16210420403_徐义威_基于ESP8266的四足机器人的设计

1、本科毕业设计（论文） 基于ESP8266的四足机器人的设计 Design of quadruped robot based on ESP8266 院 （系）计算机学院专 业电子信息工程班 级16级电子四班学 号16210420403学生姓名徐义威指导教师林瑾提交日期2020年 3 月 15 日毕业设计（论文）原创性声明本人郑重声明：所呈交的毕业设计（论文），是本人在指导老师的指导下，独立进行的设计（研究）工作及取得的成果，论文中引用他人的文献、数据、图件、资料均已明确标注出，论文中的结论和结果为本人独立完成，不包含他人已经发表或撰写的作品及成果。对本文的研究作出贡献的个人和集体，均已在论文中作

2、了明确的说明。本人完全意识到本声明的法律结果由本人承担。毕业论文作者（签字）： 签字日期： 年 月 日成绩评定成绩项论文成绩（百分制）折合比例实得成绩（折合分）指导教师成绩30%评阅教师成绩20%答辩成绩50%总评成绩注：毕业设计（论文）成绩按百分制评定。答辩成绩不及格的（评分低于60分的），则该毕业设计（论文）总评成绩为答辩成绩。内容摘要科技文明发展会推动人类社会历史的进步，21世纪是一个“人工智能”的时代，科技产物在发展人工智能满足当下需求外，也为未来的社会发展做出重要的铺垫作用，制造的机器人也被注入了“智能”的元素，使得机器具有像人一样的“学习”能力，这也意味着机器人的多功能性、高效稳定

3、性和可互动性。同时期的科技产物还有“物联网”技术，物联网与机器的结合产物，在军工业、制造业、农业、服务业等等领域有着应用，也有着相应的技术要求。本次课题设计结合了当今社会的网络应用“物联网”技术，主要以机器对象为主，网络技术为辅作为研究目的，二者通过ESP8266模块生成的Web服务器连接，以此作为上位机和下位机的连接桥梁，通过接收控制端的指令输入来控制物体对象，在完成相应的控制运动研究后，加入了超声波避障模块来实现“智能”化，即智能避障，从而实现设计的过程和目的。关键词：人工智能 四足机器人 物联网 ESP8266abstractThe development of scientific a

4、nd technological civilization will promote the progress of human social history. The 21st century is an era of artificial intelligence. In addition to the development of artificial intelligence to meet the current needs, technological products have also played an important role in paving the way for

5、 future social development. Being injected with intelligence elements makes the machine have the ability to learn like a human, which also means the robots versatility, high efficiency stability and interactivity. At the same time, the scientific and technological products also have the Internet of

6、Things technology. The combination of the Internet of Things and the machine has applications in the military industry, manufacturing, agriculture, and service industries, and has corresponding technical requirements. This project design combines the “Internet of Things” technology of network applic

7、ation in today s society, mainly based on machine objects, supplemented by network technology as a research purpose, the two are connected through the Web server generated by the ESP8266 module, which is used as the upper computer and the lower computer The machine is connected to the bridge, and th

8、e object is controlled by receiving the command input of the control terminal. After completing the corresponding control motion research, the ultrasonic obstacle avoidance module is added to achieve intelligence, that is, intelligent obstacle avoidance, so as to achieve the design process and purpo

9、se .Keywords: Artificial intelligence Quadruped robot Internet of things ESP8266目录第一章 绪论.11.1课题研究背景和意义.11.2国内外研究现状.11.3论文研究内容与设计目标.21.4论文结构安排.21.5本章小结.3第二章 四足机器人的实现原理及硬件设计.42.1四足机器人的相关技术分析.42.1.1需求分析.42.1.2系统实现框架.42.1.3实现原理分析.42.2硬件系统概述.42.3系统结构设计.52.3.1系统各模块结构概述.52.3.2结构支架设计.82.3.3系统电路原理图.92.3本章小结.

10、10第三章 软件设计与实现.113.1软件概述.113.1.1软件开发平台.113.1.2开发环境的配置.123.1.3 Web网络控制端连接.143.1.4软件结构设计.153.2本章小结.15第四章 四足机器人的基础步态测试与调试.164.1系统功能测试.164.1.1检测元器件.164.1.2整体运行检测调试.174.2四足机器人的稳定性测试.264.3本章小结.27第五章 超声波避障设计及有关故障分析.285.1超声波模块避障功能测试.285.2故障分析及解决方案.295.3可预加模块及开发应用.305.3.1人工智能机器学习模块.305.3.2环境检测模块及云台应用.305.3.3关

