基于TMS320F2407的主动振动控制系统

liyf · 发表于 2014-10-5 10:04:47

基于TMS320F2407的主动振动控制系统

摘要：基于机械振动理论和控制理论，以TMS320F2407为核心处理器建立了一种数字式主动振动控制系统。设计了该系统硬件电路，并用软件实现了控制策略。实验表明，该系统有效地解决了主动振动控制的实时性问题，并使系统具有较强的适应性，隔振效能大大提高。 关键词：主动振动控制 TMS320F2407 实时性
主动振动控制具有隔振率高、适应性强、可抗强冲击振动等优点，可使关键设备在恶劣冲击振动环境下可靠工作。但是，主动振动控制系统对相位要求较为严格，要求系统具有极强的实时性，否则由于相位滞后，控制效果将会受到严重影响。因而在数字式主动振动控制系统中，通常在单片机难以达到实时性要求，本文采用高速DSP器件解决控制的实时性问题。
ＴＭＳ３２０ＬＦ２４０７是ＴＩ公司专为实时控制而设计的高性能１６位定点ＤＳＰ器件，指令周期为３３ｎｓ，其内部集成了前端采样Ａ／Ｄ转换器和后端ＰＷＭ输出硬件，在满足系统实时性要求的同时可简化硬件电路设计。本文在总结模拟主动控制系统设计制作经验的基础上，设计了以ＴＭＳ３２０Ｆ２４０７为核心的数字式主动振动控制系统。
１主动振动控制系统及其数学模型
１．１控制系统工作原理
主动振动控制系统模型如图１所示。隔振对象通过弹性体与基础相连接，基础振动（振幅为ｕ）通过弹性体（刚度为ｋ）传递到隔振对象上，引起隔振对象振动。传感器置于二者之间检测相对位移并输入到控制器，控制器输出的控制量经过功率驱动后输出到电磁作动器控制隔振对象的振动，同时控制器根据隔振对象的加速度反馈实时调节控制参数。

１．２系统数学模型描述根据主动振动控制系统工作原理建立的系统振动模型如式（１）所示。为使隔振对象加速度x最小，控制力ｆ的计算式如式（２）所示。其中，ｕ－ｘ为基础和隔振对象相对位移，可通过光电位移传感器（ＰＳＤ）测得。

式中，ｍ为隔振对象质量，x为隔振对象加速度，u为基础加速度，ｋ为隔振弹性体刚度，ｃ为隔振系统阻尼。
系统作用力ｆ由置于气隙磁场中的载流线圈提供。当在线圈上施加电压ｖ时，其上的咯伦兹力ｆ和施加电压Ｖ如式（３）和式（４）所示。

式中，ｂ为气隙磁感应强度，ｌ为线圈有效长度，ｉ为线圈电流ｒ为线圈电阻，l′为线圈电感。
２控制策略及控制器
２．１控制策略
根据系统各部分数学模型可计算出控制电压输出，如式（５）所示。

式中，ｓ为相对位移ｕ－ｘ，s和s分别为相对位移的一次微分和二次微分。在实际应用中，上述控制参数并不能准确得出，而且有些参数如弹性体刚度、磁场强度等并不是恒定值。在控制过程中，先以估算值作为初始值，再以一定控制算法（自整定ＰＩＤ），根据加速度反馈，对控制参数进行实时校正。
２．２控制系统的硬件结构
控制器硬件结构如图２所示。位移传感器（ＰＳＤ）输出信号经由信号处理电路、加速度传感器输出信号经由电荷放大器后，再分别通过ＴＭＳ３２０Ｆ２４０７中的Ａ／Ｄ转换器输入到ＤＳＰ核心中。ＤＳＰ核心根据加速度反馈修正控制参数，由位移输入计算出控制量，进行ＰＷＭ调制后送到ＰＷＭ功率驱动部分，由功率驱动部分驱动电磁作动器进行振动控制。

２．２．１ＤＳＰ及存储器
Ｆ２４０７中集成了３２Ｋ字的ＦＬＡＳＨＥＥＰＲＯＭ和１．５Ｋ字的ＲＡＭ，由于控制算法的需要，本系统需扩充外部ＲＡＭ。ＴＭＳ３２０Ｆ２４０７片内的ＦＬＡＳＨ可用作程序存储器，但在开发阶段使用ＦＬＡＳＨ作为程序存储器极为不便，因为每一次程序的修改都需要对ＦＬＡＳＨ进行清除、擦除和编程操作，而且进行ＣＣＳ调试时只能设置硬件断点，故从调试的角度考虑，应扩充程序ＲＡＭ。为了不增加系统复杂度，从扩充的数据ＲＡＭ中分出一块作为调试时的程序ＲＡＭ。如图３所示，ＣＹ７Ｃ１０２１为６４Ｋ×１６的ＳＲＡＭ，存取时间最小为１０ｎｓ，故不需要插入等待周期，可保证系统全速运行。

