CN100594460C - 防止仿人机器人左右倾斜的运动规划方法和装置 - Google Patents
防止仿人机器人左右倾斜的运动规划方法和装置 Download PDFInfo
- Publication number
- CN100594460C CN100594460C CN200810172220A CN200810172220A CN100594460C CN 100594460 C CN100594460 C CN 100594460C CN 200810172220 A CN200810172220 A CN 200810172220A CN 200810172220 A CN200810172220 A CN 200810172220A CN 100594460 C CN100594460 C CN 100594460C
- Authority
- CN
- China
- Prior art keywords
- motor
- ankle
- joint
- anthropomorphic robot
- hip joint
- 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
Images
Landscapes
- Manipulator (AREA)
Abstract
本发明公开了一种防止仿人机器人左右倾斜的运动规划方法和装置，属于仿人机器人运动规划技术领域。该方法包括：对支撑腿髋关节的电机和踝关节的电机转角分别设置一个补偿角度；将所述支撑腿的髋关节电机和踝关节电机的转角规划角度上分别增加相应的所述补偿角度。该装置包括：设置补偿角度模块，用于对支撑腿的髋关节的电机和踝关节的电机转角分别设置一个补偿角度；添加模块，用于将所述支撑腿的髋关节的电机和踝关节的电机的转角规划角度上分别增加相应的所述补偿角度。其中，所述髋关节的电机和踝关节的电机均为轴向沿仿人机器人前后方向的电机。本发明有效地减小仿人机器人单脚支撑时左右倾斜的现象，提高了着地的稳定性。
Description
技术领域
本发明涉及仿人机器人运动规划技术领域，特别涉及防止仿人机器人左右倾斜的运动规划方法和装置。
背景技术
仿人机器人的运动规划是仿人机器人研究中非常重要的一个领域。仿人机器人的动作表演，是通过分布在仿人机器人各个关节上的电机转动来实现的。每个关节电机的个数代表了该关节上自由度的数目。每个电机在各个时刻是怎样转动的，是在仿人机器人动作表演之前由运动规划给出的。目前，仿人机器人运动规划的方法主要是基于零力矩点(ZMP，ZeroMoment Point)稳定性原理来进行的，方法是先根据地面环境设定足部踝关节的轨迹，在可变参数的有效范围内找出具有最大稳定裕度的躯干轨迹作为最后的规划结果。其中，ZMP是指仿人机器人所受的地面反作用力合力的中心点。当仿人机器人实际的ZMP落在仿人机器人脚面(单脚或双脚)与地面接触所围成的多边形区域内时，仿人机器人可稳定不倒，如图1所示。
人类在步行过程中分为单脚支撑期和双脚支撑期，双脚支撑时两只脚(支撑脚)相对地面位置不变；单脚支撑时一只脚(支撑脚)相对于地面位置固定，而另一支脚(非支撑脚)相对于支撑脚从后面迈至前面，所迈的长度称为步长，单脚支撑期和双脚支撑期时间的总和称为步行周期。人类的步行就是不断循环这两个时期的周期性运动。
仿人机器人在动作表演过程中也分成双脚支撑期和单脚支撑期。在双脚支撑期，由于双脚完全着地，仿人机器人的零力矩点只要落在双脚与地面接触形成的多边形区域内即可保证稳定。在单脚支撑期时，仿人机器人的零力矩点需要落在支撑脚脚面内才能保持稳定。但是由于机械柔性(指机械结构因受外力产生的形变)和伺服柔性(由控制误差所造成)的存在，导致仿人机器人在单脚支撑时上身倾向非支撑腿一侧，这样不但使仿人机器人容易摔倒，而且在仿人机器人的左右方向上，非支撑脚在着地瞬间会与地面形成一个较大的倾角，影响了仿人机器人着地的稳定性。
在对现有技术进行分析后，发明人发现：由于机械柔性和伺服柔性的存在，造成仿人机器人上身在左右方向上向非支撑脚一侧倾斜。这不仅影响了仿人机器人上身姿态的平衡和上臂作业的精度，而且非支撑脚在着地瞬间也会与地面产生一个左右方向的倾角，影响着地的稳定性，容易摔倒。
发明内容
为了有效减小仿人机器人单脚支撑时左右倾斜的现象，增加其着地时的稳定性，本发明实施例基于左右倾斜补偿的思想，提供了一种防止仿人机器人左右倾斜的运动规划方法和装置。所述技术方案如下：
一种防止仿人机器人左右倾斜的运动规划方法，包括以下步骤：
对支撑腿的髋关节的电机和踝关节的电机转角分别设置一个补偿角度；
将所述支撑腿的髋关节的电机和踝关节的电机的转角规划角度上分别增加相应的所述补偿角度。
其中，所述髋关节的电机和踝关节的电机均为轴向沿仿人机器人前后方向的电机。
进一步地，在仿人机器人运动的t时刻，所述补偿角度的大小为：
Δθi(t)＝Ki×(X_waist(t)-X_ankle(t))
其中，i＝1，2，Δθ1(t)表示t时刻支撑腿的髋关节的电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节的电机转角的补偿角；Ki＞0为补偿系数；X_waist为t时刻仿人机器人腰部两髋关节连线中点的左右方向坐标；X_ankle为t时刻仿人机器人支撑脚踝关节左右方向坐标。
一种防止仿人机器人左右倾斜的运动规划装置，包括：设置补偿角度模块，用于对支撑腿的髋关节的电机和踝关节的电机转角分别设置一个补偿角度；
添加模块，用于将所述支撑腿的髋关节的电机和踝关节的电机的转角规划角度上分别增加相应的所述补偿角度。
其中，所述髋关节的电机和踝关节的电机均为轴向沿仿人机器人前后方向的电机。
进一步地，在仿人机器人运动的t时刻，所述补偿角度的大小为：
Δθi(t)＝Ki×(X_waist(t)-X_ankle(t))
其中，i＝1，2，Δθ1(t)表示t时刻支撑腿的髋关节的电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节的电机转角的补偿角；Ki＞0为补偿系数；X_waist为t时刻仿人机器人腰部两髋关节连线中点的左右方向坐标；X_ankle为t时刻仿人机器人支撑脚踝关节左右方向坐标。
本发明实施例通过对支撑腿的髋关节前后方向电机和踝关节前后方向电机的倾角进行补偿，可以有效地减小仿人机器人单脚支撑时左右倾斜的现象和由柔性误差所造成的非支撑脚倾斜着地的现象，提高了着地的稳定性。
附图说明
图1是现有技术仿人机器人脚面(单脚或双脚)与地面接触所围成的多边形区域示意图；
图2是本发明实施例防止仿人机器人左右倾斜的运动规划方法流程图；
图3是仿人机器人的常用的七连杆模型示意图；
图4是世界坐标系下的仿人机器人模型示意图；
图5是仿人机器人在单脚支撑时，采用和没有采用防止左右倾斜的运动规划方法的机器人实际姿态比较示意图；
图6是本发明实施例防止仿人机器人左右倾斜的运动规划装置示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明实施方式作进一步地详细描述。
实施例一
本发明实施例基于左右倾斜补偿的思想，提供了一种防止仿人机器人左右倾斜的运动规划方法，参见图2，包括以下步骤：
210：对支撑腿的髋关节的电机和踝关节的电机分别设置一个补偿角度。
对人体运动模型进行简化，得到仿人型机器人的常用的七连杆模型，如图3所示。1为仿人机器人腰部两髋关节连线中点，2为仿人机器人左踝关节。图3模型中仿人机器人的下肢共有十二个自由度(一个电机代表一个自由度)，每条腿各有6个自由度，其中髋关节3个，膝关节1个，踝关节2个。上述髋关节的电机和踝关节的电机均为轴向沿仿人机器人前后方向的电机。如图4所示，以仿人机器人右方为X轴正方向，以仿人机器人前方为Y轴正方向，以仿人机器人上方为Z轴正方向，建立世界坐标系。仿人机器人足部轨迹的规划是通过规划其左右踝关节坐标点(X_ankle，Y_ankle，Z_ankle)来实现的，在本实施例规划中，将脚面着地时与地面夹角设置为零夹角；上身与地面的夹角设置为90度。
在仿人机器人表演过程中的单脚支撑期，仿人机器人上身姿态在左右方向与地面是否水平取决于支撑腿的髋关节Y方向电机和踝关节Y方向电机。这里Y方向电机指的是其轴向沿Y方向的电机。为防止仿人机器人单脚支撑时左右倾斜，在仿人机器人单脚支撑期对支撑腿的髋关节Y方向电机和踝关节Y方向电机补偿一个适当的角度Δθi(t)，然后将这一补偿量添加到相关电机(支撑腿的髋关节Y方向电机和踝关节Y方向电机)现有技术的规划角度上即可。在仿人机器人运动的t时刻，补偿角Δθi(t)的计算式如下：
Δθi(t)＝Ki×(X_waist(t)-X_ankle(t))
其中，Ki＞0为补偿系数，单位是度/米；X_waist(t)为t时刻仿人机器人腰部两髋关节连线中点的左右方向坐标；X_ankle(t)为t时刻仿人机器人支撑脚踝关节左右方向坐标；i＝1，2分别表示支撑腿的髋关节Y方向电机和踝关节Y方向电机，因此Δθ1(t)表示t时刻支撑腿的髋关节Y方向电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节Y方向电机转角的补偿角。在仿人机器人运动学中，仿人机器人的每一个动作都是事先由运动规划设计好的，所以在任一时刻，根据该仿人机器人的运动规划X_waist与X_ankle的差值是已知的，因此t时刻的仿人机器人单脚支撑时防止左右倾斜的补偿角度Δθi(t)可以由上式计算得出。
补偿系数Ki不能取值过大，否则防止仿人机器人单脚支撑时左右倾斜的效果就要下降。Ki的最大值应当针对具体的仿人机器人，由实验确定。在本实施例中，仿人机器人身高一米六，体重75公斤。为了防止仿人机器人单脚支撑时左右倾斜的效果最好，本实施例中取0＜Ki≤62.5，也即补偿角度Δθi(t)的范围是|Δθi(t)|≤5度。
220：将上述支撑腿的髋关节的电机和踝关节的电机的转角规划角度上分别增加相应的补偿角度Δθi(t)。
补偿角度Δθi(t)是加到相应电机原有的转角a(t)上的，补偿之后，t时刻相应电机实际的转角为：
θi(t)＝a(t)+Δθi(t)
其中，i＝1，2分别表示对支撑腿将要进行补偿的髋关节Y方向电机和踝关节Y方向电机，即Δθ1(t)表示t时刻支撑腿的髋关节Y方向电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节Y方向电机转角的补偿角。
如果不补偿，t时刻电机是按照现有技术预先规划好的角度a(t)旋转，这样仿人机器人容易左右倾斜。图5示出了仿人机器人在单脚支撑时，采用和没有采用防止左右倾斜的方法的稳定性比较示意图(正视图)。图5(a)表明：如果没有采用倾角补偿方法，由柔性误差将导致机器人向非支撑腿方向倾斜，由图可以看出仿人机器人上身与地面产生了一个左右方向的倾角。图5(b)表示采用该补偿算法以后机器人的姿态。通过补偿可以有效减小非支撑脚在着地时与地面的夹角，使其水平着地。本发明实施例中，t时刻可以为任意时刻。
本发明实施例通过对支撑腿的髋关节前后方向电机和踝关节前后方向电机的倾角进行补偿，可以有效地减小仿人机器人单脚支撑时左右倾斜的现象和由柔性误差所造成的非支撑脚倾斜着地的现象，提高了着地的稳定性。
实施例二
本发明实施例基于左右倾斜补偿的思想，提供了一种防止仿人机器人左右倾斜的运动规划装置，参见图6，包括：
设置补偿角度模块601，用于对支撑腿的髋关节的电机和踝关节的电机转角分别设置一个补偿角度。
上述髋关节的电机和踝关节的电机均为轴向沿仿人机器人前后方向的电机。
如图4所示，以仿人机器人右方为X轴正方向，以仿人机器人前方为Y轴正方向，以仿人机器人上方为Z轴正方向，建立世界坐标系。仿人机器人足部轨迹的规划是通过规划其左右踝关节坐标点(X_ankle，Y_ankle，Z_ankle)来实现的，在本实施例规划中，将脚面着地时与地面夹角设置为零夹角；上身与地面的夹角设置为90度。
在仿人机器人表演过程中的单脚支撑期，仿人机器人上身姿态在左右方向与地面是否水平取决于支撑腿的髋关节Y方向电机和踝关节Y方向电机。这里Y方向电机指的是其轴向沿Y方向的电机。为防止仿人机器人单脚支撑时左右倾斜，在仿人机器人单脚支撑期对支撑腿的髋关节Y方向电机和踝关节Y方向电机补偿一个适当的角度Δθi(t)，然后将这一补偿量添加到相关电机(支撑腿的髋关节Y方向电机和踝关节Y方向电机)现有技术的规划角度上即可。在仿人机器人运动的t时刻，补偿角Δθi(t)的计算式如下：
Δθi(t)＝Ki×(X_waist(t)-X_ankle(t))
其中，Ki＞0为补偿系数，单位是度/米；X_waist(t)为t时刻仿人机器人腰部两髋关节连线中点的左右方向坐标；X_ankle(t)为t时刻仿人机器人支撑脚踝关节左右方向坐标；i＝1，2分别表示支撑腿的髋关节Y方向电机和踝关节Y方向电机，因此Δθ1(t)表示t时刻支撑腿的髋关节Y方向电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节Y方向电机转角的补偿角。在仿人机器人运动学中，仿人机器人的每一个动作都是事先由运动规划设计好的，所以在任一时刻，根据该仿人机器人的运动规划X_waist与X_ankle的差值是已知的，因此t时刻的仿人机器人单脚支撑时防止左右倾斜的补偿角度Δθi(t)可以由上式计算得出。
补偿系数Ki不能取值过大，否则防止仿人机器人单脚支撑时左右倾斜的效果就要下降。Ki的最大值应当针对具体的仿人机器人，由实验确定。在本实施例中，仿人机器人身高一米六，体重75公斤。为使防止仿人机器人单脚支撑时左右倾斜的效果最好，本实施例中取0＜Ki≤62.5，也即补偿角度Δθi(t)的范围是|Δθi(t)|≤5度。
添加模块602，用于将所述支撑腿的髋关节的电机和踝关节的电机的转角规划角度上分别增加相应的所述补偿角度。
补偿角度Δθi(t)是加到相应电机原有的转角a(t)上的，补偿之后，t时刻相应电机实际的转角为：
θi(t)＝a(t)+Δθi(t)
其中，i＝1，2分别表示对支撑腿将要进行补偿的髋关节Y方向电机和踝关节Y方向电机，即Δθ1(t)表示t时刻支撑腿的髋关节Y方向电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节Y方向电机转角的补偿角。
如果不补偿，t时刻电机是按照现有技术预先规划好的角度a(t)旋转，这样仿人机器人容易左右倾斜。本发明实施例中，t时刻可以为任意时刻。本发明实施例通过对支撑腿的髋关节前后方向电机和踝关节前后方向电机的倾角进行补偿，可以有效地减小仿人机器人单脚支撑时左右倾斜的现象和由柔性误差所造成的非支撑脚倾斜着地的现象，提高了着地的稳定性。
以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
Claims (4)
1.一种防止仿人机器人左右倾斜的运动规划方法，其特征在于，包括以下步骤：
对支撑腿的髋关节的电机和踝关节的电机的转角分别设置一个补偿角度；
将所述支撑腿的髋关节的电机和踝关节的电机的转角规划角度上分别增加相应的所述补偿角度；
其中，所述髋关节的电机和踝关节的电机均为轴向沿仿人机器人前后方向的电机。
2.根据权利要求1所述的防止仿人机器人左右倾斜的运动规划方法，其特征在于，在仿人机器人运动的t时刻，所述补偿角度的大小为：
Δθi(t)＝Ki×(X_waist(t)-X_ankle(t))
其中，i＝1，2，Δθ1(t)表示t时刻支撑腿的髋关节的电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节的电机转角的补偿角；Ki＞0为补偿系数；X_waist(t)为t时刻仿人机器人腰部两髋关节连线中点的左右方向坐标；X_ankle(t)为t时刻仿人机器人支撑脚踝关节左右方向坐标。
3.防止仿人机器人左右倾斜的运动规划装置，其特征在于，包括：
设置补偿角度模块，用于对支撑腿的髋关节的电机和踝关节的电机转角分别设置一个补偿角度；
添加模块，用于将所述支撑腿的髋关节的电机和踝关节的电机的转角规划角度上分别增加相应的所述补偿角度；
其中，所述髋关节的电机和踝关节的电机均为轴向沿仿人机器人前后方向的电机。
4.根据权利要求3所述的防止仿人机器人左右倾斜的运动规划装置，其特征在于，在仿人机器人运动的t时刻，所述补偿角度的大小为：
Δθi(t)＝Ki×(X_waist(t)-X_ankle(t))
其中，i＝1，2，Δθ1(t)表示t时刻支撑腿的髋关节的电机转角的补偿角，Δθ2(t)表示t时刻支撑腿的踝关节的电机转角的补偿角；Ki＞0为补偿系数；X_waist(t)为t时刻仿人机器人腰部两髋关节连线中点的左右方向坐标；X_ankle(t)为t时刻仿人机器人支撑脚踝关节左右方向坐标。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN200810172220A CN100594460C (zh) | 2008-10-31 | 2008-10-31 | 防止仿人机器人左右倾斜的运动规划方法和装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN200810172220A CN100594460C (zh) | 2008-10-31 | 2008-10-31 | 防止仿人机器人左右倾斜的运动规划方法和装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN101441480A CN101441480A (zh) | 2009-05-27 |
| CN100594460C true CN100594460C (zh) | 2010-03-17 |
Family
ID=40725942
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN200810172220A Active CN100594460C (zh) | 2008-10-31 | 2008-10-31 | 防止仿人机器人左右倾斜的运动规划方法和装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN100594460C (zh) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102658548A (zh) * | 2012-05-04 | 2012-09-12 | 北京理工大学 | 防止仿人机器人前后倾斜的腰部运动规划方法和装置 |
| CN102896632A (zh) * | 2012-05-04 | 2013-01-30 | 北京理工大学 | 防止仿人机器人左右倾斜的腰部运动规划方法和装置 |
| CN109032142B (zh) * | 2018-08-14 | 2020-07-28 | 浙江大学 | 一种含腰部结构的双足机器人设计以及反馈控制方法 |
| CN110262510B (zh) * | 2019-07-11 | 2020-08-28 | 北京理工大学 | 一种降低行走能耗的仿人机器人质心轨迹规划方法 |
| CN112666939B (zh) * | 2020-12-09 | 2021-09-10 | 深圳先进技术研究院 | 一种基于深度强化学习的机器人路径规划算法 |
-
2008
- 2008-10-31 CN CN200810172220A patent/CN100594460C/zh active Active
Non-Patent Citations (6)
| Title |
|---|
| 仿人机器人踝侧摆的自调节模糊非线性控制研究. 赵建东等.机器人，第26卷第3期. 2004 |
| 仿人机器人踝侧摆的自调节模糊非线性控制研究. 赵建东等.机器人，第26卷第3期. 2004 * |
| 基于基本变量集的仿人机器人在线运动规划. 王剑等.***仿真学报，第20卷第6期. 2008 |
| 基于基本变量集的仿人机器人在线运动规划. 王剑等.***仿真学报，第20卷第6期. 2008 * |
| 欠驱动两足步行机器人测向稳定控制方法研究. 绳涛等.计算机工程与应用，第44卷第3期. 2008 |
| 欠驱动两足步行机器人测向稳定控制方法研究. 绳涛等.计算机工程与应用，第44卷第3期. 2008 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101441480A (zh) | 2009-05-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR101234726B1 (ko) | 다리식 이동 로봇 및 그 제어 프로그램 | |
| KR100843863B1 (ko) | 보행식 이동 로봇 및 그 제어 방법, 보행식 이동 로봇을위한 다리부 구조, 및 보행식 이동 로봇을 위한 가동 다리유닛 | |
| US9120512B2 (en) | Control device and gait generating device for bipedal mobile robot | |
| KR101112499B1 (ko) | 이동체의 제어장치 | |
| US8825213B2 (en) | Gait generating device for legged mobile robot and operational target generating device for robot | |
| JP5483997B2 (ja) | 脚式移動ロボットの制御装置 | |
| KR101131773B1 (ko) | 이동 로봇의 보용생성장치 | |
| KR101121020B1 (ko) | 이동 로봇의 보용생성 장치 | |
| KR101272193B1 (ko) | 다리식 이동 로봇 및 그 제어 프로그램 | |
| CN100594460C (zh) | 防止仿人机器人左右倾斜的运动规划方法和装置 | |
| KR101140810B1 (ko) | 이동로봇의 보용생성장치 | |
| KR20120134036A (ko) | 로봇 및 그 제어방법 | |
| JP2011093024A (ja) | 脚式移動ロボットの制御装置 | |
| CN102658548A (zh) | 防止仿人机器人前后倾斜的腰部运动规划方法和装置 | |
| CN101439738B (zh) | 防止仿人机器人前后倾斜的运动规划方法和装置 | |
| CN101751037A (zh) | 一种用于双足步行机器人的动态步行控制方法 | |
| CN101068662B (zh) | 腿式移动机器人及其控制方法 | |
| JP4492395B2 (ja) | 脚式ロボットとその動作制御方法 | |
| WO2004033160A1 (ja) | ロボット装置の動作制御装置及び動作制御方法 | |
| WO2022156476A1 (zh) | 一种仿人机器人连续动态稳定跳跃控制方法 | |
| JP3674779B2 (ja) | 脚式移動ロボットのための動作制御装置及び動作制御方法、並びにロボット装置 | |
| CN102896632A (zh) | 防止仿人机器人左右倾斜的腰部运动规划方法和装置 | |
| CN101408435A (zh) | 仿人机器人脚踝的运动规划方法和装置 | |
| JP5404543B2 (ja) | 脚式移動ロボットの制御装置 | |
| JP5232120B2 (ja) | 移動体の制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20170930 Address after: 100081, Beijing Haidian District Zhongguancun South Street 5, two, 204, a layer 114 Patentee after: BEIJING HARIBIT INTELLIGENT TECHNOLOGY Co.,Ltd. Address before: 100081 intelligent robot research institute, Institute of Aerospace Science, Beijing Institute of Technology, 5 South Avenue, Haidian District, Beijing, Zhongguancun Patentee before: BEIJING INSTITUTE OF TECHNOLOGY |
|
| TR01 | Transfer of patent right |