Added a file with a function for easily put the robot in home position for navigation or other needs