CN113156926B - 机器人的有限状态机的建立方法、有限状态机和机器人 - Google Patents
机器人的有限状态机的建立方法、有限状态机和机器人 Download PDFInfo
- Publication number
- CN113156926B CN113156926B CN202010073668.4A CN202010073668A CN113156926B CN 113156926 B CN113156926 B CN 113156926B CN 202010073668 A CN202010073668 A CN 202010073668A CN 113156926 B CN113156926 B CN 113156926B
- Authority
- CN
- China
- Prior art keywords
- robot
- phase
- state
- entering
- stage
- 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
- 238000000034 method Methods 0.000 title claims abstract description 57
- 230000001133 acceleration Effects 0.000 claims abstract description 93
- 230000009191 jumping Effects 0.000 claims abstract description 60
- 238000001514 detection method Methods 0.000 claims abstract description 44
- 230000008859 change Effects 0.000 claims description 27
- 238000004590 computer program Methods 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 9
- 230000006399 behavior Effects 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 3
- 125000004122 cyclic group Chemical group 0.000 claims description 2
- 230000008569 process Effects 0.000 description 20
- 238000010586 diagram Methods 0.000 description 14
- 238000004422 calculation algorithm Methods 0.000 description 11
- 230000006870 function Effects 0.000 description 6
- 238000003874 inverse correlation nuclear magnetic resonance spectroscopy Methods 0.000 description 4
- 206010010071 Coma Diseases 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 239000002023 wood Substances 0.000 description 2
- 235000008694 Humulus lupulus Nutrition 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明涉及机器人的有限状态机的建立方法、有限状态机和机器人,该建立方法包括:将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,加速相和减速相各自的规划进入阶段与对应的实际进入阶段分别相重合;对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果;根据状态检测结果,更新机器人对应的状态信息;根据更新后的状态信息,控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换以控制机器人进行连续跳跃。上述机器人的有限状态机的建立方法,大大提高了机器人连续跳跃的稳定性。
Description
技术领域
本发明涉及机器人控制领域,尤其涉及一种机器人的有限状态机的建立方法、有限状态机和机器人。
背景技术
在机器人的行走理论中,主要是通过控制零力矩点的位置,产生机器人水平方向的质心运动轨迹,同时保证机器人运动中的平衡问题。由于腾空状态中,机器人与地面没有力作用,机器人处于自由落体状态,着地时的运动模型和动力学方程完全不适用,上述方法不适用于机器人的连续跳跃和奔跑。因此,在处理机器人跳跃和奔跑运动控制时,急需建立一种判定机器人所处状态的方法或模型,以决定机器人所处的状态,从而确定该时刻下机器人执行的行为。
发明内容
鉴于此,本发明提供一种机器人的有限状态机的建立方法、有限状态机和机器人,能够通过将连续跳跃模型中每种机器人状态划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段,进而建立有限状态机,能够在机器人跳跃过程中实时获取下一时刻机器人的更新状态信息,进而输出机器人各关节的运动控制指令,使机器人根据上述运动指令在加速相、腾空相和减速相中各个不同阶段之间进行状态切换,最终实现机器人的可变高度跳跃、可变腾空时间跳跃、可变跳跃轨迹跳跃以及连续跳跃,大大提高了机器人连续跳跃的稳定性。
一种机器人的有限状态机的建立方法,应用于机器人的连续跳跃模型,连续跳跃模型中机器人状态包括加速相、腾空相和减速相,建立方法包括:
将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,加速相和减速相各自的规划进入阶段与对应的实际进入阶段分别相重合;
对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果;
根据状态检测结果,更新机器人对应的状态信息;
根据更新后的状态信息,控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换以控制机器人进行连续跳跃。
在一个实施例中,对机器人在加速相、腾空相和减速相之间进行的循环状态切换进行检测,得到对应的状态检测结果的步骤包括:
计算机器人的质心竖直方向速度并获取对应的速度方向和速度变化方向,判断质心竖直方向速度的大小是否大于预设速度阈值;
当质心竖直方向速度大于预设速度阈值且速度方向和对应的速度变化方向向上时,判断机器人处于加速相中的状态持续阶段;
根据质心加速度规划轨迹获取机器人从加速相进入腾空相的规划切换时刻并判断规划切换时刻是否到来,当规划切换时刻到来时,判断机器人进入加速相的状态结束与跳转阶段,并在下一控制周期进入腾空相的规划进入阶段;
计算机器人足底与地面之间的竖直方向作用力并获取对应的作用力变化方向,判断竖直方向作用力是否小于或等于第一预设作用力阈值;
当作用力变化方向为逐渐变小且竖直方向作用力小于或等于第一预设作用力阈值时,判断机器人进入腾空相的实际进入阶段,并在下一控制周期处于腾空相中的状态持续阶段;
当所述竖直方向作用力小于或等于所述第一预设作用力阈值且保持不变时时,判断所述机器人处于所述腾空相中的状态持续阶段;
当作用力变化方向为逐渐变大且竖直方向作用力大于或等于第二预设作用力阈值时,判断机器人进入腾空相的状态结束与跳转阶段,并在下一控制周期进入减速相的规划进入阶段和实际进入阶段;
当速度方向向下、对应的速度变化方向向上且质心竖直方向速度大于预设速度阈值时,判断机器人处于减速相中的状态持续阶段;
当速度方向向下直至质心竖直方向速度小于或等于预设速度阈值时,判断机器人进入减速相中的状态结束与跳转阶段,并在下一控制周期进入加速相的规划进入阶段和实际进入阶段。
在一个实施例中,机器人足底设置有压力传感器,计算机器人足底与地面之间的竖直方向作用力的步骤中对应的计算公式为:
其中,Rfoot是机器人足底的姿态矩阵,是压力传感器测量值,/>表示竖直方向作用力。
在一个实施例中,机器人的各关节末端设置有转矩传感器,计算机器人足底与地面之间的竖直方向作用力的步骤中对应的计算公式为:
其中,JT是机器人的质心相对于各关节的雅克比矩阵的转置矩阵,是利用转矩传感器得到的机器人的各关节受力矩组成的列向量,/>表示竖直方向作用力。
在一个实施例中,计算机器人的质心竖直方向速度的步骤中对应的计算公式为:
其中,为所述机器人各关节各自对应的角速度,J是所述机器人的质心相对于各关节的雅克比矩阵,/>表示所述机器人的质心速度,所述质心竖直方向速度为/>的竖直方向分量。
在一个实施例中,状态信息包括状态名称、规划进入标志位、实际进入标志位、状态持续标志位以及状态结束与跳转标志位,根据状态检测结果,更新机器人对应的状态信息的步骤包括:
当所述状态检测结果为所述机器人处于所述加速相对应的状态持续阶段时,当且仅当将对应的状态持续标志位置为有效;
当所述状态检测结果为所述机器人进入所述加速相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期所述机器人进入所述腾空相的规划进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置为有效;
当所述状态检测结果为所述机器人进入所述腾空相的实际进入阶段时,将对应的规划进入标志位置为无效,并将对应的实际进入标志位置为有效,并在下一控制周期所述机器人处于所述腾空相的状态持续阶段时,将对应的实际进入标志位置为无效;
当所述状态检测结果为所述机器人进入所述腾空相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期所述机器人进入所述减速相的规划进入阶段和实际进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置和实际进入标志位置为有效,并在所述机器人处于所述减速相的状态持续阶段时,将对应的规划进入标志位置和实际进入标志位置为无效,且将对应的状态持续标志位置为有效;
当所述状态检测结果为所述机器人进入所述减速相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期所述机器人进入所述加速相的规划进入阶段和实际进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置和实际进入标志位置为有效。
在一个实施例中,根据更新后的状态信息,控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换的步骤包括:
当更新后的规划进入标志位有效时,结合更新后的状态名称,控制机器人进入对应的规划进入阶段,重置计时器,并生成初始质心规划轨迹;
当更新后的实际进入标志位有效时,结合更新后的状态名称,控制机器人进入对应的实际进入阶段,计算并记录机器人对应的运动参数信息;
当更新后的状态持续标志位有效时,结合更新后的状态名称,控制机器人进入对应的状态持续阶段,根据初始质心规划轨迹和运动参数信息进行质心轨迹规划和质心速度控制;
当更新后的状态结束与跳转标志位有效时,结合更新后的状态名称,控制机器人进入对应的状态结束与跳转阶段。
一种机器人的有限状态机,应用于机器人的连续跳跃模型,连续跳跃模型中机器人状态包括加速相、腾空相和减速相,有限状态机包括状态划分单元、事件检测单元、状态变更单元和行为处理单元,机器人的有限状态机包括:
状态划分单元,用于将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,加速相和减速相各自的规划进入阶段与对应的实际进入阶段分别相重合;
事件检测单元,用于对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果;
状态变更单元,用于根据状态检测结果,更新机器人对应的状态信息;
行为处理单元,用于根据更新后的状态信息,控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换以控制机器人进行连续跳跃。
此外,还提供一种机器人,包括存储器以及处理器,存储器用于存储计算机程序,处理器运行计算机程序以使机器人执行上述建立方法。
此外,还提供一种可读存储介质,可读存储介质存储有计算机程序,计算机程序在被处理器运行时执行上述建立方法。
上述机器人的有限状态机的建立方法,应用于机器人的连续跳跃模型,连续跳跃模型中机器人状态包括加速相、腾空相和减速相,将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,加速相和减速相各自的规划进入阶段与对应的实际进入阶段分别相重合,对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果,根据状态检测结果,更新机器人对应的状态信息,根据更新后的状态信息,控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换以控制机器人进行连续跳跃,能够通过将连续跳跃模型中每种机器人状态划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段,进而建立有限状态机,能够在机器人跳跃过程中实时获取下一时刻机器人的更新状态信息,进而输出机器人各关节的运动控制指令,使机器人根据上述运动指令在加速相、腾空相和减速相中各个不同阶段之间进行状态切换,把机器人状态的检测判定和状态切换的功能从机器人的控制算法中提取出来,作为一项单独的算法模块,与其它算法解耦,这使得机器人整体算法维护容易,对应的控制过程更为精确,最终实现机器人的可变高度跳跃、可变腾空时间跳跃、可变跳跃轨迹跳跃以及连续跳跃,大大提高了机器人连续跳跃的稳定性。
附图说明
为了更清楚地说明本发明的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对本发明保护范围的限定。在各个附图中,类似的构成部分采用类似的编号。
图1为一个实施例中提供的一种机器人的有限状态机的建立方法的流程示意图;
图2为一个实施例中提供的一种单腿机器人的结构示意图;
图3为一个实施例中提供的一种单腿机器人进行不同高度的连续跳跃过程示意图;
图4为一个实施例中在机器人足底突然加入未知高度木块时,单腿机器人对应的连续跳跃过程示意图;
图5为一个实施例中在机器人足底突然撤出未知高度木块时,单腿机器人对应的连续跳跃过程示意图;
图6为一个实施例中提供的一种机器人的有限状态机的结构框图。
具体实施方式
下面将结合本发明实施例中附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。
通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
在下文中,将更全面地描述本公开的各种实施例。本公开可具有各种实施例,并且可在其中做出调整和改变。然而,应理解:不存在将本公开的各种实施例限于在此公开的特定实施例的意图,而是应将本公开理解为涵盖落入本公开的各种实施例的精神和范围内的所有调整、等同物和/或可选方案。
在下文中,可在本发明的各种实施例中使用的术语“包括”、“具有”及其同源词仅意在表示特定特征、数字、步骤、操作、元件、组件或前述项的组合,并且不应被理解为首先排除一个或更多个其它特征、数字、步骤、操作、元件、组件或前述项的组合的存在或增加一个或更多个特征、数字、步骤、操作、元件、组件或前述项的组合的可能性。
此外,术语“第一”、“第二”、“第三”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
除非另有限定,否则在这里使用的所有术语(包括技术术语和科学术语)具有与本发明的各种实施例所属领域普通技术人员通常理解的含义相同的含义。所述术语(诸如在一般使用的词典中限定的术语)将被解释为具有与在相关技术领域中的语境含义相同的含义并且将不被解释为具有理想化的含义或过于正式的含义,除非在本发明的各种实施例中被清楚地限定。
图1为一个实施例中提供的一种机器人的有限状态机的建立方法,应用于机器人的连续跳跃模型,连续跳跃模型中机器人状态包括加速相、腾空相和减速相,该机器人的有限状态机的建立方法包括:
步骤S110,将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,加速相和减速相各自的规划进入阶段与对应的实际进入阶段分别相重合。
其中,机器人在连续跳跃奔跑时,机器人状态通常包括加速相、腾空相和减速相,为更好的对机器人连续跳跃进行控制,这里将每一相分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段,这是基于机器人的运动特点和控制方面的需要所决定的。
其中,机器人在规划的离地时刻和机器人真实的离地时刻很可能不同,这是由于机器人***和电机控制会产生的必不可少的误差和延误,而机器人真实离地时,需要记录机器人的高度、质心线速度和角速度等关键信息,因此,针对机器人由加速相到腾空相的切换状态,需要进一步区分,因而将上述机器人由加速相到腾空相的切换状态进一步区分为规划进入阶段和实际进入阶段,而对于加速相或减速相,为使得处理过程方便,机器人规划进入阶段和实际进入阶段的过程可认为相重合。
步骤S120,对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果。
其中,机器人在每一相的四个阶段以及相邻相之间进行切换时,机器人对应的状态均不同,此时需要对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果。
步骤S130,根据状态检测结果,更新机器人对应的状态信息。
其中,当获取到上述状态检测结果后,机器人的控制***就需要及时的更新机器人对应的状态信息,及时的对机器人的跳跃过程做出控制。
其中,上述状态信息通常包括机器人在每个阶段所对应的状态标志位信息、状态计时信息以及状态名称。
步骤S140,根据更新后的状态信息,控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换以控制机器人进行连续跳跃。
其中,机器人在获取到更新后的状态信息后,能够进一步在对应的控制周期内生成对应的控制命令,以控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换,从而控制机器人进行连续跳跃。
在一个实施例中,如图2所示,提供了一种由两个串联弹性驱动器并联组成的单腿机器人100,每个串联弹性驱动器的关节位置、速度和关节末端转矩均可直接测量,其中,图2中110表示竖直导轨,120表示单个串联弹性驱动器,130表示试验地面,140表示压力传感器。
其中,实验地面130下的压力传感器主要用于客观测量单腿机器人100与实验地面之间作用力,从而计算单腿机器人100处于腾空相的腾空跳跃时间。
其中,单腿机器人100采用上述机器人的有限状态机的建立方法所建立的有限状态机,将每种机器人状态划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段,能够在单腿机器人100跳跃过程中实时获取下一时刻单腿机器人100的更新状态信息,进而输出单腿机器人100各关节的运动控制指令,使单腿机器人100根据上述运动指令在加速相、腾空相和减速相中各个不同阶段之间进行状态切换,进而能够对单腿机器人100的不同高度的连续跳跃,如图3中所示机器人在标号6-10过程中,相对于标号1-5过程实现了不同高度的连续跳。
其中,由于每一种机器人状态划分为多个阶段,单腿机器人100能够根据上述运动指令在加速相、腾空相和减速相中各个不同阶段之间进行状态切换,进而能够对机器人的跳跃高度、腾空时间和跳跃轨迹进行单独控制,连续跳跃过程中的抗干扰能力大大加强。
在一个实施例中,单腿机器人100腾空过程中,在机器人足底突然加入未知高度木块,这会导致单腿机器人100提前落地,然后在机器人足底突然撤出未知高度木块,这会导致单腿机器人100滞后落地,总之,单腿机器人100连续跳跃的动作会失控。
当使用上述有限状态机后,单腿机器人100会对腾空相中状态持续阶段与腾空相的结束与跳转阶段的切换时刻一直检测,当机器人足底与实验地面之间接触时,首先会进入腾空相的结束与跳转阶段,并在下一控制周期进入减速相中的规划进入阶段和实际进入阶段,然后执行后续的控制过程,整个机器人跳跃过程中的跳跃稳定性大大加强。
其中,图4中标号1-6为在机器人足底突然加入未知高度木块时对应的各个跳跃过程示意图,图5中标号1-6为在机器人足底突然撤出未知高度木块时对应的各个跳跃过程示意图。
上述机器人的有限状态机的建立方法,能够通过将连续跳跃模型中每种机器人状态划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段,进而建立有限状态机,能够在机器人跳跃过程中实时获取下一时刻机器人的更新状态信息,进而输出机器人各关节的运动控制指令,使机器人根据上述运动指令在加速相、腾空相和减速相中各个不同阶段之间进行状态切换,进而能够对机器人的跳跃高度、腾空时间和跳跃轨迹进行单独控制,把机器人状态的检测判定和状态切换的功能从机器人的控制算法中提取出来,作为一项单独的算法模块,与其它算法解耦,这使得机器人整体算法维护成本大大降低,对应的控制过程也更为精确简洁,在上述有限状态机的处理下,最终实现机器人的可变高度跳跃、可变腾空时间跳跃、可变跳跃轨迹跳跃以及连续跳跃,大大提高了机器人连续跳跃的稳定性,为双足和四足机器人的更多更复杂的跳跃奔跑实验提供了一个可靠的状态机模块框架。
在一个实施例中,步骤S120包括:
1)计算机器人的质心竖直方向速度并获取对应的速度方向和速度变化方向,判断质心竖直方向速度的大小是否大于预设速度阈值。
其中,在判断机器人是否处于加速相的状态持续阶段时,需要通过获取机器人的质心竖直方向速度并进行判断。
在一个实施例中,上述预设速度阈值取零,判断上述机器人的质心竖直方向速度是否大于零。
2)当质心竖直方向速度大于预设速度阈值且速度方向和对应的速度变化方向向上时,判断机器人处于加速相中的状态持续阶段。
其中,上述预设速度阈值理论上取值为零值,但实际应用过程中预设速度阈值取值可取值为接近零值附近的数值,换言之,当质心竖直方向速度大于上述预设速度阈值且速度方向和速度变化方向向上时,即可认为机器人处于加速相中的状态持续阶段。
在一个实施例中,预设速度阈值为零,当质心竖直方向速度大于零且速度方向和速度变化方向向上时,判断机器人处于加速相中的状态持续阶段。
其中,在加速相时,机器人开始向上加速,每一时刻,按照质心规划的位置(comp),速度(comv),加速度(coma),通过逆动力学(Inverse Dynamics)和逆运动学(InverseKinematics),计算得到各关节电机的指令。若是位置电机,计算出相应的关节角度,角速度,若是力控电机,则计算出关节转矩发送给电机。
3)根据质心加速度规划轨迹获取机器人从加速相进入腾空相的规划切换时刻并判断规划切换时刻是否到来,当规划切换时刻到来时,判断机器人进入加速相的状态结束与跳转阶段,并在下一控制周期进入腾空相的规划进入阶段。
其中,加速相的状态持续阶段下,机器人会一直进行离地检测,从加速相进入到腾空相,由于机器人的运动存在追踪误差,机器人存在规划离地时刻以及实际离地时刻,两者对应的时间往往不同,通常机器人的真实离地时间往往更晚。机器人首先按照质心加速度规划轨迹从加速相进入到腾空相,根据质心加速度规划轨迹能够获取机器人从加速相进入腾空相的规划切换时刻,并判断规划切换时刻是否到来,当规划切换时刻到来时,判断机器人进入加速相的状态结束与跳转阶段,当机器人的加速相的状态结束与跳转阶段结束后,在下一控制周期进入腾空相的规划进入阶段。
4)计算机器人足底与地面之间的竖直方向作用力并获取对应的作用力变化方向,判断竖直方向作用力是否小于或等于第一预设作用力阈值。
其中,机器人在实际进入腾空相时,机器人足底与地面之间的竖直方向作用力理论值为零且逐渐变小,但在实际处理中,上述第一预设作用力阈值取值可取值为接近零值的数值。
因此,通过计算机器人足底与地面之间的竖直方向作用力并获取对应的作用力变化方向,可判断机器人是否实际进入腾空相。
其中,上述机器人足底与地面之间的竖直方向作用力的测量通过安装的传感器进行测量。
5)当作用力变化方向为逐渐变小且竖直方向作用力小于或等于第一预设作用力阈值时,判断机器人进入腾空相的实际进入阶段。
在一个实施例中,上述第一预设作用力阈值取零值,上述作用力变化方向为逐渐变小且竖直方向作用力等于零时,判定机器人进入腾空相的实际进入阶段。
在一个实施例中,上述第一预设作用力阈值取接近零值的数值例如0.0001N,当作用力变化方向为逐渐变小且竖直方向作用力小于或等于0.0001N时,判断机器人进入腾空相的实际进入阶段。
6)当竖直方向作用力小于或等于第一预设作用力阈值且保持不变时,判断机器人处于腾空相的状态持续阶段。
7)当作用力变化方向为逐渐变大且竖直方向作用力大于或等于第二预设作用力阈值时,判断机器人进入腾空相的状态结束与跳转阶段,并在下一控制周期进入减速相的规划进入阶段和实际进入阶段。
其中,上述第二预设作用力阈值的理论值取零值,也可取接近零值的数值例如0.0001N,当作用力变化方向为逐渐变大且竖直方向作用力大于或等于0.0001N时,判断机进入腾空相的状态结束与跳转阶段,并在下一控制周期进入减速相的规划进入阶段和实际进入阶段。
其中,上述第一预设作用力阈值和第二预设作用力阈值的大小可取值相同。
其中,减速相的规划进入阶段和实际进入阶段可认为基本重合或相同,机器人进入腾空相的状态结束与跳转阶段后,在下一控制周期同时进入减速相的规划进入阶段和实际进入阶段。
8)当速度方向向下、对应的速度变化方向向上且质心竖直方向速度大于预设速度阈值时,判断机器人处于减速相中的状态持续阶段;
其中,机器人在由腾空相进入到减速相后,对应的质心竖直速度越来越小,而此时对应的速度变化方向处于向上状态,机器人处于减速状态,此时,只要质心竖直方向速度大于预设速度阈值时,可判断机器人仍然处于减速相中的状态持续阶段。
其中,上述预设速度阈值理论取值通常为零值,也可取接近零值的数值例如0.0001m/s。
9)当速度方向向下直至质心竖直方向速度小于或等于预设速度阈值时,判断机器人进入减速相中的状态结束与跳转阶段,并在下一控制周期进入加速相的规划进入阶段和实际进入阶段。
其中,加速相的规划进入阶段和实际进入阶段重合,机器人在进入减速相中的状态结束与跳转阶段后的下一控制周期同时进入加速相的规划进入阶段和实际进入阶段。
上述步骤展示的是按照机器人从加速相的状态持续阶段开始,对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测以得到对应的状态检测结果的一种描述,按照以上顺序描述仅仅是为了符合逻辑习惯,实际检测过程中对于各个不同的阶段之间的切换检测也可同时进行,并行不悖,不以上述步骤顺序为限制。
在一个实施例中,机器人足底设置有压力传感器,步骤S124中计算机器人足底与地面之间的竖直方向作用力对应的计算公式为:
其中,Rfoot是机器人足底的姿态矩阵,是压力传感器测量值,/>表示竖直方向作用力。
在一个实施例中,机器人的各关节末端设置有转矩传感器,步骤S124中计算机器人足底与地面之间的竖直方向作用力对应的计算公式为:
其中,JT是机器人的质心相对于各关节的雅克比矩阵的转置矩阵,是利用转矩传感器得到的机器人的各关节受力矩组成的列向量,/>表示竖直方向作用力。
在一个实施例中,步骤S124中计算机器人的质心竖直方向速度对应的计算公式为:
其中,为机器人各关节各自对应的角速度,J是机器人的质心相对于各关节的雅克比矩阵,/>表示机器人的质心速度,质心竖直方向速度为/>的竖直方向分量。
其中,按照质心规划的位置(comp)、速度(comv)和加速度(coma),通过逆动力学(Inverse Dynamics)和逆运动学(Inverse Kinematics),计算得到各关节电机的指令,然后进一步得到机器人关节各自对应的角速度Θ。
在一个实施例中,状态信息包括状态名称、规划进入标志位、实际进入标志位、状态持续标志位以及状态结束与跳转标志位,步骤S130包括:
当状态检测结果为机器人处于加速相对应的状态持续阶段时,当且仅当将对应的状态持续标志位置为有效。
其中,在机器人处于所述加速相对应的状态持续阶段时,将规划进入标志位、实际进入标志位以及状态结束与跳转标志位均置为无效(清零),当且仅当将对应的状态持续标志位置为有效。
当状态检测结果为机器人进入加速相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期机器人进入腾空相的规划进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置为有效。
其中,状态结束与跳转阶段结束后,机器人在下一控制周期内进入腾空相的规划进入阶段,此时需要将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置为有效。
当状态检测结果为机器人进入腾空相的实际进入阶段时,将对应的规划进入标志位置为无效,并将对应的实际进入标志位置为有效,并在下一控制周期机器人处于腾空相的状态持续阶段时,将对应的实际进入标志位置为无效。
其中,在腾空相的实际进入阶段结束后,需要将实际进入标志置为无效,机器人进而在下一控制周期处于腾空相的状态持续阶段时,当且仅当将状态持续标志置为有效。
当状态检测结果为机器人进入腾空相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期机器人进入减速相的规划进入阶段和实际进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置和实际进入标志位置为有效,并在机器人处于减速相的状态持续阶段时,将对应的规划进入标志位置和实际进入标志位置为无效,且将对应的状态持续标志位置为有效。
当状态检测结果为机器人进入减速相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期机器人进入加速相的规划进入阶段和实际进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置和实际进入标志位置为有效。
在一个实施例中,步骤S140包括:
当更新后的规划进入标志位有效时,结合更新后的状态名称,控制机器人进入对应的规划进入阶段,重置计时器,并生成初始质心规划轨迹。
其中,机器人实时获取更新后的状态信息,当获取到更新后的规划进入标志位有效时,需要结合更新后的状态名称,控制机器人进入对应的规划进入阶段,重置计时器,并生成初始质心规划轨迹。
当对应的规划进入阶段结束后,将对应的规划进入标志置为无效。
当更新后的实际进入标志位有效时,结合更新后的状态名称,控制机器人进入对应的实际进入阶段,计算并记录机器人对应的运动参数信息。
其中,当控制机器人进入对应的实际进入阶段时,计算并记录机器人对应的运动参数信息,在控制机器人进入对应的实际进入阶段结束后,需要进一步将该实际进入标志位清零。
上述运动参数信息通常包括机器人进入对应的实际进入阶段时对应的质心高度信息以及质心速度信息。
当更新后的状态持续标志位有效时,结合更新后的状态名称,控制机器人进入对应的状态持续阶段,根据初始质心规划轨迹和运动参数信息进行质心轨迹规划和质心速度控制。
其中,当腾空相更新后的状态持续标志位有效时,结合更新后的状态名称,控制机器人进入对应的状态持续阶段,机器人进入腾空相的状态持续阶段,此时可根据初始质心规划轨迹和运动参数信息进行腾空相的质心轨迹规划和质心速度控制。
当更新后的状态结束与跳转标志位有效时,结合更新后的状态名称,控制机器人进入对应的状态结束与跳转阶段。
此外,如图6所示,还提供一种机器人的有限状态机200,应用于机器人的连续跳跃模型,连续跳跃模型中机器人状态包括加速相、腾空相和减速相,有限状态机200包括状态划分单元210、事件检测单元220、状态变更单元230和行为处理单元240,机器人的有限状态机200包括:
状态划分单元210用于将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,加速相和减速相各自的规划进入阶段与对应的实际进入阶段分别相重合;
事件检测单元220用于对机器人在加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果;
状态变更单元230用于根据状态检测结果,更新机器人对应的状态信息;
行为处理单元240用于根据更新后的状态信息,控制机器人在加速相、腾空相和减速相中各个不同的阶段进行切换以控制机器人进行连续跳跃。
此外,还提供一种机器人,包括存储器以及处理器,存储器用于存储计算机程序,处理器运行计算机程序以使机器人执行上述建立方法。
此外,还提供一种可读存储介质,可读存储介质存储有计算机程序,计算机程序在被处理器运行时执行上述建立方法。
在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,附图中的流程图和结构图显示了根据本发明的多个实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在作为替换的实现方式中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,结构图和/或流程图中的每个方框、以及结构图和/或流程图中的方框的组合,可以用执行规定的功能或动作的专用的基于硬件的***来实现,或者可以用专用硬件与计算机指令的组合来实现。
另外,在本发明各个实施例中的各功能模块或单元可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或更多个模块集成形成一个独立的部分。
所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是智能手机、个人计算机、服务器、或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。
Claims (10)
1.一种机器人的有限状态机的建立方法,其特征在于,应用于机器人的连续跳跃模型,所述连续跳跃模型中机器人状态包括加速相、腾空相和减速相,所述建立方法包括:
将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,所述加速相和所述减速相各自的规划进入阶段与对应的实际进入阶段分别相重合;
对所述机器人在所述加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果;
根据所述状态检测结果,更新所述机器人对应的状态信息;
根据更新后的状态信息,控制所述机器人在所述加速相、腾空相和减速相中各个不同的阶段进行切换以控制所述机器人进行连续跳跃;
根据质心加速度规划轨迹获取所述机器人从所述加速相进入所述腾空相的规划切换时刻并判断所述规划切换时刻是否到来,当所述规划切换时刻到来时,判断所述机器人进入所述加速相的状态结束与跳转阶段,并在下一控制周期进入所述腾空相的规划进入阶段;
计算机器人足底与地面之间的竖直方向作用力并获取对应的作用力变化方向,判断所述竖直方向作用力是否小于或等于第一预设作用力阈值;
当所述作用力变化方向为逐渐变小且所述竖直方向作用力小于或等于所述第一预设作用力阈值时,判断所述机器人进入所述腾空相的实际进入阶段,并在下一控制周期处于所述腾空相中的状态持续阶段;
当所述竖直方向作用力小于或等于所述第一预设作用力阈值且保持不变时时,判断所述机器人处于所述腾空相中的状态持续阶段;
当所述作用力变化方向为逐渐变大且所述竖直方向作用力大于或等于第二预设作用力阈值时,判断所述机器人进入所述腾空相的状态结束与跳转阶段,并在下一控制周期进入所述减速相的规划进入阶段和实际进入阶段;
当所述质心竖直方向速度的方向向下、对应的质心竖直方向速度变化方向向上且所述质心竖直方向速度大于所述预设速度阈值时,判断所述机器人处于所述减速相中的状态持续阶段;
当所述质心竖直方向速度的方向向下直至所述质心竖直方向速度小于或等于所述预设速度阈值时,判断所述机器人进入所述减速相中的状态结束与跳转阶段,并在下一控制周期进入所述加速相的规划进入阶段和实际进入阶段。
2.根据权利要求1所述的建立方法,其特征在于,所述对所述机器人在所述加速相、腾空相和减速相之间进行的循环状态切换进行检测,得到对应的状态检测结果的步骤包括:
计算所述机器人的质心竖直方向速度并获取对应的速度方向和速度变化方向,判断所述质心竖直方向速度的大小是否大于预设速度阈值;
当所述质心竖直方向速度大于所述预设速度阈值且所述速度方向和对应的速度变化方向向上时,判断所述机器人处于所述加速相中的状态持续阶段。
3.根据权利要求2所述的建立方法,其特征在于,所述机器人足底设置有压力传感器,所述计算所述机器人足底与地面之间的竖直方向作用力的步骤中对应的计算公式为:
其中,Rfoot是所述机器人足底的姿态矩阵,是压力传感器测量值,/>表示所述竖直方向作用力。
4.根据权利要求2所述的建立方法,其特征在于,所述机器人的各关节末端设置有转矩传感器,所述计算所述机器人足底与地面之间的竖直方向作用力的步骤中对应的计算公式为:
其中,JT是所述机器人的质心相对于各关节的雅克比矩阵的转置矩阵,是利用所述转矩传感器得到的所述机器人的各关节受力矩组成的列向量,/>表示所述竖直方向作用力。
5.根据权利要求2所述的建立方法,其特征在于,所述计算所述机器人的质心竖直方向速度的步骤中对应的计算公式为:
其中,为所述机器人各关节各自对应的角速度,J是所述机器人的质心相对于各关节的雅克比矩阵,/>表示所述机器人的质心速度,所述质心竖直方向速度为/>的竖直方向分量。
6.根据权利要求2所述的建立方法,其特征在于,所述状态信息包括状态名称、规划进入标志位、实际进入标志位、状态持续标志位以及状态结束与跳转标志位,所述根据所述状态检测结果,更新所述机器人对应的状态信息的步骤包括:
当所述状态检测结果为所述机器人处于所述加速相对应的状态持续阶段时,当且仅当将对应的状态持续标志位置为有效;
当所述状态检测结果为所述机器人进入所述加速相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期所述机器人进入所述腾空相的规划进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置为有效;
当所述状态检测结果为所述机器人进入所述腾空相的实际进入阶段时,将对应的规划进入标志位置为无效,并将对应的实际进入标志位置为有效,并在下一控制周期所述机器人处于所述腾空相的状态持续阶段时,将对应的实际进入标志位置为无效;
当所述状态检测结果为所述机器人进入所述腾空相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期所述机器人进入所述减速相的规划进入阶段和实际进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置和实际进入标志位置为有效,并在所述机器人处于所述减速相的状态持续阶段时,将对应的规划进入标志位置和实际进入标志位置为无效,且将对应的状态持续标志位置为有效;
当所述状态检测结果为所述机器人进入所述减速相的状态结束与跳转阶段时,将对应的状态结束与跳转标志位置为有效,并在下一控制周期所述机器人进入所述加速相的规划进入阶段和实际进入阶段时,将对应的状态结束与跳转标志位置为无效,并将对应的规划进入标志位置和实际进入标志位置为有效。
7.根据权利要求1所述的建立方法,其特征在于,所述根据更新后的状态信息,控制所述机器人在所述加速相、腾空相和减速相中各个不同的阶段进行切换的步骤包括:
当更新后的规划进入标志位有效时,结合更新后的状态名称,控制所述机器人进入对应的规划进入阶段,重置计时器,并生成初始质心规划轨迹;
当更新后的实际进入标志位有效时,结合更新后的状态名称,控制所述机器人进入对应的实际进入阶段,计算并记录所述机器人对应的运动参数信息;
当更新后的状态持续标志位有效时,结合更新后的状态名称,控制所述机器人进入对应的状态持续阶段,根据所述初始质心规划轨迹和所述运动参数信息进行质心轨迹规划和质心速度控制;
当更新后的状态结束与跳转标志位有效时,结合更新后的状态名称,控制所述机器人进入对应的状态结束与跳转阶段。
8.一种机器人的有限状态机,其特征在于,应用于机器人的连续跳跃模型,所述连续跳跃模型中机器人状态包括加速相、腾空相和减速相,所述有限状态机包括状态划分单元、事件检测单元、状态变更单元和行为处理单元,所述有限状态机包括:
状态划分单元,用于将每种机器人状态分别划分为规划进入阶段、实际进入阶段、状态持续阶段以及状态结束与跳转阶段;其中,所述加速相和所述减速相各自的规划进入阶段与对应的实际进入阶段分别相重合;
事件检测单元,用于对所述机器人在所述加速相、腾空相和减速相中各个不同阶段之间进行的状态切换进行检测,得到对应的状态检测结果;
状态变更单元,用于根据所述状态检测结果,更新所述机器人对应的状态信息;
行为处理单元,用于根据更新后的状态信息,控制所述机器人在所述加速相、腾空相和减速相中各个不同的阶段进行切换以控制所述机器人进行连续跳跃;
根据质心加速度规划轨迹获取所述机器人从所述加速相进入所述腾空相的规划切换时刻并判断所述规划切换时刻是否到来,当所述规划切换时刻到来时,判断所述机器人进入所述加速相的状态结束与跳转阶段,并在下一控制周期进入所述腾空相的规划进入阶段;
计算机器人足底与地面之间的竖直方向作用力并获取对应的作用力变化方向,判断所述竖直方向作用力是否小于或等于第一预设作用力阈值;
当所述作用力变化方向为逐渐变小且所述竖直方向作用力小于或等于所述第一预设作用力阈值时,判断所述机器人进入所述腾空相的实际进入阶段,并在下一控制周期处于所述腾空相中的状态持续阶段;
当所述竖直方向作用力小于或等于所述第一预设作用力阈值且保持不变时时,判断所述机器人处于所述腾空相中的状态持续阶段;
当所述作用力变化方向为逐渐变大且所述竖直方向作用力大于或等于第二预设作用力阈值时,判断所述机器人进入所述腾空相的状态结束与跳转阶段,并在下一控制周期进入所述减速相的规划进入阶段和实际进入阶段;
当所述质心竖直方向速度的方向向下、对应的质心竖直方向速度变化方向向上且所述质心竖直方向速度大于所述预设速度阈值时,判断所述机器人处于所述减速相中的状态持续阶段;
当所述质心竖直方向速度的方向向下直至所述质心竖直方向速度小于或等于所述预设速度阈值时,判断所述机器人进入所述减速相中的状态结束与跳转阶段,并在下一控制周期进入所述加速相的规划进入阶段和实际进入阶段。
9.一种机器人,其特征在于,包括存储器以及处理器,所述存储器用于存储计算机程序,所述处理器运行所述计算机程序以使所述机器人执行权利要求1至7中任一项所述的建立方法。
10.一种可读存储介质,其特征在于,所述可读存储介质存储有计算机程序,所述计算机程序在被处理器运行时执行权利要求1至7中任一项所述的建立方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010073668.4A CN113156926B (zh) | 2020-01-22 | 2020-01-22 | 机器人的有限状态机的建立方法、有限状态机和机器人 |
US17/092,347 US20210221455A1 (en) | 2020-01-22 | 2020-11-09 | Legged robot continuous hopping control method and legged robot and computer readable storage medium using the same |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010073668.4A CN113156926B (zh) | 2020-01-22 | 2020-01-22 | 机器人的有限状态机的建立方法、有限状态机和机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113156926A CN113156926A (zh) | 2021-07-23 |
CN113156926B true CN113156926B (zh) | 2024-05-17 |
Family
ID=76857568
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010073668.4A Active CN113156926B (zh) | 2020-01-22 | 2020-01-22 | 机器人的有限状态机的建立方法、有限状态机和机器人 |
Country Status (2)
Country | Link |
---|---|
US (1) | US20210221455A1 (zh) |
CN (1) | CN113156926B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114253260B (zh) * | 2021-12-08 | 2023-08-18 | 深圳市优必选科技股份有限公司 | 机器人步态规划方法及装置、运动规划设备和存储介质 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101525011A (zh) * | 2008-03-04 | 2009-09-09 | 王慧娟 | 一种跳跃机器人及采用惯性匹配的运动优化方法 |
CN103257652A (zh) * | 2012-02-21 | 2013-08-21 | 三星电子株式会社 | 步行机器人及其控制方法 |
CN106168790A (zh) * | 2016-02-29 | 2016-11-30 | 华南理工大学 | 一种在线改变目标速度和位置的s形加减速控制方法 |
CN107179683A (zh) * | 2017-04-01 | 2017-09-19 | 浙江工业大学 | 一种基于神经网络的交互机器人智能运动检测与控制方法 |
KR101814513B1 (ko) * | 2017-07-21 | 2018-01-04 | 차성환 | 세대원 모니터링 시스템 |
CN109885080A (zh) * | 2013-11-27 | 2019-06-14 | 宾夕法尼亚大学理事会 | 自主控制***及自主控制方法 |
CN110281228A (zh) * | 2019-06-28 | 2019-09-27 | 北京理工大学 | 一种仿人机器人越过垂直壁障的规划控制方法 |
CN110315543A (zh) * | 2019-07-29 | 2019-10-11 | 北京理工大学 | 一种双足机器人步态生成与优化方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3682525B2 (ja) * | 2001-06-07 | 2005-08-10 | 独立行政法人科学技術振興機構 | 二脚歩行式人型ロボット |
JP4548135B2 (ja) * | 2005-02-03 | 2010-09-22 | トヨタ自動車株式会社 | 脚式ロボットとその制御方法 |
KR20100078248A (ko) * | 2008-12-30 | 2010-07-08 | 삼성전자주식회사 | 보행 로봇 및 그 제어방법 |
KR101633362B1 (ko) * | 2010-01-18 | 2016-06-28 | 삼성전자 주식회사 | 인간형 로봇 및 그 보행 제어방법 |
KR101953113B1 (ko) * | 2011-05-30 | 2019-03-05 | 삼성전자주식회사 | 로봇 및 그 제어방법 |
KR102115950B1 (ko) * | 2013-11-07 | 2020-06-05 | 삼성전자주식회사 | 보행 보조 로봇 및 보행 보조 로봇의 제어 방법 |
-
2020
- 2020-01-22 CN CN202010073668.4A patent/CN113156926B/zh active Active
- 2020-11-09 US US17/092,347 patent/US20210221455A1/en not_active Abandoned
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101525011A (zh) * | 2008-03-04 | 2009-09-09 | 王慧娟 | 一种跳跃机器人及采用惯性匹配的运动优化方法 |
CN103257652A (zh) * | 2012-02-21 | 2013-08-21 | 三星电子株式会社 | 步行机器人及其控制方法 |
CN109885080A (zh) * | 2013-11-27 | 2019-06-14 | 宾夕法尼亚大学理事会 | 自主控制***及自主控制方法 |
CN106168790A (zh) * | 2016-02-29 | 2016-11-30 | 华南理工大学 | 一种在线改变目标速度和位置的s形加减速控制方法 |
CN107179683A (zh) * | 2017-04-01 | 2017-09-19 | 浙江工业大学 | 一种基于神经网络的交互机器人智能运动检测与控制方法 |
KR101814513B1 (ko) * | 2017-07-21 | 2018-01-04 | 차성환 | 세대원 모니터링 시스템 |
CN110281228A (zh) * | 2019-06-28 | 2019-09-27 | 北京理工大学 | 一种仿人机器人越过垂直壁障的规划控制方法 |
CN110315543A (zh) * | 2019-07-29 | 2019-10-11 | 北京理工大学 | 一种双足机器人步态生成与优化方法 |
Non-Patent Citations (5)
Title |
---|
《A probabilistic finite state machine based strategy for multi-target search using swarm robotics》;Jie Li 等;《Applied Soft Computing Journal》;第1-17页 * |
《Delta 机器人控制***研究》;董浩 等;《天津科技》;第44卷(第1期);第1-4页 * |
《Interact with Robot: An Efficient Approach based on Finite State Machine and Mouse Gesture Recognition》;Jiajun Li 等;《IEEE》 * |
《单足弹跳机器人联合仿真教学实践》;李瑞 等;《计算机教育》(第8期);第1-6页 * |
《基于动量控制的猎豹机器人疾驰步态分析》.《机械设计与研究》.2018,第1-6页. * |
Also Published As
Publication number | Publication date |
---|---|
US20210221455A1 (en) | 2021-07-22 |
CN113156926A (zh) | 2021-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11242219B2 (en) | Story monitoring method when robot takes elevator, electronic device, and computer storage medium | |
KR102387378B1 (ko) | 보행 동작 인식을 위한 장치 및 방법 | |
US8634959B2 (en) | Apparatus and method detecting a robot slip | |
WO2019142563A1 (ja) | 電子制御装置 | |
CN113156926B (zh) | 机器人的有限状态机的建立方法、有限状态机和机器人 | |
JP2010534881A5 (zh) | ||
US11110911B2 (en) | Measurement device, measurement system, and measurement method | |
CN107607743B (zh) | 一种加速度校正方法及终端和相关介质产品 | |
WO2015169856A1 (en) | Selecting objects on a user interface | |
CN114310895B (zh) | 机器人碰撞检测方法、装置、电子设备及存储介质 | |
CN113498505A (zh) | 通过预测传感器数据对被跟踪对象的姿态建模 | |
JP2009285816A (ja) | 脚式ロボット及びその制御方法 | |
CN111669097A (zh) | 负载转动惯量辨识方法及*** | |
US11085801B2 (en) | Physical quantity measuring apparatus | |
CN108120450B (zh) | 一种静止状态的判断方法及装置 | |
CN116238479A (zh) | 车辆漂移控制方法、装置、设备及存储介质 | |
US20220129013A1 (en) | Robot and method for controlling same | |
JP7279669B2 (ja) | 移動量推定装置、モデル生成装置、移動量推定方法及びプログラム | |
JP5416896B2 (ja) | 体動検出装置 | |
CN112476428A (zh) | 机器人控制装置 | |
CN111854792B (zh) | 一种双足机器人的偏移预警方法、装置及双足机器人 | |
JP2021129389A (ja) | 制御装置、及び、断線検出方法 | |
JPH06307898A (ja) | 検出器の異常監視装置 | |
CN116674594B (zh) | 一种基于路径规划的纵向控制方法及装置 | |
JP7193206B2 (ja) | 直接教示装置及び直接教示方法 |
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 | ||
CB03 | Change of inventor or designer information | ||
CB03 | Change of inventor or designer information |
Inventor after: Wang Yuesong Inventor after: Dong Hao Inventor after: Yang Guoping Inventor after: Xiong Youjun Inventor before: Wang Yuesong Inventor before: Dong Hao Inventor before: Yang Guoping Inventor before: Zhao Mingguo Inventor before: Xiong Youjun |
|
GR01 | Patent grant | ||
GR01 | Patent grant |