aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_TECS: update for AHRS API change

Browse Source
This commit is contained in:
Andrew Tridgell 2013-11-04 14:36:25 +11:00
parent 4e82a8e1d4
commit 28a4b6ad9f
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_TECS/AP_TECS.cpp
View File

@ -176,7 +176,7 @@ void AP_TECS::update_50hz(float hgt_afe)
// Get DCM // Get DCM
const Matrix3f &rotMat = _ahrs.get_dcm_matrix(); const Matrix3f &rotMat = _ahrs.get_dcm_matrix();
// Calculate speed rate of change // Calculate speed rate of change
temp = rotMat.c.x * GRAVITY_MSS + _ahrs.get_ins()->get_accel().x; temp = rotMat.c.x * GRAVITY_MSS + _ahrs.get_ins().get_accel().x;
// take 5 point moving average // take 5 point moving average
_vel_dot = _vdot_filter.apply(temp); _vel_dot = _vdot_filter.apply(temp);
} else { } else {