incoorporated the obstacle avoidance some. After perfecting the basics with that, need to focus primarily on refactoring the code.