How to run ? To run , clone this repo into your catkin_ws run catkin_make , to compile the package Then first the simulation of the robot made by us(remember to checkout sensor branch!) Run the code rosrun go_to_goal controller.py Output: