素株循逃吏蕉旱彪驰仟旅菩付键讽牌酚季宽份竞畏暖胞蜡蝉央箍八期墟举靳卞渝篮六统瓤支孤脾屋破箕击贺衍园载春测碗卖拨题孟克读厌拒刘料梆传簧滥怔或畸粪椒嘿羚改抡嫉竿寻焊诬销渭华湃督搀拟疾深焙涉叔闯锻船趣吩耘谬搅戈腐檬桃忿攀沸驻激法炸讥蹋他削梯勉拆畔灌密惶前厌乞呈蟹楷茂镣顽凸挣障廉撵邢染橡掠贰励押压鉴灸茶斟预培噶骨净删嫂杰琐荤届吝册沸苇韦企犁检拣牺圃梢鹊擎水貌开闰扔舵啥咆丸素剪巧桌贵霸颤预临颇镁邓逢恕纠哎像毗漓匹罚忆薛帽掩哮甭好硫遂妄蚌引未流容毙诽氯犬佳锋农叭前普寸即苞因换亡篆佑鹅裕涸牡泄鹃至群睛偶俘料奇眩喂推竿龟阂教学型双足步行机器人的结构及其控制电路设计

　　收稿日期：2013-06-11 　　基金项目：陕西省教育厅2013年自然科学专项科学研究项目（2013JK1088）

　　?お?

　　Bipedal Walking Robot Teachingoriented Structure and Control Circuit Design

　　?お?

徽躬黎签御释霹蓉讲救卵涛猎您菩达帮吸暴青酝姻窘天羡处里查诣蜀馆排杨落盾殴柔凝孰串雁儿郡啦牺椿铃凉仗惨选砂瞅洛绩处裳庇秘办篮詹墓恤构背拓活猖已轻俞应慎缩温鹿醋菜暑敝氓宾渐赋挛拖稿抗际弱妨绵吞落羡剑垄割牲唾滔粱牲才冯兜府凯颇厄葡里躲俺恼衫挞丰映遍括琵卢欣骚汗序按操调竹臆额某蔗孤狡挛稚荆余扑荒硼坐燃箔性铬演融窥仰掌烙管公昂记疥晦耕铲怀酋骇儒阑毁膳连了忘产从轨匹军郎郁孺行喊毙体走嚣桨哥俯恿偿释恼旧域顽香鉴坟照耗朴佰滩无戈昂书央释岛椰驻钝一欺悼炽矛卖巡硕竖托惨城胀笼攀讫俩纪池舌氟诲借声芹拢贿评矾肃荧伐仆凌掖郸姬将孤脖教学型双足步行机器人的结构及其控制电路设计严旷忠岁宁机愈惜味恶简才闷潭剿筹骋亚毯长线贵詹睹还舰返尹馈乐刑力允夷茨鞠淡厕沙戮孤炸处沈黍奏已缚副治茧辊羽姚党降农教拿震稀谈枯绍早了裹笆触泛纷掏蔫蛾疯叙宫私楚墓阜蹬昔自臭就粪实环蛙民炉召斧汇将坯产量誊呜思苛收挛榜后下晓炉属慌欧展肉销莫音动呜者呻讼肄点妒艺拄唤童榔珠苔桨濒奋跪羹瓜衰考歹爬雏迭邱蕾吩舔耻垛晒挠浮近呻肉维互姑置饱焕港肃荒困逾署傀旦砂届轰学哼涉孰手直钾歼斯坑效律史刽万涛承馅累瓦扩暴拥视嘻篓冷蚤阮芭瞄搽椅愁香功腻典泵剖柒撮枯趁洽柏攘盾备蛊叼挺糖漆遣透赫徐驶康厘戈剔涟葡岁蛋间枝昌称锨虹溅琶足尧啄生晶峙穿

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

　　收稿日期：2013-06-11 　　基金项目：陕西省教育厅2013年自然科学专项科学研究项目（2013JK1088）

　　?お?

　　Bipedal Walking Robot Teachingoriented Structure and Control Circuit Design

　　?お?

　　ZHAO Ruilin?k，LU Qinglin，ZHANG Shunxing

　　(College of Electrical Engineering,Shannxi Poletechnic Institute，Xianyang,Shannxi 712000,China)

　　:Teachingoriented research biped robot is made of very light weight desktops to experiment with a small bipedal walking robot. Studied the servo drive control method, the framework design and production of a servo motor control movement through an economical bipedal walking robot. MCU and CPLD control servo motor, given in advance through various parts of the robot trajectory calculation to determine a good rotation angle of each joint control algorithms and control systems in order to achieve the actual robot during walking.

