using System.Collections.Generic;
using Code.Example.Race.Racer.AI.ID;
using Code.Example.Race.Track;
using Code.Infrastructure.EventBus;
using Reflex.Attributes;
using UnityEngine;

namespace Code.Example.Race.Racer.AI
{
    public class AIRacerID : Racer
    {
        [Inject] private EventBus _eventBus;
        [SerializeField] private CarControllerRB carController;
        
        public override void SetData(RacerData data)
        {
            Data = data;
            
            _velocity = Vector3.zero;
            _steering = new Steering();
        }

        public override void Initialize(List<Transform> waypoints)
        {
            Waypoints = waypoints; 
        }

        public override void NextWaypoint()
        {
            if (++CurrentWaypointIndex < Waypoints.Count) return;
            
            CurrentWaypointIndex = 0;
            _eventBus.RaiseEvent<IRacerPassedCheckpointHandler>(x=> x.LapPassed(this));
        }

        public override void StartRacer()
        {
            _running = true;
        }

        public override void StopRacer()
        {
            _running = false;
        }
         
        [SerializeField] private AgentBehaviour agent;
        
        private float _orientation;
        private float _rotation;
        private Vector3 _velocity;
        private Steering _steering;
        private bool _running;
   
        private float NormalizeAngle(float angle)
        {
            switch (angle)
            {
                case > 360.0f:
                {
                    while (angle > 360.0f) angle -= 360.0f;
                    break;
                }
                case < 0.0f:
                {
                    while (angle < 0.0f) angle += 360.0f;
                    break;
                }
            }

            return angle;
        }
        public virtual void Update()
        {
            if (!_running) return;
            
            var steering =  
                transform.InverseTransformDirection(
                    agent.GetSteering(Waypoints[CurrentWaypointIndex]).linear);
            
            carController.SetSteering(new Vector2(steering.x, steering.z));
            // var displacement = _velocity * Time.deltaTime;
            // _orientation += _rotation * Time.deltaTime;
            // _orientation = NormalizeAngle(_orientation);
            //
            // transform.Translate(displacement, Space.World);
            // transform.Rotate(Vector3.up, _orientation);
        }
        public virtual void LateUpdate()
        {
            if (!_running) return;
            //
            // _steering = agent.GetSteering(Waypoints[CurrentWaypointIndex]);
            //
            // _velocity += _steering.linear * Time.deltaTime;
            // _rotation += _steering.angular * Time.deltaTime;
            // if (_velocity.magnitude > Data.speed)
            // {
            //     _velocity = _velocity.normalized * Data.speed; 
            // }
            // if (_steering.angular == 0.0f)
            // {
            //     _rotation = 0.0f;
            // }
            // if (_steering.linear.sqrMagnitude == 0.0f)
            // {
            //     _velocity = Vector3.zero;
            // }
        }
    }
}