2014-02-10 02:10:30 +01:00
/*************************************************************************/
/* collision_polygon_2d.cpp */
/*************************************************************************/
/* This file is part of: */
/* GODOT ENGINE */
2017-08-27 14:16:55 +02:00
/* https://godotengine.org */
2014-02-10 02:10:30 +01:00
/*************************************************************************/
2021-01-01 20:13:46 +01:00
/* Copyright (c) 2007-2021 Juan Linietsky, Ariel Manzur. */
/* Copyright (c) 2014-2021 Godot Engine contributors (cf. AUTHORS.md). */
2014-02-10 02:10:30 +01:00
/* */
/* 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
2014-02-10 02:10:30 +01:00
# include "collision_polygon_2d.h"
2017-04-28 18:29:15 +02:00
2014-02-10 02:10:30 +01:00
# include "collision_object_2d.h"
2018-09-11 18:13:45 +02:00
# include "core/engine.h"
2014-02-10 02:10:30 +01:00
# include "scene/resources/concave_polygon_shape_2d.h"
# include "scene/resources/convex_polygon_shape_2d.h"
2017-04-28 18:29:15 +02:00
# include "thirdparty/misc/triangulator.h"
2017-06-24 04:30:43 +02:00
void CollisionPolygon2D : : _build_polygon ( ) {
2014-02-10 02:10:30 +01:00
2017-06-24 04:30:43 +02:00
parent - > shape_owner_clear_shapes ( owner_id ) ;
2014-02-10 02:10:30 +01:00
2017-03-05 16:44:50 +01:00
bool solids = build_mode = = BUILD_SOLIDS ;
2014-02-10 02:10:30 +01:00
if ( solids ) {
2021-03-04 18:29:49 +01:00
if ( polygon . size ( ) < 3 ) {
return ;
}
2014-02-10 02:10:30 +01:00
//here comes the sun, lalalala
//decompose concave into multiple convex polygons and add them
2021-05-04 14:20:36 +02:00
Vector < Vector < Vector2 > > decomp = _decompose_in_convex ( ) ;
2017-03-05 16:44:50 +01:00
for ( int i = 0 ; i < decomp . size ( ) ; i + + ) {
Ref < ConvexPolygonShape2D > convex = memnew ( ConvexPolygonShape2D ) ;
2014-02-10 02:10:30 +01:00
convex - > set_points ( decomp [ i ] ) ;
2017-06-24 04:30:43 +02:00
parent - > shape_owner_add_shape ( owner_id , convex ) ;
2015-09-16 03:07:03 +02:00
}
2014-02-10 02:10:30 +01:00
} else {
2021-03-04 18:29:49 +01:00
if ( polygon . size ( ) < 2 ) {
return ;
}
2014-02-10 02:10:30 +01:00
2017-03-05 16:44:50 +01:00
Ref < ConcavePolygonShape2D > concave = memnew ( ConcavePolygonShape2D ) ;
2014-02-10 02:10:30 +01:00
2017-01-07 22:25:37 +01:00
PoolVector < Vector2 > segments ;
2017-03-05 16:44:50 +01:00
segments . resize ( polygon . size ( ) * 2 ) ;
PoolVector < Vector2 > : : Write w = segments . write ( ) ;
2014-02-10 02:10:30 +01:00
2020-05-20 13:32:35 +02:00
int polygon_count = polygon . size ( ) ;
for ( int i = 0 ; i < polygon_count ; i + + ) {
2017-03-05 16:44:50 +01:00
w [ ( i < < 1 ) + 0 ] = polygon [ i ] ;
2020-05-20 13:32:35 +02:00
w [ ( i < < 1 ) + 1 ] = polygon [ ( i + 1 ) % polygon_count ] ;
2014-02-10 02:10:30 +01:00
}
2019-07-05 19:08:43 +02:00
w . release ( ) ;
2014-02-10 02:10:30 +01:00
concave - > set_segments ( segments ) ;
2017-06-24 04:30:43 +02:00
parent - > shape_owner_add_shape ( owner_id , concave ) ;
2014-02-10 02:10:30 +01:00
}
}
2021-05-04 14:20:36 +02:00
Vector < Vector < Vector2 > > CollisionPolygon2D : : _decompose_in_convex ( ) {
Vector < Vector < Vector2 > > decomp = Geometry : : decompose_polygon_in_convex ( polygon ) ;
2016-01-01 00:23:34 +01:00
return decomp ;
}
2018-01-11 21:05:42 +01:00
void CollisionPolygon2D : : _update_in_shape_owner ( bool p_xform_only ) {
parent - > shape_owner_set_transform ( owner_id , get_transform ( ) ) ;
if ( p_xform_only )
return ;
parent - > shape_owner_set_disabled ( owner_id , disabled ) ;
parent - > shape_owner_set_one_way_collision ( owner_id , one_way_collision ) ;
2019-01-18 18:15:05 +01:00
parent - > shape_owner_set_one_way_collision_margin ( owner_id , one_way_collision_margin ) ;
2018-01-11 21:05:42 +01:00
}
2014-02-10 02:10:30 +01:00
void CollisionPolygon2D : : _notification ( int p_what ) {
2017-03-05 16:44:50 +01:00
switch ( p_what ) {
2017-06-24 04:30:43 +02:00
case NOTIFICATION_PARENTED : {
2017-08-24 22:58:51 +02:00
parent = Object : : cast_to < CollisionObject2D > ( get_parent ( ) ) ;
2017-06-24 04:30:43 +02:00
if ( parent ) {
owner_id = parent - > create_shape_owner ( this ) ;
_build_polygon ( ) ;
2018-01-11 21:05:42 +01:00
_update_in_shape_owner ( ) ;
2017-06-24 04:30:43 +02:00
}
2017-08-19 01:02:56 +02:00
/*if (Engine::get_singleton()->is_editor_hint()) {
2015-12-12 12:11:36 +01:00
//display above all else
set_z_as_relative ( false ) ;
2017-12-29 23:06:03 +01:00
set_z_index ( VS : : CANVAS_ITEM_Z_MAX - 1 ) ;
2017-06-24 04:30:43 +02:00
} */
2015-12-12 12:11:36 +01:00
2018-01-11 21:05:42 +01:00
} break ;
case NOTIFICATION_ENTER_TREE : {
if ( parent ) {
_update_in_shape_owner ( ) ;
}
2015-09-16 03:07:03 +02:00
} break ;
2014-02-10 02:10:30 +01:00
case NOTIFICATION_LOCAL_TRANSFORM_CHANGED : {
2017-06-24 04:30:43 +02:00
if ( parent ) {
2018-01-11 21:05:42 +01:00
_update_in_shape_owner ( true ) ;
2015-09-16 03:07:03 +02:00
}
2014-02-10 02:10:30 +01:00
} break ;
2017-06-24 04:30:43 +02:00
case NOTIFICATION_UNPARENTED : {
if ( parent ) {
parent - > remove_shape_owner ( owner_id ) ;
}
owner_id = 0 ;
parent = NULL ;
} break ;
2014-02-10 02:10:30 +01:00
case NOTIFICATION_DRAW : {
2015-09-20 18:03:46 +02:00
2017-08-19 01:02:56 +02:00
if ( ! Engine : : get_singleton ( ) - > is_editor_hint ( ) & & ! get_tree ( ) - > is_debugging_collisions_hint ( ) ) {
2015-09-20 18:03:46 +02:00
break ;
}
2020-05-20 13:32:35 +02:00
int polygon_count = polygon . size ( ) ;
for ( int i = 0 ; i < polygon_count ; i + + ) {
2014-02-10 02:10:30 +01:00
Vector2 p = polygon [ i ] ;
2020-05-20 13:32:35 +02:00
Vector2 n = polygon [ ( i + 1 ) % polygon_count ] ;
2018-02-28 19:47:07 +01:00
// draw line with width <= 1, so it does not scale with zoom and break pixel exact editing
draw_line ( p , n , Color ( 0.9 , 0.2 , 0.0 , 0.8 ) , 1 ) ;
2014-02-10 02:10:30 +01:00
}
2021-03-04 18:29:49 +01:00
if ( polygon_count > 2 ) {
2016-01-11 03:09:05 +01:00
# define DEBUG_DECOMPOSE
2017-03-05 16:44:50 +01:00
# if defined(TOOLS_ENABLED) && defined(DEBUG_DECOMPOSE)
2021-05-04 14:20:36 +02:00
Vector < Vector < Vector2 > > decomp = _decompose_in_convex ( ) ;
2014-02-10 02:10:30 +01:00
2021-03-04 18:29:49 +01:00
Color c ( 0.4 , 0.9 , 0.1 ) ;
for ( int i = 0 ; i < decomp . size ( ) ; i + + ) {
c . set_hsv ( Math : : fmod ( c . get_h ( ) + 0.738 , 1 ) , c . get_s ( ) , c . get_v ( ) , 0.5 ) ;
draw_colored_polygon ( decomp [ i ] , c ) ;
}
2015-09-20 18:03:46 +02:00
# else
2021-03-04 18:29:49 +01:00
draw_colored_polygon ( polygon , get_tree ( ) - > get_debug_collisions_color ( ) ) ;
2014-02-10 02:10:30 +01:00
# endif
2021-03-04 18:29:49 +01:00
}
2015-09-20 18:03:46 +02:00
2017-06-24 04:30:43 +02:00
if ( one_way_collision ) {
Color dcol = get_tree ( ) - > get_debug_collisions_color ( ) ; //0.9,0.2,0.2,0.4);
dcol . a = 1.0 ;
Vector2 line_to ( 0 , 20 ) ;
draw_line ( Vector2 ( ) , line_to , dcol , 3 ) ;
Vector < Vector2 > pts ;
float tsize = 8 ;
pts . push_back ( line_to + ( Vector2 ( 0 , tsize ) ) ) ;
2019-12-10 05:13:02 +01:00
pts . push_back ( line_to + ( Vector2 ( Math_SQRT12 * tsize , 0 ) ) ) ;
pts . push_back ( line_to + ( Vector2 ( - Math_SQRT12 * tsize , 0 ) ) ) ;
2017-06-24 04:30:43 +02:00
Vector < Color > cols ;
for ( int i = 0 ; i < 3 ; i + + )
cols . push_back ( dcol ) ;
draw_primitive ( pts , cols , Vector < Vector2 > ( ) ) ; //small arrow
}
2015-03-23 15:31:03 +01:00
} break ;
2014-02-10 02:10:30 +01:00
}
}
2017-03-05 16:44:50 +01:00
void CollisionPolygon2D : : set_polygon ( const Vector < Point2 > & p_polygon ) {
2014-02-10 02:10:30 +01:00
2017-03-05 16:44:50 +01:00
polygon = p_polygon ;
2014-02-10 02:10:30 +01:00
2017-06-24 04:30:43 +02:00
{
2017-03-05 16:44:50 +01:00
for ( int i = 0 ; i < polygon . size ( ) ; i + + ) {
if ( i = = 0 )
aabb = Rect2 ( polygon [ i ] , Size2 ( ) ) ;
2015-09-16 03:07:03 +02:00
else
aabb . expand_to ( polygon [ i ] ) ;
}
2017-03-05 16:44:50 +01:00
if ( aabb = = Rect2 ( ) ) {
2014-02-10 02:10:30 +01:00
2017-03-05 16:44:50 +01:00
aabb = Rect2 ( - 10 , - 10 , 20 , 20 ) ;
2015-09-16 03:07:03 +02:00
} else {
2017-06-04 00:25:13 +02:00
aabb . position - = aabb . size * 0.3 ;
2017-03-05 16:44:50 +01:00
aabb . size + = aabb . size * 0.6 ;
2015-09-16 03:07:03 +02:00
}
2017-06-24 04:30:43 +02:00
}
if ( parent ) {
_build_polygon ( ) ;
2021-01-11 17:04:08 +01:00
_update_in_shape_owner ( ) ;
2014-02-10 02:10:30 +01:00
}
update ( ) ;
2017-01-22 14:09:41 +01:00
update_configuration_warning ( ) ;
2014-02-10 02:10:30 +01:00
}
Vector < Point2 > CollisionPolygon2D : : get_polygon ( ) const {
return polygon ;
}
void CollisionPolygon2D : : set_build_mode ( BuildMode p_mode ) {
2018-10-04 09:17:59 +02:00
ERR_FAIL_INDEX ( ( int ) p_mode , 2 ) ;
2017-03-05 16:44:50 +01:00
build_mode = p_mode ;
2017-06-24 04:30:43 +02:00
if ( parent ) {
_build_polygon ( ) ;
2021-01-11 17:04:08 +01:00
_update_in_shape_owner ( ) ;
2017-06-24 04:30:43 +02:00
}
2021-03-04 18:29:49 +01:00
update ( ) ;
update_configuration_warning ( ) ;
2014-02-10 02:10:30 +01:00
}
2017-03-05 16:44:50 +01:00
CollisionPolygon2D : : BuildMode CollisionPolygon2D : : get_build_mode ( ) const {
2014-02-10 02:10:30 +01:00
return build_mode ;
}
2019-10-21 23:37:07 +02:00
# ifdef TOOLS_ENABLED
2017-11-15 23:03:25 +01:00
Rect2 CollisionPolygon2D : : _edit_get_rect ( ) const {
2014-02-10 02:10:30 +01:00
return aabb ;
}
2018-03-08 21:35:41 +01:00
bool CollisionPolygon2D : : _edit_use_rect ( ) const {
return true ;
}
2017-12-27 09:28:02 +01:00
bool CollisionPolygon2D : : _edit_is_selected_on_click ( const Point2 & p_point , double p_tolerance ) const {
return Geometry : : is_point_in_polygon ( p_point , Variant ( polygon ) ) ;
}
2019-10-21 23:37:07 +02:00
# endif
2017-12-27 09:28:02 +01:00
2017-06-24 04:30:43 +02:00
String CollisionPolygon2D : : get_configuration_warning ( ) const {
2014-12-20 19:30:06 +01:00
2020-03-22 09:31:09 +01:00
String warning = Node2D : : get_configuration_warning ( ) ;
2017-08-24 22:58:51 +02:00
if ( ! Object : : cast_to < CollisionObject2D > ( get_parent ( ) ) ) {
2020-03-22 09:31:09 +01:00
if ( warning ! = String ( ) ) {
warning + = " \n \n " ;
}
warning + = TTR ( " CollisionPolygon2D only serves to provide a collision shape to a CollisionObject2D derived node. Please only use it as a child of Area2D, StaticBody2D, RigidBody2D, KinematicBody2D, etc. to give them a shape. " ) ;
2015-09-16 03:07:03 +02:00
}
2014-12-20 19:30:06 +01:00
2021-03-04 18:29:49 +01:00
int polygon_count = polygon . size ( ) ;
if ( polygon_count = = 0 ) {
if ( ! warning . empty ( ) ) {
2020-03-22 09:31:09 +01:00
warning + = " \n \n " ;
}
warning + = TTR ( " An empty CollisionPolygon2D has no effect on collision. " ) ;
2021-03-04 18:29:49 +01:00
} else {
bool solids = build_mode = = BUILD_SOLIDS ;
if ( solids ) {
if ( polygon_count < 3 ) {
if ( ! warning . empty ( ) ) {
warning + = " \n \n " ;
}
warning + = TTR ( " Invalid polygon. At least 3 points are needed in 'Solids' build mode. " ) ;
}
} else if ( polygon_count < 2 ) {
if ( ! warning . empty ( ) ) {
warning + = " \n \n " ;
}
warning + = TTR ( " Invalid polygon. At least 2 points are needed in 'Segments' build mode. " ) ;
}
2017-06-24 04:30:43 +02:00
}
2014-12-20 19:30:06 +01:00
2020-03-22 09:31:09 +01:00
return warning ;
2014-12-20 19:30:06 +01:00
}
2017-06-24 04:30:43 +02:00
void CollisionPolygon2D : : set_disabled ( bool p_disabled ) {
disabled = p_disabled ;
update ( ) ;
if ( parent ) {
parent - > shape_owner_set_disabled ( owner_id , p_disabled ) ;
}
2015-09-16 03:07:03 +02:00
}
2017-06-24 04:30:43 +02:00
bool CollisionPolygon2D : : is_disabled ( ) const {
return disabled ;
2015-09-16 03:07:03 +02:00
}
2017-06-24 04:30:43 +02:00
void CollisionPolygon2D : : set_one_way_collision ( bool p_enable ) {
one_way_collision = p_enable ;
update ( ) ;
if ( parent ) {
parent - > shape_owner_set_one_way_collision ( owner_id , p_enable ) ;
2016-05-17 23:27:15 +02:00
}
2017-06-24 04:30:43 +02:00
}
2016-05-17 23:27:15 +02:00
2017-06-24 04:30:43 +02:00
bool CollisionPolygon2D : : is_one_way_collision_enabled ( ) const {
2016-05-17 23:27:15 +02:00
2017-06-24 04:30:43 +02:00
return one_way_collision ;
2016-05-17 23:27:15 +02:00
}
2019-01-18 18:15:05 +01:00
void CollisionPolygon2D : : set_one_way_collision_margin ( float p_margin ) {
one_way_collision_margin = p_margin ;
if ( parent ) {
parent - > shape_owner_set_one_way_collision_margin ( owner_id , one_way_collision_margin ) ;
}
}
float CollisionPolygon2D : : get_one_way_collision_margin ( ) const {
return one_way_collision_margin ;
}
2014-02-10 02:10:30 +01:00
void CollisionPolygon2D : : _bind_methods ( ) {
2017-03-05 16:44:50 +01:00
ClassDB : : bind_method ( D_METHOD ( " set_polygon " , " polygon " ) , & CollisionPolygon2D : : set_polygon ) ;
ClassDB : : bind_method ( D_METHOD ( " get_polygon " ) , & CollisionPolygon2D : : get_polygon ) ;
2014-02-10 02:10:30 +01:00
2017-03-05 16:44:50 +01:00
ClassDB : : bind_method ( D_METHOD ( " set_build_mode " , " build_mode " ) , & CollisionPolygon2D : : set_build_mode ) ;
ClassDB : : bind_method ( D_METHOD ( " get_build_mode " ) , & CollisionPolygon2D : : get_build_mode ) ;
2017-06-24 04:30:43 +02:00
ClassDB : : bind_method ( D_METHOD ( " set_disabled " , " disabled " ) , & CollisionPolygon2D : : set_disabled ) ;
ClassDB : : bind_method ( D_METHOD ( " is_disabled " ) , & CollisionPolygon2D : : is_disabled ) ;
ClassDB : : bind_method ( D_METHOD ( " set_one_way_collision " , " enabled " ) , & CollisionPolygon2D : : set_one_way_collision ) ;
ClassDB : : bind_method ( D_METHOD ( " is_one_way_collision_enabled " ) , & CollisionPolygon2D : : is_one_way_collision_enabled ) ;
2019-01-18 18:15:05 +01:00
ClassDB : : bind_method ( D_METHOD ( " set_one_way_collision_margin " , " margin " ) , & CollisionPolygon2D : : set_one_way_collision_margin ) ;
ClassDB : : bind_method ( D_METHOD ( " get_one_way_collision_margin " ) , & CollisionPolygon2D : : get_one_way_collision_margin ) ;
2015-09-16 03:07:03 +02:00
2017-03-05 16:44:50 +01:00
ADD_PROPERTY ( PropertyInfo ( Variant : : INT , " build_mode " , PROPERTY_HINT_ENUM , " Solids,Segments " ) , " set_build_mode " , " get_build_mode " ) ;
ADD_PROPERTY ( PropertyInfo ( Variant : : POOL_VECTOR2_ARRAY , " polygon " ) , " set_polygon " , " get_polygon " ) ;
2018-11-08 15:30:02 +01:00
ADD_PROPERTY ( PropertyInfo ( Variant : : BOOL , " disabled " ) , " set_disabled " , " is_disabled " ) ;
ADD_PROPERTY ( PropertyInfo ( Variant : : BOOL , " one_way_collision " ) , " set_one_way_collision " , " is_one_way_collision_enabled " ) ;
2019-01-18 18:15:05 +01:00
ADD_PROPERTY ( PropertyInfo ( Variant : : REAL , " one_way_collision_margin " , PROPERTY_HINT_RANGE , " 0,128,0.1 " ) , " set_one_way_collision_margin " , " get_one_way_collision_margin " ) ;
2017-09-12 21:09:06 +02:00
BIND_ENUM_CONSTANT ( BUILD_SOLIDS ) ;
BIND_ENUM_CONSTANT ( BUILD_SEGMENTS ) ;
2014-02-10 02:10:30 +01:00
}
CollisionPolygon2D : : CollisionPolygon2D ( ) {
2017-03-05 16:44:50 +01:00
aabb = Rect2 ( - 10 , - 10 , 20 , 20 ) ;
build_mode = BUILD_SOLIDS ;
2015-09-16 03:07:03 +02:00
set_notify_local_transform ( true ) ;
2017-06-24 04:30:43 +02:00
parent = NULL ;
owner_id = 0 ;
disabled = false ;
one_way_collision = false ;
2019-01-18 18:15:05 +01:00
one_way_collision_margin = 1.0 ;
2014-02-10 02:10:30 +01:00
}