11、于四足机器人的“机械臂-轮子”结合应用.305.3.4关于水陆两用机器人的理论开发和应用.305.4本章小结.30总结.33致谢.34参考文献.35广东东软学院本科毕业设计（论文）第一章 绪论1.1.课题研究背景和意义人类社会的发展需要科技最为推动力，科技的进步是一个时代发展的表现，迫于现代化、自动化的要求和智能化的需求，越来越多的人工智能产品应运而生出现在我们的生活中，为我们的生活和工作服务。机器人便是其中之一的人工智能中重要的发明，各种机器人随场合要求需要被制定出来服务于人类，第三次工业革命是计算机及技术革命，20世纪90年代诞生的互联网技术应用，迅速在全球扩散传播，直接推动了“人工智能”

12、的发展雏形，为21世纪的第四次工业革命准备好了接力棒，继20世纪末互联网发展后，在21世纪初新生了一种“物联网”应用技术，并结合了“人工智能”，它就是第四次工业革命的主要组成部分，与之前的工业科技相比，这种技术是革命性的，它不仅解决了劳动力不足问题，转变了经济发展方式，而且在日常生活中普遍存在着许多“物联网”例子的应用。在此次设计中，设计的一种基于ESP8266的四足机器人的设计正是为了凸显“物联网”与“人工智能”的一个应用方面，它展示了一个“结合应用”的过程和结果，而结合“物联网”技术研究开发和控制机器人完成各种复杂指令算法成为了当今计算机行业的一个科研热点，只有将物联网技术与人工智能结合并

13、运用在生活中，科技才会得到不断地发展和改进完善，相信在未来机器人的应用会变得越来越普遍，从而更好的服务社会。1.2 国内外研究现状自人类步入电气时代，在20世纪60年代，人们开始着手关于四足机器人的研究工作，在1977年，随着计算机和机器人控制技术的的研究和成熟的应用，Frank和McGhee制造出了世界上第一台真正意义的四足步行机器人，它具有较好的运动稳定性，由于控制运动系统是逻辑电路组成的，运动受到了限制，所以只能呈现固定的运动形式。随着科学技术的进步，四足机器人经过了近大半个世纪发展，目前最具代表性的四足机器人是美国波士顿动力研制的BigDog、Spo等双足或四足机器人，结合着计算机科学

14、的AI与物联网技术，每一次的进步性演示都令业界振奋不已。然而在波士顿动力的研发过程中也是充满崎岖荆棘的，研发所需技术要求和软硬件要求极高，经过克服重重难关，利用传感器的控制和算法解决了复杂性机械运动的问题，除多足式机器人外，在后续研发的Petman两足机器人，代表作机器人技术标准的新高度，与多足式机器人不同的是，它只有“双腿”，却与当代AI完美的结合在一起，具有优异的平衡性，高度的灵活性,如今许多国内外创客的优秀作品大多是建立在这些开源项目的基础上的。回看国内科技，在机器人的发展上也终于有企业做出了在性能上接近波士顿动力的足式机器人，但相比国外的技术，国内技术水准总体来说还是有很大的进步空间。

15、当下正是科技信息高速发展的时期，在物联网的发展高潮同时，随着第五代移动通信技术的到来和应用，越来越多的科技产物得以开发应用，小到纳米技术，大到宇宙探索，在2020年初的新冠肺炎抗疫行动中，由于病危患者与医务人员存在地理上的距离，随即开展了通过5G技术操控医疗机器人进行手术医治，并取得了成功，除此之外还有无人机辅助防疫，各大车站智能测温系统等等。目前来看，机器人的发展是当代的一个科学技术发展的趋势，而且逐渐趋于无人化的比例越来越大，所以说未来更是无人机器类发展的一个人工智能时代。1.3.论文研究内容与设计目标自然界中有着许多四足或多足肢的动物，典型常见的有猫狗、蜘蛛螃蟹乌龟等等，它们的运动方式与

