bezierToLinearHeading
fun bezierToLinearHeading(controlPoints: List<Vector2d>, heading: Rotation2d, velConstraintOverride: VelConstraint? = null, accelConstraintOverride: AccelConstraint? = null): TrajectoryBuilder
fun bezierToLinearHeading(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 linearly interpolated from its current heading to heading.