This function is run when the robot is first started up and should be used for any initialization code.