38 lines
1.4 KiB
C#
38 lines
1.4 KiB
C#
|
using System;
|
||
|
|
|
||
|
|
using System.Runtime.InteropServices;
|
||
|
|
|
||
|
|
public class Tester
|
||
|
|
{
|
||
|
|
|
||
|
|
|
||
|
|
#if UNIX
|
||
|
|
[DllImport("libopenGJKlib.so", EntryPoint="csFunction", CallingConvention = CallingConvention.StdCall)]
|
||
|
|
#else
|
||
|
|
[DllImport("openGJKlib", EntryPoint = "csFunction", CallingConvention = CallingConvention.StdCall)]
|
||
|
|
#endif
|
||
|
|
static extern double gjk(int na, double [,] ia, int nb, double [,] ib);
|
||
|
|
|
||
|
|
public static void Main(string[] args)
|
||
|
|
{
|
||
|
|
double dist;
|
||
|
|
// Define array A with coordinates
|
||
|
|
int nCoordsA = 9;
|
||
|
|
var inCoordsA = new double[3,9] { {0.0 , 2.3 , 8.1 , 4.3 ,2.5 , 7.1 , 1.0 , 3.3 , 6.0} , { 5.5 , 1.0 , 4.0 , 5.0 ,1.0, 1.0, 1.5, 0.5 , 1.4} ,{ 0.0 , -2.0, 2.4, 2.2, 2.3 , 2.4 , 0.3 , 0.3 , 0.2} };
|
||
|
|
|
||
|
|
// Define array B with coordinates
|
||
|
|
int nCoordsB = 9;
|
||
|
|
var inCoordsB = new double[3,9] { {-0.0 , -2.3 , -8.1 , -4.3 ,-2.5 , -7.1 , -1.0 , -3.3 , -6.0} , { -5.5 , -1.0 ,- 4.0 ,- 5.0 ,-1.0, -1.0, -1.5, -0.5 , -1.4} ,{ -0.0 , 2.0, -2.4, -2.2, -2.3 , -2.4 , -0.3 , -0.3 , -0.2} };
|
||
|
|
|
||
|
|
// Invoke GJK to compute distance
|
||
|
|
dist = gjk( nCoordsA, inCoordsA, nCoordsB, inCoordsB );
|
||
|
|
|
||
|
|
// Output results
|
||
|
|
var s = string.Format("{0:0.##}", dist);
|
||
|
|
var message = string.Format("The distance between {0} is {1}","A and B",s);
|
||
|
|
Console.WriteLine(message);
|
||
|
|
Console.WriteLine("Press any key to exit");
|
||
|
|
Console.ReadLine();
|
||
|
|
}
|
||
|
|
}
|