毕业论文-基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究

基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究摘要基于UP-STAR自主巡航蛇形机器人的设计制造是基于仿生学的基础之上的。仿生学是生物科学与工程技术相结合的一门综合学科，通过学习、模仿、复制和再造生物系统的结构、功能、工作原理及控制机制，来改进现有的或创造新的机械和仪器系统等，仿生学已经延伸到很多领域并取得了丰富的成果。本文主要对基于UP-STAR自主巡航蛇形机器人进行运动分析和舵机控制研究。文中首先对自然界生物蛇的身体结构和运动形式进行了分析，介绍了蛇类的骨架结构和鳞片功能，并对蛇类常见的四种运动形式进行了分析。根据生物蛇骨架抽象出的模型设计出了一种正交的蛇形机器人关节结构，在该结构中，舵机分别固定在相邻的关节上，通过舵机轴旋转使相邻关节相对转动。由于采用正交结构，该蛇形机器人可以实现生物蛇常见的蜿蜒运动、摇头运动和抬头运动。对蛇形机器人的蜿蜒运动、蠕动、翻滚运动、侧向运动做了运动分析，得出了实现相关运动形式所需的关节角度时间函数；对抬头运动进行了分析，通过力矩计算得出了一种所需力矩较小的抬头方式。此蛇形机器人的舵机选择使用CDS5500，解决了传统舵机用在机器人上的各种问题，同时继承了传统舵机的各种优势，并使用其专用调试软件RobotSevoTerminal对其进行调试。调试器选择使用UP-Debugger多功能调试器，它集成了USB-232，半双工异步串行总线、AVRISP三种功能，体积小巧、功能集成度高，是一种可靠且方便的调试设备。控制器选择使用MultiFLEX2控制器，其具有尺寸小，功耗低，价格低；专为机器人设计；支持NorthSTAR图形化开发环境；等优势。控制软件选择了NorthSTAR，它可以用图形化、可视化的方式给机器人编程，同步生成C语言代码，在后台编译、并下载到机器人控制器上执行。关键词：蛇形机器人，运动分析，舵机控制IAbstractDesignandmanufactureofsnake-likerobotisbasedonthebasisofbionics.Bionics,biologicalscienceandengineeringtechnologycombiningacomprehensivediscipline,throughlearning,imitation,copy,andrecyclingofbiologicalsystemstructure,function,workingprincipleandcontrolmechanism,toimproveexistingorcreatenewsystemsofmachineryandequipmentandsoon,bionicshasbeenextendedtomanyfieldsandachievedrichresults.Inthispaper,kinematicanalysisofthesnakerobotandservocontrol.Inthefirstpartofthenaturalbiologicalsnakesbodystructureandmotionanalysisform,introducedsnakeskeletonstructureandfunctionscales,andfoursnakescommonformofexercisewereanalyzed.Abstractframeworkbasedonbiologicalmodelsofsnakesoutofanorthogonaldesignofsnake-likerobotjointstructure,inthisstructure,thesteeringgearintheadjacentjointswerefixed,throughthesteeringaxisrelativerotationofadjacentjoints.Asaresultoftheorthogonalstructureofthesnake-likerobotcanachieveacommonbiologicalsnakewindingmovement,shakinghisheadmovementandtheheadmovement.Onthewindingsnake-likerobotmotion,creeping,rollingmovement,lateralmovementtodothemovementanalysis,therelatedformsofexercisetoachievetherequiredjointangletimefunction;ontheriseofmovementanalysis,calculatedbymomentasmallerriseoftorquerequiredway.Thesnake-likerobotsservochoosetouseCDS5500,tosolvethetraditionalservorobotusedinavarietyofproblems,whileinheritingtraditionaladvantagesofsteeringgear,anduseitsspecialdebuggingtodebugtheirsoftwareRobotSevoTerminal.ChoosetousethedebuggerfunctionUP-DebuggerdebuggerthatintegratesUSB-232,half-duplexasynchronousserialbus,AVRISPthreefunctions,compactsize,featureshighintegration,isareliableandconvenientdebuggingequipment.ControllerschoosetouseMultiFLEX2controller,itssmallsize,lowpowerconsumption,lowprices;designedforrobotdesign;supportNorthSTARgraphicaldevelopmentenvironment;II基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究otheradvantages.ControlsoftwarechosenNorthSTAR,itcanbegraphicallyvisualizedthewaytotherobotprogramming,synchronizationgenerateClanguagecode,compiledinthebackground,anddownloadtotherobotcontrollerimplementation.Keywords：Snake-likerobot,motionanalysis,steeringcontrolIII基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究目录第一章绪论.11.1课题背景及研究的目的和意义.11.2国内外研究现状.11.2.1国外研究现状.11.2.2国内研究现状.51.3本课题的主要研究内容.7第二章基于UP-STAR蛇形机器人的结构设计.82.1生物蛇的身体结构及运动形式分析.82.1.1生物蛇的身体结构分析.82.1.2生物蛇的运动形式分析.92.2生物蛇骨架模型的抽象.122.3基于UP-STAR蛇形机器人身体关节结构设计.132.4基于UP-STAR蛇形机器人“蛇足”的设计.142.5基于UP-STAR蛇形机器人头部关节的设计.14第三章蛇形机器人的运动分析.153.1蛇形机器人的蜿蜒运动分析.153.2蛇形机器人的蠕动运动分析.173.3蛇形机器人的翻滚运动分析.183.4蛇形机器人的侧向运动分析.183.5蛇形机器人的抬头运动分析.18第四章基于UP-STAR蛇形机器人舵机的选择.214.1舵机简介.214.2舵机的原理.224.3CDS5500机器人舵机的主要特色.22第五章基于UP-STAR蛇形机器人的设计及组装.23I基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究5.1基于UP-STAR蛇形机器人的零件构成.235.2基于UP-STAR蛇形机器人的组装步骤.25第六章基于UP-STAR自主巡航蛇形机器人的控制系统.296.1硬件部分.296.1.1多功能调试器.296.1.2控制器.306.1.3红外避障传感器.316.2软件部分.326.2.1专用调试软件RobotSevoTerminal.326.2.2图形化机器人开发环境NorthSTAR.38第七章基于NORTHSTAR软件环境开发蛇形机器人.417.1蛇形机器人头部的开发.417.2蛇形机器人的蜿蜒运动.507.3蛇形机器人的多种运动形式组合并加装红外避障传感器.53第八章结论与展望.558.1结论.558.2对进一步研究的展望.56参考文献.58致谢.61附录1基于UP-STAR自主巡航蛇形机器人的C语言程序.62附录2关节单元三维图.82附录3舵机零件图.83声明.84II基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究第一章绪论1.1课题背景及研究的目的和意义大自然不仅赋予了人类生命和丰富的自然资源，而且其丰富的生命形态给予了人类无穷无尽的启迪。从小鸟的展翅飞翔到先进的飞机、从蝙蝠的夜间飞行到现在的雷达系统，无一不体现了研究生物系统对科学技术发展的重大意义1。蛇形机器人的研究开创了仿生机器人研究的新领域，同时由于蛇形机器人广泛的应用前景，世界上很多国家都十分重视蛇形机器人的研究。仿生机械学是以力学或机械学作为基础的，综合生物学、医学及工程学的一门综合科学，它贯穿着研究、模拟生物系统的信息处理、运动机能和系统控制，以及在医学及工程中的应用。本课题的目的是通过对生物蛇的身体结构和各种运动形式的研究，在此基础上进行蛇形机器人的设计，并对其进行运动仿真。蛇形机器人可以应用在很多不同的场合：适用于条件非常恶劣而又要求高可靠性的环境，如在有辐射、有粉尘、有毒环境下执行侦察任务和战场上的扫雷、爆破；可以满足在复杂环境中的搜救、侦察、排除爆炸物等反恐任务；在地震、塌方及火灾后的废墟中搜救幸存者；在狭小和危险的条件下探测和疏通管道；航空航天领域可用其作为行星表面探测器、空间站的柔性机械手臂等25。由于其广泛的应用前景，因此蛇形机器人的研究具有十分重要的意义。1.2国内外研究现状蛇形机器人的研究开创了仿生机器人研究的新领域，同时由于蛇形机器人广泛的应用前景，世界上很多国家都十分重视蛇形机器人的研究。下面对蛇形机器人国内外的研究情况进行介绍和分析。1.2.1国外研究现状（1）日本蛇形机器人的研究：上个世纪70年代，日本东京工业大学的Hirose教授就已经开始了蛇形机器人的研究。Hirose教授于1972年研制了第一台蛇形机器人（ActiveCordMechanism-ACM）。该机器人的总长为2m，具有20个关节，依次靠伺服机构来驱动关节左右摆动，见图1-1。为了与地面有效地接触，该机器人的腹部安装1基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究了脚轮。该机器人的最大速度为40cm/s，只能在平面上运动。继第一台蛇形机器人之后，Hirose教授的研究室又先后研制了一系列的蛇形机器人。例如ACM-R3，见图1-2，该机器人的参数见表1-1，ACM-R3机器人采用完全无线控制的方式，每个关节自带电源，而且ACM-R3为三维结构，能够在三维环境中运动和完成复杂的三维动作6,7。图1-1ACM蛇形机器人图1-2ACM-R3蛇形机器人表1-1ACM-R3的参数自由度尺寸质量关节活动范围输出力矩201755110110（mm）12.1（kg）62.5（）19.1（Nm）日本NEC公司的Takanashi研制了刚性关节连接的蛇形机器人，如图1-3所示，该机器人的机构采用了特殊的关节结构，具有6个管状的连杆，长1.4m，直径42mm，重4.6kg，能够实现三维空间运动，可以应用在危险情况下的勘察和营救工作8。2基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究图1-3NEC的蛇形机器人（2）德国蛇形机器人的研究德国GMD国家实验室研制1996年研制出了第一代蛇形机器人，如图1-4所示，该机器人由15个关节组成，在蛇的前端装有一个头关节。头关节可以携带用于不同传感装置和激励装置的应用程序。该模型上带有用于判断方位的简单的视觉传感器。每一个关节都有单独的从属处理器来控制，所有的从属处理器通过总线连接到中央控制器，由中央处理器来控制它们的协调动作。该蛇形机器人要靠由电缆连接的外部电源工作9。图1-4第一代GMD蛇形机器人在第一代机器人的基础上，GMD国家实验室于1998年开始研究第二代蛇形3基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究机器人的样机，并于1999年完成，见图1-5。它是由头部、躯干和一个尾关节构成的。它的每一个关节上都有12个轮子，同时每一个关节上都有一个16位微处理器来控制电机、读取并处理数据。安装在头部的微处理器对蛇的整体动作进行规划和控制，其控制方式为上位机-总线-下位机。目前该机器人具有速度和位置反馈，能翻越简单障碍，具有一定的自主反应能力10,11。（3）美国蛇形机器人的研究美国宇航局（NASA）于1999年开始研究多关节的蛇形机器人，并在2000年推出第一代蛇形机器人，计划其在太空中用于行星地表探测以及空间站维护工作，其第一代蛇形机器人如图1-6所示，它采用两种互相垂直的模块组成一个蛇形机器人单元。这种机构非常有效，因为在蜿蜒运动的时候，它的左右摆动的模块产生作用；在行波运动时候，它的上下摆动的模块产生作用；侧向运动和翻越障碍物的时候，两种模块一起产生作用就可以实现；由于两模块互相垂直，因此它可以实现翻滚运动。整个蛇形机器人有个总体电脑控制，控制各个模块上的电脑工作。图1-5第二代GMD蛇形机器人图1-6NASA研制的蛇形机器人美国的G.Miller博士从1987年开始从事蛇形机器人的研究工作，到目前为止共设计并制作了S1,S2,S3,S5四代机器人，图1-7为S5。其研究已经达到相当高的水平，该机器人的特点是：各个关节形状尺寸不同，高度模拟生物蛇，主要是形态上的高度模拟；为二维结构，无法完成三维空间运动；依靠从动轮而不是摩擦运动，运动速度很高，主要运动方式为游动。4基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究另外，美国加利福尼亚学院的Chrikjian和Burdick首次从超冗余度机器人角度，对蛇形机器人的机构和运动理论进行了研究，提出了采用变几何桁架结构(VGT)作为蛇形机器人的基本构架形式。（4）其它国家蛇形机器人的研究瑞典的Nilsson研制了PIRAIA蛇形机器人。该蛇形机器人采用了特殊的机械结构，具有很大的关节力矩，能够抬的很高12,13。如图1-8所示。此外，法国的Bayraktaroglu、意大利的Poi等也进行了各有特色的蛇形机构的研制和控制方法的研究。图1-7G.Miller的S5蛇形机器人图1-8Nilsson的蛇形机器人1.2.2国内研究现状在我国，蛇形机器人的研究才刚刚起步，虽然在国内也逐渐出现了对蛇形机器人研究成功的报道，但国内的研究还大多处于探索阶段。哈尔滨工业大学机器人研究所、上海交通大学等单位首先进行了蛇形机器人仿生方面的一些研究14,15。上海交通大学于1999年3月研制了我国第一台微小型仿蛇机器人样机16，该机构由一系列刚性连杆连接而成，步进电机控制相邻两刚性杆之间的夹角，使连杆可以在水平面内摆动，样机底面装有滚动轴承作为被动轮，用以改变纵向和横向摩擦系数之比，其后又相继作了一些相关的理论研究17,18。2001年，国防科学技术大学研制了一个蛇形机器人样机19，如图1-9所示，该样机不但可以实现平面内运动，而且采用密封外皮后，能在水面上实现蜿蜒运动。但在技术层面上，还5基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究不十分完善。它的执行单元在结构上仿制了日本Hirose的机器蛇结构，在身体下端装有从动轮，以减小身体与地面之间的摩擦，但执行单元只能采用平行连接方式（电机轴线相互平行），因此只能完成平面内的螺旋运动，无法进行更深入的研究，这也是它最大的缺点。中科院沈阳自动化所研究的蛇形机器人是围绕国家863计划研究项目“具有环境适应能力的蛇形机器人的研究”展开的。研制出了一种新型的蛇形机器人系统2022，如图1-10所示。该蛇行机器人可实现多种适应环境的平面和空间运动形式，从而为我国星球探测和灾难救援等领域的应用提供技术支持。苏州大学研制的蛇形机器人如图1-11所示，其主要是对蛇的直线运动的模拟，并取得了良好的实验效果，但精度稳定性问题还有待进一步研究23。此外，东北大学等高校也已经开始蛇形机器人的相关研究工作，并取得了一定的成果2426。图1-9国防科学技术大学研制的蛇形机器人图1-10沈阳自动化所研制的蛇形机器人图1-11苏州大学研制的蛇形机器人6基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究1.3本课题的主要研究内容（1）生物蛇的身体结构及运动形式的研究对生物蛇的身体结构和运动形式进行研究。通过对生物蛇的身体结构的研究抽象出骨架模型，从而为蛇形机器人的设计提供指导，通过对运动形式的研究为蛇形机器人的运动规划提供依据。（2）基于UP-STAR蛇形机器人的结构设计通过对生物蛇身体结构的研究，进行蛇形机器人的结构设计，并得出相关的性能参数。（3）基于UP-STAR自主巡航蛇形机器人的运动规划及控制通过对生物蛇的运动形式的研究，对蛇形机器人的运动形式进行分析与规划，并建立蛇形机器人的控制系统。7基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究第二章基于UP-STAR蛇形机器人的结构设计基于UP-STAR蛇形机器人的结构设计建立在对自然界生物蛇的身体结构的理论分析之上，通过对生物蛇的身体结构分析，抽象出其骨骼结构，从而进行蛇形机器人的设计。蛇形机器人的结构设计包括身体关节结构、头部关节结构、驱动方案选择、蛇形机器人的整体结构等方面的内容。2.1生物蛇的身体结构及运动形式分析通过对生物蛇的身体结构的分析，抽象出其骨骼结构，为蛇形机器人的设计提供指导；通过对生物蛇的运动形式的分析，得出生物蛇运动过程中身体形状的变化，从而为蛇形机器人的运动规划提供指导。2.1.1生物蛇的身体结构分析蛇是无四肢动物中最庞大的一类，遍布于世界各地，大约有2500多种，分为盲蛇科、蟒蛇科、游蛇科、蝰蛇科等11个蛇科。广泛的地理分布和悠久的进化历史，充分证明了这一种群的适应性和运动的优越性。蛇类具有十分独特的运动方式，它没有足，但靠躯体的摆动可以在地面上快速爬行，蛇类爬行的时速为1.5公里左右。蛇类能做到这一点是与其独特的身体结构密切相关的。虽然蛇类分为很多的种类，但是它们的主要身体结构十分的相似27。在长期的进化过程中，蛇类体形的变长是通过它自身脊椎骨数量的增加来实现的，这样可以保持身体的柔性。通常脊椎骨多达200-400枚。蛇的脊椎骨的一端有个球形的突起，而另一端有个球形凹陷，这样每根脊椎骨的突起可以和相邻脊椎骨的凹陷结合形成一个“球铰”，如图2-1所示。球套关节由一系列的表面形成，产生有限范围的水平和垂直运动。对于大多数蛇，脊骨运动范围为水平1020，垂直23。虽然关节的活动范围很小，但由于蛇的脊骨数量庞大，通过相邻脊骨间微量变化的叠加就可以实现蛇体构型上的很大调整。另外，蛇的身体周身覆盖有排列规则的鳞片，其中对运动起重要作用的是腹部鳞片，如图2-2所示。自然界中的蛇借助于腹鳞与地面的作用力向前运动，腹鳞的主要特性是蛇在运动时，其法向摩擦系数大于切向摩擦系数，使得蛇在移动时切向摩擦力很小，提高其运动效率。8基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究图2-1蛇的骨架结构图图2-2腹鳞示意图2.1.2生物蛇的运动形式分析在自然界不同的环境中，生存着不同种类的蛇，它们的运动方式也有所不同，总的来说，蛇在没有脚的情况下实现运动，都主要依靠以下器官的作用：数目甚多、彼此关联牢固又灵活的脊椎骨；躯干部几乎每一个椎骨都连接一对肋骨；宽大的腹鳞；与肋骨、椎骨和腹鳞相关的肌肉28。蛇的运动大致可分为以下四种方式：（1）蜿蜒运动在四种运动方式中使用最多的方式是蜿蜒运动，这种运动酷似游泳的鱼，所以也被称为“游动”。蛇的身体做“S”形运动时，肌肉收缩从前部开始，以波动的方式向后方传播，形成一系列的收缩波。造成蛇体的系列弯曲，每个弯曲的外侧面，旦同路上的物体如小石子、草丛等接触，便由于受推压的影响对蛇产生反作用力。同时，在别处产生的推力使蛇从接触点滑过去，于是又产生了摩擦力。这两种力的合力，可分解为纵力和横力，纵力是推动蛇前进的力量，横力是保持蛇体平衡的力29，如图2-3所示。9基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究图2-3运动过程中蛇体局部受力图实验表明，蛇在蜿蜒运动时躯体曲线中形成的波具有局部性，各个波峰、波谷的振幅并不一定完全相等，或者说，运动中的蛇体曲线是好几种基本曲线段的拼合体，具有以下性质：1)基本曲线段的起点和终点分别为相邻波谷点，即常是直线向前爬行。直线运动蛇形曲线上相邻两极小点；2)不同基本曲线段可具有不同的弧长；3)在某一给定时刻，蛇形曲线中包括数个基本曲线段，但并不是每一个基本曲线段都会被完全的形成；4)蜿蜒运动过程中蛇体的运动近似于正弦波在蛇体上传播，可以证明蛇体的运动方向与正弦波的传播方向相反15。（2）直线运动身体粗大的蛇类，例如蟒蛇是依靠肌肉收缩来实现的，肌肉收缩使得腹部鳞片进行齿轮式的活动，皮肤相对骨骼移动，从而实现直线运动的方式，如图2-4所示。由于伸缩移动的距离非常小，因此直线运动效率非常低。图2-4蛇的直线运动示意图3010基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究（3）伸缩运动蛇在通过狭长的管道时，通常采用这种运动方式，如图2-5所示蛇类，在运动过程中蛇体腹上为蛇的主要运动方式，此外，蛇类还有一些其他的运动方式，例如钻洞。该运动可分为两个节拍，首先以前部作为支撑，收缩肌肉向前拉动后部，再以后部作为支撑，通过肌肉收缩向前推动前部。图2-5蛇在管道中的伸缩运动（4）侧向运动侧向运动方式比较常见于沙漠中，蛇的腹部始终都只有很小一部分与地面接触，避免了腹部与炎热的沙地大面积接触。运动时从头部开始，蛇体各部分顺序接触地面，然后抬起，依次循环，产生一个侧向的运动，如图2-6所示。这种运动效率比较高，适合在柔软的沙地运动。以绕身体脊椎的回转、滑行冲击、蠕虫运动等等。11基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究图2-6蛇的侧向运动2.2生物蛇骨架模型的抽象由前面对生物蛇骨架模型的分析可知，蛇的相邻脊椎骨形成一个球套关节，因此可以将生物蛇的身体结构加以简化，把其看做球形铰链组成的多关节空间连杆机构，蛇的运动是依赖这些连杆之间的相对转动与地面摩擦力的作用产生驱动力的。蛇形机器人的关节结构的实现可以有多种形式，例如，可以用简单关节来实现水平面或垂直面内的运动，这种关节结构容易控制，且经济性好；也可以用球窝关节，这种关节虽然可以在水平面内和垂直面内运动，但是制造复杂，而且控制起来也十分困难。在研究蛇的运动过程中，发现蛇的水平面内的蜿蜒运动或者垂直面内的蠕动，可以看做是水平面内或垂直面内的只有一个转动机构的二维平面机构。从这种思想出发，可以通过二维平面机构的正交组合，用一种关节形式实现蜿蜒运动和蠕动的运动形式，如图2-7所示。而蛇作侧向、翻滚等空间三维运动时，可以将它们看成是两平面内的运动组合而形成的。图2-7抽象出的关节结构简图12基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究2.3基于UP-STAR蛇形机器人身体关节结构设计身体关节的结构设计主要考虑到关节的正交结构和电机的安装两个因素，单个关节的模型如图2-8所示，关节材料选用铝合金材料，关节尺寸主要根据舵机的安装尺寸确定。关节结构的实物图如图2-9所示。图2-8关节结构的三维模型(a)(b)图2-9关节结构的实物图(a)、(b)13基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究2.4基于UP-STAR蛇形机器人“蛇足”的设计本文对蛇形机器人的底部安装被动轮子，由于轮子与地面之间的滚动和滑动摩擦系数不同，蛇体形成运动曲线时受到较大的法向摩擦力和较小的切向摩擦力，它们的合力驱动蛇形机器人实现蜿蜒运动。其优点是运动速度较高。2.5基于UP-STAR蛇形机器人头部关节的设计生物蛇的头部骨骼具有特殊的结构，可以吞食比自己身躯大数倍的食物。由于从机械的角度难以完全实现生物蛇的头部功能，因此，本文只对头部的前后、左右转动进行设计，如图2-10所示。(a)(b)(c)图2-10头部运动实物拍摄(a)、(b)、(c)14基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究第三章蛇形机器人的运动分析蛇形机器人的形状控制方法有两种：第一种方法是从生物蛇运动过程中身体曲线的变化规律角度出发，以此来研究蛇形机器人各个关节之间相对转角的变化规律，通过控制关节之间的相对转角达到蛇形机器人的形状控制，该方法简单易行。第二种方法是建立其动力学方程，从动力学角度控制蛇形机器人的形状，该方法需要建立准确的动力学模型，而且需要选择合理的优化指标，因此比较复杂。本章采用第一种方法，从生物蛇运动过程中身体曲线的变化规律出发，对蛇形机器人的蜿蜒、蠕动、翻滚、侧向和抬头运动进行分析，并得出相关运动的关节角度函数，从而为蛇形机器人的控制提供理论依据。3.1蛇形机器人的蜿蜒运动分析蜿蜒运动是生物蛇最常见的运动形式。蛇在运动过程中，由于受到环境的影响，其蛇体曲线很难用准确的数学模型去建立。日本的Hirose教授通过对生物蛇的大量研究，提出了Serpenoid曲线，该曲线经过实验证明对于蛇形机器人的蜿蜒运动来说是非常有效的。本节将根据蜿蜒运动曲线建立蛇形机器人的形状控制方程，从而得出蜿蜒运动时关节角度的时间函数。Serpenoid曲线的定义：在x-y平面内，有一条通过坐标原点的曲线，假如该曲线上的任意一点可以表达为式（3-1）的形式，那么该曲线就称为蜿蜒运动曲线（SerpenoidCurve）：s+x(s)=cos(acos(b)c)d0s+y(s)=sin(acos(b)c)d0（3-1）式中s从起始点到当前点的弧长；a决定了曲线幅度的大小；b决定了曲线的频率和幅度的大小；c决定了整个曲线的偏移形状。由公式（3-1）可以看出，Serpenoid曲线由三个参数a、b、c确定，a、b、c15基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究取不同的值可以得到不同的Serpenoid曲线3135。参数a、b、c所代表的意义分别为：曲线幅度的大小、曲线的频率和幅度的大小、整个曲线的偏移形状。本文研究制成的蛇形机器人的蜿蜒运动形式实物图如图3-1所示。图3-1蜿蜒状态实物图16基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究3.2蛇形机器人的蠕动运动分析蜿蜒运动的方式虽然效率较高，但在某些特殊的环境下，如狭窄的管道内，由于空间的限制，并不能为蛇形机器人提供蜿蜒运动的条件，因此，蛇形机器人就需要做出蠕动的运动形式向前运动。假设蛇体的初始状态为一条直线，蠕动过程得到的仿真结果如图3-2（a）所示，从图中可以看出，经过一个蠕动的过程，蛇形机器人则可以向前行进一点。但是用单个三角波形推进时，蛇形机器人的蠕动效率并不高，为了提高效率，可在蠕动过程中同时拱起和推进多个三角波形，如图3-2（b）所示。（a）一个三角波形推进时（b）两个三角波形推进时图3-2蠕动过程17基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究3.3蛇形机器人的翻滚运动分析蛇形机器人的翻滚运动作为一种特殊的运动方式，可以在特殊的环境下发挥着重要的作用，比如可以用来翻越障碍物和在摩擦系数较小的环境下发挥作用。当改变蛇体与地面接触的摩擦系数时，即当摩擦系数为0时，蛇体只在原地翻滚，当摩擦系数由小变大时，蛇体的翻滚运动并没有多少变化，因此，翻滚运动可以在摩擦系数较小的环境中运动，例如冰面上。由于蛇体中心在翻滚过程中是不断与地面接触-脱离-接触的，因此，翻滚运动还可以用来翻越障碍物。由于蛇形机器人的关节较多，翻滚时的效率并不高，要想获得较好的翻滚运动，可以适当的减少关节数目。由于翻滚运动是依靠关节之间的扭转而实现的，因此翻滚运动所需力矩较大。3.4蛇形机器人的侧向运动分析侧向运动是沙漠中的蛇常用的运动方式，这种运动方式适合在柔软的沙地中运动。运动过程中蛇体各部分顺序接触地面，然后抬起，依次循环。侧向运动的方向由两个方向波形传播速度的比值所决定，当垂直面内波形的传播速度等于水平面内的传播速度时，其侧向运动的方向基本沿着水平方向，当垂直面内波形的传播速度大于水平面内的传播速度时，其侧向运动的方向是斜向上的。此外，侧向运动的稳定性由两平面内波形的相位差决定的，相位差较大时，其稳定性也较差。3.5蛇形机器人的抬头运动分析蛇形机器人抬头运动的运动状态主要由三个因素决定：相邻关节之间的最大转动角度、关节的最大静扭矩和关节的最大动扭矩。其中最大静扭矩指的是任何一个关节不失效的情况下，在静止状态下可以承受的最大负载。最大动扭矩指的是关节可以带动的最大负载，其主要受到执行单元中电机特性的限制。因此在抬头运动的规划中，关键就是要尽可能的减小电机的负载，以抬起更多的关节。蛇形机器人最简单的抬头方法是直接抬起n个关节，如图3-3所示。这时n个关节成一条直线，该方法虽然简单，但所需要的驱动力矩也是最大的，由于受到电机最大力矩的限制，这种抬头的方法并不能抬起较多的关节。因此，必须对18基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究蛇形机器人的抬头运动做出分析以使其抬起更多关节。针对本文所设计的蛇形机器人，假设关节的长度为l，质量为m，蛇形机器人抬头运动可采用如下的过程：（1）首先将头部关节抬起到最大关节角的位置，如图3-4所示。此时，抬起头部关节所需要的最大力矩为M1max=mgl/2，平衡时的力矩为M1=mglcos/2。（2）头部抬起到最大关节角后，将第一个关节抬起到最大角。此时，可以通过重心公式求得头部关节和第一个关节重心所在位置为lmglmg(l)+cos+3122x=+2mg442llcos（3-2）因此，抬起第一个关节所需要的最大力矩为3131M=+cos2=+cos2(llmgmglmgl)max4422（3-3）如果不做分析，直接将头部和第一节抬起的话，则需要的最大力矩为mglM2=2。对比公式（3-3）可以看出，规划后的抬头运动，其所需的最大力max矩小于无规划所需的最大力矩，并且，最大关节角越大，所需的最大力矩越小。（3）按照上面的分析，抬起n关节时，都将之前的n-1个关节抬起到最大关节角位置即可使得所需的力矩最小，当抬起较多的关节时，为了使得头部具有向前的视野范围，抬起后对各个关节之间进行简单调整即可36。本文研究制成的蛇形机器人的抬头运动形式实物图如图3-5所示。图3-3直接抬头示意图19基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究图3-4规划后的抬头运动示意图图3-5抬头状态实物图20基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究第四章基于UP-STAR蛇形机器人舵机的选择4.1舵机简介机器人舵机的概念起源于对“航模舵机”的改进。长期在各种教育娱乐机器人上大量使用的“航模舵机”可以实现位置伺服的功能；由于它具有高度集成、标准统一、控制简单、价格较低等特点，因此广泛使用在各类教育娱乐机器人上。但是，“航模舵机”毕竟是用于航模的产品，用作机器人关节伺服单元，有控制精度不高、无法整周旋转、没有反馈信息、响应较慢、线缆杂乱等明显的不足37。博创科技开发的Pro-MOTIONCDS系列机器人舵机，解决了传统舵机用在机器人上的各种问题，同时继承了传统舵机的各种优势。如图4-1所示。(a)(b)(c)(d)图4-1舵机实物图(a)、(b)、(c)、(d)21基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究4.2舵机的原理一般来讲，舵机主要由以下几个部分组成，舵盘、减速齿轮组、位置反馈电位计、直流电机、控制电路板等，如图4-2所示。图4-2舵机的组成舵机的原理跟伺服电机很相似，控制电路板根据控制信号解释出目标位置信息，再根据电位器输出的电压值解释出电机当前的位置，如果两个位置不一致，则控制电机转动，电机带动一系列齿轮组，减速后传动至输出舵盘，而舵盘和位置反馈电位计是相连的，舵盘转动的同时，带动位置反馈电位计，电位计输出的电压信号也随之改变，这样控制板就知道现在的转角，然后根据目标位置决定电机的转动方向和速度，从而达到目标停止。4.3CDS5500机器人舵机的主要特色（1）最大扭矩16Kgf.cm以上，转速0.14sec/60；（2）总线式通讯，多个舵机间串联数字式通讯，最多支持200个以上的舵机串联；（3）具备整周旋转和调速功能，可作为直流减速电机使用；（4）具备温度、电压、位置、转速等反馈功能，可由上位机软件读取；（5）具备温度、电流等保护功能；22基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究第五章基于UP-STAR蛇形机器人的设计及组装5.1基于UP-STAR蛇形机器人的零件构成在组装蛇形机器人之前，一定要先按照表5-1所示全部零件所需图找齐所有零件，若有缺失，及时补填。表5-1零件清单部分零件实物图：（图5-1图5-6所示）图5-1舵机23基于UP-STAR自主巡航蛇形机器人运动分析及舵机控制研究(a)(b)图5-2舵机固定件(a)、(b)(a)(b)图5-3轮子(a)、(b)(a)(b)(c)(d)(e)(f)(g)图5-4关节连接件(a)(g)24基于UP-STAR自主巡航蛇形机器