Commit Graph

849 Commits (3247751b5db8193b5fbd924b66b1e48325db7e7c)

Author SHA1 Message Date
Frank Dellaert 3247751b5d Major check-in: there are now two interchangeable implementations of VectorConfig.
VectorMap uses a straightforward stl::map of Vectors. It has O(log n)
insert and access, and is fairly fast at both. However, it has high overhead
for arithmetic operations such as +, scale, axpy etc...

VectorBTree uses a functional BTree as a way to access SubVectors
in an ordinary Vector. Inserting is O(n) and much slower, but accessing,
is O(log n) and might be a bit slower than VectorMap. Arithmetic operations
are blindingly fast, however. The cost is it is not as KISS as VectorMap.

Access to vectors is now exclusively via operator[]
Vector access in VectorMap is via a Vector reference
Vector access in VectorBtree is via the SubVector type (see Vector.h)

Feb 16 2010: FD: I made VectorMap the default, because I decided to try
and speed up conjugate gradients by using Sparse FactorGraphs all the way.
2010-02-17 03:29:12 +00:00
Kai Ni cb5d4c3127 instantiate SymbolicConfig 2010-02-16 23:20:39 +00:00
Alex Cunningham d895cb90dc Added a static dim function to Point3 for generic detection of dimension 2010-02-16 20:21:03 +00:00
Alex Cunningham 529fc5536b Fixed templating problem with visualSLAM::ProjectionFactor 2010-02-16 02:09:07 +00:00
Frank Dellaert 30893b33eb some small details to work it work with NewVectorConfig 2010-02-15 23:54:10 +00:00
Frank Dellaert 5d33eb185c added SubVector type and some related routines 2010-02-15 23:53:16 +00:00
Frank Dellaert e4691a1594 BTree refactored, Node is now an inner class, find is non-recursive 2010-02-15 23:52:46 +00:00
Manohar Paluri 2ec75bfd56 added executables to ignore list 2010-02-15 23:46:52 +00:00
Manohar Paluri 39708194a3 added TrifocalTensor test and changed DLT to use non-sorted version. 2010-02-15 23:45:53 +00:00
Frank Dellaert 341c4d9250 Deleted debug print 2010-02-15 21:38:33 +00:00
Manohar Paluri 8691d633a7 added testTensors to the tests 2010-02-15 20:25:38 +00:00
Alex Cunningham 17706d4ebd Added key template parameters to visualSLAM::projectionFactor without changing the interface. Added dimension checking function for Point2 type. 2010-02-15 16:37:37 +00:00
Manohar Paluri 1323386f12 added executable to ignore list 2010-02-14 07:27:58 +00:00
Manohar Paluri 6f0d23cdaf forgot to change comments in previous checkin 2010-02-14 07:26:53 +00:00
Manohar Paluri 1cc5bf748b make file changes and added make targets to the cproject 2010-02-14 07:26:10 +00:00
Manohar Paluri c16e6fc0d5 Moved Tensor related Files from CitySLAM 2010-02-14 07:25:03 +00:00
Manohar Paluri 1923778750 Moved Tensor related Files from CitySLAM 2010-02-14 07:24:37 +00:00
Frank Dellaert 44094b494e fixed maxIteration bug 2010-02-14 07:14:42 +00:00
Frank Dellaert 1f165a9f85 Made CG state a class 2010-02-14 05:52:20 +00:00
Manohar Paluri 43f9baf77a added test to check singular value ordering for a sample homography case 2010-02-14 04:56:29 +00:00
Manohar Paluri 693e13ef88 added default bool option to svd to sort the singular values and V. the default is true so pass false to avoid sorting 2010-02-14 04:54:39 +00:00
Kai Ni f9c2000847 save graph to graphviz format 2010-02-13 07:09:56 +00:00
Kai Ni d0a93ad9dd insert bayes net as a clique 2010-02-13 07:09:27 +00:00
Richard Roberts 4408eaf6f4 Added FactorGraph::checkGraphConsistency() to check for consistency between the variables->factors and factors->variables maps, and a unit test that tests the replace function including checking consistency. 2010-02-13 01:29:19 +00:00
Alex Cunningham f1988513fe Fixed bug in print function of TypedLabeledSymbol 2010-02-10 21:03:49 +00:00
Alex Cunningham dde0626e5c Added a constructor for TypedLabeledSymbol from Symbol that decodes the index to split out a label 2010-02-10 15:27:21 +00:00
Alex Cunningham d0aed559b5 TypedLabeledSymbols now convert properly to Symbols, so they can be used to add a runtime label to a TypedKey to express "Pose 1 of robot A" 2010-02-10 14:39:58 +00:00
Kai Ni 31999ecb1f added 4-way symbolic factor
fixed a bug in the bayes tree to graphviz routine
2010-02-09 22:59:18 +00:00
Richard Roberts e83b6c3b84 Normalizing rotation matrix to fix numerical instability when composing many poses 2010-02-09 22:44:02 +00:00
Kai Ni 31fc894a4a added 4-way symbolic factor
fixed a bug in the bayes tree to graphviz routine
2010-02-09 21:32:14 +00:00
Alex Cunningham d2a4bdae3c Made simulated2D factors more generic - can now specify key types 2010-02-09 19:47:39 +00:00
Alex Cunningham 8ff64793f1 Apparently, expmap != exmap. TupleConfigN's are no longer broken now. 2010-02-09 19:27:28 +00:00
Alex Cunningham 942e2b9c6d static chr() function for TypedSymbol, and another version of Symbol (don't use) 2010-02-09 03:59:45 +00:00
Alex Cunningham 0c74e0c309 Ensured that constraints add keys to keys_ 2010-02-09 01:52:36 +00:00
Alex Cunningham 8aa440a679 Fixed the instantiation macros and exmap global functions for TupleConfigN 2010-02-09 01:24:41 +00:00
Alex Cunningham 18d7fcc299 Added instantiation macros for TupleConfigs and NonlinearConstraints 2010-02-08 22:29:00 +00:00
Richard Roberts fbef948254 Bug fix in replace() 2010-02-08 22:22:38 +00:00
Richard Roberts ea9b44ea15 Fixed indentation 2010-02-08 22:21:56 +00:00
Alex Cunningham ed338300a1 Instantiation script for TupleConfig 2010-02-08 20:53:18 +00:00
Alex Cunningham ea3b8083b0 Fixed more tests for NonlinearConstraints, inequality constraints now work. 2010-02-07 01:18:17 +00:00
Chris Beall 814fb949ba fixed critical bug relating to height of tree 2010-02-06 17:45:40 +00:00
Chris Beall 675b30d1c1 updates to BTree 2010-02-06 15:53:31 +00:00
Alex Cunningham f88438bab4 Removed SQP optimizer and moved remaining SQP optimizer tests into testSQP. All equality constraints should be fully functional now. Inequality constraints still to come. 2010-02-06 14:48:46 +00:00
Alex Cunningham 219dfd262d SQP now works with single configs using the TupleConfigs, without needing a separate optimizer. 2010-02-06 05:14:52 +00:00
Alex Cunningham d8a8575d26 Removed a fixme comment 2010-02-06 05:12:09 +00:00
Alex Cunningham d1267d1ef3 Added more constructors, print functionality and formatting for TupleConfig 2010-02-06 05:10:25 +00:00
Alex Cunningham bb74b5c882 Added a config template parameter for ProjectionFactors 2010-02-06 05:08:52 +00:00
Alex Cunningham af9f45ff24 Used template parameters in simulated2D to make it possible to template factors on a config type with typedefs for the previous usage so no other code needs to change 2010-02-05 14:49:40 +00:00
Alex Cunningham 040d45cb45 Added wrapper classes for TupleConfig for ease of use. 2010-02-05 01:33:33 +00:00
Chris Beall 8fe0795dd0 BTree moved into gtsam 2010-02-04 21:02:05 +00:00