悬挂运动控制系统2资料

悬挂运动控制系统

摘要：本系统以单片机89C52为核心,采用了步进电机控制装置、红外寻迹传感装置来实现一个对悬挂物体运动控制系统。友好的操作界面和灵活的监控方式是本设计的两大特色,增强了系统的实用性。

关键词：步进电机；红外传感器；悬挂运动。

一、方案论证与选择

1．题目任务要求及相关指标的分析

题目的基本要求中，要求在150秒内到达设定的一个坐标点以及300秒内画圆或按照设定的轨迹运动,这要求我们对左右两个电机进行灵活、准确、快速的控制,并且有和谐的人机交换功能，才能够满足要求。因此选择合适的电机以及运用有效的算法来对电机进行控制是必需的，我们通过建立合理的数学模型，使两电机控制的绳长依照我们建立的函数关系变化，来实现悬挂物体在板上以各种方式运动。

发挥部分，要求控制物体沿板上标出的任意曲线运动，通过红外传感器寻迹，实现跟踪运动。而显示画笔的位置坐标，则可通过两段绳长变化与原点坐标之间的函数关系来计算，求出当前点的横纵坐标，并在LCD上显示出来。

2．方案的比较与选择

(1)电机的选择

方案一:直流电机

采用单片机和A/D转换构成系统，控制普通电机的步数和旋转方向，可以考虑达林管组成的H型PWM电路。用单片机控制达林管使之工作在占空比可调的开关状态，精确调整电机转速，减小因惯性，速度，步距角过大而引起的调整误差，达到改变绳长的要求，缺点是通过控制直流电机驱动模块将脉冲信号转化为模拟信号，需要将单片机输出的序列脉冲转换，延长了控制的时间，导致控制精度差；关键是直流电机不能即停，使直流电机不能精确定位，满足不了控制误差范围为设定值的要求。

方案二:步进电机

用单片机产生脉冲信号，脉冲信号的占空比为0.5左右，脉冲信号经过功率放大控制步进电机，控制信号为数字信号，不再需要数/模转换；步进电机的速度易于控制，具有快速启/停能力，可在一刹那间实现启动或停止；它的转动角度严格可控，一般情况步距角可以降低到 5.1以下，而采用专用驱动块，可以更加的精确。步进电机延时短，定位准确，精度高，可控制性强。这样我们就可以根据驱动脉冲总数来计算绳子所走过的路程，从而得出坐标和时间。

根据本课题技术指标要求，物体质量大于100克即可，步进电机的输出功率足以满足负载要求；同时根据题目要求运动轨迹与预期轨迹偏差不超过4cm，这对电机有精确的要求，而直流电机难以达到这一指标。综上方案的比较分析，

故而本设计采用方案二。

(2)悬挂物体定位方式的选择

方案一:坐标查询方式

在80cm×100cm的白色底板上，等分为8000个方格，视其为8000个点，每个点都有横纵坐标（a，b）两个数据，即共有16000个数据，而底板左右对称，所以只需记录一半的数据，即8000个，这样我们只需事先计算出悬挂物体在每一点对应的两侧绳长（x，y），将这8000个数据，即4000个确定的绳长数组记录在单片机中，这样就可以对所设定的坐标，采用查询的方式，找到相应点所对应的数组（x，y），与当前点对应的绳长做差，得到所需的绳长改变量，从而控制电机使物体到达该点。

此方案的优点在于查询方便快捷，准确性高，动作运动迅速，但准备工作的计算量太大，而且需要通过一块片外的ROM来存储如此庞大的数组集，不方便实现。

方案二：公式计算方式

根据题目中给出的各段长度，可以很容易的得到底板上各点坐标与两电机分别对应的绳长之间的函数关系，这样可以根据给定点的坐标求出各绳长或根据绳长求出点的坐标，能够实现各项指标，实现悬挂物体的精确定位，满足题目的要求。

该方案数学模型清晰，可以在较短时间内完成绳长或坐标的计算，使电机快速动作，无须片外ROM存储，而且占用单片机内存少，空间利用率较高，可操作性强。

综上方案的比较分析，根据本课题技术指标要求，用公式计算的方法比较容易实现，故而本设计采用方案二。

（3）画圆方案的选择

方案一：切分拟合法

