Support occupancy grid cells #3032
Conversation
SamerKhshiboun
force-pushed
the
occupancy-fix
branch
3 times, most recently
from
ebda453
to
ebdc11e
Compare
| msg.cell_width = cell_size; | ||
| msg.cell_height = cell_size; | ||
|
|
||
| for (auto i = 0; i < cols * rows; ++i) |
There was a problem hiding this comment.
@SamerKhshiboun, just thinking out loud for future enhancement. Maybe it makes sense to parallelize this operation by using SSSE3 or GPU acceleration. your thoughts?
There was a problem hiding this comment.
Yes, I think it worth checking if we can accelerate this.
If so, we can do this in a separated task.
Thanks for the advice !
| msg.cell_width = cell_size; | ||
| msg.cell_height = cell_size; | ||
|
|
||
| for (auto i = 0; i < cols * rows; ++i) |
There was a problem hiding this comment.
Does this means rows and columns represent the cells and not the bytes?
meaning they are in bit units?
raws = 8 is 1 byte?
There was a problem hiding this comment.
rows = grid cell height, cols = grid cell width
added more documentation for this code
| geometry_msgs::msg::Point p3d; | ||
| uint32_t row = (i / cols); | ||
| uint32_t col = (i % cols); | ||
| p3d.x = (cell_size * static_cast<float>(rows)) - cell_size * (static_cast<float>(row) + 0.5f); |
There was a problem hiding this comment.
I would expect x axis will use columns and not rows, can you explain this line?
There was a problem hiding this comment.
in ROS CS, X is forward, Y is left, and Z is up.
in AICV algo ROWS represents the height is and COLS represents the width.
| { | ||
| // find x,y,z positions of current index | ||
| geometry_msgs::msg::Point p3d; | ||
| uint32_t row = (i / cols); |
There was a problem hiding this comment.
raw is calculates from cols?
Why not from RS2_FRAME_METADATA_OCCUPANCY_GRID_ROWS?
SamerKhshiboun
force-pushed
the
occupancy-fix
branch
from
ebdc11e
to
f6886c0
Compare
Tracked by [LRS-996]