Move tests to specfic folder
Adjust for tests, item and obstacles with 1,1,1 size
RRT Planning with no rotation
New test map
Test
Map
ROS Interface