FireDrillSystem_GC_QZ/Assets/Scripts/Common/Disasters/Wound_Trapped/TrappedPathFind.cs

using AX.MessageSystem;
using System.Collections;
using System.Collections.Generic;
using UnityEngine;
using UnityEngine.AI;
using System;
using AX.InputSystem;
using AX.NetworkSystem;

public class TrappedPathFind : MonoBehaviour
{
    private NavMeshAgent agent;
    private NavMeshPath NavMeshPath;
    private NavMeshQueryFilter filter;
    private Vector3 pointhit;//寻路点  
    private GameObject hitObj;//寻路的对象
    public List<Vector3> corners = new List<Vector3>();
    private Vector3 lastPosition;
    public bool pathFindEnable;
    /// <summary>
    /// 是否被引导
    /// </summary>
    private bool guidance;
    void Start()
    {
        pathFindEnable = true;
        NavMeshPath = new NavMeshPath();
        agent = GetComponent<NavMeshAgent>();
        filter = new NavMeshQueryFilter();
        filter.agentTypeID = agent.agentTypeID;
        filter.areaMask = agent.areaMask;
    }
    void OnEnable()
    {
        MessageDispatcher.AddListener("TRAPPED_PATH_FINDING_COMMAND", PathFinding);
    }

    void OnDisable()
    {
        MessageDispatcher.RemoveListener("TRAPPED_PATH_FINDING_COMMAND", PathFinding);
    }

    void OnDestroy()
    {
        MessageDispatcher.RemoveListener("TRAPPED_PATH_FINDING_COMMAND", PathFinding);
    }

    private void PathFinding(IMessage obj)
    {
        if (pathFindEnable)
        {
            var data = (TrappedPathFindingCmdArgs)obj.Data;
            //GameObject fireman = data.fireman;
            pointhit = data.hitPoint;
            // GetComponent<TrappedMoveFree>().targetPosition = pointhit;
            //long gameID = data.gameObjID;
            long selfID = data.gameObjIdSelf;
            // List<long> movelist = data.MoveIdlist;
            //自由状态
            if (selfID != 0)
            {
                if (selfID == GetComponent<BaseGameObjInfo>().gameObjID)
                {
                    GetComponent<TrappedMoveFree>().targetPosition = pointhit;
                    StopAllCoroutines();
                    //StopCoroutine("GoToDestination");
                    corners.Clear();
                    bool flag = setPathCorners(transform.position, pointhit, corners);
                    if (flag)
                    {
                        //hitObj = EntitiesManager.Instance.GetEntityByID(data.gameObjID);

                        removeNoMainCorners(corners);
                        StartCoroutine(GoToDestination(data));
                        //寻路同步
                        if (!GetComponent<TrappedMoveFree>().Guidance)
                        {
                            PathFindSyncData pathsync = new PathFindSyncData();
                            pathsync.SendUserID = CurrentUserInfo.mySelf.Id;
                            pathsync.TargetPoint = data.hitPoint;
                            pathsync.TrappedMeetDangerous = data.MeetDangerous;
                            pathsync.gameObjID = GetComponent<BaseGameObjInfo>().gameObjID;
                            pathsync.gameObjType = GetComponent<BaseGameObjInfo>().gameObjType;
                            pathsync.UserID = GetComponent<BaseGameObjInfo>().UserID;
                            pathsync.trappedTargetpoint = GetComponent<TrappedMoveFree>().targetPosition;
                            NetworkManager.Default.SendAsync(/*CurrentUserInfo.mySelf.Id,*/ "PATHFIND_SYNC", pathsync);
                        }
                    }
                }
            }
            ////被移动状态
            //else
            //{
            //    if (movelist.Count > 0 && GetComponent<TrappedMoveFree>().MoveFireman == fireman)
            //    {
            //        if (movelist.Contains(GetComponent<BaseGameObjInfo>().gameObjID))
            //        {
            //            GetComponent<TrappedMoveFree>().targetPosition = pointhit;
            //            StopAllCoroutines();
            //            //StopCoroutine("GoToDestination");
            //            corners.Clear();
            //            bool flag = setPathCorners(transform.position, pointhit, corners);
            //            if (flag)
            //            {
            //                //hitObj = EntitiesManager.Instance.GetEntityByID(data.gameObjID);
            //                removeNoMainCorners(corners);
            //                StartCoroutine(GoToDestination(data));
            //            }
            //        }
            //    }
            //}
        }
        //else
        //{
        //    Debug.Log("不能移动");
        //    // ResourceLoadWindow.Instance.LoadTextHintWindow("不能移动", 1f);
        //}

    }

