APDS9960 gesture sensor library for use with mbed. Ported from Justin Woodman's RPI APDS9960 library.
APDS9960_I2C.cpp@0:49ae62548910, 2015-05-19 (annotated)
- Committer:
- chiggayeuh
- Date:
- Tue May 19 11:00:23 2015 +0000
- Revision:
- 0:49ae62548910
Initial release of APDS9960 library for mBed
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
chiggayeuh | 0:49ae62548910 | 1 | /** |
chiggayeuh | 0:49ae62548910 | 2 | * @file APDS9960.cpp |
chiggayeuh | 0:49ae62548910 | 3 | * @brief Raspberry Pi library for the SparkFun APDS-9960 breakout board |
chiggayeuh | 0:49ae62548910 | 4 | * @author Shawn Hymel (SparkFun Electronics), Modified for Raspberry Pi by Justin Woodman |
chiggayeuh | 0:49ae62548910 | 5 | * |
chiggayeuh | 0:49ae62548910 | 6 | * @copyright This code is public domain but you buy me a beer if you use |
chiggayeuh | 0:49ae62548910 | 7 | * this and we meet someday (Beerware license). |
chiggayeuh | 0:49ae62548910 | 8 | * |
chiggayeuh | 0:49ae62548910 | 9 | * This library interfaces the Avago APDS-9960 to Raspberry Pi over I2C. The library |
chiggayeuh | 0:49ae62548910 | 10 | * relies on the wiringPi library. to use the library, instantiate an |
chiggayeuh | 0:49ae62548910 | 11 | * APDS9960 object, call init(), and call the appropriate functions. |
chiggayeuh | 0:49ae62548910 | 12 | * |
chiggayeuh | 0:49ae62548910 | 13 | * APDS-9960 current draw tests (default parameters): |
chiggayeuh | 0:49ae62548910 | 14 | * Off: 1mA |
chiggayeuh | 0:49ae62548910 | 15 | * Waiting for gesture: 14mA |
chiggayeuh | 0:49ae62548910 | 16 | * Gesture in progress: 35mA |
chiggayeuh | 0:49ae62548910 | 17 | */ |
chiggayeuh | 0:49ae62548910 | 18 | |
chiggayeuh | 0:49ae62548910 | 19 | #include "APDS9960_I2C.h" |
chiggayeuh | 0:49ae62548910 | 20 | #include <bitset> |
chiggayeuh | 0:49ae62548910 | 21 | #include <stdio.h> |
chiggayeuh | 0:49ae62548910 | 22 | #include <stdlib.h> |
chiggayeuh | 0:49ae62548910 | 23 | #include <bitset> |
chiggayeuh | 0:49ae62548910 | 24 | #include <iostream> |
chiggayeuh | 0:49ae62548910 | 25 | #include <iomanip> |
chiggayeuh | 0:49ae62548910 | 26 | #include "mbed.h" |
chiggayeuh | 0:49ae62548910 | 27 | |
chiggayeuh | 0:49ae62548910 | 28 | |
chiggayeuh | 0:49ae62548910 | 29 | |
chiggayeuh | 0:49ae62548910 | 30 | |
chiggayeuh | 0:49ae62548910 | 31 | |
chiggayeuh | 0:49ae62548910 | 32 | |
chiggayeuh | 0:49ae62548910 | 33 | /** |
chiggayeuh | 0:49ae62548910 | 34 | * @brief Constructor - Instantiates APDS9960 object |
chiggayeuh | 0:49ae62548910 | 35 | */ |
chiggayeuh | 0:49ae62548910 | 36 | |
chiggayeuh | 0:49ae62548910 | 37 | |
chiggayeuh | 0:49ae62548910 | 38 | APDS9960_I2C::APDS9960_I2C( PinName sda, PinName scl ) : i2c( sda, scl ) |
chiggayeuh | 0:49ae62548910 | 39 | { |
chiggayeuh | 0:49ae62548910 | 40 | i2c.frequency(100000); |
chiggayeuh | 0:49ae62548910 | 41 | |
chiggayeuh | 0:49ae62548910 | 42 | gesture_ud_delta_ = 0; |
chiggayeuh | 0:49ae62548910 | 43 | gesture_lr_delta_ = 0; |
chiggayeuh | 0:49ae62548910 | 44 | |
chiggayeuh | 0:49ae62548910 | 45 | gesture_ud_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 46 | gesture_lr_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 47 | |
chiggayeuh | 0:49ae62548910 | 48 | gesture_near_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 49 | gesture_far_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 50 | |
chiggayeuh | 0:49ae62548910 | 51 | gesture_state_ = 0; |
chiggayeuh | 0:49ae62548910 | 52 | gesture_motion_ = DIR_NONE; |
chiggayeuh | 0:49ae62548910 | 53 | } |
chiggayeuh | 0:49ae62548910 | 54 | |
chiggayeuh | 0:49ae62548910 | 55 | /** |
chiggayeuh | 0:49ae62548910 | 56 | * @brief Destructor |
chiggayeuh | 0:49ae62548910 | 57 | */ |
chiggayeuh | 0:49ae62548910 | 58 | //APDS9960_I2C::~APDS9960() |
chiggayeuh | 0:49ae62548910 | 59 | //{ |
chiggayeuh | 0:49ae62548910 | 60 | |
chiggayeuh | 0:49ae62548910 | 61 | //} |
chiggayeuh | 0:49ae62548910 | 62 | |
chiggayeuh | 0:49ae62548910 | 63 | /** |
chiggayeuh | 0:49ae62548910 | 64 | * @brief Configures I2C communications and initializes registers to defaults |
chiggayeuh | 0:49ae62548910 | 65 | * |
chiggayeuh | 0:49ae62548910 | 66 | * @return True if initialized successfully. False otherwise. |
chiggayeuh | 0:49ae62548910 | 67 | */ |
chiggayeuh | 0:49ae62548910 | 68 | |
chiggayeuh | 0:49ae62548910 | 69 | uint8_t APDS9960_I2C::read_this(){ |
chiggayeuh | 0:49ae62548910 | 70 | //uint8_t val; |
chiggayeuh | 0:49ae62548910 | 71 | //wireReadDataByte(APDS9960_GFLVL, val); |
chiggayeuh | 0:49ae62548910 | 72 | //val &= 1; |
chiggayeuh | 0:49ae62548910 | 73 | /*uint8_t fifo_data[128]; |
chiggayeuh | 0:49ae62548910 | 74 | uint8_t fifo_level; |
chiggayeuh | 0:49ae62548910 | 75 | |
chiggayeuh | 0:49ae62548910 | 76 | if( !wireReadDataByte(APDS9960_GFLVL, fifo_level) ) { |
chiggayeuh | 0:49ae62548910 | 77 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 78 | } |
chiggayeuh | 0:49ae62548910 | 79 | |
chiggayeuh | 0:49ae62548910 | 80 | |
chiggayeuh | 0:49ae62548910 | 81 | val = wireReadDataBlock( APDS9960_GFIFO_U, |
chiggayeuh | 0:49ae62548910 | 82 | (uint8_t*)fifo_data, |
chiggayeuh | 0:49ae62548910 | 83 | (fifo_level * 4) ); |
chiggayeuh | 0:49ae62548910 | 84 | |
chiggayeuh | 0:49ae62548910 | 85 | return val;*/ |
chiggayeuh | 0:49ae62548910 | 86 | |
chiggayeuh | 0:49ae62548910 | 87 | } |
chiggayeuh | 0:49ae62548910 | 88 | |
chiggayeuh | 0:49ae62548910 | 89 | int APDS9960_I2C::write_this(){ |
chiggayeuh | 0:49ae62548910 | 90 | int id; |
chiggayeuh | 0:49ae62548910 | 91 | id = wireWriteDataByte(APDS9960_WTIME, DEFAULT_WTIME); |
chiggayeuh | 0:49ae62548910 | 92 | return id; |
chiggayeuh | 0:49ae62548910 | 93 | } |
chiggayeuh | 0:49ae62548910 | 94 | |
chiggayeuh | 0:49ae62548910 | 95 | bool APDS9960_I2C::init() |
chiggayeuh | 0:49ae62548910 | 96 | { |
chiggayeuh | 0:49ae62548910 | 97 | uint8_t id; |
chiggayeuh | 0:49ae62548910 | 98 | /* Initialize I2C */ |
chiggayeuh | 0:49ae62548910 | 99 | /*fd_ = wiringPiI2CSetup(APDS9960_I2C_ADDR); |
chiggayeuh | 0:49ae62548910 | 100 | if(fd_ == -1) { |
chiggayeuh | 0:49ae62548910 | 101 | return false; |
chiggayeuh | 0:49ae62548910 | 102 | }*/ |
chiggayeuh | 0:49ae62548910 | 103 | |
chiggayeuh | 0:49ae62548910 | 104 | /* Read ID register and check against known values for APDS-9960 */ |
chiggayeuh | 0:49ae62548910 | 105 | if( !wireReadDataByte(0x92, id) ) { |
chiggayeuh | 0:49ae62548910 | 106 | return false; |
chiggayeuh | 0:49ae62548910 | 107 | } |
chiggayeuh | 0:49ae62548910 | 108 | if( !(id == 0xAB || id == 0x9C) ) { |
chiggayeuh | 0:49ae62548910 | 109 | return false; |
chiggayeuh | 0:49ae62548910 | 110 | } |
chiggayeuh | 0:49ae62548910 | 111 | |
chiggayeuh | 0:49ae62548910 | 112 | /* Set ENABLE register to 0 (disable all features) */ |
chiggayeuh | 0:49ae62548910 | 113 | if( !setMode(7, 0) ) { |
chiggayeuh | 0:49ae62548910 | 114 | return false; |
chiggayeuh | 0:49ae62548910 | 115 | } |
chiggayeuh | 0:49ae62548910 | 116 | |
chiggayeuh | 0:49ae62548910 | 117 | /* Set default values for ambient light and proximity registers */ |
chiggayeuh | 0:49ae62548910 | 118 | //if( !(0x81, 219) ) { |
chiggayeuh | 0:49ae62548910 | 119 | // return false; |
chiggayeuh | 0:49ae62548910 | 120 | //} |
chiggayeuh | 0:49ae62548910 | 121 | if( !wireWriteDataByte(APDS9960_WTIME, DEFAULT_WTIME) ) { |
chiggayeuh | 0:49ae62548910 | 122 | return false; |
chiggayeuh | 0:49ae62548910 | 123 | } |
chiggayeuh | 0:49ae62548910 | 124 | if( !wireWriteDataByte(APDS9960_PPULSE, DEFAULT_PROX_PPULSE) ) { |
chiggayeuh | 0:49ae62548910 | 125 | return false; |
chiggayeuh | 0:49ae62548910 | 126 | } |
chiggayeuh | 0:49ae62548910 | 127 | if( !wireWriteDataByte(APDS9960_POFFSET_UR, DEFAULT_POFFSET_UR) ) { |
chiggayeuh | 0:49ae62548910 | 128 | return false; |
chiggayeuh | 0:49ae62548910 | 129 | } |
chiggayeuh | 0:49ae62548910 | 130 | if( !wireWriteDataByte(APDS9960_POFFSET_DL, DEFAULT_POFFSET_DL) ) { |
chiggayeuh | 0:49ae62548910 | 131 | return false; |
chiggayeuh | 0:49ae62548910 | 132 | } |
chiggayeuh | 0:49ae62548910 | 133 | if( !wireWriteDataByte(APDS9960_CONFIG1, DEFAULT_CONFIG1) ) { |
chiggayeuh | 0:49ae62548910 | 134 | return false; |
chiggayeuh | 0:49ae62548910 | 135 | } |
chiggayeuh | 0:49ae62548910 | 136 | if( !setLEDDrive(DEFAULT_LDRIVE) ) { |
chiggayeuh | 0:49ae62548910 | 137 | return false; |
chiggayeuh | 0:49ae62548910 | 138 | } |
chiggayeuh | 0:49ae62548910 | 139 | if( !setProximityGain(DEFAULT_PGAIN) ) { |
chiggayeuh | 0:49ae62548910 | 140 | return false; |
chiggayeuh | 0:49ae62548910 | 141 | } |
chiggayeuh | 0:49ae62548910 | 142 | if( !setAmbientLightGain(DEFAULT_AGAIN) ) { |
chiggayeuh | 0:49ae62548910 | 143 | return false; |
chiggayeuh | 0:49ae62548910 | 144 | } |
chiggayeuh | 0:49ae62548910 | 145 | if( !setProxIntLowThresh(DEFAULT_PILT) ) { |
chiggayeuh | 0:49ae62548910 | 146 | return false; |
chiggayeuh | 0:49ae62548910 | 147 | } |
chiggayeuh | 0:49ae62548910 | 148 | if( !setProxIntHighThresh(DEFAULT_PIHT) ) { |
chiggayeuh | 0:49ae62548910 | 149 | return false; |
chiggayeuh | 0:49ae62548910 | 150 | } |
chiggayeuh | 0:49ae62548910 | 151 | if( !setLightIntLowThreshold(DEFAULT_AILT) ) { |
chiggayeuh | 0:49ae62548910 | 152 | return false; |
chiggayeuh | 0:49ae62548910 | 153 | } |
chiggayeuh | 0:49ae62548910 | 154 | if( !setLightIntHighThreshold(DEFAULT_AIHT) ) { |
chiggayeuh | 0:49ae62548910 | 155 | return false; |
chiggayeuh | 0:49ae62548910 | 156 | } |
chiggayeuh | 0:49ae62548910 | 157 | if( !wireWriteDataByte(APDS9960_PERS, DEFAULT_PERS) ) { |
chiggayeuh | 0:49ae62548910 | 158 | return false; |
chiggayeuh | 0:49ae62548910 | 159 | } |
chiggayeuh | 0:49ae62548910 | 160 | if( !wireWriteDataByte(APDS9960_CONFIG2, DEFAULT_CONFIG2) ) { |
chiggayeuh | 0:49ae62548910 | 161 | return false; |
chiggayeuh | 0:49ae62548910 | 162 | } |
chiggayeuh | 0:49ae62548910 | 163 | if( !wireWriteDataByte(APDS9960_CONFIG3, DEFAULT_CONFIG3) ) { |
chiggayeuh | 0:49ae62548910 | 164 | return false; |
chiggayeuh | 0:49ae62548910 | 165 | } |
chiggayeuh | 0:49ae62548910 | 166 | |
chiggayeuh | 0:49ae62548910 | 167 | /* Set default values for gesture sense registers */ |
chiggayeuh | 0:49ae62548910 | 168 | if( !setGestureEnterThresh(DEFAULT_GPENTH) ) { |
chiggayeuh | 0:49ae62548910 | 169 | return false; |
chiggayeuh | 0:49ae62548910 | 170 | } |
chiggayeuh | 0:49ae62548910 | 171 | if( !setGestureExitThresh(DEFAULT_GEXTH) ) { |
chiggayeuh | 0:49ae62548910 | 172 | return false; |
chiggayeuh | 0:49ae62548910 | 173 | } |
chiggayeuh | 0:49ae62548910 | 174 | if( !wireWriteDataByte(APDS9960_GCONF1, DEFAULT_GCONF1) ) { |
chiggayeuh | 0:49ae62548910 | 175 | return false; |
chiggayeuh | 0:49ae62548910 | 176 | } |
chiggayeuh | 0:49ae62548910 | 177 | if( !setGestureGain(DEFAULT_GGAIN) ) { |
chiggayeuh | 0:49ae62548910 | 178 | return false; |
chiggayeuh | 0:49ae62548910 | 179 | } |
chiggayeuh | 0:49ae62548910 | 180 | if( !setGestureLEDDrive(DEFAULT_GLDRIVE) ) { |
chiggayeuh | 0:49ae62548910 | 181 | return false; |
chiggayeuh | 0:49ae62548910 | 182 | } |
chiggayeuh | 0:49ae62548910 | 183 | if( !setGestureWaitTime(DEFAULT_GWTIME) ) { |
chiggayeuh | 0:49ae62548910 | 184 | return false; |
chiggayeuh | 0:49ae62548910 | 185 | } |
chiggayeuh | 0:49ae62548910 | 186 | if( !wireWriteDataByte(APDS9960_GOFFSET_U, DEFAULT_GOFFSET) ) { |
chiggayeuh | 0:49ae62548910 | 187 | return false; |
chiggayeuh | 0:49ae62548910 | 188 | } |
chiggayeuh | 0:49ae62548910 | 189 | if( !wireWriteDataByte(APDS9960_GOFFSET_D, DEFAULT_GOFFSET) ) { |
chiggayeuh | 0:49ae62548910 | 190 | return false; |
chiggayeuh | 0:49ae62548910 | 191 | } |
chiggayeuh | 0:49ae62548910 | 192 | if( !wireWriteDataByte(APDS9960_GOFFSET_L, DEFAULT_GOFFSET) ) { |
chiggayeuh | 0:49ae62548910 | 193 | return false; |
chiggayeuh | 0:49ae62548910 | 194 | } |
chiggayeuh | 0:49ae62548910 | 195 | if( !wireWriteDataByte(APDS9960_GOFFSET_R, DEFAULT_GOFFSET) ) { |
chiggayeuh | 0:49ae62548910 | 196 | return false; |
chiggayeuh | 0:49ae62548910 | 197 | } |
chiggayeuh | 0:49ae62548910 | 198 | if( !wireWriteDataByte(APDS9960_GPULSE, DEFAULT_GPULSE) ) { |
chiggayeuh | 0:49ae62548910 | 199 | return false; |
chiggayeuh | 0:49ae62548910 | 200 | } |
chiggayeuh | 0:49ae62548910 | 201 | if( !wireWriteDataByte(APDS9960_GCONF3, DEFAULT_GCONF3) ) { |
chiggayeuh | 0:49ae62548910 | 202 | return false; |
chiggayeuh | 0:49ae62548910 | 203 | } |
chiggayeuh | 0:49ae62548910 | 204 | if( !setGestureIntEnable(DEFAULT_GIEN) ) { |
chiggayeuh | 0:49ae62548910 | 205 | return false; |
chiggayeuh | 0:49ae62548910 | 206 | } |
chiggayeuh | 0:49ae62548910 | 207 | |
chiggayeuh | 0:49ae62548910 | 208 | |
chiggayeuh | 0:49ae62548910 | 209 | |
chiggayeuh | 0:49ae62548910 | 210 | return true; |
chiggayeuh | 0:49ae62548910 | 211 | } |
chiggayeuh | 0:49ae62548910 | 212 | |
chiggayeuh | 0:49ae62548910 | 213 | /******************************************************************************* |
chiggayeuh | 0:49ae62548910 | 214 | * Public methods for controlling the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 215 | ******************************************************************************/ |
chiggayeuh | 0:49ae62548910 | 216 | |
chiggayeuh | 0:49ae62548910 | 217 | /** |
chiggayeuh | 0:49ae62548910 | 218 | * @brief Reads and returns the contents of the ENABLE register |
chiggayeuh | 0:49ae62548910 | 219 | * |
chiggayeuh | 0:49ae62548910 | 220 | * @return Contents of the ENABLE register. 0xFF if error. |
chiggayeuh | 0:49ae62548910 | 221 | */ |
chiggayeuh | 0:49ae62548910 | 222 | uint8_t APDS9960_I2C::getMode() |
chiggayeuh | 0:49ae62548910 | 223 | { |
chiggayeuh | 0:49ae62548910 | 224 | uint8_t enable_value; |
chiggayeuh | 0:49ae62548910 | 225 | |
chiggayeuh | 0:49ae62548910 | 226 | /* Read current ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 227 | if( !wireReadDataByte(APDS9960_ENABLE, enable_value) ) { |
chiggayeuh | 0:49ae62548910 | 228 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 229 | } |
chiggayeuh | 0:49ae62548910 | 230 | |
chiggayeuh | 0:49ae62548910 | 231 | return enable_value; |
chiggayeuh | 0:49ae62548910 | 232 | } |
chiggayeuh | 0:49ae62548910 | 233 | |
chiggayeuh | 0:49ae62548910 | 234 | /** |
chiggayeuh | 0:49ae62548910 | 235 | * @brief Enables or disables a feature in the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 236 | * |
chiggayeuh | 0:49ae62548910 | 237 | * @param[in] mode which feature to enable |
chiggayeuh | 0:49ae62548910 | 238 | * @param[in] enable ON (1) or OFF (0) |
chiggayeuh | 0:49ae62548910 | 239 | * @return True if operation success. False otherwise. |
chiggayeuh | 0:49ae62548910 | 240 | */ |
chiggayeuh | 0:49ae62548910 | 241 | bool APDS9960_I2C::setMode(uint8_t mode, uint8_t enable) |
chiggayeuh | 0:49ae62548910 | 242 | { |
chiggayeuh | 0:49ae62548910 | 243 | uint8_t reg_val; |
chiggayeuh | 0:49ae62548910 | 244 | |
chiggayeuh | 0:49ae62548910 | 245 | /* Read current ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 246 | reg_val = getMode(); |
chiggayeuh | 0:49ae62548910 | 247 | if( reg_val == ERROR ) { |
chiggayeuh | 0:49ae62548910 | 248 | return false; |
chiggayeuh | 0:49ae62548910 | 249 | } |
chiggayeuh | 0:49ae62548910 | 250 | |
chiggayeuh | 0:49ae62548910 | 251 | /* Change bit(s) in ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 252 | enable = enable & 0x01; |
chiggayeuh | 0:49ae62548910 | 253 | if( mode >= 0 && mode <= 6 ) { |
chiggayeuh | 0:49ae62548910 | 254 | if (enable) { |
chiggayeuh | 0:49ae62548910 | 255 | reg_val |= (1 << mode); |
chiggayeuh | 0:49ae62548910 | 256 | } else { |
chiggayeuh | 0:49ae62548910 | 257 | reg_val &= ~(1 << mode); |
chiggayeuh | 0:49ae62548910 | 258 | } |
chiggayeuh | 0:49ae62548910 | 259 | } else if( mode == ALL ) { |
chiggayeuh | 0:49ae62548910 | 260 | if (enable) { |
chiggayeuh | 0:49ae62548910 | 261 | reg_val = 0x7F; |
chiggayeuh | 0:49ae62548910 | 262 | } else { |
chiggayeuh | 0:49ae62548910 | 263 | reg_val = 0x00; |
chiggayeuh | 0:49ae62548910 | 264 | } |
chiggayeuh | 0:49ae62548910 | 265 | } |
chiggayeuh | 0:49ae62548910 | 266 | |
chiggayeuh | 0:49ae62548910 | 267 | /* Write value back to ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 268 | if( !wireWriteDataByte(APDS9960_ENABLE, reg_val) ) { |
chiggayeuh | 0:49ae62548910 | 269 | return false; |
chiggayeuh | 0:49ae62548910 | 270 | } |
chiggayeuh | 0:49ae62548910 | 271 | |
chiggayeuh | 0:49ae62548910 | 272 | return true; |
chiggayeuh | 0:49ae62548910 | 273 | } |
chiggayeuh | 0:49ae62548910 | 274 | |
chiggayeuh | 0:49ae62548910 | 275 | /** |
chiggayeuh | 0:49ae62548910 | 276 | * @brief Starts the light (R/G/B/Ambient) sensor on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 277 | * |
chiggayeuh | 0:49ae62548910 | 278 | * @param[in] interrupts true to enable hardware interrupt on high or low light |
chiggayeuh | 0:49ae62548910 | 279 | * @return True if sensor enabled correctly. False on error. |
chiggayeuh | 0:49ae62548910 | 280 | */ |
chiggayeuh | 0:49ae62548910 | 281 | bool APDS9960_I2C::enableLightSensor(bool interrupts) |
chiggayeuh | 0:49ae62548910 | 282 | { |
chiggayeuh | 0:49ae62548910 | 283 | |
chiggayeuh | 0:49ae62548910 | 284 | /* Set default gain, interrupts, enable power, and enable sensor */ |
chiggayeuh | 0:49ae62548910 | 285 | if( !setAmbientLightGain(DEFAULT_AGAIN) ) { |
chiggayeuh | 0:49ae62548910 | 286 | return false; |
chiggayeuh | 0:49ae62548910 | 287 | } |
chiggayeuh | 0:49ae62548910 | 288 | if( interrupts ) { |
chiggayeuh | 0:49ae62548910 | 289 | if( !setAmbientLightIntEnable(1) ) { |
chiggayeuh | 0:49ae62548910 | 290 | return false; |
chiggayeuh | 0:49ae62548910 | 291 | } |
chiggayeuh | 0:49ae62548910 | 292 | } else { |
chiggayeuh | 0:49ae62548910 | 293 | if( !setAmbientLightIntEnable(0) ) { |
chiggayeuh | 0:49ae62548910 | 294 | return false; |
chiggayeuh | 0:49ae62548910 | 295 | } |
chiggayeuh | 0:49ae62548910 | 296 | } |
chiggayeuh | 0:49ae62548910 | 297 | if( !enablePower() ){ |
chiggayeuh | 0:49ae62548910 | 298 | return false; |
chiggayeuh | 0:49ae62548910 | 299 | } |
chiggayeuh | 0:49ae62548910 | 300 | if( !setMode(AMBIENT_LIGHT, 1) ) { |
chiggayeuh | 0:49ae62548910 | 301 | return false; |
chiggayeuh | 0:49ae62548910 | 302 | } |
chiggayeuh | 0:49ae62548910 | 303 | |
chiggayeuh | 0:49ae62548910 | 304 | return true; |
chiggayeuh | 0:49ae62548910 | 305 | |
chiggayeuh | 0:49ae62548910 | 306 | } |
chiggayeuh | 0:49ae62548910 | 307 | |
chiggayeuh | 0:49ae62548910 | 308 | /** |
chiggayeuh | 0:49ae62548910 | 309 | * @brief Ends the light sensor on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 310 | * |
chiggayeuh | 0:49ae62548910 | 311 | * @return True if sensor disabled correctly. False on error. |
chiggayeuh | 0:49ae62548910 | 312 | */ |
chiggayeuh | 0:49ae62548910 | 313 | bool APDS9960_I2C::disableLightSensor() |
chiggayeuh | 0:49ae62548910 | 314 | { |
chiggayeuh | 0:49ae62548910 | 315 | if( !setAmbientLightIntEnable(0) ) { |
chiggayeuh | 0:49ae62548910 | 316 | return false; |
chiggayeuh | 0:49ae62548910 | 317 | } |
chiggayeuh | 0:49ae62548910 | 318 | if( !setMode(AMBIENT_LIGHT, 0) ) { |
chiggayeuh | 0:49ae62548910 | 319 | return false; |
chiggayeuh | 0:49ae62548910 | 320 | } |
chiggayeuh | 0:49ae62548910 | 321 | |
chiggayeuh | 0:49ae62548910 | 322 | return true; |
chiggayeuh | 0:49ae62548910 | 323 | } |
chiggayeuh | 0:49ae62548910 | 324 | |
chiggayeuh | 0:49ae62548910 | 325 | /** |
chiggayeuh | 0:49ae62548910 | 326 | * @brief Starts the proximity sensor on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 327 | * |
chiggayeuh | 0:49ae62548910 | 328 | * @param[in] interrupts true to enable hardware external interrupt on proximity |
chiggayeuh | 0:49ae62548910 | 329 | * @return True if sensor enabled correctly. False on error. |
chiggayeuh | 0:49ae62548910 | 330 | */ |
chiggayeuh | 0:49ae62548910 | 331 | bool APDS9960_I2C::enableProximitySensor(bool interrupts) |
chiggayeuh | 0:49ae62548910 | 332 | { |
chiggayeuh | 0:49ae62548910 | 333 | /* Set default gain, LED, interrupts, enable power, and enable sensor */ |
chiggayeuh | 0:49ae62548910 | 334 | if( !setProximityGain(DEFAULT_PGAIN) ) { |
chiggayeuh | 0:49ae62548910 | 335 | return false; |
chiggayeuh | 0:49ae62548910 | 336 | } |
chiggayeuh | 0:49ae62548910 | 337 | if( !setLEDDrive(DEFAULT_LDRIVE) ) { |
chiggayeuh | 0:49ae62548910 | 338 | return false; |
chiggayeuh | 0:49ae62548910 | 339 | } |
chiggayeuh | 0:49ae62548910 | 340 | if( interrupts ) { |
chiggayeuh | 0:49ae62548910 | 341 | if( !setProximityIntEnable(1) ) { |
chiggayeuh | 0:49ae62548910 | 342 | return false; |
chiggayeuh | 0:49ae62548910 | 343 | } |
chiggayeuh | 0:49ae62548910 | 344 | } else { |
chiggayeuh | 0:49ae62548910 | 345 | if( !setProximityIntEnable(0) ) { |
chiggayeuh | 0:49ae62548910 | 346 | return false; |
chiggayeuh | 0:49ae62548910 | 347 | } |
chiggayeuh | 0:49ae62548910 | 348 | } |
chiggayeuh | 0:49ae62548910 | 349 | if( !enablePower() ){ |
chiggayeuh | 0:49ae62548910 | 350 | return false; |
chiggayeuh | 0:49ae62548910 | 351 | } |
chiggayeuh | 0:49ae62548910 | 352 | if( !setMode(PROXIMITY, 1) ) { |
chiggayeuh | 0:49ae62548910 | 353 | return false; |
chiggayeuh | 0:49ae62548910 | 354 | } |
chiggayeuh | 0:49ae62548910 | 355 | |
chiggayeuh | 0:49ae62548910 | 356 | return true; |
chiggayeuh | 0:49ae62548910 | 357 | } |
chiggayeuh | 0:49ae62548910 | 358 | bool disableProximitySensor(); |
chiggayeuh | 0:49ae62548910 | 359 | |
chiggayeuh | 0:49ae62548910 | 360 | /** |
chiggayeuh | 0:49ae62548910 | 361 | * @brief Starts the gesture recognition engine on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 362 | * |
chiggayeuh | 0:49ae62548910 | 363 | * @param[in] interrupts true to enable hardware external interrupt on gesture |
chiggayeuh | 0:49ae62548910 | 364 | * @return True if engine enabled correctly. False on error. |
chiggayeuh | 0:49ae62548910 | 365 | */ |
chiggayeuh | 0:49ae62548910 | 366 | bool APDS9960_I2C::enableGestureSensor(bool interrupts) |
chiggayeuh | 0:49ae62548910 | 367 | { |
chiggayeuh | 0:49ae62548910 | 368 | |
chiggayeuh | 0:49ae62548910 | 369 | /* Enable gesture mode |
chiggayeuh | 0:49ae62548910 | 370 | Set ENABLE to 0 (power off) |
chiggayeuh | 0:49ae62548910 | 371 | Set WTIME to 0xFF |
chiggayeuh | 0:49ae62548910 | 372 | Set AUX to LED_BOOST_300 |
chiggayeuh | 0:49ae62548910 | 373 | Enable PON, WEN, PEN, GEN in ENABLE |
chiggayeuh | 0:49ae62548910 | 374 | */ |
chiggayeuh | 0:49ae62548910 | 375 | resetGestureParameters(); |
chiggayeuh | 0:49ae62548910 | 376 | if( !wireWriteDataByte(APDS9960_WTIME, 0xFF) ) { |
chiggayeuh | 0:49ae62548910 | 377 | return false; |
chiggayeuh | 0:49ae62548910 | 378 | } |
chiggayeuh | 0:49ae62548910 | 379 | if( !wireWriteDataByte(APDS9960_PPULSE, DEFAULT_GESTURE_PPULSE) ) { |
chiggayeuh | 0:49ae62548910 | 380 | return false; |
chiggayeuh | 0:49ae62548910 | 381 | } |
chiggayeuh | 0:49ae62548910 | 382 | if( !setLEDBoost(LED_BOOST_300) ) { |
chiggayeuh | 0:49ae62548910 | 383 | return false; |
chiggayeuh | 0:49ae62548910 | 384 | } |
chiggayeuh | 0:49ae62548910 | 385 | if( interrupts ) { |
chiggayeuh | 0:49ae62548910 | 386 | if( !setGestureIntEnable(1) ) { |
chiggayeuh | 0:49ae62548910 | 387 | return false; |
chiggayeuh | 0:49ae62548910 | 388 | } |
chiggayeuh | 0:49ae62548910 | 389 | } else { |
chiggayeuh | 0:49ae62548910 | 390 | if( !setGestureIntEnable(0) ) { |
chiggayeuh | 0:49ae62548910 | 391 | return false; |
chiggayeuh | 0:49ae62548910 | 392 | } |
chiggayeuh | 0:49ae62548910 | 393 | } |
chiggayeuh | 0:49ae62548910 | 394 | if( !setGestureMode(1) ) { |
chiggayeuh | 0:49ae62548910 | 395 | return false; |
chiggayeuh | 0:49ae62548910 | 396 | } |
chiggayeuh | 0:49ae62548910 | 397 | if( !enablePower() ){ |
chiggayeuh | 0:49ae62548910 | 398 | return false; |
chiggayeuh | 0:49ae62548910 | 399 | } |
chiggayeuh | 0:49ae62548910 | 400 | if( !setMode(WAIT, 1) ) { |
chiggayeuh | 0:49ae62548910 | 401 | return false; |
chiggayeuh | 0:49ae62548910 | 402 | } |
chiggayeuh | 0:49ae62548910 | 403 | if( !setMode(PROXIMITY, 1) ) { |
chiggayeuh | 0:49ae62548910 | 404 | return false; |
chiggayeuh | 0:49ae62548910 | 405 | } |
chiggayeuh | 0:49ae62548910 | 406 | if( !setMode(GESTURE, 1) ) { |
chiggayeuh | 0:49ae62548910 | 407 | return false; |
chiggayeuh | 0:49ae62548910 | 408 | } |
chiggayeuh | 0:49ae62548910 | 409 | |
chiggayeuh | 0:49ae62548910 | 410 | return true; |
chiggayeuh | 0:49ae62548910 | 411 | } |
chiggayeuh | 0:49ae62548910 | 412 | |
chiggayeuh | 0:49ae62548910 | 413 | /** |
chiggayeuh | 0:49ae62548910 | 414 | * @brief Ends the gesture recognition engine on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 415 | * |
chiggayeuh | 0:49ae62548910 | 416 | * @return True if engine disabled correctly. False on error. |
chiggayeuh | 0:49ae62548910 | 417 | */ |
chiggayeuh | 0:49ae62548910 | 418 | bool APDS9960_I2C::disableGestureSensor() |
chiggayeuh | 0:49ae62548910 | 419 | { |
chiggayeuh | 0:49ae62548910 | 420 | resetGestureParameters(); |
chiggayeuh | 0:49ae62548910 | 421 | if( !setGestureIntEnable(0) ) { |
chiggayeuh | 0:49ae62548910 | 422 | return false; |
chiggayeuh | 0:49ae62548910 | 423 | } |
chiggayeuh | 0:49ae62548910 | 424 | if( !setGestureMode(0) ) { |
chiggayeuh | 0:49ae62548910 | 425 | return false; |
chiggayeuh | 0:49ae62548910 | 426 | } |
chiggayeuh | 0:49ae62548910 | 427 | if( !setMode(GESTURE, 0) ) { |
chiggayeuh | 0:49ae62548910 | 428 | return false; |
chiggayeuh | 0:49ae62548910 | 429 | } |
chiggayeuh | 0:49ae62548910 | 430 | |
chiggayeuh | 0:49ae62548910 | 431 | return true; |
chiggayeuh | 0:49ae62548910 | 432 | } |
chiggayeuh | 0:49ae62548910 | 433 | |
chiggayeuh | 0:49ae62548910 | 434 | /** |
chiggayeuh | 0:49ae62548910 | 435 | * @brief Determines if there is a gesture available for reading |
chiggayeuh | 0:49ae62548910 | 436 | * |
chiggayeuh | 0:49ae62548910 | 437 | * @return True if gesture available. False otherwise. |
chiggayeuh | 0:49ae62548910 | 438 | */ |
chiggayeuh | 0:49ae62548910 | 439 | bool APDS9960_I2C::isGestureAvailable() |
chiggayeuh | 0:49ae62548910 | 440 | { |
chiggayeuh | 0:49ae62548910 | 441 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 442 | |
chiggayeuh | 0:49ae62548910 | 443 | /* Read value from GSTATUS register */ |
chiggayeuh | 0:49ae62548910 | 444 | if( !wireReadDataByte(APDS9960_GSTATUS, val) ) { |
chiggayeuh | 0:49ae62548910 | 445 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 446 | } |
chiggayeuh | 0:49ae62548910 | 447 | |
chiggayeuh | 0:49ae62548910 | 448 | /* Shift and mask out GVALID bit */ |
chiggayeuh | 0:49ae62548910 | 449 | val &= 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 450 | |
chiggayeuh | 0:49ae62548910 | 451 | /* Return true/false based on GVALID bit */ |
chiggayeuh | 0:49ae62548910 | 452 | if( val == 1) { |
chiggayeuh | 0:49ae62548910 | 453 | return true; |
chiggayeuh | 0:49ae62548910 | 454 | } else { |
chiggayeuh | 0:49ae62548910 | 455 | return false; |
chiggayeuh | 0:49ae62548910 | 456 | } |
chiggayeuh | 0:49ae62548910 | 457 | } |
chiggayeuh | 0:49ae62548910 | 458 | |
chiggayeuh | 0:49ae62548910 | 459 | /** |
chiggayeuh | 0:49ae62548910 | 460 | * @brief Processes a gesture event and returns best guessed gesture |
chiggayeuh | 0:49ae62548910 | 461 | * |
chiggayeuh | 0:49ae62548910 | 462 | * @return Number corresponding to gesture. -1 on error. |
chiggayeuh | 0:49ae62548910 | 463 | */ |
chiggayeuh | 0:49ae62548910 | 464 | int APDS9960_I2C::readGesture() |
chiggayeuh | 0:49ae62548910 | 465 | { |
chiggayeuh | 0:49ae62548910 | 466 | uint8_t fifo_level = 0; |
chiggayeuh | 0:49ae62548910 | 467 | uint8_t bytes_read = 0; |
chiggayeuh | 0:49ae62548910 | 468 | uint8_t fifo_data[128]; |
chiggayeuh | 0:49ae62548910 | 469 | uint8_t gstatus; |
chiggayeuh | 0:49ae62548910 | 470 | int motion; |
chiggayeuh | 0:49ae62548910 | 471 | int i; |
chiggayeuh | 0:49ae62548910 | 472 | |
chiggayeuh | 0:49ae62548910 | 473 | /* Make sure that power and gesture is on and data is valid */ |
chiggayeuh | 0:49ae62548910 | 474 | if( !isGestureAvailable() || !(getMode() & 65) ) { //01000001 |
chiggayeuh | 0:49ae62548910 | 475 | return DIR_NONE; |
chiggayeuh | 0:49ae62548910 | 476 | } |
chiggayeuh | 0:49ae62548910 | 477 | |
chiggayeuh | 0:49ae62548910 | 478 | /* Keep looping as long as gesture data is valid */ |
chiggayeuh | 0:49ae62548910 | 479 | while(1) { |
chiggayeuh | 0:49ae62548910 | 480 | /* Wait some time to collect next batch of FIFO data */ |
chiggayeuh | 0:49ae62548910 | 481 | wait_ms(FIFO_PAUSE_TIME); |
chiggayeuh | 0:49ae62548910 | 482 | |
chiggayeuh | 0:49ae62548910 | 483 | /* Get the contents of the STATUS register. Is data still valid? */ |
chiggayeuh | 0:49ae62548910 | 484 | if( !wireReadDataByte(APDS9960_GSTATUS, gstatus) ) { |
chiggayeuh | 0:49ae62548910 | 485 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 486 | } |
chiggayeuh | 0:49ae62548910 | 487 | |
chiggayeuh | 0:49ae62548910 | 488 | /* If we have valid data, read in FIFO */ |
chiggayeuh | 0:49ae62548910 | 489 | |
chiggayeuh | 0:49ae62548910 | 490 | if( (gstatus & APDS9960_GVALID) == APDS9960_GVALID ) {//00000001 |
chiggayeuh | 0:49ae62548910 | 491 | |
chiggayeuh | 0:49ae62548910 | 492 | /* Read the current FIFO level */ |
chiggayeuh | 0:49ae62548910 | 493 | //return DIR_UP; |
chiggayeuh | 0:49ae62548910 | 494 | if( !wireReadDataByte(APDS9960_GFLVL, fifo_level) ) { |
chiggayeuh | 0:49ae62548910 | 495 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 496 | } |
chiggayeuh | 0:49ae62548910 | 497 | |
chiggayeuh | 0:49ae62548910 | 498 | |
chiggayeuh | 0:49ae62548910 | 499 | /* If there's stuff in the FIFO, read it into our data block */ |
chiggayeuh | 0:49ae62548910 | 500 | if( fifo_level > 0) { |
chiggayeuh | 0:49ae62548910 | 501 | bytes_read = wireReadDataBlock( APDS9960_GFIFO_U, |
chiggayeuh | 0:49ae62548910 | 502 | (uint8_t*)fifo_data, |
chiggayeuh | 0:49ae62548910 | 503 | (fifo_level * 4) ); |
chiggayeuh | 0:49ae62548910 | 504 | if( bytes_read == -1 ) { |
chiggayeuh | 0:49ae62548910 | 505 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 506 | } |
chiggayeuh | 0:49ae62548910 | 507 | |
chiggayeuh | 0:49ae62548910 | 508 | |
chiggayeuh | 0:49ae62548910 | 509 | /* If at least 1 set of data, sort the data into U/D/L/R */ |
chiggayeuh | 0:49ae62548910 | 510 | if( bytes_read >= 4 ) { |
chiggayeuh | 0:49ae62548910 | 511 | //return DIR_UP; |
chiggayeuh | 0:49ae62548910 | 512 | for( i = 0; i < bytes_read; i += 4 ) { |
chiggayeuh | 0:49ae62548910 | 513 | gesture_data_.u_data[gesture_data_.index] = fifo_data[i + 0]; |
chiggayeuh | 0:49ae62548910 | 514 | gesture_data_.d_data[gesture_data_.index] = fifo_data[i + 1]; |
chiggayeuh | 0:49ae62548910 | 515 | gesture_data_.l_data[gesture_data_.index] = fifo_data[i + 2]; |
chiggayeuh | 0:49ae62548910 | 516 | gesture_data_.r_data[gesture_data_.index] = fifo_data[i + 3]; |
chiggayeuh | 0:49ae62548910 | 517 | gesture_data_.index++; |
chiggayeuh | 0:49ae62548910 | 518 | gesture_data_.total_gestures++; |
chiggayeuh | 0:49ae62548910 | 519 | } |
chiggayeuh | 0:49ae62548910 | 520 | |
chiggayeuh | 0:49ae62548910 | 521 | |
chiggayeuh | 0:49ae62548910 | 522 | /* Filter and process gesture data. Decode near/far state */ |
chiggayeuh | 0:49ae62548910 | 523 | if( processGestureData() ) { |
chiggayeuh | 0:49ae62548910 | 524 | |
chiggayeuh | 0:49ae62548910 | 525 | if( decodeGesture() ) { |
chiggayeuh | 0:49ae62548910 | 526 | //***TODO: U-Turn Gesturesf |
chiggayeuh | 0:49ae62548910 | 527 | } |
chiggayeuh | 0:49ae62548910 | 528 | } |
chiggayeuh | 0:49ae62548910 | 529 | |
chiggayeuh | 0:49ae62548910 | 530 | /* Reset data */ |
chiggayeuh | 0:49ae62548910 | 531 | gesture_data_.index = 0; |
chiggayeuh | 0:49ae62548910 | 532 | gesture_data_.total_gestures = 0; |
chiggayeuh | 0:49ae62548910 | 533 | } |
chiggayeuh | 0:49ae62548910 | 534 | } |
chiggayeuh | 0:49ae62548910 | 535 | } else { |
chiggayeuh | 0:49ae62548910 | 536 | |
chiggayeuh | 0:49ae62548910 | 537 | /* Determine best guessed gesture and clean up */ |
chiggayeuh | 0:49ae62548910 | 538 | wait_ms(FIFO_PAUSE_TIME); |
chiggayeuh | 0:49ae62548910 | 539 | decodeGesture(); |
chiggayeuh | 0:49ae62548910 | 540 | motion = gesture_motion_; |
chiggayeuh | 0:49ae62548910 | 541 | |
chiggayeuh | 0:49ae62548910 | 542 | resetGestureParameters(); |
chiggayeuh | 0:49ae62548910 | 543 | return motion; |
chiggayeuh | 0:49ae62548910 | 544 | } |
chiggayeuh | 0:49ae62548910 | 545 | } |
chiggayeuh | 0:49ae62548910 | 546 | } |
chiggayeuh | 0:49ae62548910 | 547 | |
chiggayeuh | 0:49ae62548910 | 548 | /** |
chiggayeuh | 0:49ae62548910 | 549 | * Turn the APDS-9960 on |
chiggayeuh | 0:49ae62548910 | 550 | * |
chiggayeuh | 0:49ae62548910 | 551 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 552 | */ |
chiggayeuh | 0:49ae62548910 | 553 | bool APDS9960_I2C::enablePower() |
chiggayeuh | 0:49ae62548910 | 554 | { |
chiggayeuh | 0:49ae62548910 | 555 | if( !setMode(POWER, 1) ) { |
chiggayeuh | 0:49ae62548910 | 556 | return false; |
chiggayeuh | 0:49ae62548910 | 557 | } |
chiggayeuh | 0:49ae62548910 | 558 | |
chiggayeuh | 0:49ae62548910 | 559 | return true; |
chiggayeuh | 0:49ae62548910 | 560 | } |
chiggayeuh | 0:49ae62548910 | 561 | |
chiggayeuh | 0:49ae62548910 | 562 | /** |
chiggayeuh | 0:49ae62548910 | 563 | * Turn the APDS-9960 off |
chiggayeuh | 0:49ae62548910 | 564 | * |
chiggayeuh | 0:49ae62548910 | 565 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 566 | */ |
chiggayeuh | 0:49ae62548910 | 567 | bool APDS9960_I2C::disablePower() |
chiggayeuh | 0:49ae62548910 | 568 | { |
chiggayeuh | 0:49ae62548910 | 569 | if( !setMode(POWER, 0) ) { |
chiggayeuh | 0:49ae62548910 | 570 | return false; |
chiggayeuh | 0:49ae62548910 | 571 | } |
chiggayeuh | 0:49ae62548910 | 572 | |
chiggayeuh | 0:49ae62548910 | 573 | return true; |
chiggayeuh | 0:49ae62548910 | 574 | } |
chiggayeuh | 0:49ae62548910 | 575 | |
chiggayeuh | 0:49ae62548910 | 576 | /******************************************************************************* |
chiggayeuh | 0:49ae62548910 | 577 | * Ambient light and color sensor controls |
chiggayeuh | 0:49ae62548910 | 578 | ******************************************************************************/ |
chiggayeuh | 0:49ae62548910 | 579 | |
chiggayeuh | 0:49ae62548910 | 580 | /** |
chiggayeuh | 0:49ae62548910 | 581 | * @brief Reads the ambient (clear) light level as a 16-bit value |
chiggayeuh | 0:49ae62548910 | 582 | * |
chiggayeuh | 0:49ae62548910 | 583 | * @param[out] val value of the light sensor. |
chiggayeuh | 0:49ae62548910 | 584 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 585 | */ |
chiggayeuh | 0:49ae62548910 | 586 | bool APDS9960_I2C::readAmbientLight(uint16_t &val) |
chiggayeuh | 0:49ae62548910 | 587 | { |
chiggayeuh | 0:49ae62548910 | 588 | uint8_t val_byte; |
chiggayeuh | 0:49ae62548910 | 589 | val = 0; |
chiggayeuh | 0:49ae62548910 | 590 | |
chiggayeuh | 0:49ae62548910 | 591 | /* Read value from clear channel, low byte register */ |
chiggayeuh | 0:49ae62548910 | 592 | if( !wireReadDataByte(APDS9960_CDATAL, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 593 | return false; |
chiggayeuh | 0:49ae62548910 | 594 | } |
chiggayeuh | 0:49ae62548910 | 595 | val = val_byte; |
chiggayeuh | 0:49ae62548910 | 596 | |
chiggayeuh | 0:49ae62548910 | 597 | /* Read value from clear channel, high byte register */ |
chiggayeuh | 0:49ae62548910 | 598 | if( !wireReadDataByte(APDS9960_CDATAH, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 599 | return false; |
chiggayeuh | 0:49ae62548910 | 600 | } |
chiggayeuh | 0:49ae62548910 | 601 | val = val + ((uint16_t)val_byte << 8); |
chiggayeuh | 0:49ae62548910 | 602 | |
chiggayeuh | 0:49ae62548910 | 603 | return true; |
chiggayeuh | 0:49ae62548910 | 604 | } |
chiggayeuh | 0:49ae62548910 | 605 | |
chiggayeuh | 0:49ae62548910 | 606 | /** |
chiggayeuh | 0:49ae62548910 | 607 | * @brief Reads the red light level as a 16-bit value |
chiggayeuh | 0:49ae62548910 | 608 | * |
chiggayeuh | 0:49ae62548910 | 609 | * @param[out] val value of the light sensor. |
chiggayeuh | 0:49ae62548910 | 610 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 611 | */ |
chiggayeuh | 0:49ae62548910 | 612 | bool APDS9960_I2C::readRedLight(uint16_t &val) |
chiggayeuh | 0:49ae62548910 | 613 | { |
chiggayeuh | 0:49ae62548910 | 614 | uint8_t val_byte; |
chiggayeuh | 0:49ae62548910 | 615 | val = 0; |
chiggayeuh | 0:49ae62548910 | 616 | |
chiggayeuh | 0:49ae62548910 | 617 | /* Read value from clear channel, low byte register */ |
chiggayeuh | 0:49ae62548910 | 618 | if( !wireReadDataByte(APDS9960_RDATAL, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 619 | return false; |
chiggayeuh | 0:49ae62548910 | 620 | } |
chiggayeuh | 0:49ae62548910 | 621 | val = val_byte; |
chiggayeuh | 0:49ae62548910 | 622 | |
chiggayeuh | 0:49ae62548910 | 623 | /* Read value from clear channel, high byte register */ |
chiggayeuh | 0:49ae62548910 | 624 | if( !wireReadDataByte(APDS9960_RDATAH, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 625 | return false; |
chiggayeuh | 0:49ae62548910 | 626 | } |
chiggayeuh | 0:49ae62548910 | 627 | val = val + ((uint16_t)val_byte << 8); |
chiggayeuh | 0:49ae62548910 | 628 | |
chiggayeuh | 0:49ae62548910 | 629 | return true; |
chiggayeuh | 0:49ae62548910 | 630 | } |
chiggayeuh | 0:49ae62548910 | 631 | |
chiggayeuh | 0:49ae62548910 | 632 | /** |
chiggayeuh | 0:49ae62548910 | 633 | * @brief Reads the green light level as a 16-bit value |
chiggayeuh | 0:49ae62548910 | 634 | * |
chiggayeuh | 0:49ae62548910 | 635 | * @param[out] val value of the light sensor. |
chiggayeuh | 0:49ae62548910 | 636 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 637 | */ |
chiggayeuh | 0:49ae62548910 | 638 | bool APDS9960_I2C::readGreenLight(uint16_t &val) |
chiggayeuh | 0:49ae62548910 | 639 | { |
chiggayeuh | 0:49ae62548910 | 640 | uint8_t val_byte; |
chiggayeuh | 0:49ae62548910 | 641 | val = 0; |
chiggayeuh | 0:49ae62548910 | 642 | |
chiggayeuh | 0:49ae62548910 | 643 | /* Read value from clear channel, low byte register */ |
chiggayeuh | 0:49ae62548910 | 644 | if( !wireReadDataByte(APDS9960_GDATAL, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 645 | return false; |
chiggayeuh | 0:49ae62548910 | 646 | } |
chiggayeuh | 0:49ae62548910 | 647 | val = val_byte; |
chiggayeuh | 0:49ae62548910 | 648 | |
chiggayeuh | 0:49ae62548910 | 649 | /* Read value from clear channel, high byte register */ |
chiggayeuh | 0:49ae62548910 | 650 | if( !wireReadDataByte(APDS9960_GDATAH, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 651 | return false; |
chiggayeuh | 0:49ae62548910 | 652 | } |
chiggayeuh | 0:49ae62548910 | 653 | val = val + ((uint16_t)val_byte << 8); |
chiggayeuh | 0:49ae62548910 | 654 | |
chiggayeuh | 0:49ae62548910 | 655 | return true; |
chiggayeuh | 0:49ae62548910 | 656 | } |
chiggayeuh | 0:49ae62548910 | 657 | |
chiggayeuh | 0:49ae62548910 | 658 | /** |
chiggayeuh | 0:49ae62548910 | 659 | * @brief Reads the red light level as a 16-bit value |
chiggayeuh | 0:49ae62548910 | 660 | * |
chiggayeuh | 0:49ae62548910 | 661 | * @param[out] val value of the light sensor. |
chiggayeuh | 0:49ae62548910 | 662 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 663 | */ |
chiggayeuh | 0:49ae62548910 | 664 | bool APDS9960_I2C::readBlueLight(uint16_t &val) |
chiggayeuh | 0:49ae62548910 | 665 | { |
chiggayeuh | 0:49ae62548910 | 666 | uint8_t val_byte; |
chiggayeuh | 0:49ae62548910 | 667 | val = 0; |
chiggayeuh | 0:49ae62548910 | 668 | |
chiggayeuh | 0:49ae62548910 | 669 | /* Read value from clear channel, low byte register */ |
chiggayeuh | 0:49ae62548910 | 670 | if( !wireReadDataByte(APDS9960_BDATAL, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 671 | return false; |
chiggayeuh | 0:49ae62548910 | 672 | } |
chiggayeuh | 0:49ae62548910 | 673 | val = val_byte; |
chiggayeuh | 0:49ae62548910 | 674 | |
chiggayeuh | 0:49ae62548910 | 675 | /* Read value from clear channel, high byte register */ |
chiggayeuh | 0:49ae62548910 | 676 | if( !wireReadDataByte(APDS9960_BDATAH, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 677 | return false; |
chiggayeuh | 0:49ae62548910 | 678 | } |
chiggayeuh | 0:49ae62548910 | 679 | val = val + ((uint16_t)val_byte << 8); |
chiggayeuh | 0:49ae62548910 | 680 | |
chiggayeuh | 0:49ae62548910 | 681 | return true; |
chiggayeuh | 0:49ae62548910 | 682 | } |
chiggayeuh | 0:49ae62548910 | 683 | |
chiggayeuh | 0:49ae62548910 | 684 | /******************************************************************************* |
chiggayeuh | 0:49ae62548910 | 685 | * Proximity sensor controls |
chiggayeuh | 0:49ae62548910 | 686 | ******************************************************************************/ |
chiggayeuh | 0:49ae62548910 | 687 | |
chiggayeuh | 0:49ae62548910 | 688 | /** |
chiggayeuh | 0:49ae62548910 | 689 | * @brief Reads the proximity level as an 8-bit value |
chiggayeuh | 0:49ae62548910 | 690 | * |
chiggayeuh | 0:49ae62548910 | 691 | * @param[out] val value of the proximity sensor. |
chiggayeuh | 0:49ae62548910 | 692 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 693 | */ |
chiggayeuh | 0:49ae62548910 | 694 | bool APDS9960_I2C::readProximity(uint8_t &val) |
chiggayeuh | 0:49ae62548910 | 695 | { |
chiggayeuh | 0:49ae62548910 | 696 | val = 0; |
chiggayeuh | 0:49ae62548910 | 697 | |
chiggayeuh | 0:49ae62548910 | 698 | /* Read value from proximity data register */ |
chiggayeuh | 0:49ae62548910 | 699 | if( !wireReadDataByte(APDS9960_PDATA, val) ) { |
chiggayeuh | 0:49ae62548910 | 700 | return false; |
chiggayeuh | 0:49ae62548910 | 701 | } |
chiggayeuh | 0:49ae62548910 | 702 | |
chiggayeuh | 0:49ae62548910 | 703 | return true; |
chiggayeuh | 0:49ae62548910 | 704 | } |
chiggayeuh | 0:49ae62548910 | 705 | |
chiggayeuh | 0:49ae62548910 | 706 | /******************************************************************************* |
chiggayeuh | 0:49ae62548910 | 707 | * High-level gesture controls |
chiggayeuh | 0:49ae62548910 | 708 | ******************************************************************************/ |
chiggayeuh | 0:49ae62548910 | 709 | |
chiggayeuh | 0:49ae62548910 | 710 | /** |
chiggayeuh | 0:49ae62548910 | 711 | * @brief Resets all the parameters in the gesture data member |
chiggayeuh | 0:49ae62548910 | 712 | */ |
chiggayeuh | 0:49ae62548910 | 713 | void APDS9960_I2C::resetGestureParameters() |
chiggayeuh | 0:49ae62548910 | 714 | { |
chiggayeuh | 0:49ae62548910 | 715 | gesture_data_.index = 0; |
chiggayeuh | 0:49ae62548910 | 716 | gesture_data_.total_gestures = 0; |
chiggayeuh | 0:49ae62548910 | 717 | |
chiggayeuh | 0:49ae62548910 | 718 | gesture_ud_delta_ = 0; |
chiggayeuh | 0:49ae62548910 | 719 | gesture_lr_delta_ = 0; |
chiggayeuh | 0:49ae62548910 | 720 | |
chiggayeuh | 0:49ae62548910 | 721 | gesture_ud_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 722 | gesture_lr_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 723 | |
chiggayeuh | 0:49ae62548910 | 724 | gesture_near_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 725 | gesture_far_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 726 | |
chiggayeuh | 0:49ae62548910 | 727 | gesture_state_ = 0; |
chiggayeuh | 0:49ae62548910 | 728 | gesture_motion_ = DIR_NONE; |
chiggayeuh | 0:49ae62548910 | 729 | } |
chiggayeuh | 0:49ae62548910 | 730 | |
chiggayeuh | 0:49ae62548910 | 731 | /** |
chiggayeuh | 0:49ae62548910 | 732 | * @brief Processes the raw gesture data to determine swipe direction |
chiggayeuh | 0:49ae62548910 | 733 | * |
chiggayeuh | 0:49ae62548910 | 734 | * @return True if near or far state seen. False otherwise. |
chiggayeuh | 0:49ae62548910 | 735 | */ |
chiggayeuh | 0:49ae62548910 | 736 | bool APDS9960_I2C::processGestureData() |
chiggayeuh | 0:49ae62548910 | 737 | { |
chiggayeuh | 0:49ae62548910 | 738 | uint8_t u_first = 0; |
chiggayeuh | 0:49ae62548910 | 739 | uint8_t d_first = 0; |
chiggayeuh | 0:49ae62548910 | 740 | uint8_t l_first = 0; |
chiggayeuh | 0:49ae62548910 | 741 | uint8_t r_first = 0; |
chiggayeuh | 0:49ae62548910 | 742 | uint8_t u_last = 0; |
chiggayeuh | 0:49ae62548910 | 743 | uint8_t d_last = 0; |
chiggayeuh | 0:49ae62548910 | 744 | uint8_t l_last = 0; |
chiggayeuh | 0:49ae62548910 | 745 | uint8_t r_last = 0; |
chiggayeuh | 0:49ae62548910 | 746 | int ud_ratio_first; |
chiggayeuh | 0:49ae62548910 | 747 | int lr_ratio_first; |
chiggayeuh | 0:49ae62548910 | 748 | int ud_ratio_last; |
chiggayeuh | 0:49ae62548910 | 749 | int lr_ratio_last; |
chiggayeuh | 0:49ae62548910 | 750 | int ud_delta; |
chiggayeuh | 0:49ae62548910 | 751 | int lr_delta; |
chiggayeuh | 0:49ae62548910 | 752 | int i; |
chiggayeuh | 0:49ae62548910 | 753 | |
chiggayeuh | 0:49ae62548910 | 754 | /* If we have less than 4 total gestures, that's not enough */ |
chiggayeuh | 0:49ae62548910 | 755 | if( gesture_data_.total_gestures <= 4 ) { |
chiggayeuh | 0:49ae62548910 | 756 | return false; |
chiggayeuh | 0:49ae62548910 | 757 | } |
chiggayeuh | 0:49ae62548910 | 758 | |
chiggayeuh | 0:49ae62548910 | 759 | /* Check to make sure our data isn't out of bounds */ |
chiggayeuh | 0:49ae62548910 | 760 | if( (gesture_data_.total_gestures <= 32) && \ |
chiggayeuh | 0:49ae62548910 | 761 | (gesture_data_.total_gestures > 0) ) { |
chiggayeuh | 0:49ae62548910 | 762 | |
chiggayeuh | 0:49ae62548910 | 763 | /* Find the first value in U/D/L/R above the threshold */ |
chiggayeuh | 0:49ae62548910 | 764 | for( i = 0; i < gesture_data_.total_gestures; i++ ) { |
chiggayeuh | 0:49ae62548910 | 765 | if( (gesture_data_.u_data[i] > GESTURE_THRESHOLD_OUT) && |
chiggayeuh | 0:49ae62548910 | 766 | (gesture_data_.d_data[i] > GESTURE_THRESHOLD_OUT) && |
chiggayeuh | 0:49ae62548910 | 767 | (gesture_data_.l_data[i] > GESTURE_THRESHOLD_OUT) && |
chiggayeuh | 0:49ae62548910 | 768 | (gesture_data_.r_data[i] > GESTURE_THRESHOLD_OUT) ) { |
chiggayeuh | 0:49ae62548910 | 769 | |
chiggayeuh | 0:49ae62548910 | 770 | u_first = gesture_data_.u_data[i]; |
chiggayeuh | 0:49ae62548910 | 771 | d_first = gesture_data_.d_data[i]; |
chiggayeuh | 0:49ae62548910 | 772 | l_first = gesture_data_.l_data[i]; |
chiggayeuh | 0:49ae62548910 | 773 | r_first = gesture_data_.r_data[i]; |
chiggayeuh | 0:49ae62548910 | 774 | break; |
chiggayeuh | 0:49ae62548910 | 775 | } |
chiggayeuh | 0:49ae62548910 | 776 | } |
chiggayeuh | 0:49ae62548910 | 777 | |
chiggayeuh | 0:49ae62548910 | 778 | /* If one of the _first values is 0, then there is no good data */ |
chiggayeuh | 0:49ae62548910 | 779 | if( (u_first == 0) || (d_first == 0) || \ |
chiggayeuh | 0:49ae62548910 | 780 | (l_first == 0) || (r_first == 0) ) { |
chiggayeuh | 0:49ae62548910 | 781 | |
chiggayeuh | 0:49ae62548910 | 782 | return false; |
chiggayeuh | 0:49ae62548910 | 783 | } |
chiggayeuh | 0:49ae62548910 | 784 | /* Find the last value in U/D/L/R above the threshold */ |
chiggayeuh | 0:49ae62548910 | 785 | for( i = gesture_data_.total_gestures - 1; i >= 0; i-- ) { |
chiggayeuh | 0:49ae62548910 | 786 | #if DEBUG |
chiggayeuh | 0:49ae62548910 | 787 | Serial.print(F("Finding last: ")); |
chiggayeuh | 0:49ae62548910 | 788 | Serial.print(F("U:")); |
chiggayeuh | 0:49ae62548910 | 789 | Serial.print(gesture_data_.u_data[i]); |
chiggayeuh | 0:49ae62548910 | 790 | Serial.print(F(" D:")); |
chiggayeuh | 0:49ae62548910 | 791 | Serial.print(gesture_data_.d_data[i]); |
chiggayeuh | 0:49ae62548910 | 792 | Serial.print(F(" L:")); |
chiggayeuh | 0:49ae62548910 | 793 | Serial.print(gesture_data_.l_data[i]); |
chiggayeuh | 0:49ae62548910 | 794 | Serial.print(F(" R:")); |
chiggayeuh | 0:49ae62548910 | 795 | Serial.println(gesture_data_.r_data[i]); |
chiggayeuh | 0:49ae62548910 | 796 | #endif |
chiggayeuh | 0:49ae62548910 | 797 | if( (gesture_data_.u_data[i] > GESTURE_THRESHOLD_OUT) && |
chiggayeuh | 0:49ae62548910 | 798 | (gesture_data_.d_data[i] > GESTURE_THRESHOLD_OUT) && |
chiggayeuh | 0:49ae62548910 | 799 | (gesture_data_.l_data[i] > GESTURE_THRESHOLD_OUT) && |
chiggayeuh | 0:49ae62548910 | 800 | (gesture_data_.r_data[i] > GESTURE_THRESHOLD_OUT) ) { |
chiggayeuh | 0:49ae62548910 | 801 | |
chiggayeuh | 0:49ae62548910 | 802 | u_last = gesture_data_.u_data[i]; |
chiggayeuh | 0:49ae62548910 | 803 | d_last = gesture_data_.d_data[i]; |
chiggayeuh | 0:49ae62548910 | 804 | l_last = gesture_data_.l_data[i]; |
chiggayeuh | 0:49ae62548910 | 805 | r_last = gesture_data_.r_data[i]; |
chiggayeuh | 0:49ae62548910 | 806 | break; |
chiggayeuh | 0:49ae62548910 | 807 | } |
chiggayeuh | 0:49ae62548910 | 808 | } |
chiggayeuh | 0:49ae62548910 | 809 | } |
chiggayeuh | 0:49ae62548910 | 810 | |
chiggayeuh | 0:49ae62548910 | 811 | /* Calculate the first vs. last ratio of up/down and left/right */ |
chiggayeuh | 0:49ae62548910 | 812 | ud_ratio_first = ((u_first - d_first) * 100) / (u_first + d_first); |
chiggayeuh | 0:49ae62548910 | 813 | lr_ratio_first = ((l_first - r_first) * 100) / (l_first + r_first); |
chiggayeuh | 0:49ae62548910 | 814 | ud_ratio_last = ((u_last - d_last) * 100) / (u_last + d_last); |
chiggayeuh | 0:49ae62548910 | 815 | lr_ratio_last = ((l_last - r_last) * 100) / (l_last + r_last); |
chiggayeuh | 0:49ae62548910 | 816 | |
chiggayeuh | 0:49ae62548910 | 817 | #if DEBUG |
chiggayeuh | 0:49ae62548910 | 818 | Serial.print(F("Last Values: ")); |
chiggayeuh | 0:49ae62548910 | 819 | Serial.print(F("U:")); |
chiggayeuh | 0:49ae62548910 | 820 | Serial.print(u_last); |
chiggayeuh | 0:49ae62548910 | 821 | Serial.print(F(" D:")); |
chiggayeuh | 0:49ae62548910 | 822 | Serial.print(d_last); |
chiggayeuh | 0:49ae62548910 | 823 | Serial.print(F(" L:")); |
chiggayeuh | 0:49ae62548910 | 824 | Serial.print(l_last); |
chiggayeuh | 0:49ae62548910 | 825 | Serial.print(F(" R:")); |
chiggayeuh | 0:49ae62548910 | 826 | Serial.println(r_last); |
chiggayeuh | 0:49ae62548910 | 827 | |
chiggayeuh | 0:49ae62548910 | 828 | Serial.print(F("Ratios: ")); |
chiggayeuh | 0:49ae62548910 | 829 | Serial.print(F("UD Fi: ")); |
chiggayeuh | 0:49ae62548910 | 830 | Serial.print(ud_ratio_first); |
chiggayeuh | 0:49ae62548910 | 831 | Serial.print(F(" UD La: ")); |
chiggayeuh | 0:49ae62548910 | 832 | Serial.print(ud_ratio_last); |
chiggayeuh | 0:49ae62548910 | 833 | Serial.print(F(" LR Fi: ")); |
chiggayeuh | 0:49ae62548910 | 834 | Serial.print(lr_ratio_first); |
chiggayeuh | 0:49ae62548910 | 835 | Serial.print(F(" LR La: ")); |
chiggayeuh | 0:49ae62548910 | 836 | Serial.println(lr_ratio_last); |
chiggayeuh | 0:49ae62548910 | 837 | #endif |
chiggayeuh | 0:49ae62548910 | 838 | |
chiggayeuh | 0:49ae62548910 | 839 | /* Determine the difference between the first and last ratios */ |
chiggayeuh | 0:49ae62548910 | 840 | ud_delta = ud_ratio_last - ud_ratio_first; |
chiggayeuh | 0:49ae62548910 | 841 | lr_delta = lr_ratio_last - lr_ratio_first; |
chiggayeuh | 0:49ae62548910 | 842 | |
chiggayeuh | 0:49ae62548910 | 843 | #if DEBUG |
chiggayeuh | 0:49ae62548910 | 844 | Serial.print("Deltas: "); |
chiggayeuh | 0:49ae62548910 | 845 | Serial.print("UD: "); |
chiggayeuh | 0:49ae62548910 | 846 | Serial.print(ud_delta); |
chiggayeuh | 0:49ae62548910 | 847 | Serial.print(" LR: "); |
chiggayeuh | 0:49ae62548910 | 848 | Serial.println(lr_delta); |
chiggayeuh | 0:49ae62548910 | 849 | #endif |
chiggayeuh | 0:49ae62548910 | 850 | |
chiggayeuh | 0:49ae62548910 | 851 | /* Accumulate the UD and LR delta values */ |
chiggayeuh | 0:49ae62548910 | 852 | gesture_ud_delta_ += ud_delta; |
chiggayeuh | 0:49ae62548910 | 853 | gesture_lr_delta_ += lr_delta; |
chiggayeuh | 0:49ae62548910 | 854 | |
chiggayeuh | 0:49ae62548910 | 855 | #if DEBUG |
chiggayeuh | 0:49ae62548910 | 856 | Serial.print("Accumulations: "); |
chiggayeuh | 0:49ae62548910 | 857 | Serial.print("UD: "); |
chiggayeuh | 0:49ae62548910 | 858 | Serial.print(gesture_ud_delta_); |
chiggayeuh | 0:49ae62548910 | 859 | Serial.print(" LR: "); |
chiggayeuh | 0:49ae62548910 | 860 | Serial.println(gesture_lr_delta_); |
chiggayeuh | 0:49ae62548910 | 861 | #endif |
chiggayeuh | 0:49ae62548910 | 862 | |
chiggayeuh | 0:49ae62548910 | 863 | /* Determine U/D gesture */ |
chiggayeuh | 0:49ae62548910 | 864 | if( gesture_ud_delta_ >= GESTURE_SENSITIVITY_1 ) { |
chiggayeuh | 0:49ae62548910 | 865 | gesture_ud_count_ = 1; |
chiggayeuh | 0:49ae62548910 | 866 | } else if( gesture_ud_delta_ <= -GESTURE_SENSITIVITY_1 ) { |
chiggayeuh | 0:49ae62548910 | 867 | gesture_ud_count_ = -1; |
chiggayeuh | 0:49ae62548910 | 868 | } else { |
chiggayeuh | 0:49ae62548910 | 869 | gesture_ud_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 870 | } |
chiggayeuh | 0:49ae62548910 | 871 | |
chiggayeuh | 0:49ae62548910 | 872 | /* Determine L/R gesture */ |
chiggayeuh | 0:49ae62548910 | 873 | if( gesture_lr_delta_ >= GESTURE_SENSITIVITY_1 ) { |
chiggayeuh | 0:49ae62548910 | 874 | gesture_lr_count_ = 1; |
chiggayeuh | 0:49ae62548910 | 875 | } else if( gesture_lr_delta_ <= -GESTURE_SENSITIVITY_1 ) { |
chiggayeuh | 0:49ae62548910 | 876 | gesture_lr_count_ = -1; |
chiggayeuh | 0:49ae62548910 | 877 | } else { |
chiggayeuh | 0:49ae62548910 | 878 | gesture_lr_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 879 | } |
chiggayeuh | 0:49ae62548910 | 880 | |
chiggayeuh | 0:49ae62548910 | 881 | /* Determine Near/Far gesture */ |
chiggayeuh | 0:49ae62548910 | 882 | if( (gesture_ud_count_ == 0) && (gesture_lr_count_ == 0) ) { |
chiggayeuh | 0:49ae62548910 | 883 | if( (abs(ud_delta) < GESTURE_SENSITIVITY_2) && \ |
chiggayeuh | 0:49ae62548910 | 884 | (abs(lr_delta) < GESTURE_SENSITIVITY_2) ) { |
chiggayeuh | 0:49ae62548910 | 885 | |
chiggayeuh | 0:49ae62548910 | 886 | if( (ud_delta == 0) && (lr_delta == 0) ) { |
chiggayeuh | 0:49ae62548910 | 887 | gesture_near_count_++; |
chiggayeuh | 0:49ae62548910 | 888 | } else if( (ud_delta != 0) || (lr_delta != 0) ) { |
chiggayeuh | 0:49ae62548910 | 889 | gesture_far_count_++; |
chiggayeuh | 0:49ae62548910 | 890 | } |
chiggayeuh | 0:49ae62548910 | 891 | |
chiggayeuh | 0:49ae62548910 | 892 | if( (gesture_near_count_ >= 10) && (gesture_far_count_ >= 2) ) { |
chiggayeuh | 0:49ae62548910 | 893 | if( (ud_delta == 0) && (lr_delta == 0) ) { |
chiggayeuh | 0:49ae62548910 | 894 | gesture_state_ = NEAR_STATE; |
chiggayeuh | 0:49ae62548910 | 895 | } else if( (ud_delta != 0) && (lr_delta != 0) ) { |
chiggayeuh | 0:49ae62548910 | 896 | gesture_state_ = FAR_STATE; |
chiggayeuh | 0:49ae62548910 | 897 | } |
chiggayeuh | 0:49ae62548910 | 898 | return true; |
chiggayeuh | 0:49ae62548910 | 899 | } |
chiggayeuh | 0:49ae62548910 | 900 | } |
chiggayeuh | 0:49ae62548910 | 901 | } else { |
chiggayeuh | 0:49ae62548910 | 902 | if( (abs(ud_delta) < GESTURE_SENSITIVITY_2) && \ |
chiggayeuh | 0:49ae62548910 | 903 | (abs(lr_delta) < GESTURE_SENSITIVITY_2) ) { |
chiggayeuh | 0:49ae62548910 | 904 | |
chiggayeuh | 0:49ae62548910 | 905 | if( (ud_delta == 0) && (lr_delta == 0) ) { |
chiggayeuh | 0:49ae62548910 | 906 | gesture_near_count_++; |
chiggayeuh | 0:49ae62548910 | 907 | } |
chiggayeuh | 0:49ae62548910 | 908 | |
chiggayeuh | 0:49ae62548910 | 909 | if( gesture_near_count_ >= 10 ) { |
chiggayeuh | 0:49ae62548910 | 910 | gesture_ud_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 911 | gesture_lr_count_ = 0; |
chiggayeuh | 0:49ae62548910 | 912 | gesture_ud_delta_ = 0; |
chiggayeuh | 0:49ae62548910 | 913 | gesture_lr_delta_ = 0; |
chiggayeuh | 0:49ae62548910 | 914 | } |
chiggayeuh | 0:49ae62548910 | 915 | } |
chiggayeuh | 0:49ae62548910 | 916 | } |
chiggayeuh | 0:49ae62548910 | 917 | |
chiggayeuh | 0:49ae62548910 | 918 | #if DEBUG |
chiggayeuh | 0:49ae62548910 | 919 | Serial.print("UD_CT: "); |
chiggayeuh | 0:49ae62548910 | 920 | Serial.print(gesture_ud_count_); |
chiggayeuh | 0:49ae62548910 | 921 | Serial.print(" LR_CT: "); |
chiggayeuh | 0:49ae62548910 | 922 | Serial.print(gesture_lr_count_); |
chiggayeuh | 0:49ae62548910 | 923 | Serial.print(" NEAR_CT: "); |
chiggayeuh | 0:49ae62548910 | 924 | Serial.print(gesture_near_count_); |
chiggayeuh | 0:49ae62548910 | 925 | Serial.print(" FAR_CT: "); |
chiggayeuh | 0:49ae62548910 | 926 | Serial.println(gesture_far_count_); |
chiggayeuh | 0:49ae62548910 | 927 | Serial.println("----------"); |
chiggayeuh | 0:49ae62548910 | 928 | #endif |
chiggayeuh | 0:49ae62548910 | 929 | |
chiggayeuh | 0:49ae62548910 | 930 | return false; |
chiggayeuh | 0:49ae62548910 | 931 | } |
chiggayeuh | 0:49ae62548910 | 932 | |
chiggayeuh | 0:49ae62548910 | 933 | /** |
chiggayeuh | 0:49ae62548910 | 934 | * @brief Determines swipe direction or near/far state |
chiggayeuh | 0:49ae62548910 | 935 | * |
chiggayeuh | 0:49ae62548910 | 936 | * @return True if near/far event. False otherwise. |
chiggayeuh | 0:49ae62548910 | 937 | */ |
chiggayeuh | 0:49ae62548910 | 938 | bool APDS9960_I2C::decodeGesture() |
chiggayeuh | 0:49ae62548910 | 939 | { |
chiggayeuh | 0:49ae62548910 | 940 | /* Return if near or far event is detected */ |
chiggayeuh | 0:49ae62548910 | 941 | if( gesture_state_ == NEAR_STATE ) { |
chiggayeuh | 0:49ae62548910 | 942 | gesture_motion_ = DIR_NEAR; |
chiggayeuh | 0:49ae62548910 | 943 | return true; |
chiggayeuh | 0:49ae62548910 | 944 | } else if ( gesture_state_ == FAR_STATE ) { |
chiggayeuh | 0:49ae62548910 | 945 | gesture_motion_ = DIR_FAR; |
chiggayeuh | 0:49ae62548910 | 946 | return true; |
chiggayeuh | 0:49ae62548910 | 947 | } |
chiggayeuh | 0:49ae62548910 | 948 | |
chiggayeuh | 0:49ae62548910 | 949 | /* Determine swipe direction */ |
chiggayeuh | 0:49ae62548910 | 950 | if( (gesture_ud_count_ == -1) && (gesture_lr_count_ == 0) ) { |
chiggayeuh | 0:49ae62548910 | 951 | gesture_motion_ = DIR_UP; |
chiggayeuh | 0:49ae62548910 | 952 | } else if( (gesture_ud_count_ == 1) && (gesture_lr_count_ == 0) ) { |
chiggayeuh | 0:49ae62548910 | 953 | gesture_motion_ = DIR_DOWN; |
chiggayeuh | 0:49ae62548910 | 954 | } else if( (gesture_ud_count_ == 0) && (gesture_lr_count_ == 1) ) { |
chiggayeuh | 0:49ae62548910 | 955 | gesture_motion_ = DIR_RIGHT; |
chiggayeuh | 0:49ae62548910 | 956 | } else if( (gesture_ud_count_ == 0) && (gesture_lr_count_ == -1) ) { |
chiggayeuh | 0:49ae62548910 | 957 | gesture_motion_ = DIR_LEFT; |
chiggayeuh | 0:49ae62548910 | 958 | } else if( (gesture_ud_count_ == -1) && (gesture_lr_count_ == 1) ) { |
chiggayeuh | 0:49ae62548910 | 959 | if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) { |
chiggayeuh | 0:49ae62548910 | 960 | gesture_motion_ = DIR_UP; |
chiggayeuh | 0:49ae62548910 | 961 | } else { |
chiggayeuh | 0:49ae62548910 | 962 | gesture_motion_ = DIR_RIGHT; |
chiggayeuh | 0:49ae62548910 | 963 | } |
chiggayeuh | 0:49ae62548910 | 964 | } else if( (gesture_ud_count_ == 1) && (gesture_lr_count_ == -1) ) { |
chiggayeuh | 0:49ae62548910 | 965 | if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) { |
chiggayeuh | 0:49ae62548910 | 966 | gesture_motion_ = DIR_DOWN; |
chiggayeuh | 0:49ae62548910 | 967 | } else { |
chiggayeuh | 0:49ae62548910 | 968 | gesture_motion_ = DIR_LEFT; |
chiggayeuh | 0:49ae62548910 | 969 | } |
chiggayeuh | 0:49ae62548910 | 970 | } else if( (gesture_ud_count_ == -1) && (gesture_lr_count_ == -1) ) { |
chiggayeuh | 0:49ae62548910 | 971 | if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) { |
chiggayeuh | 0:49ae62548910 | 972 | gesture_motion_ = DIR_UP; |
chiggayeuh | 0:49ae62548910 | 973 | } else { |
chiggayeuh | 0:49ae62548910 | 974 | gesture_motion_ = DIR_LEFT; |
chiggayeuh | 0:49ae62548910 | 975 | } |
chiggayeuh | 0:49ae62548910 | 976 | } else if( (gesture_ud_count_ == 1) && (gesture_lr_count_ == 1) ) { |
chiggayeuh | 0:49ae62548910 | 977 | if( abs(gesture_ud_delta_) > abs(gesture_lr_delta_) ) { |
chiggayeuh | 0:49ae62548910 | 978 | gesture_motion_ = DIR_DOWN; |
chiggayeuh | 0:49ae62548910 | 979 | } else { |
chiggayeuh | 0:49ae62548910 | 980 | gesture_motion_ = DIR_RIGHT; |
chiggayeuh | 0:49ae62548910 | 981 | } |
chiggayeuh | 0:49ae62548910 | 982 | } else { |
chiggayeuh | 0:49ae62548910 | 983 | return false; |
chiggayeuh | 0:49ae62548910 | 984 | } |
chiggayeuh | 0:49ae62548910 | 985 | |
chiggayeuh | 0:49ae62548910 | 986 | return true; |
chiggayeuh | 0:49ae62548910 | 987 | } |
chiggayeuh | 0:49ae62548910 | 988 | |
chiggayeuh | 0:49ae62548910 | 989 | /******************************************************************************* |
chiggayeuh | 0:49ae62548910 | 990 | * Getters and setters for register values |
chiggayeuh | 0:49ae62548910 | 991 | ******************************************************************************/ |
chiggayeuh | 0:49ae62548910 | 992 | |
chiggayeuh | 0:49ae62548910 | 993 | /** |
chiggayeuh | 0:49ae62548910 | 994 | * @brief Returns the lower threshold for proximity detection |
chiggayeuh | 0:49ae62548910 | 995 | * |
chiggayeuh | 0:49ae62548910 | 996 | * @return lower threshold |
chiggayeuh | 0:49ae62548910 | 997 | */ |
chiggayeuh | 0:49ae62548910 | 998 | uint8_t APDS9960_I2C::getProxIntLowThresh() |
chiggayeuh | 0:49ae62548910 | 999 | { |
chiggayeuh | 0:49ae62548910 | 1000 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1001 | |
chiggayeuh | 0:49ae62548910 | 1002 | /* Read value from PILT register */ |
chiggayeuh | 0:49ae62548910 | 1003 | if( !wireReadDataByte(APDS9960_PILT, val) ) { |
chiggayeuh | 0:49ae62548910 | 1004 | val = 0; |
chiggayeuh | 0:49ae62548910 | 1005 | } |
chiggayeuh | 0:49ae62548910 | 1006 | |
chiggayeuh | 0:49ae62548910 | 1007 | return val; |
chiggayeuh | 0:49ae62548910 | 1008 | } |
chiggayeuh | 0:49ae62548910 | 1009 | |
chiggayeuh | 0:49ae62548910 | 1010 | /** |
chiggayeuh | 0:49ae62548910 | 1011 | * @brief Sets the lower threshold for proximity detection |
chiggayeuh | 0:49ae62548910 | 1012 | * |
chiggayeuh | 0:49ae62548910 | 1013 | * @param[in] threshold the lower proximity threshold |
chiggayeuh | 0:49ae62548910 | 1014 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1015 | */ |
chiggayeuh | 0:49ae62548910 | 1016 | bool APDS9960_I2C::setProxIntLowThresh(uint8_t threshold) |
chiggayeuh | 0:49ae62548910 | 1017 | { |
chiggayeuh | 0:49ae62548910 | 1018 | if( !wireWriteDataByte(APDS9960_PILT, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1019 | return false; |
chiggayeuh | 0:49ae62548910 | 1020 | } |
chiggayeuh | 0:49ae62548910 | 1021 | |
chiggayeuh | 0:49ae62548910 | 1022 | return true; |
chiggayeuh | 0:49ae62548910 | 1023 | } |
chiggayeuh | 0:49ae62548910 | 1024 | |
chiggayeuh | 0:49ae62548910 | 1025 | /** |
chiggayeuh | 0:49ae62548910 | 1026 | * @brief Returns the high threshold for proximity detection |
chiggayeuh | 0:49ae62548910 | 1027 | * |
chiggayeuh | 0:49ae62548910 | 1028 | * @return high threshold |
chiggayeuh | 0:49ae62548910 | 1029 | */ |
chiggayeuh | 0:49ae62548910 | 1030 | uint8_t APDS9960_I2C::getProxIntHighThresh() |
chiggayeuh | 0:49ae62548910 | 1031 | { |
chiggayeuh | 0:49ae62548910 | 1032 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1033 | |
chiggayeuh | 0:49ae62548910 | 1034 | /* Read value from PIHT register */ |
chiggayeuh | 0:49ae62548910 | 1035 | if( !wireReadDataByte(APDS9960_PIHT, val) ) { |
chiggayeuh | 0:49ae62548910 | 1036 | val = 0; |
chiggayeuh | 0:49ae62548910 | 1037 | } |
chiggayeuh | 0:49ae62548910 | 1038 | |
chiggayeuh | 0:49ae62548910 | 1039 | return val; |
chiggayeuh | 0:49ae62548910 | 1040 | } |
chiggayeuh | 0:49ae62548910 | 1041 | |
chiggayeuh | 0:49ae62548910 | 1042 | /** |
chiggayeuh | 0:49ae62548910 | 1043 | * @brief Sets the high threshold for proximity detection |
chiggayeuh | 0:49ae62548910 | 1044 | * |
chiggayeuh | 0:49ae62548910 | 1045 | * @param[in] threshold the high proximity threshold |
chiggayeuh | 0:49ae62548910 | 1046 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1047 | */ |
chiggayeuh | 0:49ae62548910 | 1048 | bool APDS9960_I2C::setProxIntHighThresh(uint8_t threshold) |
chiggayeuh | 0:49ae62548910 | 1049 | { |
chiggayeuh | 0:49ae62548910 | 1050 | if( !wireWriteDataByte(APDS9960_PIHT, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1051 | return false; |
chiggayeuh | 0:49ae62548910 | 1052 | } |
chiggayeuh | 0:49ae62548910 | 1053 | |
chiggayeuh | 0:49ae62548910 | 1054 | return true; |
chiggayeuh | 0:49ae62548910 | 1055 | } |
chiggayeuh | 0:49ae62548910 | 1056 | |
chiggayeuh | 0:49ae62548910 | 1057 | /** |
chiggayeuh | 0:49ae62548910 | 1058 | * @brief Returns LED drive strength for proximity and ALS |
chiggayeuh | 0:49ae62548910 | 1059 | * |
chiggayeuh | 0:49ae62548910 | 1060 | * Value LED Current |
chiggayeuh | 0:49ae62548910 | 1061 | * 0 100 mA |
chiggayeuh | 0:49ae62548910 | 1062 | * 1 50 mA |
chiggayeuh | 0:49ae62548910 | 1063 | * 2 25 mA |
chiggayeuh | 0:49ae62548910 | 1064 | * 3 12.5 mA |
chiggayeuh | 0:49ae62548910 | 1065 | * |
chiggayeuh | 0:49ae62548910 | 1066 | * @return the value of the LED drive strength. 0xFF on failure. |
chiggayeuh | 0:49ae62548910 | 1067 | */ |
chiggayeuh | 0:49ae62548910 | 1068 | uint8_t APDS9960_I2C::getLEDDrive() |
chiggayeuh | 0:49ae62548910 | 1069 | { |
chiggayeuh | 0:49ae62548910 | 1070 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1071 | |
chiggayeuh | 0:49ae62548910 | 1072 | /* Read value from CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1073 | if( !wireReadDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1074 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1075 | } |
chiggayeuh | 0:49ae62548910 | 1076 | |
chiggayeuh | 0:49ae62548910 | 1077 | /* Shift and mask out LED drive bits */ |
chiggayeuh | 0:49ae62548910 | 1078 | val = (val >> 6) & 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1079 | |
chiggayeuh | 0:49ae62548910 | 1080 | return val; |
chiggayeuh | 0:49ae62548910 | 1081 | } |
chiggayeuh | 0:49ae62548910 | 1082 | |
chiggayeuh | 0:49ae62548910 | 1083 | /** |
chiggayeuh | 0:49ae62548910 | 1084 | * @brief Sets the LED drive strength for proximity and ALS |
chiggayeuh | 0:49ae62548910 | 1085 | * |
chiggayeuh | 0:49ae62548910 | 1086 | * Value LED Current |
chiggayeuh | 0:49ae62548910 | 1087 | * 0 100 mA |
chiggayeuh | 0:49ae62548910 | 1088 | * 1 50 mA |
chiggayeuh | 0:49ae62548910 | 1089 | * 2 25 mA |
chiggayeuh | 0:49ae62548910 | 1090 | * 3 12.5 mA |
chiggayeuh | 0:49ae62548910 | 1091 | * |
chiggayeuh | 0:49ae62548910 | 1092 | * @param[in] drive the value (0-3) for the LED drive strength |
chiggayeuh | 0:49ae62548910 | 1093 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1094 | */ |
chiggayeuh | 0:49ae62548910 | 1095 | bool APDS9960_I2C::setLEDDrive(uint8_t drive) |
chiggayeuh | 0:49ae62548910 | 1096 | { |
chiggayeuh | 0:49ae62548910 | 1097 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1098 | |
chiggayeuh | 0:49ae62548910 | 1099 | /* Read value from CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1100 | if( !wireReadDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1101 | return false; |
chiggayeuh | 0:49ae62548910 | 1102 | } |
chiggayeuh | 0:49ae62548910 | 1103 | |
chiggayeuh | 0:49ae62548910 | 1104 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1105 | drive &= 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1106 | drive = drive << 6; |
chiggayeuh | 0:49ae62548910 | 1107 | val &= 63; // |
chiggayeuh | 0:49ae62548910 | 1108 | val |= drive; |
chiggayeuh | 0:49ae62548910 | 1109 | |
chiggayeuh | 0:49ae62548910 | 1110 | /* Write register value back into CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1111 | if( !wireWriteDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1112 | return false; |
chiggayeuh | 0:49ae62548910 | 1113 | } |
chiggayeuh | 0:49ae62548910 | 1114 | |
chiggayeuh | 0:49ae62548910 | 1115 | return true; |
chiggayeuh | 0:49ae62548910 | 1116 | } |
chiggayeuh | 0:49ae62548910 | 1117 | |
chiggayeuh | 0:49ae62548910 | 1118 | /** |
chiggayeuh | 0:49ae62548910 | 1119 | * @brief Returns receiver gain for proximity detection |
chiggayeuh | 0:49ae62548910 | 1120 | * |
chiggayeuh | 0:49ae62548910 | 1121 | * Value Gain |
chiggayeuh | 0:49ae62548910 | 1122 | * 0 1x |
chiggayeuh | 0:49ae62548910 | 1123 | * 1 2x |
chiggayeuh | 0:49ae62548910 | 1124 | * 2 4x |
chiggayeuh | 0:49ae62548910 | 1125 | * 3 8x |
chiggayeuh | 0:49ae62548910 | 1126 | * |
chiggayeuh | 0:49ae62548910 | 1127 | * @return the value of the proximity gain. 0xFF on failure. |
chiggayeuh | 0:49ae62548910 | 1128 | */ |
chiggayeuh | 0:49ae62548910 | 1129 | uint8_t APDS9960_I2C::getProximityGain() |
chiggayeuh | 0:49ae62548910 | 1130 | { |
chiggayeuh | 0:49ae62548910 | 1131 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1132 | |
chiggayeuh | 0:49ae62548910 | 1133 | /* Read value from CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1134 | if( !wireReadDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1135 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1136 | } |
chiggayeuh | 0:49ae62548910 | 1137 | |
chiggayeuh | 0:49ae62548910 | 1138 | /* Shift and mask out PDRIVE bits */ |
chiggayeuh | 0:49ae62548910 | 1139 | val = (val >> 2) & 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1140 | |
chiggayeuh | 0:49ae62548910 | 1141 | return val; |
chiggayeuh | 0:49ae62548910 | 1142 | } |
chiggayeuh | 0:49ae62548910 | 1143 | |
chiggayeuh | 0:49ae62548910 | 1144 | /** |
chiggayeuh | 0:49ae62548910 | 1145 | * @brief Sets the receiver gain for proximity detection |
chiggayeuh | 0:49ae62548910 | 1146 | * |
chiggayeuh | 0:49ae62548910 | 1147 | * Value Gain |
chiggayeuh | 0:49ae62548910 | 1148 | * 0 1x |
chiggayeuh | 0:49ae62548910 | 1149 | * 1 2x |
chiggayeuh | 0:49ae62548910 | 1150 | * 2 4x |
chiggayeuh | 0:49ae62548910 | 1151 | * 3 8x |
chiggayeuh | 0:49ae62548910 | 1152 | * |
chiggayeuh | 0:49ae62548910 | 1153 | * @param[in] drive the value (0-3) for the gain |
chiggayeuh | 0:49ae62548910 | 1154 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1155 | */ |
chiggayeuh | 0:49ae62548910 | 1156 | bool APDS9960_I2C::setProximityGain(uint8_t drive) |
chiggayeuh | 0:49ae62548910 | 1157 | { |
chiggayeuh | 0:49ae62548910 | 1158 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1159 | |
chiggayeuh | 0:49ae62548910 | 1160 | /* Read value from CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1161 | if( !wireReadDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1162 | return false; |
chiggayeuh | 0:49ae62548910 | 1163 | } |
chiggayeuh | 0:49ae62548910 | 1164 | |
chiggayeuh | 0:49ae62548910 | 1165 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1166 | drive &= 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1167 | drive = drive << 2; |
chiggayeuh | 0:49ae62548910 | 1168 | val &= 11110011; |
chiggayeuh | 0:49ae62548910 | 1169 | val |= drive; |
chiggayeuh | 0:49ae62548910 | 1170 | |
chiggayeuh | 0:49ae62548910 | 1171 | /* Write register value back into CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1172 | if( !wireWriteDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1173 | return false; |
chiggayeuh | 0:49ae62548910 | 1174 | } |
chiggayeuh | 0:49ae62548910 | 1175 | |
chiggayeuh | 0:49ae62548910 | 1176 | return true; |
chiggayeuh | 0:49ae62548910 | 1177 | } |
chiggayeuh | 0:49ae62548910 | 1178 | |
chiggayeuh | 0:49ae62548910 | 1179 | /** |
chiggayeuh | 0:49ae62548910 | 1180 | * @brief Returns receiver gain for the ambient light sensor (ALS) |
chiggayeuh | 0:49ae62548910 | 1181 | * |
chiggayeuh | 0:49ae62548910 | 1182 | * Value Gain |
chiggayeuh | 0:49ae62548910 | 1183 | * 0 1x |
chiggayeuh | 0:49ae62548910 | 1184 | * 1 4x |
chiggayeuh | 0:49ae62548910 | 1185 | * 2 16x |
chiggayeuh | 0:49ae62548910 | 1186 | * 3 64x |
chiggayeuh | 0:49ae62548910 | 1187 | * |
chiggayeuh | 0:49ae62548910 | 1188 | * @return the value of the ALS gain. 0xFF on failure. |
chiggayeuh | 0:49ae62548910 | 1189 | */ |
chiggayeuh | 0:49ae62548910 | 1190 | uint8_t APDS9960_I2C::getAmbientLightGain() |
chiggayeuh | 0:49ae62548910 | 1191 | { |
chiggayeuh | 0:49ae62548910 | 1192 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1193 | |
chiggayeuh | 0:49ae62548910 | 1194 | /* Read value from CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1195 | if( !wireReadDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1196 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1197 | } |
chiggayeuh | 0:49ae62548910 | 1198 | |
chiggayeuh | 0:49ae62548910 | 1199 | /* Shift and mask out ADRIVE bits */ |
chiggayeuh | 0:49ae62548910 | 1200 | val &= 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1201 | |
chiggayeuh | 0:49ae62548910 | 1202 | return val; |
chiggayeuh | 0:49ae62548910 | 1203 | } |
chiggayeuh | 0:49ae62548910 | 1204 | |
chiggayeuh | 0:49ae62548910 | 1205 | /** |
chiggayeuh | 0:49ae62548910 | 1206 | * @brief Sets the receiver gain for the ambient light sensor (ALS) |
chiggayeuh | 0:49ae62548910 | 1207 | * |
chiggayeuh | 0:49ae62548910 | 1208 | * Value Gain |
chiggayeuh | 0:49ae62548910 | 1209 | * 0 1x |
chiggayeuh | 0:49ae62548910 | 1210 | * 1 4x |
chiggayeuh | 0:49ae62548910 | 1211 | * 2 16x |
chiggayeuh | 0:49ae62548910 | 1212 | * 3 64x |
chiggayeuh | 0:49ae62548910 | 1213 | * |
chiggayeuh | 0:49ae62548910 | 1214 | * @param[in] drive the value (0-3) for the gain |
chiggayeuh | 0:49ae62548910 | 1215 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1216 | */ |
chiggayeuh | 0:49ae62548910 | 1217 | bool APDS9960_I2C::setAmbientLightGain(uint8_t drive) |
chiggayeuh | 0:49ae62548910 | 1218 | { |
chiggayeuh | 0:49ae62548910 | 1219 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1220 | |
chiggayeuh | 0:49ae62548910 | 1221 | /* Read value from CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1222 | if( !wireReadDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1223 | return false; |
chiggayeuh | 0:49ae62548910 | 1224 | } |
chiggayeuh | 0:49ae62548910 | 1225 | |
chiggayeuh | 0:49ae62548910 | 1226 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1227 | drive &= 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1228 | val &= 11111100; |
chiggayeuh | 0:49ae62548910 | 1229 | val |= drive; |
chiggayeuh | 0:49ae62548910 | 1230 | |
chiggayeuh | 0:49ae62548910 | 1231 | /* Write register value back into CONTROL register */ |
chiggayeuh | 0:49ae62548910 | 1232 | if( !wireWriteDataByte(APDS9960_CONTROL, val) ) { |
chiggayeuh | 0:49ae62548910 | 1233 | return false; |
chiggayeuh | 0:49ae62548910 | 1234 | } |
chiggayeuh | 0:49ae62548910 | 1235 | |
chiggayeuh | 0:49ae62548910 | 1236 | return true; |
chiggayeuh | 0:49ae62548910 | 1237 | } |
chiggayeuh | 0:49ae62548910 | 1238 | |
chiggayeuh | 0:49ae62548910 | 1239 | /** |
chiggayeuh | 0:49ae62548910 | 1240 | * @brief Get the current LED boost value |
chiggayeuh | 0:49ae62548910 | 1241 | * |
chiggayeuh | 0:49ae62548910 | 1242 | * Value Boost Current |
chiggayeuh | 0:49ae62548910 | 1243 | * 0 100% |
chiggayeuh | 0:49ae62548910 | 1244 | * 1 150% |
chiggayeuh | 0:49ae62548910 | 1245 | * 2 200% |
chiggayeuh | 0:49ae62548910 | 1246 | * 3 300% |
chiggayeuh | 0:49ae62548910 | 1247 | * |
chiggayeuh | 0:49ae62548910 | 1248 | * @return The LED boost value. 0xFF on failure. |
chiggayeuh | 0:49ae62548910 | 1249 | */ |
chiggayeuh | 0:49ae62548910 | 1250 | uint8_t APDS9960_I2C::getLEDBoost() |
chiggayeuh | 0:49ae62548910 | 1251 | { |
chiggayeuh | 0:49ae62548910 | 1252 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1253 | |
chiggayeuh | 0:49ae62548910 | 1254 | /* Read value from CONFIG2 register */ |
chiggayeuh | 0:49ae62548910 | 1255 | if( !wireReadDataByte(APDS9960_CONFIG2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1256 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1257 | } |
chiggayeuh | 0:49ae62548910 | 1258 | |
chiggayeuh | 0:49ae62548910 | 1259 | /* Shift and mask out LED_BOOST bits */ |
chiggayeuh | 0:49ae62548910 | 1260 | val = (val >> 4) & 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1261 | |
chiggayeuh | 0:49ae62548910 | 1262 | return val; |
chiggayeuh | 0:49ae62548910 | 1263 | } |
chiggayeuh | 0:49ae62548910 | 1264 | |
chiggayeuh | 0:49ae62548910 | 1265 | /** |
chiggayeuh | 0:49ae62548910 | 1266 | * @brief Sets the LED current boost value |
chiggayeuh | 0:49ae62548910 | 1267 | * |
chiggayeuh | 0:49ae62548910 | 1268 | * Value Boost Current |
chiggayeuh | 0:49ae62548910 | 1269 | * 0 100% |
chiggayeuh | 0:49ae62548910 | 1270 | * 1 150% |
chiggayeuh | 0:49ae62548910 | 1271 | * 2 200% |
chiggayeuh | 0:49ae62548910 | 1272 | * 3 300% |
chiggayeuh | 0:49ae62548910 | 1273 | * |
chiggayeuh | 0:49ae62548910 | 1274 | * @param[in] drive the value (0-3) for current boost (100-300%) |
chiggayeuh | 0:49ae62548910 | 1275 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1276 | */ |
chiggayeuh | 0:49ae62548910 | 1277 | bool APDS9960_I2C::setLEDBoost(uint8_t boost) |
chiggayeuh | 0:49ae62548910 | 1278 | { |
chiggayeuh | 0:49ae62548910 | 1279 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1280 | |
chiggayeuh | 0:49ae62548910 | 1281 | /* Read value from CONFIG2 register */ |
chiggayeuh | 0:49ae62548910 | 1282 | if( !wireReadDataByte(APDS9960_CONFIG2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1283 | return false; |
chiggayeuh | 0:49ae62548910 | 1284 | } |
chiggayeuh | 0:49ae62548910 | 1285 | |
chiggayeuh | 0:49ae62548910 | 1286 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1287 | boost &= 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1288 | boost = boost << 4; |
chiggayeuh | 0:49ae62548910 | 1289 | val &= 11001111; |
chiggayeuh | 0:49ae62548910 | 1290 | val |= boost; |
chiggayeuh | 0:49ae62548910 | 1291 | |
chiggayeuh | 0:49ae62548910 | 1292 | /* Write register value back into CONFIG2 register */ |
chiggayeuh | 0:49ae62548910 | 1293 | if( !wireWriteDataByte(APDS9960_CONFIG2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1294 | return false; |
chiggayeuh | 0:49ae62548910 | 1295 | } |
chiggayeuh | 0:49ae62548910 | 1296 | |
chiggayeuh | 0:49ae62548910 | 1297 | return true; |
chiggayeuh | 0:49ae62548910 | 1298 | } |
chiggayeuh | 0:49ae62548910 | 1299 | |
chiggayeuh | 0:49ae62548910 | 1300 | /** |
chiggayeuh | 0:49ae62548910 | 1301 | * @brief Gets proximity gain compensation enable |
chiggayeuh | 0:49ae62548910 | 1302 | * |
chiggayeuh | 0:49ae62548910 | 1303 | * @return 1 if compensation is enabled. 0 if not. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1304 | */ |
chiggayeuh | 0:49ae62548910 | 1305 | uint8_t APDS9960_I2C::getProxGainCompEnable() |
chiggayeuh | 0:49ae62548910 | 1306 | { |
chiggayeuh | 0:49ae62548910 | 1307 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1308 | |
chiggayeuh | 0:49ae62548910 | 1309 | /* Read value from CONFIG3 register */ |
chiggayeuh | 0:49ae62548910 | 1310 | if( !wireReadDataByte(APDS9960_CONFIG3, val) ) { |
chiggayeuh | 0:49ae62548910 | 1311 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1312 | } |
chiggayeuh | 0:49ae62548910 | 1313 | |
chiggayeuh | 0:49ae62548910 | 1314 | /* Shift and mask out PCMP bits */ |
chiggayeuh | 0:49ae62548910 | 1315 | val = (val >> 5) & 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1316 | |
chiggayeuh | 0:49ae62548910 | 1317 | return val; |
chiggayeuh | 0:49ae62548910 | 1318 | } |
chiggayeuh | 0:49ae62548910 | 1319 | |
chiggayeuh | 0:49ae62548910 | 1320 | /** |
chiggayeuh | 0:49ae62548910 | 1321 | * @brief Sets the proximity gain compensation enable |
chiggayeuh | 0:49ae62548910 | 1322 | * |
chiggayeuh | 0:49ae62548910 | 1323 | * @param[in] enable 1 to enable compensation. 0 to disable compensation. |
chiggayeuh | 0:49ae62548910 | 1324 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1325 | */ |
chiggayeuh | 0:49ae62548910 | 1326 | bool APDS9960_I2C::setProxGainCompEnable(uint8_t enable) |
chiggayeuh | 0:49ae62548910 | 1327 | { |
chiggayeuh | 0:49ae62548910 | 1328 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1329 | |
chiggayeuh | 0:49ae62548910 | 1330 | /* Read value from CONFIG3 register */ |
chiggayeuh | 0:49ae62548910 | 1331 | if( !wireReadDataByte(APDS9960_CONFIG3, val) ) { |
chiggayeuh | 0:49ae62548910 | 1332 | return false; |
chiggayeuh | 0:49ae62548910 | 1333 | } |
chiggayeuh | 0:49ae62548910 | 1334 | |
chiggayeuh | 0:49ae62548910 | 1335 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1336 | enable &= 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1337 | enable = enable << 5; |
chiggayeuh | 0:49ae62548910 | 1338 | val &= 11011111; |
chiggayeuh | 0:49ae62548910 | 1339 | val |= enable; |
chiggayeuh | 0:49ae62548910 | 1340 | |
chiggayeuh | 0:49ae62548910 | 1341 | /* Write register value back into CONFIG3 register */ |
chiggayeuh | 0:49ae62548910 | 1342 | if( !wireWriteDataByte(APDS9960_CONFIG3, val) ) { |
chiggayeuh | 0:49ae62548910 | 1343 | return false; |
chiggayeuh | 0:49ae62548910 | 1344 | } |
chiggayeuh | 0:49ae62548910 | 1345 | |
chiggayeuh | 0:49ae62548910 | 1346 | return true; |
chiggayeuh | 0:49ae62548910 | 1347 | } |
chiggayeuh | 0:49ae62548910 | 1348 | |
chiggayeuh | 0:49ae62548910 | 1349 | /** |
chiggayeuh | 0:49ae62548910 | 1350 | * @brief Gets the current mask for enabled/disabled proximity photodiodes |
chiggayeuh | 0:49ae62548910 | 1351 | * |
chiggayeuh | 0:49ae62548910 | 1352 | * 1 = disabled, 0 = enabled |
chiggayeuh | 0:49ae62548910 | 1353 | * Bit Photodiode |
chiggayeuh | 0:49ae62548910 | 1354 | * 3 UP |
chiggayeuh | 0:49ae62548910 | 1355 | * 2 DOWN |
chiggayeuh | 0:49ae62548910 | 1356 | * 1 LEFT |
chiggayeuh | 0:49ae62548910 | 1357 | * 0 RIGHT |
chiggayeuh | 0:49ae62548910 | 1358 | * |
chiggayeuh | 0:49ae62548910 | 1359 | * @return Current proximity mask for photodiodes. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1360 | */ |
chiggayeuh | 0:49ae62548910 | 1361 | uint8_t APDS9960_I2C::getProxPhotoMask() |
chiggayeuh | 0:49ae62548910 | 1362 | { |
chiggayeuh | 0:49ae62548910 | 1363 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1364 | |
chiggayeuh | 0:49ae62548910 | 1365 | /* Read value from CONFIG3 register */ |
chiggayeuh | 0:49ae62548910 | 1366 | if( !wireReadDataByte(APDS9960_CONFIG3, val) ) { |
chiggayeuh | 0:49ae62548910 | 1367 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1368 | } |
chiggayeuh | 0:49ae62548910 | 1369 | |
chiggayeuh | 0:49ae62548910 | 1370 | /* Mask out photodiode enable mask bits */ |
chiggayeuh | 0:49ae62548910 | 1371 | val &= 15; //00001111 |
chiggayeuh | 0:49ae62548910 | 1372 | |
chiggayeuh | 0:49ae62548910 | 1373 | return val; |
chiggayeuh | 0:49ae62548910 | 1374 | } |
chiggayeuh | 0:49ae62548910 | 1375 | |
chiggayeuh | 0:49ae62548910 | 1376 | /** |
chiggayeuh | 0:49ae62548910 | 1377 | * @brief Sets the mask for enabling/disabling proximity photodiodes |
chiggayeuh | 0:49ae62548910 | 1378 | * |
chiggayeuh | 0:49ae62548910 | 1379 | * 1 = disabled, 0 = enabled |
chiggayeuh | 0:49ae62548910 | 1380 | * Bit Photodiode |
chiggayeuh | 0:49ae62548910 | 1381 | * 3 UP |
chiggayeuh | 0:49ae62548910 | 1382 | * 2 DOWN |
chiggayeuh | 0:49ae62548910 | 1383 | * 1 LEFT |
chiggayeuh | 0:49ae62548910 | 1384 | * 0 RIGHT |
chiggayeuh | 0:49ae62548910 | 1385 | * |
chiggayeuh | 0:49ae62548910 | 1386 | * @param[in] mask 4-bit mask value |
chiggayeuh | 0:49ae62548910 | 1387 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1388 | */ |
chiggayeuh | 0:49ae62548910 | 1389 | bool APDS9960_I2C::setProxPhotoMask(uint8_t mask) |
chiggayeuh | 0:49ae62548910 | 1390 | { |
chiggayeuh | 0:49ae62548910 | 1391 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1392 | |
chiggayeuh | 0:49ae62548910 | 1393 | /* Read value from CONFIG3 register */ |
chiggayeuh | 0:49ae62548910 | 1394 | if( !wireReadDataByte(APDS9960_CONFIG3, val) ) { |
chiggayeuh | 0:49ae62548910 | 1395 | return false; |
chiggayeuh | 0:49ae62548910 | 1396 | } |
chiggayeuh | 0:49ae62548910 | 1397 | |
chiggayeuh | 0:49ae62548910 | 1398 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1399 | mask &= 15; //00001111 |
chiggayeuh | 0:49ae62548910 | 1400 | val &= 11110000; |
chiggayeuh | 0:49ae62548910 | 1401 | val |= mask; |
chiggayeuh | 0:49ae62548910 | 1402 | |
chiggayeuh | 0:49ae62548910 | 1403 | /* Write register value back into CONFIG3 register */ |
chiggayeuh | 0:49ae62548910 | 1404 | if( !wireWriteDataByte(APDS9960_CONFIG3, val) ) { |
chiggayeuh | 0:49ae62548910 | 1405 | return false; |
chiggayeuh | 0:49ae62548910 | 1406 | } |
chiggayeuh | 0:49ae62548910 | 1407 | |
chiggayeuh | 0:49ae62548910 | 1408 | return true; |
chiggayeuh | 0:49ae62548910 | 1409 | } |
chiggayeuh | 0:49ae62548910 | 1410 | |
chiggayeuh | 0:49ae62548910 | 1411 | /** |
chiggayeuh | 0:49ae62548910 | 1412 | * @brief Gets the entry proximity threshold for gesture sensing |
chiggayeuh | 0:49ae62548910 | 1413 | * |
chiggayeuh | 0:49ae62548910 | 1414 | * @return Current entry proximity threshold. |
chiggayeuh | 0:49ae62548910 | 1415 | */ |
chiggayeuh | 0:49ae62548910 | 1416 | uint8_t APDS9960_I2C::getGestureEnterThresh() |
chiggayeuh | 0:49ae62548910 | 1417 | { |
chiggayeuh | 0:49ae62548910 | 1418 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1419 | |
chiggayeuh | 0:49ae62548910 | 1420 | /* Read value from GPENTH register */ |
chiggayeuh | 0:49ae62548910 | 1421 | if( !wireReadDataByte(APDS9960_GPENTH, val) ) { |
chiggayeuh | 0:49ae62548910 | 1422 | val = 0; |
chiggayeuh | 0:49ae62548910 | 1423 | } |
chiggayeuh | 0:49ae62548910 | 1424 | |
chiggayeuh | 0:49ae62548910 | 1425 | return val; |
chiggayeuh | 0:49ae62548910 | 1426 | } |
chiggayeuh | 0:49ae62548910 | 1427 | |
chiggayeuh | 0:49ae62548910 | 1428 | /** |
chiggayeuh | 0:49ae62548910 | 1429 | * @brief Sets the entry proximity threshold for gesture sensing |
chiggayeuh | 0:49ae62548910 | 1430 | * |
chiggayeuh | 0:49ae62548910 | 1431 | * @param[in] threshold proximity value needed to start gesture mode |
chiggayeuh | 0:49ae62548910 | 1432 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1433 | */ |
chiggayeuh | 0:49ae62548910 | 1434 | bool APDS9960_I2C::setGestureEnterThresh(uint8_t threshold) |
chiggayeuh | 0:49ae62548910 | 1435 | { |
chiggayeuh | 0:49ae62548910 | 1436 | if( !wireWriteDataByte(APDS9960_GPENTH, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1437 | return false; |
chiggayeuh | 0:49ae62548910 | 1438 | } |
chiggayeuh | 0:49ae62548910 | 1439 | |
chiggayeuh | 0:49ae62548910 | 1440 | return true; |
chiggayeuh | 0:49ae62548910 | 1441 | } |
chiggayeuh | 0:49ae62548910 | 1442 | |
chiggayeuh | 0:49ae62548910 | 1443 | /** |
chiggayeuh | 0:49ae62548910 | 1444 | * @brief Gets the exit proximity threshold for gesture sensing |
chiggayeuh | 0:49ae62548910 | 1445 | * |
chiggayeuh | 0:49ae62548910 | 1446 | * @return Current exit proximity threshold. |
chiggayeuh | 0:49ae62548910 | 1447 | */ |
chiggayeuh | 0:49ae62548910 | 1448 | uint8_t APDS9960_I2C::getGestureExitThresh() |
chiggayeuh | 0:49ae62548910 | 1449 | { |
chiggayeuh | 0:49ae62548910 | 1450 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1451 | |
chiggayeuh | 0:49ae62548910 | 1452 | /* Read value from GEXTH register */ |
chiggayeuh | 0:49ae62548910 | 1453 | if( !wireReadDataByte(APDS9960_GEXTH, val) ) { |
chiggayeuh | 0:49ae62548910 | 1454 | val = 0; |
chiggayeuh | 0:49ae62548910 | 1455 | } |
chiggayeuh | 0:49ae62548910 | 1456 | |
chiggayeuh | 0:49ae62548910 | 1457 | return val; |
chiggayeuh | 0:49ae62548910 | 1458 | } |
chiggayeuh | 0:49ae62548910 | 1459 | |
chiggayeuh | 0:49ae62548910 | 1460 | /** |
chiggayeuh | 0:49ae62548910 | 1461 | * @brief Sets the exit proximity threshold for gesture sensing |
chiggayeuh | 0:49ae62548910 | 1462 | * |
chiggayeuh | 0:49ae62548910 | 1463 | * @param[in] threshold proximity value needed to end gesture mode |
chiggayeuh | 0:49ae62548910 | 1464 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1465 | */ |
chiggayeuh | 0:49ae62548910 | 1466 | bool APDS9960_I2C::setGestureExitThresh(uint8_t threshold) |
chiggayeuh | 0:49ae62548910 | 1467 | { |
chiggayeuh | 0:49ae62548910 | 1468 | if( !wireWriteDataByte(APDS9960_GEXTH, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1469 | return false; |
chiggayeuh | 0:49ae62548910 | 1470 | } |
chiggayeuh | 0:49ae62548910 | 1471 | |
chiggayeuh | 0:49ae62548910 | 1472 | return true; |
chiggayeuh | 0:49ae62548910 | 1473 | } |
chiggayeuh | 0:49ae62548910 | 1474 | |
chiggayeuh | 0:49ae62548910 | 1475 | /** |
chiggayeuh | 0:49ae62548910 | 1476 | * @brief Gets the gain of the photodiode during gesture mode |
chiggayeuh | 0:49ae62548910 | 1477 | * |
chiggayeuh | 0:49ae62548910 | 1478 | * Value Gain |
chiggayeuh | 0:49ae62548910 | 1479 | * 0 1x |
chiggayeuh | 0:49ae62548910 | 1480 | * 1 2x |
chiggayeuh | 0:49ae62548910 | 1481 | * 2 4x |
chiggayeuh | 0:49ae62548910 | 1482 | * 3 8x |
chiggayeuh | 0:49ae62548910 | 1483 | * |
chiggayeuh | 0:49ae62548910 | 1484 | * @return the current photodiode gain. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1485 | */ |
chiggayeuh | 0:49ae62548910 | 1486 | uint8_t APDS9960_I2C::getGestureGain() |
chiggayeuh | 0:49ae62548910 | 1487 | { |
chiggayeuh | 0:49ae62548910 | 1488 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1489 | |
chiggayeuh | 0:49ae62548910 | 1490 | /* Read value from GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1491 | if( !wireReadDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1492 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1493 | } |
chiggayeuh | 0:49ae62548910 | 1494 | |
chiggayeuh | 0:49ae62548910 | 1495 | /* Shift and mask out GGAIN bits */ |
chiggayeuh | 0:49ae62548910 | 1496 | val = (val >> 5) & 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1497 | |
chiggayeuh | 0:49ae62548910 | 1498 | return val; |
chiggayeuh | 0:49ae62548910 | 1499 | } |
chiggayeuh | 0:49ae62548910 | 1500 | |
chiggayeuh | 0:49ae62548910 | 1501 | /** |
chiggayeuh | 0:49ae62548910 | 1502 | * @brief Sets the gain of the photodiode during gesture mode |
chiggayeuh | 0:49ae62548910 | 1503 | * |
chiggayeuh | 0:49ae62548910 | 1504 | * Value Gain |
chiggayeuh | 0:49ae62548910 | 1505 | * 0 1x |
chiggayeuh | 0:49ae62548910 | 1506 | * 1 2x |
chiggayeuh | 0:49ae62548910 | 1507 | * 2 4x |
chiggayeuh | 0:49ae62548910 | 1508 | * 3 8x |
chiggayeuh | 0:49ae62548910 | 1509 | * |
chiggayeuh | 0:49ae62548910 | 1510 | * @param[in] gain the value for the photodiode gain |
chiggayeuh | 0:49ae62548910 | 1511 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1512 | */ |
chiggayeuh | 0:49ae62548910 | 1513 | bool APDS9960_I2C::setGestureGain(uint8_t gain) |
chiggayeuh | 0:49ae62548910 | 1514 | { |
chiggayeuh | 0:49ae62548910 | 1515 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1516 | |
chiggayeuh | 0:49ae62548910 | 1517 | /* Read value from GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1518 | if( !wireReadDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1519 | return false; |
chiggayeuh | 0:49ae62548910 | 1520 | } |
chiggayeuh | 0:49ae62548910 | 1521 | |
chiggayeuh | 0:49ae62548910 | 1522 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1523 | gain &= 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1524 | gain = gain << 5; |
chiggayeuh | 0:49ae62548910 | 1525 | val &= 10011111; |
chiggayeuh | 0:49ae62548910 | 1526 | val |= gain; |
chiggayeuh | 0:49ae62548910 | 1527 | |
chiggayeuh | 0:49ae62548910 | 1528 | /* Write register value back into GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1529 | if( !wireWriteDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1530 | return false; |
chiggayeuh | 0:49ae62548910 | 1531 | } |
chiggayeuh | 0:49ae62548910 | 1532 | |
chiggayeuh | 0:49ae62548910 | 1533 | return true; |
chiggayeuh | 0:49ae62548910 | 1534 | } |
chiggayeuh | 0:49ae62548910 | 1535 | |
chiggayeuh | 0:49ae62548910 | 1536 | /** |
chiggayeuh | 0:49ae62548910 | 1537 | * @brief Gets the drive current of the LED during gesture mode |
chiggayeuh | 0:49ae62548910 | 1538 | * |
chiggayeuh | 0:49ae62548910 | 1539 | * Value LED Current |
chiggayeuh | 0:49ae62548910 | 1540 | * 0 100 mA |
chiggayeuh | 0:49ae62548910 | 1541 | * 1 50 mA |
chiggayeuh | 0:49ae62548910 | 1542 | * 2 25 mA |
chiggayeuh | 0:49ae62548910 | 1543 | * 3 12.5 mA |
chiggayeuh | 0:49ae62548910 | 1544 | * |
chiggayeuh | 0:49ae62548910 | 1545 | * @return the LED drive current value. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1546 | */ |
chiggayeuh | 0:49ae62548910 | 1547 | uint8_t APDS9960_I2C::getGestureLEDDrive() |
chiggayeuh | 0:49ae62548910 | 1548 | { |
chiggayeuh | 0:49ae62548910 | 1549 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1550 | |
chiggayeuh | 0:49ae62548910 | 1551 | /* Read value from GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1552 | if( !wireReadDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1553 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1554 | } |
chiggayeuh | 0:49ae62548910 | 1555 | |
chiggayeuh | 0:49ae62548910 | 1556 | /* Shift and mask out GLDRIVE bits */ |
chiggayeuh | 0:49ae62548910 | 1557 | val = (val >> 3) & 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1558 | |
chiggayeuh | 0:49ae62548910 | 1559 | return val; |
chiggayeuh | 0:49ae62548910 | 1560 | } |
chiggayeuh | 0:49ae62548910 | 1561 | |
chiggayeuh | 0:49ae62548910 | 1562 | /** |
chiggayeuh | 0:49ae62548910 | 1563 | * @brief Sets the LED drive current during gesture mode |
chiggayeuh | 0:49ae62548910 | 1564 | * |
chiggayeuh | 0:49ae62548910 | 1565 | * Value LED Current |
chiggayeuh | 0:49ae62548910 | 1566 | * 0 100 mA |
chiggayeuh | 0:49ae62548910 | 1567 | * 1 50 mA |
chiggayeuh | 0:49ae62548910 | 1568 | * 2 25 mA |
chiggayeuh | 0:49ae62548910 | 1569 | * 3 12.5 mA |
chiggayeuh | 0:49ae62548910 | 1570 | * |
chiggayeuh | 0:49ae62548910 | 1571 | * @param[in] drive the value for the LED drive current |
chiggayeuh | 0:49ae62548910 | 1572 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1573 | */ |
chiggayeuh | 0:49ae62548910 | 1574 | bool APDS9960_I2C::setGestureLEDDrive(uint8_t drive) |
chiggayeuh | 0:49ae62548910 | 1575 | { |
chiggayeuh | 0:49ae62548910 | 1576 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1577 | |
chiggayeuh | 0:49ae62548910 | 1578 | /* Read value from GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1579 | if( !wireReadDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1580 | return false; |
chiggayeuh | 0:49ae62548910 | 1581 | } |
chiggayeuh | 0:49ae62548910 | 1582 | |
chiggayeuh | 0:49ae62548910 | 1583 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1584 | drive &= 3; //00000011 |
chiggayeuh | 0:49ae62548910 | 1585 | drive = drive << 3; |
chiggayeuh | 0:49ae62548910 | 1586 | val &= 11100111; |
chiggayeuh | 0:49ae62548910 | 1587 | val |= drive; |
chiggayeuh | 0:49ae62548910 | 1588 | |
chiggayeuh | 0:49ae62548910 | 1589 | /* Write register value back into GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1590 | if( !wireWriteDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1591 | return false; |
chiggayeuh | 0:49ae62548910 | 1592 | } |
chiggayeuh | 0:49ae62548910 | 1593 | |
chiggayeuh | 0:49ae62548910 | 1594 | return true; |
chiggayeuh | 0:49ae62548910 | 1595 | } |
chiggayeuh | 0:49ae62548910 | 1596 | |
chiggayeuh | 0:49ae62548910 | 1597 | /** |
chiggayeuh | 0:49ae62548910 | 1598 | * @brief Gets the time in low power mode between gesture detections |
chiggayeuh | 0:49ae62548910 | 1599 | * |
chiggayeuh | 0:49ae62548910 | 1600 | * Value Wait time |
chiggayeuh | 0:49ae62548910 | 1601 | * 0 0 ms |
chiggayeuh | 0:49ae62548910 | 1602 | * 1 2.8 ms |
chiggayeuh | 0:49ae62548910 | 1603 | * 2 5.6 ms |
chiggayeuh | 0:49ae62548910 | 1604 | * 3 8.4 ms |
chiggayeuh | 0:49ae62548910 | 1605 | * 4 14.0 ms |
chiggayeuh | 0:49ae62548910 | 1606 | * 5 22.4 ms |
chiggayeuh | 0:49ae62548910 | 1607 | * 6 30.8 ms |
chiggayeuh | 0:49ae62548910 | 1608 | * 7 39.2 ms |
chiggayeuh | 0:49ae62548910 | 1609 | * |
chiggayeuh | 0:49ae62548910 | 1610 | * @return the current wait time between gestures. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1611 | */ |
chiggayeuh | 0:49ae62548910 | 1612 | uint8_t APDS9960_I2C::getGestureWaitTime() |
chiggayeuh | 0:49ae62548910 | 1613 | { |
chiggayeuh | 0:49ae62548910 | 1614 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1615 | |
chiggayeuh | 0:49ae62548910 | 1616 | /* Read value from GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1617 | if( !wireReadDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1618 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1619 | } |
chiggayeuh | 0:49ae62548910 | 1620 | |
chiggayeuh | 0:49ae62548910 | 1621 | /* Mask out GWTIME bits */ |
chiggayeuh | 0:49ae62548910 | 1622 | val &= 7; //00000111 |
chiggayeuh | 0:49ae62548910 | 1623 | |
chiggayeuh | 0:49ae62548910 | 1624 | return val; |
chiggayeuh | 0:49ae62548910 | 1625 | } |
chiggayeuh | 0:49ae62548910 | 1626 | |
chiggayeuh | 0:49ae62548910 | 1627 | /** |
chiggayeuh | 0:49ae62548910 | 1628 | * @brief Sets the time in low power mode between gesture detections |
chiggayeuh | 0:49ae62548910 | 1629 | * |
chiggayeuh | 0:49ae62548910 | 1630 | * Value Wait time |
chiggayeuh | 0:49ae62548910 | 1631 | * 0 0 ms |
chiggayeuh | 0:49ae62548910 | 1632 | * 1 2.8 ms |
chiggayeuh | 0:49ae62548910 | 1633 | * 2 5.6 ms |
chiggayeuh | 0:49ae62548910 | 1634 | * 3 8.4 ms |
chiggayeuh | 0:49ae62548910 | 1635 | * 4 14.0 ms |
chiggayeuh | 0:49ae62548910 | 1636 | * 5 22.4 ms |
chiggayeuh | 0:49ae62548910 | 1637 | * 6 30.8 ms |
chiggayeuh | 0:49ae62548910 | 1638 | * 7 39.2 ms |
chiggayeuh | 0:49ae62548910 | 1639 | * |
chiggayeuh | 0:49ae62548910 | 1640 | * @param[in] the value for the wait time |
chiggayeuh | 0:49ae62548910 | 1641 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1642 | */ |
chiggayeuh | 0:49ae62548910 | 1643 | bool APDS9960_I2C::setGestureWaitTime(uint8_t time) |
chiggayeuh | 0:49ae62548910 | 1644 | { |
chiggayeuh | 0:49ae62548910 | 1645 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1646 | |
chiggayeuh | 0:49ae62548910 | 1647 | /* Read value from GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1648 | if( !wireReadDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1649 | return false; |
chiggayeuh | 0:49ae62548910 | 1650 | } |
chiggayeuh | 0:49ae62548910 | 1651 | |
chiggayeuh | 0:49ae62548910 | 1652 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1653 | time &= 7; //00000111 |
chiggayeuh | 0:49ae62548910 | 1654 | val &= 11111000; |
chiggayeuh | 0:49ae62548910 | 1655 | val |= time; |
chiggayeuh | 0:49ae62548910 | 1656 | |
chiggayeuh | 0:49ae62548910 | 1657 | /* Write register value back into GCONF2 register */ |
chiggayeuh | 0:49ae62548910 | 1658 | if( !wireWriteDataByte(APDS9960_GCONF2, val) ) { |
chiggayeuh | 0:49ae62548910 | 1659 | return false; |
chiggayeuh | 0:49ae62548910 | 1660 | } |
chiggayeuh | 0:49ae62548910 | 1661 | |
chiggayeuh | 0:49ae62548910 | 1662 | return true; |
chiggayeuh | 0:49ae62548910 | 1663 | } |
chiggayeuh | 0:49ae62548910 | 1664 | |
chiggayeuh | 0:49ae62548910 | 1665 | /** |
chiggayeuh | 0:49ae62548910 | 1666 | * @brief Gets the low threshold for ambient light interrupts |
chiggayeuh | 0:49ae62548910 | 1667 | * |
chiggayeuh | 0:49ae62548910 | 1668 | * @param[out] threshold current low threshold stored on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 1669 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1670 | */ |
chiggayeuh | 0:49ae62548910 | 1671 | bool APDS9960_I2C::getLightIntLowThreshold(uint16_t &threshold) |
chiggayeuh | 0:49ae62548910 | 1672 | { |
chiggayeuh | 0:49ae62548910 | 1673 | uint8_t val_byte; |
chiggayeuh | 0:49ae62548910 | 1674 | threshold = 0; |
chiggayeuh | 0:49ae62548910 | 1675 | |
chiggayeuh | 0:49ae62548910 | 1676 | /* Read value from ambient light low threshold, low byte register */ |
chiggayeuh | 0:49ae62548910 | 1677 | if( !wireReadDataByte(APDS9960_AILTL, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 1678 | return false; |
chiggayeuh | 0:49ae62548910 | 1679 | } |
chiggayeuh | 0:49ae62548910 | 1680 | threshold = val_byte; |
chiggayeuh | 0:49ae62548910 | 1681 | |
chiggayeuh | 0:49ae62548910 | 1682 | /* Read value from ambient light low threshold, high byte register */ |
chiggayeuh | 0:49ae62548910 | 1683 | if( !wireReadDataByte(APDS9960_AILTH, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 1684 | return false; |
chiggayeuh | 0:49ae62548910 | 1685 | } |
chiggayeuh | 0:49ae62548910 | 1686 | threshold = threshold + ((uint16_t)val_byte << 8); |
chiggayeuh | 0:49ae62548910 | 1687 | |
chiggayeuh | 0:49ae62548910 | 1688 | return true; |
chiggayeuh | 0:49ae62548910 | 1689 | } |
chiggayeuh | 0:49ae62548910 | 1690 | |
chiggayeuh | 0:49ae62548910 | 1691 | /** |
chiggayeuh | 0:49ae62548910 | 1692 | * @brief Sets the low threshold for ambient light interrupts |
chiggayeuh | 0:49ae62548910 | 1693 | * |
chiggayeuh | 0:49ae62548910 | 1694 | * @param[in] threshold low threshold value for interrupt to trigger |
chiggayeuh | 0:49ae62548910 | 1695 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1696 | */ |
chiggayeuh | 0:49ae62548910 | 1697 | bool APDS9960_I2C::setLightIntLowThreshold(uint16_t threshold) |
chiggayeuh | 0:49ae62548910 | 1698 | { |
chiggayeuh | 0:49ae62548910 | 1699 | uint8_t val_low; |
chiggayeuh | 0:49ae62548910 | 1700 | uint8_t val_high; |
chiggayeuh | 0:49ae62548910 | 1701 | |
chiggayeuh | 0:49ae62548910 | 1702 | /* Break 16-bit threshold into 2 8-bit values */ |
chiggayeuh | 0:49ae62548910 | 1703 | val_low = threshold & 0x00FF; |
chiggayeuh | 0:49ae62548910 | 1704 | val_high = (threshold & 0xFF00) >> 8; |
chiggayeuh | 0:49ae62548910 | 1705 | |
chiggayeuh | 0:49ae62548910 | 1706 | /* Write low byte */ |
chiggayeuh | 0:49ae62548910 | 1707 | if( !wireWriteDataByte(APDS9960_AILTL, val_low) ) { |
chiggayeuh | 0:49ae62548910 | 1708 | return false; |
chiggayeuh | 0:49ae62548910 | 1709 | } |
chiggayeuh | 0:49ae62548910 | 1710 | |
chiggayeuh | 0:49ae62548910 | 1711 | /* Write high byte */ |
chiggayeuh | 0:49ae62548910 | 1712 | if( !wireWriteDataByte(APDS9960_AILTH, val_high) ) { |
chiggayeuh | 0:49ae62548910 | 1713 | return false; |
chiggayeuh | 0:49ae62548910 | 1714 | } |
chiggayeuh | 0:49ae62548910 | 1715 | |
chiggayeuh | 0:49ae62548910 | 1716 | return true; |
chiggayeuh | 0:49ae62548910 | 1717 | } |
chiggayeuh | 0:49ae62548910 | 1718 | |
chiggayeuh | 0:49ae62548910 | 1719 | /** |
chiggayeuh | 0:49ae62548910 | 1720 | * @brief Gets the high threshold for ambient light interrupts |
chiggayeuh | 0:49ae62548910 | 1721 | * |
chiggayeuh | 0:49ae62548910 | 1722 | * @param[out] threshold current low threshold stored on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 1723 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1724 | */ |
chiggayeuh | 0:49ae62548910 | 1725 | bool APDS9960_I2C::getLightIntHighThreshold(uint16_t &threshold) |
chiggayeuh | 0:49ae62548910 | 1726 | { |
chiggayeuh | 0:49ae62548910 | 1727 | uint8_t val_byte; |
chiggayeuh | 0:49ae62548910 | 1728 | threshold = 0; |
chiggayeuh | 0:49ae62548910 | 1729 | |
chiggayeuh | 0:49ae62548910 | 1730 | /* Read value from ambient light high threshold, low byte register */ |
chiggayeuh | 0:49ae62548910 | 1731 | if( !wireReadDataByte(APDS9960_AIHTL, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 1732 | return false; |
chiggayeuh | 0:49ae62548910 | 1733 | } |
chiggayeuh | 0:49ae62548910 | 1734 | threshold = val_byte; |
chiggayeuh | 0:49ae62548910 | 1735 | |
chiggayeuh | 0:49ae62548910 | 1736 | /* Read value from ambient light high threshold, high byte register */ |
chiggayeuh | 0:49ae62548910 | 1737 | if( !wireReadDataByte(APDS9960_AIHTH, val_byte) ) { |
chiggayeuh | 0:49ae62548910 | 1738 | return false; |
chiggayeuh | 0:49ae62548910 | 1739 | } |
chiggayeuh | 0:49ae62548910 | 1740 | threshold = threshold + ((uint16_t)val_byte << 8); |
chiggayeuh | 0:49ae62548910 | 1741 | |
chiggayeuh | 0:49ae62548910 | 1742 | return true; |
chiggayeuh | 0:49ae62548910 | 1743 | } |
chiggayeuh | 0:49ae62548910 | 1744 | |
chiggayeuh | 0:49ae62548910 | 1745 | /** |
chiggayeuh | 0:49ae62548910 | 1746 | * @brief Sets the high threshold for ambient light interrupts |
chiggayeuh | 0:49ae62548910 | 1747 | * |
chiggayeuh | 0:49ae62548910 | 1748 | * @param[in] threshold high threshold value for interrupt to trigger |
chiggayeuh | 0:49ae62548910 | 1749 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1750 | */ |
chiggayeuh | 0:49ae62548910 | 1751 | bool APDS9960_I2C::setLightIntHighThreshold(uint16_t threshold) |
chiggayeuh | 0:49ae62548910 | 1752 | { |
chiggayeuh | 0:49ae62548910 | 1753 | uint8_t val_low; |
chiggayeuh | 0:49ae62548910 | 1754 | uint8_t val_high; |
chiggayeuh | 0:49ae62548910 | 1755 | |
chiggayeuh | 0:49ae62548910 | 1756 | /* Break 16-bit threshold into 2 8-bit values */ |
chiggayeuh | 0:49ae62548910 | 1757 | val_low = threshold & 0x00FF; |
chiggayeuh | 0:49ae62548910 | 1758 | val_high = (threshold & 0xFF00) >> 8; |
chiggayeuh | 0:49ae62548910 | 1759 | |
chiggayeuh | 0:49ae62548910 | 1760 | /* Write low byte */ |
chiggayeuh | 0:49ae62548910 | 1761 | if( !wireWriteDataByte(APDS9960_AIHTL, val_low) ) { |
chiggayeuh | 0:49ae62548910 | 1762 | return false; |
chiggayeuh | 0:49ae62548910 | 1763 | } |
chiggayeuh | 0:49ae62548910 | 1764 | |
chiggayeuh | 0:49ae62548910 | 1765 | /* Write high byte */ |
chiggayeuh | 0:49ae62548910 | 1766 | if( !wireWriteDataByte(APDS9960_AIHTH, val_high) ) { |
chiggayeuh | 0:49ae62548910 | 1767 | return false; |
chiggayeuh | 0:49ae62548910 | 1768 | } |
chiggayeuh | 0:49ae62548910 | 1769 | |
chiggayeuh | 0:49ae62548910 | 1770 | return true; |
chiggayeuh | 0:49ae62548910 | 1771 | } |
chiggayeuh | 0:49ae62548910 | 1772 | |
chiggayeuh | 0:49ae62548910 | 1773 | /** |
chiggayeuh | 0:49ae62548910 | 1774 | * @brief Gets the low threshold for proximity interrupts |
chiggayeuh | 0:49ae62548910 | 1775 | * |
chiggayeuh | 0:49ae62548910 | 1776 | * @param[out] threshold current low threshold stored on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 1777 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1778 | */ |
chiggayeuh | 0:49ae62548910 | 1779 | bool APDS9960_I2C::getProximityIntLowThreshold(uint8_t &threshold) |
chiggayeuh | 0:49ae62548910 | 1780 | { |
chiggayeuh | 0:49ae62548910 | 1781 | threshold = 0; |
chiggayeuh | 0:49ae62548910 | 1782 | |
chiggayeuh | 0:49ae62548910 | 1783 | /* Read value from proximity low threshold register */ |
chiggayeuh | 0:49ae62548910 | 1784 | if( !wireReadDataByte(APDS9960_PILT, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1785 | return false; |
chiggayeuh | 0:49ae62548910 | 1786 | } |
chiggayeuh | 0:49ae62548910 | 1787 | |
chiggayeuh | 0:49ae62548910 | 1788 | return true; |
chiggayeuh | 0:49ae62548910 | 1789 | } |
chiggayeuh | 0:49ae62548910 | 1790 | |
chiggayeuh | 0:49ae62548910 | 1791 | /** |
chiggayeuh | 0:49ae62548910 | 1792 | * @brief Sets the low threshold for proximity interrupts |
chiggayeuh | 0:49ae62548910 | 1793 | * |
chiggayeuh | 0:49ae62548910 | 1794 | * @param[in] threshold low threshold value for interrupt to trigger |
chiggayeuh | 0:49ae62548910 | 1795 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1796 | */ |
chiggayeuh | 0:49ae62548910 | 1797 | bool APDS9960_I2C::setProximityIntLowThreshold(uint8_t threshold) |
chiggayeuh | 0:49ae62548910 | 1798 | { |
chiggayeuh | 0:49ae62548910 | 1799 | |
chiggayeuh | 0:49ae62548910 | 1800 | /* Write threshold value to register */ |
chiggayeuh | 0:49ae62548910 | 1801 | if( !wireWriteDataByte(APDS9960_PILT, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1802 | return false; |
chiggayeuh | 0:49ae62548910 | 1803 | } |
chiggayeuh | 0:49ae62548910 | 1804 | |
chiggayeuh | 0:49ae62548910 | 1805 | return true; |
chiggayeuh | 0:49ae62548910 | 1806 | } |
chiggayeuh | 0:49ae62548910 | 1807 | |
chiggayeuh | 0:49ae62548910 | 1808 | /** |
chiggayeuh | 0:49ae62548910 | 1809 | * @brief Gets the high threshold for proximity interrupts |
chiggayeuh | 0:49ae62548910 | 1810 | * |
chiggayeuh | 0:49ae62548910 | 1811 | * @param[out] threshold current low threshold stored on the APDS-9960 |
chiggayeuh | 0:49ae62548910 | 1812 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1813 | */ |
chiggayeuh | 0:49ae62548910 | 1814 | bool APDS9960_I2C::getProximityIntHighThreshold(uint8_t &threshold) |
chiggayeuh | 0:49ae62548910 | 1815 | { |
chiggayeuh | 0:49ae62548910 | 1816 | threshold = 0; |
chiggayeuh | 0:49ae62548910 | 1817 | |
chiggayeuh | 0:49ae62548910 | 1818 | /* Read value from proximity low threshold register */ |
chiggayeuh | 0:49ae62548910 | 1819 | if( !wireReadDataByte(APDS9960_PIHT, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1820 | return false; |
chiggayeuh | 0:49ae62548910 | 1821 | } |
chiggayeuh | 0:49ae62548910 | 1822 | |
chiggayeuh | 0:49ae62548910 | 1823 | return true; |
chiggayeuh | 0:49ae62548910 | 1824 | } |
chiggayeuh | 0:49ae62548910 | 1825 | |
chiggayeuh | 0:49ae62548910 | 1826 | /** |
chiggayeuh | 0:49ae62548910 | 1827 | * @brief Sets the high threshold for proximity interrupts |
chiggayeuh | 0:49ae62548910 | 1828 | * |
chiggayeuh | 0:49ae62548910 | 1829 | * @param[in] threshold high threshold value for interrupt to trigger |
chiggayeuh | 0:49ae62548910 | 1830 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1831 | */ |
chiggayeuh | 0:49ae62548910 | 1832 | bool APDS9960_I2C::setProximityIntHighThreshold(uint8_t threshold) |
chiggayeuh | 0:49ae62548910 | 1833 | { |
chiggayeuh | 0:49ae62548910 | 1834 | |
chiggayeuh | 0:49ae62548910 | 1835 | /* Write threshold value to register */ |
chiggayeuh | 0:49ae62548910 | 1836 | if( !wireWriteDataByte(APDS9960_PIHT, threshold) ) { |
chiggayeuh | 0:49ae62548910 | 1837 | return false; |
chiggayeuh | 0:49ae62548910 | 1838 | } |
chiggayeuh | 0:49ae62548910 | 1839 | |
chiggayeuh | 0:49ae62548910 | 1840 | return true; |
chiggayeuh | 0:49ae62548910 | 1841 | } |
chiggayeuh | 0:49ae62548910 | 1842 | |
chiggayeuh | 0:49ae62548910 | 1843 | /** |
chiggayeuh | 0:49ae62548910 | 1844 | * @brief Gets if ambient light interrupts are enabled or not |
chiggayeuh | 0:49ae62548910 | 1845 | * |
chiggayeuh | 0:49ae62548910 | 1846 | * @return 1 if interrupts are enabled, 0 if not. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1847 | */ |
chiggayeuh | 0:49ae62548910 | 1848 | uint8_t APDS9960_I2C::getAmbientLightIntEnable() |
chiggayeuh | 0:49ae62548910 | 1849 | { |
chiggayeuh | 0:49ae62548910 | 1850 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1851 | |
chiggayeuh | 0:49ae62548910 | 1852 | /* Read value from ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 1853 | if( !wireReadDataByte(APDS9960_ENABLE, val) ) { |
chiggayeuh | 0:49ae62548910 | 1854 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1855 | } |
chiggayeuh | 0:49ae62548910 | 1856 | |
chiggayeuh | 0:49ae62548910 | 1857 | /* Shift and mask out AIEN bit */ |
chiggayeuh | 0:49ae62548910 | 1858 | val = (val >> 4) & 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1859 | |
chiggayeuh | 0:49ae62548910 | 1860 | return val; |
chiggayeuh | 0:49ae62548910 | 1861 | } |
chiggayeuh | 0:49ae62548910 | 1862 | |
chiggayeuh | 0:49ae62548910 | 1863 | /** |
chiggayeuh | 0:49ae62548910 | 1864 | * @brief Turns ambient light interrupts on or off |
chiggayeuh | 0:49ae62548910 | 1865 | * |
chiggayeuh | 0:49ae62548910 | 1866 | * @param[in] enable 1 to enable interrupts, 0 to turn them off |
chiggayeuh | 0:49ae62548910 | 1867 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1868 | */ |
chiggayeuh | 0:49ae62548910 | 1869 | bool APDS9960_I2C::setAmbientLightIntEnable(uint8_t enable) |
chiggayeuh | 0:49ae62548910 | 1870 | { |
chiggayeuh | 0:49ae62548910 | 1871 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1872 | |
chiggayeuh | 0:49ae62548910 | 1873 | /* Read value from ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 1874 | if( !wireReadDataByte(APDS9960_ENABLE, val) ) { |
chiggayeuh | 0:49ae62548910 | 1875 | return false; |
chiggayeuh | 0:49ae62548910 | 1876 | } |
chiggayeuh | 0:49ae62548910 | 1877 | |
chiggayeuh | 0:49ae62548910 | 1878 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1879 | enable &= 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1880 | enable = enable << 4; |
chiggayeuh | 0:49ae62548910 | 1881 | val &= 11101111; |
chiggayeuh | 0:49ae62548910 | 1882 | val |= enable; |
chiggayeuh | 0:49ae62548910 | 1883 | |
chiggayeuh | 0:49ae62548910 | 1884 | /* Write register value back into ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 1885 | if( !wireWriteDataByte(APDS9960_ENABLE, val) ) { |
chiggayeuh | 0:49ae62548910 | 1886 | return false; |
chiggayeuh | 0:49ae62548910 | 1887 | } |
chiggayeuh | 0:49ae62548910 | 1888 | |
chiggayeuh | 0:49ae62548910 | 1889 | return true; |
chiggayeuh | 0:49ae62548910 | 1890 | } |
chiggayeuh | 0:49ae62548910 | 1891 | |
chiggayeuh | 0:49ae62548910 | 1892 | /** |
chiggayeuh | 0:49ae62548910 | 1893 | * @brief Gets if proximity interrupts are enabled or not |
chiggayeuh | 0:49ae62548910 | 1894 | * |
chiggayeuh | 0:49ae62548910 | 1895 | * @return 1 if interrupts are enabled, 0 if not. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1896 | */ |
chiggayeuh | 0:49ae62548910 | 1897 | uint8_t APDS9960_I2C::getProximityIntEnable() |
chiggayeuh | 0:49ae62548910 | 1898 | { |
chiggayeuh | 0:49ae62548910 | 1899 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1900 | |
chiggayeuh | 0:49ae62548910 | 1901 | /* Read value from ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 1902 | if( !wireReadDataByte(APDS9960_ENABLE, val) ) { |
chiggayeuh | 0:49ae62548910 | 1903 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1904 | } |
chiggayeuh | 0:49ae62548910 | 1905 | |
chiggayeuh | 0:49ae62548910 | 1906 | /* Shift and mask out PIEN bit */ |
chiggayeuh | 0:49ae62548910 | 1907 | val = (val >> 5) & 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1908 | |
chiggayeuh | 0:49ae62548910 | 1909 | return val; |
chiggayeuh | 0:49ae62548910 | 1910 | } |
chiggayeuh | 0:49ae62548910 | 1911 | |
chiggayeuh | 0:49ae62548910 | 1912 | /** |
chiggayeuh | 0:49ae62548910 | 1913 | * @brief Turns proximity interrupts on or off |
chiggayeuh | 0:49ae62548910 | 1914 | * |
chiggayeuh | 0:49ae62548910 | 1915 | * @param[in] enable 1 to enable interrupts, 0 to turn them off |
chiggayeuh | 0:49ae62548910 | 1916 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1917 | */ |
chiggayeuh | 0:49ae62548910 | 1918 | bool APDS9960_I2C::setProximityIntEnable(uint8_t enable) |
chiggayeuh | 0:49ae62548910 | 1919 | { |
chiggayeuh | 0:49ae62548910 | 1920 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1921 | |
chiggayeuh | 0:49ae62548910 | 1922 | /* Read value from ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 1923 | if( !wireReadDataByte(APDS9960_ENABLE, val) ) { |
chiggayeuh | 0:49ae62548910 | 1924 | return false; |
chiggayeuh | 0:49ae62548910 | 1925 | } |
chiggayeuh | 0:49ae62548910 | 1926 | |
chiggayeuh | 0:49ae62548910 | 1927 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1928 | enable &= 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1929 | enable = enable << 5; |
chiggayeuh | 0:49ae62548910 | 1930 | val &= 11011111; |
chiggayeuh | 0:49ae62548910 | 1931 | val |= enable; |
chiggayeuh | 0:49ae62548910 | 1932 | |
chiggayeuh | 0:49ae62548910 | 1933 | /* Write register value back into ENABLE register */ |
chiggayeuh | 0:49ae62548910 | 1934 | if( !wireWriteDataByte(APDS9960_ENABLE, val) ) { |
chiggayeuh | 0:49ae62548910 | 1935 | return false; |
chiggayeuh | 0:49ae62548910 | 1936 | } |
chiggayeuh | 0:49ae62548910 | 1937 | |
chiggayeuh | 0:49ae62548910 | 1938 | return true; |
chiggayeuh | 0:49ae62548910 | 1939 | } |
chiggayeuh | 0:49ae62548910 | 1940 | |
chiggayeuh | 0:49ae62548910 | 1941 | /** |
chiggayeuh | 0:49ae62548910 | 1942 | * @brief Gets if gesture interrupts are enabled or not |
chiggayeuh | 0:49ae62548910 | 1943 | * |
chiggayeuh | 0:49ae62548910 | 1944 | * @return 1 if interrupts are enabled, 0 if not. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 1945 | */ |
chiggayeuh | 0:49ae62548910 | 1946 | uint8_t APDS9960_I2C::getGestureIntEnable() |
chiggayeuh | 0:49ae62548910 | 1947 | { |
chiggayeuh | 0:49ae62548910 | 1948 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1949 | |
chiggayeuh | 0:49ae62548910 | 1950 | /* Read value from GCONF4 register */ |
chiggayeuh | 0:49ae62548910 | 1951 | if( !wireReadDataByte(APDS9960_GCONF4, val) ) { |
chiggayeuh | 0:49ae62548910 | 1952 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 1953 | } |
chiggayeuh | 0:49ae62548910 | 1954 | |
chiggayeuh | 0:49ae62548910 | 1955 | /* Shift and mask out GIEN bit */ |
chiggayeuh | 0:49ae62548910 | 1956 | val = (val >> 1) & 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1957 | |
chiggayeuh | 0:49ae62548910 | 1958 | return val; |
chiggayeuh | 0:49ae62548910 | 1959 | } |
chiggayeuh | 0:49ae62548910 | 1960 | |
chiggayeuh | 0:49ae62548910 | 1961 | /** |
chiggayeuh | 0:49ae62548910 | 1962 | * @brief Turns gesture-related interrupts on or off |
chiggayeuh | 0:49ae62548910 | 1963 | * |
chiggayeuh | 0:49ae62548910 | 1964 | * @param[in] enable 1 to enable interrupts, 0 to turn them off |
chiggayeuh | 0:49ae62548910 | 1965 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1966 | */ |
chiggayeuh | 0:49ae62548910 | 1967 | bool APDS9960_I2C::setGestureIntEnable(uint8_t enable) |
chiggayeuh | 0:49ae62548910 | 1968 | { |
chiggayeuh | 0:49ae62548910 | 1969 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 1970 | |
chiggayeuh | 0:49ae62548910 | 1971 | /* Read value from GCONF4 register */ |
chiggayeuh | 0:49ae62548910 | 1972 | if( !wireReadDataByte(APDS9960_GCONF4, val) ) { |
chiggayeuh | 0:49ae62548910 | 1973 | return false; |
chiggayeuh | 0:49ae62548910 | 1974 | } |
chiggayeuh | 0:49ae62548910 | 1975 | |
chiggayeuh | 0:49ae62548910 | 1976 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 1977 | enable &= 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 1978 | enable = enable << 1; |
chiggayeuh | 0:49ae62548910 | 1979 | val &= 11111101; |
chiggayeuh | 0:49ae62548910 | 1980 | val |= enable; |
chiggayeuh | 0:49ae62548910 | 1981 | |
chiggayeuh | 0:49ae62548910 | 1982 | /* Write register value back into GCONF4 register */ |
chiggayeuh | 0:49ae62548910 | 1983 | if( !wireWriteDataByte(APDS9960_GCONF4, val) ) { |
chiggayeuh | 0:49ae62548910 | 1984 | return false; |
chiggayeuh | 0:49ae62548910 | 1985 | } |
chiggayeuh | 0:49ae62548910 | 1986 | |
chiggayeuh | 0:49ae62548910 | 1987 | return true; |
chiggayeuh | 0:49ae62548910 | 1988 | } |
chiggayeuh | 0:49ae62548910 | 1989 | |
chiggayeuh | 0:49ae62548910 | 1990 | /** |
chiggayeuh | 0:49ae62548910 | 1991 | * @brief Clears the ambient light interrupt |
chiggayeuh | 0:49ae62548910 | 1992 | * |
chiggayeuh | 0:49ae62548910 | 1993 | * @return True if operation completed successfully. False otherwise. |
chiggayeuh | 0:49ae62548910 | 1994 | */ |
chiggayeuh | 0:49ae62548910 | 1995 | bool APDS9960_I2C::clearAmbientLightInt() |
chiggayeuh | 0:49ae62548910 | 1996 | { |
chiggayeuh | 0:49ae62548910 | 1997 | uint8_t throwaway; |
chiggayeuh | 0:49ae62548910 | 1998 | if( !wireReadDataByte(APDS9960_AICLEAR, throwaway) ) { |
chiggayeuh | 0:49ae62548910 | 1999 | return false; |
chiggayeuh | 0:49ae62548910 | 2000 | } |
chiggayeuh | 0:49ae62548910 | 2001 | |
chiggayeuh | 0:49ae62548910 | 2002 | return true; |
chiggayeuh | 0:49ae62548910 | 2003 | } |
chiggayeuh | 0:49ae62548910 | 2004 | |
chiggayeuh | 0:49ae62548910 | 2005 | /** |
chiggayeuh | 0:49ae62548910 | 2006 | * @brief Clears the proximity interrupt |
chiggayeuh | 0:49ae62548910 | 2007 | * |
chiggayeuh | 0:49ae62548910 | 2008 | * @return True if operation completed successfully. False otherwise. |
chiggayeuh | 0:49ae62548910 | 2009 | */ |
chiggayeuh | 0:49ae62548910 | 2010 | bool APDS9960_I2C::clearProximityInt() |
chiggayeuh | 0:49ae62548910 | 2011 | { |
chiggayeuh | 0:49ae62548910 | 2012 | uint8_t throwaway; |
chiggayeuh | 0:49ae62548910 | 2013 | if( !wireReadDataByte(APDS9960_PICLEAR, throwaway) ) { |
chiggayeuh | 0:49ae62548910 | 2014 | return false; |
chiggayeuh | 0:49ae62548910 | 2015 | } |
chiggayeuh | 0:49ae62548910 | 2016 | |
chiggayeuh | 0:49ae62548910 | 2017 | return true; |
chiggayeuh | 0:49ae62548910 | 2018 | } |
chiggayeuh | 0:49ae62548910 | 2019 | |
chiggayeuh | 0:49ae62548910 | 2020 | /** |
chiggayeuh | 0:49ae62548910 | 2021 | * @brief Tells if the gesture state machine is currently running |
chiggayeuh | 0:49ae62548910 | 2022 | * |
chiggayeuh | 0:49ae62548910 | 2023 | * @return 1 if gesture state machine is running, 0 if not. 0xFF on error. |
chiggayeuh | 0:49ae62548910 | 2024 | */ |
chiggayeuh | 0:49ae62548910 | 2025 | uint8_t APDS9960_I2C::getGestureMode() |
chiggayeuh | 0:49ae62548910 | 2026 | { |
chiggayeuh | 0:49ae62548910 | 2027 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 2028 | |
chiggayeuh | 0:49ae62548910 | 2029 | /* Read value from GCONF4 register */ |
chiggayeuh | 0:49ae62548910 | 2030 | if( !wireReadDataByte(APDS9960_GCONF4, val) ) { |
chiggayeuh | 0:49ae62548910 | 2031 | return ERROR; |
chiggayeuh | 0:49ae62548910 | 2032 | } |
chiggayeuh | 0:49ae62548910 | 2033 | |
chiggayeuh | 0:49ae62548910 | 2034 | /* Mask out GMODE bit */ |
chiggayeuh | 0:49ae62548910 | 2035 | val &= 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 2036 | |
chiggayeuh | 0:49ae62548910 | 2037 | return val; |
chiggayeuh | 0:49ae62548910 | 2038 | } |
chiggayeuh | 0:49ae62548910 | 2039 | |
chiggayeuh | 0:49ae62548910 | 2040 | /** |
chiggayeuh | 0:49ae62548910 | 2041 | * @brief Tells the state machine to either enter or exit gesture state machine |
chiggayeuh | 0:49ae62548910 | 2042 | * |
chiggayeuh | 0:49ae62548910 | 2043 | * @param[in] mode 1 to enter gesture state machine, 0 to exit. |
chiggayeuh | 0:49ae62548910 | 2044 | * @return True if operation successful. False otherwise. |
chiggayeuh | 0:49ae62548910 | 2045 | */ |
chiggayeuh | 0:49ae62548910 | 2046 | bool APDS9960_I2C::setGestureMode(uint8_t mode) |
chiggayeuh | 0:49ae62548910 | 2047 | { |
chiggayeuh | 0:49ae62548910 | 2048 | uint8_t val; |
chiggayeuh | 0:49ae62548910 | 2049 | |
chiggayeuh | 0:49ae62548910 | 2050 | /* Read value from GCONF4 register */ |
chiggayeuh | 0:49ae62548910 | 2051 | if( !wireReadDataByte(APDS9960_GCONF4, val) ) { |
chiggayeuh | 0:49ae62548910 | 2052 | return false; |
chiggayeuh | 0:49ae62548910 | 2053 | } |
chiggayeuh | 0:49ae62548910 | 2054 | |
chiggayeuh | 0:49ae62548910 | 2055 | /* Set bits in register to given value */ |
chiggayeuh | 0:49ae62548910 | 2056 | mode &= 1; //00000001 |
chiggayeuh | 0:49ae62548910 | 2057 | val &= 11111110; |
chiggayeuh | 0:49ae62548910 | 2058 | val |= mode; |
chiggayeuh | 0:49ae62548910 | 2059 | |
chiggayeuh | 0:49ae62548910 | 2060 | /* Write register value back into GCONF4 register */ |
chiggayeuh | 0:49ae62548910 | 2061 | if( !wireWriteDataByte(APDS9960_GCONF4, val) ) { |
chiggayeuh | 0:49ae62548910 | 2062 | return false; |
chiggayeuh | 0:49ae62548910 | 2063 | } |
chiggayeuh | 0:49ae62548910 | 2064 | |
chiggayeuh | 0:49ae62548910 | 2065 | return true; |
chiggayeuh | 0:49ae62548910 | 2066 | } |
chiggayeuh | 0:49ae62548910 | 2067 | |
chiggayeuh | 0:49ae62548910 | 2068 | /******************************************************************************* |
chiggayeuh | 0:49ae62548910 | 2069 | * Raw I2C Reads and Writes |
chiggayeuh | 0:49ae62548910 | 2070 | ******************************************************************************/ |
chiggayeuh | 0:49ae62548910 | 2071 | |
chiggayeuh | 0:49ae62548910 | 2072 | |
chiggayeuh | 0:49ae62548910 | 2073 | /** |
chiggayeuh | 0:49ae62548910 | 2074 | * @brief Writes a single byte to the I2C device and specified register |
chiggayeuh | 0:49ae62548910 | 2075 | * |
chiggayeuh | 0:49ae62548910 | 2076 | * @param[in] reg the register in the I2C device to write to |
chiggayeuh | 0:49ae62548910 | 2077 | * @param[in] val the 1-byte value to write to the I2C device |
chiggayeuh | 0:49ae62548910 | 2078 | * @return True if successful write operation. False otherwise. |
chiggayeuh | 0:49ae62548910 | 2079 | */ |
chiggayeuh | 0:49ae62548910 | 2080 | |
chiggayeuh | 0:49ae62548910 | 2081 | int APDS9960_I2C::wireWriteDataByte(uint8_t address, uint8_t data){ |
chiggayeuh | 0:49ae62548910 | 2082 | char address_fixed = address; |
chiggayeuh | 0:49ae62548910 | 2083 | char data_fixed = data; |
chiggayeuh | 0:49ae62548910 | 2084 | char tx[2] = { address_fixed, data_fixed }; //0d160 = 0b10100000 |
chiggayeuh | 0:49ae62548910 | 2085 | int ack = i2c.write(APDS9960_I2C_ADDR << 1, tx, 2 ); |
chiggayeuh | 0:49ae62548910 | 2086 | return !ack; |
chiggayeuh | 0:49ae62548910 | 2087 | } |
chiggayeuh | 0:49ae62548910 | 2088 | |
chiggayeuh | 0:49ae62548910 | 2089 | |
chiggayeuh | 0:49ae62548910 | 2090 | ///////////////////////////////////////////////////////////////////////////////////////////// |
chiggayeuh | 0:49ae62548910 | 2091 | |
chiggayeuh | 0:49ae62548910 | 2092 | /** |
chiggayeuh | 0:49ae62548910 | 2093 | * @brief Writes a block (array) of bytes to the I2C device and register |
chiggayeuh | 0:49ae62548910 | 2094 | * |
chiggayeuh | 0:49ae62548910 | 2095 | * @param[in] reg the register in the I2C device to write to |
chiggayeuh | 0:49ae62548910 | 2096 | * @param[in] val pointer to the beginning of the data byte array |
chiggayeuh | 0:49ae62548910 | 2097 | * @param[in] len the length (in bytes) of the data to write |
chiggayeuh | 0:49ae62548910 | 2098 | * @return True if successful write operation. False otherwise. |
chiggayeuh | 0:49ae62548910 | 2099 | */ |
chiggayeuh | 0:49ae62548910 | 2100 | |
chiggayeuh | 0:49ae62548910 | 2101 | int APDS9960_I2C::wireWriteDataBlock(uint8_t address, uint8_t* data, unsigned int quantity){ |
chiggayeuh | 0:49ae62548910 | 2102 | char address_fixed = address; |
chiggayeuh | 0:49ae62548910 | 2103 | //char* data_fixed = data; |
chiggayeuh | 0:49ae62548910 | 2104 | |
chiggayeuh | 0:49ae62548910 | 2105 | char tx[ quantity + 1 ]; |
chiggayeuh | 0:49ae62548910 | 2106 | tx[0] = address; |
chiggayeuh | 0:49ae62548910 | 2107 | for ( int i = 1; i <= quantity; i++ ){ |
chiggayeuh | 0:49ae62548910 | 2108 | tx[ i ] = data[ i - 1 ]; |
chiggayeuh | 0:49ae62548910 | 2109 | } |
chiggayeuh | 0:49ae62548910 | 2110 | int ack = i2c.write( APDS9960_I2C_ADDR << 1, tx, quantity + 1 ); |
chiggayeuh | 0:49ae62548910 | 2111 | return !ack; |
chiggayeuh | 0:49ae62548910 | 2112 | } |
chiggayeuh | 0:49ae62548910 | 2113 | |
chiggayeuh | 0:49ae62548910 | 2114 | |
chiggayeuh | 0:49ae62548910 | 2115 | ///////////////////////////////////////////////////////////////////////////////////////////// |
chiggayeuh | 0:49ae62548910 | 2116 | |
chiggayeuh | 0:49ae62548910 | 2117 | |
chiggayeuh | 0:49ae62548910 | 2118 | /** |
chiggayeuh | 0:49ae62548910 | 2119 | * @brief Reads a single byte from the I2C device and specified register |
chiggayeuh | 0:49ae62548910 | 2120 | * |
chiggayeuh | 0:49ae62548910 | 2121 | * @param[in] reg the register to read from |
chiggayeuh | 0:49ae62548910 | 2122 | * @param[out] the value returned from the register |
chiggayeuh | 0:49ae62548910 | 2123 | * @return True if successful read operation. False otherwise. |
chiggayeuh | 0:49ae62548910 | 2124 | */ |
chiggayeuh | 0:49ae62548910 | 2125 | |
chiggayeuh | 0:49ae62548910 | 2126 | int APDS9960_I2C::wireReadDataByte(uint8_t address, uint8_t &val){ |
chiggayeuh | 0:49ae62548910 | 2127 | char output = 255; |
chiggayeuh | 0:49ae62548910 | 2128 | //char address_fixed = address; |
chiggayeuh | 0:49ae62548910 | 2129 | //char vag; |
chiggayeuh | 0:49ae62548910 | 2130 | char command = address; //0d160 = 0b10100000 |
chiggayeuh | 0:49ae62548910 | 2131 | i2c.write( APDS9960_I2C_ADDR << 1, &command, 1, true); |
chiggayeuh | 0:49ae62548910 | 2132 | |
chiggayeuh | 0:49ae62548910 | 2133 | int ack = i2c.read( APDS9960_I2C_ADDR << 1, &output, 1 ); |
chiggayeuh | 0:49ae62548910 | 2134 | val = output; |
chiggayeuh | 0:49ae62548910 | 2135 | return !ack; |
chiggayeuh | 0:49ae62548910 | 2136 | |
chiggayeuh | 0:49ae62548910 | 2137 | } |
chiggayeuh | 0:49ae62548910 | 2138 | |
chiggayeuh | 0:49ae62548910 | 2139 | |
chiggayeuh | 0:49ae62548910 | 2140 | ///////////////////////////////////////////////////////////////////////////////////////////// |
chiggayeuh | 0:49ae62548910 | 2141 | |
chiggayeuh | 0:49ae62548910 | 2142 | /** |
chiggayeuh | 0:49ae62548910 | 2143 | * @brief Reads a block (array) of bytes from the I2C device and register |
chiggayeuh | 0:49ae62548910 | 2144 | * |
chiggayeuh | 0:49ae62548910 | 2145 | * @param[in] reg the register to read from |
chiggayeuh | 0:49ae62548910 | 2146 | * @param[out] val pointer to the beginning of the data |
chiggayeuh | 0:49ae62548910 | 2147 | * @param[in] len number of bytes to read |
chiggayeuh | 0:49ae62548910 | 2148 | * @return Number of bytes read. -1 on read error. |
chiggayeuh | 0:49ae62548910 | 2149 | */ |
chiggayeuh | 0:49ae62548910 | 2150 | |
chiggayeuh | 0:49ae62548910 | 2151 | int APDS9960_I2C::wireReadDataBlock( uint8_t address, uint8_t* val, unsigned int quantity ){ |
chiggayeuh | 0:49ae62548910 | 2152 | |
chiggayeuh | 0:49ae62548910 | 2153 | char* val_holder = reinterpret_cast<char*>(val); |
chiggayeuh | 0:49ae62548910 | 2154 | char command = address; |
chiggayeuh | 0:49ae62548910 | 2155 | i2c.write( APDS9960_I2C_ADDR << 1, &command, 1, true ); |
chiggayeuh | 0:49ae62548910 | 2156 | int ack = i2c.read(APDS9960_I2C_ADDR << 1, val_holder, quantity); |
chiggayeuh | 0:49ae62548910 | 2157 | return quantity; |
chiggayeuh | 0:49ae62548910 | 2158 | } |