Drake
Drake C++ Documentation
State Estimation