private void Button_Click(object sender, RoutedEventArgs e)
{
bool has_dont_linked = false;
for (int i = 0; i < VertexVisualsList.Count; i++)
{
if (VertexVisualsList[i].InCount == 0 && VertexVisualsList[i].OutCount == 0)
{
has_dont_linked = true;
}
}
if (has_dont_linked)
{
if (MessageBox.Show("Все точки, не имеющие связей (обозначены серым цветом) будут удалены. Продолжить?", "Внимание", MessageBoxButton.YesNo) == MessageBoxResult.No)
{
return;
}
List <WayPoint> remList = new List <WayPoint>();
foreach (var node in RoadGraph.Nodes)
{
int in_count = 0, out_count = 0;
foreach (var edge in RoadGraph.GetEdgesTo(node))
{
in_count++;
}
foreach (var edge in RoadGraph.GetEdgesFrom(node))
{
out_count++;
}
if (in_count == 0 && out_count == 0)
{
remList.Add(node);
}
}
for (int i = 0; i < remList.Count; i++)
{
RoadGraph.Remove(remList[i]);
}
}
//Собираем граф дорожной сети
//RoadGraph = new Graph<WayPoint, PathFigure>();
for (int i = 0; i < VertexVisualsList.Count; i++)
{
RoadGraph.Add(VertexVisualsList[i].Node);
}
for (int i = 0; i < EdgeVisualsList.Count; i++)
{
RoadGraph.AddEdge(EdgeVisualsList[i].NodeFrom, EdgeVisualsList[i].NodeTo, EdgeVisualsList[i].PathData);
}
DialogResult = true;
Close();
}
private Point CalculateCoordinateLocationOfCarrige()
{
double tmp = currentLength;
for (int i = 1; i < CheckPointsList.Count; i++)
{
//Поиск дороги
PathFigure road = null;
var edges = RoadGraph.GetEdgesFrom(CheckPointsList[i - 1]).GetEnumerator();
while (edges.MoveNext())
{
if (edges.Current.End.Equals(CheckPointsList[i]))
{
road = edges.Current.Data;
break;
}
}
//Если дорога не найдена
if (road == null)
{
CalculateAngle(position, CheckPointsList[i].LocationPoint);
position = CheckPointsList[i].LocationPoint;
return(new Point(-1, -1));
}
//Если найдена
double road_lenght = CalculateLength(road);
//Если этот участок уже пройден, то смотрим следующий
if (tmp > road_lenght)
{
tmp -= road_lenght;
continue;
}
for (int g = 0; g < road.Segments.Count; g++)
{
double x = 0, y = 0, t = 0, seg_l = 0;
Point startPoint = road.StartPoint;
if (road.Segments[g] is BezierSegment)
{
BezierSegment seg = road.Segments[g] as BezierSegment;
seg_l = CalculateLength(new PathFigure(startPoint, new List <PathSegment>()
{
seg
}, false));
if (seg_l < tmp)
{
tmp -= seg_l;
startPoint = seg.Point3;
continue;
}
t = tmp / seg_l;
x = (1 - t) * (1 - t) * (1 - t) * startPoint.X + (1 - t) * (1 - t) * 3 * t * seg.Point1.X + (1 - t) * 3 * t * t * seg.Point2.X + t * t * t * seg.Point3.X;
y = (1 - t) * (1 - t) * (1 - t) * startPoint.Y + (1 - t) * (1 - t) * 3 * t * seg.Point1.Y + (1 - t) * 3 * t * t * seg.Point2.Y + t * t * t * seg.Point3.Y;
}
else if (road.Segments[g] is LineSegment)
{
LineSegment seg = road.Segments[g] as LineSegment;
seg_l = CalculateLength(new PathFigure(startPoint, new List <PathSegment>()
{
seg
}, false));
if (seg_l < tmp)
{
tmp -= seg_l;
startPoint = seg.Point;
continue;
}
t = tmp / seg_l;
x = seg.Point.X * t + startPoint.X * (1 - t);
if (startPoint.X == seg.Point.X)
{
y = startPoint.Y + (seg.Point.Y - startPoint.Y) * t;
}
else
{
y = (x - startPoint.X) * (seg.Point.Y - startPoint.Y) / (seg.Point.X - startPoint.X) + startPoint.Y;
}
}
else if (road.Segments[g] is PolyLineSegment)
{
PolyLineSegment seg = road.Segments[g] as PolyLineSegment;
int l;
for (l = 0; l < seg.Points.Count; l++)
{
seg_l = Math.Sqrt(Math.Pow(startPoint.X - seg.Points[l].X, 2) + Math.Pow(startPoint.Y - seg.Points[l].Y, 2));
if (seg_l < tmp)
{
tmp -= seg_l;
startPoint = seg.Points[l];
continue;
}
}
t = tmp / seg_l;
x = seg.Points[l].X * t + startPoint.X * (1 - t);
y = (x - startPoint.X) * (seg.Points[l].Y - startPoint.Y) / (seg.Points[l].X - startPoint.X) + startPoint.Y;
}
CalculateAngle(position, new Point(x, y));
return(new Point(x, y));
}
}
return(new Point(-1, -1));
}
public override void Step()
{
try
{
if (position == new Point(-1, -1))
{
LocateAgent();
}
//Длина пути, которая будет пройдена за один шаг моделирвания
double step_lenght = (double)Scenario.STEP_TIME_MS / CurrentSpeed;
double tmp = currentLength;
double route_length = 0;
for (int i = 1; i < CheckPointsList.Count; i++)
{
//Поиск дороги
PathFigure road = null;
var edges = RoadGraph.GetEdgesFrom(CheckPointsList[i - 1]).GetEnumerator();
while (edges.MoveNext())
{
if (edges.Current.End.Equals(CheckPointsList[i]))
{
road = edges.Current.Data;
break;
}
}
//Расчет длины маршрута и данного участка
double road_length = CalculateLength(road);
route_length += road_length;
//Если этот участок еще не пройден
if (tmp < road_length)
{
//Если участок не будет пройден за этот шаг
if (tmp + step_lenght + Size.X / 2 < road_length)
{
currentLength += step_lenght;
position = CalculateCoordinateLocationOfCarrige();
break;
}
else if (tmp + step_lenght + Size.X / 2 > road_length)
{
if (tmp + Size.X / 2 <= road_length)
{
if (CheckPointsList[i].IsServicePoint)
{
//Паркуемся
if (tmp != road_length - Size.X / 2)
{
currentLength += road_length - tmp - Size.X / 2;
position = CalculateCoordinateLocationOfCarrige();
}
//Работаем с сервисом
if (!ReadyToIOOperation)
{
ServiceBase service = scenario.ServicesList.Find(delegate(ServiceBase sb) { return(sb.ID == CheckPointsList[i].ServiceID); });
if (service.ID == -1)
{
throw new ArgumentException("Service not found, service id = " + CheckPointsList[i].ServiceID);
}
if (service is StopService)
{
(service as StopService).OpenInputPoints(ID);
ReadyToIOOperation = true;
}
}
if (go)
{
ReadyToIOOperation = false;
go = false;
}
if (ReadyToIOOperation)
{
return;
}
}
//Задержка на маршрутной точке
if (CheckPointsList[i].IsWaitPoint)
{
if (CheckPointsList[i].MinWait > 0)
{
CheckPointsList[i].MinWait -= Scenario.STEP_TIME_MS;
return;
}
}
//Точка с присвоением фиксированной скорости
if (CheckPointsList[i].IsFixSpeedPoint)
{
CurrentSpeed = Convert.ToInt32(CheckPointsList[i].FixSpeed);
}
else
{
CurrentSpeed = MaxSpeed;
}
if (CheckPointsList.Count > i + 1 && i > 0 && CheckPointsList[i + 1].Equals(CheckPointsList[i - 1]))
{
Revers(route_length);
}
}
currentLength += step_lenght;
position = CalculateCoordinateLocationOfCarrige();
break;
}
}
else
{
if (i == CheckPointsList.Count - 1)
{
currentLength += step_lenght;
}
tmp -= road_length;
}
}
}
catch (Exception ex)
{
Console.WriteLine(string.Format("Error in Thread! Agent ID [{0}]. Error message [{1}]", ID, ex.Message));
WayPointsList.Clear();
return;
}
}
