欢迎您访问程序员文章站本站旨在为大家提供分享程序员计算机编程知识!
您现在的位置是: 首页  >  IT编程

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

程序员文章站 2022-03-07 18:22:19
野火开源平衡车官网板块https://www.firebbs.cn/forum.php?mod=forumdisplay&fid=129&page=1参考资料暂无参考视频(这个群主讲的不错)https://www.bilibili.com/video/BV1j7411z7uX硬件平台开发平台KEIL5, STM32F103X主控,程序用的SWD下载(啥下载器都行,能下载进去就好,用串口下载也是可以的)开发(一)P比例:提高响应速度,减小静态误......

野火开源平衡车官网板块

https://www.firebbs.cn/forum.php?mod=forumdisplay&fid=129&page=1

参考资料

暂无

参考视频(这个群主讲的不错)

https://www.bilibili.com/video/BV1j7411z7uX

硬件平台

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

开发平台

KEIL5, STM32F103X主控,程序用的SWD下载(啥下载器都行,能下载进去就好,用串口下载也是可以的)

开发(一) 

P 比例: 提高响应速度,减小静态误差(因为EP值比EI,ED都要大,值大贡献的值就大,太大直接跑扑街,太小会一直达不到设定点)

(静态误差指 理想值 与真实值 之差, 比例过大,会导致系统振荡,但你想达到目标值,必须围绕这目标值振荡,然后通过其他I,D来逐渐减小振荡幅度, 但你太大他直接振没了(不受ID控制了))

 

I 积分: 消除稳态误差 (积分是累加, 求面积, 主要是积累误差)

有一丁点误差,都会因为累加,变得很大, 直到你的误差消除为0

 

D 微分:减小振荡,以及超调(微分就是求导, 导数就是变化率)

微分越大,阻力就越大, 就越削弱之前的EP比例(也可能含有EI积分值)的幅度值

 

有网友总结到

比例是考虑当前,积分是回顾历史(累计误差),微分是预测未来

 

 

直立环 让小车角度趋近0,小车正立住(PD:比例微分控制)

直立环: 输入(1.给定的角度.2角度的反馈), 输出(PWM直接控制车车)

 

速度环, 让电机速度趋近0,电机不转(PI:比例积分控制)

速度环: 输入(1.给定的速度. 2速度的反馈) ,  输出(角度值,直立环的期望速度输入)

 

先搞MPU6050

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

用到了PB8和9

 

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化\

MPU6050这边设置中断的频率为50HZ,(10ms中断一次 更新电机PWM)

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

 

处理下 MPU6050  10ms来一次的中断(我们用的是PD2)

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

直立环PD控制

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

速度环 PI控制

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

转向环 在直立的时候 约束车车的转向

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

继续编写10ms的MPU6050中断内容

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

 

下面改以下OLED引脚  PB10和PB11

 

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

编写主函数

STM32野火开源平衡小车(五)之外设搭建之PID与MPU6050初始化

 

 

本文地址:https://blog.csdn.net/jwdeng1995/article/details/108177594

相关标签: stm32