发明名称 四足机器人双足支撑相位力位混合控制方法
摘要 一种四足机器人双足支撑相位力位混合控制方法,其步骤为:S1:将机器人的整体运动投影到径向平面和法向平面上;S2:建立控制模型;机器人沿径向平面上的运动简化为平面七连杆模型,在法向平面上的运动简化为线性倒立摆模型;然后将平面七连杆模型简化为平面虚拟伸缩腿模型;平面虚拟伸缩腿模型的控制目标为质心高度、本体俯仰角以及水平位移;S3:根据控制模型进行混合控制;建立平面虚拟伸缩腿模型的运动学方程并通过牛顿-欧拉方法建立其动力学方程,对于质心高度和本体俯仰角通过位置伺服方法进行控制,对虚拟伸缩腿平面模型的水平位移采用外环位置、内环足端力的双环控制方法。本发明具有控制效果好、能够提高机器人适应能力等优点。
申请公布号 CN105242677A 申请公布日期 2016.01.13
申请号 CN201510465173.5 申请日期 2015.07.31
申请人 中国人民解放军国防科学技术大学 发明人 马宏绪;刘益彰;安宏雷;饶锦辉;韦庆;王剑;王建文;郎琳;张献鹏;许可;许佳奇
分类号 G05D1/08(2006.01)I;G05D1/02(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D1/08(2006.01)I
代理机构 湖南兆弘专利事务所 43008 代理人 周长清
主权项 一种四足机器人双足支撑相位力位混合控制方法,其特征在于,步骤为:S1:将机器人的整体运动投影到径向平面和法向平面上;所述径向平面为对脚支撑并垂直于水平面的平面;所述法向平面为通过本体质心并且垂直于径向平面的平面;S2:建立控制模型;机器人沿径向平面上的运动简化为平面七连杆模型,在法向平面上的运动简化为线性倒立摆模型;然后将平面七连杆模型简化为平面虚拟伸缩腿模型;平面虚拟伸缩腿模型的控制目标为质心高度、本体俯仰角以及水平位移;S3:根据控制模型进行混合控制;建立平面虚拟伸缩腿模型的运动学方程并通过牛顿‑欧拉方法建立其动力学方程,对于质心高度和本体俯仰角通过位置伺服控制方法,对虚拟伸缩腿平面模型的水平位移采用力控制方式。
地址 410073 湖南省长沙市砚瓦池正街47号中国人民解放军国防科学技术大学机电工程与自动化学院