    void removeNoMainCorners(List<Vector3> corners)
    {
        for (int i = 0; i < corners.Count - 1; i++)
        {
            for (int k = corners.Count - 2; k > i; k--)
            {
                float distance = Vector3.Distance(corners[i], corners[k]);//计算两点的距离
                if (distance < 5)
                {
                    for (int j = k; j > i; j--)
                    {
                        corners.RemoveAt(j);
                    }
                    break;
                }
            }
        }
    }
    bool setPathCorners(Vector3 sourcePosition, Vector3 targetPosition, List<Vector3> corners)
    {
        NavMeshPath NavMeshPath = new NavMeshPath();
        NavMesh.CalculatePath(sourcePosition, targetPosition, filter, NavMeshPath);
        Vector3[] b = NavMeshPath.corners;
        if (b.Length == 1)
        {
            //Debug.Log("断裂");         
            return false;
        }
        if (NavMeshPath.status == NavMeshPathStatus.PathComplete)
        {
            //Debug.Log("PathComplete");
            foreach (Vector3 corner in b)
            {
                if (!corners.Contains(corner))
                {
                    corners.Add(corner);
                }
            }
            return true;
        }
        else if (NavMeshPath.status == NavMeshPathStatus.PathPartial)
        {
            if (Vector3.Distance(b[b.Length - 1], lastPosition) == 0)
            {
                //Debug.Log("(" + sourcePosition.x + "," + sourcePosition.y + "," + sourcePosition.z + ")、（" + lastPosition.x + "," + lastPosition.y + "," + lastPosition.z + ")");
                //Debug.Log("进入死循环");

                return false;
            }
            foreach (Vector3 corner in b)
            {
                if (!corners.Contains(corner))
                {
                    corners.Add(corner);
                }
            }
            lastPosition = sourcePosition;
            return setPathCorners(b[b.Length - 1], targetPosition, corners);
        }
        else if (NavMeshPath.status == NavMeshPathStatus.PathInvalid)
        {
            return false;
        }
        else
        {
            return false;
        }
    }
    IEnumerator GoToDestination(TrappedPathFindingCmdArgs data)
    {
        int i = 1;
        //while (i < corners.Count)
        //{
        //    NavMeshPath NavMeshPath = new NavMeshPath();
        //    NavMesh.CalculatePath(transform.position, corners[i], filter, NavMeshPath);
        //    agent.SetDestination(corners[i]);
        //    while (agent.pathPending)
        //        yield return null;

        //    //wait until we reached this position
        //    float remain = Vector3.Distance(transform.position, corners[i]);
        //    while (remain == Mathf.Infinity || remain - agent.stoppingDistance > float.Epsilon)
        //    {
        //        //remain = Vector3.Distance(transform.position, corners[i]);
        //        yield return null;
        //    }
        //    var objinfo = GetComponent<BaseGameObjInfo>();
        //    if (objinfo.gameObjType == CloneObjType.fireman || objinfo.gameObjType == CloneObjType.ObligationFireman)
        //    {
        //        //setFloorMessage();
        //    }
        //    i++;
        //}
        NavMeshPath NavMeshPath = new NavMeshPath();
        NavMesh.CalculatePath(transform.position, data.hitPoint, filter, NavMeshPath);
        Vector3[] corns = NavMeshPath.corners;
        while (i < corns.Length)
        {
            agent.isStopped = false;
            agent.SetDestination(corns[i]);
            //wait until we reached this position   
            while (agent.pathPending)
                yield return null;
            while (agent.remainingDistance > agent.stoppingDistance)
            {
                yield return null;
            }
            i++;
        }
    }
    private void setFloorMessage()
    {
        //设置寻路对象楼层属性
        Vector3 adPos2 = transform.position;
        Ray ray = new Ray(adPos2, -Vector3.up);
        RaycastHit hit = new RaycastHit();
        if (Physics.Raycast(ray, out hit, LayerMask.NameToLayer("PathFinding")))
        {
            if (hit.transform.gameObject.GetComponent<CloneGameObjInfo>())
            {
                CloneGameObjInfo msg = GetComponent<CloneGameObjInfo>();
                CloneGameObjInfo hitinfo = hit.transform.gameObject.GetComponent<CloneGameObjInfo>();
                msg.buildNum = hitinfo.buildNum;
                msg.floorNum = hitinfo.floorNum;
                msg.interlayerNum = hitinfo.interlayerNum;

                if (!SelectedObjs.selectedCharacters.Contains(gameObject))
                {
                    // msg.UpdateFloorEnabled(GlobalVariable.CurrentFloor);
                }
                return;
            }
        }
    }
}