76 lines
3.0 KiB
C#
76 lines
3.0 KiB
C#
using System;
|
|
|
|
namespace MultiWheelC.TrajectoryPlanning.EMPlanner;
|
|
|
|
/// <summary>Immutable identity bound to one rolling planning cycle.</summary>
|
|
public sealed class PlanningCycleIdentity : IEquatable<PlanningCycleIdentity>
|
|
{
|
|
public PlanningCycleIdentity(long mapSnapshotId, string referencePathId, long vehicleStateSequenceId,
|
|
string previousTrajectoryId, int segmentIndex)
|
|
{
|
|
if (mapSnapshotId < 0)
|
|
throw new ArgumentOutOfRangeException(nameof(mapSnapshotId));
|
|
if (string.IsNullOrWhiteSpace(referencePathId))
|
|
throw new ArgumentException("A reference path ID is required.", nameof(referencePathId));
|
|
if (vehicleStateSequenceId < 0)
|
|
throw new ArgumentOutOfRangeException(nameof(vehicleStateSequenceId));
|
|
if (segmentIndex < 0)
|
|
throw new ArgumentOutOfRangeException(nameof(segmentIndex));
|
|
|
|
MapSnapshotId = mapSnapshotId;
|
|
ReferencePathId = referencePathId;
|
|
VehicleStateSequenceId = vehicleStateSequenceId;
|
|
PreviousTrajectoryId = previousTrajectoryId ?? string.Empty;
|
|
SegmentIndex = segmentIndex;
|
|
}
|
|
|
|
public long MapSnapshotId { get; }
|
|
|
|
public string ReferencePathId { get; }
|
|
|
|
public long VehicleStateSequenceId { get; }
|
|
|
|
public string PreviousTrajectoryId { get; }
|
|
|
|
public int SegmentIndex { get; }
|
|
|
|
public static PlanningCycleIdentity FromRequest(EmPlanningRequest request)
|
|
{
|
|
if (request == null)
|
|
throw new ArgumentNullException(nameof(request));
|
|
if (request.Map == null)
|
|
throw new ArgumentException("A planning map is required for a rolling cycle.", nameof(request));
|
|
if (request.VehicleState == null)
|
|
throw new ArgumentException("A vehicle state is required for a rolling cycle.", nameof(request));
|
|
|
|
return new PlanningCycleIdentity(request.Map.SnapshotId, request.ReferencePathId,
|
|
request.VehicleState.SequenceId, request.PreviousTrajectoryId, request.SegmentIndex);
|
|
}
|
|
|
|
public bool Equals(PlanningCycleIdentity other)
|
|
{
|
|
return other != null && MapSnapshotId == other.MapSnapshotId &&
|
|
string.Equals(ReferencePathId, other.ReferencePathId, StringComparison.Ordinal) &&
|
|
VehicleStateSequenceId == other.VehicleStateSequenceId &&
|
|
string.Equals(PreviousTrajectoryId, other.PreviousTrajectoryId, StringComparison.Ordinal) &&
|
|
SegmentIndex == other.SegmentIndex;
|
|
}
|
|
|
|
public override bool Equals(object obj)
|
|
{
|
|
return Equals(obj as PlanningCycleIdentity);
|
|
}
|
|
|
|
public override int GetHashCode()
|
|
{
|
|
unchecked
|
|
{
|
|
int hash = MapSnapshotId.GetHashCode();
|
|
hash = (hash * 397) ^ StringComparer.Ordinal.GetHashCode(ReferencePathId);
|
|
hash = (hash * 397) ^ VehicleStateSequenceId.GetHashCode();
|
|
hash = (hash * 397) ^ StringComparer.Ordinal.GetHashCode(PreviousTrajectoryId);
|
|
return (hash * 397) ^ SegmentIndex;
|
|
}
|
|
}
|
|
}
|