一种考虑随机腿部故障的六足机器人容错步态规划方法技术

本发明专利技术属于足式机器人运动控制技术领域。本发明专利技术公开了一种考虑随机腿部故障的六足机器人容错步态规划方法，解决了六足机器人发生腿部故障后，运动效率及运动稳定性下降的问题，具体方法为：建立离线的六足机器人备选步态集及整机可容错腿部故障状态集，在此基础上以机器人实时腿部运动状态及故障状态为输入，通过设定腿部运动状态转换约束条件并建立对应评价函数，为六足机器人在备选步态集中在线搜索迈下一步时满足约束条件的最优容错腿部运动状态。本发明专利技术使六足机器人可根据随机腿部故障，自发地生成具备良好运动稳定性及行进效率的容错迈腿序列，提高了六足机器人在崎岖地形下的容错运动能力以及现实应用性。形下的容错运动能力以及现实应用性。

【技术实现步骤摘要】
一种考虑随机腿部故障的六足机器人容错步态规划方法


[0001]本专利技术涉及足式机器人运动控制
，具体而言，涉及一种考虑随机腿部故障的六足机器人容错步态规划方法。

技术介绍

[0002]当六足机器人出现腿部故障时，目前的步态规划方法普遍停留在六足机器人腿部故障自诊断后采用预制周期性容错步态序列的单一规划阶段。一方面受到处理器存储空间的限制，很难将所有可行的容错方案预制在六足机器人有限的存储空间内，另一方面在崎岖地形下六足机器人发生腿部故障后，由于机器人外部环境和内部自身运动稳定性都有可能发生突变，仅依靠离线的周期性步态规划方法很难保证预制容错方案与随机故障场景之间的匹配性。

技术实现思路

