MCPcopy Create free account
hub / github.com/Robotics-STAR-Lab/SOAR / computePathLen

Method computePathLen

src/planner/active_perception/src/graph_node.cpp:105–112  ·  view source on GitHub ↗

Source from the content-addressed store, hash-verified

103}
104
105double ViewNode::computePathLen(const Eigen::Vector3d& pose1, const Eigen::Vector3d& pose2)
106{
107 Vector3d pos1 = pose1;
108 Vector3d pos2 = pose2;
109 vector<Vector3d> path;
110 double path_cost = ViewNode::searchPath(pos1, pos2, path);
111 return path_cost;
112}
113
114double ViewNode::computeCostPY(const Eigen::VectorXd& pose1, const Eigen::VectorXd& pose2)
115{

Callers

nothing calls this directly

Calls

no outgoing calls

Tested by

no test coverage detected