Create Occupancy Grid from Matrix
Hi there!
I currently have a matrix with each cell representing 1cm² and a value associated to it. What I'd like to do is create an ocuppancy grid to display it in RViz on top of my PointCloud and see if it matches. The value of the cell means how many points of that PointCloud fall in it, so I know the position of my (0,0) cell and then every other is one cm away from each other. How can I do it?
Thanks!