ros开发增加clion常用模板及初始化配置(六)

                                                        ros开发增加clion常用模板及初始化配置(六)

c++模板 

进入clion->file->settings->Editor->live Templates 添加以下模板

使用时在c++ 代码中输入cpp 然后键盘 ctrl+shift+j就可显示自定义的模板了

cpp_ros_distance欧几里得距离

   // distance 函数来计算两个点之间的距离，使用欧几里得距离公式来实现。
    double distance(geometry_msgs::PoseStamped p1, geometry_msgs::PoseStamped p2) {
        double dx = p1.pose.position.x - p2.pose.position.x;
        double dy = p1.pose.position.y - p2.pose.position.y;
        return sqrt(dx * dx + dy * dy);
    }

/**
    distance() 函数用于计算两个点之间的距离。它接受两个参数 p1 和 p2，这两个参数是包含位置信息的 geometry_msgs::PoseStamped 对象。函数首先计算两个点在 x 和 y 方向上的差值，然后使用欧几里得距离公式（平方差值的和的平方根）计算距离，并返回结果。
*/

cpp_ros_angle_between_vectors计算两个向量之间的夹角

const double PI = 3.14159265358979