基于角速度环、角度环和速度环的串级控制方案，使小车能够在电磁赛道上面平稳运行，还有环岛识别程序，可靠稳定。程序在中断里实现周期控制，速度控制100ms，角度控制10ms，角速度控制2ms。
2021-12-12 15:34:41
278KB
1
陀螺原理:
陀螺是一个古老的学科， 自 1852 年， 傅科将高速旋转刚体命名为陀螺， 至今已有 160 年左右的历史。陀螺连同其支撑框架总体被称作陀螺仪。 陀螺具有独特的力学特性， 如定轴性、进动性和陀螺动力效应等，因而常 被作为陀螺稳定装置的敏感元件或者执行元件。 陀螺稳定装置是一种以陀螺为 敏感元件或执行元件，使被稳定对象在干扰因素作用下能相对大地坐标系保持 方位不变或者在指令力矩的作用下使其按照给定规律相对惯性空间转动的陀螺 装置。 陀螺稳定装置按照陀螺力矩在稳定装置中的作用， 可分为直接式陀螺稳定装置、间接式陀螺稳定装置、 动力式陀螺稳定装置、 指示式陀螺稳定装置和指 示-动力式陀螺稳定装置。直接式陀螺稳定装置是一种用陀螺力矩抵抗作用于被 稳定对象上的干扰力矩，而使被稳定对象相对惯性空间保持方位的稳定的陀螺 稳定装置。 在这类稳定装置中， 陀螺是直接抵抗干扰力矩装置的执行元件。
下图为独轮车结构:
本设计所研究的是基于惯性飞轮的自行车侧向平衡控制。
下图为本实验平台:
飞轮平衡效果测试视频:
自行车初步行走测试视频:
主控采用STM32f103RCT6,传感器采用的是MPU6050，姿态解算采用的是卡尔曼滤波，侧向飞轮控制采用的是角度-角速度串级PID控制。
工程编译环境为IAR7.3~7.6,软件百度云下载地址为:https://pan.baidu.com/s/1skT57at
代码提供了必要的注释，PID控制器示例代码如下:
float PID_Control(PID_Controler *Controler)
{
/*******偏差计算*********************/
Controler->Last_Err=Controler->Err;//保存上次偏差
Controler->Err=Controler->Expect-Controler->FeedBack;//期望减去反馈得到偏差
if(Controler->Err_Limit_Flag==1)//偏差限幅度标志位
{
if(Controler->Err>=Controler->Err_Max) Controler->Err= Controler->Err_Max;
if(Controler->Err<=-Controler->Err_Max) Controler->Err=-Controler->Err_Max;
}
/*******积分计算*********************/
if(Controler->Integrate_Separation_Flag==1)//积分分离标志位
{
if(ABS(Controler->Err)<=Controler->Integrate_Separation_Err)
Controler->Integrate+=Controler->Ki*Controler->Err;
}
else
{
Controler->Integrate+=Controler->Ki*Controler->Err;
}
/*******积分限幅*********************/
if(Controler->Integrate_Limit_Flag==1)//积分限制幅度标志
{
if(Controler->Integrate>=Controler->Integrate_Max)
Controler->Integrate=Controler->Integrate_Max;
if(Controler->Integrate<=-Controler->Integrate_Max)
Controler->Integrate=-Controler->Integrate_Max ;
}
/*******总输出计算*********************/
Controler->Last_Control_OutPut=Controler->Control_OutPut;//输出值递推
Controler->Control_OutPut=Controler->Kp*Controler->Err//比例
+Controler->Integrate//积分
+Controler->Kd*(Controler->Err-Controler->Last_Err);//微分
/*******总输出限幅*********************/
if(Controler->Control_OutPut>=Controler->Control_OutPut_Limit)
Controler->Control_OutPut=Controler->Control_OutPut_Limit;
if(Controler->C
2021-11-20 12:29:56
229.51MB
1
针对火电厂主汽温控制系统中被控对象具有大延迟、大惯性特点，模糊控制和常规PID很难达到理想的控制要求，在Simulink环境下，将模糊控制、PID控制和串级控制结合起来，设计了主汽温串级模糊控制策略和模糊自适应PID控制器，实现了PID控制器参数的在线自整定。仿真结果表明：模糊自适应PID串级控制比常规PID串级控制具有超调量小、调节时间短，抗干扰能力强，且具有较强的鲁棒性，对实际工程应用具有一定的参考价值。
2021-10-17 09:36:23
1.52MB
1
通过本课程设计，使学生能较好的运用过程控制的基本概念、基础理论与方法，根据大型火电机组的生产实际，对火电机组的过程控制系统进行分析，设计出原理正确，功能较为全面的300MW火电机组协调控制系统。
2021-07-22 09:03:38
5.03MB