|
|
@ -40,26 +40,26 @@ void loop() |
|
|
|
if (gps.new_data) { |
|
|
|
if (gps.new_data) { |
|
|
|
hal.console->print("gps:"); |
|
|
|
hal.console->print("gps:"); |
|
|
|
hal.console->print(" Lat:"); |
|
|
|
hal.console->print(" Lat:"); |
|
|
|
hal.console->print((float)gps.latitude / T7, DEC); |
|
|
|
hal.console->print((float)gps.latitude / T7, BASE_DEC); |
|
|
|
hal.console->print(" Lon:"); |
|
|
|
hal.console->print(" Lon:"); |
|
|
|
hal.console->print((float)gps.longitude / T7, DEC); |
|
|
|
hal.console->print((float)gps.longitude / T7, BASE_DEC); |
|
|
|
hal.console->print(" Alt:"); |
|
|
|
hal.console->print(" Alt:"); |
|
|
|
hal.console->print((float)gps.altitude_cm / 100.0, DEC); |
|
|
|
hal.console->print((float)gps.altitude_cm / 100.0, BASE_DEC); |
|
|
|
hal.console->print(" GSP:"); |
|
|
|
hal.console->print(" GSP:"); |
|
|
|
hal.console->print(gps.ground_speed_cm / 100.0); |
|
|
|
hal.console->print(gps.ground_speed_cm / 100.0); |
|
|
|
hal.console->print(" COG:"); |
|
|
|
hal.console->print(" COG:"); |
|
|
|
hal.console->print(gps.ground_course_cd / 100.0, DEC); |
|
|
|
hal.console->print(gps.ground_course_cd / 100.0, BASE_DEC); |
|
|
|
Vector2f vel = Vector2f(gps.velocity_north(), gps.velocity_east()); |
|
|
|
Vector2f vel = Vector2f(gps.velocity_north(), gps.velocity_east()); |
|
|
|
hal.console->printf(" VEL: %.2f %.2f %.2f", |
|
|
|
hal.console->printf(" VEL: %.2f %.2f %.2f", |
|
|
|
vel.x, |
|
|
|
vel.x, |
|
|
|
vel.y, |
|
|
|
vel.y, |
|
|
|
vel.length()); |
|
|
|
vel.length()); |
|
|
|
hal.console->print(" SAT:"); |
|
|
|
hal.console->print(" SAT:"); |
|
|
|
hal.console->print(gps.num_sats, DEC); |
|
|
|
hal.console->print(gps.num_sats, BASE_DEC); |
|
|
|
hal.console->print(" FIX:"); |
|
|
|
hal.console->print(" FIX:"); |
|
|
|
hal.console->print(gps.fix, DEC); |
|
|
|
hal.console->print(gps.fix, BASE_DEC); |
|
|
|
hal.console->print(" TIM:"); |
|
|
|
hal.console->print(" TIM:"); |
|
|
|
hal.console->print(gps.time, DEC); |
|
|
|
hal.console->print(gps.time, BASE_DEC); |
|
|
|
hal.console->println(); |
|
|
|
hal.console->println(); |
|
|
|
gps.new_data = 0; // We have readed the data |
|
|
|
gps.new_data = 0; // We have readed the data |
|
|
|
} |
|
|
|
} |
|
|
|