WayFindingManager.cs 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305
  1. using System.Collections;
  2. using System.Collections.Generic;
  3. using UnityEngine;
  4. /// <summary>
  5. /// 寻路管理
  6. /// </summary>
  7. public class WayFindingManager : MonoSingleton<WayFindingManager>
  8. {
  9. public Transform leftLine;
  10. public Transform rightLine;
  11. public Transform player;
  12. public Transform serverItem;
  13. private Transform oldServerItem;
  14. public LineRenderer line;
  15. public GameObject route;
  16. public GameObject deviceName;
  17. public Transform lookPoint;
  18. private List<GameObject> listRoot;
  19. private List<GameObject> listDeviceDoorName;
  20. private void Start()
  21. {
  22. listRoot = new List<GameObject>();
  23. listDeviceDoorName = new List<GameObject>();
  24. }
  25. private void Update()
  26. {
  27. player.position = OpenXRCamera.Instance.head.position;
  28. if (serverItem != null&&Vector3.Distance(new Vector3(serverItem.position.x, 0, serverItem.position.z), new Vector3(OpenXRCamera.Instance.head.position.x, 0, OpenXRCamera.Instance.head.position.z)) < 1f)
  29. {
  30. line.positionCount = 0;
  31. oldServerItem = serverItem;
  32. serverItem = null;
  33. MachineRoomManager.Instance.RandomRange();
  34. }
  35. }
  36. public void SetServerItem( Transform serverItem)
  37. {
  38. this.serverItem = serverItem;
  39. if (oldServerItem != null && serverItem.localPosition.z == oldServerItem.localPosition.z) // 再一次生成的位置和当前的机柜在同一行
  40. {
  41. line.positionCount = 2;
  42. line.SetPosition(0, new Vector3(oldServerItem.localPosition.x, 0, oldServerItem.localPosition.z+MachineRoomManager.Instance.data.cabinetW/2.0f+MachineRoomManager.Instance.data.intervalL/2.0f));
  43. line.SetPosition(1, new Vector3(serverItem.localPosition.x, 0, serverItem.localPosition.z + MachineRoomManager.Instance.data.cabinetW / 2.0f + MachineRoomManager.Instance.data.intervalL / 2.0f));
  44. }
  45. else
  46. {
  47. float leftDis = Vector3.Distance(new Vector3(player.localPosition.x, 0, player.localPosition.z), new Vector3(leftLine.localPosition.x, 0, leftLine.localPosition.z));
  48. float rightDis = Vector3.Distance(new Vector3(player.localPosition.x, 0, player.localPosition.z), new Vector3(rightLine.localPosition.x, 0, rightLine.localPosition.z));
  49. if (Mathf.Abs(leftDis) < Mathf.Abs(rightDis))
  50. {
  51. line.positionCount = 4;
  52. line.SetPosition(0, new Vector3(player.localPosition.x, 0, player.localPosition.z));
  53. line.SetPosition(1, new Vector3(leftLine.localPosition.x, 0, player.localPosition.z));
  54. line.SetPosition(2, new Vector3(leftLine.localPosition.x, 0, serverItem.localPosition.z + MachineRoomManager.Instance.data.cabinetW / 2.0f + MachineRoomManager.Instance.data.intervalL / 2.0f));
  55. line.SetPosition(3, new Vector3(serverItem.localPosition.x, 0, serverItem.localPosition.z + MachineRoomManager.Instance.data.cabinetW / 2.0f + MachineRoomManager.Instance.data.intervalL / 2.0f));
  56. }
  57. else
  58. {
  59. line.positionCount = 4;
  60. line.SetPosition(0, new Vector3(player.localPosition.x, 0, player.localPosition.z));
  61. line.SetPosition(1, new Vector3(rightLine.localPosition.x, 0, player.localPosition.z));
  62. line.SetPosition(2, new Vector3(rightLine.localPosition.x, 0, serverItem.localPosition.z));
  63. line.SetPosition(3, new Vector3(serverItem.localPosition.x, 0, serverItem.localPosition.z));
  64. }
  65. }
  66. }
  67. public void SetLine( Vector3 leftPos, Vector3 rightPos)
  68. {
  69. leftLine.localPosition = leftPos;
  70. rightLine.localPosition = rightPos;
  71. }
  72. public void NavigatorServer(MachineObj serverItem)
  73. {
  74. for (int i = 0; i < listRoot.Count; i++)
  75. {
  76. listRoot[i].SetActive(false);
  77. }
  78. listRoot.Clear();
  79. for (int i = 0; i < listDeviceDoorName.Count; i++)
  80. {
  81. listDeviceDoorName[i].SetActive(false);
  82. }
  83. listDeviceDoorName.Clear();
  84. this.serverItem = serverItem.transform;
  85. if (Mathf.Abs(player.localPosition.z- serverItem.transform.localPosition.z) < (MachineRoomManager.Instance.data.intervalL/2.0f+MachineRoomManager.Instance.data.cabinetW/2.0f)) // 我和当前导览的位置在同一行
  86. {
  87. Vector3 pos1 = new Vector3(player.localPosition.x, 0, player.localPosition.z);
  88. Vector3 pos2 = new Vector3(serverItem.transform.localPosition.x, 0, serverItem.transform.localPosition.z + ((serverItem.isSingle ? 1 : -1) * 1));
  89. List<Vector3> listPos = new List<Vector3>();
  90. listPos.Add(pos1);
  91. listPos.Add(pos2);
  92. listPos.Add(new Vector3(serverItem.transform.localPosition.x,0,serverItem.transform.localPosition.z));
  93. CreateRoute(listPos,serverItem,true);
  94. }
  95. else
  96. {
  97. float leftDis = Vector3.Distance(new Vector3(player.localPosition.x, 0, player.localPosition.z), new Vector3(leftLine.localPosition.x, 0, leftLine.localPosition.z));
  98. float rightDis = Vector3.Distance(new Vector3(player.localPosition.x, 0, player.localPosition.z), new Vector3(rightLine.localPosition.x, 0, rightLine.localPosition.z));
  99. if (Mathf.Abs(leftDis) < Mathf.Abs(rightDis))
  100. {
  101. Vector3 pos1 = new Vector3(player.localPosition.x, 0, player.localPosition.z);
  102. Vector3 pos2 = new Vector3(leftLine.localPosition.x, 0, player.localPosition.z);
  103. //Vector3 pos3 = new Vector3(leftLine.localPosition.x, 0, serverItem.navigatorPoint.localPosition.z + (serverItem.isSingle ? -1 : 1) * MachineRoomManager.Instance.data.cabinetW / 2.0f + MachineRoomManager.Instance.data.intervalL / 2.0f);
  104. //Vector3 pos4 = new Vector3(serverItem.navigatorPoint.localPosition.x, 0, serverItem.navigatorPoint.localPosition.z + (serverItem.isSingle ? -1 : 1) * MachineRoomManager.Instance.data.cabinetW / 2.0f + MachineRoomManager.Instance.data.intervalL / 2.0f);
  105. Vector3 pos3 = new Vector3(leftLine.localPosition.x,0,serverItem.transform.localPosition.z + ((serverItem.isSingle ? 1 : -1) * 1));
  106. Vector3 pos4 = new Vector3(serverItem.transform.localPosition.x, 0, serverItem.transform.localPosition.z + ((serverItem.isSingle ? 1 : -1) * 1));
  107. List<Vector3> listpos = new List<Vector3>();
  108. listpos.Add(pos1);
  109. listpos.Add(pos2);
  110. listpos.Add(pos3);
  111. listpos.Add(pos4);
  112. listpos.Add(serverItem.transform.localPosition);
  113. CreateRoute(listpos,serverItem,true);
  114. }
  115. else
  116. {
  117. //line.positionCount = 4;
  118. //line.SetPosition(0, new Vector3(player.localPosition.x, 0, player.localPosition.z));
  119. //line.SetPosition(1, new Vector3(rightLine.localPosition.x, 0, player.localPosition.z));
  120. //line.SetPosition(2, new Vector3(rightLine.localPosition.x, 0, serverItem.localPosition.z));
  121. //line.SetPosition(3, new Vector3(serverItem.localPosition.x, 0, serverItem.localPosition.z));
  122. Vector3 pos1 = new Vector3(player.localPosition.x, 0, player.localPosition.z);
  123. Vector3 pos2 = new Vector3(rightLine.localPosition.x, 0, player.localPosition.z);
  124. //Vector3 pos3 = new Vector3(rightLine.localPosition.x, 0, serverItem.navigatorPoint.localPosition.z + (serverItem.isSingle ? -1 : 1) * MachineRoomManager.Instance.data.cabinetW / 2.0f + MachineRoomManager.Instance.data.intervalL / 2.0f);
  125. //Vector3 pos4 = new Vector3(serverItem.navigatorPoint.localPosition.x, 0, serverItem.navigatorPoint.localPosition.z + (serverItem.isSingle ? -1 : 1) * MachineRoomManager.Instance.data.cabinetW / 2.0f + MachineRoomManager.Instance.data.intervalL / 2.0f);
  126. Vector3 pos3 = new Vector3(rightLine.localPosition.x, 0, serverItem.transform.localPosition.z + ((serverItem.isSingle ? 1 : -1) * 1));
  127. Vector3 pos4 = new Vector3(serverItem.transform.localPosition.x, 0, serverItem.transform.localPosition.z + ((serverItem.isSingle ? 1 : -1) * 1));
  128. List<Vector3> listpos = new List<Vector3>();
  129. listpos.Add(pos1);
  130. listpos.Add(pos2);
  131. listpos.Add(pos3);
  132. listpos.Add(pos4);
  133. listpos.Add(serverItem.transform.localPosition);
  134. CreateRoute(listpos, serverItem, true);
  135. }
  136. }
  137. }
  138. private void CreateRoute(List<Vector3> listPos,MachineObj machineObj, bool isdevice)
  139. {
  140. for (int i = 0; i < listPos.Count - 1; i++)
  141. {
  142. GameObject route1 = GameObject.Instantiate(route, MachineRoomManager.Instance.transform);
  143. route1.transform.localPosition = listPos[i];
  144. lookPoint.localPosition = listPos[i + 1];
  145. route1.transform.LookAt(lookPoint);
  146. route1.SetActive(true);
  147. listRoot.Add(route1);
  148. }
  149. if(isdevice&& machineObj)
  150. {
  151. GameObject devicedoorName = GameObject.Instantiate(deviceName, MachineRoomManager.Instance.transform);
  152. devicedoorName.transform.localPosition = listPos[listPos.Count - 2];
  153. devicedoorName.transform.LookAt(lookPoint);
  154. devicedoorName.transform.localPosition = machineObj.door.position + new Vector3(0, 1, 0);
  155. listDeviceDoorName.Add(devicedoorName);
  156. }
  157. }
  158. private void CreateRoute(List<Vector3> listPos , bool isDevice)
  159. {
  160. for (int i = 0; i < listPos.Count-1; i++)
  161. {
  162. GameObject route1 = GameObject.Instantiate(route, MachineRoomManager.Instance.transform);
  163. route1.transform.localPosition = listPos[i];
  164. lookPoint.localPosition = listPos[i + 1];
  165. route1.transform.LookAt(lookPoint);
  166. route1.SetActive(true);
  167. listRoot.Add(route1);
  168. }
  169. if(isDevice)
  170. {
  171. GameObject devicedoorName = GameObject.Instantiate(deviceName, MachineRoomManager.Instance.transform);
  172. devicedoorName.transform.localPosition = listPos[listPos.Count - 2];
  173. lookPoint.localPosition += new Vector3(0, 0, 10);
  174. devicedoorName.transform.LookAt(lookPoint);
  175. listDeviceDoorName.Add(devicedoorName);
  176. }
  177. }
  178. public void NavigatorServer(List<MachineObj> listServerItem)
  179. {
  180. for (int i = 0; i < listRoot.Count; i++)
  181. {
  182. listRoot[i].SetActive(false);
  183. }
  184. listRoot.Clear();
  185. listRoot = new List<GameObject>();
  186. float leftDis = Vector3.Distance(new Vector3(player.localPosition.x, 0, player.localPosition.z), new Vector3(leftLine.localPosition.x, 0, leftLine.localPosition.z));
  187. float rightDis = Vector3.Distance(new Vector3(player.localPosition.x, 0, player.localPosition.z), new Vector3(rightLine.localPosition.x, 0, rightLine.localPosition.z));
  188. Vector3 pos1 = new Vector3(player.localPosition.x, 0, player.localPosition.z);
  189. Vector3 pos2;
  190. if(Mathf.Abs( leftDis)<Mathf.Abs( rightDis))
  191. {
  192. pos2 = new Vector3(leftLine.localPosition.x, 0, player.localPosition.z);
  193. }
  194. else
  195. {
  196. pos2 = new Vector3(rightLine.localPosition.x, 0, player.localPosition.z);
  197. }
  198. List<Vector3> listpos = new List<Vector3>();
  199. listpos.Add(pos1);
  200. listpos.Add(pos2);
  201. listpos.Add(new Vector3(rightLine.localPosition.x, 0, player.localPosition.z + 10000));
  202. CreateRoute(listpos,null,false); // 依据Player 生成两个固定点 当前Player点 和 出口点
  203. List<Vector3> listentrance = new List<Vector3>();
  204. for (int i = 0; i < listServerItem.Count; i++)
  205. {
  206. listpos.Clear();
  207. listpos.Add(new Vector3(listServerItem[i].transform.localPosition.x, 0, listServerItem[i].transform.localPosition.z + ((listServerItem[i].isSingle ? 1 : -1) * 1)));
  208. listpos.Add(listServerItem[i].transform.localPosition);
  209. CreateRoute(listpos,listServerItem[i],true); // 根据机位生成 机位点
  210. Vector3 entrance = new Vector3(Mathf.Abs(leftDis) < Mathf.Abs(rightDis)?leftLine.localPosition.x:rightLine.localPosition.x,0, listServerItem[i].transform.localPosition.z + ((listServerItem[i].isSingle ? 1 : -1) * 1));
  211. bool finish = true;
  212. for (int j = 0; j < listentrance.Count; j++)
  213. {
  214. if(entrance == listentrance[i])
  215. {
  216. finish = false;
  217. break;
  218. }
  219. }
  220. if(finish)
  221. {
  222. List<Vector3> listentrancePos = new List<Vector3>();
  223. listentrancePos.Add(entrance);
  224. listentrancePos.Add(new Vector3(listServerItem[i].transform.localPosition.x, 0, listServerItem[i].transform.localPosition.z + ((listServerItem[i].isSingle ? 1 : -1) * 1)));
  225. CreateRoute(listentrancePos,listServerItem[i],false); // 生成当前机位的 入口点
  226. }
  227. }
  228. }
  229. }
  230. public class RouteTF
  231. {
  232. public Vector3 Pos { get; set; }
  233. public float AnglesY { get; set; }
  234. public RouteTF() { }
  235. public RouteTF(Vector3 pos)
  236. {
  237. this.Pos = pos;
  238. }
  239. }