WebSVN - Projects - Diff - Rev 791 and 931 - /Spektrum-Diversity/Software/diversity.c

 // ***************************************************************
-// ** Spektrum Diversity v1.3 - use up to 4 satellite receivers **
+// ** Spektrum Diversity v2.0 - use up to 4 satellite receivers **
 // ***************************************************************
 // ** Target: An Atmel ATtiny2313 (RC-Oscillator @ 8 MHz)       **
 // **         controls a 74HC151 Multiplexer                    **
 // ***************************************************************
 // ** It monitors the data from 4 satellite receivers and       **
 // ** connects a valid one to the output via the multiplexer    **
 // ***************************************************************
 // ** LED-Modes during startup                                  **
 // ** ************************                                  **
-// ** LED fast flash: Waiting for first datapulse               **
+// ** LED fast flash: Waiting for first signal                  **
 // **                                                           **
 // ** LED-Modes during operation                                **
 // ** **************************                                **
-// ** LED OFF: Everything is fine                               **
+// ** LED flash 1x - 4x: Shows which channel is active every 2s **
-// ** LED ON:  FAILURE - The first selected sat had lost sync   **
+// ** LED ON after flash: FAILURE - A used signal was lost      **
 // **                                                           **
 // ** LED-Modes after Self-Test and pressed button              **
 // ** ********************************************              **
 // ** LED flashes at 1 Hz: Everything is fine                   **
 // ** LED flashes some times: Times flashed -> damaged Channel# **
+#define LED_OFF PORTD |= 1 << PD0
-#define LED_OFF PORTD |= 1 << PD0
+#define LED_ON  PORTD &= ~(1 << PD0)
+volatile unsigned char Timer0Event = 0;
-#define LED_ON  PORTD &= ~(1 << PD0)
+volatile unsigned int Timer1Event;
 volatile unsigned char BlinkCode = 0;
-volatile unsigned int TimerEvent;
+volatile unsigned char failure = 0;
 unsigned char eedummy EEMEM;                                                            // Dummy-Variable for Address 0 in EEPROM
 unsigned char eecheck EEMEM;                                                            // Check-Variable
+unsigned char bind;                                                                                     // Bind-Pulse-Counter (in RAM)
+unsigned char eebind EEMEM;                                                                     // Bind-Pulse-Counter (in EEPROM)
+ISR(TIMER0_OVF_vect)                                                                            // Triggered every 32,768 msec
+{
+        if (Timer0Event > 64)                                                                   // Max. 64*32 msec = 2,097152 sec
+        {
+                Timer0Event = 0;
+                LED_OFF;
+        }
+        if(Timer0Event == 0 && BlinkCode > 0) LED_ON;
+        else if(Timer0Event == 4 && BlinkCode > 0) LED_OFF;
+        else if(Timer0Event == 8 && BlinkCode > 1) LED_ON;
+        else if(Timer0Event == 12 && BlinkCode > 1) LED_OFF;
-unsigned char bind;                                                                                     // Bind-Pulse-Counter (in RAM)
+        else if(Timer0Event == 16 && BlinkCode > 2) LED_ON;
-unsigned char eebind EEMEM;                                                                     // Bind-Pulse-Counter (in EEPROM)
+        else if(Timer0Event == 20 && BlinkCode > 2) LED_OFF;
+        else if(Timer0Event == 24 && BlinkCode > 3) LED_ON;
+        else if(Timer0Event == 28 && BlinkCode > 3) LED_OFF;
+        else if(Timer0Event == 35 && failure == 1) LED_ON;
+        else if(Timer0Event == 55 && failure == 1) LED_OFF;
         Timer0Event++;
+}
 ISR(TIMER1_OVF_vect)                                                                            // Triggered every 8,192 msec
 ISR(TIMER1_OVF_vect)                                                                            // Triggered every 8,192 msec
-        TimerEvent++;
+{
         Timer1Event++;
+}
 void SelectSat(unsigned char sat)
 {
         PORTD = (PORTD & 0b1100111) | (sat << 3);                               // Select the input for 74HC151
         _delay_us(10);                                                                                  // Wait for stable state
+}
 int main(void)
