二子样旋转矢量姿态算法IP核
摘要:
本发明公开了种二子样旋转矢量姿态算法IP核,包括422接口模块、角增量模块、等效旋转矢量模块、变换四元数模块、四元数更新模块、计算姿态角模块,其中422接口模块又包括分频模块、422接收模块、帧校验模块、FIFO存储发送模块、姿态角输出模块、运算结果分解模块、422输出模块;所述分频模块分别与422接收模块、运算结果分解模块、422输出模块相连;422接收模块通过帧校验模块、FIFO存储发送模块接入角增量模块;角增量模块与等效旋转矢量模块、变换四元数模块、四元数更新模块顺次连接,四元数更新模块分别接入计算姿态角模块和角增量模块;计算姿态角模块依次通过姿态角输出模块、运算结果分解模块接入422输出模块。本发明运行周期短、精度高,为高速姿态测量组件的实现提供可行性。
公开/授权文献
0/0