搜索
bottom↓
回复: 105

互补滤波和卡尔曼滤波结果比较

  [复制链接]

出0入0汤圆

发表于 2013-1-29 17:26:52 | 显示全部楼层 |阅读模式
本帖最后由 chengluoran 于 2013-1-29 17:28 编辑

如图:两滤波结果几乎相同。黑色曲线是互补滤波结果,黄色曲线是卡尔曼滤波结果。由于两者太相似,需要把黑色线条加粗一倍才能看到,不然就被黄色曲线覆盖了。

点击图片可查看大图



以下是部分代码:
  1. //每10ms执行一次
  2. if((millis() - time) >= 10)
  3. {
  4.     digitalWrite(14, HIGH);//用于测试程序运行时间
  5.        
  6.     time = millis();
  7.        
  8.     //读传感器数据
  9.     mpu_get_data();
  10.        
  11.     digitalWrite(13, HIGH);

  12.     //互补滤波
  13.     angle_hb = (0.98) * (angle_hb - mpu_data.y_gyro_f * 0.01) + (0.02)*(mpu_data.x_accel_f);

  14.     //卡尔曼滤波
  15.     Kalman_Filter(mpu_data.x_accel_f, -mpu_data.y_gyro_f);

  16.     digitalWrite(13, LOW);   
  17.    
  18.     //串口发送数据
  19.     Serial3.print(-mpu_data.y_gyro_f);
  20.     Serial3.print(",");
  21.     Serial3.print(mpu_data.x_accel_f);
  22.     Serial3.print(",");
  23.     Serial3.print(angle_hb);
  24.     Serial3.print(",");
  25.     Serial3.print(angle);
  26.     Serial3.println("");
  27.        
  28.     digitalWrite(14, LOW);
  29. }
复制代码
互补滤波参考 The Balance Filter ,卡尔曼滤波参考 zlstone

本帖子中包含更多资源

您需要 登录 才可以下载或查看,没有帐号?注册

x

阿莫论坛20周年了!感谢大家的支持与爱护!!

月入3000的是反美的。收入3万是亲美的。收入30万是移民美国的。收入300万是取得绿卡后回国,教唆那些3000来反美的!

出0入0汤圆

发表于 2013-1-30 06:18:17 来自手机 | 显示全部楼层
mark!!!!……

出0入0汤圆

发表于 2013-1-30 08:17:21 | 显示全部楼层
MARK。。。。。

出0入0汤圆

发表于 2013-1-30 08:34:15 | 显示全部楼层
正需要,好好学习一下

出0入0汤圆

发表于 2013-1-30 21:32:19 | 显示全部楼层
因此对于一般的应用互补滤波就可以取得不错的效果。完全不需要卡尔曼滤波器。

出0入0汤圆

发表于 2013-1-30 21:43:14 | 显示全部楼层
这个能不能不用浮点数啊,

出25入12汤圆

发表于 2013-1-30 22:12:12 | 显示全部楼层
马克一下 正想用呢

出0入0汤圆

发表于 2013-1-31 00:00:34 | 显示全部楼层
图是用设么做的??????

出0入0汤圆

发表于 2013-1-31 07:53:14 来自手机 | 显示全部楼层
不要为了卡尔曼而卡尔曼

出0入0汤圆

发表于 2013-1-31 08:36:07 来自手机 | 显示全部楼层
可以用q格式

出0入0汤圆

发表于 2013-1-31 09:02:50 来自手机 | 显示全部楼层
用的Excel会的图吧

出0入0汤圆

发表于 2013-1-31 09:21:09 | 显示全部楼层
两者的区别在于,叫法不同。。

出0入0汤圆

 楼主| 发表于 2013-1-31 09:54:59 | 显示全部楼层
yiyu 发表于 2013-1-30 21:43
这个能不能不用浮点数啊,

我觉得STM32算这个很快了。如果不用浮点你可以用Q格式运算,TI IQmath

出0入0汤圆

发表于 2013-1-31 09:56:03 | 显示全部楼层
不知道“收藏”按钮在哪里,只能mark了。
其实两个相当于是牛刀和杀猪刀的区别,在杀鸡上效果一样,但是如果杀牛,那就能看出来了

出0入0汤圆

 楼主| 发表于 2013-1-31 09:57:05 | 显示全部楼层
123bac 发表于 2013-1-31 00:00
图是用设么做的??????

串口接收数据存为文本文件,然后用excel导入作图

出0入0汤圆

 楼主| 发表于 2013-1-31 09:58:26 | 显示全部楼层
chenjiawei7 发表于 2013-1-31 07:53
不要为了卡尔曼而卡尔曼

不明白你说的什么意思

出0入0汤圆

 楼主| 发表于 2013-1-31 10:00:41 | 显示全部楼层
