using Gamecraft.Wires;
using RobocraftX.Common;
using RobocraftX.Physics;
using Svelto.ECS;
using Unity.Mathematics;
using UnityEngine;

namespace GamecraftModdingAPI
{
    /// <summary>
    /// A rigid body (like a cluster of connected blocks) during simulation.
    /// </summary>
    public class SimBody
    {
        public EGID Id { get; }

        public SimBody(EGID id)
        {
            Id = id;
        }

        public SimBody(uint id) : this(new EGID(id, CommonExclusiveGroups.SIMULATION_BODIES_GROUP))
        {
        }

        public float3 Position
        {
            get => GetStruct().position;
            set => GetStruct().position = value;
        }

        public float3 Velocity
        {
            get => GetStruct().velocity;
            set => GetStruct().velocity = value;
        }

        public float3 AngularVelocity
        {
            get => GetStruct().angularVelocity;
            set => GetStruct().angularVelocity = value;
        }

        public float3 DeltaVelocity
        {
            get => GetStruct().deltaVelocity;
            set => GetStruct().deltaVelocity = value;
        }

        public float3 DeltaAngularVelocity
        {
            get => GetStruct().deltaAngularVelocity;
            set => GetStruct().deltaAngularVelocity = value;
        }

        public float3 Rotation
        {
            get => ((Quaternion) GetStruct().rotation).eulerAngles;
            set
            {
                ref var str = ref GetStruct();
                Quaternion quaternion = str.rotation;
                quaternion.eulerAngles = value;
                str.rotation = quaternion;
            }
        }

        public float Mass
        {
            get => math.rcp(GetStruct().physicsMass.InverseMass);
            set => GetStruct().physicsMass.InverseMass = math.rcp(value);
        }

        /// <summary>
        /// Whether the body can be moved or static
        /// </summary>
        public bool Static => Block.BlockEngine.GetBlockInfo<MassEntityStruct>(Id).isStatic;
        //Setting it doesn't have any effect

        private ref RigidBodyEntityStruct GetStruct()
        {
            return ref Block.BlockEngine.GetBlockInfo<RigidBodyEntityStruct>(Id);
        }

        public override string ToString()
        {
            return $"{nameof(Id)}: {Id}, {nameof(Position)}: {Position}, {nameof(Mass)}: {Mass}, {nameof(Static)}: {Static}";
        }

        /// <summary>
        /// Returns the object identified by the given ID (A-Z).
        /// This has the same result as calling ObjectIdentifier.GetByID(id) and then GetRigidBody() with the duplicates filtered out.
        /// </summary>
        /// <param name="id">The alphabetical ID</param>
        /// <returns>An array that may be empty</returns>
        public static SimBody[] GetFromObjectID(char id) => Block.BlockEngine.GetSimBodiesFromID((byte) (id - 'A'));
    }
}