Add CubicPostureError which penalizes the posture error, velocity and accleration by approximating the postures as a cubic spline