六足爬行机器人总体设计方案
基于STM32的六足机器人系统设计

科教论坛 ScienceandEducationForum234教育前沿 Cutting Edge Education基于STM32的六足机器人系统设计文/刘飞摘要:六足机器人在复杂环境中行走时,由于未知地形容易对机器人的控制系统引入不可预知的扰动,影响机器人的运行平稳性,为了减少机器人因运动的不稳定性对机器人机身结构造成的冲击。
需要采用合适的控制方式控制机器人各关节位姿适应复杂地形。
保证机器人系统具有良好的动态稳定性。
本文以处于复杂多变环境中的六足机器人为研究对象,设计了机器人机身结构,开发了其控制系统,并以其关节运动平稳性、响应快速性和位姿准确性的提高为目的,重点对机器人关节模糊PID控制算法进行了研究。
主要研究内容为:首先,对六足机器人的机身结构进行了优化设计,并对机器人样机进行了运动学分析,得出了机器人足部的运动范围以及关节变量与机器人足部位姿的关系。
其次,在机器人运动学分析的基础上,规划了机器人纵向和横向直行的三角步态,给出了当机器人采用三角步态直行时,能保持机器人静态稳定的步长计算方法,结合机器人行走步长分析了机器人纵向和横向直行步态的稳定性。
当机器人采用三角步态直行时,若其步长小于能保持步态静态稳定的临界步长,机器人的步态是静态稳定的,否则不是静态稳定的。
关键词:六足机器人;系统设计1 六足机器人结构六足机器人的控制分为两大部分。
即硬件控制部分和软件部分。
其中硬控控制部分又分为三个部分。
电源、主控、通信。
软件部分分为原理和射程序设计。
1.1 结构简介本文所研究的六足机器人,在机器人机构学上属于多支链拓扑运动机构。
机器人具有18个驱动关节,具有冗余驱动大于机构自由度6。
为了确定六足机器人关节变量和其足部末端点的位姿的关系,建立对应的运动学模型,得出它们关系的数学模型。
本文所研究六足机器人在运动过程中一种串并联机构交替的复合型机构型,要想精确的对机器人进行运动控制,需要对六足机器人足部末端的位姿以及其运动空间进行正反运动学分析。
六足机器人设计参考解析

