Where does the EKF incorporates the uwb measurements?

Discussions about all things Bitcraze
Post Reply
nicuvlad94
Beginner
Posts: 28
Joined: Sun Sep 08, 2019 12:44 pm
Contact:

Where does the EKF incorporates the uwb measurements?

Post by nicuvlad94 »

Hello,

Can someone point me to the file where the ekf updates the state estimate with the measurements obtained from the UWB anchors (TWR)?

Thank you!
Vlad
kristoffer
Bitcraze
Posts: 630
Joined: Tue Jun 30, 2015 7:47 am

Re: Where does the EKF incorporates the uwb measurements?

Post by kristoffer »

Hi!

It is done in kalmanCoreUpdateWithDistance()
https://github.com/bitcraze/crazyflie-f ... #L367-L396
nicuvlad94
Beginner
Posts: 28
Joined: Sun Sep 08, 2019 12:44 pm
Contact:

Re: Where does the EKF incorporates the uwb measurements?

Post by nicuvlad94 »

Thank you! I managed to use it!
Post Reply