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); }