realsense d455 semantic_slam实现语义八叉树建图

orb_slam2 + 语义分割 + 八叉树地图,
github地址:https://github.com/floatlazer/semantic_slam

环境配置参考链接

现在说说要用d455来实现实时建图,需要修改哪些地方。

首先要安装intel realsense的sdk,
到realsense-viewer可成功显示界面即成功

然后安装realsense的ros wrapper, 让d455可通过ros发送topic
安装方法
这一步需要同时安装ddynamic_reconfigure包,从github上下载下来,
和realsen_ros同放在catkin_ws/src下make即可

直到roslaunch realsense_camera rs_rgbd.launch能启动

关于深度图用哪个topic的问题:
深度图有的地方说要用/camera/depth/image_rect_raw
也有的说用/camera/aligned_depth_to_color/image_raw
(具体相机发布了哪些topic可以用rostopic list命令确认)
注意用roslaunch realsense_camera rs_camera.launch启动相机是没有/camera/aligned_depth_to_color/image_raw的

在rviz里观察了一下/camera/depth/image_rect_raw 和 /camera/aligned_depth_to_color/image_raw两个图片,
发现/camera/aligned_depth_to_color/image_raw的深度图是和rgb图像对齐的,
也就是说/camera/depth/image_rect_raw 这个深度图照的范围可能会比rgb图像更广,叠在一起的话可能都不会重叠。
所以我选了/camera/aligned_depth_to_color/image_raw,
当然不同的相机可能会不一样。

确定了rgb图像/camera/color/image_raw和深度图/camera/aligned_depth_to_color/image_raw之后,
要修改orb_slam2下的ros_rgbd.cc, 修改topic名称。

然后要修改semantic_slam/semantic_slam/params下的semantic_cloud.yaml,修改topic
同时需要修改语义网络的path,即model_path,到pth文件的地方

修改相机内参:
相机标定有几种方法,可以用ros包,realsense自带的命令,也可以拍几张图片用matlab标定,
标定好之后,修改semantic_slam/semantic_slam/params下的semantic_cloud.yaml和xtion.yaml,
xtion.yaml文件是启动orb_slam2的配置文件。

这个时候语义分割图片已经能显示出来了,但是显示不了八叉图地图!
问题出在哪呢,
可以看到问题出在semantic_cloud.py,里面直接用了深度图,而没有用DepthMapFactor进行scale,
而我们可以看到在orb_slam2中深度图是经过了scale的

imDepth.convertTo(imDepth,CV_32F,mDepthMapFactor);

我们需要做同样的事情,在semantic_cloud.yaml中定义DepthMapFactor,然后把semantic_cloud.py中的深度图进行scale。

然后就能建图啦:
在这里插入图片描述

  • 3
    点赞
  • 31
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 1
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

蓝羽飞鸟

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值