小型双足步行机器人的结构及其控制电路设计

1、小型双足机器人两足步行是步行方式中自动化程度最高、最为复杂的动态系统。两足步行系统具有非常丰富的动力学特性，对步行的环境要求很低，既能在平地上行走，也能在 非结构性的复杂地面上行走，对环境有很好的适应性。与其它足式机器人相比， 双足机器人具有支撑面积小，支撑面的形状随时间变化较大，质心的相对位置高 的特点。是其中最复杂，控制难度最大的动态系统。但由于双足机器人比其它足 式机器人具有更高的灵活性，因此具有自身独特的优势，更适合在人类的生活或 工作环境中与人类协同工作，而不需要专门为其对这些环境进行大规模改造。例如代替危险作业环境中(如核电站内)的工作人员，在不平整地面上搬运货物等 等。此外将来社

2、会环境的变化使得双足机器人在护理老人、康复医学以及一般家 务处理等方面也有很大的潜力。双足步行机器人自由度的确定两足步行机器人的机构是所有部件的载体，也是设计两足步行机器人最基本 的和首要的工作1。它必须能够实现机器人的前后左右以及爬斜坡和上楼梯等 的基本功能，因此自由度的配置必须合理：首先分析一下步行机器人的运动过程 (前向)和行走步骤：重心右移(先右腿支撑)、左腿抬起、左腿放下、重心移到双 腿中间、重心左移、右腿抬起、右腿放下、重心移到双腿间，共分8个阶段。从机器人步行过程可以看出：机器人向前迈步时，髓关节与踝关节必须各自配置有 一个俯仰自由度以配合实现支撑腿和上躯体的移动 ；要实现重心转

3、移，髋关节和 踝关节的偏转自由度是必不可少的；机器人要达到目标位置，有时必须进行转弯， 所以需要有髋关节上的转体自由度。另外膝关节处配置一个俯仰自由度能够调整 摆动腿的着地高度，使上下台阶成为可能，还能实现不同的步态。这样最终决定 髋关节配置3个自由度，包括转体(roll)、俯仰(pitch)和偏转(yaw)自由度，膝 关节配置一个俯仰自由度，踝关节配置有俯仰和偏转两个自由度。 这样，每条腿 配置6个自由度，两条腿共12个自由度。髋关节、膝关节和踝关节的俯仰自由 度共同协调动作可完成机器人的在纵向平面(前进方向)内的直线行走功能；髋关 节的转体自由度可实现机器人的转弯功能； 髋关节和踝关节的偏

4、转自由度协调动 作可实现在横向平面内的重心转移功能。机器人的转体(roll)、俯仰(pitch)和偏转(yaw)定义如图1所示2。纵向半面图1步行机器人方向示意图其中，定义y轴方向为前进方向，z轴方向为机器人的身高方向 机器人的自由度总体配置如图2所示。k.nee (1O)图2自由度总体配置图动力源的选择目前市场上，有很多种电动机向机器人提供能源：直流电机、交流电机、步 进电机、伺服电动机。由于双足步行机器人要求的精度要求比较高，而交直流电机通电就转，断电就停，比较难进行机器人的位置控制； 步进电机虽能按一定的 精度工作，但它本身是一个开环系统，精度达不到要求。因此，本文选择使用伺 服电动机。

