Improved default trunction. Added simulation and plotting package. Added unit testing package. Updated look-ahead to extend the end of the road by a straight line.