Commit Graph

434 Commits (90dc1ce3b51a6917a5cf47de2c4d5f636aade31d)

Author SHA1 Message Date
cbeall3 93f7eafaa8 re-enable triangulation hack 2015-07-15 23:16:45 -04:00
cbeall3 bd4dd84933 huge refactor. Compiles again, but triangulation still broken, SmartStereo test fails 2015-07-15 16:53:04 -04:00
cbeall3 fb4dd81c4d refactoring: step 1 2015-07-15 12:58:03 -04:00
Frank Dellaert 30435da070 Moved BearingRangeFactor to SAM 2015-07-12 18:57:26 -07:00
Frank Dellaert 3bad6fea67 moved RangeFactor to SAM 2015-07-12 12:12:59 -07:00
Frank Dellaert 5052eb2c64 cleaning up 2015-07-11 18:31:36 -07:00
Frank Dellaert 7ff3e11efd removed redundancy in naming 2015-07-09 11:29:32 -07:00
Frank Dellaert 3b16ad2967 Moved deprecated headers into subdirectory 2015-07-09 11:14:39 -07:00
Frank Dellaert 377b90941b switch to Rodrigues everywhere 2015-07-05 16:11:04 -07:00
cbeall3 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
dellaert 128bac616c Globally replaced FastSet<Key> with KeySet. 2015-06-20 18:38:25 -07:00
Luca 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
cbeall3 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
Abe 13a4da21b2 misc bugfixes and cleanup from skydio 2015-05-13 22:26:24 -07:00
Frank 4ba329c23b Fixed many warnings on Ubuntu 2015-05-12 13:46:24 -07:00
cbeall3 ea6f5e3fb9 Use TriangulationParameters 2015-04-08 21:36:11 -04:00
cbeall3 762a7b7435 Remove selective relinearization and state 2015-04-08 17:52:25 -04:00
cbeall3 51482ea358 Remove template parameter D, get from Base::Dim instead 2015-04-08 14:21:40 -04:00
dellaert 956b53dc3b Fixed sign in stereo version 2015-03-12 09:51:44 -07:00
dellaert 2bdeac30f0 Fixed compile error w PointCov 2015-03-12 07:56:47 -07:00
dellaert a4d1874af4 Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3 2015-03-09 17:51:16 -07:00
dellaert faadf5b06f Fully compiles now 2015-03-06 08:48:35 -08:00
Thomas Schneider 472821f16d Merge remote-tracking branch 'upstream/develop' into fix/serialization_warnings 2015-03-06 17:10:59 +01:00
Thomas Schneider ebf5746987 Fix some serialization warnings. 2015-03-06 16:12:09 +01:00
Chris Beall 3be6b16995 relax threshold from 1e-7 to 1e-6 to make test pass. 2015-03-06 00:32:43 -05:00
dellaert 758aab6e80 Cleaned up test 2015-03-05 10:41:49 -08:00
dellaert b40c0f7f15 Fixed sign 2015-03-05 10:36:03 -08:00
dellaert dc3d5f77fe Extra stereo tests 2015-03-05 10:35:54 -08:00
dellaert e6a90db2d5 Migrated to non-keyed Fblocks 2015-03-04 23:11:01 -08:00
dellaert f28b083c14 Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3
Conflicts:
	gtsam/slam/tests/testSmartProjectionPoseFactor.cpp
