正在加载图片...
第5期 任杰,等:基于Hopf振荡器的六足机器人步态CPG模型设计 .629. 1.2正运动学分析 +cos(p+01)(L1+L2cos82+L3cos(02+83)) 根据齐次坐标变换原理,通过齐次变换,可将机 器人腿部基准坐标系∑0变换到躯干质心坐标 +sin(p+0,)(L,+L2c0s82+L3cos(02+03) 系∑c中,变换矩阵T。为 om-Lasine2 -L3sin(02+) T=Trans(之o)·Rot(z,p)(1) (4) 式中:(x,y。o六)为机器人腿部基坐标系到躯干 1.3六足机器人三角步态描述 质心坐标系的平移坐标值,φ为腿部基坐标系 步态指机器人的每条腿按一定顺序和轨迹的运 ∑0。到躯干质心坐标系∑c变换绕z轴的旋转角 动形式,包括通过调整迈步顺序和频率来调整身体 度。将表1中参数带入式(1)中,可以求得机器人 的位姿。 腿部基坐标系与躯干质心坐标系之间的关系。 步态周期T为机器人完成一次完整步态所需 表1基坐标系到躯干质心坐标系变换参数 Table 1 Transformation parameters of base coordinates to 要的时间。机器人单腿的迈步幅度称为步长。占空 geocentric coordinate system 比为单腿在一个步态周期内,处于支撑相的时间在 关节参数12 6 整个步态周期中所占比例,用字母y表示。 34 5 六足机器人步态通常按照与地面接触脚的数目 x..cm 8.810.58.8-8.8-10.5-8.8 来划分。常见有三角步态、跟导步态和波动步态。 y..cm -12.5012.5-12.50 12.5 三角步态是昆虫稳定行走时速度最快的一种步态。 o.cm 00000 0 图3为一个步行周期内六足机器人的三角步态支撑 P/ -135180135-45 0 相与摆动相示意图。白色表示摆动相,黑色阴影表 机器人右侧腿部机构D-H参数如表2所示,0 示支撑相,腿1、腿3、腿5为一组,腿2、腿4、腿6为 表示第i个关节的转动角度。左侧腿D-H参数,除 一组,同组腿相位相同,异组腿相位相差π。机器人 α1=-π2,其他参数与右侧腿一致,均保持不变。 行走时占空比分为3种情形:1)y=0.5,即每条腿的 表2右侧腿部机构D-H参数表 支撑与摆动时间相等,一组腿支撑,另一组腿摆动 Table 2 D-H parameters of the right legs (见图3(a);2)y>0.5,即每条腿支撑时间大于摆 ∑ 动时间,6条腿出现同时着地的情况(见图3(b)), a-1 Qi-1 此种情况下,机器人稳定性较高,但速度较慢;3)γ< ∑,∑m11 0 0 0.5,即每条腿支撑时间小于摆动相时间,6条腿出 现同时悬空状况(见图3(c)),显然,这一情况机器 ∑、∑2 π/2 0 人速度快但稳定性欠佳。占空比对爬行速度有直接 ∑0,、∑,3 L 0 0 影响。本文选择占空比为0.5的三角步态作为研究 对象。 ∑∑a 4 L 0 根据D-H坐标变换法[o,机器人足端点坐标 组2 系∑0,在躯干质心坐标系∑c中的位姿为 0 T/2T 0T/2T 07/2T T=T。0T·0aT0T30T。 (a)y=0.5 (b)y>0.5 (c)y<0.5 图3六足机器人三角步态支撑相与摆动相示意图 (2) Fig.3 Supporting and swinging phases of hexapod ro- 可求得右侧腿的运动学正解为 bot's tripod gait ,+cos(e+8)(L+Lc0s6,+Lcos(8,+6,) 2 CPG振荡器网络模型与仿真 +sin(9+01)(L1+L,cos82+Lcos(82+03))】 2.1CPG振荡器模型 。+Lsin92+L3sin(02+0,) 中枢模式发生器(central pattern generator,CPG) 是一种离散神经网络,能够产生复杂的高维信号控制 (3) 左侧腿的运动学正解为 动物的节律运动回。机器人学上,CPG通常被看作 耦合动态系统,即非线性振荡器模型。CG神经元的1.2 正运动学分析 根据齐次坐标变换原理,通过齐次变换,可将机 器人腿部基准坐标系 ∑om0 变换到躯干质心坐标 系 ∑c 中,变换矩阵 cTomo 为 cTomo = Trans(xom0 ,yom0 ,zom0 )·Rot(z,φ) (1) 式中:(xom0 ,yom0 ,zom0 )为机器人腿部基坐标系到躯干 质心坐 标 系 的 平 移 坐 标 值, φ 为 腿 部 基 坐 标 系 ∑om0 到躯干质心坐标系 ∑c 变换绕 z 轴的旋转角 度。 将表 1 中参数带入式(1) 中,可以求得机器人 腿部基坐标系与躯干质心坐标系之间的关系。 表 1 基坐标系到躯干质心坐标系变换参数 Table 1 Transformation parameters of base coordinates to geocentric coordinate system 关节参数 1 2 3 4 5 6 xom0 / cm 8.8 10.5 8.8 -8.8 -10.5 -8.8 yom0 / cm -12.5 0 12.5 -12.5 0 12.5 zom0 / cm 0 0 0 0 0 0 φ/ ° -135 180 135 -45 0 45 机器人右侧腿部机构 D⁃H 参数如表 2 所示,θi 表示第 i 个关节的转动角度。 左侧腿 D⁃H 参数,除 a1 = -π /2,其他参数与右侧腿一致,均保持不变。 表 2 右侧腿部机构 D⁃H 参数表 Table 2 D⁃H parameters of the right legs ∑ i ai-1 αi-1 di θi ∑om0 、∑om1 1 0 0 0 θ1 ∑om1 、∑om2 2 L1 p/2 0 θ2 ∑om2 、∑om3 3 L2 0 0 θ3 ∑om3 、∑om4 4 L3 0 0 0 根据 D⁃H 坐标变换法[10] ,机器人足端点坐标 系 ∑om4 在躯干质心坐标系 ∑c 中的位姿为 cTom4 = cTom0 ·om0 Tom1 ·om1 Tom2 ·om2 Tom3 ·om3 Tom4 (2) 可求得右侧腿的运动学正解为 xom4 yom4 zom4 é ë ê ê ê ê ê ù û ú ú ú ú ú = xom0 + cos(φ + θ1)(L1 + L2 cosθ2 + L3 cos(θ2 + θ3)) yom0 + sin(φ + θ1)(L1 + L2 cosθ2 + L3 cos(θ2 + θ3)) zom0 + L2 sinθ2 + L3 sin(θ2 + θ3 ) é ë ê ê ê ê ê ù û ú ú ú ú ú (3) 左侧腿的运动学正解为 xom4 yom4 zom4 é ë ê ê ê ê ê ù û ú ú ú ú ú = xom0 + cos(φ + θ1)(L1 + L2 cosθ2 + L3 cos(θ2 + θ3)) yom0 + sin(φ + θ1)(L1 + L2 cosθ2 + L3 cos(θ2 + θ3)) zom0 - L2 sinθ2 - L3 sin(θ2 + θ3 ) é ë ê ê ê ê ê ù û ú ú ú ú ú (4) 1.3 六足机器人三角步态描述 步态指机器人的每条腿按一定顺序和轨迹的运 动形式,包括通过调整迈步顺序和频率来调整身体 的位姿[11] 。 步态周期 T 为机器人完成一次完整步态所需 要的时间。 机器人单腿的迈步幅度称为步长。 占空 比为单腿在一个步态周期内,处于支撑相的时间在 整个步态周期中所占比例,用字母 γ 表示。 六足机器人步态通常按照与地面接触脚的数目 来划分。 常见有三角步态、跟导步态和波动步态。 三角步态是昆虫稳定行走时速度最快的一种步态。 图 3 为一个步行周期内六足机器人的三角步态支撑 相与摆动相示意图。 白色表示摆动相,黑色阴影表 示支撑相,腿 1、腿 3、腿 5 为一组,腿 2、腿 4、腿 6 为 一组,同组腿相位相同,异组腿相位相差 π。 机器人 行走时占空比分为 3 种情形:1)γ = 0.5,即每条腿的 支撑与摆动时间相等,一组腿支撑,另一组腿摆动 (见图 3(a));2) γ>0.5,即每条腿支撑时间大于摆 动时间,6 条腿出现同时着地的情况(见图 3( b)), 此种情况下,机器人稳定性较高,但速度较慢;3)γ< 0.5,即每条腿支撑时间小于摆动相时间,6 条腿出 现同时悬空状况(见图 3(c)),显然,这一情况机器 人速度快但稳定性欠佳。 占空比对爬行速度有直接 影响。 本文选择占空比为 0.5 的三角步态作为研究 对象。 图 3 六足机器人三角步态支撑相与摆动相示意图 Fig.3 Supporting and swinging phases of hexapod ro⁃ bot’s tripod gait 2 CPG 振荡器网络模型与仿真 2.1 CPG 振荡器模型 中枢模式发生器(central pattern generator, CPG) 是一种离散神经网络,能够产生复杂的高维信号控制 动物的节律运动[12] 。 机器人学上,CPG 通常被看作 耦合动态系统,即非线性振荡器模型。 CPG 神经元的 第 5 期 任杰,等:基于 Hopf 振荡器的六足机器人步态 CPG 模型设计 ·629·
<<向上翻页向下翻页>>
©2008-现在 cucdc.com 高等教育资讯网 版权所有