/*
-pins, 2 recorders 4 inputs each
*/
+// debug on serial
#define DEBUG 1
-#define REC_1_A A0
-#define REC_1_B A1
-#define REC_1_C A2
-#define REC_1_D A3
+// serial commands for loop-back test
+#define TEST 1
-#define REC_2_A A4
-#define REC_2_B A5
-#define REC_2_C A6
-#define REC_2_D A7
+// pins, 2 receivers 4 satelites signals from Diseqc for each
+int receiver[2][4] = {
+ { A0, A1, A2, A3 },
+ { A4, A5, A6, A7 },
+};
+// pin for master disable if shorted to ground (GND is next to D2, so jumpers nicely)
#define REC_MASTER 2
+// normal arduino LED on D13
#define LED 13
+// rec1 rec2 master
+// keys in serial: 1 2 3 4 5 6 7 8 9
+int test_pins[] = { 12,11,10,9, 8,7,6,5, 4 };
+int test_out[] = { 0, 0, 0,0, 0,0,0,0, 1};
+int nr_test_pins = sizeof(test_pins)/sizeof(int);
+// loop test pins to receiver pins above for testing
+
+int master_enabled() {
+ return digitalRead(REC_MASTER) == HIGH ? 1 : 0;
+}
+
void setup(){
Serial.begin(9600); // FIXME check speed
pinMode(REC_MASTER, INPUT_PULLUP); // pullup for jumper/button
- pinMode(REC_1_A, INPUT);
- pinMode(REC_1_B, INPUT);
- pinMode(REC_1_C, INPUT);
- pinMode(REC_1_D, INPUT);
-
- pinMode(REC_2_A, INPUT);
- pinMode(REC_2_B, INPUT);
- pinMode(REC_2_C, INPUT);
- pinMode(REC_2_D, INPUT);
+ for(int nr=0; nr<2; nr++) {
+ for(int input=0; input<4; input++) {
+ pinMode(receiver[nr][input], INPUT);
+ }
+ }
pinMode(LED, OUTPUT);
#if DEBUG
Serial.print("boot master=");
- Serial.println(digitalRead(REC_MASTER) == HIGH );
+ Serial.println(master_enabled());
+#endif
+
+#if TEST
+ for(int i=0;i<nr_test_pins;i++) {
+ pinMode(test_pins[i], OUTPUT);
+ digitalWrite(test_pins[i], test_out[i]);
+ }
#endif
}
-int recorder_inputs( int PinA, int PinB, int PinC, int PinD ) {
- int StateA = digitalRead( PinA ) == HIGH;
- int StateB = digitalRead( PinB ) == HIGH;
- int StateC = digitalRead( PinC ) == HIGH;
- int StateD = digitalRead( PinD ) == HIGH;
-
-#ifdef DEBUG
- Serial.print("<");
- Serial.print(StateA);
- Serial.print(StateB);
- Serial.print(StateC);
- Serial.print(StateD);
+char restore[10] = "";
+char len = 0;
+
+int receiver_satelite( int nr ) {
+
+ #ifdef DEBUG
+ Serial.print("|<");
+ #endif
+
+ if ( nr == 0 ) {
+ len = 0;
+ if ( ! master_enabled() ) restore[len++] = '9';
+ }
+
+ int active = 0;
+ int selected = -1;
+
+ for(int i=0; i<4; i++) {
+ int a = analogRead( receiver[nr][i] );
+ int on_off = a > 512 ? 1 : 0;
+ active += on_off;
+ if ( on_off ) {
+ selected = i+1;
+ restore[len++] = char('1' + (nr * 4) + i);
+ }
+
+ //Serial.print(a);
+ //Serial.print("~");
+ Serial.print(on_off);
+ //Serial.print(" ");
+ }
+ restore[len] = 0;
+
Serial.print(">");
-#endif
- if ( StateA + StateB + StateC + StateD != 1 ) { // only one active at a time
- return -1; // error
+ if ( active == 0 ) { // no inputs active
+ return 0;
}
- if ( StateA ) {
- return 1;
- } else if ( StateB ) {
- return 2;
- } else if ( StateC ) {
- return 3;
- } else if ( StateD ) {
- return 4;
+ if ( active != 1 ) { // only one active at a time
+ return -1; // error
}
- return 0; // receiver off
+ Serial.print(" selected=");
+ Serial.print(selected);
+
+ return selected;
}
#define LED_NO_ACTIVE_INPUTS 2000
#define LED_MULTIPLE_INPUTS 125
-#define LED_SERIAL 250
+#define LED_SERIAL 200 // < 250
#define LED_OFF 0
int current_sat = 0;
int blink_interval = LED_NO_ACTIVE_INPUTS; // 2 sec on/off no receivers turned on
-
+int last_changed_nr = -1;
+int last_receiver_satelite[2] = { -1, -1 };
void loop(){
-
- int sat = recorder_inputs( REC_1_A, REC_1_B, REC_1_C, REC_1_D );
- volatile int try_slave = 1;
-again_for_slave:
+ int nr = 1;
-#if DEBUG
- Serial.print(" r1 ");
- Serial.print(sat);
-#endif
+ while(nr && nr <= 2) {
+ int i = nr - 1;
- if ( sat == 0 ) { // slow blink
- blink_interval = LED_NO_ACTIVE_INPUTS;
- } else if ( sat < 0 ) { // error
- blink_interval = LED_MULTIPLE_INPUTS;
- } else {
+ int current_nr = nr;
- if ( digitalRead(REC_MASTER) == HIGH ) {
- try_slave = 0;
- Serial.print("M");
- }
+ int sat = receiver_satelite(i);
+ int last_sat = last_receiver_satelite[i];
+ last_receiver_satelite[i] = sat;
+
+ #if DEBUG
+ Serial.print(" nr:");
+ Serial.print(nr);
+ Serial.print("=");
+ Serial.print(sat);
+ Serial.print(" last:");
+ Serial.print(last_sat);
+ #endif
+
+ int prefer_master = master_enabled();
+ if ( ! prefer_master ) {
- if ( current_sat != sat ) {
+ if ( last_sat != sat ) {
- current_sat = sat;
+ Serial.print("C");
+ last_changed_nr = current_nr;
+ if ( sat == 0 ) {
+ Serial.print("off");
+ sat = receiver_satelite( (i+1)%2 ); // check other receiver
+ }
+ nr=0; // stop
+
+ } else {
+
+ Serial.print("=");
+ nr++; // next
+ continue;
+
+ }
+
+ if ( last_changed_nr != current_nr ) {
+ sat = current_sat; // ignore, last not changed
+ Serial.print("I");
+ }
+
+ }
+
+ if ( sat == 0 ) { // slow blink
+ blink_interval = LED_NO_ACTIVE_INPUTS;
+ nr++; // next
+ } else if ( sat < 0 ) { // error
+ blink_interval = LED_MULTIPLE_INPUTS;
+ nr = 0;
+ } else {
blink_interval = LED_OFF;
+
+ if ( prefer_master ) {
+ #if DEBUG
+ Serial.print("[M]");
+ #endif
+ if ( nr == 1 ) { // need to check 2nd receiver error and report it
+ int error = receiver_satelite(i + 1);
+ Serial.print(" E?");
+ Serial.print(error);
+ if ( error == -1 ) blink_interval = LED_MULTIPLE_INPUTS;
+ }
+ nr = 0; // stop
+ } else {
+ if ( last_sat != sat ) {
+ Serial.print("[C]");
+ last_changed_nr = current_nr;
+ nr=0;
+ } else {
+ Serial.print("[S]");
+ nr++;
+ }
+
+ if ( last_changed_nr != current_nr ) {
+ sat = current_sat; // ignore, last not changed
+ Serial.print("[I]");
+ }
+
+ }
- for(int repeat=0; repeat<2; repeat++) {
+ if ( current_sat != sat ) {
- Serial.print("@L,");
- Serial.println( char('A' - 1 + sat) );
+ last_changed_nr = current_nr;
+ current_sat = sat;
+ nr = 0; // stop
- for(int i=0; i<sat; i++) {
- digitalWrite(LED, HIGH);
- delay(LED_SERIAL);
- digitalWrite(LED, LOW);
- delay(LED_SERIAL);
+ for(int repeat=0; repeat<2; repeat++) {
+
+ Serial.print("@L,");
+ Serial.println( char('A' + sat - 1) );
+
+ for(int i=0; i<sat; i++) {
+ digitalWrite(LED, HIGH);
+ delay(LED_SERIAL);
+ digitalWrite(LED, LOW);
+ delay(LED_SERIAL);
+ }
+ delay( ( 5 - sat ) * LED_SERIAL * 2 ); // sleep up to 2s
+ //assert(4 * LED_SERIAL < 2000);
}
- delay( 2000 - sat * LED_SERIAL ); // sleep up to 2s
- //assert(4 * LED_SERIAL < 2000);
+
}
- }
- }
+ } // while
- if ( try_slave == 1 ) {
- try_slave = 0;
- sat = recorder_inputs( REC_2_A, REC_2_B, REC_2_C, REC_2_D );
-#if DEBUG
- Serial.print(" r2 ");
- Serial.print(sat);
-#endif
- goto again_for_slave;
}
-#if DEBUG
- Serial.print(" sat=");
+
+ #if DEBUG
+ Serial.print("| sat=");
Serial.print(current_sat);
+ Serial.print(" from:");
+ Serial.print(last_changed_nr);
+ Serial.print(" restore>");
+ Serial.print(restore);
Serial.print(" blink=");
Serial.println(blink_interval);
-#endif
+ #endif
// handle next led blink event in time
int m = millis() % ( blink_interval * 2 );
} else {
digitalWrite(LED, LOW);
}
-}
+ #if TEST
+ while ( Serial.available() ) {
+ int serial = Serial.read();
+ Serial.print(serial, HEX);
+ if ( serial >= '1' && serial <= ( '1' + nr_test_pins ) ) {
+ int nr = serial - '1';
+ Serial.print(" toggle pin ");
+ test_out[nr] = ! test_out[nr];
+ int pin = test_pins[nr];
+ Serial.print(pin);
+ Serial.print("=");
+ int out = test_out[nr];
+ Serial.print(out);
+ digitalWrite( pin, out );
+ }
+ Serial.print(" <");
+ for(int i=0;i<nr_test_pins;i++) {
+ if ( i == 4 || i == 8 ) Serial.print(" ");
+ Serial.print(test_out[i]);
+ }
+ Serial.println(">");
+ }
+ #endif
+}
+// vim: tabstop=2 shiftwidth=2 expandtab
projects / Arduino / blobdiff