机器人关节方案设计书与实现.docx

1、机器人关节方案设计书与实现 设计题目：机器人关节的设计与实现学生姓名： * 所在院系： 信息工程学院 所学专业： 计算机科学与技术 导师姓名： * 完成时间： * 摘 要机器人关节是机器人的基础部件,其性能的好坏直接影响机器人的性能。随着数字伺服技术等电子技术的发展，机器人关节也在不断发展。本文主要研究基于舵机的机器人关节的设计与实现。本文主要了完成以下工作：采用定时器控制方法产生舵机控制的脉冲信号。为了能实现活动关节根据输入角度准确定位和微调，在设计中加入了矩阵键盘调控系统。在硬件搭建方面，设计了基于STC89C52的2路脉冲信号的硬件控制电路系统。之后对系统所使用的编辑软件和调试工具进行了

2、简要说明，并详细介绍了软硬件主要模块的设计和实现过程，以及重要模块的调试和仿真的具体过程。最后，根据软硬件设计结果，制作了一个极坐标结构的机器人关节，能够完成在水平和竖直方向的比较精确的控制。关键词 舵机，机器人关节，脉冲信号Abstract Robots joint, is a basic part of robot, whose performance will directly affect a robot. With the development of electronic technology such as digital servo, the technology of rob

3、ot joint is developing continually. This paper studies the robot joint design and implementation based on digital servo. In this paper, the following work to complete:In order to achieve activities Joint accurate positioning and fine-tune based on the input angle, the design adding a matrix keyboard

4、 to control the system. Hardware structures designed 2-way pulse hardware control based on STC89C52 circuit system. Then, the paper briefly describes the editing software and debugging tools by the system. This paper introduces the design and implementation of the main modules of hardware and softwa

5、re, and important part of the specific process of debugging and simulation. Finally, according to the results of software and hardware design, produced a polar structure of the robot joints which can complete in the horizontal and vertical directions, respectively, the more precise control.Key words

6、 Servo, Robot joint，Pulse signal1.引言从一战以来，机器人学和飞机、火箭、计算机等一样，也日益发展成为我们日常生活不可或缺的科学技术，机器人的应用广泛，从传统的自动化制造领域，到人类的日常生活，再到茫茫星系的探索，都已经离不开机器人。1.1课题背景机器人关节的种类有很多，根据机器人的功能不同，关节的配置和运动系统的形式也都各不相同。应用最多的工业机器人是多关节机器人，它主要是由多个回转关节和连杆组成，模拟人的肩关节、肘关节和腕关节等的作用。工业机器人关节根据输出运动形式的不同分为移动关节和转动关节：根据传动机构的不同可以分为齿轮传动、连杆传动和摆线针轮减速传动；

7、根据驱动器形式的不同可以分为电驱动关节、气压驱动关节、液压驱动关节和特种驱动关节等。仿人机器人也是当今机器人爱好者研究的热点之一，仿人机器人因为外型类人则其关节可以分为上肢关节和下肢关节。仿人机器人主要分为仿人手臂型和仿人双足型。仿人手臂型主要是研究7自由度手臂和多自由度操作臂、多指灵巧手及手臂和灵巧手的组合。仿人双足型主要研究步行机构及步行特性，下肢关节结构是步行质量好坏的关键。微型机器人则是利用集成电路微细加工，将驱动器，关节传动装置以及传感器控制器和电源等集成在很小的多晶硅上。工业机器人与仿人机器人的肩、肘、髋关节不同的是自由度的个数。通常工业机器人的肩肘髋的关节的自由度为1。总体来看机

8、器人关节呈现出大力矩，高精度，反应灵敏，小型化，标准化和模块化的趋势和发展。1.2舵机简介在机器人关节的设计中，电机是至关重要的一部分，电机就像是机器人关节的肌肉，只有正确的配置和使用电机才能使机器人关节正常运转起来。常见的电机主要有直、交流电机，而直流电机一直在机器人设计中占有主导地位。直流电机可以分为连续转动电机和步进电机2种，主要区别是连续转动的电机在通电后主轴连续转动，只有当断电或者电机提供的驱动力无法驱动负载时，主轴才停止转动或这阻塞；步进电机则是通电后主轴转动某一个角度后，然后停止。直流电机和步进电机都是开环反馈系统，也就是在电机转动的过程中并不知道电机究竟转过了多少角度。伺服电机

