Commit Graph

2066 Commits (release/4.3a0)

Author SHA1 Message Date
Richard Roberts f4d816dcf8 Disabled testSmartProjectionFactor and made print message about this 2013-08-11 18:40:57 +00:00
Richard Roberts f240327f24 Fixed testIMUSystem and BetweenFactorEM 2013-08-11 18:40:47 +00:00
Richard Roberts 0db8e446d5 Disabled gtsam_unstable/nonlinear filters and smoothers 2013-08-11 18:40:39 +00:00
Richard Roberts 4585fd1caa Merge branch 'svn/trunk'
Conflicts:
	gtsam/navigation/tests/testInertialNavFactor_GlobalVelocity.cpp
	gtsam/nonlinear/ISAM2.cpp
	gtsam/nonlinear/ISAM2.h
	gtsam/slam/tests/testBetweenFactor.cpp
	gtsam_unstable/nonlinear/ConcurrentBatchFilter.cpp
	gtsam_unstable/nonlinear/tests/testConcurrentBatchFilter.cpp
	gtsam_unstable/nonlinear/tests/testConcurrentBatchSmoother.cpp
	gtsam_unstable/slam/SmartProjectionFactor.h
2013-08-11 18:16:56 +00:00
Stephen Williams f41d4b879b Added the ability to remove factors from ConcurrentIncrementalFilter 2013-08-10 17:16:47 +00:00
Stephen Williams 34a3a6ea49 Added the ability to remove factors from the ConcurrentBatchFilter 2013-08-10 17:16:38 +00:00
Stephen Williams ebc6a66c3a Updated to the marginal factor calculation in BatchFixedLagSmoother to
be more efficient
2013-08-10 17:16:31 +00:00
Stephen Williams 12d003229a Fixed missing '}' 2013-08-10 17:16:19 +00:00
Stephen Williams c33c6e2c70 Added unit tests for Concurrent Incremental Filter and Smoother 2013-08-10 17:15:48 +00:00
Stephen Williams 915dc98bd2 Updated unit tests for Concurrent Batch Filter and Smoother 2013-08-10 17:15:38 +00:00
Stephen Williams f656e93202 Created Concurrent Incremental Filter and Smoother 2013-08-10 17:15:31 +00:00
Stephen Williams 663c598591 Updated Concurrent Batch Filter and Smoother to the latest versions 2013-08-10 17:15:20 +00:00
Stephen Williams 1dc0e6192b Added accessor functions for internal data structures to
IncrementalFixedLagSmoother
2013-08-10 17:15:03 +00:00
Richard Roberts bb4ad176da Needed std:: 2013-08-09 18:50:15 +00:00
Richard Roberts 1eae17561d Taking ImuFactor noise model automatically from preintegrated measurement covariance 2013-08-09 18:50:14 +00:00
Chris Beall c03172aca3 add prior on second camera 2013-08-09 15:31:15 +00:00
Chris Beall 369e69b0d2 actually set everything to zero to turn factor off during linearization 2013-08-09 15:28:57 +00:00
Zsolt Kira 8d9dcfbfc2 Fixed problem with pixel_sigma (2-dimensional only)
Added switch to determine if normal GenericProjectionFactor or SmartProjectionFactor is used
2013-08-09 14:52:26 +00:00
Alex Cunningham 5b7d7b3793 Closer to building and tests running 2013-08-08 20:45:44 +00:00
Vadim Indelman b0c96f9bf6 unwhitenedError. 2013-08-08 20:14:12 +00:00
Vadim Indelman 27cabb62f1 added unwhitenedError to BetweenFactorEM. 2013-08-08 20:13:39 +00:00
Alex Cunningham 4a4e16485c Making more things in gtsam_unstable compile 2013-08-08 20:08:54 +00:00
Alex Cunningham 883c870dff Removed unnecessary summarization files in gtsam_unstable, restricted compilation of gtsam_unstable for components needing iSAM2 - core gtsam_unstable library builds 2013-08-08 20:08:52 +00:00
Zsolt Kira 5af82c4042 SmartProjectionFactor example: Cleaned up some code, added comments,
changed some of the LM parameters.  Switched to use smaller kitti
dataset for now.
2013-08-08 17:16:23 +00:00
Vadim Indelman 579e0931dc Fixed different issues with EM. 2013-08-08 15:12:21 +00:00
Luca Carlone b3ea3f9465 lines added to testSmartProjectionFactor 2013-08-08 14:30:26 +00:00
Zsolt Kira 6dd67a13fd Changed to optimize entire graph instead of sub-graphs 2013-08-08 14:20:08 +00:00
Luca Carlone a82262cf99 Included noise model and f term in SmartProjectionFactor 2013-08-08 14:00:26 +00:00
Zsolt Kira 159f9eee1e Added SmartProjectionFactorExample_kitti.cpp.
Currently loads kitti dataset after processing by VO code (stereo_factors.txt and camera_poses.txt)
Creates graph after N landmarks have been seen, runs it through SmartProjectionFactor
Verification of output is still needed; LM seems to optimize but poses don't seem to change.
2013-08-08 03:11:42 +00:00
Zsolt Kira f423d6f2a8 SmartProjectionFactor: More cleanup, added more tests, added some timing 2013-08-07 23:32:40 +00:00
Vadim Indelman d33f435eab Added BetweenFactorEM with 2 indicator variables. 2013-08-07 15:25:00 +00:00
Zsolt Kira c2f5adc7d0 Cleaned up code: Removed commented out code, added debug condition
If debug is enabled, both blockwise and full implementations are performed and then compared
2013-08-07 13:05:08 +00:00
Richard Roberts e2f8dd866d Merge branch 'svn/trunk'
Conflicts:
	gtsam/linear/GaussianBayesTree.cpp
	gtsam/linear/GaussianBayesTree.h
	gtsam/linear/VectorValues.h
	gtsam/linear/tests/testVectorValues.cpp
	gtsam_unstable/nonlinear/sequentialSummarization.cpp
