文档介绍：悬挂运动控制系统
 
 
作者:李岩沈志张海宁
赛前辅导及文稿整理辅导教师:尹仕
 
摘要:本系统采用SPCE061A单片机作为控制系统的核心,通过光电编码盘实现对悬挂物位置的精确测量,并引入局部闭环反馈控制环节对误差进行修正。在寻迹过程中,采用无线数传通讯的反馈方式替代了有线连接的反馈方式,避免了线缆牵引带来的控制误差。系统采用点阵液晶和触摸控制屏实现了友善方便的人机交互界面。
 
 
Abstract: This system adopts the SPCE061A as the kernel of the control system. The system measures the position of the suspender through the photoelectric encoder and the position is been modified by the local feedback. During the seeking mark process, it makes use of the wireless data transmission feedback instead of the lineate feedback to avoid the system control error which brought by the line. The system uses a LCD and a touch screen realizes a friendly and conveniently HMI (Human Machine Interface).
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
一、方案论证与比较
本系统主要由主控制模块、电机驱动模块、检测反馈环节和悬挂模块四部分组成,实现了局部闭环的悬挂运动控制系统。系统框图如图1所示。
(1) 位置测量方案的选择
方案一:采用位移传感器实现对悬挂物的定位。受光电鼠标原理的启发,可采用位移传感器,获取悬挂物的坐标偏移量,得到当前位置X、Y坐标。此方案可以通过直接购买鼠标成品作为悬挂物,从鼠标接口取得当前位置量,定位精度高。但是它测量的相对坐标,并非绝对,一旦掉帧,系统就无法校正;另一方面市场上的鼠标多为USB接口,USB数据传输协议较为复杂,限于比赛时间限制,实现较为困难。
方案二:采用步进电机实现对悬挂物的定位。由于步进电机可对旋转角度实现精确控制,因此可得到悬挂线的精确角位移,从而可以计算出线位移,进而可以计算得到悬挂物的位置,实现悬挂物定位。常用的两相四线步进电机和两相六线步进电机等,°,线位移误差可以达到毫米级。但由于题目对悬挂物重量有一定要求,则需要步进电机转矩较大。而步进电机转矩越大,其在停止时的锁死电流就越大,因此采用步进电机对电源功耗要求很高。另外当步进电机运转频率过高时,会出现失步等现象,影响控制精度。
方案三:采用直流电机结合光电编码盘实现对悬挂物的定位。此方案是将光电脉冲信号转化为角位移量,是工业控制中的常用方法。编码盘转轴与直流电机