X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=altosui%2FAltosState.java;h=9c6f85ebb4361cb900f3122ed04bd2b7b0c78492;hb=c9e52287751867d9e451146ccde78109609d30d7;hp=d374aed8e5d410e32fb34c30c3f291f8ea8e81f9;hpb=11a2bb8e28df7ed87542f2ee726f877971f5d52a;p=fw%2Faltos diff --git a/altosui/AltosState.java b/altosui/AltosState.java index d374aed8..9c6f85eb 100644 --- a/altosui/AltosState.java +++ b/altosui/AltosState.java @@ -28,12 +28,14 @@ public class AltosState { long report_time; + double time; double time_change; int tick; int state; boolean landed; boolean ascent; /* going up? */ + boolean boost; /* under power */ double ground_altitude; double height; @@ -48,9 +50,13 @@ public class AltosState { double max_height; double max_acceleration; double max_speed; + double max_baro_speed; AltosGPS gps; + AltosIMU imu; + AltosMag mag; + double pad_lat; double pad_lon; double pad_alt; @@ -71,7 +77,6 @@ public class AltosState { int speak_tick; double speak_altitude; - void init (AltosRecord cur, AltosState prev_state) { int i; AltosRecord prev; @@ -104,6 +109,9 @@ public class AltosState { max_height = prev_state.max_height; max_acceleration = prev_state.max_acceleration; max_speed = prev_state.max_speed; + max_baro_speed = prev_state.max_baro_speed; + imu = prev_state.imu; + mag = prev_state.mag; /* make sure the clock is monotonic */ while (tick < prev_state.tick) @@ -130,7 +138,9 @@ public class AltosState { time_change = 0; } - if (state == Altos.ao_flight_pad || state == Altos.ao_flight_idle) { + time = tick / 100.0; + + if (cur.new_gps && (state == Altos.ao_flight_pad || state == Altos.ao_flight_idle)) { /* Track consecutive 'good' gps reports, waiting for 10 of them */ if (data.gps != null && data.gps.locked && data.gps.nsat >= 4) @@ -162,12 +172,15 @@ public class AltosState { ascent = (Altos.ao_flight_boost <= state && state <= Altos.ao_flight_coast); + boost = (Altos.ao_flight_boost == state); - /* Only look at accelerometer data on the way up */ - if (ascent && acceleration > max_acceleration) + /* Only look at accelerometer data under boost */ + if (boost && acceleration > max_acceleration) max_acceleration = acceleration; - if (ascent && speed > max_speed) + if (boost && speed > max_speed) max_speed = speed; + if (boost && baro_speed > max_baro_speed) + max_baro_speed = baro_speed; if (height > max_height) max_height = height;