2013-08-06 18:33:24 +00:00
Richard Roberts 2d60d2cdfa Fixed more unit tests 2013-08-06 18:04:40 +00:00
Richard Roberts e39d100b6a Made most global unit tests compile, includes dogleg, iterative, kalman filter, etc 2013-08-06 13:44:22 +00:00
Luca Carlone 482c5df647 updates in SmartProjectionFactor: first working version with full and block version producing the same results (non-optimized) 2013-08-05 22:34:31 +00:00
Richard Roberts ede0805fac Global find+replace to remove Ordered 2013-08-05 22:31:44 +00:00
Richard Roberts cb7eb1b510 Find+replace Ordered headers 2013-08-05 22:31:33 +00:00
Richard Roberts 09643929fd Making some tests compile 2013-08-05 22:31:26 +00:00
Richard Roberts 628d4e0d77 Disabled discrete for the time being 2013-08-05 22:30:52 +00:00
Luca Carlone 2e085ace91 Changes in SmartProjectionFactor 2013-08-05 19:25:08 +00:00
Chris Beall 5518007317 adding test with regular projection factors for comparison, and bug fixes in SmartFactor test. 2013-08-05 17:58:32 +00:00
Chris Beall d1de6b29a9 adding 3 camera, 3 landmark test 2013-08-05 15:50:19 +00:00
Luca Carlone 39ec641c4a Modifications to SmartProjectionFactor and unit test: work in progress 2013-08-05 15:09:03 +00:00
Luca Carlone d1419a3d11 Added SmartProjectionFactor (+unit tests) 2013-08-02 23:35:39 +00:00
Richard Roberts f273b8f915 Removed extra 'typename' 2013-08-02 16:04:29 +00:00
Richard Roberts 34dc67c1af Brought some relevant changes from aspn-imu-factor branch (is correct this time) 2013-08-02 16:04:17 +00:00
Alex Cunningham 424ef0728f Changed a filename to avoid having multiple object files of the same name in the library 2013-08-01 16:54:44 +00:00
Richard Roberts 2705d85fa7 Merged from branch 'trunk' 2013-07-31 18:55:15 +00:00
Luca Carlone ed79432a69 Added MultiProjectionFactor, invoving n views (camera poses) observing a single landmark: work in progress 2013-07-31 18:02:56 +00:00
Richard Roberts 34998b3435 Added missing export tag 2013-07-31 15:36:39 +00:00
Richard Roberts 321a286f02 Revert "Brought some relevant changes from aspn-imu-factor branch"
This reverts commit b08a11ffb27d14487115f20745f1cea17fcc55ee.
2013-07-31 15:26:48 +00:00
Richard Roberts b62af20fdc Revert "Removed extra 'typename'"
This reverts commit 04fd69f56c1e1cbd934a54aeb415e2cf2132d236.
2013-07-31 15:26:46 +00:00
Richard Roberts 90cf73d4a7 Removed extra 'typename' 2013-07-31 15:25:05 +00:00
Richard Roberts 7345b40feb Brought some relevant changes from aspn-imu-factor branch 2013-07-31 15:25:03 +00:00
Chris Beall 201a7bfda5 adding triangulation function needed by new Schur complement factor 2013-07-30 18:52:06 +00:00
Richard Roberts 3ade190128 Renamed old classes to "Ordered" and removed "Unordered" name from new classes 2013-07-29 23:55:40 +00:00
Richard Roberts b5c530d080 Merge branch 'svn/trunk'
Conflicts:
	CMakeLists.txt
