DSP和ARM的音圈电机伺服控制系统设计

发布者:糖果龙猫最新更新时间:2021-01-10 来源: eefocus关键字:DSP  ARM  音圈电机  伺服控制系统 手机看文章 扫描二维码
随时随地手机看文章

为满足项目在控制性能和通信方式等方面的要求,提出了一种基于浮点DSP和ARM的音圈电机双核驱动控制器硬件结构,用于实现激光定位和扫描用音圈电机的位置伺服控制。根据DSP和ARM的特点,对其进行功能划分和详细的设计。


1 系统硬件结构


驱动控制器采用DSP+ARM的结构,与信号采集电路和功率驱动电路配合共同完成音圈电机的驱动控制。选用TI公司的32位浮点型DSP TMS320F28335作为主处理器,最高工作频率为150 MHz;选用ST公司的32位互联型产品ARM核STM32F107作为协处理器,最高工作频率为72 MHz。选用高性能的集成H桥芯片LMD182000,结合其外围电路构成功率驱动电路部分。选用集成芯片,一方面可以简化电路的设计;另一方面还可以提高电路设计的可靠性。位置信号检测选用光耀博晨公司的20位绝对式旋转编码器BCE105AK25M,分辨率为7.5角秒。系统的硬件结构图如图1所示。



2 系统设计


根据系统的要求以及DSP和ARM各自的特点,为了充分利用其资源,对系统进行了详细的功能划分和模块化设计。


2.1 系统功能划分


本课题来源于“地下金属矿设备精确定位与智能导航”项目,拟通过二维激光定位和导航基站对地下金属矿设备进行精确定位和导航,音圈电机用于二维基站俯仰方向激光的定位和扫描。系统除了要完成音圈电机的驱动控制,还需要完成水平方向电机的位置环控制算法,并与地下金属矿设备(以下简称上位机)之间进行以太网数据交换。课题中,音圈电机的型号为VARS002203200A,主要参数如下:总行程为32°,最大输出转矩为0.22 N·m,最大电流为1.4 A,最大电压为15.5 V。


TMS320F28335是32位浮点型数字处理器,指令周期约为6.67 ns,适合复杂高速的计算。STM32F107是意法半导体的互联型系列微控制器产品,集成了很多高性能工业标准接口。其中,包括两个12位A/D(模数)转换器、1个以太网10/100 Mbps MAC模块 、3个SPI接口。系统中DSP主要完成系统初始化、位置控制算法,ARM主要完成PWM波产生、A/D采集控制、电流环计算、以太网通信、电机限位和过流保护,以及DSP之间的数据交换等。从DSP的角度,ARM可以看做是其协处理器。系统控制功能划分图如图2所示。



2.2 ARM功能设计


根据2.1节中的功能划分,来介绍ARM部分功能模块的设计。


2.2.1 PWM模块设计


STM320F107[6]具有一个16位的可产生电机控制PWM波的定时器,能设置死区时间,同时还能进行急停处理,因此采用STM320F107定时器模块的增减计数器、比较寄存器和比较器来实现PWM波的产生。为了防止功率驱动电路中上下管直通造成电源短路,可以通过配置定时器模块的死区寄存器,在PWM信号中加入死区,使同相的上下桥臂驱动信号错开一个死区时间,防止功率器件短路。PWM模块与LMD182000功率驱动电路配合使用,即可完成音圈电机的驱动。功率驱动芯片LMD182000只需要来自ARM的3个信号驱动控制信号,分别是PWM信号、方向信号、刹车信号。


2.2.2 通信接口模块设计


串行外设接口[7](SPI)是TMS320F28335中一个高速同步的串行输入/输出接口,允许可编程位长的串行位流以可编程的位传输率移入或移出设备。DSP和ARM之间采用SPI进行数据交换,连接方式如图3所示。



SPI可以工作于主控制器模式,也可以工作于从控制器模式,工作模式决定了SPICLK信号的来源。系统中设计DSP为主控制器,控制SPICLK(时钟)信号引脚,为整个串行通信


网络提供串行时钟,可以在任何时刻启动数据传送。数据将从SPISIMO(从控制器输入,主控制器输出)引脚输出,并锁存SPISOMI(主控制器输入,从控制器输出)引脚输入的数据。而SPISTE引脚作为从SPI控制器的片选控制信号,主控制器发送数据给从控制器之前将SPISTE引脚置为低电平,待数据发送完毕后再将SPISTE引脚置为高电平。为实现系统与其他数字设备之间的数据传输和交换,还设计了CAN、100 Mbps以太网接口等。


2.2.3 电机限位和过流保护


考虑到系统运行安全,需要对系统进行限位和过流保护设计,本设计通过软件监控来实现保护。过流保护,即把每次采样的电流和允许的最大电流值进行比较,当采样值大于最大电流值时,对功率电路进行管理。有两种处理方法:其一,直接封锁PWM信号,关断功率电路的各功率管,并给出过流指示;其二,功率驱动芯片LMD182000自带刹车功能,只需通过ARM使能LMD182000的刹车引脚,便可使功率管处于关断状态,然后给出过流指示。限位保护,即把每次采集到的实时值和目标指令值分别与设定极限值比较,若实时位置超出设定极限值,且目标指令值在极限值之内,则利用位置环使其跟随目标值。若目标指令值超出设定极限值,则把极限值设为新的目标指令值。


2.3 DSP软件设计


按照系统的功能划分,主要的控制和通信功能已由ARM来完成,DSP主要完成系统初始化、通信、位置控制算法。DSP的软件设计遵循自上而下的思路,按功能划分了软件模块。DSP程序包括:主程序、系统初始化子程序、定时器T0中断服务程序等。


2.3.1 DSP主程序


DSP主程序主要完成系统的初始化、定时器中断配置、启动定时器、等待定时器中断。系统初始化包括时钟初始化、外设初始化、中断服务程序初始化等。当定时器中断产生时,程序转向执行中断,完成位置控制算法。


定时器时间即位置控制算法的调节周期,根据实时位置的采样周期来确定。定时器时间若设置过短,频繁的调节会造成系统的不稳定;若过长,则无法达到好的调节效果,本实验中定时器时间选择为采样周期的4倍。主程序流程图如图4所示。



2.3.2 定时器T0 中断程序


定时器T0中断程序主要完成位置环的计算。根据课题中音圈电机系统的特点,位置环采用积分分离式比例和积分(PI)控制算法[810],为减小累计误差对系统的影响,采用增量式PI控制。


位置调节器的输出可表示为:



其中KP、KI分别为位置调节器的比例、积分系数;en为第n次采样的偏差;β=1e(k)≤ε0e(k)>ε为积分项的开关系数,ε为根据实际情况设定的积分分离阈值。


当电机的实际位置与给定期望位置的误差小于一定值时,再恢复积分校正环节,以便消除系统的稳态误差,保证伺服电机位置控制的精度。


3 实验结果


DSP+ARM双核控制器硬件电路经过测试可用,并在控制器上实现了相关控制算法,验证了算法的可行性,系统响应速度快,稳态精度高。据统计,稳态精度能达到30 s。图5为阶跃响应实验曲线。图6表明,系统受到外界干扰后能迅速恢复到原平衡位置,抗干扰能力强。




结语


本文提出了一种基于浮点DSP和ARM的音圈电机驱动控制器,完成了用于激光定位和扫描的音圈电机位置伺服控制。实验结果表明,系统具有较好的稳、动态性能以及抗干扰能力,可以满足系统的要求。通过功能的合理划分,实现了资源的合理配置;ARM的运用,大大简化了硬件设计,分担了DSP的计算任务,保证了控制系统的实时性。


关键字:DSP  ARM  音圈电机  伺服控制系统 引用地址:DSP和ARM的音圈电机伺服控制系统设计

上一篇:新手必看,关于ARM的几个常用概念
下一篇:ARM9的超高频读写器基带编解码设计

推荐阅读最新更新时间:2024-11-13 12:19

ARM 11 裸奔之一 LED循环点亮
init.s ; 注: IMPORT 之前需要有一个空格,否则编译不能通过 IMPORT Main AREA |C$$code|,CODE,READONLY global start start bl Main END main.c #include stdio.h #define rGPMCON (*(volatile unsigned*)(0x7F008820)) #define rGPMDAT (*(volatile unsigned*)(0x7F008824)) #define rGPMPUD
[单片机]
华睿1号芯片研发工作顺利完成 解决国产雷达装备处理无“芯”之痛
 “华睿1号”是中国电科14所牵头研制的国内首款具有国际先进水平的高端四核DSP芯片,填补了我国多核DSP领域的空白。下面就随单片机小编一起来了解一下相关内容吧。 经过七年艰苦卓绝的奋斗,芯片设计、软件开发、平台研制、应用验证等工作顺利完成,目前华睿1号信号处理平台已成功应用于十多型雷达产品中,为我国雷达装备高端处理芯片国产化写下浓墨重彩的一笔。往昔历历在目,今朝点点于心。 筚路蓝缕,开拓创新,华睿1号芯动出岫 相信“华睿1号”项目团队的所有成员仍会清晰记得2010年12月27日北京人民大会堂北京厅里那场振奋人心的“核高基”重大专项---“华睿1号”DSP芯片发布会。那一天,我所正式对外宣布“华睿1号”这颗备受集成电路业界瞩
