专利名称：基于双平衡控制机制的仿人足球机器人全向踢球方法
基于双平衡控制机制的仿人足球机器人全向踢球方法技术领域
本发明属于仿人机器人踢球技术领域，具体涉及一种基于双平衡机制的仿人足球机器人全向踢球方法。
背景技术：
仿人足球机器人是仿人机器人技术研究的分支，与一般的仿人机器人相比，仿人足球机器人具有体积小、质量轻、运动灵活等特点。另外由于仿人足球机器人的竞技娱乐性，使得其更容易走进人类的生活。因此仿人足球机器人已经成为烦人机器人技术研究的热点之一。
1996年，RoboCup国际联合会成立，并在日本举行了表演赛。2002年的RoboCup比赛中启动了类人组的比赛，比赛要求仿人足球机器人反应迅速，能进行较为激烈的对抗，因此参赛队伍要综合考虑其仿人机器人的运动能力、平衡等多方面的技术。
在仿人机器人踢球方面，也有其它一些方法，如Rui Ferreira的仿人机器人全向踢球的方法，采用贝塞尔曲线规划足部运动轨迹，并结合基于质心的稳定性控制模块，该方法当修改支撑腿的关节位置以更好的维稳时，会同时改变游脚的位置即踢球的脚的运动轨迹会出现偏差；Patrick MacAlpine的踢球引擎执行机制,建立踢球技能文件以动态规划不同踢球方式下的足部运动轨迹，根据足球的位置确定固定的踢球方向。该方法使用CMA-ES优化足部运动的轨迹点，以控制踢球的距离和速度等重要的参数。
由于上述方法都是研究基于特定模块的踢球运动，而在动态对抗和时间因素等方面有一定地缺陷，即无法快速、准确而又稳定的完成踢球动作。上述问题是在仿人足球机器人的踢球过程中应当予以考虑并解决的问题。发明内容
本发明的目的是提供一种基于双平衡机制的仿人足球机器人全向踢球方法解决现有技术中存在的基于特定模块踢球运动，而在动态对抗和有限的时间内应用效率并不高，即抗外界干扰性不高，无法快速、准确而又稳定的完成踢球动作的问题。
本发明的技术解决方案是: 一种基于双平衡控制机制的仿人足球机器人全向踢球方法，包括踢球点选择机制、足部空间轨迹规划、关节角度计算和双平衡控制机制， 步骤一，踢球点选择机制: 以球为圆心、目标偏移TOffsetP为半径确定圆，该圆周上面的点均为可行的踢球点K1、K2……Κη，对其中若干个踢球点的踢球代价值KickCost进行分析；选取踢球代价值KickCost为最小值时的踢球点得到最小代价踢球点，并控制机器人A行走至该最小代价踢球点； 步骤二，足部空间轨迹规划:由机器人A身体重心的转移，同时利用三次样条插值法进行足部三维空间轨迹的规划，以获得机器人A每个时刻足部运动的参考位姿； 步骤三，关节角度计算:由步骤二得出机器人A每个时刻足部运动的参考位姿利用逆运动学知识计算出机器人A的膝盖处的关节角、踝关节的滚动角和俯仰角，以及股关节的偏摆角、滚动角和俯仰角；
步骤四，双平衡控制机制:包括机器人A身体的倾斜角度的控制和机器人A髋关节的滚动和俯仰角速度变化的控制，采用基于质心平衡的方法，维持机器人A身体在的X-Y平面上的稳定同时控制机器人A身体的倾斜角度；采用陀螺仪反馈平衡机制对机器人A髋关节的滚动和俯仰角速度变化的控制。
进一步改进在于:所述步骤一的踢球点选择机制中最小代价踢球点的选取包括步骤Ia和步骤Ib:
步骤la，踢球点选择机制:以球为圆心、目标偏移TOffsetP为半径确定圆，该圆周上面的点均为可行的踢球点Kl、K2……Kn，对其中若干个踢球点的踢球代价值KickCost进行分析；机器人A的当前位置AgentP为机器人A相对于球而言的二维坐标值，目标偏移位置TOffsetP为机器人A的踢球点Kl相对于球而言的偏移量，当前位置AgentP与目标偏移位置TOffsetP之差的绝对值除以标准值m得到距离代价值DistCost:
DistCost = [AgenlP—TOffsetP|/m(I)
步骤Ib,计算机器人A的转身代价值TurnCost,机器人A的当前朝向与球形成的夹角￡￡踢球点Kl的朝向与球形成的夹角於，夹角a与夹角声之差的绝对值除以360即是转身代价值TurnCost:
TnmCost =丨 AgentOientrfi an — T afgetOientdia(i| /360 = jff —爲',360(2)
步骤Ic,距离代价值DistCost和转身代价值TurnCost之和为机器人A在踢球点的踢球代价值KickCost:
EdtCtist — DistGbst + TumCiist(3 )
选取式(3)中踢球代价值KickCost为最小值时的踢球点得到最小代价踢球点。
进一步改进在于:所述步骤二的足部空间轨迹规划包括步骤2a和步骤2b:
步骤2a，根据机器人A游脚的运动情况能够将机器人A的一个完整地踢球动作划分为后抬腿、摆动和复位三个阶段，即得到抬腿、摆动和复位三条运动曲线；
步骤2b，由步骤2a中的抬腿、摆动和复位三条运动曲线分别利用三次样条插值法保证插值得出低阶分段且光滑的曲线函数，得出机器人A的踝关节每个时刻的参考位姿，以实现对足部踢球运动的控制。所述步骤2b中机器人A的踝关节每个时刻的参考位姿的算法为:
的n个时刻有n个插值点=Pj , I=IJ1-1i，三次样条插值函数在每个区间是一个三次多项式，而且三次样条插值函数的一阶导数sr(t)和二阶导数在区间(Iv t )是连续的;
权利要求
1.一种基于双平衡控制机制的仿人足球机器人全向踢球方法，其特征在于:包括踢球点选择机制、足部空间轨迹规划、关节角度计算和双平衡控制机制， 步骤一，踢球点选择机制:以球为圆心、目标偏移TOffsetP为半径确定圆，该圆周上面的点均为可行的踢球点K1、K2……Kn，对其中若干个踢球点的踢球代价值KickCost进行分析；选取踢球代价值KickCost为最小值时的踢球点得到最小代价踢球点，并控制机器人A行走至该最小代价踢球点； 步骤二，足部空间轨迹规划:由机器人A身体重心的转移，同时利用三次样条插值法进行足部三维空间轨迹的规划，以获得机器人A每个时刻足部运动的参考位姿； 步骤三，关节角度计算:由步骤二得出机器人A每个时刻足部运动的参考位姿利用逆运动学知识计算出机器人A的膝盖处的关节角、踝关节的滚动角和俯仰角，以及股关节的偏摆角、滚动角和俯仰角； 步骤四，双平衡控制机制:包括机器人A身体的倾斜角度的控制和机器人A髋关节的滚动和俯仰角速度变化的控制，采用基于质心平衡的方法，维持机器人A身体在的X-Y平面上的稳定同时控制机器人A身体的倾斜角度；采用陀螺仪反馈平衡机制对机器人A髋关节的滚动和俯仰角速度变化的控制。
2.如权利要求1所述的基于双平衡机制的仿人足球机器人全向踢球方法，其特征在于，所述步骤一的踢球点选择机制中最小代价踢球点的选取包括以下步骤: 步骤la，踢球点选择机制:以球为圆心、目标偏移TOffsetP为半径确定圆，该圆周上面的点均为可行的踢球点Kl、K2……Kn，对其中若干个踢球点的踢球代价值KickCost进行分析；机器人A的当前位置AgentP为机器人A相对于球而言的二维坐标值，目标偏移位置TOffsetP为机器人A的踢球点Kl相对于球而言的偏移量，当前位置AgentP与目标偏移位置TOffsetP之差的绝对值除以标准值m得到距离代价值DistCost: DistCbst = |Ag ntP-TQHsetP|/m(I) 步骤lb,计算机器人A的转身代价值TurnCost,机器人A的当前朝向与球形成有夹角a，踢球点Kl的朝向与球形成的夹角於，夹角a与夹角於之差的绝对值除以3__即是转身代价值TurnCost:TnmCost; — [AgentOrienlatiaft—T acgdtOtiaitaliaal /360 = \a—0\ /360(2) 步骤Ic,距离代价值DistCost和转身代价值TurnCost之和为机器人A在踢球点的踢球代价值KickCost: KiddCost: =+ TmtOxst;(3 ) 选取式(3)中踢球代价值KickCost为最小值时的踢球点得到最小代价踢球点。
3.如权利要求1所述的基于双平衡机制的仿人足球机器人全向踢球方法，其特征在于，所述步骤二的足部空间轨迹规划包括以下步骤: 步骤2a，根据机器人A游脚的运动情况能够将机器人A的一个完整地踢球动作划分为后抬腿、摆动和复位三个阶段，即得到抬腿、摆动和复位三条运动曲线； 步骤2b，由步骤2a中的抬腿、摆动和复位三条运动曲线分别利用三次样条插值法保证插值得出低阶分段且光滑的曲线函数， 得出机器人A的踝关节每个时刻的参考位姿，以实现对足部踢球运动的控制。
4.如权利要求3所述的基于双平衡机制的仿人足球机器人全向踢球方法，其特征在于，所述步骤2b中机器人A的踝关节每个时刻的参考位姿的算法为: 在I1Ct2O--Ktn的η个时刻有η个插值点
5.如权利要求1所述的基于双平衡机制的仿人足球机器人全向踢球方法，其特征在于，所述步骤四的双平衡控制机制包括以下步骤: 步骤4a，机器人A身体的倾斜角度的控制:利用机器人A质心COM的投影必须在支撑多边形内部准则来维持自身稳定性；如果机器人A质心COM的投影不在支撑多边形内，将打开与支撑腿同侧的手臂直到机器人A质心COM的投影在支撑多边形内为止；利用PID控制机器人A身体在X、Y平面上的平衡性，对于机器人A整个身体在三维空间中稳定性，采用毕达哥拉斯定理控制踝关节的旋转角度； 步骤4b，机器人A髋关节的滚动和俯仰角速度变化的控制:利用陀螺仪反馈控制，使用指数平滑迭代法弥补陀螺仪传感器信息的延迟，实现对机器人A髋关节的滚动和俯仰角速度变化的精确控制。
6.如权利要求5所述的基于双平衡机制的仿人足球机器人全向踢球方法，其特征在于，所述步骤4a的机器人A身体的倾斜角度的控制的具体算法为:控制器输入的误差值是测量的质心位置值COMra与理想的质心位置值COMfc之间的差值，即Sir = CDMra-CXM1ta ,其中理想的质心位置值COM_是通过未来n个时刻支撑脚的位置值的调和平均数计算得出的，测量的质心位置值COMm为:
7.如权利要求5所述的基于双平衡机制的仿人足球机器人全向踢球方法，其特征在于，所述步骤4b的机器人A髋关节的滚动和俯仰角速度变化的控制的具体算法为: 利用髋关节的滚动角每_*和俯仰角得出角度变化的目标速度，即目标角速度Desli ,Des5l的计算如下所示:
全文摘要
本发明提供一种基于双平衡控制机制的仿人足球机器人全向踢球方法，根据距离代价值和角度代价值确定具有最小代价的踢球点，并控制机器人行走至该踢球点；机器人身体重心的转移，同时利用三次样条插值法进行足部空间轨迹的规划，即可获得机器人每个时刻足部运动的参考位姿；由上述得出的参考位姿利用逆运动学知识计算出机器人各个关节的角度；采用基于质心和陀螺仪反馈的双平衡机制维持机器人在踢球过程中稳定性。本发明一种基于双平衡控制机制的仿人足球机器人全向踢球方法，在仿人机器人踢球过程中，利用质心和陀螺仪反馈双平衡机制实现机器人的全向踢球。相比现有技术，本发明的机器人踢球方法具有稳定性好、执行效率高的优点。
文档编号G05B13/04GK103217903SQ20131011687
公开日2013年7月24日 申请日期2013年4月7日 优先权日2013年4月7日
发明者梁志伟, 刘娟, 郝越, 朱松豪 申请人:南京邮电大学