福州专业建站,网站开速度几秒,找人搭建网站多少钱,手机派网站提示#xff1a;文章写完后#xff0c;目录可以自动生成#xff0c;如何生成可参考右边的帮助文档 目录 一、实验目的二、实验方法三、实验设计1.实验器材2.电路连接3.软件设计#xff08;1#xff09;实验变量#xff08;2#xff09;功能模块a#xff09;电机接收信号… 提示文章写完后目录可以自动生成如何生成可参考右边的帮助文档 目录 一、实验目的二、实验方法三、实验设计1.实验器材2.电路连接3.软件设计1实验变量2功能模块a电机接收信号计算b电机速度计算 四、实验步骤1.系统辨识2.加权函数设计3.合成控制器4.控制器降阶5. 检查闭环系统稳定性6. S/T的Bode图7. 转换为离散控制器 五、实验结果1.阶跃响应2.抗阶跃干扰3.抗正弦干扰 一、实验目的 本实验采用H∞混合灵敏度算法设计直流电机速度控制器并通过stm32f407单片机进行实物控制具体满足以下要求
1.通过开发板上按键实现正反转控制通过螺旋电位器实现电机加减速控制
2.使电机具有足够的稳定裕度和良好的跟踪性能
3.能够抑制0.1Hz以下的低频干扰二、实验方法 H∞控制是指设计一个控制器K使闭环系统稳定且干扰对系统期望输出影响最小所以利用H∞范数传递函数的H∞范数可以描述输入到输出的最大增益作为目标函数对系统进行优化设计。 图1 H∞控制框图 图中P为广义控制对象P0为系统被控对象K为控制器v为控制器输入u为控制器输出w为外部输入包括参考信号和外部扰动z为系统输出。 基于混合灵敏度 S /TS 为灵敏度T 为补灵敏度的 H∞ 控制器设计方法折中考虑了系统摄动带来的系统稳定和系统性能问题对于结构不确定的系统是行之有效的设计方法。为了借助计算机求解控制器需要把混合灵敏度问题转化为标准的 H∞ 优化问题。 图2 S/T混合灵敏度控制框图 在S/T混合灵敏度控制中所得的稳定控制器必须最小化 其中其中w1是S的加权函数w2是T的加权函数。对于H∞次优控制中上式等价于 因此S/T 加权函数w1和w2的选取成为影响控制器控制效果的重要因素。S与系统跟踪性能和抗干扰能力相关因此需要在低频范围增大w1内使S的增益变小。T与系统的鲁棒性和抗噪声干扰能力相关因此需要在带宽以外增大w2以降低T的幅值。
三、实验设计 本实验设计结构框图如下 图3 实验结构框图 1.实验器材 图4 实验器材 硬件 1.STM32F407ZGT6开发板 2.L298N电机驱动模块 3.直流空心杯电机(12V2000线) 4.螺旋电位器 软件 1.IDEMDK-Keil 软件 2.MATLAB 3.串口助手
2.电路连接 图5 电路接线图 1按键KEY0与单片机PE4引脚相连用于电机正反转控制。 2螺旋电位器通过单片机开发板3.3V电压供电并与单片机PF7引脚相连用于电机调速。 3H桥驱动电路通过单片机开发板3.3V电压供电其中的IN1、IN2引脚与单片机PF3、PF5引脚相连OUT1和OUT2引脚与直流电机IN1和IN2引脚相连实现电机的正反转控制H桥驱动电路使能端EN A引脚与单片机PB6引脚相连接收单片机输出的PWM信号实现电机的调速功能。 4直流电机编码器Encoder A、Encoder B引脚通过单片机开发板5V供电并与单片机PA6、PA7引脚相连以读取电机的速度反馈。
3.软件设计
1实验变量 实验主要定义以下变量 图6 实验定义的变量 其中输入信号scmd决定电机最终的速度actual_speed用于表示电机实际速度output_cmd用于记录控制器输出信号DIR用于记录电机方向。并进行以下初始化 图7 程序初始化 其中通过设置定时器TIM6进行中断操作(测速、计算控制器输出)中断周期为0.01s。定时器TIM4设置为PWM模式用于控制直流电机的速度。定时器TIM3设置为编码器模式用于读取编码器信号。初始化ADC3通过PF7引脚读取旋螺电位器的输入电压并转化成速度参考信号scmd。
2功能模块
a电机接收信号计算 电机接收的信号有PWM信号和方向信号具体代码如下 图8 电机PWM信号和方向信号计算代码 根据输入速度信号速度参考信号scmd、控制器输出信号output_cmd的正负判断电机速度并用变量DIR记录。当DIR0时电机正转单片机PF3引脚置位PF5引脚复位当DIR1时则相反。根据输入速度信号的模值计算PWM占空比用变量PWMVal记录并通过定时器TIM4产生所需的PWM脉冲从PB6引脚输出到电机驱动模块。
b电机速度计算 图9 电机速度计算代码 实验中定时器周期为0.01s每个周期需要计算电机每分钟转速因此将PA6、PA7接收到的脉冲信号乘以6000电机编码器为2000线4倍频后为8000所以再除以8000计算每分钟转速。
四、实验步骤
1.系统辨识 实验中通过向电机输入伪随机二进制序列PRBS并通过最小二乘法计算直流电机传递函数共采取1200组输入、输出数据 图10 电机输入PRBS信号与输出速度 假定该直流电机为5阶利用上述数据使用最小二乘法LSM计算出该直流电机传递函数为 该系统的Bode图为 图11 直流电机Bode图 2.加权函数设计 根据实验目标设计以下加权函数
|w1|-1 和|w2|-1和的Bode图如下 图12 |w1|^-1和|w2|^-1的Bode图 3.合成控制器
根据图2采用H无穷混合灵敏度方式合成控制器使用matlab计算出的控制器传递函数为 4.控制器降阶 在嵌入式应用程序中资源是有限的。高阶意味着计算复杂度采样周期更长。因此需要降低控制器的阶数而不显著失去它的属性本实验采用平衡截断的方式(balanced truncation)将控制器降到4阶
5. 检查闭环系统稳定性 计算闭环传递函数的极点如果全在负半轴则系统稳定 图13 系统闭环极点 6. S/T的Bode图 将降阶后的控制器(4)带入整个闭环系统画出S/T灵敏度/灵敏补的Bode图 图14 灵敏度和灵敏补的Bode图 7. 转换为离散控制器 将控制器(4)转换为离散控制器采样周期和控制器中断周期相等(T0.01s)
五、实验结果 将上述控制器(5)通过stm32f407zgt6单片机实现以控制直流电机速度结果如下。
1.阶跃响应 阶跃响应效果如下 图15 阶跃响应效果 其中红线为速度参考信号黄线为实际电机速度。
2.抗阶跃干扰 为测试所设计的H∞控制器的抗干扰能力应用该算法的直流电机启动后5秒后加入1V阶跃干扰实验效果如下 图16 抗阶跃干扰效果(阶跃响应5s后加入1V阶跃干扰) 3.抗正弦干扰 电机启动后在控制器后加入频率为0.1Hz、幅值为1V的正弦干扰结果如下所示 图17 抗0.1Hz、1V正弦干扰 从上图可以看出该H∞控制器基本可以抑制0.1Hz、1V的正弦干扰。
