Commit Graph

8794 Commits (2ad50ab86ea8a681caefc73850e7cc4136db475c)

Author SHA1 Message Date
dellaert 0ced228413 Regression test for predict with arbitrary measurements 2015-07-22 00:36:32 -04:00
dellaert a9b4cdbe47 coriolis now lives in NavState 2015-07-22 00:19:08 -04:00
dellaert 4c177c0ce2 unrotate now defined for vector 2015-07-21 18:28:31 -04:00
dellaert 4dbe5e68d2 Component access derivatives 2015-07-21 18:28:02 -04:00
dellaert 2dd7987478 Working AdjointMap and hence also derived derivatives of retract/localCoordinates 2015-07-21 16:25:58 -04:00
dellaert 2dbad989d1 Working Logmap ! 2015-07-21 16:09:56 -04:00
dellaert c7bc497014 Working Expmap 2015-07-21 11:36:28 -07:00
dellaert 1a47a334de Deal with changes in Rot3 2015-07-21 11:23:42 -07:00
dellaert 4c8c669d71 Moved NavState to its own header and totally revamped as a semi-direct product 2015-07-21 11:23:24 -07:00
dellaert 205d20d4dc Rot3 action on Vector3, and templated constructor 2015-07-21 11:22:49 -07:00
dellaert 8a8503ee33 New retract. Still some bug in derivative 2015-07-20 21:40:58 -07:00
dellaert 814c170caa Added reference, made documentation consistent 2015-07-20 20:57:47 -07:00
dellaert 6496bd49ed Separate and much simplified computeError works 2015-07-20 09:16:57 -07:00
dellaert 1ce6ab893d predict derivative works ! 2015-07-20 00:58:41 -07:00
dellaert 3a941a0ef4 NavState retract derivatives 2015-07-20 00:55:34 -07:00
dellaert 2df20b4f37 Second order coriolis done 2015-07-19 23:58:06 -07:00
dellaert 5f6d3a600f First order coriolis derivatives 2015-07-19 23:40:20 -07:00
dellaert a56c6e728b Small refactor 2015-07-19 23:39:44 -07:00
dellaert ee747604e7 No more MakeParams 2015-07-19 23:39:19 -07:00
dellaert 607fb4e37b Merge remote-tracking branch 'origin/develop' into feature/cleanup_ImuFactor 2015-07-19 21:27:16 -07:00
dellaert 76abf553b0 biasCorrectedDelta and test of its derivatives 2015-07-19 21:24:38 -07:00
dellaert 1229ca6fee OptionalJacobians 2015-07-19 21:24:17 -07:00
dellaert 13cca7be00 MakeParams 2015-07-19 21:23:16 -07:00
Frank Dellaert 6058d045ae Merged in feature/OptionalJacobianBlocks (pull request #177)
New OptionalJacobian functionality
2015-07-19 20:20:53 -07:00
Frank Dellaert 2deac4b88f Some fixed-size optimizations, some const. Save a quaternion->matrix conversion in transform_from. 2015-07-19 18:54:59 -07:00
Frank Dellaert c3dfa3ab10 Cleaned up Pose2 derivatives and used OptionalJacobian::cols in some places 2015-07-19 18:28:18 -07:00
Frank Dellaert f2df547d86 Functioning "cols" method. Unfortunately, "rows" and "block" are not easy. 2015-07-19 17:15:26 -07:00
dellaert d4d99c390d A custom retract does the trick 2015-07-19 03:31:11 -07:00
dellaert f32a7cbd00 Parsed out tangent space operations 2015-07-19 02:54:28 -07:00
dellaert 9382641445 Use constants, slight renaming 2015-07-19 01:52:53 -07:00
dellaert 7b02a01a44 Simplified deprecated methods 2015-07-19 01:52:23 -07:00
dellaert 042d874f08 Introduce and use NavState for predict 2015-07-19 01:52:08 -07:00
dellaert 3c59168406 Inlined Logmap and derivatives, removed from PreintegratedRotation 2015-07-19 00:54:25 -07:00
dellaert 814b8c22bf Moved a derivative down 2015-07-19 00:40:42 -07:00
dellaert c72a8344ec Added derivatives where they should be... 2015-07-19 00:40:07 -07:00
dellaert 272a563022 expmap/logmap derivatives 2015-07-19 00:39:47 -07:00
dellaert a5d49a261e Fixed MATLAB wrapper (old-style interface still) 2015-07-18 23:11:27 -07:00
Frank Dellaert 0df1e345a3 Complete refactor with a shared parameter to fixed parameters. Tests still use old-style and all pass, because of hacky backwards compatible functions. 2015-07-18 18:30:42 -07:00
Frank Dellaert 45e99f05b6 Fixed test 2015-07-18 18:28:39 -07:00
Frank Dellaert 2c765c735a Velocity3 default constructor does not zero 2015-07-17 22:09:49 -07:00
dellaert 233cabb3fb Made Velocity a Vector3 2015-07-17 17:36:29 -07:00
dellaert d5bf2493fe Fixed remaining method call 2015-07-17 16:57:16 -07:00
dellaert 55269d642c Fixed order of components in error to match RTV order 2015-07-17 15:34:58 -07:00
dellaert 61c58c6fa6 Fixed naming convention 2015-07-17 15:33:20 -07:00
dellaert fd0ad8ae78 Removed some useles computation 2015-07-17 15:32:58 -07:00
dellaert 52baa97eca Some fixed-size matrix optimizations 2015-07-17 12:00:03 -07:00
dellaert 2d425ad7be More substantial jacobian refactor 2015-07-17 01:27:07 -07:00
dellaert 66a9c34840 Clean up jacobians a bit 2015-07-17 01:14:44 -07:00
dellaert d45d2e17ed inline transpose 2015-07-17 01:07:15 -07:00
dellaert 8ff4c98337 Rationalize predict 2015-07-17 00:52:47 -07:00