Finished FindTarget and wrote PositionRobot