Commit Graph

237 Commits (02524f42e7893fc7b3232f85f8077fb6c20bf45c)

Author SHA1 Message Date
Luca 8c657f8857 slight change in implementation of hessianBlockDiagonal 2014-04-23 19:00:15 -04:00
Luca d9e93f316a error computation now does not include noise model 2014-04-23 18:43:14 -04:00
Luca 2b52bad569 optimized point damping 2014-04-23 15:15:48 -04:00
Luca e56666e85c fixed print function 2014-04-23 14:53:01 -04:00
Luca 37b750411f added gradientAtZero with raw memory access 2014-04-22 18:38:12 -04:00
Luca dd780e356c fixed computation of linearized error in implicit schur factors 2014-04-21 18:59:33 -04:00
Luca 926b4c6443 removed temporary variables - minor 2014-04-14 11:41:55 -04:00
Luca 6ef11bb297 removed debug statements 2014-04-09 21:14:38 -04:00
Luca 4bdefc3f70 removed debug bloks 2014-04-09 21:04:52 -04:00
Luca dc7b5d58c0 implemented efficient update of Hessian matrix via Schur complement 2014-04-09 21:01:03 -04:00
Luca 4123053c81 progress on grouping - still seg faults 2014-04-08 18:55:42 -04:00
Luca 310fce3be9 last updates from smartFactors project (these files are now removed from that project) 2014-04-06 14:25:46 -04:00
jing 02fc860d9e add smartfactor base classes, smartProjectionPoseFactor, and its unit test to gtsam_unstable 2014-03-27 13:14:13 -04:00
Luca 6f692b1547 Merge branch 'develop'
Conflicts:
	gtsam/base/SymmetricBlockMatrix.cpp
	gtsam/linear/JacobianFactor-inl.h
	gtsam_unstable/geometry/tests/testTriangulation.cpp
2014-03-12 12:57:59 -04:00
dellaert 9007d1ca72 Copy constructor and return const & 2014-03-06 21:07:54 -05:00
dellaert 691e9884d7 Const correctness, comments, and templated Eigen blocks (esp. important in integrate) 2014-03-06 21:05:11 -05: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
Richard Roberts 4b8c17ec77 Changed target name to 'gtsam' instead of 'gtsam-shared' and 'gtsam-static'. Modified CMake options to only allow building either static or shared, but not both. Enabled GTSAM_BUILD_TYPE_POSTFIXES by default on all platforms. 2014-01-30 14:41:25 -05:00
Luca fe55148dd7 deleted redundant files for imu factors 2014-01-27 17:38:01 -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 c4eec5d549 fix Vector_() remained 2014-01-23 02:16:04 -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 ec78d54f37 Removed old Index typedef and IndexFormatter 2013-11-08 16:35:28 +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 a1402018ca added computePoints functionality in smartFactorsCreator 2013-10-19 22:42:51 +00:00
Luca Carlone 92f0bb64b2 added tests on smartHessianFactor with Cal3Bundler 2013-10-19 22:00:43 +00:00
Luca Carlone 916d730fce Updated BAL example with readBAL functionality (work in progress) 2013-10-19 02:05:51 +00:00
Luca Carlone d5790376d7 cleaning (2) 2013-10-18 23:15:47 +00:00
Luca Carlone 81c183199a cleaning and removing useless things 2013-10-18 23:14:34 +00:00
Luca Carlone 3a139587ee minor changes 2013-10-17 01:18:22 +00:00
Luca Carlone 6f6061c6c2 fixed make check 2013-10-16 00:58:41 +00:00
Luca Carlone 45e1fe832d fixed issues 2013-10-16 00:54:56 +00:00
Luca Carlone 01f6ee56e4 templated version for Kitti, triangulation, and factorCreators 2013-10-15 22:43:10 +00:00
Luca Carlone c27f4f6bcb added possibility to read initialization from file in ProjectionFactorCreator 2013-10-15 19:16:38 +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
Frank Dellaert 0ad2dc6f81 removed "using" from header 2013-10-12 21:08:27 +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
Frank Dellaert 71039164b2 Added "using namespace boost::assign" to allow use of += 2013-10-12 17:15:36 +00:00
Luca Carlone b51a8380c4 added boost include 2013-10-12 16:21:15 +00:00
Zsolt Kira 9639660685 Added GenericProjectionFactorCreator. Both smart and generic projection factors now work (again) in batch mode. Incremental not tested yet. 2013-10-11 01:59:36 +00:00
Zsolt Kira 1a8a670870 Fixed bugs in new version since creator class is used: Get number of landmarks from creator object,
replace ensureHasOrdering with direct COLAMD call. 
Current Smart Projection factor version works in batch mode
2013-10-10 20:21:40 +00:00
Chris Beall e799c9ffa9 tabs converted to two spaces 2013-10-10 17:52:57 +00:00
Luca Carlone 121e71431a SmartFactorsCreator + initial fix in kitti example 2013-10-09 17:13:19 +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 d049dd38c6 Incremental mode in Smart Factors (not working yet with standard ProjectionFactors) 2013-10-06 18:17:32 +00:00
Richard Roberts bf40956592 Merged from Hmf6_unordered 970392249a8c50153f24594c9c81acb740cedd06 2013-10-03 19:51:56 +00:00
Luca Carlone a6dd4c0464 testing on kitti 2013-09-30 20:39:55 +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 e10a0a0650 bool to disable selective relinearization 2013-09-26 23:09:50 +00:00
Luca Carlone 8168d4a186 commented test 2013-09-26 23:09:48 +00:00
Luca Carlone 22ccd4b4b4 update to smartFactor 2013-09-26 23:09:47 +00:00
Luca Carlone 70a448f43e Efficient implementation of Selective Linearization 2013-09-26 15:07:56 +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 0e5069c26c Added toy example on SmartRangeFactors 2013-09-14 00:21:10 +00:00
Zsolt Kira a8d1072a02 Further optimization with another ~9% speed improvement.
Don't retriangulate on linearize if previous triangulation involved same poses
Added noalias in non-blockwise portion
Added exception handling for project() function
2013-09-10 15:15:24 +00:00
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 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
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
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
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
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