除锈爬壁机器人控制系统的设计.docx
- 文档编号:1986946
- 上传时间:2022-10-25
- 格式:DOCX
- 页数:18
- 大小:496.03KB
除锈爬壁机器人控制系统的设计.docx
《除锈爬壁机器人控制系统的设计.docx》由会员分享,可在线阅读,更多相关《除锈爬壁机器人控制系统的设计.docx(18页珍藏版)》请在冰豆网上搜索。
除锈爬壁机器人控制系统的设计
除锈爬壁机器人控制系统的设计
1前言
控制系统是船舶壁面除锈爬壁机器人的重要组成部分,其负责完成对除锈爬壁机器人的行走和转向功能的控制,使机器人能够按照预定的轨迹去工作,因此对除锈爬壁机器人控制系统提出如下基本要求:
(1)控制系统方便、可靠性高、操作灵活,便于操作人员使用;
(2)通过功能按键可以设定机器人的多极移动速度,并可实时调整运动方向和运动速度,实现机器人在船体表面上的全方位移动;
(3)由于船舶除锈现场环境恶劣,除锈爬壁机器人的工作环境制约了其控制方式,
本系统采用简单实用、可靠性高的有线遥控,其控制距离需大于30米。
(4)控制系统能实现除锈爬壁机器人的简单作业,保证机器人在爬行过程中的除锈质量。
2
除锈爬壁机器人控制系统的总体方案
除锈爬壁机器人在船体表面上的行走和转向是通过左右两个交流伺服电机的驱动来实现的。
当左右两个伺服电机的转速与转向相同时,爬壁除锈机器人在船体表面上实现直线行走。
电机正转时,机器人前进;电机反转时,机器人后退。
当左右两个伺服电机的转向相反时,除锈爬壁机器人在船体表面上实现转向。
综合考虑各种控制形式的优缺点,结合船舶除锈的实际情况,爬壁机器人的控制系统采用上下位机二级分布式控制方式,以保证即使在无操作人员参与的情况下,下位机
也可以按照上位机通过串口预先给定的指令和参数实现自主作业,从而使船舶壁面除锈
爬壁机器人具有高效除锈、自动化水平高和减少操作人员操作强度的性能;操作人员也
以通过观测船体表面的实际锈蚀状况,根据除锈爬壁机器人的实际作业情况,随时切换到人工操作状态,以提高机器人的实时性、实用性和高效性。
在本控制系统中,上位机和下位机都是基于单片机而设计的。
上位机是以AT89C51单片机系统为核心的控制系统,主要由AT89C51单片机、矩阵键盘以及标准的RS一485接口构成,其作用是通过各功能按键向下位机发送指令,以实现对爬壁机器人伺服电机的远程控制。
下位机控制器安装于机器人本体的背面,控制器内部装有两个伺服电机驱
动器、直流电源模块、和控制电路板。
下位机控制电路板也是以AT89C51单片机系统
为核心,主要由AT89C51单片机、8155扩展1/0接口电路、D尽、转换与运算放大电路、
数字量输入输出接口电路、电源转换电路以及与上位机进行通讯的RS一485标准接口构
成,其作用是根据上位机传送的初始化参数和动作指令进行动作,控制左右两个伺服驱
动器,驱动左右两个交流伺服电机运动,从而控制除锈爬壁机器人的行走和转向。
图1
为除锈爬壁机器人控制系统总体框图。
图1除锈爬墙机器人控制系统总体结构框图
3
除锈爬壁机器人控制系统的硬件设计
3.1下位机控制系统的硬件设计
下位机控制系统是爬壁机器人控制系统的核心部分,其主要功能是实现对左右伺服电机的运动控制以及与上位单片机控制系统之间进行通讯,以完成对机器人作业的控制。
整个下位机控制硬件主要由两个伺服电机驱动器和下位单片机控制电路板构成。
下位单片机控制电路板主要输出模拟量电压信号来控制左右两个伺服驱动器,进而控制左右两个伺服电机的运转,从而达到控制除锈爬壁机器人行走与转向的目的,同时它又担负着和上位机控制器之间的通讯任务,将上位机传送过来的控制指令处理后,再将相应的电压信号传递给伺服驱动器,从而实现遥控操作的功能。
整个下位机电路板由AT89C51单片机、8155FO口扩展电路、D/A转换与运算放大单元、数字量输入输出接口电路、电源转换电路以及与上位机进行通讯的RS一485标准接口电路构成。
3.1.1交流伺服电机驱动器
根据前面对伺服电机的选型可知,本课题选用的是调速范围宽、响应快、抗干扰性强的安川SGAMH一04AAA21型交流伺服电机,与之相匹配的伺服驱动器型号为SGDM一04AD。
该伺服驱动器有三种控制模式:
速度控制模式、转矩控制模式和位置控制模式。
本系统采用速度控制模式,可通过伺服驱动器的用户参数Pn300将速度指令电压设定为士10V,其电机转速与指令电压成线性关系,速度指令电压与电机转速对应关系如表1所示[1]。
表1速度指令压电与电极转速对应关系
正常工作时,伺服驱动器接受来自单片机控制系统的伺服准备信号,使伺服电机通
电,处于运行状态,然后根据加在V~R卫F端口上的由单片机控制系统D/A转换电路产生的模拟指令电压信号来控制电机的转速,并且通过模拟指令电压的正负来确定电机的
正反转,从而确定爬壁机器人在船体表面上的行走速度和运动方向,同时单片机控制系
统通过电平转换电路检测伺服驱动器的伺服状态输出信号,并根据接收到的信号对伺服
驱动器进行相应的控制。
此外通过伺服电机的编码器反馈,可以获得伺服电机实际工作
时转子的位置和电机的转速。
如图2所示为爬壁机器人单侧交流伺服驱动系统控制接线示意图。
图2交流伺服驱动系统控制接线示意图
3.1.2AT89C51单片机及系统时钟与复位电路
AT89C51是美国ATMEL公司生产的低电压、高性能COMOSS位单片机,片内含4KB的可反复擦写的程序存储器和128个字节的随机存取数据存储器(RAM),器件采用ATMEL公司的高密度、非易失性存储技术制造。
兼容标准MCS一51指令系统,片内配置通用8位中央处理器(CPU)和Flash存储单元。
芯片上的FP]三ROM允许在线编程或采用通用的非易失存储编程器对程序存储器重复编程。
AT89C51将具有多种功能的8位cPu和FPEROM结合在一个芯片上,为很多嵌入式控制应用提供了非常灵活而又价格适宜方案,具有较高的性能价格比[2]。
AT89csl单片机的主要性能如下:
1.与MCS一51产品指令系统完全兼容。
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为其提供了初始化手段,通过该引脚可以使程序从指定处开始执行,即从程序存储器中的O000H地址单元开始执行程序。
当AT89C51的时钟电路工作后,只要在RST引脚上出现1Oms以上的高电平时,单片机内部则开始复位。
只要RST保持高电平,则AT89C51循环复位。
只有当RST由高电平变低电平以后,AT89C51才一从0000H地址开始执行程序。
因此,AT89C51单片机在控制系统中正常工作必须要有合适的时钟电路和复位电路。
图3和图4分别为AT89C51的时钟电路和复位电路。
时钟电路由一个12M的晶振和两个30pF的小电容组成,它们决定了单片机的工作时间精度为1微秒。
复位电路由22协F的电容、IK的电阻、按键以及IN4148二极管组
成,可实现上电复位和按键复位。
通常的复位采用10协F电容和IOK电阻组成复位电路,在本系统中我们根据实际经验选用22协F的电容和IK的电阻,其好处是在满足单片机
可靠复位的前提下降低了复位引脚的对地阻抗,可以显著增强单片机复位电路的抗干扰
能力。
其中IN4148二极管的作用是起到快速泄放电容电量的功能,实现短时间内多次
复位。
3.1.338155扩展1/0接口电路
在爬壁机器人下位机控制系统中,两个伺服驱动器正常工作所需单片机的输入输出
信号较多,需占用AT89C51单片机大量的输入输出口线,而Al,89C51单片机本身提供
的输入输出口线并不多,只有Pl准双向口的8位FO口线和P3口的某些位线可作为输
入输出线使用,输入输出线不足16条,因此,为满足系统需求,AT89C51单片机需要
外扩输入输出(FO)接口芯片。
AT89C51单片机的外部I/O口是和外部数据存储器RAM
统一编址的,用户可以把外部64K字节的数据存储器RAM空间的一部分作为扩展FO
接口的地址空间,每一个接口芯片中的一个功能寄存器口地址就相当于一个RAM存储
单元,CPU可以像访问外部数据存储器RAM那样访问外部接口芯片,对其功能寄存器
进行读、写操作。
在本系统中,我们采用Iniel的815SH芯片扩展FO口,该芯片内包含有256个字
节的静态RAM存储器、两个可编程的8位并行口PA和PB、一个可编程的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口选择信号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,丽端为低电平时,8155H将单片机输出到ADO~AD7
的数据写入到8155H的UO口。
8155H地址锁存允许端ALE与AT89C51单片机的ALE端相连,其为高电平有效,当ALE=1时,8155H允许ADO一AD7上地址锁存到“地址
锁存器”;否则,地址锁存器处于封锁状态。
8155H的复位端与AT89C51单片机的复
位端相连,都接到AT89C51的复位电路上,两者共用一个复位电路。
图5AT89C引单片机与8155H的接口电路原理
在爬壁机器人的下位单片机控制系统中,伺服驱动器的伺服准备输入信号和伺服状
态输出信号主要是AT89C51单片机通过8155H芯片的PA、PB和PC口输出和读入的。
而AT89C51单片机对8155H芯片的PA、PB和PC口的操作是通过地址来实现的。
8155H
的1/0口编址见表5.2所示[3]。
表28155H的I\O口编址
根据图5中AT89C51单片机与8155H芯片的连接方式以.及表2中所列8155H的FO口编址,可知在该系统中,8155H芯片的A口、B口、C口地址分别为7F0lH、7F02H、7FO3H。
命令寄存器和状态寄存器共用一个端口地址,在本系统中地址可为7FOOH,但命令寄存器只能写入不能读出,状态寄存器只能读出不能写入。
A口、B口和C口的工作方式是通过8155H的8位命令寄存器的低4位来定义的,具体命令控制字的格式如图6所示1621。
当系统确定了8155H的A、B、c口工作方式后,可通过单片机编程将相应的命令控制字写入到8155H的命令寄存器,从而使各1/0在预定的方式下工作。
在本控制系统中,A口定义为基本输入方式,B口定义为基本输出方式,C定义为输出方式,允许A口中断,定时计数器无操作,则相应的命令控制字为16H。
图68155命令控制字格式
3.1.4
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 除锈 机器人 控制系统 设计