private static LineP getLine(Line nline)
{
LineP line = new LineP();
line.start = new Vector(nline.A.longitude, nline.A.latitude, 0);
line.end = new Vector(nline.B.longitude, nline.B.latitude, 0);
line.orientation = new Vector(nline.O.longitude, nline.O.latitude, 0);
return(line);
}
/// <summary>
/// Find the intersection of data with fix
/// </summary>
/// <param name="data"></param>
/// <param name="fix"></param>
/// <returns></returns>
private static double getIntersection(LineP data, LineP fix)
{
Vector intersection = Vector.Interception(data.start, data.end, fix.start, fix.end);
if (intersection != null)
{
return(Vector.Abs(intersection - data.start) / Vector.Abs(data.end - data.start));
}
return(-1);
}
private static bool intersectsProhAreaPoint(List <LineP> penaltyZones, LineP data, out bool changedState, out IntersectionPoint ip)
{
changedState = false;
bool result = false;
ip = new IntersectionPoint();
foreach (LineP nl in penaltyZones)
{
IntersectionPoint ip1 = new IntersectionPoint();
if (getIntersection(data, nl, out ip1))
{
ip = ip1;
result = true;
changedState = !changedState;
}
}
return(result);
}
private static bool intersectsOwnChannel(List <LineP> ownChannel, LineP data, out bool changedState, out IntersectionPoint ip)
{
changedState = false;
bool result = false;
ip = new IntersectionPoint();
foreach (LineP nl in ownChannel)
{
IntersectionPoint ip1 = new IntersectionPoint();
if (getIntersection(data, nl, out ip1))
{
ip = ip1;
result = true;
changedState = !changedState;
}
}
return(result);
}
private static LineP getEndLine(ParcourSet parcour, Route type)
{
Line nl = null;
try
{
switch (type)
{
case Route.A:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.END_A); break;
}
case Route.B:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.END_B); break;
}
case Route.C:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.END_C); break;
}
case Route.D:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.END_D); break;
}
}
}
catch { }
LineP l = null;
if (nl != null)
{
l = new LineP();
l.start = new Vector(nl.A.longitude, nl.A.latitude, 0);
l.end = new Vector(nl.B.longitude, nl.B.latitude, 0);
l.orientation = new Vector(nl.O.longitude, nl.O.latitude, 0);
}
return(l);
}
/// <summary>
/// Find the intersection of data with fix. Insersection point ip is output parameter
/// </summary>
/// <param name="data"></param>
/// <param name="fix"></param>
/// <param name="ip"></param>
/// <returns></returns>
private static bool getIntersection(LineP data, LineP fix, out IntersectionPoint ip)
{
ip = new IntersectionPoint();
bool res = false;
Vector intersectionV = Vector.Interception(data.start, data.end, fix.start, fix.end);
if (intersectionV != null)
{
double intersection = Vector.Abs(intersectionV - data.start) / Vector.Abs(data.end - data.start);
long timestmp = data.TimestamStart + (long)Math.Truncate((data.TimestamEnd - data.TimestamStart) * intersection);
double x = data.start.X + (data.end.X - data.start.X) * intersection;
double y = data.start.Y + (data.end.Y - data.start.Y) * intersection;
double z = data.start.Z + (data.end.Z - data.start.Z) * intersection;
ip.longitude = x;
ip.latitude = y;
ip.altitude = z;
ip.Timestamp = timestmp;
res = true;
return(res);
}
return(res);
}
public static List <PenaltySet> CalculatePenaltyPoints(FlightSet flight, out List <IntersectionPoint> lstIntersectionPoints)
{
bool useProhZoneCalculation = false;
Point last = null;
List <PenaltySet> result = new List <PenaltySet>();
List <LineP> PenaltyZoneLines = new List <LineP>();
// intersectionPoints will contain the intersection poinst of the flight path with SP, FP, PROH areas
List <IntersectionPoint> intersectionPoints = new List <IntersectionPoint>();
QualificationRoundSet qr = flight.QualificationRoundSet;
ParcourSet parcour = flight.QualificationRoundSet.ParcourSet;
useProhZoneCalculation = (parcour.PenaltyCalcType != (int)ParcourType.CHANNELS);
List <LineP> ChannelZoneLines = getAssignedChannelLineP(parcour, (Route)flight.Route);
foreach (Line nl in parcour.Line.Where(p => p.Type == (int)LineType.PENALTYZONE))
{
PenaltyZoneLines.Add(getLine(nl));
}
// add also all channel-specific prohibited zones assigned channel
PenaltyZoneLines.AddRange(getAssignedProhZonelLines(parcour, (Route)flight.Route));
List <LineP> dataLines = new List <LineP>();
foreach (Point g in flight.Point)
{
if (last != null)
{
LineP l = new LineP();
l.end = new Vector(g.longitude, g.latitude, 0);
l.TimestamEnd = g.Timestamp;
l.start = new Vector(last.longitude, last.latitude, 0);
l.TimestamStart = last.Timestamp;
dataLines.Add(l);
}
last = g;
}
LineP startLine = getStartLine(parcour, (Route)flight.Route);
LineP endLine = getEndLine(parcour, (Route)flight.Route);
if (startLine == null || endLine == null)
{
lstIntersectionPoints = intersectionPoints;
return(result);
}
LineP takeOffLine = new LineP();
takeOffLine.start = new Vector(qr.TakeOffLine.A.longitude, qr.TakeOffLine.A.latitude, 0);
takeOffLine.end = new Vector(qr.TakeOffLine.B.longitude, qr.TakeOffLine.B.latitude, 0);
takeOffLine.orientation = Vector.Orthogonal(takeOffLine.end - takeOffLine.start);
long maxTimestamp = 0;
maxTimestamp = flight.Point.Max(x => x.Timestamp);
// For TakeOff-, Start- and End Line, we obviously(?) assume that these lines should have been passed two minutes before the end of recording
// below values are used in case they are not passed
bool shouldHaveCrossedTakeOff = (maxTimestamp - 2 * tickOfMinute) > flight.TimeTakeOff;
bool shouldHaveCrossedStart = (maxTimestamp - 2 * tickOfMinute) > flight.TimeStartLine;
bool shouldHaveCrossedEnd = (maxTimestamp - 2 * tickOfMinute) > flight.TimeEndLine;
bool haveCrossedTakeOff = false;
bool haveCrossedStart = false;
bool haveCrossedEnd = false;
bool insidePenalty = false;
long timeSinceInsidePenalty = 0;
bool outsideOwnChannel = true;
long timeSinceOutsideOwnChannel = 0;
bool isFirstTimeIntoChannel = true;
IntersectionPoint ipTakeOff = new IntersectionPoint();
IntersectionPoint ipStart = new IntersectionPoint();
IntersectionPoint ipEnd = new IntersectionPoint();
foreach (LineP l in dataLines)
{
double intersectionTakeOff = getIntersection(l, takeOffLine);
double intersectionStart = getIntersection(l, startLine);
double intersectionEnd = getIntersection(l, endLine);
IntersectionPoint ip = new IntersectionPoint();
#region crossing takeOff line
if (getIntersection(l, takeOffLine, out ip) && !haveCrossedTakeOff)
{
haveCrossedTakeOff = true;
intersectionPoints.Add(ip);
long crossTime = ip.Timestamp;
crossTime = ((crossTime + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // round
ipTakeOff = ip;
long diff = crossTime - flight.TimeTakeOff;
PenaltySet penalty = new PenaltySet();
penalty.Points = (diff > C_TKOF_TimeUpper * tickOfSecond || diff < C_TKOF_TimeLower * tickOfSecond) ? C_TKOF_MaxPenalty : 0;
penalty.Reason = string.Format("Take-off Line planned: {1}, actual: {0}", new DateTime((Int64)crossTime).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo), new DateTime((Int64)flight.TimeTakeOff).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo));
result.Add(penalty);
}
#endregion
#region crossing start line
if (getIntersection(l, startLine, out ip) & !haveCrossedStart)
{
haveCrossedStart = true;
intersectionPoints.Add(ip);
long crossTime = ip.Timestamp;
ipStart = ip;
long diff = Math.Abs(crossTime - flight.TimeStartLine);
crossTime = ((crossTime + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // round
int sec = (int)((diff + (tickOfSecond / 2) + 1) / tickOfSecond);
PenaltySet penalty = new PenaltySet();
penalty.Points = (diff > C_SPFP_TimeTolerance * tickOfSecond) ? Math.Min((sec - C_SPFP_TimeTolerance) * C_PointsPerSec, C_SPFP_MaxPenalty) : 0;
penalty.Reason = string.Format("SP Line planned: {1}, actual: {0}", new DateTime((Int64)crossTime).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo), new DateTime((Int64)flight.TimeStartLine).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo));
result.Add(penalty);
}
#endregion
if (useProhZoneCalculation || ChannelZoneLines.Count == 0)
{
#region entering or leaving prohibited zone
bool stateChanged = false;
//IntersectionPoint ip = new IntersectionPoint();
if (intersectsProhAreaPoint(PenaltyZoneLines, l, out stateChanged, out ip))
{
if (stateChanged)
{
intersectionPoints.Add(ip);
if (!insidePenalty)
{
insidePenalty = true;
timeSinceInsidePenalty = ip.Timestamp;
}
else
{
insidePenalty = false;
long diff = ip.Timestamp - timeSinceInsidePenalty;
if (diff > tickOfSecond * C_PROH_TimeTolerance)
{
PenaltySet penalty = new PenaltySet();
// round times for entering/leaving penalty zone to nearest full second
long pstart = ((timeSinceInsidePenalty + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // rounded
long pend = ((ip.Timestamp + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // rounded
int sec = (int)((pend - pstart) / tickOfSecond);
penalty.Points = (sec - C_PROH_TimeTolerance) * C_PointsPerSec;
// Max penalty inside PROH zone: ======>> NOTE: acc FAI rules disabled after NOV 2017; zero means no maximum per event
penalty.Points = C_MaxPenaltyPerEvent > 0 ? Math.Min((sec - C_PROH_TimeTolerance) * C_PointsPerSec, C_MaxPenaltyPerEvent) : penalty.Points;
//penalty.Points = C_MaxPenaltyPerEvent > 0 ? Math.Min((sec - 5) * 3, C_MaxPenaltyPerEvent) : penalty.Points;
penalty.Reason = string.Format("Penalty zone for {0} sec, [{1} - {2}]", sec, new DateTime(pstart).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo), new DateTime(pend).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo));
result.Add(penalty);
}
}
}
}
#endregion
}
else
{
#region entering or leaving channel
bool stateChanged = false;
if (intersectsOwnChannel(ChannelZoneLines, l, out stateChanged, out ip))
{
if (stateChanged)
{
intersectionPoints.Add(ip);
if (!outsideOwnChannel)
{
outsideOwnChannel = true;
timeSinceOutsideOwnChannel = ip.Timestamp;
}
else
{
if (isFirstTimeIntoChannel)
{
isFirstTimeIntoChannel = false;
if (haveCrossedStart)
{
timeSinceOutsideOwnChannel = ipStart.Timestamp;
}
else
{
timeSinceOutsideOwnChannel = flight.TimeStartLine;
}
}
outsideOwnChannel = false;
long diff = ip.Timestamp - timeSinceOutsideOwnChannel;
if (diff > tickOfSecond * C_PROH_TimeTolerance)
{
PenaltySet penalty = new PenaltySet();
// round times for entering/leaving penalty zone to nearest full second
long pstart = ((timeSinceOutsideOwnChannel + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // rounded
long pend = ((ip.Timestamp + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // rounded
int sec = (int)((pend - pstart) / tickOfSecond);
penalty.Points = (sec - C_PROH_TimeTolerance) * C_PointsPerSec;
penalty.Points = C_MaxPenaltyPerEvent > 0 ? Math.Min((sec - C_PROH_TimeTolerance) * C_PointsPerSec, C_MaxPenaltyPerEvent) : penalty.Points;
//penalty.Points = C_MaxPenaltyPerEvent > 0 ? Math.Min((sec - 5) * 3, C_MaxPenaltyPerEvent) : penalty.Points;
penalty.Reason = string.Format("outside channel for {0} sec, [{1} - {2}]", sec, new DateTime(pstart).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo), new DateTime(pend).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo));
result.Add(penalty);
}
}
}
}
else
{
// check if end line is passed now but outside the cannel. if yes, set outSideOwnChannel = false
if (getIntersection(l, endLine, out ip))
{
outsideOwnChannel = false;
long diff = ip.Timestamp - timeSinceOutsideOwnChannel;
if (diff > tickOfSecond * C_PROH_TimeTolerance)
{
PenaltySet penalty = new PenaltySet();
// round times for entering/leaving penalty zone to nearest full second
long pstart = ((timeSinceOutsideOwnChannel + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // rounded
long pend = ((ip.Timestamp + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // rounded
int sec = (int)((pend - pstart) / tickOfSecond);
penalty.Points = (sec - C_PROH_TimeTolerance) * C_PointsPerSec;
// Max penalty outside channel; zero value means no Max penalty
penalty.Points = C_MaxPenaltyPerEvent > 0 ? Math.Min((sec - C_PROH_TimeTolerance) * C_PointsPerSec, C_MaxPenaltyPerEvent) : penalty.Points;
//penalty.Points = C_MaxPenaltyPerEvent > 0 ? Math.Min((sec - 5) * 3, C_MaxPenaltyPerEvent) : penalty.Points;
penalty.Reason = string.Format("outside channel for {0} sec, [{1} - {2}]", sec, new DateTime(pstart).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo), new DateTime(pend).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo));
result.Add(penalty);
}
}
}
#endregion
}
#region crossing end line
if (getIntersection(l, endLine, out ip) & !haveCrossedEnd)
{
haveCrossedEnd = true;
intersectionPoints.Add(ip);
long crossTime = ip.Timestamp;
ipEnd = ip;
long diff = Math.Abs(crossTime - flight.TimeEndLine);
crossTime = ((crossTime + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // round
int sec = (int)((diff + (tickOfSecond / 2) + 1) / tickOfSecond);
PenaltySet penalty = new PenaltySet();
penalty.Points = (diff > C_SPFP_TimeTolerance * tickOfSecond) ? Math.Min((sec - C_SPFP_TimeTolerance) * C_PointsPerSec, C_SPFP_MaxPenalty) : 0;
penalty.Reason = string.Format("FP Line planned: {1}, actual: {0}", new DateTime((Int64)crossTime).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo), new DateTime((Int64)flight.TimeEndLine).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo));
result.Add(penalty);
}
#endregion
}
#region handling cases where Takeoff-, Start- or End line are not observed/never crossed
if (shouldHaveCrossedStart && !haveCrossedStart)
{
PenaltySet penalty = new PenaltySet();
penalty.Points = C_SPFP_MaxPenalty;
penalty.Reason = "SP Line not passed";
result.Insert(0, penalty); // add to begin of list
}
;
if (shouldHaveCrossedTakeOff && !haveCrossedTakeOff)
{
PenaltySet penalty = new PenaltySet();
penalty.Points = C_TKOF_MaxPenalty;
penalty.Reason = "Takeoff Line not passed";
result.Insert(0, penalty); // add to begin of list
}
;
if (shouldHaveCrossedEnd && !haveCrossedEnd)
{
PenaltySet penalty = new PenaltySet();
// TODO: handle the case where we have channel calculation but no FP line
if (!(useProhZoneCalculation || ChannelZoneLines.Count == 0) && outsideOwnChannel)
{
outsideOwnChannel = false;
long crossTime = flight.TimeEndLine;
long diff = Math.Abs(crossTime - timeSinceOutsideOwnChannel);
if (diff > C_SPFP_TimeTolerance * tickOfSecond)
{
crossTime = ((crossTime + (tickOfSecond / 2) + 1) / tickOfSecond) * tickOfSecond; // round
int sec = (int)((diff + (tickOfSecond / 2) + 1) / tickOfSecond);
penalty.Points = Math.Min((sec - C_SPFP_TimeTolerance) * C_PointsPerSec, C_SPFP_MaxPenalty);
penalty.Reason = string.Format("outside channel for {0} sec, [{1} - {2}]", sec, new DateTime(timeSinceOutsideOwnChannel).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo), new DateTime(crossTime).ToString(C_TimeFormat, DateTimeFormatInfo.InvariantInfo));
result.Add(penalty);
}
}
penalty = new PenaltySet();
penalty.Points = C_SPFP_MaxPenalty;
penalty.Reason = "FP Line not passed";
result.Add(penalty);
}
;
#endregion
lstIntersectionPoints = intersectionPoints;
return(result);
}
public static List<Penalty> CalculatePenaltyPoints(Flight flight)
{
List<Penalty> result = new List<Penalty>();
Point last = null;
List<LineP> PenaltyZoneLines = new List<LineP>();
QualificationRound qr = flight.QualificationRound;
Parcour parcour = flight.QualificationRound.Parcour;
foreach (Line nl in parcour.Line.Where(p => p.Type == ((int)LineType.PENALTYZONE)))
{
PenaltyZoneLines.Add(getLine(nl));
}
List<LineP> dataLines = new List<LineP>();
foreach (Point g in flight.Point)
{
if (last != null)
{
LineP l = new LineP();
l.end = new Vector(g.longitude, g.latitude, 0);
l.TimestamEnd = g.Timestamp;
l.start = new Vector(last.longitude, last.latitude, 0);
l.TimestamStart = last.Timestamp;
dataLines.Add(l);
}
last = g;
}
LineP startLine = getStartLine(parcour, (Route)flight.Route);
LineP endLine = getEndLine(parcour, (Route)flight.Route);
if (startLine == null || endLine == null)
{
return result;
}
LineP takeOffLine = new LineP();
takeOffLine.start = new Vector(qr.TakeOffLine.A.longitude, qr.TakeOffLine.A.latitude, 0);
takeOffLine.end = new Vector(qr.TakeOffLine.B.longitude, qr.TakeOffLine.B.latitude, 0);
takeOffLine.orientation = Vector.Orthogonal(takeOffLine.end - takeOffLine.start);
long maxTimestamp = 0;
foreach (Point d in flight.Point)
{
maxTimestamp = Math.Max(d.Timestamp, maxTimestamp);
}
bool shouldHaveCrossedTakeOff = (maxTimestamp - 2 * tickOfMinute) > flight.TimeTakeOff;
bool shouldHaveCrossedStart = (maxTimestamp - 2 * tickOfMinute) > flight.TimeStartLine;
bool shouldHaveCrossedEnd = (maxTimestamp - 2 * tickOfMinute) > flight.TimeEndLine;
bool haveCrossedTakeOff = false;
bool haveCrossedStart = false;
bool haveCrossedEnd = false;
bool insidePenalty = false;
double timeSinceInsidePenalty = 0;
foreach (LineP l in dataLines)
{
double intersectionTakeOff = getIntersection(l, takeOffLine);
double intersectionStart = getIntersection(l, startLine);
double intersectionEnd = getIntersection(l, endLine);
if (intersectionTakeOff != -1)
{
haveCrossedTakeOff = true;
long crossTime = (long) Math.Floor(l.TimestamStart + (l.TimestamEnd - l.TimestamStart) * intersectionStart);
long diff = crossTime - flight.TimeTakeOff;
int seconds = (int)(diff / tickOfSecond);
if (diff < 0)
{
seconds++;
}
if (seconds > 60 || seconds < 0)
{
Penalty penalty = new Penalty();
penalty.Points = 200;
penalty.Reason = "Crossed Takeoff-Line at " + new DateTime((Int64)crossTime).ToLongTimeString() + " instead of expected " + new DateTime((Int64)flight.TimeTakeOff).ToLongTimeString();
result.Add(penalty);
}
}
if (intersectionStart != -1)
{
haveCrossedStart = true;
long crossTime = (long)Math.Floor(l.TimestamStart + (l.TimestamEnd - l.TimestamStart) * intersectionStart);
long diff = crossTime - flight.TimeStartLine;
int seconds = (int)Math.Abs(diff / tickOfSecond);
if (diff < 0)
{
seconds++;
}
if (seconds > 1)
{
Penalty penalty = new Penalty();
penalty.Points = Math.Min((seconds-1) * 3, 200);
penalty.Reason = "Crossed Start-Line at " + new DateTime((Int64)crossTime).ToLongTimeString() + " instead of expected " + new DateTime((Int64)flight.TimeStartLine).ToLongTimeString();
result.Add(penalty);
}
}
if (intersectionEnd != -1)
{
haveCrossedEnd = true;
long crossTime = (long)Math.Floor(l.TimestamStart + (l.TimestamEnd - l.TimestamStart) * intersectionEnd);
long diff = crossTime - flight.TimeEndLine;
int seconds = (int)(Math.Abs(diff / tickOfSecond));
if (diff < 0)
{
seconds++;
}
if (seconds>1)
{
Penalty penalty = new Penalty();
penalty.Points = Math.Min((seconds-1) * 3, 200);
penalty.Reason = "Crossed End-Line at " + new DateTime((Int64)crossTime).ToLongTimeString() + " instead of expected " + new DateTime((Int64)flight.TimeEndLine).ToLongTimeString();
result.Add(penalty);
}
}
bool stateChanged = false;
double intersectionPenalty = intersectsPenaltyPoint(PenaltyZoneLines, l, out stateChanged);
if (intersectionPenalty != -1)
{
if (stateChanged)
{
if (!insidePenalty)
{
insidePenalty = true;
timeSinceInsidePenalty = intersectionPenalty;
}
else
{
insidePenalty = false;
int sec = (int)Math.Floor(((intersectionPenalty - timeSinceInsidePenalty) / tickOfSecond));
if (sec > 5)
{
Penalty penalty = new Penalty();
penalty.Points = Math.Min((sec-5) * 3, 300);
penalty.Reason = "Inside Penaltyzone for " + sec + " sec from " + new DateTime((Int64)timeSinceInsidePenalty).ToLongTimeString() + " to " + new DateTime((Int64)intersectionPenalty).ToLongTimeString();
result.Add(penalty);
}
}
}
}
}
if (shouldHaveCrossedTakeOff && !haveCrossedTakeOff)
{
Penalty penalty = new Penalty();
penalty.Points = 200;
penalty.Reason = "Takeoff not passed";
result.Add(penalty);
};
if (shouldHaveCrossedStart && !haveCrossedStart)
{
Penalty penalty = new Penalty();
penalty.Points = 200;
penalty.Reason = "Start not passed";
result.Add(penalty);
};
if (shouldHaveCrossedEnd && !haveCrossedEnd)
{
Penalty penalty = new Penalty();
penalty.Points = 200;
penalty.Reason = "End not passed";
result.Add(penalty);
};
return result;
}
/// <summary>
/// Return timestamp in ticks of relevant intersection
/// </summary>
/// <param name="penaltyZones"></param>
/// <param name="line"></param>
/// <param name="changedState"></param>
/// <returns></returns>
private static double intersectsPenaltyPoint(List<LineP> penaltyZones, LineP line, out bool changedState)
{
changedState = false;
double result = -1;
foreach (LineP nl in penaltyZones)
{
double intersection = getIntersection(line, nl);
if (intersection != -1)
{
changedState = !changedState;
result = (line.TimestamStart + (line.TimestamEnd - line.TimestamStart) * intersection);
}
}
return result;
}
private static LineP getStartLine(Parcour parcour, NetworkObjects.Route type)
{
Line nl = null;
try
{
switch (type)
{
case NetworkObjects.Route.A:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.START_A); break;
}
case NetworkObjects.Route.B:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.START_B); break;
}
case NetworkObjects.Route.C:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.START_C); break;
}
case NetworkObjects.Route.D:
{
nl = parcour.Line.Single(p => p.Type == (int)LineType.START_D); break;
}
}
}
catch { }
LineP l=null;
if (nl != null)
{
l = new LineP();
l.start = new Vector(nl.A.longitude, nl.A.latitude, 0);
l.end = new Vector(nl.B.longitude, nl.B.latitude, 0);
l.orientation = new Vector(nl.O.longitude, nl.O.latitude, 0);
}
return l;
}
private static LineP getLine(Line nline)
{
LineP line = new LineP();
line.start = new Vector(nline.A.longitude, nline.A.latitude, 0);
line.end = new Vector(nline.B.longitude, nline.B.latitude, 0);
line.orientation = new Vector(nline.O.longitude, nline.O.latitude, 0);
return line;
}
private static double getIntersection(LineP data, LineP fix)
{
Vector intersection = Vector.Interception(data.start, data.end, fix.start, fix.end);
if (intersection != null)
{
return Vector.Abs(intersection - data.start) / Vector.Abs(data.end - data.start);
}
return -1;
}