+{
         unsigned char i = 0;
+        unsigned char active[4];
+        unsigned char active_lo[4];
-        unsigned char active[4];
+        unsigned char active_hi[4];
+        unsigned char sat = 99;
         unsigned char sat = 99;
         DDRB = 0b00000000;                                                                              // Port B Input for satellites and feedback
         DDRD = 0b0011001;                                                                               // Port D Output for MUX and LED, Input for Switch & Test
-        PORTB = 0b11110000;                                                                             // Port B Pullup's for (unused) satellites
-        PORTD = 0b1100001;                                                                              // Port D Pullup's for Switch & Test, LED off
-        for (i=0;i<4;i++) active[i] = 0;                                                // Reset active-array
+        PORTB = 0b11110000;                                                                             // Port B Pullup's for (unused) satellites
         PORTD = 0b1100001;                                                                              // Port D Pullup's for Switch & Test, LED off
     if (eeprom_read_byte(&eecheck) != 0x42)                                     // Invalid Data in EEPROM -> initialize
+        {
+        if (!(PIND & (1<<PD5))) Testing();                                              // Initiate Self-Test when Test-Pad is low
+        if (!(PIND & (1<<PD6))) Binding();                                              // Initiate Binding when Bind-Button is pressed
+        for (i=0;i<4;i++)                                                                               // Reset active-arrays
+        {
+                active[i] = 0;
+                active_lo[i] = 0;
-        if (!(PIND & (1<<PD5))) Testing();                                              // Initiate Self-Test when Test-Pad is low
+                active_hi[i] = 0;
+        }
         if (!(PIND & (1<<PD6))) Binding();                                              // Initiate Binding when Bind-Button is pressed
+        _delay_ms(100);
         _delay_ms(100);
+        TCCR0B = ( 1 << CS00 ) | ( 1 << CS02 );                                 // Timer0 Prescaler = 1024 -> 32,768 msec
         TCCR1B = ( 1 << CS10 );                                                                 // Timer1 Prescaler = 1 -> 8,192 msec
-        TIMSK = ( 1 << TOIE1 );                                                                 // Timer1 Overflow Interrupt Enable
+        TIMSK = ( 1 << TOIE0 ) | ( 1 << TOIE1 );                                // Timer0+1 Overflow Interrupt Enable
         sei();                                                                                                  // Global Interrupts enable
-        ResetTimer();
+        ResetTimer1();
         while(sat == 99)                                                                                // Wait for first signal
         {
+                if (Timer1Event == 10) LED_ON;                                          // Blink while waiting
+                if (Timer1Event == 20)
+                {
+                        LED_OFF;
+                        Timer1Event = 0;
+                }
+                while(Timer1Event < 3)                                                          // Check active satellites (for 3*8=24ms)
+                {
-                if (TimerEvent == 10) LED_ON;                                           // Blink while waiting...
+                        for (i=0;i<4;i++)
-                if (TimerEvent == 20)
+                        {
                                 if (PINB & (1<<(i+4))) active_hi[i] = 1;
+                                else active_lo[i] = 1;
+                        }
+                }
+                for (i=0;i<4;i++)                                                                       // When an input had low AND high signals, mark it as active
+                {
-                        LED_OFF;
+                        if (active_lo[i] == 1 && active_hi[i] == 1) active[i] = 1;
                         TimerEvent = 0;
-                }
-                for (i=0;i<4;i++)                                                                       // Select first active Satellite
+                for (i=0;i<4;i++)                                                                       // Select first active satellite
+                {
-                        if (!(PINB & (1<<(i+4))))
+                        if (active[i] == 1)
+                        {
+                                SelectSat(i);
-                                active[i] = 1;
+                                sat = i;
+                                BlinkCode = i+1;
-                                sat = i;
+                                break;
                                 SelectSat(sat);
                                 break;
-                        }
-                }
-        }
         LED_OFF;
         while(1)                                                                                                // Main-Loop
-        {
+        while(1)                                                                                                // Main-Loop
-                for (i=0;i<4;i++) active[i] = 0;                                        // Reset active-array
+        {
+                for (i=0;i<4;i++)                                                                       // Reset active-arrays
                 ResetTimer();
-                while((PINB & 0b11110000) == 0b11110000)                        // Wait for first signal (SYNC to frame)
+                        active[i] = 0;
                         active_lo[i] = 0;
-                        if (TimerEvent > 3) break;                                              // (max. 3*8=24ms)
+                        active_hi[i] = 0;
-                }
+                }
-                ResetTimer();
                 while(TimerEvent < 1)                                                           // Check active satellites (for 1*8=8ms)
                 ResetTimer1();
+                while(Timer1Event < 3)                                                          // Check active satellites (for 3*8=24ms)
-                        for (i=0;i<4;i++)
+                {
                         for (i=0;i<4;i++)
+                        {
+                                if (PINB & (1<<(i+4))) active_hi[i] = 1;
+                                else active_lo[i] = 1;
+                        }
+                }
+                for (i=0;i<4;i++)                                                                       // When an input had low AND high signals, mark it as active
+                {
+                        if (active_lo[i] == 1 && active_hi[i] == 1) active[i] = 1;
+                }
-                                if (!(PINB & (1<<(i+4))))
+                if (active[0] == 0 && active[1] == 0 && active[2] == 0 && active[3] == 0 && sat != 99)
+                {
                         failure = 1;                                                                    // Set Failure-LED when the signal is lost completely
-                                        active[i] = 1;
+                        BlinkCode = 0;
-                                }
+                        sat = 99;
-                        }
+                }
-                }
-                if (active[sat] == 0)                                                           // Detect fail on active satellite
                 for (i=0;i<4;i++)                                                                       // Select active satellite (priorized)
-                        for (i=0;i<4;i++)                                                               // Select lowest active satellite
+                {
+                        if (active[i] == 1)
+                        {
-                                if (active[i] == 1)
+                                SelectSat(i);
                                 if (sat != i) failure = 1;                                      // Set Failure-LED when the active satellite changes
-                                        sat = i;
+                                sat = i;

Subversion Repositories Projects

(root)/Spektrum-Diversity/Software/diversity.c @ 938 - Rev 791 → 931