New I2C devices
[owSlave2.git] / DS2438_VOC_DS2438_SHT_Wiregate / DS2438_DS2438.c
1 // Copyright (c) 2017, Tobias Mueller tm(at)tm3d.de\r
2 // All rights reserved.\r
3 //\r
4 // Redistribution and use in source and binary forms, with or without\r
5 // modification, are permitted provided that the following conditions are\r
6 // met:\r
7 //\r
8 //  * Redistributions of source code must retain the above copyright\r
9 //    notice, this list of conditions and the following disclaimer.\r
10 //  * Redistributions in binary form must reproduce the above copyright\r
11 //    notice, this list of conditions and the following disclaimer in the\r
12 //    documentation and/or other materials provided with the\r
13 //    distribution.\r
14 //  * All advertising materials mentioning features or use of this\r
15 //    software must display the following acknowledgement: This product\r
16 //    includes software developed by tm3d.de and its contributors.\r
17 //  * Neither the name of tm3d.de nor the names of its contributors may\r
18 //    be used to endorse or promote products derived from this software\r
19 //    without specific prior written permission.\r
20 //\r
21 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS\r
22 // "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT\r
23 // LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR\r
24 // A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT\r
25 // OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,\r
26 // SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT\r
27 // LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,\r
28 // DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY\r
29 // THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT\r
30 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE\r
31 // OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.\r
32 \r
33 //!!!!!Max Program size 7551 Byte\r
34 \r
35 #define F_CPU 8000000UL\r
36 #include <avr/io.h>\r
37 #include <avr/interrupt.h>\r
38 #include <util/delay.h>  \r
39 #include <avr/wdt.h>\r
40 #include <avr/sleep.h>\r
41 #include <avr/pgmspace.h>\r
42 #include "../common/I2C/USI_TWI_Master.h"\r
43 #include "../common/I2C/MAX1164x.h"\r
44 #include "../common/I2C/SHT2xV2.h"\r
45 #include "../common/calibr.h"\r
46 \r
47 extern void OWINIT(void);\r
48 extern void EXTERN_SLEEP(void);\r
49 \r
50 \r
51 \r
52 volatile uint8_t owid1[8]={0x26, 0x3B, 0xDA, 0x84, 0x00, 0x00, 0x03, 0xA2};/**/\r
53 volatile uint8_t owid2[8]={0x26, 0x3C, 0xDA, 0x84, 0x00, 0x00, 0x03, 0x27};/**/\r
54 volatile uint8_t config_info1[26]={0x01,0x06, 0x05,0x08, 0x8,19, 0x00,0x00, 0x02,7,0x00,17,0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};     \r
55 volatile uint8_t config_info2[26]={0x01,0x06, 0x05,0x08, 0x04,0x07, 11,0x08, 0x02,0x07,0x00,0x07,17,0x00,0x00,0x00, 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}; \r
56         \r
57 #if (owid>128) \r
58 #error "Variable not correct"\r
59 #endif\r
60 \r
61 extern uint8_t mode;\r
62 extern uint8_t gcontrol;\r
63 extern uint8_t reset_indicator;\r
64 extern uint8_t alarmflag;\r
65 volatile uint8_t wdcounter=1;\r
66 extern uint8_t cpsp2;\r
67 \r
68 \r
69 typedef union {\r
70         #if  defined(__AVR_ATtiny25__)\r
71         volatile uint8_t bytes[16];\r
72         #else\r
73         volatile uint8_t bytes[64];\r
74         #endif\r
75         struct {\r
76                 uint8_t status;  //1\r
77                 int16_t temp;  //2\r
78                 uint16_t voltage;  //4\r
79                 int16_t current;  //6\r
80                 uint8_t threshold; //8\r
81                 union {\r
82                 uint8_t page1[8]; //9\r
83                 struct {\r
84                         uint32_t etm;\r
85                         uint8_t ica;\r
86                         uint16_t offset;\r
87                         uint8_t f1;\r
88                 };\r
89                 };\r
90                 #if  defined(__AVR_ATtiny25__)\r
91                 #else\r
92                 union {\r
93                                 uint8_t page2[8]; //17\r
94                                 struct  {\r
95                                 uint32_t dis; \r
96                                 uint32_t eoc;\r
97                                 };\r
98                                 };\r
99                         \r
100                 uint8_t page3[8]; //25\r
101                 \r
102                 uint8_t page4[8];  //33\r
103                 uint8_t page5[8];  //41\r
104                 uint8_t page6[8];  //49\r
105                 uint8_t page7[8];  //57\r
106                 \r
107                 #endif\r
108         };\r
109 } pack1_t;\r
110 volatile pack1_t pack1;\r
111 \r
112 \r
113 \r
114 \r
115 typedef union {\r
116         #if  defined(__AVR_ATtiny25__)\r
117         volatile uint8_t bytes[16];\r
118         #else\r
119         volatile uint8_t bytes[64];\r
120         #endif\r
121         struct {\r
122                 uint8_t status;  //1\r
123                 int16_t temp;  //2\r
124                 uint16_t voltage;  //4\r
125                 int16_t current;  //6\r
126                 uint8_t threshold; //8\r
127                 \r
128                 uint8_t page1[8]; //9\r
129                 \r
130                 uint8_t page2[8]; //17\r
131                 uint8_t page3[8]; //25\r
132                 \r
133                 union{\r
134                         uint8_t page4[8];  //33\r
135                         struct {\r
136                                 uint16_t tol_s8;\r
137                                 uint16_t tol_d;\r
138                                 uint16_t r_day_max;\r
139                                 uint16_t r_week_max;\r
140                         };\r
141                 };\r
142                 union{\r
143                         uint8_t page5[8];  //41\r
144                         struct {\r
145                                 uint8_t codeVOC; // immer 0x37 nach Neustart\r
146                                 uint8_t days_of_r0; //Anzahl der Tage fuer die r0 ermittelt wird\r
147                                 int8_t corr_VOC_mult; //r0 corr\r
148                                 int8_t corr_VOC_div;\r
149                                 uint16_t vv3;\r
150                                 uint8_t time_corr; //Wiregate;\r
151                                 uint8_t reset_code;\r
152                         };\r
153                         uint16_t page5d[4];\r
154                 };\r
155                 union{\r
156                         uint8_t page6[8]; //25\r
157                         struct {\r
158                                 uint16_t R0;\r
159                                 uint16_t VS;\r
160                                 uint8_t cmode;\r
161                                 int16_t ip;\r
162                                 uint8_t free;\r
163                         };\r
164                 };\r
165                 uint8_t page7[8];  //57\r
166                 \r
167         };\r
168 } pack2_t;\r
169 volatile pack2_t pack2;\r
170 \r
171 //#define TIME_CORR 3\r
172 volatile int8_t time_corr_count;//=TIME_CORR;\r
173 \r
174 #if  defined(__AVR_ATtiny24__)||defined(__AVR_ATtiny44__)  || defined(__AVR_ATtiny84__) || defined(__AVR_ATtiny24A__)||defined(__AVR_ATtiny44A__)  || defined(__AVR_ATtiny84A__)\r
175 ISR(WATCHDOG_vect) {\r
176         #else\r
177         ISR(WDT_vect) {\r
178                 #endif\r
179                 pack1.etm++;\r
180                 time_corr_count--;\r
181                 if ((pack1.page1[0]&0x7)==0) {\r
182                          wdcounter++;\r
183                         } \r
184                         if (time_corr_count<=0) {\r
185                                 //wdcounter++;\r
186                                 pack1.etm+=1;\r
187                                 time_corr_count=pack2.time_corr;\r
188                         }\r
189         /*      if ((pack1.page1[0]&0x0F)==0) {\r
190                          pack1.etm+=2;\r
191 \r
192                 }*/\r
193 /*              if ((pack1.page1[0]&0x1F)==0) {\r
194                         pack1.etm--;\r
195                 }*/\r
196 \r
197                 if (reset_indicator==1) reset_indicator++;\r
198                 else if (reset_indicator==2) mode=0;\r
199 \r
200 \r
201         }\r
202 \r
203 \r
204 \r
205 \r
206 \r
207 volatile int16_t DS2438_1_TEMP;\r
208 volatile uint16_t DS2438_1_VAD;\r
209 volatile int16_t DS2438_2_TEMP;\r
210 volatile uint16_t DS2438_2_VAD;\r
211 \r
212 \r
213 uint8_t userRegister[1];\r
214 int16_t sRH,sT;\r
215 double temperatureC,humidityRH,hhum;\r
216 double l;\r
217 \r
218 uint8_t max_adr=0;\r
219 #define CH0_M MAX1164x_C_SCAN0|MAX1164x_C_SGL\r
220 #define CH1_M MAX1164x_C_SCAN0|MAX1164x_C_SGL|MAX1164x_C_CS0\r
221 #define CH0_CH1 MAX1164x_C_SCAN0\r
222 //|MAX1164x_C_CS0\r
223 \r
224 uint16_t weekmaxarr[33];\r
225 \r
226 //Kompensieren der Abhänigkeit von RS/RO von Temperatur und Luftfeuchte\r
227 inline double interp(double t, double h) {\r
228         double h2;\r
229          double t2;\r
230         h2=h*h;\r
231         t2=t*t;\r
232         return 4.76111e-9*h2*t2-3.96956e-7*h2*t+0.0000408889*h2-1.07132e-6*h*t2+0.000115968*h*t-0.0101333*h+0.000163806*t2-0.0241179*t+1.80591;\r
233 }\r
234 \r
235 double R0;\r
236 uint16_t mr;\r
237 uint8_t startup=10;\r
238 double ip;\r
239 \r
240 \r
241 int testSW(void) {\r
242         uint8_t r;\r
243         DDRB&=~(1<<PORTB0);  //Eingang\r
244          __asm__ __volatile__ ("nop"); \r
245          PORTB|=(1<<PORTB0); //Pullup\r
246          __asm__ __volatile__ ("nop"); \r
247          __asm__ __volatile__ ("nop"); \r
248          __asm__ __volatile__ ("nop"); \r
249          __asm__ __volatile__ ("nop"); \r
250          __asm__ __volatile__ ("nop"); \r
251          r=PINB&(1<<PORTB0);\r
252          __asm__ __volatile__ ("nop"); \r
253          PORTB&=~(1<<PORTB0); \r
254          __asm__ __volatile__ ("nop"); \r
255         DDRB|=(1<<PORTB0);  //Eingang\r
256         return (r==0);  //Offen mal HIH4030\r
257          \r
258          \r
259 }\r
260 \r
261 #define EEPROM_R0 0\r
262 #define EEPROM_R0d 2\r
263 #define EEPROM_R0w 4\r
264 #define EEPROM_dol 6\r
265 #define EEPROM_CODE_DAYOFR0 8\r
266 #define EEPROM_CORR 10\r
267 #define EEPROM_FREE 12\r
268 #define EEPROM_TCORR_RESET 14\r
269 \r
270 \r
271 uint16_t readEEPROM(uint8_t addr,uint16_t def) {\r
272         uint16_t hr;\r
273         while(EECR & (1<<EEPE));\r
274         EEARL=addr+1;\r
275         EECR |= (1<<EERE);\r
276         hr=EEDR;\r
277         if (hr!=0xFF) {\r
278                 hr=hr<<8;\r
279                 while(EECR & (1<<EEPE));\r
280                 EEARL=addr;\r
281                 EECR |= (1<<EERE);\r
282                 hr|=EEDR;\r
283                 return hr;\r
284         }\r
285         return def;\r
286 }\r
287 \r
288 void writeEEPROM(uint8_t addr,uint16_t val) {\r
289         while(EECR & (1<<EEPE));\r
290         EECR = (0<<EEPM1)|(0<<EEPM0);\r
291         EEARL = addr;\r
292         EEDR = val&0xFF;\r
293         EECR |= (1<<EEMPE);\r
294         EECR |= (1<<EEPE);\r
295         while(EECR & (1<<EEPE));\r
296         EECR = (0<<EEPM1)|(0<<EEPM0);\r
297         EEARL = addr+1;\r
298         EEDR = val>>8;\r
299         EECR |= (1<<EEMPE);\r
300         EECR |= (1<<EEPE);\r
301 }\r
302 \r
303 int main(void){\r
304     PRR|=(1<<PRADC);  // adc for save Power\r
305         PORTA=0xFF;\r
306         PORTB=0xFF-(1<<PORTB0); //Schalter kann gegen Masse sein und zieht dann immer Strom\r
307         DDRB|=(1<<PORTB0); //Als Ausgang und 0\r
308         OWINIT();\r
309         DDRB|=(1<<PINB1);//Ausgang und 1\r
310         DDRA|=(1<<PINA0);\r
311         \r
312         WDTCSR |= ((1<<WDCE) );   // Enable the WD Change Bit//| (1<<WDE)\r
313         WDTCSR |=   (1<<WDIE) |              // Enable WDT Interrupt\r
314         //(1<<WDP0) |(1<<WDP2) | (1<<WDP1);    // Set Timeout to ~2 seconds\r
315         (1<<WDP2) | (1<<WDP1);    // Set Timeout to ~1 seconds\r
316 \r
317         MCUSR=0;\r
318 \r
319         pack1.temp=0x0550;\r
320         pack2.page3[0]=0xF1;\r
321         pack2.cmode=0;\r
322         pack2.R0=readEEPROM(EEPROM_R0,1);\r
323         R0=pack2.R0/100.0;\r
324                 \r
325         pack2.r_day_max=readEEPROM(EEPROM_R0d,1);\r
326         pack2.r_week_max=readEEPROM(EEPROM_R0w,1);\r
327         pack2.tol_d=readEEPROM(EEPROM_dol,0); \r
328         pack2.tol_s8=0;  //Tag faengt mit Einschalten an\r
329         \r
330 \r
331         pack2.page5d[0]=readEEPROM(EEPROM_CODE_DAYOFR0,0x0437);\r
332         pack2.page5d[1]=readEEPROM(EEPROM_CORR,0x0101);\r
333         pack2.page5d[2]=readEEPROM(EEPROM_FREE,0x0);\r
334         pack2.page5d[3]=readEEPROM( EEPROM_TCORR_RESET,0x0005);\r
335         time_corr_count=pack2.time_corr;\r
336 \r
337         for(uint8_t i=0;i<pack2.days_of_r0;i++) {\r
338                 weekmaxarr[i]=pack2.r_week_max;\r
339         }\r
340         if (testSW()) {\r
341                 config_info2[5]=12;\r
342         }else{\r
343                 config_info2[5]=7;\r
344         }\r
345 \r
346         USI_TWI_Master_Initialise();\r
347         initSHT2x();\r
348         _delay_ms(100);\r
349         MAX1164x_config(MAX1164x_S_SEL2|MAX1164x_S_SEL0,CH0_M);//#define MAX1164x_C_CS0\r
350         _delay_ms(30); //Internal Referenz start\r
351         //2970 -> 1,5V  \r
352         gcontrol=1;\r
353         sei();\r
354         //DDRB|=(1<<PINB1);\r
355     while(1)   {\r
356                         if ((cpsp2&0x80)!=0) {\r
357                                 if ((cpsp2&0x0F)==5) {\r
358                                         if (pack2.reset_code==0x01) {\r
359                                                 R0=1;\r
360                                                 pack2.R0=0;\r
361                                                 writeEEPROM(EEPROM_R0,0);\r
362                                         } else if (pack2.reset_code==0x05) {\r
363                                                 pack2.r_day_max=1;\r
364                                                 pack2.r_week_max=1;\r
365                                                 pack2.tol_d=0;\r
366                                                 pack2.tol_s8=0;  //Tag faengt mit Einschalten an\r
367                                                 R0=1;\r
368                                                 writeEEPROM(EEPROM_R0,0xFF);\r
369                                                 writeEEPROM(EEPROM_R0d,0xFF);  //Maximum des Tages\r
370                                                 writeEEPROM(EEPROM_R0w,0xFF); //Maximum der Letzten 7 Tage\r
371                                                 writeEEPROM(EEPROM_dol,0xFF); //Anzahl der Betriebstage\r
372                                                 for(uint8_t i=0;i<7;i++) {\r
373                                                         weekmaxarr[i]=1;\r
374                                                 }\r
375 \r
376                                         } else {\r
377                                                 writeEEPROM(EEPROM_CODE_DAYOFR0,0x0037|(pack2.days_of_r0<<8));\r
378                                                 writeEEPROM(EEPROM_CORR,pack2.page5d[1]);\r
379                                                 writeEEPROM(EEPROM_FREE,pack2.page5d[2]);\r
380                                                 writeEEPROM(EEPROM_TCORR_RESET,pack2.time_corr);\r
381                                         }\r
382                                 }\r
383                                 cpsp2=0;\r
384                 }\r
385                 if (wdcounter>0) {  //8s\r
386                         pack2.tol_s8++;\r
387                         \r
388                         //pack1.dis+=8;\r
389                         //pack1.eoc+=8;\r
390                         if (pack2.tol_s8>(10000))  {//10800 ist theortisch der Tag aber meistens zu lang\r
391                                 pack2.tol_s8=0;\r
392                                 pack2.tol_d++;  //rund 180 Jahre :-)\r
393                                 pack2.r_week_max=0;\r
394                                 weekmaxarr[pack2.days_of_r0]=pack2.r_day_max;\r
395                                 for(uint8_t i=0;i<pack2.days_of_r0;i++) {\r
396                                         weekmaxarr[i]=weekmaxarr[i+1];\r
397                                         //maximum of week\r
398                                         if (weekmaxarr[i]>pack2.r_week_max) pack2.r_week_max=weekmaxarr[i];\r
399                                 }\r
400                                 if (pack2.tol_d>pack2.days_of_r0) {\r
401                                         pack2.R0=pack2.r_week_max;\r
402                                 } else {\r
403                                         pack2.R0=pack2.r_day_max;\r
404                                 }\r
405                                 //R0=//R0-0.5*(pack2.R0/100-R0);\r
406                                 //R0=R0-(R0-pack2.R0/100.0)*0.5 ;\r
407                                 R0=pack2.R0/100.0;\r
408                                 pack2.R0=R0*100;\r
409                                 writeEEPROM(EEPROM_R0,pack2.R0);\r
410                                 writeEEPROM(EEPROM_R0d,pack2.r_day_max);  //Maximum des Tages\r
411                                 writeEEPROM(EEPROM_R0w,pack2.r_week_max); //Maximum der Letzten 7 Tage\r
412                                 writeEEPROM(EEPROM_dol,pack2.tol_d); //Anzahl der Betriebstage\r
413                                 pack2.r_day_max=0;\r
414                         }\r
415                         if (startup!=0) startup--;\r
416                         getSHT2xHumTemp(&temperatureC,&humidityRH);\r
417                         ip=interp(temperatureC,humidityRH);\r
418                         pack2.ip=ip*1000;\r
419                         double RH=calibr_hum(temperatureC,-0.2,humidityRH)*10.0;\r
420                         double TC =temperatureC *10.0-2;\r
421 \r
422 \r
423                         if (testSW()) {\r
424                                  DS2438_2_VAD=RH;\r
425                                  DS2438_2_TEMP=TC*25.6;\r
426                                  \r
427                                  config_info2[5]=12;    //10V = 100%\r
428                         }else{\r
429                                 hhum=(1.0546-0.000216*TC)*(RH);\r
430                                 //am2302_hum=0.318*hhum +76.0;\r
431                                 DS2438_2_VAD=0.31*hhum +80;\r
432                                 DS2438_2_TEMP=TC*25.6;\r
433                                 config_info2[5]=7;\r
434                         }\r
435                         DS2438_1_TEMP=DS2438_2_TEMP;\r
436                         mr=0;\r
437 //Kritische Sektion !___Ein Breakpoint in dieser Section kann den TGS8100 zerstoeren!___________________________\r
438                         PORTB&=~(1<<PINB1); //Auf 0 Ziehen\r
439                         _delay_us(150);\r
440                         mr+=MAX1164x_read();\r
441                         _delay_us(150);\r
442                         mr+=MAX1164x_read();\r
443                         PORTB|=(1<<PINB1);\r
444 //ENDE Kritische Sektion !______________________________\r
445                         //l=mr/2.0*2.048/4096; \r
446                         // l maximal 2  mr max 4096  //mr 2V=8000 \r
447                         \r
448                         if (pack2.cmode) { //cmode=0 V 0..2 V cmode=1 V 1.5..3.5V\r
449                                 //l+=1.5; //Spannung real\r
450                                 mr+=6000;\r
451                         } \r
452                         //if (l>1.8) {\r
453                         if (mr>7200) {                          \r
454                                 if (pack2.cmode==0) {\r
455                                         MAX1164x_config(MAX1164x_S_SEL2|MAX1164x_S_SEL0,CH0_CH1);\r
456                                         pack2.cmode=1;\r
457                                 }\r
458                         }\r
459                         //if (l<1.6) {\r
460                         if (mr<6400) {  \r
461                                 if (pack2.cmode==1) {\r
462                                         MAX1164x_config(MAX1164x_S_SEL2|MAX1164x_S_SEL0,CH0_M);\r
463                                         pack2.cmode=0;\r
464                                 }\r
465                                 \r
466                                 \r
467                         }\r
468                         pack2.VS=mr*5/2;\r
469                         l=mr/4000.0;\r
470                         l=( 3/l- 1) *30;\r
471                         pack2.current=l*100;\r
472                         \r
473                         l=l/ip;\r
474                         \r
475                         if (startup==0){\r
476                                 if (l>R0) {\r
477                                         R0=l;\r
478                                         pack2.R0=R0*100;\r
479                                         writeEEPROM(EEPROM_R0,pack2.R0);\r
480 \r
481                                 }\r
482                                 if (l*100>pack2.r_day_max) {\r
483                                         pack2.r_day_max=l*100;\r
484                                 }\r
485                         } else if (l<R0) l=R0; //negative Werte am Anfang verhintern\r
486                         l=exp((1-(l/R0))*6.05)-1;// exp((1-($val)/55)*5.75);  (5.75 geht über 125 6.05 geht bis 240... mittlere Linie im Datenblatt)\r
487                         //l=(l/R0*100.0);\r
488                         l=l*0.5*35; //fuer DS2438\r
489                         l=l*(double)pack2.corr_VOC_mult/(double)pack2.corr_VOC_div;\r
490                         if (l==0) l=1;\r
491                         gcontrol=1;\r
492                         wdcounter=0;\r
493                         \r
494                 }\r
495         \r
496                 if (gcontrol==1) {\r
497                         uint16_t w=l;\r
498                         DS2438_1_VAD=w;\r
499                         \r
500                         gcontrol=0;\r
501                 }\r
502                 if ((gcontrol==2)||(gcontrol==3)) {\r
503                         gcontrol=0;\r
504                         \r
505                 }\r
506 \r
507                 \r
508 #if  defined(__AVR_ATtiny25__)||defined(__AVR_ATtiny45__)  || defined(__AVR_ATtiny85__)\r
509                         if (((TIMSK & (1<<TOIE0))==0)&& (mode==0))\r
510 #endif                  \r
511 #if  defined(__AVR_ATtiny24__)||defined(__AVR_ATtiny44__)  || defined(__AVR_ATtiny84__) ||defined(__AVR_ATtiny24A__)||defined(__AVR_ATtiny44A__)  || defined(__AVR_ATtiny84A__)\r
512                         if (((TIMSK0 & (1<<TOIE0))==0)&& (mode==0))\r
513 #endif\r
514                           {\r
515 \r
516                         MCUCR|=(1<<SE)|(1<<SM1);\r
517                         MCUCR&=~(1<<ISC01);\r
518                 } else {\r
519                         MCUCR|=(1<<SE);\r
520                         MCUCR&=~(1<<SM1);\r
521                 }\r
522                 asm("SLEEP");\r
523    }\r
524 \r
525 \r
526 }\r