Commit Graph

4423 Commits (db7b5656df0eec01a7440b9f801051af64a3e6dc)

Author SHA1 Message Date
Richard Roberts db7b5656df Set version number in package script to 2.3.1 2013-08-13 18:42:50 +00:00
Richard Roberts 6b8225b7f1 Moved ImuFactor and CombinedImuFactor into main gtsam, and moved InertialNavFactor family into gtsam_unstable. 2013-08-13 16:43:07 +00:00
Richard Roberts e8a09b9f9b Revert "failed unit test of BetweenFactor<Rot3> when the measurement is not the ground truth"
This reverts commit bd85aa68d8bf7267214ea9df5687fbae78e76fae.
2013-08-13 16:43:03 +00:00
Richard Roberts 85a6db04d1 Revert "comment on how to pass this test"
This reverts commit 8ef24f645f80cf7dd01174027cc09cc81c0bb1ff.
2013-08-13 16:42:21 +00:00
Richard Roberts 094a407093 Set version number to 2.3.1 2013-08-13 14:23:54 +00:00
Richard Roberts 0744816ce1 Created branch /branches/2.3.1 from /trunk:18250 2013-08-13 14:23:52 +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
Luca Carlone a518dae06a Fixed GPS Kitti example, VO works but bad results 2013-08-12 20:45:44 +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
Luca Carlone 0320baf3f7 Small updates in IMUKittiExampleVO 2013-08-11 22:57:54 +00:00
Luca Carlone d46902ea06 Working IMUKitti example with VO only (slow!) 2013-08-11 22:45:58 +00:00
Richard Roberts 18a72718aa Reenabled ISAM2 in SolverComparer 2013-08-11 19:29:01 +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 f9de5838f6 Added optional return information to the 'marginalizeLeaves' method of
iSAM2
2013-08-10 17:16:10 +00:00
Stephen Williams 485624f8d6 Added access to the set of fixed variables (the variables involved in
linear marginal factors) from iSAM2
2013-08-10 17:15:56 +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 2f84788c2a Adjusted sigma 2013-08-09 19:03:38 +00:00
Richard Roberts 7f5de1c3bc Added simple Kitti example 2013-08-09 18:50:20 +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
Alex Cunningham 0cb6e97803 Added stack function that takes a vector of matrix blocks 2013-08-09 16:24:45 +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
Alex Cunningham 7b0c559091 Fixed bug in 32 bit version - now calls correct keyformatter 2013-08-09 14:55:26 +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 7c07c70802 Changed Between and Prior Factors and NonLinearEquality back to NoiseModelFactor. 2013-08-08 16:08:35 +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
Duy-Nguyen Ta 6959ad5e6f Fix error when wrapping a library using Rot3 to matlab: "type stored... is N5gtsam4Rot3E but requested type was N5gtsam4Rot3E", because gtsam is linked 2 times: one with the library, one with the mex, and somehow Rot3 is not virtual and exists in both. Moving print implementation to cpp seems to fix this problem. 2013-08-08 08:51:52 +00:00
Duy-Nguyen Ta 8cf7b6723f comment on how to pass this test 2013-08-08 08:46:55 +00:00
Duy-Nguyen Ta 1631222a29 fix streaming tests to agree with new print in matlab column vector style 2013-08-08 08:44:00 +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
Duy-Nguyen Ta 6fc1464d7b print Point3 in matlab's column vector style 2013-08-06 18:49:03 +00:00