CMU 16-662 Robot Autonomy Homework Repo