There was an error while loading. Please reload this page.
1 parent 0d3fce4 commit 225941fCopy full SHA for 225941f
src/lidar/src/lidar_node.cpp
@@ -36,7 +36,7 @@ double heightArray[IMAGE_HEIGHT][IMAGE_WIDTH];
36
// returns 0 if not in range, 1 if in range and row/column are set
37
int map_pc2rc(double x, double y, int *row, int *column){
38
// Check if falls within range
39
- if(x > (IMAGE_WIDTH * -0.5 * 0.1) && x < (IMAGE_WIDTH * 0.5 * 0.1) && y > (IMAGE_HEIGHT * -0.5 * 0.1) && y < (IMAGE_HEIGHT * 0.5 * 0.1)){
+ if(x > (IMAGE_HEIGHT * -0.5 * BIN) && x < (IMAGE_HEIGHT * 0.5 * BIN) && y > (IMAGE_WIDTH * -0.5 * BIN) && y < (IMAGE_WIDTH * 0.5 * BIN)){
40
// Find x -> row mapping
41
*row = (int)round(floor(((((IMAGE_HEIGHT*BIN)/2.0) - x)/(IMAGE_HEIGHT*BIN)) * IMAGE_HEIGHT)); // obviously can be simplified, but leaving for debug
42
0 commit comments