how to save/process WHOLE map of rgbdslam
Hi, I am having trouble saving the whole map as seen in the gui of rgbdslam. I need the whole map for path planning. I created a node that listens to /rgbdslam/batch_clouds topic and data were flowing in successfully, as Rviz displays.
I want to perform a planar segmentation and obtain the floor as described in this tutorial:http pointclouds.org documentation tutorials extract_indices.php #extract-indices
The relevant part of the code in this tutorial were placed in the call back function (the function for processing rostopic data as described in ros tutorials) of my program.
And then after I ran my program, where I saved the output to a pcd file and view it via pcd_viewer, only the floor of the last captured frame is displayed, but not the whole map.
The write function (which saves the point cloud into the pcd file) is carried out within the call back function of my program which should be the cause of the problem. Where should I put the write function so that it saves not the last frame but the whole map? Or am I looking at this problem wrongly?
An option would be to save the map as an octomap (.ot extension) using the options avaiable in the gui. I could view the whole map on octovis. But the documentation for octomap is rather poor and I do no know how to manipulate the data to get the floor which I need for path planning.
I am also not sure how to read .ot files and convert them to pointcloud data; not much info can be found regarding ".ot" files.
I have considered a solution in here, but my camera will be place 45 degrees towards the floor, so this solution is insufficient.
Thanks in advance!