标签：Lane No 寻迹 Autoware 点击 设置 velodyne 加载

1. 前言

好多初创公司公布出来的视频明显都是寻迹的效果，不是说寻迹不好，相反可以证明，寻迹是自动技术开始的第一步。

自动驾驶寻迹：一种能够自动按照给定的路线（通常是采用不同颜色或者其他信号标记来引导）进行移动的汽车。

本章内容有和No. 1、No. 2与No. 3重复的内容，为了方便自己调试，我将重复的内容也贴出来。

注意：所有需要在 [Simulation] 菜单下加载的数据，都需要在所有操作之前操作，否则在RViz显示时，会出现frame_id错误。

采用寻迹方式，首先要做的就是要确定汽车离航迹点集上的那个点最近，然后通过control算法将车辆移动到该航迹点上。所以寻迹寻迹方法最核心的操作同样是定位。

本节寻迹我们同样仿真数据与真车实测两个方式来介绍

 

2. 仿真数据寻迹

 

2.1 打开runtime manager

 

2.2 打开地图要定位的数据（在百度网盘中有，这是我们录制的用于定位的数据） 

进入 [Simulaton] 页面，点击界面右上方 [Ref] 按钮，加载录制用于定位的 bag 文件。

 

 

点击 [Play] 然后点击 [Pause]暂停。

 

2.3 加载地图，加载world到map以及base_link到velodyne的TF变化

 

(1) 设置从base_link到velodyne坐标系的TF（与No. 1重复）

在 [Setup] 菜单中，确保 [Localizer] 下选项为 [Velodyne]，在 [Baselink to Localizer] 中设置好各个参数之后点击 TF 按钮，其中x、y、z、yaw、pitch、roll表示真车雷达中心点与车身后轴中心点的相对位置关系（右手坐标系，真车后车轴为原点），此时可以点击[Vehicle Model]，如果[Vehicle Model]为空，那么会加载一个默认模型（在rviz显示时，如果有激光雷达数据，车辆会显示为黑色）。如下所示。

 

 

（2）设置从world到map转换（与No. 1重复） 

点击 [Map] 页面，点击 [TF] 的 [ref] 选择 autoware/ros/src/.config/tf/tf_local.launch 文件，这是加载默认world到map的坐标转换，打开tf_local.launch文件如下：  

<launch>

    <node pkg="tf" type="static_transform_publisher" name="world_to_map" args="0 0 0 0 0 0 /world /map 10" />

</launch>

 args的参数“0 0 0 0 0 0 /world /map 10”表示：从/world坐标系转换到/map坐标系的x, y, z, roll, pitch, yaw转换，且频率为10Hz。

点击 [TF] 按钮，如下图： 

  

（2）加载地图

选择runtime manager的 [Map] 菜单，点击 [Point Cloud] 按钮的 [ref]，加载培训笔记 No. 1产生的.pcd文件（点云地图），并点击 [Point Cloud] 按钮，进度条显示OK，则加载完毕，如下所示：

 

2.4 设置相关滤波器

 选择 [Sensing] 页面，点击 [Points Downsampler] 下 [voxel_grid_filter] 的 app，设置一些参数，[voxel_grid_filter] 是一种将采样方法，将点云数据用质心近似（用于降采用），如下图：

 

           

  

这里，[Voxel Leaf Size] 参数值为2，意义是2米的立方体内的全部点近似用1个质心代替。[Measurement Range]的参数值为2，意义是点云的有效的距离为200米。 

在[Sensing] 菜单下的 [Points Preprocesser] 下 [ring_ground_filter]，[app]设置如下：

              

[ring_ground_filter]用于区分地面与障碍物。参数描述如下：

[Sensor Model]参数为激光雷达的线扫条数，我们项目用的是16线激光雷达，这里我们选16；

[Sensor Height]参数表示传感器距离地面高度；

[Max Slope]表示最大的坡度，根据Alex如果不给出好坡度，容易将坡识别为障碍物；

[Vertical Thres]表示障碍物和地面的差异度，如果大于这个值则被认为是障碍。（这里还要看代码）

我们场地大约有一个5度的坡，所以需要设置这个参数。 

 

[Points Downsampler] 下的四个滤波器都可以选，但我只看了 [voxel_grid_filter] 滤波器，其他三个暂时没看，后续会陆续补充。

 

2.5 设置导航

（1）在 [Computing] 菜单栏右侧 [Mission Planning] 中勾选 [lane_rule]，[lane_stop]，[lane_select] 三个选项，如下图所示：

 

[lane_rule]表示设置当红灯亮时，停止线之前与之后点的个数。具体参数如上图：

[Acceleration]表示到达/通过停止线的加速度；

[Stopline Search Radius]表示搜索停止线圆心，半径1m的waypoints；

[Number of zeros ahead]/[Number of zeros behind]表示停止线前/后的waypoints个数，用于修改停止线前后waypoints的速度/加速度；

[Number_of_smoothing_count]用于平滑waypoints。

 

[lane_stop]用于识别红绿等，根据红绿灯的结果将停止线的waypoints变为红色（停止）或者绿色（继续形式）。

