除锈爬壁机器人控制系统的方案设计书.doc
《除锈爬壁机器人控制系统的方案设计书.doc》由会员分享,可在线阅读,更多相关《除锈爬壁机器人控制系统的方案设计书.doc(17页珍藏版)》请在咨信网上搜索。
1、除锈爬壁机器人控制系统的设计1 前言控制系统是船舶壁面除锈爬壁机器人的重要组成部分,其负责完成对除锈爬壁机器人的行走和转向功能的控制,使机器人能够按照预定的轨迹去工作,因此对除锈爬壁机器人控制系统提出如下基本要求:矚慫润厲钐瘗睞枥庑赖。(1)控制系统方便、可靠性高、操作灵活,便于操作人员使用;(2)通过功能按键可以设定机器人的多极移动速度,并可实时调整运动方向和运动速度,实现机器人在船体表面上的全方位移动;聞創沟燴鐺險爱氇谴净。(3)由于船舶除锈现场环境恶劣,除锈爬壁机器人的工作环境制约了其控制方式,本系统采用简单实用、可靠性高的有线遥控,其控制距离需大于30米。(4)控制系统能实现除锈爬壁机
2、器人的简单作业,保证机器人在爬行过程中的除锈质量。2 除锈爬壁机器人控制系统的总体方案除锈爬壁机器人在船体表面上的行走和转向是通过左右两个交流伺服电机的驱动来实现的。当左右两个伺服电机的转速与转向相同时,爬壁除锈机器人在船体表面上实现直线行走。电机正转时,机器人前进;电机反转时,机器人后退。当左右两个伺服电机的转向相反时,除锈爬壁机器人在船体表面上实现转向。残骛楼諍锩瀨濟溆塹籟。综合考虑各种控制形式的优缺点,结合船舶除锈的实际情况,爬壁机器人的控制系统采用上下位机二级分布式控制方式,以保证即使在无操作人员参与的情况下,下位机酽锕极額閉镇桧猪訣锥。也可以按照上位机通过串口预先给定的指令和参数实现
3、自主作业,从而使船舶壁面除锈爬壁机器人具有高效除锈、自动化水平高和减少操作人员操作强度的性能;操作人员也以通过观测船体表面的实际锈蚀状况,根据除锈爬壁机器人的实际作业情况,随时切换到人工操作状态,以提高机器人的实时性、实用性和高效性。彈贸摄尔霁毙攬砖卤庑。在本控制系统中,上位机和下位机都是基于单片机而设计的。上位机是以AT89C51单片机系统为核心的控制系统,主要由AT89C51单片机、矩阵键盘以及标准的RS一485接口构成,其作用是通过各功能按键向下位机发送指令,以实现对爬壁机器人伺服电机的远程控制。下位机控制器安装于机器人本体的背面,控制器内部装有两个伺服电机驱謀荞抟箧飆鐸怼类蒋薔。动器、
4、直流电源模块、和控制电路板。下位机控制电路板也是以AT89C51单片机系统为核心,主要由AT89C51单片机、8155扩展1/0接口电路、D尽、转换与运算放大电路、数字量输入输出接口电路、电源转换电路以及与上位机进行通讯的RS一485标准接口构成,其作用是根据上位机传送的初始化参数和动作指令进行动作,控制左右两个伺服驱动器,驱动左右两个交流伺服电机运动,从而控制除锈爬壁机器人的行走和转向。图1为除锈爬壁机器人控制系统总体框图。图1除锈爬墙机器人控制系统总体结构框图3 除锈爬壁机器人控制系统的硬件设计3.1 下位机控制系统的硬件设计下位机控制系统是爬壁机器人控制系统的核心部分,其主要功能是实现对
5、左右伺服电机的运动控制以及与上位单片机控制系统之间进行通讯,以完成对机器人作业的控制。整个下位机控制硬件主要由两个伺服电机驱动器和下位单片机控制电路板构成。下位单片机控制电路板主要输出模拟量电压信号来控制左右两个伺服驱动器,进而控制左右两个伺服电机的运转,从而达到控制除锈爬壁机器人行走与转向的目的,同时它又担负着和上位机控制器之间的通讯任务,将上位机传送过来的控制指令处理后,再将相应的电压信号传递给伺服驱动器,从而实现遥控操作的功能。整个下位机电路板由AT89C51单片机、8155FO口扩展电路、D/A转换与运算放大单元、数字量输入输出接口电路、电源转换电路以及与上位机进行通讯的RS一485标
6、准接口电路构成。厦礴恳蹒骈時盡继價骚。3.1.1 交流伺服电机驱动器根据前面对伺服电机的选型可知,本课题选用的是调速范围宽、响应快、抗干扰性强的安川SGAMH一04AAA21型交流伺服电机,与之相匹配的伺服驱动器型号为SGDM一04AD。该伺服驱动器有三种控制模式:速度控制模式、转矩控制模式和位置控制模式。本系统采用速度控制模式,可通过伺服驱动器的用户参数Pn300将速度指令电压设定为士10V,其电机转速与指令电压成线性关系,速度指令电压与电机转速对应关系如表1所示1。茕桢广鳓鯡选块网羈泪。表1速度指令压电与电极转速对应关系正常工作时,伺服驱动器接受来自单片机控制系统的伺服准备信号,使伺服电机
7、通电,处于运行状态,然后根据加在VR卫F端口上的由单片机控制系统D/A转换电路产生的模拟指令电压信号来控制电机的转速,并且通过模拟指令电压的正负来确定电机的鹅娅尽損鹌惨歷茏鴛賴。正反转,从而确定爬壁机器人在船体表面上的行走速度和运动方向,同时单片机控制系统通过电平转换电路检测伺服驱动器的伺服状态输出信号,并根据接收到的信号对伺服驱动器进行相应的控制。此外通过伺服电机的编码器反馈,可以获得伺服电机实际工作时转子的位置和电机的转速。如图2所示为爬壁机器人单侧交流伺服驱动系统控制接线示意图。图2交流伺服驱动系统控制接线示意图3.1.2 AT89C51单片机及系统时钟与复位电路AT89C51是美国AT
8、MEL公司生产的低电压、高性能COMOSS位单片机,片内含4KB的可反复擦写的程序存储器和128个字节的随机存取数据存储器(RAM),器件采用ATMEL公司的高密度、非易失性存储技术制造。兼容标准MCS一51指令系统,片内配置通用8位中央处理器(CPU)和Flash存储单元。芯片上的FP三ROM允许在线编程或采用通用的非易失存储编程器对程序存储器重复编程。AT89C51将具有多种功能的8位cPu和FPEROM结合在一个芯片上,为很多嵌入式控制应用提供了非常灵活而又价格适宜方案,具有较高的性能价格比2。AT89csl单片机的主要性能如下:籟丛妈羥为贍偾蛏练淨。1. 与MCS一51产品指令系统完全
9、兼容。2. 片内有4KB可在线重复编程的Flash闪速擦写存储3. 存储器可循环写入/擦除1000。4. 存储数据保存时间为10年。5. 宽工作电压范围:VCC可为2.7V一6V。6. 时钟频率范围:OHz一24MHz。7. 程序存储器具有3级加密保护。8. 128x8B内部RAM。9. 32个可编程1/0接口线。10. 2个16位定时/计数器。11. 中断结构具有5个中断源和2个优先级。12. 可编程全双工串行UART通道。13. 空闲状态维持低功耗和掉电状态保存存储内容。图3时钟电路 图4复位电路AT89C51的复位输入引脚RST为其提供了初始化手段,通过该引脚可以使程序从指定处开始执行,
10、即从程序存储器中的O000H地址单元开始执行程序。当AT89C51的时钟电路工作后,只要在RST引脚上出现1Oms以上的高电平时,单片机内部则开始复位。只要RST保持高电平,则AT89C51循环复位。只有当RST由高电平变低电平以后,AT89C51才一从0000H地址开始执行程序。因此,AT89C51单片机在控制系统中正常工 作必须要有合适的时钟电路和复位电路。图3和图4分别为AT89C51的时钟电路和复位电路。預頌圣鉉儐歲龈讶骅籴。时钟电路由一个12M的晶振和两个30pF的小电容组成,它们决定了单片机的工作时间精度为1微秒。复位电路由22协F的电容、IK的电阻、按键以及IN4148二极管组渗
11、釤呛俨匀谔鱉调硯錦。成,可实现上电复位和按键复位。通常的复位采用10协F电容和IOK电阻组成复位电路,在本系统中我们根据实际经验选用22协F的电容和IK的电阻,其好处是在满足单片机铙誅卧泻噦圣骋贶頂廡。可靠复位的前提下降低了复位引脚的对地阻抗,可以显著增强单片机复位电路的抗干扰能力。其中IN4148二极管的作用是起到快速泄放电容电量的功能,实现短时间内多次复位。3.1.3 38155扩展1/0接口电路在爬壁机器人下位机控制系统中,两个伺服驱动器正常工作所需单片机的输入输出信号较多,需占用AT89C51单片机大量的输入输出口线,而Al,89C51单片机本身提供的输入输出口线并不多,只有Pl准双向
12、口的8位FO口线和P3口的某些位线可作为输入输出线使用,输入输出线不足16条,因此,为满足系统需求,AT89C51单片机需要外扩输入输出(FO)接口芯片。AT89C51单片机的外部I/O口是和外部数据存储器RAM统一编址的,用户可以把外部64K字节的数据存储器RAM空间的一部分作为扩展FO接口的地址空间,每一个接口芯片中的一个功能寄存器口地址就相当于一个RAM存储单元,CPU可以像访问外部数据存储器RAM那样访问外部接口芯片,对其功能寄存器进行读、写操作。在本系统中,我们采用Iniel的815SH芯片扩展FO口,该芯片内包含有256个字节的静态RAM存储器、两个可编程的8位并行口PA和PB、一
13、个可编程的6位并行口PC以及一个14位减法定时器/计数器。可以为单片机提供22个输入输出口线和一个256字节的RAM。由于8155H内部集成了地址锁存器和地址译码器,其可以直接和AT89C51单片机接口,不需要增加任何硬件逻辑。因而其灵活方便,可作为单片机与多种外围设备相连时的接口芯片。8155H共有40个引脚,采用双列直插式封装。在本控制系统中,通过AT89C51单片机的1/0口扩展81弘H芯片,其接口电路原理图如图5.5所示。图中8155H的片选信号瓦由AT89C51的P2.7口提供,即只有当擁締凤袜备訊顎轮烂蔷。P2.7为低电平时才选中8155H芯片工作。8155H的RAM存储器和1/0
14、口选择信号10/丽由PZ.O提供,当10/丽=0时,ADO一AD7的地址为8155HRAM单元的地址,选择8155H的RAM工作;当10/丽=1时,ADO一AD7的地址为8155HJ/O口的地址,选择8155H的FO口工作。在本系统中使用8155H芯片的目的是扩展1/0口,因此系统工作时应使AT89C51单片机的P2.0口为高电平,选择8155H芯片的FO口工作。8155H的读选通信号而和写选通信号丽都为低电平有效,其分别由AT89C51单片机的而和丽口提供。当瓦=0,10/丽=1,而端为低电平时,8155H将FO口内容传送到ADO一AD7供单片机读入;当瓦=0,IO/丽=1,丽端为低电平时,
15、8155H将单片机输出到ADOAD7的数据写入到8155H的UO口。8155H地址锁存允许端ALE与AT89C51单片机的ALE端相连,其为高电平有效,当ALE=1时,8155H允许ADO一AD7上地址锁存到“地址贓熱俣阃歲匱阊邺镓騷。锁存器”;否则,地址锁存器处于封锁状态。8155H的复位端与AT89C51单片机的复位端相连,都接到AT89C51的复位电路上,两者共用一个复位电路。图5 AT89C引单片机与8155H的接口电路原理在爬壁机器人的下位单片机控制系统中,伺服驱动器的伺服准备输入信号和伺服状态输出信号主要是AT89C51单片机通过8155H芯片的PA、PB和PC口输出和读入的。而A
16、T89C51单片机对8155H芯片的PA、PB和PC口的操作是通过地址来实现的。8155H的1/0口编址见表5.2所示3。表2 8155H的IO口编址根据图5中AT89C51单片机与8155H芯片的连接方式以.及表2中所列8155H的FO口编址,可知在该系统中,8155H芯片的A口、B口、C口地址分别为7F0lH、7F02H、7FO3H。命令寄存器和状态寄存器共用一个端口地址,在本系统中地址可为7FOOH,但命令寄存器只能写入不能读出,状态寄存器只能读出不能写入。A口、B口和C口的工作方式是通过8155H的8位命令寄存器的低4位来定义的,具体命令控制字的格式如图6所示1621。当系统确定了81
17、55H的A、B、c口工作方式后,可通过单片机编程将相应的命令控制字写入到8155H的命令寄存器,从而使各1/0在预定的方式下工作。在本控制系统中,A口定义为基本输入方式,B口定义为基本输出方式,C定义为输出方式,允许A口中断,定时计数器无操作,则相应的命令控制字为16H。坛摶乡囂忏蒌鍥铃氈淚。图6 8155命令控制字格式3.1.4 D/A转换与运算放大电路由于在本控制系统中,爬壁除锈机器人的伺服电机驱动系统采用的是模拟电压控制,伺服电机的转速与电压成正比关系。而单片机只能输出数字量,因此要获得模拟量电压必须对单片机输出的数字量进行D/A转换,进而通过模拟量电压来控制伺服电机的转速和转向。本控制
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 除锈 机器人 控制系统 方案设计
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,个别因单元格分列造成显示页码不一将协商解决,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【精****】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【精****】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。