How to get the length of navigation path
Hello everyone,I wanna get the length of navigation path when I use nav_msgs/GetPlan.
Do I have to calculate the distance between every two adjacent points in the array (nav_msgs/Path -> geometry_msgs/PoseStamped[] poses) ?
I mean, in real-time. The remaining length varies depending on the robot position.
My poor way is to calculate distance of every two points, and add them up...
Is there a more convenient method ?