文档来源为 :从网络收集整理 .word 版本可编辑 .欢迎下载支持
1文档来源为 :从网络收集整理 .word 版本可编辑 .欢迎下载支持
三自由度机械手工作空间的设计（ MATLA）
B
题目的选择：三自由度机械手工作空间分析，B 1,62,63的转角范围-90?~90?, l o=1m
11= 12=0.8m。每个杆横截面积为 60mm< 20mn!勺矩形铁杆，6 i绕垂直z 轴旋转，6
2，6 3
在水平面内旋转。
理论分析： 从题干可以得知，首先此工作空间需要有三个杆组成，即 l 0=1m，l 1=
1 2=0.8m,可以在刚体中设置长度；其次，题目要求 6 i, 6 2, 6 3的转角范围
-90?~90?,此项可以在信号发生器模块里面设置，本题信号均选择 n /2的正弦
波作为发生信号；第三，要求 6 i绕垂直z轴旋转，我的理解是模拟机械手的支 撑单
元杆，此结构会做原地的自传，也就是围着Z轴旋转，满足题目要求；最后， 要求 6
2,6 3
在水平面内旋转,这个比较好实现了,只要在刚体设置中,定好杆 的位置就可以实
现。
基于 SimMechanics 的运动学分析： 根据机器人的机构组成，基于 SimMechanics
的三关节机器人仿真模型如图1所示。图中SimMechanics仿真模型主要由三个 转动
关节模块，三个刚体模块和一个地模块组成。转动关节 1、2、3（R1、R2、
R3）表示机器人的两个转动关节，刚体 1、2、3 （Bi、B2、B3）代表杆1、杆2、
杆3,地（Ground）表示固定机座。对于关节1、2、3用两个驱动器（R1 Actuator、
R2 Actuator 和 R3 Actuator ）进行运动驱动，为了精简模型，本模型采用了封 装子
系统操作，即把关节驱动器部分封装起来，由于三处关节得驱动基本相同， 所以三处
都采用了此操作，封装之后如下图中的（ Power1、 Power2、 Power3）， 用两个
传感器（R2 Sensor和R3 Sensor）测量关节转角，轨迹规划模块实现机 器人末端的
运动轨迹。
三自由度机械手工作空间的设计方法：
1.打开 MATLAB/SIMULINI找到 SimMechanics模块，如图 2所示。
2 •按照题目要求从SimMechanics模块中依次拖拽相应的杆件和连接件，组成 3 关
节机器人，但是组成后机器人是仿真不起来的， 因为没有设定相关的一些参数。 所
需要的连接件在前面基于 SimMechanics 的运动学分析中已经详细介绍了。
3.参数的设定
1）转动关节模块参数的设定：按照题目的要求，需要 6 1绕垂直z轴旋转，6 2,
6 3在水平面内旋转，也就是说 R1的转动轴应以Z为坐标轴运动，R2 R3也同 样如
此，这样设定参数可以满足要求，其参数的设置如图 3所示。
2）刚体模块参数的设定：此处参数的设定很关键，设置的对错将决定整个系统 是否
可以正常运行， 参数的设定也是相对麻烦一些的， 现在详细的介绍一下本题 刚体模
块参数的设定方法。 首先， 要设定一个基准， 这里我采用 Bottom 为基准， 设定
其坐标为（0, 0, 0）,并取名为CS1;其次，设定Top的坐标为（0, 0, 1）, 取名为
CS2这样以来就可以确定第一个杆的长度为 1m它是以CS1为基准设定 的。再者还
文档来源为 :从网络收集整理 .word 版本可编辑 .欢迎下载支持
2文档来源为 :从网络收集整理 .word 版本可编辑 .欢迎下载支持
要设定一个中间点，坐标为（0, 0, 0.5 ）,取名为CG,它也是以CS1 为基准的。其参
数的初设定如图 4 所示。
之所以称之为初设定， 是因为这样设定后还不能满足题目的要求， 因为题目中要 求
每个杆横截面积为60mrK 20mm的矩形铁杆，所以还需要多设置 8个点，即每 4个
点可以形成铁杆的两个截面。值得注意的是，此 8个点中每 4个点是关于中 心点对
称的，并且4个点是以CS1为基准，后4个点以CS2为基准。单位是毫米， 截面积
为60mrK 20mm所以可以这样设定前4个点的坐标，即第一点坐标是
（ 0.03， 0.01 ， 0）依次类推，第二点坐标（ -0.03 ， 0.01 ， 0），第三点坐标
是
（ -0.03 ， -0.01 ， 0），第四点坐标（ 0.03 ， -0.01 ， 0），这样就可以构成杆
件
的一个下平面。杆件的上平面也是如此设定坐标， 这四个坐标点是以CS1为基准
的。其次的四个点是以CS2为基准的，这样就可以设计出矩形铁杆了。 矩形铁杆 参
数设定如图 5 所示。第二和第三个杆也同样设定。
图5刚体矩形铁杆参数的设定
3） 关节驱动器模块的设定：双击驱动器模块，选择 Motion 选项，然后依次在
Angle 选项中选择 rad 单位、 Anguler velocity 选项中选择 rad/s 、Anguler
acceleration 选项中选择rad/sA2单位，其参数设定如图 6所示。
图6 关节驱动器模块参数的设定
关节驱动器模块后面理解着驱动信号，本题中均采用 n /2的正弦波作为发生信 号，
为了精简模型， 将驱动器及信号发生器等模块封装为子系统。 封装好的子系 统如图
7 所示。
4） 测量关节转角传感器模块的参数设定：本题主要测出关节的转角，所以只把 转角
选项打上对号就行了，其设置参数如图 8所示。
5） XYGraph模块参数的设置：这个示波器的主要功能是使用 Matlab的图形窗口
显示信号的X-Y图，其设置参数如图9所示。
图 9 XYGraph 模块参数的设置
现在可以进行仿真了， 为了清楚看见三自由度机械手工作空间的运动方式及测出 机
器人末端的运动轨迹的曲线，首先需要设置下环境，即在 Simulink 菜单下选 择
Simulation/Mechanical environment/Visualization ，将 2 个选项都打上对 号，进行
仿真的时候即可以实现同时观测机械手的运动方法及末端运动轨迹曲 线。其次，还要
设定仿真的步长和循环时间，为了清晰观察，一般把步长设的小 点，本例中设为
0.01 ，循环时间为 inf 即无限循环。
最后开始仿真，其工作空间及机械手末端轨迹曲线在 T=100.83 的时候如图 10
所示。
文档来源为：从网络收集整理.word版本可编辑.欢迎下载支持
3文档来源为：从网络收集整理.word版本可编辑.欢迎下载支持
图10某一时间工作空间及机械手末端轨迹曲线
需要说明的一点是由于上面图形表述的是某一时间的机械手末端轨迹曲 线，
也就是说没有完全循环完毕，如果完全循环，末端轨迹应该是一个椭圆环形, 其环形
内部的每一个点机械手的末端都可以走到。
为了展示机械手工作空间的全貌，这里采用了 3D模式，其某一时间的运动情况
如图11所示。
小结：本文主要针对三自由度机械手工作空间设计这个问题展开了相应的理论与 基于
SimMechanics的运动学分析，清晰的规划了设计步骤，并且按照要求将本 题设计出
来，其结果也比较符合实际要求，总之从这次作业里我学到了很多相关 此门课程的知
识，并且通过自己的实际操作使知识的掌握丛理性化上升到感性 化，以上是我针对第
一道题的设计全过程，诚望老师给予点评与指正。
Click On Ob[«cC To 気屮孑 Infiorm
打炖
J IT
GTHBII
SOS o
竝
晝
苜
>