1、 本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 1 页 共 43 页1 引言机器人的诞生和发展与科学技术革命有着密切的关系，符合科技革命关于生产实践需要的理论。机器人作为一种高技术，也是不断发展和完善的，这种不断的发展和完善是通过科技革命的内在推动力来实现的。同时，机器人的发展和广泛应用，使科学技术成为显见的生产力，极大地推动着科学技术的发展，推动着人民生活的改善，推动着生产力的提高，推动着整个社会的进步。机器人技术作为当今科学技术发展的前沿学科，将成为未来社会生产和生活中不可缺少的角色。机器人，英语为 ROBOT，意思是一种干脏活的人形机器。它体现了人类长期以来的一种愿望，即创造一
2、种像人一样的智能机器，以便能够代替人去进行各种各样的工作。机器人虽然是一个新造词，但关于机器人这一思想的渊源，却可以追溯到遥远的古代。早在我国西周时期，就有能工巧匠侣师制作了一个歌舞“机器人”献给周穆王；公元前 3 世纪，古希腊发明家戴达罗斯用青铜为可里特岛国王迈诺斯塑造了一个守卫宝岛的青铜卫士塔罗斯；我国东汉时期，张衡发明了用于军事的指南车，可以说它是最早的移动机器人雏形 1。 随着科技的发展，18 世纪出现了以蒸汽机发明为标志的第一次技术革命，这引起了古代机器人技术的进步。1893 年 More 制造了“蒸汽人”，它的腰由杆件支撑，靠蒸汽驱动双腿沿圆周运动。以上这些自动玩具或自动作业机的出
3、现均是以当时的科学和技术为基础。用现代的眼光来看，它们的功能是单一的，实现方法是落后的，但它们却代表了当时的最高科技水平 1。20 世纪，人类取得了辉煌的成就，从量子力学、相对论的创立，原子能的应用，脱氧核糖核酸双螺旋结构的发现，到信息技术的腾飞，人类基因工作草图的绘就，世界科学发生了深刻的变革。信息技术、生物技术、新材料技术、先进制造技术、海洋技术、航空航天技术等都取得了重大突破。此时，科学技术化，技术科学化，科学技术密不可分，出现了人类历史上第一次科学与技术的综合性革命现代科技革命圆。 现代机器人是电子工程学、机械学、控制论与控制工程学、计算机科学与工程、人类学、社会学、人工智能、生物学等
4、多学科的集成，所以它是多学科科技革命的必然结果。 本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 2 页 共 43 页当时电子计算机已经出现，电子技术也有了长足的发展，产业领域出现了受计算机控制的可编程的数控机床，与机器人相关的控制技术和零部件加工有了扎实的基础。另一方面，人类需要开发自动机械，代替人去从事一些恶劣环境下的工作，比如在原子能的研究过程中，由于存在大量放射性，要求用某种操作机械代替人来处理放射性物质。正是在这一背景下，美国原子能委员会的阿尔贡研究所于 1947 年开发了一种遥控机械手代替人，1948 年又开发了主从机械手。1954 年美国人乔治?德沃尔设计出了第一台可编程
5、(示教再现型)的工业机器人，在此基础上，创建了Un5m 此 on 公司，并于 1962 年生产出来，取名为 Unimate。此机器人在美国通用汽车公司(CM) 投入使用，这标志着第一代机器人的诞生。从此，机器人开始成为社会系统中的一员，影响着社会的发展、科技的进步。从 20 世纪 60 年代初，美国生产出最初的工业机器人，到 20 世纪 80 年代初，机器人技术经历了一个长期缓慢的发展过程。到了 20 世纪 90 年代，随着计算机技术、微电子技术、网络技术等的快速发展，机器人技术也得到了飞速发展。除了工业机器人水平不断提高之外，各种用于非制造业的先进机器人系统也有了长足的进展。现将按工业机器人
6、、特种机器人两条技术发展路线分述机器人的发展进程。从机器人的发展进程可以看出，随着计算机技术、人工智能技术、信息技术等的飞速发展，使机器人在功能和技术层次上有了很大的提高，机器人的视觉、触觉、自主控制等技术就是典型的代表。由于这些技术的发展，推动了机器人概念的延伸。20 世纪 80 年代，将具有感觉、思考、决策和动作能力的系统称为智能机器人，这是一个概括的、含义广泛的概念。这一概念不但指导了机器人技术的研究和应用，而且又赋予了机器人技术向深广发展的巨大空间，水下机器人、空间机器人、空中机器人、地面机器人、微小型机器人等各种用途的机器人相继问世，许多梦想成为了现实。将机器人的单元技术渗透到社会的
7、各个领域形成了各式各样的新机器机器人化机器。当前与信息技术的交互和融合产生了“软件机器人”、“网络机器人”；与纳米技术、分子生物学的交叉和融合又产生了“纳米机器人”；今后也许与克隆技术的结合将会产生“克隆机器人”问。这说明了机器人所具有的创新活力，也说明了客观世界是一个相互作用，相互联系的统一世界。任何一门学科都是对客观世界某一方面或某种运动形式的本质和规律的正确反映，客观世界普遍联系的特征也必然会在各门学科的思想、理论体系中反映出来，同时也决定了各门学科之间的相互联系、相互依赖和相互作用的关系，决定了它们是一个有机联系的科学整体。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 3 页
8、 共 43 页机器人融合了计算机、信息、自动控制、机械、仿生等技术，从而使机器人技术的发展与其它学科的技术发展极为密切。纵观机器人的发展史，我们可以发现机器人是随着其它学科的兴旺发达而呈现出勃勃生机的。在本文中将介绍和研究仿生机器人的一种蛇形机器人。11 仿 蛇 形 机 器 人 的 原 理 及 研 究 热 点机器入学本身就是一个多学科交叉的学科，她需要多方面知识的融合。蛇形机器人作为机器人系统，也需要机构、控制、电子、通讯和智能等各个方面的支撑。本文粗略地将蛇形机器人的主要研究内容分为如下几个方面：蛇的运动原理研究：蛇的运动形式独特，运动姿态复杂。很多学者已经对蛇的运动原理和运动形式做了研究，
9、但绝大部分是从生物角度出发的。近些年随着仿生机器人的发展，机器入学者开始从机器人运动角度来研究蛇的运动原理，这是设计蛇形机器人的前提。蛇形机器人机构：机构设计是蛇形机器人研究的核心和基础。在机构设计阶段，必须综合考虑蛇形机器人的控制方式、电路情况、通讯方式和电源情况。如果要加传感器，必须考虑传感器的信息融合。根据蛇的骨骼结构，目前蛇形机器人的单元大多采用模块化设计，模块化设计节约设计和生产成本，方便维修。如果采用精巧的连接机构和连接电路，蛇形机器人就成为可重构机器人的一种构形状态。蛇形机器人运动形式和运动原理：这方面的研究主要有两个出发点，一个是根据自然蛇的运动状态，研究和提出适合蛇形机器人的
10、运动形式。另一个是根据本身的机械系统建立蛇形机器人的物理模型，提出控制规律，研究蛇形机器人的运动原理。蛇形机器人的控制方法：蛇形机器人具有超多的自由度，对蛇形机器人的控制无论在硬件上还是软件上都是一种挑战。现在，与机构相对应，蛇形机器人的控制一般也采用模块化的设计理念。每个模块化单元都包括控制（软件和硬件）单元。蛇形机器人的环境识别：蛇形机器人要达到应用的目的，必须具有高度的适应性、运动能力。环境是影响蛇形机器人运动的重要因素，同一种运动方式在不同的环境中的运动效果截然不同。例如：在光滑地面上的和粗糙地面上的蜿蜒运动效果相差甚远，尤其是在沙滩上蜿蜒运动简直不能前进。所以必须选择合适的一个或一组
11、传感器来识别环境信息。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 4 页 共 43 页蛇形机器人的智能控制：完成从上层的自主决策到下层的运动控制，使蛇形机器人成为真正意义上的智能机器人，是研究蛇形机器人的最终目标。12 仿 蛇 形 机 器 人 的 研 究 意 义传统的比较早的移动方式大多基于连续转动原理，靠轮子与地面作用实现运动；它的运动效率比较高，它对地面环境要求比较严格，比较适于平坦而质地比较硬的路况；为了增加地面的适应能力，后来出现了履带式，但它还不能充分体现运动的灵活性；这就促进了人们寻找新的运动模式。随着仿生学的发展，人们把目光瞄向了生物界；较早出现的步行机器人是四足的，
12、后来又陆续出现了两足的、六足以及多足机器人，步行机器人在一定程度上提高机器人的地面适应能力，但美中不足，它的稳定性及在松软地面的适应性比较差；于是在 21 世纪 40 年代人们又把目光转向了蛇，开始思索一种新的运动模式“无肢运动” 1。大多数己知生物和运输工具在运动时有一个共性：他们与地面的接触点是变化的；比如人是靠两腿的交替变化行走的；车子是靠车轮在地面上滚动，不停地改变接触点行走的。然而蛇在行进过程中，它的整个身体与地面接触，它与地面的接触点是不变的。从这一点上讲，蛇是一种特例。从运动效率上讲，滚动高于移动，两足高于四足，也就是说随着运动物体与支持面的接触点的增多，它的运动效率也相应的降低
13、，因此蛇的运动效率较其他有肢动物来说，比较低，但从另一角度讲，随着接触点得增多，它对地面得适应能力增强，汽车只能在平坦硬质的地面上行驶，两足的稳定性比较差而且对地面的要求也比四足高，因此蛇适应能力是最强的，它不但可以在崎岖的山路上行走如飞，而且可以在沙漠沼泽地上蜿蜒前进。作为有肢运动和无肢运动的完美结合，当属履带式，虽然其接触面大了，却提高了对松软地面的适应能力，但其仍可简化为两杆系统，相对于蛇这种多杆系统来说，身体柔性明显减弱，不能使用于崎岖不平的山区。按生物进化的观点，任何生命都有存在的理由，都有对其生存环境的适应性，这是千百年来自然选择的产物。在移动机器人领域，也不可能制造一种万能机械，
14、只能根据环境的要求，提出相应的设计方案；任何事物都是有利必有弊，不可能两者兼得，关键是看我们追求的重点。假如追求高效率，那么轮式的是首选；假如追求在非结构化环境的适应性，而对效率要求不高，多杆系统（蛇形机器人）为最佳。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 5 页 共 43 页13 蛇 形 机 器 人 的 优 缺 点 和 用 途虽然蛇形机器人已经表现出了良好的运动能力和适应环境的能力，但是与其它一切事物一样，蛇形机器人也不是十全十美的尤物，它具有很多优点，当然也存在很多不足。因此，蛇形机器人的应用环境和场合也受到一定的限制。1.3.1 蛇 形 机 器 人 的 优 点模仿蛇的身体
15、结构制作的蛇形机器人，不仅具有机构简单的特点，而且调整超冗余的身体使其能够适应环境。蛇形机器人具有蛇的运动特点能够完成以下功能：1)蛇形机器人的超多自由度使其身体具有柔软的特性，能够充分适应地形，完成在粗糙不平地面上的爬行动作。2)蛇形机器人能够将体重平均分配到支撑面上，使其能够在沼泽或者沙地上爬行。这一特性使蛇形机器人能够在强度比较低的平面上运动，例如：地震过后的楼房地板，对抢险救灾的应用十分有利。3)蛇形机器人具有细而长的体形，通过运动学的规划，它能够跨越窄沟和穿过细小的空隙，这是轮式或者腿式移动机器人很难完成的任务。4)将蛇形机器人的一端固定，它可以作为超冗余机械手完成各种复杂的抓取动作
16、。而且其本身的自由度就可以作为操作臂的夹持器来夹持物体，不用象传统工业机器人那样配备相应的夹持器。可以说，蛇形机器人在功能上是个多面手。5) 一般，蛇形机器人采用模块化设计，每个模块都相同，方便安装和维修。特别值得一提的是，近几年来可重构模块化机器人的研究也是机器人研究的一个重要和热点领域。蛇形机器人可以作为可重构模块化机器人的一个基本体。如果在模块上设计合适的连接和断开机构，蛇形机器人就可以变形成各种形式或组成新的机器人，还可以分开成几条蛇形机器人，完成协同作业。也可以随时甩掉自身的一个或几个模块，甩掉无法工作的模块有利于机器人的运动。如果在每个模块上安装特定的传感器，蛇形机器人可以通过在指
17、定位置甩掉模块的办法来布置传感器 1。6)蛇形机器人具有超多的自由度，当机器人的某个或某几个单元不能正常工作时，它仍然能够完成指定任务。因此蛇形机器人具有高度的可靠性和安全性。7)蛇形机器人在完成运动时，所有关节都不需要外露。如果在机器人的外面加上防水或防腐材料使机器人密封，它能够进入有各种泄漏的危险场台作业。也可以像蛇一样在液体环境中游泳，成为水陆两栖机器人，大大扩展了该类机器人的应用本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 6 页 共 43 页范围。8)通常情况下，在运动过程中蛇形机器人的细长而柔软的身体始终接触地面而保持最低的身体重心，使其具有高度的稳定性。而在传统的移动机
18、器人中稳定性是个十分重要而棘手的问题。特别是在腿式移动机器人和轮式移动机器人上，稳定性成为机器人运动控制的核心问题。而在蛇形机器人上，通常不必过分关注蛇形机器人的稳定性，除非执行比较特殊的操作动作。此外，蛇形机器人作为一种超冗余串联机构，通过巧妙规划和设计该机构的构形也可以实现运动，面这些运动形式并不是来源于蛇的运动。当机构中加入被动轮约束的时候，蛇形机器人可以完成在非完整约束情况下的运动控制，从而实现基于物理系统模型条件下的蛇形机器人运动控制，而不是从仿生角度下的运动输入形式。从理论角度解释了蛇的运动或蛇形机器人的运动原理。1.3.2 蛇 形 机 器 人 的 缺 点蛇形机器人的优点众多，但由
19、于身体结构、动力驱动和运动形式的原因，蛇形机器人也存在很多缺点。1)蛇形机器人的超多的自由度使机器人能够完 成各种复杂运动，组成各种构形。但在控制上，给完成超多自由度的软硬件控制的实现带来了巨大的压力。而且太多的自由度给驱动单元运动的驱动器带来巨大的压力。实验表明，蛇形机器人完成三维运动需要单元具有很强的驱动能力；随着自由度数量的增加，对单元驱动能力的要求也增加。即使巧妙设计蛇形机器人机构，解决效果也是很有限的。2)蛇形机器人本身的串联结构和爬行的特点使其无法完成携带物体操作的任务。因为依靠与地面间的摩擦实现运动，它的驱动能力十分有限，根本无法完成拖动物体等负重任务，所以蛇形机器人执行的任务只
20、能限制在去观察、检查现场和完成操作任务。3)在电源供应方面，由于外露面积小，无法有效利用太阳能。目前还无法有效解决宇宙探索中的能量供给问题。即使采用直流电源供电，由于本身的体积较小和爬行运动的运动形式，蛇形机器人无法携带大的电源，严重限制了蛇形机器人的应用和无线操作时间。4)在理想条件下，蛇的最大速度为 3m/s，而通常情况下，蛇的运动速度很低。目前就作者所知，蛇形机器人的运动速度都很低，很难与传统的轮式移动机器人相比。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 7 页 共 43 页1.3.3 蛇 形 机 器 人 的 应 用相对于传统的移动机器人，蛇形机器人具有很多优点，能够应用到
21、很多复杂和危险的环境中。虽然目前蛇形机器人的研究尚处在实验阶段，但蛇形机器人有广泛的应用前景。蛇形机器人可以应用到但不仅仅局限在以下各领域：1)科学探险和状况检查：代替或部分代替人去完成危险环境中的作业是研制机器人的主要目的之一。科学探险是科学家探索大自然奥秘和丰富地质资源的有利手段，但常常因为环境和气候恶劣，无法到达目的地完成指定的探险任务。非结构环境下的作业和运动对机器人的性能和运动形式提出了非常严格的要求。蛇形机器人本身的移动特点和封闭结构有利于应用到科学探险和状况检查。2)防恐防爆和灾难救援：自美国纽约的 911 事件之后，防恐防爆成为各个国家维护国家安全和人民生命财产不受侵害的主题。
22、机器人学的研究人员制作了形式各异的机器人来代替人去完成防恐防爆和救援伤员的任务。蛇形机器人也适合于完成灾难救援任务。特别是蛇形机器人身体的各个部分都与地面接触，对地面的压力均匀而且非常小，适合在灾难后的危险建筑中运动和搜救。这些灾难主要包括：地震、爆炸、地质陷落、龙卷风和火灾等等。3)医疗：设计小型的移动机器人，进入人体器官（如肠道、血管）完成手术和定点给药是机器人研究的一个新的热门领域。如果将蛇形机器人做得非常小，就可以进入人体的肠道完成作业。4)航空航天：神州五号飞船的顺利返航证明了中国在航空航天方面坚实的科学实力。探月工程的启动表明中国政府探索外星系的决心和信心。正像美国的勇气号和机遇号
23、机器人在火星上执行作业一样，探月工程也需要机器人来完成各种作业。蛇形机器人有望在这方面得到应用。5)危险环境作业：能够用身体移动和操作是蛇形机器人有别于其它移动机器人的一大特性。它可以穿越狭小空间、进入危险环境，然后完成操作任务。安装合适的传感器后，也可以应用蛇形机器人来完成排雷任务。6)军事：蛇形机器人本身体形细小，加上合适的伪装后，便于隐身。此外，如果蛇形机器人的每个单元都安装上传感器，那么它可以用甩掉关节的办法来布置传感器，形成一个大型的信息系统。7)作为操作手：将蛇形机器人的一端固定，那么它就变成一个具有冗余自由度本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 8 页 共 43
24、 页的操作手，可以完成复杂的抓取动作。 114 课 题 主 要 研 究 内 容1、对微小型移动机器人行走方式和生物蠕动的运动机理进行一定的研究，设计仿蛇形机器人可行的运动方案。2、在机械 CAD 环境下进行机器人蜿蜒爬行和转向运动的仿真，进行参数化设计。3、利用 CAD 设计软件对仿蛇形机器人蠕动机构进行结构设计，并绘制零件图装配图。4、对仿蛇形机器人的运动进行控制研究，设计基于单片机的控制系统。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 9 页 共 43 页2 蛇 形 机 器 人 的 机 构 设 计21 蠕 动 原 理我们将蛇形机器人简化成一系列杆件按一定顺序用转动副首尾连接而成
25、 79，如图 2-1 所示。图 2-1 蛇形机器人运动前初始状态其中 1，2，3，N 代表了转动副和对应的驱动电机。依靠地面对蛇身体的摩擦力，我们可以利用电机驱动转动副 1，2，3，N 依次转动，使部分蛇身与地面构成一个三角形，如图 2-2 所示图 2-2 三角形的形成假设 l01 与地面间的夹角为 ，则现在的 0 点距离初始点就向前移动了 StepL=2l(1-cos),只要继续将波形向前移动如图 2-3 所示图 2-3 三角形波的移动当蛇的每个身段再次回到一直线的位置时，整个蛇就向前移动了距离 StepL。22 蠕 动 步 态 规 划蠕动是蛇形机器人部分蛇体与地面保持静止，另一部分凭借静止
26、部分与地面间本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 10 页 共 43 页形成的静摩擦力实现的向前运动；根据蛇形机器人关节轴与地面间的关系，可以将蠕动分为关节轴与地面垂直的蠕动和关节轴与地面平行的蠕动。关节轴与地面垂直的蠕动是蛇形机器人整个蛇体与地面接触，此时运动部分与地面间不可避免的产生摩擦，而对于关节轴与地面平行的蠕动，沿地面行进时，因为运动部分脱离地面不与地面接触，运动部分与地面之间就不存在摩擦，因此它是一种比较节能的运动步态。本章讨论的重点就是关于关节轴与地面平行的蠕动步态。Chirikjian 曾从仿生学的角度用脊梁曲线模型法对该运动步态进行研究，但作者并没有提出一种
27、可用于实际的蛇形机器人的运动步态；Hua liu 等虽用三个运动杆组成的波形实现了蛇形机器人在平面上的运动，但其控制效果并不理想。本文的目的就是对蛇形机器人的蠕动步态进行系统理论的分析，给出合理的蠕动步态。蛇形机器人的蠕动过程归根结底就是运动杆依次传递的过程，抓住了运动杆的运动规律就抓住了问题的实质。本文就是以运动杆组成的运动波形为线索展开，相对由多运动杆组成的运动波形来说，运动波形由三连杆组成的蠕动步态有解析解 1，在此作为独立的章节进行讨论。虽对运动波形由三连杆组成的蠕动步态进行过探讨，但侧重点在于电机的控制，并没有全面系统地对该步态进的运动机理行分析。2.2.1 蠕 动 步 态 描 述下
28、面我们介绍一下运动波形由三连杆组成的蛇形机器人的蠕动过程；首先将机器蛇简化为 N 节长度为 L 的平面连杆系统。初始状态时蛇形机器人为一条直线，如图 2-4 a 所示，运动开始时，本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 11 页 共 43 页图 2-4 运动波形由三连杆组成的蠕动过程P0Pl 和 P1P2 运动，点 P 沿着 X 轴前进，其他点 pi(i2)固定不动；与此同时，杆件 P0Pl 与 X 轴之间的夹角 a（见图 2-4 中的 b)从 00 到达给定的角度 0 当该阶段结束时，杆 P0P1 与 X 轴之间 的夹角为 0（见图 2-4 中阶段 c） 。此时除了 P1 点
29、外，其他点均位于 X 轴上。下一阶段，P OP1、P 1P2 和 P2P3 为动杆，点 P0 和 Pi(i3)均保持不动，夹角 a 从 a0变为 00 与此同时 P2P3 与 x 轴的夹角 从 00 变为 a0（见图 2-4 中 d） ；当这一阶段结束时，系统处于状态 e；P 1P2、P 2P3 与 X 轴之间成等腰三角形，除了点 P2 外，其他点均位于 X 轴上。重复这个过程，直到蛇形机器人到达状态 f，最后恢复到直线状态g。在一个运动周期内，整个系统沿 X 轴的位移 StepL 相当于点 P0 从状态 a 到状态b 的位移。设每一节长为 l，有StepL=2l(1- cos0) （2-1）
30、2.2.2 由 三 连 杆 组 成 的 蠕 动 步 态 波 形 传 递 模 型从图 2-4 中可知，在波形传递阶段 12，动点为 Pi 和 Pi+1（1iN-1） ，其他点静止不动，比如运动波形从状态 c 到状态 e 只有点 P1 和 P2 在动。 因此可以将 Pi-1Pi、 PiPi+1、P i+1Pi+2 和 Pi-1Pi+2 简化成如图 2-5 所示的四连杆机构。在波形转换过程中本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 12 页 共 43 页Pi1 和 Pi+2 之间的距离 d 不变，即 d =l+ 2lcoso。图中 i、表示组成运动波形的连杆与水平地面的夹角， i 表示
31、相邻连杆间的夹角，顺时针为负，逆时针为正。图 2-5 四连杆运动模型根据图 2-5 所示的四边形 Pi-1PiPi+1Pi+2，我们可得如下矢量关系lei1 + lei2 = d + lei4 (2-2)将其在 x,y 轴上分解得1+2=+4(2-3) 1+2=+4消去 2 后得：E cos2+F sin2+G=0 (2-4)将下 cos 半角变换公式代入式(2-4)，得关于 tg(2/2)的一元二次方程式，由此解出(2-5)2=2+2+22+式中 N 为符号系数，当P i+1 Pi-1Pi 三顶点的顺序为逆时针方向，N=-1；顺时针方向N=1；这是按右手直角坐标系制定的，如为左手直角坐标系，
32、则判别 N 符号的规则本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 13 页 共 43 页与上述相反。将公式(2-5)代入(2-3)可求出(2-6) 4= 2 1+ 2 1式中 =2212=2212F=2l2sin1=2l2sin1G=l2+d2-2ldcos1=l2+d2-2ldcos12.2.3 波 形 传 递 阶 段 相 邻 连 杆 间 相 对 角 位 移 I及 其 角 速 度 分 析1 各 连 杆 间 的 角 位 移 分 析假如已知连杆 Pi+1Pi+2 的转角 1 与其角速度 ，那么运动波形上各连杆间的相 1对转角可用 1 来表示。由图 2-5 可得1=12=2-13=-(
33、-4+2) (2-7)4=-4图 2-6 2， 3， 4 和 1 之间的关系图 1本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 14 页 共 43 页图 2-7 和 之间的比例关系图 1 2 3 4 1图 2-6 给出了当 0=600时，波形传递过程中，相邻连杆间的角位移 2、 3、 4 和1 之间的关系（图中 ） ；左侧是角位移 1 从 00增加到最大值时， =3324运动波形上其他连杆的角位移变化曲线，可见连杆 PiPi+1 与 Pi+1Pi+2 间的相对角 2 变化幅度最大。右侧是角位移 1 从最大值恢复到 00 的过程中，其他连杆间的相对转角的变化曲线，在恢复过程各个连杆间的
34、角度变化比较平稳 1。2 角 速 度 分 析将式(2-2)对时间取导数，化简得(2-8) 4i 4= 1 + 2 2将式 3-8）中各项乘以 e-i2，然后取其实部，消去 ，得 2(2-9) 4= 1( 1 2)( 4 2)同理可得： 2=- 1( 1 4)( 2 4)(2-10) 结合(2-7 )式，可求出运动波形上各连杆间的夹角的角速度间的关系= r1= / =1 1 1 1 1= - r2= / =-1+sin(1-2)/sin(4-sin2) 2 2 1 2 1= - r3= / =(sin(1-2)-sin(1-4)/sin(4-2) (2- 3 4 2 3 1本 科 毕 业 设 计
35、 说 明 书 （ 论 文 ） 第 15 页 共 43 页11)=- r4= / =-sin(1-2)/sin(4-2) 4 4 4 1图 2-7 给出 2、 3、 4 和 5 之间的角速度比例关系。从图中可以看出，运动波形由三连杆组成的蠕动步态，在波形传递过程中，尤其是 1 处于70 0，75 0 (n=600)区间内，相对角 1 的角速度相差很大 12。2.2.4 小 结虽然用运动波形由三连杆组成的蠕动步态有解析解，但从其波形转换分析图(2-6)和(2-7)可以看出，此运动步态存在如下的问题：1关节角的活动范围比较大（当初始角 0=600 时， 2-1200,600） 。2关节之间的速度比较
36、大（当 0=600， 1 在700，75 0之间，速比发生突变） ；因蛇形机器人的各个模块都是相同的，因此各个关节的调速范围也是一样的；速比越大，调速范围越大，因此对驱动电机的要求也就越高。3关节之间的速度比太大，容易使组成运动波形的部分关节速度变化过快，容易产生过大的惯性力，从而造成电机失步，不利于电机的控制.因此从控制的角度和设计的角度来说，这种运动波形由三连杆组成的蠕动步态并不是最理想步态。2.3 机 构 简 图其 中 直 线 代 表 蛇 形 机 器 人 的 一 个 关 节 ， 圆 圈 代 表 电 机 。 奇 数 号 电 机 实 现 蜿 蜒运 动 ， 偶 数 号 电 机 实 现 起 伏
37、蠕 动 。 在 起 伏 运 动 时 ， 奇 数 电 机 保 持 不 动 ， 即 电 机1， 2 所 在 杆 件 构 成 一 个 整 体 ， 电 机 3， 4 所 在 杆 件 构 成 一 整 体 本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 16 页 共 43 页3 蛇 形 机 器 人 步 行 机 构 的 结 构 设 计31 蛇 形 机 器 人 运 动 部 件 设 计根据自然界蛇的体形，结合本课题要求实现的功能，兼顾美观，合理，设计蛇形机器人的关节外形如下图 3-1 所示每个蛇形机器人的组成单元由两个小关节组成，本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 17 页 共 43
38、 页其中轴线水平的转动副成称为水平关节，可实现匍匐运动；轴线在铅锤方向的转动副称为垂直关节，可实现拐弯运动。图 3-1 蛇形机器人关节的三维示意图为了进一步细化外型尺寸计算过程，我们将步态进一步细化。我们将蜿蜒电机忽略如图 3-2。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 18 页 共 43 页图 3-2 细化的步态规划我们根据各个关节在相邻两状态间角度的变化，整理制作了如下表格 3-1，并规定Pi-1PiPi+1 以 lPi-1Pi 为参考，正时针方向变化为正，逆时针方向变化为负。得到表格如下表 3-1 每周期各相邻步态间各关节所称角度的变化步态号角度变化步态 1 步态 2 步
39、态 3 步态 4 步态 5 步态 6 步态 7 步态 80 -600 -160 +760 00 00 00 00 001 +120 -160 -1640 -160 +760 00 00 002 -600 +600 +1200 -160 -1640 -160 +760 003 00 -290 -310 +600 +1200 -160 -1640 +6004 00 00 00 -290 -310 +600 +1200 -12005 00 00 00 00 00 -290 -310 +600由于在蛇头与地面，蛇尾与地面间没有直流伺服电机，所以 05 不予考虑。又由于每一个步态可以在同一时间内完成，每
40、一步态所用时间由完成角度变化时间最长的电机决定所以除去 05 后对每一步态取角度变化绝对值最大值，取和，所得值与时间成正比。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 19 页 共 43 页（3-1） 初步选择采用直流伺服电机 F130，转速为 n=300r/min(3-2)=2=3600=10800001=18000/所以每个周期最短时间为 T，则(3-3)= =912018000=0.507因此，蛇形机器人的蠕动频率 为(3-4)=1= 10.507=1.97可见蛇形机器人在单位时间内行走的距离为 S(3-5) =1.97=0.3/计算可得(3-6)=0.3/1.97=0.15
41、2由于蛇形机器人的每个单元由两个关节组成，那么每个关节的长度为 7.6cm。下面具体计算关节的外型尺寸。为了计算方便，我们将蛇形机器人每个单元的每个关节作如下简化，简化结果如图 3-3 所示本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 20 页 共 43 页图 3-3 蛇形机器人每个部分关节简图及极限位置夹角取每个关节的外伸端长 20mm，取极限夹角为 900，则蛇身最宽处宽 40mm。具体关节外观如图 3-4 所示图 3-4 蛇形机器人关节图关节采用铝材，后部三角形孔用于传递水平关节上电机输出的扭矩，运用形锁合的方法与传递扭矩轴套配合（图 3-5） ，通过内外形的配合来传递动力。轴
42、套内部与方形截面轴（图 3-6）配合，外部与关节壳体孔配合，将轴传递的扭矩传递到关节壳体，使关节与关节间产生相对运动。运动件与固定件之间用定位轴套定位，定位轴套（图 3-7）内部与方形截面轴配合，外部与关节壳体的圆孔配合，形成滑动轴承。此设计的特点是结构紧凑，体积小巧，传递可靠。关节壳体内部设计电机安装腔，同样采用与电机外型相配合的内孔与电机外壳配合来定位电机在蛇形机器人内部的相对位置。电机固定采用固定扣带，结构如图 3-8 所示本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 21 页 共 43 页图 3-5 动力传递轴套 8图 3-6 方形截面轴本 科 毕 业 设 计 说 明 书 （
43、 论 文 ） 第 22 页 共 43 页图 3-7 定位轴套图 3-8 电机固定扣带结构图电机固定扣带采用塑胶材质，与蛇形机器人的电机盒采用形变预紧，将电机可靠地定位在电机盒内。扣带具有拆装方便，定位可靠的，结构简单等特点。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 23 页 共 43 页由于在设计第二个关节时，存在重力作用点不通过形心的情况，如图 3-9。图 3-9 蛇形机器人组成单元存在偏心情况为了使整个蛇形机器人整体不存在偏心问题，提高蛇形机器人的运动稳定性，将具有偏心问题的关节在组装时注意偏心位置，交替组装，尽量消除蛇形机器人整体的偏心情况（图 3-10） 。图 3-10
44、调整后的装配图32 驱 动 装 置 设 计3.2.1 驱 动 方 式 选 择随着 MEMS 技术的迅速发展，能够进入狭窄空间工作的微型机器人已经成为国内外的研究热点。微型机器人具有体积小，相应速度快，能耗低等特点，在生物医学，航空航天，军事，工业生产，水下作业，极端危险场合具有广泛应用前景。驱动方式大致可分为有缆驱动和无缆驱动。1 有缆驱动本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 24 页 共 43 页有缆驱动技术的优点是能量供应方便而充足，但对于应用在细小管道和狭小空间等特殊环境下的微型机器人，如果采用有线方式功能，会使得微型机器人的运动灵活性，移动距离和行走路线受到限制。1）
45、微伺服电机驱动新西兰的坎特伯雷大学以竹节虫为生物模拟对象，研制成功了一种微型伺服电机驱动的 Hamlet 仿昆虫六足步行机器人。该六足机器人共有 6 条三关节的步行足，单个关节由一台功率为 10W 的电机驱动，通过齿轮箱减速输出 4Nm 的扭矩。微电机驱动可满足微型机器人自主性要求，承载力大，可靠性，适应性强，但由于系统复杂，不利于机器人进一步微型化。2）压电陶瓷驱动日本 Fukuda 等人利用压电陶瓷（PZT）作驱动器研制了一种具有 2 自由度的双鳍微机器人。该机器人具有两条腿，每条腿上带有双鳍，双鳍之间具有一定的角度；在不同的驱动频率下，每条腿能产生向前或向后的运动；当调节驱动频率驱动两条
46、腿的运动方向相反并产生不同的推力时，可实现微机器人的转弯。3）高分子材料驱动日本的 Kagawa 大学的郭书祥等人研制出一种利用电致动作原理的 ICPF 高分子聚合物材料作为驱动器的水下多自由度微型机器人。该机器人由 ICPF 高分子聚合物材料组成三条步行足和两条尾鳍，在 ICPF 驱动下，当三条步行足协条摆动使机器人在水下自由移动，两条尾鳍的摆动下使机器人移动更迅速，利用 ICPF 产生气泡的特性使机器人遇到障碍时可以迅速上浮，从而达到避障的目的。ICPF 驱动具有柔韧性好，驱动电压低，相应快，可以在水下作业等优点。韩国利用一种新型智能材料人工肌肉（IPMC）研制了一个简单的八足爬行机器人。
47、机器人的八条腿是由 IPMC 执行机构构成的。IPMC 具有在较低的电压下能产生大变形，低密度，有弹性而且可以任意切割的优点，但其产生的驱动力较低。4）气压驱动意大利的 Mitech 实验室 P.Dario 等研制了一种采用压缩空气驱动的微型机器人。它是仿照蚯蚓滑行蠕动的原理，通过两个夹钳和一个伸缩执行器在气压分配器的控制下实现在肠道中的蠕动。夹钳在驱动体的两端，充气时会鼓起起到加持作用。伸缩执行器在充气时伸长，产生推力驱使机器人滑行。气压驱动方式控制可靠，适应性强，柔性好，不易损伤操作对象。本 科 毕 业 设 计 说 明 书 （ 论 文 ） 第 25 页 共 43 页2 无缆驱动1）太阳能驱动加州大学伯克利分校 Richard Yeh 等研制了一种由太阳能功能的微型蚂蚁。它集成了微传感器，执行器，低功率微型 CMOS 控制电路，太阳能电池，用关节刚性连接的两自由度腿由静电微马达驱动。静电微马达由 CMOS 电路控制和太阳能电池提供能量。太阳能电池的功率密度约为 10Mw/cm2,可以满足静电驱动马达驱动的需要。2）外磁场驱动日本九州工业大学 Honda 等人研制
