代码拉取完成,页面将自动刷新
同步操作将从 ln920171519/惯性导航程序与讲解 强制同步,此操作会覆盖自 Fork 仓库以来所做的任何修改,且无法恢复!!!
确定后同步将在后台操作,完成时将刷新页面,请耐心等待。
function [ phi ] = qq2phi( qbp, qbn )
%% **************************************************************
%名称:Quaternion Quaternion to PHI
%功能:计算含有误差的姿态四元数和真值之间对应的等效旋转矢量
%________________________________________________________________________
% 输入:
% qbp: 含有误差的姿态四元数
% qbn: 真实姿态四元数
% 输出:
% phi: n系到p系的等效旋转矢量
%_________________________________________________________________________
%作者:哈尔滨工程大学 自动化学院 张峥
%日期:2020年10月3日
% ************************************************************************
%%
qerr = qmul(qbn, qconj(qbp));
phi = q2rv(qerr);
end
此处可能存在不合适展示的内容,页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容,可点击提交进行申诉,我们将尽快为您处理。