using UnityEngine;
using System.Collections;

public class IISoldie : MonoBehaviour
{
    public Transform finih;
    RaycastHit Hit;
    bool stena,  stenaTime;
    Vector3 PovorotDlaObxoda;
    Transform TargetPregrada;
    Vector3 NapravlenieLy4a;
    public Transform[] ForvardRay;
    public Transform[] LeftRay;
    public Transform[] RightRay;
    Transform[] pointRay;
    int distansRay = 3;
    public float speedCube = 3;
    float timeFlag;

    // Use this for initialization
    void Start()
    {

    }
    void Update()
    {
        Debug.Log(Vector3.Distance(finih.position, transform.position));
        //непрерывное движение куба пока то не достигнет цели
        if (Vector3.Distance(finih.position, transform.position) > 3)
        {
            transform.position += transform.forward * speedCube * Time.deltaTime;
        }
        if (!stena)
        {
            //дебаг линия от куба к цели
            Debug.DrawLine(finih.position, transform.position, Color.red);
            //поворот в направлении основной цели
            transform.rotation = Quaternion.Slerp(transform.localRotation, Quaternion.LookRotation(finih.position - transform.position), Time.deltaTime * 2f);
            NapravlenieLy4a = transform.forward;
            pointRay = ForvardRay;
            distansRay = 2;
        }
        else
        {
            // меняем направление луча в случае запуска опции обхода преграды
            NapravlenieLy4a = OptionRay(TargetPregrada, transform);
            //меняем точки пускания лучей на самые ближние к преграде
            pointRay = NapravlenieLy4a == -transform.right ? LeftRay : RightRay;
            distansRay = 4;
        }
        byte rayIntPoint = 0;
        for (int i = 0; i < pointRay.Length; i++)
        {
            //лучи в дебаге
            Debug.DrawRay(pointRay[i].position, NapravlenieLy4a, Color.green);
            //пускаем лучи из выбранных точек
            if (Physics.Raycast(pointRay[i].position, NapravlenieLy4a, out Hit, distansRay))
            {
                if (NapravlenieLy4a == transform.forward)
                {
                    stena = true;
                    TargetPregrada = Hit.transform;
                    //поворачиваем наш кубик к ближайшему краю преграды
                    transform.localRotation = Quaternion.Euler(OptionDirection(TargetPregrada,transform));
                }
                else stena = true;
                break;
            }
            else if (NapravlenieLy4a != transform.forward && !stenaTime )
            {
                rayIntPoint++;
                if (rayIntPoint >= pointRay.Length)
                {
                    //разворачиваем кубик в исходное положение и даем ему 1 секунду чтобы пройти мимо преграды и не цеплятся за края, 
                    //далее снова включаем курс на конечную цель
                    timeFlag = Time.time;
                    stenaTime = true;
                    Vector3 povorot = TargetPregrada.rotation.eulerAngles;
                    transform.localRotation = Quaternion.Euler(povorot);
                }
            }
        }
        if (timeFlag + 1 < Time.time && stenaTime)
        {
            stenaTime = false;
            stena = false;
        }   
    }
    //выбор направления обхода препятствия.
    Vector3 OptionDirection(Transform block, Transform myTransform)
    {
      Vector3 vec =  block.transform.rotation.eulerAngles;
      vec.y  = block.transform.position.x < myTransform.position.x ? vec.y += 90 : vec.y -= 90;
      return vec;
    }
    //выбор направлния лучей
   Vector3  OptionRay(Transform block, Transform myTransform)
    {
       Vector3 vec;
     return  vec = TargetPregrada.position.x < myTransform.position.x ? -myTransform.right : myTransform.right;
    }
}