DS2450_APDS9960/DS2450_APDS9960.c

   1 \r
   2 // Copyright (c) 2017, Tobias Mueller tm(at)tm3d.de\r
   3 // All rights reserved.\r
   4 //\r
   5 // Redistribution and use in source and binary forms, with or without\r
   6 // modification, are permitted provided that the following conditions are\r
   7 // met:\r
   8 //\r
   9 //  * Redistributions of source code must retain the above copyright\r
  10 //    notice, this list of conditions and the following disclaimer.\r
  11 //  * Redistributions in binary form must reproduce the above copyright\r
  12 //    notice, this list of conditions and the following disclaimer in the\r
  13 //    documentation and/or other materials provided with the\r
  14 //    distribution.\r
  15 //  * All advertising materials mentioning features or use of this\r
  16 //    software must display the following acknowledgement: This product\r
  17 //    includes software developed by tm3d.de and its contributors.\r
  18 //  * Neither the name of tm3d.de nor the names of its contributors may\r
  19 //    be used to endorse or promote products derived from this software\r
  20 //    without specific prior written permission.\r
  21 //\r
  22 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS\r
  23 // "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT\r
  24 // LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR\r
  25 // A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT\r
  26 // OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,\r
  27 // SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT\r
  28 // LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,\r
  29 // DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY\r
  30 // THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT\r
  31 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE\r
  32 // OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.\r
  33 \r
  34 #define F_CPU 8000000UL\r
  35 #include <avr/io.h>\r
  36 #include <avr/interrupt.h>\r
  37 #include <util/delay.h>\r
  38 #include <avr/wdt.h>\r
  39 #include <avr/sleep.h>\r
  40 #include <avr/pgmspace.h>\r
  41 #include "../common/I2C/USI_TWI_Master.h"\r
  42 #include "../common/I2C/APDS9960.h"\r
  43 \r
  44 extern void OWINIT();\r
  45 extern void EXTERN_SLEEP();\r
  46 \r
  47 uint8_t owid[8]={0x20, 0xA2, 0xD9, 0x84, 0x00, 0x16, 0x23, 0x20};/**/\r
  48 //uint8_t config_info[26]={0x03,13,0x03,13,0x03,13,0x3,15,0x02,20,20,20,20,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};\r
  49 uint8_t config_info[26]={16,15,17,15,18,15,3,15,0x02,23,23,23,23,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};\r
  50 \r
  51 #if (owid>128) \r
  52 #error "Variable not correct"\r
  53 #endif\r
  54 \r
  55 extern uint8_t mode;\r
  56 extern uint8_t gcontrol;\r
  57 extern uint8_t reset_indicator;\r
  58 extern uint8_t alarmflag;\r
  59 \r
  60 \r
  61 typedef union {\r
  62         volatile uint8_t bytes[0x20];\r
  63         struct {\r
  64                 //Page0\r
  65                 uint16_t A;  //0\r
  66                 uint16_t B;  //2\r
  67                 uint16_t C;  //4\r
  68                 uint16_t D;  //6\r
  69                 //Page1\r
  70                 uint8_t CSA1;\r
  71                 uint8_t CSA2;\r
  72                 uint8_t CSB1;\r
  73                 uint8_t CSB2;\r
  74                 uint8_t CSC1;\r
  75                 uint8_t CSC2;\r
  76                 uint8_t CSD1;\r
  77                 uint8_t CSD2;\r
  78                 //Page2\r
  79                 uint8_t LA;\r
  80                 uint8_t HA;\r
  81                 uint8_t LB;\r
  82                 uint8_t HB;\r
  83                 uint8_t LC;\r
  84                 uint8_t HC;\r
  85                 uint8_t LD;\r
  86                 uint8_t HD;\r
  87                 //Page3\r
  88                 uint8_t FC1;\r
  89                 uint8_t FC2;\r
  90                 uint8_t FC3;\r
  91                 uint8_t FC4;\r
  92                 uint8_t VCCP;\r
  93                 uint8_t FC5;\r
  94                 uint8_t FC6;\r
  95                 uint8_t FC7;\r
  96                 uint8_t convc1;\r
  97                 uint8_t convc2;\r
  98                 \r
  99                 \r
 100         };\r
 101 } pack_t;\r
 102 volatile pack_t pack;\r
 103 \r
 104 \r
 105 uint16_t light[4];\r
 106 double rlight[4];\r
 107 uint8_t gain=2;\r
 108 uint8_t atime=192;\r
 109 //uint8_t atime=255;\r
 110 double r_gain;\r
 111 double r_atime;\r
 112 \r
 113 void getLight(uint8_t setparameterr) {\r
 114         if (setparameterr) {\r
 115                 r_gain=(1<<(2*gain));\r
 116                 r_atime=(256.0-atime)*2.78;\r
 117                 APDS9960setGain(gain);\r
 118                 APDS9960setATime(atime);\r
 119                 _delay_ms(700);\r
 120         }\r
 121         APDS9960getRGBC(&light[0],&light[1],&light[2],&light[3]);\r
 122 }\r
 123 \r
 124 \r
 125 \r
 126 \r
 127 int main(void){\r
 128         pack.A=0;\r
 129         pack.B=0;\r
 130         pack.C=0;\r
 131         pack.D=0;\r
 132         pack.CSA1=0x08;\r
 133         pack.CSA2=0x8C;\r
 134         pack.CSB1=0x08;\r
 135         pack.CSB2=0x8C;\r
 136         pack.CSC1=0x08;\r
 137         pack.CSC2=0x8C;\r
 138         pack.CSD1=0x08;\r
 139         pack.CSD2=0x8C;\r
 140         pack.HA=0xFF;\r
 141         pack.LA=0x00;\r
 142         pack.HB=0xFF;\r
 143         pack.LB=0x00;\r
 144         pack.HC=0xFF;\r
 145         pack.LC=0x00;\r
 146         pack.HD=0xFF;\r
 147         pack.LD=0x00;\r
 148         pack.VCCP=0;\r
 149 \r
 150         PORTA=0xFF;\r
 151         PORTB=0xFF;\r
 152 \r
 153         OWINIT();\r
 154 \r
 155         MCUCR &=~(1<<PUD); //All Pins Pullup...\r
 156         MCUCR |=(1<<BODS);\r
 157         //PORTA&=~((1<<PINA0)|(1<<PINA1)|(1<<PINA2)|(1<<PINA3));\r
 158 \r
 159         ADCSRA=(1<<ADEN)|(1<ADPS0)|(1<<ADPS2);\r
 160 \r
 161         \r
 162         \r
 163         gcontrol=1;\r
 164         ADCSRB|=(1<<ADLAR); \r
 165         USI_TWI_Master_Initialise();\r
 166         \r
 167         initAPDS9960();\r
 168         //gain=2;\r
 169         //atime=253;\r
 170         getLight(1);\r
 171         sei();\r
 172         \r
 173         //DDRB|=(1<<PINB1);\r
 174 \r
 175     while(1)   {\r
 176 \r
 177 \r
 178                 if (gcontrol) {\r
 179                         //PORTB|=(1<<PINB1);\r
 180                         uint8_t bb=1;\r
 181                         uint8_t bb1=1;\r
 182                         for(uint8_t i=0;i<4;i++){\r
 183                                 if (pack.convc1&bb1) {\r
 184                                         if (pack.convc2&(bb)) {pack.bytes[i*2]=0;pack.bytes[i*2+1]=0;}\r
 185                                         bb=bb<<1;\r
 186                                         if (pack.convc2&(bb)) {pack.bytes[i*2]=0xFF;pack.bytes[i*2+1]=0xFF;}\r
 187                                         bb=bb<<1;\r
 188                                 } else bb=bb<<2;\r
 189                                 bb1=bb1<<1;                             \r
 190                         }\r
 191                         //CHanel A\r
 192                         if (pack.convc1&1) {\r
 193                                 getLight(0);\r
 194                                 while (light[3]>0xF000) {\r
 195                                 //while (light[3]>900) {\r
 196                                         if (gain!=0) {\r
 197                                                 gain--;\r
 198                                                 getLight(1);\r
 199                                         }  else break;\r
 200                                 } \r
 201                                 if (light[3]<0x2222) {\r
 202                                 //if (light[3]<0x22) {\r
 203                                         if (gain<3) {\r
 204                                                 gain++;\r
 205                                                 getLight(1);\r
 206                                         }\r
 207 \r
 208                                 }\r
 209                                 for(uint8_t i=0;i<4;i++) {\r
 210                                         rlight[i]=(double)light[i]/r_atime/r_gain*70.0;\r
 211                                         rlight[i]=(log(rlight[i])*1000)+32767.0;\r
 212                                 }\r
 213                                 cli();pack.A=rlight[0];sei();\r
 214                                 //cli();pack.A=r_gain;sei();\r
 215                                 alarmflag=0;\r
 216                                 if (pack.CSA2&0x08)  //AEH\r
 217                                         if (pack.bytes[1]>pack.HA) {alarmflag=1;pack.CSA2|=0x20;}\r
 218                                 if (pack.CSA2&0x04)  //AEL\r
 219                                         if (pack.bytes[1]<pack.LA) {alarmflag=1;pack.CSA2|=0x10;}\r
 220                         }\r
 221 \r
 222                         if (pack.convc1&2) {\r
 223                                 cli();pack.B=rlight[1];sei();\r
 224                                 //cli();pack.B=atime;sei();\r
 225                                 if (pack.CSB2&0x08)  //AEH\r
 226                                         if (pack.bytes[1]>pack.HB) {alarmflag=1;pack.CSB2|=0x20;}\r
 227                                 if (pack.CSB2&0x04)  //AEL\r
 228                                         if (pack.bytes[1]<pack.LB) {alarmflag=1;pack.CSB2|=0x10;}\r
 229                         }\r
 230 \r
 231                         if (pack.convc1&4) {\r
 232                                 cli();pack.C=rlight[2];sei();\r
 233                                 //cli();pack.C=light[3];sei();\r
 234                                 if (pack.CSC2&0x08)  //AEH\r
 235                                         if (pack.bytes[1]>pack.HC) {alarmflag=1;pack.CSC2|=0x20;}\r
 236                                 if (pack.CSC2&0x04)  //AEL\r
 237                                         if (pack.bytes[1]<pack.LC) {alarmflag=1;pack.CSC2|=0x10;}\r
 238                         } \r
 239                         if (pack.convc1&8) {\r
 240                                 cli();pack.D=rlight[3];sei();\r
 241                                 if (pack.CSD2&0x08)  //AEH\r
 242                                         if (pack.bytes[1]>pack.HD) {alarmflag=1;pack.CSD2|=0x20;}\r
 243                                 if (pack.CSD2&0x04)  //AEL\r
 244                                         if (pack.bytes[1]<pack.LD) {alarmflag=1;pack.CSD2|=0x10;}\r
 245                         }\r
 246                         \r
 247                         EXTERN_SLEEP();\r
 248                         //PORTB&=~(1<<PINB1);\r
 249                 }\r
 250 \r
 251                 uint8_t bb=1;\r
 252                 for(uint8_t i=0;i<4;i++) {\r
 253                         if (pack.bytes[8+i*2]&0x80) {  //Chanel as output\r
 254                                 if (pack.bytes[8+i*2]&0x40) {\r
 255                                         DDRA|=bb;\r
 256                                 } else {\r
 257                                         DDRA&=~bb;\r
 258                                 }\r
 259                         } else {\r
 260                                 DDRA&=~bb;\r
 261                         }\r
 262                         bb=bb*2;\r
 263                 }\r
 264                 \r
 265 #if  defined(__AVR_ATtiny25__)||defined(__AVR_ATtiny45__)  || defined(__AVR_ATtiny85__)\r
 266                         if (((TIMSK & (1<<TOIE0))==0)&& (mode==0))\r
 267 #endif                  \r
 268 #if  defined(__AVR_ATtiny24__)||defined(__AVR_ATtiny44__)  || defined(__AVR_ATtiny84__) ||defined(__AVR_ATtiny24A__)||defined(__AVR_ATtiny44A__)  || defined(__AVR_ATtiny84A__)\r
 269                         if (((TIMSK0 & (1<<TOIE0))==0)&& (mode==0))\r
 270 #endif\r
 271                           {\r
 272 \r
 273                         MCUCR|=(1<<SE)|(1<<SM1);\r
 274                         MCUCR&=~(1<<ISC01);\r
 275                 } else {\r
 276                         MCUCR|=(1<<SE);\r
 277                         MCUCR&=~(1<<SM1);\r
 278                 }\r
 279         //      asm("SLEEP");\r
 280    }\r
 281 \r
 282 \r
 283 }