Hello, I am learning Fast-Planner recently, and I find that in this line, end_vel should be path_nodes_.back()->state.tail(3) but not node->state.tail(3). https://github.com/HKUST-Aerial-Robotics/Fast-Planner/blob/41be219fe4ecc43bf0e0c2b42a523f8755ccc0bd/fast_planner/path_searching/src/kinodynamic_astar.cpp#L667 Looking forward to your reply.
Hello,
I am learning Fast-Planner recently, and I find that in this line, end_vel should be path_nodes_.back()->state.tail(3) but not node->state.tail(3).
Fast-Planner/fast_planner/path_searching/src/kinodynamic_astar.cpp
Line 667 in 41be219
Looking forward to your reply.