加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
文件
克隆/下载
qq2phi.m 656 Bytes
一键复制 编辑 原始数据 按行查看 历史
ZhangZh3ng 提交于 2020-10-12 20:55 . version 1.0
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
Loading...
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化