public double distance(Pose2dWithCurvature other)
{
return(getPose().distance(other.getPose()));
}
public Pose2dWithCurvature interpolate(Pose2dWithCurvature other, double x)
{
return(new Pose2dWithCurvature(getPose().interpolate(other.getPose(), x),
interpolate(getCurvature(), other.getCurvature(), x),
interpolate(getDCurvatureDs(), other.getDCurvatureDs(), x)));
}