16、人类截然不同，但它们可以在复杂的地形上行走自如，科研人员通过仿生学进行研究发现，相比在平面上运动的物体，在复杂环境中前行或达到目的地是非常困难的，所以特定的地形需要特定的运动控制形式，才可以可靠、高效地前行，目前的人工机器主要运用最广的有轮式和履带式，足式机器人是非常少见的，有许科学研究目的无法使用传统轮式或履带式的移动工具到达，所以为了应对特殊场所相应的开发出足式机器人，本次设计的一款基于ESP8266的四足机器人仅为代表例子演示，它以舵机作为肢足，四个肢足在电机驱动板的PWM信号下协调配合运动，不同于于轮式和履带式机器人，其不仅有四只运动机械肢体，而且相比轮式和履带式机器人，它有着不可比拟

17、的地形运动优势，可以在相对复杂的地形上运动。同时结合了“物联网”技术，原因是ESP8266是一款含有串口wifi模块的开发板，这使得其更具有操控性和实时性，更好地完成相关指令动作，比如前进后退，左右移动和平移等，在此基础上再加入超声波模块，实现智能避障的功能，从而达到更好地设计目的和效果。1.4 论文结构安排第一章为绪论，讨论了足式机器人的研究背景和意义，介绍了足式机器人在国内外的研究情况，以及关于足式机器人和运动控制和功能扩展和优缺点的解决方案。 第二章为四足机器人的系统需求设计方案和相关硬件的设计，分析了四足或多足机器人的系统的需求点,提出了可行性的设计和性能要求并对部分操作执行原理进行描

18、述。讲述了四足机器人的机械结构以及硬件模块之间的配合方式。 第三章为四足机器人的开发平台和软件的设计，对软件开发平台以及程序执行的流程图进行了介绍，讲述了两者之间的通信机制，控制运动的过程。 第四章为四足机器人的基本步态测试和调试，在单独测试了各个子系统的正常运行情况下，进一步进行前进、后退、左转、右转、左移、右移以及整体的最终测试。第五章为四足机器人的超声波避障测试以及有关整个设计存在的故障进行分析，同时对四足机器人有关领域的结合应用进行分析。最后对本文进行设计总结，总结设计开发过程中遇到的问题，自己的感受和收获。1.5 本章小结本章结介绍了该课题设计的背景和意义，结合国内外的研究状况，讨论

19、了此次设计的实现功能和目标，并给出了论文撰写和本次设计的安排。第二章 四足机器人的实现原理及硬件设计2.1 四足机器人的相关技术分析2.1.1需求分析本设计要求采用ESP8266串口WiFi模块进行指令编译和接收，要求通信模块与网络模块连接成功，机器人才能接收命令指令，经过MCU处理，再通过PWM Servo舵机驱动板模块PCA9685来调节舵机转动的角度值，从而完成预定或指定的动作，比如前进后退，左右移动和左右平移等等，最后环节再加上一个超声波避障。2.1.2系统实现框架 为实现上述功能需求，如图2.1所示系统框架图，在移动操作端进行指令的输入，通过无线局域网WiFi模块的接收，经过MCU处

20、理指令信息，从而驱动PWMservo的输出来控制各个舵机的转动的幅度值。 图2.1系统框架图2.1.3实现原理分析本次设计的四足机器人使用8个舵机，每2个舵机组成一个运动的肢足，运动的方式是靠舵机接收PWM信号来对相应的肢足进行运动控制，而每个肢足它组成的2个舵机PWM信号值进行配合变成相应的运动状态，根据要求的运动姿势来发送PWM信号给各个肢足，从而实现一个完整的运动控制。四足机器人的前后运动，左右运动及左右平移运动会在第五章整体测试与调试中进行详细的解析。2.2 硬件系统概述一个现代制造的机器的运转缺少不了硬件和软件，但每一个机器组成成分最多的就是硬件，硬件及外辅助支架的组成相当于机器的器

