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