《毕业设计（论文）-模块化机器人设计(15页).docx》由会员分享，可在线阅读，更多相关《毕业设计（论文）-模块化机器人设计(15页).docx（15页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、-毕业设计（论文）-模块化机器人设计-第 15 页模块化机器人设计摘要如今，机器人的发展突飞猛进，机器人服务已经覆盖了人们生活、工作、娱乐的方方方面。随着人类的需求的不断增加，对机器人领域的探索也越走越远，机器人模块化技术已在各个领域的产品研究和开发中广泛应用。于传统机器人相对比，模块化机器人柔性更好，自修复能力强柔性高，且容错性强、成本较低。模块化结构较简单，便于加工，各模块能互相替换，组装快捷简便。由于模块化机器人结构和功能的可重组性，对任务和环境有很强的适应能力。采用模块化技术，有利于机器人的维护和保养，缩短了机器人设计的时间。因此，本文将采用模块化的方法开发一种新机器人系统，希望有利于
2、改善目前机器人控制复杂、通用性差和操作繁琐等问题。本文一共分为六个部分，第一部分绪论主要概括模块化机器人的研究背景、意义和国内外模块化机器人研究现状，第二部分探讨了机器人模块化的设计原理和方法，第三部分主要讨论了机器人控制系统设计，第四部分分析机器人主从控制策略。第五部分概述了机器人构型，最后进行了小结。关键词：机器人；模块化；系统设计；构型AbstractNowadays, the development of robots is advancing by leaps and bounds. Robot service has covered all aspects of peoples l
3、ife, work and entertainment. With the increasing demand of human beings, the exploration of robot field is more and more far away. Robot modularization technology has been widely used in product research and development in various fields. Compared with the traditional robot, modular robot is more fl
4、exible, self repairing ability, high flexibility, and good fault tolerance and low cost. The modular structure is simple, easy to process, each module can replace each other, and the assembly is quick and easy. Because of the reconfiguration of modular robot structure and function, it has a strong a
5、daptability to task and environment. Modular technology is beneficial to the maintenance and maintenance of robots, and shortens the time of robot design. Therefore, this paper will use modular method to develop a new robot system, in the hope of improving the complexity of robot control, low univer
6、sality and tedious operation. This paper is divided into six parts, the first part is the introduction mainly summarizes the modular robot research background, significance and research status quo of inside and outside of the modular robot, the second part discusses the design principle and method o
7、f modular robot, the third part mainly discusses the design of robot control system, the fourth part of the analysis of the master-slave robot control strategy. In the fifth part, the configuration of robot is summarized, and finally a brief summary is made.Key words: robot; modularization; system d
8、esign; configuration目 录摘要1Abstract2第一章 绪论41.1研究背景及意义41.2国内外研究现状4第二章 机器人模块化设计原理及设计方法52.1模块的划分52.1.1模块化思想概述52.1.2模块划分原理62.2模块化设计方法62.3随遇平衡的实现72.3主机器人模块82.3.1 I模块82.3.2 T模块92.3.3 应用模块化方法的效果103.1控制系统硬件设计103.2单片机最小系统模块113.3 CAN通信模块设计113.4控制器设计12第四章 机器人主从控制策略124.1从机器人系统搭建124.2同构型主从控制策略134.3镜像同构型主从控制策略14第五
9、章 机器人构型16第六章 结论18参考文献19第一章 绪论1.1研究背景及意义 机器人结构不同，通用性也不一样。研究模块化机器人的意义，主要是为了改善机器人的通用性，因此要设计出改变构型后能完成任务的机器人。模块化机器人可以在不同的任务要求、工作环境下，通过改变自身仅有的几种模块的连接顺序或方式而获得多种不同构型的机器人系统。这些不同的构型之间可以通过简单地改变模块之间连接顺序就可以相互转化。这种组合并不是简单的机械装配，参与的各个模块都是一种集通信、控制、驱动和传动为一体的单元，使组合成的系统满足不同的工作环境或不同的任务要求。相比传统机器人，模块化机器人具有柔性高、容错性强和自修复能力强、
10、成本低等优点。模块化结构简单，易于加工，各模块之间可以相互替换，实现快速组装。因此，本文将采用模块化的方法研究开发一种新型主机器人系统，以解决目前主机器人通用性差、控制复杂和操作不直观等主要问题。1.2国内外研究现状国内外学者在模块化机器人方面的研究成果较丰富，尤其是国外，很多机器人系统已经商业化了，如瑞士的Omega 7.0机器人，法国的MPB Techn机器人，美国研发出的phantom Desktop，以及gies公司生产出的Freedom6S机器人和Haptic Technologies公司开发的Excalibur机器人等。早先研发出的这些机器人在构型上都是固定的，比较死板，无法按照任
11、务要求在构型上作出相应的变化;机器人的自由度完全是固定的，不利于保证主从控制的实时性与稳定性;当实际任务发生改变时，由于主机器人无法胜任工作，必须重新研发其他机器人，造成成本和工作量的增加。可见，主机器人的通用性问题是研发机器人要解决的重要问题。21世纪以来，国内一些机器人研发部门对模块化机器人展开了深入研究，其中工业机器人的研究最多。张玉华（哈尔滨工业大学机器人研究所）认为可以研发一种模块化可重构的机器人系统，有利于模块迅速组成多种阵列网格式的整体构型，使模块化机器人整体结构既有阵列式特点，又有串联式的特点;张玉华采用相对方位矩阵来阐释模块间的相对关系以及模块的周围环境，建立了模块化机器人各
12、个模块的运动规则库。赵广涛（清华大学）提出了一种新的可重构机器人的单元组合模块理论，对机器人的摆动、旋转这两个关节进行了设计，研发出了摆动模块和旋转模块，巴东模块有独立的结构，旋转模块有运动功能，设计出的辅助模块可以完成整体组合结构的重构，降低了设计和分析模块化机器人的难度。刘金国（沈阳自动化研究所）一种模块化链式移动机器人结构，提出了基于组合计数原理的递归算法，用于多模块变形机器人的非同构构形计数。李树军（东北大学）也探讨了一种模块化可重构工业机器人，设计了三大类模块关节模块、连杆模块和辅助模块，并采用基于指数坐标的运动学求解方法。可以看出，模块化工业机器人还主要处在研究和起步阶段，模块化机
13、器人的应用也主要是针对一些高端领域，主要集中于一些大学及研究所的科研领域的研究，儿乎没有工业生产方面的应用。模块化机器人所具备的灵活性、对环境的强大适应性以及工作范围的可扩展性，必然会成为未来工业机器人领域的一个主要趋势，尤其是随着人类对外太空等一些人类无法到达领域的涉足，就更需要比传统机器人更优越的机器人来取代人类进行探索。第二章 机器人模块化设计原理及设计方法2.1模块的划分2.1.1模块化思想概述模块化思想并不是一个新颖的概念，最早被称为积木拼搭方式,所谓积木拼搭系统，就是把标准化的部件拼装组成一个装置或一个系统，用组件批量生产来降低成本,用互换性来改善维修保养性能，同时提高系统的柔性。
14、模块设计思想利用到工业机器人设计中可以缩短产品的开发、生产周期,降低生产成本,提高设计的重复使用性,增加系统的可靠性,同时可以根据客户的需要对系统进行合理的配置,以不满不同的市场需求,模块与系统之间存在以下几个方面的关系：一是模块具有独立的功能，二是模块的功能需要在整体系统中得以实现，三是模块具有标准的可速配的输入输出接日，尺寸上的连接分离装置是必须的，此外信息、能量等输入输出接口也是实现整体系统功能所必需具备的。 模块化工业机器人中的模块是一个个相互独立的机械功能模块单元，模块之间可以实现快速的连接和分离，每个模块都是一个集通信、控制、驱动、传动为一体的单元，模块之间允许动力和信息的输入并且
15、可以通过该模块输入到其他相邻的模块。同时，构成模块化机器人的模块需具备以下几个功能特性:一是每个模块都应该可以独立完成某一特定的功能，相互之间彼此独立，这样就可以减小整机系统模块之间的关联性，使机器人的设计和加工更加快速有效;二是当模块分为主动模块和被动模块时，每一个主动模块都应该具有单独的控制和驱动系统，并且可以驱动被动模块完成特定的机械动作;三是各模块之间可以方便地组合装配，不仅要保证机械连接能够快速有效，同时还要保证相互之间可以实现电气、信息、能量等方面的传输；四是各个模块在动力学、运动学上也应具有独立性，机器人的祸合性非常强，应尽可能保证模块在运动学和动力学上的独立性。2.1.2模块划
16、分原理模块的划分及创建原理有两种，一种是基于功能分析的模块创建原理， 一种是基于相似特征聚类的模块创建原理。基于功能分析的模块创建原理，主要对产品进行功能分解，建立功能层次模型，然后在该模型基础上结合模块划分中的功能独立、结构完整等原则进行模块的划分。2.2模块化设计方法进行模块化设计时，首先必须进行模块分解，按照一定的标准将系统分解成若干模块，然后以模块为基本单元进行构型设计。因此，模块划分的合理性对模块化系统的性能、外观以及模块的通用化程度和成本都有很大影响。模块的划分方法有很多，比如按物理功能划分(例如机械、电气、软件等)、按制造方式划分、按系统的组成结构划分等，不同的划分方法得到的模块
17、化系统截然不同。机器人系统作为一个综合控制、电子、机械、软件等多领域的复杂的机电系统，以机械结构为依据分解系统是一种理想的模块化方法。通常，模块化产品的构成模式可用一个简单的公式表达:系统=通用模块(不变部分)+专用模块(变动部分)。要到达目标并操作以完成任务，机器人系统一般具有移动和作业两个基本的功能。机器移动是由驱动器带动适当构型的关节结构实现的，而作业功能通常是由所谓的执行器完成。 考虑到主机器人结构和功能的特点，结合上面描述的模块化分解方法，我们把主机器人分解成关节模块(即通用模块)和功能模块(即专用模块)。分析转轴与自身轴线之间的关系，可知运动构型中包括两种基本的关节:回转关节和摆动
18、关节。回转关节的转轴与自身的轴线重合或平行，称之为I关节。摆动关节的转轴与自身轴线垂直，称之为T型关节。关节模块就包括I关节模块和T关节模块，这两种模块都拥有单一自由度。功能模块可以根据实际需要设计，这里设计有手柄模块。根据模块化的要求和主机器人的结构功能要求，模块化主机器人的设计应遵循以下的原则: (l)舒适性。(2)独立完整。 (3)质轻紧凑。(4)简易互换。(5)准确性。(6)模块种类精简。根据以上的原则，本文设计了两种自由度单转动的关节模块，即I模块和T模块，作为基本模块，还有功能模块，即操作手柄(H模块)。应用这两种关节模块可以灵活地构建多种主机器人本体，再加上一个或两个手柄模块，可
19、以方便地控制多种从机器人系统。2.3随遇平衡的实现在操作过程中，随着主机器人位姿的变化，各关节所支撑的结构的质心位置跟随着变化，由此产生的重力矩的大小也不断发生变化，会使机器人部分或者整体有向下倾斜的趋势。因此在设计时要保证主机器人达到随遇平衡，即当不受外力的作用的时候，能够克服自身的重量，在任何位置和姿态都能保持静止状态。 为了研制结构简单、控制简单、操作性能好、低成本且能实现完全平衡的主机器人，本课题采用增大关节阻尼的方式，在关节模块内安装缓冲器，缓冲器具有恒定阻尼，且产生的反力矩约等于主机器人在极限位置时的重力矩，从而实现系统的随遇平衡。 以常见的5自由度的操作臂构型为例，校核缓冲器的扭
20、矩。机器人的构型中，两端分别为基座和手柄，中间是3个转动轴互相平行的T所示，主机器型关节串接，两端与T型关节串之间分别通过l个I型关节连接.其构型如式(2一l)所示:B-I1T1T2T3I2-H (2一l)式中，B表示基座，H表示手柄，T表示T型关节模块，I表示I型关节模块，土和日分别表示相邻的2个关节模块转轴之间的垂直和平行关系。图2-2-a)是主机器人的构型图，图2-2-b)是主机器人的实物图。最大负载时的结构是当Tl关节转角为90。，后续关节“一”摆开时，TI关节受到的扭矩最大。图2-2最大负载时的结构图通过计算得Tl往后的结构的质量为m=604.139，重心的位置为X=一4.97mm，
21、Y=-0.42mm，z=180.08，力臂长为=180.15mm，则Tl受到的扭矩为M=mgL=1 .07Nm。我们选用扭矩恒为INm的缓冲器，因为这是机器人的极限位置，基本上不会到达这个极限，所以扭矩也是小于该极限值，再加上关节摩擦力，可以使机器人保持随遇平衡的同时，保证操作的舒适性。选用的缓冲器是FUJI公司生产的单向摩擦式缓冲器，图2-3显示了两种关节模块分别选用的缓冲器，考虑到安装的方便，两种缓冲器的结构有所不同，I模块选用的缓冲器的安装方式是通过凸台与模块中的凹槽配合实现的，这样是由I模块的转动轴与结构轴线重合以及径向尺寸有限决定的;而T模块选用的缓冲器的安装方式则是通过单边法兰固定
22、实现的，这是由T模块的转动轴与结构的轴线垂直以及结构轴线上的空间比转动轴线上的富余决定的。缓冲器的详细参数见表2-1。图2-3两种模块选用的缓冲器表2-1模块用缓冲器2.3主机器人模块2.3.1 I模块 I模块的转轴与自身结构的轴线重合，具有回转的运动功能。I模块主要包括两个相互旋转的基座、转动轴、编码器和缓冲器等零件。因为主机器人的运动是由操作者手动驱动的，所以模块不需要有电机等动力源。我们发现仅通过螺钉只能轴向定位转动轴，但轴还是可以切向窜动，这对一个需要精确转动的零件来说是不能容忍的，所以我们增加了切向定位结构，如图2一4所示，通过增加凸台，使得两个相对转动件在切向上有平面接触。通过这种
23、改进，转动轴的切向定位效果非常好，与旋转基座2固连成一体。图2-4工模块的旋转基座2与转动轴之问的切向定位结构2.3.2 T模块 T模块的转轴与自身的轴线垂直，具有摆动功能。T模块主要包括两个相互摆动的基座、转动轴、编码器和缓冲器等零件。T模块同样不需要动力源。 T模块与I模块具有相同的零部件，但结构却完全不同，因为I模块实现的是回转运动，所以转动相关的零件包括转动轴、编码器、缓冲器等，均可与模块自身的轴线重合，但是T则必须是垂直的，否则传动结构将很复杂。孔进入到T模块的内腔与控制器连接。 在T模块内同样有个双层圆状的控制器，用于提供编码器的电源、控制关节模块转角信号的采集并与CAN总线进行通
24、信。不同类型模块的控制器是完全一样的，可以相互替换，这样也实现系统电气上的模块化。控制器通过两个双头螺柱和螺钉与摆动基座l固定连接。摆动基座l两侧也有对称的两个直方孔，作为USB外接线与外电源总线和CAN总线连接的通道。 T模块两端同样有统一的机械接口，可以通过卡环便捷地与两端的模块串联对接。模块尺寸为中40X109.8mm，为了减轻重量，主体材料采用铝合金，整个模块质量更轻，仅有149.79。T模块的摆动范围为士110。，其整体外形结构如图2-5所示。图2-5关节模块的外形结构图2.3.3 应用模块化方法的效果我们研制了一系列主机器人模块，包括I模块、T模块、手柄模块和基座模块等等，这些模块
25、能够方便地、灵活地连接组合成各种能够随遇平衡的主机器人机构。通过模块化设计，我们的研制的主机器人系统有如下的优点:一是成本低:模块大都是标准的、可大规模制造的，因此在搭建主机器人系统时的设计、制造、装配和维修成本将比用传统方法低很多。二是具有可重构性、控制直观。通过改变模块之间的连接或组合来改变系统的结构。这样系统可以根据从机器人的需要灵活地调整构型以适应任务要求，主从机器人的构型接近，则控制程序简单且控制操作直观。三是具有通用性。只需几种标准的模块，就可以组成多种主机器人系统应对多种构型的从机器人。根据任务的要求，可以增加或者减少模块而不影响其他模块的正常工作。四是改型设计和研制周期低:因为
26、根据任务的改变要求可能只需改进个别模块，不需全部重新设计，这样工作量就会减小。另外由于系统功能分割成多个模块，而模块之间相互独立，任务被分解可以减小复杂性并且能单独并行开展，所以当需要对机器人进行修改时，设计和研制周期将大大缩短。五是结构简单、装配方便:我们选用缓冲器实现系统随遇平衡，并且使转动部件的转动轴与模块的轴线重合等措施，大大简化了机械结构，并且考虑到结构的对称性和可替换性，使系统装配连接简单、安全可靠。六是操作舒适:主机器人系统可以根据操作者的需要，调整自己的构型，使得整个过程中的姿态、位置更方便操作。第三章 机器人控制系统设计3.1控制系统硬件设计控制器负责采集关节模块的角位移和手
27、柄的开关信号，并把这些信号传送到CAN总线上，同时从总线上接收发给该模块的控制信号。整个控制电路包括主控芯片的最小系统模块、信号采集模块(鉴相计数模块)、电源模块、通信模块、编程下载与仿真接口模块等，整个电路硬件框图如图3一1所示。该电路完成了传感器与按钮信号的采集、与总线通信、以及传感器的电源供应等三大功能，是主机器人准确控制从机器人不可缺少的部分。本节将详细介绍该控制器电路的工作原理。图3一1扩展控制电路硬件框图3.2单片机最小系统模块 本通信节点电路采用美国cygnal公司生产、完全集成的系统型芯片c805lF043微控制器。尺寸小，在同系列的芯片中，它是封装尺寸最小的单片机，这是我们狭
28、小的模块空间所需要的;集成了完全支持CAN2.OA和CAN2.OB的CAN控制器，符合我们想利用单片机加CAN接收器实现CAN通信的要求;它内部还带有JTAG接口，允许在MCU上进行非侵入式(不占用片内资源)调试，使调试变得非常方便;采用流水线处理结构，平均指令速率达25MIPS，满足我们实时性的要求。综上这些功能，说明该主控芯片非常适合该电路的设计要求。由于单片机的内部晶振器频率跨度很大，从24MHz到25MHz，不符合需要精确控制的主机器人的要求，所以为了提高系统的稳定性，系统在稳定工作后采用外部振荡器，出于空间考虑，选用晶体四脚无源贴片晶振XS一3225作为振荡器。外部晶体配置电路中两个
29、30PF电容提供晶体正确振荡所需要的负载。晶体振荡器电路对PcB布局非常敏感，所以将晶体靠近微控制器的XTAL引脚，与两个XLAL引脚的连线尽可能地短并且尽量平行，以防止多余的连线引入的噪声或干扰。3.3 CAN通信模块设计 设计中，C805lF043的CAN控制器的串行数据输出线CANTx和串行数据输入线CANRX分别连接到收发器PCA82C25O的接受引脚TXD和发送脚RXD。PCA82C25O收发器通过两个总线终端CANH和CANL与总线连接，这两个输出引脚具有差动发送和接收功能。引脚RS作为斜率控制电阻输入端与地之间的电阻为斜率电阻，该电阻具有分流作用。在波特率较低的情况下，一般采用斜
30、率控制方式，电阻选择在16一140KQ之间，这里选用为47KQ。参考电压引脚Vcc，电源电压选用SV电压。Vref作为基准电压输出端，这里采用悬空处理。而CANH，CANL脚是信号的输入输出，实现对电平信号的传送，完成通信传输。分别在CANH、CANL两个引脚和CAN总线之间串接一个SQ的限流电阻，当过流时电阻发热，阻值变大，保护82C250免受过流的冲击;在CANH和CANL与地之间分别反接l个保护二极管，可起到一定的过压保护作用，阻止发送器输出级的破坏;并联2个30PF的小电容，可以滤除总线上的高频干扰和电磁辐射。CANH，CANL脚之间串连一个124的匹配电阻和一个跳线接口，当该通信节点
31、用在总线的一端时，就加上跳线帽，使匹配电阻接进电路中，用于消除长距离线反射所引起的干扰。CAN总线两端的两只匹配电阻对于匹配总线阻抗具有相当重要的作用，保证了通信的抗干扰性及可靠性。CAN通信模块的电路原理图和PCB图见参考附录。3.4控制器设计为了使每个模块也实现电气上的模块化，控制器必须是紧凑、尺寸小并且具有高的控制性能与通信性能的。控制器负责采集关节的角位移或手柄的开关信号，并把这些信号传送到总线上，同时从总线上接收发给该模块的控制信号。采用新华龙公司的c805lF043作为主控芯片，主频为24MHZ，负责对编码器转角信息和手柄开关量进行收集，并利用其内部的CAN控制器与外部的CAN收发
32、器实现与CAN总线信号的传输，接收上位机的控制命令。编码器信号的鉴相计数电路由3个四位可逆计数器74Lsl93串联而成，其输出为12位的二进制数，将其初值设为即2048，逆时针旋转时，测量范围为2048一1024，顺时针旋转时，测量范围为2048一3072，满足编码器的精度采集要求，计数电路的数据输出DO一Dll送至主控芯片处理。第四章 机器人主从控制策略4.1从机器人系统搭建从机器人是任务的执行者，所以必须具备运动和作业两种基本的功能。运动是由驱动器带动适当构型的关节结构实现的。根据模块化设计的一般原则，我们同样设计了模块化从机器人系统。该系统包括两种关节模块(I模块和T模块)和多种功能模块
33、。关节模块都具有单一转动自由度，I模块的转动轴线与自身轴线垂直，T模块的转动轴线与自身轴线重合，经过了两代的开发和优化分析设计，关节模块的性能达到了较好的状态。关节模块有相同的机械安装接口，可以方便地互相连接。应用这两种基本的单自由度的关节，可以组建多种机器人的主体。功能模块的机械连接接口与关节模块一样，因此可以方便地把它串联在机器人主体的一端或两端，不同的功能模块结合机器人主体可以构建多种机器人系统用于实现不同的作业任务如操作臂作业或者爬杆、爬树等功能，如图4-1中所示。图4-1模块从机器人系统4.2同构型主从控制策略 采用位姿一位姿型控制策略，控制系统如图4-2所示。主机器人和从机器人各自
34、有自己的传感系统。操作主机器人时，主从机器人各自检测自己的位姿，当主从位姿不同时，必然存在位姿差，根据该位姿差信号驱动从机器人动作，让从机器人一直跟随主机器人的位姿，直到两者完全重合为止。图4-2位姿一位姿型控制系统方框图 同构型的主机器人采用双手柄构型H1-H2，主从机器人的主体构型一样，自由度数目和运动藕合方式相同。此时主从机器人的结构上的不同就是末端执行器，从机器人是两个末端执行器(以攀爬机器人为例，则是夹持器)，主机器人是两个手柄。对于控制5一DoFs的攀爬机器人Climbot的主从控制系统的构型如4-3所示。主从之间对应模块的长度尺寸为常数，工作空间之比也是该常数。因此，可以用主机器
35、人的各个关节的位移量直接控制从机器人各个关节的运动。此时的映射关系为: 主从机器人之间对应关节一一映射，包括末端执行器(H1对应于G1，H2对应于G2)。作者可以两手各个持握两个手柄，根据期望的从机器人运动轨迹操作手柄，通过采集主机器人各个模块的位姿信号，分别控制对应的从机器人模块，就可以控制从机器人根据这个轨迹运动，控制形象直观。图4-3同构型主从机器人的构型映射4.3镜像同构型主从控制策略 镜像同构的主从机器人中，主机器人采用操作臂构型B-H，只有一端有手柄，另一端是基座，用于固定整个机器人。对于控制5一DoFS的攀爬机器人Climbot的主从控制系统的构型如4-4所示。也是采用采用位姿一
36、位姿型控制策略。因为主从机器人的主体构型一样，所以还是采用对应关节一一映射的控制方式。但是与同构型由有所不同，因为它需要通过操作主机器人的一个手柄来控制从机器人的两个末端执行器。以图4-4的构型为例，此时的从机器人的运动学模型为，此时的模型与主机器人的一致，主机器人的运动学模型为，设定主从之间的映射关系为 即主机器人的基座B对应于从机器人的末端执行器Gl，手柄H对应于G:，以此类推，相应关节互相对应。镜像同构控制过程具体细分为两个步骤: 步骤一：当从机器人的末端夹持器Gl夹紧时，要移动G:到达目标夹持点，由于主从机器人相应模块的转动范围一样，长度比例恒定，可以通过主机器人的各个关节的位移量直接
37、控制从机器人各个关节的运动，不需做任何的变换。 步骤二：当从机器人的G2夹紧，换成要移动Gl到达目标夹持点时，因为各个模块串联成一个整体，Gl和G2之间的运动是相对的，主机器人的两个末端基座B和手柄H的运动也是相对的，H的运动相当于固定H后，B沿反方向运动。这样，操作者在控制的过程中，只要如果想让从机器人的末端执行器Gl向左移动，则需控制手柄向右移动，如果想控制Gl向上移动，则是控制手柄向下移动。但是各个时刻主从机器人的位姿还是保持一致的。控制过程中还是用主机器人的各个关节的位移量直接控制从机器人各个关节的运动，不需任何的变换。只是此时主机器人的运动端是B，但从机器人的运动端却是Gl。 由此反
38、复，操作者只需操控主机器人手柄，就可以控制从机器人的两个夹持器交推动作，进行攀爬作业。Gl和G2之间的交换通过按钮3控制，当按钮3断开时为Gl工子模式，连通为G2工作模式。这就是镜像同构的概念，步骤一中，主从机器人完全同构，从机器人的运动过程中的位姿变化与主机器人完全一样，但在步骤二主从运动位姿变化则是镜像对称的。但整个过程的各个时刻，主从机器人的位姿都是保持一致的。这种控制方式相对于异构型的控制方式，不仅控制简单直观，而且误差小。因为它是通过关节一关节一一映射方式控制的，不是通过运动学正逆解和工作空间的比例映射来控制，所以单关节的误差不会累积放大，误差小。图4-4镜像同构型主从机器人的构型映
39、射第五章 机器人构型采用5自由度操作臂的构型进行实验，模块链为B一I1一T1一T2一I2一T3一H，构型如图5-1所示。图5-1 5一DoFS操作臂 我们要求解从基座坐标系到末端执行器坐标系的坐标变换矩阵T60，这个矩阵表示机器人末端执行器在基系中表现出的位置和姿态矩阵。Climbot的D一H参数表如表5-1所不。 则可求得各杆的变换矩阵:给定各关节的转动范围和各杆件的长度(如表5一2)所示，可得该构型的主机器人的工作空间，如图5一2所示。其工作空间是由两个曲面包络的区域。外曲面是一个桃形曲面，其上面部分是半径为424.7mm的球面的一部分;内曲面是一个半径为53.9mm的球面。同样的方法可以
40、求得其他构型的工作空间。第六章 结论针对现存主机器人结构复杂、随遇平衡不理想、通用性不强、控制复杂不直观等不足，本文用模块化方法研制的主机器人。本文完整搭建了模块化主机器人系统，包括机械结构的研制、控制器硬件的开发和控制程序的设计。该主机器人系统仅包含机构简单的两种单自由度关节模块和手柄模块。灵活组合连接这些模块可以构建多种构型的主机器人，用以控制不同的从机器人系统;另外根据从机器人面对的不同环境和作业任务，可以通过改变模块之间的排列顺序和连接方式，甚至是增加模块，使主机器人更加简便、迅速地控制从机器人作业。模块化的方法克服了主机器人通用性不强、控制复杂和操作不直观的缺点。比较各种实现随遇平衡
41、的方法后，我们选择通过在关节处安装恒扭矩阻尼器的方法实现主机器人的完全随遇平衡，该方法结构简单，控制方便，且适合模块化的结构要求。控制系统采用基于CAN总线的分布式控制方式，充分发挥了模块化的优势。并通过攀爬主从式控制例子说明了模块化主机器人系统的优越性，根据操作的需要可以通过改变构型可以使主从同构或异构，控制直观、简单。应用主机器人系统，针对某一固定的从机器人系统，可以构建多种主机器人构型与之对应，因此操作者有更大的选择空间去挑选适合自己操作习惯又能优化控制系统性能的构型。 但是由于机械结构和控制系统等方面的不足，该主机器人系统仍还有很大的改进空间。首先是是精度和迟延问题，本文分析了误差的来
42、源和迟延的成因，后续改进工作将从这些主要原因入手。其次是上位机辅助控制系统还不够完善，包括图像反馈和虚拟仿真环境等。还有就是微操作有点难度，操作者需要反复练习才能准确操作和控制，这点需要从结构操作性能的优化和控制系统对动作的判断与处理能力的完善两方面进行改进。另外，后来的工作重点之一将是针对不同的从机器人、不同的作业对象设计合适的构型并且实际控制操作，使该平台广泛地服务于人类生活和研究。参考文献1刘璇. 面向特种机器人的模块化设计方法研究D.河北工业大学,2010.2闫华晓. 模块化工业机器人设计的若干问题研究D.浙江大学,2008.3单以才. 机器人机械操作臂的模块化设计及其控制的研究D.扬
43、州大学,2003.4吴文强,管贻生,朱海飞,苏满佳,李怀珠,周雪峰. 面向任务的可重构模块化机器人构型设计J. 哈尔滨工业大学学报,2014,46(03):93-98. 5陈航,殷国富,赵伟,周晓军. 工业机器人模块化设计研究J. 机械,2009,36(03):56-58. 2017-08-31. 6雷静桃,王田苗,何勇灵. 基于功能构件分解的机器人模块化设计方法J. 机器人技术与应用,2009,(02):40-44. 7曹燕军,葛为民,张华瑾. 一种新型模块化自重构机器人结构设计与仿真研究J. 机器人,2013,35(05):568-575+606. 8王勇. 可重构模块化机器人的构形及运动学设计D.西华大学,2006.9王林. 可重构模块化机器人构形设计理论及方法的研究D.武汉理工大学,2007.10肖超,周玉林,盛海泳,侯雨雷. 工业机器人机械本体模块化设计J. 中国机械工程,2016,27(08):1018-1025. 11舒畅,熊蓉,傅周东. 基于模块化设计方法的服务机器人结构设计J. 机电工程,2010,27(02):1-4. 12周雪峰,江励,朱海飞,蔡传武,管贻生,张宪民. 一个模块化机器人平台的设计J. 华南理工大学学报(自然科学版),2011,39(04):50-55+61.13庞博. 模块化蛇形机器人的设计与研究D.河北工程大学,2014.