Autonomous mobile robot code for robot hockey competition