Commit Graph

369 Commits (b3d500f58c15e106b4771bb37b32c29a4cf12ad4)

Author SHA1 Message Date
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