Removed hessian symmetrization trick from the QPSolver.

release/4.3a0
= 2016-09-09 10:27:01 -04:00
parent 41b840485e
commit 8877e3de4d
1 changed files with 0 additions and 3 deletions

View File

@ -37,9 +37,6 @@ struct QPPolicy {
GaussianFactorGraph no_constant_factor;
for (auto factor : qp.cost) {
HessianFactor hf = static_cast<HessianFactor>(*factor);
//a trick to ensure that the augmented matrix is always symmetric. Should only be an issue when dealing
// with the manifold.
hf.augmentedInformation() = (hf.augmentedInformation() + hf.augmentedInformation().transpose())/2;
if (hf.constantTerm() < 0) // Hessian Factors cannot deal
// with negative constant terms replace with zero in this case
//TODO: Perhaps there is a smarter way to set the constant term such that the resulting matrix is almost always