costmap_2d: footprint_tests.cpp
1、函数[void calculateMinAndMaxDistances(const std::vector<geometry_msgs::Point>& footprint,
double& min_dist, double& max_dist)]
功能:计算机器人轮廓的最小距离和最大距离
通过计算原点与顶点距离、原点与线段(顶点-顶点)距离,算出轮廓的最小距离和最大距离。
2、函数[geometry_msgs::Point toPoint(geometry_msgs::Point32 pt