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