移动机器人-控制科学与工程学院-浙江大学
相关主题
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
– – – – 轮子半径为 r 轮子到两轮中间中点P的距离为 l 两个轮子的旋转速度分别为 1 ,2 若 r , l , ,1 ,2 已知，则机器人在全局坐标系下的速度
xI I yI f l , r , ,1 , 2 I
与机械臂的运动学模型 不同，轮式移动机器人 的模型为速度空间之间 的关系，类似于机械臂 的Jacobian
R R I
I R R
1
关键在求局部坐标系下各轮的贡献
12
• 机器人沿+XR方向移动，其运动是每 个轮子的旋转速度对P点作用的叠加
– 对P点在XR方向平移速度的作用
• 一个旋转，一个静止
xR (1/ 2)r1或xR (1/ 2)r2
• 同时旋转 xR r1 / 2＋r2 / 2
cos( )
sin( ) d l sin R( ) I d 0
– 机械臂：机械臂末端执行器可能到达位置的范围 – 移动机器人：机器人在环境中可以到达的可能姿态的范围
• 可控性
– 机械臂：在工作空间中实现从一个位姿移动到另一个位姿的 控制方式 – 移动机器人：在工作空间中的可能路径和轨迹
• 动力学的约束和影响
9
移动机器人运动学
• 主要内容
– 运动学模型和约束
• • • • • 机器人位置表示 前向运动模型 轮子的运动学约束 机器人运动学约束 基于约束的运动学建模
差动驱动机器人的运动学模型 13
轮子的运动学约束
• 假设
– 轮子的平面始终保持竖直，以及在所有情况下，轮子 和地面都只有一个接触点 – 轮子与地面在接触点上没有打滑，即轮子仅仅在纯转 动下运动，并通过接触点绕垂直轴旋转
• 轮子存在的约束
– 滚动约束，即轮子在相应方向发生运动时必须转动 – 无侧滑，即轮子不能在垂直于轮子平面的方向发生滑 动
5
轮式移动机器人
• Swedish轮
3个自由度： 绕轮子主轴转动 绕滚子轴心转动 绕轮子和地面的接触点转动
45度Swedish轮
90度Swedish轮
连续切换轮 振动较小
6
存在不连续振动
轮式障碍翻越
仅依靠摩擦力 改变重心 自适应悬挂机制
7
移动机器人运动学
8
移动机器人运动学
• 运动学：研究机械系统的运动方式，是实现机器人运 动控制的基础 • 工作空间：
– 移动机器人的工作空间
• 工作空间的概念 • 完整性 • 路径和轨迹
– 运动控制
运动作用 运动约束
10
机器人位置表示
• 机器人：
– 刚体，忽略内部和轮子的关节和自由度 – 在水平面上运动，总维数为3
• 坐标系定义
– 平面全局坐标系
• 机器人姿态 I x, y,
T
– 机器人局部坐标系
sin( ) cos( )
cos( ) (l )cos R( ) I r 0 sin( ) l sin R( ) I 0
16
无侧滑约束
转向标准轮
• 转向标准轮比固定标准轮多一 个自由度，即轮子可能绕着穿 过轮子中心和地面接触点的垂 直轴旋转
3
四种基本轮子类型
• a)标准轮
– 几个自由度？
• 轮轴 • 地面接触点
• b)小脚轮
– 几个自由度？
• 轮轴 • 地面接触点 • 结合点
4
四种基本轮子类型
• c)瑞典轮
– 几个自由度？
• 轮轴 • 辊轴 • 地面接触点
• d)球形轮
– 几个自由度？
• 地面接触点 • 底盘平面上自由运动
有动力的球形轮的悬挂系统技术上实现困难， 一般类似于具有动力的机械鼠标
滚动约束
sin( )
无侧滑约束
cos( ) (l )cos R( ) I r 0 sin( ) l sin R( ) I 0
cos( )
转向位置的变化 对机器人当前的运动约束没有直接影响， 它对运动的影响需通过时间积分表现出来，影响车的活动性 17
– 对P点在YR方向平移速度的作用 y 0 I R( ) 1 R – 对P点旋转分量的作用
R百度文库
• 仅右轮向前旋转，P点以左轮为中心 逆时针旋转，旋转速度为 r 2l • 仅左轮向前旋转，P点以右轮为中心 顺时针旋转，旋转速度为 r 2l
1 1 2 2
r1 r 2 2 2 1 R( ) 0 r1 r 2 2 l 2 l
14
固定标准轮
• 没有可操纵的垂直转动轴，对底盘的角度固定， 只能沿着轮平面后退或者前进，并绕着地面接触 点旋转
机器人坐标系下，固定标准轮A的位姿用极坐标表示(l , ) 轮平面相对于底盘的角度为 ，固定
15
固定标准轮
• 约束：
– 沿轮子平面运动 为轮子的转动 – 沿正交于轮子平 面的运动为零 滚动约束
R R I
xR xI y R( ) y R I R I
cos R( ) sin 0
sin cos 0
0 0 1
11
前向运动模型
• 差动驱动移动机器人
小脚轮
• 可以绕着垂直轴转向，但其 旋转垂直轴并不通过地面接 触点，需附加一个参数d
滚动约束(旋转垂直轴的偏移对平行于轮平面的运动不起作用)
sin( )
无侧滑约束
cos( ) (l )cos R( ) I r 0
轮子上的侧向力发生在A点，相对于A点的地面接触 点的偏移使得侧向移动为零的约束不再成立，要求 通过一个等量而相反的转向运动进行平衡
移动机器人
轮式移动机器人
浙江大学控制科学与工程学院
轮式移动机器人
2
轮式移动机器人
• 轮子在移动机器人中最常用 • 三个轮子的移动机器人能够保证稳定平衡 • 当轮子多于三个时，需要悬挂系统保证所有轮子 与地面接触 • 轮子的个数选择依赖于应用 • 轮式机器人的重点在牵引、稳定性、机动性和控 制，平衡性不是主要问题。
xI I yI f l , r , ,1 , 2 I
与机械臂的运动学模型 不同，轮式移动机器人 的模型为速度空间之间 的关系，类似于机械臂 的Jacobian
R R I
I R R
1
关键在求局部坐标系下各轮的贡献
12
• 机器人沿+XR方向移动，其运动是每 个轮子的旋转速度对P点作用的叠加
– 对P点在XR方向平移速度的作用
• 一个旋转，一个静止
xR (1/ 2)r1或xR (1/ 2)r2
• 同时旋转 xR r1 / 2＋r2 / 2
cos( )
sin( ) d l sin R( ) I d 0
– 机械臂：机械臂末端执行器可能到达位置的范围 – 移动机器人：机器人在环境中可以到达的可能姿态的范围
• 可控性
– 机械臂：在工作空间中实现从一个位姿移动到另一个位姿的 控制方式 – 移动机器人：在工作空间中的可能路径和轨迹
• 动力学的约束和影响
9
移动机器人运动学
• 主要内容
– 运动学模型和约束
• • • • • 机器人位置表示 前向运动模型 轮子的运动学约束 机器人运动学约束 基于约束的运动学建模
差动驱动机器人的运动学模型 13
轮子的运动学约束
• 假设
– 轮子的平面始终保持竖直，以及在所有情况下，轮子 和地面都只有一个接触点 – 轮子与地面在接触点上没有打滑，即轮子仅仅在纯转 动下运动，并通过接触点绕垂直轴旋转
• 轮子存在的约束
– 滚动约束，即轮子在相应方向发生运动时必须转动 – 无侧滑，即轮子不能在垂直于轮子平面的方向发生滑 动
5
轮式移动机器人
• Swedish轮
3个自由度： 绕轮子主轴转动 绕滚子轴心转动 绕轮子和地面的接触点转动
45度Swedish轮
90度Swedish轮
连续切换轮 振动较小
6
存在不连续振动
轮式障碍翻越
仅依靠摩擦力 改变重心 自适应悬挂机制
7
移动机器人运动学
8
移动机器人运动学
• 运动学：研究机械系统的运动方式，是实现机器人运 动控制的基础 • 工作空间：
– 移动机器人的工作空间
• 工作空间的概念 • 完整性 • 路径和轨迹
– 运动控制
运动作用 运动约束
10
机器人位置表示
• 机器人：
– 刚体，忽略内部和轮子的关节和自由度 – 在水平面上运动，总维数为3
• 坐标系定义
– 平面全局坐标系
• 机器人姿态 I x, y,
T
– 机器人局部坐标系
sin( ) cos( )
cos( ) (l )cos R( ) I r 0 sin( ) l sin R( ) I 0
16
无侧滑约束
转向标准轮
• 转向标准轮比固定标准轮多一 个自由度，即轮子可能绕着穿 过轮子中心和地面接触点的垂 直轴旋转
3
四种基本轮子类型
• a)标准轮
– 几个自由度？
• 轮轴 • 地面接触点
• b)小脚轮
– 几个自由度？
• 轮轴 • 地面接触点 • 结合点
4
四种基本轮子类型
• c)瑞典轮
– 几个自由度？
• 轮轴 • 辊轴 • 地面接触点
• d)球形轮
– 几个自由度？
• 地面接触点 • 底盘平面上自由运动
有动力的球形轮的悬挂系统技术上实现困难， 一般类似于具有动力的机械鼠标
滚动约束
sin( )
无侧滑约束
cos( ) (l )cos R( ) I r 0 sin( ) l sin R( ) I 0
cos( )
转向位置的变化 对机器人当前的运动约束没有直接影响， 它对运动的影响需通过时间积分表现出来，影响车的活动性 17
– 对P点在YR方向平移速度的作用 y 0 I R( ) 1 R – 对P点旋转分量的作用
R百度文库
• 仅右轮向前旋转，P点以左轮为中心 逆时针旋转，旋转速度为 r 2l • 仅左轮向前旋转，P点以右轮为中心 顺时针旋转，旋转速度为 r 2l
1 1 2 2
r1 r 2 2 2 1 R( ) 0 r1 r 2 2 l 2 l
14
固定标准轮
• 没有可操纵的垂直转动轴，对底盘的角度固定， 只能沿着轮平面后退或者前进，并绕着地面接触 点旋转
机器人坐标系下，固定标准轮A的位姿用极坐标表示(l , ) 轮平面相对于底盘的角度为 ，固定
15
固定标准轮
• 约束：
– 沿轮子平面运动 为轮子的转动 – 沿正交于轮子平 面的运动为零 滚动约束
R R I
xR xI y R( ) y R I R I
cos R( ) sin 0
sin cos 0
0 0 1
11
前向运动模型
• 差动驱动移动机器人
小脚轮
• 可以绕着垂直轴转向，但其 旋转垂直轴并不通过地面接 触点，需附加一个参数d
滚动约束(旋转垂直轴的偏移对平行于轮平面的运动不起作用)
sin( )
无侧滑约束
cos( ) (l )cos R( ) I r 0
轮子上的侧向力发生在A点，相对于A点的地面接触 点的偏移使得侧向移动为零的约束不再成立，要求 通过一个等量而相反的转向运动进行平衡
移动机器人
轮式移动机器人
浙江大学控制科学与工程学院
轮式移动机器人
2
轮式移动机器人
• 轮子在移动机器人中最常用 • 三个轮子的移动机器人能够保证稳定平衡 • 当轮子多于三个时，需要悬挂系统保证所有轮子 与地面接触 • 轮子的个数选择依赖于应用 • 轮式机器人的重点在牵引、稳定性、机动性和控 制，平衡性不是主要问题。