除锈爬壁机器人控制系统的设计.docxVIP

除锈爬壁机器人控制系统的设计 1前言 控制系统是船舶壁面除銹爬壁机器人的重要组成部分，其负责完成对除锈爬壁机器人的 行走和转向功能的控制，使机器人能够按照预定的轨迹去工作，因此对除锈爬壁机器人控制系 统提出如下基本要求： 控制系统方便、可靠性高、操作灵活，便于操作人员使用； 通过功能按键可以设定机器人的多极移动速度，并可实时调整运动方向和运动速度，实现机 器人在船体表面上的全方位移动； 由于船舶除锈现场环境恶劣,除锈爬壁机器人的工作环境制约了其控制方式， 本系统釆用简单实用、可靠性高的有线遥控，其控制距离需大于30米。 控制系统能实现除锈爬壁机器人的简单作业，保证机器人在爬行过程中的除锈质量。 2除锈爬壁机器人控制系统的总体方案 除锈爬壁机器人在船体表面上的行走和转向是通过左右两个交流伺服电机的驱动来 实现的。当左右两个伺服电机的转速与转向相同时，爬壁除锈机器人在船体表面上实现 直线行走。电机正转时，机器人前进;电机反转时,机器人后退。当左右两个伺服电机的转 向相反时,除锈爬壁机器人在船体表面上实现转向。 综合考虑务种控制形式的优缺点,结合船舶除锈的实际情况，爬壁机器人的控制系统采 用上下位机二级分布式控制方式，以保证即使在无操作人员参与的情况下.下位机 也可以按照上位机通过串门预先给定的指令和参数实现自主作业,从而使船辩壁面除锈 爬壁机器人具有高效除锈、自动化水平高和减少操作人员操作强度的性能；操作人员也 以通过观测船体表面的实际锈蚀状况，根据除锈爬壁机器人的实际作业情况，随时切换到 人工操作状态，以提高机器人的实时性、实用性和高效性。 在本控制系统中,上位机和下位机都是基于单片机而设计的。上位机是以AT89C 5 1 单片机系统为核心的控制系统，主要由AT89C51单片机、矩阵键盘以及标准的RS-485 接口构成，其作用是通过各功能按键向下位机发送指令,以实现对爬壁机器人伺服电机的 远程控制。下位机控制器安装于机器人本体的背面，控制器内部装有两个伺服电机驱 动器、直流电源模块、和控制电路板。下位机控制电路板也是以AT89C5 1单片机系统 为核心，主要由AT89C51单片机、8 155扩展1/ 0接口电路、D尽、转换与运算放大 电路、 数字量输入输出接口电路、电源转换电路以及与上位机进行通讯的RS-485标准接口构 成，其作用是根据上位机传送的初始化参数和动作指令进行动作，控制左右两个伺服驱 动器，驱动左右两个交流伺服电机运动，从而控制除锈爬壁机器人的行走和转向。图1 为除锈爬壁机器人控制系统总体框图。 图1除锈爬墙机器人控制系统总体结构框图 3除锈爬壁机器人控制系统的硬件设计 3.1下位机控制系统的硬件设计 下位机控制系统是爬壁机器人控制系统的核心部分，其主要功能是实现对左右伺服电 机的运动控制以及与上位单片机控制系统之间进行通讯，以完成对机器人作业的控制。整 个下位机控制硬件主要由两个伺服电机驱动器和下位单片机控制电路板构成。下位单片 机控制电路板主要输岀模拟量电压信号来控制左右两个伺服驱动器，进而控制左右两个 伺服电机的运转，从而达到控制除锈爬壁机器人行走与转向的目的,同时它乂担负着和上 位机控制器之间的通讯任务，将上位机传送过来的控制指令处理后，再将相应的电圧信号 传递给伺服驱动器，从而实现遥控操作的功能。整个下位机电路板由AT89C51单片机、 8 155F 0 口扩展电路、D/A转换与运算放大单元、数字量输入输出接口电路、电源转换 电路以及与上位机进行通讯的RS-48 5标准接口电路构成。 交流伺服电机驱动器 根据前面对伺服电机的选型可知，本课题选用的是调速范围宽、响应快、抗干扰性强 的安川SGAMH - 0 4 AAA21型交流伺服电机，与之相匹配的伺服驱动器型号为SGD M— 0 4AD。该伺服驱动器有三种控制模式:速度控制模式、转矩控制模式和位置控制模 式。本系统采用速度控制模式，可通过伺服驱动器的用户参数Pn3 0 0将速度指令电压设 定为士 10V,其电机转速与指令电压成线性关系，速度指令电压与电机转速对应关系如表1 所示卩,。 ? ? JT ? 建度指令电压 it转方向 转速 SGMAH不电机 + 10V 止转 额定转速 3000r^min -1 V 正转 1/10額定转進 300 r/min 0V 帰止 0 Q -IV 反转 1/10 ?定转速 300 rAnin J0V 反转 額定巽速 JOOOr^min 表1速度指令压电与电极转速对应关系 正常工作时?伺服驱动器接受来自单片机控制系统的伺服准备信号，使伺服电机通 电,处于运行状态.然后根据加在V?R卫F端口上的由单片机控制系统D / A转换电路产 生的模拟指令电压信号来控制电机的转速，并且通过模拟指令电圧的正负来确定电机的 正反转，从而确定爬壁