static void Main(string[] args)
{
try
{
ReedAndShepp ras = new ReedAndShepp(5.0);
ReedAndShepp.Vector3[] path;
Console.WriteLine(ras.ComputeCurve(new ReedAndShepp.Vector3(0, 0, 0), new ReedAndShepp.Vector3(1, 1, 0), 0.1, out path));
foreach (ReedAndShepp.Vector3 v in path)
{
ReedAndShepp.Vector3 v2 = v.Floor(2);
Console.WriteLine(v2.x.ToString() + "\t" + v2.y.ToString() + "\t" + v2.z.ToString());
}
Console.ReadLine();
}
catch (Exception e)
{
Console.WriteLine(e.ToString() + " : " + e.Message);
Console.ReadLine();
}
}
public static Vector3 RSConfToUnityConf(ReedAndShepp.ReedAndShepp.Vector3 v)
{
return(new Vector3((float)-v.x, (float)v.y, CarController.normalizeAngle((float)(v.z * Mathf.Rad2Deg + 90))));
}