没有合适的资源?快使用搜索试试~ 我知道了~
2007年全国研究生数学建模竞赛优秀论文选-机械臂运动路径设计问题1 - 副本.pdf
1.该资源内容由用户上传,如若侵权请联系客服进行举报
2.虚拟产品一经售出概不退款(资源遇到问题,请及时私信上传者)
2.虚拟产品一经售出概不退款(资源遇到问题,请及时私信上传者)
版权申诉
0 下载量 147 浏览量
2024-03-18
14:14:14
上传
评论
收藏 405KB PDF 举报
温馨提示
试读
22页
华为杯数学竞赛获奖论文,历届,研究生数学,内容丰富,大学生数学,数学竞赛,参考资料,极具参考价值
资源推荐
资源详情
资源评论
1
机械臂运动路径设计问题
1.问题的简述
机器人最主要的操作机构是各种形态的机械臂,机械臂的动作形态是是由三种不同的单位动作
——旋转、回转、伸缩组合而成的。旋转或回转是指机械臂产生相对转动,两者的不同仅在于转动
部件的轴线与转动轴线是否同轴
[1]
。旋转如笔帽的转动,回转如摇柄的转动,伸缩指机械臂产生直
线运动,引进伸缩动作,运动范围可以得到扩大。机器人机械手具有的独立的单位动作组合数称之
为自由度。一个物体在三维空间中的位置和姿态分别需要三个独立的坐标才能得到确定。所以,能
使手爪达到任意空间位置并具有任意姿态的机械手最少需要六个自由度。自由度是表达机器人通用
性、灵活性的主要指标,自由度越多,机械臂越灵活,可达的空间更广泛。当然自由度越多,机械
结构越复杂,从而控制也越困难。
本文所研究的六自由度的机器臂的简化图如图(1):
图(1)
自由度一、四、六,对应于图中的 F,G,H 点为旋转关节,自由度二、三、五,对应
的图中的 B,C,D 点为回转关节。每一个关节对应一个角度
i
,这个角度表示前一个连杆方
向到后一个连杆方向转角(对于 B,C,D),连杆方向为 AB
、
BC
、
CD
、
DE
,
或者相对于初
始位置的转角(对于 F,G,H),假设机器人的初始位置是在一个平面上的(y-z 平面)。
为了使机器人运动得更加灵活,允许关节的转角超过 360°。
机器人关于六个自由度的每一个组合
),,,,,(
654321
,表示机械臂的一个姿态,显
然每个姿态确定顶端指尖的空间位置 X:
Xf
)(
。假定机器人控制系统只能够接收改变各个关
节的姿态的关于连杆角度的增量指令(机器指令)
),,,,,(
654321
P
,使
得指尖(图 2 中的 E 点)移动到空间点 X′,通过一系列的指令序列
n
PPPP ,,,,
321
可以将指尖依
2
次到达位置 X
0
,X
1
,┅,X
n
,则称 X
0
,X
1
,┅,X
n
为从指尖初始位置 X
0
到达目标位置 X
n
的一条路
径(运动轨迹)。
根据具体的目标和约束条件计算出合理、便捷、有效的指令序列是机器人控制中的一个重要问
题。本文就是对这个问题进行讨论。其中 AB=140mm,BC=255mm,CD=255mm,DE=65mm,
各个增量
i
只能取到-2, -1.9, -1.8, ┅,1.8, 1.9, 2 这 41 个离散值(即精度为 0.1°,绝对值不超过
2°)。讨论问题如下:
①.已知初始姿态 Φ
0
和一个可达目标点的空间位置(O
x
, O
y
, O
z
),计算指尖到达目标点
的指令序列。
②.要求指尖沿着预先指定的一条空间曲线 x = x(s), y = y(s), z = z(s), a ≦ s ≦b 移动,计
算满足要求的指令序列。
③.在第①个问题中,假设在初始位置与目标位置之间的区域中有若干个已知大小、形
状、方向和位置的障碍物,要求机械臂在运动中始终不能与障碍物相碰,否则会损坏机器。
这个问题称机械臂避碰问题,要求机械臂末端在误差范围内到达目标点并且整个机械臂不碰
到障碍物。
应用所讨论的算法就下面具体的数据给出计算结果: 假设在机械臂的旁边有一个待加工
的中空圆台形工件,上部开口。工件高 180mm,下底外半径 168mm,上底外半径 96mm,壁
厚 8mm。竖立地固定在 xy-平面的操作台上,底部的中心在 (210, 0, 0)。
①.要求机械臂(指尖)从初始位置移动到工具箱所在位置的 (20,-200, 120) 处,以夹
取要用的工具。
②.如果圆台形工件外表面与平面 x = 2 z 的交线是一条裂纹需要焊接,请你给出机械
臂指尖绕这条曲线一周的指令序列。
③.有一项任务是在工件内壁点焊四个小零件,它们在内表面上的位置到 xy 平面的投影
为(320,-104)、(120,106)、(190,-125)和(255,88)。要求机械臂从圆台的上部开口处伸
进去到达这些点进行加工,为简捷起见,不妨不计焊条等的长度,只考虑指尖的轨迹。
2.问题的分析
机械臂的运动属于运动学的范畴。运动学研究旨在解决机器人的手臂转向何方。机械臂的运动
学要研究两个问题:运动学正问题———已知各关节位移变量的值,要求机械臂指尖在空间的位置
和姿态,这实际上是建立运动学方程的过程;运动学逆问题——— 指定指尖的空间位置和姿态,
要求出各关节位移变量的相应值,这实际上是求解运动学的过程。
本文中的问题属于运动学逆问题,即已知初始状态求机械臂指尖到达目标点或者沿一定的轨迹
曲线到达目标点的指令序列。运动学逆问题直接求解较困难。本文设计几何算法和牛顿迭代法求解
自由空间中机械臂的运动逆问题。
3
3.符号约定与模型假设
为简化问题,作如下假设:机械臂连杆的粗细忽略不计。
全文符号约定如下:
),,,,,()(
654321
ff
: 指尖任意姿态:
)(
0
f
0 0 0 0 0 0
1 2 3 4 5 6
, , , , ,f
: 初始姿态:
( )
f
1 2 3 4 5 6
, , , , ,
f
: 最终达到的姿态:
d
: 机械臂指尖最终达到的位置与目标点之间的距离
4.自由空间中机械臂运动逆问题的求解模型
4.1 机械臂指尖坐标公式求解
对机械臂在空间运动的描述离不开各关节的坐标,因此须首先求出各关节的坐标。
首先,建立直角坐标系。原点设在图(1)中的 A 点。z 轴与 AB 重合,正向与 AB 方向一
致。x 轴垂直纸面,正向向外。y 轴在基座所在的水平面上,正向向右。如图(2)所示:
图(2)
对角度方向作如下约定:机械臂的关节旋转时,约定顺时针方向为负。坐标系变换时,约定顺
时针方向为正。假设
FB
相对于
AF
的旋转角为
1
,
DH
到
BC
的回转角为
2
,
BC
到
CD
的回
A
B
z
E
H
C
3
5
2
y
x
y
’
z’
F
G
D
4
转角为
3
,
GD
相对于
CG
的旋转角为
4
,
CD
到
DE
的回转角为
5
,
HE
相对于
DH
的旋转角
为
6
,由于
6
控制手指的转动,用于操纵工具,它不影响机械臂指尖的定位问题,因此,本文不
考虑
6
对问题的影响。
4.1.1 A、B、C、D 坐标的确定
由于 A、B、C、D 点在同一平面上,易知 A、B、C、D 点坐标为:
A:
0
A
x
0
A
y
0
A
z
B:
0
B
x
0
B
y
140
B
z
C:
2 1
sin( )sin
C
x BC
,
2 1
sin( ) cos
C
y BC
2
cos( )
C
z BC AB
D:
2 3 2 1
[ sin( ) sin( )]sin
D
x CD BC
2 3 2 1
[ sin( ) sin( )]cos
D
y CD BC
2 2 3
[ cos( ) cos( )] 140
D
z BC CD
4.1.2 E 点坐标
由于 E 点与上述 A、B、C、D 点异面,所以直接在此坐标系下求 E 的坐标比较困难。因
此,我们在 D 点建立新坐标系,求得 E 点在新坐标系下的坐标后,再变换到原坐标系,得到
E 点在原坐标系下的坐标公式。
建立新坐标系
' ' '
Dx y z
:以 D 为原点,以
CD
为
'
y
轴,正向与
CD
方向一致。
'
x
轴垂直于
平面 yoz,正向向外。垂直于
CD
的方向定义为
'
z
轴,轴
'
x
、
'
y
、
'
z
的方向满足右手准则。
将 Axyz 坐标系变换到
' ' '
Dx y z
坐标系,可分为三步:(1)将原点平移到 D;(2)将 yAz
平面绕 x 轴旋转(
2 3
2
),得到
'' '' ''
Dx y z
坐标系;(3) 将
'' '' ''
Dx y z
坐标系绕 z 轴旋转
1
,得到新坐标系
' ' '
Dx y z
。于是得到坐标变换公式:
1 2
[ ' ' ']
E E E E E E
x y z x y z TT
+
D D D
x y z
(1)
其中:
5
2 2 3 2 3
2 3 2 3
cos 0 cos cos
2 2
cos cos( ) cos( )
2 2
cos cos( ) cos( )
2 2
T
1 1
1 1 1
cos cos( ) cos
2 2
cos( ) cos( ) cos
2 2
cos cos( ) cos 0
2 2
T
机器臂指尖 E 点在新坐标系下的坐标为:
4 5
' 65sin sin
E
x
5
' 65 cos
E
y
5 4
' 65sin cos
E
z
。
由式(1)可得 E 点在原坐标系下的坐标为:
1 2 2 3 1 4 5
sin [ 255sin 255sin( )] 65cos sin sin
E
x
1 5 2 3 2 3 4 5
sin [ 65cos sin( ) 65cos( ) cos sin ]
E 1 2 2 3 1 4 5
cos [ 255sin 255sin( )] 65sin sin sin
y
1 5 2 3 2 3 4 5
cos [ 65cos sin( ) 65cos( ) cos sin ]
2 2 3 2 3 5
140 255cos 255cos( ) 65cos( ) cos
E
z
4 2 3 5
65cos sin( ) sin
4.2 几何算法
从初始状态
)(
0
f
出发,为了到达自由空间中任一目标点 Q
QQQ
zyx ,,
,机械臂先快速的接
近该点,再通过对机械臂微调更精确接近目标点,微调的准则为:使机械臂指尖最终达到位置与目
标点之间的距离
d
最小。
在自由空间中,可以令
0
4
。机械臂精确定位算法如下:
(1) 求机械臂指尖 E 最接近目标 Q 的位置
机械臂的初始状态如图(3):
剩余21页未读,继续阅读
资源评论
阿拉伯梳子
- 粉丝: 1656
- 资源: 5735
上传资源 快速赚钱
- 我的内容管理 展开
- 我的资源 快来上传第一个资源
- 我的收益 登录查看自己的收益
- 我的积分 登录查看自己的积分
- 我的C币 登录后查看C币余额
- 我的收藏
- 我的下载
- 下载帮助
安全验证
文档复制为VIP权益,开通VIP直接复制
信息提交成功