stm32,倒立摆,pid资料,MATLAB仿真自动生成代码 资料合集,包括但不限于,pid学习资料,倒立摆学习资料和倒立摆原理图pcb,MATLAB仿真自动生成代码。
倒立摆这玩意儿看着玄乎,其实搞过机器人的朋友应该都不陌生。当年我第一次见实验室学长玩这个的时候,那摆杆在电机驱动下稳稳竖着,跟变魔术似的。后来自己上手才发现,核心就藏在PID这三个字母里。
先说说硬件部分。咱用STM32F4做主控,TB6612驱动直流电机,MPU6050负责角度采集。原理图上最精妙的是那个双电源设计——数字电路和电机驱动必须物理隔离,不然电机一启动,单片机直接表演当场去世。这里贴个角度采集的核心代码:
float Get_Angle(void) { MPU_Get_Data(); float acc_angle = atan2(accY, accZ) * 180/PI; gyro_rate = gyroX / 131.0; return 0.98*(last_angle + gyro_rate*dt) + 0.02*acc_angle; }这个互补滤波算法比卡尔曼滤波更适合新手,0.98和0.02这两个权重参数就像调鸡尾酒,陀螺仪积分负责保口感(动态响应),加速度计负责提香(静态精度)。调试时发现dt时间间隔必须精确到毫秒级,不然角度计算会飘得亲妈都不认识。
PID控制才是重头戏。最开始用位置式PID翻车N次后,果断切到增量式算法。上段实际跑通的代码:
typedef struct { float Kp,Ki,Kd; float Err,LastErr,PrevErr; } PID; float PID_Calc(PID *pid) { float increment = pid->Kp*(pid->Err - pid->LastErr) + pid->Ki*pid->Err + pid->Kd*(pid->Err - 2*pid->LastErr + pid->PrevErr); pid->PrevErr = pid->LastErr; pid->LastErr = pid->Err; return increment; }这里有个坑爹的细节:输出限幅!刚开始没加限制,电机直接满速狂转,摆杆飞出去把隔壁组的示波器屏幕砸出个流星痕。后来在PWM输出前加个if判断,世界顿时清净了。
Matlab仿真能救命这话真不是吹的。用Simulink搭建模型时,发现角度微分环节加上噪声滤波后,系统响应明显稳了很多。自动生成代码的骚操作更绝——配置好硬件支持包,点个生成按钮,直接出带底层驱动的工程文件。对比下自己手写的初始化函数:
% 自动生成代码配置 cfg = coder.config('ert'); cfg.Hardware = coder.hardware('STM32F4xx'); cfg.GenerateReport = true;生成的GPIO初始化代码比人工写的规范多了,特别是时钟使能那部分,自己写老是忘记开启AHB1外设时钟。不过自动生成的PID算法略显臃肿,得手动优化下乘除运算,毕竟STM32没有硬件浮点单元。
调参过程堪称玄学现场。白天调好的参数,晚上温度降个几度,摆杆又开始抽风。后来发现Kp系数跟电压强相关,电池掉到7.4V以下就得重新整定。最终方案是ADC实时监测供电电压,动态补偿控制量——这招是从大疆电调方案里偷师的。
倒立摆站起来的瞬间,那感觉比通关黑魂还爽。但别急着庆祝,马上尝试施加干扰力(比如用手轻推),这时候才能看出控制器的鲁棒性。有个邪门现象:有时候参数越调越差,还原到之前的版本反而更稳,可能这就是玄学PID的奥义吧。
完整工程里还藏了个彩蛋:用蓝牙模块传输实时角度数据到手机,在APP上画波形图。这功能看似装逼,实际调试时比串口助手直观十倍。当看到阶跃响应曲线终于呈现完美衰减震荡时,老铁们把"稳了"打在公屏上!