SafePosePathBuilder

constructor(path: PositionPath<Arclength>, beginHeading: Rotation2d)
constructor(path: PositionPath<Arclength>, beginHeading: Double)