CN114489092B - 足式机器人运动控制方法、装置、设备及介质 - Google Patents
足式机器人运动控制方法、装置、设备及介质 Download PDFInfo
- Publication number
- CN114489092B CN114489092B CN202011154824.6A CN202011154824A CN114489092B CN 114489092 B CN114489092 B CN 114489092B CN 202011154824 A CN202011154824 A CN 202011154824A CN 114489092 B CN114489092 B CN 114489092B
- Authority
- CN
- China
- Prior art keywords
- foot
- target
- moment
- robot
- centroid position
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 185
- 238000000034 method Methods 0.000 title claims abstract description 64
- 230000008859 change Effects 0.000 claims abstract description 153
- 206010034701 Peroneal nerve palsy Diseases 0.000 claims abstract description 137
- 238000005070 sampling Methods 0.000 claims description 171
- 230000001133 acceleration Effects 0.000 claims description 39
- 230000006870 function Effects 0.000 claims description 36
- 230000014509 gene expression Effects 0.000 claims description 34
- 239000013598 vector Substances 0.000 claims description 18
- 210000002683 foot Anatomy 0.000 description 374
- 206010034719 Personality change Diseases 0.000 description 19
- 230000008569 process Effects 0.000 description 19
- 238000010586 diagram Methods 0.000 description 15
- 239000004973 liquid crystal related substance Substances 0.000 description 12
- 230000007613 environmental effect Effects 0.000 description 9
- 239000011159 matrix material Substances 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 7
- 230000016776 visual perception Effects 0.000 description 7
- 238000006243 chemical reaction Methods 0.000 description 5
- 238000004891 communication Methods 0.000 description 5
- 238000004590 computer program Methods 0.000 description 5
- 230000005021 gait Effects 0.000 description 4
- 230000008685 targeting Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 238000003491 array Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 241000282472 Canis lupus familiaris Species 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 210000000548 hind-foot Anatomy 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 241000282326 Felis catus Species 0.000 description 1
- 241000238631 Hexapoda Species 0.000 description 1
- 241000364483 Lipeurus epsilon Species 0.000 description 1
- 241001455273 Tetrapoda Species 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000004438 eyesight Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 208000031232 peroneal neuropathy Diseases 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
- 210000001364 upper extremity Anatomy 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Combustion & Propulsion (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Business, Economics & Management (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Game Theory and Decision Science (AREA)
- Medical Informatics (AREA)
- Manipulator (AREA)
Abstract
本申请提供一种足式机器人运动控制方法、装置、设备及介质,涉及机器人技术领域,用于提高足式机器人运动与环境的适应程度。该方法包括:获取在规划周期内起始时刻的状态数据;根据起始时刻的状态数据,确定在规划周期内各足端的候选落脚点;根据起始时刻的状态数据、候选落脚点确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;在约束条件集合的约束下,确定满足第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点;根据目标质心位置变化系数、目标迈步占空比和目标落脚点,控制足式机器人在规划周期内运动。
Description
技术领域
本申请涉及机器人技术领域,尤其涉及一种足式机器人运动控制方法、装置、设备及介质。
背景技术
在机器人控制领域中,通常是先确定足式机器人质心运动轨迹,进而根据质心运动轨迹确定控制足式机器人的运动控制参数。
相关技术在确定质心运动轨迹时,足式机器人的状态数据大多是采用固定的取值计算质心运动轨迹,如此一来,计算出的运动控制参数往往不能与环境相适应,导致依据运动控制参数控制足式机器人时,足式机器人在于环境的适应性上表现较差。
发明内容
本申请实施例提供一种足式机器人运动控制方法、装置、设备及介质,用于提高足式机器人运动与环境的适应性。
一方面,提供一种足式机器人运动控制方法,包括:
根据规划周期内起始时刻的状态数据,确定在所述规划周期内各足端的候选落脚点;
根据所述起始时刻的状态数据和所述各足端的候选落脚点,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;
在约束条件集合的约束下,确定满足所述第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点;
根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,控制所述足式机器人在所述规划周期内运动。
又一方面,提供一种足式机器人运动控制装置,包括:
候选落脚点确定模块,用于根据规划周期内起始时刻的状态数据,确定在所述规划周期内各足端的候选落脚点;
关系式确定模块,用于根据所述起始时刻的状态数据和所述各足端的候选落脚点,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;
目标确定模块,用于在约束条件集合的约束下,确定满足所述第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点;
运动控制模块,用于根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,控制所述足式机器人在所述规划周期内运动。
在一种可能的实施例中,所述关系式确定模块具体用于:
从所述规划周期内确定出多个采样时刻;
根据所述多个采样时刻,确定每个时间间隔与迈步占空比相关的第二关系式;其中,每个时间间隔是指每个采样时刻与所述起始时刻之间的时间间隔;
针对每个采样时刻,根据第三关系式,以及对应采样时刻的第二关系式与质心位置变化系数的关系式,获得质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;其中,所述第三关系式表示每个采样时刻所述足式机器人的足端接触力与对应采样时刻的质心位置、质心加速度和候选落脚点之间的变化关系,其中对应采样时刻的质心位置设置为起始时刻的起始质心位置与在时间间隔内的质心位置变化量之和。
在一种可能的实施例中,所述第三关系式中质心加速度是通过质心位置变化量求时间的二阶导数表示,其中质心位置变化量采用第二关系式和所述质心位置变化系数表示。
在一种可能的实施例中,所述起始时刻的状态数据包括起始时刻的给定姿态,所述关系式确定模块具体用于:
根据所述起始时刻的给定姿态,以及所述规划周期内结束时刻的给定姿态,确定足式机器人每个采样时刻的给定姿态,以及确定足式机器人每个时刻的姿态变化角参数;
针对每个采样时刻,根据对应采样时刻的给定姿态,以及对应采样时刻的姿态变化角参数,确定每个采样时刻的质心角动量对时间的一阶导数;
针对每个采样时刻,根据对应采样时刻的质心角动量对时间的一阶导数,以及所述第三关系式,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式。
在一种可能的实施例中,所述约束条件集合包括用于约束所述足式机器人落脚点的空间落脚点约束条件,所述目标确定模块具体用于:
针对每个采样时刻,根据所述足式机器人在对应采样时刻的给定姿态、以及空间落脚点约束条件,确定质心位置变化系数、迈步占空比与对应采样时刻的落脚点之间的目标约束条件;
确定满足每个采样时刻的目标约束条件和每个采样时刻的第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点。
在一种可能的实施例中,当约束条件集合还包括摩擦力约束条件时,所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚点满足所述摩擦力约束条件;所述摩擦力约束条件用于约束每个采样时刻的足端接触力位于摩擦锥内,所述摩擦锥是根据落脚点的法向量以及落脚的足端与接触面之间的摩擦系数确定的;
当所述约束条件集合还包括足端接触力约束条件时,所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚点满足所述接触力约束条件;所述足端接触力约束条件用于约束足端接触力在法线方向上的分量小于或等于作用力上限。
在一种可能的实施例中,所述目标确定模块具体用于:
获得满足所述第一关系式和约束条件集合的多组候选结果;其中,每组候选结果包括质心位置变化系数、迈步占空比和落脚点;
根据所述多组候选结果中每组候选结果,确定每组候选结果的代价函数的取值;其中,所述代价函数是根据候选结果所包括的相关量构建的二次项;
将取值最小的代价函数对应一组候选结果确定为目标结果。
在一种可能的实施例中,所述目标确定模块具体用于:
根据每组候选结果,对在所述规划周期内足端接触力的平方和、在所述规划周期内质心位置变化量的平方和、以及在所述规划周期内结束时刻的规划质心状态数据与对应的期望质心状态数据之间差值的平方和三者进行加权;
其中,所述规划质心状态数据是根据候选结果中的迈步占空比和质心位置变化系数确定的,所述期望质心状态数据是根据候选结果中的落脚点确定的。
在一种可能的实施例中,所述运动控制模块具体用于:
根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,确定所述足式机器人的目标运动控制参数;
根据所述足式机器人的目标运动控制参数,控制所述足式机器人在所述规划周期内运动。
在一种可能的实施例中,所述运动控制模块具体用于:
根据所述目标质心位置变化系数,确定所述足式机器人在每个时刻的规划质心位置,以及根据所述起始时刻的起始落脚点、所述目标落脚点和所述目标迈步占空比,确定所述足式机器人在所述规划周期内每个时刻的期望足端位置;
根据所述起始时刻的期望姿态,以及所述足式机器人在结束时刻的期望姿态,确定所述足式机器人在每个时刻的期望姿态;
针对每个时刻,对所述足式机器人在对应时刻的规划质心位置、对应时刻的期望姿态、对应时刻的期望足端位置进行逆运动学运算,确定所述足式机器人在对应时刻的期望关节角度;
针对每个时刻,根据对应时刻的期望关节角度,以及对应时刻的实际关节角度,确定所述足式机器人每个时刻的关节力矩。
在一种可能的实施例中,所述候选落脚点确定模块具体用于:
采集所述足式机器人当前所处环境的三维点云图;
从所述三维点云图中确定可落脚点的候选平面;
根据所述起始时刻,从所述候选平面中,确定出每次与接触面接触的足端所对应的候选落脚点。
本申请实施例提供一种足式机器人运动控制设备,包括:
存储器;
至少一个处理器,与所述存储器连接;
其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述至少一个处理器通过执行所述存储器存储的指令实现如一方面中任一项所述的方法。
本申请实施例提供一种存储介质,所述存储介质存储有计算机指令,当所述计算机指令在计算机上运行时,使得计算机执行如一方面中任一项所述的方法。
由于本申请实施例采用上述技术方案,至少具有如下技术效果:
本申请实施例中,根据足式机器人在起始时刻的状态数据,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式,并利用约束条件集合以及该第一关系式,确定足式机器人的目标质心位置变化系数、目标落脚点、目标迈步占空比,进而确定足式机器人的运动控制参数,并控制足式机器人运动,由于本申请实施例在确定目标运动控制参数时,是根据足式机器人当前所处的实际状态和运动环境情况去规划质心位置、迈步占空比和落脚点,从而使得确定的质心位置、迈步占空比和落脚点与实际运动环境更相符合,即提高了足式机器人的运动对环境的适应能力。且,本申请实施例中能够实现自动生成足式机器人的质心位置和迈步占空比,以及实现自动选取足式机器人的落脚点,提高了足式机器人的智能化程度。
附图说明
图1为本申请实施例提供的足式机器人运动控制方法的应用场景示例图;
图2为本申请实施例提供的足式机器人运动控制系统的架构图;
图3为本申请实施例提供一种工作空间的示例图;
图4A为本申请实施例提供的一种足式机器人的结构示例图;
图4B为本申请实施例提供的一种摩擦锥的示例图;
图5为本申请实施例提供的一种足式机器人运动控制方法的流程图;
图6为本申请实施例提供的一种采样时刻的分布示意图;
图7为本申请实施例提供的一种足式机器人的运动过程示例图;
图8为本申请实施例提供的一种足式机器人运动控制装置的结构示意图;
图9为本申请实施例提供的一种足式机器人运动控制设备的结构示意图。
具体实施方式
为了更好的理解本申请实施例提供的技术方案,下面将结合说明书附图以及具体的实施方式进行详细的说明。
为了便于本领域技术人员更好地理解本申请的技术方案,下面对本申请涉及的名词进行介绍。
机器人(Robot):包括各类模拟人类行为或思想上模拟其他生物的机械(如机器狗,机器猫等)。在广义上某些电脑程序也被称为机器人。在当代工业中,機器人指能自动执行任务的人造机器人,用以取代或协助人类工作,可以是机电装置,或由电脑程序或电子电路控制。
足式机器人:泛指具有足端的机器人,足式机器人可以配置一个或多个腿,每个腿可以配置一个或多个关节,通常一只腿对应是三个关节,每条腿对应一个足端,足式机器人例如两足机器人、四足机器人或六足机器人等。四足机器人例如机器狗。由于足式机器人可能包括多个足端,而在不同时刻落足的足端可能是不同的,因此为了便于区分,可以将足式机器人的各个足端表示为第一足端、第二足端……第i足端等。
规划周期:是指每一次规划机器人的运动时间长度。规划周期的长度可以是任意的,可以根据规划需求设定。规划周期包括多个时刻,在本申请中从规划周期中多个时刻中选择出的时刻称为采样时刻。在足式机器人的实际运动过程中,规划足式机器人从A到B,从A到B点所需的总时长可以划分为多个规划周期,将控制足式机器人从A到B的过程具体划分为控制足端机器人依次完成各个规划周期所对应的运动。
起始时刻:是指机器人在规划周期内开始运动的时刻。起始时刻例如可以从0开始计时。起始时刻对应机器人所在的位置可以称为起始位置。
终止时刻:又可以称为结束时刻,是指在规划周期内结束运动的时刻,即机器人沿规划周期停止运动的时刻。终止时刻对应机器人的位置可以称为结束位置或结束位置。
状态数据:包括机器人的质心状态数据,还可以包括机器人的姿态、落脚点和足端位置等。由于状态数据与机器人在当前的状态相关,因此机器人在不同时刻所对应的状态数据不同。
质心状态数据:是指用于描述机器人质心状态变化的数据,具体包括机器人的质心位置、质心速度或质心加速度中的一种或多种。质心位置为机器人质量的中心位置,用于描述机器人的位置,机器人在不同的运动状态下,其质心位置会发生变化。质心速度可以由质心位置对时间求一阶导得到,质心加速可以由质心位置对时间求二阶导得到。为了便于描述,起始时刻的质心位置可以称为起始质心位置,起始时刻的质心速度可以称为起始质心速度,起始时刻的质心加速度可以称为起始质心加速度。同理,结束时刻的质心位置可以称为终点质心位置,结束时刻的质心速度可以称为终点质心速度,结束时刻的质心加速度可以称为终点质心加速度。
给定姿态:机器人在运动过程中,每个时刻对应不同的姿态,在控制机器人运动之前,可以设定机器人在起始时刻的姿态和设定结束时刻的姿态,设定的姿态即为给定姿态。给定姿态可以用矩阵、向量或者多个坐标值等进行表示。
期望姿态:是指根据机器人的落脚点所确定出的机器人在各时刻对应的姿态。由于起始时刻的姿态是已知的,因此起始时刻实际的姿态又可以视为起始时刻的期望姿态,又可以视为起始时刻的给定姿态。
落脚点:是指机器人足端与接触力接触的位置,用于泛指机器人的落脚点,可以是起始落脚点或候选落脚点,当候选落脚点被选中作为足端的落脚点时,则该候选落脚点又可以视为目标落脚点。其中起始落脚点是指起始时刻对应的足式机器人的落脚点。
候选落脚点:是指在机器人的足端与接触面接触时,确定的足端与接触面可能接触的位置,通常是根据机器人的运动环境为机器人的每次落脚的足端确定的一个或多个候选落脚点。例如,在第i腿落脚的的候选落脚点包括A、B和C三个。
目标落脚点:是指从候选落脚点中最终确定出的被选中的候选落脚点。在本申请实施例中,目标落脚点的选择实际可以用一组二进制数βij表示,在确定出βij的取值之后,自然能够对应确定出被选中的候选落脚点,对应也就能获得目标落脚点的取值。
质心位置变化系数:质心位置变化系数用于描述质心位置随时间变化的参数。质心位置变化系数以矩阵形式表示,或者以向量形式表示等。质心位置变化系数与时间间隔能够共同表示特定时刻的质心位置,该时间间隔是指该特定时刻与起始时刻之间的时间差。
接触面:是指机器人的足端与环境所接触的面,接触面例如地面、或其它与足端接触的支撑物等。应当说明的是,由于路面不平整等其它情况,足式机器人所对应的接触面可能是不同的。本申请实施例中是以足端接触接触面为例进行说明,但本申请实施例涉及的方法依旧适用于足式机器人其它部位与接触面接触的情况。
质心运动轨迹:又可以称为质心位置运动轨迹,又可以称为质心轨迹,用于描述机器人在不同时刻的质心位置。质心运动轨迹实际由机器人在不同时刻的质心位置组成。
接触点的数量:是指机器人与接触面接触的足端的数量。当然,机器人在不同时刻,与接触面接触的足端的数量不完全相同,因此接触点的数量随时间可能发生变化。
迈步时序:机器人在什么时候迈什么腿,具体包括迈步时间和迈步顺序。其中,迈步时间用于描述机器人在规划周期过程中什么时候迈腿。迈步顺序是指机器人在规划周期内迈腿的顺序,例如机器人先迈左腿、再迈右腿等。
足端接触力:是指机器人的足端与接触面之间的接触力大小,当机器人的足端与接触面不接触时,则该足端与接触面之间不存在足端接触力,或者足端接触力为0。
约束条件集合:是指用于约束质心位置变化系数、迈步占空比、落脚点和足端接触力四个变量中的一个或多个。约束条件集合包括一个或多个约束条件。本申请实施例中的约束条件集合包括空间落脚点约束条件、摩擦力约束条件和接触力约束条件。空间落脚点约束条件用于约束足式机器人质心位置所对应的落脚点均是足式机器人的足端可达的。该空间落脚点约束条件实际用于约束机器人的质心位置变化系数、迈步占空比和落脚点。摩擦力约束条件用于约束接触面接触的足端与接触面之间摩擦力大小,以避免足式机器人与接触面之间出现打滑的情况,摩擦力约束条件具体用于将足端接触力约束在摩擦锥内,而摩擦锥是根据足式机器人在候选落脚点的法向量和落脚的足端与接触面之间的摩擦系数确定的。足端接触力约束条件用于约束足端接触力在法线方向上的接触力小于或等于接触力上限,以避免足式机器人与接触面之间的作用力过大。
目标运动控制参数:是指用于控制足式机器人运动所需的参数,具体包括足式机器人在每个时刻的期望关节角度和每个时刻的关节力矩等。
迈步占空比:是指机器人在规划周期内执行迈步的腿的迈步时间与规划周期的比值。在规划周期内,任意两个执行迈步的腿的迈步占空比是相同的。
姿态变化角参数:包括机器人姿态变化角、姿态变化角速度和姿态变化角加速度。姿态变化角可以理解机器人从一个姿态变化至另一个姿态的变化角度,例如机器人从A点以第一姿态移动至B点,机器人在B点也是第一姿态,那么机器人的姿态变化角度为0。姿态变化角速度是姿态变化角度对时间求一阶导数获得,姿态变化角加速度是姿态变化角度对时间求二阶导数获得。
另外,本申请实施例中的“多个”是指两个或两个以上,“至少一个”是指一个或多个。
为了提高生成的运动控制参数与环境之间的相符程度,本申请实施例提供一种足式机器人运动控制方法,下面对本申请实施例涉及的足式机器人运动控制方法的设计思想进行介绍。
本申请实施例中确定足式机器人足端对应的多个候选落脚点,根据足式机器人状态数据,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式,并根据多个候选落脚点,利用该第一关系式和约束条件集合,确定出足式机器人的目标质心位置变化系数、目标落脚点和目标迈步占空比,进而根据目标质心位置变化系数、迈步占空比确定足式机器人的质心运动轨迹,并根据质心运动轨迹和目标落脚点,确定目标运动控制参数,利用目标运动控制参数控制足式机器人在规划周期内运动。由于本申请实施例中在确定足式机器人的目标运动控制参数时,足式机器人的质心位置变化系数、迈步占空比和落脚点变量等均是根据实际情况规划出来的,因此使得基于这些变量确定出的运动控制参数能够更符合足式机器人的实际运动,从而提高运动控制参数与环境之间的适应性。
进一步地,本申请实施例中可以根据第一关系式、约束条件集合,以及代价函数构建混合整数二次规划,利用求解混合整数二次规划的方式求解目标质心位置变化系数、目标落脚点和目标迈步占空比。由于混合整数二次规划问题如果存在解,必然能够求解出全局最优解,因此将求解目标质心位置变化系数、目标落脚点和目标迈步占空比转换为混合整数二次规划问题,使得能够求解出最优的目标质心位置变化系数、目标落脚点和目标迈步占空比。
基于上述设计思想,下面对本申请实施例中足式机器人运动控制方法的应用场景进行介绍。
该足式机器人运动控制方法适用于控制各类足式机器人在各种环境下的各种步态。各类足式机器人例如双足机器人、四足机器人等。各种环境例如平地、不平地面、斜坡或楼梯等。各种步态例如双足行走、四足行走、四足小跑和随机步态等。
请参照图1,为一种足式机器人运动控制方法的应用场景图,或者可以理解为足式机器人运动控制系统的架构图,该架构图包括足式机器人110和控制设备120,下面对控制设备120与足式机器人110之间的交互进行示例介绍。
在一种可能的情况中,控制设备120与足式机器人110是相对独立的两个设备:
在该情况下,足式机器人110和控制设备120之间通过有线或无线进行通信,图1中是以足式机器人110和控制设备120之间利用通信网络实现通信为例。
在控制足式机器人110运动之前,控制设备120可以根据用户的操作,或者足式机器人110的任务,设置足式机器人110起始时刻的状态数据。或者,足式机器人110可以检测起始时刻的状态数据,并将起始时刻的状态数据上传至控制设备120。或者,控制设备120直接采集足式机器人110在起始时刻的状态数据。
进一步地,控制设备120采集足式机器人110当前所处的环境图像,或接收足式机器人110上报的环境图像,控制设备120根据该环境图像确定足式机器人110在规划周期内需要落脚的足端可能的候选落脚点。当然,控制设备120确定候选落脚点的方式有多种,下文进行具体介绍。
控制设备120根据状态数据,以及候选落脚点,确定足式机器人110的运动控制参数,进而控制足式机器人110进行相应的运动。其中,确定运动控制参数的内容将在下文中进行介绍。
控制设备120可以通过服务器或终端实现,服务器包括但不限于:独立的物理服务器、多个物理服务器构成的服务器集群、或者分布式系统,还可以是提供云服务、云数据库、云计算、云函数、云存储、网络服务、云通信、中间件服务、域名服务、安全服务、内容分发网络(Content Delivery Network,CDN)、以及大数据和人工智能平台等基础云计算服务的云服务器。终端例如手机、个人计算机、智能电视或便携式平板电脑等。
在另一种可能的情况中,控制设备120为足式机器人110的一部分:
控制设备120可以设置在足式机器人110的机体内,例如,控制设备120为足式机器人110中的内部处理器等。
在控制设备120控制足式机器人110运动之前,控制设备120可以从上位机接收运动指令,或根据用户的输入操作以获得运动指令,该运动指令可以指示足式机器人110执行某项任务,或者指示足式机器人110规划周期内的起始时刻和结束时刻。上位机可以为与控制设备120无线或有线连接的任意设备,上位机例如终端或服务器等。
同理,控制设备120采集足式机器人110状态数据。控制设备120可以根据足式机器人110当前所处的环境图像,确定足式机器人110每次落脚的足端可能的候选落脚点。控制设备120根据状态数据和候选落脚点,确定足式机器人的目标运动控制参数,以控制足式机器人110运动。其中,确定目标运动控制参数的内容将在下文中进行介绍。
为了更清楚地介绍控制设备120的结构,下面结合图2所示的足式机器人运动控制系统进行示例介绍,图2中是以控制设备120包括视觉感知单元210、轨迹生成单元220和运动控制单元230为例。
其中,视觉感知单元210可以设置在足式机器人110上,例如搭载在足式机器人110的头部。视觉感知单元210例如包括摄像头、红外摄像头中的一种或多种。摄像头例如RGBD摄像头。视觉感知单元还包括用于实现即时定位与地图创建(Simultaneous Localizationand Mapping)功能。
视觉感知单元210采集机器人的状态数据。状态数据包括足式机器人110起始时刻的状态数据。
另外,视觉感知单元210还可以采集足式机器人110所处的环境图像,获得足式机器人110每次落脚可能的候选落脚点。在获得状态数据、环境图像之后,视觉感知单元210可以将状态数据和环境图像发送至轨迹生成单元220。
或者,轨迹生成单元220可以通过足式机器人110的内部传感器和外部传感器获得足式机器人110的状态数据。或者轨迹生成单元220可以将上一个规划周期的结束时刻的期望状态数据作为当前对应规划周期的起始时刻的状态数据。或者,轨迹生成单元220通过运动控制单元230的状态估计器获得足式机器人110的状态数据。
轨迹生成单元220接收并根据状态数据和候选落脚点,确定足式机器人110在多个时刻的质心位置、目标落脚点和迈步占空比,并根据多个时刻的质心位置和迈步占空比等获得该足式机器人110的质心运动轨迹,进而根据质心运动轨迹和目标落脚点确定足式机器人110的全身运动轨迹,将全身运动轨迹和目标落脚点发送给运动控制单元230。
运动控制单元230可以根据全身运动轨迹和目标落脚点,确定该足式机器人110各个关节的关节力矩,按照各个关节力矩,控制足式机器人110的各个关节转动,从而实现足式机器人110的运动。
进一步地,运动控制单元230还可以监测足式机器人110移动的过程中实时的状态数据,根据实时的状态数据,控制足式机器人110的运动,以保证足式机器人110能够稳定移动。
基于上述应用场景,下面对本申请实施例涉及的足式机器人运动控制方法的总体思路进行介绍:
本申请实施例,根据状态数据以及各足端的候选落脚点,确定质心位置变化系数、足端接触力、落脚点以及迈步占空比之间的第一关系式,并基于该第一关系式以及约束条件集合,进而求解出质心位置变化系数、迈步占空比和落脚点,进而根据目标质心位置变化系数和目标迈步占空比,获得足式机器人110的质心运动轨迹,并根据质心运动轨迹、目标占空比和目标落脚点确定足式机器人110的目标运动控制参数,利用目标运动控制参数控制足式机器人110的运动。
进一步地,在确定质心位置变化系数、目标落脚点和目标迈步占空比时,可以结合约束条件集合和第一关系式,将确定质心位置变化系数、落脚点和迈步占空比的问题转换为一个混合整数二次规划问题,通过求解该混合整数二次规划问题,以获得目标质心位置变化系数、目标落脚点和目标迈步占空比。第一关系式以及约束条件集合是控制设备120中预配置的,或者控制设备120从其他设备或网络资源获取的,或者由控制设备120创建的。下面对控制设备120创建第一关系式和约束条件集合的方式进行示例介绍:
一,获得第一关系式:
控制设备120可以从网络资源或其他设备获得每个时刻的质心位置与对应时刻的足端接触力之间的关系式,足端接触力的含义可以参照前文论述的内容,此处不再赘述。将该关系式中每个时刻的质心位置采用起始质心位置、质心位置变化系数和时间间隔共同表示,并将时间间隔采用迈步占空比表示,从而将每个时刻的质心位置与对应时刻的足端接触力之间的关系式转换为质心位置变化系数、足端接触力、落脚点以及迈步占空比之间的第一关系式。在获得第一关系式之后,控制设备120可以以任意形式存储该第一关系式,任意形式例如函数形式、描述语句形式等。
下面对控制设备120创建第一关系式的过程进行具体示例介绍:
1:获得足式机器人110的质心动力学运动方程。
质心动力学运动方程用于表示足式机器人110的运动与所受外力之间的关系。质心动力学运动方程可以有多种表达形式,例如牛顿-欧拉方程,一种质心动力学运动方程示例如下:
其中,m为足式机器人110的总质量,g∈R3为重力加速度,pG∈R3为足式机器人110的质心位置,为足式机器人110与接触面接触的第i个接触点的位置,或者也可以称为落脚点,即表示与接触面接触的足端的位置,L∈R3为足式机器人110的质心角动量,/>表示由质心角动量对时间求一阶导,fi∈R3为第i个接触点的足端接触力,Nc为接触点的个数,即落脚的足端的数量,/>运算是指()的斜对角阵,/>表示由pG对时间间隔求二阶导,I表示单位矩阵。R3表示坐标系下的三个坐标值。
应当说明的是,本申请实施例中在没有特定说明的情况下,各个量均是在世界坐标系下的表示结果。例如公式(1)中的各个变量均是在世界坐标系下的表示结果。
需要说明的是,公式(1)中的前三行是根据牛顿定律获得的,后三行是根据欧拉方程获得的。
进一步地,根据上述公式(1)中的前三行可知:将公式(2)代入公式(1),获得如下公式:
其中,Gi∈R3×3是3×3的矩阵。
2:将质心动力学运动方程中每个时刻的质心位置表示为从起始质心位置与经过时间间隔t后的质心位置变化量之和,获得第三关系式。
①:将质心位置设置表示为起始时刻的质心位置到经过时间间隔t后的质心位置变化量之和,具体为:
pG=pinit+pt (4)
其中,pinit表示起始质心位置,pt表示经过时间间隔t后的质心变化量。
②:将公式(4)代入公式(3),获得第三关系式如下:
下面对上述第三关系式中的各项进行分析:
第一项与/>和pt呈线性关系,第二项/>为常数项,第三项/>存在/>第四项/>存在/>和/>的乘积。
作为一种实施例,当足式机器人110的姿态变化较小时,近似为03×1,或者,可以根据足式机器人110预配置的每个时刻的姿态,确定出该第三项/>的取值。
在一种可能的实施例中,的取值可以根据起始时刻足式机器人的给定姿态和结束时刻的给定姿态确定,下面对确定/>的公式进行说明:
在规划周期内姿态变化量可以表示为:
ΔR=RteRts T (6)
其中,其中,本申请中的()T表示对()进行转置处理;ΔR为姿态变化量,Rts为起始时刻的给定姿态,Rte为结束时刻的给定姿态。其中,姿态变化量可以表示成绕某个单位轴1旋转某个姿态角度θ得到的:
其中,单位轴1为一个向量表示的旋转轴,ΔR11表示ΔR中第1行第1列的元素,ΔR22表示ΔR中第2行第2列的元素,ΔR23表示ΔR中第2行第3列的元素,ΔR32表示ΔR中第3行第2列的元素,ΔR21表示ΔR中第2行第1列的元素,ΔR12表示ΔR中第1行第2列的元素,ΔR21表示ΔR中第2行第1列的元素。
在满足如下条件下,对姿态变化角进行三次曲线插值:
其中,θts表示起始时刻的姿态变化角,θte表示终止时刻的姿态变化角,表示姿态变化角对时间的一阶导数在起始时刻的值,/>表示姿态变化角对时间的一阶导数在终止时刻的值,因此足式机器人在任意时刻的给定姿态可以表示为:
/>
其中,I表示单位矩阵,Rt∈R3×3为旋转矩阵,表示足式机器人110在对应时刻的给定姿态,θt表示任意时刻对应的姿态变化角度。
其中I0表示足式机器人在机体坐标系中的关于质心的转动惯量,表示足式机器人在某一坐标系下的转动惯量,该坐标系的原点为足式机器人110的质心位置处,该坐标系的姿态与世界坐标系的姿态相同,/>可以取固定值,/>表示在世界坐标系下ω的表示结果,ω表示机体坐标系下的角速度。/>表示姿态变化角速度,/>表示姿态变化角加速度。
3:将第三关系式中的第四项中的质心位置变化量表示为各个方向上变化量的矢量和,获得第五关系式:
其中,pt=pt xy+pt z,pt xy包括pt在x和y轴上的分量。是指质心位置变化量pt在xy轴构成的平面上的分量对时间的二阶导数,即质心加速度在x、y轴构成的平面上的分量;是指质心位置变化量pt在z轴上的分量对时间的二阶导数,即质心加速度在z轴上的分量;/>表示质心位置变化量pt在xy轴构成的平面上的分量的斜对角阵,/>表示质心位置变化量pt在z轴分量的斜对角阵。
pt xy的z坐标为0,pt z包括pt在z轴上的分量,pt z对应的x和y的坐标为0。产生绕z轴的力矩为xy平面内某一方向上的力矩为/> 由于/>和pt z共线,因此/>
另外,足式机器人110在z轴方向上的运动通常较为稳定,因此可以忽略pt z以及/>此外,pt xy,/>以及/>的绝对值较小,也可以忽略。在实际控制足式机器人110的过程中,可以通过调整足端与接触面之间的足端接触力来补偿上述公式(11)相关的力矩/>
作为一种实施例,可以忽略第三关系式中的第五项,获得第六关系式:
Gf≈H0xt-w (12)
其中:
其中,H0可以根据起始时刻的质心位置计算得的,w可以是固定值,或者根据足式机器人在每个时刻的姿态计算得到,xt包括质心位置变化量pt和质心加速度为待定量。
4:将质心位置变化量设置为以时间为自变量的n阶多项式,具体如下:
质心变化量pt可以表示为在x、y和z上的三个分量,质心位置变化量可以表示为:
p*t=[1t...tn]c* (13)
其中,c*=[c*,0 c*,1...c*,n]T∈Rn+1为多项式系数,t表示时间间隔,即该时刻与起始时刻对应时刻之间的时间间隔,*代表x、y和z,c是指质心位置变化系数,其包含了所有多项式系数。在实际应用中在获得质心位置变化系数c后,根据上述公式(13)能计算出任意时刻的质心位置。
作为一种实施例,n的取值大于或等于2的任意整数。
5:以迈步占空比表示每个时间间隔。
定义足式机器人的迈步占空比为:
其中,d表示迈步占空比,tsw表示足式机器人在规划周期内的单腿的迈步时长,tsd表示足式机器人在规划周期内的单腿的支撑时长。
在规划周期确定的情况下,足式机器人某个腿的规划周期te=tsw+ttd是已知的,且足式机器人执行迈步的每条腿的规划周期以及迈步占空比是相同的。
例如以足式机器人先迈腿后支撑情况为例:
单腿的迈步时长可以表示为:0~d*te
单腿的支撑时长可以表示为:d*te~te
A:采样点若取成迈步时长的n等分点,则任一的采样时刻与起始时刻之间的时间间隔可以表示为:
B:采样点若取成支撑时长的m等分点,则任一采样时刻与起始时刻之间的时间间隔可以表示为:
结合A和B两种情况,可以看出任一采样时刻与起始时刻之间的时间间隔均与迈步占空比d成线性关系,因此可以将任一采样时刻与起始时刻之间的时间间隔采用迈步占空比表示为如下第二关系式:
t=ktd+bt (15)
结合公式(15),可以将公式(13)表示为如下公式:
其中,
其中,上述(16)中的Kpt中右上角第i行第j列元素可以表示为其中,2≤i+1≤j≤n+1,/>为第j-1个数中选取i个数的组合数。
将公式(16)对时间求二阶导,获得如下第四关系式:
at与前文中的相同,表示质心加速度,其中:/>
Kat右上角第i行第j列的元素为
结合公式(12)、公式(16)以及公式(18),得出如下公式:
其中,Tp=[pxt pyt pzt]T,Ta=[axt ayt azt]T。
其中,Tp表示质心变化量在x、y和z轴的质心变化分量的联合表示结果,pxt表示质心变化量在x轴方向上的分量,pyt表示质心变化量在y轴方向上的分量,pzt表示质心变化量在z轴方向上的分量。Ta表示质心加速度在x、y和z轴的质心加速度分量的联合表示结果,axt表示质心加速度在x轴方向上的分量,ayt表示质心加速度在y轴方向上的分量,azt表示质心加速度在z轴方向上的分量。
6:在公式(21)中引入候选落脚点。
足式机器人110中需要落脚的足端通常会有不止一个候选落脚点,即前文中涉及的ri∈{rij|j=1,2,3...Ni},rij表示第i足端的第j候选落脚点的位置,Ni表示第i足端的候选落脚点的数量。
作为一种实施例,只有被选中的候选落脚点对应的足端接触力fi的取值域才不为零,因此可以引入二进制变量βij∈{0,1},j=1,2,3...Ni表示被选中的目标落脚点具体是哪一个候选落脚点,即:
其中:
公式(23)表示Ni中二进制变量只有一个等于1,其余为0,表示只能选择一个候选落脚点作为目标落脚点。根据候选落脚点,对质心运动方程进行改写,获得如下改写后的质心运动方程为:
由于在不同时刻,fij、w、Ni的取值可能不同,因此可以将上述公式(24)进一步表示为如下所示的第一关系式:
应当说明的是,Tp=[pxt pyt pzt]T,Ta=[axt ayt azt]T。为了简化公式的表示,在公式(25)中并未示意T的具体表示。
下面举例对Nik说明,例如足式机器人110在起始时刻四足支撑站立,那么每个足端当前与接触面接触的位置为足式机器人110每个足端的起始落脚点,如果足式机器人在下一个时刻迈第i足端,而第i足端对应存在3个候选落脚点,那么这个时刻对应的Nik则为3,如果再下一个时刻迈第(i-1)足端,而第(i-1)足端存在4个候选落脚点,那么这个时刻对应的Nik则为4。
其中,在起始时刻时,rij则对应起始落脚点,在对应其它时刻时,rij则对应其它时刻所对应的候选落脚点。k表示第k个时刻,fijk表示第k个时刻且第i个足端第j个候选落脚点的足端接触力。wk表示第k个时刻所对应的w,w的具体计算公式可以参照前文的内容。
应当说明的是,上述是对创建第一关系式的过程进行示例说明,实际上述过程中可以利用其它的动力学方程描述足式机器人110的质心运动轨迹,进而对其它的动力学方程进行变换,以获得第一关系式。
二,获得约束条件集合:
约束条件集合包括一个或多个约束条件,每个约束条件是用于约束质心位置变化系数、落脚点、迈步占空比、足端接触力中的一个或多个的取值,每个约束条件的形式可以是不等式。约束条件集合包括空间落脚点约束条件、摩擦力约束条件和足端接触力约束条件中的一种或多种。各个约束条件的含义可以参照前文论述的内容,此处不再赘述。
应当说明的是,由于足式机器人110在每个时刻的足端接触力大小是不同的,因此每个时刻,足端与接触面之间的摩擦力也是不同的,因此摩擦力约束条件实际上约束了每个时刻接触面接触的足端与接触面之间的摩擦力大小,而接触力约束条件是约束了每个时刻足端接触力在法线方向上的接触力大小。
控制设备120可以是从网络资源、或其它设备获得约束条件集合、或者自行创建的约束条件集合,下面对控制设备120创建各个约束条件进行示例说明:
(1)获得空间落脚点约束条件:
1:将足式机器人110足端对应的工作空间近似为凸多面体,并获得该凸多面体中各个面的线性不等式的表示,联合各个面的线性不等式,获得凸多面体的线性不等式表示。凸多面体的线性不等式表示如下:
Si Txi≤di (26)
其中,Si=[si1 si2...sil]∈R3×l,di=[di1 di2...dil]∈R1,xi表示足式机器人110在该坐标系下的落脚点,di1是凸多面体中面与原点之间的距离,si1表示凸多面体中面对应的单位法向量,l表示凸多面体对应的面的数量,凸多面体是根据足式机器人110落脚的足端配置的关节的运动范围,以及关节的长度确定的。运动范围例如关节的转动范围或者关节的平动范围。
具体的,控制设备120根据足式机器人110关节的运动范围和关节的长度,离散地确定出足式机器人110的足端相对于该关节可达到的位置。该关节是落脚的足端配置的关节,具体可以是与该足端直接连接的关节,或者与该足端通过关节所连接的其它关节。关节的运动范围是指关节能够运动的最小角度和最大角度组成的范围,例如关节的运动范围为0°~120°,该运动范围通常是已知的。关节的长度例如为1米。
在离散地确定出足式机器人110的足端相对于该关节可达到的多个位置后,控制设备120拟合多个位置,从而获得足式机器人110足端的工作空间。而足式机器人110足端的工作空间一般呈非凸区域,但可以通过拟合方式将工作空间近似为凸多面体。凸多面体具体如图3中所示的凸多面体310,图3中所示的多个点中每个点表示足端相对于该关节可达到的位置。
在近似成凸多面体之后,控制设备120可以获得该凸多面体中每个面的线性不等式表示,每个面的线性不等式表示具体表示为sil Txi≤dil。控制设备120联合该凸多面体各个面的不等式,从而获得如上述的公式(26)。
在具体实施时,上述公式(26)可以在关节的局部固定坐标系中进行,关节的局部固定坐标系是指以该关节的局部为坐标原点建立的坐标系,即关节的局部固定坐标系的坐标原点与世界坐标系下的坐标原点可能不同。关节可以是与落脚的足端相关的任一关节。
例如,请参照图4A,为足式机器人110的结构示意图,该足式机器人110包括多个关节410,4个足端420,每个足端420配置有多个关节,关节的局部固定坐标系如图4A中所示的坐标系。在该关节的局部固定坐标系下,各个变量均可以根据该关节的局部固定坐标系分解为多个变量。
如前文论述的内容,控制设备120已提前确定出了需要落脚的足端所对应的候选落脚点430,控制设备120可以根据上述公式(26)判断选择的某个候选落脚点430是否位于足端的凸多面体内。例如,可以判断足式机器人110在时间间隔t后,第i足端的落脚点是否位于该凸多面体中。
2:将落脚点位置ri转换为局部固定坐标系的表示,获得第六关系式。
由于上述公式(26)为局部固定坐标系下的表示结果,因此需要将世界坐标系(又可以称为全局坐标系)下的落脚的足端的位置ri转换为局部固定坐标系下的表示结果xi,具体转换过程表示为:
其中,pi1∈R3为足式机器人110中第i足端的关节相对于足式机器人110质心在身体坐标系中的位置,Ri1∈R3为关节在局部固定坐标系中相对于身体坐标系的姿态。pi1和Ri1均为常量。
作为一种实施例,当足式机器人110的姿态变化较小时,Rt可以为常数,或者控制设备120可以根据对应时刻足式机器人110的给定姿态确定。
3:将公式(16)中质心位置表示为与时间相关的n阶多项式,并代入第六关系式中,获得第七关系式:
控制设备120联合上述公式(4)、(16)、(26)和(27),获得第七关系式为:
AiTP+Biri≤bi (28)
其中:
4:将选中的候选落脚点和时间引入第七关系式,获得空间落脚点约束条件:
将被选中的候选落脚点引入第七关系式,具体结合公式(22)和公式(28),获得第九关系式表示为:
由于不同时刻,该空间落脚点约束条件中对应的某些量取值不同,因此可以将时间引入第九关系式,获得空间落脚点约束条件为:
其中,TPk、Aik、Bik、bik和Nik分别表示第k个时刻对应的TP、Ai、Bi、bi和Ni。
下面对控制设备120创建摩擦力约束条件和接触力力约束条件的方式进行示例:
(2)获得摩擦力约束条件:
1:确定每个接触力对应的摩擦力约束表示,获得第八关系式:
每个足端接触力fi(i=1,2...Nc)均受到摩擦力约束,摩擦力约束是将足端接触力约束在摩擦锥内,摩擦锥一般是圆锥体,但因为圆锥体的表达是非线性的三角函数,因此在本申请实施例中将圆锥体近似为内接四棱锥,而内接四棱锥可以通过四棱锥的四个面联合表示,因此在本申请实施例中的摩擦力约束条件具体可以近似为如下第八关系式:
其中,Ni=-[μini-oi μini+oi μini-ti μini+ti]∈R3×4,ni表示第i足端的落脚点的法向量,oi表示第i足端的落脚点的在一个切线方向上的向量,ti第i足端的落脚点的另一个切线方向上的向量,μi表示足端与接触面之间的摩擦系数。Ni可以理解为摩擦锥的四个面约束,满足公式(32)的足端接触力是位于摩擦锥内的。
例如请参照图4B,表示一种摩擦锥的示例图,摩擦锥为图4B中所示的圆锥体,在本申请实施例中将圆锥体用图4B中所示的内接四棱锥进行替换。
例如,继续参照图4A,图4A中表示由接触点的法向确定的局部坐标系,该局部坐标系可以参照如图4A中所示的oi、ni和ti,图4A中的oi、ni和ti分别与图4B中的oi、ni和ti对应。
应当说明的是,足端所接触的接触面材质不同时,对应的摩擦系数的取值也可能不同,在同一个时刻,不同足端所接触的接触面不同,不同足端与接触面之间的摩擦力系数也可能不同。
应当说明的是,本申请实施例中是将圆锥体近似为内接四棱锥为例进行说明,但实际上该圆锥体可以近似为其它多棱锥,具体不做限定。
2:在第八关系式中引入时间和落脚的足端,获得摩擦力约束条件。
具体的,足端对应的位置rij处的法向量为nij,足端接触力为fij,获得第九关系式:
其中,Nij=-[μinij-oij μinij+oij μinij-tij μinij+tij]∈R3×4,nij表示第i足端对应第j个候选落脚点的法向量,oij表示第i足端对应第j个候选落脚点的在一个切线方向上的向量,tij第i足端对应第j个候选落脚点在另一个切线方向上的向量,μi表示足端与接触面之间的摩擦系数。
在不同时刻,足端接触力大小不同,因此可以在公式(32)中引入时刻,获得摩擦力约束条件为:
其中,fijk表示第k个时刻且第i足端第j个候选落脚点的足端接触力。
(3)获得接触力约束条件:
足式机器人110在运动过程中,足端与接触面之间的足端接触力如果过大,容易损害足式机器人110的部件,因此可以设置接触力约束条件,约束足式机器人110与接触面之间的足端接触力大小,避免足式机器人110每次运动与接触面之间的作用力过大。
下面对控制设备120创建接触力约束条件的方式进行示例:
1:将足端接触力在法线方向上的分力设置为小于或等于接触力上限,获得第十关系式:
其中,表示接触力上限,其取值可以根据实际情况设置,例如可以参照足式机器人的重力设置。
2:在第十关系式中引入时间和落脚的足端,获得接触力约束条件:
由于只有被选中的落脚点才能产生接触力,因此公式(34)可以改写为:
由于每个时刻的足端接触力不同,在公式(35)中引入时间,具体表示为:
其中,表示第i足端第j个候选落脚点所对应的/>的取值,fijk表示第k个时刻第i足端第j个候选落脚点的足端接触力。
由于第一关系式、约束条件集合所对应的关系式较少,而需要求解的未知量较多,因此满足第一关系式、约束条件集合的质心位置变化系数和落脚点等可能不止一个,因此在实际求解上述中的质心位置变化系数和目标落脚点时,可以从满足第一关系式、约束条件集合的取值中随机确定出目标质心位置变化系数、目标落脚点和目标迈步占空比。
或者,为了获得较佳的质心位置变化系数、落脚点和迈步占空比,本申请实施例中还可以引入代价函数,利用代价函数进一步地筛选出最优的质心位置变化系数、落脚点和迈步占空比,进而将最优的质心位置变化系数确定为目标质心位置变化系数,将最优的落脚点确定为目标落脚点,将最优的迈步占空比确定为目标迈步占空比。
由于求解混合整数二次规划问题必然地能够获得相应的解,因此本申请实施例中可以将确定目标质心位置变化系数、目标落脚点和目标迈步占空比转化为一个混合整数二次规划问题,为此,本申请实施例中的代价函数至少包括一个或多个变量的二次项,一个或多个变量可以是满足第一关系式和约束条件集合的候选结果相关的任意的变量。二次项可以根据变量的二次方构建的。
在一种可能的实施例中,代价函数包括如下的A1~A5中的至少一种:
A1:在规划周期内足端接触力相关的二次项;
A2:在规划周期内质心位置变化量的二次项;
A3:在规划周期对应的结束时刻的规划质心位置与期望质心位置之间差值的二次项;
在一种可能的实施例中,期望质心位置是根据候选结果中的落脚点确定的。
期望质心位置可以理解为足式机器人在规划周期内的目标落脚点构成的多边形的中心点上方某一合适高度的位置,中心点上方某一合适高度的位置具体可以是在中心点的基础上增加一个常数值,以获得期望质心位置。该常数值可以根据足式机器人的高度确定。或者该期望质心位置可以预先设定的。例如,目标落脚点具体包括4个目标落脚点,则可以确定4个目标落脚点的中心点,然后在该中心点的基础上增加足式机器人110的高度,从而获得期望质心位置。
规划质心位置可以根据质心位置变化系数确定,具体计算公式可以参照前文的公式(16)和公式(4)。
A4:在规划周期对应的结束时刻的规划质心速度与期望质心速度之间差值的二次项;
在一种可能的实施例中,期望质心速度是根据候选结果中的落脚点确定的,具体在确定期望质心位置之后,利用期望质心位置与初始质心位置的差值除以时间,从而获得期望质心速度。
根据式(16)的一阶导数关系式获得规划质心速度。
A5:在规划周期对应的结束时刻的规划质心加速度与期望质心加速度之间差值的二次项;
在一种可能的实施例中,期望质心加速度是根据候选结果中的落脚点确定的,具体在确定期望质心速度之后,利用期望质心速度与初始质心速度的差值除以时间,从而获得期望质心加速度。例如,根据式(18)获得规划质心加速度。
下面对上述各个二次项的作用进行分析:
A1的作用:足端接触力相关的二次项可以用于优化足端与接触面之间的作用力的分配,使得足式机器人110在行走过程中足端与接触面之间的作用力分配更为均匀。
A2的作用:质心位置变化量反应了质心运动轨迹的长度,有利于降低质心运动轨迹的震荡幅度。
A3~A5的作用:有利于降低计算结果与期望结果之间的误差。
联合上述A1~A5,一种代价函数的表达式如下:
Jgrf+Jlen+Jtgt (37)
其中,Jgrf为在规划周期内所有足端接触力的加权平方和,Jlen为每相邻两个时刻之间的质心位置变化量之间的差值的加权平方和,Jtgt为在规划周期对应的结束时刻的规划质心位置与期望质心位置之间差值、在规划周期对应的结束时刻的规划质心速度与期望质心速度之间差值和在规划周期对应的结束时刻的规划质心加速度与期望质心加速度之间差值的加权平方和。
在介绍完构建第一关系式、约束条件集合和代价函数之后,下面结合图5所示的足式机器人运动控制方法的流程,对本申请实施例具体如何利用构建出的第一关系式和约束条件集合,控制足式机器人运动的过程进行示例介绍,请参照图5,该方法包括:
S501,根据起始时刻的状态数据,确定在规划周期内各足端的候选落脚点。
在控制足式机器人110运动时,控制设备120是通过控制足式机器人110的足端的抬起和落下,进而实现足式机器人110的移动,使得足式机器人110能够完成从起始时刻至结束时刻的整个规划周期的运动。起始时刻为足式机器人110为当前时刻所在的位置。结束时刻为足式机器人110所要达到的位置,结束时刻可以是提前设定的,或者控制设备120根据足式机器人110所需执行的任务确定的。
状态数据的含义以及获取方式可以参照前文论述的内容,此处不再赘述。起始时刻的状态数据可以包括起始时刻的质心位置。起始时刻的状态数据还可以包括
起始时刻的质心速度和质心加速度,另外状态数据还可以包括足式机器人110在起始时刻的给定姿态。给定姿态、质心位置、质心速度或质心加速度均可以通过坐标系中的坐标表示或通过向量表示等。
作为一种实施例,规划周期、起始时刻和结束时刻是根据选择的足式机器人110的采样周期相关的,规划周期、起始时刻和结束时刻三者可以根据实际需要进行灵活设定。
例如,控制设备120可以将足式机器人110当前时刻对应的位置确定为起始时刻,控制设备120可以将第3s所对应的位置确定为结束时刻,在下一个采样周期时,可以选择第3s作为足式机器人110运动的起始时刻。
在获得起始时刻的状态数据之后,控制设备120可以确定在规划周期内各足端的候选落脚点。
具体的,足式机器人110从起始时刻到结束时刻过程中,可能有一个或多个足端落脚,每个足端可能落脚一次或多次,具体与设定的起始时刻和结束时刻相关,控制设备120可以预先为每次需要落脚的足端确定多个候选落脚点。候选落脚点是指足式机器人110在规划周期内可能的落脚点。落脚点可以用世界坐标系中的坐标表示或向量表示等。
在具体实现时,控制设备120可以通过视觉感知单元210采集足式机器人110的环境图像,并构建环境图像中各像素点与世界坐标系之间的转换关系。控制设备120通过环境图像,以及转换关系,确定沿起始时刻到结束时刻的移动方向上可能的候选落脚点。
控制设备120具体可以根据环境图像,识别从起始时刻到结束时刻中的障碍物,根据转换关系,确定沿起始时刻到结束时刻所对应的移动方向上的非障碍物的位置,并将确定出的位置作为候选落脚点。
或者,控制设备120通过视觉感知单元210采集环境的三维点云图,例如视觉感知单元210为RGBD摄像头时,可以采集得到三维点云图,或者例如通过采集足式机器人110当前所处的多个环境图像,对多个环境图像进行三维重建,获得三维点云图。根据环境的三维点云图,从三维点云图中确定足式机器人110可以落脚的候选平面,具体可以从三维点云图中确定能够支撑足式机器人的平面作为候选平面。控制设备120从候选平面中,确定足式机器人的足端所对应的候选落脚点。
由于足式机器人110在规划周期过程可能不止一次落脚,控制设备120可以确定出机器人在规划周期内的所有可能的候选落脚点,该所有可能的候选落脚点为每次落脚所对应候选落脚点。或者,在确定候选落脚点时,可以根据足式机器人110的运动速度,确定足式机器人110每次可能落脚的区域,并根据上述任一方式依次从每次可能落脚对应的区域中筛选出候选落脚点。
例如,请继续参照图4A,足式机器人110的当前位置如图4A所示,控制设备120分别确定足端的候选落脚点430包括图4A中所示的地面上的多个圆圈。
S503,根据起始时刻的状态数据和各足端的候选落脚点,确定质心位置变化系数、迈步占空比和落脚点之间的第一关系式。
其中,第一关系式例如前文论述的公式(14),变化关系的含义可以参照前文论述的内容,此处不再赘述。
参照前文公式(25)所示的第一关系式,该第一关系式中除了质心位置变化系数、足端接触力、落脚点和迈步占空比相关,还包括H0和wk等参数,因此可以通过状态数据等已知量确定这些参数的取值,进而获得只包含质心位置变化系数置、足端接触力、落脚点和迈步占空比四个未知量的第一关系式。
下面对控制设备120获得只包含质心位置变化系数、足端接触力、落脚点和迈步占空比四个未知量的第一关系式的方式进行具体示例介绍:
第一种可能的方式:
控制设备120根据起始时刻的状态数据,计算出公式(25)对应起始时刻的H0等参数,从而获得起始时刻对应的第一关系式。
具体的,公式(12)中涉及的wk计算公式中的可以取值为0,并根据起始时刻的质心位置,从而依据公式(12)计算出w的取值,由于这种情况下,每个时刻的w的取值是相同,因此每个时刻的wk均是相同的取值。
或者,在另外一种情况下,控制设备120可以根据起始时刻的给定姿态和结束时刻的给定姿态,结合公式(7)至(10)计算出,进而可以起始时刻所对应的wk的取值。控制设备120可以根据H0的计算公式,根据起始时刻的质心位置,计算出H0的取值。
控制设备120将计算出的起始时刻的H0的取值,以及起始时刻的wk的取值代入公式(25)中,并将起始时刻用迈步占空比进行表示,具体表示公式可以参照前文的公式(15),从而获得起始时刻对应的第一关系式。
进一步地,控制设备120可以根据起始时刻和迈步占空比表示出结束时刻,按照计算起始时刻对应的H0的取值,以及起始时刻的wk的取值的相同方式,计算出结束时刻的H0的取值和wk的取值,并根据迈步占空比表示的结束时刻,获得结束时刻对应的包含质心位变化系数、足端接触力、迈步占空比和落脚点第一关系式。
在该方式中,根据起始时刻所对应的第一关系式,以及结束时刻所对应的第一关系式,这样确定目标质心位变化系数、目标足端接触力、目标迈步占空比和目标落脚点所涉及的关系式较少,计算量较小。
在第二种可能的方式中:
从规划周期中获取多个采样时刻,确定每个采样时刻所对应的时间间隔与迈步占空比的第二关系式,结合第二关系式以及公式(25),确定出每个采样时刻所对应的第一关系式,根据每个采样时刻所对应的第一关系式,计算出目标质心位变化系数、目标足端接触力、目标迈步占空比和目标落脚点。
在实际对足式机器人110进行运动控制过程中,需要获得足式机器人110从起始时刻到结束时刻中任意时刻的质心位置,但这样的计算量较大,为此,本申请实施例中控制设备120可以通过获得采样周期中多个时刻中每个时刻的质心位置,基于这多个时刻的质心位置进而确定出足式机器人110的质心运动轨迹。下面对获得每个时刻所对应的第一关系式的方式进行示介绍:
S1.1,获得多个采样时刻。
控制设备120可以根据规划周期的总长度和足式机器人110的运动速度,预计足式机器人完成规划周期所需的规划周期,或者控制设备120预配置有足式机器人110完成规划周期所需的规划周期。该规划周期即为采样周期所对应的时长。控制设备120可以从采样周期中确定出多个采样时刻。
在获得规划周期之后,控制设备120可以从规划周期中随机采样,获得多个采样时刻。随机采样以获得采样时刻的方式较为简单。
或者,控制设备120根据足式机器人110的迈步时序,从每个运动阶段的持续时长中分别进行采样,以获得多个采样时刻。由于每个运动阶段都存在对应的采样时刻,这样可以保证各个运动阶段都能存在对应的采样时刻,利于提高后期确定出的质心运动轨迹的准确性。
作为一种实施例,任意相邻两个采样时刻之间的时间间隔可以是相同的,也可以是不相同的,不相同是指任意相邻两个采样时刻之间的时间间隔是不完全相同的,或者存在相邻两个采样时刻之间的时间间隔不相同。
作为一种实施例,采样时刻的个数越多,采样时刻的分布越合理,确定出的质心运动轨迹可靠性越高。但采样时刻越多,后续求解质心位置变化系数以及目标落脚点所构建的关系式的数量越多,求解质心位置变化系数以及目标落脚点所需时间越长,因此合理规划采样点的数量极为重要。在本申请实施例中,采样时刻至少包括每个运动阶段的阶段开始时刻和阶段终止时刻,以及每个运动阶段中的至少一中间时刻。中间时刻是指该运动阶段的阶段开始时刻和阶段终止时刻之间的任意时刻,例如可以选择该运动阶段的起始时刻和该运动阶段中的结束时刻的中间时刻。或者,可以按照规划周期对迈步阶段进行n等分,或者对采样支撑阶段进行m等分采样,n和m取正整数。
例如,将足式机器人110的四足行走步态设置为一个采样周期,控制设备120将该采样周期中足式机器人110的运动过程依次划分为八个运动阶段,八个运动阶段具体为:四足支撑移动质心(简称为4S)、迈右后足(简称为HR)、迈右前足(简称为FR)、四腿支撑移动质心(简称为4S)、四足支撑移动质心(简称为4S)、迈左后足(简称为HL)、迈左前足(简称为FL)和四足支撑移动质心(简称为4S)。
请参照图6所示的采样时刻分布示意图,八个运动阶段每个运动阶段的持续时长分别为图6中所示的t1、t2、t3、t4、t5、t6、t7和t8,为便于描述,八个运动阶段分别称为第一运动阶段和第二运动阶段,以此类推。控制设备120从每个运动阶段进行采样,获得如图6所示的第一运动阶段中的采样时刻为1和2,第二运动阶段中的采样时刻为2、3和4,第三运动阶段中的采样时刻为4、5和6,第四运动阶段中的采样时刻为6、7和8,依次类推,获得多个采样时刻。其中,图6中属于同一种形状的采样时刻表示属于同一个运动阶段中的采样时刻,不同形状的采样时刻表示两个采样时刻属于两个不同的运动阶段。
应当说明的是,由于一个采样周期内各个运动阶段是连续的,因此某个运动阶段的结束时刻既可以视为该运动阶段中的采样时刻,又可以视为下一个运动阶段的采样时刻,例如上述图6中的采样时刻4可以同时视为第二运动阶段和第三运动阶段中的采样时刻。
S1.2,从规划周期中确定出多个采样时刻,并确定每个时间间隔与迈步占空比相关的第二关系式。
控制设备120已知起始时刻和结束时刻,因此可以利用迈步占空比表示出每个时间间隔,即每个时间间隔可以用迈步占空比的第二关系式表示,第二关系式具体可以参照前文的公式(15)。每个时间间隔是指每个采样时刻与起始时刻之间的时间间隔。
参照前文中的公式(15),由于采样时刻具体如何划分是已知的,起始时刻和结束时刻是已知的,因此可以计算每个采样时刻所对应的第二关系式中的kt和bt的取值,从而获得每个时间间隔只与迈步占空比相关的第二关系式。
例如,足式机器人一个完整的迈步周期为例,假设足式机器人先迈腿后保持不动直至下一次迈腿,总运动时间为2s,占空比d。对于迈步阶段,进行n等分采样得到的第k个采样点的时间为2kd/n,对于支撑阶段,进行m等分采样得到的第k个采样点的时间为2d+2k(1-d)/m。
S1.3,针对每个采样时刻,根据对应时间间隔所对应的第二关系式、以及每个采样时刻的质心位置与足端接触力之间的第三关系式,获得质心位置变化系数、足端接触力、迈步占空比和落脚点之间的第一关系式。
所述第三关系式表示每个采样时刻足式机器人的足端接触力与对应采样时刻的质心位置、质心加速度、候选落脚点和足端接触力之间的变化关系,质心位置可以表示起始质心位置和质心位置变化量之和,第三关系式具体可以参照前文的公式(5)。
控制设备120已根据迈步占空比表示出各个时间间隔,因此可以结合第二关系式,以及第三关系式,从而获得质心位置变化系数、足端接触力、迈步占空比和落脚点之间的第一关系式。
具体的,控制设备120可以计算每个采样时刻所对应的上述公式(25)中的H0、wk的取值,并代入候选落脚点rij,从而可以获得质心位置变化系数、足端接触力、迈步占空比和落脚点四个未知量的第一关关系式。计算H0的取值的内容可以参照前文论述的内容,此处不再赘述。
其中,wk的取值可以是固定的,或者控制设备120确定足式机器人在每个采样时刻对应的姿态变化角度,并根据每个采样时刻的姿态变化角度,以及起始时刻对应的给定姿态,确定每个采样时刻的质心角动量对时间得一阶导数,也就是确定出的取值,进而计算出每个采样时刻对应的wk的取值。
进一步地,由于控制设备120获得足式机器人110的迈步顺序,自然也就能获得各个运动阶段所需要落脚的足端,可以获得公式(25)中对应的每个采样时刻对应的Ni和Nc的取值。
在确定每个采样时刻的wk的取值、Hk的取值、Ni和Nc的取值之后,将获得的每个采样时刻对应的值分别代入上述公式(25)中,从而获得质心位置变化系数与每个采样时刻所对应的足端接触力之间的第一关系式,如果有多个采样时刻,那么每个采样时刻都对应一个第一关系式。
进一步地,在第三关系式中除了涉及质心位置,还涉及质心位置对时间的二阶导,因此控制设备120还可以将第三关系式中的质心变化量求时间的二阶导表示为第四关系式,第四关系式具体可以参照前文论述的公式(18)。第四关系式是对第二关系式和质心位置变化系数表示的质心位置变化量求时间的二阶导获得的,即将质心变化量求时间的二阶导表示为与迈步占空比相关的表达,进而根据已知量,将第三关系式进一步转换为只与质心位置变化系数、足端接触力、迈步占空比和落脚点四个变量相关的第一关系式。
请继续参照图6所示的例子,下面对各个运动阶段涉及的变量的取值进行分析:
(1)在首个4S阶段,足式机器人110的四个足端与接触面的接触位置已确定,因此可以确定Ni,取值为1,Nc为落脚点的个数为4,rij的取值则对应起始落脚点。
(2)当足式机器人110处在HR阶段中的采样点时,由于右后腿在空中尚未触地,其对应的Ni为0,即无需考虑对右后腿的任何约束,Nc为落脚点和rij的取值依旧和(1)中相同。
(3)当足式机器人110处在紧接着的FR及随后各阶段中某时刻时,右后足端已触地,其位置取决于落脚点的选取,故对应右后足端的Ni设不为1,rij为右后足端所对应的候选落脚点,由于右前腿尚在迈腿过程中,并未触地,其对应Ni设为0,以此类推。
S504,在约束条件集合的约束下,确定满足第一关系式的目标质心位置变化系数、目标落脚点和目标迈步占空比。
其中,约束条件集合中包括一个或多个约束条件,每个约束条件用于约束质心位置变化系数、落脚点、足端接触力和迈步占空比中的一个变量或多个变量。约束条件集合具体可以包括前文论述的空间落脚点约束条件、摩擦力约束条件和足端接触力约束条件中的一种或多种。
由于根据每个采样时刻的第一关系式和约束条件集合并不能获得唯一解,因此,控制设备120可以确定出满足每个采样时刻的第一关系式和约束条件集合的多组候选结果。每一组候选结果包括质心位置变化系数、目标落脚点和迈步占空比。如果迈步占空比及其幂组成的向量是以h表示,那么候选结果中获得的是h的值,根据h的值可以进一步计算出迈步占空比。
同理,如果目标落脚点是选中的候选落脚点表示,那么候选结果获得的是前文中βij的取值,控制设备120根据βij的取值,从而确定出对应的目标落脚点。应当说明的是,一组候选结果中的目标落脚点可以是包括一个或多个,具体与足式机器人在规划周期内的落脚次数是相关的。当然,每组候选结果还可以包括每个采样时刻对应的足端接触力fijk。
在一种可能的实施例中:控制设备120可以从多组候选结果随机选择一组候选结果作为目标结果,即将该组候选结果中的质心位置变化系数作为目标质心位置变化系数,将该候选结果中的落脚点作为目标落脚点,将候选结果中的迈步占空比确定为目标迈步占空比。
在另一种可能的实施例中:控制设备120可以从多组候选结果中,确定出最优化代价函数所对应的候选结果,将最优化代价函数时所对应的候选结果作为目标结果。
当约束条件集合包括空间落脚点约束条件时,下面先对控制设备120确定候选结果的过程进行示例介绍:
步骤1:针对每个采样时刻,根据足式机器人110在每个采样时刻的给定姿态、以及空间落脚点约束条件,获得质心位置变化系数、迈步占空比与对应采样时刻的落脚点之间的目标约束关系。
空间落脚约束条件的表达式可以参照前文论述的公式(30),在公式(30)中除了质心位置变化系数c、被选中的候选落脚点βij和迈步占空比之外,还包括一些需要控制设备120求解的变化量,具体包括公式(30)中的Aik、Bik、Ni、bik,下面对控制设备120确定这些变化量的方式进行示例说明:
当足式机器人110的关节长度以及关节的转动范围已知的情况下,控制设备120可以计算出足式机器人对应的Si和di的取值。或者,当该足式机器人110的关节长度与关节转动范围与常规的足式机器人的关节长度和转动范围等均分别相同的情况下,控制设备120可以直接获得预存的Si和di的取值。
应当说明的是,足式机器人110的任意两个腿的长度是相同的,任意两个腿中每个腿的转动范围也是相同的,因此足式机器人110的每一个腿所对应的Si和di的取值都是相同的。如果足式机器人110一个腿的长度与另一个腿的长度不同,或者足式机器人110的一个腿的转动范围与另一个腿的转动范围不相同,那么控制设备120可以分别确定足式机器人110的每个腿所对应的Si和di的取值。
进一步地,控制设备可以根据起始时刻的给定姿态,以及结束时刻的给定姿态,进而结合前文公式(7)至公式(10)计算出足式机器人110在每个采样时刻所对应的姿态,也就获得了足式机器人110的Rt的取值,进而结合公式(27)以及公式(30),可以计算出每个采样时刻对应的Aik、Ni、Bik和bik的取值,将每个采样时刻已知的Aik、Nik、Bik和bik代入公式(30)中,从而获得每个采样时刻的质心位置变化系数、迈步占空比与对应采样时刻的落脚点之间的目标约束关系。
在一种可能的情况下,如果足式机器人110的姿态变化较小时,Rt的取值也可以是取固定值。
作为一种实施例,当约束条件集合还包括摩擦力约束条件时,摩擦力约束条件的含义可以参照前文论述的内容,此处不再赘述。控制设备120可以根据每个采样时刻对应的候选落脚点,以及摩擦力约束条件,获得每个采样时刻的落脚点与足端接触力之间的约束关系。摩擦力约束条件具体如前文中的公式(33)。
具体的,控制设备120可以确定每个采样时刻对应的候选落脚点,利用该采样时刻对应的候选落脚点表示出Nij,进而可以获得βij所表示的Nij,进而可以获得每个采样时刻所对应的βij和足端接触力fijk之间的第一约束关系。
作为一种实施例,当约束条件集合还包括接触力约束条件时,接触力约束条件的含义可以参照前文论述的内容,此处不再赘述,控制设备120可以根据将接触力约束条件中nij表示为对应采样时刻的βij相关的表达式,以及代入已知的接触力上限,从而获得每个采样时刻βij和足端接触力fijk之间的第二约束关系。接触力约束条件具体如前文公式(36)所示。
例如,继续参数图6所示的例子:
(1)对于首个4S阶段中的采样点,由于初始四只脚与地面接触位置均已确定,Ni取值为1,βij的取值为1,rij为足端的初始位置。
(2)当机器人处在HR阶段中的采样点时,由于右后腿在空中尚未触地,其对应的Ni取值为1,即无需考虑对右后足端的任何约束,其余不变。
(3)当机器人处在紧接着的FR及随后各阶段中某时刻时,右后腿已触地,其位置取决于落脚点的选取,故对应右后足端的Ni取值不为1,相应的βij设为二进制变量,rij为右后足端候选落脚点,由于右前足端尚在迈腿过程中、未触地,其对应的Ni取值为0,以此类推。
步骤2:确定满足每个采样时刻的第一变化关系式,每个采样时刻的目标约束关系的多组候选结果。
控制设备120可以根据每个采样时刻的第一关系式,每个采样时刻的目标约束关系,确定满足这些关系的各组候选结果。候选结果的含义可以参照前文论述的内容,此处不再赘述。
当约束条件集合还包括摩擦力约束条件和/或接触力约束条件时,则确定满足每个采样时刻的第一关系式、每个采样时刻的目标约束关系、每个采样时刻的第二约束关系以及每个采样时刻的第一约束关系的多组候选结果。
例如,每组候选结果具体应当满足如下各个关系式:
k表示选择的任意一个采样时刻,上述公式中其它字母的含义可以参照前文论述的内容,此处不再赘述。Tp(0)表示起始时刻对应的质心变化量,Tv(0)表示起始时刻对应的质心速度,Ta(0)表示起始时刻对应的质心加速度。
由于上述涉及的关系式依旧少于需要求解的未知量的数量,因此满足上述关系式存在多组候选结果,在获得多组候选结果后,控制设备120可以任意选择一组作为目标结果。或者最小化代价函数,以获得目标结果。
具体的,控制设备120在获得多组候选结果之后,可以确定每组候选结果所对应的代价函数的取值,将取值最小的代价函数所对应的候选结果确定为目标结果。代价函数的具体形式可以参照前文论述的内容,此处不再赘述。下面以代价函数为前文论述的公式(37)为例,对控制设备120获得一组候选结果所对应的代价函数的取值进行介绍:
(1)控制设备120根据一组候选结果中每个采样时刻对应的足端接触力,确定各个足端接触力的加权平方和,从而获得公式(37)所示的代价函数中的Jgrf的取值。其中,任意两个足端接触力所对应的加权权重可以是相同的,或者可以是不同的。
(2)控制设备120确定多个采样时刻中每相邻两个采样时刻的质心位置变化量之间的差值的加权平方,从而获得公式(37)所示的代价函数中Jlen的取值。任意两个质心位置变化量的加权权重可以是相同的,或者可以是不同的。
(3)控制设备120在规划周期对应的结束时刻的规划质心位置与期望质心位置之间差值、在规划周期对应的结束时刻的规划质心速度与期望质心速度之间差值和在规划周期对应的结束时刻的规划质心加速度与期望质心加速度之间差值的加权平方和,从而获得公式(37)所示的代价函数中的Jtgt的取值。
在获得公式(37)所示的代价函数中Jgrf的取值、Jlen的取值和Jtgt的取值之后,控制设备120确定Jgrf的取值、Jlen的取值和Jtgt的取值之和,从而该候选结果所对应的代价函数的取值。
以此类推,可以获得控制设备120每组候选结果所对应的代价函数的取值,从而将取值最小的代价函数所对应的候选结果确定为目标结果。
S505,根据目标质心位置变化系数、目标落脚点和目标迈步占空比,控制足式机器人在规划周期内运动。
在实际控制过程中,控制设备120可以通过控制足式机器人110对应关节,来实现足式机器人的各个足的抬起或落下,从而带动足式机器人110沿着移动路径移动。控制设备120具体通过控制足式机器人110对应关节的关节力矩,使足式机器人的至少一个足支撑足式机器人移动,使足式机器人的真实质心位置尽量地保持在上述确定出的质心位置。因此,控制设备120在获得目标质心位置变化系数、目标落脚点和目标迈步占空比之后,需要先确定目标运动控制参数。
下面对控制设备120确定目标运动控制参数的方式进行示例:
控制设备120在获得目标结果后,也就是获得了目标质心位置变化系数、目标迈步占空比和目标落脚点,因此控制设备120可以根据起始质心位置、质心位置变化系数和目标迈步占空比,获得任意时刻对应的规划质心位置,其中涉及的具体计算公式可以参照前文中的公式(4)和公式(15)。
例如,请参照图7,表示足式机器人110的实际运动过程示例图,足式机器人的质心运动轨迹可以如图7中701所示,从图7可以看出,足式机器人110的质心位置随着时间不断发生变化,且波动较小。
控制设备120根据起始时刻的起始落脚点、目标落脚点和目标迈步占空比,确定足式机器人在规划周期内每个时刻的期望足端位置。
具体的,控制设备120根据获得每个采样时刻的目标落脚点,以及根据目标迈步占空比,确定足式机器人110所对应的各个运动阶段所需要落脚的足,对起始落脚点和目标落脚点进行插值,从而获得足式机器人110在每个时刻所对应的期望足端位置。
控制设备120根据起始时刻的给定姿态,足式机器人110在结束时刻的期望姿态,计算每个时刻所对应的期望姿态变化角度,从而根据每个时刻所对应的期望姿态变化角度,计算出足式机器人110在每个时刻所对应的期望姿态。具体计算公式可以参照前文公式(7)至公式(10),其中结束时刻的期望姿态可以根据足式机器人110结束时刻的落脚点确定。
进一步地,控制设备120对足式机器人在对应时刻的规划质心位置、对应时刻的期望姿态、对应时刻的期望足端位置进行逆运动学运算,确定足式机器人在对应时刻的期望关节角度。对期望关节角度进行微分,得到每个时刻对应的期望角速度。
控制设备120根据每个时刻的期望关节角度、以及期望角速度,足式机器人,确定足式机器人在每个时刻的关节力矩。
具体的,控制设备120会根据每个时刻的期望关节角度、期望角速度、对应时刻的实际关节角度、实际角速度,通过机器人动力学控制方法,进而确定足式机器人在对应时刻的关节力矩,以获得目标运动控制参数。
例如,控制设备120根据期望姿态、期望质心位置与实际姿态、实际质心位置确定出期望的足端接触力,将优化的足端接触力乘以对应雅各比矩阵的转置将足端接触力转化到关节,从而获得前馈力矩。再根据关节的期望关节角度、实际关节角度,利用pd控制计算反馈力矩。最后对前馈力矩和反馈力矩之和进行限幅,获得控制足式机器人110最终的力矩控制信号,进而根据力矩控制信号控制足式机器人110的运动。
作为一种实施例,S501~S504的步骤可以是轨迹生成单元220执行的,或者视觉感知单元210执行S501的步骤,轨迹生成单元220执行S502-S503的步骤,轨迹控制单元230执行S504的步骤。
本申请实施例中,在控制足式机器人110的运动过程中,是根据足式机器人110的实际运动过程,去确定迈步占空比、质心位置以及落脚点,即在足式机器人运动之前,使得规划出的足式机器人110的运动控制参数能够更符合足式机器人的实际运动过程。且,由于无需设定足式机器人110的迈步占空比、质心位置和落脚点等,因此提升足式机器人110的运动的智能程度。
基于同一发明构思,本申请实施例提供一种足式机器人运动控制装置,该装置相当于设置在前文论述的控制设备120中,请参照图8,该足式机器人运动控制装置800包括:
候选落脚点确定模块801,用于根据规划周期内起始时刻的状态数据,确定在规划周期内各足端的候选落脚点;
关系式确定模块802,用于根据起始时刻的状态数据和各足端的候选落脚点,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;
目标确定模块803,用于在约束条件集合的约束下,确定满足第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点;
运动控制模块804,用于根据目标质心位置变化系数、目标迈步占空比和目标落脚,控制足式机器人在规划周期内运动。
在一种可能的实施例中,关系式确定模块802具体用于:
从规划周期内确定出多个采样时刻;
根据多个采样时刻,确定每个时间间隔与迈步占空比相关的第二关系式;其中,每个时间间隔是指每个采样时刻与起始时刻之间的时间间隔;
针对每个采样时刻,根据第三关系式,以及对应采样时刻的第二关系式与质心位置变化系数的关系式,获得质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;其中,第三关系式表示每个采样时刻足式机器人的足端接触力与对应采样时刻的质心位置、质心加速度和候选落脚点之间的变化关系,其中对应采样时刻的质心位置设置为起始时刻的起始质心位置与在时间间隔内的质心位置变化量之和。
在一种可能的实施例中,第三关系式中质心加速度是通过质心位置变化量求时间的二阶导数表示,其中质心位置变化量采用第二关系式和质心位置变化系数表示。
在一种可能的实施例中,起始时刻的状态数据包括起始时刻的给定姿态,关系式确定模块802具体用于:
根据起始时刻的给定姿态,以及规划周期内结束时刻的给定姿态,确定足式机器人每个采样时刻的给定姿态,以及确定足式机器人每个时刻的姿态变化角参数;
针对每个采样时刻,根据对应采样时刻的给定姿态,以及对应采样时刻的姿态变化角参数,确定每个采样时刻的质心角动量对时间的一阶导数;
针对每个采样时刻,根据对应采样时刻的质心角动量对时间的一阶导数,以及第三关系式,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式。
在一种可能的实施例中,约束条件集合包括用于约束足式机器人落脚点的空间落脚点约束条件,目标确定模块803具体用于:
针对每个采样时刻,根据足式机器人在对应采样时刻的给定姿态、以及空间落脚点约束条件,确定质心位置变化系数、迈步占空比与对应采样时刻的落脚点之间的目标约束条件;
确定满足每个采样时刻的目标约束条件和每个采样时刻的第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点。
在一种可能的实施例中,当约束条件集合还包括摩擦力约束条件时,目标质心位置变化系数、目标迈步占空比和目标落脚点满足摩擦力约束条件;摩擦力约束条件用于约束每个采样时刻的足端接触力位于摩擦锥内,摩擦锥是根据落脚点的法向量以及落脚的足端与接触面之间的摩擦系数确定的;
当约束条件集合还包括足端接触力约束条件时,目标质心位置变化系数、目标迈步占空比和目标落脚点满足接触力约束条件;足端接触力约束条件用于约束足端接触力在法线方向上的分量小于或等于作用力上限。
在一种可能的实施例中,目标确定模块803具体用于:
获得满足第一关系式和约束条件集合的多组候选结果;其中,每组候选结果包括质心位置变化系数、迈步占空比和落脚点;
根据多组候选结果中每组候选结果,确定每组候选结果的代价函数的取值;其中,代价函数是根据候选结果所包括的相关量构建的二次项
将取值最小的代价函数对应一组候选结果确定为目标结果
在一种可能的实施例中,目标确定模块803具体用于:
根据每组候选结果,对在规划周期内足端接触力的平方和、在规划周期内质心位置变化量的平方和、以及在规划周期内结束时刻的规划质心状态数据与对应的期望质心状态数据之间差值的平方和三者进行加权;
其中,规划质心状态数据是根据候选结果中的迈步占空比和质心位置变化系数确定的,期望质心状态数据是根据候选结果中的落脚点确定的。
在一种可能的实施例中,运动控制模块804具体用于:
根据目标质心位置变化系数、目标迈步占空比和目标落脚,确定足式机器人的目标运动控制参数;
根据足式机器人的目标运动控制参数,控制足式机器人在规划周期内运动。
在一种可能的实施例中,运动控制模块804具体用于:
根据目标质心位置变化系数,确定足式机器人在每个时刻的规划质心位置,以及根据起始时刻的起始落脚点、目标落脚点和目标迈步占空比,确定足式机器人在规划周期内每个时刻的期望足端位置;
根据起始时刻的期望姿态,以及足式机器人在结束时刻的期望姿态,确定足式机器人在每个时刻的期望姿态;
针对每个时刻,对足式机器人在对应时刻的规划质心位置、对应时刻的期望姿态、对应时刻的期望足端位置进行逆运动学运算,确定足式机器人在对应时刻的期望关节角度;
针对每个时刻,根据对应时刻的期望关节角度,以及对应时刻的实际关节角度,确定足式机器人每个时刻的关节力矩。
在一种可能的实施例中,候选落脚点确定模块801具体用于:
采集足式机器人当前所处环境的三维点云图;
从三维点云图中确定可落脚点的候选平面;
根据起始时刻,从候选平面中,确定出每次与接触面接触的足端所对应的候选落脚点。
基于同一发明构思,本申请实施例还提供了一种足式机器人运动控制设备。该足式机器人能够用于实现前文论述的足式机器人110的功能,或能够用于实现前文控制设备120的功能。
请参照图9,计算机设备900以通用计算机设备的形式表现。计算机设备900的组件可以包括但不限于:至少一个处理器910、至少一个存储器920、连接不同系统组件(包括处理器910和存储器920)的总线930。
总线930表示几类总线结构中的一种或多种,包括存储器总线或者存储器控制器、外围总线、处理器或者使用多种总线结构中的任意总线结构的局域总线。
存储器920可以包括易失性存储器形式的可读介质,例如随机存取存储器(RAM)921和/或高速缓存存储器922,还可以进一步包括只读存储器(ROM)923。存储器920还可以包括具有一组(至少一个)程序模块925的程序/实用工具926,这样的程序模块925包括但不限于:操作系统、一个或者多个应用程序、其它程序模块以及程序数据,这些示例中的每一个或某种组合中可能包括网络环境的实现。处理器910用于执行存储器920存储的程序指令等实现前文论述的足式机器人运动控制方法。
计算机设备900可以与一个或多个外部设备940(例如键盘、指向设备等)通信,还可与一个或者多个使得终端能与计算机设备900交互的设备通信,和/或与使得该计算机设备900能与一个或多个其它设备进行通信的任何设备(例如路由器、调制解调器等)通信。这种通信可以通过输入/输出(I/O)接口950进行。并且,计算机设备900还可以通过网络适配器960与一个或者多个网络(例如局域网(LAN),广域网(WAN)和/或公共网络,例如因特网)通信。如图所示,网络适配器960通过总线930与用于计算机设备900的其它模块通信。应当理解,尽管图中未示出,可以结合计算机设备900使用其它硬件和/或软件模块,包括但不限于:微代码、设备驱动器、冗余处理器、外部磁盘驱动阵列、RAID系统、磁带驱动器以及数据备份存储系统等。
基于同一发明构思,本申请实施例提供一种存储介质,所述存储介质存储有计算机指令,当所述计算机指令在计算机上运行时,使得计算机执行前文论述的足式机器人运动控制方法。
基于同一发明构思,本申请实施例提供一种计算机程序产品,该计算机程序产品包括计算机指令,该计算机指令存储在计算机可读存储介质中。计算机设备的处理器从计算机可读存储介质读取该计算机指令,处理器执行该计算机指令,使得该计算机设备执行上述的任一足式机器人运动控制方法。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
显然,本领域的技术人员可以对本申请进行各种改动和变型而不脱离本申请的精神和范围。这样,倘若本申请的这些修改和变型属于本申请权利要求及其等同技术的范围之内,则本申请也意图包含这些改动和变型在内。
Claims (13)
1.一种足式机器人运动控制方法,其特征在于,包括:
根据规划周期内起始时刻的状态数据,确定在所述规划周期内各足端的候选落脚点;
根据所述起始时刻的状态数据和所述各足端的候选落脚点,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;
在约束条件集合的约束下,确定满足所述第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点;
根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,控制所述足式机器人在所述规划周期内运动;
其中,根据所述起始时刻的状态数据和所述各足端的候选落脚点,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式,包括:
从所述规划周期内确定出多个采样时刻;
根据所述多个采样时刻,确定每个时间间隔与迈步占空比相关的第二关系式;其中,每个时间间隔是指每个采样时刻与所述起始时刻之间的时间间隔;
针对每个采样时刻,根据第三关系式,以及对应采样时刻的第二关系式与质心位置变化系数的关系式,获得质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;其中,所述第三关系式表示每个采样时刻所述足式机器人的足端接触力与对应采样时刻的质心位置、质心加速度和候选落脚点之间的变化关系,其中对应采样时刻的质心位置设置为起始时刻的起始质心位置与在时间间隔内的质心位置变化量之和。
2.如权利要求1所述的方法,其特征在于,所述第三关系式中质心加速度是通过质心位置变化量求时间的二阶导数表示,其中质心位置变化量采用第二关系式和所述质心位置变化系数表示。
3.如权利要求1或2所述的方法,其特征在于,所述起始时刻的状态数据包括起始时刻的给定姿态,根据所述起始时刻的状态数据和所述各足端的候选落脚点,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式,还包括:
根据所述起始时刻的给定姿态,以及所述规划周期内结束时刻的给定姿态,确定足式机器人每个采样时刻的给定姿态,以及确定足式机器人每个时刻的姿态变化角参数;
针对每个采样时刻,根据对应采样时刻的给定姿态,以及对应采样时刻的姿态变化角参数,确定每个采样时刻的质心角动量对时间的一阶导数;
针对每个采样时刻,根据对应采样时刻的质心角动量对时间的一阶导数,以及所述第三关系式,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式。
4.如权利要求1或2所述的方法,其特征在于,所述约束条件集合包括用于约束所述足式机器人落脚点的空间落脚点约束条件;在约束条件集合的约束下,确定满足所述第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点,包括:
针对每个采样时刻,根据所述足式机器人在对应采样时刻的给定姿态、以及空间落脚点约束条件,确定质心位置变化系数、迈步占空比与对应采样时刻的落脚点之间的目标约束条件;
确定满足每个采样时刻的目标约束条件和每个采样时刻的第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点。
5.如权利要求4所述的方法,其特征在于,当约束条件集合还包括摩擦力约束条件时,所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚点满足所述摩擦力约束条件;所述摩擦力约束条件用于约束每个采样时刻的足端接触力位于摩擦锥内,所述摩擦锥是根据落脚点的法向量以及落脚的足端与接触面之间的摩擦系数确定的;
当所述约束条件集合还包括足端接触力约束条件时,所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚点满足所述接触力约束条件;所述足端接触力约束条件用于约束足端接触力在法线方向上的分量小于或等于作用力上限。
6.如权利要求1或2所述的方法,其特征在于,在约束条件集合的约束下,确定满足所述第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点,包括:
获得满足所述第一关系式和约束条件集合的多组候选结果;其中,每组候选结果包括质心位置变化系数、迈步占空比和落脚点;
根据所述多组候选结果中每组候选结果,确定每组候选结果的代价函数的取值;其中,所述代价函数是根据候选结果所包括的相关量构建的二次项
将取值最小的代价函数对应一组候选结果确定为目标结果。
7.如权利要求6所述的方法,其特征在于,所述根据所述多组候选结果中每组候选结果,确定每组候选结果的代价函数的取值,包括:
根据每组候选结果,对在所述规划周期内足端接触力的平方和、在所述规划周期内质心位置变化量的平方和、以及在所述规划周期内结束时刻的规划质心状态数据与对应的期望质心状态数据之间差值的平方和三者进行加权;
其中,所述规划质心状态数据是根据候选结果中的迈步占空比和质心位置变化系数确定的,所述期望质心状态数据是根据候选结果中的落脚点确定的。
8.如权利要求1或2所述的方法,其特征在于,根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,控制所述足式机器人在所述规划周期内运动,包括:
根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,确定所述足式机器人的目标运动控制参数;
根据所述足式机器人的目标运动控制参数,控制所述足式机器人在所述规划周期内运动。
9.如权利要求8所述的方法,其特征在于,根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,确定所述足式机器人的目标运动控制参数,包括:
根据所述目标质心位置变化系数,确定所述足式机器人在每个时刻的规划质心位置,以及根据所述起始时刻的起始落脚点、所述目标落脚点和所述目标迈步占空比,确定所述足式机器人在所述规划周期内每个时刻的期望足端位置;
根据所述起始时刻的期望姿态,以及所述足式机器人在结束时刻的期望姿态,确定所述足式机器人在每个时刻的期望姿态;
针对每个时刻,对所述足式机器人在对应时刻的规划质心位置、对应时刻的期望姿态、对应时刻的期望足端位置进行逆运动学运算,确定所述足式机器人在对应时刻的期望关节角度;
针对每个时刻,根据对应时刻的期望关节角度,以及对应时刻的实际关节角度,确定所述足式机器人每个时刻的关节力矩。
10.一种足式机器人运动控制装置,其特征在于,包括:
候选落脚点确定模块,用于根据规划周期内起始时刻的状态数据,确定在所述规划周期内各足端的候选落脚点;
关系式确定模块,用于根据所述起始时刻的状态数据和所述各足端的候选落脚点,确定质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;
目标确定模块,用于在约束条件集合的约束下,确定满足所述第一关系式的目标质心位置变化系数、目标迈步占空比和目标落脚点;
运动控制模块,用于根据所述目标质心位置变化系数、所述目标迈步占空比和所述目标落脚,控制所述足式机器人在所述规划周期内运动;
其中,所述关系式确定模块具体用于:
从所述规划周期内确定出多个采样时刻;
根据所述多个采样时刻,确定每个时间间隔与迈步占空比相关的第二关系式;其中,每个时间间隔是指每个采样时刻与所述起始时刻之间的时间间隔;
针对每个采样时刻,根据第三关系式,以及对应采样时刻的第二关系式与质心位置变化系数的关系式,获得质心位置变化系数、迈步占空比、落脚点与足端接触力之间的第一关系式;其中,所述第三关系式表示每个采样时刻所述足式机器人的足端接触力与对应采样时刻的质心位置、质心加速度和候选落脚点之间的变化关系,其中对应采样时刻的质心位置设置为起始时刻的起始质心位置与在时间间隔内的质心位置变化量之和。
11.如权利要求10所述的装置,其特征在于,所述第三关系式中质心加速度是通过质心位置变化量求时间的二阶导数表示,其中质心位置变化量采用第二关系式和所述质心位置变化系数表示。
12.一种足式机器人运动控制设备,其特征在于,包括:
存储器;
至少一个处理器,与所述存储器连接;
其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述至少一个处理器通过执行所述存储器存储的指令实现如权利要求1~9中任一项所述的方法。
13.一种存储介质,其特征在于,所述存储介质存储有计算机指令,当所述计算机指令在计算机上运行时,使得计算机执行如权利要求1~9中任一项所述的方法。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011154824.6A CN114489092B (zh) | 2020-10-26 | 2020-10-26 | 足式机器人运动控制方法、装置、设备及介质 |
PCT/CN2021/124524 WO2022089247A1 (zh) | 2020-10-26 | 2021-10-19 | 足式机器人运动控制方法、装置、设备、介质及程序 |
EP21884975.0A EP4109198A4 (en) | 2020-10-26 | 2021-10-19 | METHOD AND APPARATUS FOR CONTROLLING THE MOVEMENT OF A WALKING ROBOT, DEVICE, SUPPORT, AND PROGRAM |
US17/954,028 US20230030054A1 (en) | 2020-10-26 | 2022-09-27 | Method and apparatus for controlling motion of legged robot, device, and medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011154824.6A CN114489092B (zh) | 2020-10-26 | 2020-10-26 | 足式机器人运动控制方法、装置、设备及介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114489092A CN114489092A (zh) | 2022-05-13 |
CN114489092B true CN114489092B (zh) | 2023-07-18 |
Family
ID=81381920
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011154824.6A Active CN114489092B (zh) | 2020-10-26 | 2020-10-26 | 足式机器人运动控制方法、装置、设备及介质 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20230030054A1 (zh) |
EP (1) | EP4109198A4 (zh) |
CN (1) | CN114489092B (zh) |
WO (1) | WO2022089247A1 (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2428335A1 (en) * | 2010-09-09 | 2012-03-14 | Samsung Electronics Co., Ltd | Robot and control method thereof |
CN106886155A (zh) * | 2017-04-28 | 2017-06-23 | 齐鲁工业大学 | 一种基于pso‑pd神经网络的四足机器人运动轨迹控制方法 |
CN111353119A (zh) * | 2020-03-26 | 2020-06-30 | 北京理工大学 | 一种基于轨道机械能的双足行走稳定性分析方法 |
CN111506094A (zh) * | 2020-04-14 | 2020-08-07 | 腾讯科技(深圳)有限公司 | 质心位置确定方法、装置、足式机器人及存储介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102749919B (zh) * | 2012-06-15 | 2014-05-07 | 华中科技大学 | 一种多足机器人平衡控制方法 |
US9259838B1 (en) * | 2014-07-24 | 2016-02-16 | Google Inc. | Systems and methods for ground plane estimation |
US9594377B1 (en) * | 2015-05-12 | 2017-03-14 | Google Inc. | Auto-height swing adjustment |
CN106695791B (zh) * | 2017-01-11 | 2019-02-05 | 山东科技大学 | 四足仿生机器人连续自由步态生成方法 |
CN111766885B (zh) * | 2020-07-08 | 2023-08-11 | 清华大学深圳国际研究生院 | 一种四足机器人的静步态规划方法 |
-
2020
- 2020-10-26 CN CN202011154824.6A patent/CN114489092B/zh active Active
-
2021
- 2021-10-19 WO PCT/CN2021/124524 patent/WO2022089247A1/zh unknown
- 2021-10-19 EP EP21884975.0A patent/EP4109198A4/en active Pending
-
2022
- 2022-09-27 US US17/954,028 patent/US20230030054A1/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2428335A1 (en) * | 2010-09-09 | 2012-03-14 | Samsung Electronics Co., Ltd | Robot and control method thereof |
CN106886155A (zh) * | 2017-04-28 | 2017-06-23 | 齐鲁工业大学 | 一种基于pso‑pd神经网络的四足机器人运动轨迹控制方法 |
CN111353119A (zh) * | 2020-03-26 | 2020-06-30 | 北京理工大学 | 一种基于轨道机械能的双足行走稳定性分析方法 |
CN111506094A (zh) * | 2020-04-14 | 2020-08-07 | 腾讯科技(深圳)有限公司 | 质心位置确定方法、装置、足式机器人及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
US20230030054A1 (en) | 2023-02-02 |
WO2022089247A1 (zh) | 2022-05-05 |
EP4109198A1 (en) | 2022-12-28 |
EP4109198A4 (en) | 2023-10-18 |
CN114489092A (zh) | 2022-05-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112114589B (zh) | 足式机器人运动控制方法、装置、设备及介质 | |
CN112051797B (zh) | 足式机器人运动控制方法、装置、设备及介质 | |
CN114474034B (zh) | 足式机器人运动控制方法、装置、设备及介质 | |
JP6715952B2 (ja) | バランスのとれた運動および行動能力が向上した移動型ロボット | |
CN113534828B (zh) | 质心位置确定方法、装置、足式机器人及存储介质 | |
JP7324932B2 (ja) | 動的計画コントローラ | |
Bartsch et al. | Development and control of the multi-legged robot mantis | |
Kim et al. | Computationally-robust and efficient prioritized whole-body controller with contact constraints | |
CN112783175B (zh) | 质心轨迹确定方法、装置、足式机器人、设备及介质 | |
Miyashita et al. | Human-like natural behavior generation based on involuntary motions for humanoid robots | |
CN114489092B (zh) | 足式机器人运动控制方法、装置、设备及介质 | |
US20210331313A1 (en) | Robot Localization Using Variance Sampling | |
Yoon et al. | Real-time 3D simultaneous localization and map-building for a dynamic walking humanoid robot | |
CN114723807A (zh) | 质心轨迹确定方法、装置、足式机器人、设备及介质 | |
WO2021208917A1 (zh) | 质心位置确定方法、装置、足式机器人及存储介质 | |
WO2024051408A1 (zh) | 移动轨迹确定方法、装置、计算机设备及存储介质 | |
WO2024021749A1 (zh) | 足式机器人的运动控制方法、装置、足式机器人、存储介质及程序产品 | |
US20240009842A1 (en) | Robot control method based on trajectory of center of mass, robot and computer-readable storage medium | |
US20240219917A1 (en) | Motion control method of mobile robot and mobile robot | |
Sygulla | Dynamic robot walking on unknown terrain: Stabilization and multi-contact control of biped robots in uncertain environments | |
Lei et al. | Research on dynamic performance of quadruped robot in complex environment | |
Sygulla | Dynamic Robot Walking on Unknown Terrain | |
CN116952508A (zh) | 接触碰撞测试方法、接触碰撞测试系统 | |
CN114683281A (zh) | 足式机器人运动控制方法、装置、电子设备及存储介质 | |
Liu et al. | Dynamic modeling and torque distribution of a climbing hexapod robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
REG | Reference to a national code |
Ref country code: HK Ref legal event code: DE Ref document number: 40071432 Country of ref document: HK |
|
GR01 | Patent grant | ||
GR01 | Patent grant |