21、官和骨架，它可以提供强劲有力、高效稳定的运转条件，此次关于四足机器人的设计也是如此。2.3 系统结构设计2.3.1 系统各模块结构概述（1）结构支架有可选方案如下：1.塑料3D打印支架结构。2.椴木支架结构。对比两种支架材料，虽然塑料的3D打印支架具有良好的实用性、稳定性和观赏性，自己没有相关的3D打印设备，而且价格较高。反观普通的椴木板。即使椴木支架易松动损坏，但也可以提供短期的稳定效果，又考虑到设计成本及现有设备材料，以及设计实验的初衷，决定用椴木作为结构支架。（2）MCU控制端模块由于此次四足机器人的设计采用的是ESP8266WiFi模块，局域网的无线连接，它支持手机、平板、电脑的连接控

22、制，在很大方面展示了物联网的控制平台兼容性，相比电脑和平板，为方便此次设计，采用了移动手机作为操作控制端。（3）电源模块能源是每一个机器运转的前提条件，此次设计可用5.0V-12.0V电源作为动力，有两种电源方案选择：1.锂电池优点：质量偏轻，自放电率低，高储存能量密度。缺点：厚度偏厚，成本高。2.聚合物锂电池优点：容量大，质量轻，厚度薄，价格便宜。缺点：极片受潮容易发生气鼓，对环境要求高。综上所述及设计目的功能需求，在此选择7.4V聚合物锂电池来作为电源。（如下图2.2所示） 图2.2聚合物锂电池 （4）电源转接板电源转接板可间接保护电路，以及提供稳定的工作电源。（如图2.3所示）图2.3

23、7.4V电源转接板（5）ESP8266 WiFi模块ESP8266模块有两种选择方案1.ESP8266 NodeMcu Lua WiFi V3（CH340）。2.ESP8266 NodeMcu Lua WiFi（CPC2102）。由图2.1系统框架图可知，此模块负责接收指令并运行执行指令，市场上有很多NodeMCU变体并且基本上具有相同的功能,以上两种皆可以实现设计目的，但考虑价格，且性能相近，决定采用了ESP8266 NodeMcu Lua WiFi V3模块，支持Android和iOS移动设备，工作温度范围：-40C - 125C等等，并且NodeMcu已经刷好固件，安装串口驱动后，连接到

24、电脑即可用。（如图2.4所示，引脚图说明如图2.5所示） 图2.4 ESP8266 NodeMcu Lua WiFi V3 图2.5 ESP8266 NodeMcu Lua WiFi V3 引脚图（6）PCA9685电机驱动模块由于设计中用到舵机，需要用驱动板板来驱动，又考虑到存在多个舵机工作，所以用到了16路PWMServo PCA9685电机驱动模块接收来自nodemcu的信号，并驱动舵机动作，这里需要注意的是在连接各个舵机时要注意对应颜色的接口。（如图2.6实物图所示） 图2.6 PCA9685电机驱动板（7）舵机模块此次设计采用的舵机质量也会影响设计的准确性，有两种舵机可供选择：1.普

25、通塑料SG90舵机（图2.7所示）优点：价格便宜。缺点：故障率高，易抖动。2.MG90S金属齿轮舵机（图2.8所示）优点：稳定性好。缺点：价格相对较高。为提供稳定的性能，保证数据的准确性，两种舵机进行比较后，决定采用MG90S金属齿轮舵机，舵机装配在一起之前要把舵机插到主板对应插槽上，上下电，驱动主板会让舵机转到出厂位置，即初始位，然后再装配。图2.7 普通通塑料SG90舵机 图2.8 MG90S金属齿轮舵机（8）HC-SR04超声波模块图2.9 HC-SR04老款HC-SR04超声波模块需要主板另外接5V的电源供电，而新款HC-SR04超声波模块，如图3.7所示，可在主板的3.3V电压下工作

26、，精准度较高，在完成四足机器人前进后退、左右移动基础运动次设计后，增加此模块来实现智能的超声波避障，以此实现给予指令后四足机器人自身避开障碍物持续运动的效果。2.3.2 结构支架设计如图2.10支架受力平衡分析图，2.11三维构架图画,图2.12实物图所示 ： 图2.10支架受力平衡分析图图2.10支架受力平衡分析图 图2.11 四足机器人三维构架图画 图2.12 四足机器人实物图2.3.3 系统电路原理图如图2.13所示： 图2.13 系统电路原理图2.4本章小结本章节介绍了四足机器人的需求分析和原理框架图，详细地描述了其控制原理及运动机制，为后文关于硬件的选取和软件的结构设计实践确定了目的

