rep进行地图构建仿真(2)

  V-rep中的视觉传感器可以探测到障碍物的坐标以及与其距离,上面的X-Y图就是直接采用坐标点画出的。然而一般激光雷达只能探测障碍物距离,不能直接获取其坐标,我们可以将距离画成与角度对应的极坐标图。将距离数据保存为CSV文件,用Mathematica读入并画出极坐标图:

ranges = Flatten[Import["C:\\Users\\Administrator\\Desktop\\distance.csv"]]; ListPolarPlot[ranges, DataRange -> {-135 Degree, 135 Degree}]

rep进行地图构建仿真

 发布LaserScan消息 

   下面的代码将激光雷达扫描数据按照LaserScan的消息格式发布出去:

rep进行地图构建仿真

内容版权声明:除非注明,否则皆为本站原创文章。

转载注明出处:https://www.heiqu.com/524f2e50ad7761be73d948fd9299c85f.html