[单片机]
ARM发布Mali-C71图像信号处理器,推动下一代汽车图像处理
ARM今天正式发布Mali-C71图像信号处理器(ISP),应对汽车图像处理所面临的挑战,包括在极端条件下对图像进行快速的处理和分析,符合严苛的汽车安全标准的设计要求。Mali-C71也是ARM Mali Camera系列的第一款产品。 随着技术的演进,汽车已经成为一个充满活力的创新平台,不仅正在改变驾驶者的体验,也使得真正的自动驾驶离我们越来越近。先进驾驶辅助系统(ADAS)是这一技术演进的一个不可或缺的关键。一些最新的ADAS应用,例如更先进的后视镜、驾驶员疲劳检测以及行人保护系统,都对车内图像处理提出了更高的要求。这些技术要求更多数量的车内摄像头;据Strategy Analytics的预计,在未来几年内,绝大部分市售高端
[汽车电子]
ARM芯片详解翻译
译者注:这篇文章主要介绍了Risc结构的PDA芯片组成和汇编程序,翻译不周,肯定有错误,请多包涵,另外我忘记了出处,这里向作者表示歉意。 RISC处理器被广泛应用在小型设备上,例如PDA,移动电话,智能热水器等。有很多关于RISC处理器的汇编程序,但最常见的还是ARM。 下面我要谈的是ARM 7,因为我研究的是这个。 让我们先了解一下ARM的架构。ARM处理器包含37个寄存器:31个通用的32位寄存器,以及6个状态寄存器。寄存器的设置取决于处理器状态。ARM状态执行32位指令,Thumb状态执行16位指令集。 在ARM状态,有18个寄存器可用:可供直接存储的R0―R15,CPSR(当前程序状态寄存器),SPSR(被存储程
[单片机]
Arm任命 Rene Haas为新任首席执行官
2月8日,Arm宣布其董事会已经任命Rene Haas成为新任首席执行官,并加入董事会。此项人事任命即刻生效。Rene Haas拥有35年丰富的半导体行业经验,他将接任已为Arm服务30年的原首席执行官与董事会成员的Simon Segars。短期内,Simon Segars仍将担任公司的顾问,支持领导层交接工作。 软银集团董事长兼首席执行官孙正义表示:“在Arm准备重新上市的阶段,Rene是带领Arm加速增长的合适领导者。我在此要感谢Simon过去30年的领导力以及对公司的贡献与投入。” Rene Haas表示:“在Arm的市场机遇空前蓬勃的此刻,我很荣幸能带领世界上最具影响力的科技公司。作为行业内最普及的计算架构的创新者
[半导体设计/制造]
英数字部长:英国正在评估向英伟达出售Arm的影响
据路透社报道,英国数字部长卡罗琳·迪尼纳奇(Caroline Dinenage)表示,英国正在评估将芯片设计公司Arm出售给美国公司英伟达的影响,包括后者承诺将Arm总部和员工保留在英国东部的剑桥。 早些时候她告诉议员说:“我们目前正在了解这一举动的全部影响及其对未来的潜在影响,由此,我们才可以考虑采取什么步骤。” 按市值计算,美国最大的芯片公司英伟达已同意以400亿美元的价格从日本的软银手中收购ARM 。 迪尼纳奇说,部长们会考虑软银和英伟达做出的将Arm保持为英国企业的承诺,而且政府已经与有关方面进行了讨论。 她说,是否介入交易的决定将由负责数字,文化,媒体和体育的国务大臣在考虑相关信息后作出。
[手机便携]
gsm库(libgsm)在ARM-Linux下的移植
GSM是常见的VOIP的语音编解码库,在Linux下用libgsm来实现。在项目中需要用到libgsm库。因此试着直接编译GSM库来编译.官网已经停止服务了,因此在这个网址下了最新版来编译 解压后发现,这个Makefile是一个手写而非 Au toconf生成的Makefile,并且只有编译静态库,而没有常见的动态库的Makefile. 因此将其修改一下,使用其能在ARM编译并且成动态库。这也是一个典型的Makefile的修改练习,如果想编译成静态库,简单把 LIBEXT 改成 a即可 # Copyright 1992-1996 by Jutta Degener and Carsten Bormann, Technis
[单片机]
gsm库(libgsm)在<font color='red'>ARM</font>-Linux下的移植
Arm中国澄清华为事件:从未断货,仍在合作
注:文章头图及文内配图由作者本人拍摄。 近日,虎嗅在Arm中国的上海办公室进行了一场独家专访。在这次专访中,Arm中国发言人、市场部负责人梁泉,首次以Arm中国官方的身份,向虎嗅澄清了此前华为事件中的部分细节,以及与华为合作的最新状态。 今年5月23日,我们就曾经就Arm在整个华为事件中的关键角色进行报道(《 Arm也喊停,这对华为影响有多大? 》),当时Arm仅针对此事件做了简单的回复, 而在本次采访中,梁泉针对华为的合作进行了多个说明。笔者总结一下,以下是最关键的几点: 而在本次采访中,梁泉针对华为的合作进行了多个说明,以下是最关键的几点: ● Arm公司和Arm中国断供华为是不实的。在华为事件发生之后,Ar
[半导体设计/制造]
<font color='red'>Arm</font>中国澄清华为事件:从未断货,仍在合作
小广播
设计资源 培训 开发板 精华推荐

最新单片机文章
何立民专栏 单片机及嵌入式宝典

北京航空航天大学教授,20余年来致力于单片机与嵌入式系统推广工作。

换一换 更多 相关热搜器件
更多往期活动
随便看看

 
EEWorld订阅号

 
EEWorld服务号

 
汽车开发圈

电子工程世界版权所有 京B2-20211791 京ICP备10001474号-1 电信业务审批[2006]字第258号函 京公网安备 11010802033920号 Copyright © 2005-2024 EEWORLD.com.cn, Inc. All rights reserved