2018-08-29 22:38:13 +02:00
|
|
|
/*************************************************************************/
|
|
|
|
/* animation_blend_space_2d.cpp */
|
|
|
|
/*************************************************************************/
|
|
|
|
/* This file is part of: */
|
|
|
|
/* GODOT ENGINE */
|
|
|
|
/* https://godotengine.org */
|
|
|
|
/*************************************************************************/
|
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). */
|
2018-08-29 22:38:13 +02: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-06-22 21:52:13 +02:00
|
|
|
#include "animation_blend_space_2d.h"
|
2018-09-11 18:13:45 +02:00
|
|
|
#include "core/math/delaunay.h"
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-08-20 18:38:18 +02:00
|
|
|
void AnimationNodeBlendSpace2D::get_parameter_list(List<PropertyInfo> *r_list) const {
|
2018-08-21 21:28:06 +02:00
|
|
|
r_list->push_back(PropertyInfo(Variant::VECTOR2, blend_position));
|
2018-11-21 20:06:17 +01:00
|
|
|
r_list->push_back(PropertyInfo(Variant::INT, closest, PROPERTY_HINT_NONE, "", 0));
|
|
|
|
r_list->push_back(PropertyInfo(Variant::REAL, length_internal, PROPERTY_HINT_NONE, "", 0));
|
2018-08-20 18:38:18 +02:00
|
|
|
}
|
|
|
|
Variant AnimationNodeBlendSpace2D::get_parameter_default_value(const StringName &p_parameter) const {
|
2018-11-21 20:06:17 +01:00
|
|
|
if (p_parameter == closest) {
|
|
|
|
return -1;
|
|
|
|
} else if (p_parameter == length_internal) {
|
|
|
|
return 0;
|
|
|
|
} else {
|
|
|
|
return Vector2();
|
|
|
|
}
|
2018-08-20 18:38:18 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void AnimationNodeBlendSpace2D::get_child_nodes(List<ChildNode> *r_child_nodes) {
|
2018-08-21 21:28:06 +02:00
|
|
|
for (int i = 0; i < blend_points_used; i++) {
|
2018-08-20 18:38:18 +02:00
|
|
|
ChildNode cn;
|
2018-08-21 21:28:06 +02:00
|
|
|
cn.name = itos(i);
|
|
|
|
cn.node = blend_points[i].node;
|
2018-08-20 18:38:18 +02:00
|
|
|
r_child_nodes->push_back(cn);
|
2018-06-28 01:50:25 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::add_blend_point(const Ref<AnimationRootNode> &p_node, const Vector2 &p_position, int p_at_index) {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_COND(blend_points_used >= MAX_BLEND_POINTS);
|
|
|
|
ERR_FAIL_COND(p_node.is_null());
|
|
|
|
ERR_FAIL_COND(p_at_index < -1 || p_at_index > blend_points_used);
|
|
|
|
|
|
|
|
if (p_at_index == -1 || p_at_index == blend_points_used) {
|
|
|
|
p_at_index = blend_points_used;
|
|
|
|
} else {
|
2018-06-22 21:52:13 +02:00
|
|
|
for (int i = blend_points_used - 1; i > p_at_index; i--) {
|
2018-06-21 20:45:44 +02:00
|
|
|
blend_points[i] = blend_points[i - 1];
|
|
|
|
}
|
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
if (triangles[i].points[j] >= p_at_index) {
|
2018-07-25 03:11:03 +02:00
|
|
|
triangles.write[i].points[j]++;
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
blend_points[p_at_index].node = p_node;
|
|
|
|
blend_points[p_at_index].position = p_position;
|
|
|
|
|
2018-08-21 21:28:06 +02:00
|
|
|
blend_points[p_at_index].node->connect("tree_changed", this, "_tree_changed", varray(), CONNECT_REFERENCE_COUNTED);
|
2018-06-21 20:45:44 +02:00
|
|
|
blend_points_used++;
|
2018-06-22 03:48:47 +02:00
|
|
|
|
2019-01-11 01:40:46 +01:00
|
|
|
_queue_auto_triangles();
|
|
|
|
|
2018-08-20 18:38:18 +02:00
|
|
|
emit_signal("tree_changed");
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_blend_point_position(int p_point, const Vector2 &p_position) {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX(p_point, blend_points_used);
|
|
|
|
blend_points[p_point].position = p_position;
|
2019-01-11 01:40:46 +01:00
|
|
|
_queue_auto_triangles();
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_blend_point_node(int p_point, const Ref<AnimationRootNode> &p_node) {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX(p_point, blend_points_used);
|
|
|
|
ERR_FAIL_COND(p_node.is_null());
|
|
|
|
|
|
|
|
if (blend_points[p_point].node.is_valid()) {
|
2018-08-21 21:28:06 +02:00
|
|
|
blend_points[p_point].node->disconnect("tree_changed", this, "_tree_changed");
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
blend_points[p_point].node = p_node;
|
2018-08-21 21:28:06 +02:00
|
|
|
blend_points[p_point].node->connect("tree_changed", this, "_tree_changed", varray(), CONNECT_REFERENCE_COUNTED);
|
2018-08-20 18:38:18 +02:00
|
|
|
|
|
|
|
emit_signal("tree_changed");
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
Vector2 AnimationNodeBlendSpace2D::get_blend_point_position(int p_point) const {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX_V(p_point, blend_points_used, Vector2());
|
|
|
|
return blend_points[p_point].position;
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
Ref<AnimationRootNode> AnimationNodeBlendSpace2D::get_blend_point_node(int p_point) const {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX_V(p_point, blend_points_used, Ref<AnimationRootNode>());
|
|
|
|
return blend_points[p_point].node;
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::remove_blend_point(int p_point) {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX(p_point, blend_points_used);
|
|
|
|
|
2019-11-01 16:16:31 +01:00
|
|
|
ERR_FAIL_COND(blend_points[p_point].node.is_null());
|
2018-08-21 21:28:06 +02:00
|
|
|
blend_points[p_point].node->disconnect("tree_changed", this, "_tree_changed");
|
2018-06-21 20:45:44 +02:00
|
|
|
|
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
|
|
|
bool erase = false;
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
if (triangles[i].points[j] == p_point) {
|
|
|
|
erase = true;
|
|
|
|
break;
|
|
|
|
} else if (triangles[i].points[j] > p_point) {
|
2018-07-25 03:11:03 +02:00
|
|
|
triangles.write[i].points[j]--;
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
if (erase) {
|
|
|
|
triangles.remove(i);
|
|
|
|
|
|
|
|
i--;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
for (int i = p_point; i < blend_points_used - 1; i++) {
|
|
|
|
blend_points[i] = blend_points[i + 1];
|
|
|
|
}
|
|
|
|
blend_points_used--;
|
2018-08-20 18:38:18 +02:00
|
|
|
emit_signal("tree_changed");
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
int AnimationNodeBlendSpace2D::get_blend_point_count() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
return blend_points_used;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
bool AnimationNodeBlendSpace2D::has_triangle(int p_x, int p_y, int p_z) const {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX_V(p_x, blend_points_used, false);
|
|
|
|
ERR_FAIL_INDEX_V(p_y, blend_points_used, false);
|
|
|
|
ERR_FAIL_INDEX_V(p_z, blend_points_used, false);
|
|
|
|
|
|
|
|
BlendTriangle t;
|
|
|
|
t.points[0] = p_x;
|
|
|
|
t.points[1] = p_y;
|
|
|
|
t.points[2] = p_z;
|
|
|
|
|
|
|
|
SortArray<int> sort;
|
|
|
|
sort.sort(t.points, 3);
|
|
|
|
|
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
|
|
|
bool all_equal = true;
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
if (triangles[i].points[j] != t.points[j]) {
|
|
|
|
all_equal = false;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2021-05-05 12:44:11 +02:00
|
|
|
if (all_equal) {
|
2018-06-21 20:45:44 +02:00
|
|
|
return true;
|
2021-05-05 12:44:11 +02:00
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::add_triangle(int p_x, int p_y, int p_z, int p_at_index) {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX(p_x, blend_points_used);
|
|
|
|
ERR_FAIL_INDEX(p_y, blend_points_used);
|
|
|
|
ERR_FAIL_INDEX(p_z, blend_points_used);
|
|
|
|
|
2018-06-22 03:48:47 +02:00
|
|
|
_update_triangles();
|
|
|
|
|
2018-06-21 20:45:44 +02:00
|
|
|
BlendTriangle t;
|
|
|
|
t.points[0] = p_x;
|
|
|
|
t.points[1] = p_y;
|
|
|
|
t.points[2] = p_z;
|
|
|
|
|
|
|
|
SortArray<int> sort;
|
|
|
|
sort.sort(t.points, 3);
|
|
|
|
|
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
|
|
|
bool all_equal = true;
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
if (triangles[i].points[j] != t.points[j]) {
|
|
|
|
all_equal = false;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
ERR_FAIL_COND(all_equal);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (p_at_index == -1 || p_at_index == triangles.size()) {
|
|
|
|
triangles.push_back(t);
|
|
|
|
} else {
|
|
|
|
triangles.insert(p_at_index, t);
|
|
|
|
}
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
int AnimationNodeBlendSpace2D::get_triangle_point(int p_triangle, int p_point) {
|
2018-06-22 03:48:47 +02:00
|
|
|
_update_triangles();
|
|
|
|
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX_V(p_point, 3, -1);
|
|
|
|
ERR_FAIL_INDEX_V(p_triangle, triangles.size(), -1);
|
|
|
|
return triangles[p_triangle].points[p_point];
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::remove_triangle(int p_triangle) {
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_INDEX(p_triangle, triangles.size());
|
|
|
|
|
|
|
|
triangles.remove(p_triangle);
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
int AnimationNodeBlendSpace2D::get_triangle_count() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
return triangles.size();
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_min_space(const Vector2 &p_min) {
|
2018-06-21 20:45:44 +02:00
|
|
|
min_space = p_min;
|
|
|
|
if (min_space.x >= max_space.x) {
|
|
|
|
min_space.x = max_space.x - 1;
|
|
|
|
}
|
|
|
|
if (min_space.y >= max_space.y) {
|
|
|
|
min_space.y = max_space.y - 1;
|
|
|
|
}
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
Vector2 AnimationNodeBlendSpace2D::get_min_space() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
return min_space;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_max_space(const Vector2 &p_max) {
|
2018-06-21 20:45:44 +02:00
|
|
|
max_space = p_max;
|
|
|
|
if (max_space.x <= min_space.x) {
|
|
|
|
max_space.x = min_space.x + 1;
|
|
|
|
}
|
|
|
|
if (max_space.y <= min_space.y) {
|
|
|
|
max_space.y = min_space.y + 1;
|
|
|
|
}
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
Vector2 AnimationNodeBlendSpace2D::get_max_space() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
return max_space;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_snap(const Vector2 &p_snap) {
|
2018-06-21 20:45:44 +02:00
|
|
|
snap = p_snap;
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
Vector2 AnimationNodeBlendSpace2D::get_snap() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
return snap;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_x_label(const String &p_label) {
|
2018-06-21 20:45:44 +02:00
|
|
|
x_label = p_label;
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
String AnimationNodeBlendSpace2D::get_x_label() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
return x_label;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_y_label(const String &p_label) {
|
2018-06-21 20:45:44 +02:00
|
|
|
y_label = p_label;
|
|
|
|
}
|
2018-06-22 15:17:54 +02:00
|
|
|
String AnimationNodeBlendSpace2D::get_y_label() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
return y_label;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::_add_blend_point(int p_index, const Ref<AnimationRootNode> &p_node) {
|
2018-06-21 20:45:44 +02:00
|
|
|
if (p_index == blend_points_used) {
|
|
|
|
add_blend_point(p_node, Vector2());
|
|
|
|
} else {
|
|
|
|
set_blend_point_node(p_index, p_node);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::_set_triangles(const Vector<int> &p_triangles) {
|
2021-05-05 12:44:11 +02:00
|
|
|
if (auto_triangles) {
|
2018-06-22 03:48:47 +02:00
|
|
|
return;
|
2021-05-05 12:44:11 +02:00
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
ERR_FAIL_COND(p_triangles.size() % 3 != 0);
|
|
|
|
for (int i = 0; i < p_triangles.size(); i += 3) {
|
|
|
|
add_triangle(p_triangles[i + 0], p_triangles[i + 1], p_triangles[i + 2]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
Vector<int> AnimationNodeBlendSpace2D::_get_triangles() const {
|
2018-06-21 20:45:44 +02:00
|
|
|
Vector<int> t;
|
2021-05-05 12:44:11 +02:00
|
|
|
if (auto_triangles && trianges_dirty) {
|
2018-06-22 03:48:47 +02:00
|
|
|
return t;
|
2021-05-05 12:44:11 +02:00
|
|
|
}
|
2018-06-22 03:48:47 +02:00
|
|
|
|
2018-06-21 20:45:44 +02:00
|
|
|
t.resize(triangles.size() * 3);
|
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
2018-07-25 03:11:03 +02:00
|
|
|
t.write[i * 3 + 0] = triangles[i].points[0];
|
|
|
|
t.write[i * 3 + 1] = triangles[i].points[1];
|
|
|
|
t.write[i * 3 + 2] = triangles[i].points[2];
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
return t;
|
|
|
|
}
|
|
|
|
|
2019-01-11 01:40:46 +01:00
|
|
|
void AnimationNodeBlendSpace2D::_queue_auto_triangles() {
|
|
|
|
if (!auto_triangles || trianges_dirty) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
trianges_dirty = true;
|
|
|
|
call_deferred("_update_triangles");
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::_update_triangles() {
|
2021-05-05 12:44:11 +02:00
|
|
|
if (!auto_triangles || !trianges_dirty) {
|
2018-06-22 03:48:47 +02:00
|
|
|
return;
|
2021-05-05 12:44:11 +02:00
|
|
|
}
|
2018-06-22 03:48:47 +02:00
|
|
|
|
|
|
|
trianges_dirty = false;
|
|
|
|
triangles.clear();
|
2019-01-11 01:40:46 +01:00
|
|
|
if (blend_points_used < 3) {
|
|
|
|
emit_signal("triangles_updated");
|
2018-06-22 03:48:47 +02:00
|
|
|
return;
|
2019-01-11 01:40:46 +01:00
|
|
|
}
|
2018-06-22 03:48:47 +02:00
|
|
|
|
|
|
|
Vector<Vector2> points;
|
|
|
|
points.resize(blend_points_used);
|
|
|
|
for (int i = 0; i < blend_points_used; i++) {
|
2018-07-25 03:11:03 +02:00
|
|
|
points.write[i] = blend_points[i].position;
|
2018-06-22 03:48:47 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
Vector<Delaunay2D::Triangle> triangles = Delaunay2D::triangulate(points);
|
|
|
|
|
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
|
|
|
add_triangle(triangles[i].points[0], triangles[i].points[1], triangles[i].points[2]);
|
|
|
|
}
|
2019-01-11 01:40:46 +01:00
|
|
|
emit_signal("triangles_updated");
|
2018-06-22 03:48:47 +02:00
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
Vector2 AnimationNodeBlendSpace2D::get_closest_point(const Vector2 &p_point) {
|
2018-06-22 03:48:47 +02:00
|
|
|
_update_triangles();
|
|
|
|
|
2021-05-05 12:44:11 +02:00
|
|
|
if (triangles.size() == 0) {
|
2018-06-21 20:45:44 +02:00
|
|
|
return Vector2();
|
2021-05-05 12:44:11 +02:00
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
|
|
|
|
Vector2 best_point;
|
|
|
|
bool first = true;
|
|
|
|
|
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
|
|
|
Vector2 points[3];
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
points[j] = get_blend_point_position(get_triangle_point(i, j));
|
|
|
|
}
|
|
|
|
|
|
|
|
if (Geometry::is_point_in_triangle(p_point, points[0], points[1], points[2])) {
|
|
|
|
return p_point;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
Vector2 s[2] = {
|
|
|
|
points[j],
|
|
|
|
points[(j + 1) % 3]
|
|
|
|
};
|
|
|
|
Vector2 closest = Geometry::get_closest_point_to_segment_2d(p_point, s);
|
|
|
|
if (first || closest.distance_to(p_point) < best_point.distance_to(p_point)) {
|
|
|
|
best_point = closest;
|
|
|
|
first = false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return best_point;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::_blend_triangle(const Vector2 &p_pos, const Vector2 *p_points, float *r_weights) {
|
2018-06-21 20:45:44 +02:00
|
|
|
if (p_pos.distance_squared_to(p_points[0]) < CMP_EPSILON2) {
|
|
|
|
r_weights[0] = 1;
|
|
|
|
r_weights[1] = 0;
|
|
|
|
r_weights[2] = 0;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
if (p_pos.distance_squared_to(p_points[1]) < CMP_EPSILON2) {
|
|
|
|
r_weights[0] = 0;
|
|
|
|
r_weights[1] = 1;
|
|
|
|
r_weights[2] = 0;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
if (p_pos.distance_squared_to(p_points[2]) < CMP_EPSILON2) {
|
|
|
|
r_weights[0] = 0;
|
|
|
|
r_weights[1] = 0;
|
|
|
|
r_weights[2] = 1;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
Vector2 v0 = p_points[1] - p_points[0];
|
|
|
|
Vector2 v1 = p_points[2] - p_points[0];
|
|
|
|
Vector2 v2 = p_pos - p_points[0];
|
|
|
|
|
|
|
|
float d00 = v0.dot(v0);
|
|
|
|
float d01 = v0.dot(v1);
|
|
|
|
float d11 = v1.dot(v1);
|
|
|
|
float d20 = v2.dot(v0);
|
|
|
|
float d21 = v2.dot(v1);
|
|
|
|
float denom = (d00 * d11 - d01 * d01);
|
|
|
|
if (denom == 0) {
|
|
|
|
r_weights[0] = 1;
|
|
|
|
r_weights[1] = 0;
|
|
|
|
r_weights[2] = 0;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
float v = (d11 * d20 - d01 * d21) / denom;
|
|
|
|
float w = (d00 * d21 - d01 * d20) / denom;
|
|
|
|
float u = 1.0f - v - w;
|
|
|
|
|
|
|
|
r_weights[0] = u;
|
|
|
|
r_weights[1] = v;
|
|
|
|
r_weights[2] = w;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
float AnimationNodeBlendSpace2D::process(float p_time, bool p_seek) {
|
2018-06-22 03:48:47 +02:00
|
|
|
_update_triangles();
|
|
|
|
|
2018-08-20 18:38:18 +02:00
|
|
|
Vector2 blend_pos = get_parameter(blend_position);
|
2018-11-21 20:06:17 +01:00
|
|
|
int closest = get_parameter(this->closest);
|
|
|
|
float length_internal = get_parameter(this->length_internal);
|
|
|
|
float mind = 0; //time of min distance point
|
2018-08-20 18:38:18 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
if (blend_mode == BLEND_MODE_INTERPOLATED) {
|
2021-05-05 12:44:11 +02:00
|
|
|
if (triangles.size() == 0) {
|
2018-11-21 20:06:17 +01:00
|
|
|
return 0;
|
2021-05-05 12:44:11 +02:00
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
Vector2 best_point;
|
|
|
|
bool first = true;
|
|
|
|
int blend_triangle = -1;
|
|
|
|
float blend_weights[3] = { 0, 0, 0 };
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
for (int i = 0; i < triangles.size(); i++) {
|
|
|
|
Vector2 points[3];
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
points[j] = get_blend_point_position(get_triangle_point(i, j));
|
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
if (Geometry::is_point_in_triangle(blend_pos, points[0], points[1], points[2])) {
|
2018-06-21 20:45:44 +02:00
|
|
|
blend_triangle = i;
|
2018-11-21 20:06:17 +01:00
|
|
|
_blend_triangle(blend_pos, points, blend_weights);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
Vector2 s[2] = {
|
|
|
|
points[j],
|
|
|
|
points[(j + 1) % 3]
|
|
|
|
};
|
2019-02-12 21:10:08 +01:00
|
|
|
Vector2 closest2 = Geometry::get_closest_point_to_segment_2d(blend_pos, s);
|
|
|
|
if (first || closest2.distance_to(blend_pos) < best_point.distance_to(blend_pos)) {
|
|
|
|
best_point = closest2;
|
2018-11-21 20:06:17 +01:00
|
|
|
blend_triangle = i;
|
|
|
|
first = false;
|
|
|
|
float d = s[0].distance_to(s[1]);
|
|
|
|
if (d == 0.0) {
|
|
|
|
blend_weights[j] = 1.0;
|
|
|
|
blend_weights[(j + 1) % 3] = 0.0;
|
|
|
|
blend_weights[(j + 2) % 3] = 0.0;
|
|
|
|
} else {
|
2019-02-12 21:10:08 +01:00
|
|
|
float c = s[0].distance_to(closest2) / d;
|
2018-11-21 20:06:17 +01:00
|
|
|
|
|
|
|
blend_weights[j] = 1.0 - c;
|
|
|
|
blend_weights[(j + 1) % 3] = c;
|
|
|
|
blend_weights[(j + 2) % 3] = 0.0;
|
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
ERR_FAIL_COND_V(blend_triangle == -1, 0); //should never reach here
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
int triangle_points[3];
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
triangle_points[j] = get_triangle_point(blend_triangle, j);
|
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
first = true;
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
for (int i = 0; i < blend_points_used; i++) {
|
|
|
|
bool found = false;
|
|
|
|
for (int j = 0; j < 3; j++) {
|
|
|
|
if (i == triangle_points[j]) {
|
|
|
|
//blend with the given weight
|
|
|
|
float t = blend_node(blend_points[i].name, blend_points[i].node, p_time, p_seek, blend_weights[j], FILTER_IGNORE, false);
|
|
|
|
if (first || t < mind) {
|
|
|
|
mind = t;
|
|
|
|
first = false;
|
|
|
|
}
|
|
|
|
found = true;
|
|
|
|
break;
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
2018-11-21 20:06:17 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
if (!found) {
|
|
|
|
//ignore
|
|
|
|
blend_node(blend_points[i].name, blend_points[i].node, p_time, p_seek, 0, FILTER_IGNORE, false);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
int new_closest = -1;
|
|
|
|
float new_closest_dist = 1e20;
|
|
|
|
|
|
|
|
for (int i = 0; i < blend_points_used; i++) {
|
|
|
|
float d = blend_points[i].position.distance_squared_to(blend_pos);
|
|
|
|
if (d < new_closest_dist) {
|
|
|
|
new_closest = i;
|
|
|
|
new_closest_dist = d;
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2019-08-07 12:54:30 +02:00
|
|
|
if (new_closest != closest && new_closest != -1) {
|
2018-11-21 20:06:17 +01:00
|
|
|
float from = 0;
|
|
|
|
if (blend_mode == BLEND_MODE_DISCRETE_CARRY && closest != -1) {
|
|
|
|
//see how much animation remains
|
|
|
|
from = blend_node(blend_points[closest].name, blend_points[closest].node, p_time, true, 0.0, FILTER_IGNORE, false) - length_internal;
|
|
|
|
}
|
|
|
|
|
|
|
|
mind = blend_node(blend_points[new_closest].name, blend_points[new_closest].node, from, true, 1.0, FILTER_IGNORE, false) + from;
|
|
|
|
length_internal = from + mind;
|
|
|
|
|
|
|
|
closest = new_closest;
|
|
|
|
|
|
|
|
} else {
|
|
|
|
mind = blend_node(blend_points[closest].name, blend_points[closest].node, p_time, p_seek, 1.0, FILTER_IGNORE, false);
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
}
|
2018-11-21 20:06:17 +01:00
|
|
|
|
|
|
|
set_parameter(this->closest, closest);
|
|
|
|
set_parameter(this->length_internal, length_internal);
|
2018-06-21 20:45:44 +02:00
|
|
|
return mind;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
String AnimationNodeBlendSpace2D::get_caption() const {
|
|
|
|
return "BlendSpace2D";
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::_validate_property(PropertyInfo &property) const {
|
2019-01-11 01:40:46 +01:00
|
|
|
if (auto_triangles && property.name == "triangles") {
|
|
|
|
property.usage = 0;
|
|
|
|
}
|
2018-06-21 20:45:44 +02:00
|
|
|
if (property.name.begins_with("blend_point_")) {
|
|
|
|
String left = property.name.get_slicec('/', 0);
|
|
|
|
int idx = left.get_slicec('_', 2).to_int();
|
|
|
|
if (idx >= blend_points_used) {
|
|
|
|
property.usage = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
AnimationRootNode::_validate_property(property);
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::set_auto_triangles(bool p_enable) {
|
2019-01-11 01:40:46 +01:00
|
|
|
if (auto_triangles == p_enable) {
|
|
|
|
return;
|
2018-06-22 03:48:47 +02:00
|
|
|
}
|
2019-01-11 01:40:46 +01:00
|
|
|
|
|
|
|
auto_triangles = p_enable;
|
|
|
|
_queue_auto_triangles();
|
2018-06-22 03:48:47 +02:00
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
bool AnimationNodeBlendSpace2D::get_auto_triangles() const {
|
2018-06-22 03:48:47 +02:00
|
|
|
return auto_triangles;
|
|
|
|
}
|
|
|
|
|
2018-08-20 18:38:18 +02:00
|
|
|
Ref<AnimationNode> AnimationNodeBlendSpace2D::get_child_by_name(const StringName &p_name) {
|
|
|
|
return get_blend_point_node(p_name.operator String().to_int());
|
|
|
|
}
|
|
|
|
|
|
|
|
void AnimationNodeBlendSpace2D::_tree_changed() {
|
|
|
|
emit_signal("tree_changed");
|
|
|
|
}
|
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
void AnimationNodeBlendSpace2D::set_blend_mode(BlendMode p_blend_mode) {
|
|
|
|
blend_mode = p_blend_mode;
|
|
|
|
}
|
|
|
|
|
|
|
|
AnimationNodeBlendSpace2D::BlendMode AnimationNodeBlendSpace2D::get_blend_mode() const {
|
|
|
|
return blend_mode;
|
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
void AnimationNodeBlendSpace2D::_bind_methods() {
|
|
|
|
ClassDB::bind_method(D_METHOD("add_blend_point", "node", "pos", "at_index"), &AnimationNodeBlendSpace2D::add_blend_point, DEFVAL(-1));
|
|
|
|
ClassDB::bind_method(D_METHOD("set_blend_point_position", "point", "pos"), &AnimationNodeBlendSpace2D::set_blend_point_position);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_blend_point_position", "point"), &AnimationNodeBlendSpace2D::get_blend_point_position);
|
|
|
|
ClassDB::bind_method(D_METHOD("set_blend_point_node", "point", "node"), &AnimationNodeBlendSpace2D::set_blend_point_node);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_blend_point_node", "point"), &AnimationNodeBlendSpace2D::get_blend_point_node);
|
|
|
|
ClassDB::bind_method(D_METHOD("remove_blend_point", "point"), &AnimationNodeBlendSpace2D::remove_blend_point);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_blend_point_count"), &AnimationNodeBlendSpace2D::get_blend_point_count);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("add_triangle", "x", "y", "z", "at_index"), &AnimationNodeBlendSpace2D::add_triangle, DEFVAL(-1));
|
|
|
|
ClassDB::bind_method(D_METHOD("get_triangle_point", "triangle", "point"), &AnimationNodeBlendSpace2D::get_triangle_point);
|
|
|
|
ClassDB::bind_method(D_METHOD("remove_triangle", "triangle"), &AnimationNodeBlendSpace2D::remove_triangle);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_triangle_count"), &AnimationNodeBlendSpace2D::get_triangle_count);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("set_min_space", "min_space"), &AnimationNodeBlendSpace2D::set_min_space);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_min_space"), &AnimationNodeBlendSpace2D::get_min_space);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("set_max_space", "max_space"), &AnimationNodeBlendSpace2D::set_max_space);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_max_space"), &AnimationNodeBlendSpace2D::get_max_space);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("set_snap", "snap"), &AnimationNodeBlendSpace2D::set_snap);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_snap"), &AnimationNodeBlendSpace2D::get_snap);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("set_x_label", "text"), &AnimationNodeBlendSpace2D::set_x_label);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_x_label"), &AnimationNodeBlendSpace2D::get_x_label);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("set_y_label", "text"), &AnimationNodeBlendSpace2D::set_y_label);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_y_label"), &AnimationNodeBlendSpace2D::get_y_label);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("_add_blend_point", "index", "node"), &AnimationNodeBlendSpace2D::_add_blend_point);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("_set_triangles", "triangles"), &AnimationNodeBlendSpace2D::_set_triangles);
|
|
|
|
ClassDB::bind_method(D_METHOD("_get_triangles"), &AnimationNodeBlendSpace2D::_get_triangles);
|
2018-06-21 20:45:44 +02:00
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("set_auto_triangles", "enable"), &AnimationNodeBlendSpace2D::set_auto_triangles);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_auto_triangles"), &AnimationNodeBlendSpace2D::get_auto_triangles);
|
2018-06-22 03:48:47 +02:00
|
|
|
|
2018-11-21 20:06:17 +01:00
|
|
|
ClassDB::bind_method(D_METHOD("set_blend_mode", "mode"), &AnimationNodeBlendSpace2D::set_blend_mode);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_blend_mode"), &AnimationNodeBlendSpace2D::get_blend_mode);
|
|
|
|
|
2018-08-20 18:38:18 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("_tree_changed"), &AnimationNodeBlendSpace2D::_tree_changed);
|
2019-01-11 01:40:46 +01:00
|
|
|
ClassDB::bind_method(D_METHOD("_update_triangles"), &AnimationNodeBlendSpace2D::_update_triangles);
|
2018-08-20 18:38:18 +02:00
|
|
|
|
2018-06-22 03:48:47 +02:00
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::BOOL, "auto_triangles", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR), "set_auto_triangles", "get_auto_triangles");
|
|
|
|
|
2018-06-21 20:45:44 +02:00
|
|
|
for (int i = 0; i < MAX_BLEND_POINTS; i++) {
|
2018-08-20 18:38:18 +02:00
|
|
|
ADD_PROPERTYI(PropertyInfo(Variant::OBJECT, "blend_point_" + itos(i) + "/node", PROPERTY_HINT_RESOURCE_TYPE, "AnimationRootNode", PROPERTY_USAGE_NOEDITOR | PROPERTY_USAGE_INTERNAL), "_add_blend_point", "get_blend_point_node", i);
|
2018-06-21 20:45:44 +02:00
|
|
|
ADD_PROPERTYI(PropertyInfo(Variant::VECTOR2, "blend_point_" + itos(i) + "/pos", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR | PROPERTY_USAGE_INTERNAL), "set_blend_point_position", "get_blend_point_position", i);
|
|
|
|
}
|
|
|
|
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::POOL_INT_ARRAY, "triangles", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR | PROPERTY_USAGE_INTERNAL), "_set_triangles", "_get_triangles");
|
|
|
|
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::VECTOR2, "min_space", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR), "set_min_space", "get_min_space");
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::VECTOR2, "max_space", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR), "set_max_space", "get_max_space");
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::VECTOR2, "snap", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR), "set_snap", "get_snap");
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::STRING, "x_label", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR), "set_x_label", "get_x_label");
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::STRING, "y_label", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_NOEDITOR), "set_y_label", "get_y_label");
|
2018-11-21 20:06:17 +01:00
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::INT, "blend_mode", PROPERTY_HINT_ENUM, "Interpolated,Discrete,Carry", PROPERTY_USAGE_NOEDITOR), "set_blend_mode", "get_blend_mode");
|
|
|
|
|
2019-01-11 01:40:46 +01:00
|
|
|
ADD_SIGNAL(MethodInfo("triangles_updated"));
|
2018-11-21 20:06:17 +01:00
|
|
|
BIND_ENUM_CONSTANT(BLEND_MODE_INTERPOLATED);
|
|
|
|
BIND_ENUM_CONSTANT(BLEND_MODE_DISCRETE);
|
|
|
|
BIND_ENUM_CONSTANT(BLEND_MODE_DISCRETE_CARRY);
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
AnimationNodeBlendSpace2D::AnimationNodeBlendSpace2D() {
|
2018-08-21 21:28:06 +02:00
|
|
|
for (int i = 0; i < MAX_BLEND_POINTS; i++) {
|
|
|
|
blend_points[i].name = itos(i);
|
2018-08-20 18:38:18 +02:00
|
|
|
}
|
2018-06-22 03:48:47 +02:00
|
|
|
auto_triangles = true;
|
2018-06-21 20:45:44 +02:00
|
|
|
blend_points_used = 0;
|
|
|
|
max_space = Vector2(1, 1);
|
|
|
|
min_space = Vector2(-1, -1);
|
|
|
|
snap = Vector2(0.1, 0.1);
|
|
|
|
x_label = "x";
|
|
|
|
y_label = "y";
|
2018-06-22 03:48:47 +02:00
|
|
|
trianges_dirty = false;
|
2018-08-20 18:38:18 +02:00
|
|
|
blend_position = "blend_position";
|
2018-11-21 20:06:17 +01:00
|
|
|
closest = "closest";
|
|
|
|
length_internal = "length_internal";
|
|
|
|
blend_mode = BLEND_MODE_INTERPOLATED;
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|
|
|
|
|
2018-06-22 15:17:54 +02:00
|
|
|
AnimationNodeBlendSpace2D::~AnimationNodeBlendSpace2D() {
|
2018-06-21 20:45:44 +02:00
|
|
|
}
|