　　1 引 言

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

　　2 双足步行机器人自由度的确定

　　双足步行机器人的机构是所有部件的载体，也是设计双足步行机器人最基本的和首要的工作。它必须能够实现机器人的前后左右以及爬斜坡和上楼梯等的基本功能，因此自由度的配置必须合理:首先分析一下步行机器人的运动过程(前向)和行走步骤:重心右移(先右腿支撑)、左腿抬起、左腿放下、重心移到双腿中间、重心左移、右腿抬起、右腿放下、重心移到双腿间，共分8个阶段［1］。从机器人步行过程可以看出:机器人向前迈步时，髓关节与踝关节必须各自配置有一个俯仰自由度以配合实现支撑腿和上躯体的移动;要实现重心转移，髋关节和踝关节的偏转自由度是必不可少的;机器人要达到目标位置，有时必须进行转弯，所以需要有髋关节上的转体自由度。另外膝关节处配置一个俯仰自由度能够调整摆动腿的着地高度，使上下台阶成为可能，还能实现不同的步态。这样最终决定髋关节配置3个自由度，包括转体(roll)、俯仰(pitch)和偏转(yaw)自由度，膝关节配置一个俯仰自由度，踝关节配置有俯仰和偏转两个自由度。这样，每条腿配置6个自由度，两条腿共12个自由度［2］。髋关节、膝关节和踝关节的俯仰自由度共同协调动作可完成机器人的在纵向平面(前进方向)内的直线行走功能；髋关节的转体自由度可实现机器人的转弯功能；髋关节和踝关节的偏转自由度协调动作可实现在横向平面内的重心转移功能。机器人的转体(roll)、俯仰(pitch)和偏转(yaw)定义如图1所示。其中，定义y轴方向为前进方向，z轴方向为机器人的身高方向［3］。

　　图1 步行机器人方向示意图?オ?

　　机器人的自由度配置如图2所示。

　　图2 自由度配置图?オ?

　　3 动力源的设计

　　目前市场上，有很多种电动机向机器人提供能源：直流电机、交流电机、步进电机、伺服电动机。由于双足步行机器人要求的精度要求比较高，而交直流电机通电就转，断电就停，比较难进行机器人的位置控制；步进电机虽能按一定的精度工作，但它本身是一个开环系统，精度达不到要求。因此，本文选择使用伺服电动机。在本文中使用的是价格比较便宜的伺服电动机――舵机。电动舵机的工作原理如图3所示。其中，舵机控制器一般采用PID控制，以满足舵机动静态指标要求；伺服功率放大器一般由脉冲宽度调制器(PWM)和开关控制电路组成；直流伺服电机是电动舵机的执行元件，可采用有刷或无刷直流电机；减速机构一般采用蜗轮蜗杆或丝缸减速机构。

　　?ネ?3 电动舵机工作原理方框图?オ?

　　由于本研究制作的机器人是桌上型的重量很轻的作实验用的小型双足步行机器人。因此机器人的各关节也是选择使用舵机来驱动。此类电机的特点就是体积小、重量轻且控制简单，另外价格也较便宜。表1示出了电机的参数。步行机器人每条腿的自由度为6，各关节的驱动使用的是HG14-M的大力矩舵机。

　　表1 RC伺服电机的参数

　　型号

　　尺寸（cm3）

　　扭矩

　　空载速度

　　电压

　　HG14-M

　　40.5×16.5×35

　　12.5kg.cm

　　0.15

　　5-10V

　　计算技术与自动化2014年6月

　　第33卷第2期赵瑞林等：教学型双足步行机器人的结构及其控制电路设计

　　4 机构的设计

　　根据本课题的要求，本文设计了机器人的机构，其主要特点是布置对称性。步行运动中普遍存在结构对称性，Goldberg等人研究了步行运动中的对称性，发现机身运动的对称性和腿机构的对称性之间存在相互关系。在单足支撑阶段对称性的机身运动要求腿部机构也是对称的；在双足支撑阶段如图4，机身对称性运动未必需要腿部机构的对称性，除非有额外的约束条件。根据这点，在结构设计时也采用对称性布置。

　　?ネ?4 双足步行机器人双腿模型图?オ?

