OccupancyGridUpdate - Data is not being processed correctly

[Eric-Bwr]

Using Ubuntu 20.04 with ros2-foxy.

The std::copy is faulty, replacing it by a for loop fixes the incorrect updating of the costmap.
You are currently not able to set each pixels value as the std::copy fills the entire x axis with the first value of itself.
Fixed in: #895

[Eric-Bwr]

One can simply reproduce this issue by trying to upload a checker-board pattern. (x % 2 == 0 || y % == 0) and change the color depending on that:
if(bbX % 2 == 0 || bbY % 2 == 0) theMessage->data[bbX + bbY * bW] = 2; else theMessage->data[bbX + bbY * bW] = 50;

[Eric-Bwr]

I will close this because the fix has been merged.