5、在本文中使用的是价格比较便宜的伺服电动机一舵机。 舵机最早出现在航模 运动中。在航空模型中，飞行机的飞行姿态是通过调节发动机和各个控制舵面来 实现的。电动舵机的工作原理如图3所示。其中，舵机控制器一般采用PID控制, 以满足舵机动静态指标要求；伺服功率放大器一般由脉冲宽度调制器(PWM和开关控制电路组成；直流伺服电机是电动舵机的执行元件， 可采用有刷或无刷直流 电机；减速机构一般采用蜗轮蜗杆或丝缸减速机构。由于本研究制作的机器人是桌上型的重量很轻的作实验用的小型双足步行 机器人。因此机器人的各关节是选择使用舵机驱动。图3电动舵机工作原理方框图附表 RC伺服电机的参数型号足寸（cm钉电压HG4D

6、6 * 19.8 - 3?.BI cmft. las./'feO'1 宀此类电机的特点就是体积小、重量轻且控制简单，另外价格也较便宜。附表示出了电机的参数。步行机器人每条腿的自由度为6。各关节的驱动使用的是北京汉库科技有限 公司的HG14-M的大力矩舵机。机构的设计根据本课题的要求，本文设计了机器人的机构，其主要特点有以下几点：布置对称性步行运动中普遍存在结构对称性。Goldberg3等人研究了步行运动中的对 称性，发现机身运动的对称性和腿机构的对称性之间存在相互关系。在单足支撑阶段如图4,对称性的机身运动要求腿部机构也是对称的；在双足支撑阶段如图5,机身对称性运动未必需要腿部

7、机构的对称性，除非有额外的约束条件。根据这点，笔者在结构设计时也采用对称性布置4。框架的设计有效的利用了 RC伺服电机的尺寸大小，并使电机的活动范围能 尽量符合各关节的活动范围。采用多关节型结构。行走机构能实现平地前后行、平地侧行、转弯、上下台 阶、爬斜坡等功能。整个结构采用1mm勺铝合金（LY12）钣金材料，这种材料重量轻、硬度高、强 度虽不如钢，但却大大高于普通铝合金。且这种材料具有弹性模量、密度比高的 特点。由于机器人的各关节是用 RC伺服电机驱动，为了减小机器人的体积、减轻 重量，机器人的结构做成是框架型的。框架的设计有效的利用了RC伺服电机的尺寸大小，并使电机的活动范围能尽量符合各关

8、节的活动范围。控制系统方案构思由于本机器人机构采用了 12个舵机，本控制系统就是要实现能同时驱动这12个舵机的功能。由前面的叙述知道，舵机的控制信号为周期是20ms的脉宽调制（PWM信号，其中脉冲宽度从0.5ms 2.5ms,相对应舵盘的位置为 0180°, 呈线性变化。也就是说，给它提供一定的脉宽，它的输出轴就会保持在一个 相对应的角度上，无论外界转矩怎样改变，直到给它提供一个另外宽度的脉冲信 号，它才会改变输出角度到新的对应的位置上。图4单腿模型图图5两足步行机器人双腿模型图传统产生PWM波的方法是通过大量的分立元件来实现的,所产生的脉冲频率 和宽度往往不是很准确，很难做到对舵机

9、的精确控制。目前，产生PWM波的方法 有很多种：最直接的方法就是用单片机本身所带的 PWMR产生波形，但该方法受 MCI内部资源的限制，仅能实现 24路PWM波的输出，对于需要多路舵机的场 合显然是不够的。另一种方法就是利用分时复用的思想利用单片机一个中断产生 7路控制futaba舵机用PW波的方法。该方法虽然实现了 7路舵机的控制，但 也仅能实现7路舵机的控制，并且仅针对特定舵机的控制，控制精度也不高，在 一些重要场合的应用受到了限制；还有一种方法就是利用单片机纯软件的循环计 数的方法或者，利用硬件定时，软件计数相结合的方法，在不增加任何硬件接口 的前提下，实现了多路PWM波的输出，然而此方

10、法大量占用 MCU!算时间， 基本不能再处理其它的事务，并且精度不高。另外，目前一些数字信号处理芯片片内就集成了 PW波形产生的功能，只需 要进行寄存器参数的设置就可得到 PWM勺输出。但在一些只需要简单电机控制的 场合，从成本考虑不需要较为昂贵的数字信号处理芯片。本文采用一片51的单片机和一片复杂可编程逻辑器件（CPLD）实现了 PW啲 产生。由于CPLD具有他特有的并行处理能力和大量的10接口，可以同时控制几 十甚至上百个舵机同时工作，可以为后续的工作留出一定的空间，但由于 CPLD 不具备事务处理能力，实际应用中还需要 MCI协同工作，本文使用51系列的单 片机和CPLD协同控制舵机，另

11、外，使用了单片机，还可以为后续的传感器反馈 处理留出空间。图6控制系统结构图控制系统所图6所示，选用“上位机+串口 +下位机”的控制系统解决方案。 上位机控制软件的主要功能是对预定的机器人动作进行规划和位置插补，再按照一定时间间隔和次序进行发送给下位机，实现机器人关节位置和近似的速度控制 下位机主要功能是接收上位机发送的位置信号，根据信号要求产生PWM波,控制机器人各个关节舵机运动，使机器人按动作规划完成溜冰动作。 相应的，下位机 主要由完成串口通信、数据的调度和 12个舵机驱动模块构成7。图7 CPLD的 12路舵机驱动原理图图7为CPLD勺12路舵机驱动原理图，CPLD通过一个简单的接口与

12、51单片 机进行通信，把要驱动的12个舵机的PWM信号数据存入到数据存储区，从而通 过数字PWM生成器驱动12个舵机转到需要的角度，当需要转换到下一个角度时， 通过与51单片机的接口，从51单片机中传送新的PWM&号数据到数据存储区中 进行更新，这样数字PWM生成器就会驱动舵机转过一个新的角度。硬件设计 电源为了避免舵机的供电电源产生的电压波动对控制电路的干扰， 控制电路与舵 机的电源要进行隔离，即分开供电。控制电路电源使用的是一个 9V输出的AC-DC 变压电源经7805芯片后提供的5V电源，而舵机的电源提供了一个接口，外接一 个6V的直流电源。控制芯片控制芯片模块包括单片机、 时钟

13、电路、 复位电路、 外部程序存储芯片扩展以 及大规模CPLD芯片。单片机采用Atmel公司的AT89S52它是8位的高性能嵌 入式控制器,其内部集成了 8k的可在线编程的Flash存储器;256字节的RAM可 寻址 64 字节，具有 32 根 I/O 口、3 个可编程定时器、 8 个中断源、 6 个中断矢 量、1 个看门狗定时器。 时钟电路给系统提供时间基准 , 设计时采用 11.05296MHz 晶振。同时，本设计还扩展了一片 8kX8位的外部存储芯片2864。CPLD芯片采 用的是ALTERA公司的EPM7128 串行通信串行通信模块主要用于AT89S52单片机与PC机之间的串行通信。由于PC 机的COM口符合RS-232标准,AT89S52单片机上的串行接口是 CMO电平，在 RS-232与CMO电平通信时，需要电平转换，因此，设计时利用 MAX232芯片来作 电平转换。舵机的驱动控制12路舵机的控制信号来自 CPLD芯片的I/O 口（引脚30、31、33、34、35、 36、 37、 39、 40、 41、 44、 45）。为了防止干扰， 13 路舵机控制信号和驱动电路 应经过TLP-521光电隔离，通过隔离出来的控制信号，还必须接入LM324比较器， 以消除毛刺， 增加信号的稳定性， 提高信号的输出电流， 以便舵机能够正确工作 不至于产生不必要的抖动。图