/*************************************************************************/ /* navigation_mesh.cpp */ /*************************************************************************/ /* This file is part of: */ /* GODOT ENGINE */ /* https://godotengine.org */ /*************************************************************************/ /* Copyright (c) 2007-2022 Juan Linietsky, Ariel Manzur. */ /* Copyright (c) 2014-2022 Godot Engine contributors (cf. AUTHORS.md). */ /* */ /* Permission is hereby granted, free of charge, to any person obtaining */ /* a copy of this software and associated documentation files (the */ /* "Software"), to deal in the Software without restriction, including */ /* without limitation the rights to use, copy, modify, merge, publish, */ /* distribute, sublicense, and/or sell copies of the Software, and to */ /* permit persons to whom the Software is furnished to do so, subject to */ /* the following conditions: */ /* */ /* The above copyright notice and this permission notice shall be */ /* included in all copies or substantial portions of the Software. */ /* */ /* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */ /* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */ /* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/ /* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */ /* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */ /* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */ /* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */ /*************************************************************************/ #include "navigation_mesh.h" void NavigationMesh::create_from_mesh(const Ref &p_mesh) { ERR_FAIL_COND(p_mesh.is_null()); vertices = Vector(); clear_polygons(); for (int i = 0; i < p_mesh->get_surface_count(); i++) { if (p_mesh->surface_get_primitive_type(i) != Mesh::PRIMITIVE_TRIANGLES) { continue; } Array arr = p_mesh->surface_get_arrays(i); ERR_CONTINUE(arr.size() != Mesh::ARRAY_MAX); Vector varr = arr[Mesh::ARRAY_VERTEX]; Vector iarr = arr[Mesh::ARRAY_INDEX]; if (varr.size() == 0 || iarr.size() == 0) { continue; } int from = vertices.size(); vertices.append_array(varr); int rlen = iarr.size(); const int *r = iarr.ptr(); for (int j = 0; j < rlen; j += 3) { Vector vi; vi.resize(3); vi.write[0] = r[j + 0] + from; vi.write[1] = r[j + 1] + from; vi.write[2] = r[j + 2] + from; add_polygon(vi); } } } void NavigationMesh::set_sample_partition_type(SamplePartitionType p_value) { ERR_FAIL_INDEX(p_value, SAMPLE_PARTITION_MAX); partition_type = p_value; } NavigationMesh::SamplePartitionType NavigationMesh::get_sample_partition_type() const { return partition_type; } void NavigationMesh::set_parsed_geometry_type(ParsedGeometryType p_value) { ERR_FAIL_INDEX(p_value, PARSED_GEOMETRY_MAX); parsed_geometry_type = p_value; notify_property_list_changed(); } NavigationMesh::ParsedGeometryType NavigationMesh::get_parsed_geometry_type() const { return parsed_geometry_type; } void NavigationMesh::set_collision_mask(uint32_t p_mask) { collision_mask = p_mask; } uint32_t NavigationMesh::get_collision_mask() const { return collision_mask; } void NavigationMesh::set_collision_mask_value(int p_layer_number, bool p_value) { ERR_FAIL_COND_MSG(p_layer_number < 1, "Collision layer number must be between 1 and 32 inclusive."); ERR_FAIL_COND_MSG(p_layer_number > 32, "Collision layer number must be between 1 and 32 inclusive."); uint32_t mask = get_collision_mask(); if (p_value) { mask |= 1 << (p_layer_number - 1); } else { mask &= ~(1 << (p_layer_number - 1)); } set_collision_mask(mask); } bool NavigationMesh::get_collision_mask_value(int p_layer_number) const { ERR_FAIL_COND_V_MSG(p_layer_number < 1, false, "Collision layer number must be between 1 and 32 inclusive."); ERR_FAIL_COND_V_MSG(p_layer_number > 32, false, "Collision layer number must be between 1 and 32 inclusive."); return get_collision_mask() & (1 << (p_layer_number - 1)); } void NavigationMesh::set_source_geometry_mode(SourceGeometryMode p_geometry_mode) { ERR_FAIL_INDEX(p_geometry_mode, SOURCE_GEOMETRY_MAX); source_geometry_mode = p_geometry_mode; notify_property_list_changed(); } NavigationMesh::SourceGeometryMode NavigationMesh::get_source_geometry_mode() const { return source_geometry_mode; } void NavigationMesh::set_source_group_name(StringName p_group_name) { source_group_name = p_group_name; } StringName NavigationMesh::get_source_group_name() const { return source_group_name; } void NavigationMesh::set_cell_size(float p_value) { ERR_FAIL_COND(p_value <= 0); cell_size = p_value; } float NavigationMesh::get_cell_size() const { return cell_size; } void NavigationMesh::set_cell_height(float p_value) { ERR_FAIL_COND(p_value <= 0); cell_height = p_value; } float NavigationMesh::get_cell_height() const { return cell_height; } void NavigationMesh::set_agent_height(float p_value) { ERR_FAIL_COND(p_value < 0); agent_height = p_value; } float NavigationMesh::get_agent_height() const { return agent_height; } void NavigationMesh::set_agent_radius(float p_value) { ERR_FAIL_COND(p_value < 0); agent_radius = p_value; } float NavigationMesh::get_agent_radius() { return agent_radius; } void NavigationMesh::set_agent_max_climb(float p_value) { ERR_FAIL_COND(p_value < 0); agent_max_climb = p_value; } float NavigationMesh::get_agent_max_climb() const { return agent_max_climb; } void NavigationMesh::set_agent_max_slope(float p_value) { ERR_FAIL_COND(p_value < 0 || p_value > 90); agent_max_slope = p_value; } float NavigationMesh::get_agent_max_slope() const { return agent_max_slope; } void NavigationMesh::set_region_min_size(float p_value) { ERR_FAIL_COND(p_value < 0); region_min_size = p_value; } float NavigationMesh::get_region_min_size() const { return region_min_size; } void NavigationMesh::set_region_merge_size(float p_value) { ERR_FAIL_COND(p_value < 0); region_merge_size = p_value; } float NavigationMesh::get_region_merge_size() const { return region_merge_size; } void NavigationMesh::set_edge_max_length(float p_value) { ERR_FAIL_COND(p_value < 0); edge_max_length = p_value; } float NavigationMesh::get_edge_max_length() const { return edge_max_length; } void NavigationMesh::set_edge_max_error(float p_value) { ERR_FAIL_COND(p_value < 0); edge_max_error = p_value; } float NavigationMesh::get_edge_max_error() const { return edge_max_error; } void NavigationMesh::set_verts_per_poly(float p_value) { ERR_FAIL_COND(p_value < 3); verts_per_poly = p_value; } float NavigationMesh::get_verts_per_poly() const { return verts_per_poly; } void NavigationMesh::set_detail_sample_distance(float p_value) { ERR_FAIL_COND(p_value < 0.1); detail_sample_distance = p_value; } float NavigationMesh::get_detail_sample_distance() const { return detail_sample_distance; } void NavigationMesh::set_detail_sample_max_error(float p_value) { ERR_FAIL_COND(p_value < 0); detail_sample_max_error = p_value; } float NavigationMesh::get_detail_sample_max_error() const { return detail_sample_max_error; } void NavigationMesh::set_filter_low_hanging_obstacles(bool p_value) { filter_low_hanging_obstacles = p_value; } bool NavigationMesh::get_filter_low_hanging_obstacles() const { return filter_low_hanging_obstacles; } void NavigationMesh::set_filter_ledge_spans(bool p_value) { filter_ledge_spans = p_value; } bool NavigationMesh::get_filter_ledge_spans() const { return filter_ledge_spans; } void NavigationMesh::set_filter_walkable_low_height_spans(bool p_value) { filter_walkable_low_height_spans = p_value; } bool NavigationMesh::get_filter_walkable_low_height_spans() const { return filter_walkable_low_height_spans; } void NavigationMesh::set_vertices(const Vector &p_vertices) { vertices = p_vertices; notify_property_list_changed(); } Vector NavigationMesh::get_vertices() const { return vertices; } void NavigationMesh::_set_polygons(const Array &p_array) { polygons.resize(p_array.size()); for (int i = 0; i < p_array.size(); i++) { polygons.write[i].indices = p_array[i]; } notify_property_list_changed(); } Array NavigationMesh::_get_polygons() const { Array ret; ret.resize(polygons.size()); for (int i = 0; i < ret.size(); i++) { ret[i] = polygons[i].indices; } return ret; } void NavigationMesh::add_polygon(const Vector &p_polygon) { Polygon polygon; polygon.indices = p_polygon; polygons.push_back(polygon); notify_property_list_changed(); } int NavigationMesh::get_polygon_count() const { return polygons.size(); } Vector NavigationMesh::get_polygon(int p_idx) { ERR_FAIL_INDEX_V(p_idx, polygons.size(), Vector()); return polygons[p_idx].indices; } void NavigationMesh::clear_polygons() { polygons.clear(); } Ref NavigationMesh::get_debug_mesh() { if (debug_mesh.is_valid()) { return debug_mesh; } Vector vertices = get_vertices(); const Vector3 *vr = vertices.ptr(); List faces; for (int i = 0; i < get_polygon_count(); i++) { Vector p = get_polygon(i); for (int j = 2; j < p.size(); j++) { Face3 f; f.vertex[0] = vr[p[0]]; f.vertex[1] = vr[p[j - 1]]; f.vertex[2] = vr[p[j]]; faces.push_back(f); } } Map<_EdgeKey, bool> edge_map; Vector tmeshfaces; tmeshfaces.resize(faces.size() * 3); { Vector3 *tw = tmeshfaces.ptrw(); int tidx = 0; for (const Face3 &f : faces) { for (int j = 0; j < 3; j++) { tw[tidx++] = f.vertex[j]; _EdgeKey ek; ek.from = f.vertex[j].snapped(Vector3(CMP_EPSILON, CMP_EPSILON, CMP_EPSILON)); ek.to = f.vertex[(j + 1) % 3].snapped(Vector3(CMP_EPSILON, CMP_EPSILON, CMP_EPSILON)); if (ek.from < ek.to) { SWAP(ek.from, ek.to); } Map<_EdgeKey, bool>::Element *F = edge_map.find(ek); if (F) { F->get() = false; } else { edge_map[ek] = true; } } } } List lines; for (const KeyValue<_EdgeKey, bool> &E : edge_map) { if (E.value) { lines.push_back(E.key.from); lines.push_back(E.key.to); } } Vector varr; varr.resize(lines.size()); { Vector3 *w = varr.ptrw(); int idx = 0; for (const Vector3 &E : lines) { w[idx++] = E; } } debug_mesh = Ref(memnew(ArrayMesh)); if (!lines.size()) { return debug_mesh; } Array arr; arr.resize(Mesh::ARRAY_MAX); arr[Mesh::ARRAY_VERTEX] = varr; debug_mesh->add_surface_from_arrays(Mesh::PRIMITIVE_LINES, arr); return debug_mesh; } void NavigationMesh::_bind_methods() { ClassDB::bind_method(D_METHOD("set_sample_partition_type", "sample_partition_type"), &NavigationMesh::set_sample_partition_type); ClassDB::bind_method(D_METHOD("get_sample_partition_type"), &NavigationMesh::get_sample_partition_type); ClassDB::bind_method(D_METHOD("set_parsed_geometry_type", "geometry_type"), &NavigationMesh::set_parsed_geometry_type); ClassDB::bind_method(D_METHOD("get_parsed_geometry_type"), &NavigationMesh::get_parsed_geometry_type); ClassDB::bind_method(D_METHOD("set_collision_mask", "mask"), &NavigationMesh::set_collision_mask); ClassDB::bind_method(D_METHOD("get_collision_mask"), &NavigationMesh::get_collision_mask); ClassDB::bind_method(D_METHOD("set_collision_mask_value", "layer_number", "value"), &NavigationMesh::set_collision_mask_value); ClassDB::bind_method(D_METHOD("get_collision_mask_value", "layer_number"), &NavigationMesh::get_collision_mask_value); ClassDB::bind_method(D_METHOD("set_source_geometry_mode", "mask"), &NavigationMesh::set_source_geometry_mode); ClassDB::bind_method(D_METHOD("get_source_geometry_mode"), &NavigationMesh::get_source_geometry_mode); ClassDB::bind_method(D_METHOD("set_source_group_name", "mask"), &NavigationMesh::set_source_group_name); ClassDB::bind_method(D_METHOD("get_source_group_name"), &NavigationMesh::get_source_group_name); ClassDB::bind_method(D_METHOD("set_cell_size", "cell_size"), &NavigationMesh::set_cell_size); ClassDB::bind_method(D_METHOD("get_cell_size"), &NavigationMesh::get_cell_size); ClassDB::bind_method(D_METHOD("set_cell_height", "cell_height"), &NavigationMesh::set_cell_height); ClassDB::bind_method(D_METHOD("get_cell_height"), &NavigationMesh::get_cell_height); ClassDB::bind_method(D_METHOD("set_agent_height", "agent_height"), &NavigationMesh::set_agent_height); ClassDB::bind_method(D_METHOD("get_agent_height"), &NavigationMesh::get_agent_height); ClassDB::bind_method(D_METHOD("set_agent_radius", "agent_radius"), &NavigationMesh::set_agent_radius); ClassDB::bind_method(D_METHOD("get_agent_radius"), &NavigationMesh::get_agent_radius); ClassDB::bind_method(D_METHOD("set_agent_max_climb", "agent_max_climb"), &NavigationMesh::set_agent_max_climb); ClassDB::bind_method(D_METHOD("get_agent_max_climb"), &NavigationMesh::get_agent_max_climb); ClassDB::bind_method(D_METHOD("set_agent_max_slope", "agent_max_slope"), &NavigationMesh::set_agent_max_slope); ClassDB::bind_method(D_METHOD("get_agent_max_slope"), &NavigationMesh::get_agent_max_slope); ClassDB::bind_method(D_METHOD("set_region_min_size", "region_min_size"), &NavigationMesh::set_region_min_size); ClassDB::bind_method(D_METHOD("get_region_min_size"), &NavigationMesh::get_region_min_size); ClassDB::bind_method(D_METHOD("set_region_merge_size", "region_merge_size"), &NavigationMesh::set_region_merge_size); ClassDB::bind_method(D_METHOD("get_region_merge_size"), &NavigationMesh::get_region_merge_size); ClassDB::bind_method(D_METHOD("set_edge_max_length", "edge_max_length"), &NavigationMesh::set_edge_max_length); ClassDB::bind_method(D_METHOD("get_edge_max_length"), &NavigationMesh::get_edge_max_length); ClassDB::bind_method(D_METHOD("set_edge_max_error", "edge_max_error"), &NavigationMesh::set_edge_max_error); ClassDB::bind_method(D_METHOD("get_edge_max_error"), &NavigationMesh::get_edge_max_error); ClassDB::bind_method(D_METHOD("set_verts_per_poly", "verts_per_poly"), &NavigationMesh::set_verts_per_poly); ClassDB::bind_method(D_METHOD("get_verts_per_poly"), &NavigationMesh::get_verts_per_poly); ClassDB::bind_method(D_METHOD("set_detail_sample_distance", "detail_sample_dist"), &NavigationMesh::set_detail_sample_distance); ClassDB::bind_method(D_METHOD("get_detail_sample_distance"), &NavigationMesh::get_detail_sample_distance); ClassDB::bind_method(D_METHOD("set_detail_sample_max_error", "detail_sample_max_error"), &NavigationMesh::set_detail_sample_max_error); ClassDB::bind_method(D_METHOD("get_detail_sample_max_error"), &NavigationMesh::get_detail_sample_max_error); ClassDB::bind_method(D_METHOD("set_filter_low_hanging_obstacles", "filter_low_hanging_obstacles"), &NavigationMesh::set_filter_low_hanging_obstacles); ClassDB::bind_method(D_METHOD("get_filter_low_hanging_obstacles"), &NavigationMesh::get_filter_low_hanging_obstacles); ClassDB::bind_method(D_METHOD("set_filter_ledge_spans", "filter_ledge_spans"), &NavigationMesh::set_filter_ledge_spans); ClassDB::bind_method(D_METHOD("get_filter_ledge_spans"), &NavigationMesh::get_filter_ledge_spans); ClassDB::bind_method(D_METHOD("set_filter_walkable_low_height_spans", "filter_walkable_low_height_spans"), &NavigationMesh::set_filter_walkable_low_height_spans); ClassDB::bind_method(D_METHOD("get_filter_walkable_low_height_spans"), &NavigationMesh::get_filter_walkable_low_height_spans); ClassDB::bind_method(D_METHOD("set_vertices", "vertices"), &NavigationMesh::set_vertices); ClassDB::bind_method(D_METHOD("get_vertices"), &NavigationMesh::get_vertices); ClassDB::bind_method(D_METHOD("add_polygon", "polygon"), &NavigationMesh::add_polygon); ClassDB::bind_method(D_METHOD("get_polygon_count"), &NavigationMesh::get_polygon_count); ClassDB::bind_method(D_METHOD("get_polygon", "idx"), &NavigationMesh::get_polygon); ClassDB::bind_method(D_METHOD("clear_polygons"), &NavigationMesh::clear_polygons); ClassDB::bind_method(D_METHOD("create_from_mesh", "mesh"), &NavigationMesh::create_from_mesh); ClassDB::bind_method(D_METHOD("_set_polygons", "polygons"), &NavigationMesh::_set_polygons); ClassDB::bind_method(D_METHOD("_get_polygons"), &NavigationMesh::_get_polygons); ADD_PROPERTY(PropertyInfo(Variant::PACKED_VECTOR3_ARRAY, "vertices", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NO_EDITOR | PROPERTY_USAGE_INTERNAL), "set_vertices", "get_vertices"); ADD_PROPERTY(PropertyInfo(Variant::ARRAY, "polygons", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NO_EDITOR | PROPERTY_USAGE_INTERNAL), "_set_polygons", "_get_polygons"); ADD_PROPERTY(PropertyInfo(Variant::INT, "sample_partition_type/sample_partition_type", PROPERTY_HINT_ENUM, "Watershed,Monotone,Layers"), "set_sample_partition_type", "get_sample_partition_type"); ADD_PROPERTY(PropertyInfo(Variant::INT, "geometry/parsed_geometry_type", PROPERTY_HINT_ENUM, "Mesh Instances,Static Colliders,Both"), "set_parsed_geometry_type", "get_parsed_geometry_type"); ADD_PROPERTY(PropertyInfo(Variant::INT, "geometry/collision_mask", PROPERTY_HINT_LAYERS_3D_PHYSICS), "set_collision_mask", "get_collision_mask"); ADD_PROPERTY(PropertyInfo(Variant::INT, "geometry/source_geometry_mode", PROPERTY_HINT_ENUM, "Navmesh Children, Group With Children, Group Explicit"), "set_source_geometry_mode", "get_source_geometry_mode"); ADD_PROPERTY(PropertyInfo(Variant::STRING, "geometry/source_group_name"), "set_source_group_name", "get_source_group_name"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "cell/size", PROPERTY_HINT_RANGE, "0.1,1.0,0.01,or_greater"), "set_cell_size", "get_cell_size"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "cell/height", PROPERTY_HINT_RANGE, "0.1,1.0,0.01,or_greater"), "set_cell_height", "get_cell_height"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "agent/height", PROPERTY_HINT_RANGE, "0.1,5.0,0.01,or_greater"), "set_agent_height", "get_agent_height"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "agent/radius", PROPERTY_HINT_RANGE, "0.1,5.0,0.01,or_greater"), "set_agent_radius", "get_agent_radius"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "agent/max_climb", PROPERTY_HINT_RANGE, "0.1,5.0,0.01,or_greater"), "set_agent_max_climb", "get_agent_max_climb"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "agent/max_slope", PROPERTY_HINT_RANGE, "0.0,90.0,0.1"), "set_agent_max_slope", "get_agent_max_slope"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "region/min_size", PROPERTY_HINT_RANGE, "0.0,150.0,0.01,or_greater"), "set_region_min_size", "get_region_min_size"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "region/merge_size", PROPERTY_HINT_RANGE, "0.0,150.0,0.01,or_greater"), "set_region_merge_size", "get_region_merge_size"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "edge/max_length", PROPERTY_HINT_RANGE, "0.0,50.0,0.01,or_greater"), "set_edge_max_length", "get_edge_max_length"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "edge/max_error", PROPERTY_HINT_RANGE, "0.1,3.0,0.01,or_greater"), "set_edge_max_error", "get_edge_max_error"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "polygon/verts_per_poly", PROPERTY_HINT_RANGE, "3.0,12.0,1.0,or_greater"), "set_verts_per_poly", "get_verts_per_poly"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "detail/sample_distance", PROPERTY_HINT_RANGE, "0.1,16.0,0.01,or_greater"), "set_detail_sample_distance", "get_detail_sample_distance"); ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "detail/sample_max_error", PROPERTY_HINT_RANGE, "0.0,16.0,0.01,or_greater"), "set_detail_sample_max_error", "get_detail_sample_max_error"); ADD_PROPERTY(PropertyInfo(Variant::BOOL, "filter/low_hanging_obstacles"), "set_filter_low_hanging_obstacles", "get_filter_low_hanging_obstacles"); ADD_PROPERTY(PropertyInfo(Variant::BOOL, "filter/ledge_spans"), "set_filter_ledge_spans", "get_filter_ledge_spans"); ADD_PROPERTY(PropertyInfo(Variant::BOOL, "filter/filter_walkable_low_height_spans"), "set_filter_walkable_low_height_spans", "get_filter_walkable_low_height_spans"); BIND_ENUM_CONSTANT(SAMPLE_PARTITION_WATERSHED); BIND_ENUM_CONSTANT(SAMPLE_PARTITION_MONOTONE); BIND_ENUM_CONSTANT(SAMPLE_PARTITION_LAYERS); BIND_ENUM_CONSTANT(SAMPLE_PARTITION_MAX); BIND_ENUM_CONSTANT(PARSED_GEOMETRY_MESH_INSTANCES); BIND_ENUM_CONSTANT(PARSED_GEOMETRY_STATIC_COLLIDERS); BIND_ENUM_CONSTANT(PARSED_GEOMETRY_BOTH); BIND_ENUM_CONSTANT(PARSED_GEOMETRY_MAX); BIND_ENUM_CONSTANT(SOURCE_GEOMETRY_NAVMESH_CHILDREN); BIND_ENUM_CONSTANT(SOURCE_GEOMETRY_GROUPS_WITH_CHILDREN); BIND_ENUM_CONSTANT(SOURCE_GEOMETRY_GROUPS_EXPLICIT); BIND_ENUM_CONSTANT(SOURCE_GEOMETRY_MAX); } void NavigationMesh::_validate_property(PropertyInfo &property) const { if (property.name == "geometry/collision_mask") { if (parsed_geometry_type == PARSED_GEOMETRY_MESH_INSTANCES) { property.usage = PROPERTY_USAGE_NONE; return; } } if (property.name == "geometry/source_group_name") { if (source_geometry_mode == SOURCE_GEOMETRY_NAVMESH_CHILDREN) { property.usage = PROPERTY_USAGE_NONE; return; } } } NavigationMesh::NavigationMesh() {}