CN112476429A - 一种机器人步态控制方法 - Google Patents
一种机器人步态控制方法 Download PDFInfo
- Publication number
- CN112476429A CN112476429A CN202011080030.XA CN202011080030A CN112476429A CN 112476429 A CN112476429 A CN 112476429A CN 202011080030 A CN202011080030 A CN 202011080030A CN 112476429 A CN112476429 A CN 112476429A
- Authority
- CN
- China
- Prior art keywords
- point
- foot end
- height value
- starting point
- coordinate
- 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
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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种机器人步态控制方法,通过将第一高度值H1与第二高度值H2进行权重计算,对第一高度值H1的数据进行修正;这样计算出的足端最高点A的高度准确;通过计算出足端最高点A的Y坐标,然后再计算出控制点P1的坐标;本方法能根据不同的场景设定起始点P0、终止点P2的坐标,然后计算出控制点P1的坐标;然后通过二阶贝塞尔曲线公式生成足端运动曲线;这样使用场景广泛;运动模式丰富;同时因为贝塞尔曲线过度平滑,机器人通过以贝塞尔曲线生成的足端运动坐标运动,这样移动稳定。
Description
技术领域
本发明涉及机器人运动控制方法,具体涉及一种机器人步态控制方法。
背景技术
随着科学技术的飞速发展,机器人技术得到了突飞猛进的发展。机器人可以在远离人类的情况下,快速精准地完成高精度的工作。可广泛应用于抢险救灾、星球探测、军事排雷等不适宜人类生存的环境当中。而足式机器人相对于轮式或履带式机器人在非结构环境中运动具有一定的优越性。在多足步行机器人中,四足机器人结构简单,且运动稳定,在足式机器人中有着最广泛的研究与应用。但四足机器人的运动过程是一个多连杆、强耦合、时变的非线性系统,因此四足机器人的运动控制十分复杂。现有方法多为基于转矩控制的四足机器人步态控制方法,只能对机器人进行固定步长,固定转弯半径的运动控制。在中国专利号为201710295191.2,公告日为2020.4.24的专利文献公开了一种基于正弦对角步态与快速查表法的四足机器人运动控制方法及控制装置,包括:(1)结合对角步态,分析四足机器人腿部结构,建立四足机器人腿部运动数学模型;采用新型正弦步态;(2)通过求解非线性方程组得到四肢各个关节的控制率;建立一种专门面向机器人运动控制的数据库,通过快速查表法得到精确的关节开合角度,快速准确地实现足端轨迹控制。(3)设计足端轨迹控制单元与转向控制单元,以便接入其他控制系统。
但是该四足机器人运动控制方法及控制装置,采用正弦对角步态;控制机器人,运动模式过于单一,且运动时动作过于僵硬,只能越过部分简单障碍;同时这种方法不能区分使用场景对步态曲线进行修改;这样适应性差。
发明内容
本发明提供一种移动稳定的机器人步态控制方法。
为达到上述目的,本发明的技术方案是:一种机器人步态控制方法,包括以下步骤:
1).预设起始点P0的坐标、终止点P2的坐标;起始点P0为足端移动前的位置点,终止点P2为足端移动后的位置点,控制点P1为足端移动时的控制点;起始点P0与终止点P2在同一水平线上;2).预设起始点P0与终止点P2在X轴上的移动距离L;预设控制点P1的X坐标与L的比值为t2;
3).输入第一高度值H1,采集第二高度值H2;第一高度值H1和第二高度值H2都为足端最高点A与起始点P0在Y轴上的差值;
4).比较第一高度值H1与第二高度值H2的差值,并计算足端最高点A的Y坐标H:若H1- H2>0,则进行步骤5);若H1- H2<0,则进行步骤6);若H1- H2=0,则步骤7);
5).进行H=0.8*H1+0.2*H2运算;然后进行步骤8);
6).进行H=0.8*H2+0.2*H1运算;然后进行步骤8);
7).进行H=H1运算;然后进行步骤8);
8).进行Y1= H/[2*(1-t2)*t2]运算;得到控制点P1的坐标(t2*L,H/[2*(1-t2)*t2]);
9).起始点P0、控制点P1和终止点P2通过二阶贝塞尔曲线公式生成足端运动坐标;
10).控制足端按照足端运动坐标移动。
进一步的,步骤2)中,控制点P1控制点P1的坐标在L中的占比t1为1/3。
进一步的,步骤4)中,具体为:第一高度值H1由上位机输入,第二高度值H2由数据采集器采集。
进一步的,步骤1)中,具体为:起始点P0和终止点P2的纵坐标相等。
进一步的,起始点P0的坐标为(0,0); 终止点P2的坐标为(L,0)。
进一步的,步骤1)中,还包括预设跨步速度S。
进一步的,步骤9)中,具体为:控制足端以跨步速度S在足端运动坐标上移动。
以上控制方法,因为第二高度值H2通过数据采集器采集;第一高度值H1通过上位机输入,第一高度值H1与第二高度值H2会有一定数据出入;通过将第一高度值H1与第二高度值H2进行权重计算,对第一高度值H1的数据进行修正;这样计算出的足端最高点A的高度准确;同时对于同一水平线上的起始点P0和终止点P2;利用步骤8)中公式使得将足端最高点A、起始点P0和终止点P2能满足二阶贝塞尔公式的要求;这样控制点P1的坐标准确;然后再生成足端运动坐标;这样机器人的步态控制准确率高;因为贝塞尔曲线过度平滑,机器人通过以二阶贝塞尔曲线生成的足端运动坐标运动,这样移动稳定。同时,二阶贝塞尔曲线通过起始点、控制点和终止点生成,通过一个控制点控制路径的弯曲轨迹,这样控制变量少,方便控制。
附图说明
图1为本发明的流程图。
图2为本发明中足端运动坐标生成的足端运动曲线的示意图。
具体实施方式
下面结合附图和具体实施方式对本发明做进一步详细说明。
如图1-2所示;一种机器人步态控制方法,机器人包括机械腿和控制模块;机械腿设有足端;足端设置在机械腿最下方,足端具有数据采集器;在本实施例中,数据采集器为红外测距传感器;控制模块包括控制系统和上位机;控制系统包括交互层、权重决策层、足端规划层和执行层;数据采集器、上位机都与交互层信号连接;交互层将数据采集器采集的第二高度值H2、上位机输入的第一高度值H1发送到权重决策层,权重决策层第一高度值H1和第二高度值H2进行权重计算;足端规划层将起始点P0、控制点P1和终止点P2通过二阶贝塞尔曲线公式(B(t)=(1-t)2 P0+2t (1-t) P1+t2 P2),t∈[0,1];生成足端运动坐标;执行层足端按照足端运动坐标移动。在本实施中,起始点P0为二阶贝塞尔曲线的起始点;控制点P1为二阶贝塞尔曲线的控制点;终止点P2为二阶贝塞尔曲线的终止点;起始点P0和终止点P2的纵坐标处于同一水平面上,即纵坐标相等,本实施例中,起始点P0的坐标为(0,0); 终止点P2的坐标为(L,0)。
在本实施中,L为起始点P0与终止点P2在X轴上的移动距离;t2为控制点P1的X坐标与L的比值。t∈[0,1],t表示足端在起始点P0与终止点P2之间移动的过程;当t=0时,足端在起始点P0;当t=1时,足端在终止点P2。
机器人步态控制方法,包括以下步骤:
1).预设起始点P0的坐标、终止点P2的坐标;起始点P0为足端移动前的位置点,终止点P2为足端移动后的位置点,控制点P1为足端移动时的控制点;
2).预设起始点P0与终止点P2在X轴上的移动距离L;预设控制点P1的X坐标与L的比值为t2;
3).输入第一高度值H1,采集第二高度值H2;第一高度值H1和第二高度值H2都为足端最高点A与起始点P0在Y轴上的差值;
4).比较第一高度值H1与第二高度值H2的差值,并计算足端最高点A的Y坐标H:若H1- H2>0,则进行步骤5);若H1- H2<0,则进行步骤6);若H1- H2=0,则步骤7);
5).进行H=0.8*H1+0.2*H2运算;然后进行步骤8);
6).进行H=0.8*H2+0.2*H1运算;然后进行步骤8);
7).进行H=H1运算;然后进行步骤8);
8).进行Y1= H/[2*(1-t2)*t2]运算;得到控制点P1的坐标(t2*L,H/[2*(1-t2)*t2]);
9).起始点P0、控制点P1和终止点P2通过二阶贝塞尔曲线公式生成足端运动坐标;
10).控制足端按照足端运动坐标移动。
上述控制方法,
步骤1),还包括预设跨步速度S。起始点P0的坐标为(0,0)。
步骤2),控制点P1控制点P1的坐标在L中的占比t2为1/3。
步骤3),第一高度值H1由上位机输入,第二高度值H2由数据采集器采集。在本实施例中,用户通过上位机输入第一高度值H1。
步骤8),因为起始点P0与终止点P2在同一水平线上;起始点P0与终止点P2的Y坐标相同;将设定起始点P0与终止点P2的Y坐标都设为0;将起始点P0(0,0);终止点P2(L,0)的Y坐标代入到二阶贝塞尔曲线公式(B(t)=(1-t)2 P0+2t (1-t) P1+t2 P2);同时结合足端最高点的Y坐标H;推导出:H=2t*(1-t)*Y1;将t2代入到Y1= H/[2*(1-t)*t]运算;当t2为1/3时,推导出P1的坐标为(L/3,[9H]/4)。
因为控制点P1是变量,控制点P1的Y坐标会随着足端最高点A的Y坐标变化;当足端最高点A的Y坐标数值增大时,控制点P1的Y坐标也会增大;通过公式Y1= H/[2*(1-t2)*t2]计算控制点P1的Y坐标这样数据准确。
步骤9),将起始点P0(0,0)、控制点P[(L/3,(9H)/4]、终止点P2(L,0)的X坐标和Y坐标分别代入到二阶贝塞尔曲线公式
(B(t)=(1-t)2 P0+2t (1-t) P1+t2 P2),t∈[0,1]进行计算。
X=(1-t)2 *0+2t(1-t)*(L/3) +t2*L;Y=(1-t)2 *0+2t*(1-t)*[(9H)/4]+t2*0。
推导出X=2t*(1-t)*(L/3) +t2*L;Y= [2t*(1-t)*(9H)]/4;然后生成足端运动坐标。
步骤10),控制足端以跨步速度S按照足端运动坐标移动。
以上控制方法,因为第二高度值H2通过数据采集器采集;第一高度值H1通过上位机输入,第一高度值H1与第二高度值H2会有一定数据出入;通过将第一高度值H1与第二高度值H2进行权重计算,对第一高度值H1的数据进行修正;这样计算出的足端最高点A的高度准确;同时同时对于同一水平线上的起始点P0和终止点P2;利用步骤8)中公式使得将足端最高点A、起始点P0和终止点P2能满足二阶贝塞尔公式的要求;;这样控制点P1的坐标准确;然后再生成足端运动坐标;这样机器人的步态控制准确率高;因为贝塞尔曲线过度平滑,机器人通过以二阶贝塞尔曲线生成的足端运动坐标运动,这样移动稳定。同时,二阶贝塞尔曲线通过起始点、控制点和终止点生成,通过一个控制点控制路径的弯曲轨迹,这样控制变量少,方便控制。
Claims (7)
1.一种机器人步态控制方法,其特征在于:包括以下步骤:
1).预设起始点P0的坐标、终止点P2的坐标;起始点P0为足端移动前的位置点,终止点P2为足端移动后的位置点,控制点P1为足端移动时的控制点;起始点P0与终止点P2在同一水平线上;
2).预设起始点P0与终止点P2在X轴上的移动距离L;预设控制点P1的X坐标与L的比值为t2;
3).输入第一高度值H1,采集第二高度值H2;第一高度值H1和第二高度值H2都为足端最高点A与起始点P0在Y轴上的差值;
4).比较第一高度值H1与第二高度值H2的差值,并计算足端最高点A的Y坐标H:若H1-H2>0,则进行步骤5);若H1-H2<0,则进行步骤6);若H1-H2=0,则步骤7);
5).进行H=0.8*H1+0.2*H2运算;然后进行步骤8);
6).进行H=0.8*H2+0.2*H1运算;然后进行步骤8);
7).进行H=H1运算;然后进行步骤8);
8).进行Y1=H/[2*(1-t2)*t2]运算;得到控制点P1的坐标(t2*L,H/[2*(1-t2)*t2]);
9).起始点P0、控制点P1和终止点P2通过二阶贝塞尔曲线公式生成足端运动坐标;
10).控制足端按照足端运动坐标移动。
2.根据权利要求1所述的一种机器人步态控制方法,其特征在于:步骤2)中,控制点P1控制点P1的坐标在L中的占比t1为1/3。
3.根据权利要求1所述的一种机器人步态控制方法,其特征在于:步骤3)中,具体为:第一高度值H1由上位机输入,第二高度值H2由数据采集器采集。
4.根据权利要求1所述的一种机器人步态控制方法,其特征在于:步骤1)中,具体为:起始点P0和起始点P2的纵坐标相等。
5.根据权利要求4所述的一种机器人步太控制方法,其特征在于:步骤1)中具体为:起始点P0的坐标为(0,0);起始点P2的坐标为(L,0)。
6.根据权利要求1所述的一种机器人步态控制方法,其特征在于:步骤1)中,还包括预设跨步速度S。
7.根据权利要求6所述的一种机器人步态控制方法,其特征在于:步骤9)中,具体为:控制足端以跨步速度S在足端运动坐标上移动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011080030.XA CN112476429B (zh) | 2020-10-10 | 2020-10-10 | 一种机器人步态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011080030.XA CN112476429B (zh) | 2020-10-10 | 2020-10-10 | 一种机器人步态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112476429A true CN112476429A (zh) | 2021-03-12 |
CN112476429B CN112476429B (zh) | 2022-06-21 |
Family
ID=74926716
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011080030.XA Active CN112476429B (zh) | 2020-10-10 | 2020-10-10 | 一种机器人步态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112476429B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113961008A (zh) * | 2021-10-25 | 2022-01-21 | 上海同普电力技术有限公司 | 一种应用于agv曲线路径导航跟随方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004202652A (ja) * | 2002-12-26 | 2004-07-22 | Toyota Motor Corp | 体幹を捩じって歩行する2足ロボットとそのための方法 |
CN102156484A (zh) * | 2011-03-24 | 2011-08-17 | 西北工业大学 | 四足机器人对角步态的自适应控制方法 |
CN106094817A (zh) * | 2016-06-14 | 2016-11-09 | 华南理工大学 | 基于大数据方式的强化学习仿人机器人步态规划方法 |
CN111063035A (zh) * | 2019-11-22 | 2020-04-24 | 同济大学 | 一种gis中od关系的三维可视化方法及装置 |
-
2020
- 2020-10-10 CN CN202011080030.XA patent/CN112476429B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004202652A (ja) * | 2002-12-26 | 2004-07-22 | Toyota Motor Corp | 体幹を捩じって歩行する2足ロボットとそのための方法 |
CN102156484A (zh) * | 2011-03-24 | 2011-08-17 | 西北工业大学 | 四足机器人对角步态的自适应控制方法 |
CN106094817A (zh) * | 2016-06-14 | 2016-11-09 | 华南理工大学 | 基于大数据方式的强化学习仿人机器人步态规划方法 |
CN111063035A (zh) * | 2019-11-22 | 2020-04-24 | 同济大学 | 一种gis中od关系的三维可视化方法及装置 |
Non-Patent Citations (2)
Title |
---|
何治成: "室内环境下基于三维地图的双足机器人步态规划与控制", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
陈林: "基于双足机器人步态规划的研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113961008A (zh) * | 2021-10-25 | 2022-01-21 | 上海同普电力技术有限公司 | 一种应用于agv曲线路径导航跟随方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112476429B (zh) | 2022-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Horaud et al. | Visually guided object grasping | |
Liu et al. | Uncalibrated visual servoing of robots using a depth-independent interaction matrix | |
Tarokh et al. | Kinematic modeling of a high mobility Mars rover | |
CN107045552B (zh) | 一种基于正弦对角步态与快速查表法的四足机器人运动控制方法及控制装置 | |
CN110865641B (zh) | 一种反演滑模控制的轮式移动机器人的轨迹跟踪方法 | |
CN111483532A (zh) | 一种静步态上楼梯的四足机器人运动控制方法 | |
CN102794767A (zh) | 视觉引导的机器人关节空间b样条轨迹规划方法 | |
CN112051797A (zh) | 足式机器人运动控制方法、装置、设备及介质 | |
CN112859856A (zh) | 一种基于质心高度补偿的仿人机器人步态生成方法 | |
CN112263440A (zh) | 一种柔性下肢外骨骼与助行器共融康复助力方法及装置 | |
CN112476429B (zh) | 一种机器人步态控制方法 | |
US20230278214A1 (en) | Robot localization using variance sampling | |
CN114536346B (zh) | 一种基于人机协作和视觉检测的机械臂精确路径规划方法 | |
CN115793683A (zh) | 一种重心控制方法、调整机构及足式机器人 | |
CN113843799B (zh) | 一种四足机器人姿态复位控制方法、装置及存储介质 | |
CN114055467A (zh) | 基于五自由度机器人的空间位姿在线仿真系统 | |
Szumowski et al. | Preview control applied for humanoid robot motion generation | |
Gu et al. | Dexterous obstacle-avoidance motion control of Rope Driven Snake Manipulator based on the bionic path following | |
Yunardi et al. | Implementation of motion capture system for trajectory planning of leg swing simulator | |
Seleem et al. | Sliding mode control of underactuated five-link biped robot for climbing stairs based on real human data | |
CN113146616B (zh) | 一种四自由度机械臂视觉伺服控制方法 | |
CN115781666A (zh) | 一种用于机器人全身模仿系统的控制方法 | |
Lang et al. | Visual servoing with LQR control for mobile robots | |
Conticelli et al. | Hybrid visual servoing: A combination of nonlinear control and linear vision | |
Hashemi et al. | In-plane path planning for biped robots based on bezier curve |
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 |