27、要求和设计思路。同时概述了硬件和电路设计在此次机器人结构上的重要作用，粗略地描述了设计所需的硬件及模块功能和控制电路的实现原理，针对设计目的对部分模块进行详细的综合分析进行选择，以此达到最好的数据和效果，并且完成基础设计后增加超声波模块来实现智能避障运动。第三章 软件设计与实现3.1软件概述上章节介绍了硬件模块的组成，硬件之外便是软件的组成部分了，又分有系统软件和应用软件等，此次是软件设为源代码编程，经过开发环境编译处理后形成执行指令，源代码部分涉及了javascript的局域网Web网页的应用，即控制四足机器人的操作端，本次软件设计重点偏向于在辅助应用下进行四足机器人主要的运动控制的源代码修

28、改设计。3.1.1软件开发平台在此，ESP8266模块可以支持多种编程模式，这显示了它的兼容性和实用方便性，以下是对其开发平台的参考及建议：（1）.使用AT指令进行操作：这是最常见的方式，使用PC端的串口助手配合简单的指令就可以实现，也可以配合单片机发送指令使用。（2）.LUA语言编程：这是一种单独ESP8266编程的方式，可以不依靠单片机和串口调试软件，直接把程序编写到ESP8266内部。（3）.Arduino开发环境编程：这个接触过Arduino的都会比较熟悉。可以直接在Arduino IDE的环境下进行代码烧录，使用Arduino的开发方式进行开发，其相关资料也比较多。综上所述，个人比较

29、推荐Arduino 开发环境编程，因为比较容易接受与理解，arduino现在已经非常的成熟了，是一个非常成熟的解决方案了,相关资料也比较多，更适合作为这次设计的软件开发平台。（软件开发平台如图3.1、3.2所示）图3.1 arduino开发平台 图3.2 代码编辑界面3.1.2开发环境的配置在Arduino开发环境中，由于设计中用到的是ESP8266开发板模块，在原来的开发板管理器是没有的，需要自己手动输入搜索添加的，操作过程下如图3.3、3.4、3.5所示。1.在编辑界面中，点开工具，单击开“发板:XXX”，展示右边界面，双机“开发板管理器”，如图3.3开发环境配置示意图所示； 图3.3 开

30、发环境配置示意图 2.在搜索栏框中输入ESP8266，找到ESP8266开发板安装包后，点击下载安装即可，如图3.4开发环境安装包安装示意图所示；图3.4 开发环境安装包安装示意图3.进行相关参数的设置，如图3.5开发板配置示意所示；图3.5 开发板配置示意图4. 最后进行源码开发，编辑修改并校验准确性，并在下载程序前确认检测到的端口（COM）号，如图3.6校验程序示意图、3.7校验程序完成示意图所示； 图3.6 校验程序示意图 图3.7校验程序完成示意图注：若代码校验无误后即可上传到ESP8266。3.1.3 Web网页控制端连接上传完成后，基于ESP8266四足机器人控制系统在接通电源数秒

31、后，会生成一个WIFI热点名为“Robot-J mini”，初始密码为“12345678”，连接后在移动端的浏览器的搜索栏或网址栏框中输入“192.168.4.1”，点击访问，就会进入Web控制指令端移界面，在此之前，请确认先关闭移动设备自身的网络数据，避免产生网络访问错误的提示信息，在这一步的测试中，如若使用笔记本电脑类连接，偶尔发生指令传输失灵现象，因此不建议使用此方式，具体问题也在分析解决中。移动控制端连接操作及操作界面如图3.8控制指令Web界面所示；如图3.8控制指令Web界面关于生成的Web无线局域网，虽然是一个有限地理范围内的网络系统，在众多领域中有着应用，具有广阔市场前景，可见

32、无线局域网技术在生活中起着重要的作用。相比生活中有线网络中缺少灵活性，而WLAN具有多方面的优点，WLAN可以避免了以上情况的发生，而且不受布线条件的限制，安装方便，使用灵活，可以随身携带，因此非常适合移动办公或移动操作的需要。3.1.4 软件结构设计1.程序流程图如下图3.9所示；图3.9 程序流程图 当所需的软件应用准备就绪后，接下就是进行源码的修改和编辑了，许多电子或创客的网页有相关于四足机器人的代码设计，虽然运动控制的动作大体相同，但还是存在许多使用不同计算机语言的开发编辑的四足机器人源码，这时就要选择合适源码设计作为自身实践设计。3.2本章小结本章节介绍了关于ESP8266模块的软件

