一种足式机器人地形参数的测量方法及系统

摘要

本发明涉及一种足式机器人地形参数的测量方法及系统，包括：计算足式机器人的支撑腿足端位置单位矢量；根据单位矢量计算大地相对于世界坐标系的法向量；根据大地相对于世界坐标系的法向量计算地形参数。本发明的测量方法仅仅利用足式机器人运动控制所必须的传感器信息即可计算出所处地形的地形参数，包括翻滚角以及俯仰角的姿态角，可满足足式机器人运动控制的要求，简单易行、精度高。