Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Lead Filter: simplified calculation

This commit is contained in:
Jason Short 2012-07-18 11:09:05 -07:00
parent 819b6459b2
commit 148da2e4a0
1 changed files with 12 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
libraries/AP_LeadFilter/AP_LeadFilter.cpp
View File

@ -17,7 +17,7 @@
#include "AP_LeadFilter.h"
// setup the control preferences
/*
int32_t
AP_LeadFilter::get_position(int32_t pos, int16_t vel)
{
@ -27,3 +27,14 @@ AP_LeadFilter::get_position(int32_t pos, int16_t vel)
_last_velocity = vel;
return pos;
}
*/
// setup the control preferences
int32_t
AP_LeadFilter::get_position(int32_t pos, int16_t vel)
{
// assumes a 1 second delay in the GPS
int16_t acc = vel - _last_velocity;
_last_velocity = vel;
return pos + vel + acc;
}