kopia lustrzana https://github.com/YohanHadji/R2Home
Fix minor glitches and improve GPS vertical speed precision
rodzic
5f9096c2a7
commit
ffd806f3d6
|
@ -39,8 +39,8 @@ void flight_init() {
|
||||||
}
|
}
|
||||||
|
|
||||||
baroset(gps.altitude.meters(), 1);
|
baroset(gps.altitude.meters(), 1);
|
||||||
|
get_baro(1);
|
||||||
get_baro(1);
|
cmpt_fusion();
|
||||||
|
|
||||||
b_vs.reset();
|
b_vs.reset();
|
||||||
b_al.reset();
|
b_al.reset();
|
||||||
|
|
|
@ -46,7 +46,7 @@ void get_gps() {
|
||||||
}
|
}
|
||||||
|
|
||||||
if (gps.altitude.isUpdated()) {
|
if (gps.altitude.isUpdated()) {
|
||||||
cmpt_vertical_speed_gps(gps.altitude.meters()-prev_alt_gps, millis()-gpsB);
|
cmpt_vertical_speed_gps(gps.altitude.meters()-prev_alt_gps, (millis()-gps.altitude.age())-gpsB);
|
||||||
gpsB = millis();
|
gpsB = millis();
|
||||||
prev_alt_gps = gps.altitude.meters();
|
prev_alt_gps = gps.altitude.meters();
|
||||||
new_gps = true;
|
new_gps = true;
|
||||||
|
|
|
@ -92,7 +92,9 @@ void datacmpt() {
|
||||||
|
|
||||||
cmpt_flight_state();
|
cmpt_flight_state();
|
||||||
cmpt_data_rate(flight_mode);
|
cmpt_data_rate(flight_mode);
|
||||||
cmpt_fusion();
|
if (initialised) {
|
||||||
|
cmpt_fusion();
|
||||||
|
}
|
||||||
cmpt_vertical_state();
|
cmpt_vertical_state();
|
||||||
|
|
||||||
if ((millis()-sd)>=delaySD) {
|
if ((millis()-sd)>=delaySD) {
|
||||||
|
|
Ładowanie…
Reference in New Issue