WebSVN - Projects - Blame - Rev 775 - /Spektrum-Diversity/Software/diversity.c

Rev	Author	Line No.	Line
775	-	1	// ************************************************************
		2	// Spektrum Diversity - use up to 8 satellite receivers
		3	// ************************************************************
		4	// Target: An Atmel ATtiny2313 (RC-Oscillator @ 8 MHz)
		5	// controls a 74HC151 Multiplexer
		6	// ************************************************************
		7	// It monitors the data from 8 satellite receivers and
		8	// connects a valid one to the output via the multiplexer
		9	// ************************************************************
		10	// LED-Modes during startup (in chronological order)
		11	// ********************
		12	// LED fast blink: Waiting for first datapulse
		13	// LED slow blink: Waiting 3 seconds while counting sat's
		14	// LED flashes: Indicates the number of active sat's
		15	//
		16	// LED-Modes during operation
		17	// **********************
		18	// LED OFF: Everything is fine
		19	// LED ON: FAILURE - The first selected sat had lost sync
		20	// ************************************************************
		21	// (c) 2010-0xFFFF Stefan Pendsa
		22	// License: don't know - use it and have fun
		23	// ************************************************************
		24
		25	#include <avr/io.h>
		26	#include <avr/interrupt.h>
		27	#include <util/delay.h>
		28
		29	#define LED_OFF PORTD \|= 1 << PORTD3
		30	#define LED_ON PORTD &= ~(1 << PORTD3)
		31
		32
		33	volatile unsigned int TimerEvent;
		34
		35
		36	void SelectSat(unsigned char sat)
		37	{
		38	/*
		39	Re-Assignment due to easier routing on layout: sat -> mux-channel# -> mux-input (seen from �C)
		40
		41	1 -> 1 -> 4
		42	2 -> 0 -> 0
		43	3 -> 3 -> 6
		44	4 -> 4 -> 1
		45	5 -> 5 -> 5
		46	6 -> 6 -> 3
		47	7 -> 7 -> 7
		48	*/
		49
		50
		51	if (sat == 0) sat = 2;
		52	else if (sat == 1) sat = 4;
		53	else if (sat == 2) sat = 0;
		54	else if (sat == 3) sat = 6;
		55	else if (sat == 4) sat = 1;
		56	else if (sat == 5) sat = 5;
		57	else if (sat == 6) sat = 3;
		58	else if (sat == 7) sat = 7;
		59
		60
		61	PORTD = (PORTD & 0b00001000) \| sat;
		62	}
		63
		64	void ResetTimer(void)
		65	{
		66	TCNT1H = 0;
		67	TCNT1L = 0;
		68	TimerEvent = 0;
		69	}
		70
		71
		72
		73	ISR(TIMER1_OVF_vect) // Triggered every 4,096 msec
		74	{
		75	TimerEvent++;
		76	}
		77
		78
		79	int main(void)
		80	{
		81	unsigned char i = 0;
		82	unsigned int j = 0;
		83	unsigned char active[8];
		84	unsigned char sat = 9;
		85	DDRB = 0b00000000; // PORT A INPUT FOR SATELLITES
		86	DDRD = 0b00001111; // PORT B OUTPUT FOR MUX AND LED
		87	PORTB = 0b11111111; // PORT A PULLUP's FOR (unused) SATELLITES
		88
		89
		90	TCCR1B = ( 1 << CS10 ); // Timer1 Prescaler 1 = 4,096 msec
		91	TIMSK = ( 1 << TOIE1 ); // Timer1 Overflow Interrupt Enable
		92	sei(); // Global Interrupts enable
		93
		94	for (i=0;i<8;i++) active[i] = 0; // Reset active-array
		95
		96	ResetTimer();
		97	while(PINB == 255) // Wait for first signal (SYNC to frame)
		98	{
		99	if (TimerEvent == 10) LED_ON; // Blink while waiting...
		100	if (TimerEvent == 20)
		101	{
		102	LED_OFF;
		103	TimerEvent = 0;
		104	}
		105	}
		106
		107	LED_OFF;
		108
		109	ResetTimer();
		110	while(1) // Check active satellites for 3 seconds
		111	{
		112	if (TimerEvent == 20) LED_ON; // Blink (slower) while waiting...
		113	if (TimerEvent == 40)
		114	{
		115	LED_OFF;
		116	TimerEvent = 0;
		117	j++;
		118	}
		119
		120	for (i=0;i<8;i++)
		121	{
		122	if (!(PINB & (1<<i)))
		123	{
		124	active[i] = 1;
		125	if (sat == 9) // Select first active satellite (only once)
		126	{
		127	sat = i;
		128	SelectSat(i);
		129	}
		130
		131	}
		132	}
		133
		134	if (j == 9) break; // 9 * 40 * 8ms = ~3sec
		135	}
		136
		137	LED_OFF;
		138	_delay_ms(1000);
		139
		140	for (i=0;i<8;i++) // Flash once for every active satellite
		141	{
		142	if (active[i] == 1)
		143	{
		144	LED_ON;
		145	_delay_ms(200);
		146	LED_OFF;
		147	_delay_ms(200);
		148	}
		149	}
		150
		151
		152
		153
		154	while(1) // Main-Loop
		155	{
		156	ResetTimer();
		157
		158	while(PINB == 255) // Wait for first signal (SYNC to frame)
		159	{
		160	if (TimerEvent > 3) break; // (max. 3*8=24ms)
		161	}
		162
		163	for (i=0;i<8;i++) active[i] = 0; // Reset active-array
		164	ResetTimer();
		165
		166	while(TimerEvent < 1) // Check active satellites (for 1*8=8ms)
		167	{
		168
		169	for (i=0;i<8;i++)
		170	{
		171	if (!(PINB & (1<<i)))
		172	{
		173	active[i] = 1;
		174	}
		175	}
		176	}
		177
		178
		179	if (active[sat] == 0) // Detect fail on active satellite
		180	{
		181	LED_ON; // Failure-LED ON (never goes off again)
		182	for (i=0;i<8;i++) // Select lowest active satellite
		183	{
		184	if (active[i] == 1)
		185	{
		186	sat = i;
		187	SelectSat(sat);
		188	break;
		189	}
		190	}
		191	}
		192	}
		193	}

Subversion Repositories Projects

(root)/Spektrum-Diversity/Software/diversity.c @ 931 - Rev 775