sync rawgps test with APM 2x rawgps test

git-svn-id: https://arducopter.googlecode.com/svn/trunk@2501 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
dhcorley@msn.com 2011-06-06 13:35:46 +00:00
parent 7925c97354
commit 732a36960e

View File

@ -780,18 +780,23 @@ test_wp(uint8_t argc, const Menu::arg *argv)
static int8_t
test_rawgps(uint8_t argc, const Menu::arg *argv)
{
print_hit_enter();
delay(1000);
print_hit_enter();
delay(1000);
while(1){
if (Serial1.available()){
digitalWrite(B_LED_PIN, HIGH); // Blink Yellow LED if we are sending data to GPS
Serial.write(Serial1.read());
digitalWrite(B_LED_PIN, LOW);
}
if(Serial.available() > 0){
return (0);
}
while(1){
if (Serial3.available()){
digitalWrite(B_LED_PIN, HIGH); // Blink Yellow LED if we are sending data to GPS
Serial1.write(Serial3.read());
digitalWrite(B_LED_PIN, LOW);
}
if (Serial1.available()){
digitalWrite(C_LED_PIN, HIGH); // Blink Red LED if we are receiving data from GPS
Serial3.write(Serial1.read());
digitalWrite(C_LED_PIN, LOW);
}
if(Serial.available() > 0){
return (0);
}
}
}