Page 1 of 1

Where does the EKF incorporates the uwb measurements?

Posted: Mon Jun 01, 2020 6:08 pm
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

Re: Where does the EKF incorporates the uwb measurements?

Posted: Tue Jun 02, 2020 6:58 am
by kristoffer
Hi!

It is done in kalmanCoreUpdateWithDistance()
https://github.com/bitcraze/crazyflie-f ... #L367-L396

Re: Where does the EKF incorporates the uwb measurements?

Posted: Fri Jun 05, 2020 11:58 am
by nicuvlad94
Thank you! I managed to use it!