123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114 |
- #include <config.h>
- #include <switch.h>
- #define MAX_CHANNELS 16
- #define CHANNELS_GROUPS ((MAX_CHANNELS+7)/8)
- static unsigned char Pins[MAX_CHANNELS];
- static unsigned char States[CHANNELS_GROUPS];
- static unsigned char oldStates[CHANNELS_GROUPS];
- #define CHANISSET(num) (bittst(States[num>>3],num&7))
- #define CHANCLR(num) (bitclr(States[num>>3],num&7))
- #define CHANSET(num) (bitset(States[num>>3],num&7))
- #define OLDCHANISSET(num) (bittst(oldStates[num>>3],num&7))
- #define OLDCHANCLR(num) (bitclr(oldStates[num>>3],num&7))
- #define OLDCHANSET(num) (bitset(oldStates[num>>3],num&7))
- void switchInit()
- {
- unsigned char i;
-
- for(i=0;i<CHANNELS_GROUPS;i++) {
- oldStates[i] = States[i] = 1;
- }
-
- for(i=0;i<MAX_CHANNELS;i++) {
- Pins[i] = 255;
- }
- }
- void switchSelectHW(unsigned char channel, unsigned char *port, unsigned char bit)
- {
- Pins[channel] = (((unsigned int)(port-&PORTA)&7)<<4) + (bit&7);
- }
- void switchDeselect(unsigned char channel)
- {
- Pins[channel] = 255;
- }
- void switchService(void)
- {
- unsigned char i,pin;
-
- for(i=0;i<MAX_CHANNELS;i++) {
- pin=Pins[i];
- if(pin != 255) {
- if(bittst(*(&PORTA+(pin>>4)),pin&7)) CHANSET(i);
- else CHANCLR(i);
- }
- }
- }
- char switchSend(void)
- {
- static unsigned char chan=0;
- unsigned char count=0,pin,set;
-
- while(count<4) {
- pin=Pins[chan];
- if(pin != 255) {
- set=CHANISSET(chan);
- if(set!=OLDCHANISSET(chan)) {
- if(set) OLDCHANSET(chan);
- else OLDCHANCLR(chan);
- printf("C s %d %d\n",chan,set==0);
- count++;
- }
- }
- chan++;
- if(chan>=MAX_CHANNELS) {
- chan=0;
- break;
- }
- }
- return count;
- }
- char switchGet(unsigned char chan)
- {
- return CHANISSET(chan);
- }
|