一种四足机器狗复杂地形稳定行走控制方法及系统与流程

摘要: 本发明涉及四足机器人行走控制,具体为一种四足机器狗复杂地形稳定行走控制方法及系统。背景技术:1、四足机器狗具有较好的地形适应能力,已逐渐应用于变电站、厂区管廊、...
一种四足机器狗复杂地形稳定行走控制方法及系统与流程

本发明涉及四足机器人行走控制,具体为一种四足机器狗复杂地形稳定行走控制方法及系统。

背景技术:

1、四足机器狗具有较好的地形适应能力,已逐渐应用于变电站、厂区管廊、电缆沟、室外巡检通道等场景。在上述场景中,机器狗需要连续通过碎石路面、坡道、台阶边缘、沟盖板接缝以及局部起伏地面。现有稳定行走控制方法通常会在行走前或当前步态周期内获取地形高度、机身姿态、足端位置、支撑足状态等信息,并依据地形感知结果和预设步态参数生成摆动足的规划落足点、触地时刻和机身姿态,再通过足端接触检测、关节力矩反馈或机身姿态反馈对行走过程进行调整。该类方式在地形连续、足端接触稳定的条件下能够满足一般行走控制需求。

2、但是,在真实巡检现场中,复杂地形并不总是呈现规则连续状态。碎石松动、台阶边缘遮挡、沟盖板接缝高差、局部坡面附着力变化等情况,均可能使摆动足在触地瞬间出现实际触地点偏移、触地时刻提前或滞后、足端短时滑移、支撑反力突变以及机身姿态偏转。此时,行走控制器在当前步态周期内预先形成的规划落足状态,与足端真实触地后的实际支撑状态之间可能产生偏差。现有方式多侧重于依据地形感知结果生成落足规划,或者在机身姿态发生变化后进行姿态恢复,缺少对规划落足状态与实际触地状态之间的周期化比对记录,因而不易在触地后的短时间内准确确认支撑稳定裕量下降的成因。

3、进一步地,四足机器狗的行走具有连续步态特征,当前摆动足触地后的偏差会影响下一摆动足的落足位置、步态周期和机身姿态控制。如果当前周期中出现的落足偏差、触地时刻偏差、支撑反力变化、足端滑移和机身姿态偏转未被及时整理并传递至下一步态周期,控制系统可能仍按照原步态节律和原规划落足状态执行后续动作,造成支撑状态偏差在连续步态中累积,进而影响复杂地形下的持续稳定通过能力。因此,在现有四足机器狗复杂地形行走控制中,仍需要解决规划落足状态与实际触地状态不一致时,如何及时识别支撑稳定裕量下降并用于后续步态控制衔接的问题。

技术实现思路

1、针对现有技术的不足,本发明提供了一种四足机器狗复杂地形稳定行走控制方法及系统,以解决上述背景技术中提出的问题。

2、为实现上述目的,本发明提供如下技术方案:一种四足机器狗复杂地形稳定行走控制方法,包括:

3、s1、获取机器狗当前机身姿态、支撑足状态、行进方向、步态周期以及局部地形高度变化信息,生成当前步态周期的规划落足状态;

4、s2、在摆动足进入触地阶段时建立触地核验窗口,采集足端接触信号、关节力矩变化、足端速度变化、足端位移变化以及机身姿态变化,生成实际触地状态;

5、s3、将实际触地状态同规划落足状态进行比对,得到触地偏差量,触地偏差量包括落足位置偏差、触地时刻偏差、支撑反力变化量、足端滑移方向以及机身姿态偏转方向;

6、s4、依据触地偏差量、当前支撑足状态、机身姿态变化方向,确定支撑稳定裕量下降类型;

7、s5、按照支撑稳定裕量下降类型生成下一步控制修正量,下一步控制修正量包括下一摆动足落足位置修正量、步态周期修正量、机身姿态补偿量;

8、s6、将下一步控制修正量写入下一步态周期的行走控制指令,并在下一摆动足触地后重复触地核验、触地偏差量生成、支撑稳定裕量下降类型确定以及控制修正量生成。

9、进一步的,生成当前步态周期的规划落足状态包括:

10、以行走控制器内部时钟对齐机身惯性测量单元记录和关节编码器记录,形成当前机身姿态;

11、依据足端接触信号、关节角度记录和关节力矩记录确认支撑足状态;

12、将巡检任务路径转换至机身坐标系形成行进方向;

13、依据步态调度记录确定步态周期;

14、将局部地形高度变化信息转换至机身坐标系,并按行进方向截取当前摆动足可达落足区域;

15、排除不可补齐区域、高度超限区域和支撑足占用区域,形成当前步态周期的规划落足状态。

16、进一步的,建立触地核验窗口包括:

17、监听当前步态周期内摆动足的相位切换记录;

18、在摆动足进入规划落足状态对应的下落末段,且摆动足编号同规划落足状态中的摆动足编号一致时,以触地阶段起点建立触地核验窗口;

19、锁定摆动足编号、周期编号、窗口起点、窗口结束规则和传感器标定版本。

20、进一步的,生成实际触地状态包括:

21、在触地核验窗口内采集足端接触信号、关节力矩变化、足端速度变化、足端位移变化和机身姿态变化;

22、在记录均达到窗口确认条件后,按照触地核验窗口编号归并形成实际触地状态。

23、进一步的,将实际触地状态同规划落足状态进行比对包括:

24、得到触地偏差量前,锁定同一任务编号、巡检段编号、周期编号、摆动足编号、机身坐标系版本和时间口径下的实际触地状态版本与规划落足状态版本,并以锁定后的实际触地状态和规划落足状态作为比对依据。

25、进一步的,得到触地偏差量包括:

26、依据实际触地位置和规划落足点形成落足位置偏差;

27、依据足端接触信号连续成立时刻和规划触地时刻形成触地时刻偏差;

28、依据触地前稳定段和触地核验窗口内的承载变化形成支撑反力变化量;

29、依据接触成立后的足端位移变化形成足端滑移方向;

30、依据触地核验窗口结束时刻的机身姿态和规划机身姿态形成机身姿态偏转方向。

31、进一步的,确定支撑稳定裕量下降类型包括:

32、读取同一周期编号和同一摆动足编号下的触地偏差量、当前支撑足状态和机身姿态变化方向;

33、以当前支撑足状态中确认支撑足的足端接触点形成支撑区域;

34、在触地偏差量、当前支撑足状态和机身姿态变化方向均形成后,按照支撑冲击型、支撑空缺型、支撑边界收缩型、承载失衡型、连续步态偏移型的顺序确定首个成立类型为支撑稳定裕量下降类型。

35、进一步的,生成下一步控制修正量包括:

36、依据步态类型版本锁定的足端切换顺序确定下一摆动足编号;

37、读取支撑稳定裕量下降类型、触地偏差量、机身姿态变化方向及下一摆动足可达区域;

38、在步态类型版本锁定的修正档位和边界内,生成下一摆动足落足位置修正量、步态周期修正量和机身姿态补偿量;

39、将三项修正量归并为下一步控制修正量。

40、进一步的,写入下一步态周期的行走控制指令包括:

41、读取同一下一步控制修正量版本下的下一摆动足落足位置修正量、步态周期修正量和机身姿态补偿量;

42、将修正量分别写入下一摆动足落足位置字段、步态周期字段和机身姿态字段;

43、在字段均完成写入后生成行走控制指令版本;

44、在下一摆动足触地后,按新的周期编号重复触地核验、触地偏差量生成、支撑稳定裕量下降类型确定和控制修正量生成。

45、另一方面,本发明提供了一种四足机器狗复杂地形稳定行走控制系统,包括:

46、规划落足状态生成模块,用于获取机器狗当前机身姿态、支撑足状态、行进方向、步态周期以及局部地形高度变化信息,生成当前步态周期的规划落足状态;

47、实际触地状态生成模块,用于在摆动足进入触地阶段时建立触地核验窗口,采集足端接触信号、关节力矩变化、足端速度变化、足端位移变化以及机身姿态变化,生成实际触地状态;

48、触地偏差量生成模块,用于将实际触地状态同规划落足状态进行比对,得到触地偏差量,触地偏差量包括落足位置偏差、触地时刻偏差、支撑反力变化量、足端滑移方向以及机身姿态偏转方向;

49、稳定裕量下降类型确定模块,用于依据触地偏差量、当前支撑足状态、机身姿态变化方向,确定支撑稳定裕量下降类型;

50、控制修正量生成模块,用于按照支撑稳定裕量下降类型生成下一步控制修正量,下一步控制修正量包括下一摆动足落足位置修正量、步态周期修正量、机身姿态补偿量;

51、行走控制指令写入模块,用于将下一步控制修正量写入下一步态周期的行走控制指令,并在下一摆动足触地后重复触地核验、触地偏差量生成、支撑稳定裕量下降类型确定以及控制修正量生成。

52、与现有技术相比,本发明具有以下有益效果:

53、1、通过在当前步态周期内生成规划落足状态,并在摆动足进入触地阶段后建立触地核验窗口,采集足端接触信号、关节力矩变化、足端速度变化、足端位移变化以及机身姿态变化,形成实际触地状态,再将实际触地状态同规划落足状态进行比对得到触地偏差量,并依据触地偏差量、当前支撑足状态和机身姿态变化方向确定支撑稳定裕量下降类型,从而达到在复杂地形中将规划落足状态与真实触地状态进行闭环关联,及时识别支撑稳定裕量下降成因,避免仅依赖预先地形感知或单一姿态反馈造成连续落足偏差累积的目的。

54、2、通过按照支撑稳定裕量下降类型生成下一摆动足落足位置修正量、步态周期修正量和机身姿态补偿量,并将下一步控制修正量写入下一步态周期的行走控制指令,在下一摆动足触地后继续重复触地核验、触地偏差计算、支撑稳定裕量下降类型确定以及控制修正量生成,从而达到将当前触地偏差传递至下一步态周期进行提前修正,使机器狗在碎石、坡道、台阶边缘和局部起伏混合地形中保持连续稳定行走控制的目的。