Implementation of Kalman Filter using APM 2.0.

Hello,

I am currently working on APM 2.0 to implement Kalman filter using GPS and INS data using 9 by 9 state matrix,  [P_x,V_x,Pl_x,P_y,V_y,PI_y,P_z,V_z,PI_z]', where PI_x,PI_y, and PI_z represent platform tilt about x, y, and z axis.

A problem is that newly updated global matrices X and P are not transferred to next iteration although I defined those as global matrices.

As far as I tested, a single global variable which is defined before void setup() works well as a global variable in that the previous value of the variable is successfully transferred into next iteration.

Is there anyone who could shed some lights on me?

Tags: 2.0, APM, Ardupilot, Filter, Filtering, GPS, INS, Kalman, Mega, and, More…global, matrix

Views: 446

▶ Reply to This

Replies to This Discussion

Permalink Reply by Shyam Balasubramanian on September 9, 2012 at 9:39am

Hi Sunghun,

Did you get solution to your problem ? If so could you tell me what as I am also working on Kalman filter using this board. Moreover, I wanted to know where in the code is kalman filter implemented in ArduPlane (or any Ardu code)..

Seeking your reply.

Permalink Reply by Dr Sudesh Kumar KAshyap on April 1, 2013 at 9:51pm

Hello Sunghun. 

Nice to see your interest on implementing Kalman filter on APM 2.0. Have you solved the problem of updating global variable?  I too have implemented 9 state Kalman filter for navigation and i did not faced any problem in updating global variables. I am getting good prediction of attitudes but if i enable measurement update part of filter the estimation give NAN. I guess that there is some problem while computing Kalman gain. Would you like to discussion with me to sort out this problem?

Sudesh K Kashyap

Permalink Reply by Shyam Balasubramanian on April 2, 2013 at 4:59am

Hi Dr. Sudesh,

I think that post was over a year ago. Might be a good idea to create a new forum, as I think an alternative to DCM as Kalman might be interesting to people out there, who can reply to you.


Regards,

Shyam.

RSS

Social Networking

Top Content 

1 APM Project vs DJI NAZA and WOOKONG

APM Project vs DJI NAZA and WOOKONG
2 APM 2.5 with NEO-6M ublox gps (not 3DR LEA-6)

APM 2.5 with NEO-6M ublox gps (not 3DR LEA-6)
3 APM Copter 2.9.1.b has been released

APM Copter 2.9.1.b has been released
4 Flying 3D Spline Curves between Waypoints with ArduCopter 3.0

Flying 3D Spline Curves between Waypoints with ArduCopter 3.0
5 ArduCopter-3.0 ready for wider use

ArduCopter-3.0 ready for wider use
6 10k autonomous flight - telemetry guided flight, and other APM tests!

10k autonomous flight - telemetry guided flight, and other APM tests!
7 Drone shot down by police

Drone shot down by police
8 MAAT final version is being tested

MAAT final version is being tested
9 Getting ready for Arducopter 3.0

Getting ready for Arducopter 3.0
10 Help Tuning Arduplane 2.73 With A Large Slow Airframe

Help Tuning Arduplane 2.73 With A Large Slow Airframe

Contests

Season Two of the Trust Time Trial (T3) Contest has now begun. The fourth round is an accuracy round for multicopters, which requires contestants to fly a cube. The deadline is April 14th.

A list of all T3 contests is here. 

Groups

Advertisement

© 2013   Created by Chris Anderson.   Powered by

Badges  |  Report an Issue  |  Terms of Service