DistanceUtils.cs 5.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147
  1. /*
  2. Copyright (c) 2021 Omar Duarte
  3. Unauthorized copying of this file, via any medium is strictly prohibited.
  4. Writen by Omar Duarte, 2021.
  5. THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  6. IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  7. FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  8. AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  9. LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  10. OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  11. THE SOFTWARE.
  12. */
  13. #if !UNITY_2020_2_OR_NEWER
  14. using System.Linq;
  15. #endif
  16. using UnityEngine;
  17. namespace PluginMaster
  18. {
  19. public static class DistanceUtils
  20. {
  21. #if !UNITY_2020_2_OR_NEWER
  22. private static System.Reflection.MethodInfo findNearestVertex = null;
  23. #endif
  24. public static bool FindNearestVertexToMouse(out RaycastHit hit, Transform transform = null)
  25. {
  26. var mouseRay = UnityEditor.HandleUtility.GUIPointToWorldRay(Event.current.mousePosition);
  27. hit = new RaycastHit();
  28. hit.point = mouseRay.origin;
  29. hit.normal = Vector3.up;
  30. hit.distance = 0f;
  31. bool result = false;
  32. var vertex = Vector3.zero;
  33. void SetHit(ref RaycastHit resultHit)
  34. {
  35. var vertexRay = new Ray(vertex - mouseRay.direction, mouseRay.direction);
  36. if (Physics.Raycast(vertexRay, out RaycastHit rayHit))
  37. {
  38. if (transform == null) transform = rayHit.collider.transform;
  39. resultHit.normal = rayHit.normal;
  40. }
  41. else if (transform != null)
  42. {
  43. var normal = GetNormal(transform, vertex, Vector3.zero);
  44. if (normal != Vector3.zero) resultHit.normal = normal;
  45. }
  46. resultHit.point = vertex;
  47. }
  48. if (transform != null)
  49. {
  50. var terrain = transform.GetComponent<Terrain>();
  51. if (terrain != null)
  52. {
  53. var corners = TerrainUtils.GetCorners(terrain, Space.World);
  54. var minDist = float.MaxValue;
  55. vertex = corners[0];
  56. foreach (var corner in corners)
  57. {
  58. var dist = Vector3.Cross(mouseRay.direction, corner - mouseRay.origin).magnitude;
  59. if (dist < minDist)
  60. {
  61. minDist = dist;
  62. vertex = corner;
  63. }
  64. }
  65. result = true;
  66. SetHit(ref hit);
  67. return result;
  68. }
  69. }
  70. #if UNITY_2020_2_OR_NEWER
  71. if (transform == null)
  72. result = UnityEditor.HandleUtility.FindNearestVertex(Event.current.mousePosition, out vertex);
  73. else
  74. result = UnityEditor.HandleUtility.FindNearestVertex(Event.current.mousePosition,
  75. new Transform[] { transform }, out vertex);
  76. #else
  77. Transform[] selection = { transform };
  78. if (findNearestVertex == null)
  79. {
  80. var editorTypes = typeof(UnityEditor.Editor).Assembly.GetTypes();
  81. var type_HandleUtility = editorTypes.FirstOrDefault(t => t.Name == "HandleUtility");
  82. findNearestVertex = type_HandleUtility.GetMethod("FindNearestVertex",
  83. System.Reflection.BindingFlags.Static | System.Reflection.BindingFlags.NonPublic);
  84. }
  85. var parameters = new object[] { Event.current.mousePosition, selection, null };
  86. result = (bool)findNearestVertex.Invoke(null, parameters);
  87. if (result) vertex = (Vector3)parameters[2];
  88. #endif
  89. if (!result) return false;
  90. SetHit(ref hit);
  91. return result;
  92. }
  93. private static Vector3 GetNormal(Transform transform, Vector3 vertex, Vector3 defaultValue)
  94. {
  95. var result = defaultValue;
  96. var colliders = transform.GetComponentsInChildren<Collider>();
  97. int GetVertexIdx(Mesh mesh, Vector3 v)
  98. {
  99. if (mesh == null) return -1;
  100. var idx = System.Array.IndexOf(mesh.vertices, v);
  101. if (idx < 0) return idx;
  102. return idx;
  103. }
  104. foreach (var collider in colliders)
  105. {
  106. if (collider is MeshCollider)
  107. {
  108. var meshCollider = collider as MeshCollider;
  109. var idx = GetVertexIdx(meshCollider.sharedMesh, vertex);
  110. if (idx < 0) continue;
  111. return meshCollider.sharedMesh.normals[idx];
  112. }
  113. else
  114. {
  115. var center = BoundsUtils.GetBoundsRecursive(transform).center;
  116. result = (vertex - center).normalized;
  117. return result;
  118. }
  119. }
  120. var meshFilters = transform.GetComponentsInChildren<MeshFilter>();
  121. foreach (var filter in meshFilters)
  122. {
  123. var mesh = filter.sharedMesh;
  124. var idx = GetVertexIdx(mesh, vertex);
  125. if (idx < 0) continue;
  126. return mesh.normals[idx];
  127. }
  128. var renderers = transform.GetComponentsInChildren<SkinnedMeshRenderer>();
  129. foreach (var renderer in renderers)
  130. {
  131. var mesh = renderer.sharedMesh;
  132. var idx = GetVertexIdx(mesh, vertex);
  133. if (idx < 0) continue;
  134. return mesh.normals[idx];
  135. }
  136. return result;
  137. }
  138. }
  139. }