Added code to RobotTemplate