hw1 code almost cleaned up, still need to comment
updated with robot quivers and step option