摘要六足机器人有强大的运动能力,采用类似生物的爬行机构进行运动,自动化程度高,可以提供给运动学、仿生学原理研究提供有力的工具。
本设计中六足机器人系统基于仿生学原理,采用六足昆虫的机械结构,通过控制18个舵机,采用三角步态和定点转弯等步态,实现六足机器人的姿态控制。
系统使用RF24L01射频模块进行遥控。
为提高响应速度和动作连贯性,六足机器人的驱动芯片采用ARM Cortex M4芯片,基于μC/OS-II操作系统,遥控器部分采用ARM9处理器S3C2440,基于Linux系统。
通过建立六足机器人的运动模型,运用正运动学和逆运动学对机器人进行分析,验证机器人步态的可靠性。
关键字:六足机器人,Linux,ARM,NRF24L01,运动学AbstractBionic hexapod walking robot has a strong ability of movement, the use of similar creatures crawling mechanism movement, high degree of automation, can be provided to the kinematics, the principle of bionics research provides powerful tool. Six feet in the design of this robot system based on bionics principle, the mechanical structure of the six-legged insect, through 18 steering gear control, use the gait, such as triangle gait and turning point to control the position ofsix-legged robot. Remote control system use RF24L01 rf modules. In order to improve the response speed and motion consistency, six-legged robot driver chip USES the ARM architecture (M4 chip, based on mu C/OS - II operation system, remote control part adopts ARM9 processorS3C2440, based on Linux system. By establishing a six-legged robot motion model, using forward kinematics and inverse kinematics analysis of robot, verify the reliability of the robot gait.KEYWORD:Bionic hexapod walking robot;Linux,ARM,NRF24L01;Kinematics目录1. 绪论2. 六足机器人的硬件搭建3. 操作系统的搭建4. 六足机器人的步态分析与实现5. 总结与展望1. 绪论1.1 多足机器人的发展状况目前,用于在人类不宜、不便或不能进入的地域进行独立探测的机器人主要分两种,一种是由轮子驱动的轮行机器人,另一种是基于仿生学的步行机器人。
六足机器人系统设计

郭从良等:六足机器人系统设计l特罐P图表3抗干扰交流信号传感器电路发光管通的是脉冲电流,发出交流脉冲光,而接收部分只对持续一段时间且超过一定频率的脉冲光敏感.接收部分是这样工作的:传感器信号先经过cR高通网络去掉直流和低频成分,并加入一个直流offset,也就是一个稳定的直流分量叠加一个交流分量,再与一个设定的直流分量进行比较,如果交流分量的峰值超过offset与设定值之差,比较器就会输出一个方波脉冲,否则输出0:然后通过Rc低通网络,使方波脉冲的交流分量尽可能的减小,变成某个直流电压V(>0),再与另一个设定值(<v)比较,输出低电平.如果没有交流输入,第一级比较器输出0,第二级比较器输出高电平,如下表所示:低通滤波器的通带太宽,输出会有较多的振荡(如右图);通带太窄响应太慢,于是选取R=IOOK,C=O.1uF.在程序中,接收到信号后要延迟一段时间再确认一次,以消除抖动.控制程序是机器人的灵魂,六足机器人由AT89C51单片机控制,程序用汇编语言编写,采用模块化设计思想,分为直流电机和步进电机两大部分.首先分析机器人的动作特点,将整体的动作分解为基本动作元素,再通过编写通用的子程序实现各种基本动作,将这些基本元素作为动作库零件.在编写整个动作时。
按照要求调用不同的元素即可,如果动作有了变化,程序修改也相当容易.这种编程思想为我们在短时间里编写程序和编排动作以及程序的调试修改带来了很大的方便.我们提出一种寄存器循环移位奇偶位分别作两个步进电机的驱动端的做法,简化了代码长度,但缺点是两个步进电机只能以相同的速度动作.事实上每个电机的动作是不同的,为此我们在R枷中为每个电机开辟一个byte的状态字节用以循环移位.在每个电机周期里,根据需要对每个电机的byte进行移位,并用ANL指令将两个电机的状态合成到一个字节里输出,使得可以同时控制两个电机.步进电机的速度由驱动脉冲的频率决定,移位的周期不同,电机的速度也就不同了.同时使用了基于定时器中断的双进程和使用RAM/寄存器的进程间通信.而单进程程序里步进电机和直流电机是不可能同时运动的,为此我们采用中断来实现步进电机和直流电机I一17。
六足机器人运动控制系统设计与实现

硕士学位论文六足机器人运动控制系统设计与实现DESIGN AND IMPLEMENTATION OF MOTION CONTROL SYSTEM OFHEXAPOD ROBOT刘德高哈尔滨工业大学2013年7月国内图书分类号:TP302.8 学校代码:10213 国际图书分类号:681.5 密级:公开工学硕士学位论文六足机器人运动控制系统设计与实现硕士研究生:刘德高导师:吴翔虎教授申请学位:工学硕士学科:计算机科学与技术所在单位:计算机科学与技术学院答辩日期:2013年7月授予学位单位:哈尔滨工业大学Classified Index: TP302.8U.D.C: 681.5Dissertation for the Master Degree in EngineeringDESIGN AND IMPLEMENTATION OFMOTION CONTROL SYSTEM OFHEXAPOD ROBOTCandidate:Liu DegaoSupervisor:Prof.Wu XianghuAcademic Degree Applied for:Master of Engineering Speciality:Computer Science and Technology Affiliation:School of Computer Science andTechnologyDate of Defence:July, 2013Degree-Conferring-Institution:Harbin Institute of Technology哈尔滨工业大学工学硕士学位论文摘要针对国内用于大负载物资运输的六足机器人运动控制系统缺乏的问题,设计并实现了一款具有很高实时性和可靠性的六足机器人运动控制系统。
系统采用主从应答模式对三维力系统和单足控制系统进行控制,包含模式控制机制、步态规划控制机制和安全控制机制,采用高速率、高可靠性的CAN总线通信,使系统能完成六足机器人正常步态行走的控制任务和各步态间自由切换的控制任务,而且具有很强的安全性、可靠性和实时性。
新型六足爬行机器人设计

第24卷第6期2007年6月机 电 工 程M ECHAN I CA L &ELECTR IC A L ENG I NEER I NG M AGAZ I N EV o.l 24N o .6Jun .2007收稿日期:2007-01-08作者简介:金 波(1971-),男,江苏常州人,副教授,博士,主要从事电液控制系统和机电一体化系统的研究。
新型六足爬行机器人设计金 波1,胡 厦1,俞亚新2(1.浙江大学流体传动与控制国家重点实验室,浙江杭州310027;2.浙江理工大学机械与自动控制学院,浙江杭州310018)摘 要:采用了仿哺乳类的腿部结构,并针对这种腿部结构设计了六足的行走方式,通过对12个步进电机的控制,采用三角步态,实现了六足机器人的直行功能。
仿真及试验证明,这种结构能较好地维持六足机器人自身的平衡,并且对今后更深入地研究六足机器人抬腿行走姿态及可行性,具有较高的参考价值。
关键词:六足机器人;步行;腿机构;电机控制中图分类号:TP242 文献标识码:A 文章编号:1001-4551(2007)06-0023-04D esign of novel hexapod w al k ing robotJI N Bo 1,HU Sha 1,YU Ya -x in2(1.T he State K ey Labora t ory of F l u i d Pow er T rans m iss i on and C ontrol ,Zhej i ang Un i vers it y,H angzhou 310027,China ;2.Co llege of M echanical E ngineer i ng and A u t oma tion,Zhejiang Sci -T ech Uni ver sity,H angzhou 310018,China )Abstrac t :A b i on i c l eg struc t ure w hich is si m il ar to t he legs of m a mm a l s w as used ,and a hexapod w alki ng mode w as desi gned accord i ng to t h is struc t ure .By contro lli ng 12step m oto rs straigh tw a l k i ng functi on o f the hexapod robot has been i m ple m ented w i th tripod ga it m ove m ent .Si m ulation and experi m ent sho w that th i s structure can keep the hex apod robot body p s balance bette r ,providi ng hi gh reference va l ue to research t he advantage and feasi b ilit y o f leg -raisi ng w a l ki ng gesture .K ey word s :hexapod robo t ;w alki ng ;leg structure ;driver ;mo tor contro l0 前 言多足步行机器人能够在不平的路面上稳定地行走,可以取代轮式车完成复杂环境中的运输、探测作业,因此在军事运输及探测、矿山开采、海底工作、核工业、星球探测、农业及森林采伐等许多行业有着非常广阔的应用前景。
六足机器人毕业设计论文

目录插表清单 (III)插图清单 .................................................................................................................................................................... I V 第一章绪论 . (1)1.1机器人的发展历史 (1)1.2机器人的定义和基本组成 (2)1.2.1机器人的定义 (2)1.2.2机器人的基本组成: (2)1.3移动机器人概述 (3)1.4移动机器人分类 (3)1.5多足机器人的发展现状 (5)1.6本设计的主要工作 (7)1.7本章小结 (7)第二章六足仿生机器人的结构分析及设计 (8)2.1“六足纲”昆虫的运动原理 (8)2.1.1步态的参数描述 (8)2.1.2三角步态运动原理 (9)2.2六足仿生机器人机械结构分析 (9)2.3本章小结 (10)第三章六足仿生机器人的步态分析和设计 (11)3.1六足步行机器人坐标定义 (11)3.2六足机器人的稳定性分析 (13)3.3.1 稳定性分析 (13)3.3.2稳定裕量计算 (13)3.4六足仿生机器人的直线运动步态设计 (15)3.4.1步态规划 (15)3.4.2步态动作分析 (15)3.5“三角步态”定点转弯步态设计 (18)3.6本章小结 (20)第四章六足仿生机器人的控制系统设计 (21)4.1功能分解 (21)4.2控制系统的硬件设计 (22)4.2.1微处理器AT89S52简介 (22)4.2.2 舵机模块设计 (23)4.2.3 避障模块设计 (24)4.3控制系统软件设计 (26)4.3.1单个舵机控制方法 (27)4.3.2多舵机控制 (31)4.3.3六足仿生机器人全方位步态程序设计 (36)4.4软件的抗干扰及可靠性设计 (39)4.5本章小结 (40)第五章软硬件联调 (41)5.1K EIL C51开发系统基本知识 (41)5.2P ROTEUS 仿真软件基本知识 (41)5.2.1 Proteus介绍 (41)5.2.2 Proteus的仿真 (42)5.2.3 Proteus PCB (42)5.3调试结果 (42)5.2相关数值测试 (43)5.3本章小结 (44)第六章结束语 (45)6.1论文总结 (45)6.2论文写作的感想 (45)6.3本章小结 (45)参考文献 (46)致谢辞 (47)表 1-1机器人Fred Delcomyn的参数 (6)表 2-1 本设计机器人相关参数 (9)表 4-1 I/O引脚分配表 (23)表4-2 时基脉冲与舵机角度对应表 (24)表 4-2 探测障碍物的传感器与单片机引脚对应关系表 (25)表 4-3舵机与六足机器人足对应关系表 (36)表 4-4 舵机与单片机端口的对应关系表 (36)表 5-1 关系数值表 (44)图 1-1Fred Delcomyn六足仿生机器人 (6)图 1-2Gengh机器人 (6)图 1-3 DRROB系列高级机器人 (7)图 2-1 本设计的六足仿生机器人 (10)图 2-2机器人腿部实物 (10)图 3-1腿部组图简图 (11)图 3-2 机器人腿部坐标示意图 (12)图 3-3 腿部简图 (12)图 3-4步行机器人任一时刻姿态图 (13)图 3-5三角步态稳定图 (14)图 3-6 六足步态示意图 (15)图 3-7(A、B、C、D)定点转弯步态示意图 (16)图 4-1 基本功能框图 (21)图 4-2 PDIP封装图 (23)图 4-3微动开关示意图 (25)图 4-4 微动开关安装位置图 (25)图 4-5 硬件设计仿真图 (26)图 4-6 系统软件的总体流程 (27)图 4-7 舵盘的位置线性变化图 (28)图 4-8 舵机的控制脉冲图 (28)图 4-9 控制脉冲程序流程图 (29)图 4-10 8路信号舵机控制脉冲图 (31)图 4-11 12个舵机控制流程图 (33)图 4-12 舵机位置示意图 (36)图 4-13 直行程序流程图 (37)图 4-14 转弯程序流程图 (38)图 4-15 避障程序流程图 (39)图 5-1 硬件仿真结果图 (44)第一章绪论机器人的应用越来越广泛,几乎渗透到人们生活的各个领域。
(机械制造行业)六脚爬虫机器人机械结构设计和控制系统搭建

(机械制造行业)六脚爬虫机器人机械结构设计和控制系统搭建摘要本文详细介绍了六脚爬虫机器人的机械结构以及控制程序的编写。
机械结构采用了对称式设计,结构简单;其行走功能由六只脚、18个舵机实现,自由度较高,稳定性、灵活性较好。
控制程序的主体是C语言。
包括基本步态的编写,以及传感器的在机器人上的高级应用,这样,机器人在满足基本行走运动的同时,也能感知外界环境,并通过控制器对接收到的外界信号进行处理,并控制机器人运动。
关键词:对称式结构,舵机控制器,步态,传感器Abstract ThethesisdescribesindetailthatthemechanicdesignofHexcrawlerandthepil ingofcontrolprogram. Thestructureoftherobotisinsymmetricexpression,asimplemechanism;thef unctionofwalkingissupportedbysixlegs,andeighteenmotors,withmultiple degreesoffreedom.Besides,itisofhighstabilityandflexibility. TheprogramtocontroltherobotiswritteninClanguage,includingbasicgait,t headvancedapplicationofsensors.Thereby,therobotcanwalkinseveralgaits .Atthesametime,itcansensetheconditionaroundit.Then,itwillprocesstheda taitreceived,andcontrolthemotionoftherobot.Keywords:symmetricexpression,PSCU,gait,sensor目录摘要IAbstractII目录III1绪论-1-1.1课题来源-1-1.2本课题的目的及其意义-1-1.3国内外发展现状-1-1.4本课题的研究内容-5-2机械结构设计介绍-6-2.1功能需求与分析-6-2.2材料选择与结构设计介绍-6-3舵机控制板原理与应用-9-3.1舵机原理介绍-9-3.2舵机控制板原理介绍-10-3.3如何使用舵机控制板-12-3.4控制板程序编写-14-4STM32开发板介绍与程序编写-18-4.1STM32F107芯片简介-18-4.2软件与编程初始准备-18-4.3GPIO与AFIO设置与应用-18-4.31GPIO设置与应用 (18)4.32AFIO-----I/O口重映射 (22)4.4USART设置与应用-22-4.5外部中断设置与应用-26-4.6系统时钟设置与应用-29-4.61系统时钟简介与应用 (29)4.62定时器配置 (31)4.7机器人行走步态程序编写-32-4.71机器人行走步态简介 (33)4.72三脚步态 (35)4.73四脚步态 (37)4.74单脚(波动)步态 (38)4.75转弯与横爬步态 (40)4.8多传感器应用与程序编写-43-4.81指南针传感器 (43)4.82红外、光敏传感器 (45)4.83柔性力传感器 (46)4.84温湿度、发声、射频识别(RFID)传感器 (48)4.85无线(Zigbee)传感器 (49)4.86超声传感器 (52)5总结-55-致谢-56-参考文献-57-1绪论1.1课题来源本项目来源于华中科技大学与伍斯特理工学院合作的WPI项目。
红外遥控六足机器人设计

六足机器人设计前言 2(一)、机器人的大脑 2(二)、机器人的眼睛耳朵 2(三)、机器人的腿——驱动器与驱动轮 3(四)、机器人的手臂——机械传动专制 4(五)、机器人的心脏——电池 4一、AT89S51单片机简介 5(一)、AT89S51主要功能列举如下: 5(二)、AT89S51各引脚功能介绍: 5二、控制系统电路图 7三、微型伺服马达原理与控制 8(一)、微型伺服马达内部结构 8(二)、微行伺服马达的工作原理 8(三)、伺服马达的控制 9(四)、选用的伺服马达 9四、红外遥控 11(一)、红外遥控系统 11(二)、遥控发射器及其编码 11(三)、红外接收模块 11(四)、红外解码程序设计 11五、控制程序 12六、六足爬虫机器人结构设计图 18前言(一)、机器人的大脑它可以有很多叫法,可以叫做:可编程控制器、微控制器,微处理器,处理器或者计算器等,不过这都不要紧,通常微处理器是指一块芯片,而其它的是一整套控制器,包括微处理器和一些别的元件。
任何一个机器人大脑就必须要有这块芯片,不然就称不上机器人了。
在选择微控制器的时候,主要要考虑:处理器的速度,要实现的功能,ROM 和RAM的大小,I/O端口类型和数量,编程语言以及功耗等。
其主要类型有:单片机、PLC、工控机、PC机等。
单有这些硬件是不够的,机器人的大脑还无法运行。
只有在程序的控制下,它才能按我们的要求去工作。
可以说程序就是机器人的灵魂了。
而程序是由编程语言所编写的。
编程语言是一个控制器能够接受的语言类型,一般有C语言,汇编语言或者basic语言等,这些通常能被高级一点的控制器直接执行,因为在高级控制器里面内置了编译器能够直接把一些高级语言翻译成机器码。
微处理器将执行这些机器码,并对机器人进行控制。
(二)、机器人的眼睛耳朵传感器,是机器人的感觉器官,是机器人和现实世界之间的纽带,使机器人能感知周围的环境情况。
其主要有:光电传感器、红外传感器、力传感器、超声波传感器、位置和姿态传感器等等。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
本文的设计为六足爬虫机器人,机器人以交流-直流开关电源作为动力源,单片
机为控制元件,伺服电机为执行部件,机器人采用三足着地进行运动,通过单片
机对伺服电机的控制,机器人能够实现前进、后退等运动方式,三足着地运动方
式保证了机器人能够平稳运行。伺服电机具有力量大,扭矩大,体积小,重量轻
等特点。单片机产生20ms 的PWM 波形,通过软件改写脉冲的占空比,从而达到
改变伺服电机角度的目的。
1 机器人运动分析
1.1 六足爬虫式机器人运动方案比较
方案一:六足爬虫式机器人的每条腿都能单独完成抬腿、前进、后退运动。
此方案的特点:
每条腿都能自由活动,每条腿都能单独进行二自由度的运动。每条腿的灵活
性好,更容易进行仿生运动,六足爬虫机器人可以完成除要求外的很多动作,运
动的视觉效果更好。由于每条腿能单独完成二自由度的运动,所以每条腿上要安
装两个舵机,舵机使用数量大,舵机的安装难度加大,机械结构部分的制作相对
复杂,又由于每个舵机都要有单独的信号控制,电路控制部分变得复杂了,控制
程序也相应的变得复杂。
方案二:六足爬虫式机器人采取三腿为一组的运动模式,且同一侧的前腿、
后腿的前后转动由同一侧的中腿进行驱动。采用三腿为一组(一侧的前足、后足
与另一侧的中足为一组)的运动方式,各条腿能够协调的进行运动,机器人的运
动相对平稳。
此方案特点:相比上述方案,个腿能够协调运动,在满足运动要求的情况下,
舵机使用数量少,节约成本。机器人运动平稳,控制、驱动部分都得到相应的简
化,控制简单。选择此方案,机器人还可进行横向运动。
两方案相比,选择方案二更合适。
1.2 六足爬虫式机器人运动状态分析
1.2.1 机器人运动步态分析
六足爬虫式机器人的行走是以三条腿为一组进行的,即一侧的前、后足与另
一侧的中足为一组。这样就形成了一个三角形支架结构,当这三条腿放在地面并
向后蹬时,另外三条腿即抬起向前准备轮换。这种行走方式使六足爬虫式机器人
运动相当稳定,任何时刻有三足着地,能够保持良好的平衡,并可以随时随地停
息下来,因为其重心总是落在三角支架之内。
三角步态行走运动原理:
步行时把六条足分为两组,以身体一侧的前足、后足与另一侧的中足作为一
组,形成一个稳定的三角架支撑虫体,因此在同一时间内只有一组的三条足起行
走作用:前足用爪固定物体后拉动虫体前进,中足用以支撑并举起所属一侧的身
体,后足则推动虫体前进,同时使虫体转向,行走时虫体向前并稍向外转,三条
足同时行动,然后再与另一组的三条足交替进行,两组足如此交替地摆动和支撑,
从而实现昆虫的快速运动,其行走的轨迹线是一条锯齿状曲线。
图2-1 运动示意图
机器人开始运动时,左侧的 2 号腿和右侧的4、6 号腿抬起准备向前摆动,
另外 3 条腿1、3、5 处于支撑状态,支撑机器人本体确保机器人的原有重心位
置处于 3 条支撑腿所构成的三角形内,使机器人处于稳定状态不至于摔倒(见
图 2-1(a),摆动腿 2、4、6 向前跨步(见图 2-1(b),支撑腿 1、3、5 一面
支撑机器人本体,一面在驱动装置作用下驱动机器人本体,使机器人机体向前运
动了半个步长!(见图 2-1(c))。
在机器人机体移动到位时,摆动腿 2、4、6 立即放下,呈支撑态,使机器
人的重心位置处于 2、4、6 三条支撑腿所构成的三角形稳定区内,原来的支撑
腿 1、3、5 已抬起并准备向前跨步(见图 2-1(d)),摆动腿 1、3、5 向前跨步
(见图 2-1(e)),支撑腿 2、4、6 此时一面支撑机器人本体,一面驱动机器人
本体,使机器人机体又向前运动了半个步长(见图 2-1(f)),如此不断从步态
(a)、(b)、(c)、(d)、(e)、(f)、(a),循环往复,周而复始实现机器人不断向
前运动。这样的六组爬虫机器人每向前跨一步即行走一个步长的距离,也就是三
角步态的的行走原理。
占空系数β又称有荷因数,占空系数(或负载因数)是信号在一个周期内触发
电平以下或以上的时间百分比。步态设计是实现步行的关键之一,为达到较为理
想的步行,本文所研究的六足机器人的步态是β=0.5时的状态;在其中的三条摆
动腿着地的同时,另外三支支撑腿立即抬起,即任意时刻同时只有支撑相或摆动
相。这样能够使机器人的行进过程比较连续,而且比较稳定。
在机器人遇到障碍物时,通过传感器和电路控制装置,可以控制电动机的旋
转方向,使得两侧的电机的旋转方向相反,从而使机器人转向。
图2-2 机器人转弯时的步态图
具体的控制过程如下(向右偏转):
1)使控制足1、足2和足3的电机反转,如图2-2(a)所示(图2-2中实线代表着地,
虚线代表悬空);
2)这时足1、足3、足4和足6准备悬空,只有足2、足5是准备抓紧地面的,
3)在这一瞬间只有两个足着地,机器人处于不稳定状态,直到有四只足着地,
使机器人重新回到稳定状态,由于该不稳定状态的时间非常短暂,并不影响
机器人行走稳定的性能。
向左偏转的情况机理也是一样的,只要使控制足4、足5、足6一侧的电机反转
就可以了。
1.3 机器人平衡性分析
由于机器人在运动过程中总有三足着地,其支撑作用的三足构成了一个三角
形支架机构,保证了机器人的重心总是落在三角形支架内。在机器人运动过程中
的重心位置如下图所示:
图2-3 运动过程重心位置示意图
机器人采用三足支撑,在机器人的运行过程中,任何时刻总有三足着地,构
成一个三角形支架,并通过对机器人整体尺寸、足部摆角的设定,可使得机器人
的重心总是落在三角形支架内,保证了机器人的平衡,三足三足交替支撑,保证
了重心在水平面内的平稳运动。
1.4 微型六足仿生机器人的足端运动轨迹曲线的确定
在进行步行机构的运动仿真设计时,如果将腿直接连在轴上则足端轨迹为圆
形。这样机器人的运动将会呈半圆状起伏,如果能够使得足端轨迹在触地的部分
保持平整就可以保持机器人的平稳前进。况且步行机器人要求有很强的环境适应
能力,它必须能够在平面、台阶上稳定地行走,又能够跨越障碍,横沟,不同的
路面对轨迹曲线有不同的要求:对于平地路面要求有一定的速度,对于台阶要求
能够抬起并越过,对障碍物要求顺利跨越,可见足端运动轨迹的选择对于步行机
器人来说显得非常重要。选择足端运动轨迹曲线时应主要考虑以下问题 :
(a)曲线的高宽比:曲线的高宽比直接反应出曲线的运动特性。该比值越
大则足端运动轨迹曲线越高,相应的跨越台阶的能力就越强同时前进特性(运动
速度)就越差。
(b)曲线弧长:在曲线宽度一定的情况下,曲线长度越长,在空中运动的
时间就越长,这将直接影响到摆动腿的速度,进而影响到步行机的运行速度。曲
线弧长越短,运动时间就越短,但相应的跨越能力就越差。
根据步行机的行走要求,初步确定足端运动曲线的高宽比和曲线弧长,采用
半径是6mm弧长的足端。
1.5 腿部力学分析
对六足爬虫机器人的腿部受力进行分析,通过大致计算可估算出机器人足部
运动时所需要的扭矩大小,从而可以确定所需要的舵机的扭矩参数。支撑足上的
舵机2 承受的力通过舵机转轴轴心,支撑足上舵机在承载力时所受扭矩为零,对
于支撑足上的舵机要求,只需抬起支撑足即可,可见一般舵机都能满足工作要求。
由于机器人由支撑足支撑而与地面无滑动摩擦,对舵机1 的要求,只需克服机械
结构间的摩擦即可。
1.6 机器人运动速度计算
下图所示:
图2-4 足部运动范围示意图
机器人足部运动示意图,机器人足部运动由舵机驱动,舵机的转动角度为Ф
=2×18º,在舵机的一个运动周期内,机器人运动的直线距离为4M,舵机运动一个
周期的用时为0.8s。M=L×sin18º=36mm×sin18 º=11.12mm。机器人在0.8s 内的
运行距离为:4M=4×11.12mm=44.48mm
机器人的运行速度为:V=4M/0.8s=44.48mm/0.8s=55.6mm/s。
2 机器人机械结构设计
2.1 机械结构分析与设计
机器人各部分结构,可以较清楚的判别构件所处的位置,机器人由若干部件
组合而成,各部件都是通过螺钉、螺母、螺栓而固定在一起的。机器人各侧三足
的运动原理是相同的,故只需分析一侧的三足即可。以上已对机器人的运动状态
进行了分析,机器人的机械结构、传动机构已经确定。此时,由于机器人部分尺
寸无法确定,所以无法进行机器人的制作。为了方便的确定个机械部分的尺寸,
并避免因试制而造成的成本、工作量的增加。首先通过Pro/E 软件的三维实体功
能,进行机器人的实体设计,通过三维实体的制作可以直观、准确的控制个机械
部分的尺寸,可以使机器人的结构性更加合理。