Homework #4 for Robot Autonomy