DIY编程器网

 找回密码
 注册

QQ登录

只需一步,快速开始

扫一扫,访问微社区

查看: 1801|回复: 0
打印 上一主题 下一主题

[待整理] 基于32位DSP及电机驱动芯片的悬挂运动控制系统设计

[复制链接]
跳转到指定楼层
楼主
发表于 2015-4-27 23:50:49 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
随着32位DSP的普及,32位处理器已经成为控制领域的主流产品,与传统的微处理器相比速度更快、性能更强、资源丰富,更符合发展的脚步。TMS320F28027是一款32位的DSP,具有运算速度快、稳定性高的优点。本文利用TMS320F28027控制两个步进电机,从而使物体在平面内运动,实现物体在平面内可以任意地画指定的曲线和圆等。图1为悬挂系统的模型。
       
        1系统总体方案的设计
       
        图2为悬挂系统控制框图,以TMS320F28027为控制芯片,利用L298N驱动两个步进电机。步进电机采用42HS4813A4,其额定电流为1.3A,步距角为1.8°,利用LCD-12864液晶显示被控制物的实时坐标。控制2个步进电机正向、反向转动来达到物体在平面内任意运动的效果。
       
       
        图1悬挂系统的模型

       
       
        图2悬挂系统控制框图
         

         
        2硬件电路设计
       
        2.1 L298N
       
        L298N是ST公司生产的一种高电压、大电流电机驱动芯片。图3为L298N模块的电路原理图。该芯片的主要特点是:工作电压高,其最高工作电压可达46V;输出电流大,瞬间峰值电流可达3A,持续工作电流为2A;内含两个H桥的高电压大电流全桥式驱动器。利用2个L298N来分别控制2个步进电机,步进电机的额定电流为1.3A,同时通2相时,电流为2.6A,L298N可以达到42HS4813A4步进电机的电流要求。
       
       
        图3 L298N模块电路原理图

         
        2.2绝对式编码器
       
        绝对式编码器的精度必须要高于步进电机的精度,所以这里采用的是10位绝对式编码器。选用的型号是Mini1024J,精度为10位,优点在于采用无接触霍尔检测技术,传感器运行不受灰尘或其他杂物影响,很好克服了基于光学检测原理的缺点。
       
        3系统软件设计
       
        3.1几何关系1:从任意点移动到任意点算法
       
        坐标示意图如图4所示,有如下的边长和角度关系:
       
       
       
        图4坐标示意图

       

         
        3.2几何关系2:当前位置坐标显示算法
       
        如图5所示,存在以下的角度和边长关系:
       
       

         
        控制代码如下:
       
       
        图5坐标示意图

        3.3电机位置闭环控制方法
       
        步进电机闭环控制框图如图6所示,TMS320F28027分别用2个定时器来控制两个电机,用绝对式编码器对位置进行监控,进行失步补偿,保证位置正确,并且可以使曲线圆滑。
       
       
        图6步进电机闭环控制框图

         
        步进电机的型号为42HS4813A4,为了防止失步,步进电机每步的最小间隔为4ms,并且用软件对步进电机进行了十六细分,即每步的间距为0.45°。控制电机部分的程序流程图如图7所示。
       
       
        图7控制电机部分的程序流程图

         
        控制代码如下:
       
       

         
        3.4画图算法
       
        利用几何关系任意点到任意点的算法,分别给处理器一连串的位置坐标,控制物体的运动轨迹,如图8所示。
       
       
        图8画圆取点示意图

         
        相同间隔取N个点,分别输入处理器,来控制物体的坐标。将取的点传递给TMS320F28027时,为了让圆足够的平滑,消去锯齿状,所以在圆上取了200个点。控制代码如下所示:
       
       

         
        4系统测试
       
        系统完成后,进行了两项测试,分别是画圆运动和运动到指定点。
       
        其中画圆运动测试是在输入圆心坐标以及半径后,对实际画出圆的直径与理论直径作了对比,并且记录了画圆的耗时。此测试中,圆心坐标为(40.0cm,40.0cm),输入的半径值为30.0cm,测试结果如表1所列。
       
       
        表1画图运动测试结果
       

         
       
        其中,运动到指定点测试是以坐标原点为起始点,在输入指定坐标之后,对原点到指定点距离的理论值和实际值作了对比,并且记录了运动完后回到原点的误差距离,即是否能准确回到原点。在此测试中,运动的原点坐标为(0cm,0cm),目标坐标为(49.0cm,50.0cm),即距离原点为70.0cm,实际测试时,运动到(49.1cm,49.2cm),即距离原点69.5cm,测试结果如表2所列。
       
       
        表2运动到指定点测试
       

         
       
        由测试结果可看出,该系统具有高效、稳定、准确的优点,符合实验预期。
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友 微信微信
收藏收藏 分享分享 支持支持 反对反对
您需要登录后才可以回帖 登录 | 注册

本版积分规则

小黑屋|文字版|手机版|DIY编程器网 ( 桂ICP备14005565号-1 )

GMT+8, 2024-12-25 01:26 , 耗时 0.093730 秒, 21 个查询请求 , Gzip 开启.

各位嘉宾言论仅代表个人观点,非属DIY编程器网立场。

桂公网安备 45031202000115号

DIY编程器群(超员):41210778 DIY编程器

DIY编程器群1(满员):3044634 DIY编程器1

diy编程器群2:551025008 diy编程器群2

QQ:28000622;Email:libyoufer@sina.com

本站由桂林市临桂区技兴电子商务经营部独家赞助。旨在技术交流,请自觉遵守国家法律法规,一旦发现将做封号删号处理。

快速回复 返回顶部 返回列表