在调试时，用跳线短接ＰＳ和与门输入脚，在存储映像文件中将ＣＹ７Ｃ１０２１前３２Ｋ字设为数据ＲＡＭ，后３２Ｋ字设为程序ＲＡＭ，可将程序实时下载到程序ＲＡＭ中进行调试，避免了对ＦＬＡＳＨ的繁琐操作。当开发完成时将ＶＣＣ和与门短接，同时修改映像文件，将６４ＫＲＡＭ全部用作数据存储器，而将程序写入内部ＦＬＡＳＨ中，系统即可脱离开发环境独立运行。
２．２．２传感器处理电路及Ａ／Ｄ变换
加速度传感器和位移传感器输出需进行预处理后再进行Ａ／Ｄ变换。前者输出电荷信号，应用电荷放大器将其转化为电压信号，后者输出微弱的电流信号（数个微安），进行前置放大及相关模拟处理后得到表示位移的模拟电压信号，经过处理的此二路信号分别送入ＤＳＰ片内Ａ／Ｄ转换器的１、２通道进行模／数变换。
２．２．３ＰＷＭ调制及驱动
核心程序计算出控制量后进行ＰＷＭ调制、功率驱动后输出到作动器中。ＰＷＭ调制在片内完成，而功率驱动则需依靠外加的驱动电路来完成。商品化的ＰＷＭ驱动器体积庞大、价格昂贵，在此采用了自制的小功率ＰＷＭ驱动器，其电路图如图４所示。ＩＲ２１１０完成初次驱动，将来自ＤＳＰ的ＴＴＬ电平转化为１２Ｖ电平输出，推动由四个功率管ＩＲＦ３７１０构成的Ｈ桥进行开关动作，Ｈ桥再驱动作动器施加控制力。

２．３控制器软件
２．３．１控制算法
控制算法是整个系统的核心，要求较高的实时性和一定的自适应能力。算法由两部分组成，如图５所示，上半部分根据隔振对象相对位移输入完成控制量的计算，下半部分根据隔振对象加速度反馈完成控制参数的实时优化。算法先根据式（５）估算出各个系数的值，运用ＰＩＤ算法根据隔振对象加速度反馈输入依次对各系数进行校正，得到最优的控制参数。之后脱离ＰＩＤ算法，完全依靠式（５）计算输出。当系统结构或环境发生变化，控制效果变差时，再重新调用ＰＩＤ校正参数。这样既满足了实时性的要求，又提高了适应能力。

２．３．２中断控制
根据系统控制要求，Ａ／Ｄ需定时采样隔振对象加速度和相对位移信号，为提高效率，Ａ／Ｄ转换结果以中断方式读取。因此中断控制包括定时器中断控制和Ａ／Ｄ转换结束中断控制。
ＴＭＳ３２０Ｆ２４０７有二级中断服务程序，分别为通用中断服务程序ＧＩＳＲ和特定中断服务程序ＳＩＳＲ。所有可屏蔽中断分为六级（ＩＮＴ１－ＩＮＴ６），如图６所示。中断产生时，系统通过通用中断向量表自动跳到该中断所属级别的ＧＩＳＲ中，在ＧＩＳＲ中，读取外设中断向量寄存器ＰＩＶＲ的值，根据外设中断向量表，使程序跳转到中断对应的ＳＩＳＲ中。所以进行中断处理需要二级中断向量表（通用中断向量表和外设中断向量表）和二级中断服务程序（ＧＩＳＲ和ＳＩＳＲ）。其中，通用中断向量表必须映射到零地址开始的片内ＦＬＡＳＨ程序存储空间中。

２．３．３ＰＷＭ及Ａ／Ｄ转换接口程序
ＰＷＭ接口程序实现ＰＷＭ初始化，控制输出的ＰＷＭ调制、载波频率、死区宽度等参数的功能。Ａ／Ｄ转换接口程序包括Ａ／Ｄ转换初始化、转换的通道选择、定时启动和数据读取等部分。

３实验测试
根据课题的要求，对５Ｈｚ～２ｋＨｚ范围内的信号进行控制。按照采样定理的规定，采样频率应大于４ｋＨｚ，为精确控制，将系统采样频率扩大到原来的２．５倍，达到１０ｋＨｚ，即系统Ａ／Ｄ转换、控制算法、ＰＷＭ调制均要求在１００μｓ以内完成。ＴＭＳ３２０Ｆ２４０７内置Ａ／Ｄ转换器最小转换周期可达到５００ｎｓ（２ＭＨｚ），ＰＷＭ亦有较高响应速度，经过测试，Ａ／Ｄ转换器和ＰＷＭ完全可以满足要求。ＤＳＰ工作在３０ＭＨｚ时钟下时，速度为３０ＭＩＰＳ，故控制算法要求不能超过３０００条汇编指令，由于控制算法的简化和去除了浮点运算，实际程序没有超过２０００条指令。
本设计解决了主动振动控制系统的实时性问题，提高了系统适应性，简化了电路结构，使得系统隔振率大幅提高。在５Ｈｚ－２ｋＨｚ频段内，对振动的隔振率达到６％以上。

李小路 · 发表于 2021-8-3 19:49:24

谢谢分享！

		自动登录	找回密码
密码			注册

[待整理] 基于TMS320F2407的主动振动控制系统