Added wall_following_controller. It still needs to be checked on the robot