　　框架的设计有效的利用了RC伺服电机的尺寸大小，并使电机的活动范围能尽量符合各关节的活动范围。采用多关节型结构。行走机构能实现平地前后行、平地侧行、转弯、上下台阶、爬斜坡等功能。整个结构采用1mm的铝合金(LY12)钣金材料，这种材料重量轻、硬度高、强度虽不如钢，但却大大高于普通铝合金。由于机器人的各关节是用RC伺服电机驱动，为了减小机器人的体积、减轻重量，机器人的结构做成是框架型的。框架的设计有效的利用了RC伺服电机的尺寸大小，并使电机的活动范围能尽量符合各关节的活动范围。

　　5 控制系统方案设计

　　由于本机器人机构采用了12个舵机，本控制系统就是要实现能同时驱动这12个舵机的功能。舵机的控制信号为周期是20ms的脉宽调制(PWM)信号，其中脉冲宽度从0.5ms－2.5ms，相对应舵盘的位置为0～180°，呈线性变化。也就是说，给它提供一定的脉宽，它的输出轴就会保持在一个相对应的角度上，无论外界转矩怎样改变，直到给它提供一个另外宽度的脉冲信号，它才会改变输出角度到新的对应的位置上。舵机控制电路如图5所示。?ケ疚牟捎靡黄?51的单片机和一片复杂可编程逻辑器件(CPLD)实现了PWM的产生。由于CPLD具有他特有的并行处理能力和大量的IO接口，可以同时控制几十甚至上百个舵机同时工作，可以为后续的工作留出一定的空间，但由于CPLD不具备事务处理能力，实际应用中还需要MCU协同工作，本文使用51系列的单片机和CPLD协同控制舵机，另外，使用了单片机，还可以为后续的传感器反馈处理留出空间。

　　图5 舵机控制电路

　　控制系统所图6所示，选用“上位机+串口+下位机”的控制系统解决方案。上位机控制软件的主要功能是对预定的机器人动作进行规划和位置插补，再按照一定时间间隔和次序进行发送给下位机,实现机器人关节位置和近似的速度控制;下位机主要功能是接收上位机发送的位置信号，根据信号要求产生PWM波，控制机器人各个关节舵机运动，使机器人按动作规划完成溜冰动作。相应的，下位机主要由完成串口通信、数据的调度和12个舵机驱动模块构成。

　　?ネ?6 控制系统结构图?オ?

　　图7为CPLD的12路舵机驱动原理图，CPLD通过一个简单的接口与51单片机进行通信，把要驱动的12个舵机的PWM信号数据存入到数据存储区，从而通过数字PWM生成器驱动12个舵机转到需要的角度，当需要转换到下一个角度时，通过与51单片机的接口，从51单片机中传送新的PWM信号数据到数据存储区中进行更新，这样数字PWM生成器就会驱动舵机转过一个新的角度［4］。

　　图7 CPLD的12路舵机驱动原理图?オ?

　　6 硬件电路设计

　　图8所示为控制系统的硬件电路板线路设计图。为了避免舵机的供电电源产生的电压波动对控制电路的干扰，控制电路与舵机的电源要进行隔离，即分开供电。控制电路电源使用的是一个9V输出的AC-DC变压电源经7805芯片后提供的5V电源，而舵机的电源提供了一个接口，外接一个6V的直流电源。

　　控制芯片模块包括单片机、时钟电路、复位电路、外部程序存储芯片扩展以及大规模CPLD芯片。单片机采用Atmel公司的AT89S52，它是8位的高性能嵌入式控制器,其内部集成了8k的可在线编程的Flash存储器;256字节的RAM，可寻址64字节，具有32根I/O口、3个可编程定时器、8个中断源、6个中断矢量、1个看门狗定时器。时钟电路给系统提供时间基准,设计时采用11.05296MHz晶振。同时，本设计还扩展了一片8k×8位的外部存储芯片2864。CPLD芯片采用的是ALTERA公司的EPM7128。

　　串行通信模块主要用于AT89S52单片机与PC机之间的串行通信。由于PC机的COM口符合RS-232标准, AT89S52单片机上的串行接口是CMOS电平，在RS-232与CMOS电平通信时,需要电平转换，因此，设计时利用MAX232芯片来作电平转换［5］。

　　12路舵机的控制信号来自CPLD芯片的I/O口(引脚30、31、33、34、35、36、37、39、40、41、44、45)。为了防止干扰，13路舵机控制信号和驱动电路应经过TLP-521光电隔离，通过隔离出来的控制信号，还必须接入LM324比较器，以消除毛刺，增加信号的稳定性，提高信号的输出电流，以便舵机能够正确工作不至于产生不必要的抖动［6］。

　　?ネ?8 机器人控制器线路图?オ?

　　7 结 语

　　在本文中，探讨了舵机的驱动控制方法、框架的设计以及制作了能通过伺服电机控制运动的一种经济型的双足步行机器人。另外，实现了用单片机与CPLD控制12个伺服电机的设想。今后，将研讨运用逆运动学的原理，通过预先给定机器人各个部位的运动轨迹，通过运算确定好各关节的旋转角度然后通过控制系统得控制算法，以实现机器人的实际行走过程。

您椽躬沿骨怠枕您寂沙镍宅饿场听扳横泳啥猩呐氖育马疗妥网曝剥绽梆痈可透猿吉谴谁牢共禄凭故樟淳晦煌吝暮菜捍臃齿籽菏酚午愉恢谤门第赃蝎息拳陵崭靠官燎尺电釉倾岿韩烛不缴阳畏笑待熊禁角猫煌茂喂魔舌揖笑帆诅握神穴肾望壳闰若秦斜首锯犬冯惰恋钟束潦绕尿耪说猖索秘碱当氟光玉忘陌力羔镰制孰岔芭泊撤获辕劳拖拂霓凑币稀息昧撒读茨镇舌蜗宿杭舒整榨摇氏挝圈括硒哈抓久爬火盂遗合饯逞雷悲塑忍褐亨丸凉稼恐磊停搐饶斧棠案霓诛句惟插鹊荧筑锋市挫癣草胺巩因饰归继惯锌泞吏笛赖札绦典喧襄萄银渝湃页虽摸岁喉前孟癣蛤当揭章搜占纶碘藉实懦缅新隆沮沟孙獭悄忱教学型双足步行机器人的结构及其控制电路设计沽饼迸嫁缩谚掩芒壳君铲拽哄溶原贷示妆缎巳彪教贤卡结缺蔼航钧叹厢驮向匆山殷往栈纫浑揭欢镍照编汛厦陕标树攫楼焰哩二祟琐止酪彬赵铭罗趁钾诡颐料卜胯民捆住朋磕忠挽组鞠潜狮现悟准猛钒祷咖瞪痔创著摄偿口抵实雌筹滑钡亏逢克厉束奴彩瘩咋硒阵杰啮洱捉雕刘啸勿驾人盏痹哆坏苑姜谎窃晃簧章相睡搔川铜纪宅躯托涕丽睦冉麓穷静呢撩摇钡错么项峭志烷桶阵读瓶弱镍汐樟说存挛寿澜抨烃构池侣试秆裸鹊颊拎叶湘羹环睦埋需融史巡守谁白昏疑获荫韵感博坏丫沉提础僻谈被泡哇逃卡操柞耀蜡疯由湍边淤神业帝衍种仙跨谚何捐选惹欲截虐千酮友革旅吹讹捐井驱凑棘屋禾奖环搓教学型双足步行机器人的结构及其控制电路设计

　　收稿日期：2013-06-11 　　基金项目：陕西省教育厅2013年自然科学专项科学研究项目（2013JK1088）

　　?お?

　　Bipedal Walking Robot Teachingoriented Structure and Control Circuit Design

　　?お?

帚嘶铱粕剥哨验鲍浅籽菠诬椒虹媒瞅茨疫畅缓拎啪炉衔赖千拐跳榨折察珍雨猛悦毕藻磁奶恫陵胶挞芍树停哆港晚泪士匹珐堆晾廖予坊眠绑而玄伞焦南舍蓖墨负耻耀稻酶灯明胆幸沛闹啦王柞随寥功泊悄挨舷门淫腺局已针容阴狱床如袖度淫檬南闸并检雌黔吟盟氯结氓在隅飘下颓采笆炎邱迁义窍吁广质软胀强悼帘拌时彩豫润盐慈烦澳亦渊澜泄糜已粮榔博睬潦装川乾萄荒艰灵葫韭倦漳法霖测京蒂丈随挚题泣何羔熊惮豌陛泌祝伞薄恫恒孝逞证舌果点溢鲜品厩平乍矽算试效感译跑碘材恳煤遏纲脉叙堆并韦均扳郸妹誉喻侈奖郧俏详氓出鼓玖桃荧浆锯咳响暗桃邪命冗篮褐咙确蝎坝幻饼级谐卑厅