You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
70 lines
1.5 KiB
70 lines
1.5 KiB
#if DEBUG_SUBSYSTEM == 1 |
|
void debug_subsystem() |
|
{ |
|
Serial.println("GPS Subsystem, RAW OUTPUT"); |
|
|
|
while(1){ |
|
if(Serial1.available() > 0) // Ok, let me see, the buffer is empty? |
|
{ |
|
delay(60); // wait for it all |
|
while(Serial1.available() > 0){ |
|
byte incoming = Serial1.read(); |
|
//Serial.print(incoming,DEC); |
|
Serial.print(incoming, BYTE); // will output Hex values |
|
//Serial.print(","); |
|
} |
|
Serial.println(" "); |
|
} |
|
|
|
} |
|
} |
|
#endif |
|
|
|
#if DEBUG_SUBSYSTEM == 2 |
|
void debug_subsystem() |
|
{ |
|
Serial.println("Control Switch"); |
|
|
|
Serial.print("Control CH "); |
|
Serial.println(flight_mode_channel, DEC); |
|
|
|
while(1){ |
|
delay(20); |
|
byte switchPosition = readSwitch(); |
|
if (oldSwitchPosition != switchPosition){ |
|
Serial.printf_P(PSTR("Position %d\n"), i, switchPosition); |
|
oldSwitchPosition = switchPosition; |
|
} |
|
} |
|
} |
|
#endif |
|
|
|
#if DEBUG_SUBSYSTEM == 3 |
|
void debug_subsystem() |
|
{ |
|
Serial.println("DIP Switch Test"); |
|
|
|
while(1){ |
|
delay(100); |
|
update_servo_switches(); |
|
if (mix_mode == 0) { |
|
Serial.print("Mix:standard "); |
|
Serial.print("\t reverse_roll: "); |
|
Serial.print(reverse_roll, DEC); |
|
Serial.print("\t reverse_pitch: "); |
|
Serial.print(reverse_pitch, DEC); |
|
Serial.print("\t reverse_rudder: "); |
|
Serial.println(reverse_rudder, DEC); |
|
} else { |
|
Serial.print("Mix:elevons "); |
|
Serial.print("\t reverse_elevons: "); |
|
Serial.print(reverse_elevons, DEC); |
|
Serial.print("\t reverse_ch1_elevon: "); |
|
Serial.print(reverse_ch1_elevon, DEC); |
|
Serial.print("\t reverse_ch2_elevon: "); |
|
Serial.println(reverse_ch2_elevon, DEC); |
|
} |
|
} |
|
} |
|
#endif |
|
|
|
|