Partially done with obstacle avoidance node

[emmaskychuks]

I need help with arranging the files (e.g header files) to their correct location in the ROS package. It also needs testing.