CN112947428B - 一种四足机器人的移动控制方法及装置 - Google Patents
一种四足机器人的移动控制方法及装置 Download PDFInfo
- Publication number
- CN112947428B CN112947428B CN202110143439.XA CN202110143439A CN112947428B CN 112947428 B CN112947428 B CN 112947428B CN 202110143439 A CN202110143439 A CN 202110143439A CN 112947428 B CN112947428 B CN 112947428B
- Authority
- CN
- China
- Prior art keywords
- foot
- robot
- gait
- movement control
- swing gait
- 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 67
- 238000000034 method Methods 0.000 title claims abstract description 45
- 230000005021 gait Effects 0.000 claims abstract description 117
- 238000003062 neural network model Methods 0.000 claims abstract description 23
- 238000012545 processing Methods 0.000 claims description 10
- 230000004044 response Effects 0.000 claims description 9
- 230000008569 process Effects 0.000 abstract description 10
- 238000012827 research and development Methods 0.000 abstract description 7
- 238000010586 diagram Methods 0.000 description 14
- 238000004891 communication Methods 0.000 description 5
- 210000001364 upper extremity Anatomy 0.000 description 5
- 238000012549 training Methods 0.000 description 4
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 210000002569 neuron Anatomy 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 210000001503 joint Anatomy 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001537 neural effect Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- 230000002618 waking effect Effects 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/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
-
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (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
技术领域
本发明涉及机器人控制技术技域，尤其涉及一种四足机器人的移动控制方法及装置。
背景技术
现阶段的四足机器人针对复杂地形下的移动控制，主要是基于人工搭建的视觉传感器，如摄像头和激光雷达实现。具体实现时，首先利用驱动传感器获取外景环境信息，包括图像信息和点云信息等，然后对外景环境信息进行滤波处理及符合图像特征提取的特殊处理，如图片灰度化和图像二值化等，得到有效信息，在经过复杂的算法匹配，最终得到四足机器人行进路面的信息，然后才能制定四足机器人在不同地形下的移动控制策略。这种四足机器人的移动控制方法容易受外界环境影响，且算法复杂，导致研发控制系统所投入的时间精力较大。
因此，提出一种可以降低研发难度，稳定性强的四足机器人的全地形移动控制方法，具有十分重要的意义。
发明内容
本发明提供了一种四足机器人的移动控制方法及装置，用于降低四足机器人的移动控制方法的研发难度，提升移动控制过程的稳定性。
第一方面，本发明提供的一种四足机器人的移动控制方法，包括：
响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置；
将所述当前坐标位置和所述当前四元数输入预先训练的神经网络模型，得到地形预测结果；
根据所述地形预测结果，确定目标摆动步态；
基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；
依据所述状态轨迹，对所述四足机器人进行移动控制。
可选地，所述四足机器人安装有惯性传感器和电机带位置编码器；响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置，包括：
响应所述四足机器人的四足触地操作，通过惯性传感器获取所述当前四元数；
以及，
利用正运动学定理分别计算所述电机带位置编码器反馈的所述四组机器人的足端反馈角度，得到所述四个足端的当前坐标位置。
可选地，摆动步态包括：单足摆动步态和双足摆动步态；根据所述地形预测结果，确定目标摆动步态，包括：
判断所述地形预测结果是否为上坡地形；
若是，则选择所述单足摆动步态为所述目标摆动步态；
若否，则选择所述双足摆动步态为所述目标摆动步态。
可选地，基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹，包括：
基于所述目标摆动步态，结合ZMP稳定性判据，确定所述目标摆动步态对应的约束条件；
基于所述地形预测结果及所述目标摆动步态及对应的约束条件，确定所述四足机器人的状态轨迹。
可选地，依据所述状态轨迹，对所述四足机器人进行移动控制，包括：
对所述状态轨迹中的状态量进行线性化处理，得到线性状态量；
依据所述线性状态量，对所述四足机器人进行移动控制。
第二方面，本发明还公开了一种四足机器人的移动控制装置，包括：
响应模块，用于响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置；
输入模块，用于将所述当前坐标位置和所述当前四元数输入预先训练的神经网络模型，得到地形预测结果；
步态确定模块，用于根据所述地形预测结果，确定目标摆动步态；
状态轨迹确定模块，用于基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；
移动控制模块，用于依据所述状态轨迹，对所述四足机器人进行移动控制。
可选地，所述四足机器人安装有惯性传感器和电机带位置编码器；所述响应模块包括：
响应子模块，用于响应所述四足机器人的四足触地操作，通过惯性传感器获取所述当前四元数；
以及，
利用正运动学定理分别计算所述电机带位置编码器反馈的所述四组机器人的足端反馈角度，得到所述四个足端的当前坐标位置。
可选地，摆动步态包括：单足摆动步态和双足摆动步态；所述步态确定模块包括：
判断子模块，用于判断所述地形预测结果是否为上坡地形；若是，则选择所述单足摆动步态为所述目标摆动步态；
若否，则选择所述双足摆动步态为所述目标摆动步态。
可选地，所述状态轨迹确定模块包括：
约束条件确定子模块，用于基于所述目标摆动步态，结合ZMP稳定性判据，确定所述目标摆动步态对应的约束条件；
状态轨迹确定子模块，用于基于所述地形预测结果及所述目标摆动步态及对应的约束条件，确定所述四足机器人的状态轨迹。
可选地，所述移动控制模块包括：
线性处理子模块，用于对所述状态轨迹中的状态量进行线性化处理，得到线性状态量；
移动控制子模块，用于依据所述线性状态量，对所述四足机器人进行移动控制。
从以上技术方案可以看出，本发明具有以下优点：
本发明通过响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置；将所述当前坐标位置和所述当前四元数输入预先训练的神经网络模型，得到地形预测结果；根据所述地形预测结果，确定目标摆动步态；基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；依据所述状态轨迹，对所述四足机器人进行移动控制。通过预先训练好的神经网络模型，实时得到四足机器人的地形预测结果，从而可以根据地形预测结果制定四足机器人的状态轨迹，简化对四足机器人控制的复杂性，进而减小控制系统研发所投入的时间，并可以提升移动过程的稳定性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其它的附图；
图1为本发明的一种四足机器人的移动控制方法实施例一的步骤流程图；
图2为本发明的一种四足机器人的移动控制方法实施例二的步骤流程图；
图3为本发明的一种神经网络模型示意图；
图4为本发明的一种四足机器人的移动控制方法实施例二中的单足摆动步态在四足触地时的步态示意图；
图5为本发明的一种四足机器人的移动控制方法实施例二中的双足摆动步态在四足触地时的步态示意图；
图6为本发明的一种四足机器人的移动控制装置实施例的结构框图。
具体实施方式
本发明实施例提供了一种四足机器人的移动控制方法及装置，用于降低四足机器人的移动控制方法的研发难度，提升移动控制过程的稳定性。
为使得本发明的发明目的、特征、优点能够更加的明显和易懂，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，下面所描述的实施例仅仅是本发明一部分实施例，而非全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。
请参阅图1，图1为本发明的一种四足机器人的移动控制方法实施例一的步骤流程图，具体可以包括如下步骤：
步骤S101，响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置；
步骤S102，将所述当前坐标位置和所述当前四元数输入预先训练的神经网络模型，得到地形预测结果；
步骤S103，根据所述地形预测结果，确定目标摆动步态；
步骤S104，基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；
步骤S105，依据所述状态轨迹，对所述四足机器人进行移动控制。
在本发明实施例中，通过响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置；将所述当前坐标位置和所述当前四元数输入预先训练的神经网络模型，得到地形预测结果；根据所述地形预测结果，确定目标摆动步态；基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；依据所述状态轨迹，对所述四足机器人进行移动控制。通过预先训练好的神经网络模型，实时得到四足机器人的地形预测结果，从而可以根据地形预测结果制定四足机器人的状态轨迹，简化对四足机器人控制的复杂性，进而减小控制系统研发所投入的时间，并可以提升移动过程的稳定性。
请参阅图2，为本发明的一种四足机器人的移动控制方法实施例二的步骤流程图，具体包括：
步骤S201，响应所述四足机器人的四足触地操作，通过惯性传感器获取四足机器人的当前四元数；
以及，
利用正运动学定理分别计算所述电机带位置编码器反馈的所述四组机器人的足端反馈角度，得到所述四个足端的当前坐标位置；
需要说明的是，惯性传感器(Inertial Measurement Unit，IMU)，主要用于测量加速度与旋转运动的传感器；位置传感器，用于测量机器人自身位置的传感器。位置传感器可分为两种，接触式传感器和接近式传感器；四元数用于快速、准确地表示四足机器人当前的姿态及旋转状态，具体地，四元数是IMU直接输出的原始数据，而对于四足机器人当前的姿态及旋转状态的获取，则需要对四元数进行解析，从而得到四足机器人当前的姿态角度，如：俯仰角度、偏航角度和翻滚角度等。
在本发明实施例中，预先设定一种机制：当四足机器人的状态四足触地时，唤醒四足机器人配置的端对端系统，端对端系统中配置有预先训练的神经网络模型，当端对端系统被唤醒后，会利用IMU，通过串口通讯的方法进行数据传输，获取四足机器人的当前位置的四元数，或者获取四足机器人当前位置的姿态角，如仰俯角、翻滚角和偏航角等；同时利用电机带位置编码器，通过SPI通讯或I2C通讯的方式进行数据的传输，利用正运动学定理分别计算所述电机带位置编码器反馈的所述四组机器人的足端反馈角度，得到所述四个足端的当前坐标位置。
在具体实现中，IMU可以安装在四足机器人上的任意地方，而电机带位置编码器一般在电机上，如果电机上没有位置传感器，则在四足机器人的每一个电机位置进行安装，具体地，本发明实施例提及的电机用到的是半直驱的电机，能够实时反馈电机实际转动角度，从而地形预测器可直接使用电机实际转动角度作为传入数据，同时考虑到算法的通用性，不同机械结构的机器人均可使用，因此还要考虑腿部关节长度，再通过运用机器人正运动学就可以计算出足端相对于机器人自身坐标系下的坐标信息。
步骤S202，将所述当前坐标位置和所述当前四元数输入预先训练的神经网络模型，得到地形预测结果；
请参阅图3，图3为本发明的一种神经网络模型示意图，也可以理解为是一个端对端系统，即只需要将现有数据输入，从而通过该端对端系统即可获得输出结果，图中包括多个以空心圆代表的神经元，以及由神经元构成的神经网络模型的层级，其中，图中最左层为输入层，图中最右层输出层，中间三层为隐藏层，由于本发明实施例存在16个传感器数据，因此在输入层设置有16个神经元，而由于本发明实施例中归纳了6种地形，因此输出层设置有6个神经元。
在本发明实施例中，预先收集四足机器人移动时，在四足触地情况下的坐标信息和四元数，并对其进行标记，得到地形标签，从而形成数据集。在训练神经网络模型时，从数据集中获取地形训练样本，所述地形训练样本包括由四元数和坐标信息组成的地形数据及对应的地形样本，将所述地形数据输入所述神经网络模型，生成地形样本的类别，根据地形样本的类别和地形标签，确定训练误差；基于所述训练误差所述而网络神经模型进行调整，以得到最优网络参数，并采用所述最优网络参数生成训练好的神经网络模型。
本发明实施例通过训练好的神经网络模型实时预测地形，可以避免复杂算法，从而摆脱用于搭载复杂算法的硬件设备，进而大大降低了四足机器人的移动控制成本。
步骤S203，根据所述地形预测结果，确定目标摆动步态；
在一个可选实施例中，摆动步态包括：单足摆动步态和双足摆动步态；根据所述地形预测结果，确定目标摆动步态，包括：
判断所述地形预测结果是否为上坡地形；
若是，则选择所述单足摆动步态为所述目标摆动步态；
若否，则选择所述双足摆动步态为所述目标摆动步态。
请参阅图4，图4为本发明的一种四足机器人的移动控制方法实施例二中的单足摆动步态在四足触地时的步态示意图，其中，白色部分表示摆动相，深色部分表示支撑相，其中，四个步态示意图依次为FR、FL、HR、HL在同一时刻的步态示意图，FR表示右前腿、FL表示左前腿、HR表示右后腿、HL表示左后腿，使用单足摆动步态的情况下，存在8找那个状态，分别是FR摆动、四足触地、FL摆动、四足触地、HR摆动、四足触地、HL摆动、四足触地，对于每次摆动腿触地时，当出现四足同时触地时，假如是右前腿摆动，则生成的如图4所示的步态示意图；请参阅图5，图5为本发明的一种四足机器人的移动控制方法实施例二中的双足摆动步态在四足触地时的步态示意图，其中，白色部分表示摆动相，深色部分表示支撑相，其中，四个步态示意图依次为FR、FL、HR、HL在同一时刻的步态示意图，FR表示右前腿、FL表示左前腿、HR表示右后腿、HL表示左后腿，使用双足摆动步态的情况下，足部移动的顺序是FR和HL，以及FL和HR，在一组腿经过摆动触地后，中间会间隔一个四足均触地时刻，若是FR和HL摆动后触地，则生成如图5所示的步态示意图。
在实际应用中，单足摆动步态主要应用于崎岖地形，而双足摆动步态主要应用于上坡地形。由于上坡过程四足机器人假如使用单足摆动步态爬坡，其移动速度会严重减少，而双足摆动步态相比于单足摆动步态，在上坡过程更容易克服坡度对移动速度的影响。
步骤S204，基于所述目标摆动步态，结合ZMP稳定性判据，确定所述目标摆动步态对应的约束条件；
需要说明的是，ZMP(零力矩点)稳定性判据用于分析ZMP和COP(压力中心)的相互关系，确定研究对象在移动过程的稳定性。
在本发明实施例中，根据ZMP稳定判断规划CoM坐标信息，当选择单足摆动步态作为目标摆动步态，则约束条件为CoM的X坐标和Y坐标规划时，要以三触地足所形成的多边形区域为约束条件；而当选择双足摆动步态作为目标摆动步态时，约束条件为两触地足之间的对角线作为约束条件。
步骤S205，基于所述目标摆动步态及对应的约束条件，确定所述四足机器人的状态轨迹；
步骤S206，对所述状态轨迹中的状态量进行线性化处理，得到线性状态量；
步骤S207，依据所述线性状态量，对所述四足机器人进行移动控制。
在具体实现中，对于步骤S205得到的状态轨迹，状态轨迹中的状态量如角度和角速度等，需要做线性化处理，得到线性状态量，并依据线性状态量及目标摆动步态对四足机器人进行移动控制。
在本发明实施例所提供的一种四足机器人的移动控制方法，通过响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置；将所述当前坐标位置和所述当前四元数输入预先训练的目标神经网络模型，得到地形预测结果；根据所述地形预测结果，确定目标摆动步态；基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；依据所述状态轨迹，对所述四足机器人进行移动控制。通过预先训练好的目标神经网络模型，实时得到四足机器人的地形预测结果，从而可以根据地形预测结果制定四足机器人的状态轨迹，简化对四足机器人控制的复杂性，进而减小控制系统研发所投入的时间，并可以提升移动过程的稳定性。
请参阅图6，示出了一种四足机器人的移动控制装置实施例的结构框图，包括如下模块：
响应模块101，用于响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四组机器人的四个足端的当前坐标位置；
输入模块102，用于将所述当前坐标位置和所述当前四元数输入预先训练的神经网络模型，得到地形预测结果；
步态确定模块103，用于根据所述地形预测结果，确定目标摆动步态；
状态轨迹确定模块104，用于基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；
移动控制模块105，用于依据所述状态轨迹，对所述四足机器人进行移动控制。
在一个可选实施例中，所述四足机器人安装有惯性传感器和位置传感器；所述响应模块101包括：
响应子模块，用于响应所述四足机器人的四足触地操作，通过惯性传感器获取所述当前四元数，以及通过位置传感器获取所述当前坐标位置。
在一个可选实施例中，摆动步态包括：单足摆动步态和双足摆动步态；所述步态确定模块103包括：
判断子模块，用于判断所述地形预测结果是否为上坡地形；若是，则选择所述单足摆动步态为所述目标摆动步态；
若否，则选择所述双足摆动步态为所述目标摆动步态。
在一个可选实施例中，所述状态轨迹确定模块104包括：
约束条件确定子模块，用于基于所述目标摆动步态，结合ZMP稳定性判据，确定所述目标摆动步态对应的约束条件；
状态轨迹确定子模块，用于基于所述地形预测结果及所述目标摆动步态及对应的约束条件，确定所述四足机器人的状态轨迹。
在一个可选实施例中，所述移动控制模块105包括：
线性处理子模块，用于对所述状态轨迹中的状态量进行线性化处理，得到线性状态量；
移动控制子模块，用于依据所述线性状态量，对所述四足机器人进行移动控制。
所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，上述描述的装置的具体工作过程，可以参考前述方法实施例中的对应过程，在此不再赘述。
在本发明所提供的几个实施例中，应该理解到，所揭露的装置和方法，可以通过其它的方式实现。例如，以上所描述的装置实施例仅仅是示意性的，例如，所述单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，例如多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口，装置或单元的间接耦合或通信连接，可以是电性，机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外，在本发明各个实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现，也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(ROM，Read-OnlyMemory)、随机存取存储器(RAM，Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述，以上实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (8)
1.一种四足机器人的移动控制方法，其特征在于，包括：
响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四足机器人的四个足端的当前坐标位置；
将所述当前坐标位置和当前所述四元数输入预先训练的神经网络模型，得到地形预测结果；
根据所述地形预测结果，确定目标摆动步态；
基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；
依据所述状态轨迹，对所述四足机器人进行移动控制；
摆动步态包括：单足摆动步态和双足摆动步态；根据所述地形预测结果，确定目标摆动步态，包括：
判断所述地形预测结果是否为上坡地形；
若是，则选择所述单足摆动步态为所述目标摆动步态；
若否，则选择所述双足摆动步态为所述目标摆动步态。
2.根据权利要求1所述的四足机器人的移动控制方法，其特征在于，所述四足机器人安装有惯性传感器和电机带位置编码器；响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四足机器人的四个足端的当前坐标位置，包括：
响应所述四足机器人的四足触地操作，通过惯性传感器获取当前所述四元数；
以及，
利用正运动学定理分别计算所述电机带位置编码器反馈的所述四足机器人的足端反馈角度，得到所述四个足端的当前坐标位置。
3.根据权利要求1所述的四足机器人的移动控制方法，其特征在于，基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹，包括：
基于所述目标摆动步态，结合ZMP稳定性判据，确定所述目标摆动步态对应的约束条件；
基于所述地形预测结果及所述目标摆动步态及对应的约束条件，确定所述四足机器人的状态轨迹。
4.根据权利要求1-3中任一所述的四足机器人的移动控制方法，其特征在于，依据所述状态轨迹，对所述四足机器人进行移动控制，包括：
对所述状态轨迹中的状态量进行线性化处理，得到线性状态量；
依据所述线性状态量，对所述四足机器人进行移动控制。
5.一种四足机器人的移动控制装置，其特征在于，包括：
响应模块，用于响应四足机器人的四足触地操作，分别获取所述四足机器人的四元数，以及所述四足机器人的四个足端的当前坐标位置；
输入模块，用于将所述当前坐标位置和当前所述四元数输入预先训练的神经网络模型，得到地形预测结果；
步态确定模块，用于根据所述地形预测结果，确定目标摆动步态；
状态轨迹确定模块，用于基于所述地形预测结果，结合所述目标摆动步态，确定所述四足机器人的状态轨迹；
移动控制模块，用于依据所述状态轨迹，对所述四足机器人进行移动控制；
摆动步态包括：单足摆动步态和双足摆动步态；所述步态确定模块包括：
判断子模块，用于判断所述地形预测结果是否为上坡地形；若是，则选择所述单足摆动步态为所述目标摆动步态；
若否，则选择所述双足摆动步态为所述目标摆动步态。
6.根据权利要求5所述的四足机器人的移动控制装置，其特征在于，所述四足机器人安装有惯性传感器和电机带位置编码器；所述响应模块包括：
响应子模块，用于响应所述四足机器人的四足触地操作，通过惯性传感器获取当前所述四元数；
以及，
利用正运动学定理分别计算所述电机带位置编码器反馈的所述四足机器人的足端反馈角度，得到所述四个足端的当前坐标位置。
7.根据权利要求6所述的四足机器人的移动控制装置，其特征在于，所述状态轨迹确定模块包括：
约束条件确定子模块，用于基于所述目标摆动步态，结合ZMP稳定性判据，确定所述目标摆动步态对应的约束条件；
状态轨迹确定子模块，用于基于所述地形预测结果及所述目标摆动步态及对应的约束条件，确定所述四足机器人的状态轨迹。
8.根据权利要求5-7中任一所述的四足机器人的移动控制装置，其特征在于，所述移动控制模块包括：
线性处理子模块，用于对所述状态轨迹中的状态量进行线性化处理，得到线性状态量；
移动控制子模块，用于依据所述线性状态量，对所述四足机器人进行移动控制。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110143439.XA CN112947428B (zh) | 2021-02-02 | 2021-02-02 | 一种四足机器人的移动控制方法及装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110143439.XA CN112947428B (zh) | 2021-02-02 | 2021-02-02 | 一种四足机器人的移动控制方法及装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112947428A CN112947428A (zh) | 2021-06-11 |
| CN112947428B true CN112947428B (zh) | 2023-12-22 |
Family
ID=76241628
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110143439.XA Active CN112947428B (zh) | 2021-02-02 | 2021-02-02 | 一种四足机器人的移动控制方法及装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112947428B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115840453B (zh) * | 2023-02-10 | 2023-05-05 | 季华实验室 | 四足机器人自适应足端避障方法、装置、电子设备及介质 |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9387588B1 (en) * | 2014-08-25 | 2016-07-12 | Google Inc. | Handling gait disturbances with asynchronous timing |
| CN106354137A (zh) * | 2016-09-28 | 2017-01-25 | 齐鲁工业大学 | 应用于四足仿生机器人的静步态和对角小跑步态切换算法 |
| CN107065867A (zh) * | 2017-03-28 | 2017-08-18 | 浙江大学 | 一种面向未知崎岖地形的四足机器人运动规划方法 |
| CN107121128A (zh) * | 2017-05-27 | 2017-09-01 | 中国北方车辆研究所 | 一种足式机器人地形参数的测量方法及系统 |
| US10017218B1 (en) * | 2015-11-11 | 2018-07-10 | Boston Dynamics, Inc. | Achieving a target gait behavior in a legged robot |
| CN108536011A (zh) * | 2018-03-19 | 2018-09-14 | 中山大学 | 一种基于深度强化学习的六足机器人复杂地形自适应运动控制方法 |
| CN111086001A (zh) * | 2019-12-25 | 2020-05-01 | 广东省智能制造研究所 | 一种足式机器人多模态感知的状态估计方法及系统 |
| CN111896007A (zh) * | 2020-08-12 | 2020-11-06 | 智能移动机器人(中山)研究院 | 一种补偿足地冲击的四足机器人姿态解算方法 |
-
2021
- 2021-02-02 CN CN202110143439.XA patent/CN112947428B/zh active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9387588B1 (en) * | 2014-08-25 | 2016-07-12 | Google Inc. | Handling gait disturbances with asynchronous timing |
| US10017218B1 (en) * | 2015-11-11 | 2018-07-10 | Boston Dynamics, Inc. | Achieving a target gait behavior in a legged robot |
| CN106354137A (zh) * | 2016-09-28 | 2017-01-25 | 齐鲁工业大学 | 应用于四足仿生机器人的静步态和对角小跑步态切换算法 |
| CN107065867A (zh) * | 2017-03-28 | 2017-08-18 | 浙江大学 | 一种面向未知崎岖地形的四足机器人运动规划方法 |
| CN107121128A (zh) * | 2017-05-27 | 2017-09-01 | 中国北方车辆研究所 | 一种足式机器人地形参数的测量方法及系统 |
| CN108536011A (zh) * | 2018-03-19 | 2018-09-14 | 中山大学 | 一种基于深度强化学习的六足机器人复杂地形自适应运动控制方法 |
| CN111086001A (zh) * | 2019-12-25 | 2020-05-01 | 广东省智能制造研究所 | 一种足式机器人多模态感知的状态估计方法及系统 |
| CN111896007A (zh) * | 2020-08-12 | 2020-11-06 | 智能移动机器人(中山)研究院 | 一种补偿足地冲击的四足机器人姿态解算方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112947428A (zh) | 2021-06-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Dai et al. | Modeling vehicle interactions via modified LSTM models for trajectory prediction | |
| EP3940421A1 (en) | Positioning method and device based on multi-sensor fusion | |
| US11619943B2 (en) | Optimal path library for local path planning of an autonomous vehicle | |
| JP7506876B2 (ja) | 自律車両における運動挙動推定および動的挙動推定のための技術 | |
| CN111142091B (zh) | 一种融合车载信息的自动驾驶系统激光雷达在线标定方法 | |
| Erfani et al. | Comparison of two data fusion methods for localization of wheeled mobile robot in farm conditions | |
| Dang et al. | Tightly-coupled data fusion of VINS and odometer based on wheel slip estimation | |
| CN111257853B (zh) | 一种基于imu预积分的自动驾驶系统激光雷达在线标定方法 | |
| CN111402328A (zh) | 一种基于激光里程计的位姿计算方法及装置 | |
| CN112947428B (zh) | 一种四足机器人的移动控制方法及装置 | |
| CN107121128B (zh) | 一种足式机器人地形参数的测量方法及系统 | |
| Zhao et al. | A real-time low-computation cost human-following framework in outdoor environment for legged robots | |
| CN117270551A (zh) | 基于局部环境感知的四足机器人自主攀爬楼梯方法及系统 | |
| Parra-Tsunekawa et al. | A kalman-filtering-based approach for improving terrain mapping in off-road autonomous vehicles | |
| CN115032984A (zh) | 一种面向港口物流智能机器人的半自主导航方法及系统 | |
| US20200293051A1 (en) | Route determination method | |
| CN115525054B (zh) | 大型工业园区无人清扫车沿边路径跟踪控制方法及系统 | |
| US20230211842A1 (en) | Autonomous walking vehicle | |
| Zheng et al. | Vision-based autonomous vehicle control using the two-point visual driver control model | |
| EP3797939B1 (en) | Control command based adaptive system and method for estimating motion parameters of differential drive vehicles | |
| Leng et al. | An improved method for odometry estimation based on EKF and Temporal Convolutional Network | |
| Schulte et al. | 2D and 3D Pose Estimation for Gesture Recognition in Deep-learning-driven Human–vehicle Leader–follower Systems | |
| US11693416B2 (en) | Route determination method | |
| CN118293925B (zh) | 基于多传感器信息融合的双足机器人状态估计方法及系统 | |
| CN114056338B (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 |