CN113524190B - 机器人足端碰撞稳定控制方法、装置和足式机器人 - Google Patents

机器人足端碰撞稳定控制方法、装置和足式机器人 Download PDF

Info

Publication number
CN113524190B
CN113524190B CN202110846375.XA CN202110846375A CN113524190B CN 113524190 B CN113524190 B CN 113524190B CN 202110846375 A CN202110846375 A CN 202110846375A CN 113524190 B CN113524190 B CN 113524190B
Authority
CN
China
Prior art keywords
collision
robot
foot end
swing leg
track component
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
Application number
CN202110846375.XA
Other languages
English (en)
Other versions
CN113524190A (zh
Inventor
陈春玉
刘益彰
葛利刚
白杰
周江琛
罗秋月
熊友军
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ubtech Robotics Corp
Original Assignee
Ubtech Robotics Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Ubtech Robotics Corp filed Critical Ubtech Robotics Corp
Priority to CN202110846375.XA priority Critical patent/CN113524190B/zh
Publication of CN113524190A publication Critical patent/CN113524190A/zh
Priority to PCT/CN2021/131466 priority patent/WO2023005068A1/zh
Application granted granted Critical
Publication of CN113524190B publication Critical patent/CN113524190B/zh
Priority to US18/089,588 priority patent/US20230133934A1/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085—Force or torque sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B25J9/1666—Avoiding collision or forbidden zones
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676—Avoiding collision or forbidden zones
    • 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
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39082—Collision, real time collision avoidance

Abstract

本申请实施例提供一种机器人足端碰撞稳定控制方法、装置和足式机器人，机器人的单腿运动规划轨迹包括足端前进方向轨迹分量、侧移方向轨迹分量和抬起方向轨迹分量；该方法包括：在检测到机器人的摆动腿发生足端碰撞时，停止摆动腿在碰撞方向上的轨迹分量规划，所述碰撞方向的轨迹分量为前进方向轨迹分量和/或侧移方向轨迹分量；根据实时获取的摆动腿的足端在碰撞方向上受到的外力基于足端拖动控制模式计算碰撞方向上的位置偏移量；利用碰撞方向上的位置偏移量和在非碰撞方向上的期望轨迹分量控制摆动腿运动。该方法可以在机器人在发生足端碰撞后，避免出现摔倒或受到损坏等，保证了机器人自身或外界环境的安全。

Description

机器人足端碰撞稳定控制方法、装置和足式机器人
技术领域
本申请涉及足式机器人技术领域，尤其涉及一种机器人足端碰撞稳定控制方法、装置和足式机器人。
背景技术
对于足式机器人而言，如双足机器人等，如图1所示，其在上台阶或走在带有障碍物的地面上时，如果外部感知信息出现误差或无外部传感信息时，当机器人踢到障碍物时，往往会导致机器人自身或外界障碍物受到损坏，或者机器人出现不稳定而摔倒的现象等。
发明内容
本申请实施例提供一种机器人足端碰撞稳定控制方法、装置和足式机器人，该机器人足端碰撞稳定控制方法可以在机器人发生足端碰撞后而不会出现摔倒或受到损坏等，可以保证机器人自身及外界环境的安全。
本申请的实施例提供一种机器人足端碰撞稳定控制方法，所述机器人的单腿运动规划轨迹包括足端前进方向轨迹分量、侧移方向轨迹分量和抬起方向轨迹分量；该方法包括：
在检测到机器人的摆动腿发生足端碰撞时，停止所述摆动腿在碰撞方向上的轨迹分量规划，所述碰撞方向的轨迹分量为所述前进方向轨迹分量和/或所述侧移方向轨迹分量；
根据实时获取的所述摆动腿的足端在所述碰撞方向上受到的外力基于足端拖动控制模式计算所述碰撞方向上的位置偏移量，并基于所述位置偏移量确定所述碰撞方向上的再规划轨迹分量；
根据所述碰撞方向上的所述再规划轨迹分量和所述摆动腿在非碰撞方向上的期望轨迹分量控制所述摆动腿运动。
在一些实施例中，所述计算所述碰撞方向上的当前位置偏移量，之前包括：
对所述足端拖动控制模式进行积分转换操作，得到位置偏移计算公式，所述位置偏移计算公式用于根据所述摆动腿的足端在对应轨迹分量方向上受到的外力计算所述对应轨迹分量方向上的位置偏移量。
在一些实施例中，所述足端拖动控制模式的表达式如下：
Figure M_220614142908719_719006001
；
其中，
Figure M_220614142908768_768332001
分别表示所述机器人的参考速度和测量的实际速度；b为预设参数；F为所述摆动腿的足端受到的外力；
所述位置偏移计算公式如下：
Figure M_220614142908815_815218001
；
其中，
Figure M_220614142908846_846469001
为位置偏移量；
Figure M_220614142908877_877741002
为所述机器人的程序控制周期。
在一些实施例中，当所述碰撞方向的轨迹分量为所述前进方向轨迹分量和/或所述侧移方向轨迹分量时，所述碰撞方向上的所述位置偏移量包括所述前进方向上的位置偏移量和/或所述侧移方向上的位置偏移量；
所述摆动腿在所述前进方向和/或所述侧移方向的再规划轨迹分量表示为：
Figure M_220614142908893_893362001
；
Figure M_220614142908941_941672001
；
其中，
Figure M_220614142908973_973425001
分别表示所述摆动腿在所述前进方向上的t时刻和t-1时刻的位置；
Figure M_220614142909004_004673002
分别表示所述摆动腿在所述侧移方向上的t时刻和t-1时刻的位置；
Figure M_220614142909035_035925003
和
Figure M_220614142909067_067186004
分别表示实时计算到的在所述前进方向和所述侧移方向上的所述位置偏移量。
在一些实施例中，所述机器人的足端设有力传感器，所述力传感器的坐标系中的X方向、Y方向和Z方向依次对应于所述前进方向、所述侧移方向和所述抬起方向；
所述检测到机器人的摆动腿发生足端碰撞，之前还包括：
当所述机器人处于摆动期时，通过所述力传感器实时检测所述摆动腿的足端在X方向、Y方向和Z方向上受到的外力；
若所述摆动腿的足端在X方向或Y方向上受到的外力大于等于预设阈值，则确定所述摆动腿发生碰撞。
在上述实施例中，该机器人足端碰撞稳定控制方法还包括：
若所述摆动腿的足端在X方向或Y方向上受到的外力小于所述预设阈值，则按照期望的所述摆动腿的运动规划轨迹控制所述摆动腿运动。
在一些实施例中，所述摆动腿的期望运动规划轨迹表示如下：
Figure M_220614142909082_082794001
；
Figure M_220614142909129_129648001
；
Figure M_220614142909164_164819001
；
其中，
Figure M_220614142909196_196088001
、
Figure M_220614142909227_227319002
和
Figure M_220614142909258_258571003
分别表示所述摆动腿足端的所述前进方向轨迹分量、所述侧移方向轨迹分量和所述抬起方向轨迹分量；t为抬腿时间；T为摆动期总时间；
Figure M_220614142909289_289821004
为所述摆动腿的期望前向步长；
Figure M_220614142909305_305465005
为所述摆动腿的期望侧向步长；A、B、C和D分别为预设系数。
本申请的实施例还提供一种机器人足端碰撞稳定控制装置，所述机器人的单腿运动规划轨迹包括足端前进方向轨迹分量、侧移方向轨迹分量和抬起方向轨迹分量；该装置包括：
碰撞检测模块，用于在检测到机器人的摆动腿发生足端碰撞时，停止所述摆动腿在碰撞方向上的轨迹分量规划，所述碰撞方向的轨迹分量为所述前进方向轨迹分量和/或所述侧移方向轨迹分量；
偏移量计算模块，用于根据实时获取的所述摆动腿的足端在所述碰撞方向上受到的外力基于足端拖动控制模式计算所述碰撞方向上的位置偏移量，并基于所述位置偏移量确定所述碰撞方向上的再规划轨迹分量；
运动控制模块，用于根据所述碰撞方向上的所述再规划轨迹分量和所述摆动腿在非碰撞方向上的期望轨迹分量控制所述摆动腿运动。
本申请的实施例还提供一种足式机器人，所述足式机器人包括处理器和存储器，所述存储器存储有计算机程序，所述处理器用于执行所述计算机程序以实施上述的机器人足端碰撞稳定控制方法。
本申请的实施例还提供一种可读存储介质，其存储有计算机程序，所述计算机程序在处理器上执行时，实施上述的机器人足端碰撞稳定控制方法。
本申请的实施例具有如下有益效果：
本申请实施例的机器人足端碰撞稳定控制方法在检测到机器人的摆动腿发生足端碰撞时，停止摆动腿在碰撞方向上的期望规划，并利用设计的足端拖动控制模式计算该碰撞方向上的位置偏移量，然后结合非碰撞方向上的期望轨迹分量以对该摆动腿的轨迹进行再规划。通过对摆动腿进行拖动模式控制器设计与轨迹再规划处理，可以实现机器人的稳定运行，而不会出现足端碰撞后摔倒或受到损坏等问题，从而保证了机器人自身及外界环境的安全。
附图说明
为了更清楚地说明本申请实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本申请的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。
图1示出了一种双足机器人碰到障碍物的应用示意图；
图2示出了本申请实施例机器人足端碰撞稳定控制方法的一种流程示意图；
图3示出了本申请实施例机器人足端碰撞稳定控制方法的另一种流程示意图；
图4示出了本申请实施例的足式机器人的足端运动方向的应用示意图；
图5示出了本申请实施例机器人足端碰撞稳定控制装置的结构示意图。
具体实施方式
下面将结合本申请实施例中附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分实施例，而不是全部的实施例。
通常在此处附图中描述和示出的本申请实施例的组件可以以各种不同的配置来布置和设计。因此，以下对在附图中提供的本申请的实施例的详细描述并非旨在限制要求保护的本申请的范围，而是仅仅表示本申请的选定实施例。基于本申请的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本申请保护的范围。
对于如双足机器人等足式机器人，在行走过程中会存在支撑期和摆动期，其中，摆动期是指该机器人存在至少一条腿处于悬空状态而没有与地面接触的时期，对应地，该处于悬空状态的腿则称为摆动腿。例如，当足式机器人行走在设有障碍物的地面上或上阶梯等场景中，可能会与外界环境发生碰撞，进而因受到外界环境的冲击力而容易出现摔倒等问题。
此外，足式机器人的摆动腿与外界环境的交互通常可等效为质量-阻尼-弹簧模型，其动力学方程可描述为：
Figure M_220614142909336_336699001
；
其中，m为摆动腿的等效质量，b为速度项的预设参数，k为比例项参数，f表示摆动腿受到的外部作用力；
Figure M_220614142909370_370834001
分别表示参考加速度、参考速度、参考位置；
Figure M_220614142909402_402134002
分别表示测量得到的实际加速度、实际速度、实际位置。可知，当受到外力作用力后，基于上述的质量-阻尼-弹簧模型进行控制时，摆动腿将会发生回弹，往往会出现再次碰撞，这将导致机器人自身或外界环境会受到损坏等。
为此，本申请实施例提出一种机器人足端碰撞稳定控制方法，当发生碰撞时，通过立即停止摆动腿在碰撞方向上的期望规划，并利用足端拖动控制模式计算该碰撞方向上的位置偏移量以便规划出碰撞方向上的新轨迹分量，同时结合摆动腿在非碰撞方向上的期望轨迹来对摆动腿的轨迹进行再规划。该方法通过对摆动腿足端的拖动模式控制与轨迹再规划处理，可以实现机器人的稳定运行，而不会出现足端碰撞后摔倒或受到损坏等，从而保证了机器人自身及外界环境的安全。
下面结合具体的实施例来进行详细说明。
实施例1
请参照图2，本实施例提出一种机器人足端碰撞稳定控制方法，可用于如上台阶、带有障碍物的地面等不同场景中，以实现机器人当足端踢到障碍物时而不会出现摔倒或自身损坏等问题，从而达到稳定控制目的。
本实施例中，为方便对机器人的摆动腿进行运动控制，规划的该机器人的摆动腿的运动轨迹可分解到三个不同的方向，分别是足端前进方向上的轨迹分量、足端侧移方向上的轨迹分量和足端抬起方向上的轨迹分量。基于上述的运动轨迹，下面对该机器人足端碰撞稳定控制方法进行说明。
步骤S110，在检测到机器人的摆动腿发生足端碰撞时，停止摆动腿在碰撞方向上的轨迹分量规划。
当检测到机器人发生足端碰撞时，为了使得摆动腿不再恢复到碰撞时的位置，本实施例将停止该摆动腿在碰撞方向上的当前轨迹分量的规划，以避免机器人按照原来的轨迹分量规划继续进行摆动腿运动而造成机器人自身和外界环境更严重的损坏。
在一种实施方式中，为了实现上述停止规划控制，这里需要保持碰撞时刻时的摆动腿的抬腿时间为t_max，在后续规划中采用t_max代替抬腿时间t，可以实现摆动腿在碰撞方向上停止轨迹分量规划。可以理解，预先规划的期望运动轨迹仅与抬腿时间t有关，当t固定为t_max时，对应的轨迹也将不变。
本实施例中，机器人在某个方向上发生碰撞，此时需要停止规划的该碰撞方向的轨迹分量应当能够分解到上述的三个足端方向的轨迹分量中。例如，在一种实施方式中，若该机器人为正向碰撞，则该碰撞方向的轨迹分量则为前进方向上的轨迹分量；又或者，若机器人为斜侧碰撞，即视为在前进方向和侧移方向上均发生碰撞，此时，该碰撞方向的轨迹分量为前进方向轨迹分量和侧移方向轨迹分量。可以理解，该碰撞方向的轨迹分量主要取决于机器人与外界环境发生碰撞的形态。
其中，在上述步骤S110之前，该机器人足端碰撞稳定控制方法还包括，当机器人处于摆动期时，实时检测机器人的摆动腿的碰撞情况。示范性地，如图3所示，该机器人足端碰撞稳定控制方法包括：
步骤S210，当机器人处于摆动期时，通过力传感器实时检测摆动腿的足端在X方向、Y方向和Z方向上受到的外力。
示范性地，机器人的每条腿可在足端相应位置设置力传感器，以用于检测摆动腿的足端受力情况。其中，上述的力传感器不限于为六维力传感器等，其中，六维力传感器可以用于对三维力和三维力矩的测量，这里可以根据需求选取所需的三维力的测量结果进行处理。此外，该力传感器也可以是仅用于测量三维力的力传感器等。
为方便计算，本实施例将力传感器的测量坐标系与摆动腿的足端运动方向对应设置，使得摆动腿足端的力传感器测量到的三个方向上的外部作用力直接作为该摆动腿足端在三个运动轨迹分量方向上受到的外力。
例如，在一种实施方式中，力传感器的三维空间坐标系中的X方向对应于足端水平前进的方向、Y方向对应于足端侧移的方向、以及Z方向对应于足端竖直抬起的方向，如图4所示。
以六维力传感器为例，对于上述步骤S210，示范性地，在足式机器人正常行走时，当机器人处于摆动期时，可通过六维力传感器实时检测该摆动腿的足端在各个运动轨迹分量方向上受到的外力。
步骤S220，若该摆动腿的足端在X方向或Y方向上受到的外力大于等于预设阈值，则确定该摆动腿发生碰撞。
示范性地，可在预设测量方向上设置相应的阈值Fth，进而实时判断该测量方向上受到的外部作用力是否大于或等于该阈值。例如，若该摆动腿在该测量方向上的足端受力大于或等于该受力阈值Fth，则判断该摆动腿与外界环境发生碰撞。反之，若该测量方向上的足端受力小于该受力阈值Fth，则判断未发生碰撞，并继续检测。
其中，上述的阈值Fth的大小可根据实际需要来确定，不同测量方向上的阈值可以相同，也可以不同。例如，在一种实施方式中，该预设测量方向可以是X方向或Y方向等，可以理解，该预设测量方向可以根据实际的外界环境来相应选取，这里仅是一种示例。
步骤S230，若该摆动腿的足端在X方向或Y方向上受到的外力小于该预设阈值，则按照该摆动腿的期望运动规划轨迹控制该摆动腿运动。
在没有发生碰撞的情况下，足式机器人将按照预先规划好的摆动腿和支撑腿各自的足端期望运动轨迹进行正常行走。例如，在一种实施方式中，该摆动腿的期望运动规划轨迹如下：
Figure M_220614142909433_433362001
；
Figure M_220614142909464_464631001
；
Figure M_220614142909495_495855001
；
其中，
Figure M_220614142909511_511508001
、
Figure M_220614142909543_543689002
和
Figure M_220614142909559_559833003
分别表示该摆动腿的前进方向轨迹分量（即X方向上的运动轨迹）、侧移方向轨迹分量（即Y方向上的运动轨迹）和抬起方向轨迹分量（即Z方向上的运动轨迹）；t为抬腿时间；T为摆动期总时间；
Figure M_220614142909591_591107004
为摆动腿的期望前向步长；
Figure M_220614142909606_606709005
为摆动腿的期望侧向步长；A、B、C和D分别为预设系数，具体可根据实际需求来设定。
步骤S120，根据实时获取的该摆动腿的足端受力在碰撞方向上的受力分量基于足端拖动控制模式计算该碰撞方向上的位置偏移量，并基于该位置偏移量确定该碰撞方向上的再规划轨迹分量。
当机器人进入碰撞阶段时，本实施例设计一个新的足端控制器来控制摆动腿的运动，考虑到摆动腿在发生碰撞时，由于受到外界力冲击后会引起位置移动，这里将摆动腿足端与外界环境交互的模型设计为拖动控制模式，可以使得摆动腿在受到外界碰撞力后不再恢复到发生碰撞时的位置。
在一种实施方式中，该足端拖动控制模式的表达式如下：
Figure M_220614142909622_622333001
；
其中，
Figure M_220614142909653_653581001
分别表示机器人的参考速度和测量的实际速度；b为预设参数；F为摆动腿的足端受到的外力。
进一步地，对足端拖动控制模式进行转换并作积分处理操作，可得到位置偏移计算公式。示范性地，该位置偏移计算公式如下：
Figure M_220614142909684_684846001
；
其中，
Figure M_220614142909716_716102001
为位置偏移量；
Figure M_220614142909731_731722002
为机器人的程序控制周期。
进而，根据该摆动腿在各个控制周期的在碰撞方向上的位置偏移量即可规划得到该摆动腿在碰撞方向上的新轨迹分量。
以碰撞方向为前进方向为例，若摆动腿的足端在前进方向上受到的外力记为Fx，代入该位置偏移计算公式后，可得到在前进方向上的位置偏移量
Figure M_220614142909764_764908001
。对于其他的运动方向，同理。
仍以碰撞方向为前进方向为例，该摆动腿在碰撞方向上的新轨迹分量可表示为：
Figure M_220614142909780_780540001
；
其中，
Figure M_220614142909811_811801001
分别表示该摆动腿在前进方向上的t时刻和t-1时刻的位置；
Figure M_220614142909843_843082002
表示t时刻在前进方向计算得到的位置偏移量。
或者，若该碰撞方向为其他的运动方向，如侧移方向等，此时该侧移方向上的新轨迹分量如下：
Figure M_220614142909874_874285001
；
其中，
Figure M_220614142909905_905535001
分别表示该摆动腿在侧移方向上的t时刻和t-1时刻的位置；
Figure M_220614142909936_936787002
分别表示t时刻在侧移方向上计算得到的位置偏移量。
又或者，若该碰撞方向为斜碰撞方向，此时碰撞方向的轨迹分量包括前进方向轨迹分量和侧移方向轨迹分量。于是，该摆动腿在碰撞方向上的新轨迹分量可表示为：
Figure M_220614142909969_969979001
；
Figure M_220614142910065_065996001
。
对于上述步骤S120，示范性地，将实时获取的摆动腿的足端在碰撞方向上受到的外力代入上述位置偏移计算公式，可得到对应轨迹分量上的位置偏移量，进而基于上一时刻的位置可得到当前的规划轨迹分量。
步骤S130，根据该碰撞方向上的再规划轨迹分量和该摆动腿在非碰撞方向上的期望轨迹分量控制摆动腿运动。
本实施例中，将根据摆动腿在碰撞方向上的再规划轨迹分量和在非碰撞方向上的期望轨迹分量来对该摆动腿进行运动轨迹再规划，以改变摆动腿的轨迹，这样可以避免机器人碰撞后再次回到碰撞的位置。其中，所述的摆动腿在非碰撞方向上的期望轨迹分量是指，摆动腿足端在非碰撞方向上将按照其原来的期望轨迹分量进行运动。
在第一种实施方式中，若碰撞方向为前进方向，则该碰撞方向的轨迹分量为前进方向轨迹分量，该非碰撞方向上的期望轨迹分量则为侧移方向和抬起方向的原来轨迹分量。例如，以上述的侧移方向和抬起方向的期望轨迹规划为例，此时该摆动腿的运动轨迹可表示为：
Figure M_220614142910110_110627001
。
又例如，在另一种实施方式中，若该碰撞方向的轨迹分量包括前进方向轨迹分量和侧移方向轨迹分量，则该摆动腿将按照如下的运动轨迹进行运动：
Figure M_220614142910190_190207001
。
可以理解，本实施例在足端碰撞阶段利用设计的足端拖动模式来计算摆动腿在碰撞方向上的位置偏移量，可以改变摆动腿的运动轨迹，使得机器人在发生碰撞后，摆动腿不会再恢复到碰撞时的初始位置，避免了再次碰撞。
本实施例的足端碰撞稳定控制方法通过利用对摆动腿足端的拖动与轨迹再规划处理，可以实现机器人的稳定运行，而不会出现足端碰撞后摔倒或受到损坏等，从而保证了机器人自身及外界环境的安全。
实施例2
请参照图5，基于上述实施例1的方法，本实施例提出一种机器人足端碰撞稳定控制装置100。本实施例中，该机器人的单腿运动规划轨迹包括足端前进方向轨迹分量、侧移方向轨迹分量和抬起方向轨迹分量。
示范性地，该机器人足端碰撞稳定控制装置100包括：
碰撞检测模块110，用于在检测到机器人的摆动腿发生足端碰撞时，停止所述摆动腿在碰撞方向上的轨迹分量规划，所述碰撞方向的轨迹分量为所述前进方向轨迹分量和/或所述侧移方向轨迹分量；
偏移量计算模块120，用于根据实时获取的所述摆动腿的足端在所述碰撞方向上受到的外力基于足端拖动控制模式计算所述碰撞方向上的位置偏移量，并基于所述位置偏移量确定所述碰撞方向上的再规划轨迹分量；
运动控制模块130，用于根据所述碰撞方向上的所述再规划轨迹分量和所述摆动腿在非碰撞方向上的期望轨迹分量控制所述摆动腿运动。
可以理解，本实施例的装置对应于上述实施例1的方法，上述实施例1中的可选项同样适用于本实施例，故在此不再重复描述。
本申请还提供了一种足式机器人，例如，可以是双足机器人、三足机器人等。示范性地，该足式机器人包括处理器和存储器，其中，存储器存储有计算机程序，处理器通过运行所述计算机程序，从而使足式机器人执行上述的机器人足端碰撞稳定控制方法或者上述机器人足端碰撞稳定控制装置中的各个模块的功能。
本申请还提供了一种可读存储介质，用于储存上述足式机器人中使用的所述计算机程序。
在本申请所提供的几个实施例中，应该理解到，所揭露的装置和方法，也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的，例如，附图中的流程图和结构图显示了根据本申请的多个实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上，流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分，所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意，在作为替换的实现方式中，方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如，两个连续的方框实际上可以基本并行地执行，它们有时也可以按相反的顺序执行，这依所涉及的功能而定。也要注意的是，结构图和/或流程图中的每个方框、以及结构图和/或流程图中的方框的组合，可以用执行规定的功能或动作的专用的基于硬件的系统来实现，或者可以用专用硬件与计算机指令的组合来实现。
另外，在本申请各个实施例中的各功能模块或单元可以集成在一起形成一个独立的部分，也可以是各个模块单独存在，也可以两个或更多个模块集成形成一个独立的部分。
所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备（可以是智能手机、个人计算机、服务器、或者网络设备等）执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器（ROM，Read-Only Memory）、随机存取存储器（RAM，Random Access Memory）、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述，仅为本申请的具体实施方式，但本申请的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本申请揭露的技术范围内，可轻易想到变化或替换，都应涵盖在本申请的保护范围之内。

Claims (8)

1.一种机器人足端碰撞稳定控制方法，其特征在于，所述机器人的单腿运动规划轨迹包括足端前进方向轨迹分量、侧移方向轨迹分量和抬起方向轨迹分量；该方法包括：
在检测到机器人的摆动腿发生足端碰撞时，停止所述摆动腿在碰撞方向上的轨迹分量规划，所述碰撞方向的轨迹分量为所述前进方向轨迹分量和/或所述侧移方向轨迹分量；
根据实时获取的所述摆动腿的足端在所述碰撞方向上受到的外力基于足端拖动控制模式计算所述碰撞方向上的位置偏移量，并基于所述位置偏移量确定所述碰撞方向上的再规划轨迹分量；
根据所述碰撞方向上的所述再规划轨迹分量和所述摆动腿在非碰撞方向上的期望轨迹分量控制所述摆动腿运动；
其中，所述足端拖动控制模式的表达式如下：
Figure M_220614142904621_621851001
；
其中，
Figure M_220614142904668_668710001
分别表示所述机器人的参考速度和测量的实际速度；b为预设参数；F为所述摆动腿的足端受到的外力；
通过对所述足端拖动控制模式进行积分转换操作，得到位置偏移计算公式，所述位置偏移计算公式用于根据所述摆动腿的足端在对应轨迹分量方向上受到的外力计算所述对应轨迹分量方向上的位置偏移量；所述位置偏移计算公式如下：
Figure M_220614142904699_699973001
；
其中，
Figure M_220614142904763_763923001
为位置偏移量；
Figure M_220614142904795_795176002
为所述机器人的程序控制周期。
2.根据权利要求1所述的机器人足端碰撞稳定控制方法，其特征在于，当所述碰撞方向的轨迹分量为所述前进方向轨迹分量和/或所述侧移方向轨迹分量时，所述碰撞方向上的所述位置偏移量包括所述前进方向上的位置偏移量和/或所述侧移方向上的位置偏移量；
所述摆动腿在所述前进方向和/或所述侧移方向的再规划轨迹分量表示为：
Figure M_220614142904810_810849001
；
Figure M_220614142904857_857686001
；
其中，
Figure M_220614142904904_904566001
分别表示所述摆动腿在所述前进方向上的t时刻和t-1时刻的位置；
Figure M_220614142904935_935838002
分别表示所述摆动腿在所述侧移方向上的t时刻和t-1时刻的位置；
Figure M_220614142904968_968544003
和
Figure M_220614142904984_984203004
分别表示实时计算到的在所述前进方向和所述侧移方向上的所述位置偏移量。
3.根据权利要求1所述的机器人足端碰撞稳定控制方法，其特征在于，所述机器人的足端设有力传感器，所述力传感器的坐标系中的X方向、Y方向和Z方向依次对应于所述前进方向、所述侧移方向和所述抬起方向；
所述检测到机器人的摆动腿发生足端碰撞，之前还包括：
当所述机器人处于摆动期时，通过所述力传感器实时检测所述摆动腿的足端在X方向、Y方向和Z方向上受到的外力；
若所述摆动腿的足端在X方向或Y方向上受到的外力大于等于预设阈值，则确定所述摆动腿发生碰撞。
4.根据权利要求3所述的机器人足端碰撞稳定控制方法，其特征在于，还包括：
若所述摆动腿的足端在X方向或Y方向上受到的外力小于所述预设阈值，则按照所述摆动腿的期望运动规划轨迹控制所述摆动腿运动。
5.根据权利要求4所述的方法，其特征在于，所述摆动腿的期望运动规划轨迹表示如下：
Figure M_220614142905015_015414001
；
Figure M_220614142905046_046662001
；
Figure M_220614142905109_109161001
；
其中，
Figure M_220614142905144_144261001
、
Figure M_220614142905160_160405002
和
Figure M_220614142905191_191660003
分别表示所述摆动腿足端的所述前进方向轨迹分量、所述侧移方向轨迹分量和所述抬起方向轨迹分量；t为抬腿时间；T为摆动期总时间；
Figure M_220614142905222_222916004
为所述摆动腿的期望前向步长；
Figure M_220614142905254_254158005
为所述摆动腿的期望侧向步长；A、B、C和D分别为预设系数。
6.一种机器人足端碰撞稳定控制装置，其特征在于，所述机器人的单腿运动规划轨迹包括足端前进方向轨迹分量、侧移方向轨迹分量和抬起方向轨迹分量；该装置包括：
碰撞检测模块，用于在检测到机器人的摆动腿发生足端碰撞时，停止所述摆动腿在碰撞方向上的轨迹分量规划，所述碰撞方向的轨迹分量为所述前进方向轨迹分量和/或所述侧移方向轨迹分量；
偏移量计算模块，用于根据实时获取的所述摆动腿的足端在所述碰撞方向上受到的外力基于足端拖动控制模式计算所述碰撞方向上的位置偏移量，并基于所述位置偏移量确定所述碰撞方向上的再规划轨迹分量；
运动控制模块，用于根据所述碰撞方向上的所述再规划轨迹分量和所述摆动腿在非碰撞方向上的期望轨迹分量控制所述摆动腿运动；
其中，所述足端拖动控制模式的表达式如下：
Figure M_220614142905285_285415001
；
式中，
Figure M_220614142905316_316685001
分别表示所述机器人的参考速度和测量的实际速度；b为预设参数；F为所述摆动腿的足端受到的外力；
通过对所述足端拖动控制模式进行积分转换操作，得到位置偏移计算公式，所述位置偏移计算公式用于根据所述摆动腿的足端在对应轨迹分量方向上受到的外力计算所述对应轨迹分量方向上的位置偏移量；所述位置偏移计算公式如下：
Figure M_220614142905351_351794001
；
其中，
Figure M_220614142905383_383576001
为位置偏移量；
Figure M_220614142905399_399179002
为所述机器人的程序控制周期。
7.一种足式机器人，其特征在于，所述足式机器人包括处理器和存储器，所述存储器存储有计算机程序，所述处理器用于执行所述计算机程序以实施权利要求1-5中任一项所述的机器人足端碰撞稳定控制方法。
8.一种可读存储介质，其特征在于，其存储有计算机程序，所述计算机程序在处理器上执行时，实施根据权利要求1-5中任一项所述的机器人足端碰撞稳定控制方法。
CN202110846375.XA 2021-07-26 2021-07-26 机器人足端碰撞稳定控制方法、装置和足式机器人 Active CN113524190B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN202110846375.XA CN113524190B (zh) 2021-07-26 2021-07-26 机器人足端碰撞稳定控制方法、装置和足式机器人
PCT/CN2021/131466 WO2023005068A1 (zh) 2021-07-26 2021-11-18 机器人足端碰撞稳定控制方法、装置和足式机器人
US18/089,588 US20230133934A1 (en) 2021-07-26 2022-12-28 Method for controlling legged robot, robot and computer-readable storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110846375.XA CN113524190B (zh) 2021-07-26 2021-07-26 机器人足端碰撞稳定控制方法、装置和足式机器人

Publications (2)

Publication Number Publication Date
CN113524190A CN113524190A (zh) 2021-10-22
CN113524190B true CN113524190B (zh) 2022-07-29

Family

ID=78120908

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110846375.XA Active CN113524190B (zh) 2021-07-26 2021-07-26 机器人足端碰撞稳定控制方法、装置和足式机器人

Country Status (3)

Country Link
US (1) US20230133934A1 (zh)
CN (1) CN113524190B (zh)
WO (1) WO2023005068A1 (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113524190B (zh) * 2021-07-26 2022-07-29 深圳市优必选科技股份有限公司 机器人足端碰撞稳定控制方法、装置和足式机器人

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107168351A (zh) * 2017-05-26 2017-09-15 中国北方车辆研究所 一种足式机器人的柔顺控制方法及装置
CN110480640A (zh) * 2019-08-26 2019-11-22 中科新松有限公司 用于台阶地形行走的机器人足端轨迹规划方法
CN110625610A (zh) * 2018-06-25 2019-12-31 西门子股份公司 确定机器人的末端执行器的运动轨迹的方法与装置、系统
CN112405531A (zh) * 2020-11-06 2021-02-26 广东电网有限责任公司电力科学研究院 位置域阻抗控制方法、装置、存储介质及作业机器人
CN113064433A (zh) * 2021-03-22 2021-07-02 深圳市优必选科技股份有限公司 机器人迈步控制方法、装置、机器人控制设备及存储介质
CN113110484A (zh) * 2021-04-30 2021-07-13 深圳市优必选科技股份有限公司 一种步态轨迹规划方法、装置、可读存储介质及机器人

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101428657B (zh) * 2008-12-16 2011-02-02 吉林大学 欠驱动双足步行机器人行走机构
CN101531006B (zh) * 2009-03-31 2011-06-29 清华大学 双足机器人动力式行走方法
US9594377B1 (en) * 2015-05-12 2017-03-14 Google Inc. Auto-height swing adjustment
US11287826B2 (en) * 2018-10-12 2022-03-29 Boston Dynamics, Inc. Terrain aware step planning system
KR101987868B1 (ko) * 2018-11-29 2019-06-11 주식회사 트위니 시간상태 영역에서의 장애물 회피 방법, 이를 구현하기 위한 프로그램이 저장된 기록매체 및 이를 구현하기 위해 매체에 저장된 컴퓨터프로그램
CN113524190B (zh) * 2021-07-26 2022-07-29 深圳市优必选科技股份有限公司 机器人足端碰撞稳定控制方法、装置和足式机器人

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107168351A (zh) * 2017-05-26 2017-09-15 中国北方车辆研究所 一种足式机器人的柔顺控制方法及装置
CN110625610A (zh) * 2018-06-25 2019-12-31 西门子股份公司 确定机器人的末端执行器的运动轨迹的方法与装置、系统
CN110480640A (zh) * 2019-08-26 2019-11-22 中科新松有限公司 用于台阶地形行走的机器人足端轨迹规划方法
CN112405531A (zh) * 2020-11-06 2021-02-26 广东电网有限责任公司电力科学研究院 位置域阻抗控制方法、装置、存储介质及作业机器人
CN113064433A (zh) * 2021-03-22 2021-07-02 深圳市优必选科技股份有限公司 机器人迈步控制方法、装置、机器人控制设备及存储介质
CN113110484A (zh) * 2021-04-30 2021-07-13 深圳市优必选科技股份有限公司 一种步态轨迹规划方法、装置、可读存储介质及机器人

Also Published As

Publication number Publication date
CN113524190A (zh) 2021-10-22
WO2023005068A1 (zh) 2023-02-02
US20230133934A1 (en) 2023-05-04

Similar Documents

Publication Publication Date Title
CN111880544B (zh) 仿人机器人步态规划方法、装置和仿人机器人
KR20210152055A (ko) 로봇으로 계단들을 오르내리기
US11851120B2 (en) Control of robotic devices with non-constant body pitch
US9469031B2 (en) Motion limiting device and motion limiting method
US8332068B2 (en) Intelligent stepping for humanoid fall direction change
US8634959B2 (en) Apparatus and method detecting a robot slip
CN110480640B (zh) 用于台阶地形行走的机器人足端轨迹规划方法
CN113064433B (zh) 机器人迈步控制方法、装置、机器人控制设备及存储介质
Neuhaus et al. Comprehensive summary of the Institute for Human and Machine Cognition’s experience with LittleDog
US11040449B2 (en) Robot control system and method of controlling a robot
CN113524190B (zh) 机器人足端碰撞稳定控制方法、装置和足式机器人
US20090132087A1 (en) Learning Capture Points for Humanoid Push Recovery
JP2010501413A (ja) 車両の運転操作のための衝突防止軌道を計算する方法
KR102570338B1 (ko) 자동차의 환경에서 타겟 자동차의 궤적을 예측하기 위한 방법 및 시스템
US20090295324A1 (en) Device and method for controlling manipulator
US11383381B2 (en) Footstep contact detection
US20210299867A1 (en) Systems and methods for controlling robotic behaviors
CN113031639B (zh) 机器人步长处理方法、装置、机器人控制设备及存储介质
Bohórquez et al. Adaptive step duration in biped walking: a robust approach to nonlinear constraints
WO2022179209A1 (zh) 机器人摆动腿落地检测方法、装置和机器人
JP2009285816A (ja) 脚式ロボット及びその制御方法
CN114115295A (zh) 机器人运动规划方法及装置、机器人控制设备和存储介质
Lu et al. Whole‐body motion planning and control of a quadruped robot for challenging terrain
EP4112234A1 (en) Legged robot and method for controlling legged robot
CN117232511A (zh) 一种局部路径规划方法、存储介质及设备

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
GR01 Patent grant
GR01 Patent grant