Commit Graph

297 Commits (0744816ce17666b32948db92e9080e94238ad99a)

Author SHA1 Message Date
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
Frank Dellaert 0837eab8f5 Scripts to test (still not working so-well) smart range factor 2013-06-25 17:13:02 +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