2015-03-04 16:02:25 -08:00
dellaert 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
dellaert 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
dellaert 0bf95ae7f6 Removed obsolete code, including slow Schur-complement versions 2015-02-26 11:44:51 +01:00
dellaert fd71974ff3 Got mostly rid of computeEP: just a call to cameras.project2 2015-02-25 20:52:16 +01:00
dellaert 850470ef06 rename of computeJacobians overloads to better reflect functionality 2015-02-25 19:30:17 +01:00
Paul Drews 8a88f101db Fix deprecation warnings 2015-02-24 21:58:17 -05:00
dellaert d7b5156dcc rename to reprojectionErrorAfterTriangulation 2015-02-25 01:14:36 +01:00
dellaert eb28d0ffa8 Restored reprojectionErrors -> reprojectionError 2015-02-24 14:09:35 +01:00
dellaert d6f54475c3 BIG change: SmartFactorBase and SmartProjectionFactor now templated on CAMERA 2015-02-23 12:43:43 +01:00
dellaert 64bb6b77d7 Merged in feature/SmartCT (pull request #107)
Refactoring of Smart Factors
2015-02-22 06:14:19 +01:00
cbeall3 5afc3c4cea again: overlooked Dim -> dimension because this factor has no unit test! 2015-01-28 16:48:12 -05:00
cbeall3 b1cea2bee7 overlooked Dim -> dimension because this factor has no unit test! 2015-01-23 14:29:25 -05:00
dellaert e119846280 Updated examples and test 2014-12-28 19:10:41 +01:00
dellaert 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
dellaert c8faa102e3 Moved EexpressionFactor related files to gtsam 2014-12-28 13:48:13 +01:00
dellaert e5017984a1 traits_x -> traits 2014-12-26 16:47:51 +01:00
dellaert afe20d83bd Dealing with Pose3 mojo loss 2014-12-25 20:04:28 +01:00
dellaert 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
dellaert d9f5681dc2 Fixed warning 2014-12-24 11:34:53 +01:00
dellaert ea3b4624d8 Testable concept prereqs check 2014-12-23 14:56:48 +01:00
Mike Bosse 52ec4f0784 fixed serialization tests 2014-12-23 12:35:49 +01:00
dellaert f5c9c24330 Corrected sillyness 2014-12-22 23:41:42 +01:00
dellaert 355b938f3a Point3 loses its mojo (superfluous Lie/Manifold stuff) 2014-12-22 17:22:45 +01:00
dellaert 5473550eea Using traits in many places (forced by loss of Point2 mojo) 2014-12-22 16:02:33 +01:00
Mike Bosse a6f612844f fixed testTSAMFactors.cpp 2014-12-22 09:39:51 +01:00
dellaert 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
dellaert 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
dellaert 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
Mike Bosse d0e1c1a770 test compiling!! but 34 tests failed out of 198 2014-12-20 20:36:54 +01:00
Mike Bosse 07bcc18d43 fixed testTSAMFactors 2014-12-15 23:23:40 +01:00
dellaert 8f27b048f1 Moved experiment to doubleExpresso project 2014-12-12 08:53:32 +01:00
dellaert 541217175c Added ExpressionFactorGraph (should go away with move of ExpressionFactor to gtsam) 2014-12-12 08:00:02 +01:00
dellaert fa7071bdd8 Comments, renaming 2014-12-12 07:45:09 +01:00
dellaert 8cc813f03e Removed misguided Factory attempt in favor of direct expressions 2014-12-12 07:31:33 +01:00
dellaert a9121fc3fc Now it's super-easy to create priors on pieces of state. 2014-12-11 13:45:15 +01:00
dellaert cedf2647d2 Use handy dandy Factor Factory 2014-12-11 13:19:37 +01:00
dellaert d37216cde3 TOAFactor header 2014-12-10 22:50:41 +01:00
dellaert bb00e375da Print for MATLAB 2014-12-10 21:44:56 +01:00
dellaert dc84b6589e Added in real experimental data gathered by Jay at KU Leuven 2014-12-10 21:12:38 +01:00
dellaert d17caa5487 Event header and test file 2014-12-10 19:14:18 +01:00
dellaert 5d6e0bc753 Optimization test succeeds, but only with 5th microphone... 2014-12-10 19:00:52 +01:00
dellaert 2dcbc72d8d Derivatives work !!! 2014-12-10 17:58:35 +01:00
dellaert 0ceb09262c Put in prototype derivatives, needs unit test 2014-12-10 16:06:34 +01:00
dellaert cca1a54544 Everything done, except derivatives !!! 2014-12-10 16:02:13 +01:00
dellaert d54c70202a TOAFactor compiles and can be put into a factor graph 2014-12-10 15:43:31 +01:00
dellaert ba1a2685bc Not-working yet, but lots of progress towards TOAFactor 2014-12-10 15:10:59 +01:00
dellaert 5ce007446d Merge remote-tracking branch 'origin/develop' into feature/SoundSlam
Conflicts:
	.cproject
2014-12-10 14:47:58 +01:00
dellaert 777aa005b4 Developing time of arrival factor with Jay at KU Leuven 2014-12-10 14:24:10 +01:00
Andrew Melim 1e778cf77b No longer need to cast function pointers for expressions on Windows, with Optional Jacobian 2014-12-09 11:53:35 -05:00
Andrew Melim 137ea64200 Updating with OptionalJacobian 2014-12-09 11:49:47 -05:00
Andrew Melim 3bd491bf66 Merge branch 'develop' into fix/windowsExpressions 2014-12-09 11:04:30 -05:00
Andrew Melim cea76a2848 More template handholding for windows 2014-12-08 21:48:59 -05:00
dellaert d2e53d4fe9 "Fixed" AHRS 2014-12-04 12:30:41 +01:00
Natesh Srinivasan 4e557d38e6 updated Matrix.h with commonly used matrices. 2014-12-03 09:59:10 -05:00
dellaert 6505e602d8 FixedRef is now OptionalJacobian 2014-11-28 17:14:26 +01:00
dellaert 0d41523725 Use new FixedRef type 2014-11-28 01:57:55 +01:00
Andrew Melim cc4cdc93a3 Correct issue with function overload ambiguity when passing function pointer to expression constructor on windows 2014-11-26 15:06:16 -05:00
Chris Beall 7b1a9ba371 Merged in feature/TemplatedSmartFactors (pull request #39)
Templated Smart Factors
2014-11-25 07:36:14 -05:00
Frank Dellaert ea02e577f5 Merged in feature/expressions (pull request #45)
Pull request for debugging Expression<double> issue
2014-11-24 18:40:31 +01:00
dellaert a9090fd7af Cleanup with Jing 2014-11-24 15:53:13 +01:00
Richard Roberts 3ba9e8f405 Updated some usages that were missed 2014-11-23 15:24:55 -08:00
Richard Roberts f9ca07e610 Converted Vector(2|3) << ... to Vector2(...) or Vector3(...) syntax 2014-11-23 10:22:25 -08:00
dellaert f21fe5043a Created a new expressions.h file in nonlinear 2014-11-23 17:31:33 +01:00
Richard Roberts aa093a35da Updated all comma initializer usages to use .finished() 2014-11-22 16:35:27 -08:00
cbeall3 f3d42a8487 Move to unstable 2014-11-17 19:53:21 -05:00
dellaert 265184b6c9 Avoid warning 2014-11-10 17:56:08 +01:00
dellaert e976aae38a Avoid warning and re-formatted with BORG template 2014-11-10 16:27:33 +01:00
dellaert 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
dellaert efc2dc69fe Got rid of some concats 2014-11-04 15:44:41 +01:00
dellaert f1dd554a9d No more LieVector (too much copy/paste here) 2014-11-03 13:38:25 +01:00
dellaert 2a745b6c26 No more LieVector/LieScalar 2014-11-03 13:32:58 +01:00
dellaert 39ce31d0cc No more LieVector 2014-11-03 13:15:41 +01:00
dellaert b5327673fb Get rid of LieVector 2014-11-03 11:02:15 +01:00
cbeall3 699153ece9 Coding convention: convert tabs to two spaces 2014-10-30 12:44:46 -04:00
cbeall3 f916531492 remove typename from non-templated class 2014-10-24 13:06:45 -04:00
Chris Beall eeb0293f27 Merged in feature/FixQuaternion (pull request #22)
Was quaternion (somewhat) broken ?
2014-10-24 09:53:50 -04:00
dellaert 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
dellaert 845697555a Fixed tests for Quaternion mode but Pose3 not in EXPMAP mode 2014-10-23 09:52:35 +02:00
dellaert a29f09423c Merge branch 'develop' into feature/BAD
Conflicts:
	gtsam/linear/tests/testGaussianBayesNet.cpp
2014-10-22 13:56:27 +02:00
dellaert 113b9d2e74 Got rid of unnecessary LieVector usage that broke fixed-code 2014-10-22 01:32:59 +02:00
dellaert 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
dellaert 83d77271d9 Ternary now fixed 2014-10-07 13:04:04 +02:00
dellaert 921b79f446 No more default argument 2014-10-07 01:01:16 +02:00
Luca 7a4f307342 moved biasedGPS and GaussMarkov to unstable 2014-10-06 13:11:40 -04:00
dellaert d5709facf6 Added Pose2SLAMExample 2014-10-02 20:20:00 +02:00
dellaert 0d94eeb480 Created expressions.h header 2014-10-01 11:25:49 +02:00
cbeall3 e0a9eb63ce Fix for Windows: renamed some tests 2014-09-24 16:47:07 -04: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 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 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
cbeall3 87f5818776 Move smart projection factor 2014-05-31 15:33:19 -04:00
cbeall3 a7a209ce0c Minor fixes and documentation cleanup 2014-05-30 13:31:35 -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
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
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 1ed07ca4ed Moved to unstable 2014-05-03 12:23:20 -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