33、开发平台有多种可以选择，需要我们根据实际应用来选择开发平台，同时介绍了程序设计控制四足机器人运动的思路和程序执行的流程图。为后文整体调试阶段提供了软件支持和保障。第四章 四足机器人的测试与调试4.1系统功能测试4.1.1检测元器件在进行整体搭建设计之前，需要对各个元器件进行质量检测，检测环节包括单独检测、部分检测和整体检测，同时包含电路接口和连接准确性的排查检测。在这个环节尤为重要，它可以为整体的构建提供有效可靠的基础，从平时实验可知，运用到数量较大的元件时，应增加该元件的实际数量，由此来解决低概率故障性的发生，确保设计如期进行。4.1.2整体运行检测调试按照设计的目的，在完成所有硬件和支架检

34、测后，进行软件的写入和调试，这是设计中最后，也是最关键的一部分。保证由单个肢足运动到整体的运动动作的可行性和连贯性，从而达到预期的机械运动效果。四足机器人的运动可以比作一个团队合作的成果，而一个团队队员的分工合作起着绝对性的作用，四足机器人的各个肢足通过有序的PWM信号值调节，从而形成四足机器人连贯的运动动作。接下来对对各个运动状态以图画演示和文字描述，含部分代码示例，详细代码参见附录。1.开机复位及指令复位状态（如图4.1所示）/开机复位int Servo_Act_0 PROGMEM = 140, 30, 140, 40, 40, 150, 40, 140, 1000 ;/指令复位int S

35、ervo_Prg_8_Step = 2;int Servo_Prg_8 ALLMATRIX PROGMEM = 70, 90, 90, 130, 120, 90, 90, 70, 1000 , 140, 30, 140, 40, 40, 150, 40, 140, 1000 ,; 图4.1 开机复位状态示意图2.站立状态（如图4.2所示）int Servo_Prg_8_Step = 1;int Servo_Prg_8 ALLMATRIX PROGMEM = / 3, 14, 13, 12, 0, 1, 2, 15, ms 90, 90, 90, 90, 90, 90, 90, 90, 500

36、, / 70, 90, 90, 130, 130, 90, 90, 70, 500 , / 起立; 图4.2 站立状态示意图3.前进运动/前进int Servo_Prg_2_Step = 11;int Servo_Prg_2 ALLMATRIX PROGMEM = / 3, 14, 13, 12, 0, 1, 2, 15, ms 70, 90, 90, 130, 120, 90, 90, 70, 200 , /站立等待 90, 90, 90, 130, 120, 90, 45, 90, 200 , 70, 90, 90, 130, 120, 90, 45, 70, 200 , 70, 90,

37、90, 90, 90, 90, 45, 70, 200 , 70, 45, 135, 90, 90, 90, 90, 70, 200 , 70, 45, 135, 130, 120, 90, 90, 70, 200 , 90, 90, 135, 130, 120, 90, 90, 90, 200 , 90, 90, 90, 130, 120, 135, 90, 90, 200 , 70, 90, 90, 130, 120, 135, 90, 70, 200 , 70, 90, 90, 130, 90, 135, 90, 70, 200 , 70, 90, 90, 130, 120, 90, 9

38、0, 70, 200 , ;（1）前进步态1，如图4.3所示；进入站立姿态，或直接从待机状态开始运动。 图4.3 前进步态1示意图（2）前进步态2，如图4.4所示； 图4.4 前进步态2示意图 （3）前进步态3，如图4.5所示；图4.5 前进步态3示意图（3）前进步态4，如图4.6所示； 图4.6 前进步态4示意图4.后退运动/后退int Servo_Prg_3_Step = 11;int Servo_Prg_3 ALLMATRIX PROGMEM = / 3, 14, 13, 12, 0, 1, 2, 15, ms 70, 90, 90, 130, 120, 90, 90, 70, 200

