Frank Dellaert
f7182eeaf6
fixed warning
2013-09-04 00:57:30 +00:00
Luca Carlone
a27087ef36
Disabled testBetweenFactorEM because it is in progress for debugging
2013-08-19 21:04:38 +00:00
Richard Roberts
4b3021b818
Moved ImuFactor and CombinedImuFactor into main gtsam, and moved InertialNavFactor family into gtsam_unstable.
2013-08-13 21:03:48 +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
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
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
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
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
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
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
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
ecb24ebd06
Fixes to include path ordering and boost libraries
2013-07-09 15:43:55 +00:00
Alex Cunningham
f3aa2fde53
Fixed compile error
2013-06-25 17:22:45 +00:00