我正在尝试构建一个两轮平衡机器人来取乐。我已经构建并组装了所有硬件,并且我认为我也对其进行了编码。我正在使用带有陀螺仪和加速度计的 IMU 来找到我的倾斜角度,并带有一个用于平滑信号的免费滤波器。来自 IMU 的输入信号看起来非常平滑,小于 0.7 方差 + 或 - 实际倾斜角。
我的 IMU 采样率为 50 Hz,我也以 50 Hz 进行PID计算,我认为这应该足够快。
基本上,我使用的是 PID Library 中的PID 库。
当我将 P 值设置为较低的值时,车轮会朝正确的方向前进。
当我将 P 值设置为较大时,我会得到类似图表的输出。