Garbage614 发表于 2013-1-31 09:56
不知道“收藏”按钮在哪里,只能mark了。
其实两个相当于是牛刀和杀猪刀的区别,在杀鸡上效果一样,但是如 ...

收藏按钮在1楼末尾。

这个比喻很形象

出0入0汤圆

发表于 2013-1-31 10:15:56 | 显示全部楼层
弱弱问一句,这是用在那里的啊.

出0入0汤圆

 楼主| 发表于 2013-1-31 10:18:13 | 显示全部楼层
cyxavr 发表于 2013-1-31 10:15
弱弱问一句,这是用在那里的啊.

两轮平衡小车

出0入0汤圆

发表于 2013-1-31 12:43:55 | 显示全部楼层
串口接收数据存为文本文件,然后用excel导入作图教我一下这个我真不懂

出0入0汤圆

 楼主| 发表于 2013-1-31 12:56:40 | 显示全部楼层
123bac 发表于 2013-1-31 12:43
串口接收数据存为文本文件,然后用excel导入作图教我一下这个我真不懂

额。。。单片机按照格式 “数据1,数据2,数据3,数据4 ... 换行” 发送数据,电脑端用串口调试助手或者超级终端接收,然后把接收到数据保存为txt文件。打开excel导入数据。excel会自动识别逗号和换行符。然后就可以按常规处理数据的方法作图了

出0入0汤圆

发表于 2013-1-31 20:13:11 | 显示全部楼层

出0入0汤圆

发表于 2013-1-31 20:13:28 | 显示全部楼层

出0入0汤圆

发表于 2013-1-31 20:26:31 | 显示全部楼层
我最近在弄得就是单片机用串口发数据的事,把串口通信和I2C通信理解了很多遍也编不出采集数据用串口发到调试助手,

出0入0汤圆

发表于 2013-1-31 20:31:03 | 显示全部楼层
这程序死活编不出来论坛的大师说很简单的但是我就是采集不到mpu6050角度的加速的数据我有把角度和加速度显示在1602的程序怎么转到串口就不行了

出0入0汤圆

