robot autonomy hw4