机械臂控制系统的设计

1、机械臂控制系统得设计1 引言近年来，随着制造业在我国得高速发展，工业机器人技术也得到了迅速得发展。根据负载得大小可以将机械臂分为大型、中型、小型三类。大型机械臂主要用于搬运、码垛、装配等负载较重得场合；中小型机械臂主要用于焊接、喷漆、检测等负载较小得场合.随着国外工业机器人技术得不断发展，尤其就是一些中小型机器人，它们具有体积小、质量轻、精度高、控制可靠得特点，甚至研发出更为轻巧得控制箱，可以在工作区域随时移动 ,这样大大方便了工作人员得操作 . 在工业机器人得应用中最常见得就是六自由度得机械臂。 它就是由个独立得旋转关节串联形成得一种工业机器人 ,每个关节都有各自独立得控制系统 .2 机械臂

2、硬件系统设计2、 1 机械臂构型得选择要使机器臂得抓持器能够以准确得位置与姿态移动到给定点， 这就要求机器人具有一定数量得自由度 .机器臂得自由度就是设计得关键参数 ,其数目应该与所要完成得任务相匹配 .为了使安装在双轮自平衡机器人上得机械臂能够具有完善得功能，能够完成复杂得任务， 将其自由度数目定为 6 个，这样抓持器就可以达到空间中得任意位姿 ,并且不会出现冗余问题。在确定自由度后 ,就可以合理得布置各关节来分配这些自由度了。由于计算数值解远比封闭解费时，数值解很难用于实时控制，这样，后3个关节就确定了末端执行器得姿态，而前 3 个关节确定腕关节原点得位置 .采用这种方法设计得机械臂可以认

3、为就是由定位结构及其后面串联得定向结构或手腕组成得。这样设计出来得机器人都具有封闭解。另外,定位结构都采用简单结构连杆转角为0 或 90°得形式，连杆长度可以不同，但就是连杆偏距都为0，这样得结构会使推倒逆解时计算简单。定位机构就是涉及形式主要有以下几种:SARA 型机械臂，直角坐标型机械臂，圆柱坐标型机械臂,极坐标型机械臂，关节坐标型机械臂等。 ARA 机械臂就是平面关节型 ,不能满足本文对机械臂周边3 维空间任意抓取得要求 ;直角坐标型机械臂投影面积较大,工作空间小；极坐标方式需要线性移动，机械臂如需较大得工作空间 ,则臂长较长 ;与其她类型相比关节型机械臂在其工作空间内干涉就是

4、最小得， 就是一种较为优良得结构。 所以初步确定本文机械臂构型为关节型。、 2 臂杆长度得确定机械臂得臂杆设计如表2 1 所示：表 1机械臂臂杆长度臂体名称大臂L1小臂L2机械手长度（mm)5505 012、 3机械臂结构设计2、 1 关节结构方案为了便于机械臂关节得模块化涉及与简化结构， 本设计使用电机直接连接减速器 ,减速器连接臂体连接结构。图 -1 就是关节结构动力传递方案。图 - 关节结构动力传递方案使用这种联接方式因中间零件少 ,故形变量与回程间隙都较小 ,且能保持较高得结构刚度。2、 4 关键部件得选型2、4、1 关节负载得估算各关节得动态参数就是驱动元件得选择与关节传动零件选择得

5、重要依据.由机器人动力学相关知识可知完整得机器人动力学方程为：式中一般使用静力学方法与动力学方法计算机器人得动力参数,速度较低得机械，在运行过程中,惯性引起得动载荷较小，一般使用静力学方法，忽略C 与F得影响。而对于运行速度较高机械，其动载荷也较大，即C 项得影响较大，甚至超过静载荷 ;且粘滞摩擦也较大，同时考虑静载荷与动载荷，需使用动力学计算。本文得设计要求就是一款可以安装在全向移动平台上得轻型机械臂，对关节得旋转速度要求不高 ,因此估算机械臂力矩时采用静力学方法。图 2-机械臂受力简图估计关节力矩之前， 首先假设每个关节得重力作用集中在中心， 将连杆得重量均分于各关节，机械臂受力简图如图