2013-07-09 17:54:06 +00:00
Richard Roberts ecb24ebd06 Fixes to include path ordering and boost libraries 2013-07-09 15:43:55 +00:00
Richard Roberts d7767188b3 Merged from branch 'trunk' 2013-07-01 13:11:15 +00:00
Alex Cunningham f3aa2fde53 Fixed compile error 2013-06-25 17:22:45 +00:00
Frank Dellaert 0837eab8f5 Scripts to test (still not working so-well) smart range factor 2013-06-25 17:13:02 +00:00
Richard Roberts 31a9319fca Merge branch 'trunk' 2013-06-24 19:30:29 +00:00
Richard Roberts bad9373aec Merge branch 'trunk' 2013-06-24 19:30:24 +00:00
Richard Roberts 26df712592 Put new unit test global variables into anonymous namespaces. Removed dll export tag from SmartRangeFactor since it is a header-only class. 2013-06-24 19:30:00 +00:00
Frank Dellaert 39910717d6 Picked the winner 2013-06-24 16:25:02 +00:00
Frank Dellaert 34db300802 Fixed n<3 Jacobians 2013-06-24 16:18:48 +00:00
Frank Dellaert 3383e52c5f Split unit tests.... 2013-06-24 16:02:17 +00:00
Frank Dellaert 43fe036c32 Made more efficient by adding errors -> Jacobians back to 1*3, always. This is big savings if a landmark is seen from many poses. 2013-06-24 15:57:03 +00:00
Frank Dellaert aea4f31096 Fixed Jacobians, optimization works 2013-06-24 15:31:13 +00:00
Richard Roberts 123657e3d0 Merged from branch 'trunk' 2013-06-24 15:28:16 +00:00
Frank Dellaert b7dbcefa8b simplified measurements_ to vector 2013-06-24 12:15:01 +00:00
Frank Dellaert 4b412b0a4b keys and Jacobians 2013-06-24 12:07:21 +00:00
Frank Dellaert 40bc7070ff Example in unstable, to use SmartRangeFactor 2013-06-24 12:06:47 +00:00
Frank Dellaert d041c5b8a8 Split up circle intersection code into three routines that are used in SmartRangeFactor 2013-06-24 08:24:56 +00:00
Frank Dellaert 5f5e481394 AHRS mechanization small efficiency change (in progress) 2013-06-21 00:21:18 +00:00
Alex Cunningham e7334b89bd Rebasing... 2013-06-20 17:08:30 +00:00
Richard Roberts 5ae4f21517 Added missing dll export tags to new functions 2013-06-20 16:05:23 +00:00
Alex Cunningham 456d1b5cf7 Cleanup: moving old serialization function to gtsam_unstable, renaming matlab serializaion test 2013-06-19 17:50:09 +00:00
Alex Cunningham 45b5389f8a Serialized more classes in gtsam and gtsam_unstable 2013-06-19 17:50:07 +00:00
Richard Roberts 8f9d5ec2e2 Merge branch 'trunk' 2013-06-17 21:15:57 +00:00
Kyel Ok d85c773f7c Changes in AHRS - flat trim initialization added, some comments by Frank, aidingAvailablitiy function 2013-06-14 21:18:22 +00:00
Alex Cunningham 9e3bfdc4f8 comments only 2013-06-11 14:36:54 +00:00
Alex Cunningham 083e0c849e Switched to templated version of liquefy() to allow for use with non-default clique types 2013-06-11 14:36:53 +00:00
Alex Cunningham 83a1483e9f Adding unit tests and a bugfix for liquefying bayes tree function 2013-06-11 14:36:52 +00:00
Alex Cunningham 361682c485 Working on a test for liquefy 2013-06-11 14:36:51 +00:00
Richard Roberts d5e721a1d0 Continued work on unordered classes and elimination algorithm 2013-06-06 15:36:11 +00:00
Frank Dellaert ebcc638ef5 renamed dist to distance (dist still works but now deprecated) 2013-06-05 16:11:36 +00:00
Richard Roberts b2d4469cb3 Added missing export tag 2013-06-04 17:34:02 +00:00
Stephen Williams 1e5f9c742d Revert "Modified Concurrent Filter to calculate marginals using a "shortcut" that allows constant-time updates during synchronization. Still need to test implementation."
This reverts commit f24a4f4668006cfe9a3eeb1658b7df03c74490d5.
2013-05-22 00:05:03 +00:00
Stephen Williams 8e26da7396 Added matlab version of the Concurrent Filtering and Smoothing example 2013-05-21 21:07:45 +00:00
Stephen Williams 5f371a4e55 Modified Concurrent Filter to calculate marginals using a "shortcut"
that allows constant-time updates during synchronization. Still need to
test implementation.
2013-05-21 21:07:43 +00:00
Richard Roberts 16c11c70fb Fixes to compile on Windows 2013-05-21 17:24:49 +00:00
Stephen Williams 13d3f1cb6e Updated Fixed-Lag smoother example 2013-05-21 14:57:40 +00:00
Duy-Nguyen Ta 77c2e37a4d remove unused debug variables 2013-05-21 00:03:05 +00:00
Frank Dellaert 03977ba628 Added wrapping of AHRS 2013-05-20 23:28:38 +00:00
Frank Dellaert 1d9000724d Moved AHRS to gtsam_unstable 2013-05-20 23:16:44 +00:00
Stephen Williams 1c5061cf3c Added optional flag to ConcurrentBatchFilter to control relinearization
during syncs.
2013-05-17 08:06:06 +00:00
Alex Cunningham d4ec018d0f Added constructors to Point2Vector 2013-05-13 20:48:09 +00:00
Richard Roberts 50866b9a0e Partial fix for compiling statically on Windows 2013-05-13 18:04:36 +00:00
Stephen Williams 7d03d3c502 Moved pre-sync code to the update() call for the cuncurrent smoother 2013-05-09 18:59:22 +00:00
Stephen Williams 93149ae5f2 Updated Concurrent example, forcing a call to smoother.update() between
each synchronization
2013-05-09 18:59:20 +00:00
Chris Beall 7ad3de6bc0 documentation 2013-05-08 20:10:49 +00:00
Chris Beall 32b3eebf07 removed redundant shared_ptr typedefs in Cal3_S2 and Cal3_S2Stereo 2013-05-08 19:21:00 +00:00
Stephen Williams 9e39df6e88 Added PriorFactor and BetweenFactor with optional sensor pose
transformations. Ideally these should simply be the PriorFactor and
BetweenFactor, but more investigation is needed.
2013-05-08 13:23:56 +00:00
Stephen Williams f68e301458 Wrapped Inverse Depth Factor variants 2013-05-08 13:23:39 +00:00
Stephen Williams 54808f6d44 Added several experimental versions of an Inverse Depth Factor 2013-05-08 13:23:35 +00:00
Alex Cunningham acd6e629e8 Moved older functions back to gtsam_unstable, cleanup. All tests pass. Rearranged summarization wrap interfaces. 2013-05-08 10:13:57 +00:00
Alex Cunningham 81f63bcc0e Rearranging summarization, now with unit test in gtsam 2013-05-08 10:11:45 +00:00
Stephen Williams 36e66b2f0b Fixed synchronization code in ConcurrentBatchFilter such that an empty graph does not trigger a segfault 2013-05-01 20:54:53 +00:00
Duy-Nguyen Ta 444ab957c4 a numerical derivative version for DiscreteEulerPoincare'Factor, but currently disabled. 2013-05-01 17:30:21 +00:00
Alex Cunningham 62f6089119 Updated matlab wrapping for moved factors 2013-04-30 17:50:48 +00:00
Alex Cunningham a069d24374 Moved PoseRotationPrior, PoseTranslationPrior and ReferenceFrameFactor to gtsam.slam 2013-04-30 17:50:47 +00:00
Duy-Nguyen Ta 84ababc653 wrap SimpleHelicopter factors and fix a bug in noisemodel dimension 2013-04-30 17:21:42 +00:00
Duy-Nguyen Ta 26c63ec122 increase tolerance in TEST( testPoseRTV, Lie ) 2013-04-29 23:35:08 +00:00
Duy-Nguyen Ta e4a9c398c8 Factor for Discrete Euler Poincare' equation in SE3 for Simple Helicopter dynamics with correct dertivatives 2013-04-29 17:21:13 +00:00
Alex Cunningham 224be276e4 Added a new summarization convenience function and cleaned up documentation 2013-04-26 18:27:22 +00:00
Alex Cunningham 2b7d173c22 Added include path for generated headers when wrapping 2013-04-25 18:24:41 +00:00
Stephen Williams 009012005e Removed VariableIndex from the class members as it was often left in an inconsistent state 2013-04-25 18:12:05 +00:00
Stephen Williams 1e1dfdd808 Updated BatchFixedLagSmoother to use the latest version of optimization and marginalization code 2013-04-25 18:10:21 +00:00
Richard Roberts eeef9eab32 Generating config.h file in CMake with quaternion mode flag, dataset paths. Also added CMake option to use system-installed Eigen, which works by generating a global eigen include file containing the corresponding include paths. 2013-04-25 15:57:15 +00:00
Richard Roberts 5f3238634d Added missing GTSAM_UNSTABLE_EXPORT tag 2013-04-25 15:57:06 +00:00
Alex Cunningham 38af960c53 removed commented line 2013-04-24 17:34:49 +00:00
Alex Cunningham 1c17065376 Removed unnecessary templated traits from partial pose priors - now uses rotationInterval and translationInterval 2013-04-24 17:34:48 +00:00
Richard Roberts 124a38f72d Made unit test local vars/functions in anonymous namespace 2013-04-22 17:44:09 +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
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
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
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
Stephen Williams 41238572c1 Extended the Concurrent Filtering and Smoothing example to include a delayed loop closure 2013-04-15 16:07:40 +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
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 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
Stephen Williams 0b5c07e543 Starting to clean up and refactor the Concurrent Filtering and Smoothing classes. Currently the synchronization is disables, as is the marginalization in the filter. 2013-04-09 21:24:05 +00:00
Richard Roberts 35cebaa873 Moved inertial nav factors and unit tests to gtsam/navigation 2013-04-09 20:04:10 +00:00
Richard Roberts b68fee7b00 Fixed bug in hessian_equal in testConcurrentBatchFilter 2013-04-09 19:53:59 +00:00
Stephen Williams ed90b00edf Updated ConcurrentBatchSmoother to use LinearContainerFactors 2013-04-09 15:48:53 +00:00
Stephen Williams 4f064be4fa Updated synchronization code for CConcurrent Filter 2013-04-09 15:39:24 +00:00
Vadim Indelman 244ea20f9c Clean-up. 2013-04-08 22:49:55 +00:00
Stephen Williams 4c6a460fa0 Fixed bugs in tic-toc statements for Concurrent Filter and Smoother 2013-04-08 17:42:26 +00:00
Richard Roberts 7c362b2cbd Loosened unit test thresholds slightly to account for roundoff error on some systems 2013-04-05 19:12:46 +00:00
Richard Roberts dd18366a2f Loosened unit test thresholds slightly to account for roundoff error on some systems 2013-04-05 19:09:51 +00:00
Richard Roberts b9820550e2 Added DLL export tags to new code 2013-04-05 19:06:28 +00:00
Richard Roberts 67e36febf2 Added DLL export annotations on new code 2013-04-01 19:29:53 +00:00
Richard Roberts f773a34834 Renamed experimentalMarginalizeLeaves to marginalizeLeaves and added comment 2013-03-26 20:46:08 +00:00
Alex Cunningham 233c8aa7bb Moved summarization functions 2013-03-23 20:19:43 +00:00
Alex Cunningham f45c5c5f44 Actually installing headers from unstable/linear 2013-03-23 20:19:42 +00:00
Alex Cunningham a2bc0f8ae5 Fixing wrapped typedefs 2013-03-23 20:19:40 +00:00
Alex Cunningham 045072746d Cleaning up extraneous namespace references 2013-03-23 20:19:39 +00:00
Alex Cunningham da334ed8a2 Added linear tools (including summarization) from MastSLAM 2013-03-23 20:19:36 +00:00
Alex Cunningham a0b55c3ff7 Moved additional wrap definitions 2013-03-23 20:19:32 +00:00
Alex Cunningham 3c2e037b16 Moved geometry components from MastSLAM for Pose3Upright, BearingS2, SimWall2D and SimPolygon2D 2013-03-23 20:19:30 +00:00
Frank Dellaert 458707ed45 Small changes for Qualifier 2013 Scheduling 2013-03-19 18:05:13 +00:00
Stephen Williams 396732ff6a Only call iSAM2 marginalize function if there are actually keys to marginalizae out 2013-03-18 22:28:14 +00:00
Stephen Williams 9e1a07fcec Added debugging function to IncrementalFixedLagSmoother 2013-03-18 21:39:07 +00:00
Stephen Williams f03be70770 Updated iSAM2 Marginalize call for the latest version of GTSAM 2013-03-18 21:32:43 +00:00
Richard Roberts a54d177202 Added dll export tags and updated cmake scripts so that GTSAM can build as a shared library on windows 2013-03-13 18:56:21 +00:00
Richard Roberts 6111c099ab Improved build of shared vs static GTSAM libraries - now possible to build either one or both, executables link to the shared if it is being build, or otherwise to the static. Also removed separate shared/static CMake flags for gtsam_unstable, now uses the same GTSAM_BUILD_SHARED and GTSAM_BUILD_STATIC as gtsam. 2013-03-13 18:17:39 +00:00
Stephen Williams eacbaeb84d Updated incremental version of the fixed lag smoother to use the in-development iSAM2 marginalize functionality 2013-03-05 20:54:00 +00:00
Stephen Williams 60d3ba2d0e Added and incremental fixed-lag smoother using new iSAM2 marginalization functionality, and created a common base class for all fixed-lag smoother implementations. 2013-02-27 20:23:47 +00:00
Richard Roberts 2b27c14dac Fixed compile errors on windows 2013-02-24 19:09:52 +00:00
Stephen Williams 6fef6cf7d5 Added Fixed Lag Smoother and Concurrent Filtering and Smoothing to gtsam_unstable 2013-02-19 21:37:17 +00:00
Stephen Williams bc16edd2ac Added Equivalent IMU factor to gtsam_unstable 2013-02-19 21:24:44 +00:00
Alex Cunningham 8fc5ab527d Comments only - appear to be unnecessary variables? 2013-02-14 20:42:14 +00:00
Richard Roberts 542d396d3b Missing qualifying namespace on sqrt in InertialNavFactor_GlobalVelocity.h 2013-02-05 21:52:51 +00:00
Richard Roberts 6572400bc3 Improved handling of Boost shared libraries on Windows 2013-02-04 21:28:39 +00:00
Vadim Indelman 4f5b9f2074 added imu factor (global velocity) 2013-01-24 21:01:10 +00:00
Richard Roberts 880d98e068 Chain test on Cholesky 2012-12-11 19:14:39 +00:00
Richard Roberts 7851d5553b Updated MATLAB cholesky scaling experiment 2012-12-11 19:14:36 +00:00
Chris Beall 879417cb0d more documentation and cleanup: missed a file 2012-11-29 18:20:39 +00:00
Chris Beall 6b67238dd3 more documentation and cleanup 2012-11-29 18:19:28 +00:00
Richard Roberts ca16f341f9 Changed badscale to a more reasonable value in Cholesky scaling test 2012-11-26 19:21:13 +00:00
Richard Roberts 60f29fde15 MATLAB tests for Cholesky scaling and preconditioning 2012-11-23 23:24:58 +00:00
Alex Cunningham 237da8b3a7 Moved LinearContainerFactor to gtsam/nonlinear and removed the now-redundant LinearizedFactor from gtsam_unstable 2012-11-21 19:41:24 +00:00
Alex Cunningham cba120c96d LinearContainerFactor now includes ability to "relinearize" when supplied with an original linearization point 2012-11-21 19:02:13 +00:00
Richard Roberts 00b12c7dc1 Added simple matrix-math eliminate and shortcut functions, and a simple matrix-math test of the feasibility of correcting root shortcut joint marginals. 2012-10-29 15:52:02 +00:00
Alex Cunningham c3f38349b4 Fixed include paths for matlab modules 2012-10-28 20:48:17 +00:00
Stephen Williams f9494679d2 Added optional derivatives to 'inverse' and 'compose' for variable type 'PoseRTV' 2012-10-22 17:31:41 +00:00
Richard Roberts 89b50e7679 Renamed tic -> gttic and toc -> gttoc to avoid conflict with PCL tic/toc 2012-10-02 20:18:41 +00:00
Richard Roberts c44f8f7f80 Fixed examples from timing statement change (missed) 2012-10-02 18:49:48 +00:00
Richard Roberts 4876cc7ff7 Revamped timing statements - much easier to use, exception-safe (see email to frankcvs list) 2012-10-02 18:36:39 +00:00
Chris Beall 4297d24c96 changed tabs to spaces for consistent indentation in all of GTSAM 2012-10-02 14:40:07 +00:00
Alex Cunningham 1985758d35 Updated interfaces and wrapped LinearContainerFactor 2012-09-21 14:19:57 +00:00
Alex Cunningham 0ef12f2f20 Moved in reference frame factor from MastSLAM 2012-09-19 02:23:43 +00:00
Alex Cunningham f272a07e29 Moved DummyFactor to gtsam_unstable from MastSLAM - allows for adding sufficient connectivity for solvers to operate 2012-09-18 17:48:18 +00:00
Chris Beall 49a952d237 more doxygen fixes 2012-09-07 19:12:02 +00:00
Chris Beall 9e960b4589 doxygen fixes 2012-09-07 18:54:12 +00:00
Yong-Dian Jian 6c2f213091 1. use DSFVector for spanning tree in SubgraphSolver
2. move DSFVector from unstable to stable
3. create Dummy.cpp to prevent base_unstable degenerate
2012-09-05 15:03:35 +00:00
Alex Cunningham d3b5c463ed Fixed initialization bug 2012-09-03 17:22:09 +00:00
Alex Cunningham d8e0a95890 Small bug-fixes for managing linearization points 2012-09-03 03:06:08 +00:00
Alex Cunningham 891fb2e038 comments only 2012-09-03 00:50:24 +00:00
Alex Cunningham 2285b14c5f Alternate matrix operation 2012-09-03 00:39:02 +00:00
Alex Cunningham 878c79f265 Reworked PoseRotationPrior with better tests and no dependence on PartialPriorFactor 2012-08-27 16:51:52 +00:00
Alex Cunningham 6b14e652ff Fixed bug in equality check 2012-08-27 01:40:11 +00:00
Alex Cunningham 12290dc7b2 Added linearization points to LinearContainerFactor. Fixed bug with localCoordinates() in Values 2012-08-27 01:11:37 +00:00
Alex Cunningham f9c3af7e3d Fixed bug in key assignment 2012-08-26 04:16:47 +00:00
Alex Cunningham c60fc3ca2a Relegated the PartialPriorFactor to gtsam_unstable 2012-08-24 21:39:56 +00:00
Richard Roberts 519ad72139 Made explicit instantiations in header file inline to avoid duplicate definition 2012-08-22 22:40:39 +00:00
Alex Cunningham 9962a66e7c Added utility functions for converting graphs with LinearContainerFactors, added direct order() to avoid the need to fake linearize. 2012-08-21 18:48:04 +00:00
Alex Cunningham bac1faa68e Added ordering-less negate() 2012-08-20 18:28:19 +00:00
Alex Cunningham 0aa72c986e wrapped RelativeElevationFactor 2012-08-20 14:25:10 +00:00
Alex Cunningham e488871ffd Fixed compile problem in toolbox for PoseTranslationPrior. Added planar tests. 2012-08-20 14:25:09 +00:00
Alex Cunningham 3794c2a7b7 Reworked PoseTranslationPrior so that it actually works now 2012-08-20 14:25:07 +00:00
Alex Cunningham 4fb9f3b39e Moved RelativeElevationFactor from MastSLAM 2012-08-20 14:25:04 +00:00
Alex Cunningham 83a853f6f1 Removed use of EasyFactorGraph 2012-08-04 19:48:52 +00:00
Richard Roberts 6f0c0fc7c5 Merged from branch 'trunk' 2012-08-03 21:09:59 +00:00
Richard Roberts 84924ad663 Removed remaining reference to slam namespace headers 2012-08-03 21:02:39 +00:00
Richard Roberts d93aac12d0 Fixed ambiguous sqrt/atan errors 2012-08-03 21:02:37 +00:00
Richard Roberts 711b28ae01 Merge remote-tracking branch 'svn/trunk' into remove_slam_namespaces
Conflicts:
	matlab/examples/Pose2SLAMExample_graph.m
