2013的弹子球 发表于 2014-11-22 22:21:31

新手对平衡小车卡尔曼滤波算法的总结

由于做平衡小车,然后对那段滤波算法很疑惑,然后网上讲的又比较少,我看了一段时间的书。。。。。。。。。。。这是小弟的对这段卡尔曼滤波程序的一点理解,因为基础薄弱(大二),有错的请多多包涵。
先上程序,这是抄的不知道谁的代码。。。抱歉了。。不过这程序好像都写的差不多。。。附程序。。

Wisen 发表于 2014-11-22 23:25:11

顶起来,谢谢分享!

openm4 发表于 2014-11-22 23:29:14

谢谢分享。收了。

yanjiesh 发表于 2014-11-26 21:17:54

学习了楼主,谢谢 啊 ,我这两天 正愁着着这个呢!楼主还有其他的资料么?

zhenghe 发表于 2014-11-26 21:52:33

才大二,能看懂很不错了。既然在大学,不如多放精力在理论上。

shaojianbuguai 发表于 2014-11-26 22:05:27

比我大二时候牛多了

2013的弹子球 发表于 2014-11-26 22:17:05

yanjiesh 发表于 2014-11-26 21:17
学习了楼主,谢谢 啊 ,我这两天 正愁着着这个呢!楼主还有其他的资料么? ...

2013的弹子球 发表于 2014-11-26 22:49:46

shaojianbuguai 发表于 2014-11-26 22:05
比我大二时候牛多了

你们那会不一样,条件没这么好,那会的人到现在才牛逼

2013的弹子球 发表于 2014-11-26 22:50:40

yanjiesh 发表于 2014-11-26 21:17
学习了楼主,谢谢 啊 ,我这两天 正愁着着这个呢!楼主还有其他的资料么? ...

啊啊啊啊,电脑修好了再发,现在用的别人的。。。

2013的弹子球 发表于 2014-11-26 22:58:14

zhenghe 发表于 2014-11-26 21:52
才大二,能看懂很不错了。既然在大学,不如多放精力在理论上。

谢谢前辈

dxzky 发表于 2014-11-27 00:16:35

赞一个,大三开始做平衡车一开始也搞不明白卡尔曼...也是花了很长时间和很多人交流过后,才明白一点...

老谷 发表于 2014-11-27 07:21:57

谢谢分享

xiangbin099 发表于 2014-11-28 10:52:27

谢谢分享……

chun2495 发表于 2014-11-28 11:15:28

zhenghe 发表于 2014-11-26 21:52
才大二,能看懂很不错了。既然在大学,不如多放精力在理论上。

我不认为这样 ,我觉得在大学实践更重要, 因为理论理解的再透彻,也不顶做成一个东西。

2013的弹子球 发表于 2014-11-28 12:30:48

嗷,都有道理。

franki 发表于 2014-11-28 19:39:45

才大二就搞 卡尔曼滤波啦 !现在孩子懂的真多

qwe2231695 发表于 2014-11-28 22:10:03

写的不错~~!!!!

tooper2 发表于 2014-11-28 22:23:43

正式我要找的东西,学习了!

大田 发表于 2014-11-28 22:29:34

我当时只会51单片机。。。

dukang 发表于 2014-11-29 18:00:56


顶起来,谢谢分享!

Krise@pasion 发表于 2014-11-29 18:12:07

下载看过,资料不错

jiang887786 发表于 2014-11-29 18:29:33

谢谢楼主,收下了,希望我以后不走弯路。{:handshake:}

dory_m 发表于 2014-11-29 19:07:15

学习,谢谢!!!

Ray______ 发表于 2014-12-6 11:13:35

我看不懂就直接用了

yzh 发表于 2014-12-10 22:04:34

本人也想学习这个,先收下了,谢谢分享!

lf8013 发表于 2015-1-2 22:09:51

正想学习这个,收下了,谢谢分享!

sissigg 发表于 2015-1-8 15:12:01

谢谢分享

makeflyeasy 发表于 2015-1-8 21:41:53

本帖最后由 makeflyeasy 于 2015-1-8 21:49 编辑

chun2495 发表于 2014-11-28 11:15
我不认为这样 ,我觉得在大学实践更重要, 因为理论理解的再透彻,也不顶做成一个东西。 ...

同意,理论就像织网的线,经验就像线中的结,理论再多没有经验照样是一盘散线,钓不上大鱼,不如来一点线打一个结实的结,时间长了才能学有所成,所以我非常反感现在的大学教育,4年教出的大部分是废材,到头来大学知识大部分白学,工作中才慢慢走上正道,某些专家还美其名曰多学理论增长见识,放屁,一群误人子弟的蠢货。

此外,楼主程序中的这里感觉有点问题:
void count_Acc_angle()                                                                                                                                                                                                       
//反正切计算倾角值
{
        Read_Acc();
        if(temp_acc_y>0)
        {
                Acc_angle = atan2((float)temp_acc_y,(float)temp_acc_z)*(180/3.14159265);                          
        }
                else
                {
                   Acc_angle = atan2((float)temp_acc_z,(float)temp_acc_y)*(180/3.14159265)-90;               
                        Acc_angle = -Acc_angle;
                }
}
这样计算是不靠谱的哈,你这是计算Y轴的值,我万一把车朝X轴偏移了45度呢?输出的值就是不准的,解算姿态要XYZ3轴加速度值都得用上。
举个例子:AngleAx=atan(Angle_ax/sqrt(Angle_ay*Angle_ay+Angle_az*Angle_az))*180/3.141592657;

2013的弹子球 发表于 2015-1-9 12:29:08

