Robot Autonomy HW1