应用PIC单片机控制的智能排险机器人
- 格式:pdf
- 大小:311.92 KB
- 文档页数:4
现代制造工程2010年第8期机器人应用PIC单片机控制的智能排险机器人陈琪,吴立志,王中雨,高鹏(北京石油化工学院工程教育中心,北京102617)
摘要:介绍以PIC单片机为控制核心的智能排险机器人。重点介绍机器人的硬件电路、软件设计以及机械结构。其中硬件控制系统主要包括主芯片的外围电路、信号采集模块以及电动机驱动模块。软件设计主要包括机器人的搜寻算法和灭火处理模式。关键词:PIC单片机;电动机驱动;信号采集;传感器;搜寻算法中图分类号:TP242文献标识码:A文章编号:1671—3133(2010)08—0156—04
TherobotusedtogetridofthedangerbasedonPICcontrolCHENQi,WULI-zhi,WANGZhong-yu,GAOPeng(DepartmentofMechanicalEngineering,BeijingInstituteofPetro-chemicalTechnology,Beijing102617,China)Abstract:Inducesarobotusedtogetridofthedanger.ThecorechipadaptedisPICchip.Especiallyintroducedit'shardwarecircuit,softwaredesignandthemechanicalstructure.Amongthemthecontrolsystemofhardwarehasintroducedtheperipheralcircuitincludingmainchipmainly,themodulethesignalgathersandthemotordrivingmodule.Softwaredesignhasintroducedsearchingalgorithmsandthemodeofputtingoutthefire.Keywords:PICchip;themotordriving;thesignalgathers;sensors,;searchalgorithms
近年来,机器人技术已经取得很大的发展。机器人技术融合了机械、电子、传感器、计算机和人工智能等许多学科的知识,涉及当今许多前沿领域的技术。一些发达国家已经把机器人比赛作为创新教育的战略手段。我国近几年也举办了各式各样的机器人比赛。这在一定程度上促进了机器人技术的发展,同时也提高了广大学生动手能力、创新能力、合作能力和进取精神,普及了机器人知识。在各种智能机器人中,排险机器人越来越受到人们的重视。它们主要被用来代替人去排除一些危险的情况。由于其在现实中有着巨大的使用价值,目前许多研究机构都投入大量的人力和物力进行研究。本文基于PIC单片机设计了一种小型车载智能排险机器人,它能被广大中小学以及大学用来进行实验性教学。根据设计的不同实验环境来编制软件,通过软件来控制机器人完成需要的动作。在实验中用火源来代替危险物,让机器人实现搜寻、靠近和处理等一系列的动作,取得了很好的效果。同时,此种机器人还有很强的可扩展性,能根据自己的需要在此基础上进行二次开发。1机器人的总体构成车载智能排险机器人由控制系统、车身以及机械手组成。主控制电路板是整个机器人的核心,它实现的是采集信号并处理信号,然后根据程序逻辑输出控制电动机。车身是机械手的载体,用两个直流电动机驱动并带有前、后两个导向轮,可以携带机械手到达指定地点,并且保证机器人在运动过程中的平稳性。机械手主要是实现对外界情况的处理,由四个直流电动机分别控制左、右转动,前、后伸缩,上、下升降以及手的开合,可以完成空间多自由度运动。机器人总体结构如图1所示。
2控制系统
车载智能排险机器人的控制系统主要由PIC单片机控制器、电动机驱动模块和传感器接口模块组成,如图2所示。2.1硬件构成
控制电路板包括美国Microchip公司的PIC16F877微控制器、电源模块、复位电路、外部晶振、
651机器人现代制造工程2010年第8期图1机器人总体结构图2机器人控制系统组成数字信号采集模块、模拟信号采集模块,以及电动机驱动模块和扩展端口。2.1.1电源、复位以及外部晶振电路
采用7805芯片为PIC16F877微控制器提供工作电压。电池采用9V电压,经7805芯片的管脚输出为5V,同时设置一个三位开关,既可以实现正常启动、关
闭机器人,又可以为机器人电池充电。外部晶振使用12MHz,为PIC16F877微控制器提供时钟频率。2.1.2信号采集模块
信号采集模块包括数字信号采集模块和模拟信号采集模块。传感器采用碰撞传感器、接近传感器以及红外光敏传感器,其中前两类传感器采集的是数字信号。碰撞传感器当没有东西接触时其信号端为高电平,反之为低电平;接近传感器可以检测5~15cm区间内有没有障碍物,如果有则信号端为低电平,反之为高电平;红外光敏传感器的信号端输出的是模拟信号。根据外界红外光强的不同变换输出0~5V的电压值。其中,PIC16F877微控制器有RE0~RE2、RA0
~RA3以及RA5等八个接口,具有模拟/数字(A/D)转
换功能,通过程序将其中某些接口设定为模拟量输入口。2.1.3直流电动机驱动模块
直流电动机的驱动部分采用双H桥高电压大功
率集成电路L298N,用来驱动继电器线圈、直流电动机和步进电动机等感性负载。L298N可用来驱动双电动机,驱动能力强,而且与单片机直接连接,用高/低电平来控制电动机的正转、反转及停止,非常方便。控制板共使用三个电动机驱动电路,分别驱动两个小车电动机和四个机械手电动机。同时,外扩了一个三极管驱动电路,控制风扇按一个方向转动,实现灭火。2.2软件设计
整个控制程序工作流程如图3所示。
图3控制程序工作流程2.2.1搜寻算法
机器人在没有发现火源时会自主搜寻火源,而且在搜寻火源的过程中要实现避障功能。按照搜寻规则,给定接近传感器的端口分配。由于采用两个接近传感器,且沿前方对称布置,并分别与正前方向外成15°夹角(可以根据具体情况改变)。当传感器检测到
有障碍物时,则传感器信号值为低电平,因此,可以通过位判断语句来确定有无障碍,根据信号可判断出外界的四种情况,利用控制程序使机器人进行相应的处理:1)左边有、右边无时右转一角度。2)右边有、左边无时左转一角度。3)左边有、右边有时后退,并左转一角度。4)左边无、右边无时前进搜寻。由于机器人是向前行走的,因此无须对后面进行检测。通过以上控制算法,机器人可以实现在自主搜寻过程中的无障碍行驶。
751现代制造工程2010年第8期机器人2.2.2趋近算法
机器人在搜寻火源的过程中,通过判别红外光敏传感器的数值来确定是否有火。本设计采用三个红外光敏传感器,一个安置在机器人正前方,另外两个在机器人两边对称布置,并向外与正前方成30°角。传感器返回电压值经模/数转化后转化为14位数字量,由于传感器的精度问题一般通过软件设置只取其中的高八位。对于火的判断设置了三个变量值。第一个是“环境平均光强”,其主要作用是屏蔽掉环境因素的影响,由于外界阳光或其他红外光源的存在,使机器人所在环境存在某一光强水平,只有当检测的光强水平值高于平均水平时才认为是火源。第二个是“近距离靠近变量”,机器人在靠近危险区域时才停止行走,机器人的停止是靠检测危险区域的白色信号来控制的,因此,在较远距离时不检测白色信号,只有在充分靠近时才进行检测,这样可防止机器人在较远位置时的“误判断”。由于对称布置传感器,以上两个变量值要
与中间传感器的转化值进行比较。第三个是“偏转变量”,机器人在趋近火源时,要保证其尽量对准火源,当光强差处在一个范围即偏转变量之内时前行,否则就要进行纠偏,通过左、右光强差来实现纠偏控制功能。2.2.3机械手控制
当机器人到达危险区域并停止前进时,机械手开始抓取危险物,如蜡烛等。机械手由伺服电动机控制,通过碰撞传感器来检测其转过的角度,进而确定机械手的空间位移。因此,可以通过软件精确控制机械手,并能记录下机械手的空间位置和每次走过的位移。在机械手抓取危险物的过程中,采取精确对准,即在前伸抓取时让机械手去不断调整自己的空间位置,始终保证危险物处在机械手的正前方。精确对准采用与前面“纠偏”一样的方法,只是将“偏转变量”调整得更小一些,实现动态抓取,即使火源不是固定的,而是在空间有些位移,机械手仍然可以成功地抓取。为了实现机械手的快速动作,在程序上采用电动机联动。机械手的控制设置为“正常抓取”和“抓取演示”两种工作模式,可以根据需要进行切换。机械手能实现自动复位和人工复位两种复位方式。机器人手臂前伸抓取子程序如下:;************QIANSHENDAOQIANFANGQIAN_SHEN_ZUACLRF10HM_23CLRF12HLO_2BSFPORTD,4
BCFPORTD,5CALLZAI_DUIM_21BTFSSPORTB,2GOTOM_22GOTOM_23M_22CALLDELAYBTFSC12H,1GOTOLO_2BSF12H,1INCF10HMOVLWD'60'SUBWF10H,0BTFSSSTATUS,CGOTOLO_2CALLX_XGOTOCH_ZY_1BSFXX,7CH_ZSUBWF39H,0BTFSCSTATUS,CRETURNBTFSSXX,7GOTOX_YGOTOX_ZX_ZBSFPORTD,6MOVF10H,0MOVWF14HGOTOZUA_QRETURN;****************ZAICIDUIZHUNZAI_DUIBCFXX,7CALLMO_SHUMOVLWDIFF_1MOVWF39HMOVF30H,0;30H-RE0ZUOBIANSUBWF31H,0;31H-RE1YOUBIANBTFSCSTATUS,C;YOUQIANGTIAOZHUANGOTOY_1MOVF31H,0SUBWF30H,0BSFXX1,7BCFPORTD,7RETURNX_YBSFPORTD,7BCFPORTD,6RETURN(下转第162页)
851