bd4dd84933
huge refactor. Compiles again, but triangulation still broken, SmartStereo test fails
2015-07-15 16:53:04 -04:00
fb4dd81c4d
refactoring: step 1
2015-07-15 12:58:03 -04:00
30435da070
Moved BearingRangeFactor to SAM
2015-07-12 18:57:26 -07:00
7ff3e11efd
removed redundancy in naming
2015-07-09 11:29:32 -07:00
3b16ad2967
Moved deprecated headers into subdirectory
2015-07-09 11:14:39 -07:00
377b90941b
switch to Rodrigues everywhere
2015-07-05 16:11:04 -07:00
b0f04503c9
Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3
...
# Conflicts:
# gtsam/linear/tests/testRegularHessianFactor.cpp
# gtsam/slam/SmartFactorBase.h
2015-06-23 10:03:42 -04:00
128bac616c
Globally replaced FastSet<Key> with KeySet.
2015-06-20 18:38:25 -07:00
f8205bfe02
Merge branch 'develop' into feature/SmartFactors3
...
Conflicts:
gtsam/geometry/CalibratedCamera.h
gtsam/geometry/tests/testCalibratedCamera.cpp
gtsam/geometry/triangulation.h
gtsam/nonlinear/ExpressionFactor.h
gtsam/slam/SmartProjectionFactor.h
gtsam_unstable/slam/SmartStereoProjectionFactor.h
tests/testExpressionFactor.cpp
2015-06-19 16:55:30 -04:00
13a4da21b2
misc bugfixes and cleanup from skydio
2015-05-13 22:26:24 -07:00
4ba329c23b
Fixed many warnings on Ubuntu
2015-05-12 13:46:24 -07:00
762a7b7435
Remove selective relinearization and state
2015-04-08 17:52:25 -04:00
a4d1874af4
Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3
2015-03-09 17:51:16 -07:00
3be6b16995
relax threshold from 1e-7 to 1e-6 to make test pass.
2015-03-06 00:32:43 -05:00
758aab6e80
Cleaned up test
2015-03-05 10:41:49 -08:00
dc3d5f77fe
Extra stereo tests
2015-03-05 10:35:54 -08:00
f28b083c14
Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3
...
Conflicts:
gtsam/slam/tests/testSmartProjectionPoseFactor.cpp
2015-03-04 16:02:25 -08:00
a132d959f5
RADICAL: Got rid of sensor_pose. In the new PinholePose philosophy, this is entirely the responsibility of the CAMERA. Just like PinholePose, we can have a camera class that has a shared extra transform: it is part of the calibration. PinholePose itself is not able to do this, as the calibration is assumed 2D only, but it's easy to create a class and have the correct derivatives in place.
2015-02-26 12:06:43 +01:00
8a88f101db
Fix deprecation warnings
2015-02-24 21:58:17 -05:00
64bb6b77d7
Merged in feature/SmartCT (pull request #107 )
...
Refactoring of Smart Factors
2015-02-22 06:14:19 +01:00
e119846280
Updated examples and test
2014-12-28 19:10:41 +01:00
f9c353d4a5
Merge remote-tracking branch 'origin/develop' into feature/SoundSlam
...
Conflicts:
.cproject
gtsam/base/LieMatrix.h
gtsam/base/LieVector.h
gtsam/base/OptionalJacobian.h
gtsam/base/tests/testOptionalJacobian.cpp
gtsam/geometry/Cal3_S2Stereo.h
gtsam/geometry/CalibratedCamera.h
gtsam/geometry/PinholeCamera.h
gtsam/geometry/Point2.h
gtsam/geometry/Point3.h
gtsam/geometry/Pose2.cpp
gtsam/geometry/Pose2.h
gtsam/geometry/Pose3.cpp
gtsam/geometry/Pose3.h
gtsam/geometry/Rot2.cpp
gtsam/geometry/Rot2.h
gtsam/geometry/Rot3.cpp
gtsam/geometry/Rot3.h
gtsam/geometry/Rot3M.cpp
gtsam/geometry/Rot3Q.cpp
gtsam/geometry/Unit3.cpp
gtsam/geometry/tests/testRot3.cpp
gtsam/nonlinear/AdaptAutoDiff.h
gtsam/nonlinear/Expression-inl.h
gtsam/nonlinear/Expression.h
gtsam/nonlinear/tests/testExpression.cpp
gtsam/slam/RangeFactor.h
timing/timeAdaptAutoDiff.cpp
timing/timeCameraExpression.cpp
2014-12-28 17:45:41 +01:00
e5017984a1
traits_x -> traits
2014-12-26 16:47:51 +01:00
78386ad144
Merge ExmapeDerivative/LogmapDerivative changes from 'origin/develop' into feature/tighteningTraits
...
Conflicts:
gtsam/base/LieScalar.h
gtsam/geometry/Point2.h
gtsam/geometry/Point3.h
gtsam/geometry/Rot3.h
gtsam/geometry/Rot3M.cpp
gtsam/geometry/Rot3Q.cpp
gtsam/geometry/tests/testRot3.cpp
2014-12-24 13:55:15 +01:00
d9f5681dc2
Fixed warning
2014-12-24 11:34:53 +01:00
355b938f3a
Point3 loses its mojo (superfluous Lie/Manifold stuff)
2014-12-22 17:22:45 +01:00
a6f612844f
fixed testTSAMFactors.cpp
2014-12-22 09:39:51 +01:00
79d8514528
MASSIVE edit: made Testable its own concept, and moderinized Testable.h to use Testable traits. This required adding Testable traits in many classes.
2014-12-21 22:02:57 +01:00
07bcc18d43
fixed testTSAMFactors
2014-12-15 23:23:40 +01:00
8f27b048f1
Moved experiment to doubleExpresso project
2014-12-12 08:53:32 +01:00
541217175c
Added ExpressionFactorGraph (should go away with move of ExpressionFactor to gtsam)
2014-12-12 08:00:02 +01:00
fa7071bdd8
Comments, renaming
2014-12-12 07:45:09 +01:00
8cc813f03e
Removed misguided Factory attempt in favor of direct expressions
2014-12-12 07:31:33 +01:00
a9121fc3fc
Now it's super-easy to create priors on pieces of state.
2014-12-11 13:45:15 +01:00
cedf2647d2
Use handy dandy Factor Factory
2014-12-11 13:19:37 +01:00
d37216cde3
TOAFactor header
2014-12-10 22:50:41 +01:00
bb00e375da
Print for MATLAB
2014-12-10 21:44:56 +01:00
dc84b6589e
Added in real experimental data gathered by Jay at KU Leuven
2014-12-10 21:12:38 +01:00
d17caa5487
Event header and test file
2014-12-10 19:14:18 +01:00
5d6e0bc753
Optimization test succeeds, but only with 5th microphone...
2014-12-10 19:00:52 +01:00
2dcbc72d8d
Derivatives work !!!
2014-12-10 17:58:35 +01:00
0ceb09262c
Put in prototype derivatives, needs unit test
2014-12-10 16:06:34 +01:00
cca1a54544
Everything done, except derivatives !!!
2014-12-10 16:02:13 +01:00
d54c70202a
TOAFactor compiles and can be put into a factor graph
2014-12-10 15:43:31 +01:00
ba1a2685bc
Not-working yet, but lots of progress towards TOAFactor
2014-12-10 15:10:59 +01:00
5ce007446d
Merge remote-tracking branch 'origin/develop' into feature/SoundSlam
...
Conflicts:
.cproject
2014-12-10 14:47:58 +01:00
777aa005b4
Developing time of arrival factor with Jay at KU Leuven
2014-12-10 14:24:10 +01:00
d2e53d4fe9
"Fixed" AHRS
2014-12-04 12:30:41 +01:00
7b1a9ba371
Merged in feature/TemplatedSmartFactors (pull request #39 )
...
Templated Smart Factors
2014-11-25 07:36:14 -05:00
f9ca07e610
Converted Vector(2|3) << ... to Vector2(...) or Vector3(...) syntax
2014-11-23 10:22:25 -08:00
aa093a35da
Updated all comma initializer usages to use .finished()
2014-11-22 16:35:27 -08:00
f3d42a8487
Move to unstable
2014-11-17 19:53:21 -05:00
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
f1dd554a9d
No more LieVector (too much copy/paste here)
2014-11-03 13:38:25 +01:00
2a745b6c26
No more LieVector/LieScalar
2014-11-03 13:32:58 +01:00
39ce31d0cc
No more LieVector
2014-11-03 13:15:41 +01:00
b5327673fb
Get rid of LieVector
2014-11-03 11:02:15 +01:00
699153ece9
Coding convention: convert tabs to two spaces
2014-10-30 12:44:46 -04:00
eeb0293f27
Merged in feature/FixQuaternion (pull request #22 )
...
Was quaternion (somewhat) broken ?
2014-10-24 09:53:50 -04:00
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
845697555a
Fixed tests for Quaternion mode but Pose3 not in EXPMAP mode
2014-10-23 09:52:35 +02:00
a29f09423c
Merge branch 'develop' into feature/BAD
...
Conflicts:
gtsam/linear/tests/testGaussianBayesNet.cpp
2014-10-22 13:56:27 +02:00
113b9d2e74
Got rid of unnecessary LieVector usage that broke fixed-code
2014-10-22 01:32:59 +02:00
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
7a4f307342
moved biasedGPS and GaussMarkov to unstable
2014-10-06 13:11:40 -04:00
e0a9eb63ce
Fix for Windows: renamed some tests
2014-09-24 16:47:07 -04:00
50c8313233
Rename TransformProjectionFactor to ProjectionFactorPPP
2014-08-12 15:55:28 -04:00
2c3f6e563d
Renamed TransformCalProjectionFactor to ProjectionFactorPPPC to follow new naming convention
2014-08-12 15:29:05 -04:00
bc982293ab
New unit tests for quaternary pose+transform+landmark+calibration factor
2014-07-29 21:55:14 -04:00
f261a6ddbc
Merge remote-tracking branch 'origin/develop' into feature/concurrent-calibration
2014-07-02 15:49:47 -04:00
5b2f4a2c3a
Move Transform factors to unstable
2014-07-01 16:03:35 -04:00
991906181b
Updating EM factor (to accout for uncertainty in states)
2014-06-30 20:43:25 +03:00
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
87f5818776
Move smart projection factor
2014-05-31 15:33:19 -04:00
c2705902cb
added dynamic outlier rejection (with unit tests) for smart pose factors
2014-05-22 22:32:12 -04:00
e0500f7b18
added and renamed unit tests
2014-05-22 21:28:00 -04:00
842554a230
Unit test fixes for quaternion mode and also rotation matrix + full expmap mode.
2014-05-06 20:03:45 -04:00
05c1e572b6
Moved TSAMFactors.h from tsam to gtsam
2014-05-05 10:14:36 -04:00
1ed07ca4ed
Moved to unstable
2014-05-03 12:23:20 -04:00
02fc860d9e
add smartfactor base classes, smartProjectionPoseFactor, and its unit test to gtsam_unstable
2014-03-27 13:14:13 -04:00
4c5cb4d8ec
Removed some unused code that was causing warnings
2014-02-23 18:51:48 -05:00
89e6d2f1e8
Removed some commented-out includes
2014-02-18 13:44:25 -05:00
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
5ef681bc4a
Changed Vec() to Vector().
2014-02-05 13:59:21 -05:00
381899640e
Moved TransformBtwRobotsUnaryFactor to gtsam_unstable from svn version.
2014-02-04 14:13:25 -05:00
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
8641816b21
fix Vector_() in gtsam_unstable and tests
2014-01-23 02:03:12 -05:00
880d9a8e3c
Switched to new Eigen built-in special comma initializer
2013-12-16 21:33:12 +00:00
0b3aac7048
Fix Matrix_(...) to Mat() <<... in gtsam_unstable
2013-11-13 05:51:03 +00:00
5defdbe73f
Fixed compile problems on windows
2013-11-05 16:06:10 +00:00
de55dc0d66
Fix Vector_() to Vec() in gtsam_unstable/slam
2013-10-22 04:56:01 +00:00
6e7302283e
moved smart factors for smartFactors_ceres
2013-10-21 15:35:23 +00:00
92f0bb64b2
added tests on smartHessianFactor with Cal3Bundler
2013-10-19 22:00:43 +00:00
d5790376d7
cleaning (2)
2013-10-18 23:15:47 +00:00
3a139587ee
minor changes
2013-10-17 01:18:22 +00:00
4f2d233e67
added test on Hessian
2013-10-15 14:57:48 +00:00
b77f7f77a4
created infrastructure for testing BAL datasets
2013-10-15 02:02:53 +00:00
44ae90f523
added SmartHessianProjection factor: allows different calibrations and noises for the cameras
2013-10-14 22:33:15 +00:00
9ad033fc45
Added unit tests on projectPointAtInfinity and backprojectPointAtInfinity. Fixed error projectPointAtInfinity. Deleted projectPointAtInfinity
2013-10-12 19:29:07 +00:00
e799c9ffa9
tabs converted to two spaces
2013-10-10 17:52:57 +00:00
426b4d79cf
testSmartProjectionFactor - disabled
2013-10-08 14:28:50 +00:00
444df1958a
Kitti test not working
2013-10-06 18:17:35 +00:00
441dcec64e
added unit test for selective relinearization
2013-09-28 21:25:08 +00:00
9ad72e9523
included rank tolerance in Smart factor constructor
2013-09-28 18:49:26 +00:00
d10ffee4d4
management of degeneracy
2013-09-28 00:49:37 +00:00
8168d4a186
commented test
2013-09-26 23:09:48 +00:00
73e72a98bd
Selective relinearization
2013-09-26 01:06:55 +00:00
9f68c04792
Initial implementation of selective relinearization
2013-09-20 20:19:58 +00:00
141958123a
Working version of rotation only smart factor
2013-08-28 17:37:58 +00:00
0422b9cfef
degenerate case in smart vision factor
2013-08-28 16:07:58 +00:00
633220a9dd
degenerate case in SmartProjectionFactor
2013-08-28 16:07:56 +00:00
e6d5c2bf73
updated to the new gtsam version.
2013-08-23 18:15:28 +00:00
e439a298b8
disabled until debugging is done.
2013-08-23 16:18:18 +00:00
77e02a332e
Added TransformBtwRobotsUnaryFactorEM. May need to move to MAST later.
2013-08-23 15:24:16 +00:00
ca3956adc1
minor changes.
2013-08-23 15:21:50 +00:00
4b12d6f794
Moved Symbol and LabeledSymbol to inference as they are no longer specific to nonlinear optimization
2013-08-19 15:32:16 +00:00
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
09c4d8b712
Disabled testBetweenFactorEM because it is in progress for debugging
2013-08-16 21:57:49 +00:00
0212bbc30d
Fixed some unit tests
2013-08-16 04:11:02 +00:00
0514ad39c6
Smart projection factor working on Kitti
2013-08-14 19:12:23 +00:00
d7e6f43fa7
Updated to work with unordered GTSAM
2013-08-14 19:12:21 +00:00
16b4f0fe8b
Moved ImuFactor and CombinedImuFactor into main gtsam, and moved InertialNavFactor family into gtsam_unstable.
2013-08-13 21:04:31 +00:00
13d829687c
Merged from branch 'trunk'
2013-08-12 21:49:59 +00:00
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
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
7a027be7e5
Fixed unit tests compiling on windows
2013-08-12 16:25:13 +00:00
14931bcc7d
improved tests a little. basic 3 landmark test with smart projection factor fails!
2013-08-12 14:40:57 +00:00
ea3ca54cba
"Fixed" more unit tests
2013-08-11 19:01:06 +00:00
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
f4d816dcf8
Disabled testSmartProjectionFactor and made print message about this
2013-08-11 18:40:57 +00:00
f240327f24
Fixed testIMUSystem and BetweenFactorEM
2013-08-11 18:40:47 +00:00
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
1eae17561d
Taking ImuFactor noise model automatically from preintegrated measurement covariance
2013-08-09 18:50:14 +00:00
4a4e16485c
Making more things in gtsam_unstable compile
2013-08-08 20:08:54 +00:00
b3ea3f9465
lines added to testSmartProjectionFactor
2013-08-08 14:30:26 +00:00
a82262cf99
Included noise model and f term in SmartProjectionFactor
2013-08-08 14:00:26 +00:00
f423d6f2a8
SmartProjectionFactor: More cleanup, added more tests, added some timing
2013-08-07 23:32:40 +00:00
d33f435eab
Added BetweenFactorEM with 2 indicator variables.
2013-08-07 15:25:00 +00:00
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
e39d100b6a
Made most global unit tests compile, includes dogleg, iterative, kalman filter, etc
2013-08-06 13:44:22 +00:00
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
ede0805fac
Global find+replace to remove Ordered
2013-08-05 22:31:44 +00:00
5518007317
adding test with regular projection factors for comparison, and bug fixes in SmartFactor test.
2013-08-05 17:58:32 +00:00
d1de6b29a9
adding 3 camera, 3 landmark test
2013-08-05 15:50:19 +00:00
39ec641c4a
Modifications to SmartProjectionFactor and unit test: work in progress
2013-08-05 15:09:03 +00:00
d1419a3d11
Added SmartProjectionFactor (+unit tests)
2013-08-02 23:35:39 +00:00
34dc67c1af
Brought some relevant changes from aspn-imu-factor branch (is correct this time)
2013-08-02 16:04:17 +00:00
2705d85fa7
Merged from branch 'trunk'
2013-07-31 18:55:15 +00:00
ed79432a69
Added MultiProjectionFactor, invoving n views (camera poses) observing a single landmark: work in progress
2013-07-31 18:02:56 +00:00
321a286f02
Revert "Brought some relevant changes from aspn-imu-factor branch"
...
This reverts commit b08a11ffb27d14487115f20745f1cea17fcc55ee.
2013-07-31 15:26:48 +00:00
cbeall3
Frank Dellaert
dellaert
Luca
Abe
Paul Drews
Mike Bosse
Richard Roberts
Vadim Indelman
jing
vindelman3
Jing Dong
Luca Carlone
Chris Beall
Vadim Indelman
Alex Cunningham
Zsolt Kira