Safety improvement

Barometer and GPS vertical speed are now constrained between -50 and 10m/s which are the physical limit. Any vertical speed higher or lower would just be wrong.
main
YohanHadji 2022-04-10 12:15:44 +02:00
rodzic 320e73eeb4
commit addb2d6d75
2 zmienionych plików z 2 dodań i 0 usunięć

Wyświetl plik

@ -73,6 +73,7 @@ void cmpt_vertical_speed_baro(float da, int dt) {
baro_vspeed = (da/(dt/1000.0));
baro_vspeed = b_vs.reading(baro_vspeed*100);
baro_vspeed = (baro_vspeed/100);
baro_vspeed = constrain(baro_vspeed, -50, 10);
}
void get_baro(int mode) {

Wyświetl plik

@ -22,6 +22,7 @@ void cmpt_vertical_speed_gps(float da, int dt) {
gps_vspeed = (da/(dt/1000.0));
gps_vspeed = g_vs.reading(gps_vspeed*100);
gps_vspeed = (gps_vspeed/100);
gps_vspeed = constrain(gps_vspeed, -50, 10);
}
void get_gps() {