CN116619389A - 一种小型仿生鼠四足机器人的步态控制方法 - Google Patents
一种小型仿生鼠四足机器人的步态控制方法 Download PDFInfo
- Publication number
- CN116619389A CN116619389A CN202310869516.9A CN202310869516A CN116619389A CN 116619389 A CN116619389 A CN 116619389A CN 202310869516 A CN202310869516 A CN 202310869516A CN 116619389 A CN116619389 A CN 116619389A
- Authority
- CN
- China
- Prior art keywords
- motion
- polar
- leg
- range
- robot
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 71
- 230000005021 gait Effects 0.000 title claims abstract description 43
- 239000011664 nicotinic acid Substances 0.000 title claims abstract description 25
- 238000004364 calculation method Methods 0.000 claims abstract description 51
- 241001529936 Murinae Species 0.000 claims abstract description 14
- 230000009466 transformation Effects 0.000 claims abstract description 13
- 210000001364 upper extremity Anatomy 0.000 claims description 24
- 230000010363 phase shift Effects 0.000 claims description 8
- 230000007246 mechanism Effects 0.000 claims description 6
- 230000000737 periodic effect Effects 0.000 claims description 6
- 238000013528 artificial neural network Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000010606 normalization Methods 0.000 claims description 3
- 238000004590 computer program Methods 0.000 description 6
- 238000004422 calculation algorithm Methods 0.000 description 5
- 230000002787 reinforcement Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000010801 machine learning Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 101100186920 Campylobacter jejuni subsp. jejuni serotype O:2 (strain ATCC 700819 / NCTC 11168) legI gene Proteins 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
- 230000007547 defect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000011426 transformation method Methods 0.000 description 1
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
- 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/1628—Programme controls characterised by the control loop
-
- 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
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
本发明属于四足机器人运动控制领域,更具体地,涉及一种小型仿生鼠四足机器人的步态控制方法。首先基于鼠类机器人腿部的结构特点,构建末端足迹可运动空间,在该空间内使用参数曲线界定最大运动边界;输入归一化的运动信号,得到对应当前相位的运动位置对应的极径;得到极径后确定当前时刻t下的运动位置的极坐标;通过坐标变换,得到机器人每条腿的运动平面上的笛卡尔坐标系下的运动位置坐标(y,z),对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。本发明提供的方法精度更高,自由度更大。
Description
技术领域
本发明属于四足机器人运动控制领域,更具体地,涉及一种小型仿生鼠四足机器人的步态控制方法。
背景技术
四足机器人在运动控制过程中需要实现高效的步态,并适应不同的地形。近年来强化学习等人工智能方法被广泛应用于四足机器人的控制,但传统的控制方法没有针对20cm高度以下小型四足机器人的机器学习场景进行过针对性设计,因而无法兼顾小型机器人的运动效率和可探索性。
在四足机器人的步态控制方法领域,以往有一些专利提出过传统的基于规划的控制方法,和基于强化学习的控制方法等。从方法上看,现有的四足控制方法基于规划模型,使用转置矩阵获得电机的输出力矩。基于转置矩阵进行逆运动学计算的方法属于一种近似逼近的控制算法,虽然简单适用于各种类型的结构,但没有对末端运动空间进行进一步设计,导致末端运动空间点离散不可控,在运动时需要进一步的模型来约束步态,且控制过程无法参数归一化,不适用于融合强化学习方法的控制方案。从平台上看,目前没有针对小型鼠类机器人的高自由度的运动控制方法被提出。传统的控制方法都没有针对20cm高度以下小型四足机器人的机器学习场景进行过针对性设计,因而无法兼顾小型机器人的运动效率和可探索性。而针对鼠类机器人设计的强化学习算法,仅仅是训练机器人选择几个预设的行为模式,无法生成新的步态,不具备高自由度和可扩展性。
发明内容
本发明为克服上述现有技术中的缺陷,提供一种小型仿生鼠四足机器人的步态控制方法,控制精度更高,运动自由度也更高。
为解决上述技术问题,本发明采用的技术方案是:一种小型仿生鼠四足机器人的步态控制方法,包括以下步骤:
S1. 基于鼠类机器人腿部的结构特点,构建末端足迹可运动空间,在该空间内使用参数曲线界定最大运动边界;
S2. 输入归一化的运动信号,得到对应当前相位的运动位置对应的极径;得到极径后确定当前时刻t下的运动位置的极坐标;
S3. 通过坐标变换,得到机器人每条腿的运动平面上的笛卡尔坐标系下的运动位置坐标(y,z),对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
进一步地,对于任意时刻t,计算整机相位状态θ;在相位状态θ的基础上叠加每条腿的相位偏移,得到每条腿的相位角;由每条腿的相位角计算得到对应的运动范围边界。
进一步地,确定任意相位状态θ的最大运动范围边界的步骤包括:
S11. 基于腿部机构的执行电机类型,给出每个电机的转动范围;
S12. 基于腿部结构的正运动学模型进行正向运算,得到现有电机转动范围以得到的末端空间范围,该空间为一个二维平面区域;
S13. 在末端可运动空间内,根据最大化横向和纵向跨度的原则,划定基本运动范围;
S14. 在基本运动范围内,设定一个运动中心,坐标为(Cy, Cz);
S15. 以运动中心(Cy,Cz)为极点,进行坐标转换,将平面坐标从笛卡尔坐标系转换为极坐标系;
S16. 在极坐标系下标识出基本运动范围;
S17. 划定极坐标系的极角范围为,对该范围内的极角,计算处于基本运动范围内的最大极径的大小;
S18. 结合基本运动范围的划分方式,得到任意极角对应的运动范围边界/>。
进一步地,所述的步骤S2具体包括以下步骤:
S21. 运动信号的控制输入端定义为一组大小为4的归一化信号;取0到1之间的任意连续数值:;
S22. 设定机器人的周期运动频率为f;
S23. 计算完整运动周期长度:;
S24. 对于运动时的时刻t,计算整机相位状态:;
S25. 以跑动步态作为机器人的基本步态,在此步态下,四条腿具有不同的相位偏移:;其中/>到/>分别代表左前腿、右前腿、左后腿、右后腿的相位偏移;
S26. 在整机相位状态上叠加每条腿的相位偏移,得到每条腿的相位角,由下式计算:;其中i从1到4分别代表左前腿、右前腿、左后腿、右后腿;
S27. 由相位角计算得到对应的运动范围边界;
S28. 由下式计算得到对应当前相位的运动位置对应的极径:;
S29. 得出当前时刻t下的运动位置的极坐标。
进一步地,由一个深度神经网络生成;当数值恒为1时,代表执行预设的步态;当数值恒为0时,代表四足末端点恒控制在运动中心,机器人保持不动。
进一步地,所述的步骤S3具体包括:
S31. 通过坐标变换,重新得到笛卡尔坐标系下的运动位置坐标:
其中,y-z平面是机器人每条腿的运动平面;
S32. 对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
本发明还提供一种小型仿生鼠四足机器人的步态控制系统,包括:
最大运动边界确定模块:用于基于鼠类机器人腿部的结构特点,构建末端足迹可运动空间,在该空间内使用参数曲线界定最大运动边界;
极坐标计算模块:用于输入归一化的运动信号,得到对应当前相位的运动位置对应的极径;得到极径后确定当前时刻t下的运动位置的极坐标;
电机转动角度计算模块:用于通过坐标变换,得到机器人每条腿的运动平面上的笛卡尔坐标系下的运动位置坐标(y,z),对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
进一步地,所述的最大运动边界确定模块还包括:
电机转动范围确定单元:用于基于腿部机构的执行电机类型,给出每个电机的转动范围;
末端空间范围确定单元:用于基于腿部结构的正运动学模型进行正向运算,得到现有电机转动范围以得到的末端空间范围,该空间为一个二维平面区域;
基本运动范围划定单元:用于在末端可运动空间内,根据最大化横向和纵向跨度的原则,划定基本运动范围;
运动中心确定单元:用于在基本运动范围内,设定一个运动中心,坐标为(Cy,Cz);
极坐标转换单元:用于以运动中心(Cy,Cz)为极点,进行坐标转换,将平面坐标从笛卡尔坐标系转换为极坐标系;
基本运动范围标识单元:用于在极坐标系下标识出基本运动范围;
最大极径计算单元:用于在划定极坐标系的极角范围为时,对该范围内的极角,计算处于基本运动范围内的最大极径的大小;
任意极角运动范围边界确定单元:用于结合基本运动范围的划分方式,得到任意极角对应的运动范围边界/>。
进一步地,极坐标计算模块具体包括:
归一化单元:用于将运动信号的控制输入端定义为一组大小为4的归一化信号;取0到1之间的任意连续数值:;
运动频率设定单元:用于设定机器人的周期运动频率为f;
运动周期计算单元:用于计算完整运动周期长度:;
整机相位状态计算单元:用于对于运动时的时刻t,计算整机相位状态:;
相位偏移计算单元:用于以跑动步态作为机器人的基本步态,在此步态下,分别计算四条腿的相位偏移:;其中/>到/>分别代表左前腿、右前腿、左后腿、右后腿的相位偏移;
相位角计算单元:用于在整机相位状态上叠加每条腿的相位偏移,计算得到每条腿的相位角,由下式计算:;其中i从1到4分别代表左前腿、右前腿、左后腿、右后腿;
极径计算单元:用于计算得到对应当前相位的运动位置对应的极径:;
极坐标计算单元:用于得出当前时刻t下的运动位置的极坐标。
进一步地,所述的电机转动角度计算模块具体包括:
笛卡尔坐标计算单元:用于通过坐标变换,重新得到笛卡尔坐标系下的运动位置坐标:
其中,y-z平面是机器人每条腿的运动平面;
逆运动学解算单元:用于对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
本发明还提供一种小型仿生鼠四足机器人,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序,以实现如上所述的小型仿生鼠四足机器人的步态控制方法。
本发明还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行,以用于实现如上所述的小型仿生鼠四足机器人的步态控制方法。
与现有技术相比,有益效果是:
1、本发明针对小型鼠类四足机器人的结构特点做出了针对性的设计,使用解析形式的变换方法进行末端空间控制,精度更高;
2、在本发明中控制信号以一组归一化的浮点数表示,控制简洁,能同时适用于传统的规划步态控制,也能适用于强化学习控制方法;
3、在本发明中运动轨迹模式可以通过参数进行任意的生成,运动自由度高。
附图说明
图1是本发明的方法流程示意图。
图2是实施例1中最大运动范围划定流程示意图。
图3是实施例1中控制算法流程示意图。
图4是实施例1中最大运动范围划定示意图。
图5是实施例1中参数符号在运动空间内的几何含义示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。下面结合具体实施方式对本发明作在其中一个实施例中说明。其中,附图仅用于示例性说明,表示的仅是示意图,而非实物图,不能理解为对本专利的限制;为了更好地说明本发明的实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;对本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。
在本发明的描述中,需要理解的是,若有术语“上”、“下”、“左”、“右”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制,对于本领域的普通技术人员而言,可以根据具体情况理解上述术语的具体含义。另外,若本发明实施例中有涉及“第一”、“第二”等的描述,则该“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外,全文中出现的“和/或”的含义为,包括三个并列的方案,以“A和/或B”为例,包括A方案,或B方案,或A和B同时满足的方案。
实施例1:
如图1所示,一种小型仿生鼠四足机器人的步态控制方法,包括以下步骤:
最大运动范围划定:
基于鼠类机器人腿部的结构特点,构建末端足迹可运动空间,在该空间内使用参数曲线界定最大运动边界;在具体的控制过程中,对于任意时刻t,计算整机相位状态θ;在相位状态θ的基础上叠加每条腿的相位偏移,得到每条腿的相位角;由每条腿的相位角计算得到对应的运动范围边界;
控制算法执行:
首先,输入归一化的运动信号,得到对应当前相位的运动位置对应的极径;得到极径后确定当前时刻t下的运动位置的极坐标;
接着,通过坐标变换,得到机器人每条腿的运动平面上的笛卡尔坐标系下的运动位置坐标(y,z),对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
具体的,如图2和图5所示,确定任意相位状态θ的最大运动范围边界的步骤包括:
S11. 基于腿部机构的执行电机类型,给出每个电机的转动范围;
S12. 基于腿部结构的正运动学模型进行正向运算,得到现有电机转动范围以得到的末端空间范围,该空间为一个二维平面区域;
S13. 在末端可运动空间内,根据最大化横向和纵向跨度的原则,划定基本运动范围(圆弧形);
S14. 在基本运动范围内,设定一个运动中心,坐标为(Cy, Cz);
S15. 以运动中心(Cy,Cz)为极点,进行坐标转换,将平面坐标从笛卡尔坐标系转换为极坐标系;
S16. 在极坐标系下标识出基本运动范围;
S17. 划定极坐标系的极角范围为,对该范围内的极角,计算处于基本运动范围内的最大极径的大小;
S18. 结合基本运动范围的划分方式,得到任意极角对应的运动范围边界/>。如图4所示。
其中,如图3所示,控制算法执行具体包括以下步骤:
S21. 运动信号的控制输入端定义为一组大小为4的归一化信号;取0到1之间的任意连续数值:;/>由一个深度神经网络生成;当数值恒为1时,代表执行预设的步态;当数值恒为0时,代表四足末端点恒控制在运动中心,机器人保持不动
S22. 设定机器人的周期运动频率为f;
S23. 计算完整运动周期长度:;
S24. 对于运动时的时刻t,计算整机相位状态:;
S25. 以跑动步态作为机器人的基本步态,在此步态下,四条腿具有不同的相位偏移:;其中/>到/>分别代表左前腿、右前腿、左后腿、右后腿的相位偏移;
S26. 在整机相位状态上叠加每条腿的相位偏移,得到每条腿的相位角,由下式计算:;其中i从1到4分别代表左前腿、右前腿、左后腿、右后腿;
S27. 由相位角计算得到对应的运动范围边界;
S28. 由下式计算得到对应当前相位的运动位置对应的极径:;
S29. 得出当前时刻t下的运动位置的极坐标;
S31. 通过坐标变换,重新得到笛卡尔坐标系下的运动位置坐标:
其中,y-z平面是机器人每条腿的运动平面;
S32. 对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
实施例2
本实施例提供一种小型仿生鼠四足机器人的步态控制系统,包括:
最大运动边界确定模块:用于基于鼠类机器人腿部的结构特点,构建末端足迹可运动空间,在该空间内使用参数曲线界定最大运动边界;
极坐标计算模块:用于输入归一化的运动信号,得到对应当前相位的运动位置对应的极径;得到极径后确定当前时刻t下的运动位置的极坐标;
电机转动角度计算模块:用于通过坐标变换,得到机器人每条腿的运动平面上的笛卡尔坐标系下的运动位置坐标(y,z),对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
具体的,所述的最大运动边界确定模块还包括:
电机转动范围确定单元:用于基于腿部机构的执行电机类型,给出每个电机的转动范围;
末端空间范围确定单元:用于基于腿部结构的正运动学模型进行正向运算,得到现有电机转动范围以得到的末端空间范围,该空间为一个二维平面区域;
基本运动范围划定单元:用于在末端可运动空间内,根据最大化横向和纵向跨度的原则,划定基本运动范围;
运动中心确定单元:用于在基本运动范围内,设定一个运动中心,坐标为(Cy,Cz);
极坐标转换单元:用于以运动中心(Cy,Cz)为极点,进行坐标转换,将平面坐标从笛卡尔坐标系转换为极坐标系;
基本运动范围标识单元:用于在极坐标系下标识出基本运动范围;
最大极径计算单元:用于在划定极坐标系的极角范围为时,对该范围内的极角,计算处于基本运动范围内的最大极径的大小;
任意极角运动范围边界确定单元:用于结合基本运动范围的划分方式,得到任意极角对应的运动范围边界/>。
其中,极坐标计算模块具体包括:
归一化单元:用于将运动信号的控制输入端定义为一组大小为4的归一化信号;取0到1之间的任意连续数值:;
运动频率设定单元:用于设定机器人的周期运动频率为f;
运动周期计算单元:用于计算完整运动周期长度:;
整机相位状态计算单元:用于对于运动时的时刻t,计算整机相位状态:;
相位偏移计算单元:用于以跑动步态作为机器人的基本步态,在此步态下,分别计算四条腿的相位偏移:;其中/>到/>分别代表左前腿、右前腿、左后腿、右后腿的相位偏移;
相位角计算单元:用于在整机相位状态上叠加每条腿的相位偏移,计算得到每条腿的相位角,由下式计算:;其中i从1到4分别代表左前腿、右前腿、左后腿、右后腿;
极径计算单元:用于计算得到对应当前相位的运动位置对应的极径:;
极坐标计算单元:用于得出当前时刻t下的运动位置的极坐标。
另外,电机转动角度计算模块具体包括:
笛卡尔坐标计算单元:用于通过坐标变换,重新得到笛卡尔坐标系下的运动位置坐标:
其中,y-z平面是机器人每条腿的运动平面;
逆运动学解算单元:用于对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
实施例3
本实施例提供一种小型仿生鼠四足机器人,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序,以实现实施例1所述的小型仿生鼠四足机器人的步态控制方法。
实施例4
本实施例提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行,以用于实现实施例1所述的小型仿生鼠四足机器人的步态控制方法。
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (10)
1.一种小型仿生鼠四足机器人的步态控制方法,其特征在于,包括以下步骤:
S1. 基于鼠类机器人腿部的结构特点,构建末端足迹可运动空间,在末端足迹可运动空间内使用参数曲线界定最大运动边界;
S2. 输入归一化的运动信号,得到对应当前相位的运动位置对应的极径;得到极径后确定当前时刻t下的运动位置的极坐标;
S3. 通过坐标变换,得到机器人每条腿的运动平面上的笛卡尔坐标系下的运动位置坐标(y,z),对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
2.根据权利要求1所述的小型仿生鼠四足机器人的步态控制方法,其特征在于,对于任意时刻t,计算整机相位状态θ;在相位状态θ的基础上叠加每条腿的相位偏移,得到每条腿的相位角;由每条腿的相位角计算得到对应的运动范围边界。
3.根据权利要求1所述的小型仿生鼠四足机器人的步态控制方法,其特征在于,确定任意相位状态θ的最大运动范围边界的步骤包括:
S11. 基于腿部机构的执行电机类型,给出每个电机的转动范围;
S12. 基于腿部结构的正运动学模型进行正向运算,得到现有电机转动范围以得到的末端空间范围,该空间为一个二维平面区域;
S13. 在末端可运动空间内,根据最大化横向和纵向跨度的原则,划定基本运动范围;
S14. 在基本运动范围内,设定一个运动中心,坐标为(Cy, Cz);
S15. 以运动中心(Cy,Cz)为极点,进行坐标转换,将平面坐标从笛卡尔坐标系转换为极坐标系;
S16. 在极坐标系下标识出基本运动范围;
S17. 划定极坐标系的极角范围为,对该范围内的极角,计算处于基本运动范围内的最大极径的大小;
S18. 结合基本运动范围的划分方式,得到任意极角对应的运动范围边界/>。
4.根据权利要求1所述的小型仿生鼠四足机器人的步态控制方法,其特征在于,所述的步骤S2具体包括以下步骤:
S21. 运动信号的控制输入端定义为一组大小为4的归一化信号;取0到1之间的任意连续数值:;
S22. 设定机器人的周期运动频率为f;
S23. 计算完整运动周期长度:;
S24. 对于运动时的时刻t,计算整机相位状态:;
S25. 以跑动步态作为机器人的基本步态,在此步态下,四条腿具有不同的相位偏移:;其中/>到/>分别代表左前腿、右前腿、左后腿、右后腿的相位偏移;
S26. 在整机相位状态上叠加每条腿的相位偏移,得到每条腿的相位角,由下式计算:;其中i从1到4分别代表左前腿、右前腿、左后腿、右后腿;
S27. 由相位角计算得到对应的运动范围边界;
S28. 由下式计算得到对应当前相位的运动位置对应的极径:;
S29. 得出当前时刻t下的运动位置的极坐标。
5.根据权利要求4所述的小型仿生鼠四足机器人的步态控制方法,其特征在于,由一个深度神经网络生成;当数值恒为1时,代表执行预设的步态;当数值恒为0时,代表四足末端点恒控制在运动中心,机器人保持不动。
6.根据权利要求4所述的小型仿生鼠四足机器人的步态控制方法,其特征在于,所述的步骤S3具体包括:
S31. 通过坐标变换,重新得到笛卡尔坐标系下的运动位置坐标:
其中,y-z平面是机器人每条腿的运动平面;
S32. 对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
7.一种小型仿生鼠四足机器人的步态控制系统,其特征在于,包括:
最大运动边界确定模块:用于基于鼠类机器人腿部的结构特点,构建末端足迹可运动空间,在该空间内使用参数曲线界定最大运动边界;
极坐标计算模块:用于输入归一化的运动信号,得到对应当前相位的运动位置对应的极径;得到极径后确定当前时刻t下的运动位置的极坐标;
电机转动角度计算模块:用于通过坐标变换,得到机器人每条腿的运动平面上的笛卡尔坐标系下的运动位置坐标(y,z),对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
8.根据权利要求7所述的小型仿生鼠四足机器人的步态控制系统,其特征在于,所述的最大运动边界确定模块还包括:
电机转动范围确定单元:用于基于腿部机构的执行电机类型,给出每个电机的转动范围;
末端空间范围确定单元:用于基于腿部结构的正运动学模型进行正向运算,得到现有电机转动范围以得到的末端空间范围,该空间为一个二维平面区域;
基本运动范围划定单元:用于在末端可运动空间内,根据最大化横向和纵向跨度的原则,划定基本运动范围;
运动中心确定单元:用于在基本运动范围内,设定一个运动中心,坐标为(Cy, Cz);
极坐标转换单元:用于以运动中心(Cy,Cz)为极点,进行坐标转换,将平面坐标从笛卡尔坐标系转换为极坐标系;
基本运动范围标识单元:用于在极坐标系下标识出基本运动范围;
最大极径计算单元:用于在划定极坐标系的极角范围为时,对该范围内的极角,计算处于基本运动范围内的最大极径的大小;
任意极角运动范围边界确定单元:用于结合基本运动范围的划分方式,得到任意极角对应的运动范围边界/>。
9.根据权利要求7所述的小型仿生鼠四足机器人的步态控制系统,其特征在于,极坐标计算模块具体包括:
归一化单元:用于将运动信号的控制输入端定义为一组大小为4的归一化信号;取0到1之间的任意连续数值:;
运动频率设定单元:用于设定机器人的周期运动频率为f;
运动周期计算单元:用于计算完整运动周期长度:;
整机相位状态计算单元:用于对于运动时的时刻t,计算整机相位状态:;
相位偏移计算单元:用于以跑动步态作为机器人的基本步态,在此步态下,分别计算四条腿的相位偏移:;其中/>到/>分别代表左前腿、右前腿、左后腿、右后腿的相位偏移;
相位角计算单元:用于在整机相位状态上叠加每条腿的相位偏移,计算得到每条腿的相位角,由下式计算:;其中i从1到4分别代表左前腿、右前腿、左后腿、右后腿;
极径计算单元:用于计算得到对应当前相位的运动位置对应的极径:;
极坐标计算单元:用于得出当前时刻t下的运动位置的极坐标。
10.根据权利要求9所述的小型仿生鼠四足机器人的步态控制系统,其特征在于,所述的电机转动角度计算模块具体包括:
笛卡尔坐标计算单元:用于通过坐标变换,重新得到笛卡尔坐标系下的运动位置坐标:
其中,y-z平面是机器人每条腿的运动平面;
逆运动学解算单元:用于对运动平面的笛卡尔坐标进行逆运动学解算,得到末端点位置对应的电机转动角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310869516.9A CN116619389B (zh) | 2023-07-17 | 2023-07-17 | 一种小型仿生鼠四足机器人的步态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310869516.9A CN116619389B (zh) | 2023-07-17 | 2023-07-17 | 一种小型仿生鼠四足机器人的步态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116619389A true CN116619389A (zh) | 2023-08-22 |
CN116619389B CN116619389B (zh) | 2023-12-08 |
Family
ID=87621531
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310869516.9A Active CN116619389B (zh) | 2023-07-17 | 2023-07-17 | 一种小型仿生鼠四足机器人的步态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116619389B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050113973A1 (en) * | 2003-08-25 | 2005-05-26 | Sony Corporation | Robot and attitude control method of robot |
US20160023350A1 (en) * | 2013-03-15 | 2016-01-28 | Springactive, Inc. | Gravitational Load Support System |
CN111208822A (zh) * | 2020-02-17 | 2020-05-29 | 清华大学深圳国际研究生院 | 一种基于强化学习和cpg控制器的四足机器人步态控制方法 |
CN114859911A (zh) * | 2022-04-28 | 2022-08-05 | 云南红岭云科技股份有限公司 | 一种基于drl的四足机器人路径规划方法 |
CN115328125A (zh) * | 2022-08-05 | 2022-11-11 | 中国科学院自动化研究所 | 机器人足端摆动路径确定方法、装置和电子设备 |
-
2023
- 2023-07-17 CN CN202310869516.9A patent/CN116619389B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050113973A1 (en) * | 2003-08-25 | 2005-05-26 | Sony Corporation | Robot and attitude control method of robot |
US20160023350A1 (en) * | 2013-03-15 | 2016-01-28 | Springactive, Inc. | Gravitational Load Support System |
CN111208822A (zh) * | 2020-02-17 | 2020-05-29 | 清华大学深圳国际研究生院 | 一种基于强化学习和cpg控制器的四足机器人步态控制方法 |
CN114859911A (zh) * | 2022-04-28 | 2022-08-05 | 云南红岭云科技股份有限公司 | 一种基于drl的四足机器人路径规划方法 |
CN115328125A (zh) * | 2022-08-05 | 2022-11-11 | 中国科学院自动化研究所 | 机器人足端摆动路径确定方法、装置和电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN116619389B (zh) | 2023-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10962976B1 (en) | Motion control method and system for biomimetic robotic fish based on adversarial structured control | |
CN110450156B (zh) | 多自由度机械臂系统自适应模糊控制器的优化设计方法 | |
CN109240091B (zh) | 一种基于强化学习的水下机器人控制方法及其进行跟踪的控制方法 | |
Wu et al. | Kinematic comparison of forward and backward swimming and maneuvering in a self-propelled sub-carangiform robotic fish | |
Yu et al. | Geometric optimization of relative link lengths for biomimetic robotic fish | |
Wang et al. | Multimodal swimming control of a robotic fish with pectoral fins using a CPG network | |
CN116149166B (zh) | 一种基于改进白鲸算法的无人救援艇航向控制方法 | |
Yu et al. | Design and attitude control of a novel robotic jellyfish capable of 3D motion | |
CN114460849B (zh) | 仿生机器鱼运动控制方法、装置和仿生机器鱼 | |
CN111158385B (zh) | 仿生机器鱼的运动控制方法、装置、设备及可读存储介质 | |
CN116619389B (zh) | 一种小型仿生鼠四足机器人的步态控制方法 | |
CN116690557A (zh) | 基于点云的仿人三维扫描运动控制方法及装置 | |
Wen et al. | Consensus protocol based attitudes coordination control for Underwater Glider formation | |
CN116663637A (zh) | 一种多层级智能体同步嵌套训练方法 | |
CN107831781B (zh) | 一种机器鱼运动的控制方法及系统 | |
CN115771142A (zh) | 一种多关节蛇形机器人运动规划方法 | |
CN112256028B (zh) | 一种双足机器人柔顺步态控制方法、系统、设备及介质 | |
CN111830832B (zh) | 仿生滑翔机器海豚平面路径跟踪方法及系统 | |
CN114670207A (zh) | 一种基于野狗优化算法的机械臂柔顺控制方法及系统 | |
CN113967909A (zh) | 基于方向奖励的机械臂智能控制方法 | |
CN108717267B (zh) | 一种六足机器人中枢模式逆向控制方法 | |
WO2013007037A1 (zh) | 工程机械以及机械臂的控制方法与控制装置 | |
CN113411006B (zh) | 一种基于鲸鱼算法的并网模式下储能双向变流器充放电控制方法 | |
Shao et al. | Formation control of multiple biomimetic robotic fish | |
CN116061195B (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 |