Commit Graph

1516 Commits (b51e89c910d50ca6fd98fce1818bac77fac9da94)

Author SHA1 Message Date
Paul Furgale aae206b308 Merge branch 'develop' into feature/BAD_using_charts 2014-11-22 14:38:55 +01:00
Paul Furgale e5fe5676b1 Working on a prototype of wrapping external types 2014-11-22 14:10:25 +01:00
HannesSommer 87ea6341f2 virtual inheritance for better readability and decoupling 2014-11-22 09:39:08 +01:00
HannesSommer b4fe033d12 added CallRecord unit test 2014-11-21 23:04:58 +01:00
HannesSommer 32992cf05e added missing overload for full dynamic matrix. 2014-11-21 23:04:58 +01:00
thduynguyen ee52ca15dd move LPSolver and QPSolver to unstable. Add script to compile lpsolve on Mac when doing cmake if it's not found. 2014-11-21 16:04:12 -05:00
HannesSommer 6d0c1a44e1 - some small cleanup and improved readability.
- virtual overload warnings should not be issued anymore
2014-11-21 21:13:24 +01:00
HannesSommer f699dd26bb correct case in import 2014-11-21 21:10:12 +01:00
dellaert c238e5852c Now uses CallRecord.h 2014-11-21 15:48:29 +01:00
dellaert 2983cf33a6 Created CallRecord header 2014-11-21 15:48:10 +01:00
cbeall3 dd255eb24c Remove landmark template parameter 2014-11-19 13:07:14 -05:00
cbeall3 6529b793cc Some fixes for feedback reported in pull request #39 2014-11-19 12:51:12 -05:00
cbeall3 f3d42a8487 Move to unstable 2014-11-17 19:53:21 -05:00
cbeall3 36a485169d Refactor Ordering parameters. Now compiles and passes with gcc 2014-11-17 16:16:52 -05:00
HannesSommer fb24ab586e introduced a MaxVirtualStaticRows compile time constant and realized as many static rows specific virtual reverseAD methods in the CallRecord interface to speedup the Jacobian evaluatio. 2014-11-17 11:18:09 +01:00
HannesSommer 4966f5a942 mini cleanup and improve comment TODO 2014-11-17 11:18:09 +01:00
cbeall3 d24b799988 Merge remote-tracking branch 'origin/develop' into feature/TemplatedSmartFactors 2014-11-14 14:35:25 -05:00
dellaert d4b868aa12 Formatting and documentation 2014-11-14 11:20:36 +01:00
Zhaoyang Lv 87ef601b66 changes revertted to 502a745 2014-11-13 21:26:33 -05:00
Zhaoyang Lv ee3ea5bfad reverse to previous MKL_BLAS defined order 2014-11-13 21:14:07 -05:00
Zhaoyang Lv c4f3a48bc9 Revert "Fixed remaining compile issues in "make timing""
This reverts commit 502a7459f9.
2014-11-13 21:07:27 -05:00
dellaert 502a7459f9 Fixed remaining compile issues in "make timing" 2014-11-14 02:30:10 +01:00
dellaert c2c1de1761 Fix compile errors in issue #147 2014-11-14 02:19:48 +01:00
dellaert 865b0c0129 Fixed compile issue in Debug mode 2014-11-14 02:13:11 +01:00
dellaert e2aef1b325 Merge remote-tracking branch 'origin/develop' into feature/BAD 2014-11-14 01:31:49 +01:00
Abhijit Kundu 1c97d1270d Changing include order so as to OpenMP flags (if used) are defined
before metis. This fixes a compilation error with testFindSeparator.cpp
2014-11-11 17:14:51 -05:00
Jing Dong 0313c46272 fix DCHECK_LT in fix/wrap 2014-11-11 12:02:53 -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
Jing Dong 139ef0d61d fix glog macro to assert 2014-11-08 22:16:32 -05:00
Mike Bosse e4936df80a matlab wrappers compile, but need testing 2014-11-07 22:41:21 +01:00
Renaud Dube 90ec6b1452 reverted extra spaces which were added in last commit 2014-11-07 12:11:08 +01:00
Renaud Dube bd3f9db7df inlined a fully specialized function template defined in a .hpp 2014-11-07 11:37:27 +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 3824fe5f90 Fixed assert_equal and warnings 2014-11-04 15:48:30 +01:00
dellaert efc2dc69fe Got rid of some concats 2014-11-04 15:44:41 +01:00
dellaert 4afe132b1a Fixed dimensions of Vectors 2014-11-04 15:41:14 +01:00
dellaert da3677e704 No more LieVector/LieScalar 2014-11-03 13:52:08 +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
dellaert 492c607f9e No more Lie types 2014-11-03 09:27:40 +01:00
dellaert e0c4d84dd7 Fixed some tests/warnings in quaternion mode 2014-11-03 00:59:19 +01:00
Mike Bosse 11416cac65 Merge branch 'feature/BAD' into feature/BAD_generic_value_traits
Conflicts:
	gtsam_unstable/nonlinear/tests/testAdaptAutoDiff.cpp
	gtsam_unstable/nonlinear/tests/testExpressionFactor.cpp
