diff -r cc2274b92647 -r 40a309c9c135 trackswitch/main.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/trackswitch/main.c Tue Nov 29 13:42:29 2011 +0100 @@ -0,0 +1,215 @@ +#include +#include +#include +#include +#include +#include +#include + +#include "main.h" + +#include "driver/rs232.h" +#include "util/delay.h" + + +ISR ( USART_RXC_vect ) { +} + +#define PULSE_PORT PORTD +#define PULSE_BIT PD2 + +volatile uint16_t data = 0; +volatile uint8_t data_len = 0; +volatile uint8_t bitbuf_len = 0; +volatile uint16_t bitbuf = 0; + +ISR ( INT0_vect ) { + GICR &= ~_BV(INT0) ; // Disable INT0 + // Startsignal erkannt, ab hier den Timer2 starten, + // der liest dann alle 50µs den Zustand ein und schreibt das + // empfangene Bit in den Puffer + bitbuf = 0; // init + bitbuf_len = 0b10000000; // init 1 pulse received + TCNT2 = 0; + TIMSK |= _BV(OCIE2); //enable timer2 interrupt +} + + +ISR ( TIMER2_COMP_vect ) { + + uint8_t clock; + uint8_t state; + uint8_t state2; + if ((bitbuf_len & 0b10000000) == 0) clock = 0; else clock = 0xff; + if ((bitbuf_len & 0b01000000) == 0) state = 0; else state = 0xff; + if ((PIN(PULSE_PORT) & _BV(PULSE_BIT)) == 0) state2 = 0xff; else state2 = 0; + + if (clock) { + bitbuf_len &= ~_BV(7); // switch clock to low + // second pulse of bit + if ((state==state2) & state2) { + // two cycles high: packet end received + data_len = (bitbuf_len & 0b00111111); + TIMSK &= ~_BV(OCIE2); //disable timer2 interrupt + GICR |= _BV(INT0) ; // Enable INT0 + data = bitbuf; // output data + } else { + bitbuf_len++; // increment bit counter + bitbuf = bitbuf << 1; // shift bits + if (state2 == 0) bitbuf |= 1; // receive logic one + } + } else { + bitbuf_len |= _BV(7); // switch clock to high + // first pulse of bit + if (state2) { + bitbuf_len |= _BV(6); // store new state + } else { + bitbuf_len &= ~_BV(6); // store new state + } + } + +} + + +uint16_t car0_new, car0_old; +uint16_t car1_new, car1_old; +volatile uint16_t car0, car1; +ISR (TIMER1_OVF_vect) { + // reset both car counters to overflow + car0_old = 0xffff; + car1_old = 0xffff; +} + +ISR (INT1_vect) { + // car0 detector + uint16_t tmp = 0; + car0_new = TCNT1; // get current counter + if (car0_old < car0_new) { + // calculate difference + if (car0 == 0) tmp = car0_new-car0_old; + if ( (tmp > 54) && (tmp < 74) ) car0 = 1; + if ( (tmp > 118) && (tmp < 138) ) car0 = 2; + if ( (tmp > 186) && (tmp < 206) ) car0 = 3; + if ( (tmp > 246) && (tmp < 266) ) car0 = 4; + } + car0_old = car0_new; +} + +ISR (TIMER1_CAPT_vect) { + // car1 detector + uint16_t tmp = 0; + car1_new = TCNT1; // get current counter + if (car1_old < car1_new) { + // calculate difference + if (car1 == 0) tmp = car1_new-car1_old; + if ( (tmp > 54) && (tmp < 74) ) car1 = 1; + if ( (tmp > 118) && (tmp < 138) ) car1 = 2; + if ( (tmp > 186) && (tmp < 206) ) car1 = 3; + if ( (tmp > 246) && (tmp < 266) ) car1 = 4; + } + car1_old = car1_new; +} + +#define OSC_OFFSET 0 + +int main(void) +{ + uint16_t i, data_tmp; + uint8_t tmp, datalen_tmp; + unsigned char s[30]; + + + uint8_t car_speed[8]; + uint8_t car_switch[8]; + uint8_t car_switch_old[8]; + + // setup data bit timer2 + TCCR2 = (1<= 5) { + if (datalen_tmp == 13) { // sync to first packet + i = 1; + } else i++; + if (datalen_tmp == 10) { // controller data packet + tmp = (data_tmp >> 6) & 0b111; + if (tmp < 6) { + car_speed[tmp] = (data_tmp >> 1) & 0x0F; + car_switch[tmp] = (data_tmp >> 5) & 1; + } + } + } + } + + for (i=0; i<6; i++) { + if (car_switch[i] != car_switch_old[i]) { + RS232_putc('0'+i); + RS232_putc('0'+car_switch[i]); + RS232_putc('\n'); + } + car_switch_old[i] = car_switch[i]; + } + + +/* + i = get_car(_BV(PD3)); + if (i > 0) { + itoa ( i , s, 10); + RS232_puts(s); + RS232_putc('\n'); + } + _delay_ms(50); +*/ + + if (car0 > 0) { + itoa ( car0 , s, 10); + car0 = 0; + RS232_putc('A'); + RS232_puts(s); + RS232_putc('\n'); + } + + if (car1 > 0) { + itoa ( car1 , s, 10); + car1 = 0; + RS232_putc('B'); + RS232_puts(s); + RS232_putc('\n'); + } + + } // main loop end +}; +