dellaert
ab1f4c1e32
keys now functional
2014-09-27 16:08:59 +02:00
dellaert
186afcc95e
Made constructors private
2014-09-27 15:58:34 +02:00
dellaert
e487979b0f
Removed obsolete typedefs
2014-09-27 15:49:25 +02:00
dellaert
cde9a41acc
Formatting only
2014-09-27 15:48:07 +02:00
Paul Furgale
768c7f00e1
Removed the clone method
2014-09-27 15:01:02 +02:00
dellaert
9eed7e10fe
Added testBAD.run target, fixed an issue with getKeys
2014-09-27 14:08:31 +02:00
Paul Furgale
1a00d7e3d9
Second draft of the BAD implementation
2014-09-27 11:39:46 +02:00
cbeall3
e0a9eb63ce
Fix for Windows: renamed some tests
2014-09-24 16:47:07 -04:00
dellaert
b47837462e
Unit test succeeds !!!
2014-09-21 18:54:01 +02:00
dellaert
4bc82da85c
Compile with optional derivatives
2014-09-21 18:36:19 +02:00
dellaert
8e3a0f4847
Prototype [jacobians] code
2014-09-21 18:22:28 +02:00
dellaert
583c81ffea
Implemented uncalibrate, value test succeeds
2014-09-21 17:59:34 +02:00
dellaert
6a5e4191a3
UnaryExpression
2014-09-21 17:43:47 +02:00
dellaert
b89f65cccc
BinaryExpression
2014-09-21 17:37:09 +02:00
dellaert
59b0e6a657
Progress on error
2014-09-21 17:13:25 +02:00
dellaert
d9fafc1bf1
No more base class
2014-09-21 16:48:24 +02:00
dellaert
7a64e2e546
Class hierarchy
2014-09-21 16:30:30 +02:00
dellaert
6532966f62
Call JacobianFactor constructor with map
2014-09-21 13:11:55 +02:00
dellaert
c7b6a9af12
Now use old-style factor to create expected value and derivatives
2014-09-21 05:33:53 -04:00
dellaert
a76c27d074
Now just linearize
2014-09-18 18:33:11 -04:00
dellaert
b19132e004
First version of test, with vector of Matrices
2014-09-18 17:10:39 -05:00
Jing Dong
be68cc0047
add given marginals to update_noiseModel to improve speed
2014-09-15 03:03:25 -04:00
Jing Dong
1a7653730c
fix headers for TransBtwRobotFactorEM
2014-09-13 18:12:28 -04:00
Vadim Indelman
6b890cec0e
added updateNoiseModels functionality
2014-09-10 00:24:32 +03:00
Chris Beall
2634b2e890
Finish concurrent-calibration
2014-08-12 16:00:20 -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
Vadim Indelman
bcab483574
Changed norm to determinant.
2014-08-01 21:51:52 +03:00
Vadim Indelman
89410fe1ee
added updateNoiseModels_givenCovs to BetweenFactorEM.
2014-08-01 21:11:19 +03:00
cbeall3
bc982293ab
New unit tests for quaternary pose+transform+landmark+calibration factor
2014-07-29 21:55:14 -04:00
Jing Dong
b5b1bbfba0
improve TransBtwRobotEM factor's preformance by removing redundant unwhitenedError calc
2014-07-18 17:11:21 -04:00
Jing Dong
e06c2cfacc
change few function parameters to const reference to improve preformance of TransformBtwRobot factors
2014-07-18 15:59:14 -04:00
cbeall3
f4dc6a3a95
Fix metis linking in tests
2014-07-16 14:45:12 -04:00
cbeall3
f261a6ddbc
Merge remote-tracking branch 'origin/develop' into feature/concurrent-calibration
2014-07-02 15:49:47 -04:00
cbeall3
8bc87e8f4f
Transform + Calibration examples and factor
2014-07-01 16:33:23 -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
946cc5338a
Merge branch 'develop' into feature/timing_scripts_build
...
Conflicts:
gtsam_unstable/CMakeLists.txt
2014-06-21 08:55:49 -07:00
cbeall3
7485a8f2d5
Merge remote-tracking branch 'origin/develop' into feature/concurrent-calibration
2014-06-20 13:48:26 -04:00
cbeall3
3bacdbbec5
Move Smart Projection Factor wrapper to stable
2014-06-20 13:41:51 -04:00
cbeall3
a34dff1397
Merge remote-tracking branch 'origin/feature/new_imu_factors' into develop
2014-06-20 13:32:34 -04:00
cbeall3
67e0e71802
First script to experiment with Concurrent calibration estimation
2014-06-13 12:17:45 -04:00
cbeall3
9f796565d0
print optimization errors for now
2014-06-12 16:24:03 -04:00
cbeall3
8bee2cd70f
Fixed unstable examples never getting built
2014-06-12 14:40:24 -04: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
Richard Roberts
2591f7dca2
Fixed missing gtsam_unstable/partition tests
2014-06-07 19:01:13 -07:00
cbeall3
87f5818776
Move smart projection factor
2014-05-31 15:33:19 -04:00
cbeall3
41de41deec
minor cleanup
2014-05-30 19:37:03 -04:00
cbeall3
a7a209ce0c
Minor fixes and documentation cleanup
2014-05-30 13:31:35 -04:00
cbeall3
625b7b0743
Monocular Smart Projection factor example based on stereo data
2014-05-30 11:58:07 -04:00
Luca
386ed2e510
Merge branch 'develop'
...
Conflicts:
gtsam_unstable/slam/SmartFactorBase.h
2014-05-28 18:11:39 -04:00
cbeall3
2699605943
Fix return type mismatch
2014-05-28 11:31:17 -04:00
Luca
8806c15b36
fixed possible connectivity issue when smart factors are degenerate
2014-05-23 17:49:42 -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
Luca
4f91f94d1e
included possibility to linearize to Jacobian for smart Pose factors
2014-05-22 21:27:46 -04:00
djensen3
b83a996731
Fixed SmartProjectionPoseFactor matlab wrapping
2014-05-13 17:04:16 -04:00
Chris Beall
1062e41de3
shut up some warnings on Windows
2014-05-06 22:57:26 -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
cbeall3
0450c58d66
silence warning
2014-05-06 12:06:07 -04:00
dellaert
9373711a85
Finish TSAMFactors
2014-05-06 01:34:56 -04:00
cbeall3
2f180d1d02
Remove using namespace std from header files
2014-05-05 16:35:22 -04:00
dellaert
0a2385711b
MATLAB wrapping of TSAMFactors
2014-05-05 10:14:56 -04:00
dellaert
05c1e572b6
Moved TSAMFactors.h from tsam to gtsam
2014-05-05 10:14:36 -04:00
Luca
5c420f1aec
added references
2014-05-04 18:16:40 -04:00
dellaert
92c9e9c0aa
Fixed "unused" warnings
2014-05-03 12:23:49 -04:00
dellaert
1ed07ca4ed
Moved to unstable
2014-05-03 12:23:20 -04:00
djensen3
5402f9fa20
Removed smartProjectionPoseFactor from matlab wrapper; it was causing matlab crashes
2014-05-02 11:12:10 -04:00
djensen3
8dbd7c175c
added SmartProjectionFactor to matlab wrapper
2014-05-01 15:55:37 -04:00
djensen3
ce13807d10
added script to run and save tests in a simplified way
2014-05-01 12:56:24 -04:00
Luca
32e1a8f994
tried some changes for wrapping
2014-05-01 10:48:54 -04:00
djensen3
2cb448fa24
adding SmartProjectionPoseFactor to wrapper
2014-04-30 16:17:32 -04:00
Luca
185c572b5a
removed wrong base class
2014-04-24 11:28:41 -04:00
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
e232b6085b
wrapping smart factors
2014-04-15 11:06:38 -04:00
Luca
bd218feada
Merge branch 'develop'
2014-04-15 10:57:20 -04:00
Luca
f63db8859b
addind wrapper for smart factors
2014-04-15 10:56:17 -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
2908197f1a
Merge branch 'develop'
2014-04-06 14:35:32 -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
Andrew Melim
e98b90bd2a
Make building of metis/partition optional via cmake flag
2014-04-04 15:49:04 -04:00
jing
02fc860d9e
add smartfactor base classes, smartProjectionPoseFactor, and its unit test to gtsam_unstable
2014-03-27 13:14:13 -04:00
cbeall3
178b7f29da
clang warnings
2014-03-17 21:56:50 -04:00
Andrew Melim
9ffc928536
Correct signed vs unsigned comparison warnings
2014-03-17 12:07:54 -04:00
Andrew Melim
719592258b
Remove unused variable
2014-03-17 12:04:40 -04:00
dellaert
68297dedb5
Removed unused variable
2014-03-16 16:36:07 -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
dellaert
f5ce1d865e
A custom linearize for speed
2014-03-04 02:50:28 -05:00
dellaert
b1013163e7
Switched to TriangulationFactors: huge improvement
2014-03-02 15:51:02 -05:00
dellaert
5c466a7914
Moved to header file
2014-03-02 15:36:29 -05:00
dellaert
a7f98a8316
Drastically simplified by passing cameras
2014-03-02 15:33:56 -05:00
dellaert
f3ee25f1a8
TriangulationFactor, first version
2014-03-02 14:56:50 -05:00
dellaert
dfee108e53
Some more refactoring
2014-03-02 13:49:42 -05:00
dellaert
bf779af3d1
added twoPoses test
2014-03-02 13:44:18 -05:00
dellaert
7b93cd207c
fixed header bloat
2014-03-02 13:34:43 -05:00
dellaert
68401cf216
removed Cheirality testing in that GTSAM mode
2014-03-02 13:16:36 -05:00
dellaert
ba6f857663
Removed some copy/paste
2014-03-02 13:02:21 -05:00
Richard Roberts
bf1f5037d0
Fixed warning
2014-03-01 20:41:05 -05:00
Andrew Melim
e9eb706786
Fix conflict
2014-02-24 11:37:43 -05:00
Richard Roberts
ed8b1eeaa1
Converted another loop to use insert like was fixed in the previous commit (wasn't a problem this time but am matching the style to the other file)
2014-02-24 09:29:30 -05:00
cbeall3
3e0904e250
remove unneeded/wasteful loop
2014-02-23 23:12:25 -05:00
Richard Roberts
1770f44ad9
Fixed a number of clang warnings
2014-02-23 18:53:48 -05:00
Richard Roberts
4c5cb4d8ec
Removed some unused code that was causing warnings
2014-02-23 18:51:48 -05:00
Richard Roberts
485b3b475a
Fixed a typo that disabled the testTriangulation tests.
2014-02-23 18:50:58 -05:00
Andrew Melim
efcf58161c
Spelling correction for adjacency, correct unused var warnings and unsigned vs signed int comparision warnings
2014-02-23 17:55:18 -05:00
Andrew Melim
adeac28527
Graph reduction unit test pass
2014-02-23 17:47:39 -05:00
Andrew Melim
46c52bc957
Issues with key index versus graph index is source of the problem re heap trashing. Need to verify GenericGraph but seems that properly odering the keys fixes the issues.
2014-02-23 17:42:21 -05:00
Andrew Melim
2c5c38c855
Unit tests pass using GenericGraph 2D, use of GenericGraph 3D causes heap corruption during prepare graph for some unknown reason
2014-02-23 16:37:09 -05:00
Andrew Melim
0aa32a748f
Updating to new metis interface. Need to address prepareMetisGraph since its causing core dump on second edgeseparator test
2014-02-21 18:20:43 -05:00
Andrew Melim
05e42ba452
Test Separator unit test passes. Partially
2014-02-21 11:21:08 -05:00
Andrew Melim
1ff9309533
Parition builds partially. Computing edge separate is no longer a separate function in METIS. testFindSep fails
2014-02-20 14:36:14 -05:00
Andrew Melim
f48b8e593c
Move tests to folder
2014-02-20 12:27:58 -05:00
Andrew Melim
4c86ea1ab5
Merge branch 'develop' of bitbucket.org:gtborg/gtsam into feature/partition
2014-02-20 10:10:04 -05:00
Richard Roberts
89e6d2f1e8
Removed some commented-out includes
2014-02-18 13:44:25 -05:00
Andrew Melim
ed4e1a8e57
Merge branch 'develop' of bitbucket.org:gtborg/gtsam into feature/partition
2014-02-17 12:41:09 -05:00
Richard Roberts
3293df1529
Removed duplicate link libraries during wrap
2014-02-17 00:43:14 -05:00
Richard Roberts
f283150eb4
Using macro for creating examples to remove cmake code copy/paste
2014-02-13 13:24:14 -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
Andrew Melim
2e1e4951e1
Merge branch 'develop' of bitbucket.org:gtborg/gtsam into feature/partition
2014-02-09 13:45:41 -05:00
Richard Roberts
9d2c5888b8
Made cmake slightly nicer when using Xcode - removed a couple unnecessary prints, and removed .run targets when using Xcode since they're not needed and clog up the project view.
2014-02-08 11:14:43 -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
Andrew Melim
1d9aa38a62
Move partition over
2014-01-28 19:38:28 -05:00
Luca
fe55148dd7
deleted redundant files for imu factors
2014-01-27 17:38:01 -05:00
jing
38846aaac6
remove FixVector(size_t m, ...)
2014-01-23 19:08:20 -05:00
jing
376892f67f
fix FixVector(size_t m, ...), which also has dangerous behavior
2014-01-23 19:02:24 -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
Frank Dellaert
dd447f2c6c
Moved all common methods in new file Rot3.cpp
...
git-svn-id: https://svn.cc.gatech.edu/borg/gtsam/trunk@20416 898a188c-9671-0410-8e00-e3fd810bbb7f
2013-12-21 18:30:46 -05:00
Frank Dellaert
848f992b98
fixed two tests that did not pass with Quaternions
...
git-svn-id: https://svn.cc.gatech.edu/borg/gtsam/trunk@20414 898a188c-9671-0410-8e00-e3fd810bbb7f
2013-12-21 18:30:46 -05:00
Frank Dellaert
d7dc390130
Particle factor scaffold
2013-12-19 17:14:40 +00:00
Richard Roberts
880d9a8e3c
Switched to new Eigen built-in special comma initializer
2013-12-16 21:33:12 +00:00
Richard Roberts
f664df729c
Updated to new wrap functions in gtsam cmake
2013-12-16 21:32:55 +00:00
Luca Carlone
abbbd02979
reintroduced triangulation.cpp with non-templated functions
2013-12-09 21:28:43 +00:00
Richard Roberts
5f87cbea7f
New SymmetricBlockMatrix interface - should be safer as all exposed functions use symmetric matrix expressions and the internal uninitialized values below the diagonal are never exposed.
2013-11-26 23:49:53 +00:00
Frank Dellaert
4e2b658588
some excel file I forgot to check in
2013-11-23 19:04:43 +00:00
Richard Roberts
a27f97dec4
Fix in ConcurrentFilteringAndSmoothing - one elimination call was using the default elimination function instead of the one from the parameters.
2013-11-21 15:42:17 +00:00
Richard Roberts
0608e9a05b
Added support for MKL in Eigen and fixed several errors and warnings within Eigen when using MKL
2013-11-18 19:23:23 +00:00
Jing Dong
2896a45d1f
Fix Matrix_(...) to Mat() <<...
2013-11-13 06:08:59 +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
Frank Dellaert
199505db5f
Changed API for triangulation to use vectors of pinhole cameras, or a vector of poses and a single calibration
2013-11-06 06:31:46 +00:00
Richard Roberts
5defdbe73f
Fixed compile problems on windows
2013-11-05 16:06:10 +00:00
Frank Dellaert
a28e04988d
Some documentation, and extra optimize test. In debug mode the unit test fails because it does not throw the right exception, but everything else seems fine.
2013-11-01 01:04:34 +00:00
Luca Carlone
efeb7b4f8a
fixed warning on cheirality exception
2013-10-31 01:32:48 +00:00
Frank Dellaert
5a71336ddd
Fixed a compile error with Clang 5.0 on OS Mavericks
2013-10-30 12:15:43 +00:00
Luca Carlone
73b82a00eb
added possibility to disable Cheirality in triangulation.h using cmake flag
2013-10-29 23:38:31 +00:00
Richard Roberts
3c33e44c46
Fixed compile errors on windows
2013-10-29 04:24:14 +00:00
Andrew Melim
788f69c00e
Add header for size_t since gcc requires
2013-10-28 18:07:19 +00:00
Frank Dellaert
b88e15e694
Faster variant of DSFMap, if not as elegant.
2013-10-27 03:45:12 +00:00
Frank Dellaert
d1a62b0cc1
Killed other variants
2013-10-27 02:50:47 +00:00
Frank Dellaert
f4b7ab54b0
Several DSFMap variants
2013-10-27 02:18:42 +00:00
Andrew Melim
5e29bc5b67
Return set partitions from DFSMap
2013-10-26 22:22:31 +00:00
Frank Dellaert
14ab4f6355
Quadratic growth in nr images to be expected.
2013-10-26 20:21:10 +00:00
Frank Dellaert
b80859211c
Timing DSF variants: functional DSF is faster than in-place, but both way slower than DSFMap, which in turn is slower than DSFBase
2013-10-26 20:14:01 +00:00
Frank Dellaert
4e68feff37
Small improvements
2013-10-26 20:12:49 +00:00
Frank Dellaert
48dd3cb769
DSF with Map, allows more general types
2013-10-26 17:57:03 +00:00
Frank Dellaert
19966fe112
Added pairwise matching example
2013-10-26 16:08:18 +00:00
Frank Dellaert
fccdc46180
Fixed some compile errors related to rename
2013-10-25 19:16:15 +00:00
Frank Dellaert
def9b84e45
Added virtual solve method to NonlinearOptimizer that you can override, e.g., with Ceres
...
See example in testNonlinearOptimizer
As part of this, I also merged SuccessiveLinearizationParams into NonlinearOptimizerParams, which is now in its own separate file NonlinearOptimizerParams.h
2013-10-25 18:27:43 +00:00
Luca Carlone
11edeca3e3
removed example that was moved to smartFactors_ceres
2013-10-23 19:28:39 +00:00
Chris Beall
6d288a193d
another unit test for distinct calibrations, more documentation
2013-10-22 15:52:10 +00:00
Chris Beall
e98c80aad0
removed nontemplated triangulation functions. Improved unit tests and documentation
2013-10-22 15:31:46 +00:00
Jing Dong
de55dc0d66
Fix Vector_() to Vec() in gtsam_unstable/slam
2013-10-22 04:56:01 +00:00
Jing Dong
87f9a2ab03
Fix Vector_() to Vec() in gtsam_unstable/nonlinear
2013-10-22 04:35:21 +00:00
Jing Dong
2a178515b3
Fix Vector_() to Vec() in gtsam_unstable/examples
2013-10-22 04:30:13 +00:00
Jing Dong
6587f9781c
Fix Vector_() to Vec() in gtsam_unstable/dynamics
2013-10-22 04:22:50 +00:00
Pablo Fernandez Alcantarilla
b8ce816de2
2013-10-21 22:00:12 +00:00
Chris Beall
d57f61e5ab
removing include which no longer exists
2013-10-21 18:23:00 +00:00
Luca Carlone
6e7302283e
moved smart factors for smartFactors_ceres
2013-10-21 15:35:23 +00:00
Pablo Fernandez Alcantarilla
8b68c71614
2013-10-20 02:20:07 +00:00
Luca Carlone
5bf761a67a
minor changes to BAL example
2013-10-19 23:07:16 +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
796d9c7a67
added functionalities in dataset.cpp (writeBALfromValues) and BAL example
2013-10-19 20:28:20 +00:00
Luca Carlone
916d730fce
Updated BAL example with readBAL functionality (work in progress)
2013-10-19 02:05:51 +00:00
Luca Carlone
de5f8ee354
templated calibration object in triangulateDLT
2013-10-19 02:05:49 +00:00
Pablo Fernandez Alcantarilla
aa1f1582f5
KITTItoBALConverted checked in
2013-10-19 00:57:01 +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
f7e90bbe86
temporary disabled -
2013-10-18 06:17:01 +00:00
Frank Dellaert
1400498b72
Back to old calibration
2013-10-18 04:31:14 +00:00
Frank Dellaert
7901e0d795
Switch to Cal3Bundler
2013-10-18 04:01:07 +00:00
Zsolt Kira
9997e0b8ea
EPI: Optimize landmark position using LM using SVD triangulation as initialization.
...
Works for both single camera and multi-camera (with different calibration) cases.
2013-10-18 02:56:10 +00:00
Luca Carlone
06812ed964
intermediate changes (work in progress)
2013-10-18 01:25:18 +00:00
Luca Carlone
3a139587ee
minor changes
2013-10-17 01:18:22 +00:00
Luca Carlone
12b19b6ca9
added input arguments for BAL testing
2013-10-16 23:17:29 +00:00
Luca Carlone
b95c1c14e4
minor adds
2013-10-16 02:50:57 +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
aa3729b098
Running, but to test
2013-10-15 19:16:39 +00:00
Luca Carlone
c27f4f6bcb
added possibility to read initialization from file in ProjectionFactorCreator
2013-10-15 19:16:38 +00:00
Luca Carlone
575e5b1693
Cosmetic corrections
2013-10-15 19:16:35 +00:00
Duy-Nguyen Ta
16af82dc86
support multivalue variables
2013-10-15 18:25:05 +00:00
Luca Carlone
9bff152dbe
add template on triangulation
2013-10-15 18:01:06 +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
Duy-Nguyen Ta
223da3e34f
fixed DiscreteBayesNet::sample.
2013-10-12 20:23:04 +00:00
Duy-Nguyen Ta
939f694b33
first converged loopy belief test
2013-10-12 20:06:02 +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
Duy-Nguyen Ta
8be7363a01
refactor and add more comments
2013-10-12 15:27:37 +00:00
Duy-Nguyen Ta
b161a106c7
loopy belief in progress
2013-10-12 05:49:11 +00:00
Duy-Nguyen Ta
35924f6055
disable printing
2013-10-11 21:59:36 +00:00
Duy-Nguyen Ta
2570492fa6
disable printing
2013-10-11 21:58:09 +00:00
Duy-Nguyen Ta
a5f1d68099
fix scheduling examples by adding the default key index ordering in Scheduler.
2013-10-11 21:55:31 +00:00
Duy-Nguyen Ta
19d64460ba
check in fail DiscreteBayesNet::sample unittest.
2013-10-11 19:07:16 +00:00
Duy-Nguyen Ta
8add3de3c2
fix compilation errors in unstable discrete examples
2013-10-11 19:01:12 +00:00
Duy-Nguyen Ta
1531abd285
fix testCSP by using the default key ordering.
2013-10-11 17:48:44 +00:00
Duy-Nguyen Ta
bf11f93cee
revive unstable discrete. testCSP still fails, but looks like the solution is valid. See comments in file.
2013-10-11 17:42:30 +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
Zsolt Kira
83182b05ca
Second method for landmark-first ordering: Provide a constrained ordering with landmarks in group 1 and poses in group 2
2013-10-04 14:25:19 +00:00
Zsolt Kira
cc724134a6
Added ability to run both smart and projection factor version (for comparison)
...
For projection factor version, we can specify a landmark-first ordering
2013-10-04 13:47:24 +00:00
Richard Roberts
43d56b120a
From Hmf6_unordered: getISAM2 and variables Reeliminated/Relinearized (d97dcacf186900d12003c399e7fe55e03ca34e3f)
2013-10-03 19:52:05 +00:00
Richard Roberts
0c7b2ec062
From Hmf6_unordered: Public isam2 - to be changed (10834edc1698d941be3203e8e6bea0bd4a573443)
2013-10-03 19:52:01 +00:00
Richard Roberts
bf40956592
Merged from Hmf6_unordered 970392249a8c50153f24594c9c81acb740cedd06
2013-10-03 19:51:56 +00:00
Luca Carlone
4996db5023
Fix in running incremental optimization on Kitti
2013-10-03 18:02:25 +00:00
Richard Roberts
4d31dd99f3
Hopefully fixed the mex build flags
2013-10-03 16:50:14 +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
7560a1f6e3
Typo fixed
2013-09-27 16:06:36 +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
Zsolt Kira
b04d2f1512
ICRA version of Kitti dataset processing
2013-09-26 20:36:57 +00:00
Alex Cunningham
d440901920
Fixed quoting on include paths for building the toolbox so that the toolbox builds again
2013-09-26 18:12:32 +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
Zsolt Kira
c310bafc8a
ISAM2 option, increased num poses
2013-09-14 03:10:10 +00:00
Luca Carlone
0e5069c26c
Added toy example on SmartRangeFactors
2013-09-14 00:21:10 +00:00
Chris Beall
5dc138aa09
wrap important bits of SmartRangeFactor
2013-09-13 21:00:48 +00:00
Chris Beall
14e65ce607
Matrix initialization bug fix
2013-09-13 18:26:39 +00:00
Zsolt Kira
7413b50da1
Support for running on entire kitti dataset.
...
Cleaned up prints, added gathering of statistics (# variables, triangulation failures, etc.)
2013-09-13 13:22:43 +00:00
Zsolt Kira
35327d0d56
Added incremental version using the normal Projection Factor.
...
Supports initialization both using read-in landmark poses or triangulation.
2013-09-11 14:02:41 +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
3b7670c5aa
added TransformBtwRobotsUnaryFactorEM.
2013-08-23 15:24:46 +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
Richard Roberts
930c537991
Added TBB include directories when compiling matlab wrapper
2013-08-22 21:44:14 +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
Richard Roberts
ae958ad0f5
Fixed testConcurrentIncrementalFilter
2013-08-19 22:07:32 +00:00
Luca Carlone
568335d21f
In progress fixing filter/smoother unit tests
2013-08-19 21:33:13 +00:00
Chris Beall
e42f8e5a35
fix documentation
2013-08-19 20:25:04 +00:00
Chris Beall
ab51b50a9a
landmark triangulation now throws two different exceptions instead of returning boost::none. TriangulationCheiralityException and TriangulationUnderconstrainedException
2013-08-19 20:10:36 +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
Alex Cunningham
f9dcf31c2b
Fixing examples and some tests for gtsam_unstable/nonlinear. testConcurrentIncrementalFilter doesn't compile and is disabled, testIncrementalFixedLagSmoother is enabled and builds, but fails.
2013-08-19 15:32:08 +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
ce9e9b4a91
Added "TODO: correct?" comments
2013-08-16 21:16:07 +00:00
Richard Roberts
192962d96f
Fixed a couple problems in converted ConcurrentIncrementalFilter and ConcurrentIncrementalSmoother
2013-08-16 21:16:06 +00:00
Richard Roberts
68c6bf4a38
Added CMake code and preprocessor macros so that everything works without TBB and falls back on single-threading
2013-08-16 20:26:07 +00:00
Alex Cunningham
2d413e05c6
Removed functions largely supersceded by newer bayes tree functionality
2013-08-16 16:32:19 +00:00
Richard Roberts
0212bbc30d
Fixed some unit tests
2013-08-16 04:11:02 +00:00
Luca Carlone
3701dc6322
Changes in CFS for unordered (still work in progress)
2013-08-15 22:12:09 +00:00
Luca Carlone
6337a65ce7
Updated Incremental Smoother to unordered
2013-08-15 22:12:07 +00:00
Alex Cunningham
591a43a343
Added TBB linking flags to wrap build script
2013-08-15 17:44:17 +00:00
Luca Carlone
e4f65eacf8
Updating ConcurrentIncrementalSmoother/Filter to work with unordered (work in progress)
2013-08-14 19:12:24 +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