2012-08-03 21:02:27 +00:00
Alex Cunningham 73d64d04a8 Removed unused make targets, changed wrap structure for PosePartialPriors 2012-08-03 19:49:26 +00:00
Alex Cunningham b211c1070d Rearranged the inverse depth factor/camera, created a gtsam_unstable/geometry folder - run cmake to find the new/moved files 2012-08-02 20:47:16 +00:00
Alex Cunningham 4c836c6e3a Wrapped Pose[Translation|Rotation]Factor 2012-08-02 19:57:10 +00:00
Chris Beall 93d9023a61 added InverseDepth factor based on Montiel/Civera's paramaterization. MOntiel06rss, Civera08tro 2012-08-02 19:27:36 +00:00
Stephen Williams e2e780de4d Removed SLAM namespaces from testLinearizedFactor 2012-07-23 22:51:18 +00:00
Alex Cunningham 46b2971e45 Removed imu dynamics example slam namespace 2012-07-22 18:49:07 +00:00
Alex Cunningham 4b772b43cf Simplified include handling in wrap: no more default includes, includes are not associated with a class or a namespace. 2012-07-17 18:30:02 +00:00
Richard Roberts e9f710a1ac More flexible handling of includes in wrap - can now use multiple includes both at the namespace and class levels, and namespace includes do not override the default class-name includes of their enclosed classes. 2012-07-17 15:51:35 +00:00
Richard Roberts e4f74354ca Wrapped factors in gtsam_unstable and updated PoseRTV 2012-07-13 21:55:05 +00:00
Richard Roberts 6c9608752e Small cleanups / fixes in handling of compile options 2012-07-13 21:55:00 +00:00
Richard Roberts 191d73df0b Simplified matlab wrapper cmake options 2012-07-13 21:54:52 +00:00
Alex Cunningham e337ab8b1d Merge branch 'master' into wrap_mods_local 2012-07-10 18:36:21 +00:00
Richard Roberts da5c924d58 Merged from branch 'trunk' 2012-07-06 18:37:55 +00:00
Alex Cunningham 1abf81052f Removed unused test file - linear containers to appear in MastSLAM 2012-07-06 14:48:25 +00:00
Richard Roberts ce4968d498 Wrap cmake options to more easily link with additional libraries 2012-07-05 14:04:55 +00:00
Richard Roberts 14c384c0dd wrap flags for gtsam_unstable 2012-07-05 14:04:53 +00:00
Alex Cunningham b33713a02e Merge branch 'master' into new_wrap_local
Conflicts:
	.cproject
	gtsam.h
