PID算法控制小车转向

1.平衡小车转向控制调试:

角加速度传感器线加速度计:

直立静止时:x和y轴输出为0,z轴为g

存在一定角度时:g会在x和y轴存在分量

在这里插入图片描述

Angle_Y表示角度β,弧度制
Accel_X表示重力加速度在x轴的分量

在这里插入图片描述 

 

 (1)平衡小车转向环使用P(比例控制器)或者PD控制器,转向环是一般 的控制系统,我们只使用P控制器。 

(2)目标是配合直立环和速度换,使小车保持直线行驶。

(3)确定KP的极性,为了方便实验,我们关闭之前的直立环和速度环。 

(4)我们得到MPU6050输出的陀螺仪的原始数据,觉得最大值不会很大,应该在0~2之间。

(5)我们先确定转向控制的极性:
先设置KP=-负0.6  .  我们把小车放在地上,按照顺时针的方向旋转小车,发现小车并没有阻止我们旋转,这并不是我们希望看到的效果。

(6)我们把KP值设置为正的+0.6 。我们按照顺时针去旋转小车,发现特别的困难,
所以我们确定KP的极性为-负的。

(7)我们打开之前设置好直立环和速度环。
先设置KP=0.2,看看小车走直线的效果,发现KP=0.2发现小车走直线的情况是非常不理想的。

(8) 我们把KP设置为0.6看看走直线的效果。
控制转向的效果有所好转,但是也不是很理想。

(9)我们把KP值设置为1.0看看走直线的效果。
我们看到小车走直线的效果已经很理想了

(10)我们把KP值设置为1.6我们再看看效果。
小车走直线的效果不错,但是会低频的抖动,所以我们 选择KP=1.0

 

版权声明:本文为CSDN博主「同学小辜」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
原文链接:https://blog.csdn.net/weixin_49303682/article/details/118686567

生成海报
点赞 0

同学小辜

我还没有学会写个人说明!

暂无评论

发表评论

相关推荐

RT-Thread Studio移植LAN8720A驱动

RTT网络协议栈驱动移植(霸天虎) 1、新建工程 ​ 工程路径不含中文路径名,工程名用纯英文不含任何符号。 2、用CubeMx配置板子外设 2.1、配置时钟 ​ 按照自己板子配置相应时钟。

ESP8266 无限重启踩坑

最近做了一个电子墨水屏万年历,在移植屏幕代码时遇到了esp8266无限软复位的问题,如果你的串口打印是以下图片所示,那么恭喜你问题解决了。 造成软复位的原因是因为,程序里有死循环&#xf

Renode应用:在RISC-V核上运行FreeRTOS

本篇记录通过Renode在RISC-V核上运行FreeRTOS demo的情况。本来不准备写这一篇,但是发现近期工作学习密度实在太大,上周工作的中间结果这周竟然完全想不起来了,不得不又花了一些时间从头摸

Lin总线通信在STM32作为主机代码以及从机程序

距离上次做资料准备已经过去六天了。最近在学车,上周末就没有开电脑。这周开始进行了Lin通信的代码整理,目前是可以正常通信的了,采用的是增强型校验方式。后期再进一步跟进研究。。。更新一博,留