机器人实验报告

1、实验一机器人运动学实验一、实验目的了解四自由度机械臂的开链结构；掌握机械臂运动关节之间的坐标变换原理；学会机器人运动方程的正反解方法。二、实验原理本实验以SCARA四自由度机械臂为例研究机器人的运动学问题.机器人运 动学问题包括运动学方程的表示，运动学方程的正解、反解等，这些是研究机器人 动力学和机器人控制的重要基础，也是开放式机器人系统轨迹规划的重要基础。机械臂杆件链的最末端是机器人工作的末端执行器（或者机械手），末端执 行器的位姿是机器人运动学研究的目标，对于位姿的描述常有两种方法：关节坐 标空间法和直角坐标空间法。本次实验用D-H变化方法求解运动学问题。建立坐标系如下图所示连杆坐标系i

2、相对于 i -1 的变换矩阵I可以按照下式计算出，其中连 杆坐标系d-h参数为*，-由表1-1给出。齐坐标变换矩阵为：COS ft一 sinQ cossin Q. sina. cossin 9.cos 6. cos a.-cos 9i sin(7.ci, sin 0,i1 0cos atV0001其中描述连杆i本身的特征；，和拦描述连杆i- 1与i之间的联 系。对于旋转关节，仅拦是关节变量，其它三个参数固定不变；对于移动关节，仅E是关节变量，其它三个参数不变。表1-1连杆参数表连杆数变量%裆1cossin1召】D0102&20201030D02104位D0010其中连杆长 l -200mm，l

3、 -200mm，机器人基坐标系为O-XYZ。根据上面的坐标变换公式，各个关节的位姿矩阵如下：0 00cos 9-一 sinq cosffsin 9- sin a-L cos 6sin 9cos a- -cos 6 sin a sin %0sin acos a-00001cos a一 sin a c。泌7gin 9, sin/2 cos A1丁 -sin 6.cos? cos a.-cos 日、sintz-,L sin 劣0sin tz.cos心00001cos 0.-sin q cos a.sin 8 sin0一sin 3-.cos 另 cos %-cos q sina.00sin a%cos

4、 cz.0001cos 9.-sin % cos cz4sin 日4 sin 40# =sin 3.COS 84 C0S7.一 cos % sin% o0cos a400001运动学正解：各连杆变换矩阵相乘，可得到机器人末端执行器的位姿方程（正 运动学模型）为： TOC o 1-5 h z 七气%耳：T = ；r（8）Z（务）#（%）：（）= %勺勺Pt-七？VP. HYPERLINK l bookmark15 o Current Document 0001其中：z轴为于指接近物体的方向，称接近矢量a （approach）； y轴为 两手指的连线方向，称方位矢量o （orientation）

5、； x轴称法向矢量n （normal）, 由右手法则确定，n=o*a。p为手爪坐标系原点在基坐标系中的位置矢量。运动学逆解：通常可用未知的连杆逆变换右乘上式：；丁7二丁计一匕丁-：（其中。os% =l.sincz. = 0 ）令两式对应元素分别相等即可解出*n村土。14B = arctan k, ) an 其中将上式回代，可得，勺武+ 忧血(弓 I arLtcin) -/L令第二行第四个元素对应相等，可得：d令第四行第三个元素对应相等，可得：前 110 cos + sin 6 cosj + 如 sin 耳=% cost所以，%-或环血（上澎祐F河）三、实验步骤步骤1.检查实验系统各部分的信号连

6、接线、电源是否插好，完成后打开伺 服驱动系统的电源开关。步骤2.运行GRBserver程序，出现以下程序界面。图1-6机器人示教程序界面步骤3.按下“打开控制器”按钮，按下“伺服上电”按钮。步骤4.清理周围环境，避免机械臂运动时打到周围的人或物。检查末端执 行器上的电线连接，避免第四个关节运动时电线缠绕而被拉断。步骤5.按下“自动回零”按钮，机械臂自动回零。步骤6.选择“关节空间”或“直角坐标空间”，选择“运动步长”，选择“运 动速度倍率”为合适值。一般刚开始时尽量选择较小的值，以使运动速度不致太 快。步骤7.在“示教操作”区按下相应关节按钮，观察机械臂的运动情况。此 时可以按下“记录”按钮，

7、以便以后重复该次运动。步骤8.重复步骤7，演示各种运动及功能。四、实验数据及处理实验数据e 1e 2-d3e 4XYZ手爪11005020150-207.9296.9620149.9210050-20150-207.9296.96-20149.9310050-20-150-207.9296.96-20-149.941308030-100-301.753.2229.9-99.951507030-100-326.4-25.5529.9-99.9运动学正解的MATLAB程序：x=0 1;A=cos(x) -sin(x) 0 0.2*cos(x);sin(x) cos(x) 0 0.2*sin(x);

8、0 0 1 0;0 0 0 1 y=0 2;B=cos(y) -sin(y) 0 0.2*cos(y);sin(y) cos(y) 0 0.2*sin(y);0 0 1 0;0 0 0 1 d=-d3;C=1 0 0 0;0 1 0 0;0 0 1 d;0 0 0 1z=0 4;D=cos(z) -sin(z) 0 0;sin(z) cos(z) 0 0;0 0 1 0;0 0 0 1T=A*B*C*D其中 A=0T ; B=1T ; C=2T ; D=3T1234分别把e 1、e 2、-d3、e 4的五组数据代入程序算出结果如下：第一组：A =-0.1736-0.98480-0.03470.

9、9848-0.173600.1970001.000000001.0000B =0.6428-0.766000.12860.76600.642800.1532001.000000001.0000C =1.000000001.000000001.00000.02000001.0000D =-0.8660-0.5000000.5000-0.866000001.000000001.00000.50000.86600-0.2079-0.86600.500000.2970001.00000.02000001.0000第二组:A =-0.1736-0.98480-0.03470.9848-0.173600.

10、1970001.000000001.00000.6428-0.766000.12860.76600.642800.1532001.000000001.00001.000000001.000000001.0000-0.02000001.0000-0.8660-0.5000000.5000-0.866000001.000000001.00000.50000.86600-0.2079-0.86600.500000.2970001.0000-0.02000001.0000第三组:A =-0.1736-0.98480-0.03470.9848-0.173600.1970001.000000001.000

11、0B =0.6428-0.766000.12860.76600.642800.1532001.000000001.00001.000000001.000000001.0000-0.02000001.0000-0.86600.500000-0.5000-0.866000001.000000001.0000T =1.00000.00000-0.2079-0.00001.000000.2970001.0000-0.02000001.0000第四组：A =-0.6428-0.76600-0.12860.7660-0.642800.1532001.000000001.0000B =0.1736-0.98

12、4800.03470.98480.173600.1970001.000000001.00001.000000001.000000001.00000.03000001.0000D =-0.17360.984800-0.9848-0.173600001.000000001.0000T =-0.3420-0.93970-0.30180.9397-0.342000.0532001.00000.03000001.0000第五组：A=-0.8660-0.50000-0.17320.5000-0.866000.1000001.000000001.0000B=0.3420-0.939700.06840.93970.342000.1879001.000000001.0000C=1.000000001.000000