分享经验：兴奋，车子终于站起来了，两天都摇摇晃晃，今天终于站了军姿。

歪腰

一开始觉得自己滤波（卡尔曼）很好：如图但是小车始终震荡、抖动傻傻分不清楚，调理一天的角度P,D，还是站不稳。
换个思路，是不是滤波问题？可是跟随的很好啊？然后想是不是什么数字地啊，模拟地啊在实际站立时干扰了。采集实际站立时的波形，结果：如图蓝色是最终角度，红色是加速度，黄色是陀螺仪。太扯了，我把车模始终保持很小的角度，图上显示会震荡到20几度。然后想怎么去除它们的抖动啊？已经卡尔曼滤过了啊？难道参数不对？可是已经跟随的很好了啊？（ps：本人对于卡尔曼只知道它的功能，不清楚原理。）只好改了改参数，结果，站直了，哈哈哈。不过还有一个疑问：我无论P给多大，车模一样站立，不会出现卓老大说的震荡。D感觉没啥用。
以上只是个人的想法，如果有些低级错误请轻喷！

上高第二个军长

溜溜溜溜溜溜溜溜溜溜溜溜遛遛遛

zhou1994

为什么很大范围的p没有效果呢，因为你用的E车，因为你的p还不够大，d参数，没有用那也是你数字还不够大。大了就会高频振动。

司飞1096375602

楼主，我有同样问题，怎样改卡尔曼参数啊？看着你的波形很好了啊

歪腰

zhou1994 发表于 2015-4-22 16:41
为什么很大范围的p没有效果呢，因为你用的E车，因为你的p还不够大，d参数，没有用那也是你数字还不够大。大 ...

受教了了。把D很大确实有了抖动，嘿嘿。

歪腰

zhou1994 发表于 2015-4-22 16:41
为什么很大范围的p没有效果呢，因为你用的E车，因为你的p还不够大，d参数，没有用那也是你数字还不够大。大 ...

还想问一下，ccd多久采集一次啊？

歪腰

司飞1096375602 发表于 2015-4-22 16:56
楼主，我有同样问题，怎样改卡尔曼参数啊？看着你的波形很好了啊

//dt的取值为kalman滤波器采样时间;
//Q_angle:系统过程噪声协方差矩阵
//Q_gyro  = 0.0015; //数值越小表明越信任
//R_angle=0.001; //加速度计测量误差协方差
float Q_angle=0.003, Q_gyro=0.005, R_angle=15.0, dt=0.020;
本人的


上面红色的是我在论坛看别人的，根据这个调的。

zhou1994

歪腰 发表于 2015-4-22 17:05
还想问一下，ccd多久采集一次啊？

看你的光线环境和你对ad值的要求，还有处理周期的要求。我5到20ms浮动。

歪腰

zhou1994 发表于 2015-4-22 17:17
看你的光线环境和你对ad值的要求，还有处理周期的要求。我5到20ms浮动。

是在卓老大的时间片中断外，再开一个中断吗？

zhou1994

歪腰 发表于 2015-4-22 17:20
是在卓老大的时间片中断外，再开一个中断吗？

我没有照着官网的那个电磁车指南做。