public TrajectoryStatePoint(Pose2dWithCurvature state, double t, double velocity, double acceleration)
{
mState = state;
this.t = t;
this.velocity = velocity;
this.acceleration = acceleration;
}
public TrajectorySamplePoint(Pose2dWithCurvature state, int index_floor, int index_ceil)
{
mState = state;
mIndex_floor = index_floor;
mIndex_ceil = index_ceil;
}
public TrajectorySamplePoint(TrajectoryPoint point)
{
mState = point.mState;
mIndex_floor = mIndex_ceil = point.mIndex;
}
public TrajectoryPoint(Pose2dWithCurvature state, int index)
{
mState = state;
mIndex = index;
}
public TrajectoryStatePoint(Pose2dWithCurvature state)
{
mState = state;
}
