A library for the Avago ADJD-S311-CR999 Color Light Sensor
Dependents: ADJD-S311_HelloWorld
ADJDs311.cpp@0:d5bb69f92ea3, 2014-03-24 (annotated)
- Committer:
- CheeseW
- Date:
- Mon Mar 24 04:46:51 2014 +0000
- Revision:
- 0:d5bb69f92ea3
Come out for publication
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
CheeseW | 0:d5bb69f92ea3 | 1 | #include "ADJDs311.h" |
CheeseW | 0:d5bb69f92ea3 | 2 | #include "mbed.h" |
CheeseW | 0:d5bb69f92ea3 | 3 | #include <algorithm> |
CheeseW | 0:d5bb69f92ea3 | 4 | |
CheeseW | 0:d5bb69f92ea3 | 5 | ADJDs311::ADJDs311(PinName sda, PinName scl, PinName led): |
CheeseW | 0:d5bb69f92ea3 | 6 | _i2c(sda, scl), _led(led) { |
CheeseW | 0:d5bb69f92ea3 | 7 | // hard coded value for number of capacitors |
CheeseW | 0:d5bb69f92ea3 | 8 | colorCap.red = 12; |
CheeseW | 0:d5bb69f92ea3 | 9 | colorCap.green = 9; |
CheeseW | 0:d5bb69f92ea3 | 10 | colorCap.blue = 2; |
CheeseW | 0:d5bb69f92ea3 | 11 | colorCap.clear = 9; |
CheeseW | 0:d5bb69f92ea3 | 12 | |
CheeseW | 0:d5bb69f92ea3 | 13 | // hard coded value for number of integration time slot |
CheeseW | 0:d5bb69f92ea3 | 14 | colorInt.red = 16; |
CheeseW | 0:d5bb69f92ea3 | 15 | colorInt.green = 16; |
CheeseW | 0:d5bb69f92ea3 | 16 | colorInt.blue = 16; |
CheeseW | 0:d5bb69f92ea3 | 17 | colorInt.clear = 16; |
CheeseW | 0:d5bb69f92ea3 | 18 | |
CheeseW | 0:d5bb69f92ea3 | 19 | colorOffset.red = readRegister(OFFSET_RED); |
CheeseW | 0:d5bb69f92ea3 | 20 | colorOffset.green = readRegister(OFFSET_GREEN); |
CheeseW | 0:d5bb69f92ea3 | 21 | colorOffset.blue = readRegister(OFFSET_BLUE); |
CheeseW | 0:d5bb69f92ea3 | 22 | colorOffset.clear = readRegister(OFFSET_CLEAR); |
CheeseW | 0:d5bb69f92ea3 | 23 | |
CheeseW | 0:d5bb69f92ea3 | 24 | // write number of capacitors to registers |
CheeseW | 0:d5bb69f92ea3 | 25 | writeRegister(colorCap.red & 0xF, CAP_RED); |
CheeseW | 0:d5bb69f92ea3 | 26 | writeRegister(colorCap.green & 0xF, CAP_GREEN); |
CheeseW | 0:d5bb69f92ea3 | 27 | writeRegister(colorCap.blue & 0xF, CAP_BLUE); |
CheeseW | 0:d5bb69f92ea3 | 28 | writeRegister(colorCap.clear & 0xF, CAP_CLEAR); |
CheeseW | 0:d5bb69f92ea3 | 29 | |
CheeseW | 0:d5bb69f92ea3 | 30 | // write number of integration time slot to registers |
CheeseW | 0:d5bb69f92ea3 | 31 | writeInt(colorInt.red & 0xFFF, INT_RED_LO); |
CheeseW | 0:d5bb69f92ea3 | 32 | writeInt(colorInt.green & 0xFFF, INT_GREEN_LO); |
CheeseW | 0:d5bb69f92ea3 | 33 | writeInt(colorInt.blue & 0xFFF, INT_BLUE_LO); |
CheeseW | 0:d5bb69f92ea3 | 34 | writeInt(colorInt.clear & 0xFFF, INT_CLEAR_LO); |
CheeseW | 0:d5bb69f92ea3 | 35 | } |
CheeseW | 0:d5bb69f92ea3 | 36 | |
CheeseW | 0:d5bb69f92ea3 | 37 | // Read data regeisters and return a RGBC var |
CheeseW | 0:d5bb69f92ea3 | 38 | RGBC ADJDs311::read(){ |
CheeseW | 0:d5bb69f92ea3 | 39 | RGBC color = RGBC(); |
CheeseW | 0:d5bb69f92ea3 | 40 | |
CheeseW | 0:d5bb69f92ea3 | 41 | performMeasurement(); |
CheeseW | 0:d5bb69f92ea3 | 42 | |
CheeseW | 0:d5bb69f92ea3 | 43 | color.red = readInt(DATA_RED_LO); |
CheeseW | 0:d5bb69f92ea3 | 44 | color.green = readInt(DATA_GREEN_LO); |
CheeseW | 0:d5bb69f92ea3 | 45 | color.blue = readInt(DATA_BLUE_LO); |
CheeseW | 0:d5bb69f92ea3 | 46 | color.clear = readInt(DATA_CLEAR_LO); |
CheeseW | 0:d5bb69f92ea3 | 47 | |
CheeseW | 0:d5bb69f92ea3 | 48 | return color; |
CheeseW | 0:d5bb69f92ea3 | 49 | } |
CheeseW | 0:d5bb69f92ea3 | 50 | |
CheeseW | 0:d5bb69f92ea3 | 51 | // get number of capacitor |
CheeseW | 0:d5bb69f92ea3 | 52 | RGBC ADJDs311::getColorCap() |
CheeseW | 0:d5bb69f92ea3 | 53 | { |
CheeseW | 0:d5bb69f92ea3 | 54 | return colorCap; |
CheeseW | 0:d5bb69f92ea3 | 55 | } |
CheeseW | 0:d5bb69f92ea3 | 56 | |
CheeseW | 0:d5bb69f92ea3 | 57 | // get number of intetgration time slot |
CheeseW | 0:d5bb69f92ea3 | 58 | RGBC ADJDs311::getColorInt() |
CheeseW | 0:d5bb69f92ea3 | 59 | { |
CheeseW | 0:d5bb69f92ea3 | 60 | return colorInt; |
CheeseW | 0:d5bb69f92ea3 | 61 | } |
CheeseW | 0:d5bb69f92ea3 | 62 | |
CheeseW | 0:d5bb69f92ea3 | 63 | // set number of capacitor |
CheeseW | 0:d5bb69f92ea3 | 64 | void ADJDs311::setColorCap(int red, int green, int blue, int clear) { |
CheeseW | 0:d5bb69f92ea3 | 65 | colorCap.red = red; |
CheeseW | 0:d5bb69f92ea3 | 66 | colorCap.green = green; |
CheeseW | 0:d5bb69f92ea3 | 67 | colorCap.blue = blue; |
CheeseW | 0:d5bb69f92ea3 | 68 | colorCap.clear = clear; |
CheeseW | 0:d5bb69f92ea3 | 69 | |
CheeseW | 0:d5bb69f92ea3 | 70 | // write number of capacitors to registers |
CheeseW | 0:d5bb69f92ea3 | 71 | writeRegister(colorCap.red & 0xF, CAP_RED); |
CheeseW | 0:d5bb69f92ea3 | 72 | writeRegister(colorCap.green & 0xF, CAP_GREEN); |
CheeseW | 0:d5bb69f92ea3 | 73 | writeRegister(colorCap.blue & 0xF, CAP_BLUE); |
CheeseW | 0:d5bb69f92ea3 | 74 | writeRegister(colorCap.clear & 0xF, CAP_CLEAR); |
CheeseW | 0:d5bb69f92ea3 | 75 | } |
CheeseW | 0:d5bb69f92ea3 | 76 | |
CheeseW | 0:d5bb69f92ea3 | 77 | // set number of integration time slot |
CheeseW | 0:d5bb69f92ea3 | 78 | void ADJDs311::setColorInt(int red, int green, int blue, int clear) { |
CheeseW | 0:d5bb69f92ea3 | 79 | colorInt.red = red; |
CheeseW | 0:d5bb69f92ea3 | 80 | colorInt.green = green; |
CheeseW | 0:d5bb69f92ea3 | 81 | colorInt.blue = blue; |
CheeseW | 0:d5bb69f92ea3 | 82 | colorInt.clear = clear; |
CheeseW | 0:d5bb69f92ea3 | 83 | |
CheeseW | 0:d5bb69f92ea3 | 84 | // write number of integration time slot to registers |
CheeseW | 0:d5bb69f92ea3 | 85 | writeInt(colorInt.red & 0xFFF, INT_RED_LO); |
CheeseW | 0:d5bb69f92ea3 | 86 | writeInt(colorInt.green & 0xFFF, INT_GREEN_LO); |
CheeseW | 0:d5bb69f92ea3 | 87 | writeInt(colorInt.blue & 0xFFF, INT_BLUE_LO); |
CheeseW | 0:d5bb69f92ea3 | 88 | writeInt(colorInt.clear & 0xFFF, INT_CLEAR_LO); |
CheeseW | 0:d5bb69f92ea3 | 89 | } |
CheeseW | 0:d5bb69f92ea3 | 90 | |
CheeseW | 0:d5bb69f92ea3 | 91 | // Perform measurement and save the result to registers |
CheeseW | 0:d5bb69f92ea3 | 92 | void ADJDs311::performMeasurement(){ |
CheeseW | 0:d5bb69f92ea3 | 93 | writeRegister(0x01, 0x00); // start sensing |
CheeseW | 0:d5bb69f92ea3 | 94 | while(readRegister(0x00) != 0) |
CheeseW | 0:d5bb69f92ea3 | 95 | ; // waiting for a result |
CheeseW | 0:d5bb69f92ea3 | 96 | } |
CheeseW | 0:d5bb69f92ea3 | 97 | |
CheeseW | 0:d5bb69f92ea3 | 98 | // Write a byte of data to a specific ADJD-S311 address |
CheeseW | 0:d5bb69f92ea3 | 99 | void ADJDs311::writeRegister(char data, char regAddr){ |
CheeseW | 0:d5bb69f92ea3 | 100 | char temp[2]; |
CheeseW | 0:d5bb69f92ea3 | 101 | temp[0] = regAddr; // register addresss |
CheeseW | 0:d5bb69f92ea3 | 102 | temp[1] = data; |
CheeseW | 0:d5bb69f92ea3 | 103 | |
CheeseW | 0:d5bb69f92ea3 | 104 | _i2c.write(WRITE_ADDRESS, temp, 2, false); |
CheeseW | 0:d5bb69f92ea3 | 105 | } |
CheeseW | 0:d5bb69f92ea3 | 106 | |
CheeseW | 0:d5bb69f92ea3 | 107 | // Read a byte of data from ADJD-S311 address |
CheeseW | 0:d5bb69f92ea3 | 108 | char ADJDs311::readRegister(char regAddr){ |
CheeseW | 0:d5bb69f92ea3 | 109 | char data; |
CheeseW | 0:d5bb69f92ea3 | 110 | |
CheeseW | 0:d5bb69f92ea3 | 111 | _i2c.write(WRITE_ADDRESS, ®Addr, 1, true); |
CheeseW | 0:d5bb69f92ea3 | 112 | _i2c.read(READ_ADDRESS, &data, 1, false); |
CheeseW | 0:d5bb69f92ea3 | 113 | return data; |
CheeseW | 0:d5bb69f92ea3 | 114 | } |
CheeseW | 0:d5bb69f92ea3 | 115 | |
CheeseW | 0:d5bb69f92ea3 | 116 | // Read two bytes of data from ADJD-S311 address and addres+1 |
CheeseW | 0:d5bb69f92ea3 | 117 | int ADJDs311::readInt(char loRegAddr) |
CheeseW | 0:d5bb69f92ea3 | 118 | { |
CheeseW | 0:d5bb69f92ea3 | 119 | return (unsigned char)readRegister(loRegAddr) + (((unsigned char)readRegister(loRegAddr+1))<<8); |
CheeseW | 0:d5bb69f92ea3 | 120 | } |
CheeseW | 0:d5bb69f92ea3 | 121 | |
CheeseW | 0:d5bb69f92ea3 | 122 | // Write two bytes of data to ADJD-S311 address and addres+1 |
CheeseW | 0:d5bb69f92ea3 | 123 | void ADJDs311::writeInt(int data, char loRegAddr) |
CheeseW | 0:d5bb69f92ea3 | 124 | { |
CheeseW | 0:d5bb69f92ea3 | 125 | char lobyte = data; |
CheeseW | 0:d5bb69f92ea3 | 126 | char hibyte = data >> 8; |
CheeseW | 0:d5bb69f92ea3 | 127 | |
CheeseW | 0:d5bb69f92ea3 | 128 | writeRegister(lobyte, loRegAddr); |
CheeseW | 0:d5bb69f92ea3 | 129 | writeRegister(hibyte, loRegAddr+1); |
CheeseW | 0:d5bb69f92ea3 | 130 | } |
CheeseW | 0:d5bb69f92ea3 | 131 | |
CheeseW | 0:d5bb69f92ea3 | 132 | /* calibrateClear() - This function calibrates the clear integration registers |
CheeseW | 0:d5bb69f92ea3 | 133 | of the ADJD-S311. |
CheeseW | 0:d5bb69f92ea3 | 134 | */ |
CheeseW | 0:d5bb69f92ea3 | 135 | void ADJDs311::calibrateClearInt(){ |
CheeseW | 0:d5bb69f92ea3 | 136 | bool gainFound = false; |
CheeseW | 0:d5bb69f92ea3 | 137 | int upperBox=4096; |
CheeseW | 0:d5bb69f92ea3 | 138 | int lowerBox = 0; |
CheeseW | 0:d5bb69f92ea3 | 139 | int half; |
CheeseW | 0:d5bb69f92ea3 | 140 | |
CheeseW | 0:d5bb69f92ea3 | 141 | while (!gainFound){ |
CheeseW | 0:d5bb69f92ea3 | 142 | half = ((upperBox-lowerBox)/2)+lowerBox; |
CheeseW | 0:d5bb69f92ea3 | 143 | //no further halfing possbile |
CheeseW | 0:d5bb69f92ea3 | 144 | |
CheeseW | 0:d5bb69f92ea3 | 145 | if (half==lowerBox){ |
CheeseW | 0:d5bb69f92ea3 | 146 | gainFound=true; |
CheeseW | 0:d5bb69f92ea3 | 147 | }else{ |
CheeseW | 0:d5bb69f92ea3 | 148 | colorInt.clear = half; |
CheeseW | 0:d5bb69f92ea3 | 149 | writeInt(colorInt.clear & 0xFFF, INT_CLEAR_LO); |
CheeseW | 0:d5bb69f92ea3 | 150 | performMeasurement(); |
CheeseW | 0:d5bb69f92ea3 | 151 | int halfValue = readInt(DATA_CLEAR_LO); |
CheeseW | 0:d5bb69f92ea3 | 152 | |
CheeseW | 0:d5bb69f92ea3 | 153 | if (halfValue>800){ |
CheeseW | 0:d5bb69f92ea3 | 154 | upperBox=half; |
CheeseW | 0:d5bb69f92ea3 | 155 | }else if (halfValue<800){ |
CheeseW | 0:d5bb69f92ea3 | 156 | lowerBox=half; |
CheeseW | 0:d5bb69f92ea3 | 157 | }else{ |
CheeseW | 0:d5bb69f92ea3 | 158 | gainFound=true; |
CheeseW | 0:d5bb69f92ea3 | 159 | } |
CheeseW | 0:d5bb69f92ea3 | 160 | } |
CheeseW | 0:d5bb69f92ea3 | 161 | } |
CheeseW | 0:d5bb69f92ea3 | 162 | } |
CheeseW | 0:d5bb69f92ea3 | 163 | |
CheeseW | 0:d5bb69f92ea3 | 164 | /* calibrateColor() - This function clalibrates the RG and B |
CheeseW | 0:d5bb69f92ea3 | 165 | integration registers. |
CheeseW | 0:d5bb69f92ea3 | 166 | */ |
CheeseW | 0:d5bb69f92ea3 | 167 | void ADJDs311::calibrateColorInt(){ |
CheeseW | 0:d5bb69f92ea3 | 168 | bool gainFound = false; |
CheeseW | 0:d5bb69f92ea3 | 169 | int upperBox=4096; |
CheeseW | 0:d5bb69f92ea3 | 170 | int lowerBox = 0; |
CheeseW | 0:d5bb69f92ea3 | 171 | int half; |
CheeseW | 0:d5bb69f92ea3 | 172 | int halfValue; |
CheeseW | 0:d5bb69f92ea3 | 173 | |
CheeseW | 0:d5bb69f92ea3 | 174 | while (!gainFound) |
CheeseW | 0:d5bb69f92ea3 | 175 | { |
CheeseW | 0:d5bb69f92ea3 | 176 | half = ((upperBox-lowerBox)/2)+lowerBox; |
CheeseW | 0:d5bb69f92ea3 | 177 | //no further halfing possbile |
CheeseW | 0:d5bb69f92ea3 | 178 | if (half==lowerBox) |
CheeseW | 0:d5bb69f92ea3 | 179 | { |
CheeseW | 0:d5bb69f92ea3 | 180 | gainFound=true; |
CheeseW | 0:d5bb69f92ea3 | 181 | } |
CheeseW | 0:d5bb69f92ea3 | 182 | else { |
CheeseW | 0:d5bb69f92ea3 | 183 | colorInt.red = half; |
CheeseW | 0:d5bb69f92ea3 | 184 | colorInt.green = half; |
CheeseW | 0:d5bb69f92ea3 | 185 | colorInt.blue = half; |
CheeseW | 0:d5bb69f92ea3 | 186 | |
CheeseW | 0:d5bb69f92ea3 | 187 | // write number of integration time slot to registers |
CheeseW | 0:d5bb69f92ea3 | 188 | writeInt(colorInt.red & 0xFFF, INT_RED_LO); |
CheeseW | 0:d5bb69f92ea3 | 189 | writeInt(colorInt.green & 0xFFF, INT_GREEN_LO); |
CheeseW | 0:d5bb69f92ea3 | 190 | writeInt(colorInt.blue & 0xFFF, INT_BLUE_LO); |
CheeseW | 0:d5bb69f92ea3 | 191 | |
CheeseW | 0:d5bb69f92ea3 | 192 | performMeasurement(); |
CheeseW | 0:d5bb69f92ea3 | 193 | halfValue = 0; |
CheeseW | 0:d5bb69f92ea3 | 194 | |
CheeseW | 0:d5bb69f92ea3 | 195 | halfValue=std::max(halfValue, readInt(DATA_RED_LO)); |
CheeseW | 0:d5bb69f92ea3 | 196 | halfValue=std::max(halfValue, readInt(DATA_GREEN_LO)); |
CheeseW | 0:d5bb69f92ea3 | 197 | halfValue=std::max(halfValue, readInt(DATA_BLUE_LO)); |
CheeseW | 0:d5bb69f92ea3 | 198 | |
CheeseW | 0:d5bb69f92ea3 | 199 | if (halfValue>800) { |
CheeseW | 0:d5bb69f92ea3 | 200 | upperBox=half; |
CheeseW | 0:d5bb69f92ea3 | 201 | } |
CheeseW | 0:d5bb69f92ea3 | 202 | else if (halfValue<800) { |
CheeseW | 0:d5bb69f92ea3 | 203 | lowerBox=half; |
CheeseW | 0:d5bb69f92ea3 | 204 | } |
CheeseW | 0:d5bb69f92ea3 | 205 | else { |
CheeseW | 0:d5bb69f92ea3 | 206 | gainFound=true; |
CheeseW | 0:d5bb69f92ea3 | 207 | } |
CheeseW | 0:d5bb69f92ea3 | 208 | } |
CheeseW | 0:d5bb69f92ea3 | 209 | } |
CheeseW | 0:d5bb69f92ea3 | 210 | } |
CheeseW | 0:d5bb69f92ea3 | 211 | |
CheeseW | 0:d5bb69f92ea3 | 212 | |
CheeseW | 0:d5bb69f92ea3 | 213 | /* calibrateCapacitors() - This function calibrates each of the RGB and C |
CheeseW | 0:d5bb69f92ea3 | 214 | capacitor registers. |
CheeseW | 0:d5bb69f92ea3 | 215 | */ |
CheeseW | 0:d5bb69f92ea3 | 216 | void ADJDs311::calibrateCapacitors(){ |
CheeseW | 0:d5bb69f92ea3 | 217 | |
CheeseW | 0:d5bb69f92ea3 | 218 | bool calibrated = false; |
CheeseW | 0:d5bb69f92ea3 | 219 | |
CheeseW | 0:d5bb69f92ea3 | 220 | //need to store detect better calibration |
CheeseW | 0:d5bb69f92ea3 | 221 | int diff; |
CheeseW | 0:d5bb69f92ea3 | 222 | int oldDiff = 1024; |
CheeseW | 0:d5bb69f92ea3 | 223 | |
CheeseW | 0:d5bb69f92ea3 | 224 | while (!calibrated){ |
CheeseW | 0:d5bb69f92ea3 | 225 | // sensor gain setting (Avago app note 5330) |
CheeseW | 0:d5bb69f92ea3 | 226 | // CAPs are 4bit (higher value will result in lower output) |
CheeseW | 0:d5bb69f92ea3 | 227 | writeRegister(colorCap.red & 0xF, CAP_RED); |
CheeseW | 0:d5bb69f92ea3 | 228 | writeRegister(colorCap.green & 0xF, CAP_GREEN); |
CheeseW | 0:d5bb69f92ea3 | 229 | writeRegister(colorCap.blue & 0xF, CAP_BLUE); |
CheeseW | 0:d5bb69f92ea3 | 230 | |
CheeseW | 0:d5bb69f92ea3 | 231 | int maxRead = 0; |
CheeseW | 0:d5bb69f92ea3 | 232 | int minRead = 1024; |
CheeseW | 0:d5bb69f92ea3 | 233 | int red = 0; |
CheeseW | 0:d5bb69f92ea3 | 234 | int green = 0; |
CheeseW | 0:d5bb69f92ea3 | 235 | int blue = 0; |
CheeseW | 0:d5bb69f92ea3 | 236 | |
CheeseW | 0:d5bb69f92ea3 | 237 | for (int i=0; i<4 ;i ++) |
CheeseW | 0:d5bb69f92ea3 | 238 | { |
CheeseW | 0:d5bb69f92ea3 | 239 | performMeasurement(); |
CheeseW | 0:d5bb69f92ea3 | 240 | red += readInt(DATA_RED_LO); |
CheeseW | 0:d5bb69f92ea3 | 241 | green += readInt(DATA_GREEN_LO); |
CheeseW | 0:d5bb69f92ea3 | 242 | blue += readInt(DATA_BLUE_LO); |
CheeseW | 0:d5bb69f92ea3 | 243 | } |
CheeseW | 0:d5bb69f92ea3 | 244 | red /= 4; |
CheeseW | 0:d5bb69f92ea3 | 245 | green /= 4; |
CheeseW | 0:d5bb69f92ea3 | 246 | blue /= 4; |
CheeseW | 0:d5bb69f92ea3 | 247 | |
CheeseW | 0:d5bb69f92ea3 | 248 | maxRead = std::max(maxRead, red); |
CheeseW | 0:d5bb69f92ea3 | 249 | maxRead = std::max(maxRead, green); |
CheeseW | 0:d5bb69f92ea3 | 250 | maxRead = std::max(maxRead, blue); |
CheeseW | 0:d5bb69f92ea3 | 251 | |
CheeseW | 0:d5bb69f92ea3 | 252 | minRead = std::min(minRead, red); |
CheeseW | 0:d5bb69f92ea3 | 253 | minRead = std::min(minRead, green); |
CheeseW | 0:d5bb69f92ea3 | 254 | minRead = std::min(minRead, blue); |
CheeseW | 0:d5bb69f92ea3 | 255 | |
CheeseW | 0:d5bb69f92ea3 | 256 | diff = maxRead - minRead; |
CheeseW | 0:d5bb69f92ea3 | 257 | |
CheeseW | 0:d5bb69f92ea3 | 258 | if (oldDiff != diff) |
CheeseW | 0:d5bb69f92ea3 | 259 | { |
CheeseW | 0:d5bb69f92ea3 | 260 | if ((maxRead==red) && (colorCap.red<15)) |
CheeseW | 0:d5bb69f92ea3 | 261 | colorCap.red++; |
CheeseW | 0:d5bb69f92ea3 | 262 | else if ((maxRead == green) && (colorCap.green<15)) |
CheeseW | 0:d5bb69f92ea3 | 263 | colorCap.green++; |
CheeseW | 0:d5bb69f92ea3 | 264 | else if ((maxRead == blue) && (colorCap.blue<15)) |
CheeseW | 0:d5bb69f92ea3 | 265 | colorCap.blue++; |
CheeseW | 0:d5bb69f92ea3 | 266 | } |
CheeseW | 0:d5bb69f92ea3 | 267 | else |
CheeseW | 0:d5bb69f92ea3 | 268 | calibrated = true; |
CheeseW | 0:d5bb69f92ea3 | 269 | |
CheeseW | 0:d5bb69f92ea3 | 270 | oldDiff=diff; |
CheeseW | 0:d5bb69f92ea3 | 271 | |
CheeseW | 0:d5bb69f92ea3 | 272 | } |
CheeseW | 0:d5bb69f92ea3 | 273 | |
CheeseW | 0:d5bb69f92ea3 | 274 | } |
CheeseW | 0:d5bb69f92ea3 | 275 | |
CheeseW | 0:d5bb69f92ea3 | 276 | void ADJDs311::calibrate(){ |
CheeseW | 0:d5bb69f92ea3 | 277 | setColorCap(0, 0, 0, 8); |
CheeseW | 0:d5bb69f92ea3 | 278 | calibrateColorInt(); // This calibrates R, G, and B int registers |
CheeseW | 0:d5bb69f92ea3 | 279 | calibrateClearInt(); // This calibrates the C int registers |
CheeseW | 0:d5bb69f92ea3 | 280 | calibrateCapacitors(); // This calibrates the RGB, and C cap registers |
CheeseW | 0:d5bb69f92ea3 | 281 | calibrateColorInt(); |
CheeseW | 0:d5bb69f92ea3 | 282 | } |
CheeseW | 0:d5bb69f92ea3 | 283 | |
CheeseW | 0:d5bb69f92ea3 | 284 | |
CheeseW | 0:d5bb69f92ea3 | 285 | void ADJDs311::ledMode(bool ledOn) |
CheeseW | 0:d5bb69f92ea3 | 286 | { |
CheeseW | 0:d5bb69f92ea3 | 287 | _led = ledOn; |
CheeseW | 0:d5bb69f92ea3 | 288 | } |
CheeseW | 0:d5bb69f92ea3 | 289 | |
CheeseW | 0:d5bb69f92ea3 | 290 | void ADJDs311::offsetMode(bool useOffset) |
CheeseW | 0:d5bb69f92ea3 | 291 | { |
CheeseW | 0:d5bb69f92ea3 | 292 | if (useOffset) |
CheeseW | 0:d5bb69f92ea3 | 293 | { |
CheeseW | 0:d5bb69f92ea3 | 294 | writeRegister(0x01, CONFIG); |
CheeseW | 0:d5bb69f92ea3 | 295 | } else |
CheeseW | 0:d5bb69f92ea3 | 296 | { |
CheeseW | 0:d5bb69f92ea3 | 297 | writeRegister(0x00, CONFIG); |
CheeseW | 0:d5bb69f92ea3 | 298 | } |
CheeseW | 0:d5bb69f92ea3 | 299 | } |
CheeseW | 0:d5bb69f92ea3 | 300 | |
CheeseW | 0:d5bb69f92ea3 | 301 | RGBC ADJDs311::getOffset() |
CheeseW | 0:d5bb69f92ea3 | 302 | { |
CheeseW | 0:d5bb69f92ea3 | 303 | return colorOffset; |
CheeseW | 0:d5bb69f92ea3 | 304 | } |
CheeseW | 0:d5bb69f92ea3 | 305 | |
CheeseW | 0:d5bb69f92ea3 | 306 | RGBC ADJDs311::setOffset(bool useOffset) |
CheeseW | 0:d5bb69f92ea3 | 307 | { |
CheeseW | 0:d5bb69f92ea3 | 308 | _led = 0; |
CheeseW | 0:d5bb69f92ea3 | 309 | |
CheeseW | 0:d5bb69f92ea3 | 310 | writeRegister(0x02, CTRL); |
CheeseW | 0:d5bb69f92ea3 | 311 | while(readRegister(CTRL)); |
CheeseW | 0:d5bb69f92ea3 | 312 | colorOffset.red = readRegister(OFFSET_RED); |
CheeseW | 0:d5bb69f92ea3 | 313 | colorOffset.green = readRegister(OFFSET_GREEN); |
CheeseW | 0:d5bb69f92ea3 | 314 | colorOffset.blue = readRegister(OFFSET_BLUE); |
CheeseW | 0:d5bb69f92ea3 | 315 | colorOffset.clear = readRegister(OFFSET_CLEAR); |
CheeseW | 0:d5bb69f92ea3 | 316 | |
CheeseW | 0:d5bb69f92ea3 | 317 | offsetMode(useOffset); |
CheeseW | 0:d5bb69f92ea3 | 318 | |
CheeseW | 0:d5bb69f92ea3 | 319 | return colorOffset; |
CheeseW | 0:d5bb69f92ea3 | 320 | } |