Commit Graph

1439 Commits (b8de033bd0510367a044d0fddfa32127d7d61819)

Author SHA1 Message Date
Alex Hagiopol c769ed8452 One line definition of gravity force. 2016-03-12 20:49:00 -05:00
Alex Hagiopol 93bf31f852 Replaced Vector::Constant(N,value) with VectorN::Constant(value). 2016-03-12 20:47:16 -05:00
Alex Hagiopol ae19e078c7 Changed argument and implementation of correct() in Mechanization_bRn2 2016-03-12 20:44:05 -05:00
Alex Hagiopol 026a0f59fe Deprecated repeat() in Vector.h. 2016-03-11 23:10:18 -05:00
Alex Hagiopol 97e26cc365 Deprecated sub() in Vector.h. 2016-03-11 20:30:19 -05:00
Alex Hagiopol 3989178aba Deprecated subInsert() in Vector.h 2016-03-11 20:13:51 -05:00
Alex Hagiopol 5502691022 Deprecated norm_2() in Vector.h 2016-03-11 19:34:49 -05:00
Alex Hagiopol 2f146e85ef Deprecated esqrt() from Vector.h. 2016-03-11 14:34:19 -05:00
ivan 5d8218e902 [REFACTOR] Simplified Grammar. 2016-03-08 10:34:31 -05:00
ivan b54c897f91 [FEATURE] QPS Parser Preliminary Commit.
Notes:
- Correctly parses MPS files and makes appropiate calls to RawQP
- Containts Debug Code
- Does not generate raw bounds from parse
- Does not generate Hessian from parse
- Does not generate Actual QP from raw QP
2016-03-07 10:29:43 -05:00
ivan 1c87f9d07a [BUGFIX] Fix Evaluate Hessians for Matrices of a given dimension. 2016-03-07 10:14:27 -05:00
Alex Hagiopol 7d0b562908 Fixed two missed replacements of cwiseProduct() with array().square(). 2016-03-05 21:20:32 -05:00
Alex Hagiopol caa45ad67b Replaced cwiseProduct() with array().square(). Killed deprecated comments. 2016-03-05 21:08:24 -05:00
Alex Hagiopol 22c3af906e Deprecated emul() in Vector.h. 2016-03-05 18:49:34 -05:00
ivan 62ad643d41 Merge branches 'develop' and 'feature/LPSolver' of bitbucket.org:gtborg/gtsam into feature/LPSolver
# Conflicts:
#	CMakeLists.txt
2016-03-05 13:58:54 -05:00
Ivan Jimenez f5e6b21547 [BUGFIX] Point3 called with default constructor. 2016-02-27 23:52:41 -05:00
Ivan Jimenez 6cc4ab8bdf [BUGFIX-WARNING] Fixed warning in gcc5 by adding SYSTEM to gtsam included eigen. 2016-02-27 19:21:42 -05:00
dellaert 853b5192a5 Changed to more types to FactorIndices 2016-02-26 07:32:32 -08:00
dellaert 2ca649a11f Made some type changes to FactorIndices 2016-02-26 00:01:59 -08:00
dellaert fad9462661 A better solution through typedef of FactorIndices -> FastVector<size_t> 2016-02-25 23:51:01 -08:00
dellaert 64aae16b3c Fixed problem with wrapping iSAM by a hack: made vector<size_t> into KeyVector. This is not a long-term solution: we should enable wrapping of vector<T>. 2016-02-25 22:07:04 -08:00
Frank 0372a959ee Many small improvements, bug-fixes, and tests 2016-02-24 11:01:19 -08:00
Ivan Jimenez 0987ae259c [BUGFIX] Fixed Linker Errors in Release Mode 2016-02-21 23:36:39 -05:00
Ivan Jimenez 482144821b [Fix] Rot3.ypr -> Rot3.Ypr
[REFACTOR] Fixed including with "" instead of <>
2016-02-18 21:51:43 -05:00
Ivan Jimenez 5fab190194 Merged develop into feature/LPSolver 2016-02-18 18:49:51 -05:00
Ivan Jimenez 3def6cab74 [FEATURE] QPSolver without initial Values.
[REFACTOR] Reformat code with eclipse code formatter.
2016-02-15 14:44:00 -05:00
Ivan Jimenez ace23973a8 [FEATURE] LPSolver without initial Values.
[REFACTOR] Reformat code with eclipse code formatter.
2016-02-15 13:53:22 -05:00
dellaert 1c920967d9 No more use of vector() or default constructor 2016-02-12 00:06:07 -08:00
dellaert 56dbf487ee Fixed more default constructor calls 2016-02-11 23:31:17 -08:00
Ivan Jimenez 8227f1a5fb [REFACTOR] ActiveSetSolver to match commenting and format conventions.
[BUGIFX] Fixed Errors in Unit Tests By commenting.
[BUGFIX] FIxed Active Set Solver Problem with template in cpp file
2016-02-12 00:57:37 -05:00
Ivan Jimenez 10caa759d6 [COMMENT] Added missing class-level comment. 2016-02-11 23:33:33 -05:00
Ivan Jimenez 89fc822259 [REFACTOR] ActiveSetSolver to match commenting and format conventions. 2016-02-11 23:28:08 -05:00
Frank 2060b09a2b Avoid calling default constructors and/or vector 2016-02-11 19:03:11 -08:00
Frank 94ccf98985 Avoid default constructor in tests 2016-02-11 19:01:54 -08:00
Frank 0a7fd27f28 Working on getting a simple typedef to compile - as well as dealing with Point3() now creating uninitialized memory. 2016-02-10 17:48:52 -08:00
Ivan Jimenez f42c4f6a92 [FEATURE] SQP Removed
[FEATURE] Test SQP for Infeasible
[FEATURE] Test QP for Infeasible
[FEATURE] LP Initialize Without Initial Values
[FEATURE] QP Initialize Without Initial Values
** TESTS FAIL **
2016-02-09 10:45:55 -05:00
dellaert 6eeeb3fef1 Fixed forgotten compose 2016-02-08 18:58:43 -08:00
Frank a19aa793d7 Cleaned up a number of Point3/Rot3 related uses 2016-02-08 17:31:32 -08:00
Frank 23d4c0fd9f Deprecated several Point3 methods 2016-02-08 13:27:38 -08:00
Frank Dellaert 9e4b4b3f72 Merged in feature/testTransform_Sim3 (pull request #218)
Fixed Sim3 Action derivative
2016-02-08 08:11:51 -08:00
dellaert 5f0b493666 Cleanup 2016-02-08 00:12:19 -08:00
dellaert e39eed661e Formatting 2016-02-07 22:29:51 -08:00
dellaert fb3eda5eee Fixed derivative of group action, as explained in LieGroups.pdf 2016-02-07 22:26:10 -08:00
lvzhaoyang c5b2c63c9d fix typo in test for Sim3 transform_from 2016-02-07 23:51:26 -05:00
dellaert 0ceeb4bd47 A set of geometry changes from the FixedValues branch, unrelated to that PR 2016-02-07 20:11:01 -08:00
dellaert f64d17f4f0 Cleaned up and tested exmpap 2016-02-07 15:02:07 -08:00
dellaert d7ed19dc21 Fixed equality, transform_from, AdjointMap, and added wedge (for testing AdjointMap) 2016-02-07 14:05:59 -08:00
dellaert 95f4d14d5e Fixed static Rot3 methods 2016-02-07 13:00:49 -08:00
dellaert faffcb193e Merge remote-tracking branch 'origin/develop' into feature/OptimizeSimilarity
Conflicts:
	gtsam_unstable/geometry/tests/testSimilarity3.cpp
2016-02-07 13:00:29 -08:00
Ivan Jimenez 8926a1da91 [EXPERIMENTAL] Initial SQP Solver. DO NOT BUILD. 2016-02-02 11:03:53 -05:00
Ivan Jimenez d4b4b2b31d [COMMENTS] Added Some Missing Comments 2016-02-01 21:10:16 -05:00
dellaert 1720adbbd7 Merge remote-tracking branch 'origin/develop' into feature/LPSolver 2016-01-29 09:12:50 -08:00
Frank Dellaert 26a7647629 Some refactoring, small edits, TODOs for Ivan 2016-01-29 09:07:14 -08:00
Frank Dellaert 4d93a33f61 Static methods should be uppercase. 2016-01-26 23:09:58 -08:00
Ivan Jimenez b1949966e9 [REFACTOR] Extract LPSolver.cpp from LPSolver.h 2016-01-26 09:34:05 -05:00
Ivan Jimenez 796e2d813c [REFACTOR] Remove Debug statements from Iteration. 2016-01-26 07:56:52 -05:00
Ivan Jimenez 84662bc5d9 [REFACTOR] Extracted common components from QPSolver and LPSolver into ActiveSetSolver. 2016-01-25 19:24:37 -05:00
Ivan Jimenez 2978664cbd Merge branch 'develop' into feature/LPSolver
Conflicts:
	gtsam_unstable/linear/QPSolver.h
2016-01-25 15:59:52 -05:00
ivan ec1d0201e5 [REFACTOR] Changed Vector(..).finished for VectorN(...) 2016-01-24 20:18:10 -05:00
ivan b2825ca4d0 [REFACTOR] Remove unnecessary includes from testLPSolver. 2016-01-24 20:08:14 -05:00
ivan 88dc9ca73d [REFACTOR] Extracted LPInitSolver.h from testLPSolver.cpp
[REFACTOR] Extracted LPSolver.h from testLPSolver.cpp
[REFACTOR] Extracted LPState.h from testLPSolver.cpp
2016-01-24 19:58:42 -05:00
ivan 580d1671f4 [REFACTOR] Extracted LPState.h from testLPSolver.cpp 2016-01-24 19:44:43 -05:00
ivan 2fa3a56f03 [REFACTOR] Extract LP.h from LPSolver.cpp
[REFACTOR] Extract InfeasibleInitialValus.h from LPSolver.cpp
[REFACTOR] Extract InfeasibleOrUnboundedProblem.h from LPSolver.cpp
2016-01-24 19:40:55 -05:00
ivan bc3398a6a2 [BUGFIX] Fixed Failing Unit Test 2016-01-24 14:09:16 -05:00
Frank Dellaert 35b6986d32 Merged in feature/c++11 (pull request #193)
Make C++ 11 the default
2015-10-26 17:04:08 -07:00
cbeall3 04bcf26aa6 Explicitly cast optional to bool 2015-10-20 14:44:00 -04:00
Frank 901fb56993 Fixed warnings 2015-10-19 15:01:48 -07:00
Duy-Nguyen Ta e2ce27f712 move static member definition to cpp file 2015-09-22 08:17:19 -04:00
Duy-Nguyen Ta aa2ffcd118 Merge branch 'develop' into feature/cleanup_ImuFactor 2015-09-17 17:42:38 -04:00
cbeall3 92e210b893 Fix examples and Matlab wrapper 2015-08-26 13:25:12 -04:00
cbeall3 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
cbeall3 0503df31fa Relax tolerance to 1e-6 for MKL/quaternion test, and fix up documentation a bit. 2015-08-25 12:14:52 -04:00
Chris Beall 6a5147b5b5 Merged in fix/SmartStereo (pull request #181)
Fix/smartstereo
2015-08-25 09:51:59 -04:00
cbeall3 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
cbeall3 c8df985e2f Relax test tolerance a bit for quaternion mode 2015-08-19 07:30:14 -04:00
cbeall3 1727b60728 Fixed and cleaned up unit test 2015-08-19 00:11:35 -04:00
cbeall3 123c55f0d7 respect triangulation.enableEPI flag in SmartStereo factor 2015-07-29 14:05:48 -04:00
cbeall3 07bd7fa2bd fix examples and wrapper 2015-07-28 15:14:39 -04:00
cbeall3 fd1e41a9e6 remove calibration template from SmartStereoProjectionPoseFactor 2015-07-28 15:12:02 -04:00
cbeall3 748877ff7e remove calibration template from SmartStereoProjectionFactor 2015-07-28 14:56:45 -04:00
cbeall3 db64b48fda tests pass 2015-07-28 14:48:53 -04:00
cbeall3 da9078cf3b add nonlinear triangulation back. Some unit tests fail again 2015-07-27 23:27:20 -04:00
dellaert 110a046fb6 Fixed compile issue and tightened tolerances 2015-07-24 16:05:15 +02:00
dellaert 0bb73bae9e Comments 2015-07-23 16:59:26 +02:00
dellaert 1a47a334de Deal with changes in Rot3 2015-07-21 11:23:42 -07:00
cbeall3 7ae31bd8e7 delete some unused stuff 2015-07-20 11:43:57 -04:00
cbeall3 b5a978c534 improve dynamic outlier rejection test 2015-07-19 21:01:14 -04:00
cbeall3 fcc9ac2669 remove extra cout 2015-07-19 20:39:34 -04:00
cbeall3 36c652ac40 remove monocular triangulation hack and make tests pass again 2015-07-19 20:37:16 -04:00
Frank Dellaert 2c765c735a Velocity3 default constructor does not zero 2015-07-17 22:09:49 -07:00
dellaert 233cabb3fb Made Velocity a Vector3 2015-07-17 17:36:29 -07:00
dellaert d1271fd9d5 Fixed product retract/localCoordinates and corresponding tests 2015-07-16 23:48:56 -07:00
dellaert 459226800d Replaced failing test with two new, working tests 2015-07-16 22:38:30 -07:00
dellaert b8f5141743 HasRange 2015-07-16 22:38:17 -07:00
cbeall3 3f0e695cc9 some tests pass again 2015-07-16 11:26:07 -04:00
dellaert 0c3bb85547 Added test of localCoordinates 2015-07-15 23:22:31 -07:00
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 03db69117a Define and partially specify Range and Bearing functors 2015-07-12 15:51:49 -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
dellaert 464a82cc51 Merge remote-tracking branch 'origin/develop' into feature/betterOrdering
Conflicts:
	.cproject
	gtsam/inference/Ordering.h
	gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp
	gtsam_unstable/nonlinear/BatchFixedLagSmoother.cpp
	gtsam_unstable/nonlinear/ConcurrentBatchSmoother.cpp
2015-06-28 15:41:58 -07:00
zhaoyang 35c23da427 change: add const traits and renaming some test parameters 2015-06-26 18:24:30 -04:00
zhaoyang 12f9b413ff feature: add concept test for similarity3 2015-06-26 16:01:26 -04:00
zhaoyang 400a17d9ab change: a little clean up 2015-06-26 15:44:08 -04:00
dellaert d415cffd4b Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3 2015-06-23 22:41:33 -07:00
Frank Dellaert 801d1fb700 Merged in feature/performance (pull request #161)
Improving performance
2015-06-23 22:27:10 -07:00
cbeall3 0e022b3b33 Values::keys now returns KeyVector instead of list. Corresponding fixes in Matlab wrapper. 2015-06-24 00:35:32 -04: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 f9ddbb1345 Eliminated linked list 2015-06-21 01:45:56 -07: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
Luca 78c8160dc5 all tests pass and it compiles (yuppii!), but if I make check I get errors with isManifold and something that seems unrelated to smart factors. going to merge with develop 2015-06-19 12:06:45 -04:00
Paul Drews 99fce3f5af Added a few tests 2015-06-11 19:55:10 -04:00
Paul Drews 76ffc45ee7 Merged 'develop'.
Conflicts:
	gtsam_unstable/geometry/Similarity3.cpp
	gtsam_unstable/geometry/Similarity3.h
2015-06-11 19:54:54 -04:00
Paul Drews f6ac546cc3 Added comparison to brute force matrix exponential 2015-06-11 13:56:35 -04:00
Paul Drews 5ceb7d9ddc Fully implemented logmap/expmap, which are used for retract/localCoordinates 2015-06-10 16:36:56 -04:00
Paul Drews 0d5f0510ab Expmap and Logmap, still incorrect around identity 2015-06-10 11:01:34 -04:00
dellaert d385984f26 Working compose/between/inverse derivatives 2015-05-26 01:08:27 -07:00
dellaert d060d4621e PoseRTV is now implemented using ProductLieGroup 2015-05-25 23:50:00 -07:00
dellaert 9d522c72f3 internal::LieGroup needed if you also want Testable traits 2015-05-25 22:04:04 -07:00
dellaert b23a51db6d PoseRTV as ProductManifold works 2015-05-25 17:13:08 -07: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
Duy-Nguyen Ta 58de1ac296 re-enable all tests. Disable printing. Fixing bad names due to unintentional global replace 2015-05-15 08:57:43 -04:00
Duy-Nguyen Ta 827caf1793 compute a feasible initial value for LPSolver: simple test passed. 2015-05-15 08:47:57 -04:00
Duy-Nguyen Ta f30e2501be compute error for constrained linear factor graphs 2015-05-15 08:45:47 -04:00
Duy-Nguyen Ta ee8316e291 fix comments 2015-05-15 08:44:58 -04:00
dellaert 79d20b6c44 GTSAM-style formatting 2015-05-13 23:44:46 -07:00
Abe 13a4da21b2 misc bugfixes and cleanup from skydio 2015-05-13 22:26:24 -07:00
Frank Dellaert e456923a74 Merged in feature/SimplerExpressions (pull request #135)
Expressions without MPL
2015-05-13 00:36:49 -07:00
Frank 057aef90d9 Fixed some more warnings on Ubuntu 2015-05-12 15:05:34 -07:00
Frank 4ba329c23b Fixed many warnings on Ubuntu 2015-05-12 13:46:24 -07:00
dellaert 4f846ff75f No more boost::mpl needed for Expressions 2015-05-12 01:33:33 -07:00
dellaert 81b3860991 Moved all internal data structures to internal namespace 2015-05-11 21:19:40 -07:00
dellaert 13dcc977f2 Moved Point2Vector wrapper from gtsam_unstable.h to gtsam.h 2015-05-03 17:31:08 -07:00
Chris Beall b52ced7a09 Merged in fix/serialization_warnings (pull request #128)
Fix some unused variable warnings in the serialization code.
2015-04-20 15:00:45 -04:00
nsrinivasan7 a4fac2ab62 added cout style print statements for similarity 2015-04-12 15:38:40 -04: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
Duy-Nguyen Ta 40659cab38 first LPSolver test passed!! 2015-03-25 08:19:43 -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
Duy-Nguyen Ta d8564f25e0 fix exception text 2015-03-12 09:37:26 -04:00
dellaert a4d1874af4 Merge remote-tracking branch 'origin/develop' into feature/SmartFactors3 2015-03-09 17:51:16 -07:00