[0003]本专利技术解决的问题是使六足机器人能够根据随机的腿部实时故障，自发地生成具有良好运动稳定性及行进效率的容错步态序列，提高六足机器人在崎岖地形下的容错运动能力。
[0004]为解决上述问题，本专利技术提供了一种考虑随机腿部故障的六足机器人容错步态规划方法，所述方法包括如下步骤：
[0005]步骤一：建立六足机器人离线备选步态集。
[0006]由六足机器人腿部只有支撑和摆动两种运动状态这一规律，且六足机器人运动时至少需要三条腿作支撑，则遍历六条腿后机器人共有种腿部运动状态，在此基础上删去不满足机器人静态稳定状态的6种腿部运动状态，将机器人剩余36种腿部运动状态根据支撑腿个数的不同划分为三腿、四腿、五腿以及六腿离线备选步态集。
[0007]步骤二：建立六足机器人故障腿与备选步态集之间的在线映射。
[0008]在满足六足机器人静态稳定运动时最少需要三条腿支撑，一条腿摆动的基础上，遍历六足机器人所有可能的腿部故障状态组合，通过分析能否在离线备选步态集中找到一组使机器人始终处于静态稳定状态的腿部运动状态，来判断在所遍历腿部故障状态组合下，机器人是否具有可容错性，若具备可容错性，则可建立机器人故障腿个数及位置分布与备选步态集的在线映射关系，使机器人在某种腿部故障状态下仍具备较好的运动稳定性及行进效率，否则，机器人应停止运动。
[0009]步骤三：建立六足机器人腿部运动状态转换间的约束条件及最优容错腿部运动状态在线搜索的评价函数。
[0010]从稳定性角度和运动学角度出发，规定六足机器人腿部状态转换过程中必须始终处于静态稳定状态并且所有非故障腿的位置必须始终在其对应的腿部工作空间内，以确保机器人进行容错运动时始终具有较好的稳定性及机动性，据此建立六足机器人腿部运动状态转换的两个约束条件，分别以ZMP稳定裕度和运动学裕度作为二者的评价指标，通过为约
束条件的评价指标构造权重赋值函数，最终建立最优容错腿部运动状态在线搜索的评价函数，以评分的形式结合机器人当前运动时刻的腿部运动状态，在实时备选步态集中筛选出满足约束条件的最优容错腿部运动状态，作为机器人迈下一步时的腿部运动状态，通过最优容错腿部运动状态的在线实时循环选择，形成具备良好运动稳定性与行进效率的最优容错迈腿序列。
[0011]本专利技术的一种考虑随机腿部故障的六足机器人容错步态规划方法的有益效果是：相对于离线步态规划时需考虑的多种单一容错预制方案，基于腿部运动状态在线搜索的步态规划方式使六足机器人在运动时可根据随机腿部故障，自发地生成满足运动学约束和稳定性约束的最优容错步态序列，极大地减轻了步态程序的冗余性与处理器的存储负担，提高了六足机器人在复杂地形下的容错运动能力。
附图说明
[0012]图1为本专利技术实施例的一种考虑随机腿部故障的六足机器人容错步态规划方法的流程示意图；
[0013]图2为本专利技术实施例的ZMP稳定裕度示意图；
[0014]图3为本专利技术实施例的运动学裕度示意图。
具体实施方式
[0015]为使本专利技术的上述目的、特征和优点能够更为明显易懂，下面结合附图对本专利技术的具体实施例做详细的说明。
[0016]如图1所示，本专利技术实施例提供的一种考虑随机腿部故障的六足机器人容错步态规划方法，所示方法包括如下步骤：
[0017]步骤001，建立六足机器人离线备选步态集。
[0018]由于六足机器人每一条腿都只有摆动或者支撑两种运动状态，且六足机器人稳定运动时最少需要三条支撑腿，则遍历所有腿后一共得到种腿部运动状态，在此基础上删去6种不满足六足机器人静态稳定的腿部运动状态，并根据支撑腿个数的不同，将剩余36种腿部运动状态划分为三腿、四腿、五腿以及六腿步态集。
[0019]本专利技术实施例所述的六足机器人静态稳定是指，六足机器人重心在水平面上的投影点与机器人支撑足所构成多边形在水平面上投影多边形之间的位置关系，当机器人重心投影在支撑腿投影多边形内部，则认为六足机器人处于静态稳定状态。
[0020]依次对六足机器人的六条腿进行排序，支撑状态用数字1表示，摆动状态用数字0表示，则六足机器人36种腿部运动状态如表一所示：
[0021]表一腿部运动状态表
[0022][0023][0024]表一中腿部运动状态显示了该状态下的各条腿的状态，状态示意图中的多边形即为机器人腿部支撑多边形，状态1～14为三腿步态集，状态15～29为四腿步态集，状态30～35为五腿步态集，状态36为六腿步态集。
[0025]步骤002，建立六足机器人故障腿与备选步态集之间的在线映射。
[0026]本专利技术实施例所述的腿部故障指的是机器人腿部整体故障，完全丧失运动能力，但仍固定在机身上，不起支撑作用，不与地面产生摩擦的状态。
[0027]六足机器人故障腿的数量以及位置分布会影响机器人的容错能力，因此，首先应遍历所有可能出现的腿部故障组合，再判断出现该故障状态后机器人的整机可容错性，六足机器人所有可能出现的故障状态数量如式(1)所示：
[0028]式中，p为六足机器人所有腿数目，q为故障腿个数。
[0029]当故障腿个数为1时，由式(1)可得机器人共有6种腿部故障状态，此时无论机器人每迈一步时有一条或两条摆动腿，都能在所建立离线备选步态集中找到一组满足机器人静态稳定的腿部运动状态，即机器人可容错，此时可通过合理的容错步态规划，使机器人在发生单腿故障后仍能保证较好的运动稳定性及行进效率。
[0030]当故障腿个数为2时，由式(1)可得机器人共有15种故障状态，此时机器人两条故障腿之间的位置关系呈相邻、相间及相对分布，六足机器人每迈一步只有一条摆动腿时，只有当两条故障腿位置呈相对分布时，才能在离线备选步态集中找到一组满足机器人静态稳定的腿部运动状态，即只有当两条故障腿之间呈相对分布时，机器人才可容错。
[0031]利用传感器获取六足机器人运动时的实时腿部故障状态，用数字1表示腿部发生故障，用数字0表示腿部未发生故障，则六足机器人整机可容错的腿部故障状态如下表二所示：
[0032]表二六足机器人整机可容错腿部故障状态示意图
[0033][0034]表二中整机可容错状态显示了六足机器人各条腿的故障情况，状态示意图中多边形本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种考虑随机腿部故障的六足机器人容错步态规划方法，其特征在于，将该方法包括以下步骤：步骤1：建立六足机器人离线备选步态集：遍历六足机器人所有可能的腿部运动状态，并根据支撑腿个数的不同，建立满足六足机器人静态稳定状态的三腿、四腿、五腿以及六腿离线备选步态集；步骤2：建立六足机器人故障腿与备选步态集之间的在线映射：遍历六足机器人所有可能的腿部故障状态，根据六足机器人腿部故障后，是否能在离线备选步态集中找到一组使机器人始终处于静态稳定状态的腿部运动状态，来遍历并筛选出六足机器人可容错的腿部故障状态集，若在某种腿部故障状态下机器人可容错，则可建立机器人故障腿个数及位置分布与备选步态集的在线映射关系，当实时故障腿个数为0且可容错时，机器人迈下一步时的腿部运动状态将在三腿备选步态集中选择，当实时故障腿个数为1且可容错时，机器人迈下一步时的腿部运动状态将在四腿备选步态集中选择，当实时故障腿个数为2且可容错时，机器人迈下一步时的腿部运动状态将在五腿备选步态集中选择；步骤3：建立六足机器人腿部运动状态转换间的约束条件及最优容错腿部运动状态在线搜索的评价函数：当出现可容错的腿部故障后，六足机器人在容错运动下的腿部运动状态转换必须满足稳定性约束及运动学约束，以稳定性约束及运动学约束为目标构造最优容错腿部运动状态在线搜索评价函数，并以ZMP稳定裕度和运动学裕度作为稳定性约束和运动学约束的评价指标，前者倾向于在实时备选步态集中搜索运动稳定性最优的容错腿部运动状态，后者倾向于在实时备选步态集中搜索运动能力最优的容错腿部运动状态，以机器人实时ZMP稳定裕度为自变量，引入种群竞争模型，为稳定性约束和运动学约束的评价指标构造变权重赋值函数，并据此建立完整的六足机器人最优容错腿部运动状态在线搜索评价函数，根据评价函数的计算值为六足机器人选择迈下一步时的最优容错腿部运动状态，通过最优容错腿部运动状态的在线实时循环选择，形成具备良好运动稳定性与行进效率的最优容错迈腿序列。2.根据权利要求1所述的一种考虑随机腿部故障的六足机器人容错步态规划方法，其特征在于，步骤1所述的遍历六足机器人所有可能的腿部运动状态为：六足机器人六条腿同一运动时刻下处于支撑或摆动状态的集合，由于六足机...

【专利技术属性】
技术研发人员：尤波，刘凯乐，陈晨，李佳钰，
申请(专利权)人：哈尔滨理工大学，
类型：发明
国别省市：