Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-05-25 14:35:51 +08:00
Code Issues Actions 27 Packages Projects Releases Wiki Activity

altitude initialization

Browse Source
This commit is contained in:
Pascal Brisset
2006-06-15 13:10:20 +00:00
parent 5b5a6d5936
commit fd69688e49
1 changed files with 13 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/simulator/sim.ml
+13 -5
View File
@@ -87,7 +87,7 @@ module Make(AircraftItl : AIRCRAFT_ITL) = struct
let lat0 = rad_of_deg (float_attrib flight_plan "lat0")
let lon0 = rad_of_deg (float_attrib flight_plan "lon0")
let qfu = (float_attrib flight_plan "qfu")
let alt0 = (float_attrib flight_plan "ground_alt")
let alt0 = ref (float_attrib flight_plan "ground_alt")
let pos0 = ref {Latlong.posn_lat=lat0; posn_long=lon0}
@@ -197,13 +197,21 @@ module Make(AircraftItl : AIRCRAFT_ITL) = struct
let set_pos = fun _ ->
let current_pos = Latlong.string_of !pos0 in
match GToolbox.input_string ~title:"Setting geographic position" ~text:current_pos "Geographic position" with
Some s -> pos0 := Latlong.of_string s
| _ -> ()
begin
match GToolbox.input_string ~title:"Setting geographic position" ~text:current_pos "Geographic position" with
Some s -> pos0 := Latlong.of_string s
| _ -> ()
end;
begin
let text = string_of_float !alt0 in
match GToolbox.input_string ~title:"Setting initial altitude" ~text "Geographic altitude" with
Some s -> alt0 := float_of_string s
| _ -> ()
end
in
let boot = fun () ->
Gps.set_ref !pos0 alt0;
Gps.set_ref !pos0 !alt0;
Aircraft.boot (time_scale:>value);
Stdlib.timer ~scale:time_scale fm_period fm_task;
Stdlib.timer ~scale:time_scale ir_period ir_task;