[发明专利]一种被动轮式四足机器人轮滑步态控制方法有效
申请号: | 202111074849.X | 申请日: | 2021-09-14 |
公开(公告)号: | CN113934208B | 公开(公告)日: | 2023-08-04 |
发明(设计)人: | 苏波;闫曈;许威;江磊;党睿娜;汪建兵;邓秦丹;郭亮;姚其昌;蒋云峰;刘宇飞;邢伯阳;王志瑞;慕林栋;梁振杰;赵建新;许鹏;邱天奇 | 申请(专利权)人: | 中国北方车辆研究所 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 北京理工大学专利中心 11120 | 代理人: | 许姣 |
地址: | 100072*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 被动 轮式 机器人 步态 控制 方法 | ||
1.一种被动轮式四足机器人轮滑步态控制方法,所述被动轮式四足机器人具有四条腿,每条腿具有三节,分别令为首节腿、中节腿和末节腿;每条腿的足端设置有轮足结构;所述首节腿与机身的连接处、首节腿与中节腿的连接处、中节腿与末节腿的连接处均设置有关节电机;
其特征在于:所述被动轮式四足机器人的各条腿以设定的轮换时间间隔T依次作为主动腿进行蹬地运动,四条腿轮换结束为一个运动周期;然后所述被动轮式四足机器人以4T为周期进行周期性重复的轮滑运动;所述主动腿进行蹬地运动时,与主动腿中心对称的腿进行平衡运动,其余两条腿被动支撑;令进行平衡运动的腿为平衡腿,被动支撑的两条腿为支撑腿;
所述主动腿蹬地运动分为三个相位:切换相、滑移相和摆动相;
所述切换相为蹬地准备阶段:所述主动腿保持足端位置不变,末节腿绕触地点向上旋转,由轮触地转化为足触地;
所述滑移相运动为蹬地阶段:所述主动腿的末节腿平移向后运动一个蹬地步长,所述蹬地步长为设定值;
所述摆动相为足端复位阶段,所述主动腿完成从足触地到轮触地的切换,为下一次蹬地做准备;
所述平衡运动为平衡腿为平衡主动腿质心运动效应所作的运动,用于保证所述被动轮式四足机器人蹬地运动时的稳定;
令被动轮式四足机器人的行进方向为X向,其中前进方向为正,后退方向为负;竖直方向为Y向;令从机身到足端的四个关节点分别为A点、B点、C点和P点;首节腿为杆AB,中节腿为杆BC,末节腿为杆CP,P点为触地点;首节腿杆AB的长度为L1;中节腿杆BC的长度为L2;末节腿杆CP的长度为L3;杆AB与机身水平方向的夹角为关节角θ1,杆AB与杆BC之间的夹角为关节角θ2,杆BC与杆CP之间的夹角为关节角θ3;各腿以轮触地时末节腿杆CP与X负半轴夹角为δ2,各腿以足触地时末节腿杆CP与X负半轴夹角为δ1;
所述主动腿蹬地运动过程中:
蹬地准备阶段:从0到t1时刻,所述主动腿的关节点C的轨迹为:
其中:xP0为主动腿足端初始位置X坐标;h为主动腿的高度;
蹬地阶段:从t1到t2时刻,所述主动腿的末节腿向后平移运动一个蹬地步长l主,则所述主动腿的关节点C的轨迹为:
足端复位阶段:从t2到t3时刻,所述主动腿的关节点C的轨迹规划采用贝塞尔曲线拟合,该阶段主动腿的关节点C的轨迹为:
其中:u=(t-t2)/(t3-t2);
上述三个阶段中,在计算得到各阶段的C点的轨迹后,进一步由逆运动学根据C点轨迹依据下述公式求解得到各个阶段主动腿的三个关节角,然后依据得到的三个关节角通过各关节电机控制所述主动腿运动;
其中:δi由当前状态下主动腿与地面的接触状态确定:
首先令所述被动轮式四足机器人各条腿中首节腿杆AB的质量为MAB,中节腿杆BC的质量为MBC,末节腿杆CP的质量为MCP;B点关节的质量为MB,C点关节的质量为MC,P点轮足结构的质量为MP;机身质量为M,单腿质量为M0;
所述平衡腿在进行平衡运动时的平衡控制方法为:
步骤一:计算所述主动腿蹬地运动后其质心的位移;
步骤二:依据步骤一计算的所述主动腿的质心位移,由所述被动轮式四足机器人整机质心期望位置与主动腿质心位移解算出所述平衡腿质心期望位置,进而获得所述平衡腿质心期望位移;
步骤三:根据步骤二所得到的平衡腿质心期望位移,依据腿部质心-步长方程计算所述平衡腿的关节点C与足端点P的迈步长度,作为期望迈步长度;再由逆运动学解算出平衡腿各个关节角的转角,进而通过控制对应关节处的电机实现对所述平衡腿运动的控制,使所述平衡腿的迈步长度为所计算的期望迈步长度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国北方车辆研究所,未经中国北方车辆研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111074849.X/1.html,转载请声明来源钻瓜专利网。