So now that we have established that we need a goal to goal behavior, and possibly an avoid obstacle behavior in order to go between points a and b and we have figured out that if we have a differential drive robot that we can model as a unicycle 