UMich-CURLY / drift

Dead Reckoning In Field Time: Symmetry-Preserving State Estimation Library for Various Robotic Platforms
BSD 3-Clause "New" or "Revised" License
112 stars 8 forks source link

Implemented SEk(3) class and RobotState class #3

Closed Jonathan-Twz closed 1 year ago

Jonathan-Twz commented 1 year ago

Compilable for the main branch, added the latest index mapping feature from augmented states to state matrix index.

The index mapping management needs to be merged and checked with Tingjun's InEKF propagation/correction steps.

Welcome and please leave comments about the current RobotState and SEk(3) class implementation.