added the initial underlinings of obstacle avoidance
incoorporated the obstacle avoidance some. After perfecting the basics with that, need to focus primarily on refactoring the code.
some work on the eigenvectors and heading worked out. Still more to do
robot autonomous direction now updated based on robot direction and position relative to the map direction and position