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