一种双足机器人足部力和力矩跟随控制方法技术

本发明专利技术公开了一种双足机器人足部力和力矩跟随控制方法，该方法设计了双弹簧阻尼模型，并用LQR优化方法设计力跟随控制器，实现了双足机器人足部受力和力矩的跟随；而足部期望受力、足部期望力矩由规划ZMP分配方法计算得到，最终使得双足机器人的ZMP跟随更好，且能够适应一定的不平整地面。本发明专利技术舍弃了传统的ZMP跟随以实现双足机器人稳定行走和不平整地面适应的控制方式，直接计算使机器人稳定行走的足部期望受力和受力矩，并直接控制实现足部受力和受力矩的跟随，从更加本质、更容易实现的方式进行稳定控制，控制响应更快，适应不平整地面的能力更强，而ZMP跟随效果很理想。

A Foot Force and Torque Following Control Method for Biped Robots

【技术实现步骤摘要】
一种双足机器人足部力和力矩跟随控制方法
本专利技术属于机器人
，具体涉及一种双足机器人足部力和力矩跟随控制方法。
技术介绍
零力矩点ZMP是双足机器人研究中非常重要的概念，其对双足机器人的行走规划、稳定等有举足轻重的作用。评估双足机器人行走是否的稳定地一个重要手段是实际ZMP是否能够良好地跟随规划的ZMP。而足部受到的力和力矩可以体现机器人的ZMP情况，一般也是通过足部受到的力和力矩来计算机器人在平地上行走时实际的ZMP，故可以通过控制机器人实际的足部力和力矩，使其能够跟随规划的力和力矩，以此来实现ZMP的跟随，并使机器人行走地更加稳定。这个方法从物理的角度来看，能够使得足部一直提供机器人稳定行走所需要的力和力矩，所以理论上还能实现让机器人在任意不平整地面上行走的效果，但由于机器人系统带来的滞后以及冲击带来的各种误差，力和力矩的控制效果无法达到理论的理想状态，机器人只能适应较小的地面起伏，但对于位置控制机器人来说，这也是很难得可贵的。现有技术公开了双足机器人不平整地面行走的稳定控制方法，该方法结合柔顺控制，能够减小机器人足部着地冲击，以保证足部落地时的ZMP在脚底板支撑域内，以满足机器人稳定行走条件，但没有考虑ZMP能够尽量跟随规划值，更没有考虑足部力和力矩的跟随情况，仅仅控制ZMP在支撑域内，是无法解决机器人在不平整地面上行走的稳定性问题的。现有技术公开了一种基于全身动量补偿的ZMP跟随方法，能够利用全身关节的转动产生的动量来补偿ZMP的差值，但未考虑机器人在不平整地面上行走的状况，也未考虑机器人足部的受力情况，也无法应对不平整地面的ZMP跟随问题。现有技术还提出了利用规划ZMP计算机器人规划力和力矩的方法，其重心并不在于使足部力和力矩跟随该规划值已达到不平地面行走的目的，故只采用了非常简单的导纳控制器来控制以达到调整效果，但控制器可调节的范围太小，无法满足略带突起与凹陷的不平整地面的控制要求。综上，现有的技术大多直接通过检测机器人的实际ZMP，通过控制手段让其跟随规划的ZMP，来实现机器人的稳定行走。但是使用ZMP跟随实现这一切，有两个弊端，一是计算不平整地面上的ZMP从理论上讲，既不方便，也不准确，所以无法良好地反应机器人的行走状态，也就是说在不平整的地面上单使用ZMP跟随的控制方法效果必然不会太好，不能一味地追求通过计算得到的机器人ZMP去跟随规划值。另一方面，由于力传感器的冲击和误差，从足部受力和力矩计算而来的ZMP也非常不准，加上理论上的误差，这样计算出来的机器人真实ZMP一点也不真实，这就必然对控制效果造成影响。
技术实现思路
为了解决现有技术中存在的问题，本专利技术公开了一种双足机器人足部力和力矩跟随控制方法，不仅能够使双足机器人在平地上实现实际ZMP对规划ZMP的良好跟随，还能很好地实现较小不平整地面的稳定行走，另外，力跟随控制器控制模型的设计，还能减小足部在着地时受到的冲击。本专利技术是通过以下技术方案实现上述技术目的的。一种双足机器人足部力和力矩跟随控制方法，通过规划的机器人零力矩点分配机器人足部期望受力和足部期望力矩，将足部期望受力、足部期望力矩分别与足部实际受力、足部实际力矩作差，差值作为力跟随控制器的输入量，力跟随控制器输出踝关节三个方向的位置调节量，并将位置调节量加在原有的踝关节轨迹规划，得到调节后的踝关节轨迹，通过逆运动学得到各关节角度，实现机器人足部力和力矩的跟随，继而实现ZMP跟随。进一步，所述踝关节三个方向包括踝关节的竖直方向、俯仰方向和翻滚方向。进一步于，所述足部实际受力、足部实际力矩是通过机器人踝部的六维力传感器来计算。进一步，所述足部期望受力、足部期望力矩由规划ZMP分配方法计算得到。更进一步，所述规划ZMP分配方法计算的具体过程为：(1)计算单脚支撑期的足部期望受力和力矩根据ZMP与两脚踝关节之间的距离之比计算并分配左脚和右脚的竖直方向足部期望受力，再将ZMP与两脚踝关节距离分别与两期望受叉乘，分别得到两脚的足部期望力矩；(2)计算双脚支撑期的足部期望受力和力矩足部期望受力的计算方法与单脚支撑期相同，计算足部期望力矩时，先用计算单脚支撑期足部期望力矩的方法计算两足的期望力矩之和，再根据ZMP与两脚踝关节之间的距离之比计算并分配左脚和右脚的足部期望力矩。进一步，所述力跟随控制器的表达式为：其中e为两个弹簧阻尼系统的形变量之和，F为输入外力，Fold为上一个控制周期的输入力，eold为上一控制周期的输出位置调节量，为上一控制周期的输出位置调节量导数，TCONTROL为控制周期。进一步，所述两个弹簧阻尼系统串联组成双弹簧阻尼模型，每个弹簧阻尼系统由弹簧和阻尼并联而成。本专利技术的有益效果为：(1)本专利技术通过ZMP规划值计算机器人足部受力和力矩的规划值。(2)本专利技术利用导纳控制来实现由力的误差输出位置调节量，需要使用其他控制手段来减弱导纳控制作用于机器人系统产生的滞后带来的影响。(3)本专利技术使用双弹簧阻尼模型设计导纳控制器，具有吸收冲击、柔顺的效果，并能达到良好地力和力矩跟随效果。(4)本专利技术改进了由ZMP分配计算机器人足部规划力和力矩的方法，能够更加真实地反应理论上机器人足部应提供的力和力矩。(5)本专利技术将ZMP的跟随反映到足部力和力矩的跟随，在考虑机器人稳定行走的问题上，尝试解决更加根本的问题，能够适应不平整度更大的地面，实际的ZMP跟随效果也比较理想。附图说明图1为本专利技术双足机器人足部力和力矩跟随控制流程图；图2为由六维力传感器计算足部实际受力过程示意图；图3为本专利技术双足机器人足部z方向受力映射示意图；图4为世界坐标系中机器人双脚踝关节位置以及ZMP位置规划示意图；图5为本专利技术双弹簧阻尼模型示意图；图6为足部受力跟随效果实验数据曲线图，图6(a)为左脚受力跟随情况曲线图，图6(b)为右脚受力跟随情况曲线图。具体实施方式为了使本
的人员更好地理解本专利技术方案，下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本专利技术一部分实施例，而不是全部的实施例，基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。如图1所示，一种双足机器人足部力和力矩跟随控制方法，通过规划的机器人零力矩点ZMP来分配机器人足部期望受力和足部期望力矩，将足部期望受力、足部期望力矩分别与足部实际受力、足部实际力矩作差，作为力跟随控制器的输入量，力跟随控制器输出踝关节三个方向(分别是踝关节的竖直方向、俯仰方向Pitch和翻滚方向Roll)的位置调节量，并将该踝关节位置调节量加在原有的踝关节轨迹规划，得到调节后的踝关节轨迹，通过逆运动学(IK)得到各关节角度，实现机器人足部力和力矩的跟随，而实现ZMP跟随。足部实际受力、足部实际力矩是通过机器人踝部的六维力传感器测量并计算，具体的计算过程为：如图2所示，Fz.sensor为力传感器测得的足部坐标系下z方向受力，Fy.sensor为力传感器测得的足部坐标系下y方向受力，τsensor力传感器测得的足部坐标系下x方向力矩。需要根据力传感器测得的力和力矩计算得到机器人腰部坐标系下实际的力和力矩。当机器人足部转动时，足部坐标系的姿态不再与腰本文档来自技高网...

