public static double Distance(NetPoint p1, NetPoint p2)
{
double dx = p2.x - p1.x;
double dy = p2.y - p1.y;
return(Math.Sqrt(dx * dx + dy * dy));
}
public void ReadPoints(string filepathKnownPoints, bool changeRoute = false)
{
var reader = new StreamReader(filepathKnownPoints);
int i;
for (i = 0; i < pointNum; i++)
{
netPoints[i] = new NetPoint();
}
var line = reader.ReadLine();
var buf = line.Split(',');
startKnownPoint = Int32.Parse(buf[0]);
netPoints[startKnownPoint].x = double.Parse(buf[1]);
netPoints[startKnownPoint].y = double.Parse(buf[2]);
line = reader.ReadLine();
buf = line.Split(',');
endKnownPoint = Int32.Parse(buf[0]);
netPoints[endKnownPoint].x = double.Parse(buf[1]);
netPoints[endKnownPoint].y = double.Parse(buf[2]);
if (changeRoute)
{
int temp = startKnownPoint;
startKnownPoint = endKnownPoint;
endKnownPoint = temp;
}
reader.Close();
}
public static double Azimuth(NetPoint startPt, NetPoint endPt)
{
double azimuth;
double dx = endPt.x - startPt.x;
double dy = endPt.y - startPt.y;
azimuth = IMathNet.Atan_2PI(dy, dx);
return(azimuth);
}
