当前位置:
文档之家› 机器人学-第3章_机器人运动学
机器人学-第3章_机器人运动学
o
X
由(3-1)式可得运动学约束条件,x&sinq y&cosq 0 平面轮式移动机器人
是所谓的“非完整约束”。物理含义是,机器人不能沿轮轴线方向横移。
设轮距为D,轮半径为r,两轮独立驱动时轮子转速wL,wR 则
v
r 2
wR
wL
,
w
r D
wR
wL
(3-2)
1
v
r 2
wR
wL
,
w
r D
wR
wL
q2 L1
定义参考坐标系{0},它固定在基座上,当第一
个关节变量(q1)为0时坐标系{1}与坐标系{0}重合
,因此建立参考坐标系{0}如图所示,Z0轴与关节1 的轴线重合且垂直于机械臂所在平面。
q1
平面3R机械臂
由于机械臂位于一个平面上,因此所有Z轴相互平
X3
行,且连杆偏距d和连杆转角均为0。该机械臂的DH
动距离分别为lR = rR和lL = rL,
机器人移动距离
l=(lR+lL)/2
方位角变化
q =(lR-lL)/D。
第n步机器人位姿可以按下面公式更新:
qn qn1 q
xn
xn1
l
cos qn1
q
/
2
yn
yn1
l
sin qn1
q
/
2
若已知机器人的初始位姿,根据该递推公式可以确定任意时刻机器
人位姿,比较简单,但因积累误差大,所以长时间不可靠。
相邻连杆间坐标变换公式
建立 {P}、{Q}和{R}3个中间坐标系, 其中{i}和{i-1}是固定在连杆 i 和 i-1 上的固 连坐标系,如图3-13所示。
连杆 i-1 Zi
ZP
Xi ai
di ZQ XQ
ZR
qi
Zi-1
Xi-1XR ai-1
XP
i-1
1. 绕 Xi-1 轴旋转 i-1角
图3-13中间坐标系选择示意图
参数如表3-1所示。
表3-1 3R机械臂DH参数
Y3
Y2
X2
Y0
i
i-1
ai-1
di
qi
Y1
X1
1
0
0
0
q1
X0
2
0
L1
0
q2
连杆坐标系布局
3
0
L2
0
q3
12
轴i θi
空间机械臂运动学
轴 i-1
θi-1
本节将导出相邻连杆间坐标系变换的一 般形式,然后将这些独立的变换联系起来 求出连杆n相对连杆0的位置和姿态。
杆参数的定义:
连杆长度,连杆两端关节轴线间 公垂线的长度
连杆转角,过关节轴i-1做垂直 于公垂线的平面,在该平面内 做过垂足且平行于关节轴i 的直 线。该直线与关节轴i-1的夹角 定义为连杆转角。
连杆转角只在 两个关节轴为 空间异面直线 的情况有意义
ai
di qi
ai-1
i-1 连杆描述
连杆偏距,关节轴i与相邻关节转轴(i-1和i+1) 公垂线间距离称为连杆偏距
逆运动学的解一般不唯一,显然图中机械臂关于OB轴对称的位置也 是逆运动学问题的一个解。
空间机械臂连杆描述
机械臂可以看成一系列刚体通过关节连接而成的链式运动机构。 一般把这些刚体称为连杆,通过关节将相邻的连杆连接起来。旋转关 节和移动关节是机械臂设计中经常采用的单自由度关节。
称基座为连杆0。第一个可移动连杆为连杆1,机械臂的最末端连
采用矢量表示为 r = f(q )
式中f 表示矢量函数,r =[x,y]T,q=[q1, q2]T。 从关节变量q 求手爪位置 r 称为正运动学,
反之,从手爪位置r求关节变量q 称为逆运动学。
5
逆运动学公式:
△OAB中 可以根据余弦定理确定
arccos [L12 L22 (x2 y2)] / 2L1L2
Z2
a2=L2 2=0 q2=90o d2=-L1
轴i θi
连杆 i-1
Zi Yi
Yi-1
di
Xi ai
ai-1
qi
Zi-1
Xi-1 i-1
坐标系{i}选择示意图
L1
L2
11
q3
L3
L2
例3-1 如图3-9所示的平面三连杆机械臂,因为三个 关节均为旋转关节,称为RRR(或3R)机构。请在 该机构上建立连杆坐标系并写出DH参数。
因为所有变换都是相对于动坐标系的,所 以坐标系{i}和{i-1}之间的变换矩阵为:
i i
1T
= Rot(x,i-1)Trans(ai-1,0,0)Rot(z,qi)Trans(0,0,di)
13
其中各独立变换矩阵如下:
Rot(x,i-1)Trans(ai-1,0,0)Rot(z,qi)Trans(0,0,di)
因此,可以得到 q2 = -
q1+β和β都可计算,因此q1也是可以计算的。
tan q1 y / x , tan L2 sinq2 /(L1 L2 cosq2)
平面机械臂简图
因此,q1 atan y / x atan y / x atanL2 sinq2 /(L1 L2 cosq2)
关节角,两相邻连杆绕公共轴线旋转的角度称为关节角。
7
机器人的每个连杆都可以用以上四个参数描述,其中连杆长度和连杆转 角描述连杆本身,连杆偏距和关节角描述连杆之间的连接关系。
对于转动关节,qi为关节变量,其它三个参数是常数;对于移动关节,di
为关节变量,其它三个参数是常数。
这种用连杆参数描述机构运动学关系的规则称为(Devanit-Hartenberg) DH方法,连杆参数称为DH参数。 对于一个6关节机器人,需要18个参数就可以完全描述机械臂固定的运动学结
若ai =0,两Z轴相交,则选Xi垂于Zi和Zi+1 ,坐标系{i}的选择不是唯一的。
9
轴i θi
轴 i-1
连杆坐标系中连杆参数确定
θi-1
连杆 i-1
DH参数按以下方法确定:
Zi
ai =沿Xi轴,从Zi移动到Zi+1的距离;
Yi
i =绕Xi轴,从Zi旋转到Zi+1的角度;
di =沿Zi轴,从Xi-1移动到Xi的距离;
8
轴i
θi
轴 i-1
连杆 i
固连在基座上的坐标系称为坐标系
θi-1
连杆 i-1
{0}。该坐标系在机械臂运动过程中保
持固定,因此在研究机械臂运动学问
题时一般把坐标系{0}选为参考系,用
来描述其它连杆坐标系的位置。 ai
原则上参考系{0}可以任意设定,
di
但为了简化描述,通常设定Z0轴沿关 节轴1的方向,并且关节1的关节变量
{i-1} {R},对应变换Rot(x, i-1 );
2. 沿 XR轴平移 ai-1 {R} {Q},对应变换Trans(ai-1 ,0,0);
4. 沿 ZP 轴平移 di {P} {i},对应变换Trans(0 ,0, di)
3. 绕 ZQ轴旋转 qi 角 {Q} {P},对应变换Rot(z, qi )
qi ai-1
为0时参考系{0}与坐标系{1}重合。
因此,当关节1为转动关节时a0=0,0=0, d1=0;当关节1为移动关节时a0=0,0=0,q1 =0。
i-1
坐标系{i}选择示意图
对于中间连杆i,坐标系{i}的Zi轴与关节轴i重合,坐标系{i}的原点位于 公垂线ai与关节轴i的交点处。Xi沿ai方向由关节i指向关节i+1,并按照右手 系规则确定Yi,ai按右手定则绕Xi转角定义。
第3章 机器人运动学
运动学研究物体的位姿、速度和加速度之间的关系。
本章将介绍双轮移动机器人、三轮全向移动机器人和关节式机械臂的运 动学问题。
双轮移动机器人运动学
Y
v
(x, y, q)表示双轮机器人位姿,v 表示机器人前
q
进速度,表示机器人转动速度w,则
xy&&
v v
cosq sin q
q& w
w
(3-1)
给定期望的机器人前进速度v,转动速度w,则可以确定机器人的两轮转速为
wR (v Dw / 2) / r, wL (v Dw / 2) / r
(3-3)
因此,可以非常方便地通过控制电机的转速来控制机器人移动和转动速度。
机器人位置估计
已知初始位姿为(x0, y0, q0),两轮转角增量为L和 R,则两轮移
2
三轮全向移动机器人运动学
双轮移动机器人运动中最大的问题是不 能横向移动,在实际应用中灵活性比较差。
全向移动轮是一种新的轮式移动机构,在 大轮的边缘上布置若干小轮,使得机器人的移 动方向不再限定于大轮所在的平面方向。
xoy是机器人坐标系,机器人的运动速度用 vx、vy和w表示,三个全向轮的角速度分别用w1 、w2和w3表示,v1、v2和v3分别表示三个全向轮 轮心处的线速度。假设全向轮的半径为R,距运 动机构中心的距离为L,则速度间关系为:
杆为连杆n。为了使机械臂末端执行器可以在3维空间达到任意的位置
和姿态,机械臂至少需要6个关节,因此,典型的工业机械臂一般都具
有6个关节。
6
轴i
θi
用一条空间直线表示关节的转轴
轴 i-1
连杆 i
(平移轴),连杆i 的运动可以用 转轴i 和连杆i相对连杆i-1的转动
θi-1
连杆 i-1
角度qi 来描述。下面给出几个连
构参数。如果机器人6个关节均为转动关节,18个固定参数可以用6组(ai-1, i-