2014-11-02 19:00:30 +01:00
dellaert 17d352bab4 Slight re-factor 2014-11-02 14:42:59 +01:00
dellaert d2f56b13ed Non-trivial noise models now correctly handled (at a small performance penalty, due to malloc of Vector b). 2014-11-02 14:37:52 +01:00
dellaert 8a6d8bfc82 Back to single 2014-11-02 14:35:32 +01:00
dellaert 90a0fa6e45 Check if active 2014-11-02 13:53:22 +01:00
dellaert a8ab910c32 Merged twio changes in: the is_constrained() flag that does away with the dynamic cast, and the changes duy made in commit a61b49d to remove the constrained noise model hack. At the same time, both linearize methods (in expressionFactor and NonlinearFactor) now make use of is_constrained(). 2014-11-02 13:45:54 +01:00
dellaert b9e3c3b116 Made unsafe constructor private, but made ExpressionFactor<T> a friend. 2014-11-02 12:01:52 +01:00
dellaert cb69f2cb82 Fastest linearize so far. Putting 'unsafe' constructor in JacobianFactor itself makes a *huge* difference. 2014-11-02 11:40:48 +01:00
dellaert 7aaf4dae8c Merge remote-tracking branch 'origin/feature/BAD_VerticalBlockMatrix' into feature/BAD_WriteableJacobianFactor
Conflicts:
	gtsam_unstable/nonlinear/ExpressionFactor.h
2014-11-01 17:45:23 +01:00
dellaert 7debde7518 Moved to ExpressionFactor that now uses it - timing seems worse ? 2014-11-01 15:12:06 +01:00
dellaert 12e38a44e4 WriteableJacobianFactor will allow ExpressionFactor to write into the factor directly, (hopefull) eliminating huge overhead. 2014-11-01 14:13:08 +01:00
dellaert a4fa61a7a4 Removed JacobianMap tests 2014-11-01 11:56:38 +01:00
dellaert f38b0b0eed Fixed unwhitenedError 2014-11-01 11:50:28 +01:00
dellaert 7b539fbb5c Make JacobianMap a wrapper around a VerticalBlockMatrix, which avoids us having to make a vector of references into it 2014-11-01 11:35:49 +01:00
dellaert 593edd1e5c Fixed asserts 2014-10-31 16:29:15 +01:00
dellaert d0c3bc0c8e Fixed tests 2014-10-31 16:27:54 +01:00
dellaert 768a4abc05 Does not need lambda 2014-10-31 16:27:46 +01:00
Sungtae An a5b8d0fd35 Modified finding method 2014-10-31 11:06:26 -04:00
Sungtae An 6a20d35a60 Modified pointer expression 2014-10-31 07:28:07 -04:00
Sungtae An 133fcf20e2 Cleaned up some commented codes 2014-10-31 07:22:19 -04:00
Sungtae An 97d4120858 Changed the type of JacobianMap as std::vector 2014-10-31 07:10:53 -04:00
cbeall3 699153ece9 Coding convention: convert tabs to two spaces 2014-10-30 12:44:46 -04:00
gawela 2788ec7f33 removed std::type_traits which is c++11 2014-10-29 10:23:13 +01:00
Mike Bosse 80187362b8 attemping to expose ChartValue for expressions with non DefaultCharts, but needs testing 2014-10-28 11:20:02 +01:00
Mike Bosse bc094951ed all values in Values container are now a ChartValue<ValueType, Chart=DefaultChart<ValueType> >
ChartValues are GenericValues and a Chart, which defaults to DefaultChart
had to make charts functional (ie no storage of the chart origin) so that they could be zero sized base class
otherwise there would have been a double of the memory for values (ones for the value, and once for the chart origin, which default to the same)

