diff options
author | Anton Babushkin <anton.babushkin@me.com> | 2014-01-24 00:06:10 +0100 |
---|---|---|
committer | Anton Babushkin <anton.babushkin@me.com> | 2014-01-24 00:06:10 +0100 |
commit | 58792c5ca6e42bc251dd3c92b0e79217ff5d5403 (patch) | |
tree | ea46289f1159857c26ea40f71674a3bbb06cec8e /src/drivers/frsky_telemetry | |
parent | b3d98e4a19662af44432a0436a1b5de7fb9649c9 (diff) | |
download | px4-firmware-58792c5ca6e42bc251dd3c92b0e79217ff5d5403.tar.gz px4-firmware-58792c5ca6e42bc251dd3c92b0e79217ff5d5403.tar.bz2 px4-firmware-58792c5ca6e42bc251dd3c92b0e79217ff5d5403.zip |
Use double for lat/lon in vehicle_global_position topic, use filed names lat, lon, alt, vel_n, vel_e, vel_d for global positions
Diffstat (limited to 'src/drivers/frsky_telemetry')
-rw-r--r-- | src/drivers/frsky_telemetry/frsky_data.c | 6 |
1 files changed, 3 insertions, 3 deletions
diff --git a/src/drivers/frsky_telemetry/frsky_data.c b/src/drivers/frsky_telemetry/frsky_data.c index 63b2d2d29..e201ecbb3 100644 --- a/src/drivers/frsky_telemetry/frsky_data.c +++ b/src/drivers/frsky_telemetry/frsky_data.c @@ -230,11 +230,11 @@ void frsky_send_frame2(int uart) struct tm *tm_gps = gmtime(&time_gps); course = (global_pos.yaw + M_PI_F) / M_PI_F * 180.0f; - lat = frsky_format_gps(abs(global_pos.lat) / 10000000.0f); + lat = frsky_format_gps(abs(global_pos.lat)); lat_ns = (global_pos.lat < 0) ? 'S' : 'N'; - lon = frsky_format_gps(abs(global_pos.lon) / 10000000.0f); + lon = frsky_format_gps(abs(global_pos.lon)); lon_ew = (global_pos.lon < 0) ? 'W' : 'E'; - speed = sqrtf(global_pos.vx * global_pos.vx + global_pos.vy * global_pos.vy) + speed = sqrtf(global_pos.vel_n * global_pos.vel_n + global_pos.vel_e * global_pos.vel_e) * 25.0f / 46.0f; alt = global_pos.alt; sec = tm_gps->tm_sec; |