public void CalcularAngulosFinales()
{
angulos = AngleHelper.SetValorAngulos(HombroDerecho,
ManoDerecha, CodoDerecho, skelObjeto);
if (angulos[0] == -1 || angulos[1] == -1 || angulos[2] == -1 || angulos[3] == -1)
{
//Console.WriteLine("no se puede alcanzar el objeto");
/*dc.DrawText(
* new FormattedText("No se puede alcanzar el objeto",
* CultureInfo.GetCultureInfo("en-us"),
* FlowDirection.LeftToRight,
* new Typeface("Verdana"),
* 25, System.Windows.Media.Brushes.Red),
* new Point(0,0));*/
flagSkeleton = false;
}
else
{
flagSkeleton = true;
//si se puede alcanzar el objeto,
try
{
this.ConfirmacionButton.IsEnabled = true;
this.MensajesLabel.Content = "Angulos calculados";
}
catch (Exception)
{
Console.WriteLine("Excepcion en escribir el angulo en arduino");
}
}
}
public PruebaAngulos()
{
mano = new Joint();
mano.Position = SetPosition(-0.87, 4.29, 1.89);
codo = new Joint();
codo.Position = SetPosition(-0.87, 2.31, 1.8);
hombro = new Joint();
hombro.Position = SetPosition(-0.87, 0.52, 3.8);
objeto = new SkeletonPoint();
objeto = SetPosition(-0.87, 4.74, 4.1);
AngleHelper.SetValorAngulos(hombro, mano, codo, objeto);
}
public PruebaAngulos()
{
hombro = new Joint();
hombro.Position = SetPosition(2.3, 1.21, -1.67);
codo = new Joint();
codo.Position = SetPosition(2.3, 0.98, -0.78);
mano = new Joint();
mano.Position = SetPosition(2.3, 1.42, 0.3);
objeto = new SkeletonPoint();
objeto = SetPosition(2.3, 0.25, -0.17);
AngleHelper a = new AngleHelper();
a.SetValorAngulos(new Puntos(hombro, codo, mano, objeto));
}
