| 39 | } |
| 40 | |
| 41 | void Astar::setResolution(const double& res) { |
| 42 | resolution_ = res; |
| 43 | this->inv_resolution_ = 1.0 / resolution_; |
| 44 | } |
| 45 | |
| 46 | int Astar::search(const Eigen::Vector3d& start_pt, const Eigen::Vector3d& end_pt, bool optimistic) { |
| 47 | NodePtr cur_node = path_node_pool_[0]; |
no outgoing calls
no test coverage detected