Commit Graph

880 Commits (02524f42e7893fc7b3232f85f8077fb6c20bf45c)

Author SHA1 Message Date
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
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 f4dc6a3a95 Fix metis linking in tests 2014-07-16 14:45:12 -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