Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-06-07 17:49:49 +08:00
Code Issues Actions 28 Packages Projects Releases Wiki Activity

*** empty log message ***

Browse Source
This commit is contained in:
Antoine Drouin
2008-09-08 16:19:53 +00:00
parent c1bd5b0078
commit f492b50dba
1 changed files with 4 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/ground_segment/tmtc/booz_translator.ml
+4 -4
View File
@@ -36,20 +36,20 @@ let get_fp = fun _ values ->
and phi = i32value "phi"
and theta = i32value "theta"
and psi = i32value "psi" in
(*let utm = Latlong.utm_of Latlong.WGS84 (Latlong.make_geo lat lon) in*)
let utm = Latlong.utm_of Latlong.WGS84 (Latlong.make_geo_deg lat lon) in
let gspeed = sqrt(vnorth*.vnorth +. veast*.veast) in
let power_12 = 1 lsl 12 in
let gps_values = [
"mode", Pprz.Int !gps_status;
"utm_east", Pprz.Int32 (Int32.of_int 0) (* (Int32.of_float (utm.Latlong.utm_x *. 100.))*);
"utm_north", Pprz.Int32 (Int32.of_int 0) (* (Int32.of_float (utm.Latlong.utm_y *. 100.))*);
"utm_east", Pprz.Int32 (Int32.of_float (utm.Latlong.utm_x *. 100.));
"utm_north", Pprz.Int32 (Int32.of_float (utm.Latlong.utm_y *. 100.));
"course", Pprz.Int (573 * (Int32.to_int psi) / power_12);
"alt", Pprz.Int 0;
"speed", Pprz.Int (int_of_float gspeed);
"climb", Pprz.Int 0;
"itow", Pprz.Int32 (Int32.of_int 0);
"utm_zone", Pprz.Int 0;
"utm_zone", Pprz.Int utm.Latlong.utm_zone;
"gps_nb_err", Pprz.Int 0] in
Tm_Pprz.message_send ac_id "GPS" gps_values;