9、是一种比较特殊的连续转动电机类型。伺服电机转动的角度可以通过控制电路反馈，并且控制电路不断的修正转动角度的误差，直到电机转动要预期位置。舵机是一种伺服电机，它具有伺服电机的优点，即在接收到控制信号后可以转过相对准确的位置，这使舵机在机器人设计，航模，船模等有着广泛的应用，比如用来控制机器人的转动方向等。舵机的定位是利用脉宽调制的方法实现的。舵机可以根据周期内高电平的持续时间（即脉宽）来完成定位。一般的舵机控制电路能够接收周期为20ms、脉宽为12ms的脉冲信号，脉冲的准确长度决定了舵机轴转动的准确位置（图1-1）。目前普遍使用PWM（占空比）即高电平在20ms周期内的持续时间所占的比例来描述脉

10、宽。当舵机接收到的1ms的脉宽时，舵机向某一个极限位置转动，当接收到脉宽为2ms的时候，舵机向另一个方向极限位置转动。也可以说舵机的角位移与接收到的脉宽成正比，一般情况下，舵机能在0.250.5的时间内转过60。伺服电机是一种闭环反馈系统，内部主要有一个控制电路、一个电机、一个齿轮箱和一个电位计组成。电位计的作用是检测舵机的输出轴是否已经转到期望位置。电位计与舵机的输出轴相连接，这样分压计能够非常准确的反映出舵机输出轴的当前位置。电位计输出为一个电压信号，当舵机的输出轴的位置变换时，控制电路就会从分压器接收到不同的电压信号。舵机中的控制电路将电位计的输出的电压信号和控制脉冲信号定时比较，如果电

11、压信号不正确就会产生误差信号。该误差信号与电位计的位置和可能告知脉冲的差值成正比，当存在误差信号时，电机就会保持转动，直到电位计输出的电压信号和控制脉冲信号相匹配时，误差信号被移除，电机停转。图1-1 周期为20ms的脉冲信号的高电平持续时间在12ms之间变化可以控制舵机的输出轴位置舵机的主要技术参数有力矩，回转率，工作电压，工作温度，死区等。舵机的应用场合，主要有多自由度机器人设计，多路伺服航模控制，电动遥控飞机,遥控飞机，航海模型，高档遥控仿真车等。1.3本文研究的工作通过对电机类型的结构和原理进行分析与比较，本课题选用舵机作为机器人关节的本体原件来完成的机器人关节的设计与实现，以达到可以

12、在水平和竖直两个方向上控制机器人关节的活动效果。系统主要包括硬件设计和软件设计，以及最终硬件的制作。硬件设计主要包括液晶显示模块，矩阵键盘模块和舵机与单片机的接口模块，以及最后的机器人关节外形设计。与硬件设计相对应的，软件设计主要包括液晶显示模块，矩阵键盘模块和舵机的脉冲形成模块。在本文的下面一些章节会详细介绍软硬件各部分的设计过程。2.系统的总体设计系统的总体设计分别包括系统的硬件设计和软件设计。硬件设计主要是指完成系统工作所必须的硬件部分电路设计以及硬件组装设计；软件设计主要是指单片机的程序设计。硬件设计主要包含液晶显示，矩阵键盘和舵机接口三大部分。图2-1为系统框图。图2-1 系统框图3

13、.硬件的设计与实现硬件是系统运行的基础，硬件设计是系统设计中的重要组成部分。本系统中的硬件设计主要包括系统工作电源电路设计，1602液晶显示电路设计，矩阵键盘和舵机与系统接口的电路设计等。3.1主要元器件介绍下面主要对硬件中使用的一些重要的元器件的电气特征作一下介绍。3.1.1舵机通过对舵机的结构原理，控制特性与机械特性的综合分析与研究，最终选择TowerPro公司的MG995型号舵机（图3-1）作为本课题的舵机本体。该型号舵机具有力矩大（10kg/cm），输出功率高，价格合理，稳定性好等优点。其他参数还有回转率0.20s/60，工作电压4.87.2V，工作温度为055，角度范围090度等。图

14、 3-1 TowerPro MG9953.1.2STC89C52由于51系列单片机在国内广泛使用，技术比较成熟，而且相关的开发工具也比较普及，性能优越，所以在此也选择51系列的STC89C52单片机作为控制机器人关节的单片机。STC89C5*系列单片机不仅性能优越，而且控制简单，价格合理。该型号的单片机片内EPROM达到8K，同时有2个定时器，足以承担系统的设计需要。其他的选用的主要器件还有稳压器7805, 液晶显示器1602，电容和电阻等一系列电器元件。3.2硬件的设计过程硬件的设计过程包括硬件的电路设计和机器人关节的外形设计。根据系统将要完成的几项功能考虑硬件电路设计，硬件部分所要提供的功