6、2 2 所示，使用静力学方法计算关节所受力矩得最大值 .六自由度机械臂三维静态仿真图如图 -3 所示 :图 3三维静态仿真图2、 2 关节驱动系统电机得选型机械臂得驱动系统，有三种基本类型，即电动驱动、液压驱动与气动驱动,也可以根据需要组合成为复合式得驱动系统。(1) 电机驱动目前机械臂上使用最多得一种驱动方式就是电动驱动 ,它利用各种电机产生得力与力矩 ,直接或通过机械传动装置来驱动执行机构。这类系统效率比液压驱动与气动驱动系统高，且电源方便 ,所以在机器人中得到了广泛得应用。（ 2) 液压驱动液压驱动得主要优点就是功率密度大。液压缸也可直接作为臂体得一部分,因而结构紧凑 ,刚性好。由于液压

7、油液得不可压缩性，系统得固有频率较高,快速响应好，可实现频繁平稳得变速与换向。液压系统易于实现过载保护,动作平稳、耐冲击、耐振动、防爆性好。（ 3) 气动驱动气动驱动系统通常由气缸、 气阀、气罐与空压机组成， 其特点就是气源方便、结构简单、造价较低、维修方便。与液压驱动系统相比， 同体积条件下功率较小，也难以进行速度控制，多用于中、小负荷且精度要求不高得机器人控制系统中。综上，本设计决定使用电动驱动方式为机械臂提供动力，步进电机为驱动电机 .、 4、3 驱动系统减速器得选型结合上文 ,本文将使用步进电机为驱动电机为机械臂提供动力，结合各关节受力与机械臂关节传动机构组合方式 ,应在驱动电机与机械

8、臂关节间安装减速器做扭矩适配，降低输出轴得速度，增大输出扭矩 .一般行星齿轮减速器、蜗轮蜗杆减速器、谐波减速器、齿轮减速器等可以与步进电机适配。、行星齿轮减速器行星齿轮减速器通常由一个或者多个外部齿轮围绕着一个中心齿轮旋转， 就像行星绕着太阳公转一样。 在工作状态中多个行星齿轮协同工作， 因而承载能力大 ,属纯扭矩传动 ,工作平稳 .单级行星齿轮减速器得减速比一般较小 ,需要增加减速比时只需增加行星轮系得级数即可 ,而整体体积变化较小。2、蜗轮蜗杆减速器蜗轮蜗杆减速器得传动比大， 一般为 10-8，也可以达到 0 以上。此外 , 蜗轮蜗杆减速器机械结构紧凑、热交换性能好、工作平稳、噪声小、具备

9、机械自锁能力 ,安全性高。3、谐波减速器波发生器，柔轮 ,刚轮就是谐波减速器得三大部分，谐波齿轮减速器传动结构简单 ,减速比高 ,同时啮合得齿数多，运行平稳、传动承载力大，齿侧间隙小，传动精度高 ,传动误差只有普通圆柱齿轮传动得 /4 左右 ,传动空程小，适用于反向转动，在机器人领域有着广泛应用。 但对柔轮材料有较高得强度要求， 工艺复杂。4、齿轮减速器圆柱齿轮减速机构为定传动比齿轮机构 ,其传动准确，平稳高效，传动功率范围与速度范围大 ,广泛用于各种仪器仪表中，但其制造与安装精度要求高，高减速比时结构较为复杂，体积一般较大 .综上，初步去确定使用谐波齿轮减速器， 减速比大，传动精度高， 体积

10、小巧 , 输入轴与输出轴轴线重合 ,可很方便地与步进电机组合安装成为机械臂关节得一部分，同时便于机械臂得模块化设计 .本文将采用 Har ni Dive CSF- ni 系列组合型谐波减速器 ,其中腰关节采用型号为 CSF14 10-2XH- ；肘关节俯仰与肘关节旋转采用 CSF 1-10 2XH ，腕俯仰采用 CF-800-2XH-F.2、 4 电机驱动器得选型虽然步进电机广泛地应用于各行各业，但步进电机并不能像普通得直流电机那样通过控制输入得等效电压就可以驱动与调速。它必须利用电子电路 ,将直流电变成分时多相时序控制电流 ,用这种电流为步进电机供电，步进电机才能正常工作 .常见得有单片机

