polygon_sorter.gd 2.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869
  1. # The MIT License (MIT)
  2. #
  3. # Copyright (c) 2018 George Marques
  4. #
  5. # Permission is hereby granted, free of charge, to any person obtaining a copy
  6. # of this software and associated documentation files (the "Software"), to deal
  7. # in the Software without restriction, including without limitation the rights
  8. # to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  9. # copies of the Software, and to permit persons to whom the Software is
  10. # furnished to do so, subject to the following conditions:
  11. #
  12. # The above copyright notice and this permission notice shall be included in all
  13. # copies or substantial portions of the Software.
  14. #
  15. # THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16. # IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17. # FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  18. # AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19. # LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  20. # OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  21. # SOFTWARE.
  22. # Sorter for polygon vertices
  23. @tool
  24. extends RefCounted
  25. class_name PolygonSorter
  26. var center
  27. # Sort the vertices of a convex polygon to clockwise order
  28. # Receives a PoolVector2Array and returns a new one
  29. func sort_polygon(vertices):
  30. vertices = Array(vertices)
  31. var centroid = Vector2()
  32. var size = vertices.size()
  33. for i in range(0, size):
  34. centroid += vertices[i]
  35. centroid /= size
  36. center = centroid
  37. vertices.sort_custom(is_less)
  38. return PackedVector2Array(vertices)
  39. # Sorter function, determines which of the poins should come first
  40. func is_less(a, b):
  41. if a.x - center.x >= 0 and b.x - center.x < 0:
  42. return false
  43. elif a.x - center.x < 0 and b.x - center.x >= 0:
  44. return true
  45. elif a.x - center.x == 0 and b.x - center.x == 0:
  46. if a.y - center.y >= 0 or b.y - center.y >= 0:
  47. return a.y < b.y
  48. return a.y > b.y
  49. var det = (a.x - center.x) * (b.y - center.y) - (b.x - center.x) * (a.y - center.y)
  50. if det > 0:
  51. return true
  52. elif det < 0:
  53. return false
  54. var d1 = (a - center).length_squared()
  55. var d2 = (b - center).length_squared()
  56. return d1 < d2