Added A* heuristic to speed up searches and decrease processing time required.  TODO:  Allow robot to learn about walls more quickly without noise becoming an issue.  As of right now, the robot headbuts the first wall when run on certain computers.