Updating init function to robot, adding makefile