Changed initRobot function to be a member function of Init class