【Autoware】三、ROSBAG生成waypoint

1.启动Autoware

cd ~/autoware.ai/
source install/setup.bash 
roslaunch runtime_manager runtime_manager.launch

2.切换到Simulation模块

  • 点击右侧的Ref,选择文件:
    /.autoware/sample_moriyama_150324.bag
  • 点击Play按钮以后,立马点击Pause按钮
    在这里插入图片描述

3.加载地图数据

4.切换到Setup模块

  • 依次点击TF和Vehicle Model
  • 启动右下方RViz可视化工具
    在这里插入图片描述

5.切换到Computing模块

  • 勾选下图所示:
    点击waypoint_saver后面的App点击Ref选择保存路径
    在这里插入图片描述

6.返回Simuation模块

  • 点击Pause继续播放,效果如下:
    在这里插入图片描述

在这里插入图片描述

7.查看生成文件

找到自己的保存路径,生成一个waypoint文件
在这里插入图片描述
在这里插入图片描述

  • 1
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
好的,我会尽力回答你的问题。下面是一个用 c++ 14 实现的函数,用于计算经过给定点的直线与以该点为圆心、指定半径的圆的交点,并返回一个 `std::vector<autoware_msgs::Waypoint>` 类型的向量: ```cpp #include <cmath> #include "autoware_msgs/Waypoint.h" std::vector<autoware_msgs::Waypoint> getIntersectionPoints(const autoware_msgs::Waypoint& waypoint, double k, double r) { std::vector<autoware_msgs::Waypoint> result; // 计算圆心坐标 double cx = waypoint.pose.pose.position.x; double cy = waypoint.pose.pose.position.y; // 计算直线方程中的常数项 double b = cy - k * cx; // 计算直线方程中一次项的系数 double a = k * k + 1; // 计算直线方程中二次项的系数 double c = cx * cx + cy * cy - r * r - 2 * b * cy + b * b; // 计算判别式 double delta = b * b - a * c; // 如果判别式小于0,则直线与圆没有交点 if (delta < 0) { return result; } // 计算交点坐标 double x1 = (-b + sqrt(delta)) / a; double x2 = (-b - sqrt(delta)) / a; double y1 = k * x1 + b; double y2 = k * x2 + b; // 将交点坐标保存到向量中 autoware_msgs::Waypoint point1 = waypoint; point1.pose.pose.position.x = x1; point1.pose.pose.position.y = y1; result.push_back(point1); autoware_msgs::Waypoint point2 = waypoint; point2.pose.pose.position.x = x2; point2.pose.pose.position.y = y2; result.push_back(point2); return result; } ``` 这个函数需要传入一个 `autoware_msgs::Waypoint` 类型的点、一个斜率 `k` 和一个圆的半径 `r`,并返回一个 `std::vector<autoware_msgs::Waypoint>` 类型的向量,其中包含直线与圆的交点的坐标。函数首先计算圆心的坐标,然后使用给定的斜率 `k` 和圆心的坐标计算直线方程,同时计算圆的方程。然后,它计算判别式,以确定直线与圆是否相交。如果判别式小于0,则直线与圆没有交点,函数将返回一个空向量。否则,它将计算交点的坐标,并将它们存储在一个向量中,然后将该向量返回。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值