bezierToSplineHeading
fun bezierToSplineHeading(controlPoints: List<Vector2d>, heading: Rotation2d, velConstraintOverride: VelConstraint? = null, accelConstraintOverride: AccelConstraint? = null): TrajectoryBuilder
fun bezierToSplineHeading(controlPoints: List<Vector2d>, heading: Double, velConstraintOverride: VelConstraint? = null, accelConstraintOverride: AccelConstraint? = null): TrajectoryBuilder
Adds a curved path using a Bezier curve, with the current pose of this builder as the first control point and controlPoints as the remaining control points. The robot's heading is interpolated from its current heading to heading using a spline.