一种人体关节角度解算方法及装置

发布时间：2018年09月30日 分类：专利

本发明涉及一种基于四元数的人体关节角度解算方法及装置。所述方法包括：获取第一采集点的初始四元数和第二采集点的初始四元数；利用所述第一采集点的初始四元数和所述第二采集点的初始四元数计算两者的初始偏置四元数；获取每个采集周期内第一采集点的当前四元数和第二采集点的当前四元数；利用所述第一采集点的当前四元数和所述第二采集点的当前四元数计算两者的绝对偏置四元数；计算当前时刻下所述第一采集点和所述第二采集点的相对偏置四元数；根据上述相对偏置四元数解算右臂肘关节在三轴方向上的相对转角。所述装置基于上述方法实现。本发明可以利用两个采集点的四元数解算到人体关节在三轴方向上相对于初始位置的实时角度变化，实现基于人体姿态的机器人随动控制。

CN201610628545-一种人体关节角度解算方法及装置-申请公开.pdf