2012-06-30 20:04:12 +00:00
Andrew Melim f68ba93f3d Dep checking for cmake 2012-06-30 01:34:04 +00:00
Frank Dellaert 0fe2d527f9 Fixed warnings due to discrete. GTSAM now Wall-safe? 2012-06-22 21:45:36 +00:00
Richard Roberts d5fbfcb7b7 Create and load CMake exports and config files 2012-06-19 22:06:40 +00:00
Frank Dellaert 82482e61fc Make unique IDs 2012-06-15 03:52:50 +00:00
Frank Dellaert 9d3bb30bc2 Dummy object for Andrew to play with 2012-06-15 01:01:25 +00:00
Alex Cunningham d36b8b63e7 Added versions of partial priors for parts of poses - useful for GPS or inertial priors. Added interval interface to Pose2 and Pose3. 2012-06-14 20:00:51 +00:00
Yong-Dian Jian 6fd2ac7f86 move iterative.* back to stable. add a template-style nonlinear iterative solver 2012-06-12 14:19:01 +00:00
Alex Cunningham 94560fcc45 Fixed factor equals 2012-06-10 19:55:01 +00:00
Alex Cunningham b602e75a99 Removed the use of the ADD_CLONE_NONLINEAR_FACTOR macro, documented instances of clone() in factors 2012-06-09 21:06:06 +00:00
Alex Cunningham 3d2c3aff05 Moved all Simulated* example domains and smallExample to the tests folder so they are no longer installed 2012-06-09 20:15:44 +00:00
Alex Cunningham f45c236585 Isolated exception case for use of Symbol.key(), removed use of Symbol in several tests. Removed "using namespace xxx" in header 2012-06-09 19:17:15 +00:00
Frank Dellaert 5b08dde1f3 Include -inl.h as is now custom 2012-06-09 18:50:29 +00:00
Yong-Dian Jian 734a18b02e old spcg solver fixed 2012-06-09 02:42:45 +00:00
Yong-Dian Jian 913160462a in the middle of resurrecting spcg 2012-06-08 16:45:16 +00:00
Richard Roberts 1913640d2c Qualified more namespaces after removing using namespace from headers 2012-06-08 14:34:03 +00:00
Richard Roberts d188ed2e1a Removed using namespace in header files 2012-06-08 14:33:59 +00:00
Richard Roberts a23127a315 Removed using namespace in header files 2012-06-08 14:33:36 +00:00
Alex Cunningham 14c38918c0 Store flags for the library targets 2012-06-07 20:42:13 +00:00
Alex Cunningham 61c7e8760b Fixed linking problem with gtsam_unstable/nonlinear 2012-06-07 18:48:40 +00:00
Alex Cunningham 111ef8a0f0 Moved LinearizedFactor from MastSLAM, started on a test for LinearContainerFactor 2012-06-07 18:16:37 +00:00
Richard Roberts 8ba08135b2 Disambiguated sqrt function 2012-06-07 16:12:57 +00:00
Richard Roberts 8e39e6b656 Fixed doxygen warnings 2012-06-07 04:54:40 +00:00
Richard Roberts ecd5862a90 Fixed build problems on windows 2012-06-07 04:54:06 +00:00
Richard Roberts 19542c27d5 gtsam_unstable build script tweaks for windows 2012-06-07 04:53:52 +00:00
Frank Dellaert fd3b1d1cb5 comments 2012-06-07 02:19:26 +00:00
Frank Dellaert 81b577eb59 Fixed compile error in gtsam_unstable 2012-06-07 02:11:16 +00:00
Alex Cunningham 87a705468d Removed unnecessary tests/examples, consolidated utility functions 2012-06-06 13:04:47 +00:00
Richard Roberts 55ff10a1c2 Updated old timing statements in discrete examples and reenabled the examples 2012-06-06 12:51:44 +00:00
Alex Cunningham 74138787e8 testPoseRTV no longer fails when using quaternions - still should add full analytical derivatives, however. 2012-06-06 12:44:06 +00:00
Duy-Nguyen Ta 8037c44b17 fix CMakeLists to generate correct paths to gtsam lib for MEX, both in command line and make_gtsam.m 2012-06-06 09:35:19 +00:00
Frank Dellaert 0f079b70f2 Disabled two examples until timing fixed 2012-06-06 04:29:14 +00:00
Alex Cunningham ad3b431c4d Moved building of wrap libraries to a cmake macro and moved install for matlab components to the appropriate folder 2012-06-05 18:05:00 +00:00
Alex Cunningham 02ce40546f Changed names of cmake flags to be more intuitive, fixed include/library path issues for building the mex binaries 2012-06-05 17:20:19 +00:00
Alex Cunningham cc2351da68 Fixed documentation for wrap 2012-06-04 21:14:47 +00:00
Alex Cunningham 2c82a01d9a Fixed mex command for gtsam_unstable 2012-06-04 21:05:00 +00:00
Alex Cunningham fc437cc641 Moved matlab wrapped PoseRTV into the gtsam namespace 2012-06-04 18:23:18 +00:00
Alex Cunningham e1725fb8e3 Fleshed out support for building MEX binaries during gtsam build 2012-06-04 15:33:16 +00:00
Yong-Dian Jian 009907c347 2012-06-03 20:45:36 +00:00
Yong-Dian Jian abcb6c6bd9 move iterative.* to unstable 2012-06-03 20:45:00 +00:00
Frank Dellaert f29afd62b4 Fixed compile errors 2012-06-02 22:10:22 +00:00
Frank Dellaert ca7e9b6919 under development 2012-06-02 20:48:04 +00:00
Frank Dellaert 8440939f27 Using symbol_shorthand instead of redundant kx, kl functions 2012-06-02 19:28:21 +00:00
Frank Dellaert a2512475c9 Symbol.h is now included just in time, no longer by default everywhere. 2012-06-02 19:05:38 +00:00
Frank Dellaert 5160c2eb50 Significant API change in slam (GTSAM 2.0.1 or 2.1): to eliminate confusion and give the user more freedom in creating their own Keys, the different slam variants no longer create Symbol keys themselves. Instead, all interaction is done via Keys (which are just unordered, unsigned ints). All PoseSLAM unit tests and examples now just use sequential keys. However, a user can still create Keys using the Symbol constructor, which is illustrated in the landmark-based unit tests and examples. 2012-06-02 16:18:40 +00:00
Alex Cunningham 3c694e25f7 Added experimental target for building unstable matlab toolbox 2012-05-27 20:05:42 +00:00
Alex Cunningham efd94014b7 Added check.unstable target - currently runs each unstable group separately, however 2012-05-25 16:12:55 +00:00
Frank Dellaert de79924e73 Fixed discrete examples 2012-05-25 15:10:13 +00:00
Frank Dellaert 4ed447ca8e Fixed CSP, now a DiscreteFactorGraph again, uses dynamic_cast for Constraint-specific functionality :-( 2012-05-25 14:51:03 +00:00
Alex Cunningham 54f6f3629c Added clone() functionality to nonlinear factors 2012-05-21 20:54:40 +00:00
Alex Cunningham 75673e28f1 Disabled unstable discrete examples bacause they don't build currently 2012-05-21 20:21:09 +00:00
Alex Cunningham 9dfc765696 Disabling broken tests in gtsam_unstable/discrete by excluding from build 2012-05-21 19:44:24 +00:00
Alex Cunningham 8af4581139 Making GTSAM_BUILD_EXAMPLES flag affect unstable examples 2012-05-20 17:38:46 +00:00
Alex Cunningham 720ff3ac82 Added a flag to optionally remove examples from "all" target 2012-05-19 02:21:21 +00:00
Alex Cunningham b571a2a7ee Uncommented failing code, re-enabled testScheduler - both fail to compile 2012-05-17 18:08:34 +00:00
Alex Cunningham 6def916bdb Commented out non-implemented functionality, since the interface appears to have changed - Frank? 2012-05-16 05:15:15 +00:00
Stephen Williams f3ed18dfdc Updated gtsam_unstable for the new nonlinear optimizer 2012-05-15 18:13:37 +00:00
Frank Dellaert 913029cc93 Removed undue burden on DiscreteFactor by adding Constraint class 2012-05-15 09:51:26 +00:00
Frank Dellaert 33cdd30173 Fixed link and load errors in example, added exception (rather than segfault) if file not found. 2012-05-15 01:01:31 +00:00
Frank Dellaert f7349704f8 Moved constraint satisfaction stuff to gtsam_unstable (in progress!). 2012-05-15 00:47:19 +00:00
Alex Cunningham a8a1d61fbd Fixed include path for gtsam_unstable matlab toolbox 2012-05-04 18:50:34 +00:00
Richard Roberts a72c100e8c Added missing linking of gtsam_unstable to gtsam 2012-05-04 17:19:26 +00:00
Alex Cunningham 3d49a8b27b Updated README with info about gtsam_unstable, merged cmake files 2012-05-04 14:44:21 +00:00
Alex Cunningham e4bc0f9b81 Moved tensor code back to geometry 2012-05-04 14:44:19 +00:00
Alex Cunningham a095b156c1 Added wrap support for gtsam_unstable 2012-05-03 17:03:27 +00:00
Alex Cunningham 9ce892ce65 gtsam_unstable now builds and tests pass 2012-05-03 17:03:25 +00:00