[Traffic Light]下的Red Light与Green Light用与手动调整当前路径处在红灯状态还是绿灯状态；

[Lane Change]用于变道，[<<Left Lane]与[Right Lane>>]用于变道的按钮。

[Current Lane]下的[Keep at]表示当前Lane保持的速度，[Stop in]表示停止时距离Stopline的最大距离。

 

[lane_select]用于将汽车行驶在可以选择的Lane上，如果 [waypoint_loader] 仅有一条Lane可以选择，那么选择这条路径。

[Distance threshold to neighbor lanes]表示表示检测当前路径周围的有效通道的阈值。 超过此阈值的车道不会被识别为车道；

[Lane Change Interval After Lane merge]指示在更改车道后可以运行多少米的值，您可以再次更改车道；

[Lane Change Target Ratio]（这个暂时还不太明白作用）

[Lane Change Target minimum(m)]表示讲变道到目标车道上目标点的最小距离；

[Vector Length of Hermite Curve(m)]表示用Hermite曲线上waypoints的向量长度；

 

上述三个设置全部用默认值。

 

（2）在菜单栏 [Computing] 右侧的 [astar_planner] 下的 [obstacle_avold], [velocity_set] 并勾选，如下所示：

 

[obstacle_avold]表示避障的相关参数；

[velocity_set]表示避障速度设置的相关参数。

 

上面 [app] 参数还在看代码，日后补充

 

以上参数全部采用默认值。

 

（3）在菜单栏 [Computing] 右侧的 [waypoint_maker] 下的 [waypoint_loader] 加载waypoints。

 

选择 [Ref] 加载之前保存下来的路点文件，并点击 [Close] 关闭页面。勾选 [waypoint_loader] ，如下图所示：

 

这里需要勾选[disable_decision_maker]。

 

（4）在 [Computing] 菜单栏，找到 [waypoint_follower] 下 [pure_pursuit] 与 [twist_filter] 的 [app] 进行设置。

                  

 

[waypoint_follower] 的 [app] 在打开的菜单栏如上左图所示，勾选 [Dlalog] 选项，确保 [Velocity]( 手动设置速度 ) 选项值不能太大，因为这里是路点跟随中设置速度的地方，[Waypoint] 模式下速度即是制作路点文件中记录的 bag 文件的车速，已经被写入路点文件中，而 [Dlalog] 模式则可以手动设置车辆速度。

[waypoint_follower] （详细参数还没有看，日后补充）

 

2.6 运行仿真数据

打开 [Rviz], 在 [file] 菜单中的 [open config] 选择路径：autoware/ros/src/.config/rviz/default.rviz 的文件。这是回到runtime manager，进入 [Simulaton] 页面，点击 [Pause]开始。这时可以从RViz中看到一辆黑色的带有激光雷达数据的汽车停在地图的右下方，如下图所示：

 

运行效果如下：

 

 

 3. 真车寻迹

真车寻迹与仿真寻迹类似，差别在于仿真定位采用事先记录的数据，真车定位采用实际的激光雷达。

 

3.1 打开runtime manager

 

3.2 启动激光雷达（与No.1 重复内容）

（1）针对velodyne 多线lidar

如果你有velodyne激光可以启动默认配置：[Sensing] 页面下 [Lidars] 选项下针对你的velodyne选择，velodyne激光对应的发布的点云topic：/velodyne_packets，frame_id：velodyne，topic会被重映射成为/points_raw。

例如：假如你有16线激光，点选 [velodyne VLP-16] 的 [config]，点选[ref]，加载/home/pix/Autoware/ros/src/sensing/drivers/lid ar/packages/velodyne/velodyne_pointcloud/param s/VLP16db.yaml路径下的配置文件（自己多线激光雷达可以针对这个配置改写），退出 [config]，勾选 [velodyne VLP-16] 选项（一般的操作都是先修改config或者app下的配置或参数文件，然后勾选选项）。

                

查看点云输出。

 

（2）针对其他品牌多线lidar

如果你有其他品牌的激光，他们发布的topic不是/velodyne_packets，且frame_id同样不对应，这时可以自己写个程序转一下，参照：https://www.cnblogs.com/hgl0417/p/11067660.html。然后单独运行你的lidar driver node，将你的点云数据模拟成velodyne数据。此时，不需要点选runtime manager上的lidar配置文件（每个配置文件对应一个package或者node，意义在于将对应的topic发布，此时你已经发布了topic，所以不需要在点选上述配置文件）。

 

3.2 加载地图，开启相关设置

重复上述2.2~2.5的操作

 

3.3 启动底盘连接

由于我们的车底盘的CAN已经做好了，所以在这里，我们只需点击 [Interface] 菜单下的 [Gateway] 按钮就可以链接底盘。

 

3.4 启动汽车的自动驾驶

我们轿车为了安全，启动环节比较复杂，感谢老司机每天重复这样的操作

自动驾驶成功。

 

标签：Lane,No,寻迹,Autoware,点击,设置,velodyne,加载
来源： https://www.cnblogs.com/hgl0417/p/11147109.html

本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享；
2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关；
3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关；
4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除；
5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。