using SHADE;
using System;
using System.Collections.Generic;
using static Item;


public class PhysicsTestObj : Script
{
    public RigidBody body { get; set; }
    public Collider collider { get; set; }

    // Movement input booleans
    public enum Direction
    {
        UP,
        DOWN,
        FORWARD,
        BACK,
        LEFT,
        RIGHT
    };

    internal bool[] move   = new bool[6];
    internal bool[] rotate = new bool[6];

    internal Vector3[] moveVec = new Vector3[6]
    {
        Vector3.Up, 
        Vector3.Down, 
        Vector3.Back, 
        Vector3.Forward, 
        Vector3.Left, 
        Vector3.Right
    };

    internal Vector3[] rotateVec = new Vector3[6]
    {
        Vector3.Right,
        Vector3.Left,
        Vector3.Forward,
        Vector3.Down,
        Vector3.Up,
        Vector3.Down
    };

    internal Input.KeyCode[] moveInputKeys = new Input.KeyCode[6]
    {
        Input.KeyCode.Space,
        Input.KeyCode.LeftControl,
        Input.KeyCode.W,
        Input.KeyCode.S,
        Input.KeyCode.A,
        Input.KeyCode.D
    };

    internal Input.KeyCode[] rotateInputKeys = new Input.KeyCode[6]
    {
        Input.KeyCode.I,
        Input.KeyCode.K,
        Input.KeyCode.U,
        Input.KeyCode.O,
        Input.KeyCode.J,
        Input.KeyCode.L
    };

    public float forceAmount = 50.0f;
    public float torqueAmount = 500.0f;

    protected override void awake()
    {
        body = GetComponent<RigidBody>();
        collider = GetComponent<Collider>();

        for (int i = 0; i < 6; ++i)
        {
            move[i] = false;
            rotate[i] = false;
        }
    }

    protected override void update()
    {
        Ray colliderRay = new Ray();
        colliderRay.Direction = Vector3.Right;
        Physics.ColliderRaycast(collider.Owner, colliderRay, false);

        for (int i = 0; i < 6; ++i)
        {
            if (Input.GetKeyDown(moveInputKeys[i]))
                move[i] = true;

            if (Input.GetKeyDown(rotateInputKeys[i]))
                rotate[i] = true;
        }
    }

    protected override void fixedUpdate()
    {
        for (int i = 0; i < 6; ++i)
        {
            bool shouldMove = move[i];
            bool shouldRotate = rotate[i];

            if (shouldMove)
            {
                //Vector3 offset = new Vector3(0.25f, 0.0f, 0.0f);
                //rb.AddForceAtLocalPos(moveVec[i] * forceAmount, offset);
                body.AddForce(moveVec[i] * forceAmount);
                move[i] = false;
            }

            if (shouldRotate)
            {
                body.AddTorque(rotateVec[i] * torqueAmount);
                rotate[i] = false;
            }
        }
    }
}