5 * Copyright (C) 2013-06-11 K.Ohta <whatisthis.sowhat ai gmail.com>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2,
11 * or (at your option) any later version.
12 * This library / program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
15 * See the GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this library; see the file COPYING. If not, write to the
19 * Free Software Foundation, 51 Franklin Street, Fifth Floor, Boston,
22 * As a special exception, if you link this(includeed from sdcc) library
23 * with other files, some of which are compiled with SDCC,
24 * to produce an executable, this library does not by itself cause
25 * the resulting executable to be covered by the GNU General Public License.
26 * This exception does not however invalidate any other reasons why
27 * the executable file might be covered by the GNU General Public License.
30 #include <pic18fregs.h> /* ONLY FOR PIC18x */
37 INTCON = INTCON & ~(_TMR0IF | _RBIF); // Enable tmr0 as interrupt and clear interrupt flags.
38 INTCON2 = ~_TMR0IP & _TMR0IP; // Interrupt is lower.
40 WDTCON = 1; // OK? WDT=Disabled.
50 void idle(unsigned int initial)
52 // unsigned char osccon;
53 unsigned char contword;
56 WDTCONbits.SWDTEN = 0; // Lame WDT OFF.
59 INTCONbits.TMR0IF = 0;
60 INTCONbits.TMR0IE = 1; // Enable tmr0 as interrupt and clear interrupt flags.
62 /* Set TMR0 for interrupt*/
63 /* Pre-scaler: 1/16, PSA=0(ON), TOSE=0, T0CS=0(INTERNAL), T08BIT=0(16bit), TMR0ON=1(START) */
64 contword = _T0PS0 | _T0PS1 | _T0PS2 | _TMR0ON; // Prescaler = 1:256.
65 //contword = _T0PS2 | _TMR0ON; // Pre-scakler is 1:32.
66 //TMR0H = initial >> 8;
68 TMR0L = initial & 0xff;
69 TMR0H = initial >> 8; // Write order : L->H
73 // i = TMR0H << 8 + TMR0L; // Check if IDLE-Timer was elapsed.
74 // } while(i < 3); // Dead area : 0-2.
75 WDTCONbits.SWDTEN = 1; // WDT ON.
79 void idle_time_ms(unsigned int ms)
85 upper = (ms & 0xe000) >> 13;
86 // unsigned int upper;
87 tim = ms << 3 - ms >> 4 - ms >>3;
88 tim = 65535 - tim + 1; // tim = 65536 - tim;
90 idle(0x0000); // Upper is 65536 tick.
95 void idle_time_62_5ms(void)
97 // Tim = 1ms * 64 - 1ms - 0.5ms
98 // Tim = 0.128ms * (488 + 2.2)
100 idle(65535 - 488 + 4);
103 void idle_time_35ms(void)
105 // Tim = 35 / 0.128 = 273.44
106 idle(65535 - 274 + 1);