/// <summary>
/// Updates the current vehicle
/// </summary>
/// <param name="lane"></param>
/// <param name="state"></param>
public void Update(IFQMPlanable lane, VehicleState state)
{
// get the forward path
LinePath p = lane.LanePath();
// get our position
Coordinates f = state.Front;
// get all vehicles associated with those components
List <VehicleAgent> vas = new List <VehicleAgent>();
foreach (IVehicleArea iva in lane.AreaComponents)
{
if (TacticalDirector.VehicleAreas.ContainsKey(iva))
{
vas.AddRange(TacticalDirector.VehicleAreas[iva]);
}
}
// get the closest forward of us
double minDistance = Double.MaxValue;
VehicleAgent closest = null;
// set the vehicles to ignore
this.VehiclesToIgnore = new List <int>();
// get clsoest
foreach (VehicleAgent va in vas)
{
// get position of front
Coordinates frontPos = va.ClosestPosition;
// check relatively inside
if (lane.RelativelyInside(frontPos))
{
// distance to vehicle
double frontDist = lane.DistanceBetween(f, frontPos);
// check forward of us
if (frontDist > 0)
{
// add to ignorable
this.VehiclesToIgnore.Add(va.VehicleId);
// check for closest
if (frontDist < minDistance)
{
minDistance = frontDist;
closest = va;
}
}
}
}
this.CurrentVehicle = closest;
this.currentDistance = minDistance;
}
/// <summary>
/// Updates the current vehicle
/// </summary>
/// <param name="lane"></param>
/// <param name="state"></param>
public void Update(IFQMPlanable lane, VehicleState state)
{
// get the forward path
LinePath p = lane.LanePath();
// get our position
Coordinates f = state.Front;
// get all vehicles associated with those components
List<VehicleAgent> vas = new List<VehicleAgent>();
foreach (IVehicleArea iva in lane.AreaComponents)
{
if (TacticalDirector.VehicleAreas.ContainsKey(iva))
vas.AddRange(TacticalDirector.VehicleAreas[iva]);
}
// get the closest forward of us
double minDistance = Double.MaxValue;
VehicleAgent closest = null;
// set the vehicles to ignore
this.VehiclesToIgnore = new List<int>();
// get clsoest
foreach (VehicleAgent va in vas)
{
// get position of front
Coordinates frontPos = va.ClosestPosition;
// check relatively inside
if (lane.RelativelyInside(frontPos))
{
// distance to vehicle
double frontDist = lane.DistanceBetween(f, frontPos);
// check forward of us
if (frontDist > 0)
{
// add to ignorable
this.VehiclesToIgnore.Add(va.VehicleId);
// check for closest
if (frontDist < minDistance)
{
minDistance = frontDist;
closest = va;
}
}
}
}
this.CurrentVehicle = closest;
this.currentDistance = minDistance;
}
