1
0
Fork 0

Tweak control input estimation gains.

This commit is contained in:
curt 2007-06-11 20:14:40 +00:00
parent 93617f577d
commit 78cb8f5ca3

View file

@ -211,8 +211,8 @@ static void ugear2fg( gps *gpspacket, imu *imupacket, nav *navpacket,
static float est_elev = 0.0;
static float est_aileron = 0.0;
static float est_rudder = 0.0;
est_elev = 0.95 * est_elev + 0.05 * (imupacket->q * 8);
est_aileron = 0.95 * est_aileron + 0.05 * (imupacket->p * 8);
est_elev = 0.99 * est_elev + 0.01 * (imupacket->q * 10);
est_aileron = 0.95 * est_aileron + 0.05 * (imupacket->p * 5);
est_rudder = 0.95 * est_rudder + 0.05 * (imupacket->r * 8);
fdm->elevator = -est_elev;
fdm->left_aileron = est_aileron;