逻辑概述
这里采用的是5ms一次的外部中断,用的是6050对应的INT引脚,通过外部中断进行定时的读取的6050的欧拉角变化,也就是PITCH,YAW,ROLL三个角,再在进行相应的车体调整,那么车体调整的核心就是PID的控制,这里用的串级PID,流程图很多地方也都有,如果想了解原理的小伙伴可以去找找,内外环,内环速度环,外环角度环。看你平衡车的好与坏最重要的就是看PID调参之后所反应的车体的变化,通过肉眼可见的车体变化角度,来判断你的PID调参是否过关。
以上便是大致的逻辑概述,第一次写文很多缺点,希望大家能共同进步,有不好的地方或者不理解的代码处可以直接评论区留言。
|