Commit Graph

4178 Commits (a5f28ac8f412215ff6a4865eeef1211bcc17e13c)

Author SHA1 Message Date
Richard Roberts 124a38f72d Made unit test local vars/functions in anonymous namespace 2013-04-22 17:44:09 +00:00
Richard Roberts dd84ffcc8e Fix in Rot3Q constructor 2013-04-22 17:44:07 +00:00
Richard Roberts bd38ae5c68 Added Alex as author 2013-04-22 17:44:06 +00:00
Richard Roberts 82c8fffd28 Added missing dllexport in LieScalar 2013-04-22 17:44:05 +00:00
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
Duy-Nguyen Ta b1b05887fc allow method starting with uppercase letter to be wrapped in matlab. Wrap Pose3's AdjointMap and Adjoint operator 2013-04-21 19:29:41 +00:00
Duy-Nguyen Ta 96f9ecaf53 Change "adjoint" and "adjoint_map" to Adjoint and Adjoint_map, since they correspond to Lie group's Ad operator. Implement the Lie algebra's adjoint operator, aka Lie bracket, and the inverse right-trivialized tangent map of the exponential map using the trapezoidal Lie-Newmark scheme, as detailed in [Kobilarov09siggraph] 2013-04-21 05:50:07 +00:00
Stephen Williams c1f14d60be Purged unused code 2013-04-19 12:16:18 +00:00
Stephen Williams 201ca3da9e Removed debug print statement 2013-04-19 12:16:04 +00:00
Stephen Williams 3eade960b8 Fixed bugs in marginal generation. It is possible that the marginalization will be "perfect", resulting in no marginal factor. However, a factor was being created anyway. 2013-04-19 12:13:43 +00:00
Stephen Williams 584f5c6c8c Fixed typos in class names 2013-04-18 21:01:44 +00:00
Alex Cunningham 88d3def0db Added assert_inequal for matrices 2013-04-18 18:12:37 +00:00
Richard Roberts ddea66e026 Disabled additional msvc warnings 2013-04-18 17:41:56 +00:00
Richard Roberts 31cbc7c826 relax two test criterion from 1e-5 to 2e-3 so they pass on Ubuntu VM 2013-04-18 17:41:55 +00:00
Duy-Nguyen Ta 541d416c84 comment for VelocityConstraint3::evaluateError 2013-04-17 21:25:15 +00:00
Duy-Nguyen Ta 494885bf1d factors for the pendulum discrete mechanics in position-momentum form to use with variational integrator 2013-04-16 19:07:59 +00:00
Alex Cunningham 6b87b9d307 comments only 2013-04-16 16:52:21 +00:00
Stephen Williams 6ffe6a08df Fixed bug in LinearContainerFactor only present during relinearization 2013-04-16 14:58:09 +00:00
Duy-Nguyen Ta 37d244e49b fix bug in PendulumFactor2's jacobian 2013-04-16 02:17:19 +00:00
Duy-Nguyen Ta 6a139bd0f8 Factors for the simple Pendulum dynamics for being used with explicit/implicit/sympletic Euler integrators as in [Stern06siggraph] 2013-04-15 21:31:47 +00:00
Stephen Williams c2fb82b935 Added matlab wrapping for Fixed-Lag Smoothers and Concurrent Filters and Smoothers 2013-04-15 19:54:46 +00:00
Stephen Williams f216e97a15 Modified the getter method in the FixedLagSmoother base class to follow general GTSAM conventions 2013-04-15 17:53:33 +00:00
Alex Cunningham 6804ef77b1 Removing limitation on precision in Pose2::print() 2013-04-15 16:35:13 +00:00
Stephen Williams 41238572c1 Extended the Concurrent Filtering and Smoothing example to include a delayed loop closure 2013-04-15 16:07:40 +00:00
Duy-Nguyen Ta ed1f5f7576 add cpp file for LieScalar. Try to debug the "same-name-different-type" problem in matlab wrapper. 2013-04-12 15:43:36 +00:00
Stephen Williams 693a0f991a Added the Filter<->Smoother synchronization back into the example 2013-04-12 13:05:52 +00:00
Stephen Williams f3007f5013 Moved the pre-sync code back into the presync() function call. This allows the Filter and Smoother to synchronize properly even when no call to smoother.update() has been made. 2013-04-12 13:05:20 +00:00
Stephen Williams 34d7742d95 Added first version of a Concurrent Filtering and Smoothing example 2013-04-12 12:53:34 +00:00
Stephen Williams 03db2b7e55 Modified comments 2013-04-12 12:53:05 +00:00
Stephen Williams 460a428c97 Provided default parameters for concurrent batch filter and smoother constructors 2013-04-12 12:52:29 +00:00
Stephen Williams 1c738123b9 Fixed inconsistency between odometry measurements and initializations 2013-04-12 12:51:22 +00:00
Stephen Williams 5087e4eabc Modified Fixed-Lag Smoothing example to call iSAM2 multiple times to recover the same solution as batch 2013-04-11 21:10:32 +00:00
Stephen Williams 321de2f701 Removed debugging check from IncrementalFixedLagSmoother and added work around for tree reordering 2013-04-11 20:55:55 +00:00
Stephen Williams c902908115 Added 'examples' folder to gtsam_unstable 2013-04-11 20:47:25 +00:00
Stephen Williams 95e97c2dfc Changed the default 'enforceConsistency' flag to true in the Batch Fixed-Lag Smoother to match the incremental version 2013-04-11 20:07:58 +00:00
Stephen Williams d44a9e3b75 Removed unused code from Concurrent Batch Filter unit test 2013-04-11 19:16:52 +00:00
Stephen Williams f963aeb401 Completed rewrite of synchronization functions for the Concurrent Batch Filter 2013-04-11 19:16:15 +00:00
Stephen Williams 04d595dec1 Started re-implementing the synchronization functions for the Concurrent Filter 2013-04-11 12:43:42 +00:00
Stephen Williams 634a4c5ef9 Updated Concurrent Smoother for changes in the base class synchronization 2013-04-11 12:42:45 +00:00
Stephen Williams 0a459549f8 Updated synchronization interface to require the smoother and filter to track their own separator keys and values 2013-04-11 12:42:09 +00:00
Duy-Nguyen Ta 08e6d8860b wrap VelocityConstraint3 2013-04-11 12:07:42 +00:00
Duy-Nguyen Ta 72325d673d simple 3-way factor velocity constraint with LieScalar 2013-04-10 22:02:21 +00:00
Stephen Williams 1952337e23 Removed unused code from Concurrent Batch Smoother 2013-04-10 21:08:52 +00:00
Alex Cunningham 3e754ecd70 Comments and argument name only change 2013-04-10 19:35:48 +00:00
Alex Cunningham 9b2a74bbaf Fixed problem with building convenience libraries with empty source files 2013-04-10 15:47:01 +00:00
Stephen Williams dce575cb73 Refactored synchronization code for Concurrent Batch Smoother 2013-04-10 15:22:28 +00:00
Stephen Williams e4b452473e Removed variable index from equal test in ConcurrentBatchFilter 2013-04-10 15:21:50 +00:00
Stephen Williams 5cd020080b Added marginalization code and unit tests to ConcurrentBatchFilter 2013-04-10 12:47:55 +00:00
Stephen Williams e10413c135 Added pop_back to VectorValues 2013-04-10 12:47:13 +00:00
Stephen Williams ed560aa13a Updated unit tests for changes in the Concurrent Filtering and Smoothing classes. Currently the synchronization tests are disabled. 2013-04-09 21:48:48 +00:00