2014-02-10 01:10:30 +00:00
|
|
|
/*************************************************************************/
|
|
|
|
/* ray_cast_2d.cpp */
|
|
|
|
/*************************************************************************/
|
|
|
|
/* This file is part of: */
|
|
|
|
/* GODOT ENGINE */
|
2017-08-27 12:11:45 +00:00
|
|
|
/* https://godotengine.org */
|
2014-02-10 01:10:30 +00:00
|
|
|
/*************************************************************************/
|
2017-01-01 21:01:57 +00:00
|
|
|
/* Copyright (c) 2007-2017 Juan Linietsky, Ariel Manzur. */
|
2017-04-07 22:45:00 +00:00
|
|
|
/* Copyright (c) 2014-2017 Godot Engine contributors (cf. AUTHORS.md) */
|
2014-02-10 01:10:30 +00: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. */
|
|
|
|
/*************************************************************************/
|
2014-04-05 21:50:09 +00:00
|
|
|
#include "ray_cast_2d.h"
|
|
|
|
#include "collision_object_2d.h"
|
2017-03-18 23:36:26 +00:00
|
|
|
#include "servers/physics_2d_server.h"
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
void RayCast2D::set_cast_to(const Vector2 &p_point) {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
cast_to = p_point;
|
2016-04-07 11:30:40 +00:00
|
|
|
if (is_inside_tree() && (get_tree()->is_editor_hint() || get_tree()->is_debugging_collisions_hint()))
|
2014-04-05 21:50:09 +00:00
|
|
|
update();
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
Vector2 RayCast2D::get_cast_to() const {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
return cast_to;
|
|
|
|
}
|
|
|
|
|
2014-05-14 04:22:15 +00:00
|
|
|
void RayCast2D::set_layer_mask(uint32_t p_mask) {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
layer_mask = p_mask;
|
2014-05-14 04:22:15 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t RayCast2D::get_layer_mask() const {
|
|
|
|
|
|
|
|
return layer_mask;
|
|
|
|
}
|
|
|
|
|
2015-10-10 03:46:47 +00:00
|
|
|
void RayCast2D::set_type_mask(uint32_t p_mask) {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
type_mask = p_mask;
|
2015-10-10 03:46:47 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t RayCast2D::get_type_mask() const {
|
|
|
|
|
|
|
|
return type_mask;
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bool RayCast2D::is_colliding() const {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
return collided;
|
|
|
|
}
|
2017-03-18 23:36:26 +00:00
|
|
|
Object *RayCast2D::get_collider() const {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (against == 0)
|
2014-04-05 21:50:09 +00:00
|
|
|
return NULL;
|
|
|
|
|
|
|
|
return ObjectDB::get_instance(against);
|
|
|
|
}
|
|
|
|
|
|
|
|
int RayCast2D::get_collider_shape() const {
|
|
|
|
|
|
|
|
return against_shape;
|
|
|
|
}
|
2017-03-18 23:36:26 +00:00
|
|
|
Vector2 RayCast2D::get_collision_point() const {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
return collision_point;
|
|
|
|
}
|
2017-03-18 23:36:26 +00:00
|
|
|
Vector2 RayCast2D::get_collision_normal() const {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
return collision_normal;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RayCast2D::set_enabled(bool p_enabled) {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
enabled = p_enabled;
|
2014-11-06 00:20:42 +00:00
|
|
|
if (is_inside_tree() && !get_tree()->is_editor_hint())
|
2014-04-05 21:50:09 +00:00
|
|
|
set_fixed_process(p_enabled);
|
|
|
|
if (!p_enabled)
|
2017-03-18 23:36:26 +00:00
|
|
|
collided = false;
|
2014-04-05 21:50:09 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
bool RayCast2D::is_enabled() const {
|
|
|
|
|
|
|
|
return enabled;
|
|
|
|
}
|
|
|
|
|
|
|
|
void RayCast2D::_notification(int p_what) {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
switch (p_what) {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2014-11-06 00:20:42 +00:00
|
|
|
case NOTIFICATION_ENTER_TREE: {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2014-11-06 00:20:42 +00:00
|
|
|
if (enabled && !get_tree()->is_editor_hint())
|
2014-04-05 21:50:09 +00:00
|
|
|
set_fixed_process(true);
|
|
|
|
else
|
|
|
|
set_fixed_process(false);
|
|
|
|
|
|
|
|
} break;
|
2014-11-06 00:20:42 +00:00
|
|
|
case NOTIFICATION_EXIT_TREE: {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
if (enabled)
|
|
|
|
set_fixed_process(false);
|
|
|
|
|
|
|
|
} break;
|
2015-09-20 16:03:46 +00:00
|
|
|
|
2014-04-05 21:50:09 +00:00
|
|
|
case NOTIFICATION_DRAW: {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (!get_tree()->is_editor_hint() && !get_tree()->is_debugging_collisions_hint())
|
2014-04-05 21:50:09 +00:00
|
|
|
break;
|
|
|
|
Matrix32 xf;
|
2015-11-19 13:41:20 +00:00
|
|
|
xf.rotate(cast_to.angle());
|
2017-08-03 00:06:35 +00:00
|
|
|
xf.translate(Vector2(0, cast_to.length()));
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
//Vector2 tip = Vector2(0,s->get_length());
|
2017-03-18 23:36:26 +00:00
|
|
|
Color dcol = get_tree()->get_debug_collisions_color(); //0.9,0.2,0.2,0.4);
|
|
|
|
draw_line(Vector2(), cast_to, dcol, 3);
|
2014-04-05 21:50:09 +00:00
|
|
|
Vector<Vector2> pts;
|
2017-03-18 23:36:26 +00:00
|
|
|
float tsize = 4;
|
2017-08-03 00:06:35 +00:00
|
|
|
pts.push_back(xf.xform(Vector2(0, tsize)));
|
|
|
|
pts.push_back(xf.xform(Vector2(0.707 * tsize, 0)));
|
|
|
|
pts.push_back(xf.xform(Vector2(-0.707 * tsize, 0)));
|
2014-04-05 21:50:09 +00:00
|
|
|
Vector<Color> cols;
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int i = 0; i < 3; i++)
|
2014-04-05 21:50:09 +00:00
|
|
|
cols.push_back(dcol);
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
draw_primitive(pts, cols, Vector<Vector2>()); //small arrow
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
} break;
|
2015-09-20 16:03:46 +00:00
|
|
|
|
2014-04-05 21:50:09 +00:00
|
|
|
case NOTIFICATION_FIXED_PROCESS: {
|
|
|
|
|
|
|
|
if (!enabled)
|
|
|
|
break;
|
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
_update_raycast_state();
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
} break;
|
|
|
|
}
|
|
|
|
}
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
void RayCast2D::_update_raycast_state() {
|
|
|
|
Ref<World2D> w2d = get_world_2d();
|
2017-03-18 23:36:26 +00:00
|
|
|
ERR_FAIL_COND(w2d.is_null());
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
Physics2DDirectSpaceState *dss = Physics2DServer::get_singleton()->space_get_direct_state(w2d->get_space());
|
2017-03-18 23:36:26 +00:00
|
|
|
ERR_FAIL_COND(!dss);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
Matrix32 gt = get_global_transform();
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
Vector2 to = cast_to;
|
2017-03-18 23:36:26 +00:00
|
|
|
if (to == Vector2())
|
|
|
|
to = Vector2(0, 0.01);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
Physics2DDirectSpaceState::RayResult rr;
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (dss->intersect_ray(gt.get_origin(), gt.xform(to), rr, exclude, layer_mask, type_mask)) {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
collided = true;
|
|
|
|
against = rr.collider_id;
|
|
|
|
collision_point = rr.position;
|
|
|
|
collision_normal = rr.normal;
|
|
|
|
against_shape = rr.shape;
|
2016-08-09 17:52:15 +00:00
|
|
|
} else {
|
2017-03-18 23:36:26 +00:00
|
|
|
collided = false;
|
2014-04-05 21:50:09 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-08-09 17:52:15 +00:00
|
|
|
void RayCast2D::force_raycast_update() {
|
|
|
|
_update_raycast_state();
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
void RayCast2D::add_exception_rid(const RID &p_rid) {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
exclude.insert(p_rid);
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
void RayCast2D::add_exception(const Object *p_object) {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
ERR_FAIL_NULL(p_object);
|
2017-03-18 23:36:26 +00:00
|
|
|
CollisionObject2D *co = ((Object *)p_object)->cast_to<CollisionObject2D>();
|
2014-04-05 21:50:09 +00:00
|
|
|
if (!co)
|
|
|
|
return;
|
|
|
|
add_exception_rid(co->get_rid());
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
void RayCast2D::remove_exception_rid(const RID &p_rid) {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
exclude.erase(p_rid);
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
void RayCast2D::remove_exception(const Object *p_object) {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
ERR_FAIL_NULL(p_object);
|
2017-03-18 23:36:26 +00:00
|
|
|
CollisionObject2D *co = ((Object *)p_object)->cast_to<CollisionObject2D>();
|
2014-04-05 21:50:09 +00:00
|
|
|
if (!co)
|
|
|
|
return;
|
|
|
|
remove_exception_rid(co->get_rid());
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
void RayCast2D::clear_exceptions() {
|
2014-04-05 21:50:09 +00:00
|
|
|
|
|
|
|
exclude.clear();
|
|
|
|
}
|
|
|
|
|
|
|
|
void RayCast2D::_bind_methods() {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("set_enabled", "enabled"), &RayCast2D::set_enabled);
|
|
|
|
ObjectTypeDB::bind_method(_MD("is_enabled"), &RayCast2D::is_enabled);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("set_cast_to", "local_point"), &RayCast2D::set_cast_to);
|
|
|
|
ObjectTypeDB::bind_method(_MD("get_cast_to"), &RayCast2D::get_cast_to);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("is_colliding"), &RayCast2D::is_colliding);
|
|
|
|
ObjectTypeDB::bind_method(_MD("force_raycast_update"), &RayCast2D::force_raycast_update);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("get_collider"), &RayCast2D::get_collider);
|
|
|
|
ObjectTypeDB::bind_method(_MD("get_collider_shape"), &RayCast2D::get_collider_shape);
|
|
|
|
ObjectTypeDB::bind_method(_MD("get_collision_point"), &RayCast2D::get_collision_point);
|
|
|
|
ObjectTypeDB::bind_method(_MD("get_collision_normal"), &RayCast2D::get_collision_normal);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("add_exception_rid", "rid"), &RayCast2D::add_exception_rid);
|
|
|
|
ObjectTypeDB::bind_method(_MD("add_exception", "node"), &RayCast2D::add_exception);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("remove_exception_rid", "rid"), &RayCast2D::remove_exception_rid);
|
|
|
|
ObjectTypeDB::bind_method(_MD("remove_exception", "node"), &RayCast2D::remove_exception);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("clear_exceptions"), &RayCast2D::clear_exceptions);
|
2014-04-05 21:50:09 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("set_layer_mask", "mask"), &RayCast2D::set_layer_mask);
|
|
|
|
ObjectTypeDB::bind_method(_MD("get_layer_mask"), &RayCast2D::get_layer_mask);
|
2014-05-14 04:22:15 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ObjectTypeDB::bind_method(_MD("set_type_mask", "mask"), &RayCast2D::set_type_mask);
|
|
|
|
ObjectTypeDB::bind_method(_MD("get_type_mask"), &RayCast2D::get_type_mask);
|
2015-10-10 03:46:47 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::BOOL, "enabled"), _SCS("set_enabled"), _SCS("is_enabled"));
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::VECTOR2, "cast_to"), _SCS("set_cast_to"), _SCS("get_cast_to"));
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::INT, "layer_mask", PROPERTY_HINT_ALL_FLAGS), _SCS("set_layer_mask"), _SCS("get_layer_mask"));
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::INT, "type_mask", PROPERTY_HINT_FLAGS, "Static,Kinematic,Rigid,Character,Area"), _SCS("set_type_mask"), _SCS("get_type_mask"));
|
2014-04-05 21:50:09 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
RayCast2D::RayCast2D() {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
enabled = false;
|
|
|
|
against = 0;
|
|
|
|
collided = false;
|
|
|
|
against_shape = 0;
|
|
|
|
layer_mask = 1;
|
|
|
|
type_mask = Physics2DDirectSpaceState::TYPE_MASK_COLLISION;
|
|
|
|
cast_to = Vector2(0, 50);
|
2014-04-05 21:50:09 +00:00
|
|
|
}
|