2023-01-05 13:25:55 +01:00
/**************************************************************************/
/* navigation_region_2d.cpp */
/**************************************************************************/
/* This file is part of: */
/* GODOT ENGINE */
/* https://godotengine.org */
/**************************************************************************/
/* Copyright (c) 2014-present Godot Engine contributors (see AUTHORS.md). */
/* Copyright (c) 2007-2014 Juan Linietsky, Ariel Manzur. */
/* */
/* 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. */
/**************************************************************************/
2018-01-05 00:50:27 +01:00
2020-03-27 08:44:44 +01:00
# include "navigation_region_2d.h"
2017-04-28 18:29:15 +02:00
2018-09-11 18:13:45 +02:00
# include "core/core_string_names.h"
2023-01-10 07:14:16 +01:00
# include "core/math/geometry_2d.h"
# include "scene/2d/navigation_obstacle_2d.h"
2022-02-12 02:46:22 +01:00
# include "scene/resources/world_2d.h"
2020-03-27 19:21:27 +01:00
# include "servers/navigation_server_2d.h"
2022-07-01 18:58:03 +02:00
# include "servers/navigation_server_3d.h"
2017-04-28 18:29:15 +02:00
2020-02-28 08:05:04 +01:00
void NavigationRegion2D : : set_enabled ( bool p_enabled ) {
2020-05-14 16:41:43 +02:00
if ( enabled = = p_enabled ) {
2015-02-14 16:09:52 +01:00
return ;
2020-05-14 16:41:43 +02:00
}
2022-08-21 04:21:01 +02:00
2015-02-14 16:09:52 +01:00
enabled = p_enabled ;
2020-05-14 16:41:43 +02:00
if ( ! is_inside_tree ( ) ) {
2015-02-14 16:09:52 +01:00
return ;
2020-05-14 16:41:43 +02:00
}
2015-02-14 16:09:52 +01:00
if ( ! enabled ) {
2020-03-27 19:21:27 +01:00
NavigationServer2D : : get_singleton ( ) - > region_set_map ( region , RID ( ) ) ;
2022-12-21 23:21:43 +01:00
NavigationServer2D : : get_singleton ( ) - > disconnect ( " map_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
2015-02-14 16:09:52 +01:00
} else {
2021-03-08 09:47:18 +01:00
NavigationServer2D : : get_singleton ( ) - > region_set_map ( region , get_world_2d ( ) - > get_navigation_map ( ) ) ;
2022-12-21 23:21:43 +01:00
NavigationServer2D : : get_singleton ( ) - > connect ( " map_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
2015-02-14 16:09:52 +01:00
}
2022-07-01 18:58:03 +02:00
# ifdef DEBUG_ENABLED
2023-01-10 07:14:16 +01:00
if ( Engine : : get_singleton ( ) - > is_editor_hint ( ) | | NavigationServer3D : : get_singleton ( ) - > get_debug_navigation_enabled ( ) ) {
2022-08-13 23:21:24 +02:00
queue_redraw ( ) ;
2020-05-14 16:41:43 +02:00
}
2022-07-01 18:58:03 +02:00
# endif // DEBUG_ENABLED
2015-02-14 16:09:52 +01:00
}
2020-02-28 08:05:04 +01:00
bool NavigationRegion2D : : is_enabled ( ) const {
2015-02-14 16:09:52 +01:00
return enabled ;
}
2023-04-01 01:49:43 +02:00
void NavigationRegion2D : : set_use_edge_connections ( bool p_enabled ) {
if ( use_edge_connections = = p_enabled ) {
return ;
}
use_edge_connections = p_enabled ;
NavigationServer2D : : get_singleton ( ) - > region_set_use_edge_connections ( region , use_edge_connections ) ;
}
bool NavigationRegion2D : : get_use_edge_connections ( ) const {
return use_edge_connections ;
}
2022-06-14 23:34:43 +02:00
void NavigationRegion2D : : set_navigation_layers ( uint32_t p_navigation_layers ) {
2022-08-21 04:21:01 +02:00
if ( navigation_layers = = p_navigation_layers ) {
return ;
}
navigation_layers = p_navigation_layers ;
NavigationServer2D : : get_singleton ( ) - > region_set_navigation_layers ( region , navigation_layers ) ;
2021-03-08 20:56:33 +01:00
}
2022-06-14 23:34:43 +02:00
uint32_t NavigationRegion2D : : get_navigation_layers ( ) const {
2022-08-21 04:21:01 +02:00
return navigation_layers ;
2021-03-08 20:56:33 +01:00
}
2022-06-19 13:23:13 +02:00
void NavigationRegion2D : : set_navigation_layer_value ( int p_layer_number , bool p_value ) {
ERR_FAIL_COND_MSG ( p_layer_number < 1 , " Navigation layer number must be between 1 and 32 inclusive. " ) ;
ERR_FAIL_COND_MSG ( p_layer_number > 32 , " Navigation layer number must be between 1 and 32 inclusive. " ) ;
2022-08-21 04:21:01 +02:00
2022-06-19 13:23:13 +02:00
uint32_t _navigation_layers = get_navigation_layers ( ) ;
2022-08-21 04:21:01 +02:00
2022-06-19 13:23:13 +02:00
if ( p_value ) {
_navigation_layers | = 1 < < ( p_layer_number - 1 ) ;
} else {
_navigation_layers & = ~ ( 1 < < ( p_layer_number - 1 ) ) ;
}
2022-08-21 04:21:01 +02:00
2022-06-19 13:23:13 +02:00
set_navigation_layers ( _navigation_layers ) ;
}
bool NavigationRegion2D : : get_navigation_layer_value ( int p_layer_number ) const {
ERR_FAIL_COND_V_MSG ( p_layer_number < 1 , false , " Navigation layer number must be between 1 and 32 inclusive. " ) ;
ERR_FAIL_COND_V_MSG ( p_layer_number > 32 , false , " Navigation layer number must be between 1 and 32 inclusive. " ) ;
2022-08-21 04:21:01 +02:00
2022-06-19 13:23:13 +02:00
return get_navigation_layers ( ) & ( 1 < < ( p_layer_number - 1 ) ) ;
}
2022-06-06 05:24:11 +02:00
void NavigationRegion2D : : set_enter_cost ( real_t p_enter_cost ) {
ERR_FAIL_COND_MSG ( p_enter_cost < 0.0 , " The enter_cost must be positive. " ) ;
2022-08-21 04:21:01 +02:00
if ( Math : : is_equal_approx ( enter_cost , p_enter_cost ) ) {
return ;
}
enter_cost = p_enter_cost ;
NavigationServer2D : : get_singleton ( ) - > region_set_enter_cost ( region , enter_cost ) ;
2022-06-06 05:24:11 +02:00
}
real_t NavigationRegion2D : : get_enter_cost ( ) const {
return enter_cost ;
}
void NavigationRegion2D : : set_travel_cost ( real_t p_travel_cost ) {
ERR_FAIL_COND_MSG ( p_travel_cost < 0.0 , " The travel_cost must be positive. " ) ;
2022-08-21 04:21:01 +02:00
if ( Math : : is_equal_approx ( travel_cost , p_travel_cost ) ) {
return ;
}
travel_cost = p_travel_cost ;
2022-08-07 19:40:33 +02:00
NavigationServer2D : : get_singleton ( ) - > region_set_travel_cost ( region , travel_cost ) ;
2022-06-06 05:24:11 +02:00
}
real_t NavigationRegion2D : : get_travel_cost ( ) const {
return travel_cost ;
}
2022-04-30 13:27:30 +02:00
RID NavigationRegion2D : : get_region_rid ( ) const {
return region ;
}
2019-10-21 23:37:07 +02:00
# ifdef TOOLS_ENABLED
2020-02-28 08:05:04 +01:00
Rect2 NavigationRegion2D : : _edit_get_rect ( ) const {
2022-12-11 18:02:35 +01:00
return navigation_polygon . is_valid ( ) ? navigation_polygon - > _edit_get_rect ( ) : Rect2 ( ) ;
2017-12-27 09:28:02 +01:00
}
2020-02-28 08:05:04 +01:00
bool NavigationRegion2D : : _edit_is_selected_on_click ( const Point2 & p_point , double p_tolerance ) const {
2022-12-11 18:02:35 +01:00
return navigation_polygon . is_valid ( ) ? navigation_polygon - > _edit_is_selected_on_click ( p_point , p_tolerance ) : false ;
2017-12-27 09:28:02 +01:00
}
2019-10-21 23:37:07 +02:00
# endif
2017-12-27 09:28:02 +01:00
2020-02-28 08:05:04 +01:00
void NavigationRegion2D : : _notification ( int p_what ) {
2015-02-14 16:09:52 +01:00
switch ( p_what ) {
case NOTIFICATION_ENTER_TREE : {
2021-03-08 09:47:18 +01:00
if ( enabled ) {
NavigationServer2D : : get_singleton ( ) - > region_set_map ( region , get_world_2d ( ) - > get_navigation_map ( ) ) ;
2022-12-21 23:21:43 +01:00
NavigationServer2D : : get_singleton ( ) - > connect ( " map_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
2023-01-10 07:14:16 +01:00
for ( uint32_t i = 0 ; i < constrain_avoidance_obstacles . size ( ) ; i + + ) {
if ( constrain_avoidance_obstacles [ i ] . is_valid ( ) ) {
NavigationServer2D : : get_singleton ( ) - > obstacle_set_map ( constrain_avoidance_obstacles [ i ] , get_world_2d ( ) - > get_navigation_map ( ) ) ;
NavigationServer2D : : get_singleton ( ) - > obstacle_set_position ( constrain_avoidance_obstacles [ i ] , get_global_position ( ) ) ;
}
}
2015-02-14 16:09:52 +01:00
}
2023-04-05 02:15:25 +02:00
current_global_transform = get_global_transform ( ) ;
NavigationServer2D : : get_singleton ( ) - > region_set_transform ( region , current_global_transform ) ;
2015-02-14 16:09:52 +01:00
} break ;
2022-02-15 18:06:48 +01:00
2015-02-14 16:09:52 +01:00
case NOTIFICATION_TRANSFORM_CHANGED : {
2023-04-05 02:15:25 +02:00
set_physics_process_internal ( true ) ;
2015-02-14 16:09:52 +01:00
} break ;
2022-02-15 18:06:48 +01:00
2015-02-14 16:09:52 +01:00
case NOTIFICATION_EXIT_TREE : {
2021-03-08 09:47:18 +01:00
NavigationServer2D : : get_singleton ( ) - > region_set_map ( region , RID ( ) ) ;
2021-03-15 12:45:28 +01:00
if ( enabled ) {
2022-12-21 23:21:43 +01:00
NavigationServer2D : : get_singleton ( ) - > disconnect ( " map_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
2021-03-15 12:45:28 +01:00
}
2023-01-10 07:14:16 +01:00
for ( uint32_t i = 0 ; i < constrain_avoidance_obstacles . size ( ) ; i + + ) {
if ( constrain_avoidance_obstacles [ i ] . is_valid ( ) ) {
NavigationServer2D : : get_singleton ( ) - > obstacle_set_map ( constrain_avoidance_obstacles [ i ] , RID ( ) ) ;
}
}
2015-02-14 16:09:52 +01:00
} break ;
2022-02-15 18:06:48 +01:00
2023-04-05 02:15:25 +02:00
case NOTIFICATION_INTERNAL_PHYSICS_PROCESS : {
set_physics_process_internal ( false ) ;
if ( is_inside_tree ( ) ) {
Transform2D new_global_transform = get_global_transform ( ) ;
if ( current_global_transform ! = new_global_transform ) {
current_global_transform = new_global_transform ;
NavigationServer2D : : get_singleton ( ) - > region_set_transform ( region , current_global_transform ) ;
queue_redraw ( ) ;
for ( uint32_t i = 0 ; i < constrain_avoidance_obstacles . size ( ) ; i + + ) {
if ( constrain_avoidance_obstacles [ i ] . is_valid ( ) ) {
NavigationServer2D : : get_singleton ( ) - > obstacle_set_position ( constrain_avoidance_obstacles [ i ] , get_global_position ( ) ) ;
}
}
}
}
} break ;
2015-02-14 16:09:52 +01:00
case NOTIFICATION_DRAW : {
2022-07-01 18:58:03 +02:00
# ifdef DEBUG_ENABLED
2023-02-13 04:35:42 +01:00
if ( is_inside_tree ( ) & & ( Engine : : get_singleton ( ) - > is_editor_hint ( ) | | NavigationServer2D : : get_singleton ( ) - > get_debug_enabled ( ) ) & & navigation_polygon . is_valid ( ) ) {
Vector < Vector2 > navigation_polygon_vertices = navigation_polygon - > get_vertices ( ) ;
if ( navigation_polygon_vertices . size ( ) < 3 ) {
2015-02-14 16:09:52 +01:00
return ;
2020-05-14 16:41:43 +02:00
}
2015-02-14 16:09:52 +01:00
2023-02-13 04:35:42 +01:00
const NavigationServer2D * ns2d = NavigationServer2D : : get_singleton ( ) ;
bool enabled_geometry_face_random_color = ns2d - > get_debug_navigation_enable_geometry_face_random_color ( ) ;
bool enabled_edge_lines = ns2d - > get_debug_navigation_enable_edge_lines ( ) ;
2023-04-01 01:49:43 +02:00
bool enable_edge_connections = use_edge_connections & & ns2d - > get_debug_navigation_enable_edge_connections ( ) & & ns2d - > map_get_use_edge_connections ( get_world_2d ( ) - > get_navigation_map ( ) ) ;
2023-02-13 04:35:42 +01:00
Color debug_face_color = ns2d - > get_debug_navigation_geometry_face_color ( ) ;
Color debug_edge_color = ns2d - > get_debug_navigation_geometry_edge_color ( ) ;
Color debug_edge_connection_color = ns2d - > get_debug_navigation_edge_connection_color ( ) ;
if ( ! enabled ) {
debug_face_color = ns2d - > get_debug_navigation_geometry_face_disabled_color ( ) ;
debug_edge_color = ns2d - > get_debug_navigation_geometry_edge_disabled_color ( ) ;
2015-02-14 16:09:52 +01:00
}
2021-03-15 12:45:28 +01:00
RandomPCG rand ;
2015-02-14 16:09:52 +01:00
2022-12-11 18:02:35 +01:00
for ( int i = 0 ; i < navigation_polygon - > get_polygon_count ( ) ; i + + ) {
2021-03-15 12:45:28 +01:00
// An array of vertices for this polygon.
2022-12-11 18:02:35 +01:00
Vector < int > polygon = navigation_polygon - > get_polygon ( i ) ;
2023-02-13 04:35:42 +01:00
Vector < Vector2 > debug_polygon_vertices ;
debug_polygon_vertices . resize ( polygon . size ( ) ) ;
2021-03-15 12:45:28 +01:00
for ( int j = 0 ; j < polygon . size ( ) ; j + + ) {
2023-02-13 04:35:42 +01:00
ERR_FAIL_INDEX ( polygon [ j ] , navigation_polygon_vertices . size ( ) ) ;
debug_polygon_vertices . write [ j ] = navigation_polygon_vertices [ polygon [ j ] ] ;
2015-02-14 16:09:52 +01:00
}
2021-03-15 12:45:28 +01:00
// Generate the polygon color, slightly randomly modified from the settings one.
2023-02-13 04:35:42 +01:00
Color random_variation_color = debug_face_color ;
if ( enabled_geometry_face_random_color ) {
random_variation_color . set_hsv (
debug_face_color . get_h ( ) + rand . random ( - 1.0 , 1.0 ) * 0.1 ,
debug_face_color . get_s ( ) ,
debug_face_color . get_v ( ) + rand . random ( - 1.0 , 1.0 ) * 0.2 ) ;
}
random_variation_color . a = debug_face_color . a ;
2021-03-15 12:45:28 +01:00
2023-02-13 04:35:42 +01:00
Vector < Color > debug_face_colors ;
debug_face_colors . push_back ( random_variation_color ) ;
RS : : get_singleton ( ) - > canvas_item_add_polygon ( get_canvas_item ( ) , debug_polygon_vertices , debug_face_colors ) ;
if ( enabled_edge_lines ) {
Vector < Color > debug_edge_colors ;
debug_edge_colors . push_back ( debug_edge_color ) ;
debug_polygon_vertices . push_back ( debug_polygon_vertices [ 0 ] ) ; // Add first again for closing polyline.
RS : : get_singleton ( ) - > canvas_item_add_polyline ( get_canvas_item ( ) , debug_polygon_vertices , debug_edge_colors ) ;
}
2021-03-15 12:45:28 +01:00
}
2023-02-13 04:35:42 +01:00
if ( enable_edge_connections ) {
// Draw the region edge connections.
Transform2D xform = get_global_transform ( ) ;
real_t radius = ns2d - > map_get_edge_connection_margin ( get_world_2d ( ) - > get_navigation_map ( ) ) / 2.0 ;
for ( int i = 0 ; i < ns2d - > region_get_connections_count ( region ) ; i + + ) {
// Two main points
Vector2 a = ns2d - > region_get_connection_pathway_start ( region , i ) ;
a = xform . affine_inverse ( ) . xform ( a ) ;
Vector2 b = ns2d - > region_get_connection_pathway_end ( region , i ) ;
b = xform . affine_inverse ( ) . xform ( b ) ;
draw_line ( a , b , debug_edge_connection_color ) ;
// Draw a circle to illustrate the margins.
real_t angle = a . angle_to_point ( b ) ;
draw_arc ( a , radius , angle + Math_PI / 2.0 , angle - Math_PI / 2.0 + Math_TAU , 10 , debug_edge_connection_color ) ;
draw_arc ( b , radius , angle - Math_PI / 2.0 , angle + Math_PI / 2.0 , 10 , debug_edge_connection_color ) ;
}
2015-02-14 16:09:52 +01:00
}
}
2022-07-01 18:58:03 +02:00
# endif // DEBUG_ENABLED
2015-02-14 16:09:52 +01:00
} break ;
}
}
2022-12-11 18:02:35 +01:00
void NavigationRegion2D : : set_navigation_polygon ( const Ref < NavigationPolygon > & p_navigation_polygon ) {
if ( p_navigation_polygon = = navigation_polygon ) {
2015-02-14 16:09:52 +01:00
return ;
2018-12-06 22:03:26 +01:00
}
2015-02-14 16:09:52 +01:00
2022-12-11 18:02:35 +01:00
if ( navigation_polygon . is_valid ( ) ) {
navigation_polygon - > disconnect ( CoreStringNames : : get_singleton ( ) - > changed , callable_mp ( this , & NavigationRegion2D : : _navigation_polygon_changed ) ) ;
2015-02-14 16:09:52 +01:00
}
2020-01-10 12:22:34 +01:00
2022-12-11 18:02:35 +01:00
navigation_polygon = p_navigation_polygon ;
NavigationServer2D : : get_singleton ( ) - > region_set_navigation_polygon ( region , p_navigation_polygon ) ;
2020-01-10 12:22:34 +01:00
2022-12-11 18:02:35 +01:00
if ( navigation_polygon . is_valid ( ) ) {
navigation_polygon - > connect ( CoreStringNames : : get_singleton ( ) - > changed , callable_mp ( this , & NavigationRegion2D : : _navigation_polygon_changed ) ) ;
2015-02-14 16:09:52 +01:00
}
2022-12-11 18:02:35 +01:00
_navigation_polygon_changed ( ) ;
2015-02-14 16:09:52 +01:00
2020-10-29 11:01:28 +01:00
update_configuration_warnings ( ) ;
2015-02-14 16:09:52 +01:00
}
2020-02-28 08:05:04 +01:00
Ref < NavigationPolygon > NavigationRegion2D : : get_navigation_polygon ( ) const {
2022-12-11 18:02:35 +01:00
return navigation_polygon ;
2015-02-14 16:09:52 +01:00
}
2022-12-11 18:02:35 +01:00
void NavigationRegion2D : : _navigation_polygon_changed ( ) {
2020-05-14 16:41:43 +02:00
if ( is_inside_tree ( ) & & ( Engine : : get_singleton ( ) - > is_editor_hint ( ) | | get_tree ( ) - > is_debugging_navigation_hint ( ) ) ) {
2022-08-13 23:21:24 +02:00
queue_redraw ( ) ;
2020-05-14 16:41:43 +02:00
}
2022-12-11 18:02:35 +01:00
if ( navigation_polygon . is_valid ( ) ) {
NavigationServer2D : : get_singleton ( ) - > region_set_navigation_polygon ( region , navigation_polygon ) ;
2022-05-18 13:36:18 +02:00
}
2023-01-10 07:14:16 +01:00
_update_avoidance_constrain ( ) ;
2015-02-14 16:09:52 +01:00
}
2022-07-01 18:58:03 +02:00
2021-03-15 12:45:28 +01:00
void NavigationRegion2D : : _map_changed ( RID p_map ) {
2022-07-01 18:58:03 +02:00
# ifdef DEBUG_ENABLED
if ( is_inside_tree ( ) & & get_world_2d ( ) - > get_navigation_map ( ) = = p_map ) {
2022-08-13 23:21:24 +02:00
queue_redraw ( ) ;
2021-03-15 12:45:28 +01:00
}
2022-07-01 18:58:03 +02:00
# endif // DEBUG_ENABLED
2021-03-15 12:45:28 +01:00
}
2015-02-14 16:09:52 +01:00
2022-09-19 17:43:15 +02:00
PackedStringArray NavigationRegion2D : : get_configuration_warnings ( ) const {
PackedStringArray warnings = Node2D : : get_configuration_warnings ( ) ;
2020-05-14 22:59:27 +02:00
2020-10-29 11:01:28 +01:00
if ( is_visible_in_tree ( ) & & is_inside_tree ( ) ) {
2022-12-11 18:02:35 +01:00
if ( ! navigation_polygon . is_valid ( ) ) {
2022-03-28 15:24:14 +02:00
warnings . push_back ( RTR ( " A NavigationMesh resource must be set or created for this node to work. Please set a property or draw a polygon. " ) ) ;
2020-05-14 22:59:27 +02:00
}
2016-05-17 23:27:15 +02:00
}
2020-10-29 11:01:28 +01:00
return warnings ;
2016-05-17 23:27:15 +02:00
}
2020-02-28 08:05:04 +01:00
void NavigationRegion2D : : _bind_methods ( ) {
2022-12-11 18:02:35 +01:00
ClassDB : : bind_method ( D_METHOD ( " set_navigation_polygon " , " navigation_polygon " ) , & NavigationRegion2D : : set_navigation_polygon ) ;
2020-02-28 08:05:04 +01:00
ClassDB : : bind_method ( D_METHOD ( " get_navigation_polygon " ) , & NavigationRegion2D : : get_navigation_polygon ) ;
2015-02-14 16:09:52 +01:00
2020-02-28 08:05:04 +01:00
ClassDB : : bind_method ( D_METHOD ( " set_enabled " , " enabled " ) , & NavigationRegion2D : : set_enabled ) ;
ClassDB : : bind_method ( D_METHOD ( " is_enabled " ) , & NavigationRegion2D : : is_enabled ) ;
2015-02-14 16:09:52 +01:00
2023-04-01 01:49:43 +02:00
ClassDB : : bind_method ( D_METHOD ( " set_use_edge_connections " , " enabled " ) , & NavigationRegion2D : : set_use_edge_connections ) ;
ClassDB : : bind_method ( D_METHOD ( " get_use_edge_connections " ) , & NavigationRegion2D : : get_use_edge_connections ) ;
2022-06-14 23:34:43 +02:00
ClassDB : : bind_method ( D_METHOD ( " set_navigation_layers " , " navigation_layers " ) , & NavigationRegion2D : : set_navigation_layers ) ;
ClassDB : : bind_method ( D_METHOD ( " get_navigation_layers " ) , & NavigationRegion2D : : get_navigation_layers ) ;
2021-03-08 20:56:33 +01:00
2022-06-19 13:23:13 +02:00
ClassDB : : bind_method ( D_METHOD ( " set_navigation_layer_value " , " layer_number " , " value " ) , & NavigationRegion2D : : set_navigation_layer_value ) ;
ClassDB : : bind_method ( D_METHOD ( " get_navigation_layer_value " , " layer_number " ) , & NavigationRegion2D : : get_navigation_layer_value ) ;
2023-01-10 07:14:16 +01:00
ClassDB : : bind_method ( D_METHOD ( " set_constrain_avoidance " , " enabled " ) , & NavigationRegion2D : : set_constrain_avoidance ) ;
ClassDB : : bind_method ( D_METHOD ( " get_constrain_avoidance " ) , & NavigationRegion2D : : get_constrain_avoidance ) ;
ClassDB : : bind_method ( D_METHOD ( " set_avoidance_layers " , " layers " ) , & NavigationRegion2D : : set_avoidance_layers ) ;
ClassDB : : bind_method ( D_METHOD ( " get_avoidance_layers " ) , & NavigationRegion2D : : get_avoidance_layers ) ;
ClassDB : : bind_method ( D_METHOD ( " set_avoidance_layer_value " , " layer_number " , " value " ) , & NavigationRegion2D : : set_avoidance_layer_value ) ;
ClassDB : : bind_method ( D_METHOD ( " get_avoidance_layer_value " , " layer_number " ) , & NavigationRegion2D : : get_avoidance_layer_value ) ;
2022-04-30 13:27:30 +02:00
ClassDB : : bind_method ( D_METHOD ( " get_region_rid " ) , & NavigationRegion2D : : get_region_rid ) ;
2022-06-06 05:24:11 +02:00
ClassDB : : bind_method ( D_METHOD ( " set_enter_cost " , " enter_cost " ) , & NavigationRegion2D : : set_enter_cost ) ;
ClassDB : : bind_method ( D_METHOD ( " get_enter_cost " ) , & NavigationRegion2D : : get_enter_cost ) ;
ClassDB : : bind_method ( D_METHOD ( " set_travel_cost " , " travel_cost " ) , & NavigationRegion2D : : set_travel_cost ) ;
ClassDB : : bind_method ( D_METHOD ( " get_travel_cost " ) , & NavigationRegion2D : : get_travel_cost ) ;
2022-12-11 18:02:35 +01:00
ClassDB : : bind_method ( D_METHOD ( " _navigation_polygon_changed " ) , & NavigationRegion2D : : _navigation_polygon_changed ) ;
2015-02-14 16:09:52 +01:00
2022-12-11 18:02:35 +01:00
ADD_PROPERTY ( PropertyInfo ( Variant : : OBJECT , " navigation_polygon " , PROPERTY_HINT_RESOURCE_TYPE , " NavigationPolygon " ) , " set_navigation_polygon " , " get_navigation_polygon " ) ;
2017-02-12 01:11:37 +01:00
ADD_PROPERTY ( PropertyInfo ( Variant : : BOOL , " enabled " ) , " set_enabled " , " is_enabled " ) ;
2023-04-01 01:49:43 +02:00
ADD_PROPERTY ( PropertyInfo ( Variant : : BOOL , " use_edge_connections " ) , " set_use_edge_connections " , " get_use_edge_connections " ) ;
2022-06-14 23:34:43 +02:00
ADD_PROPERTY ( PropertyInfo ( Variant : : INT , " navigation_layers " , PROPERTY_HINT_LAYERS_2D_NAVIGATION ) , " set_navigation_layers " , " get_navigation_layers " ) ;
2022-06-06 05:24:11 +02:00
ADD_PROPERTY ( PropertyInfo ( Variant : : FLOAT , " enter_cost " ) , " set_enter_cost " , " get_enter_cost " ) ;
ADD_PROPERTY ( PropertyInfo ( Variant : : FLOAT , " travel_cost " ) , " set_travel_cost " , " get_travel_cost " ) ;
2023-01-10 07:14:16 +01:00
ADD_PROPERTY ( PropertyInfo ( Variant : : BOOL , " constrain_avoidance " ) , " set_constrain_avoidance " , " get_constrain_avoidance " ) ;
ADD_PROPERTY ( PropertyInfo ( Variant : : INT , " avoidance_layers " , PROPERTY_HINT_LAYERS_AVOIDANCE ) , " set_avoidance_layers " , " get_avoidance_layers " ) ;
2015-02-14 16:09:52 +01:00
}
2022-12-18 05:07:10 +01:00
# ifndef DISABLE_DEPRECATED
// Compatibility with earlier 4.0 betas.
bool NavigationRegion2D : : _set ( const StringName & p_name , const Variant & p_value ) {
if ( p_name = = " navpoly " ) {
set_navigation_polygon ( p_value ) ;
return true ;
}
return false ;
}
bool NavigationRegion2D : : _get ( const StringName & p_name , Variant & r_ret ) const {
if ( p_name = = " navpoly " ) {
r_ret = get_navigation_polygon ( ) ;
return true ;
}
return false ;
}
# endif // DISABLE_DEPRECATED
2020-02-28 08:05:04 +01:00
NavigationRegion2D : : NavigationRegion2D ( ) {
2017-01-13 00:35:46 +01:00
set_notify_transform ( true ) ;
2023-01-26 13:17:26 +01:00
set_hide_clip_children ( true ) ;
2022-10-01 07:49:39 +02:00
2020-03-27 19:21:27 +01:00
region = NavigationServer2D : : get_singleton ( ) - > region_create ( ) ;
2022-10-01 07:49:39 +02:00
NavigationServer2D : : get_singleton ( ) - > region_set_owner_id ( region , get_instance_id ( ) ) ;
2022-06-06 05:24:11 +02:00
NavigationServer2D : : get_singleton ( ) - > region_set_enter_cost ( region , get_enter_cost ( ) ) ;
NavigationServer2D : : get_singleton ( ) - > region_set_travel_cost ( region , get_travel_cost ( ) ) ;
2022-07-01 18:58:03 +02:00
# ifdef DEBUG_ENABLED
2022-12-21 23:21:43 +01:00
NavigationServer3D : : get_singleton ( ) - > connect ( " map_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
NavigationServer3D : : get_singleton ( ) - > connect ( " navigation_debug_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
2022-07-01 18:58:03 +02:00
# endif // DEBUG_ENABLED
2020-01-10 12:22:34 +01:00
}
2020-02-28 08:05:04 +01:00
NavigationRegion2D : : ~ NavigationRegion2D ( ) {
2022-12-12 18:42:37 +01:00
ERR_FAIL_NULL ( NavigationServer2D : : get_singleton ( ) ) ;
2020-03-27 19:21:27 +01:00
NavigationServer2D : : get_singleton ( ) - > free ( region ) ;
2022-07-01 18:58:03 +02:00
2023-01-10 07:14:16 +01:00
for ( uint32_t i = 0 ; i < constrain_avoidance_obstacles . size ( ) ; i + + ) {
if ( constrain_avoidance_obstacles [ i ] . is_valid ( ) ) {
NavigationServer2D : : get_singleton ( ) - > free ( constrain_avoidance_obstacles [ i ] ) ;
}
}
constrain_avoidance_obstacles . clear ( ) ;
2022-07-01 18:58:03 +02:00
# ifdef DEBUG_ENABLED
2022-12-21 23:21:43 +01:00
NavigationServer3D : : get_singleton ( ) - > disconnect ( " map_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
NavigationServer3D : : get_singleton ( ) - > disconnect ( " navigation_debug_changed " , callable_mp ( this , & NavigationRegion2D : : _map_changed ) ) ;
2022-07-01 18:58:03 +02:00
# endif // DEBUG_ENABLED
2015-02-14 16:09:52 +01:00
}
2023-01-10 07:14:16 +01:00
void NavigationRegion2D : : _update_avoidance_constrain ( ) {
for ( uint32_t i = 0 ; i < constrain_avoidance_obstacles . size ( ) ; i + + ) {
if ( constrain_avoidance_obstacles [ i ] . is_valid ( ) ) {
NavigationServer2D : : get_singleton ( ) - > free ( constrain_avoidance_obstacles [ i ] ) ;
constrain_avoidance_obstacles [ i ] = RID ( ) ;
}
}
constrain_avoidance_obstacles . clear ( ) ;
if ( ! constrain_avoidance ) {
return ;
}
if ( get_navigation_polygon ( ) = = nullptr ) {
return ;
}
Ref < NavigationPolygon > _navpoly = get_navigation_polygon ( ) ;
int _outline_count = _navpoly - > get_outline_count ( ) ;
if ( _outline_count = = 0 ) {
return ;
}
for ( int outline_index ( 0 ) ; outline_index < _outline_count ; outline_index + + ) {
const Vector < Vector2 > & _outline = _navpoly - > get_outline ( outline_index ) ;
const int outline_size = _outline . size ( ) ;
if ( outline_size < 3 ) {
ERR_FAIL_COND_MSG ( _outline . size ( ) < 3 , " NavigationPolygon outline needs to have at least 3 vertex to create avoidance obstacles to constrain avoidance agent's " ) ;
continue ;
}
RID obstacle_rid = NavigationServer2D : : get_singleton ( ) - > obstacle_create ( ) ;
constrain_avoidance_obstacles . push_back ( obstacle_rid ) ;
Vector < Vector2 > new_obstacle_outline ;
if ( outline_index = = 0 ) {
for ( int i ( 0 ) ; i < outline_size ; i + + ) {
new_obstacle_outline . push_back ( _outline [ outline_size - i - 1 ] ) ;
}
ERR_FAIL_COND_MSG ( Geometry2D : : is_polygon_clockwise ( _outline ) , " Outer most outline needs to be clockwise to push avoidance agent inside " ) ;
} else {
for ( int i ( 0 ) ; i < outline_size ; i + + ) {
new_obstacle_outline . push_back ( _outline [ i ] ) ;
}
}
new_obstacle_outline . resize ( outline_size ) ;
NavigationServer2D : : get_singleton ( ) - > obstacle_set_vertices ( obstacle_rid , new_obstacle_outline ) ;
NavigationServer2D : : get_singleton ( ) - > obstacle_set_avoidance_layers ( obstacle_rid , avoidance_layers ) ;
if ( is_inside_tree ( ) ) {
NavigationServer2D : : get_singleton ( ) - > obstacle_set_map ( obstacle_rid , get_world_2d ( ) - > get_navigation_map ( ) ) ;
NavigationServer2D : : get_singleton ( ) - > obstacle_set_position ( obstacle_rid , get_global_position ( ) ) ;
}
}
constrain_avoidance_obstacles . resize ( _outline_count ) ;
}
void NavigationRegion2D : : set_constrain_avoidance ( bool p_enabled ) {
constrain_avoidance = p_enabled ;
_update_avoidance_constrain ( ) ;
notify_property_list_changed ( ) ;
}
bool NavigationRegion2D : : get_constrain_avoidance ( ) const {
return constrain_avoidance ;
}
void NavigationRegion2D : : _validate_property ( PropertyInfo & p_property ) const {
if ( p_property . name = = " avoidance_layers " ) {
if ( ! constrain_avoidance ) {
p_property . usage = PROPERTY_USAGE_NO_EDITOR ;
}
}
}
void NavigationRegion2D : : set_avoidance_layers ( uint32_t p_layers ) {
avoidance_layers = p_layers ;
if ( constrain_avoidance_obstacles . size ( ) > 0 ) {
for ( uint32_t i = 0 ; i < constrain_avoidance_obstacles . size ( ) ; i + + ) {
NavigationServer2D : : get_singleton ( ) - > obstacle_set_avoidance_layers ( constrain_avoidance_obstacles [ i ] , avoidance_layers ) ;
}
}
}
uint32_t NavigationRegion2D : : get_avoidance_layers ( ) const {
return avoidance_layers ;
}
void NavigationRegion2D : : set_avoidance_layer_value ( int p_layer_number , bool p_value ) {
ERR_FAIL_COND_MSG ( p_layer_number < 1 , " Avoidance layer number must be between 1 and 32 inclusive. " ) ;
ERR_FAIL_COND_MSG ( p_layer_number > 32 , " Avoidance layer number must be between 1 and 32 inclusive. " ) ;
uint32_t avoidance_layers_new = get_avoidance_layers ( ) ;
if ( p_value ) {
avoidance_layers_new | = 1 < < ( p_layer_number - 1 ) ;
} else {
avoidance_layers_new & = ~ ( 1 < < ( p_layer_number - 1 ) ) ;
}
set_avoidance_layers ( avoidance_layers_new ) ;
}
bool NavigationRegion2D : : get_avoidance_layer_value ( int p_layer_number ) const {
ERR_FAIL_COND_V_MSG ( p_layer_number < 1 , false , " Avoidance layer number must be between 1 and 32 inclusive. " ) ;
ERR_FAIL_COND_V_MSG ( p_layer_number > 32 , false , " Avoidance layer number must be between 1 and 32 inclusive. " ) ;
return get_avoidance_layers ( ) & ( 1 < < ( p_layer_number - 1 ) ) ;
}