Commit Graph

922 Commits (6abb9af0a6e9c207a23b355e1cb40a1d55b02414)

Author SHA1 Message Date
Frank Dellaert 5ef0400e06 put Factorization class in its own file, and added checks in constructors that take shared pointers, so we get some more meaningful output rather than *segmentation error* 2010-03-05 15:09:09 +00:00
Viorela Ila fccbaa2d6f right folders 2010-03-05 05:41:21 +00:00
Frank Dellaert 45b2eef13f Adjoint 2010-03-05 03:02:23 +00:00
Viorela Ila abf7758374 now datasets are in CitySALM/data/XXXX/xxxx.graph 2010-03-05 02:58:59 +00:00
Yong-Dian Jian 43df7375c0 add helper functions 2010-03-05 00:55:36 +00:00
Kai Ni d0d2aa8aee added erase method 2010-03-04 23:39:36 +00:00
Alex Cunningham d6c2b415a5 Added a check to NonlinearOptimizer to short circuit optimization if the initial error is below the absolute threshold. 2010-03-04 22:46:27 +00:00
Alex Cunningham 4ae9b72a35 Commented marginalGaussian() due to compile error 2010-03-04 22:40:01 +00:00
Richard Roberts 5f8b0e9341 Added marginalGaussian to get a marginal on a single variable from a GaussianFactorGraph 2010-03-04 22:03:40 +00:00
Alex Cunningham badc7b6ee6 Added keys() function to LieConfig to return an ordered list of keys 2010-03-04 13:21:48 +00:00
Frank Dellaert b9045528ee no more normalize. in compose?
Also moved constructors around, one inline in h, others to cpp
2010-03-03 05:35:00 +00:00
Frank Dellaert c9fcf95501 fixed some issues in SE(2) "branch" 2010-03-03 05:34:08 +00:00
Frank Dellaert 707627fb3a Rot2 "named constructors" (http://www.parashift.com/c++-faq-lite/ctors.html#faq-10.8):
/** Named constructor from angle == exponential map at identity */
  static Rot2 fromAngle(double theta) { return Rot2(cos(theta),sin(theta));}

  /** Named constructor from cos(theta),sin(theta) pair, will *not* normalize! */
  static Rot2 fromCosSin(double c, double s);

  /** Named constructor that behaves as atan2, i.e., y,x order (!) and normalizes */ 
  static Rot2 atan2(double y, double x);

which are a bit more verbose, but at least won't cause hours of bug-tracking :-(

I also made most compose, inverse, and rotate functions into methods, with the global functions mostly calling the methods. Methods have privileged access to members and hence are typically much more readable.
2010-03-03 03:31:53 +00:00
Frank Dellaert 85fe43949d arithmetic tests 2010-03-03 02:50:49 +00:00
Frank Dellaert eec6017b12 scalar multiplication 2010-03-03 02:49:06 +00:00
Kai Ni 23986349de added measured function 2010-03-02 21:43:39 +00:00
Frank Dellaert 190e87afb9 Correct exmap is indeed correct, but derivatives *still* do not check out. I'm starting to suspect numericalDerivative. 2010-03-02 17:56:26 +00:00
Frank Dellaert 32beb8c712 more refactoring, use different Rot3 constructor so no confusion 2010-03-02 06:16:11 +00:00
Kai Ni 680a6a28c1 added begin and end iterators 2010-03-02 06:07:46 +00:00
Frank Dellaert 33c6c51658 refactored and thoroughly checked rodrgues, added two more unit test 2010-03-02 05:45:19 +00:00
Frank Dellaert f956bae6a4 combined version only 2010-03-02 02:27:09 +00:00
Frank Dellaert 1093317fdc wedge 2010-03-02 02:25:27 +00:00
Frank Dellaert c62ebe3ea8 exponential map approximation 2010-03-02 02:24:38 +00:00
Alex Cunningham 20ac6b85c8 Added static dim() functions to remaining geometry types so that dimensions can be calculated on size alone. 2010-03-01 21:56:13 +00:00
Manohar Paluri e670e00e3b added const Tensor3expression 2010-03-01 18:08:18 +00:00
Manohar Paluri 8bf8e4dc1f added operator() to change values 2010-03-01 18:07:18 +00:00
Manohar Paluri 6073bdb679 made the function const 2010-03-01 18:05:24 +00:00
Alex Cunningham a46dc4cea0 Added threshold for lambda in NonlinearOptimizer so that if lambda has gotten unreasonably large, optimization will throw a runtime exception to prevent infinite loops where lambda goes to infinity. 2010-03-01 16:31:05 +00:00
Frank Dellaert d9c185498e combined a few arithmetic tests 2010-03-01 01:38:26 +00:00
Frank Dellaert 4cb59438f7 documentation 2010-03-01 01:37:50 +00:00
Frank Dellaert 619190a818 new-style combined unrotate 2010-03-01 01:36:27 +00:00
Frank Dellaert 20ad08e48f new Pose3 derivatives still don't work :-( 2010-03-01 01:35:33 +00:00
Frank Dellaert b943644ddd re-factored so corresponds to math.lyx 2010-03-01 01:33:45 +00:00
Frank Dellaert 6e03783465 negation 2010-03-01 01:30:15 +00:00
Frank Dellaert 28f4493a2b Now uses Adjoint map for derivatives of inverse/compose/between, see doc/math.pdf 2010-02-28 09:10:39 +00:00
Frank Dellaert 98aa08bcd0 Re-use memory 2010-02-28 09:09:37 +00:00
Frank Dellaert 85784400c6 prototype object map 2010-02-28 09:09:12 +00:00
Frank Dellaert dcfe52dae7 some renaming of variables 2010-02-28 09:08:47 +00:00
Kai Ni b58f7b8ea7 the derivative for transform_from 2010-02-28 08:51:43 +00:00
Kai Ni d894e23a06 assert_equal for a list of matrices 2010-02-28 00:48:42 +00:00
Manohar Paluri 4604cbce05 svd now handles m < n cases. Added unit tests to verify this. But svd in place will throw an exception for such cases. 2010-02-27 18:23:34 +00:00
Frank Dellaert 5e00c58ea7 Baker–Campbell–Hausdorff formula: in non-commutative Lie groups, when composing exp(Z) = exp(X)exp(Y) it is not true that Z = X+Y. Instead, Z can be calculated using the BCH formula:
Z = X + Y + [X,Y]/2 + [X-Y,[X,Y]]/12 - [Y,[X,[X,Y]]]/24 + ...
See http://en.wikipedia.org/wiki/Baker–Campbell–Hausdorff_formula
2010-02-27 14:58:54 +00:00
Kai Ni 67b4834bdb someone forgot to return it 2010-02-27 00:04:51 +00:00
Viorela Ila b6599ebdce readst the tree files 2010-02-26 22:23:00 +00:00
justinca 9941b28128 Fix matrix inverse square root so it, once again, returns an upper triangular matrix 2010-02-26 18:53:41 +00:00
Manohar Paluri 940202226b added #pragma 2010-02-26 14:45:17 +00:00
Frank Dellaert d21ff82d21 Kruskal skeleton 2010-02-26 13:31:38 +00:00
Kai Ni 87c8465315 the beautiful Jacobian of compose in pose2 2010-02-26 10:55:41 +00:00
Frank Dellaert c40760485d I think we might have a problem: is expmap<Pose2> correct? Uncomment the new test in testPose2. It does not match what is said in http://www.cis.upenn.edu/~cis610/cis610lie1.ps. 2010-02-26 06:00:58 +00:00
Frank Dellaert 0004d90feb formatting only 2010-02-26 05:30:02 +00:00
Frank Dellaert 38ed1a5cdd more compulsive checking, more efficient removing 2010-02-26 05:29:45 +00:00
Kai Ni 73848d9e0e added comments to make people realize it is for the matlab wrapper not actually c++ implementation 2010-02-26 05:05:05 +00:00
Kai Ni 7e8aa6e6b9 add unit test for the constructor 2010-02-26 05:04:03 +00:00
Frank Dellaert 5e97d07f5e *it is already the right type 2010-02-26 04:03:56 +00:00
Frank Dellaert 0a33b50554 use Matrix.resize 2010-02-26 04:03:31 +00:00
Frank Dellaert 17bd59ec80 only call alpha calls if CBLAS version will be called. 2010-02-26 03:23:48 +00:00
Frank Dellaert 044ea1348d Modernized/refactored, esp. with regards to map insert and iterating. 2010-02-26 03:20:15 +00:00
Alex Cunningham 9d704bb977 Added flag to default Factorization for old or new elimination, defaulting to old code. 2010-02-25 21:07:35 +00:00
Alex Cunningham 5b60511505 Reverted default elimination code to older implementation - use switch in optimize() or eliminate() to use newer code. 2010-02-25 20:43:59 +00:00
Kai Ni c56ee9ea0d added a new constructor that takes a list 2010-02-25 08:16:33 +00:00
Alex Cunningham 74787df3fc Added ability to insert whole configs at a time to LieConfig and TupleConfig 2010-02-25 02:50:01 +00:00
Frank Dellaert 93a3f48920 Created patch to camera homography function with Duy 2010-02-25 00:05:27 +00:00
Alex Cunningham 9955ea20bd Added pure cblas implementation of multiplyAdd functions. This does not have autotools support yet, so to enable, goto cpp/Makefile.am, comment out the block concerning GSL/ATLAS, and uncomment the above section enabling just blas. 2010-02-24 18:12:48 +00:00
Alex Cunningham f8c4e1fe27 Fixed bug in unit test causing crashes, altered corner case test for column insertion 2010-02-24 18:09:15 +00:00
Alex Cunningham 022f706d94 Changed default elimination algorithm to newer one with fewer matrix allocations to solve crashing bug from LM discovered in MAST 2010-02-24 14:19:52 +00:00
Frank Dellaert 04f7bbf253 use vector_scale_inplace 2010-02-24 06:15:06 +00:00
Frank Dellaert 696be0d0c1 RETURN CONST REFERENCES WHERE YOU CAN and some inlining 2010-02-24 06:14:43 +00:00
Frank Dellaert dd9446993a 5-fold performance improvement in combined between function 2010-02-24 06:14:02 +00:00
Frank Dellaert 51281ea78f in-place colamd 2010-02-24 06:13:11 +00:00
Frank Dellaert 71089a6354 vector_scale_inplace 2010-02-24 06:12:56 +00:00
Frank Dellaert c1f50a0637 fixed noise model, removed istringstream and getline in favor of ignore 2010-02-24 06:11:52 +00:00
Kai Ni 547427514f add save functions for Matrix and Vector to save them to disk 2010-02-24 00:12:10 +00:00
Alex Cunningham ac41ee7215 Added a test in GaussianFactor to demo a problem found in MAST where eliminating a single factor with two priors causes a memory corruption error. To run the test and see the error, go to the last test in testGaussianFactor called "exploding_MAST_factor" and uncomment the indicated line. 2010-02-23 18:41:07 +00:00
Alex Cunningham a2310b4eab Fixed small error in NonlinearConstraint and added note explaining why nonlinear constraints do not use a constrained noisemodel in the nonlinear sense. 2010-02-23 18:37:17 +00:00
Manohar Paluri 032c8887d6 added point-point-point check 2010-02-23 13:14:07 +00:00
Kai Ni 5594d162a2 allocate noise model once 2010-02-23 05:28:39 +00:00
Kai Ni 3ae81002be fixed the unit tests 2010-02-23 05:23:15 +00:00
Manohar Paluri 8900a37d93 removed unncessary prints 2010-02-23 05:08:42 +00:00
Frank Dellaert a178023a27 Fixed christian01 example, polluting gtsam with extra header files for MATLAB. Need to look for a better solution. 2010-02-23 05:06:16 +00:00
Manohar Paluri 443d304a7c Added another TrifocalTensor estimation test 2010-02-22 21:45:15 +00:00
Alex Cunningham fbbdd0be3e Fixed error calculation with NonlinearConstraints - now use Unit noisemodels in NonlinearConstraint to prevent having the error forced to infinity 2010-02-22 21:11:22 +00:00
Kai Ni ee9205f0fa uncommented unit tests 2010-02-22 16:43:40 +00:00
Kai Ni 65cbff6af6 added unit tests 2010-02-22 06:42:58 +00:00
Frank Dellaert 6ea8a22958 Fixed two unit tests in MATLAB, needed some small changes in C++ as well 2010-02-21 23:50:28 +00:00
Frank Dellaert 694f6e4219 linearize now always returns a shared pointer 2010-02-21 21:17:47 +00:00
Frank Dellaert 517c82f62f Small details, like using a reference in FOREACH 2010-02-21 17:06:11 +00:00
Frank Dellaert fe4471930f avoid keys() call to known set of keys 2010-02-21 15:24:05 +00:00
Frank Dellaert 190ec53a63 use ifdef 2010-02-21 15:23:27 +00:00
Manohar Paluri 7f1c3f9952 fixed a bug 2010-02-21 04:51:42 +00:00
Frank Dellaert 274265a401 Errors:axpy and testErrors 2010-02-21 00:01:43 +00:00
Frank Dellaert 5b6af9e4bd 1.0 versions of BLAS level 2 2010-02-20 23:44:07 +00:00
Frank Dellaert ac316f2d56 formatting only 2010-02-20 23:43:41 +00:00
Richard Roberts 75b35949c9 Fixed several unit test main() functions that were returning 0 instead of the result of runAllTests. This caused unit tests to print failures but not count as failures in the pass/fail counts. In CMake projects, since test output is logged to a file instead of printed, this caused no indication of failures when they occured! All tests still pass with no other modifications after fixing this. 2010-02-20 22:22:45 +00:00
Kai Ni 1949a992cd define two additional types 2010-02-20 00:28:10 +00:00
Kai Ni 689b9fefc0 throw exceptions instead of crashing 2010-02-19 22:44:45 +00:00
Kai Ni d0ce5d36da created addPrior 2010-02-19 02:48:47 +00:00
Manohar Paluri e60d903210 removed extra quotes 2010-02-18 23:31:23 +00:00
Manohar Paluri 2bf4c0ce5b Fixed two bugs, both related to array overflow 2010-02-18 22:52:49 +00:00
Richard Roberts c26219e3d4 Added Pose2::matrix() function. 2010-02-18 16:27:01 +00:00
Frank Dellaert cd5c281c76 Added get and set 2010-02-18 14:30:16 +00:00