public float Heuristic(Node n1, Node n2)
{
NavMeshNode node1 = (NavMeshNode)n1;
NavMeshNode node2 = (NavMeshNode)n2;
return(DistanceMetrics.Euclidean(node1.Position, node2.Position));
}
public void TestPointToPlane_PointToBackOfPlane()
{
Point staticPoint = new Point(new Vector3(-5, -3, 6));
float expected = -5;
float actual = DistanceMetrics.PointToPlane(staticPoint, modelPoint);
Assert.AreEqual(expected, actual, tolerance);
}
public void TestPointToPlane_PointInFrontOfPlane()
{
Point staticPoint = new Point(new Vector3(3, 5, 7));
float expected = 3;
float actual = DistanceMetrics.PointToPlane(staticPoint, modelPoint);
Assert.AreEqual(expected, actual, tolerance);
}
public void TestSquardEuclideanDistance_NegativeElements()
{
Point a = new Point(new Vector3(+9.1f, -2.3f, +3.4f));
Point b = new Point(new Vector3(-4.5f, +5.6f, -6.7f));
float expected = 349.3800000000000f;
float actual = DistanceMetrics.SquaredEuclidean(a, b);
Assert.AreEqual(expected, actual, tolerance);
}
public void TestSquardEuclideanDistance_Three()
{
Point a = new Point(new Vector3(9.1f, 2.3f, 3.4f));
Point b = new Point(new Vector3(4.5f, 5.6f, 6.7f));
float expected = 42.939999999999998f;
float actual = DistanceMetrics.SquaredEuclidean(a, b);
Assert.AreEqual(expected, actual, tolerance);
}
public void TestSquardEuclideanDistance_Two()
{
Point a = new Point(new Vector3(3.4f, 4.5f, 5.6f));
Point b = new Point(new Vector3(6.7f, 7.8f, 8.9f));
float expected = 32.670000000000002f;
float actual = DistanceMetrics.SquaredEuclidean(a, b);
Assert.AreEqual(expected, actual, tolerance);
}
public void TestSquardEuclideanDistance_One()
{
Point a = new Point(new Vector3(1.0f, 2.0f, 3.0f));
Point b = new Point(new Vector3(2.0f, 3.0f, 4.0f));
float expected = 3.000000000000000f;
float actual = DistanceMetrics.SquaredEuclidean(a, b);
Assert.AreEqual(expected, actual, tolerance);
}
public void CalculateDistance_ReturnsCorrectDistanceBetweenTwoPoints(double point1Lat, double point1Long, double point2Lat, double point2Long, double expectedDistanceBetweenPoints)
{
// Arrange
var point1 = new double[] { point1Lat, point1Long };
var point2 = new double[] { point2Lat, point2Long };
// Act
var actualDistance = DistanceMetrics.CalculateDistance(point1, point2);
// Assert
actualDistance.Should().Be(expectedDistanceBetweenPoints);
}
/// <summary>
/// Calculates the distance between this location and another one, in meters.
/// </summary>
public double CalculateDistance(Location location)
{
var point1 = new[]
{
this.Latitude,
this.Longitude
};
var point2 = new[]
{
location.Latitude,
location.Longitude
};
return(DistanceMetrics.CalculateDistance(point1, point2));
}
