Mercurial > iotbalkon / file comparison

comparison: esp-idf-lib/components/apds9930/apds9930.c

esp-idf-lib/components/apds9930/apds9930.c

changeset 11
bdc123ae7b49
child 12
bb72d448e282
equal deleted inserted replaced
10:eee990609da7 11:bdc123ae7b49
1 /**
2 * @file APDS-9930.cpp
3 * @brief Library for the SparkFun APDS-9930 breakout board
4 * @author Shawn Hymel (SparkFun Electronics)
5 *
6 * @copyright This code is public domain but you buy me a beer if you use
7 * this and we meet someday (Beerware license). Davide Depau Arduino version.
8 *
9 * This library interfaces the Avago APDS-9930 to ESP-IDf over I2C.
10 *
11 * APDS-9930 current draw tests (default parameters):
12 * Off: 1mA
13 * Waiting for gesture: 14mA
14 * Gesture in progress: 35mA
15 */
16
17 #include "apds9930.h"
18 #include <inttypes.h>
19 #include <esp_log.h>
20 #include <esp_idf_lib_helpers.h>
21
22 #define I2C_FREQ_HZ 1000000 // Max 1MHz for esp-idf
23
24 static const char *TAG = "apds9930";
25
26
27 /* Error code for returned values */
28 #define APDS9930_ERROR 0xFF
29
30 /* Command register modes */
31 #define APDS9930_REPEATED_BYTE 0x80
32 #define APDS9930_AUTO_INCREMENT 0xA0
33 #define APDS9930_SPECIAL_FN 0xE0
34
35 /* APDS-9930 register addresses */
36 #define APDS9930_ENABLE 0x00
37 #define APDS9930_ATIME 0x01
38 #define APDS9930_PTIME 0x02
39 #define APDS9930_WTIME 0x03
40 #define APDS9930_AILTL 0x04
41 #define APDS9930_AILTH 0x05
42 #define APDS9930_AIHTL 0x06
43 #define APDS9930_AIHTH 0x07
44 #define APDS9930_PILTL 0x08
45 #define APDS9930_PILTH 0x09
46 #define APDS9930_PIHTL 0x0A
47 #define APDS9930_PIHTH 0x0B
48 #define APDS9930_PERS 0x0C
49 #define APDS9930_CONFIG 0x0D
50 #define APDS9930_PPULSE 0x0E
51 #define APDS9930_CONTROL 0x0F
52 #define APDS9930_ID 0x12
53 #define APDS9930_STATUS 0x13
54 #define APDS9930_Ch0DATAL 0x14
55 #define APDS9930_Ch0DATAH 0x15
56 #define APDS9930_Ch1DATAL 0x16
57 #define APDS9930_Ch1DATAH 0x17
58 #define APDS9930_PDATAL 0x18
59 #define APDS9930_PDATAH 0x19
60 #define APDS9930_POFFSET 0x1E
61
62 /* Bit fields */
63 #define APDS9930_PON 0b00000001
64 #define APDS9930_AEN 0b00000010
65 #define APDS9930_PEN 0b00000100
66 #define APDS9930_WEN 0b00001000
67 #define APSD9930_AIEN 0b00010000
68 #define APDS9930_PIEN 0b00100000
69 #define APDS9930_SAI 0b01000000
70
71 /* On/Off definitions */
72 #define APDS9930_OFF 0
73 #define APDS9930_ON 1
74
75 /* Default values */
76 #define APDS9930_DEFAULT_ATIME 0xED
77 #define APDS9930_DEFAULT_WTIME 0xFF
78 #define APDS9930_DEFAULT_PTIME 0xFF
79 #define APDS9930_DEFAULT_PPULSE 0x08
80 #define APDS9930_DEFAULT_POFFSET 0 // 0 offset
81 #define APDS9930_DEFAULT_CONFIG 0
82 #define APDS9930_DEFAULT_PDRIVE APDS9930_LED_DRIVE_100MA
83 #define APDS9930_DEFAULT_PDIODE 2
84 #define APDS9930_DEFAULT_PGAIN APDS9930_PGAIN_8X
85 #define APDS9930_DEFAULT_AGAIN APDS9930_AGAIN_1X
86 #define APDS9930_DEFAULT_PILT 0 // Low proximity threshold
87 #define APDS9930_DEFAULT_PIHT 50 // High proximity threshold
88 #define APDS9930_DEFAULT_AILT 0xFFFF // Force interrupt for calibration
89 #define APDS9930_DEFAULT_AIHT 0
90 #define APDS9930_DEFAULT_PERS 0x22 // 2 consecutive prox or ALS for int.
91
92 /* Acceptable parameters for setMode */
93 #define APDS9930_MODE_POWER 0
94 #define APDS9930_MODE_AMBIENT_LIGHT 1
95 #define APDS9930_MODE_PROXIMITY 2
96 #define APDS9930_MODE_WAIT 3
97 #define APDS9930_MODE_AMBIENT_LIGHT_INT 4
98 #define APDS9930_MODE_PROXIMITY_INT 5
99 #define APDS9930_MODE_SLEEP_AFTER_INT 6
100 #define APDS9930_MODE_ALL 7
101
102 /* Interrupt clear values */
103 #define APDS9930_CLEAR_PROX_INT 0xE5
104 #define APDS9930_CLEAR_ALS_INT 0xE6
105 #define APDS9930_CLEAR_ALL_INTS 0xE7
106
107 /* ALS coefficients */
108 #define APDS9930_DF 52
109 #define APDS9930_GA 0.49
110 #define APDS9930_ALS_B 1.862
111 #define APDS9930_ALS_C 0.746
112 #define APDS9930_ALS_D 1.291
113
114
115 #define CHECK(x) do { esp_err_t __; if ((__ = x) != ESP_OK) return __; } while (0)
116 #define CHECK_ARG(VAL) do { if (!(VAL)) return ESP_ERR_INVALID_ARG; } while (0)
117 #define CHECK_LOGE(dev, x, msg, ...) do { \
118 esp_err_t __; \
119 if ((__ = x) != ESP_OK) { \
120 I2C_DEV_GIVE_MUTEX(dev); \
121 ESP_LOGE(TAG, msg, ## __VA_ARGS__); \
122 return __; \
123 } \
124 } while (0)
125
126
127 inline static esp_err_t write_register8(i2c_dev_t *dev, uint8_t addr, uint8_t value)
128 {
129 return i2c_dev_write_reg(dev, addr, &value, 1);
130 }
131
132
133 esp_err_t apds9930_init_desc(i2c_dev_t *dev, uint8_t addr, i2c_port_t port, gpio_num_t sda_gpio, gpio_num_t scl_gpio)
134 {
135 CHECK_ARG(dev);
136 CHECK_ARG(addr & 0x20);
137
138 dev->port = port;
139 dev->addr = addr;
140 dev->cfg.sda_io_num = sda_gpio;
141 dev->cfg.scl_io_num = scl_gpio;
142 #if HELPER_TARGET_IS_ESP32
143 dev->cfg.master.clk_speed = I2C_FREQ_HZ;
144 #endif
145
146 return i2c_dev_create_mutex(dev);
147 }
148
149
150 esp_err_t apds9930_free_desc(i2c_dev_t *dev)
151 {
152 CHECK_ARG(dev);
153
154 return i2c_dev_delete_mutex(dev);
155 }
156
157
158 esp_err_t apds9930_init(i2c_dev_t *dev)
159 {
160 esp_err_t err = ESP_OK;
161 uint8_t id;
162
163 CHECK_ARG(dev);
164 I2C_DEV_TAKE_MUTEX(dev);
165
166 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_ID, &id, 1), "Sensor not found");
167
168 if (id != APDS9930_ID_1 && id != APDS9930_ID_2 && id != APDS9930_ID_3) {
169 CHECK_LOGE(dev, ESP_ERR_INVALID_VERSION,
170 "Invalid chip ID: expected: 0x%x or 0x%x or 0x%x got: 0x%x",
171 APDS9930_ID_1, APDS9930_ID_2, APDS9930_ID_3, id);
172 }
173
174 /* Set ENABLE register to 0 (disable all features) */
175 if ( !apds9930_setMode(dev, APDS9930_MODE_ALL, APDS9930_OFF) ) {
176 ESP_LOGE(TAG, "Regs off");
177 err = ESP_ERR_INVALID_ARG;
178 }
179
180 /* Set default values for ambient light and proximity registers */
181 CHECK_LOGE(dev, write_register8(dev, APDS9930_ATIME, APDS9930_DEFAULT_ATIME), "Default atime");
182 CHECK_LOGE(dev, write_register8(dev, APDS9930_WTIME, APDS9930_DEFAULT_WTIME), "Default wtime");
183 CHECK_LOGE(dev, write_register8(dev, APDS9930_PPULSE, APDS9930_DEFAULT_PPULSE), "Default ppulse");
184 CHECK_LOGE(dev, write_register8(dev, APDS9930_POFFSET, APDS9930_DEFAULT_POFFSET), "Default poffset");
185 CHECK_LOGE(dev, write_register8(dev, APDS9930_CONFIG, APDS9930_DEFAULT_CONFIG), "Default config");
186 CHECK_LOGE(dev, apds9930_setLEDDrive(dev, APDS9930_DEFAULT_PDRIVE), "Default pdrive");
187 CHECK_LOGE(dev, apds9930_setProximityGain(dev, APDS9930_DEFAULT_PGAIN), "Default pgain");
188 CHECK_LOGE(dev, apds9930_setAmbientLightGain(dev, APDS9930_DEFAULT_AGAIN), "Default again");
189 CHECK_LOGE(dev, apds9930_setProximityDiode(dev, APDS9930_DEFAULT_PDIODE), "Default pdiode");
190 CHECK_LOGE(dev, apds9930_setProximityIntLowThreshold(dev, APDS9930_DEFAULT_PILT), "Default PILT");
191 CHECK_LOGE(dev, apds9930_setProximityIntHighThreshold(dev, APDS9930_DEFAULT_PIHT), "Default PIHT");
192 CHECK_LOGE(dev, apds9930_setLightIntLowThreshold(dev, APDS9930_DEFAULT_AILT), "Default ailt");
193 CHECK_LOGE(dev, apds9930_setLightIntHighThreshold(dev, APDS9930_DEFAULT_AIHT), "Default aiht");
194 CHECK_LOGE(dev, write_register8(dev, APDS9930_PERS, APDS9930_DEFAULT_PERS), "Default pers");
195
196 I2C_DEV_GIVE_MUTEX(dev);
197 return err;
198 }
199
200 /*******************************************************************************
201 * Public methods for controlling the APDS-9930
202 ******************************************************************************/
203
204 uint8_t apds9930_getMode(i2c_dev_t *dev)
205 {
206 uint8_t enable_value;
207
208 I2C_DEV_TAKE_MUTEX(dev);
209 /* Read current ENABLE register */
210 if (i2c_dev_read_reg(dev, APDS9930_ENABLE, &enable_value, 1) != ESP_OK) {
211 I2C_DEV_GIVE_MUTEX(dev);
212 return APDS9930_ERROR;
213 }
214
215 I2C_DEV_GIVE_MUTEX(dev);
216 return enable_value;
217 }
218
219
220 esp_err_t apds9930_setMode(i2c_dev_t *dev, uint8_t mode, uint8_t enable)
221 {
222 uint8_t reg_val;
223
224 CHECK_ARG(dev);
225 /* Read current ENABLE register */
226 reg_val = apds9930_getMode(dev);
227 if( reg_val == APDS9930_ERROR ) {
228 return ESP_ERR_INVALID_RESPONSE;
229 }
230
231 /* Change bit(s) in ENABLE register */
232 enable = enable & 0x01;
233 if (mode <= 6) {
234 if (enable) {
235 reg_val |= (1 << mode);
236 } else {
237 reg_val &= ~(1 << mode);
238 }
239 } else if (mode == APDS9930_MODE_ALL) {
240 if (enable) {
241 reg_val = 0x7F;
242 } else {
243 reg_val = 0x00;
244 }
245 }
246
247 /* Write value back to ENABLE register */
248 I2C_DEV_TAKE_MUTEX(dev);
249 CHECK_LOGE(dev, write_register8(dev, APDS9930_ENABLE, reg_val), "Enable register");
250 I2C_DEV_GIVE_MUTEX(dev);
251
252 return ESP_OK;
253 }
254
255
256 esp_err_t apds9930_enableLightSensor(i2c_dev_t *dev, bool interrupts)
257 {
258 CHECK_ARG(dev);
259
260 /* Set default gain, interrupts, enable power, and enable sensor */
261 CHECK_LOGE(dev, apds9930_setAmbientLightGain(dev, APDS9930_DEFAULT_AGAIN), "setAmbientLightGain");
262 if ( interrupts ) {
263 CHECK_LOGE(dev, apds9930_setAmbientLightIntEnable(dev, 1), "setAmbientLightIntEnable(1)");
264 } else {
265 CHECK_LOGE(dev, apds9930_setAmbientLightIntEnable(dev, 0), "setAmbientLightIntEnable(0)");
266 }
267 CHECK_LOGE(dev, apds9930_enablePower(dev), "enablePower");
268 CHECK_LOGE(dev, apds9930_setMode(dev, APDS9930_MODE_AMBIENT_LIGHT, 1), "setMode");
269
270 return ESP_OK;
271 }
272
273
274 esp_err_t apds9930_disableLightSensor(i2c_dev_t *dev)
275 {
276 CHECK_ARG(dev);
277
278 CHECK_LOGE(dev, apds9930_setAmbientLightIntEnable(dev, 0), "setAmbientLightIntEnable(0)");
279 CHECK_LOGE(dev, apds9930_setMode(dev, APDS9930_MODE_AMBIENT_LIGHT, 0), "setMode");
280
281 return ESP_OK;
282 }
283
284
285 esp_err_t apds9930_enableProximitySensor(i2c_dev_t *dev, bool interrupts)
286 {
287 CHECK_ARG(dev);
288
289 /* Set default gain, LED, interrupts, enable power, and enable sensor */
290 CHECK_LOGE(dev, apds9930_setProximityGain(dev, APDS9930_DEFAULT_PGAIN), "setProximityGain");
291 CHECK_LOGE(dev, apds9930_setLEDDrive(dev, APDS9930_DEFAULT_PDRIVE), "setLEDDrive");
292 if( interrupts ) {
293 CHECK_LOGE(dev, apds9930_setProximityIntEnable(dev, 1), "setProximityIntEnable(1)");
294 } else {
295 CHECK_LOGE(dev, apds9930_setProximityIntEnable(dev, 0), "setProximityIntEnable(0)");
296 }
297 CHECK_LOGE(dev, apds9930_enablePower(dev), "enablePower");
298 CHECK_LOGE(dev, apds9930_setMode(dev, APDS9930_MODE_PROXIMITY, 1), "setMode");
299
300 return ESP_OK;
301 }
302
303
304 esp_err_t apds9930_disableProximitySensor(i2c_dev_t *dev)
305 {
306 CHECK_ARG(dev);
307
308 CHECK_LOGE(dev, apds9930_setProximityIntEnable(dev, 0), "setProximityIntEnable(0)");
309 CHECK_LOGE(dev, apds9930_setMode(dev, APDS9930_MODE_PROXIMITY, 0), "setMode");
310
311 return ESP_OK;
312 }
313
314
315 esp_err_t apds9930_enablePower(i2c_dev_t *dev)
316 {
317 return apds9930_setMode(dev, APDS9930_MODE_POWER, 1);
318 }
319
320
321 esp_err_t apds9930_disablePower(i2c_dev_t *dev)
322 {
323 return apds9930_setMode(dev, APDS9930_MODE_POWER, 0);
324 }
325
326
327 /*******************************************************************************
328 * Ambient light sensor controls
329 ******************************************************************************/
330
331 esp_err_t apds9930_readAmbientLightLux(i2c_dev_t *dev, float *val)
332 {
333 uint16_t Ch0, Ch1;
334
335 /* Read value from channels */
336 CHECK_LOGE(dev, apds9930_readCh0Light(dev, &Ch0), "read ch0");
337 CHECK_LOGE(dev, apds9930_readCh1Light(dev, &Ch1), "read ch1");
338 *val = apds9930_floatAmbientToLux(dev, Ch0, Ch1);
339
340 return ESP_OK;
341 }
342
343
344 esp_err_t apds9930_readulAmbientLightLux(i2c_dev_t *dev, unsigned long *val)
345 {
346 uint16_t Ch0, Ch1;
347
348 /* Read value from channels */
349 CHECK_LOGE(dev, apds9930_readCh0Light(dev, &Ch0), "read ch0");
350 CHECK_LOGE(dev, apds9930_readCh1Light(dev, &Ch1), "read ch1");
351 *val = apds9930_ulongAmbientToLux(dev, Ch0, Ch1);
352
353 return ESP_OK;
354 }
355
356
357 float apds9930_floatAmbientToLux(i2c_dev_t *dev, uint16_t Ch0, uint16_t Ch1)
358 {
359 uint8_t x[4] = {1,8,16,120};
360 float iac;
361
362 float ALSIT = 2.73 * (256 - APDS9930_DEFAULT_ATIME);
363 if ((Ch0 - APDS9930_ALS_B * Ch1) > (APDS9930_ALS_C * Ch0 - APDS9930_ALS_D * Ch1))
364 iac = Ch0 - APDS9930_ALS_B * Ch1;
365 else
366 iac = APDS9930_ALS_C * Ch0 - APDS9930_ALS_D * Ch1;
367 //float iac = fmax(Ch0 - APDS9930_ALS_B * Ch1, APDS9930_ALS_C * Ch0 - APDS9930_ALS_D * Ch1);
368 if (iac < 0)
369 iac = 0;
370 float lpc = APDS9930_GA * APDS9930_DF / (ALSIT * x[apds9930_getAmbientLightGain(dev)]);
371 return iac * lpc;
372 }
373
374
375 unsigned long apds9930_ulongAmbientToLux(i2c_dev_t *dev, uint16_t Ch0, uint16_t Ch1)
376 {
377 uint8_t x[4] = {1,8,16,120};
378 unsigned long iac;
379
380 unsigned long ALSIT = 2.73 * (256 - APDS9930_DEFAULT_ATIME);
381 if ((Ch0 - APDS9930_ALS_B * Ch1) > (APDS9930_ALS_C * Ch0 - APDS9930_ALS_D * Ch1))
382 iac = Ch0 - APDS9930_ALS_B * Ch1;
383 else
384 iac = APDS9930_ALS_C * Ch0 - APDS9930_ALS_D * Ch1;
385 //unsigned long iac = max(Ch0 - APDS9930_ALS_B * Ch1, APDS9930_ALS_C * Ch0 - APDS9930_ALS_D * Ch1);
386 // if (iac < 0) iac = 0;
387 unsigned long lpc = APDS9930_GA * APDS9930_DF / (ALSIT * x[apds9930_getAmbientLightGain(dev)]);
388 return iac * lpc;
389 }
390
391
392 esp_err_t apds9930_readCh0Light(i2c_dev_t *dev, uint16_t *val)
393 {
394 uint8_t val_byte;
395 *val = 0;
396
397 CHECK_ARG(dev);
398
399 I2C_DEV_TAKE_MUTEX(dev);
400 /* Read value from channel 0 */
401 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_Ch0DATAL, &val_byte, 1), "Read ch0 low");
402 *val = val_byte;
403 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_Ch0DATAH, &val_byte, 1), "Read ch0 high");
404 *val += ((uint16_t)val_byte << 8);
405 I2C_DEV_GIVE_MUTEX(dev);
406
407 return ESP_OK;
408 }
409
410
411 esp_err_t apds9930_readCh1Light(i2c_dev_t *dev, uint16_t *val)
412 {
413 uint8_t val_byte;
414 *val = 0;
415
416 I2C_DEV_TAKE_MUTEX(dev);
417 /* Read value from channel 1 */
418 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_Ch1DATAL, &val_byte, 1), "Read ch1 low");
419 *val = val_byte;
420 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_Ch1DATAH, &val_byte, 1), "Read ch1 high");
421 *val += ((uint16_t)val_byte << 8);
422 I2C_DEV_GIVE_MUTEX(dev);
423
424 return ESP_OK;
425 }
426
427 /*******************************************************************************
428 * Proximity sensor controls
429 ******************************************************************************/
430
431 esp_err_t apds9930_readProximity(i2c_dev_t *dev, uint16_t *val)
432 {
433 *val = 0;
434 uint8_t val_byte;
435
436 I2C_DEV_TAKE_MUTEX(dev);
437 /* Read value from proximity data register */
438 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_PDATAL, &val_byte, 1), "Read proximity low");
439 *val = val_byte;
440 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_PDATAH, &val_byte, 1), "Read proximity high");
441 *val += ((uint16_t)val_byte << 8);
442 I2C_DEV_GIVE_MUTEX(dev);
443
444 return ESP_OK;
445 }
446
447 /*******************************************************************************
448 * Getters and setters for register values
449 ******************************************************************************/
450
451 uint16_t apds9930_getProximityIntLowThreshold(i2c_dev_t *dev)
452 {
453 uint16_t val;
454 uint8_t val_byte;
455
456 /* Read value from PILT register */
457 I2C_DEV_TAKE_MUTEX(dev);
458 if (i2c_dev_read_reg(dev, APDS9930_PILTL, &val_byte, 1) != ESP_OK) {
459 val = 0;
460 }
461 val = val_byte;
462 if (i2c_dev_read_reg(dev, APDS9930_PILTH, &val_byte, 1) != ESP_OK) {
463 val = 0;
464 }
465 I2C_DEV_GIVE_MUTEX(dev);
466 val |= ((uint16_t)val_byte << 8);
467
468 return val;
469 }
470
471
472 esp_err_t apdsi9930_setProximityIntLowThreshold(i2c_dev_t *dev, uint16_t threshold)
473 {
474 uint8_t lo;
475 uint8_t hi;
476 hi = threshold >> 8;
477 lo = threshold & 0x00FF;
478
479 I2C_DEV_TAKE_MUTEX(dev);
480 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_PILTL, &lo, 1), "Write PILTL");
481 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_PILTH, &hi, 1), "Write PILTH");
482 I2C_DEV_GIVE_MUTEX(dev);
483
484 return ESP_OK;
485 }
486
487
488 uint16_t apds9930_getProximityIntHighThreshold(i2c_dev_t *dev)
489 {
490 uint16_t val;
491 uint8_t val_byte;
492
493 /* Read value from PIHT register */
494 I2C_DEV_TAKE_MUTEX(dev);
495 if (i2c_dev_read_reg(dev, APDS9930_PIHTL, &val_byte, 1) != ESP_OK) {
496 val = 0;
497 }
498 val = val_byte;
499 if (i2c_dev_read_reg(dev, APDS9930_PIHTH, &val_byte, 1) != ESP_OK) {
500 val = 0;
501 }
502 I2C_DEV_GIVE_MUTEX(dev);
503 val |= ((uint16_t)val_byte << 8);
504
505 return val;
506 }
507
508
509 esp_err_t apds9930_setProximityIntHighThreshold(i2c_dev_t *dev, uint16_t threshold)
510 {
511 uint8_t lo;
512 uint8_t hi;
513 hi = threshold >> 8;
514 lo = threshold & 0x00FF;
515
516 I2C_DEV_TAKE_MUTEX(dev);
517 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_PIHTL, &lo, 1), "Write PIHTL");
518 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_PIHTH, &hi, 1), "Write PIHTH");
519 I2C_DEV_GIVE_MUTEX(dev);
520
521 return ESP_OK;
522 }
523
524
525 uint8_t apds9930_getLEDDrive(i2c_dev_t *dev)
526 {
527 uint8_t val;
528
529 /* Read value from CONTROL register */
530 I2C_DEV_TAKE_MUTEX(dev);
531 if (i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1) != ESP_OK) {
532 I2C_DEV_GIVE_MUTEX(dev);
533 return APDS9930_ERROR;;
534 }
535 I2C_DEV_GIVE_MUTEX(dev);
536
537 /* Shift and mask out LED drive bits */
538 val = (val >> 6) & 0b00000011;
539
540 return val;
541 }
542
543
544 esp_err_t apds9930_setLEDDrive(i2c_dev_t *dev, uint8_t drive)
545 {
546 uint8_t val;
547
548 /* Read value from CONTROL register */
549 I2C_DEV_TAKE_MUTEX(dev);
550 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1), "Read control");
551
552 /* Set bits in register to given value */
553 drive &= 0b00000011;
554 drive = drive << 6;
555 val &= 0b00111111;
556 val |= drive;
557
558 /* Write register value back into CONTROL register */
559 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_CONTROL, &val, 1), "Write control");
560 I2C_DEV_GIVE_MUTEX(dev);
561
562 return ESP_OK;
563 }
564
565
566 uint8_t apds9930_getProximityGain(i2c_dev_t *dev)
567 {
568 uint8_t val;
569
570 /* Read value from CONTROL register */
571 I2C_DEV_TAKE_MUTEX(dev);
572 if (i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1) != ESP_OK) {
573 I2C_DEV_GIVE_MUTEX(dev);
574 return APDS9930_ERROR;;
575 }
576 I2C_DEV_GIVE_MUTEX(dev);
577
578 /* Shift and mask out PDRIVE bits */
579 val = (val >> 2) & 0b00000011;
580
581 return val;
582 }
583
584
585 esp_err_t apds9930_setProximityGain(i2c_dev_t *dev, uint8_t drive)
586 {
587 uint8_t val;
588
589 /* Read value from CONTROL register */
590 I2C_DEV_TAKE_MUTEX(dev);
591 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1), "Read control");
592
593 /* Set bits in register to given value */
594 drive &= 0b00000011;
595 drive = drive << 2;
596 val &= 0b11110011;
597 val |= drive;
598
599 /* Write register value back into CONTROL register */
600 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_CONTROL, &val, 1), "Write control");
601 I2C_DEV_GIVE_MUTEX(dev);
602
603 return ESP_OK;
604 }
605
606
607 uint8_t apds9930_getProximityDiode(i2c_dev_t *dev)
608 {
609 uint8_t val;
610
611 /* Read value from CONTROL register */
612 I2C_DEV_TAKE_MUTEX(dev);
613 if (i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1) != ESP_OK) {
614 I2C_DEV_GIVE_MUTEX(dev);
615 return APDS9930_ERROR;;
616 }
617 I2C_DEV_GIVE_MUTEX(dev);
618
619 /* Shift and mask out PDRIVE bits */
620 val = (val >> 4) & 0b00000011;
621
622 return val;
623 }
624
625
626 esp_err_t apds9930_setProximityDiode(i2c_dev_t *dev, uint8_t drive)
627 {
628 uint8_t val;
629
630 /* Read value from CONTROL register */
631 I2C_DEV_TAKE_MUTEX(dev);
632 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1), "Read control");
633
634 /* Set bits in register to given value */
635 drive &= 0b00000011;
636 drive = drive << 4;
637 val &= 0b11001111;
638 val |= drive;
639
640 /* Write register value back into CONTROL register */
641 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_CONTROL, &val, 1), "Write control");
642 I2C_DEV_GIVE_MUTEX(dev);
643
644 return ESP_OK;
645 }
646
647
648 uint8_t apds9930_getAmbientLightGain(i2c_dev_t *dev)
649 {
650 uint8_t val;
651
652 /* Read value from CONTROL register */
653 I2C_DEV_TAKE_MUTEX(dev);
654 if (i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1) != ESP_OK) {
655 I2C_DEV_GIVE_MUTEX(dev);
656 return APDS9930_ERROR;;
657 }
658 I2C_DEV_GIVE_MUTEX(dev);
659
660 /* Shift and mask out ADRIVE bits */
661 val &= 0b00000011;
662
663 return val;
664 }
665
666
667 esp_err_t apds9930_setAmbientLightGain(i2c_dev_t *dev, uint8_t drive)
668 {
669 uint8_t val;
670
671 /* Read value from CONTROL register */
672 I2C_DEV_TAKE_MUTEX(dev);
673 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1), "Read control");
674
675 /* Set bits in register to given value */
676 drive &= 0b00000011;
677 val &= 0b11111100;
678 val |= drive;
679
680 /* Write register value back into CONTROL register */
681 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_CONTROL, &val, 1), "Write control");
682 I2C_DEV_GIVE_MUTEX(dev);
683
684 return true;
685 }
686
687
688 uint8_t apds9930_getAmbientGainLevel(i2c_dev_t *dev)
689 {
690 uint8_t val;
691
692 /* Read value from CONTROL register */
693 I2C_DEV_TAKE_MUTEX(dev);
694 if (i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1) != ESP_OK) {
695 I2C_DEV_GIVE_MUTEX(dev);
696 return APDS9930_ERROR;;
697 }
698 I2C_DEV_GIVE_MUTEX(dev);
699
700 /* Shift and mask out AGL bit */
701 val = (val >> 2) & 0b00000001;
702
703 return val;
704 }
705
706
707 esp_err_t apds9930_setAmbientGainLevel(i2c_dev_t *dev, uint8_t enable)
708 {
709 uint8_t val;
710
711 /* Read value from CONTROL register */
712 I2C_DEV_TAKE_MUTEX(dev);
713 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_CONTROL, &val, 1), "Read control");
714
715 /* Set bits in register to given value */
716 enable &= 0b00000001;
717 enable = enable << 2;
718 val &= 0b11111011;
719 val |= enable;
720
721 /* Write register value back into CONTROL register */
722 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_CONTROL, &val, 1), "Write control");
723 I2C_DEV_GIVE_MUTEX(dev);
724
725 return ESP_OK;
726 }
727
728
729 esp_err_t apds9930_getLightIntLowThreshold(i2c_dev_t *dev, uint16_t *threshold)
730 {
731 uint8_t val_byte;
732 *threshold = 0;
733
734 /* Read value from ambient light low threshold, low byte register */
735 I2C_DEV_TAKE_MUTEX(dev);
736 if (i2c_dev_read_reg(dev, APDS9930_AILTL, &val_byte, 1) != ESP_OK) {
737 *threshold = 0;
738 }
739 *threshold = val_byte;
740 if (i2c_dev_read_reg(dev, APDS9930_AILTH, &val_byte, 1) != ESP_OK) {
741 *threshold = 0;
742 }
743 I2C_DEV_GIVE_MUTEX(dev);
744 *threshold = *threshold + ((uint16_t)val_byte << 8);
745
746 return ESP_OK;
747 }
748
749
750 esp_err_t apds9930_setLightIntLowThreshold(i2c_dev_t *dev, uint16_t threshold)
751 {
752 uint8_t val_low;
753 uint8_t val_high;
754
755 /* Break 16-bit threshold into 2 8-bit values */
756 val_low = threshold & 0x00FF;
757 val_high = (threshold & 0xFF00) >> 8;
758
759 I2C_DEV_TAKE_MUTEX(dev);
760 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_AILTL, &val_low, 1), "Write AILTL");
761 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_AILTH, &val_high, 1), "Write AILTH");
762 I2C_DEV_GIVE_MUTEX(dev);
763
764 return ESP_OK;
765 }
766
767
768 esp_err_t apds9930_getLightIntHighThreshold(i2c_dev_t *dev, uint16_t *threshold)
769 {
770 uint8_t val_byte;
771 *threshold = 0;
772
773 /* Read value from ambient light high threshold, low byte register */
774 I2C_DEV_TAKE_MUTEX(dev);
775 if (i2c_dev_read_reg(dev, APDS9930_AIHTL, &val_byte, 1) != ESP_OK) {
776 *threshold = 0;
777 }
778 *threshold = val_byte;
779 if (i2c_dev_read_reg(dev, APDS9930_AIHTH, &val_byte, 1) != ESP_OK) {
780 *threshold = 0;
781 }
782 I2C_DEV_GIVE_MUTEX(dev);
783 *threshold = *threshold + ((uint16_t)val_byte << 8);
784
785 return ESP_OK;
786 }
787
788
789 esp_err_t apds9930_setLightIntHighThreshold(i2c_dev_t *dev, uint16_t threshold)
790 {
791 uint8_t val_low;
792 uint8_t val_high;
793
794 /* Break 16-bit threshold into 2 8-bit values */
795 val_low = threshold & 0x00FF;
796 val_high = (threshold & 0xFF00) >> 8;
797
798 I2C_DEV_TAKE_MUTEX(dev);
799 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_AIHTL, &val_low, 1), "Write AIHTL");
800 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_AIHTH, &val_high, 1), "Write AIHTH");
801 I2C_DEV_GIVE_MUTEX(dev);
802
803 return ESP_OK;
804 }
805
806
807 uint8_t apds9930_getAmbientLightIntEnable(i2c_dev_t *dev)
808 {
809 uint8_t val;
810
811 /* Read value from ENABLE register */
812 I2C_DEV_TAKE_MUTEX(dev);
813 if (i2c_dev_read_reg(dev, APDS9930_ENABLE, &val, 1) != ESP_OK) {
814 I2C_DEV_GIVE_MUTEX(dev);
815 return APDS9930_ERROR;;
816 }
817 I2C_DEV_GIVE_MUTEX(dev);
818
819 /* Shift and mask out AIEN bit */
820 val = (val >> 4) & 0b00000001;
821
822 return val;
823 }
824
825
826 esp_err_t apds9930_setAmbientLightIntEnable(i2c_dev_t *dev, uint8_t enable)
827 {
828 uint8_t val;
829
830 /* Read value from ENABLE register */
831 I2C_DEV_TAKE_MUTEX(dev);
832 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_ENABLE, &val, 1), "Read enable");
833
834 /* Set bits in register to given value */
835 enable &= 0b00000001;
836 enable = enable << 4;
837 val &= 0b11101111;
838 val |= enable;
839
840 /* Write register value back into ENABLE register */
841 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_ENABLE, &val, 1), "Write enable");
842 I2C_DEV_GIVE_MUTEX(dev);
843
844 return ESP_OK;
845 }
846
847
848 uint8_t apds9930_getProximityIntEnable(i2c_dev_t *dev)
849 {
850 uint8_t val;
851
852 /* Read value from ENABLE register */
853 I2C_DEV_TAKE_MUTEX(dev);
854 if (i2c_dev_read_reg(dev, APDS9930_ENABLE, &val, 1) != ESP_OK) {
855 I2C_DEV_GIVE_MUTEX(dev);
856 return APDS9930_ERROR;;
857 }
858 I2C_DEV_GIVE_MUTEX(dev);
859
860 /* Shift and mask out PIEN bit */
861 val = (val >> 5) & 0b00000001;
862
863 return val;
864 }
865
866
867 esp_err_t apds9930_setProximityIntEnable(i2c_dev_t *dev, uint8_t enable)
868 {
869 uint8_t val;
870
871 /* Read value from ENABLE register */
872 I2C_DEV_TAKE_MUTEX(dev);
873 CHECK_LOGE(dev, i2c_dev_read_reg(dev, APDS9930_ENABLE, &val, 1), "Read enable");
874
875 /* Set bits in register to given value */
876 enable &= 0b00000001;
877 enable = enable << 5;
878 val &= 0b11011111;
879 val |= enable;
880
881 /* Write register value back into ENABLE register */
882 CHECK_LOGE(dev, i2c_dev_write_reg(dev, APDS9930_ENABLE, &val, 1), "Write enable");
883 I2C_DEV_GIVE_MUTEX(dev);
884
885 return ESP_OK;
886 }
887
888
889 esp_err_t apds9930_clearAmbientLightInt(i2c_dev_t *dev)
890 {
891 uint8_t val = APDS9930_CLEAR_ALS_INT;
892
893 I2C_DEV_TAKE_MUTEX(dev);
894 /* This should write to the chip without register address */
895 CHECK_LOGE(dev, i2c_dev_write(dev, NULL, 0, &val, 1), "Clear ALS_INT");
896 I2C_DEV_GIVE_MUTEX(dev);
897
898 // if( !wireWriteByte(CLEAR_ALS_INT) ) {
899 // return false;
900 //}
901
902 return ESP_OK;
903 }
904
905
906 esp_err_t apds9930_clearProximityInt(i2c_dev_t *dev)
907 {
908 uint8_t val = APDS9930_CLEAR_PROX_INT;
909
910 I2C_DEV_TAKE_MUTEX(dev);
911 CHECK_LOGE(dev, i2c_dev_write(dev, NULL, 0, &val, 1), "Clear PROX_INT");
912 I2C_DEV_GIVE_MUTEX(dev);
913
914 return ESP_OK;
915 }
916
917
918 esp_err_t apds9930_clearAllInts(i2c_dev_t *dev)
919 {
920 uint8_t val = APDS9930_CLEAR_ALL_INTS;
921
922 I2C_DEV_TAKE_MUTEX(dev);
923 CHECK_LOGE(dev, i2c_dev_write(dev, NULL, 0, &val, 1), "Clear ALL_INTS");
924 I2C_DEV_GIVE_MUTEX(dev);
925
926 return ESP_OK;
927 }
928

Mercurial Repository: iotbalkon

mercurial