Optical flow: compute velociy from corrected flow data for logging (#920)

This is really useful when debugging optical flow data
This commit is contained in:
Mathieu Bresciani
2020-10-26 13:27:52 +01:00
committed by GitHub
parent 9126282c03
commit dd3ffc4192
4 changed files with 44 additions and 0 deletions
+25
View File
@@ -708,6 +708,31 @@ void Ekf::getFlowInnovRatio(float &flow_innov_ratio) const
flow_innov_ratio = _optflow_test_ratio;
}
Vector2f Ekf::getFlowVelBody() const
{
return _flow_vel_body;
}
Vector2f Ekf::getFlowVelNE() const
{
return _flow_vel_ne;
}
Vector2f Ekf::getFlowCompensated() const
{
return _flow_compensated_XY_rad;
}
Vector2f Ekf::getFlowUncompensated() const
{
return _flow_sample_delayed.flow_xy_rad;
}
Vector3f Ekf::getFlowGyro() const
{
return _flow_sample_delayed.gyro_xyz;
}
void Ekf::getHeadingInnov(float &heading_innov) const
{
heading_innov = _heading_innov;