wrote out goals and states for mock 3; cleared most of the errors but completely untested on actual robot