关 闭

新闻中心

EEPW首页 > 工控自动化 > 设计应用 > 基于MSP430F449的悬挂运动控制系统设计

基于MSP430F449的悬挂运动控制系统设计

作者:时间:2012-02-09来源:网络收藏

摘要:以低功耗单片机系统平台为控制核心,由步进电机控制模块、红外传感和人机交互3个功能部分组成。由实现相应算法产生不同状态的PWM波,以控制电机的,从而实现对画笔的控制。系统可通过键盘任意设置坐标点参数;控制质量大于100g的物体在仰角不大于100°的80 cmx100 cm白板上做自行设定的,并在白板上画出轨迹;控制物体沿白板上按标出的任意黑色间断曲线运动。画笔坐标点及各运动状态实时显示在LCD上,人机界面友好。
关键词:步进电机;红外传感;PWM波;人机交互

在现代的车辆运动、医疗设备和工业控制等系统中,运动系统的应用越来越多,在这些系统中运动部件通常是具体的执行机构,因而部件的运动精确性是整个系统工作效能的决定因素,因而实际实现悬挂运动的精确控制具有极其重大的现实意义。本系统采用低功耗单片机系统平台了悬挂运动,采用高效的PWM电路,提高电源利用率;红外传感检测,提高纠错能力。由单片机产生脉冲信号驱动有精确步距的步进电动机,电机带动悬挂部件在平面上做特定的准确运动。

1 悬挂运动方案
1.1 电机选取
方案①:直流电机。直流电机的优点是输出功率大,带负载能力强;缺点是不能精确地控制直流电机的转动角度。
方案②:步进电机。步进电机是将电脉冲信号转变为角位移或线位移的开环控制元件。给电机加一个脉冲信号,电机就转过一个步距角,具有较强的快速启停能力。步进角方面,选用的三相六拍式步进电机,步进转角最小可以达到1.5°,可以满足系统控制精度要求。并且可以通过对其转动步数的控制实现对位移的精确控制。
方案③:使用伺服电机,伺服电机是一种内带编码盘,可以通过驱动器精确控制转动角度(0.001°级别),而且过载能力强,常用于精密控制,但其驱动电压一般较高,体积较大,在本题目的实现上并不适用。
综上所述,选择方案②。采用步进电机。
1. 2 电机驱动器选择
方案①:使用分立元件搭建。利用大功率三极管放大功率给步进电机提供驱动电压和电流。但本实验对功率要求较大,精度有限。
方案②:集成步进电机驱动器。集成驱动块能力强,工作稳定,其内部加入了光耦隔离器将控制电路与驱动电路完全隔离,防止了电动机在启动和制动时对控制电路造成影响。并且其只需要两三根线便实现电机的精确控制,控制相当简单。
综上所述,由于本系统需尽量采用高性能的驱动电路以保证步进电机良好的运转性能,故选择方案②。
1.3 循迹传感器选择
方案①:发光二极管和光敏二极管组成发射-接收电路。发光二极管为可见光,故光敏二极管的工作受外界光照影响很大,很容易造成误判和漏判。
方案②:反射式红外发射-接收器。采用红外对管替代普通可见光管,能极大地降低环境光源的影响。并且,红外线波长大,近距离衰减小,故探测近距离黑线更加可靠。
综上,选择方案②,采用发射时红外传感器ST188。
1. 4 画线算法
方案①:DDA算法。根据直线起始坐标得出斜率。取合适的步进量,根据斜率得出直线上每点的坐标,直接计算出两侧电机步数,控制画笔画线。该算法简单易行。
方案②:Bresenham微元算法。该算法只做整数加/减运算和乘2运算,运算速度很快,适于用硬件实现。
本系统采用软件实现算法,故选择方案①。
1.5 画圆算法
方案①:图形扫描Bresenham算法。该算法采用直角坐标系,但画圆时采用该坐标系算法不够清晰。
方案②:用自行的极坐标法。极坐标法公式简单,算法清晰。运算速度较快,完全能达到要求。
故选择方案②。
1.6 循迹传感器的安装方法
将8个传感器均匀分布予画笔周围,并形成一个八边形以细化物体的运动方向。由于黑色物体和白色物体的反射系数不同,传感器的输出电平亦有不同,用硬件比较器LM311标定传感器的阈值,将曲线的有无变换为高低电平送单片机I/O口,由软件寻找反射最弱的传感器方位,从而实现定位。
1.7 控制方案
对步进电机步进方式的考虑,采取一种将物体运动坐标移动转化为步进长度的策略。控制悬线在一定时间内伸缩的长度就可以控制物体的运动方向。电机正转,则悬线伸长;反转,则悬线缩短。悬线变化的长度和电机转动的步数成正比。题目指标要求物体可以行走直线、圆周和一段现场给出的不确定间断曲线,对此3种运动线型采取统一处理的策略,即都是用微小直线段组合成复杂曲线。这样做不仅能使电机的步进直接实现,还可以将所有线型集中转化为对直线运动的研究之后再拼接组合复原。对于不确定的运动曲线,物体上的光电传感器阵列实时采集路线信息,将其传送给处理器进行方向判断,给出下一步运动目标点的相关信息。

2 系统总体方案设计与实现
2.1 系统总体设计
根据设计要求和方案选择,本系统主要由3个模块电路组成:步进电机控制模块、红外传感和人机交互模块。电机驱动模块采用集成电机驱动器,驱动能力强;循迹采用红外对管,抗干扰能力好。MSP430单片机微控制器控制电机的旋转方向,以实现画直线、画圆及循迹过程。用户可通过4x4键盘选择运动坐标及画笔行动方式的设定。同时所有状态均在LCD上实时显示,及时跟踪电机行动状态。
2.2 总体实现框图
系统总体实现框图如图1所示。

本文引用地址:http://www.eepw.com.cn/article/161134.htm

,所以称为三相步进电机,磁极上有均匀分布的矩形小齿,转子上没有绕组,但有小齿均匀分布在其圆周上。其工作过程是:当一相绕组通电时,相应的两个磁极就分别形成了N极和S极,产生磁场,并与转子形成磁路。磁通从正相齿,经过软铁芯的转子,并以最短的路径流向负相齿,而其他四个凸齿并无磁通。为使磁通路径最短,在磁场力的作用下,转子被强迫移动,使最近的一对齿与被激励的一相对准,即使转子齿与定子齿对齐,从而步进电机实现向前“走”了一步。
如果给绕组施加有序的脉冲电流就可以控制电机转动起来,从而实现电脉冲信号到角度的转换。转动的角度大小与施加的脉冲数成正比,转速与脉冲的频率成正比,转向则与脉冲顺序有关。三相电机电流脉冲的施加方式有3种:
1)三相单三拍方式(按照单向绕组施加脉冲):
正转:→A→B→C→;反转:→A→C→B→。
2)三相双三拍方式(按照双向绕组施加脉冲):
正转:→AB→BC→CA→;反转:→AC→CB→BA→。
3)三相六拍方式(单向绕组和双向绕组交替施加脉冲):
正转:→A→AB→B→BC→C→CA→;反转:→A→AC→C→CB→B→BA→。
其中,三相六拍式的步距角是1.5°,其他两种方式为3°。为了不产生累积误差,必须保证电机不失步,这和其运行矩频特性密切相关,值得注意的是步进电机的驱动信号存在一个必须避开的频率——共振频率£0。
由于两边电机型号不一样,系统控制时需要注意两者的同步问题,从而以最佳的配合实现对画笔的精确圆滑控制。


上一页 1 2 3 下一页

评论


相关推荐

技术专区

关闭