123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302 |
- #include <dimmer.h>
- static unsigned int Val[8];
- static unsigned char first[2];
- static unsigned int firstTime[2];
- static unsigned char follower[16];
- static unsigned int followerTime[16];
- static unsigned char sorted[8];
- union{
- unsigned char flags;
- struct {
- unsigned page:1;
- unsigned pageInt:1;
- unsigned changed:1;
- unsigned is60Hz;
- };
- } status;
- #define TIMER DIMMER_TIMER
- #include <timer.h>
- #define TIMER_INIT() do{\
- TIMER_CON = 0; \
- TIMER_PS1 = 1; \
- TIMER_16BIT = 1;\
- TIMER_IP = DIMMER_INTPRI; \
- TIMER_ON = 0; \
- TIMER_IF = 0; \
- TIMER_IE = 1; \
- } while(0)
- #define INTPIN KINT(DIMMER_INTPIN)
- #include <intpin.h>
- void dimmerInit()
- {
- unsigned char i;
-
- status.flags = 0;
- TIMER_INIT();
- for(i = 0; i < 8; i++) {
- Val[i] = 65535;
- sorted[i] = i;
- }
- pinModeDigitalIn(DIMMER_INTPIN);
- INTPIN_EDGE = DIMMER_INTEDGE;
- INTPIN_IP = DIMMER_INTPRI;
- INTPIN_IF = 0;
- INTPIN_IE = 1;
- digitalClear(DIMMER_K0);
- digitalClear(DIMMER_K1);
- digitalClear(DIMMER_K2);
- digitalClear(DIMMER_K3);
- digitalClear(DIMMER_K4);
- digitalClear(DIMMER_K5);
- digitalClear(DIMMER_K6);
- digitalClear(DIMMER_K7);
- pinModeDigitalOut(DIMMER_K0);
- pinModeDigitalOut(DIMMER_K1);
- pinModeDigitalOut(DIMMER_K2);
- pinModeDigitalOut(DIMMER_K3);
- pinModeDigitalOut(DIMMER_K4);
- pinModeDigitalOut(DIMMER_K5);
- pinModeDigitalOut(DIMMER_K6);
- pinModeDigitalOut(DIMMER_K7);
- }
- void dimmerSet(unsigned char num,unsigned int val)
- {
- if(status.is60Hz) Val[num] = DIMMER_TMIN + (((unsigned long)(0xFFFF - val) * (33000UL- DIMMER_TMIN)) / 0xFFFF);
- else Val[num] = 8000UL + (((unsigned long)(0xFFFF - val) * (40000UL - DIMMER_TMIN)) / 0xFFFF);
- status.changed = 1;
- }
- void dimmerService(void)
- {
- unsigned char i, j, tmp;
-
- if( (!status.changed) || (status.page != status.pageInt)) return;
- status.changed = 0;
-
- for(i = 1 ; i < 8 ; i++) {
- j = i;
- while((j > 0) && (Val[sorted[j-1]] > Val[sorted[j]])) {
- tmp = sorted[j-1];
- sorted[j-1] = sorted[j];
- sorted[j] = tmp;
- j--;
- }
- }
-
- first[status.page==0] = sorted[0];
- firstTime[status.page==0] = 0xFFFF - Val[sorted[0]];
- for(i = 0 ; i < 7 ; i++) {
- tmp = sorted[i];
- if(status.page==0) tmp += 8;
- follower[tmp] = sorted[i+1];
- followerTime[tmp] = 0xFFFF - (Val[sorted[i+1]] - Val[sorted[i]]);
- }
- tmp = sorted[7];
- if(status.page==0) tmp += 8;
- follower[tmp] = 8;
- status.page = (status.page==0);
- }
- #define PROCESS_CHAN(chan) do { \
- digitalSet(DIMMER_K##chan); \
- if(status.pageInt) { \
- next = follower[chan + 8] ; \
- if(!(next & 8)) { \
- TIMER_H = (followerTime[chan + 8]) >> 8; \
- TIMER_L = (followerTime[chan + 8]) & 255; \
- TIMER_ON = 1; \
- } \
- } else { \
- next = follower[chan] ; \
- if(!(next & 8)) { \
- TIMER_H = (followerTime[chan]) >> 8; \
- TIMER_L = (followerTime[chan]) & 255; \
- TIMER_ON = 1; \
- } \
- } \
- } while(0)
-
- void dimmerInterrupt(void)
- {
- static unsigned char next;
- static unsigned int val;
- static t_time lastTime= 0;
-
- if(INTPIN_IF){
-
- lastTime = timeISR();
-
- INTPIN_IF = 0;
-
- status.pageInt = 0;
- if(status.page) status.pageInt = 1;
-
- digitalClear(DIMMER_K0);
- digitalClear(DIMMER_K1);
- digitalClear(DIMMER_K2);
- digitalClear(DIMMER_K3);
- digitalClear(DIMMER_K4);
- digitalClear(DIMMER_K5);
- digitalClear(DIMMER_K6);
- digitalClear(DIMMER_K7);
-
- next = status.pageInt ? first[1] : first[0];
- val = status.pageInt ? firstTime[1] : firstTime[0];
- TIMER_ON = 0;
- TIMER_H = val>>8;
- TIMER_L = val&255;
- TIMER_IF = 0;
- TIMER_ON = 1;
- }
-
- if(TIMER_IF) {
- TIMER_ON = 0;
- TIMER_IF = 0;
-
- if(!(next&4)) {
- if(!(next&2)) {
- if(!(next&1)) PROCESS_CHAN(0);
- else PROCESS_CHAN(1);
- } else {
- if(!(next&1)) PROCESS_CHAN(2);
- else PROCESS_CHAN(3);
- }
- } else {
- if(!(next&2)) {
- if(!(next&1)) PROCESS_CHAN(4);
- else PROCESS_CHAN(5);
- } else {
- if(!(next&1)) PROCESS_CHAN(6);
- else PROCESS_CHAN(7);
- }
- }
-
-
-
- }
- }
- void dimmerHighInterrupt(void)
- {
- #if DIMMER_INTPRI == 1
- dimmerInterrupt();
- #endif
- }
- void dimmerLowInterrupt(void)
- {
- #if DIMMER_INTPRI != 1
- dimmerInterrupt();
- #endif
- }
- void dimmerReceive()
- {
- unsigned char c, c2;
- unsigned int i = 0;
-
- c=fraiseGetChar();
- if(c < 8) {
- dimmerSet(c, fraiseGetInt());
- } else if (c == 8) {
- status.is60Hz = (fraiseGetChar() != 0);
- }
- }
- void dimmerPrintDebug()
- {
- unsigned char i;
- putchar('B');
- for(i = 0 ; i < 8 ; i++) {
- putchar(sorted[i]);
- }
- for(i = 0 ; i < 8 ; i++) {
- putchar(follower[i]);
- }
- for(i = 0 ; i < 8 ; i++) {
- putchar(follower[i+8]);
- }
-
- putchar(status.flags);
- putchar('\n');
- }
|