Commit Graph

237 Commits (90dc1ce3b51a6917a5cf47de2c4d5f636aade31d)

Author SHA1 Message Date
dellaert 5ce007446d Merge remote-tracking branch 'origin/develop' into feature/SoundSlam
Conflicts:
	.cproject
2014-12-10 14:47:58 +01:00
dellaert 777aa005b4 Developing time of arrival factor with Jay at KU Leuven 2014-12-10 14:24:10 +01:00
dellaert d2e53d4fe9 "Fixed" AHRS 2014-12-04 12:30:41 +01:00
Chris Beall 7b1a9ba371 Merged in feature/TemplatedSmartFactors (pull request #39)
Templated Smart Factors
2014-11-25 07:36:14 -05:00
Richard Roberts f9ca07e610 Converted Vector(2|3) << ... to Vector2(...) or Vector3(...) syntax 2014-11-23 10:22:25 -08:00
Richard Roberts aa093a35da Updated all comma initializer usages to use .finished() 2014-11-22 16:35:27 -08:00
cbeall3 f3d42a8487 Move to unstable 2014-11-17 19:53:21 -05:00
dellaert a94835a2e4 Merge remote-tracking branch 'origin/develop' into feature/BAD
Conflicts:
	.cproject
	gtsam/geometry/Cal3DS2.cpp
	gtsam/geometry/Cal3DS2.h
	gtsam/geometry/Cal3Unified.h
	gtsam/navigation/CombinedImuFactor.h
	gtsam/navigation/ImuFactor.h
	gtsam/nonlinear/NonlinearFactor.h
	gtsam/slam/tests/testPoseRotationPrior.cpp

Modified: testGaussMarkov1stOrderFactor.cpp, testPoseRotationPrior.cpp
2014-11-04 17:04:57 +01:00
dellaert f1dd554a9d No more LieVector (too much copy/paste here) 2014-11-03 13:38:25 +01:00
dellaert 2a745b6c26 No more LieVector/LieScalar 2014-11-03 13:32:58 +01:00
dellaert 39ce31d0cc No more LieVector 2014-11-03 13:15:41 +01:00
dellaert b5327673fb Get rid of LieVector 2014-11-03 11:02:15 +01:00
cbeall3 699153ece9 Coding convention: convert tabs to two spaces 2014-10-30 12:44:46 -04:00
Chris Beall eeb0293f27 Merged in feature/FixQuaternion (pull request #22)
Was quaternion (somewhat) broken ?
2014-10-24 09:53:50 -04:00
dellaert 77e7f0437d Merge remote-tracking branch 'origin/feature/FixQuaternion' into feature/BAD
Conflicts:
	gtsam/geometry/tests/testRot3M.cpp
	gtsam/geometry/tests/testRot3Q.cpp
2014-10-23 10:03:10 +02:00
dellaert 845697555a Fixed tests for Quaternion mode but Pose3 not in EXPMAP mode 2014-10-23 09:52:35 +02:00
dellaert a29f09423c Merge branch 'develop' into feature/BAD
Conflicts:
	gtsam/linear/tests/testGaussianBayesNet.cpp
2014-10-22 13:56:27 +02:00
dellaert 113b9d2e74 Got rid of unnecessary LieVector usage that broke fixed-code 2014-10-22 01:32:59 +02:00
dellaert 1eb5e185e5 New numericalDerivatives with traits an Charts - still some segfaults, *and* there should be no need for (a) multiple prototypes to match against c++ pointers, (b) the use of explicit template arguments. A task for someone... 2014-10-21 18:50:52 +02:00
Luca 7a4f307342 moved biasedGPS and GaussMarkov to unstable 2014-10-06 13:11:40 -04:00
cbeall3 e0a9eb63ce Fix for Windows: renamed some tests 2014-09-24 16:47:07 -04:00
Chris Beall 50c8313233 Rename TransformProjectionFactor to ProjectionFactorPPP 2014-08-12 15:55:28 -04:00
Chris Beall 2c3f6e563d Renamed TransformCalProjectionFactor to ProjectionFactorPPPC to follow new naming convention 2014-08-12 15:29:05 -04:00
cbeall3 bc982293ab New unit tests for quaternary pose+transform+landmark+calibration factor 2014-07-29 21:55:14 -04:00
cbeall3 f261a6ddbc Merge remote-tracking branch 'origin/develop' into feature/concurrent-calibration 2014-07-02 15:49:47 -04:00
cbeall3 5b2f4a2c3a Move Transform factors to unstable 2014-07-01 16:03:35 -04:00
Vadim Indelman 991906181b Updating EM factor (to accout for uncertainty in states) 2014-06-30 20:43:25 +03:00
Richard Roberts fe235b1209 Building timing scripts using new timing script support in GtsamTesting.cmake. Fixed compile errors in timing scripts but disabled a couple. 2014-06-07 19:02:11 -07:00
cbeall3 87f5818776 Move smart projection factor 2014-05-31 15:33:19 -04:00
Luca c2705902cb added dynamic outlier rejection (with unit tests) for smart pose factors 2014-05-22 22:32:12 -04:00
Luca e0500f7b18 added and renamed unit tests 2014-05-22 21:28:00 -04:00
cbeall3 842554a230 Unit test fixes for quaternion mode and also rotation matrix + full expmap mode. 2014-05-06 20:03:45 -04:00
dellaert 05c1e572b6 Moved TSAMFactors.h from tsam to gtsam 2014-05-05 10:14:36 -04:00
dellaert 1ed07ca4ed Moved to unstable 2014-05-03 12:23:20 -04:00
jing 02fc860d9e add smartfactor base classes, smartProjectionPoseFactor, and its unit test to gtsam_unstable 2014-03-27 13:14:13 -04:00
Richard Roberts 4c5cb4d8ec Removed some unused code that was causing warnings 2014-02-23 18:51:48 -05:00
Richard Roberts 89e6d2f1e8 Removed some commented-out includes 2014-02-18 13:44:25 -05:00
Richard Roberts 661a157553 Working on standardizing/simplifying building unit tests and examples. Much simpler cmake function to add a glob of tests, doing away with convenience libraries, and removing other options that we never change from their defaults. 2014-02-13 01:34:31 -05:00
vindelman3 5ef681bc4a Changed Vec() to Vector(). 2014-02-05 13:59:21 -05:00
vindelman3 381899640e Moved TransformBtwRobotsUnaryFactor to gtsam_unstable from svn version. 2014-02-04 14:13:25 -05:00
jing 96296333ae remove all LieVector(size_t m, ...), which doesn't check parameter's type and it's also dangerous 2014-01-23 18:35:29 -05:00
jing 8641816b21 fix Vector_() in gtsam_unstable and tests 2014-01-23 02:03:12 -05:00
Richard Roberts 880d9a8e3c Switched to new Eigen built-in special comma initializer 2013-12-16 21:33:12 +00:00
Jing Dong 0b3aac7048 Fix Matrix_(...) to Mat() <<... in gtsam_unstable 2013-11-13 05:51:03 +00:00
Richard Roberts 5defdbe73f Fixed compile problems on windows 2013-11-05 16:06:10 +00:00
Jing Dong de55dc0d66 Fix Vector_() to Vec() in gtsam_unstable/slam 2013-10-22 04:56:01 +00:00
Luca Carlone 6e7302283e moved smart factors for smartFactors_ceres 2013-10-21 15:35:23 +00:00
Luca Carlone 92f0bb64b2 added tests on smartHessianFactor with Cal3Bundler 2013-10-19 22:00:43 +00:00
Luca Carlone d5790376d7 cleaning (2) 2013-10-18 23:15:47 +00:00
Luca Carlone 3a139587ee minor changes 2013-10-17 01:18:22 +00:00
Luca Carlone 4f2d233e67 added test on Hessian 2013-10-15 14:57:48 +00:00
Luca Carlone b77f7f77a4 created infrastructure for testing BAL datasets 2013-10-15 02:02:53 +00:00
Luca Carlone 44ae90f523 added SmartHessianProjection factor: allows different calibrations and noises for the cameras 2013-10-14 22:33:15 +00:00
Luca Carlone 9ad033fc45 Added unit tests on projectPointAtInfinity and backprojectPointAtInfinity. Fixed error projectPointAtInfinity. Deleted projectPointAtInfinity 2013-10-12 19:29:07 +00:00
Chris Beall e799c9ffa9 tabs converted to two spaces 2013-10-10 17:52:57 +00:00
Luca Carlone 426b4d79cf testSmartProjectionFactor - disabled 2013-10-08 14:28:50 +00:00
Luca Carlone 444df1958a Kitti test not working 2013-10-06 18:17:35 +00:00
Luca Carlone 441dcec64e added unit test for selective relinearization 2013-09-28 21:25:08 +00:00
Luca Carlone 9ad72e9523 included rank tolerance in Smart factor constructor 2013-09-28 18:49:26 +00:00
Luca Carlone d10ffee4d4 management of degeneracy 2013-09-28 00:49:37 +00:00
Luca Carlone 8168d4a186 commented test 2013-09-26 23:09:48 +00:00
Luca Carlone 73e72a98bd Selective relinearization 2013-09-26 01:06:55 +00:00
Luca Carlone 9f68c04792 Initial implementation of selective relinearization 2013-09-20 20:19:58 +00:00
Luca Carlone 141958123a Working version of rotation only smart factor 2013-08-28 17:37:58 +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
Vadim Indelman e6d5c2bf73 updated to the new gtsam version. 2013-08-23 18:15:28 +00:00
Vadim Indelman e439a298b8 disabled until debugging is done. 2013-08-23 16:18:18 +00:00
Vadim Indelman 77e02a332e Added TransformBtwRobotsUnaryFactorEM. May need to move to MAST later. 2013-08-23 15:24:16 +00:00
Vadim Indelman ca3956adc1 minor changes. 2013-08-23 15:21:50 +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
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 0212bbc30d Fixed some unit tests 2013-08-16 04:11:02 +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
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 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 7a027be7e5 Fixed unit tests compiling on windows 2013-08-12 16:25:13 +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
Richard Roberts ea3ca54cba "Fixed" more unit tests 2013-08-11 19:01:06 +00:00
Richard Roberts 517a5037a7 Enabled more unit tests and either fixed them or have them print a "disabled" message during make check 2013-08-11 18:41:08 +00:00
Richard Roberts f4d816dcf8 Disabled testSmartProjectionFactor and made print message about this 2013-08-11 18:40:57 +00:00
Richard Roberts f240327f24 Fixed testIMUSystem and BetweenFactorEM 2013-08-11 18:40:47 +00:00
Richard Roberts 4585fd1caa Merge branch 'svn/trunk'
Conflicts:
	gtsam/navigation/tests/testInertialNavFactor_GlobalVelocity.cpp
	gtsam/nonlinear/ISAM2.cpp
	gtsam/nonlinear/ISAM2.h
	gtsam/slam/tests/testBetweenFactor.cpp
	gtsam_unstable/nonlinear/ConcurrentBatchFilter.cpp
	gtsam_unstable/nonlinear/tests/testConcurrentBatchFilter.cpp
	gtsam_unstable/nonlinear/tests/testConcurrentBatchSmoother.cpp
	gtsam_unstable/slam/SmartProjectionFactor.h
2013-08-11 18:16:56 +00:00
Richard Roberts 1eae17561d Taking ImuFactor noise model automatically from preintegrated measurement covariance 2013-08-09 18:50:14 +00:00
Alex Cunningham 4a4e16485c Making more things in gtsam_unstable compile 2013-08-08 20:08:54 +00:00
Luca Carlone b3ea3f9465 lines added to testSmartProjectionFactor 2013-08-08 14:30:26 +00:00
Luca Carlone a82262cf99 Included noise model and f term in SmartProjectionFactor 2013-08-08 14:00:26 +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
Richard Roberts e2f8dd866d Merge branch 'svn/trunk'
Conflicts:
	gtsam/linear/GaussianBayesTree.cpp
	gtsam/linear/GaussianBayesTree.h
	gtsam/linear/VectorValues.h
	gtsam/linear/tests/testVectorValues.cpp
	gtsam_unstable/nonlinear/sequentialSummarization.cpp
2013-08-06 18:33:24 +00:00
Richard Roberts e39d100b6a Made most global unit tests compile, includes dogleg, iterative, kalman filter, etc 2013-08-06 13:44:22 +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
Richard Roberts ede0805fac Global find+replace to remove Ordered 2013-08-05 22:31:44 +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 34dc67c1af Brought some relevant changes from aspn-imu-factor branch (is correct this time) 2013-08-02 16:04:17 +00:00
Richard Roberts 2705d85fa7 Merged from branch 'trunk' 2013-07-31 18:55:15 +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 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 7345b40feb Brought some relevant changes from aspn-imu-factor branch 2013-07-31 15:25:03 +00:00
Richard Roberts 3ade190128 Renamed old classes to "Ordered" and removed "Unordered" name from new classes 2013-07-29 23:55:40 +00:00
Frank Dellaert 34db300802 Fixed n<3 Jacobians 2013-06-24 16:18:48 +00:00
Frank Dellaert 3383e52c5f Split unit tests.... 2013-06-24 16:02:17 +00:00
Frank Dellaert 43fe036c32 Made more efficient by adding errors -> Jacobians back to 1*3, always. This is big savings if a landmark is seen from many poses. 2013-06-24 15:57:03 +00:00
Frank Dellaert aea4f31096 Fixed Jacobians, optimization works 2013-06-24 15:31:13 +00:00
Frank Dellaert b7dbcefa8b simplified measurements_ to vector 2013-06-24 12:15:01 +00:00
Frank Dellaert 4b412b0a4b keys and Jacobians 2013-06-24 12:07:21 +00:00
Frank Dellaert d041c5b8a8 Split up circle intersection code into three routines that are used in SmartRangeFactor 2013-06-24 08:24:56 +00:00
Frank Dellaert 5f5e481394 AHRS mechanization small efficiency change (in progress) 2013-06-21 00:21:18 +00:00
Alex Cunningham 456d1b5cf7 Cleanup: moving old serialization function to gtsam_unstable, renaming matlab serializaion test 2013-06-19 17:50:09 +00:00
Frank Dellaert 1d9000724d Moved AHRS to gtsam_unstable 2013-05-20 23:16:44 +00:00
Stephen Williams 9e39df6e88 Added PriorFactor and BetweenFactor with optional sensor pose
transformations. Ideally these should simply be the PriorFactor and
BetweenFactor, but more investigation is needed.
2013-05-08 13:23:56 +00:00
Stephen Williams 54808f6d44 Added several experimental versions of an Inverse Depth Factor 2013-05-08 13:23:35 +00:00
Alex Cunningham a069d24374 Moved PoseRotationPrior, PoseTranslationPrior and ReferenceFrameFactor to gtsam.slam 2013-04-30 17:50:47 +00:00
Chris Beall 879417cb0d more documentation and cleanup: missed a file 2012-11-29 18:20:39 +00:00
Chris Beall 4297d24c96 changed tabs to spaces for consistent indentation in all of GTSAM 2012-10-02 14:40:07 +00:00
Alex Cunningham 0ef12f2f20 Moved in reference frame factor from MastSLAM 2012-09-19 02:23:43 +00:00
Alex Cunningham f272a07e29 Moved DummyFactor to gtsam_unstable from MastSLAM - allows for adding sufficient connectivity for solvers to operate 2012-09-18 17:48:18 +00:00
Alex Cunningham 878c79f265 Reworked PoseRotationPrior with better tests and no dependence on PartialPriorFactor 2012-08-27 16:51:52 +00:00
Alex Cunningham e488871ffd Fixed compile problem in toolbox for PoseTranslationPrior. Added planar tests. 2012-08-20 14:25:09 +00:00
Alex Cunningham 3794c2a7b7 Reworked PoseTranslationPrior so that it actually works now 2012-08-20 14:25:07 +00:00
Alex Cunningham 4fb9f3b39e Moved RelativeElevationFactor from MastSLAM 2012-08-20 14:25:04 +00:00
Richard Roberts 84924ad663 Removed remaining reference to slam namespace headers 2012-08-03 21:02:39 +00:00
Alex Cunningham b211c1070d Rearranged the inverse depth factor/camera, created a gtsam_unstable/geometry folder - run cmake to find the new/moved files 2012-08-02 20:47:16 +00:00
Chris Beall 93d9023a61 added InverseDepth factor based on Montiel/Civera's paramaterization. MOntiel06rss, Civera08tro 2012-08-02 19:27:36 +00:00
Alex Cunningham d36b8b63e7 Added versions of partial priors for parts of poses - useful for GPS or inertial priors. Added interval interface to Pose2 and Pose3. 2012-06-14 20:00:51 +00:00
Alex Cunningham 3d2c3aff05 Moved all Simulated* example domains and smallExample to the tests folder so they are no longer installed 2012-06-09 20:15:44 +00:00
Frank Dellaert 8440939f27 Using symbol_shorthand instead of redundant kx, kl functions 2012-06-02 19:28:21 +00:00
Frank Dellaert a2512475c9 Symbol.h is now included just in time, no longer by default everywhere. 2012-06-02 19:05:38 +00:00
Frank Dellaert 5160c2eb50 Significant API change in slam (GTSAM 2.0.1 or 2.1): to eliminate confusion and give the user more freedom in creating their own Keys, the different slam variants no longer create Symbol keys themselves. Instead, all interaction is done via Keys (which are just unordered, unsigned ints). All PoseSLAM unit tests and examples now just use sequential keys. However, a user can still create Keys using the Symbol constructor, which is illustrated in the landmark-based unit tests and examples. 2012-06-02 16:18:40 +00:00
Alex Cunningham 9ce892ce65 gtsam_unstable now builds and tests pass 2012-05-03 17:03:25 +00:00