Commit Graph

880 Commits (02524f42e7893fc7b3232f85f8077fb6c20bf45c)

Author SHA1 Message Date
Richard Roberts 0608e9a05b Added support for MKL in Eigen and fixed several errors and warnings within Eigen when using MKL 2013-11-18 19:23:23 +00:00
Jing Dong 2896a45d1f Fix Matrix_(...) to Mat() <<... 2013-11-13 06:08:59 +00:00
Jing Dong 0b3aac7048 Fix Matrix_(...) to Mat() <<... in gtsam_unstable 2013-11-13 05:51:03 +00:00
Richard Roberts ec78d54f37 Removed old Index typedef and IndexFormatter 2013-11-08 16:35:28 +00:00
Frank Dellaert 199505db5f Changed API for triangulation to use vectors of pinhole cameras, or a vector of poses and a single calibration 2013-11-06 06:31:46 +00:00
Richard Roberts 5defdbe73f Fixed compile problems on windows 2013-11-05 16:06:10 +00:00
Frank Dellaert a28e04988d Some documentation, and extra optimize test. In debug mode the unit test fails because it does not throw the right exception, but everything else seems fine. 2013-11-01 01:04:34 +00:00
Luca Carlone efeb7b4f8a fixed warning on cheirality exception 2013-10-31 01:32:48 +00:00
Frank Dellaert 5a71336ddd Fixed a compile error with Clang 5.0 on OS Mavericks 2013-10-30 12:15:43 +00:00
Luca Carlone 73b82a00eb added possibility to disable Cheirality in triangulation.h using cmake flag 2013-10-29 23:38:31 +00:00
Richard Roberts 3c33e44c46 Fixed compile errors on windows 2013-10-29 04:24:14 +00:00
Andrew Melim 788f69c00e Add header for size_t since gcc requires 2013-10-28 18:07:19 +00:00
Frank Dellaert b88e15e694 Faster variant of DSFMap, if not as elegant. 2013-10-27 03:45:12 +00:00
Frank Dellaert d1a62b0cc1 Killed other variants 2013-10-27 02:50:47 +00:00
Frank Dellaert f4b7ab54b0 Several DSFMap variants 2013-10-27 02:18:42 +00:00
Andrew Melim 5e29bc5b67 Return set partitions from DFSMap 2013-10-26 22:22:31 +00:00
Frank Dellaert 14ab4f6355 Quadratic growth in nr images to be expected. 2013-10-26 20:21:10 +00:00
Frank Dellaert b80859211c Timing DSF variants: functional DSF is faster than in-place, but both way slower than DSFMap, which in turn is slower than DSFBase 2013-10-26 20:14:01 +00:00
Frank Dellaert 4e68feff37 Small improvements 2013-10-26 20:12:49 +00:00
Frank Dellaert 48dd3cb769 DSF with Map, allows more general types 2013-10-26 17:57:03 +00:00
Frank Dellaert 19966fe112 Added pairwise matching example 2013-10-26 16:08:18 +00:00
Frank Dellaert fccdc46180 Fixed some compile errors related to rename 2013-10-25 19:16:15 +00:00
Frank Dellaert def9b84e45 Added virtual solve method to NonlinearOptimizer that you can override, e.g., with Ceres
See example in testNonlinearOptimizer
As part of this, I also merged SuccessiveLinearizationParams into NonlinearOptimizerParams, which is now in its own separate file NonlinearOptimizerParams.h
2013-10-25 18:27:43 +00:00
Luca Carlone 11edeca3e3 removed example that was moved to smartFactors_ceres 2013-10-23 19:28:39 +00:00
Chris Beall 6d288a193d another unit test for distinct calibrations, more documentation 2013-10-22 15:52:10 +00:00
Chris Beall e98c80aad0 removed nontemplated triangulation functions. Improved unit tests and documentation 2013-10-22 15:31:46 +00:00
Jing Dong de55dc0d66 Fix Vector_() to Vec() in gtsam_unstable/slam 2013-10-22 04:56:01 +00:00
Jing Dong 87f9a2ab03 Fix Vector_() to Vec() in gtsam_unstable/nonlinear 2013-10-22 04:35:21 +00:00
Jing Dong 2a178515b3 Fix Vector_() to Vec() in gtsam_unstable/examples 2013-10-22 04:30:13 +00:00
Jing Dong 6587f9781c Fix Vector_() to Vec() in gtsam_unstable/dynamics 2013-10-22 04:22:50 +00:00
Pablo Fernandez Alcantarilla b8ce816de2 2013-10-21 22:00:12 +00:00
Chris Beall d57f61e5ab removing include which no longer exists 2013-10-21 18:23:00 +00:00
Luca Carlone 6e7302283e moved smart factors for smartFactors_ceres 2013-10-21 15:35:23 +00:00
Pablo Fernandez Alcantarilla 8b68c71614 2013-10-20 02:20:07 +00:00
Luca Carlone 5bf761a67a minor changes to BAL example 2013-10-19 23:07:16 +00:00
Luca Carlone a1402018ca added computePoints functionality in smartFactorsCreator 2013-10-19 22:42:51 +00:00
Luca Carlone 92f0bb64b2 added tests on smartHessianFactor with Cal3Bundler 2013-10-19 22:00:43 +00:00
Luca Carlone 796d9c7a67 added functionalities in dataset.cpp (writeBALfromValues) and BAL example 2013-10-19 20:28:20 +00:00
Luca Carlone 916d730fce Updated BAL example with readBAL functionality (work in progress) 2013-10-19 02:05:51 +00:00
Luca Carlone de5f8ee354 templated calibration object in triangulateDLT 2013-10-19 02:05:49 +00:00
Pablo Fernandez Alcantarilla aa1f1582f5 KITTItoBALConverted checked in 2013-10-19 00:57:01 +00:00
Luca Carlone d5790376d7 cleaning (2) 2013-10-18 23:15:47 +00:00
Luca Carlone 81c183199a cleaning and removing useless things 2013-10-18 23:14:34 +00:00
Luca Carlone f7e90bbe86 temporary disabled - 2013-10-18 06:17:01 +00:00
Frank Dellaert 1400498b72 Back to old calibration 2013-10-18 04:31:14 +00:00
Frank Dellaert 7901e0d795 Switch to Cal3Bundler 2013-10-18 04:01:07 +00:00
Zsolt Kira 9997e0b8ea EPI: Optimize landmark position using LM using SVD triangulation as initialization.
Works for both single camera and multi-camera (with different calibration) cases.
2013-10-18 02:56:10 +00:00
Luca Carlone 06812ed964 intermediate changes (work in progress) 2013-10-18 01:25:18 +00:00
Luca Carlone 3a139587ee minor changes 2013-10-17 01:18:22 +00:00
Luca Carlone 12b19b6ca9 added input arguments for BAL testing 2013-10-16 23:17:29 +00:00
Luca Carlone b95c1c14e4 minor adds 2013-10-16 02:50:57 +00:00
Luca Carlone 6f6061c6c2 fixed make check 2013-10-16 00:58:41 +00:00
Luca Carlone 45e1fe832d fixed issues 2013-10-16 00:54:56 +00:00
Luca Carlone 01f6ee56e4 templated version for Kitti, triangulation, and factorCreators 2013-10-15 22:43:10 +00:00
Luca Carlone aa3729b098 Running, but to test 2013-10-15 19:16:39 +00:00
Luca Carlone c27f4f6bcb added possibility to read initialization from file in ProjectionFactorCreator 2013-10-15 19:16:38 +00:00
Luca Carlone 575e5b1693 Cosmetic corrections 2013-10-15 19:16:35 +00:00
Duy-Nguyen Ta 16af82dc86 support multivalue variables 2013-10-15 18:25:05 +00:00
Luca Carlone 9bff152dbe add template on triangulation 2013-10-15 18:01:06 +00:00
Luca Carlone 4f2d233e67 added test on Hessian 2013-10-15 14:57:48 +00:00
Luca Carlone b77f7f77a4 created infrastructure for testing BAL datasets 2013-10-15 02:02:53 +00:00
Luca Carlone 44ae90f523 added SmartHessianProjection factor: allows different calibrations and noises for the cameras 2013-10-14 22:33:15 +00:00
Frank Dellaert 0ad2dc6f81 removed "using" from header 2013-10-12 21:08:27 +00:00
Duy-Nguyen Ta 223da3e34f fixed DiscreteBayesNet::sample. 2013-10-12 20:23:04 +00:00
Duy-Nguyen Ta 939f694b33 first converged loopy belief test 2013-10-12 20:06:02 +00:00
Luca Carlone 9ad033fc45 Added unit tests on projectPointAtInfinity and backprojectPointAtInfinity. Fixed error projectPointAtInfinity. Deleted projectPointAtInfinity 2013-10-12 19:29:07 +00:00
Frank Dellaert 71039164b2 Added "using namespace boost::assign" to allow use of += 2013-10-12 17:15:36 +00:00
Luca Carlone b51a8380c4 added boost include 2013-10-12 16:21:15 +00:00
Duy-Nguyen Ta 8be7363a01 refactor and add more comments 2013-10-12 15:27:37 +00:00
Duy-Nguyen Ta b161a106c7 loopy belief in progress 2013-10-12 05:49:11 +00:00
Duy-Nguyen Ta 35924f6055 disable printing 2013-10-11 21:59:36 +00:00
Duy-Nguyen Ta 2570492fa6 disable printing 2013-10-11 21:58:09 +00:00
Duy-Nguyen Ta a5f1d68099 fix scheduling examples by adding the default key index ordering in Scheduler. 2013-10-11 21:55:31 +00:00
Duy-Nguyen Ta 19d64460ba check in fail DiscreteBayesNet::sample unittest. 2013-10-11 19:07:16 +00:00
Duy-Nguyen Ta 8add3de3c2 fix compilation errors in unstable discrete examples 2013-10-11 19:01:12 +00:00
Duy-Nguyen Ta 1531abd285 fix testCSP by using the default key ordering. 2013-10-11 17:48:44 +00:00
Duy-Nguyen Ta bf11f93cee revive unstable discrete. testCSP still fails, but looks like the solution is valid. See comments in file. 2013-10-11 17:42:30 +00:00
Zsolt Kira 9639660685 Added GenericProjectionFactorCreator. Both smart and generic projection factors now work (again) in batch mode. Incremental not tested yet. 2013-10-11 01:59:36 +00:00
Zsolt Kira 1a8a670870 Fixed bugs in new version since creator class is used: Get number of landmarks from creator object,
replace ensureHasOrdering with direct COLAMD call. 
Current Smart Projection factor version works in batch mode
2013-10-10 20:21:40 +00:00
Chris Beall e799c9ffa9 tabs converted to two spaces 2013-10-10 17:52:57 +00:00
Luca Carlone 121e71431a SmartFactorsCreator + initial fix in kitti example 2013-10-09 17:13:19 +00:00
Luca Carlone 426b4d79cf testSmartProjectionFactor - disabled 2013-10-08 14:28:50 +00:00
Luca Carlone 444df1958a Kitti test not working 2013-10-06 18:17:35 +00:00
Luca Carlone d049dd38c6 Incremental mode in Smart Factors (not working yet with standard ProjectionFactors) 2013-10-06 18:17:32 +00:00
Zsolt Kira 83182b05ca Second method for landmark-first ordering: Provide a constrained ordering with landmarks in group 1 and poses in group 2 2013-10-04 14:25:19 +00:00
Zsolt Kira cc724134a6 Added ability to run both smart and projection factor version (for comparison)
For projection factor version, we can specify a landmark-first ordering
2013-10-04 13:47:24 +00:00
Richard Roberts 43d56b120a From Hmf6_unordered: getISAM2 and variables Reeliminated/Relinearized (d97dcacf186900d12003c399e7fe55e03ca34e3f) 2013-10-03 19:52:05 +00:00
Richard Roberts 0c7b2ec062 From Hmf6_unordered: Public isam2 - to be changed (10834edc1698d941be3203e8e6bea0bd4a573443) 2013-10-03 19:52:01 +00:00
Richard Roberts bf40956592 Merged from Hmf6_unordered 970392249a8c50153f24594c9c81acb740cedd06 2013-10-03 19:51:56 +00:00
Luca Carlone 4996db5023 Fix in running incremental optimization on Kitti 2013-10-03 18:02:25 +00:00
Richard Roberts 4d31dd99f3 Hopefully fixed the mex build flags 2013-10-03 16:50:14 +00:00
Luca Carlone a6dd4c0464 testing on kitti 2013-09-30 20:39:55 +00:00
Luca Carlone 441dcec64e added unit test for selective relinearization 2013-09-28 21:25:08 +00:00
Luca Carlone 9ad72e9523 included rank tolerance in Smart factor constructor 2013-09-28 18:49:26 +00:00
Luca Carlone d10ffee4d4 management of degeneracy 2013-09-28 00:49:37 +00:00
Luca Carlone 7560a1f6e3 Typo fixed 2013-09-27 16:06:36 +00:00
Luca Carlone e10a0a0650 bool to disable selective relinearization 2013-09-26 23:09:50 +00:00
Luca Carlone 8168d4a186 commented test 2013-09-26 23:09:48 +00:00
Luca Carlone 22ccd4b4b4 update to smartFactor 2013-09-26 23:09:47 +00:00
Zsolt Kira b04d2f1512 ICRA version of Kitti dataset processing 2013-09-26 20:36:57 +00:00
Alex Cunningham d440901920 Fixed quoting on include paths for building the toolbox so that the toolbox builds again 2013-09-26 18:12:32 +00:00
Luca Carlone 70a448f43e Efficient implementation of Selective Linearization 2013-09-26 15:07:56 +00:00
Luca Carlone 73e72a98bd Selective relinearization 2013-09-26 01:06:55 +00:00
Luca Carlone 9f68c04792 Initial implementation of selective relinearization 2013-09-20 20:19:58 +00:00
Zsolt Kira c310bafc8a ISAM2 option, increased num poses 2013-09-14 03:10:10 +00:00
Luca Carlone 0e5069c26c Added toy example on SmartRangeFactors 2013-09-14 00:21:10 +00:00
Chris Beall 5dc138aa09 wrap important bits of SmartRangeFactor 2013-09-13 21:00:48 +00:00
Chris Beall 14e65ce607 Matrix initialization bug fix 2013-09-13 18:26:39 +00:00
Zsolt Kira 7413b50da1 Support for running on entire kitti dataset.
Cleaned up prints, added gathering of statistics (# variables, triangulation failures, etc.)
2013-09-13 13:22:43 +00:00
Zsolt Kira 35327d0d56 Added incremental version using the normal Projection Factor.
Supports initialization both using read-in landmark poses or triangulation.
2013-09-11 14:02:41 +00:00
Zsolt Kira a8d1072a02 Further optimization with another ~9% speed improvement.
Don't retriangulate on linearize if previous triangulation involved same poses
Added noalias in non-blockwise portion
Added exception handling for project() function
2013-09-10 15:15:24 +00:00
Vadim Indelman b3d500f58c Added optional flag_bump_up_near_zero_probs. 2013-08-29 22:43:09 +00:00
Vadim Indelman 86d21aaa05 Added optional flag_bump_up_near_zero_probs. 2013-08-29 22:42:33 +00:00
Luca Carlone 141958123a Working version of rotation only smart factor 2013-08-28 17:37:58 +00:00
Vadim Indelman df36ee643a Added option to start with an M step. 2013-08-28 16:56:57 +00:00
Luca Carlone 0422b9cfef degenerate case in smart vision factor 2013-08-28 16:07:58 +00:00
Luca Carlone 633220a9dd degenerate case in SmartProjectionFactor 2013-08-28 16:07:56 +00:00
Chris Beall 19ddf3f228 minor speedup 2013-08-28 14:47:57 +00:00
Zsolt Kira bf8621aa3a Added some state that is returned/passed in to smart projection factor to support smart re-linearization
Fixed bug in batch example that did not add last set of measurements in file
Created incremental version that reads measurements as they come, associates with a smart factor (or creates new one), and optimizes.  
Last example achieves same results on 200-pose example as batch example.
2013-08-28 12:31:56 +00:00
Chris Beall 138a7ea28c minor fixes - removed unnecessary boost optional 2013-08-27 17:48:59 +00:00
Zsolt Kira f779736380 Fixed failed test, which resulted from removal of feature allowing one to pass a landmark in to constructor 2013-08-26 12:46:13 +00:00
Vadim Indelman e6d5c2bf73 updated to the new gtsam version. 2013-08-23 18:15:28 +00:00
Vadim Indelman 6ab49e95da Added cref_list_of. 2013-08-23 18:12:59 +00:00
Vadim Indelman e439a298b8 disabled until debugging is done. 2013-08-23 16:18:18 +00:00
Vadim Indelman 3b7670c5aa added TransformBtwRobotsUnaryFactorEM. 2013-08-23 15:24:46 +00:00
Vadim Indelman 77e02a332e Added TransformBtwRobotsUnaryFactorEM. May need to move to MAST later. 2013-08-23 15:24:16 +00:00
Vadim Indelman f6402916d6 added flag_bump_up_near_zero_probs_. 2013-08-23 15:22:50 +00:00
Vadim Indelman ca3956adc1 minor changes. 2013-08-23 15:21:50 +00:00
Richard Roberts 930c537991 Added TBB include directories when compiling matlab wrapper 2013-08-22 21:44:14 +00:00
Zsolt Kira 0466e606b0 Added try/catch for triangulation exception
Optimizations resulting in about 6-7% improvement
Added methods returning keys and other information needed to create generic projection factors
Code cleanup
2013-08-21 01:35:13 +00:00
Richard Roberts ae958ad0f5 Fixed testConcurrentIncrementalFilter 2013-08-19 22:07:32 +00:00
Luca Carlone 568335d21f In progress fixing filter/smoother unit tests 2013-08-19 21:33:13 +00:00
Chris Beall e42f8e5a35 fix documentation 2013-08-19 20:25:04 +00:00
Chris Beall ab51b50a9a landmark triangulation now throws two different exceptions instead of returning boost::none. TriangulationCheiralityException and TriangulationUnderconstrainedException 2013-08-19 20:10:36 +00:00
Alex Cunningham c6cf4d2dab Removed use of convenience libraries for tests - wasn't really supported in current version 2013-08-19 15:32:21 +00:00
Alex Cunningham 4b12d6f794 Moved Symbol and LabeledSymbol to inference as they are no longer specific to nonlinear optimization 2013-08-19 15:32:16 +00:00
Alex Cunningham f9dcf31c2b Fixing examples and some tests for gtsam_unstable/nonlinear. testConcurrentIncrementalFilter doesn't compile and is disabled, testIncrementalFixedLagSmoother is enabled and builds, but fails. 2013-08-19 15:32:08 +00:00
Zsolt Kira fe860be33f SmartProjectionFactor: Added add(measured, poseKey) method to incrementally add views to the same landmark.
Added unit test for new method and way of creating factor.
Fixed missing negative when calculating b for non-blockwise version of Schur complement
2013-08-18 02:18:32 +00:00
Richard Roberts 09c4d8b712 Disabled testBetweenFactorEM because it is in progress for debugging 2013-08-16 21:57:49 +00:00
Richard Roberts ce9e9b4a91 Added "TODO: correct?" comments 2013-08-16 21:16:07 +00:00
Richard Roberts 192962d96f Fixed a couple problems in converted ConcurrentIncrementalFilter and ConcurrentIncrementalSmoother 2013-08-16 21:16:06 +00:00
Richard Roberts 68c6bf4a38 Added CMake code and preprocessor macros so that everything works without TBB and falls back on single-threading 2013-08-16 20:26:07 +00:00
Alex Cunningham 2d413e05c6 Removed functions largely supersceded by newer bayes tree functionality 2013-08-16 16:32:19 +00:00
Richard Roberts 0212bbc30d Fixed some unit tests 2013-08-16 04:11:02 +00:00
Luca Carlone 3701dc6322 Changes in CFS for unordered (still work in progress) 2013-08-15 22:12:09 +00:00
Luca Carlone 6337a65ce7 Updated Incremental Smoother to unordered 2013-08-15 22:12:07 +00:00
Alex Cunningham 591a43a343 Added TBB linking flags to wrap build script 2013-08-15 17:44:17 +00:00
Luca Carlone e4f65eacf8 Updating ConcurrentIncrementalSmoother/Filter to work with unordered (work in progress) 2013-08-14 19:12:24 +00:00
Luca Carlone 0514ad39c6 Smart projection factor working on Kitti 2013-08-14 19:12:23 +00:00
Luca Carlone d7e6f43fa7 Updated to work with unordered GTSAM 2013-08-14 19:12:21 +00:00
Luca Carlone 4dfa2506ab ConcurrentFilterAndSmoother updated and working with the unordered version of GTSAM 2013-08-13 22:30:08 +00:00
Richard Roberts 16b4f0fe8b Moved ImuFactor and CombinedImuFactor into main gtsam, and moved InertialNavFactor family into gtsam_unstable. 2013-08-13 21:04:31 +00:00
Richard Roberts 5d0f8399ed Fixed gtsam_unstable matlab wrapper 2013-08-12 22:26:37 +00:00
Richard Roberts 175965a6bf Merged from branch 'branches/unordered' 2013-08-12 21:52:43 +00:00
Richard Roberts 13d829687c Merged from branch 'trunk' 2013-08-12 21:49:59 +00:00
Richard Roberts d9c9682f6e Merge branch 'svn/trunk'
Conflicts:
	gtsam_unstable/slam/BetweenFactorEM.h
	gtsam_unstable/slam/tests/testBetweenFactorEM.cpp
2013-08-12 21:47:36 +00:00
Zsolt Kira b34b6cc9ee Added warning if triangulation fails
Added ability to pass in landmark position directly, thereby avoiding triangulation
Added test that compares GenericProjectionFactor and SmartProjectionFactor for 1 iteration using
both GaussNewton and LM optimization.  These tests also fail, until we find the problem/bug.
2013-08-12 21:44:54 +00:00
Richard Roberts f1c9322d37 Removed old VerticalBlockView and SymmetricBlockView (replaced with VerticalBlockMatrix and SymmetricBlockMatrix) 2013-08-12 21:41:05 +00:00
Richard Roberts 6cba528671 Fixed include path 2013-08-12 18:21:27 +00:00
Richard Roberts 7a027be7e5 Fixed unit tests compiling on windows 2013-08-12 16:25:13 +00:00
Vadim Indelman 87a7c56c88 Switched to square root of covariance norm. 2013-08-12 16:11:48 +00:00
Chris Beall 14931bcc7d improved tests a little. basic 3 landmark test with smart projection factor fails! 2013-08-12 14:40:57 +00:00
Richard Roberts ea3ca54cba "Fixed" more unit tests 2013-08-11 19:01:06 +00:00
Richard Roberts 517a5037a7 Enabled more unit tests and either fixed them or have them print a "disabled" message during make check 2013-08-11 18:41:08 +00:00
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