Homework 3 for Robot Autonomy