most tests work, execept for serialization based stuff, and const filtering of values.
2014-10-28 00:57:44 +01:00
Mike Bosse 4a3dc51f85 more tests work, except for serialization based tests 2014-10-24 23:47:02 +02:00
cbeall3 f916531492 remove typename from non-templated class 2014-10-24 13:06:45 -04:00
Mike Bosse 1fadda83e0 removed DerivedValue<> inheritence from classes 2014-10-24 18:34:06 +02:00
Chris Beall eeb0293f27 Merged in feature/FixQuaternion (pull request #22)
Was quaternion (somewhat) broken ?
2014-10-24 09:53:50 -04:00
dellaert e7ec6b3fa5 Fixed size 2014-10-23 12:04:16 +02: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 49ff33602d Undid change 2014-10-23 01:44:04 +02:00
dellaert 0501750c7c Fixed accuracy and size issues in Quaternion mode 2014-10-22 22:54:25 +02:00
dellaert 48a6777935 Some refactoring 2014-10-22 16:26:40 +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 0f53c8d5ec Timing of Ceres AutoDiff adaptor 2014-10-22 12:49:18 +02:00
dellaert f44e6f0187 Moved AdaptAutoDiff template in its own header file 2014-10-22 11:41:04 +02:00
dellaert 516bb4b0b1 Isolated Snavely example 2014-10-22 11:23:35 +02:00
dellaert 439f51ec7f test out invoke 2014-10-22 10:10:58 +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 fcbc1e90cf More traits 2014-10-21 18:03:28 +02:00
dellaert 224b71d696 Created testManifold 2014-10-21 12:54:28 +02:00
dellaert 0acffe5ae9 Fixed bug in DefaultChart: keeping a reference s never a good idea. 2014-10-21 11:13:14 +02:00
dellaert 25ad9ade05 Moved AdaptAutoDiff into its own test 2014-10-21 10:42:30 +02:00
dellaert bf16446f92 Deal with traits changes 2014-10-21 01:26:17 +02:00
dellaert e0841fb3e6 No more Ceres dependecy, copied relevant Ceres files here (for now) 2014-10-20 23:53:56 +02:00
dellaert bce84ca4db Successfully created Expression from AutoDiff function! 2014-10-20 15:38:27 +02:00
dellaert bf5580d518 AdaptAutoDiff now works with RowMajor Eigen matrices 2014-10-20 14:39:28 +02:00
dellaert df5e584412 Compiles, but Jacobains not correct yet 2014-10-20 14:32:20 +02:00
dellaert a423f284e9 Canonical coordinates prototype, works for Snavely 2014-10-20 14:23:08 +02:00
dellaert 821f776118 Wrapper works to some extent 2014-10-20 09:43:32 +02:00
dellaert 7ebc8e969f Charts with default constructors 2014-10-20 09:29:45 +02:00
dellaert 63ae33088e Some success on the way to autodiff 2014-10-19 23:47:59 +02:00
dellaert 8ee16c9018 Comments for Paul 2014-10-19 11:19:09 +02:00
dellaert eac76cd0f0 Some progress on defining interface 2014-10-19 11:18:36 +02:00
dellaert 6e142184cc Implemented is_manifold and dimension for all types in testExpressionFactor 2014-10-19 00:35:25 +02:00
dellaert c32d2bb3b2 Fixed comments 2014-10-18 23:48:51 +02:00
dellaert d436d99146 Moved stuff to Manifold.h 2014-10-18 23:25:25 +02:00
dellaert fcda501ee2 double as manifold. No more LieScalar ! 2014-10-18 18:13:33 +02:00
dellaert ed6a2b6eff Charts !!!! 2014-10-18 17:11:28 +02:00
dellaert 9c97b1d8a0 Some more refactoring 2014-10-18 16:45:04 +02:00
dellaert 66b3081603 localCoordinates and retract 2014-10-18 15:02:22 +02:00
dellaert 10cfd47404 TangentVector meta-function 2014-10-18 14:29:40 +02:00
dellaert ec69949f43 Point2 specialized 2014-10-18 14:22:01 +02:00
dellaert f08dc6c031 More boost-style traits 2014-10-18 14:16:24 +02:00
dellaert 4c33444415 Snavely tested 2014-10-18 13:16:44 +02:00
dellaert bdf12b14b9 Add Snavely cost function 2014-10-18 12:35:02 +02:00
dellaert 7018afdd58 Slight refactor of numerical derivatives 2014-10-18 12:34:05 +02:00
dellaert 2972671064 Use boost::bind to avoid code duplication 2014-10-18 12:29:14 +02:00
dellaert db037c96c5 Implemented manifold_traits to allow numerical derivatives wrpt Matrix arguments 2014-10-18 12:12:25 +02:00
dellaert 2cbba15573 ceres style functor 2014-10-18 00:29:18 +02:00
dellaert 02d25f6658 New tests on traceSize 2014-10-16 15:07:05 +02:00
dellaert 0bcca2c386 Drastic reduction in allocations at ExpressionFactor construction by having dims constructed imperatively, and using it for both keys_ and dimensions_ 2014-10-16 14:16:58 +02:00
dellaert 944422e295 Only ExpressionFactor needs dimensions! Also, add dimensions at construction -> speeds up linearize. 2014-10-16 11:15:47 +02:00
dellaert 3413b98331 New storage sizes 2014-10-15 14:30:36 +02:00
dellaert 4a854f7e22 No using namespace in headers 2014-10-15 11:01:27 +02:00
dellaert 898c06ccbb New multi-threaded, realistic SFM example (1M factors, not 1M calls on same factor) 2014-10-15 11:01:02 +02:00
dellaert 79ff0c54f9 createUnknowns 2014-10-15 10:38:54 +02:00
dellaert 649478f186 Should work but seg-faults 2014-10-15 01:19:14 +02:00
dellaert 9b1c9bbf37 Allocate temporary matrix on the stack rather tahn on heap, and give VerticalBlockMatrix a view on it. 2014-10-15 00:56:06 +02:00
dellaert c88b2a5902 Fixed bizarre link erro as well as off-by-1 bug 2014-10-15 00:34:28 +02:00
dellaert 0f055f7910 Pass matrix to VerticalBlockMatrix constructor 2014-10-15 00:28:53 +02:00
dellaert 625b939b66 Another very significant speed-up of reverseAD pipeline, by template specialization of the leaf case for fixed matrices. Unfortunately, while this sped up reverse AD for our SFM kernel by 300%, reverseAD was only 6%, and is now 2% of total time. So, time to look elsewhere.
Oh, and, it is clear that the Identity matrix for Leaf only expressions is completely known at compile time: Eigen::Matrix<double, T::dimension, T::dimension>::Identity(). That should nicely speed up many a PriorFactor (replacement).
2014-10-14 23:40:21 +02:00
dellaert baaeaacabe Made dimensions constant property. Now performance is ***blazing***, way past custom factors. 2014-10-14 17:46:57 +02:00
dellaert c971207abf Switched to vector for dimensions 2014-10-14 17:16:31 +02:00
dellaert 1c3f328fb2 Successful switch to Blocks ! 2014-10-14 15:43:41 +02:00
dellaert f3e1561105 Prepare VerticalBlockMatrix for filling 2014-10-14 11:13:49 +02:00
dellaert 4c76f39009 Now uses dimensions 2014-10-14 09:55:34 +02:00
dellaert d8d94d0c34 dimensions implemented and tested 2014-10-14 09:53:47 +02:00
dellaert 781cc6daa9 keys now from expression_ 2014-10-14 08:59:01 +02:00
dellaert 0a41b0a027 Moved meta-programming tests to testExpressionMeta.cpp 2014-10-14 08:53:16 +02:00
dellaert ef5bf03c81 Clean up 2014-10-13 23:04:30 +02:00
dellaert 70f0caf0e3 Experimenting w Fusion 2014-10-13 22:50:47 +02:00
dellaert dda91df6e1 On the way to full fusion: Optional meta-function now separate from Jacobian. 2014-10-13 18:32:58 +02:00
dellaert ba0b68110f Boost Fusion needed to access values :-( 2014-10-13 13:56:51 +02:00
dellaert a52ff52941 Try some meta-transforms 2014-10-13 13:34:00 +02:00
dellaert 1c1695353e Now we can apply ExecutionTrace and Expression as meta-functions 2014-10-13 13:04:37 +02:00
dellaert c11d7885e1 Comments 2014-10-13 11:55:16 +02:00
dellaert 74269902d7 Big collapse now realized all the way through 2014-10-13 11:37:47 +02:00
dellaert da0e5fe52f The great collapse: instead of two recursively defined classes, there is now only one. The Record class is now a (recursive) inner class. 2014-10-13 10:50:05 +02:00
dellaert bc9e11f43c Pre-big collapse: prototype recursively defined inner Record2 type 2014-10-13 10:10:46 +02:00
dellaert 7fde47c48b No more JacobianTA typedefs -> all use Jacobian<T,A> now. 2014-10-13 09:25:06 +02:00
dellaert 7848d74928 Detailed explanation of recursive class composition pattern.
Jacobian type now defined in argument.
2014-10-13 08:49:12 +02:00
dellaert 7f621af54a Fixed bug 2014-10-13 00:57:11 +02:00
dellaert 2e8d868cd2 keys have been implemented 2014-10-13 00:37:46 +02:00
dellaert a9d9fcd241 FunctionalNode inherited for all three functional ExpressionNode sub-classes 2014-10-13 00:31:03 +02:00
dellaert 8100d89094 So much better as methods 2014-10-12 23:57:08 +02:00
dellaert 55cc4ba56c Switched names of fold result and meta-function that is folded over 2014-10-12 23:31:58 +02:00
dellaert ef21a4ba4a Major re-org in preparation of recursive Functional nodes 2014-10-12 23:03:33 +02:00
dellaert 408be628d2 Small change in meta-programming, big improvement in clarity 2014-10-12 22:17:21 +02:00
dellaert 107bcd8bb4 Going forwards, we default to reverse :-) 2014-10-12 22:04:40 +02:00
dellaert 4d1eb05c7d Passing JacobianMap as an argument now.. 2014-10-12 20:16:08 +02:00
dellaert dc541f1051 made traceSize an instance variable 2014-10-12 18:52:12 +02:00
dellaert 7a5f48f6dd Fixed typo in assert 2014-10-12 12:20:12 +02:00
dellaert fea2eb0b5f Inlined VerticalBlockMatrix construction 2014-10-12 11:05:43 +02:00
dellaert ed62271f81 Dealing with constrained noise model 2014-10-12 10:52:07 +02:00
dellaert 86d3e559e6 Merge branch 'feature/BAD' into feature/BAD_linearize 2014-10-11 23:07:40 +02:00
dellaert c9f80536c0 Added a constraint model 2014-10-11 23:07:23 +02:00
dellaert 3c6f7a42e6 Merge branch 'feature/BAD' into feature/BAD_linearize: easier trace/dTdA access 2014-10-11 22:31:43 +02:00
dellaert c776e87f78 Refactoring for readability/sanity 2014-10-11 21:33:07 +02:00
dellaert 0c7ea68f2f Now overwriting linearize as preparation for direct VericalBlockMatrix 2014-10-11 17:05:53 +02:00
dellaert 1bac83381f Merge remote-tracking branch 'origin/feature/BAD_meta' into feature/BAD: Now the Record structures are recursively generated using template meta-programming, basically mpl::fold
Conflicts:
	gtsam_unstable/nonlinear/Expression-inl.h
2014-10-11 15:20:12 +02:00
dellaert 88f9a423c5 Numbered types avoid ambiguity 2014-10-11 14:19:39 +02:00
dellaert ecf6462a25 Victory!! Unit tests work! 2014-10-11 13:07:58 +02:00
dellaert 599e232d1d traceSize, two tests work 2014-10-11 12:11:22 +02:00
dellaert 9585823d5d ...but works with correct size ! 2014-10-11 11:32:52 +02:00
dellaert deed7b8018 Unary prints, but still-faults downstream 2014-10-11 11:30:06 +02:00
dellaert 05f78b6dca Re-factor, allow traceExecution 2014-10-11 11:29:42 +02:00
dellaert 1f692638f5 Accessing matrices works 2014-10-11 11:04:39 +02:00
dellaert 69b69a0bc8 placement new works! And sophisticated Trace::print 2014-10-11 11:03:35 +02:00
dellaert eef2d49e8d First prototype, segfaults 2014-10-11 10:27:30 +02:00
dellaert e09e24964a No need to have all of T as template parameter 2014-10-11 09:00:03 +02:00
dellaert 820988b04e Do casting inside Trace 2014-10-11 08:52:24 +02:00
dellaert 52fc6f2db4 Testing old trace 2014-10-11 08:41:39 +02:00
dellaert 820e9553ee TestBinaryExpression friend 2014-10-11 08:17:46 +02:00
dellaert a2d2d82e0e some namespace management 2014-10-11 07:39:13 +02:00
dellaert 23485a0e71 New and consistent naming: ExecutionTrace = whole tree, CallRecord = local information left by the function. 2014-10-10 17:45:39 +02:00
dellaert 5cfe761f27 Timing multi-threaded code 2014-10-10 17:17:20 +02:00
dellaert ae93dd9869 Commented out repeated arguments 2014-10-10 13:57:37 +02:00
dellaert 58bbce482d Ternary works, same caveat 2014-10-10 13:33:13 +02:00
dellaert 406467e341 Binary works, but it's ugly and does not work for repeated types 2014-10-10 13:29:56 +02:00
dellaert 24714e48c5 Works for Unary ! 2014-10-10 12:38:26 +02:00
dellaert f8468bd596 Recursion done 2014-10-10 12:31:40 +02:00
dellaert 40fc6f5c03 Working prototype 2014-10-10 12:29:01 +02:00
dellaert dd1b931802 Successfully defined Jacobian 2014-10-10 12:03:13 +02:00
dellaert 732ff54b83 More experiments 2014-10-10 11:41:01 +02:00
dellaert 8e264f4289 Attempt at defining Trace recursively 2014-10-09 14:38:16 +02:00
dellaert 5e5457b390 Renamed entry point to startReverseAD to emphasize it is only called once 2014-10-09 13:42:43 +02:00
dellaert 563c4d214c Renamed BADFactor -> ExpressionFactor 2014-10-09 13:00:56 +02:00
dellaert 7e069191e5 Slight refactor 2014-10-09 10:58:46 +02:00
dellaert a38a0ae9e1 Some comments 2014-10-09 00:21:10 +02:00
dellaert 9ebe1e6d10 Super-speedup by specializing to 2-dimensional output (for now). Using some template magic. 2014-10-08 23:50:17 +02:00
dellaert 31c138d0d6 Profile Bin(Leaf,Un(Bin(Leaf,Leaf))) by default 2014-10-08 17:52:46 +02:00
dellaert abb92632b8 Empty derived destructors are not needed 2014-10-08 17:32:46 +02:00
dellaert 6a1bc6e242 Documentation 2014-10-08 17:28:33 +02:00
dellaert 4ac065fab4 Show explanation of timing 2014-10-08 17:27:46 +02:00
dellaert ce2dcaeb3b Tagged union, lightweight 2014-10-08 15:39:59 +02:00
dellaert 390842e1f7 Put Trace in front 2014-10-08 13:58:15 +02:00
dellaert ba9faa68b6 New Leaf/noise tests 2014-10-08 13:56:54 +02:00
dellaert d7022a21c7 More samples to average 2014-10-07 20:11:19 +02:00
dellaert c4a92acde1 Avoid argument temporaries 2014-10-07 19:35:44 +02:00
dellaert 84987aa351 Deal with Rot3 changes 2014-10-07 19:35:20 +02:00
dellaert 3c1c9c6d12 Switch to pointers - nice improvement 2014-10-07 18:11:12 +02:00
dellaert 982dc29d2f Time ternary version as well 2014-10-07 18:10:53 +02:00
dellaert e4392c0a3b JacobianTrace no longer templated 2014-10-07 16:11:55 +02:00
dellaert 83d77271d9 Ternary now fixed 2014-10-07 13:04:04 +02:00
dellaert 613cb0bb12 Binary functions now take fixed Jacobians 2014-10-07 01:01:46 +02:00
dellaert 921b79f446 No more default argument 2014-10-07 01:01:16 +02:00
dellaert 0a6fe0f0a8 No more default argument 2014-10-07 00:44:40 +02:00
Luca 7a4f307342 moved biasedGPS and GaussMarkov to unstable 2014-10-06 13:11:40 -04:00
dellaert e48b38ca21 Fixing uncalibrate (does not yet compile) 2014-10-06 15:45:26 +02:00
dellaert e5c3f4228a Some fixed size in UnaryExpression 2014-10-06 14:22:18 +02:00
dellaert 51eab1068f Time the most common SFM expression 2014-10-06 13:57:37 +02:00
dellaert 5c96b7f38d Made naming more suggestive of AD process rather than generic H1,H2... 2014-10-06 13:19:01 +02:00
dellaert 0ed96dda33 Avoid alloc and copy 2014-10-06 12:14:15 +02:00
dellaert c748fdb404 Re-did with move semantics. Dangerously imperative. 2014-10-06 12:13:52 +02:00
Sungtae An 69f74014aa add traceExecution in TernaryExpression 2014-10-05 17:40:11 -04:00
Sungtae An cc3c0fcfec add trace structure for reverse AD in TernaryExpression 2014-10-05 17:38:09 -04:00
Sungtae An 0421d05d44 add forward() in TernaryExpression 2014-10-05 17:36:53 -04:00
Sungtae An 0a7db2d252 Merge remote-tracking branch 'origin/feature/BAD' into feature/BAD 2014-10-05 16:16:19 -04:00
Sungtae An 40565564f5 TernaryExpression is added 2014-10-05 16:09:24 -04:00
dellaert 632810ff9a Now only inline add, for performance 2014-10-05 21:53:40 +02:00
dellaert 33c1d072a4 Add switch between inline add and JacobianMap as a new class. 2014-10-05 21:49:30 +02:00
dellaert 5b13306104 Split out starting the AD process vs. propagating it, is more efficient than starting with a useless identity matrix 2014-10-05 19:27:52 +02:00
dellaert ff9dd8eb8d Removed some obsolete code 2014-10-05 19:09:16 +02:00
dellaert caf742d5e1 Better names 2014-10-05 17:20:55 +02:00
dellaert 001504a432 JacobianTrace base, and avoid copying JacobianMaps. 2014-10-05 17:12:38 +02:00
dellaert 2718662467 Removed debug printing 2014-10-05 15:01:36 +02:00
dellaert fdf9c10b42 Implemented value and now testBADFactor also runs 2014-10-05 15:00:10 +02:00
dellaert 8db2cd17fc Finished constant Trace and *everything* just works!!! Amazing :-) 2014-10-05 13:41:20 +02:00
dellaert 7c19542245 Leaf Trace compiles 2014-10-05 13:37:51 +02:00
dellaert 75445307b2 Unary Trace done 2014-10-05 13:33:23 +02:00
dellaert 8e527a2251 Binary Trace compiles, runs 2014-10-05 13:27:41 +02:00
dellaert 303d37a716 Separate hierarchy 2014-10-05 11:22:14 +02:00
dellaert 6fb10a5de9 Rename, emphasizing is forward AD 2014-10-03 21:13:34 +02:00
dellaert 3f017bf51f An optimized version 2014-10-03 14:35:39 +02:00
dellaert c20b588fe0 timing, is pretty bleak for Expressions 2014-10-03 14:19:23 +02:00
dellaert a5b92f0342 MUCH simpler by just using boost::bind to turn methods into functions 2014-10-03 13:18:25 +02:00
dellaert bdf5451565 Typedefs 2014-10-03 12:52:35 +02:00
dellaert c8dd361080 Common base class BinaryExpression 2014-10-03 12:48:28 +02:00
dellaert 987b123ec9 NullaryMethodExpression and UnaryFunctionExpression, derived from UnaryExpression 2014-10-03 12:40:26 +02:00
dellaert aefad1e548 MAJOR refactor: I now use separate functions for value (only) and "augmented", for combined value-derivatives. The latter returns a new templated class, Augmented<T>. 2014-10-03 10:25:02 +02:00
dellaert da4cfe6fdc ternary test 2014-10-02 23:39:17 +02:00
dellaert 59af1c4b6d Major refactor that does not ask for derivatives when argument is constant. Also split combine into double add, added print, and moved those two statics to ExpressionNode. 2014-10-02 23:28:19 +02:00
dellaert 166396d6f6 Added tests with constant Expression 2014-10-02 23:26:59 +02:00
dellaert e7e7b3806f New test with constant argument 2014-10-02 20:28:37 +02:00
dellaert d5709facf6 Added Pose2SLAMExample 2014-10-02 20:20:00 +02:00
dellaert 8f856ceaf8 Renamed 2014-10-02 20:19:49 +02:00
dellaert df17758469 Assume H pre-allocated as usual, and *move* Jacobians to avoid allocations 2014-10-02 13:30:16 +02:00
dellaert 0800b83285 Slight efficiencies 2014-10-02 11:44:16 +02:00
dellaert bef23a2008 ExpressionExample now only uses BADFactors and yields same result as SFMExample 2014-10-02 11:21:24 +02:00
dellaert ebb091d390 BadFactor is now a functioning NoiseModelFactor 2014-10-02 11:01:39 +02:00
dellaert 3f5aa0f23e Expression version of SFMExample (in progress) 2014-10-01 14:10:54 +02:00
dellaert ce53346a9e Added Symbol versions 2014-10-01 13:12:07 +02:00
dellaert 0d94eeb480 Created expressions.h header 2014-10-01 11:25:49 +02:00
dellaert 254f8c5f75 Possible naming convention 2014-10-01 11:01:38 +02:00
dellaert a6c1ba19cc Concise version 2014-10-01 10:53:35 +02:00
dellaert d45250a989 Fixed dim 2014-10-01 10:45:57 +02:00
dellaert d935172ac5 Tightened 2014-10-01 10:43:03 +02:00
dellaert 8f6eae922a Tightened/cleaned up 2014-10-01 10:36:24 +02:00
Paul Furgale 837b2a6bc0 Fixed the member function with very ugly syntax 2014-09-30 23:13:07 +02:00
dellaert c68c2d2dac Prototype code for passing methods. Does not work (uncomment line 61) 2014-09-30 13:19:44 +02:00
dellaert ae17f8a82f Some refactoring, new static method "combine" 2014-09-30 13:00:37 +02:00
dellaert 374140abb8 Moved all BAD stuff to nonlinear 2014-09-30 12:34:03 +02:00
dellaert 1aa7b570f9 Added BADFactor header and created new test 2014-09-30 12:30:15 +02:00
dellaert ef52e12f87 Split off BADFactor code from Expression 2014-09-30 12:29:57 +02:00
dellaert 5a1ea6071b Split off ExpressionNode hierarchy 2014-09-30 12:20:02 +02:00
dellaert e2f6f01941 Some cleanup of headers/old code 2014-09-30 12:12:17 +02:00
dellaert e789de2353 Check derivatives of compose 2014-09-29 12:14:59 +02:00
dellaert 05c49601ed Added Expression header 2014-09-29 12:06:04 +02:00
Paul Furgale de3e1c3ed1 Fixed the product compilation 2014-09-29 07:22:25 +02:00
dellaert 10a35f3535 Structure for compose. Does not compile (uncomment line 492) 2014-09-28 17:50:36 +02:00
dellaert 7be6ac0e8c Now compiles but product construction fails because optional derivatives can't be delivered by the operator*() 2014-09-28 10:22:19 +02:00
dellaert 11187a4c0d I added operator logic but can't get it to compile 2014-09-27 18:22:37 +02:00
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
cbeall3 f75f26fb63 Fix for Mac 2014-07-22 22:00:33 -04:00
Stephen Camp 8bad295209 Changed initial noise generation for SmartStereoProjectionFactorExample to Y direction, changed noise generation scale 2014-07-22 12:49:09 -04:00
Stephen Camp a297434148 Modified SmartStereoProjectionFactorExample to write optimized poses to file 2014-07-22 09:08:38 -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
Stephen Camp e7c82652af Added option to increase initial error in SmartStereoProjectionFactorExample 2014-07-16 14:45:56 -04:00
cbeall3 f4dc6a3a95 Fix metis linking in tests 2014-07-16 14:45:12 -04:00
cbeall3 d68e6b9add Noisemodel dimension 2->3 2014-07-15 13:09:12 -04:00
Stephen Camp 4c076fca2d Added SmartStereoProjectionFactor example 2014-07-15 10:14:23 -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
Luca Carlone 4dfa2506ab ConcurrentFilterAndSmoother updated and working with the unordered version of GTSAM 2013-08-13 22:30:08 +00:00
Richard Roberts 16b4f0fe8b Moved ImuFactor and CombinedImuFactor into main gtsam, and moved InertialNavFactor family into gtsam_unstable. 2013-08-13 21:04:31 +00:00
Richard Roberts 5d0f8399ed Fixed gtsam_unstable matlab wrapper 2013-08-12 22:26:37 +00:00
Richard Roberts 175965a6bf Merged from branch 'branches/unordered' 2013-08-12 21:52:43 +00:00
Richard Roberts 13d829687c Merged from branch 'trunk' 2013-08-12 21:49:59 +00:00
Richard Roberts 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
Zsolt Kira 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
Richard Roberts f1c9322d37 Removed old VerticalBlockView and SymmetricBlockView (replaced with VerticalBlockMatrix and SymmetricBlockMatrix) 2013-08-12 21:41:05 +00:00
Richard Roberts 6cba528671 Fixed include path 2013-08-12 18:21:27 +00:00
Richard Roberts 7a027be7e5 Fixed unit tests compiling on windows 2013-08-12 16:25:13 +00:00
Vadim Indelman 87a7c56c88 Switched to square root of covariance norm. 2013-08-12 16:11:48 +00:00
Chris Beall 14931bcc7d improved tests a little. basic 3 landmark test with smart projection factor fails! 2013-08-12 14:40:57 +00:00
Richard Roberts ea3ca54cba "Fixed" more unit tests 2013-08-11 19:01:06 +00:00
Richard Roberts 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
Richard Roberts f4d816dcf8 Disabled testSmartProjectionFactor and made print message about this 2013-08-11 18:40:57 +00:00
Richard Roberts f240327f24 Fixed testIMUSystem and BetweenFactorEM 2013-08-11 18:40:47 +00:00
Richard Roberts 0db8e446d5 Disabled gtsam_unstable/nonlinear filters and smoothers 2013-08-11 18:40:39 +00:00
Richard Roberts 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
Stephen Williams f41d4b879b Added the ability to remove factors from ConcurrentIncrementalFilter 2013-08-10 17:16:47 +00:00
Stephen Williams 34a3a6ea49 Added the ability to remove factors from the ConcurrentBatchFilter 2013-08-10 17:16:38 +00:00
Stephen Williams ebc6a66c3a Updated to the marginal factor calculation in BatchFixedLagSmoother to
be more efficient
2013-08-10 17:16:31 +00:00
Stephen Williams 12d003229a Fixed missing '}' 2013-08-10 17:16:19 +00:00
Stephen Williams c33c6e2c70 Added unit tests for Concurrent Incremental Filter and Smoother 2013-08-10 17:15:48 +00:00
Stephen Williams 915dc98bd2 Updated unit tests for Concurrent Batch Filter and Smoother 2013-08-10 17:15:38 +00:00
Stephen Williams f656e93202 Created Concurrent Incremental Filter and Smoother 2013-08-10 17:15:31 +00:00
Stephen Williams 663c598591 Updated Concurrent Batch Filter and Smoother to the latest versions 2013-08-10 17:15:20 +00:00
Stephen Williams 1dc0e6192b Added accessor functions for internal data structures to
IncrementalFixedLagSmoother
2013-08-10 17:15:03 +00:00
Richard Roberts bb4ad176da Needed std:: 2013-08-09 18:50:15 +00:00
Richard Roberts 1eae17561d Taking ImuFactor noise model automatically from preintegrated measurement covariance 2013-08-09 18:50:14 +00:00
Chris Beall c03172aca3 add prior on second camera 2013-08-09 15:31:15 +00:00
Chris Beall 369e69b0d2 actually set everything to zero to turn factor off during linearization 2013-08-09 15:28:57 +00:00
Zsolt Kira 8d9dcfbfc2 Fixed problem with pixel_sigma (2-dimensional only)
Added switch to determine if normal GenericProjectionFactor or SmartProjectionFactor is used
2013-08-09 14:52:26 +00:00
Alex Cunningham 5b7d7b3793 Closer to building and tests running 2013-08-08 20:45:44 +00:00
Vadim Indelman b0c96f9bf6 unwhitenedError. 2013-08-08 20:14:12 +00:00
Vadim Indelman 27cabb62f1 added unwhitenedError to BetweenFactorEM. 2013-08-08 20:13:39 +00:00
Alex Cunningham 4a4e16485c Making more things in gtsam_unstable compile 2013-08-08 20:08:54 +00:00
Alex Cunningham 883c870dff Removed unnecessary summarization files in gtsam_unstable, restricted compilation of gtsam_unstable for components needing iSAM2 - core gtsam_unstable library builds 2013-08-08 20:08:52 +00:00
Zsolt Kira 5af82c4042 SmartProjectionFactor example: Cleaned up some code, added comments,
changed some of the LM parameters.  Switched to use smaller kitti
dataset for now.
2013-08-08 17:16:23 +00:00
Vadim Indelman 579e0931dc Fixed different issues with EM. 2013-08-08 15:12:21 +00:00
Luca Carlone b3ea3f9465 lines added to testSmartProjectionFactor 2013-08-08 14:30:26 +00:00
Zsolt Kira 6dd67a13fd Changed to optimize entire graph instead of sub-graphs 2013-08-08 14:20:08 +00:00
Luca Carlone a82262cf99 Included noise model and f term in SmartProjectionFactor 2013-08-08 14:00:26 +00:00
Zsolt Kira 159f9eee1e Added SmartProjectionFactorExample_kitti.cpp.
Currently loads kitti dataset after processing by VO code (stereo_factors.txt and camera_poses.txt)
Creates graph after N landmarks have been seen, runs it through SmartProjectionFactor
Verification of output is still needed; LM seems to optimize but poses don't seem to change.
2013-08-08 03:11:42 +00:00
Zsolt Kira f423d6f2a8 SmartProjectionFactor: More cleanup, added more tests, added some timing 2013-08-07 23:32:40 +00:00
Vadim Indelman d33f435eab Added BetweenFactorEM with 2 indicator variables. 2013-08-07 15:25:00 +00:00
Zsolt Kira 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
Richard Roberts 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
Richard Roberts 2d60d2cdfa Fixed more unit tests 2013-08-06 18:04:40 +00:00
Richard Roberts e39d100b6a Made most global unit tests compile, includes dogleg, iterative, kalman filter, etc 2013-08-06 13:44:22 +00:00
Luca Carlone 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
Richard Roberts ede0805fac Global find+replace to remove Ordered 2013-08-05 22:31:44 +00:00
Richard Roberts cb7eb1b510 Find+replace Ordered headers 2013-08-05 22:31:33 +00:00
Richard Roberts 09643929fd Making some tests compile 2013-08-05 22:31:26 +00:00
Richard Roberts 628d4e0d77 Disabled discrete for the time being 2013-08-05 22:30:52 +00:00
Luca Carlone 2e085ace91 Changes in SmartProjectionFactor 2013-08-05 19:25:08 +00:00
Chris Beall 5518007317 adding test with regular projection factors for comparison, and bug fixes in SmartFactor test. 2013-08-05 17:58:32 +00:00
Chris Beall d1de6b29a9 adding 3 camera, 3 landmark test 2013-08-05 15:50:19 +00:00
Luca Carlone 39ec641c4a Modifications to SmartProjectionFactor and unit test: work in progress 2013-08-05 15:09:03 +00:00
Luca Carlone d1419a3d11 Added SmartProjectionFactor (+unit tests) 2013-08-02 23:35:39 +00:00
Richard Roberts f273b8f915 Removed extra 'typename' 2013-08-02 16:04:29 +00:00
Richard Roberts 34dc67c1af Brought some relevant changes from aspn-imu-factor branch (is correct this time) 2013-08-02 16:04:17 +00:00
Alex Cunningham 424ef0728f Changed a filename to avoid having multiple object files of the same name in the library 2013-08-01 16:54:44 +00:00
Richard Roberts 2705d85fa7 Merged from branch 'trunk' 2013-07-31 18:55:15 +00:00
Luca Carlone ed79432a69 Added MultiProjectionFactor, invoving n views (camera poses) observing a single landmark: work in progress 2013-07-31 18:02:56 +00:00