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() 函数用于