예제 #1
0
 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();
     }
 }
예제 #2
0
 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))));
 }