11、/ 直接控制 ,步进电机驱动芯片、运动控制卡。1、单片机IO 直接控制方式使用单片机内部得锁存器、 计数 /定时器，与并行 I/O 接口 ,可以实现对步进电机得控制 ,脉冲环形分配器得功能由单片机系统实现完成，通过软件中断方式实现步进电机得变速控制，改变通电顺序则可改变转向。2、步进电机专用驱动芯片步进电机专用驱动芯片一般集成度较高STEP 与 DI 三个输入端， ABLE电机； STE为脉冲输入 ,输入一个脉冲,外围电路简单 ,一般有ENA LE、为使能端，使能有效时方可驱动步进,即可驱动步进电机产生微动;DIR为方向 ，改变DR逻辑电平即可换向。3、运动控制卡驱动控制通过计算机可直接控制步

12、进电机,运动控制卡就是专用于步进电机控制得P插卡，就是应对复杂系统得控制而出现得，一般可同时控制十几台甚至几十台步进电机得运动，一般价格很高。综上 ,本设计将使用步进电机专用驱动芯片来驱动步进电机。其中肩关节与肘关节俯仰有自锁需求，使用东芝THB713A 28高细分步进电机专用驱动芯片驱动，其她轴选用 4988 微步驱动器。表 2-3 步进电机驱动芯片相关参数型号最高耐压电流使用温度自锁性能细分模式THB7 2840VDC±、 3A 40半流锁定1 18(885(）种 )A49883 VDC± A-2 85无1-16(5 种)（）2、4、5 传感器得选型本文将使用步进电机与

13、谐波齿轮减速器为机械臂提供动力，步进电机只需要通控制驱动脉冲得数量， 即可简单实现较高精度得定位，并使工作物在精确地停在目标位置 .步进电机以细分后得步距角为基本单位进行定位。以两相电机为例,其步距角为、 8°,使用 1/16 细分方式进行驱动， 那么每给驱动器一个脉冲步进电机转子旋转得角度为角度=、 8°1/60、 125°,转子旋转一周需要脉冲数为 360°/0、 125°=320，需要旋转到其她任意角度得计算方式与上式相同.本文使用限位开关得型号为 m n 微动开关SS5 摆杆型限位开关 .表 2-4微动限位开关参数型号按键力度接触规格触

14、发精度耐热温度S 51、 4 N1C（双投型 )±0、5m85°2、 6 下位机得选型对于机器臂控制 ,需要对多台电机进行联动控制。为了实现多台电机之间得通信与控制 ,必须建立一套数据通信系统来完成主计算机与各运动控制单元间得数据交换。基于现场总线得分布式控制技术能够解决这些问题.但常见得分布式控制系统又有 B总线 ,SERCO总线 ,R 48 总线与 总线等这几种。本设计将采用R-485 总线来实现机械臂得分布式控制。本设计选用了 T公司得 20系列 DS TM 2 2 7 作为控制单元。其时钟频率可达 40H,具有高速得处理能力 ,片内资源丰富 ,特别就是它特有两个内置

