悬挂运动控制系统论文

悬挂运动控制系统摘要本系统以msp430（MSP430F22X4）单片机为核心作为悬挂运动控制的系统，实现了键盘输入识别、传感器信号采集、电机驱动电路控制等功能。根据物体在平面任一处两端吊绳的长度唯一确定的原理，通过单片机编程控制电机转动带动吊绳伸长或缩短，实现物体沿任意设定轨迹运动。引导部分用反射式红外传感器探测板面黑线，信息送入单片机处理后，控制物块沿黑线前进。以完成到达任意预设坐标，沿自行设定轨迹运动，以板上任意处为圆心画直径为50cm的圆和寻黑线前进任务。关键词：msp430（MSP430F22X4）步进电机红外传感器AbstractThesystemtomsp430(MSP430F22X4)microcontrollerasthecoreasthehoistingofthemovementcontrolsystem,thekeyboardinputtoachieverecognition,sensorssignalacquisition,motordrivecircuitcontrol,andotherfunctions.AccordingtotheobjectsinaflatatbothendsofDiaoshengonlydeterminethelengthoftheprinciplesofprogrammingthroughtheMCUcontrolmotordrivenrotationalDiaoshengelongateorshorten,andobjectsalongthearbitrarytrackingmovement.Reflectiveoftheguidewithinfraredsensorsdetectboardblackline,processingtheinformationintothemicrocontroller,controlofblockalongtheblacklineforward.Tocompletethelandingcoordinatesofanydefault,setyourownpathalongthecampaigntotheboardforthecenterofarbitrarydiameterof50cmpaintingofthecircleandlookforwardlineandtasks.Keywords:msp430（MSP430F22X4）step-motorinfraredwavesensor一、系统方案选择与论证根据设计要求，系统可分为控制部分和信号检测部分。其中信号检测部分通过传感器检测黑色轨迹，并将信号传回控制器处理。控制部分的作用是接受并处理键盘输入的控制信号以及检测信号，通过控制电机的转动改变吊绳长度，从而控制悬挂物体的运动，并将物体坐标实时显示出来，系统框图如图1所示。控制器模块键盘输入物体轨迹检测模块显示模块电机驱动模块图1系统框图系统分为控制器模块，物体轨迹检测模块，键盘输入模块，显示模块，电机驱动模块。（1）控制器模块方案一：采用FPGA作为系统的控制器。FPGA可以实现各种复杂的逻辑功能，所有器件集中在一块芯片上，体积小，稳定性高。同时FPGA可用EDA软件仿真调试，易于进行功能扩展，但由于系统对数据处理的要求不高，而FPGA引脚较多，步线复杂，成本也偏高。方案二：采用单片机作为控制器。单片机使用简单，软件编程灵活。选用msp430（MSP430F22X4）单片机作为核心器件。该单片机具有高速的运算能力以及含有丰富的功能模块，例如：多通道10~14位AD转换器，双路12位DA转换器，比较器，看门狗定时器和多个16位，8位定时器(可进行捕获，比较，PWM输出)以及FALASH存储器，他可以在运行过程中由程序控制写操作和段擦除(Insystemprogrammable)，不需要额外的高电压等，软件编程灵活，自由度大，可用软件编程实现各种算法和逻辑控制。综上比较，选择方案二。（2）执行电机根据题目的要求，我们选用了步进电机，因为本系统要求电机能实现精确的位置控制，若采用直流电机，只能通过软件算法，，调节占空比。但占空比与电机速度的准确关系不易掌握，控制精度不够高。由于步进电机的步距角一定，控制输入步进电机的脉冲数就可以精确控制步进电机的角度，从而精确控制物体的位置。（3）电机驱动模块方案一：用三极管和与门等简单的元器件设计H桥式电机控制电路。该方案涉及的元件简单，设计方便，然而其通断速率可能受到元件反映速率的影响，且不能驱动较大电流的电机。方案二：采用步进电机专用驱动芯片LM298N。芯片内含两个H桥式电机驱动电路，其优点在于驱动电流大，工作稳定。综上比较，选择方案二。二、主要电路设计本系统采用单片机作为控制核心，对键盘输入的控制信号和传感器送来的信号进行分析处理，然后控制画笔在画板上运动，并通过LED数码管显示各种界面的输出数据。本系统主要的单元电路有步进电机驱动电路、物体寻轨检测电路、键盘及LED显示接口电路。1.步进电机驱动电路及接口电路的设计系统需要控制两个步进电机的运动，则需要两个独立的L298N驱动电路分别驱动两个步进电机。L298N驱动电路如图2所示。IN1~IN4接单片机I/O口，OUT1~OUT4分别接步进电机4相输入引线，ENA和ENB为使能端，接高电平允许。步进电机另外两条中间抽头悬空。另外，在L298N外围还接了8个续流二极管，起保护电机的作用。图2步进电机驱动电路2.物体寻轨检测电路的设计光电传感器检测电路如图3所示。当传感器位于白纸上时，输出为低电平；当传感器位于黑线上时，输出为高电平。因此，当传感器由白纸运动到黑线或是黑线运动到白纸上时，电平会发生变化。单片机接收到这些脉冲信号并作相应的处理，从而控制重物寻轨运动。由于8个光电传感器的灵敏度可能不一致，即当外界光源或传感器离画板距离变化时，8个光电传感器检测出的信号不统一，故每个传感器电路中都加上一个运放作为比较器，并通过滑动电阻器改变比较电压，这样，可由试验调整8个光电传感器的灵敏度，使之统一。图3光电传感器检测电路3.键盘及LED显示接口电路的设计本系统采用4*4矩阵式键盘，处理方式采用行扫描法来识别键是否按下。程序可以通过外部中断来进行键盘输入的控制。LED电视接口电路的设计：本系统采用2个四位一体数码管和两个74HS138构成显示部分，能够达到题目的要求。三、系统的软件设计本系统以msp430单片机为控制器，采用C语言对单片机进行编程。主程序主要起导向和决策的作用，它控制整个系统协调稳定的运作，系统各种功能主要通过调用具体的子程序来实现。系统中的其他子程序有：键盘扫描程序，数码管显示程序，延时程序，步进电机转动控制程序。开始设置当前坐标检测键盘寻坐标？自定义？画圆？寻黑线？输入目标坐标输入运行轨迹输入圆心输入黑线子程序坐标合理？进入画圆子程序进入坐标子程序进入自定义曲线子程序YNYYYYNNNN图4系统总流程图控制算法分析：控制算法中，我们选择的是数学建模法。数学建模法是指用数学方法，运用几何知识（极坐标）把圆上的点和两个电机所在的位置联系起来，通过相关计算把圆上的点的坐标用数学表达式表示出来，并转换成电机所要转动的偏移量，最后把偏移量转化为电机所要转的速度。此方法，计算复杂，但所得数据较为准确，只要编程正确，用电机所画出来的线就不会偏差大。（1）直线的计算从右图我们可以看到假设原点坐标X0,Y0,要达到的坐标点X1,Y1，那么到坐标点的距离：201201)()(yyxxL我们没有采用Y=Kx+B的直线方程,而是把L的长度分为5.0_LLCOUNT等分。然后计算出每一个增量INC_X,INC_Y。（X0，Y0）XY（X1，Y1）L的直线即LCOUNTXXXINC__01LCOUNTYYYINC__01我们假设一个变量i,i的范围从1----COUNT_L，所以每走一步的坐标值0_*XXINCiXX0_*YYINCiYY（2）圆的的计算在圆弧的编程中,它的算法比直线的算法更复杂.从图我们可以看到假设圆心坐标X0,Y0,半径为R，圆上的一点坐标为XQ,YQ。即：（XQ=X0+R，YQ=Y0）而我们把圆分成360°,即设一个变量i,i的范围从1°到360°,每走一小步的坐标值XX,YY。0)*180cos(*xiRXX0)*180sin(*yiRYY那么它的力臂LL,LR22)115()15(yxyxLL22)115()95(yxyxLR而原点坐标的力臂LL0,LR02020)115()15(0yxLL2020)115()95(0yxLR因此力臂的增量为LL,LR0LLLLLL0LRLRLR因我们的步进不同,所以它的增量分别为0.026,0.026,最后才计算出要给的脉冲数COUNT_L,COUNT_R039.0_LLCOUNT078.0_LRCOUNT四、系统测试在底板上覆上厘米方格纸，对准坐标，设定不同的圆心及起始点坐标，分别进行圆周直线的绘图测试。测试仪器：米尺，秒表，以及必要的仪表。（1）测量设置坐标点参数功能和定点运动纪录数据见表一原点坐标（X，Y）输入坐标（X，Y）实际测量距离/cm误差值/cm运行时间/s(30,30)(40,30)9.90.111(40,30)(50,40)14.10.315(50,40)(30,20)28.2020（X0，Y0）YXXQ，YQR（2）测量圆周运动纪录的数据见表二圆心坐标/cm实际圆心坐标/cm半径最大偏差/cm运行时间/s(40,50)(39,50)0.921(50,40)(50,40)016时实显示当前坐标位置能够精确的显示当前坐标。五、总结通过控制步进电机转动角度以改变吊绳长度来实现对物体位置的控制，完成了系统基础部分和部分发挥部分的性能要求。在系统设计过程中，硬件线路简单，充分发挥软件编程方便灵活的特点，调试过程中详细分析系统可能的误差来源，并通过软件算法对误差进行补偿，以满足系统设计要求。画圆时误差范围在题目给定范围之内，从原点开始运动时终点与任意设定的目标点的偏差均不超过1cm。通过本次训练，也让我们对电机控制有了新的了解，也从程序的算法中获得了相应的知识。参考文献1全国大学生电子设计竞赛组委会.全国大学生电子设计竞赛获奖作品选编（2005）.北京理工大学出版社.2007.022悬挂运动控制系统中的循环算法研究.唐涛，刘波，袁磊.文章编号：1006-2475（2008）01-0048-043悬挂运动控制系统设计.刘华章，张晨亮，唐建华.海军航空工程学院学报.2006年5月第21卷第3期附录：1.总图2.详细流程图：开始计算直线长度L输入两点坐标（X0，Y0）计算直线以0.5等分计算出步数count_L计算出x轴y轴的增量INC_X,INC_Y计算（x0，y0）对应的两条线的长度计算出第i步的坐标并转换成对应的长度L_1,L_r计算输送给电机的脉冲驱动电机转动Icount_L结束YN开始输入圆心，半径根据输入的起点坐标计算对应轴的初始长度L_10,L_r0计算第i步的坐标xx，yy，并转换成相应的线的物理长度i=360°结束YN计算第i步时与i-1的线长驱动电机转动直线函数的流程图画圆函数的流程图3.源程序/******************************************************************************Filename:悬挂运动控制系统Processor:msp430f2274Description:本系统用于悬挂物体运动接口安排:P4---电机(两个步进电机)P3---键盘(4*4)P1.0~P1.3和P2.0~P2.3---数码管(8位)(单4拍)(左电机):P4.0~PP4.3--ABCD(右电机):P4.4~P4.7---A'B'C'D'(双4拍)********************************