Matlab and C++ code for implementation of the Extended Kalman Filter for estimating dynamic quantities for a single rigid body with distributed force/torque measurements and distributed gyroscopes and accelerometers measurements.It also include estimation of the orientation under the quaternion representation.
Reference: http://54.183.65.232/docs/indigo/api/bfl/html/smoother__test_8cpp_source.html