本文整理汇总了C++中LogReader::get_check_state方法的典型用法代码示例。如果您正苦于以下问题:C++ LogReader::get_check_state方法的具体用法?C++ LogReader::get_check_state怎么用?C++ LogReader::get_check_state使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类LogReader
的用法示例。
在下文中一共展示了LogReader::get_check_state方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: log_check_solution
/*
check current solution against CHEK message
*/
void Replay::log_check_solution(void)
{
const LR_MsgHandler::CheckState &check_state = logreader.get_check_state();
Vector3f euler;
Vector3f velocity;
Location loc {};
_vehicle.EKF.getEulerAngles(euler);
_vehicle.EKF.getVelNED(velocity);
_vehicle.EKF.getLLH(loc);
float roll_error = degrees(fabsf(euler.x - check_state.euler.x));
float pitch_error = degrees(fabsf(euler.y - check_state.euler.y));
float yaw_error = wrap_180_cd(100*degrees(fabsf(euler.z - check_state.euler.z)))*0.01f;
float vel_error = (velocity - check_state.velocity).length();
float pos_error = get_distance(check_state.pos, loc);
check_result.max_roll_error = MAX(check_result.max_roll_error, roll_error);
check_result.max_pitch_error = MAX(check_result.max_pitch_error, pitch_error);
check_result.max_yaw_error = MAX(check_result.max_yaw_error, yaw_error);
check_result.max_vel_error = MAX(check_result.max_vel_error, vel_error);
check_result.max_pos_error = MAX(check_result.max_pos_error, pos_error);
}