void DrawCapsule2(Capsule capsule)
        {
            model.Push ();
            model.MultMatrix (capsule.Model);
            SendUniforms (capsule.Color);
            var a = capsule.PointA;
            var b = capsule.PointB;
            var r = capsule.Radius;
            DrawLine (new Vec3(a.X,a.Y,a.Z), new Vec3(b.X,b.Y,b.Z));

            model.Pop ();
        }
 void DrawCapsule1(Capsule capsule)
 {
     model.Push ();
     model.MultMatrix (capsule.Model);
     SendUniforms (capsule.Color);
     DrawLine (capsule.PointA, capsule.PointB);
     model.Push ();
     model.MultMatrix (IMatrix.Translation (capsule.PointA.X, capsule.PointA.Y,capsule.PointA.Z));
     SendUniforms ();
     DrawSphere (capsule.Radius, 32, 16);
     model.Pop ();
     model.MultMatrix (IMatrix.Translation (capsule.PointB.X, capsule.PointB.Y,capsule.PointB.Z));
     SendUniforms ();
     DrawSphere (capsule.Radius, 32, 16);
     model.Pop ();
     model.Pop ();
 }