• Patent Title: 一种仿人机器人身体姿态角度实时估计方法
  • Patent Title (English): Method for estimating body posture angle of humanoid robot in real time
  • Application No.: CN201010597601.7
    Application Date: 2010-12-21
  • Publication No.: CN102121828B
    Publication Date: 2012-12-19
  • Inventor: 相远飞熊蓉
  • Applicant: 浙江大学
  • Applicant Address: 浙江省杭州市西湖区浙大路38号
  • Assignee: 浙江大学
  • Current Assignee: 浙江大学
  • Current Assignee Address: 浙江省杭州市西湖区浙大路38号
  • Agency: 杭州求是专利事务所有限公司
  • Agent 周烽
  • Main IPC: G01C21/16
  • IPC: G01C21/16
一种仿人机器人身体姿态角度实时估计方法
Abstract:
本发明公开了一种仿人机器人身体姿态角度实时估计方法,该方法首先建立机器人姿态的运动学模型;然后根据机器人姿态的运动学模型,建立带噪声的线性离散随机系统模型,利用卡尔曼滤波的相应方法,基于三轴加速度计的加速度数据,三轴陀螺仪的角速度数据和六维力/力矩传感器三维力数据估计机器人的姿态状态,再根据估计的机器人姿态信息,得到机器人实际的姿态角度,从而矫正机器人当前的姿态;本方法克服了角速度积分的漂移以及传统线性化方法测量范围较小的缺陷,实现了仿人机器人姿态实时准确的估计。
Public/Granted literature
Patent Agency Ranking
0/0