Alex Cunningham
|
e3e79e3888
|
Added lagrange access function to the SQPOptimizer
Added a test testSQP to try changing the initial Lagrange multiplier values to find a way around the stability problem, but there is no effect.
|
2009-11-24 14:44:46 +00:00 |
|
Alex Cunningham
|
140e79572f
|
Added a test to testSQP to check VSLAM solution stability when the initial config is away from the ground truth. The test without the nonlinear constraints has the same stability problem, and both the constrained and unconstrained versions are in place and disabled.
|
2009-11-24 14:14:03 +00:00 |
|
Alex Cunningham
|
fec280db8e
|
Added a nonlinear constraint version of the stereo SQP example, but the test when the initial configuration is incorrect is not stable and the points continue moving away indefinitely.
|
2009-11-24 06:39:27 +00:00 |
|
Alex Cunningham
|
36877532ad
|
Added ground truth for VSLAM example in testSQP
|
2009-11-23 16:45:53 +00:00 |
|
Alex Cunningham
|
1fd0404ec9
|
Cleanup in testSQP, also demoed the unary constraint, as well.
|
2009-11-21 19:05:24 +00:00 |
Frank Dellaert
|
a0a250750b
|
compare config
|
2009-11-21 04:22:59 +00:00 |
|
Alex Cunningham
|
08f5b074a0
|
Added verbosity selector for the SQP demo to remove printouts every time it runs
|
2009-11-20 14:29:11 +00:00 |
|
Alex Cunningham
|
5f848f272b
|
SQP demo that moves maps into the correct reference frames is now working using the NonlinearConstraint machinery.
|
2009-11-20 14:05:21 +00:00 |
|
Alex Cunningham
|
6aba2f1c1c
|
Changed initial SQP example to use exmap using the new scaling function for VectorConfig
|
2009-11-20 05:13:32 +00:00 |
|
Alex Cunningham
|
ee4a066275
|
Implemented linearization and equality for unary NonlinearConstraints. Current tests use a scalar example. Split out implementation into a separate implementation file.
|
2009-11-20 03:04:49 +00:00 |
|
Alex Cunningham
|
429f27550c
|
Added a NonlinearConstraint and testNonlinearConstraint. There is currently an abstract base class for constraints and a partially implemented unary constraint.
|
2009-11-19 16:50:18 +00:00 |
|
Alex Cunningham
|
f98f49381a
|
Added an example to testSQP to use for combining graphs
|
2009-11-18 21:57:59 +00:00 |
|
Alex Cunningham
|
d700cd2cac
|
Made some small changes to testSQP to simplify the system and improve convergence.
|
2009-11-18 20:23:07 +00:00 |
|
Alex Cunningham
|
7fc68e2d90
|
Updated testSQP to use a real SQP implementation as separate factors on the previous problem. SQP now works.
|
2009-11-18 19:42:14 +00:00 |
|
Alex Cunningham
|
20830a1534
|
Added testSQP demo to show a simple problem solved by Sequential Quadratic Programming. To see the outputs, set verbose=true at the start of the test.
|
2009-11-16 19:12:56 +00:00 |