Cộng đồng kỹ thuật điện tử Việt Nam Nơi ý tưởng được cấp nguồn.

Thử tìm PIC16F877A dsPIC nguồn xung pin mặt trời

Linh kiện · RP Store

R&P phân phối chính thức Microchip, ROHM, Epson, Nichicon, Taejin…

Gửi BOM nhận báo giá

[HELP] Kalman với MPU6050

Thu gọn
X
 
  • Giờ
  • Hiển thị
Xóa tất cả
bài mới
  • huuchinh02
    Thành viên mới
    • Jan 2013
    • 22

    #1

    [HELP] Kalman với MPU6050

    Em đang làm mạch lọc Kalman cho con MPU6050 6 trục (3 acc + 3 gyro), search google thì thấy trên forum của arduino có share code như thế này. Đọc không hiểu là cái chắc rồi nhưng em muốn hỏi hàm float KalmanCalculate(float newAngle, float newRate, int looptime) có các biến newAngle,newRate, looptime có nghĩa là gì ạ? Q_angle,Q_gyro,R_angle là những hệ số gì và nó ảnh hưởng như thế nào đến bộ lọc ạ?? Cám ơn mọi người

    #ifndef _Kalman_h
    #define _Kalman_h
    float Q_angle = 0.0004; //0.001 //0.005
    float Q_gyro = 0.0002; //0.003 //0.0003
    float R_angle = 0.002; //0.03 //0.008

    float x_bias = 0;
    float x_angle;
    float P_00 = 0, P_01 = 0, P_10 = 0, P_11 = 0;
    float y, S;
    float K_0, K_1;

    float KalmanCalculate(float newAngle, float newRate, int looptime)
    {
    float dt = (float)(looptime)/1000;
    x_angle += dt * (newRate - x_bias);

    //! P_00 += - dt * (P_10 + P_01) + Q_angle * dt;
    P_00 += - dt * (P_10 + P_01) + Q_angle * dt;
    //! P_01 += - dt * P_11;
    P_01 += -dt * P_11;
    //! P_10 += - dt * P_11;
    P_10 += -dt * P_11;
    //! P_11 += + Q_gyro * dt;
    P_11 += Q_gyro * dt;

    y = newAngle - x_angle;

    S = P_00 + R_angle;

    K_0 = P_00 / S;
    K_1 = P_10 / S;


    x_angle += K_0 * y;
    x_bias += K_1 * y;

    P_00 -= K_0 * P_00;
    P_01 -= K_0 * P_01;
    P_10 -= K_1 * P_00;
    P_11 -= K_1 * P_01;

    return x_angle;
    }


    #endif
  • accongaso2
    Thành viên mới
    • Apr 2013
    • 10

    #2
    chào bạn. k biết bạn đã làm xong con MPU6050 này chưa. Mình đang tìm hiểu về con này . MÌnh dùng code MPU6050-DMP6 thấy cũng khá chuẩn . Bạn dùng thử xem.

    Bình luận

    • huuchinh02
      Thành viên mới
      • Jan 2013
      • 22

      #3
      Nguyên văn bởi accongaso2
      chào bạn. k biết bạn đã làm xong con MPU6050 này chưa. Mình đang tìm hiểu về con này . MÌnh dùng code MPU6050-DMP6 thấy cũng khá chuẩn . Bạn dùng thử xem.
      Mình làm xong rồi bạn. Sử dụng DMP mình thấy rắc rối quá (thời điểm đó mà làm không biết giờ xong chưa nữa) mặc dù code trên mạng cũng có sẵn (khoảng 1000 dòng ). Với lại mình cũng tập xài các bộ lọc tự viết xem như thế nào? Đâu phải cái gì cũng có tích hợp sẵn 1 bộ tương tự như DMP của MPU6050

      Bình luận

      Về tác giả

      Thu gọn

      huuchinh02 Tìm hiểu thêm về huuchinh02

      Bài viết mới nhất

      Thu gọn

      Đang tải...