kopia lustrzana https://github.com/YohanHadji/R2Home
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
rodzic
320e73eeb4
commit
addb2d6d75
|
@ -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) {
|
||||
|
|
|
@ -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() {
|
||||
|
|
Ładowanie…
Reference in New Issue