//Draw Shape Gizmo
 protected override void OnDrawGizmosSelected()
 {
     if (!DrawGizmo)
     {
         return;
     }
     BUtility.DebugDrawCylinder(transform.position, transform.rotation, transform.localScale, _halfExtents.x, _halfExtents.y, 1, GizmoColor);
 }
        public override void DrawCylinder(float radius, float halfHeight, int upAxis, ref BM.Matrix trans, ref BM.Vector3 color)
        {
            var pos   = BulletExtensionMethods.ExtractTranslationFromMatrix(ref trans);
            var rot   = BulletExtensionMethods.ExtractRotationFromMatrix(ref trans);
            var scale = BulletExtensionMethods.ExtractScaleFromMatrix(ref trans);
            var c     = new Color(color.X, color.Y, color.Z);

            BUtility.DebugDrawCylinder(pos, rot, scale, radius, halfHeight, upAxis, c);
        }