| 1 | /**************************************************************************/ |
| 2 | /* gltf_physics_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 | |
| 31 | #include "gltf_physics_shape.h" |
| 32 | |
| 33 | #include "../../gltf_state.h" |
| 34 | |
| 35 | #include "core/math/convex_hull.h" |
| 36 | #include "scene/3d/area_3d.h" |
| 37 | #include "scene/resources/box_shape_3d.h" |
| 38 | #include "scene/resources/capsule_shape_3d.h" |
| 39 | #include "scene/resources/concave_polygon_shape_3d.h" |
| 40 | #include "scene/resources/convex_polygon_shape_3d.h" |
| 41 | #include "scene/resources/cylinder_shape_3d.h" |
| 42 | #include "scene/resources/importer_mesh.h" |
| 43 | #include "scene/resources/sphere_shape_3d.h" |
| 44 | |
| 45 | void GLTFPhysicsShape::_bind_methods() { |
| 46 | ClassDB::bind_static_method("GLTFPhysicsShape" , D_METHOD("from_node" , "shape_node" ), &GLTFPhysicsShape::from_node); |
| 47 | ClassDB::bind_method(D_METHOD("to_node" , "cache_shapes" ), &GLTFPhysicsShape::to_node, DEFVAL(false)); |
| 48 | |
| 49 | ClassDB::bind_static_method("GLTFPhysicsShape" , D_METHOD("from_dictionary" , "dictionary" ), &GLTFPhysicsShape::from_dictionary); |
| 50 | ClassDB::bind_method(D_METHOD("to_dictionary" ), &GLTFPhysicsShape::to_dictionary); |
| 51 | |
| 52 | ClassDB::bind_method(D_METHOD("get_shape_type" ), &GLTFPhysicsShape::get_shape_type); |
| 53 | ClassDB::bind_method(D_METHOD("set_shape_type" , "shape_type" ), &GLTFPhysicsShape::set_shape_type); |
| 54 | ClassDB::bind_method(D_METHOD("get_size" ), &GLTFPhysicsShape::get_size); |
| 55 | ClassDB::bind_method(D_METHOD("set_size" , "size" ), &GLTFPhysicsShape::set_size); |
| 56 | ClassDB::bind_method(D_METHOD("get_radius" ), &GLTFPhysicsShape::get_radius); |
| 57 | ClassDB::bind_method(D_METHOD("set_radius" , "radius" ), &GLTFPhysicsShape::set_radius); |
| 58 | ClassDB::bind_method(D_METHOD("get_height" ), &GLTFPhysicsShape::get_height); |
| 59 | ClassDB::bind_method(D_METHOD("set_height" , "height" ), &GLTFPhysicsShape::set_height); |
| 60 | ClassDB::bind_method(D_METHOD("get_is_trigger" ), &GLTFPhysicsShape::get_is_trigger); |
| 61 | ClassDB::bind_method(D_METHOD("set_is_trigger" , "is_trigger" ), &GLTFPhysicsShape::set_is_trigger); |
| 62 | ClassDB::bind_method(D_METHOD("get_mesh_index" ), &GLTFPhysicsShape::get_mesh_index); |
| 63 | ClassDB::bind_method(D_METHOD("set_mesh_index" , "mesh_index" ), &GLTFPhysicsShape::set_mesh_index); |
| 64 | ClassDB::bind_method(D_METHOD("get_importer_mesh" ), &GLTFPhysicsShape::get_importer_mesh); |
| 65 | ClassDB::bind_method(D_METHOD("set_importer_mesh" , "importer_mesh" ), &GLTFPhysicsShape::set_importer_mesh); |
| 66 | |
| 67 | ADD_PROPERTY(PropertyInfo(Variant::STRING, "shape_type" ), "set_shape_type" , "get_shape_type" ); |
| 68 | ADD_PROPERTY(PropertyInfo(Variant::VECTOR3, "size" ), "set_size" , "get_size" ); |
| 69 | ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "radius" ), "set_radius" , "get_radius" ); |
| 70 | ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "height" ), "set_height" , "get_height" ); |
| 71 | ADD_PROPERTY(PropertyInfo(Variant::BOOL, "is_trigger" ), "set_is_trigger" , "get_is_trigger" ); |
| 72 | ADD_PROPERTY(PropertyInfo(Variant::INT, "mesh_index" ), "set_mesh_index" , "get_mesh_index" ); |
| 73 | ADD_PROPERTY(PropertyInfo(Variant::OBJECT, "importer_mesh" , PROPERTY_HINT_RESOURCE_TYPE, "ImporterMesh" ), "set_importer_mesh" , "get_importer_mesh" ); |
| 74 | } |
| 75 | |
| 76 | String GLTFPhysicsShape::get_shape_type() const { |
| 77 | return shape_type; |
| 78 | } |
| 79 | |
| 80 | void GLTFPhysicsShape::set_shape_type(String p_shape_type) { |
| 81 | shape_type = p_shape_type; |
| 82 | } |
| 83 | |
| 84 | Vector3 GLTFPhysicsShape::get_size() const { |
| 85 | return size; |
| 86 | } |
| 87 | |
| 88 | void GLTFPhysicsShape::set_size(Vector3 p_size) { |
| 89 | size = p_size; |
| 90 | } |
| 91 | |
| 92 | real_t GLTFPhysicsShape::get_radius() const { |
| 93 | return radius; |
| 94 | } |
| 95 | |
| 96 | void GLTFPhysicsShape::set_radius(real_t p_radius) { |
| 97 | radius = p_radius; |
| 98 | } |
| 99 | |
| 100 | real_t GLTFPhysicsShape::get_height() const { |
| 101 | return height; |
| 102 | } |
| 103 | |
| 104 | void GLTFPhysicsShape::set_height(real_t p_height) { |
| 105 | height = p_height; |
| 106 | } |
| 107 | |
| 108 | bool GLTFPhysicsShape::get_is_trigger() const { |
| 109 | return is_trigger; |
| 110 | } |
| 111 | |
| 112 | void GLTFPhysicsShape::set_is_trigger(bool p_is_trigger) { |
| 113 | is_trigger = p_is_trigger; |
| 114 | } |
| 115 | |
| 116 | GLTFMeshIndex GLTFPhysicsShape::get_mesh_index() const { |
| 117 | return mesh_index; |
| 118 | } |
| 119 | |
| 120 | void GLTFPhysicsShape::set_mesh_index(GLTFMeshIndex p_mesh_index) { |
| 121 | mesh_index = p_mesh_index; |
| 122 | } |
| 123 | |
| 124 | Ref<ImporterMesh> GLTFPhysicsShape::get_importer_mesh() const { |
| 125 | return importer_mesh; |
| 126 | } |
| 127 | |
| 128 | void GLTFPhysicsShape::set_importer_mesh(Ref<ImporterMesh> p_importer_mesh) { |
| 129 | importer_mesh = p_importer_mesh; |
| 130 | } |
| 131 | |
| 132 | Ref<GLTFPhysicsShape> GLTFPhysicsShape::from_node(const CollisionShape3D *p_collider_node) { |
| 133 | Ref<GLTFPhysicsShape> gltf_shape; |
| 134 | gltf_shape.instantiate(); |
| 135 | ERR_FAIL_NULL_V_MSG(p_collider_node, gltf_shape, "Tried to create a GLTFPhysicsShape from a CollisionShape3D node, but the given node was null." ); |
| 136 | Node *parent = p_collider_node->get_parent(); |
| 137 | if (cast_to<const Area3D>(parent)) { |
| 138 | gltf_shape->set_is_trigger(true); |
| 139 | } |
| 140 | // All the code for working with the shape is below this comment. |
| 141 | Ref<Shape3D> shape_resource = p_collider_node->get_shape(); |
| 142 | ERR_FAIL_COND_V_MSG(shape_resource.is_null(), gltf_shape, "Tried to create a GLTFPhysicsShape from a CollisionShape3D node, but the given node had a null shape." ); |
| 143 | gltf_shape->_shape_cache = shape_resource; |
| 144 | if (cast_to<BoxShape3D>(shape_resource.ptr())) { |
| 145 | gltf_shape->shape_type = "box" ; |
| 146 | Ref<BoxShape3D> box = shape_resource; |
| 147 | gltf_shape->set_size(box->get_size()); |
| 148 | } else if (cast_to<const CapsuleShape3D>(shape_resource.ptr())) { |
| 149 | gltf_shape->shape_type = "capsule" ; |
| 150 | Ref<CapsuleShape3D> capsule = shape_resource; |
| 151 | gltf_shape->set_radius(capsule->get_radius()); |
| 152 | gltf_shape->set_height(capsule->get_height()); |
| 153 | } else if (cast_to<const CylinderShape3D>(shape_resource.ptr())) { |
| 154 | gltf_shape->shape_type = "cylinder" ; |
| 155 | Ref<CylinderShape3D> cylinder = shape_resource; |
| 156 | gltf_shape->set_radius(cylinder->get_radius()); |
| 157 | gltf_shape->set_height(cylinder->get_height()); |
| 158 | } else if (cast_to<const SphereShape3D>(shape_resource.ptr())) { |
| 159 | gltf_shape->shape_type = "sphere" ; |
| 160 | Ref<SphereShape3D> sphere = shape_resource; |
| 161 | gltf_shape->set_radius(sphere->get_radius()); |
| 162 | } else if (cast_to<const ConvexPolygonShape3D>(shape_resource.ptr())) { |
| 163 | gltf_shape->shape_type = "hull" ; |
| 164 | Ref<ConvexPolygonShape3D> convex = shape_resource; |
| 165 | Vector<Vector3> hull_points = convex->get_points(); |
| 166 | ERR_FAIL_COND_V_MSG(hull_points.size() < 3, gltf_shape, "GLTFPhysicsShape: Convex hull has fewer points (" + itos(hull_points.size()) + ") than the minimum of 3. At least 3 points are required in order to save to GLTF, since it uses a mesh to represent convex hulls." ); |
| 167 | if (hull_points.size() > 255) { |
| 168 | WARN_PRINT("GLTFPhysicsShape: Convex hull has more points (" + itos(hull_points.size()) + ") than the recommended maximum of 255. This may not load correctly in other engines." ); |
| 169 | } |
| 170 | // Convert the convex hull points into an array of faces. |
| 171 | Geometry3D::MeshData md; |
| 172 | Error err = ConvexHullComputer::convex_hull(hull_points, md); |
| 173 | ERR_FAIL_COND_V_MSG(err != OK, gltf_shape, "GLTFPhysicsShape: Failed to compute convex hull." ); |
| 174 | Vector<Vector3> face_vertices; |
| 175 | for (uint32_t i = 0; i < md.faces.size(); i++) { |
| 176 | uint32_t index_count = md.faces[i].indices.size(); |
| 177 | for (uint32_t j = 1; j < index_count - 1; j++) { |
| 178 | face_vertices.append(hull_points[md.faces[i].indices[0]]); |
| 179 | face_vertices.append(hull_points[md.faces[i].indices[j]]); |
| 180 | face_vertices.append(hull_points[md.faces[i].indices[j + 1]]); |
| 181 | } |
| 182 | } |
| 183 | // Create an ImporterMesh from the faces. |
| 184 | Ref<ImporterMesh> importer_mesh; |
| 185 | importer_mesh.instantiate(); |
| 186 | Array surface_array; |
| 187 | surface_array.resize(Mesh::ArrayType::ARRAY_MAX); |
| 188 | surface_array[Mesh::ArrayType::ARRAY_VERTEX] = face_vertices; |
| 189 | importer_mesh->add_surface(Mesh::PRIMITIVE_TRIANGLES, surface_array); |
| 190 | gltf_shape->set_importer_mesh(importer_mesh); |
| 191 | } else if (cast_to<const ConcavePolygonShape3D>(shape_resource.ptr())) { |
| 192 | gltf_shape->shape_type = "trimesh" ; |
| 193 | Ref<ConcavePolygonShape3D> concave = shape_resource; |
| 194 | Ref<ImporterMesh> importer_mesh; |
| 195 | importer_mesh.instantiate(); |
| 196 | Array surface_array; |
| 197 | surface_array.resize(Mesh::ArrayType::ARRAY_MAX); |
| 198 | surface_array[Mesh::ArrayType::ARRAY_VERTEX] = concave->get_faces(); |
| 199 | importer_mesh->add_surface(Mesh::PRIMITIVE_TRIANGLES, surface_array); |
| 200 | gltf_shape->set_importer_mesh(importer_mesh); |
| 201 | } else { |
| 202 | ERR_PRINT("Tried to create a GLTFPhysicsShape from a CollisionShape3D node, but the given node's shape '" + String(Variant(shape_resource)) + |
| 203 | "' had an unsupported shape type. Only BoxShape3D, CapsuleShape3D, CylinderShape3D, SphereShape3D, ConcavePolygonShape3D, and ConvexPolygonShape3D are supported." ); |
| 204 | } |
| 205 | return gltf_shape; |
| 206 | } |
| 207 | |
| 208 | CollisionShape3D *GLTFPhysicsShape::to_node(bool p_cache_shapes) { |
| 209 | CollisionShape3D *gltf_shape = memnew(CollisionShape3D); |
| 210 | if (!p_cache_shapes || _shape_cache == nullptr) { |
| 211 | if (shape_type == "box" ) { |
| 212 | Ref<BoxShape3D> box; |
| 213 | box.instantiate(); |
| 214 | box->set_size(size); |
| 215 | _shape_cache = box; |
| 216 | } else if (shape_type == "capsule" ) { |
| 217 | Ref<CapsuleShape3D> capsule; |
| 218 | capsule.instantiate(); |
| 219 | capsule->set_radius(radius); |
| 220 | capsule->set_height(height); |
| 221 | _shape_cache = capsule; |
| 222 | } else if (shape_type == "cylinder" ) { |
| 223 | Ref<CylinderShape3D> cylinder; |
| 224 | cylinder.instantiate(); |
| 225 | cylinder->set_radius(radius); |
| 226 | cylinder->set_height(height); |
| 227 | _shape_cache = cylinder; |
| 228 | } else if (shape_type == "sphere" ) { |
| 229 | Ref<SphereShape3D> sphere; |
| 230 | sphere.instantiate(); |
| 231 | sphere->set_radius(radius); |
| 232 | _shape_cache = sphere; |
| 233 | } else if (shape_type == "hull" ) { |
| 234 | ERR_FAIL_COND_V_MSG(importer_mesh.is_null(), gltf_shape, "GLTFPhysicsShape: Error converting convex hull shape to a node: The mesh resource is null." ); |
| 235 | Ref<ConvexPolygonShape3D> convex = importer_mesh->get_mesh()->create_convex_shape(); |
| 236 | _shape_cache = convex; |
| 237 | } else if (shape_type == "trimesh" ) { |
| 238 | ERR_FAIL_COND_V_MSG(importer_mesh.is_null(), gltf_shape, "GLTFPhysicsShape: Error converting concave mesh shape to a node: The mesh resource is null." ); |
| 239 | Ref<ConcavePolygonShape3D> concave = importer_mesh->create_trimesh_shape(); |
| 240 | _shape_cache = concave; |
| 241 | } else { |
| 242 | ERR_PRINT("GLTFPhysicsShape: Error converting to a node: Shape type '" + shape_type + "' is unknown." ); |
| 243 | } |
| 244 | } |
| 245 | gltf_shape->set_shape(_shape_cache); |
| 246 | return gltf_shape; |
| 247 | } |
| 248 | |
| 249 | Ref<GLTFPhysicsShape> GLTFPhysicsShape::from_dictionary(const Dictionary p_dictionary) { |
| 250 | ERR_FAIL_COND_V_MSG(!p_dictionary.has("type" ), Ref<GLTFPhysicsShape>(), "Failed to parse GLTFPhysicsShape, missing required field 'type'." ); |
| 251 | Ref<GLTFPhysicsShape> gltf_shape; |
| 252 | gltf_shape.instantiate(); |
| 253 | const String &shape_type = p_dictionary["type" ]; |
| 254 | gltf_shape->shape_type = shape_type; |
| 255 | if (shape_type != "box" && shape_type != "capsule" && shape_type != "cylinder" && shape_type != "sphere" && shape_type != "hull" && shape_type != "trimesh" ) { |
| 256 | ERR_PRINT("GLTFPhysicsShape: Error parsing unknown shape type '" + shape_type + "'. Only box, capsule, cylinder, sphere, hull, and trimesh are supported." ); |
| 257 | } |
| 258 | if (p_dictionary.has("radius" )) { |
| 259 | gltf_shape->set_radius(p_dictionary["radius" ]); |
| 260 | } |
| 261 | if (p_dictionary.has("height" )) { |
| 262 | gltf_shape->set_height(p_dictionary["height" ]); |
| 263 | } |
| 264 | if (p_dictionary.has("size" )) { |
| 265 | const Array &arr = p_dictionary["size" ]; |
| 266 | if (arr.size() == 3) { |
| 267 | gltf_shape->set_size(Vector3(arr[0], arr[1], arr[2])); |
| 268 | } else { |
| 269 | ERR_PRINT("GLTFPhysicsShape: Error parsing the size, it must have exactly 3 numbers." ); |
| 270 | } |
| 271 | } |
| 272 | if (p_dictionary.has("isTrigger" )) { |
| 273 | gltf_shape->set_is_trigger(p_dictionary["isTrigger" ]); |
| 274 | } |
| 275 | if (p_dictionary.has("mesh" )) { |
| 276 | gltf_shape->set_mesh_index(p_dictionary["mesh" ]); |
| 277 | } |
| 278 | if (unlikely(gltf_shape->get_mesh_index() < 0 && (shape_type == "hull" || shape_type == "trimesh" ))) { |
| 279 | ERR_PRINT("Error parsing GLTFPhysicsShape: The mesh-based shape type '" + shape_type + "' does not have a valid mesh index." ); |
| 280 | } |
| 281 | return gltf_shape; |
| 282 | } |
| 283 | |
| 284 | Dictionary GLTFPhysicsShape::to_dictionary() const { |
| 285 | Dictionary d; |
| 286 | d["type" ] = shape_type; |
| 287 | if (shape_type == "box" ) { |
| 288 | Array size_array; |
| 289 | size_array.resize(3); |
| 290 | size_array[0] = size.x; |
| 291 | size_array[1] = size.y; |
| 292 | size_array[2] = size.z; |
| 293 | d["size" ] = size_array; |
| 294 | } else if (shape_type == "capsule" ) { |
| 295 | d["radius" ] = get_radius(); |
| 296 | d["height" ] = get_height(); |
| 297 | } else if (shape_type == "cylinder" ) { |
| 298 | d["radius" ] = get_radius(); |
| 299 | d["height" ] = get_height(); |
| 300 | } else if (shape_type == "sphere" ) { |
| 301 | d["radius" ] = get_radius(); |
| 302 | } else if (shape_type == "trimesh" || shape_type == "hull" ) { |
| 303 | d["mesh" ] = get_mesh_index(); |
| 304 | } |
| 305 | if (is_trigger) { |
| 306 | d["isTrigger" ] = is_trigger; |
| 307 | } |
| 308 | return d; |
| 309 | } |
| 310 | |