首先通过周长计算，将圆等分为3000等份，然后依次计算初始点到下一点的坐标增量，通过增量来控制两个电机的运动，从而调整绳长，实现点对点的精确移动，也就是说所画的圆是由3000段小线段与之拟合连接起来的。这需要我们有足够快的运算速度，与很高的精度，依次精确计算出每一次步进的距离，横纵坐标和两段绳子的改变量，占用内存很大，计算时间较长，反应到电机上就是电机的运动时断时续，画圆的用时很长，线段相对光滑，但是累积误差比较大。

方案二：查询计算法

第一步要求我们能够画出一个题中要求的标准圆，然后将这条轨迹对应的各点坐标与相邻坐标的增量处理后详细记录，并且存储到单片机内，当我们需要画圆的时候，只需要调用这些标准增量，通过公式计算出绳长的改变量，就可以很精准的得到：左右电机从当前点运动到相邻点的脉冲数目与方向。这样就可以实现快速、准确、美观的画圆。

上述两种方案中，方案二可以避免复杂的计算，缩短电机的等待时间，没有误差的累积，反应快速、灵活，画面连续、美观，实现起来也比较方便。因此，我们画圆采用上述的方案二。

(4)寻迹传感器的选择

发挥部分寻迹传感器可供选择的种类较多，主要有以下两种:

方案一：光电传感器

光电传感器有多种类型，按其外表结构有对射型、回归反射型、扩散反射

型；按光源色分类又有红色、绿色、蓝色、红外以及半导体雷射等，其自身带有内置的或分离的放大器。根据题目的要求，要使所选传感器可以很好区分白色与黑色，有多种光电传感器可供选择，某些光源色为红色或绿色的光电传感器由于其对黑色与白色的反射率相差很大，所以可以很容易的识别。但是其价格昂贵，结构偏大，外围机械部分比较复杂。

方案二：红外传感器

红外传感器是我们非常常用的一种传感器，也具有很强的对黑色与白色的辨识能力。由于红外光波长比可见光长，因此受可见光的影响较小。同时红外系统还具有以下优点：尺寸小、质量轻，能有效的抗可见光波段的伪装，对辅助装置要求最少，对人眼无伤害。当然红外光也有一定的缺点，如大气、潮湿的天气、雾和云对它有衰减作用。它具有体积小、灵敏度高、线性好等特点，外围电路简单，安装起来方便，电源要求不高。用它作为近距离传感器是最理想的，电路设计简单、性能稳定可靠。

综上方案的比较分析，根据本课题技术指标要求，故而本设计采用方案二。

(4)寻迹传感器布局的选择

方案一：5传感器梅花状分布

采用上、中、下、左、右各装一个红外传感器来探测黑线，常态让中间的传感器保持在黑线上面，其余四个方向的传感器用来告知控制系统：该传感器所在的位置，是否为黑线上方。若在，则控制画笔向该传感器所在的方位移动，否则保持原来的移动方向不变，直到某个传感器探测到黑线，并发出信号为止。

这种方法虽然所用器件少，但是可靠性相对较差，精度较低。

方案二： 8传感器九宫图分布

在九宫格中间的右上、右、上、右下、左上、左下、左、下这八个方向装上红外传感器，并按照上面的顺序设置优先级。优先级的设定，取决于坐标原点相对于运动区域的所在位置。这样的话，我们就可以很容易的探测出黑线的前进趋向，依照优先级来控制电机的运动，可以准确快速实现寻迹功能，能够精准追踪1.5cm~1.8cm宽的黑色轨迹。

比较以上两种方案，方案一的探测范围显然要小，一旦传感器组处于黑线的同一边时，就很难重新自纠正，尤其是碰到有间断的曲线时，就很难控制它的运动；而方案二则可以探测较大的范围，实现多方位探测，控制思想较之方案一要先进的多，便于实现PID控制。

(5) 小结

经过仔细比较与论证，我们确定了整个控制系统各个模块的最终方案如下：

电机的选择：步进电机，带专用驱动模块，通过单片机输出脉冲信号来控制；

悬挂物体定位方式的选择：公式计算方式，求出点坐标对应的绳长，用步进电机实现绳长的改变。

画圆的算法：存储、查询计算，预先存储标准圆的相应增量，以便随时调用。

发挥部分寻迹传感器的选择：红外传感器

发挥部分寻迹传感器布局方法的选择：九宫图分布