#include <gtsam/geometry/Pose3.h>
#include <gtsam/geometry/Point3.h>
#include <gtsam/geometry/Point2.h>
#include <gtsam/geometry/SimpleCamera.h>
#include <gtsam/nonlinear/Symbol.h>
#include <gtsam/slam/PriorFactor.h>
#include <gtsam/slam/ProjectionFactor.h>
#include <gtsam/nonlinear/NonlinearFactorGraph.h>
#include <gtsam/nonlinear/DoglegOptimizer.h>
#include <gtsam/nonlinear/LevenbergMarquardtOptimizer.h>
#include <gtsam/nonlinear/Values.h>
#include <gtsam/linear/linearExceptions.h>
#include <boost/random/mersenne_twister.hpp>
#include <boost/random/uniform_real.hpp>
#include <boost/random/uniform_int.hpp>
#include <boost/random/variate_generator.hpp>
#include <boost/range/algorithm/random_shuffle.hpp>
#include <geometry_msgs/Pose.h>
#include <vector>
#include <math.h>
Go to the source code of this file.
Classes | |
struct | arm_3d_cb_calib::CBCalibProblem |
struct | arm_3d_cb_calib::CBCalibSolution |
Namespaces | |
namespace | arm_3d_cb_calib |
Functions | |
void | arm_3d_cb_calib::generateCBCalibProblem (CBCalibProblem &prob, CBCalibSolution &sol, int num_ees) |
gtsam::Pose3 | arm_3d_cb_calib::geomPoseToGtsamPose3 (const geometry_msgs::Pose &pose_in) |
geometry_msgs::Pose | arm_3d_cb_calib::gtsamPose3ToGeomPose (const gtsam::Pose3 &pose_in) |
void | arm_3d_cb_calib::solveCBCalibProblem (const CBCalibProblem &prob, CBCalibSolution &sol) |