BansheeEngine/Source/MBansheeEditor/Scene/Gizmos/CharacterControllerGizmo.cs

//********************************** Banshee Engine (www.banshee3d.com) **************************************************//
//**************** Copyright (c) 2016 Marko Pintera ([email protected]). All rights reserved. **********************//
using BansheeEngine;

namespace BansheeEditor
{
    /// <summary>
    /// Handles drawing of gizmos for the <see cref="CharacterController"/> component.
    /// </summary>
    internal class CharacterControllerGizmo
    {
        /// <summary>
        /// Method called by the runtime when gizmos are meant to be drawn.
        /// </summary>
        /// <param name="controller">Collider to draw gizmos for.</param>
        [DrawGizmo(DrawGizmoFlags.Selected)]
        private static void Draw(CharacterController controller)
        {
            SceneObject so = controller.SceneObject;

            Vector3 offset = so.Position;
            Quaternion rotation = Quaternion.FromToRotation(Vector3.YAxis, controller.Up);

            // Rotate around origin
            Matrix4 rotMatrix = Matrix4.TRS(offset, Quaternion.Identity, Vector3.One) *
                Matrix4.TRS(Vector3.Zero, rotation, Vector3.One) *
                Matrix4.TRS(-offset, Quaternion.Identity, Vector3.One);

            Gizmos.Color = Color.Green;
            Gizmos.Transform = so.WorldTransform * rotMatrix;

            Gizmos.DrawWireCapsule(offset, controller.Height, controller.Radius);
        }
    }
}