Improved naviagtion using beizer curves, now moves to node before intersections, moves through intersection before moving on to either the next intersection or the end goal