#include <JointGTSPSolver.h>
Public Member Functions | |
void | getActions (const std::vector< unsigned int > &traj, std::vector< unsigned int > &actions) |
void | getSolution (std::vector< std::vector< double > > &joint_path, std::vector< tf::Pose > &pose_path, std::vector< unsigned int > &action, std::vector< unsigned int > &res_traj) |
JointGTSPSolver () | |
JointGTSPSolver (double max_adjacency, std::string tsp_type) | |
Private Member Functions | |
void | getJointPoses (const Eigen::VectorXi &multinode_mapping, const std::vector< unsigned int > &traj, std::vector< std::vector< double > > &joint_path) |
void | insertStartIntoWeights (const Eigen::MatrixXf &weights, const Eigen::VectorXi &multinode_mapping, Eigen::MatrixXf &new_weights) |
void | mapGTSPIndexToMultinode (const Eigen::VectorXi &multinode_mapping, const std::vector< unsigned int > &traj, std::vector< unsigned int > &multinode_traj) |
unsigned int | mapGTSPIndexToMultinode (const Eigen::VectorXi &multinode_mapping, unsigned int node) |
void | transformGraphToGTSP (const Eigen::MatrixXi &adj_bool, const std::vector< SurfacePatch > &patches, const std::vector< std::vector< std::vector< std::vector< double > > > > &coll_free_ik, Eigen::VectorXi &mapping, Eigen::MatrixXi &new_adj_bool, Eigen::MatrixXf &new_adj_float) |
void | transformGTSPToTSP (const Eigen::VectorXi &multinode_mapping, Eigen::MatrixXi &adj_bool, Eigen::MatrixXf &adj_float) |
Definition at line 12 of file JointGTSPSolver.h.
Definition at line 7 of file JointGTSPSolver.cpp.
JointGTSPSolver::JointGTSPSolver | ( | double | max_adjacency, |
std::string | tsp_type | ||
) |
Definition at line 12 of file JointGTSPSolver.cpp.
void JointGTSPSolver::getActions | ( | const std::vector< unsigned int > & | traj, |
std::vector< unsigned int > & | actions | ||
) | [virtual] |
Implements SolverInterface.
Definition at line 316 of file JointGTSPSolver.cpp.
void JointGTSPSolver::getJointPoses | ( | const Eigen::VectorXi & | multinode_mapping, |
const std::vector< unsigned int > & | traj, | ||
std::vector< std::vector< double > > & | joint_path | ||
) | [private] |
Definition at line 287 of file JointGTSPSolver.cpp.
void JointGTSPSolver::getSolution | ( | std::vector< std::vector< double > > & | joint_path, |
std::vector< tf::Pose > & | pose_path, | ||
std::vector< unsigned int > & | action, | ||
std::vector< unsigned int > & | res_traj | ||
) | [virtual] |
Implements SolverInterface.
Definition at line 18 of file JointGTSPSolver.cpp.
void JointGTSPSolver::insertStartIntoWeights | ( | const Eigen::MatrixXf & | weights, |
const Eigen::VectorXi & | multinode_mapping, | ||
Eigen::MatrixXf & | new_weights | ||
) | [private] |
Definition at line 332 of file JointGTSPSolver.cpp.
void JointGTSPSolver::mapGTSPIndexToMultinode | ( | const Eigen::VectorXi & | multinode_mapping, |
const std::vector< unsigned int > & | traj, | ||
std::vector< unsigned int > & | multinode_traj | ||
) | [private] |
Definition at line 256 of file JointGTSPSolver.cpp.
unsigned int JointGTSPSolver::mapGTSPIndexToMultinode | ( | const Eigen::VectorXi & | multinode_mapping, |
unsigned int | node | ||
) | [private] |
Definition at line 279 of file JointGTSPSolver.cpp.
void JointGTSPSolver::transformGraphToGTSP | ( | const Eigen::MatrixXi & | adj_bool, |
const std::vector< SurfacePatch > & | patches, | ||
const std::vector< std::vector< std::vector< std::vector< double > > > > & | coll_free_ik, | ||
Eigen::VectorXi & | mapping, | ||
Eigen::MatrixXi & | new_adj_bool, | ||
Eigen::MatrixXf & | new_adj_float | ||
) | [private] |
Definition at line 101 of file JointGTSPSolver.cpp.
void JointGTSPSolver::transformGTSPToTSP | ( | const Eigen::VectorXi & | multinode_mapping, |
Eigen::MatrixXi & | adj_bool, | ||
Eigen::MatrixXf & | adj_float | ||
) | [private] |
Definition at line 210 of file JointGTSPSolver.cpp.