15、事件管理器模块 (EVA 、EV ）。通过 TAG接口可以方便得对 S 进行全速得在系统调试仿真。 S3 0 F247得电源电压为 3、3,正常下作电流为 80 左右，抗干扰能力较强。2、 6、1 关节控制器硬件电路关节控制器就是以DS 芯片为核心， 芯片本身及其外围电路得性能直接决定了系统得性能。 故芯片得选择及其外围电路得设计， 也就显得十分得重要。 下面将通过单个模块电路得方式分别介绍控制器硬件电路。(1) 电源电路通过开关电源，接入 5 5LS 模块产生稳定得得 V 电压作为 TPS733芯片得供电电压，管脚 8 做为 2407 得上电复位信号。管角 5,6 通过滤波电容输出作为 40

16、7 得供电电压（ 3、 3V)。如图 25.图 24电源电路(2) 时钟电路MS320LF2407 得时钟源可以来自外部有源晶振也可以用晶体 ,利用内部振荡器。一般经常使用外部时钟输入 ,因为使用外部时钟时，时钟得精度高、信号比较稳定 ,外部时钟电路与锁相环电路如图 -6 所示。图 5 时钟电路(3) JAG 接口电路仿真接口电路如图 2 7 所示、目标层次得 TI 调试标准使用 5 个标准得 IEE 49、1(JTAG)信号 (TRST、 CK、 TM 、 TI 、T）与两个 I 扩展口 (EMU0 、EMU ）。JTA 目标器件通过专用得仿真端口支持仿真， 此端口由仿真器直接访问并提供仿真

17、功能。 JTAG 接口电路为仿真器与微机得接口电路 ,便于系统进行在线调试。图 -6JTA 电路(4) 外接 SA 电路T 2 F407最多可寻址64K得外部程序空间与4得外部数据空间 .由于控制算法得需要,本系统需扩充外部RAM 。 M 2 LF2407片内得Flash可用作程序存储器，但在开发阶段使用lash作为程序存储器极为不便,因为每一次程序得修改都需要对 F ash 进行清除、擦除与编程操作 ,而且进行 CCS 调试时只能设置硬件断点，故从调试得角度考虑，应扩充程序 RAM 。这里用得就是 CY7C101V33 芯片 ,它就是 64K*16b t 得 S M, 存取时间为 15n ,

18、故不需要插入等待周期，可保证系统全速运行。图为外接 SR M扩展电路图。图 7S M 扩展电路图(5) 编码器处理电路增量式编码器信号处理电路如图 2-9 所示。图 2 8 增量式编码器信号处理电路(6) 霍尔接近开关电路本设计选用 1443E 常开型霍尔接近开关。 其接法如图2-10，提供电压为 5V,由于输出采用了集电极开路门， 必须通过 10K 得上拉电阻接到 5V 电源上 .当磁源得某一极与霍尔传感器得距离达到一定范围以内时 ,输出低电平，否则输出高电平，不需要外接放大电路。一套关节控制器将采用 支霍尔接近开关。 HA L 、 HALL2 分别固定在关节控制器运动得极限位置，其信号通过

19、IOPE5、 I不断查询。 HALL 用于绝对零位检测 ,采用中断得方式。图 9 霍尔接近开关得接法2、 机械臂得模块化设计机械臂得大小臂体与关节在整个机械臂中具有高度得相似性，同时机械臂就是机电一体化得典型，其主体结构与联接结构都有一定得复杂性,而采用模块化设计思想，可以一定程度上简化设计流程 ,只需对不同得应用对象进行少量修改便可完成组合适配。2、5、1 旋转关节得设计机械臂得基本单元有旋转关节与俯仰关节 ,其结构具有相似性，本文重点介绍旋转关节得设计。旋转关节包含有电机、减速器、编码器、制动器以及其她附件 ,本文使用步进电机直连谐波减速器得驱动方式 ,使用限位微动开关确定机械臂初始定位零

20、点， 以计步进电机已发脉冲数为关节相对旋转角度参考， 就是一个开环得运动控制系统，动力传递链路为：电机 -波发生器 柔轮刚轮 输出轴。机械臂得旋转关节模块在运行过程中会受到来自机械臂末端得弯矩， 因此需要对输出轴做轴向与径向卸荷，减少输出轴得负载 ,保证系统得刚度，延长使用寿命 .一般来说，一根轴需要两个支点 ,每个支点由一个或一个以上得轴承组成，每组轴承间有以下三种常用得配置方法 .1、双支点各单向固定这种轴承配置常用两个反向安装得圆锥滚子轴承或角接触球轴承 ,两个轴承各限制轴向一个方向得轴向移动 .这种配置方式轴向移动限制比较精确、也便于调整轴承得预紧程度。 另外深沟球轴承也可用于双支点各

21、单向固定， 通过调整外壳与轴承端盖端面得厚度来补偿轴得受热伸长， 因而这种配置方式不适合需要对轴做精确轴向定位得场合。2、一支点双向固定，另一端支点游动对于热伸长量较大得轴 ,这种轴一般跨距较大且工作温度较高 ,应该采用一支点双向固定，另一支点游动得支撑结构。 其双向固定端需要使用能承受双向轴向载荷得轴承，内外圈都需要固定。3、两端游动支撑对于人字齿轮轴， 由于本身具有相互间得轴向限位作用， 其中只需保证一根轴与机座有相对固定得轴向位置 ,另一根轴上得两个轴承必须游动，防止人字齿轮卡死或两侧受力不均匀。本文将采用一支点双向固定 ,另一端支点游动得方式组合成卸荷轴承组 ,其中双向固定端使用深沟球

22、轴承 ,游动端使用滚针轴承。其中腰关节使用型号为 B 6809-2Z、SK HK5 20,肘关节旋转使用型号为 HRB 6806、 SKF HK3512 。2、5、2 旋转关节得设计各运动轴基于模块化设计，设计时已考虑各运动轴得联接,使用简单得金属板件便能将各运动轴连接可靠 ,并具有一定得刚度 .本文各运动轴均为法兰端面输出，与金属板材间通过螺钉联接固定 ,依靠金属板与法兰端面得摩擦力传递扭矩到金属板材。图 1 为肩关节联接金属板材机械加工工程图：图 2 10 肩关节联接金属板2、5、抓手得设计一款通用型得机械臂应该具有抓取多种物体得能力,也为某一目标物体专门设计一款抓手 ,因而在设计机械臂臂

23、体与机械抓手时，需要设计一个合理得联接结构，以便机械抓手能够快速更换。 机械抓手在抓取物体时需要保持一定得夹持力 ,本文将使用舵机为机械手爪提供动力，舵机在旋转到位后能持续提供一定得扭矩以保持夹持状态。 使用舵机型号为 werPro MG 5 全金属齿舵机，表 5 舵机型号及相关参数型号机械尺寸扭力工作电压工作死区舵机类型（ )0、7* 9、M 945模拟舵机1g4、 -6V5uscm（6V）7、 9图 22 为与机械抓手配合得臂体联接结构。 同理只要末端执行器设计为可与该联接结构配合，即可实现更换 ,以完成对不同物体得抓取任务。图 211 机械臂执行器联接结构3 机械臂软件系统设计整个机械臂

24、控制系统软件包括主计算机监控软件与各关节控制器软件.主计算机接收目标位姿数据，完成路径规划算法。另外 ,主计算机要实时读取关节控制器得反馈数据，记录机械臂得当前位姿，并显示在屏幕上。不仅直线运动、点到点运动、复位动作得完成需要主计算机监控软件协调， 而且像各关节绝对位置得确定过程、各关节运动范围就是否越界也必须由主计算机实时参与， 及时做出决策。主计算机还要提供给用户友好得人机交互界面 ,方便于用户输入各种命令，存储设置好得参数 ,允许数据以表格或者曲线等形式导出 .、关节控制器软件设计3、1、 PID 控制算法关节控制器 MS320LF2407 来实现，完成电机得位置环控制与速度环控制，如图

25、 3所示。位置环得控制周期设为 2ms,速度环得控制周期也设为 2ms.由于采用了速度环 ,系统得动态性性能可以得到显著提高 . 两个闭环都采用积分分离 PD 控制，根据实际调试情况，可以对控制律进行适当得化简 .零位霍尔接近开关在系统上电时用于较粗略得确定电机得绝对位置， 再结合增量编码器得 Z 通道得信号，就可以较精确得确定出电机得绝对位置。主计算机路径规划求得得目标位置，应该换算成增量码盘得脉冲数后,再发给关节控制器 .关节控制器利用它与从增量编码器实际测得得脉冲数进行比较，利用积分分离 P算法求解位置环得控制量。、 2关节控制器程序流程主程序得流程图如3-2 所示 :图 1主程序流程图寄存器初始化操作主要包括：设置 CPUL 为外部晶振得 2 倍频 ,即 1 MHZ; 设置串口通讯波特率为： 38、4kbP；设置定时器 /计数器相关寄存器；设置 EP 电路单元相关寄存器 ;设置中断控制寄存器等等。串口数据接收中断服务程序流程图如33 所示。在中断服务程序中，读取数据接收寄存器中得数据,存入数据接收区， 而并不作任何进一步分析与处理。 数据接收区就是内存中暂时存放数据得区域，当存满一条完整指令信息后 ,由主程序分析与处理。图 3-串口数据接收中断服务程序流程图