[Fix] Rot3.ypr -> Rot3.Ypr

[REFACTOR] Fixed including with "" instead of <>
release/4.3a0
Ivan Jimenez 2016-02-18 21:51:43 -05:00
parent 5fab190194
commit 482144821b
4 changed files with 5 additions and 7 deletions

View File

@ -18,8 +18,6 @@
//
///////////////////////////////////////////////////////////////////////////////
#ifndef TESTRESULT_H
#define TESTRESULT_H

View File

@ -22,7 +22,7 @@
#include <gtsam_unstable/linear/LPSolver.h>
#include <gtsam_unstable/linear/InfeasibleInitialValues.h>
#include <boost/range/adaptor/map.hpp>
#include "LPInitSolverMatlab.h"
#include <gtsam_unstable/linear/LPInitSolverMatlab.h>
using namespace std;

View File

@ -125,15 +125,15 @@ TEST(testlcnlpSolver, poseOnALine) {
//Instantiate LinearConstraintNLP
LinearConstraintNLP lcnlp;
lcnlp.cost.add(PriorFactor<Pose3>(X(1), Pose3(Rot3::ypr(0.1, 0.2, 0.3), Point3(1, 0, 0)), noiseModel::Unit::Create(6)));
lcnlp.cost.add(PriorFactor<Pose3>(X(1), Pose3(Rot3::Ypr(0.1, 0.2, 0.3), Point3(1, 0, 0)), noiseModel::Unit::Create(6)));
LineConstraintX constraint(X(1), dualKey);
lcnlp.linearEqualities.add(constraint);
Values initialValues;
initialValues.insert(X(1), Pose3(Rot3::ypr(0.3, 0.2, 0.3), Point3(1,0,0)));
initialValues.insert(X(1), Pose3(Rot3::Ypr(0.3, 0.2, 0.3), Point3(1,0,0)));
Values expectedSolution;
expectedSolution.insert(X(1), Pose3(Rot3::ypr(0.1, 0.2, 0.3), Point3()));
expectedSolution.insert(X(1), Pose3(Rot3::Ypr(0.1, 0.2, 0.3), Point3()));
// Instantiate LinearConstraintSQP
LinearConstraintSQP lcnlpSolver(lcnlp);

View File

@ -146,7 +146,7 @@ TEST(PositionUpperBoundX, evaluateError ) {
// Instantiate a class PositionUpperBoundX
PositionUpperBoundX ineq(X(1), 45.6);
Pose3 pose(Rot3::ypr(0.1, 0.3, 0.2), Point3(43.0, 27.8, 91.1));
Pose3 pose(Rot3::Ypr(0.1, 0.3, 0.2), Point3(43.0, 27.8, 91.1));
Matrix H;
Vector error = ineq.evaluateError(pose, H);