convex_polygon_shape.cpp 3.9 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091
  1. /**************************************************************************/
  2. /* convex_polygon_shape.cpp */
  3. /**************************************************************************/
  4. /* This file is part of: */
  5. /* GODOT ENGINE */
  6. /* https://godotengine.org */
  7. /**************************************************************************/
  8. /* Copyright (c) 2014-present Godot Engine contributors (see AUTHORS.md). */
  9. /* Copyright (c) 2007-2014 Juan Linietsky, Ariel Manzur. */
  10. /* */
  11. /* Permission is hereby granted, free of charge, to any person obtaining */
  12. /* a copy of this software and associated documentation files (the */
  13. /* "Software"), to deal in the Software without restriction, including */
  14. /* without limitation the rights to use, copy, modify, merge, publish, */
  15. /* distribute, sublicense, and/or sell copies of the Software, and to */
  16. /* permit persons to whom the Software is furnished to do so, subject to */
  17. /* the following conditions: */
  18. /* */
  19. /* The above copyright notice and this permission notice shall be */
  20. /* included in all copies or substantial portions of the Software. */
  21. /* */
  22. /* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
  23. /* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
  24. /* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. */
  25. /* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
  26. /* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
  27. /* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
  28. /* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
  29. /**************************************************************************/
  30. #include "convex_polygon_shape.h"
  31. #include "core/math/convex_hull.h"
  32. #include "servers/physics_server.h"
  33. Vector<Vector3> ConvexPolygonShape::get_debug_mesh_lines() {
  34. PoolVector<Vector3> points = get_points();
  35. if (points.size() > 3) {
  36. Vector<Vector3> varr = Variant(points);
  37. Geometry::MeshData md;
  38. Error err = ConvexHullComputer::convex_hull(varr, md);
  39. if (err == OK) {
  40. Vector<Vector3> lines;
  41. lines.resize(md.edges.size() * 2);
  42. for (int i = 0; i < md.edges.size(); i++) {
  43. lines.write[i * 2 + 0] = md.vertices[md.edges[i].a];
  44. lines.write[i * 2 + 1] = md.vertices[md.edges[i].b];
  45. }
  46. return lines;
  47. }
  48. }
  49. return Vector<Vector3>();
  50. }
  51. real_t ConvexPolygonShape::get_enclosing_radius() const {
  52. PoolVector<Vector3> data = get_points();
  53. PoolVector<Vector3>::Read read = data.read();
  54. real_t r = 0;
  55. for (int i(0); i < data.size(); i++) {
  56. r = MAX(read[i].length_squared(), r);
  57. }
  58. return Math::sqrt(r);
  59. }
  60. void ConvexPolygonShape::_update_shape() {
  61. PhysicsServer::get_singleton()->shape_set_data(get_shape(), points);
  62. Shape::_update_shape();
  63. }
  64. void ConvexPolygonShape::set_points(const PoolVector<Vector3> &p_points) {
  65. points = p_points;
  66. _update_shape();
  67. notify_change_to_owners();
  68. }
  69. PoolVector<Vector3> ConvexPolygonShape::get_points() const {
  70. return points;
  71. }
  72. void ConvexPolygonShape::_bind_methods() {
  73. ClassDB::bind_method(D_METHOD("set_points", "points"), &ConvexPolygonShape::set_points);
  74. ClassDB::bind_method(D_METHOD("get_points"), &ConvexPolygonShape::get_points);
  75. ADD_PROPERTY(PropertyInfo(Variant::ARRAY, "points"), "set_points", "get_points");
  76. }
  77. ConvexPolygonShape::ConvexPolygonShape() :
  78. Shape(RID_PRIME(PhysicsServer::get_singleton()->shape_create(PhysicsServer::SHAPE_CONVEX_POLYGON))) {
  79. }