15、能有液晶显示、矩阵键盘、舵机接口，所以硬件电路设计主要包含这几个部分的功能。除此之外还有系统工作的电压电路，以及机器人关节的外形设计等。下面详细介绍重要功能模块的设计。3.2.1工作电源控制电路设计为了给系统各部分提供稳定可靠的直流电压，在控制系统中选用了稳压器7805完成对工作电压的稳定控制工作。7805具有体积小，重量轻，可靠性好等特点。图3-2是为系统电源控制电路图。12V的直流电压经过7805后转换为稳定的5V电压后，供应整个电路的电源系统。为了防止电路回时电流过大对7805造成损害，在电路中选用二极管保护7805。图3-2 电源控制电路图3.2.21602显示控制电路设计系统选用16

16、02（SPI16引脚）作为数据显示器件，主要用于显示舵机的当前角度和调整角度。1602是一种16*2字符型液晶显示器，采用电路模块封装，控制器大部分为HD44780，带有标准的SIP14引脚（无背光）或SIP16引脚（带背光），芯片和背光电路工作电压与单片机兼容引脚分为电源、通信数据和控制三部分，可以很方便的可以与单片机进行连接。设计中选用单片机的P0口作为1602的数据输入端口（D0D7），P3.2，P3.3，P3.4分别作为数据命令选择端(H/L)（RS），读/写选择端（H/L）（RW），使能信号端（E）。上拉电阻部分（RP1）具有限流的作用。图3-3为1602与STC89C52的接口电路

17、图。图3-3 1602显示电路图3.2.3矩阵键盘控制电路设计本系统的矩阵键盘主要是用于定位调整和加减微调舵机角度两项功能。电路图3-4为矩阵键盘的控制电路。选用STC98C52单片机的P2口作为矩阵键盘的控制端口。按键09为数字按键，主要用于定位舵机角度的输入。键D1+，D1，D2+，D2分别控制舵机1和舵机2微调。确定键，当输入舵机需要定位的角度后，按下确认键后，舵机开始运转。取消键，用于取消输入的定位角度（未按确定键前）。图3-4 矩阵键盘电路图3.2.4舵机与系统接口电路设计向舵机发送脉冲信号的电路部分，舵机根据脉冲宽度调整舵机的位置。下图（图3-5）为舵机与系统接口的控制电路部分。图

18、3-5 舵机脉冲信号控制电路分别选用STC89C52单片机的P1.3，P1.4引脚作为舵机1和舵机2的输出脉冲信号的控制端口。在电路仿真中，该2个端口接的是虚拟示波器，用来显示和反映脉冲信号的输出状态。3.2.5机器人关节的外形设计机器人关节的外形设计是指最终机器人关节的成型外形。首先是关节的支架部分的设计，因为关节支架是第一眼外观直接接触到的，所以设计的时候兼顾成本与外形的美观；然后是关节基座的设计，关节基座是位于关节底层的基础部件，它的稳固与灵活直接关系到整个关节的活动性。3.3硬件的实现过程硬件的实现过程主要包括PCB板得制作过程和硬件的组装过程下面对此两方面做分别介绍。3.3.1电路板

19、的设计过程将整个系统电路图设计出来后，接下来我们就需要制作电路板图了。电路板设计得是否合理，质量是否可靠，直接决定着制作出来的控制电路的质量和运行的可靠性。Altium Designer提供了板图设计功能，包括自动布线和器件自动摆放功能。事实上，器件自动摆放功能是达不到要求的，因此，实际操作时应采用“人工摆放元件人工预布线自动布线人工细调”的设计流程，一步一步制作出符合要求的电路板。电路板图见附录二。3.3.2硬件的组装过程这部分主要包括部分硬件的制作和硬件的组装。前期硬件制作的精细将直接关系到最终关节的灵活性、外观以及扩充能力，也就是决定了机器人关节的质量。硬件的组装主要包括机器人关节的外形

20、组装和电路板的各元件的安放与焊接，以及组装完成后的调试等过程。首先是硬件的选材，在跑遍各材料市场之后，终于选定了以铝合金作为支架的材料。但是因为铝合金的硬度较大，实验的工具有限，不易裁剪，所以这对部分的器件制作产生了不小的困难。不过最终我们依然是不懈的向我们的设计靠近，裁剪出来比较合格的部件。硬件的组装过程可以说也是一个有难度的过程，在设计阶段的各个关节部件，在组装过程中才会发现设计的不足，以及遇到各式各样的问题。比如会遇到裁剪好的部件因为误差和裁剪过程的失误，造成的最终部件不能很好的吻合舵机的转轴问题等。图3-6 关节实物图4.软件的设计与实现软件是系统的灵魂，软件设计的好坏直接影响到整个系

