Subversion Repositories Projects

// ***************************************************************

// ** Spektrum Diversity v1.3 - 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-Modes during operation                                **

// ** **************************                                **

// ** LED OFF: Everything is fine                               **

// ** LED ON:  FAILURE - The first selected sat had lost sync   **

// **                                                           **

// ** LED-Modes after Self-Test and pressed button              **

// ** ********************************************              **

// ** LED flashes at 1 Hz: Everything is fine                   **

// ** LED flashes some times: Times flashed -> damaged Channel# **

// ** LED off: check voltage(regulator), button or firmware     **

// ***************************************************************

// ** (c) 2010-0xFFFF Stefan Pendsa                             **

// ** License: don't know - use it and have fun                 **

// ***************************************************************

#include <avr/io.h>

#include <avr/eeprom.h>

#include <avr/interrupt.h>

#include <util/delay.h>

#define LED_OFF	PORTD |= 1 << PD0

#define LED_ON	PORTD &= ~(1 << PD0)

volatile unsigned int TimerEvent;

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(TIMER1_OVF_vect)										// Triggered every 8,192 msec

{

	TimerEvent++;

}

void SelectSat(unsigned char sat)

{

	PORTD = (PORTD & 0b1100111) | (sat << 3);				// Select the input for 74HC151

	_delay_us(10);											// Wait for stable state

}

void ResetTimer(void)

{

	TCNT1H = 0;

	TCNT1L = 0;

	TimerEvent = 0;

}

void Binding(void)											// Binding sequence

{

	unsigned char i = 0;

	DDRB = 0b11110000;										// Sat-Pins to output

	_delay_ms(80);											// Let them time to boot up

	for (i=0;i<bind;i++)									// Send negative 100µs pulses to all sat's

	{

		PORTB = 0b00000000;

		_delay_us(100);

		PORTB = 0b11110000;

		_delay_us(100);

	}

	for (i=0;i<bind;i++)									// Flash the number of used pulses to the LED

	{

		LED_ON;

		_delay_ms(100);

		LED_OFF;

		_delay_ms(250);

	}

	DDRB = 0b00000000;										// Sat-Pins to input again

	bind++;													// Save increased bind-pulse-counter for next binding.

	if (bind > 6) bind = 3;									// 3 pulses are for DX7+AR6200, 4-6 pulses have been seen...

	eeprom_write_byte(&eebind, bind);						// around the world for other combinations. Hopefully it works for them.

	_delay_ms(500);

}

void Testing(void)											// Self Test

{

	unsigned char error = 0;

	unsigned char i = 0;

	DDRB = 0b11110000;										// Port B Output for satellites, Input for feedback

	PORTB = 0b01010000;										// Test Pattern

	SelectSat(0);

	if (!(PINB & (1<<PB3))) error = 1;

	SelectSat(1);

	if (PINB & (1<<PB3)) error = 2;

	SelectSat(2);

	if (!(PINB & (1<<PB3))) error = 3;

	SelectSat(3);

	if (PINB & (1<<PB3)) error = 4;

	PORTB = 0b10100000;										// Another (inverted) Test Pattern

	SelectSat(0);

	if (PINB & (1<<PB3)) error = 1;

	SelectSat(1);

	if (!(PINB & (1<<PB3))) error = 2;

	SelectSat(2);

	if (PINB & (1<<PB3)) error = 3;

	SelectSat(3);

	if (!(PINB & (1<<PB3))) error = 4;

	DDRB = 0b00000000;										// Port B Input again

	while (PIND & (1<<PD6));								// Wait for Bind-Switch

	while(1)												// Never return

	{

		if (error == 0)										// When no error occured -> LED flashes at 1 Hz

		{

			LED_ON;

			_delay_ms(100);

			LED_OFF;

			_delay_ms(900);

		}

		else

		{

			for (i=0;i<error;i++)							// When error occured -> Flash-Out the Errorcode

			{

				LED_ON;

				_delay_ms(100);

				LED_OFF;

				_delay_ms(400);

			}

			_delay_ms(1000);

		}

	}

}

int main(void)

{

	unsigned char i = 0;

	unsigned char active[4];

	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

    if (eeprom_read_byte(&eecheck) != 0x42)					// Invalid Data in EEPROM -> initialize

	{

		eeprom_write_byte(&eecheck, 0x42);

		bind = 3;

		eeprom_write_byte(&eebind, bind);

	}

	else bind = eeprom_read_byte(&eebind);					// Valid Data in EEPROM -> read bind-pulse-counter

	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

	_delay_ms(100);

	TCCR1B = ( 1 << CS10 );									// Timer1 Prescaler = 1 -> 8,192 msec

	TIMSK = ( 1 << TOIE1 );									// Timer1 Overflow Interrupt Enable

	sei();													// Global Interrupts enable

	ResetTimer();

	while(sat == 99)										// Wait for first signal

	{

		if (TimerEvent == 10) LED_ON;						// Blink while waiting...

		if (TimerEvent == 20)

		{

			LED_OFF;

			TimerEvent = 0;

		}

		for (i=0;i<4;i++)									// Select first active Satellite

		{

			if (!(PINB & (1<<(i+4))))

			{

				active[i] = 1;

				sat = i;

				SelectSat(sat);

				break;

			}

		}

	}

	LED_OFF;

	while(1)												// Main-Loop

	{

		for (i=0;i<4;i++) active[i] = 0;					// Reset active-array

		ResetTimer();

		while((PINB & 0b11110000) == 0b11110000)			// Wait for first signal (SYNC to frame)

		{

			if (TimerEvent > 3) break;						// (max. 3*8=24ms)

		}

		ResetTimer();

		while(TimerEvent < 1)								// Check active satellites (for 1*8=8ms)

		{

			for (i=0;i<4;i++)

			{

				if (!(PINB & (1<<(i+4))))

				{

					active[i] = 1;

				}

			}

		}

		if (active[sat] == 0)								// Detect fail on active satellite

		{

			for (i=0;i<4;i++)								// Select lowest active satellite

			{

				if (active[i] == 1)

				{

					sat = i;

					SelectSat(sat);

					break;

				}

			}

			LED_ON;											// Failure-LED ON

		}

		if (!(PIND & (1<<PD6))) LED_OFF;					// Reset Failure-LED when Bind-Button is pressed

	}

}