public static WavefrontFormat DrawClothoRadius(this WavefrontFormat wf,
bool invertY, double a,
string radiusColor)
{
List <int> indices = new List <int>();
double lmax = ClothoUtils.GetMaxL(a);
int c = 100;
for (int i = -c; i <= c; i++)
{
double s = i * lmax / c;
double r = ClothoUtils.ClothoRadius(s, invertY, a);
if (double.IsInfinity(r))
{
r = SysMath.Sign(r) * 1000;
}
int v0 = wf.AddVertex(new Point2d(s, r));
indices.Add(v0);
//double dx, dy;
//MathUtils.DClotho(s, r, a, out dx, out dy);
}
wf.UseMaterial(radiusColor);
wf.AddLines(indices, false);
return(wf);
}
public static WavefrontFormat DrawClotho(this WavefrontFormat wf,
bool invertY, double a,
string clothoColor)
{
List <int> indices = new List <int>();
int c = 100;
for (int i = -c; i <= c; i++)
{
double lmax = ClothoUtils.GetMaxL(a);
double s = i * lmax / c;
double x, y;
ClothoUtils.Clotho(s, invertY, a, out x, out y);
int v0 = wf.AddVertex(new Point2d(x, y));
indices.Add(v0);
//double dx, dy;
//MathUtils.DClotho(s, r, a, out dx, out dy);
}
wf.UseMaterial(clothoColor);
wf.AddLines(indices, false);
return(wf);
}
private double GetL(double t)
{
t = t.Clamp(this.tmin, this.tmax);
double dl = this.ttransform.Get(t);
if (SysMath.Abs(dl) > ClothoUtils.GetMaxL(this.a))
{
throw new Exception("Longitud del arco por encima del máximo permitido.");
}
return(dl);
}
public void Test2()
{
double a = 10;
bool invertY = true;
double maxL = ClothoUtils.GetMaxL(a);
int ysign = invertY ? -1 : 1;
double[] angles =
{
ysign * 0,
ysign *SysMath.PI / 4,
ysign *SysMath.PI / 2,
ysign * 3 *SysMath.PI / 4
};
using (MaterialFormat mf = new MaterialFormat(@"C:\Temp\Default.mtl"))
{
mf.DefaultColors();
}
using (WavefrontFormat wf = new WavefrontFormat(@"C:\Temp\ClothoidArc2dTest_Test2.obj"))
{
wf.LoadMaterialLib("Default.mtl");
wf.DrawClotho(invertY, a, "Red");
foreach (double angle in angles)
{
Vec2d v = vecMath.NewRotate(angle);
double l = ClothoUtils.FindTangent(invertY, a, v);
wf.DrawLine("Green", ClothoUtils.Clotho(l, invertY, a), v);
wf.DrawLine("Magenta", ClothoUtils.Clotho(-l, invertY, a), v);
}
//wf.DrawLine("Yellow", new Vec2d(0, 0), new Vec2d(1, 0), 100);
//wf.DrawLine("Yellow", new Vec2d(0, 0), new Vec2d(0, 1), 100);
}
}
public static WavefrontFormat DrawClotho(this WavefrontFormat wf,
bool invertY, double a,
string clothoColor,
string dirColor,
string normalColor,
string radColor)
{
List <int> indices = new List <int>();
List <Tuple <int, int> > normals = new List <Tuple <int, int> >();
List <Tuple <int, int> > dirs = new List <Tuple <int, int> >();
List <Tuple <int, int> > radius = new List <Tuple <int, int> >();
int c = 100;
for (int i = -c; i <= c; i++)
{
double lmax = ClothoUtils.GetMaxL(a);
double s = i * lmax / c;
Point2d xy = ClothoUtils.Clotho(s, invertY, a);
int v0 = wf.AddVertex(xy);
indices.Add(v0);
Vector2d n = ClothoUtils.ClothoLeftNormal(s, invertY, a).Unit;
int v1 = wf.AddVertex(xy.Add(n));
normals.Add(Tuple.Create(v0, v1));
double dir = ClothoUtils.ClothoTangent(s, invertY, a);
Vector2d d = Vector2d.NewRotate(dir);
int v2 = wf.AddVertex(xy.Add(d.Mul(5)));
dirs.Add(Tuple.Create(v0, v2));
double r = ClothoUtils.ClothoRadius(s, invertY, a);
if (double.IsInfinity(r))
{
r = SysMath.Sign(r) * 100;
}
int v3 = wf.AddVertex(xy.Add(n.Mul(r)));
radius.Add(Tuple.Create(v0, v3));
//double dx, dy;
//MathUtils.DClotho(s, r, a, out dx, out dy);
}
wf.UseMaterial(clothoColor);
wf.AddLines(indices, false);
wf.UseMaterial(normalColor);
foreach (Tuple <int, int> normal in normals)
{
wf.AddLines(new[] { normal.Item1, normal.Item2 }, false);
}
wf.UseMaterial(dirColor);
foreach (Tuple <int, int> dir in dirs)
{
wf.AddLines(new[] { dir.Item1, dir.Item2 }, false);
}
wf.UseMaterial(radColor);
foreach (Tuple <int, int> rr in radius)
{
wf.AddLines(new[] { rr.Item1, rr.Item2 }, false);
}
return(wf);
}