39、,/站立等待 90, 45, 90, 130, 120, 90, 90, 90, 200 , 70, 45, 90, 130, 120, 90, 90, 70, 200 , 70, 45, 90, 90, 90, 90, 90, 70, 200 , 70, 90, 90, 90, 90, 135, 45, 70, 200 , 70, 90, 90, 130, 120, 135, 45, 70, 200 , 90, 90, 90, 130, 120, 135, 90, 90, 200 , 90, 90, 135, 130, 120, 90, 90, 90, 200 , 70, 90, 135,

40、130, 120, 90, 90, 70, 200 , 70, 90, 135, 90, 120, 90, 90, 70, 200 , 70, 90, 90, 130, 120, 90, 90, 70, 200 , ;后退运动步态与前进步态相似，只不过肢足运动顺序为：右前肢向下运动左前肢向下、左后肢向上、右前肢复原左前肢复原、左后肢复原、右后肢向上右后肢复原，进入站立等待下一指令状态。5.左转运动/左转int Servo_Prg_6_Step = 8;int Servo_Prg_6 ALLMATRIX PROGMEM = / 3, 14, 13, 12, 0, 1, 2, 15, ms 70,

41、 90, 90, 130, 120, 90, 90, 70, 200 , /站立等待 90, 90, 90, 130, 120, 90, 90, 90, 200 , 90, 135, 90, 130, 120, 90, 135, 90, 200 , 70, 135, 90, 130, 120, 90, 135, 70, 200 , 70, 135, 90, 90, 90, 90, 135, 70, 200 , 70, 135, 135, 90, 90, 135, 135, 70, 200 , 70, 135, 135, 130, 120, 135, 135, 70, 200 , 70, 90,

42、 90, 130, 120, 90, 90, 70, 200 , ;（1）左转步态1，如图4.7所示； 图4.7 左转步态1示意图（2）左转步态2，如图4.8所示； 图4.8 左转步态2示意图（3）左转步态3，如图4.9所示；在这一步态进入站立常态，等待下一指令。 图4.9 左转步态3示意图6.右转运动/右转int Servo_Prg_7_Step = 8;int Servo_Prg_7 ALLMATRIX PROGMEM = / 3, 14, 13, 12, 0, 1, 2, 15, ms 70, 90, 90, 130, 120, 90, 90, 70, 200 , /站立等待 70, 9

43、0, 90, 90, 90, 90, 90, 70, 200 , 70, 90, 45, 90, 90, 45, 90, 70, 200 , 70, 90, 45, 130, 120, 45, 90, 70, 200 , 90, 90, 45, 130, 120, 45, 90, 90, 200 , 90, 45, 45, 130, 120, 45, 45, 90, 200 , 70, 45, 45, 130, 120, 45, 45, 70, 200 , 70, 90, 90, 130, 120, 90, 90, 70, 200 , ;右转步态与左转步态相似，但顺序为：左前肢向上、右前肢向下

44、左后肢向上、右前肢向下，最后复位为站立姿态。7.左移运动/左移int Servo_Prg_4_Step = 11;int Servo_Prg_4 ALLMATRIX PROGMEM = / 3, 14, 13, 12, 0, 1, 2, 15, ms 70, 90, 90, 130, 120, 90, 90, 70, 200 ,/站立等待 70, 90, 45, 90, 90, 90, 90, 70, 200 , 70, 90, 45, 130, 120, 90, 90, 70, 200 , 90, 90, 45, 130, 120, 90, 90, 90, 200 , 90, 135, 90

45、, 130, 120, 45, 90, 90, 200 , 70, 135, 90, 130, 120, 45, 90, 70, 200 , 70, 135, 90, 90, 90, 90, 90, 70, 200 , 70, 90, 90, 90, 90, 90, 135, 70, 200 , 70, 90, 90, 130, 120, 90, 135, 70, 200 , 70, 90, 90, 130, 120, 90, 135, 90, 200 , 70, 90, 90, 130, 120, 90, 90, 70, 200 , ;（1）左移步态1，如图4.10所示；图4.10 左移步态1示意图（2）左移步态2，如图4.11所示； 图4.11 左移步态2示意图（3）左移步态3，如图4.12所示；图4.12 左移步态2示意图（4）左移步态4，如图4.13所示；在这一步态进入站立常态，等待下一指令。图