mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-11 10:28:29 -04:00
AP_LeadFilter: bug fix so velocity * _lag is used (otherwise we are assuming a 1sec lag)
This commit is contained in:
parent
2c36693a50
commit
2110231ee3
@ -40,5 +40,5 @@ AP_LeadFilter::get_position(int32_t pos, int16_t vel)
|
|||||||
// store velocity for next iteration
|
// store velocity for next iteration
|
||||||
_last_velocity = vel;
|
_last_velocity = vel;
|
||||||
|
|
||||||
return pos + vel + accel_contribution;
|
return pos + vel_contribution + accel_contribution;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user