悬挂运动控制系统(设计报告).docVIP

PAGE PAGE 1 悬挂运动控制系统设计报告 一．方案的选择与比较 1．主体控制方案比较 方案1. 闭环数字控制方式 闭环数字控制方式，主要利用光电传感器检测法，结构图如图1所示。首先单片机根据输入的数据来计算物体要移动的距离并控制物体往坐标的大概方向运动，红外发射接收器来探测悬挂物体移动了多少个1*1cm的小方格,并经过A/D送给单片机，单片机通过特定的算法计算出物体的坐标，并控制电机的转动来控制物体往坐标进发，在此过程中单片机不断计算，不断调整电机的转速和方向使悬挂物体做一定路线的移动。但其缺点是，电路复杂，不但要求要有A/D电路，光电探测电路，还要其电路要做得十分精确。任何一个电路设计得不好，也会使物体运动产生很大的偏差。 图1 闭环数字控制 方案2. 开环数字控制方式 开环数字程序控制方式,即没有反馈系统，开环数字控制的结构图如图2所示。由图可看出，此种控制方式与上面的控制方式少了反馈电路。单片机由输入的数据来计算物体要移动的距离，直接发出控制脉冲来控制电机的转动，进而控制物体的运动方向。由于少了反馈电路，系统的精度只与单片机所采用的算法准确性有关，此种方式电路结构简单，成本低且易于调整和维护，是一种较理想的方式。 图2 开环数字控制方式 综合上面所述，考虑时间和调试的复杂性，本设计采用方案2。 2．电机选择 方案1. 直流电机。 直流电机又分为直流无刷电机和直流有刷电机，是最早实现调速的电动机，其优点是有良好的线性调速特性，简单的控制性能，高的效率，但其数字控制方面较难把握。 方案2. 步进电机。 步进电机是多种机电设备中被广泛应用的一种电机，它主要由定子和转子构成。定子的主要结构是绕组。三相、四相、五相步进电机分别有三个、四个、五个绕组，其它以此类推。绕组按一定的通电顺序工作着，这个通电顺序我们称为步进电机的“相序”。转子的主要结构是磁性转轴，当定子中的绕组在相序信号作用下，有规律的通电、断电工作时，转子周围就会有一个按此规律变化的电磁场，因此一个按规律变化的电磁力就会作用在因此转子上，使转子发生转动。它将电脉冲信号转换成角位移，即给一个脉冲信号，步进电动机就转动一个角度，因此非常适合于单片机控制。另外步进电机还有动态响应快易于起停，易于正反速及变速等优点。 综合上面所述，为易于单片机控制，本设计采用方案2。 3．驱动方式的选择 我们知道步进电动机使用脉冲电源工作。开关管是按照控制脉冲的规律“开”和“关”，使直流电源以脉冲方式向绕组L供电，这一过程我们称它为步进电动机的驱动。 （1）单电压驱动 单电压驱动是指电动机绕组在工作时，只用一个电压电源对绕组供电(如图3所示)。它的特点是电路简单，一般只用于小功率步进电动机的驱动。 图3 单电压驱动原理图 图4 双电压驱动原理图 （2）双电压驱动 双电压驱动是用提高电压的方法使绕组中的电流上升波形变陡(如图4所示)。它的基本思路是在低频段使用较低的电压驱动，在高频段使用较高的电压驱动。这种驱动方法在低频段具有单电压驱动的特点，在高频段具有良好的高频性能。 本设计考虑到变压器,因采用了单电压驱动. 4．系统组成 经过方案比较与论证,最终确定的系统组成框图如图5所示.其中单片机用89S52,驱动用1TIP122,驱动用液晶显示. 图5 系统控制硬件总框图 二．软件设计 对与一个开环控制系统来说,最重要的就是它的算法的选择,然后就是针对算法的编程. 1．控制算法的比较 方案1. 逐点比较直线插补算法 逐点比较法是数控机床中广泛采用的一种软件插补算法，该方法普遍用于二坐标数控加工系统.所谓逐点比较法就是在绘图过程中,绘图笔每移动一步都要与理想线路进行比较,然后决定下一步的移动方向用步步修正的方法画出所期望的线段. 逐点比较法的基本原理是斜率比较法．即线段的起点与笔当前的位置构成的直线斜率与要绘线段斜率进行比较．当前者斜率小于后者斜率时，笔应该向Ｙ方向走一步．当前者斜率大于后者斜率时，笔应该向Ｘ方向走一步． 如图6所示，ＯＡ为欲画的路线，Ｍ１为画笔开始所在的位置，当ＯＡ的斜率小欲画线段的斜率时，ＯＡ向＋Ｙ方向移动一步，到达Ｍ２点．然后再用线段ＯＭ２的斜率与ＯＡ的斜率进行比较，当ＯＭ２的斜率大欲画线段ＯＡ斜率时,ＯＡ向＋Ｘ方向移动一步。 图6逐点比较直线插补算法 方案2. 逐点比较圆弧插补算法． 圆弧轨迹插补不同于直线，一段圆弧可能跨越几个象限。每当一段圆弧跨过象限后，原来的偏差