Reimplemented PlayForwardInXAndXd to work for any quadratic function of x and xd independent of where it was linearized. Added a test to demonstrate both accuracy of the playforward w.r.t. to the quadratic approximation independent of where the taylor approximation was created, as well as the superiority of the future linearization point for the taylor approximation amid high curvature.