makeflyeasy 发表于 2015-1-8 21:41
同意,理论就像织网的线,经验就像线中的结,理论再多没有经验照样是一盘散线,钓不上大鱼,不如来一点线 ...

奥。。。平衡小车是单轴的。。。没有x轴

2013的弹子球 发表于 2015-1-9 12:32:49

makeflyeasy 发表于 2015-1-8 21:41
同意,理论就像织网的线,经验就像线中的结,理论再多没有经验照样是一盘散线,钓不上大鱼,不如来一点线 ...

奥。。我觉得我们本科学的那些东西本身是没有问题的。。。只是人的问题。。。

zjk 发表于 2015-1-9 12:43:40

LZ的分享很适合新人学习

makeflyeasy 发表于 2015-1-9 21:01:11

2013的弹子球 发表于 2015-1-9 12:29
奥。。。平衡小车是单轴的。。。没有x轴

万一在斜坡上跑呢?程序还是不要有漏洞为好。

也是,没有那些庸人,哪来的精英呢?我们的工资怎么会比别人高呢,精英之所以是精英,就是因为与众不同啊。让那些喜欢打游戏的打游戏去吧,欢迎腾讯再开发几款千万玩家级的游戏,这样工作竞争压力也小点。

2013的弹子球 发表于 2015-1-9 22:33:44

makeflyeasy 发表于 2015-1-9 21:01
万一在斜坡上跑呢?程序还是不要有漏洞为好。

也是,没有那些庸人,哪来的精英呢?我们的工资怎么会比别 ...

{:lol:} 啊。。。原来是这样。。。从来没想到过。。。。

westloveohyeah 发表于 2015-2-16 16:44:57

你的去漂移方法不太好,考虑一下降噪

2013的弹子球 发表于 2015-2-16 22:18:36

westloveohyeah 发表于 2015-2-16 16:44
你的去漂移方法不太好,考虑一下降噪

你说陀螺仪的?里面有一段对误差的积分可以消除漂移

2013的弹子球 发表于 2015-2-16 23:34:21

westloveohyeah 发表于 2015-2-16 16:44
你的去漂移方法不太好,考虑一下降噪

额。。对不起我以为是四旋翼的。。。谢谢你。。确实需要改进的地方很多。

westloveohyeah 发表于 2015-2-23 16:55:40

2013的弹子球 发表于 2015-2-16 23:34
额。。对不起我以为是四旋翼的。。。谢谢你。。确实需要改进的地方很多。 ...

去漂移的本质是要对漂移数据进行时间序列分析,进而利用误差模型对输出数据进行一次卡尔曼滤波,得到降噪的陀螺仪数据。最后再结合降噪的误差模型和加速度计的误差模型进行第二次卡尔曼滤波,出来的结果才基本能用用

hello_sunny 发表于 2015-3-5 13:13:42

谢谢分享了{:smile:}

yllyly0454 发表于 2015-3-6 09:22:16

好文共赏!

R8C 发表于 2015-3-6 09:52:52

卡尔曼滤波,好东西

2013的弹子球 发表于 2015-3-7 09:52:47

有错啊。。。对不起大家,卡尔曼增益的取值~跟初始的Q还有R直接相关,如果不能取精确模型就别用这个。。。。

tangcangeng 发表于 2015-3-7 12:11:56

本帖最后由 tangcangeng 于 2015-3-7 12:16 编辑

makeflyeasy 发表于 2015-1-8 21:41
同意,理论就像织网的线,经验就像线中的结,理论再多没有经验照样是一盘散线,钓不上大鱼,不如来一点线 ...

恩 没有理论怎么会有这些代码呢 理论还是要学的 不过我个人觉得还是先打个理论基础先把做练习题的时间变成做产品 就不会白学了 感觉你说的这些话都是先看了人家的代码然后再对照理论的 如果我说错了请不要在意啊 我虽然现在跟你的想法一样 但是我现在除了做产品外有时候还在不断复习课本上的理论 我有时候会想想我现在做的都是别人通过理论验证然后代码都已经可以参考了 但是哪天碰到如果要你开发一个市场没有现成可供参考的 需要从理论开始着手的话 就有点被动了理论与实际动手都不能太偏 搞技术的不容易啊

菜鸟飞 发表于 2015-3-28 17:54:47

顶顶顶顶顶顶顶顶顶

左岸 发表于 2015-3-30 11:57:22

makeflyeasy 发表于 2015-1-8 21:41
同意,理论就像织网的线,经验就像线中的结,理论再多没有经验照样是一盘散线,钓不上大鱼,不如来一点线 ...

表示赞同

左岸 发表于 2015-3-30 14:37:41

A' 是A的什么矩阵啊?

zxjfun 发表于 2015-11-24 11:20:51

左岸 发表于 2015-3-30 14:37
A' 是A的什么矩阵啊?

转置矩阵吧。。。

gowin31581191 发表于 2016-2-5 14:02:06

我看了,還是不懂,還要努力學習了解

gowin31581191 发表于 2016-2-5 14:03:09

我看了,還是看不懂,還要努力學習

liupanliang 发表于 2016-2-15 17:20:06


谢谢分享。收了。{:smile:}{:smile:}

迷茫理工男 发表于 2016-4-25 13:17:52

谢谢分享

zhanglongbao 发表于 2016-4-25 14:57:18

谢谢分享

shortking 发表于 2016-5-3 20:14:06

mark 谢谢分享

hongmark 发表于 2016-5-3 21:52:42

谢谢分享!!!!!!

sjh306 发表于 2016-6-10 09:48:37

多系诶分享,正要学习,下了!{:victory:}

老魏 发表于 2016-6-10 11:27:31

谢谢分享!
页: [1]
查看完整版本: 新手对平衡小车卡尔曼滤波算法的总结