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?

You need to be a member of diydrones to add comments!

Join diydrones

Email me when people reply –

Replies

  • 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

  • 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.

This reply was deleted.

Activity

DIY Robocars via Twitter
RT @TinkerGen_: "The Tinkergen MARK ($199) is my new favorite starter robocar. It’s got everything — computer vision, deep learning, sensor…
yesterday
DIY Robocars via Twitter
yesterday
DIY Robocars via Twitter
RT @roboton_io: Join our FREE Sumo Competition 🤖🏆 👉 https://roboton.io/ranking/vsc2020 #sumo #robot #edtech #competition #games4ed https://t.co/WOx…
Nov 16
DIY Drones via Twitter
First impressions of Tinkergen MARK robocar https://ift.tt/36IeZHc
Nov 16
DIY Robocars via Twitter
Our review of the @TinkerGen_ MARK robocar, which is the best on the market right now https://diyrobocars.com/2020/11/15/first-impressions-of-tinkergen-mark-robocar/ https://t.co/ENIlU5SfZ2
Nov 15
DIY Robocars via Twitter
RT @Ingmar_Stapel: I have now explained the OpenBot project in great detail on my blog with 12 articles step by step. I hope you enjoy read…
Nov 15
DIY Robocars via Twitter
RT @DAVGtech: This is a must attend. Click the link, follow link to read the story, sign up. #chaos2020 #digitalconnection #digitalworld ht…
Nov 15
DIY Robocars via Twitter
RT @a1k0n: Got a new chassis for outdoor races (hobbyking Quantum Vandal) but I totally didn't expect that it might cause problems for my g…
Nov 11
DIY Drones via Twitter
First impressions of the Intel OpenBot https://ift.tt/36qkVV4
Nov 10
DIY Robocars via Twitter
Nov 9
DIY Robocars via Twitter
Excellent use of cardboard instead of 3D printing! https://twitter.com/Ingmar_Stapel/status/1324960595318333441
Nov 7
DIY Robocars via Twitter
RT @chr1sa: We've got a record 50 teams competing in this month's @DIYRobocars @donkey_car virtual AI car race. Starting today at 10:00am…
Nov 7
DIY Robocars via Twitter
Nov 6
DIY Robocars via Twitter
RT @a1k0n: Car's view, using a fisheye camera. The ceiling light tracking algorithm gave me some ideas to improve ConeSLAM, and having grou…
Nov 5
DIY Robocars via Twitter
RT @a1k0n: To get ground truth I measured the rug, found the pixel coordinates of its corners, calibrated my phone camera with my standard…
Nov 5
DIY Robocars via Twitter
RT @a1k0n: @DIYRobocars is back in December, but outside. Time to reinvestigate ConeSLAM! I rigged up a quick and dirty ground-truth captur…
Nov 5
More…