f009633384
exposed point status in smart factors to keep uniformity with mono smart factors
2016-07-31 18:33:58 -04:00
6a21f1b730
adapted stereoSmart factors to use "outlier" and "far point" statuses
2016-07-31 18:31:38 -04:00
20c13580cc
deleted unused variables in unit test
2016-07-29 16:34:18 -04:00
50d6532fe1
the ultimate test: smartStereoFactors generalize smartFactors in that they work in the purely monocular case!
2016-07-27 23:48:58 -04:00
a5138bfb46
included body_P_sensor in smartStereoProjectionPoseFactor!
2016-07-25 22:13:25 -04:00
6c163b0a4d
added test which optimize smartStereoFactor with missing measurements (uR)
2016-07-24 19:07:00 -04:00
b90e224f59
added tests for error and triangulation
2016-07-24 18:56:04 -04:00
cd9b4cd5ab
moved common definitions to base class
2016-07-24 18:31:55 -04:00
f2bec78a58
first implementation of smartStereo with possibly left-only pixel measurements
2016-07-24 18:27:20 -04:00
3c15ef5d1e
great simplification in stereo triangulation: converting stereo into a set of monocular cameras, then proceed as in the monocular case
2016-07-24 16:11:07 -04:00
a97502f5a1
Resolved all issues with typedefs
2016-06-06 21:57:52 -07:00
41b091e86f
Chasing down more vector() and Point2 default constructor uses
2016-06-06 00:37:49 -07:00
bdbbe0203d
Derive Point2 from Vector2 and deprecate a number of methods
2016-06-05 23:52:04 -07:00
72fe66d468
Removed headers
2016-05-22 14:22:36 -07:00
3b7c57aedf
Replaced BOOSE_FOREACH with for in gtsam_unstable folder.
2016-05-20 23:41:41 -04:00
b6728ef620
Deprecated Vector ones(size_t n). All unit tests pass.
2016-04-15 17:30:54 -04:00
76308a5d46
Deprecated Vector zero(size_t n). All unit tests pass.
2016-04-15 16:54:46 -04:00
652edb6e61
Merged in fix/DeprecateMatrixFunctions (pull request #243 )
...
Fix/deprecatematrixfunctions
2016-04-12 23:53:42 -07:00
70b2aab352
Deprecated all inline functions in Matrix.h.
2016-04-11 15:11:29 -04:00
a3b66a94ea
Cleaned up Double_ problems
2016-04-10 19:01:14 -07:00
ae19e078c7
Changed argument and implementation of correct() in Mechanization_bRn2
2016-03-12 20:44:05 -05:00
97e26cc365
Deprecated sub() in Vector.h.
2016-03-11 20:30:19 -05:00
5502691022
Deprecated norm_2() in Vector.h
2016-03-11 19:34:49 -05:00
2f146e85ef
Deprecated esqrt() from Vector.h.
2016-03-11 14:34:19 -05:00
7d0b562908
Fixed two missed replacements of cwiseProduct() with array().square().
2016-03-05 21:20:32 -05:00
caa45ad67b
Replaced cwiseProduct() with array().square(). Killed deprecated comments.
2016-03-05 21:08:24 -05:00
22c3af906e
Deprecated emul() in Vector.h.
2016-03-05 18:49:34 -05:00
0372a959ee
Many small improvements, bug-fixes, and tests
2016-02-24 11:01:19 -08:00
1c920967d9
No more use of vector() or default constructor
2016-02-12 00:06:07 -08:00
56dbf487ee
Fixed more default constructor calls
2016-02-11 23:31:17 -08:00
2060b09a2b
Avoid calling default constructors and/or vector
2016-02-11 19:03:11 -08:00
94ccf98985
Avoid default constructor in tests
2016-02-11 19:01:54 -08:00
4d93a33f61
Static methods should be uppercase.
2016-01-26 23:09:58 -08:00
04bcf26aa6
Explicitly cast optional to bool
2015-10-20 14:44:00 -04:00
aa2ffcd118
Merge branch 'develop' into feature/cleanup_ImuFactor
2015-09-17 17:42:38 -04:00
29ad9478f7
Move noise model initialization from add function into constructor. Can only have one noise model per factor anyway
2015-08-26 13:02:39 -04:00
0503df31fa
Relax tolerance to 1e-6 for MKL/quaternion test, and fix up documentation a bit.
2015-08-25 12:14:52 -04:00
6a5147b5b5
Merged in fix/SmartStereo (pull request #181 )
...
Fix/smartstereo
2015-08-25 09:51:59 -04:00
8b4228fa56
Make smart parameters public. Now easier to set, and it's sufficient for this to be const within the smart factor itself!
2015-08-19 10:58:35 -04:00
c8df985e2f
Relax test tolerance a bit for quaternion mode
2015-08-19 07:30:14 -04:00
1727b60728
Fixed and cleaned up unit test
2015-08-19 00:11:35 -04:00
123c55f0d7
respect triangulation.enableEPI flag in SmartStereo factor
2015-07-29 14:05:48 -04:00
fd1e41a9e6
remove calibration template from SmartStereoProjectionPoseFactor
2015-07-28 15:12:02 -04:00
748877ff7e
remove calibration template from SmartStereoProjectionFactor
2015-07-28 14:56:45 -04:00
db64b48fda
tests pass
2015-07-28 14:48:53 -04:00
da9078cf3b
add nonlinear triangulation back. Some unit tests fail again
2015-07-27 23:27:20 -04:00
1a47a334de
Deal with changes in Rot3
2015-07-21 11:23:42 -07:00
7ae31bd8e7
delete some unused stuff
2015-07-20 11:43:57 -04:00
b5a978c534
improve dynamic outlier rejection test
2015-07-19 21:01:14 -04:00
fcc9ac2669
remove extra cout
2015-07-19 20:39:34 -04:00
36c652ac40
remove monocular triangulation hack and make tests pass again
2015-07-19 20:37:16 -04:00
3f0e695cc9
some tests pass again
2015-07-16 11:26:07 -04:00
93f7eafaa8
re-enable triangulation hack
2015-07-15 23:16:45 -04:00
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
3bad6fea67
moved RangeFactor to SAM
2015-07-12 12:12:59 -07:00
5052eb2c64
cleaning up
2015-07-11 18:31:36 -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
f8ab4ef144
Change SimpleCamera from typedef back to regular class to make wrapping+serialiation work. Had to change some templates because vector<PinholeCamera> can't be upcast to vector<SimpleCamera>
2015-05-18 14:33:27 -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
ea6f5e3fb9
Use TriangulationParameters
2015-04-08 21:36:11 -04:00
762a7b7435
Remove selective relinearization and state
2015-04-08 17:52:25 -04:00
51482ea358
Remove template parameter D, get from Base::Dim instead
2015-04-08 14:21:40 -04:00
956b53dc3b
Fixed sign in stereo version
2015-03-12 09:51:44 -07:00
2bdeac30f0
Fixed compile error w PointCov
2015-03-12 07:56:47 -07:00
a4d1874af4
Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3
2015-03-09 17:51:16 -07:00
faadf5b06f
Fully compiles now
2015-03-06 08:48:35 -08:00
472821f16d
Merge remote-tracking branch 'upstream/develop' into fix/serialization_warnings
2015-03-06 17:10:59 +01:00
ebf5746987
Fix some serialization warnings.
2015-03-06 16:12:09 +01: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
b40c0f7f15
Fixed sign
2015-03-05 10:36:03 -08:00
dc3d5f77fe
Extra stereo tests
2015-03-05 10:35:54 -08:00
e6a90db2d5
Migrated to non-keyed Fblocks
2015-03-04 23:11:01 -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
a375e7b5be
RADICAL2: The SmartProjectionPoseFactor (soon to be renamed SmartPinholePoseFactor, if it survives at all) now no longer stores shared calibrations. Values expect to contain PinholePoses not Pose3s now. The current state of affairs was simply a bug: one pose could be optimized for several different calibrations. It relied on the user to make sure all measurements for a specific pose to optimize were all given the same shared calibration, which was then stored *millions of times* in the pose factors. Instead, there is now *one* shared calibration per PinholePose unknown.
2015-02-26 13:55:16 +01: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
0bf95ae7f6
Removed obsolete code, including slow Schur-complement versions
2015-02-26 11:44:51 +01:00
fd71974ff3
Got mostly rid of computeEP: just a call to cameras.project2
2015-02-25 20:52:16 +01:00
850470ef06
rename of computeJacobians overloads to better reflect functionality
2015-02-25 19:30:17 +01:00
8a88f101db
Fix deprecation warnings
2015-02-24 21:58:17 -05:00
d7b5156dcc
rename to reprojectionErrorAfterTriangulation
2015-02-25 01:14:36 +01:00
eb28d0ffa8
Restored reprojectionErrors -> reprojectionError
2015-02-24 14:09:35 +01:00
d6f54475c3
BIG change: SmartFactorBase and SmartProjectionFactor now templated on CAMERA
2015-02-23 12:43:43 +01:00
64bb6b77d7
Merged in feature/SmartCT (pull request #107 )
...
Refactoring of Smart Factors
2015-02-22 06:14:19 +01:00
5afc3c4cea
again: overlooked Dim -> dimension because this factor has no unit test!
2015-01-28 16:48:12 -05:00
b1cea2bee7
overlooked Dim -> dimension because this factor has no unit test!
2015-01-23 14:29:25 -05: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
c8faa102e3
Moved EexpressionFactor related files to gtsam
2014-12-28 13:48:13 +01:00
e5017984a1
traits_x -> traits
2014-12-26 16:47:51 +01:00
afe20d83bd
Dealing with Pose3 mojo loss
2014-12-25 20:04:28 +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
ea3b4624d8
Testable concept prereqs check
2014-12-23 14:56:48 +01:00
52ec4f0784
fixed serialization tests
2014-12-23 12:35:49 +01:00
f5c9c24330
Corrected sillyness
2014-12-22 23:41:42 +01:00
355b938f3a
Point3 loses its mojo (superfluous Lie/Manifold stuff)
2014-12-22 17:22:45 +01:00
5473550eea
Using traits in many places (forced by loss of Point2 mojo)
2014-12-22 16:02:33 +01:00
a6f612844f
fixed testTSAMFactors.cpp
2014-12-22 09:39:51 +01:00
06c3696176
Fixed more problems so everything compiles now after splitting up concepts into Group/Manifold/Lie/VectorSpace. Still 25 tests that fail.
2014-12-22 02:52:31 +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
00b374c9e9
Merge remote-tracking branch 'origin/develop' into feature/tighteningTraits
...
Conflicts:
gtsam/base/LieScalar.h
gtsam/geometry/Point2.h
2014-12-21 14:39:23 +01:00
d0e1c1a770
test compiling!! but 34 tests failed out of 198
2014-12-20 20:36:54 +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
1e778cf77b
No longer need to cast function pointers for expressions on Windows, with Optional Jacobian
2014-12-09 11:53:35 -05:00
137ea64200
Updating with OptionalJacobian
2014-12-09 11:49:47 -05:00
3bd491bf66
Merge branch 'develop' into fix/windowsExpressions
2014-12-09 11:04:30 -05:00
cea76a2848
More template handholding for windows
2014-12-08 21:48:59 -05:00
d2e53d4fe9
"Fixed" AHRS
2014-12-04 12:30:41 +01:00
4e557d38e6
updated Matrix.h with commonly used matrices.
2014-12-03 09:59:10 -05:00
6505e602d8
FixedRef is now OptionalJacobian
2014-11-28 17:14:26 +01:00
0d41523725
Use new FixedRef type
2014-11-28 01:57:55 +01:00
cc4cdc93a3
Correct issue with function overload ambiguity when passing function pointer to expression constructor on windows
2014-11-26 15:06:16 -05:00
7b1a9ba371
Merged in feature/TemplatedSmartFactors (pull request #39 )
...
Templated Smart Factors
2014-11-25 07:36:14 -05:00
ea02e577f5
Merged in feature/expressions (pull request #45 )
...
Pull request for debugging Expression<double> issue
2014-11-24 18:40:31 +01:00
a9090fd7af
Cleanup with Jing
2014-11-24 15:53:13 +01:00
3ba9e8f405
Updated some usages that were missed
2014-11-23 15:24:55 -08:00
f9ca07e610
Converted Vector(2|3) << ... to Vector2(...) or Vector3(...) syntax
2014-11-23 10:22:25 -08:00
f21fe5043a
Created a new expressions.h file in nonlinear
2014-11-23 17:31:33 +01: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
265184b6c9
Avoid warning
2014-11-10 17:56:08 +01:00
e976aae38a
Avoid warning and re-formatted with BORG template
2014-11-10 16:27:33 +01: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
efc2dc69fe
Got rid of some concats
2014-11-04 15:44:41 +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
f916531492
remove typename from non-templated class
2014-10-24 13:06:45 -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
83d77271d9
Ternary now fixed
2014-10-07 13:04:04 +02:00
921b79f446
No more default argument
2014-10-07 01:01:16 +02:00
7a4f307342
moved biasedGPS and GaussMarkov to unstable
2014-10-06 13:11:40 -04:00
d5709facf6
Added Pose2SLAMExample
2014-10-02 20:20:00 +02:00
0d94eeb480
Created expressions.h header
2014-10-01 11:25:49 +02:00
e0a9eb63ce
Fix for Windows: renamed some tests
2014-09-24 16:47:07 -04:00
be68cc0047
add given marginals to update_noiseModel to improve speed
2014-09-15 03:03:25 -04:00
1a7653730c
fix headers for TransBtwRobotFactorEM
2014-09-13 18:12:28 -04:00
6b890cec0e
added updateNoiseModels functionality
2014-09-10 00:24:32 +03:00
2634b2e890
Finish concurrent-calibration
2014-08-12 16:00:20 -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
bcab483574
Changed norm to determinant.
2014-08-01 21:51:52 +03:00
89410fe1ee
added updateNoiseModels_givenCovs to BetweenFactorEM.
2014-08-01 21:11:19 +03:00
bc982293ab
New unit tests for quaternary pose+transform+landmark+calibration factor
2014-07-29 21:55:14 -04:00
b5b1bbfba0
improve TransBtwRobotEM factor's preformance by removing redundant unwhitenedError calc
2014-07-18 17:11:21 -04:00
e06c2cfacc
change few function parameters to const reference to improve preformance of TransformBtwRobot factors
2014-07-18 15:59:14 -04:00
f261a6ddbc
Merge remote-tracking branch 'origin/develop' into feature/concurrent-calibration
2014-07-02 15:49:47 -04:00
8bc87e8f4f
Transform + Calibration examples and factor
2014-07-01 16:33:23 -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
a7a209ce0c
Minor fixes and documentation cleanup
2014-05-30 13:31:35 -04:00
386ed2e510
Merge branch 'develop'
...
Conflicts:
gtsam_unstable/slam/SmartFactorBase.h
2014-05-28 18:11:39 -04:00
2699605943
Fix return type mismatch
2014-05-28 11:31:17 -04:00
8806c15b36
fixed possible connectivity issue when smart factors are degenerate
2014-05-23 17:49:42 -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
4f91f94d1e
included possibility to linearize to Jacobian for smart Pose factors
2014-05-22 21:27:46 -04:00
1062e41de3
shut up some warnings on Windows
2014-05-06 22:57:26 -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
5c420f1aec
added references
2014-05-04 18:16:40 -04:00
1ed07ca4ed
Moved to unstable
2014-05-03 12:23:20 -04:00
185c572b5a
removed wrong base class
2014-04-24 11:28:41 -04:00
8c657f8857
slight change in implementation of hessianBlockDiagonal
2014-04-23 19:00:15 -04:00
d9e93f316a
error computation now does not include noise model
2014-04-23 18:43:14 -04:00
2b52bad569
optimized point damping
2014-04-23 15:15:48 -04:00
e56666e85c
fixed print function
2014-04-23 14:53:01 -04:00
37b750411f
added gradientAtZero with raw memory access
2014-04-22 18:38:12 -04:00
dd780e356c
fixed computation of linearized error in implicit schur factors
2014-04-21 18:59:33 -04:00
926b4c6443
removed temporary variables - minor
2014-04-14 11:41:55 -04:00
6ef11bb297
removed debug statements
2014-04-09 21:14:38 -04:00
4bdefc3f70
removed debug bloks
2014-04-09 21:04:52 -04:00
dc7b5d58c0
implemented efficient update of Hessian matrix via Schur complement
2014-04-09 21:01:03 -04:00
4123053c81
progress on grouping - still seg faults
2014-04-08 18:55:42 -04:00
310fce3be9
last updates from smartFactors project (these files are now removed from that project)
2014-04-06 14:25:46 -04:00
02fc860d9e
add smartfactor base classes, smartProjectionPoseFactor, and its unit test to gtsam_unstable
2014-03-27 13:14:13 -04:00
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
9007d1ca72
Copy constructor and return const &
2014-03-06 21:07:54 -05:00
691e9884d7
Const correctness, comments, and templated Eigen blocks (esp. important in integrate)
2014-03-06 21:05:11 -05: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
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
fe55148dd7
deleted redundant files for imu factors
2014-01-27 17:38:01 -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
c4eec5d549
fix Vector_() remained
2014-01-23 02:16:04 -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
ec78d54f37
Removed old Index typedef and IndexFormatter
2013-11-08 16:35:28 +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
a1402018ca
added computePoints functionality in smartFactorsCreator
2013-10-19 22:42:51 +00:00
92f0bb64b2
added tests on smartHessianFactor with Cal3Bundler
2013-10-19 22:00:43 +00:00
916d730fce
Updated BAL example with readBAL functionality (work in progress)
2013-10-19 02:05:51 +00:00
d5790376d7
cleaning (2)
2013-10-18 23:15:47 +00:00
81c183199a
cleaning and removing useless things
2013-10-18 23:14:34 +00:00
3a139587ee
minor changes
2013-10-17 01:18:22 +00:00
6f6061c6c2
fixed make check
2013-10-16 00:58:41 +00:00
45e1fe832d
fixed issues
2013-10-16 00:54:56 +00:00
01f6ee56e4
templated version for Kitti, triangulation, and factorCreators
2013-10-15 22:43:10 +00:00
c27f4f6bcb
added possibility to read initialization from file in ProjectionFactorCreator
2013-10-15 19:16:38 +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
0ad2dc6f81
removed "using" from header
2013-10-12 21:08:27 +00:00
9ad033fc45
Added unit tests on projectPointAtInfinity and backprojectPointAtInfinity. Fixed error projectPointAtInfinity. Deleted projectPointAtInfinity
2013-10-12 19:29:07 +00:00
71039164b2
Added "using namespace boost::assign" to allow use of +=
2013-10-12 17:15:36 +00:00
b51a8380c4
added boost include
2013-10-12 16:21:15 +00:00
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
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
e799c9ffa9
tabs converted to two spaces
2013-10-10 17:52:57 +00:00
121e71431a
SmartFactorsCreator + initial fix in kitti example
2013-10-09 17:13:19 +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
d049dd38c6
Incremental mode in Smart Factors (not working yet with standard ProjectionFactors)
2013-10-06 18:17:32 +00:00
bf40956592
Merged from Hmf6_unordered 970392249a8c50153f24594c9c81acb740cedd06
2013-10-03 19:51:56 +00:00
a6dd4c0464
testing on kitti
2013-09-30 20:39:55 +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
e10a0a0650
bool to disable selective relinearization
2013-09-26 23:09:50 +00:00
8168d4a186
commented test
2013-09-26 23:09:48 +00:00
22ccd4b4b4
update to smartFactor
2013-09-26 23:09:47 +00:00
70a448f43e
Efficient implementation of Selective Linearization
2013-09-26 15:07:56 +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
0e5069c26c
Added toy example on SmartRangeFactors
2013-09-14 00:21:10 +00:00
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
b3d500f58c
Added optional flag_bump_up_near_zero_probs.
2013-08-29 22:43:09 +00:00
86d21aaa05
Added optional flag_bump_up_near_zero_probs.
2013-08-29 22:42:33 +00:00
141958123a
Working version of rotation only smart factor
2013-08-28 17:37:58 +00:00
df36ee643a
Added option to start with an M step.
2013-08-28 16:56:57 +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
19ddf3f228
minor speedup
2013-08-28 14:47:57 +00:00
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
138a7ea28c
minor fixes - removed unnecessary boost optional
2013-08-27 17:48:59 +00:00
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
e6d5c2bf73
updated to the new gtsam version.
2013-08-23 18:15:28 +00:00
6ab49e95da
Added cref_list_of.
2013-08-23 18:12:59 +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
f6402916d6
added flag_bump_up_near_zero_probs_.
2013-08-23 15:22:50 +00:00
ca3956adc1
minor changes.
2013-08-23 15:21:50 +00:00
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
c6cf4d2dab
Removed use of convenience libraries for tests - wasn't really supported in current version
2013-08-19 15:32:21 +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
87a7c56c88
Switched to square root of covariance norm.
2013-08-12 16:11:48 +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
bb4ad176da
Needed std::
2013-08-09 18:50:15 +00:00
1eae17561d
Taking ImuFactor noise model automatically from preintegrated measurement covariance
2013-08-09 18:50:14 +00:00
369e69b0d2
actually set everything to zero to turn factor off during linearization
2013-08-09 15:28:57 +00:00
b0c96f9bf6
unwhitenedError.
2013-08-08 20:14:12 +00:00
4a4e16485c
Making more things in gtsam_unstable compile
2013-08-08 20:08:54 +00:00
579e0931dc
Fixed different issues with EM.
2013-08-08 15:12:21 +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
c2f5adc7d0
Cleaned up code: Removed commented out code, added debug condition
...
If debug is enabled, both blockwise and full implementations are performed and then compared
2013-08-07 13:05:08 +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
2e085ace91
Changes in SmartProjectionFactor
2013-08-05 19:25:08 +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
f273b8f915
Removed extra 'typename'
2013-08-02 16:04:29 +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
b62af20fdc
Revert "Removed extra 'typename'"
...
This reverts commit 04fd69f56c1e1cbd934a54aeb415e2cf2132d236.
2013-07-31 15:26:46 +00:00
90cf73d4a7
Removed extra 'typename'
2013-07-31 15:25:05 +00:00
7345b40feb
Brought some relevant changes from aspn-imu-factor branch
2013-07-31 15:25:03 +00:00
3ade190128
Renamed old classes to "Ordered" and removed "Unordered" name from new classes
2013-07-29 23:55:40 +00:00
f3aa2fde53
Fixed compile error
2013-06-25 17:22:45 +00:00
0837eab8f5
Scripts to test (still not working so-well) smart range factor
2013-06-25 17:13:02 +00:00
26df712592
Put new unit test global variables into anonymous namespaces. Removed dll export tag from SmartRangeFactor since it is a header-only class.
2013-06-24 19:30:00 +00:00
39910717d6
Picked the winner
2013-06-24 16:25:02 +00:00
34db300802
Fixed n<3 Jacobians
2013-06-24 16:18:48 +00:00
3383e52c5f
Split unit tests....
2013-06-24 16:02:17 +00:00
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
aea4f31096
Fixed Jacobians, optimization works
2013-06-24 15:31:13 +00:00
b7dbcefa8b
simplified measurements_ to vector
2013-06-24 12:15:01 +00:00
4b412b0a4b
keys and Jacobians
2013-06-24 12:07:21 +00:00
d041c5b8a8
Split up circle intersection code into three routines that are used in SmartRangeFactor
2013-06-24 08:24:56 +00:00
5f5e481394
AHRS mechanization small efficiency change (in progress)
2013-06-21 00:21:18 +00:00
e7334b89bd
Rebasing...
2013-06-20 17:08:30 +00:00
5ae4f21517
Added missing dll export tags to new functions
2013-06-20 16:05:23 +00:00
456d1b5cf7
Cleanup: moving old serialization function to gtsam_unstable, renaming matlab serializaion test
2013-06-19 17:50:09 +00:00
d85c773f7c
Changes in AHRS - flat trim initialization added, some comments by Frank, aidingAvailablitiy function
2013-06-14 21:18:22 +00:00
b2d4469cb3
Added missing export tag
2013-06-04 17:34:02 +00:00
Luca
Frank Dellaert
dellaert
Yao Chen
Alex Hagiopol
cbeall3
Duy-Nguyen Ta
Luca
Abe
Thomas Schneider
Paul Drews
Mike Bosse
Andrew Melim
Natesh Srinivasan
Richard Roberts
Jing Dong
Vadim Indelman
Vadim Indelman
vindelman3
Jing Dong
Luca Carlone
Frank Dellaert
Zsolt Kira
Chris Beall
Vadim Indelman
Alex Cunningham
Kyel Ok