gtsam

Author	SHA1	Message	Date
Duy-Nguyen Ta	cde44b2952	Finally finish implementing the Reconstruction factor for updating the poses of holonomic vehicles using discrete variational integrators (eq. 10 in [Kobilarov09siggraph]). Also, better approximation for the derivative of the inverse expmap wrt the lie algebra in Pose3. Test with numericalderivative.	2013-04-22 08:34:40 +00:00