public static void SetupModel(ImuzDraw draw, KinematicsModel model)
{
foreach (Link l in model.Model)
{
draw.AddPyramidModel((float)0.5, (float)0.1, (float)0.1);
}
}
public static void DrawModel(ImuzDraw draw, KinematicsModel model)
{
foreach (Pose p in model.Result)
{
Mat4 m = p.Matrix;
draw.GetModel(p.LinkId).SetWorldMatrix(MatrixHelper.ToXna(m));
}
}
public static void SetupModel(ImuzDraw draw, KinematicsModel model)
{
foreach (Link l in model.Model) {
draw.AddPyramidModel((float)0.5, (float)0.1, (float)0.1);
}
}
public static void DrawModel(ImuzDraw draw, KinematicsModel model)
{
foreach (Pose p in model.Result) {
Mat4 m = p.Matrix;
draw.GetModel(p.LinkId).SetWorldMatrix(MatrixHelper.ToXna(m));
}
}