【技术保护点】
1.一种双足机器人足部力和力矩跟随控制方法，其特征在于，通过规划的机器人零力矩点分配机器人足部期望受力和足部期望力矩，将足部期望受力、足部期望力矩分别与足部实际受力、足部实际力矩作差，差值作为力跟随控制器的输入量，力跟随控制器输出踝关节三个方向的位置调节量，并将位置调节量加在原有的踝关节轨迹规划，得到调节后的踝关节轨迹，通过逆运动学得到各关节角度，实现机器人足部力和力矩的跟随，继而实现ZMP跟随。

【技术特征摘要】
1.一种双足机器人足部力和力矩跟随控制方法，其特征在于，通过规划的机器人零力矩点分配机器人足部期望受力和足部期望力矩，将足部期望受力、足部期望力矩分别与足部实际受力、足部实际力矩作差，差值作为力跟随控制器的输入量，力跟随控制器输出踝关节三个方向的位置调节量，并将位置调节量加在原有的踝关节轨迹规划，得到调节后的踝关节轨迹，通过逆运动学得到各关节角度，实现机器人足部力和力矩的跟随，继而实现ZMP跟随。2.根据权利要求1所述的双足机器人足部力和力矩跟随控制方法，其特征在于，所述踝关节三个方向包括踝关节的竖直方向、俯仰方向和翻滚方向。3.根据权利要求1所述的双足机器人足部力和力矩跟随控制方法，其特征在于，所述足部实际受力、足部实际力矩是通过机器人踝部的六维力传感器来计算。4.根据权利要求1所述的双足机器人足部力和力矩跟随控制方法，其特征在于，所述足部期望受力、足部期望力矩由规划ZMP分配方法计算得到。5.根据权利要求4所述的双足机器人足部力和力矩跟随控制方法，其特征在于，所述规划ZMP分配...

【专利技术属性】
技术研发人员：黄强，董宸呈，余张国，陈学超，李庆庆，黄则临，黄远灿，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京,11