21、统性能的强弱。所以软件设计是本系统中重要的组成部分。4.1系统软件设计流程在本系统中的软件主要是指单片机的程序，主要包括舵机脉冲信号发生模块，矩阵键盘控制模块和液晶显示器1602显示模块几大部分。软件的工作过程首先单片机程序复位以后，定时器和160分别进行初始化。之后在主函数里设置舵机的初始位置，然后进入while()函数。在函数内部，不停的进行按键扫描是否有按键被按下，如果按键被按下，则进入按键数据处理函数keymanage()进行按键处理，并将处理结果送去1602显示。系统流程图如图4-1所示。4-1 系统设计流程图4.2各模块程序设计单片机程序的子模块主要包括脉冲信号产生模块，矩阵键盘控

22、制模块和液晶显示模块，在这里主要详细介绍前2个模块。4.2.1脉冲信号产生模块在该单片机程序中，主要使用2个定时器来产生2路脉冲信号，分别输送给2个舵机。具体实现方法是timer1作为基准定时器，提供稳定的10ms定时，timer0则作为控制高电平时间定时器。在timer1中每次根据标志位选择翻转脉冲信号高低电平，并打开timer0：在timer0中断函数中，则根据标志位重新翻转脉冲信号，最后关闭timer0，则形成高电平脉冲，完成舵机脉冲信号的输出。脉冲信号产生流程图如图4-2所示。图4-2 脉冲信号产生流程图因为舵机的控制电路周期的脉冲时间为20ms，而STC89C52里共有2个定时器，所

23、以本系统采用分时复用的方法来产生2路脉冲信号。该方法在理论上可以控制10个舵机的共同工作，可扩充性强。4.2.2矩阵键盘控制模块在单片机程序中，矩阵键盘的控制最为繁杂。首先是键盘的扫描，根据按键的不同分别执行不同的程序操作：09数字按键经过键盘的散列转换后分别被存入程序处理并置flag_key=1（表示有数字按键被按下）和送去液晶显示器显示；+，按键直接控制脉宽信号微调增加（减少）千分之0.5（0.1）；确定键则是很据所输入2个舵机的角度的范围满足要求且flag_key=1（数字键按下标志）时， 系统则控制脉宽信号发生变化，舵机转动到相应角度，并更新1602显示，否则执行出错；取消键则是用于取

24、消已输入角度，但是还未按下确定键的角度值。矩阵键盘的控制流程图如图4-3所示。图4-3 矩阵键盘流程图4.3数据处理在本单片机程序中，数据处理的任务主要有两个，分别是矩阵键盘的散列转换和脉宽与角度转换的处理。4.3.1矩阵键盘的散列转换键盘的散列转换是指键盘分别接收到不同的按键信息后，分别转化为相应的数字或者相应的操作。键盘地散列转换采用根据P2的值来进行不同的键的功能定义，分别对应见下表：表4-3-1 键盘散列转换功能定义表P2值对应键P2值对应键0xee取消0xeb舵机1-0xde确定0xdb60xbe舵机2-0xbb50x7e舵机2+0x7e40xed00xe7舵机1+0xdd90xd7

25、30xbd80xb720x7d70x7714.3.2脉宽与角度的数据处理根据舵机的控制原理可知，脉宽与角度满足线性关系（图4.2）。脉宽与角度的处理包含2个部分，一是将脉宽信号转化为角度并用液晶显示器显示出来，另一部分是将输入的角度转换为脉宽信号。若角度记为，脉宽记为，脉宽-角度关系图如图4-4所示。图4-4 脉宽角度关系图在将脉宽转换为角度的时候，因为显示的角度是整数，显示部分采取下限取整（如80.080.9显示为80）。需要指出的是，在程序内部，使用的脉宽单位为us，故转换公式如下：脉宽信号在程序内部采用的是整数（即10002000us），在将输入的角度转换为脉宽信号时，采取的约法是四舍五

26、入（如1500.3=1500,1500.6=1501）。转换公式如下：5.仿真与调试5.1硬件电路的仿真在本系统中的硬件电路仿真设计，主要是运用英国Labcenter electronics公司开发的 EDA工具软件Protues，Protues是一款非常优秀的仿真软件，能支持当前主流单片机系统的仿真并有丰富的软件调试功能。下面对主要的硬件电路仿真作介绍和分析。首先是系统脉冲信号的产生，因为产生的是脉冲信号，所以选用2个虚拟示波器查看单片机定时器产生的波形与大小；然后使用LCD1602来模拟液晶显示器的显示，4*4按键模拟矩阵键盘（图5-1）。图5-1 电路仿真图系统最终输送给舵机的脉冲信号是