发表于 2013-1-31 20:32:55 | 显示全部楼层
  1. #include <REG52.H>       
  2. #include <math.h>    //Keil library  
  3. #include <stdio.h>   //Keil library       
  4. #include <INTRINS.H>
  5. typedef unsigned char  uchar;
  6. typedef unsigned short ushort;
  7. typedef unsigned int   uint;
  8. //****************************************
  9. // 定义51单片机端口
  10. //****************************************
  11. #define DataPort P0                //LCD1602数据端口
  12. sbit    SCL=P1^0;                        //IIC时钟引脚定义
  13. sbit    SDA=P1^1;                        //IIC数据引脚定义
  14. sbit    LCM_RS=P2^6;                //LCD1602命令端口               
  15. sbit    LCM_RW=P2^5;                //LCD1602命令端口               
  16. sbit    LCM_EN=P2^7;                //LCD1602命令端口                                                   

  17. //****************************************
  18. // 定义MPU6050内部地址
  19. //****************************************
  20. #define        SMPLRT_DIV                0x19        //陀螺仪采样率,典型值:0x07(125Hz)
  21. #define        CONFIG                        0x1A        //低通滤波频率,典型值:0x06(5Hz)
  22. #define        GYRO_CONFIG                0x1B        //陀螺仪自检及测量范围,典型值:0x18(不自检,2000deg/s)
  23. #define        ACCEL_CONFIG        0x1C        //加速计自检、测量范围及高通滤波频率,典型值:0x01(不自检,2G,5Hz)
  24. #define        ACCEL_XOUT_H        0x3B
  25. #define        ACCEL_XOUT_L        0x3C
  26. #define        ACCEL_YOUT_H        0x3D
  27. #define        ACCEL_YOUT_L        0x3E
  28. #define        ACCEL_ZOUT_H        0x3F
  29. #define        ACCEL_ZOUT_L        0x40
  30. #define        TEMP_OUT_H                0x41
  31. #define        TEMP_OUT_L                0x42
  32. #define        GYRO_XOUT_H                0x43
  33. #define        GYRO_XOUT_L                0x44       
  34. #define        GYRO_YOUT_H                0x45
  35. #define        GYRO_YOUT_L                0x46
  36. #define        GYRO_ZOUT_H                0x47
  37. #define        GYRO_ZOUT_L                0x48
  38. #define        PWR_MGMT_1                0x6B        //电源管理,典型值:0x00(正常启用)
  39. #define        WHO_AM_I                        0x75        //IIC地址寄存器(默认数值0x68,只读)
  40. #define        SlaveAddress        0xD0        //IIC写入时的地址字节数据,+1为读取
  41. //****************************************
  42. //定义类型及变量
  43. //****************************************
  44. uchar dis[4];                                                        //显示数字(-511至512)的字符数组
  45. int        dis_data;                                                //变量
  46. //int        Temperature,Temp_h,Temp_l;        //温度及高低位数据
  47. //****************************************
  48. //函数声明
  49. //****************************************
  50. void  delay(unsigned int k);                                                                                //延时
  51. //LCD相关函数
  52. void  InitLcd();                                                                                                                //初始化lcd1602
  53. void  lcd_printf(uchar *s,int temp_data);
  54. void  WriteDataLCM(uchar dataW);                                                                        //LCD数据
  55. void  WriteCommandLCM(uchar CMD,uchar Attribc);                                //LCD指令
  56. void  DisplayOneChar(uchar X,uchar Y,uchar DData);                        //显示一个字符
  57. void  DisplayListChar(uchar X,uchar Y,uchar *DData,L);        //显示字符串
  58. //MPU6050操作函数
  59. void  InitMPU6050();                                                                                                        //初始化MPU6050
  60. void  Delay5us();
  61. void  I2C_Start();
  62. void  I2C_Stop();
  63. void  I2C_SendACK(bit ack);
  64. bit   I2C_RecvACK();
  65. void  I2C_SendByte(uchar dat);
  66. uchar I2C_RecvByte();
  67. void  I2C_ReadPage();
  68. void  I2C_WritePage();
  69. void  display_ACCEL_x();
  70. void  display_ACCEL_y();
  71. void  display_ACCEL_z();
  72. uchar Single_ReadI2C(uchar REG_Address);                                                //读取I2C数据
  73. void  Single_WriteI2C(uchar REG_Address,uchar REG_data);        //向I2C写入数据
  74. //****************************************
  75. //整数转字符串
  76. //****************************************
  77. void lcd_printf(uchar *s,int temp_data)
  78. {
  79.         if(temp_data<0)
  80.         {
  81.                 temp_data=-temp_data;
  82.                 *s='-';
  83.         }
  84.         else *s=' ';
  85.         *++s =temp_data/100+0x30;
  86.         temp_data=temp_data%100;     //取余运算
  87.         *++s =temp_data/10+0x30;
  88.         temp_data=temp_data%10;      //取余运算
  89.         *++s =temp_data+0x30;        
  90. }
  91. //****************************************
  92. //延时
  93. //****************************************
  94. void delay(unsigned int k)       
  95. {                                               
  96.         unsigned int i,j;                               
  97.         for(i=0;i<k;i++)
  98.         {                       
  99.                 for(j=0;j<121;j++);
  100.         }                                               
  101. }
  102. //****************************************
  103. //LCD1602初始化
  104. //****************************************
  105. void InitLcd()                               
  106. {                       
  107.         WriteCommandLCM(0x38,1);       
  108.         WriteCommandLCM(0x08,1);       
  109.         WriteCommandLCM(0x01,1);       
  110.         WriteCommandLCM(0x06,1);       
  111.         WriteCommandLCM(0x0c,1);
  112.         DisplayOneChar(0,0,'A');
  113.         DisplayOneChar(0,1,'G');
  114. }                       
  115. //****************************************
  116. //LCD1602写允许
  117. //****************************************
  118. void WaitForEnable(void)       
  119. {                                       
  120.         DataPort=0xff;               
  121.         LCM_RS=0;LCM_RW=1;_nop_();
  122.         LCM_EN=1;_nop_();_nop_();
  123.         while(DataPort&0x80);       
  124.         LCM_EN=0;                               
  125. }                                       
  126. //****************************************
  127. //LCD1602写入命令
  128. //****************************************
  129. void WriteCommandLCM(uchar CMD,uchar Attribc)
  130. {                                       
  131.         if(Attribc)WaitForEnable();       
  132.         LCM_RS=0;LCM_RW=0;_nop_();
  133.         DataPort=CMD;_nop_();       
  134.         LCM_EN=1;_nop_();_nop_();LCM_EN=0;
  135. }                                       
  136. //****************************************
  137. //LCD1602写入数据
  138. //****************************************
  139. void WriteDataLCM(uchar dataW)
  140. {                                       
  141.         WaitForEnable();               
  142.         LCM_RS=1;LCM_RW=0;_nop_();
  143.         DataPort=dataW;_nop_();       
  144.         LCM_EN=1;_nop_();_nop_();LCM_EN=0;
  145. }               
  146. //****************************************
  147. //LCD1602写入一个字符
  148. //****************************************
  149. void DisplayOneChar(uchar X,uchar Y,uchar DData)
  150. {                                               
  151.         Y&=1;                                               
  152.         X&=15;                                               
  153.         if(Y)X|=0x40;                                       
  154.         X|=0x80;                       
  155.         WriteCommandLCM(X,0);               
  156.         WriteDataLCM(DData);               
  157. }                                               
  158. //****************************************
  159. //LCD1602显示字符串
  160. //****************************************
  161. void DisplayListChar(uchar X,uchar Y,uchar *DData,L)
  162. {
  163.         uchar ListLength=0;
  164.         Y&=0x1;               
  165.         X&=0xF;               
  166.         while(L--)            
  167.         {                       
  168.                 DisplayOneChar(X,Y,DData[ListLength]);
  169.                 ListLength++;  
  170.                 X++;                        
  171.         }   
  172. }
  173. //**************************************
  174. //延时5微秒(STC90C52RC@12M)
  175. //不同的工作环境,需要调整此函数
  176. //当改用1T的MCU时,请调整此延时函数
  177. //**************************************
  178. void Delay5us()
  179. {
  180.         _nop_();_nop_();_nop_();_nop_();
  181.         _nop_();_nop_();_nop_();_nop_();
  182.         _nop_();_nop_();_nop_();_nop_();
  183.         _nop_();_nop_();_nop_();_nop_();
  184.         _nop_();_nop_();_nop_();_nop_();
  185.         _nop_();_nop_();_nop_();_nop_();
  186. }
  187. //**************************************
  188. //I2C起始信号
  189. //**************************************
  190. void I2C_Start()
  191. {
  192.     SDA = 1;                    //拉高数据线
  193.     SCL = 1;                    //拉高时钟线
  194.     Delay5us();                 //延时
  195.     SDA = 0;                    //产生下降沿
  196.     Delay5us();                 //延时
  197.     SCL = 0;                    //拉低时钟线
  198. }
  199. //**************************************
  200. //I2C停止信号
  201. //**************************************
  202. void I2C_Stop()
  203. {
  204.     SDA = 0;                    //拉低数据线
  205.     SCL = 1;                    //拉高时钟线
  206.     Delay5us();                 //延时
  207.     SDA = 1;                    //产生上升沿
  208.     Delay5us();                 //延时
  209. }
  210. //**************************************
  211. //I2C发送应答信号
  212. //入口参数:ack (0:ACK 1:NAK)
  213. //**************************************
  214. void I2C_SendACK(bit ack)
  215. {
  216.     SDA = ack;                  //写应答信号
  217.     SCL = 1;                    //拉高时钟线
  218.     Delay5us();                 //延时
  219.     SCL = 0;                    //拉低时钟线
  220.     Delay5us();                 //延时
  221. }
  222. //**************************************
  223. //I2C接收应答信号
  224. //**************************************
  225. bit I2C_RecvACK()
  226. {
  227.     SCL = 1;                    //拉高时钟线
  228.     Delay5us();                 //延时
  229.     CY = SDA;                   //读应答信号
  230.     SCL = 0;                    //拉低时钟线
  231.     Delay5us();                 //延时
  232.     return CY;
  233. }
  234. //**************************************
  235. //向I2C总线发送一个字节数据
  236. //**************************************
  237. void I2C_SendByte(uchar dat)
  238. {
  239.     uchar i;
  240.     for (i=0; i<8; i++)         //8位计数器
  241.     {
  242.         dat <<= 1;              //移出数据的最高位
  243.         SDA = CY;               //送数据口
  244.         SCL = 1;                //拉高时钟线
  245.         Delay5us();             //延时
  246.         SCL = 0;                //拉低时钟线
  247.         Delay5us();             //延时
  248.     }
  249.     I2C_RecvACK();
  250. }
  251. //**************************************
  252. //从I2C总线接收一个字节数据
  253. //**************************************
  254. uchar I2C_RecvByte()
  255. {
  256.     uchar i;
  257.     uchar dat = 0;
  258.     SDA = 1;                    //使能内部上拉,准备读取数据,
  259.     for (i=0; i<8; i++)         //8位计数器
  260.     {
  261.         dat <<= 1;
  262.         SCL = 1;                //拉高时钟线
  263.         Delay5us();             //延时
  264.         dat |= SDA;             //读数据               
  265.         SCL = 0;                //拉低时钟线
  266.         Delay5us();             //延时
  267.     }
  268.     return dat;
  269. }
  270. //**************************************
  271. //向I2C设备写入一个字节数据
  272. //**************************************
  273. void Single_WriteI2C(uchar REG_Address,uchar REG_data)
  274. {
  275.     I2C_Start();                  //起始信号
  276.     I2C_SendByte(SlaveAddress);   //发送设备地址+写信号
  277.     I2C_SendByte(REG_Address);    //内部寄存器地址,
  278.     I2C_SendByte(REG_data);       //内部寄存器数据,
  279.     I2C_Stop();                   //发送停止信号
  280. }
  281. //**************************************
  282. //从I2C设备读取一个字节数据
  283. //**************************************
  284. uchar Single_ReadI2C(uchar REG_Address)
  285. {
  286.         uchar REG_data;
  287.         I2C_Start();                   //起始信号
  288.         I2C_SendByte(SlaveAddress);    //发送设备地址+写信号
  289.         I2C_SendByte(REG_Address);     //发送存储单元地址,从0开始       
  290.         I2C_Start();                   //起始信号
  291.         I2C_SendByte(SlaveAddress+1);  //发送设备地址+读信号
  292.         REG_data=I2C_RecvByte();       //读出寄存器数据
  293.         I2C_SendACK(1);                //接收应答信号
  294.         I2C_Stop();                    //停止信号
  295.         return REG_data;
  296. }
  297. //**************************************
  298. //初始化MPU6050
  299. //**************************************
  300. void InitMPU6050()
  301. {
  302.         Single_WriteI2C(PWR_MGMT_1, 0x00);        //解除休眠状态
  303.         Single_WriteI2C(SMPLRT_DIV, 0x07);
  304.         Single_WriteI2C(CONFIG, 0x06);
  305.         Single_WriteI2C(GYRO_CONFIG, 0x18);
  306.         Single_WriteI2C(ACCEL_CONFIG, 0x01);
  307. }
  308. //**************************************
  309. //合成数据
  310. //**************************************
  311. int GetData(uchar REG_Address)
  312. {
  313.         char H,L;
  314.         H=Single_ReadI2C(REG_Address);
  315.         L=Single_ReadI2C(REG_Address+1);
  316.         return (H<<8)+L;   //合成数据
  317. }
  318. //**************************************
  319. //在1602上显示10位数据
  320. //**************************************
  321. void Display10BitData(int value,uchar x,uchar y)
  322. {
  323.         value/=64;                                                        //转换为10位数据
  324.         lcd_printf(dis, value);                        //转换数据显示
  325.         DisplayListChar(x,y,dis,4);        //启始列,行,显示数组,显示长度
  326. }
  327. //**************************************
  328. //显示温度
  329. //**************************************
  330. /*
  331. void display_temp()
  332. {         Temp_h=Single_ReadI2C(TEMP_OUT_H); //读取温度
  333.         Temp_l=Single_ReadI2C(TEMP_OUT_L); //读取温度
  334.         Temperature=Temp_h<<8|Temp_l;     //合成温度
  335.         Temperature = 35+ ((double) (Temperature + 13200)) / 280; // 计算出温度
  336.         lcd_printf(dis,Temperature);     //转换数据显示
  337.         DisplayListChar(11,1,dis,4);     //启始列,行,显示数组,显示位数
  338. }
  339. */
  340. //*********************************************************
  341. //主程序
  342. //*********************************************************
  343. void main()
  344. {
  345.         delay(500);                //上电延时               
  346.         InitLcd();                //液晶初始化
  347.         InitMPU6050();        //初始化MPU6050
  348.         delay(150);
  349.         while(1)
  350.         {
  351.                 Display10BitData(GetData(ACCEL_XOUT_H),2,0);        //显示X轴加速度
  352.                 Display10BitData(GetData(ACCEL_YOUT_H),7,0);        //显示Y轴加速度
  353.                 Display10BitData(GetData(ACCEL_ZOUT_H),12,0);        //显示Z轴加速度
  354.                 Display10BitData(GetData(GYRO_XOUT_H),2,1);        //显示X轴角速度
  355.                 Display10BitData(GetData(GYRO_YOUT_H),7,1);        //显示Y轴角速度
  356.                 Display10BitData(GetData(GYRO_ZOUT_H),12,1);        //显示Z轴角速度
  357.                 delay(5000);
  358.         }
  359. }
  360.          /*
  361.     在论坛上潜水几个月了,跟大家学习两轮平衡车的制作,获益良多。
  362. 在调试传感器数据和滤波时写了一个串口工具,趁这个周末整理
  363. 了一下,共享出来,希望能对初学者们有所帮助。
  364.     功能比较简单,主要是接收单片机发送来的3个整型数据,以图形显示。
  365. 可以向单片机发送几个字节,用作控制目的。单片机发送的数据以0xFF作为
  366. 帧结束标志,每个整型数以5个字节表示,具体参照下面的函数。
  367.     没有经过全面测试,如果你想用但有bug,可以反馈给我 :)

  368.                                            小皮2005
  369.                                            2012.12.08                                                                                  


  370. =============================================================
  371. void Print_Show(int data1, int data2, int data3)
  372. {
  373.         SeriPush2Bytes(data1);             
  374.         SeriPush2Bytes(data2);             
  375.         SeriPush2Bytes(data3);             
  376.         uart_transmit(0xff);
  377. }


  378. void SeriPush2Bytes(int value)
  379. {
  380.         unsigned char t_char;
  381.         if(value < 0) {
  382.                 value = -value;
  383.                 uart_transmit(0xf0);
  384.         }
  385.         else {
  386.                 uart_transmit(0xf5);
  387.         }
  388.         t_char = value/256;
  389.         if(t_char > 127)        uart_transmit(0x80);
  390.         else        uart_transmit(0x00);
  391.         uart_transmit(t_char & 0x7f);
  392.         t_char = value%256;
  393.         if(t_char > 127)        uart_transmit(0x80);
  394.         else        uart_transmit(0x00);
  395.         uart_transmit(t_char & 0x7f);
  396. }

  397. void uart_transmit(char c)
  398. {
  399.         while (!(UCSRA & DATA_REGISTER_EMPTY));
  400.         UDR=c;
  401. }

复制代码

出0入0汤圆

发表于 2013-2-1 09:12:37 | 显示全部楼层
chengluoran 发表于 2013-1-31 10:00
收藏按钮在1楼末尾。

这个比喻很形象

谢谢!搞定

出0入0汤圆

发表于 2013-2-10 22:05:12 | 显示全部楼层
mark!!!!!!

出0入0汤圆

发表于 2013-2-16 00:26:57 | 显示全部楼层
self-balancing                                 

出0入0汤圆

发表于 2013-2-16 09:38:40 | 显示全部楼层
学习了!!!

出0入0汤圆

发表于 2013-2-16 09:40:28 | 显示全部楼层
这个要好好学习下

出0入0汤圆

发表于 2013-2-16 11:08:38 | 显示全部楼层
mark。。。。

出0入0汤圆

发表于 2013-2-20 16:31:09 | 显示全部楼层
mark

出0入0汤圆

发表于 2013-2-20 16:42:44 | 显示全部楼层
mark!!!!!

出0入0汤圆

发表于 2013-3-1 09:21:51 | 显示全部楼层
留名~~以前我也就是冲着卡尔曼而用卡尔曼滤波的,在小车上应用效果是差不多的

出0入0汤圆

发表于 2013-4-9 22:08:24 | 显示全部楼层
还是搞不懂,不知道咋用,学习一下

出0入0汤圆

发表于 2013-4-10 16:14:36 | 显示全部楼层
mark

出0入0汤圆

发表于 2013-4-17 17:13:10 | 显示全部楼层
本帖最后由 济南电子爱好者 于 2013-4-17 17:15 编辑

我对比 卡尔曼,和互补滤波,结果和楼主不太一样,卡尔曼感觉更好一些,还是说我的互补滤波程序写的不对,
        bias_cf_p*=0.998;                        //陀螺仪零飘低通滤波;500次均值;
                bias_cf_p+=gyro_m_cf*0.002;
                angle_dot_cf_p=gyro_m_cf-bias_cf_p;   //这里angle_dot与angle在PID控制中会起到作用
                angle_cf_p=(angle_cf_p+angle_dot_cf_p*dt)*0.98+angle_m_cf*0.02;       
                //加速度低通滤波;50次均值;按200次每秒计算,低通4Hz;
http://player.youku.com/player.php/sid/XNTQyODUxNzU2/v.swf

出0入0汤圆

发表于 2013-4-19 22:45:29 | 显示全部楼层
学习中,mark下

出0入0汤圆

发表于 2013-4-21 09:01:18 | 显示全部楼层
好像不错的样子

出0入0汤圆

发表于 2013-4-23 20:05:22 | 显示全部楼层
mark  还需要潜一段时间潜水

出0入0汤圆

发表于 2013-5-19 21:18:27 | 显示全部楼层
受教了,确实不错,高手啊

出0入0汤圆

发表于 2013-6-12 00:24:10 | 显示全部楼层
不错.学习了.
但是用在姿态解算上是啥样对比呢?

出0入0汤圆

发表于 2013-6-12 00:37:24 | 显示全部楼层
这是说明互补完全可以代替卡尔曼吗,那卡尔曼用在哪里的时候才能显出真本事呢

出0入0汤圆

发表于 2013-6-25 21:45:09 | 显示全部楼层
济南电子爱好者 发表于 2013-4-17 17:13
我对比 卡尔曼,和互补滤波,结果和楼主不太一样,卡尔曼感觉更好一些,还是说我的互补滤波程序写的不对,
        bias ...

一阶互补效果确实不怎么好,你可以试试二阶的。觉得楼主kalman滤波并没有用好,用好了的话kalman应该比互补好些。

出0入0汤圆

发表于 2013-6-26 09:06:26 来自手机 | 显示全部楼层
个人观点:首先应该保证卡尔曼和互补滤波参数都是最优的,再进行比较。不知道楼主参数怎么确定的?

出0入0汤圆

发表于 2013-6-26 22:35:06 | 显示全部楼层
不错值得关注

出0入0汤圆

发表于 2013-7-6 23:04:52 | 显示全部楼层
暂时看不懂,留下学习

出0入0汤圆

发表于 2013-7-24 10:02:20 | 显示全部楼层
太深奥了,,,

出0入0汤圆

发表于 2013-7-30 20:00:17 | 显示全部楼层
Kalman_Filter(mpu_data.x_accel_f, -mpu_data.y_gyro_f);怎么输出参数是四个呢》》??

出0入0汤圆

发表于 2013-8-1 22:28:03 | 显示全部楼层
如何测量互补滤波的采样率??

出0入0汤圆

发表于 2013-8-1 22:46:32 | 显示全部楼层
学习了,多谢

出0入16汤圆

发表于 2013-8-3 15:20:18 | 显示全部楼层
学习一下~

出0入0汤圆

发表于 2013-8-14 19:55:38 | 显示全部楼层
yirenonege 发表于 2013-1-31 09:21
两者的区别在于,叫法不同。。

不是哟,原理上还是有区别噻。

出0入0汤圆

发表于 2013-8-26 18:47:05 | 显示全部楼层
济南电子爱好者 发表于 2013-4-17 17:13
我对比 卡尔曼,和互补滤波,结果和楼主不太一样,卡尔曼感觉更好一些,还是说我的互补滤波程序写的不对,
        bias ...

这个软件叫什么?能发给我一个吗?binfengsxxk@gmail.com谢谢啦

出0入0汤圆

发表于 2013-8-27 15:24:43 | 显示全部楼层
为什么我得出的图形,kalman收敛不没有互补快,

出0入4汤圆

发表于 2013-8-28 15:23:19 | 显示全部楼层
学习中,mark!

出0入0汤圆

发表于 2013-9-5 21:49:29 来自手机 | 显示全部楼层
路过,看看         

出0入0汤圆

发表于 2013-9-10 10:51:24 | 显示全部楼层
果断收藏。。。。。。。。。。。。。

出0入0汤圆

发表于 2013-9-15 03:42:53 | 显示全部楼层
不错,正在研究卡尔曼

出0入0汤圆

发表于 2013-9-15 10:05:27 | 显示全部楼层
mark

出0入0汤圆

发表于 2013-9-15 10:19:59 | 显示全部楼层
好,研究下,很有用的东西了

出0入0汤圆

发表于 2013-11-8 12:55:27 | 显示全部楼层
这个比较,,很直观。。刚才还在犹豫用哪个滤波~~

出0入0汤圆

发表于 2013-11-8 19:18:04 | 显示全部楼层
标记一下

出0入0汤圆

发表于 2013-11-10 15:42:19 | 显示全部楼层

学习中,mark下

出0入0汤圆

发表于 2013-11-10 16:07:12 | 显示全部楼层
学习中,顶一下

出0入0汤圆

发表于 2013-11-10 16:15:00 | 显示全部楼层
学习学习

出0入0汤圆

发表于 2013-11-17 11:00:17 | 显示全部楼层
wujohn 发表于 2013-8-1 22:28
如何测量互补滤波的采样率??

每秒钟执行多少次就是互补滤波器的采样率。

出0入0汤圆

发表于 2013-11-17 11:01:01 | 显示全部楼层
mark下,请问楼主用的是什么型号的传感器啊?
你的校准函数是怎么样的?

出0入0汤圆

发表于 2014-2-15 17:03:44 | 显示全部楼层
楼主,我用互补滤波效果也不错,就只想知道如果把互补滤波用在四轴上,效果怎么样,楼主有试过吗

出0入0汤圆

发表于 2014-3-29 07:55:32 | 显示全部楼层
mark,,,,正好在做。

出0入0汤圆

发表于 2014-4-1 10:46:42 | 显示全部楼层
MARK!!!      

出0入0汤圆

发表于 2014-4-24 13:58:21 | 显示全部楼层

MPU6050是怎样校准的?我的板子平放在桌子上,z轴加速度计读数只有0.756左右,而立起来或测起来x和y的读数分别为一,但z有0.3左右,该如何校准mpu6050采集回来的数据呢?

出0入0汤圆

发表于 2014-4-27 23:36:52 | 显示全部楼层
mark一下

出0入0汤圆

发表于 2014-5-4 17:40:43 | 显示全部楼层
mark一下

出0入0汤圆

发表于 2014-5-4 17:51:03 | 显示全部楼层
互补滤波和卡尔曼滤波结果比较

出0入0汤圆

发表于 2014-5-6 17:13:55 | 显示全部楼层
以后肯定会需要,果断收藏

出0入0汤圆

发表于 2014-5-7 16:18:45 | 显示全部楼层
38楼的视频,第一个明显丢失了部分数据吧,看到最后你的传感器大约在水平时,它根本还有很大角度呢。

出0入0汤圆

发表于 2014-6-21 15:04:43 | 显示全部楼层
多谢楼主分享,大爱楼主啊

出0入0汤圆

发表于 2014-7-16 22:31:41 | 显示全部楼层
这个东西只有自己用了才知道

出0入0汤圆

发表于 2014-7-29 21:20:27 | 显示全部楼层
学习了,不错,。。。。。。。。。。。。。。。。

出0入0汤圆

发表于 2014-7-31 11:53:35 | 显示全部楼层
mark!!!!……

出0入0汤圆

发表于 2014-7-31 11:53:50 | 显示全部楼层
mark!!!!……

出0入0汤圆

发表于 2014-8-8 20:11:05 | 显示全部楼层
楼主好强大啊,能和你做个朋友,聊聊技术上的点点滴滴吗?我的邮箱,709117559@qq.com

出0入0汤圆

发表于 2014-8-16 22:33:42 | 显示全部楼层


学习中,mark下

出0入0汤圆

发表于 2014-8-19 20:45:14 | 显示全部楼层
都是大神啊,学习中

出0入0汤圆

发表于 2014-8-22 15:29:36 | 显示全部楼层
做卡尔曼的时候,楼主怎么获得系统的置信度等数据的。。。

出0入0汤圆

发表于 2014-9-17 14:45:35 | 显示全部楼层
楼主,我觉得你的融合曲线将加速度计跟随的很紧,这样可以站起来吗?我看好多都是跟陀螺仪跟随的很紧,我用的是L3G4200,MMA7361,最近在做平衡车想问一下,加速度计得的噪声大,陀螺仪的温飘存在,低通加速度计,高通陀螺仪,对不对

出0入0汤圆

发表于 2014-10-7 10:55:26 | 显示全部楼层
陀螺仪积分的累计误差没显示出来

出0入0汤圆

发表于 2014-10-7 11:12:38 | 显示全部楼层
学习一下!

出0入0汤圆

发表于 2014-12-18 16:41:40 | 显示全部楼层
请问楼主  你卡尔曼滤波的参数是如何整定的?如果方便的话 请分享一下哇!先谢谢啦

出0入0汤圆

发表于 2015-1-7 14:52:23 | 显示全部楼层
学习中~~~

出0入0汤圆

发表于 2015-1-14 11:29:49 | 显示全部楼层
有图有真象,不错!

出0入0汤圆

发表于 2015-1-14 14:06:32 | 显示全部楼层
MARK                             

出0入0汤圆

发表于 2015-2-16 16:42:34 | 显示全部楼层
这个不能算是真正的KF

出0入0汤圆

发表于 2015-2-27 10:40:25 | 显示全部楼层
卡尔曼滤波之前也有点研究,可惜不精

出0入0汤圆

发表于 2015-2-27 10:45:03 | 显示全部楼层
这只能说你预处理和互补滤波调试选择的参数好,正好和卡尔曼增益一样。

出0入0汤圆

发表于 2015-4-25 15:44:20 | 显示全部楼层
感谢楼主分享!

出0入0汤圆

发表于 2015-5-16 19:51:49 | 显示全部楼层
(0.98) * (angle_hb - mpu_data.y_gyro_f * 0.01) + (0.02)*(mpu_data.x_accel_f);这里的0.98时滤波权值吗?怎么整定的?

出0入37汤圆

发表于 2015-5-16 20:11:51 | 显示全部楼层
这样的好帖子咋收藏,哪位大侠叫一下。
回帖提示: 反政府言论将被立即封锁ID 在按“提交”前,请自问一下:我这样表达会给举报吗,会给自己惹麻烦吗? 另外:尽量不要使用Mark、顶等没有意义的回复。不得大量使用大字体和彩色字。【本论坛不允许直接上传手机拍摄图片,浪费大家下载带宽和论坛服务器空间,请压缩后(图片小于1兆)才上传。压缩方法可以在微信里面发给自己(不要勾选“原图),然后下载,就能得到压缩后的图片】。另外,手机版只能上传图片,要上传附件需要切换到电脑版(不需要使用电脑,手机上切换到电脑版就行,页面底部)。
您需要登录后才可以回帖 登录 | 注册

本版积分规则

手机版|Archiver|amobbs.com 阿莫电子技术论坛 ( 粤ICP备2022115958号, 版权所有:东莞阿莫电子贸易商行 创办于2004年 (公安交互式论坛备案:44190002001997 ) )

GMT+8, 2024-4-27 06:34

© Since 2004 www.amobbs.com, 原www.ourdev.cn, 原www.ouravr.com

快速回复 返回顶部 返回列表