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)); } }