27、20ms分2次10ms周期，两路舵机信号分别在前10ms与后10ms翻转，形成高电平，最终仍然脉冲周期仍为20ms。图5-2为系统产生的2路舵机脉冲信号图。图5-2 2路舵机脉冲信号图5.2单片机的程序调试开发工具是选用目前国内流行的Keil公司出品的51系列单片机软件仿真器。Keil Vision3 IDE是一个窗口化的软件开发平台，它集可视化编程、编译、调试、仿真于一体，支持51汇编、PLM和C语言的混合编程，界面友好、易学易用、功能强大。它具有功能强大的编辑器、工程管理器以及各种编译工具。由于单片机程序采用C语言编写，因而程序的调试比较简单。使用Keil uVision3提供了丰富的调试

28、工具，使调试进行的非常顺利，最后通过编译并生成了hex可执行文件，下图5-3为程序部分调试过程图。图5-3 程序部分调试图6.总结本课题利用单片机定时器实现了舵机2路脉冲信号的输出，实现了机器人关节转动的功能，完成了本课题的主要内容：机器人关节的设计与实现。由于制作工艺水平的有限，使得本次设计中电路系统做得比较简易与粗糙，由于时间紧迫，未能完成更高等的目标与任务。然而，在有限的时间内，我努力掌握了舵机的控制方式，整体把握了机器人关节的设计思路，完成了从设计硬件电路、单片机程序到实现关节转动的整个过程。在实验过程中，我学习了Keil、Potues和Altium Designer软件的基本功能，并

29、掌握了一些基本的使用方法。在前期收集资料的过程中，从网上和前辈们的论文中搜集到了很多不同的多路PWM脉冲信号的控制方法，使我从不同的角度深入的了解舵机的控制方法，这对我本次实验的软件设计脉冲信号部分有很大的借鉴和参考意义。虽然这次软件设计过程中，林林总总换了三、四种脉冲信号产生方案，在做过几种方法的稳定性与操作难度的比较之后，最终决定使用定时器方式来完成脉冲信号的产生。毕业设计是一个回顾与理顺旧知识，不断的吸收新知识的过程。在这个过程中，我深深感觉到自己的不足，连每一次的失败都显得是那么的珍贵，都会给我以深刻的启迪。虽然在以后不一定会有机会从事单片机相关的工作，但是这个过程的努力和汗水，思维和

30、方法都会是我宝贵的人生财富。致 谢在论文的完成过程中，得到了院系老师的大力支持，尤其是得到了曲培新老师的精心指导和帮助，感谢曲老师在百忙之中的辛苦指点，给予我无尽的启迪。曲老师从论文方向的选定，到最后的整篇文论的完成，都非常耐心的对我进行指导。给我提供了大量数据资料和建议，告诉我应该注意的细节问题，细心的给我指出错误。他严肃的科学态度，严谨的治学精神，精益求精的工作作风，深深地感染和激励着我。在此，我还要特别感谢在论文完成过程中所有给予我帮助的老师和同学。正是由于你们的帮助和支持，我才能克服一个一个的困难和疑惑，直至本文的顺利完成。在论文即将完成之际，请在这里请接受我诚挚的谢意！参考文献 1

31、刘广瑞等. 机器人创新制作. 西安：西北工业大学出版社，2007.22 张玉茹，李继婷，李剑锋等. 机器人灵巧手. 北京：机械工业出版社，2007.13 (美)Gordon McComb，Myke Predko 著；庞明等译. 北京：科学出版社，20074 (美)McComb,G，著：原魁等译. 机器人本体制作指南. 北京：机械工业出版社，2006.25 李华晋，刘鸣. 机器人关节及转向装置舵机的原理及应用J 高校实验室工作研究，2010（103）: 62-636 王倩，李冬雪. 基于FPGA的机器人多路舵机控制器J 科学技术与工程，2009（11）:3083-30857 万小丹，孔凡让，李岩，赵小伟. 基于at89c52单片机的机器人关节控制系统设计J 学术 论文 2008(2):38-408 付丽，刘卫国，伊强单片要控制的多路舵机用PWM波产生方法 J 微特电机，2006(2)：28-339 徐谋峰，黄雪梅. 舞蹈机器人动作编程研究 J 山东理工大学学报，2010（24）：77-8010 梁峰，王志良，解仑，等多舵机控制在类人机器人上的应用J微计算机信息，2008(1-2)：242-