2014-02-10 02:10:30 +01:00
|
|
|
/*************************************************************************/
|
|
|
|
/* grid_map.cpp */
|
|
|
|
/*************************************************************************/
|
|
|
|
/* This file is part of: */
|
|
|
|
/* GODOT ENGINE */
|
|
|
|
/* http://www.godotengine.org */
|
|
|
|
/*************************************************************************/
|
2017-01-01 22:01:57 +01:00
|
|
|
/* Copyright (c) 2007-2017 Juan Linietsky, Ariel Manzur. */
|
2017-04-08 00:11:42 +02:00
|
|
|
/* Copyright (c) 2014-2017 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. */
|
|
|
|
/*************************************************************************/
|
|
|
|
#include "grid_map.h"
|
|
|
|
#include "message_queue.h"
|
|
|
|
#include "scene/3d/light.h"
|
2017-03-05 16:44:50 +01:00
|
|
|
#include "scene/resources/surface_tool.h"
|
|
|
|
#include "servers/visual_server.h"
|
2017-02-15 12:29:46 +01:00
|
|
|
|
2014-02-10 02:10:30 +01:00
|
|
|
#include "io/marshalls.h"
|
2015-09-20 18:03:46 +02:00
|
|
|
#include "os/os.h"
|
2016-04-20 20:19:05 +02:00
|
|
|
#include "scene/resources/mesh_library.h"
|
2017-03-05 16:44:50 +01:00
|
|
|
#include "scene/scene_string_names.h"
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
bool GridMap::_set(const StringName &p_name, const Variant &p_value) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
String name = p_name;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (name == "theme") {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
set_theme(p_value);
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (name == "cell_size") {
|
2014-02-10 02:10:30 +01:00
|
|
|
set_cell_size(p_value);
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (name == "cell_octant_size") {
|
2014-02-10 02:10:30 +01:00
|
|
|
set_octant_size(p_value);
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (name == "cell_center_x") {
|
2014-02-10 02:10:30 +01:00
|
|
|
set_center_x(p_value);
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (name == "cell_center_y") {
|
2014-02-10 02:10:30 +01:00
|
|
|
set_center_y(p_value);
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (name == "cell_center_z") {
|
2014-02-10 02:10:30 +01:00
|
|
|
set_center_z(p_value);
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (name == "cell_scale") {
|
2014-02-10 02:10:30 +01:00
|
|
|
set_cell_scale(p_value);
|
2017-03-05 16:44:50 +01:00
|
|
|
/* } else if (name=="cells") {
|
2017-01-07 22:25:37 +01:00
|
|
|
PoolVector<int> cells = p_value;
|
2014-02-10 02:10:30 +01:00
|
|
|
int amount=cells.size();
|
2017-01-07 22:25:37 +01:00
|
|
|
PoolVector<int>::Read r = cells.read();
|
2014-02-10 02:10:30 +01:00
|
|
|
ERR_FAIL_COND_V(amount&1,false); // not even
|
2017-01-14 18:03:38 +01:00
|
|
|
cell_map.clear();
|
2014-02-10 02:10:30 +01:00
|
|
|
for(int i=0;i<amount/3;i++) {
|
|
|
|
|
|
|
|
|
|
|
|
IndexKey ik;
|
|
|
|
ik.key=decode_uint64(&r[i*3]);
|
|
|
|
Cell cell;
|
|
|
|
cell.cell=uint32_t(r[i*+1]);
|
|
|
|
cell_map[ik]=cell;
|
|
|
|
|
|
|
|
}
|
|
|
|
_recreate_octant_data();*/
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (name == "data") {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
Dictionary d = p_value;
|
|
|
|
|
|
|
|
if (d.has("cells")) {
|
|
|
|
|
2017-01-07 22:25:37 +01:00
|
|
|
PoolVector<int> cells = d["cells"];
|
2017-03-05 16:44:50 +01:00
|
|
|
int amount = cells.size();
|
2017-01-07 22:25:37 +01:00
|
|
|
PoolVector<int>::Read r = cells.read();
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(amount % 3, false); // not even
|
2017-01-14 18:03:38 +01:00
|
|
|
cell_map.clear();
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < amount / 3; i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
IndexKey ik;
|
2017-03-05 16:44:50 +01:00
|
|
|
ik.key = decode_uint64((const uint8_t *)&r[i * 3]);
|
2014-02-10 02:10:30 +01:00
|
|
|
Cell cell;
|
2017-03-05 16:44:50 +01:00
|
|
|
cell.cell = decode_uint32((const uint8_t *)&r[i * 3 + 2]);
|
|
|
|
cell_map[ik] = cell;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
_recreate_octant_data();
|
|
|
|
|
|
|
|
} else if (name.begins_with("areas/")) {
|
2017-03-05 16:44:50 +01:00
|
|
|
int which = name.get_slicec('/', 1).to_int();
|
|
|
|
String what = name.get_slicec('/', 2);
|
|
|
|
if (what == "bounds") {
|
|
|
|
ERR_FAIL_COND_V(area_map.has(which), false);
|
|
|
|
create_area(which, p_value);
|
2014-02-10 02:10:30 +01:00
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(!area_map.has(which), false);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (what == "name")
|
|
|
|
area_set_name(which, p_value);
|
|
|
|
else if (what == "disable_distance")
|
|
|
|
area_set_portal_disable_distance(which, p_value);
|
|
|
|
else if (what == "exterior_portal")
|
|
|
|
area_set_portal_disable_color(which, p_value);
|
2014-02-10 02:10:30 +01:00
|
|
|
else
|
|
|
|
return false;
|
|
|
|
} else
|
|
|
|
return false;
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
bool GridMap::_get(const StringName &p_name, Variant &r_ret) const {
|
|
|
|
|
|
|
|
String name = p_name;
|
|
|
|
|
|
|
|
if (name == "theme") {
|
|
|
|
r_ret = get_theme();
|
|
|
|
} else if (name == "cell_size") {
|
|
|
|
r_ret = get_cell_size();
|
|
|
|
} else if (name == "cell_octant_size") {
|
|
|
|
r_ret = get_octant_size();
|
|
|
|
} else if (name == "cell_center_x") {
|
|
|
|
r_ret = get_center_x();
|
|
|
|
} else if (name == "cell_center_y") {
|
|
|
|
r_ret = get_center_y();
|
|
|
|
} else if (name == "cell_center_z") {
|
|
|
|
r_ret = get_center_z();
|
|
|
|
} else if (name == "cell_scale") {
|
|
|
|
r_ret = cell_scale;
|
|
|
|
} else if (name == "data") {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
Dictionary d;
|
|
|
|
|
2017-01-07 22:25:37 +01:00
|
|
|
PoolVector<int> cells;
|
2017-03-05 16:44:50 +01:00
|
|
|
cells.resize(cell_map.size() * 3);
|
2014-02-10 02:10:30 +01:00
|
|
|
{
|
2017-01-07 22:25:37 +01:00
|
|
|
PoolVector<int>::Write w = cells.write();
|
2017-03-05 16:44:50 +01:00
|
|
|
int i = 0;
|
|
|
|
for (Map<IndexKey, Cell>::Element *E = cell_map.front(); E; E = E->next(), i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
encode_uint64(E->key().key, (uint8_t *)&w[i * 3]);
|
|
|
|
encode_uint32(E->get().cell, (uint8_t *)&w[i * 3 + 2]);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
d["cells"] = cells;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
r_ret = d;
|
2014-02-10 02:10:30 +01:00
|
|
|
} else if (name.begins_with("areas/")) {
|
2017-03-05 16:44:50 +01:00
|
|
|
int which = name.get_slicec('/', 1).to_int();
|
|
|
|
String what = name.get_slicec('/', 2);
|
|
|
|
if (what == "bounds")
|
|
|
|
r_ret = area_get_bounds(which);
|
|
|
|
else if (what == "name")
|
|
|
|
r_ret = area_get_name(which);
|
|
|
|
else if (what == "disable_distance")
|
|
|
|
r_ret = area_get_portal_disable_distance(which);
|
|
|
|
else if (what == "exterior_portal")
|
|
|
|
r_ret = area_is_exterior_portal(which);
|
2014-02-10 02:10:30 +01:00
|
|
|
else
|
|
|
|
return false;
|
|
|
|
} else
|
|
|
|
return false;
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::_get_property_list(List<PropertyInfo> *p_list) const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
p_list->push_back(PropertyInfo(Variant::OBJECT, "theme", PROPERTY_HINT_RESOURCE_TYPE, "MeshLibrary"));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::NIL, "Cell", PROPERTY_HINT_NONE, "cell_", PROPERTY_USAGE_GROUP));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::REAL, "cell_size", PROPERTY_HINT_RANGE, "0.01,16384,0.01"));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::INT, "cell_octant_size", PROPERTY_HINT_RANGE, "1,1024,1"));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::BOOL, "cell_center_x"));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::BOOL, "cell_center_y"));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::BOOL, "cell_center_z"));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::REAL, "cell_scale"));
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
p_list->push_back(PropertyInfo(Variant::DICTIONARY, "data", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_STORAGE));
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (const Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
String base = "areas/" + itos(E->key()) + "/";
|
|
|
|
p_list->push_back(PropertyInfo(Variant::RECT3, base + "bounds", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_STORAGE));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::STRING, base + "name", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_STORAGE));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::REAL, base + "disable_distance", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_STORAGE));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::COLOR, base + "disable_color", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_STORAGE));
|
|
|
|
p_list->push_back(PropertyInfo(Variant::BOOL, base + "exterior_portal", PROPERTY_HINT_NONE, "", PROPERTY_USAGE_STORAGE));
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::set_theme(const Ref<MeshLibrary> &p_theme) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
if (!theme.is_null())
|
|
|
|
theme->unregister_owner(this);
|
2017-03-05 16:44:50 +01:00
|
|
|
theme = p_theme;
|
2014-02-10 02:10:30 +01:00
|
|
|
if (!theme.is_null())
|
|
|
|
theme->register_owner(this);
|
|
|
|
|
|
|
|
_recreate_octant_data();
|
|
|
|
_change_notify("theme");
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Ref<MeshLibrary> GridMap::get_theme() const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
return theme;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::set_cell_size(float p_size) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
cell_size = p_size;
|
2014-02-10 02:10:30 +01:00
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
float GridMap::get_cell_size() const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
return cell_size;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::set_octant_size(int p_size) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
octant_size = p_size;
|
2014-02-10 02:10:30 +01:00
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
int GridMap::get_octant_size() const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
return octant_size;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::set_center_x(bool p_enable) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
center_x = p_enable;
|
2014-02-10 02:10:30 +01:00
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
|
|
|
|
|
|
|
bool GridMap::get_center_x() const {
|
|
|
|
return center_x;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::set_center_y(bool p_enable) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
center_y = p_enable;
|
2014-02-10 02:10:30 +01:00
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
|
|
|
|
|
|
|
bool GridMap::get_center_y() const {
|
|
|
|
return center_y;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::set_center_z(bool p_enable) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
center_z = p_enable;
|
2014-02-10 02:10:30 +01:00
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
|
|
|
|
|
|
|
bool GridMap::get_center_z() const {
|
|
|
|
return center_z;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
int GridMap::_find_area(const IndexKey &p_pos) const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (const Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
|
|
|
//this should somehow be faster...
|
|
|
|
const Area &a = *E->get();
|
|
|
|
if (p_pos.x >= a.from.x && p_pos.x < a.to.x &&
|
|
|
|
p_pos.y >= a.from.y && p_pos.y < a.to.y &&
|
|
|
|
p_pos.z >= a.from.z && p_pos.z < a.to.z) {
|
2014-02-10 02:10:30 +01:00
|
|
|
return E->key();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::set_cell_item(int p_x, int p_y, int p_z, int p_item, int p_rot) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_INDEX(ABS(p_x), 1 << 20);
|
|
|
|
ERR_FAIL_INDEX(ABS(p_y), 1 << 20);
|
|
|
|
ERR_FAIL_INDEX(ABS(p_z), 1 << 20);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
IndexKey key;
|
2017-03-05 16:44:50 +01:00
|
|
|
key.x = p_x;
|
|
|
|
key.y = p_y;
|
|
|
|
key.z = p_z;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
OctantKey ok;
|
2017-03-05 16:44:50 +01:00
|
|
|
ok.x = p_x / octant_size;
|
|
|
|
ok.y = p_y / octant_size;
|
|
|
|
ok.z = p_z / octant_size;
|
2014-02-10 02:10:30 +01:00
|
|
|
ok.area = _find_area(key);
|
|
|
|
|
|
|
|
if (cell_map.has(key)) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
int prev_item = cell_map[key].item;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
OctantKey octantkey = ok;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
ERR_FAIL_COND(!octant_map.has(octantkey));
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant &g = *octant_map[octantkey];
|
2014-02-10 02:10:30 +01:00
|
|
|
ERR_FAIL_COND(!g.items.has(prev_item));
|
|
|
|
ERR_FAIL_COND(!g.items[prev_item].cells.has(key));
|
|
|
|
|
|
|
|
g.items[prev_item].cells.erase(key);
|
2017-03-05 16:44:50 +01:00
|
|
|
if (g.items[prev_item].cells.size() == 0) {
|
2014-02-10 02:10:30 +01:00
|
|
|
VS::get_singleton()->free(g.items[prev_item].multimesh_instance);
|
|
|
|
g.items.erase(prev_item);
|
|
|
|
}
|
|
|
|
if (g.items.empty()) {
|
|
|
|
|
|
|
|
PhysicsServer::get_singleton()->free(g.static_body);
|
2015-09-20 18:03:46 +02:00
|
|
|
if (g.collision_debug.is_valid()) {
|
|
|
|
PhysicsServer::get_singleton()->free(g.collision_debug);
|
|
|
|
PhysicsServer::get_singleton()->free(g.collision_debug_instance);
|
|
|
|
}
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2016-03-09 00:00:52 +01:00
|
|
|
memdelete(&g);
|
2014-02-10 02:10:30 +01:00
|
|
|
octant_map.erase(octantkey);
|
|
|
|
} else {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
g.dirty = true;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
cell_map.erase(key);
|
|
|
|
|
|
|
|
_queue_dirty_map();
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (p_item < 0)
|
2014-02-10 02:10:30 +01:00
|
|
|
return;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
OctantKey octantkey = ok;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
//add later
|
|
|
|
if (!octant_map.has(octantkey)) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant *g = memnew(Octant);
|
|
|
|
g->dirty = true;
|
2014-02-10 02:10:30 +01:00
|
|
|
g->static_body = PhysicsServer::get_singleton()->body_create(PhysicsServer::BODY_MODE_STATIC);
|
2017-08-07 12:17:31 +02:00
|
|
|
PhysicsServer::get_singleton()->body_attach_object_instance_id(g->static_body, get_instance_id());
|
2014-02-10 02:10:30 +01:00
|
|
|
if (is_inside_world())
|
2017-03-05 16:44:50 +01:00
|
|
|
PhysicsServer::get_singleton()->body_set_space(g->static_body, get_world()->get_space());
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
SceneTree *st = SceneTree::get_singleton();
|
2015-09-20 18:03:46 +02:00
|
|
|
|
|
|
|
if (st && st->is_debugging_collisions_hint()) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
g->collision_debug = VisualServer::get_singleton()->mesh_create();
|
|
|
|
g->collision_debug_instance = VisualServer::get_singleton()->instance_create();
|
|
|
|
VisualServer::get_singleton()->instance_set_base(g->collision_debug_instance, g->collision_debug);
|
2015-09-20 18:03:46 +02:00
|
|
|
if (is_inside_world()) {
|
2017-03-05 16:44:50 +01:00
|
|
|
VisualServer::get_singleton()->instance_set_scenario(g->collision_debug_instance, get_world()->get_scenario());
|
|
|
|
VisualServer::get_singleton()->instance_set_transform(g->collision_debug_instance, get_global_transform());
|
2015-09-20 18:03:46 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
octant_map[octantkey] = g;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant &g = *octant_map[octantkey];
|
2014-02-10 02:10:30 +01:00
|
|
|
if (!g.items.has(p_item)) {
|
|
|
|
|
|
|
|
Octant::ItemInstances ii;
|
|
|
|
if (theme.is_valid() && theme->has_item(p_item)) {
|
2017-03-05 16:44:50 +01:00
|
|
|
ii.mesh = theme->get_item_mesh(p_item);
|
|
|
|
ii.shape = theme->get_item_shape(p_item);
|
|
|
|
ii.navmesh = theme->get_item_navmesh(p_item);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
ii.multimesh = Ref<MultiMesh>(memnew(MultiMesh));
|
2017-02-15 12:29:46 +01:00
|
|
|
ii.multimesh->set_color_format(MultiMesh::COLOR_NONE);
|
|
|
|
ii.multimesh->set_transform_format(MultiMesh::TRANSFORM_3D);
|
2014-02-10 02:10:30 +01:00
|
|
|
ii.multimesh->set_mesh(ii.mesh);
|
|
|
|
ii.multimesh_instance = VS::get_singleton()->instance_create();
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_base(ii.multimesh_instance, ii.multimesh->get_rid());
|
2017-07-16 04:24:37 +02:00
|
|
|
VS::get_singleton()->instance_geometry_set_flag(ii.multimesh_instance, VS::INSTANCE_FLAG_USE_BAKED_LIGHT, true);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
g.items[p_item] = ii;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
Octant::ItemInstances &ii = g.items[p_item];
|
|
|
|
ii.cells.insert(key);
|
2017-03-05 16:44:50 +01:00
|
|
|
g.dirty = true;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
_queue_dirty_map();
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
cell_map[key] = Cell();
|
|
|
|
Cell &c = cell_map[key];
|
|
|
|
c.item = p_item;
|
|
|
|
c.rot = p_rot;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
int GridMap::get_cell_item(int p_x, int p_y, int p_z) const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_INDEX_V(ABS(p_x), 1 << 20, INVALID_CELL_ITEM);
|
|
|
|
ERR_FAIL_INDEX_V(ABS(p_y), 1 << 20, INVALID_CELL_ITEM);
|
|
|
|
ERR_FAIL_INDEX_V(ABS(p_z), 1 << 20, INVALID_CELL_ITEM);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
IndexKey key;
|
2017-03-05 16:44:50 +01:00
|
|
|
key.x = p_x;
|
|
|
|
key.y = p_y;
|
|
|
|
key.z = p_z;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
if (!cell_map.has(key))
|
|
|
|
return INVALID_CELL_ITEM;
|
|
|
|
return cell_map[key].item;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
int GridMap::get_cell_item_orientation(int p_x, int p_y, int p_z) const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_INDEX_V(ABS(p_x), 1 << 20, -1);
|
|
|
|
ERR_FAIL_INDEX_V(ABS(p_y), 1 << 20, -1);
|
|
|
|
ERR_FAIL_INDEX_V(ABS(p_z), 1 << 20, -1);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
IndexKey key;
|
2017-03-05 16:44:50 +01:00
|
|
|
key.x = p_x;
|
|
|
|
key.y = p_y;
|
|
|
|
key.z = p_z;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
if (!cell_map.has(key))
|
|
|
|
return -1;
|
|
|
|
return cell_map[key].rot;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::_octant_enter_tree(const OctantKey &p_key) {
|
2016-04-20 20:19:05 +02:00
|
|
|
ERR_FAIL_COND(!octant_map.has(p_key));
|
2017-03-05 16:44:50 +01:00
|
|
|
if (navigation) {
|
|
|
|
Octant &g = *octant_map[p_key];
|
2016-04-20 20:19:05 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 ofs(cell_size * 0.5 * int(center_x), cell_size * 0.5 * int(center_y), cell_size * 0.5 * int(center_z));
|
2016-04-20 20:19:05 +02:00
|
|
|
_octant_clear_navmesh(p_key);
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Octant::ItemInstances>::Element *E = g.items.front(); E; E = E->next()) {
|
|
|
|
Octant::ItemInstances &ii = E->get();
|
2016-04-20 20:19:05 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Set<IndexKey>::Element *F = ii.cells.front(); F; F = F->next()) {
|
2016-04-20 20:19:05 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
IndexKey ik = F->get();
|
|
|
|
Map<IndexKey, Cell>::Element *C = cell_map.find(ik);
|
2016-04-20 20:19:05 +02:00
|
|
|
ERR_CONTINUE(!C);
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 cellpos = Vector3(ik.x, ik.y, ik.z);
|
2016-04-20 20:19:05 +02:00
|
|
|
|
|
|
|
Transform xform;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (clip && ((clip_above && cellpos[clip_axis] > clip_floor) || (!clip_above && cellpos[clip_axis] < clip_floor))) {
|
2016-04-20 20:19:05 +02:00
|
|
|
|
|
|
|
xform.basis.set_zero();
|
|
|
|
|
|
|
|
} else {
|
|
|
|
|
|
|
|
xform.basis.set_orthogonal_index(C->get().rot);
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
xform.set_origin(cellpos * cell_size + ofs);
|
|
|
|
xform.basis.scale(Vector3(cell_scale, cell_scale, cell_scale));
|
2016-04-20 20:19:05 +02:00
|
|
|
// add the item's navmesh at given xform to GridMap's Navigation ancestor
|
2017-03-05 16:44:50 +01:00
|
|
|
if (ii.navmesh.is_valid()) {
|
|
|
|
int nm_id = navigation->navmesh_create(ii.navmesh, xform, this);
|
2016-04-20 20:19:05 +02:00
|
|
|
Octant::NavMesh nm;
|
2017-03-05 16:44:50 +01:00
|
|
|
nm.id = nm_id;
|
|
|
|
nm.xform = xform;
|
|
|
|
g.navmesh_ids[ik] = nm;
|
2016-04-20 20:19:05 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-02-10 02:10:30 +01:00
|
|
|
void GridMap::_octant_enter_world(const OctantKey &p_key) {
|
|
|
|
|
|
|
|
ERR_FAIL_COND(!octant_map.has(p_key));
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant &g = *octant_map[p_key];
|
|
|
|
PhysicsServer::get_singleton()->body_set_state(g.static_body, PhysicsServer::BODY_STATE_TRANSFORM, get_global_transform());
|
|
|
|
PhysicsServer::get_singleton()->body_set_space(g.static_body, get_world()->get_space());
|
2014-02-10 02:10:30 +01:00
|
|
|
//print_line("BODYPOS: "+get_global_transform());
|
|
|
|
|
2015-09-20 18:03:46 +02:00
|
|
|
if (g.collision_debug_instance.is_valid()) {
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_scenario(g.collision_debug_instance, get_world()->get_scenario());
|
|
|
|
VS::get_singleton()->instance_set_transform(g.collision_debug_instance, get_global_transform());
|
2015-09-20 18:03:46 +02:00
|
|
|
if (area_map.has(p_key.area)) {
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_room(g.collision_debug_instance, area_map[p_key.area]->instance);
|
2015-09-20 18:03:46 +02:00
|
|
|
}
|
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Octant::ItemInstances>::Element *E = g.items.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_scenario(E->get().multimesh_instance, get_world()->get_scenario());
|
|
|
|
VS::get_singleton()->instance_set_transform(E->get().multimesh_instance, get_global_transform());
|
2017-02-15 12:29:46 +01:00
|
|
|
//print_line("INSTANCEPOS: "+get_global_transform());
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
if (area_map.has(p_key.area)) {
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_room(E->get().multimesh_instance, area_map[p_key.area]->instance);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_octant_transform(const OctantKey &p_key) {
|
|
|
|
|
|
|
|
ERR_FAIL_COND(!octant_map.has(p_key));
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant &g = *octant_map[p_key];
|
|
|
|
PhysicsServer::get_singleton()->body_set_state(g.static_body, PhysicsServer::BODY_STATE_TRANSFORM, get_global_transform());
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2015-09-20 18:03:46 +02:00
|
|
|
if (g.collision_debug_instance.is_valid()) {
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_transform(g.collision_debug_instance, get_global_transform());
|
2015-09-20 18:03:46 +02:00
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Octant::ItemInstances>::Element *E = g.items.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_transform(E->get().multimesh_instance, get_global_transform());
|
2017-02-15 12:29:46 +01:00
|
|
|
//print_line("UPDATEPOS: "+get_global_transform());
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::_octant_clear_navmesh(const OctantKey &p_key) {
|
|
|
|
Octant &g = *octant_map[p_key];
|
2016-04-20 20:19:05 +02:00
|
|
|
if (navigation) {
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<IndexKey, Octant::NavMesh>::Element *E = g.navmesh_ids.front(); E; E = E->next()) {
|
2016-04-20 20:19:05 +02:00
|
|
|
Octant::NavMesh *nvm = &E->get();
|
2017-03-05 16:44:50 +01:00
|
|
|
if (nvm && nvm->id) {
|
2016-04-20 20:19:05 +02:00
|
|
|
navigation->navmesh_remove(E->get().id);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
g.navmesh_ids.clear();
|
|
|
|
}
|
|
|
|
}
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
void GridMap::_octant_update(const OctantKey &p_key) {
|
|
|
|
ERR_FAIL_COND(!octant_map.has(p_key));
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant &g = *octant_map[p_key];
|
2014-02-10 02:10:30 +01:00
|
|
|
if (!g.dirty)
|
|
|
|
return;
|
|
|
|
|
|
|
|
Ref<Mesh> mesh;
|
|
|
|
|
2016-04-20 20:19:05 +02:00
|
|
|
_octant_clear_navmesh(p_key);
|
2014-02-10 02:10:30 +01:00
|
|
|
PhysicsServer::get_singleton()->body_clear_shapes(g.static_body);
|
|
|
|
|
2015-09-20 18:03:46 +02:00
|
|
|
if (g.collision_debug.is_valid()) {
|
|
|
|
|
|
|
|
VS::get_singleton()->mesh_clear(g.collision_debug);
|
|
|
|
}
|
|
|
|
|
2017-01-07 22:25:37 +01:00
|
|
|
PoolVector<Vector3> col_debug;
|
2015-09-20 18:03:46 +02:00
|
|
|
|
2016-04-20 20:19:05 +02:00
|
|
|
/*
|
|
|
|
* foreach item in this octant,
|
|
|
|
* set item's multimesh's instance count to number of cells which have this item
|
|
|
|
* and set said multimesh bounding box to one containing all cells which have this item
|
|
|
|
*/
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Octant::ItemInstances>::Element *E = g.items.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant::ItemInstances &ii = E->get();
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2016-04-20 20:19:05 +02:00
|
|
|
ii.multimesh->set_instance_count(ii.cells.size());
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-01-11 04:52:51 +01:00
|
|
|
Rect3 aabb;
|
2017-03-05 16:44:50 +01:00
|
|
|
Rect3 mesh_aabb = ii.mesh.is_null() ? Rect3() : ii.mesh->get_aabb();
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 ofs(cell_size * 0.5 * int(center_x), cell_size * 0.5 * int(center_y), cell_size * 0.5 * int(center_z));
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
//print_line("OCTANT, CELLS: "+itos(ii.cells.size()));
|
2017-03-05 16:44:50 +01:00
|
|
|
int idx = 0;
|
2016-04-20 20:19:05 +02:00
|
|
|
// foreach cell containing this item type
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Set<IndexKey>::Element *F = ii.cells.front(); F; F = F->next()) {
|
|
|
|
IndexKey ik = F->get();
|
|
|
|
Map<IndexKey, Cell>::Element *C = cell_map.find(ik);
|
2014-02-10 02:10:30 +01:00
|
|
|
ERR_CONTINUE(!C);
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 cellpos = Vector3(ik.x, ik.y, ik.z);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
Transform xform;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (clip && ((clip_above && cellpos[clip_axis] > clip_floor) || (!clip_above && cellpos[clip_axis] < clip_floor))) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
xform.basis.set_zero();
|
|
|
|
|
|
|
|
} else {
|
|
|
|
|
|
|
|
xform.basis.set_orthogonal_index(C->get().rot);
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
xform.set_origin(cellpos * cell_size + ofs);
|
|
|
|
xform.basis.scale(Vector3(cell_scale, cell_scale, cell_scale));
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ii.multimesh->set_instance_transform(idx, xform);
|
2015-09-20 18:03:46 +02:00
|
|
|
//ii.multimesh->set_instance_transform(idx,Transform() );
|
2017-02-15 12:29:46 +01:00
|
|
|
//ii.multimesh->set_instance_color(idx,Color(1,1,1,1));
|
2014-02-10 02:10:30 +01:00
|
|
|
//print_line("MMINST: "+xform);
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (idx == 0) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
aabb = xform.xform(mesh_aabb);
|
2014-02-10 02:10:30 +01:00
|
|
|
} else {
|
|
|
|
|
|
|
|
aabb.merge_with(xform.xform(mesh_aabb));
|
|
|
|
}
|
|
|
|
|
2016-04-20 20:19:05 +02:00
|
|
|
// add the item's shape at given xform to octant's static_body
|
2014-02-10 02:10:30 +01:00
|
|
|
if (ii.shape.is_valid()) {
|
2016-04-20 20:19:05 +02:00
|
|
|
// add the item's shape
|
2017-03-05 16:44:50 +01:00
|
|
|
PhysicsServer::get_singleton()->body_add_shape(g.static_body, ii.shape->get_rid(), xform);
|
2015-09-20 18:03:46 +02:00
|
|
|
if (g.collision_debug.is_valid()) {
|
2017-03-05 16:44:50 +01:00
|
|
|
ii.shape->add_vertices_to_array(col_debug, xform);
|
2015-09-20 18:03:46 +02:00
|
|
|
}
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-01-14 12:26:56 +01:00
|
|
|
//print_line("PHIS x: "+xform);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
2016-04-20 20:19:05 +02:00
|
|
|
// add the item's navmesh at given xform to GridMap's Navigation ancestor
|
2017-03-05 16:44:50 +01:00
|
|
|
if (navigation) {
|
|
|
|
if (ii.navmesh.is_valid()) {
|
|
|
|
int nm_id = navigation->navmesh_create(ii.navmesh, xform, this);
|
2016-04-20 20:19:05 +02:00
|
|
|
Octant::NavMesh nm;
|
2017-03-05 16:44:50 +01:00
|
|
|
nm.id = nm_id;
|
|
|
|
nm.xform = xform;
|
|
|
|
g.navmesh_ids[ik] = nm;
|
2016-04-20 20:19:05 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-02-10 02:10:30 +01:00
|
|
|
idx++;
|
|
|
|
}
|
|
|
|
|
2017-02-15 12:29:46 +01:00
|
|
|
//ii.multimesh->set_aabb(aabb);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
2015-09-20 18:03:46 +02:00
|
|
|
if (col_debug.size()) {
|
|
|
|
|
|
|
|
Array arr;
|
|
|
|
arr.resize(VS::ARRAY_MAX);
|
2017-03-05 16:44:50 +01:00
|
|
|
arr[VS::ARRAY_VERTEX] = col_debug;
|
2015-09-20 18:03:46 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->mesh_add_surface_from_arrays(g.collision_debug, VS::PRIMITIVE_LINES, arr);
|
|
|
|
SceneTree *st = SceneTree::get_singleton();
|
2015-09-20 18:03:46 +02:00
|
|
|
if (st) {
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->mesh_surface_set_material(g.collision_debug, 0, st->get_debug_collision_material()->get_rid());
|
2015-09-20 18:03:46 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
g.dirty = false;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_octant_exit_world(const OctantKey &p_key) {
|
|
|
|
|
|
|
|
ERR_FAIL_COND(!octant_map.has(p_key));
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant &g = *octant_map[p_key];
|
|
|
|
PhysicsServer::get_singleton()->body_set_state(g.static_body, PhysicsServer::BODY_STATE_TRANSFORM, get_global_transform());
|
|
|
|
PhysicsServer::get_singleton()->body_set_space(g.static_body, RID());
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2015-09-20 18:03:46 +02:00
|
|
|
if (g.collision_debug_instance.is_valid()) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_room(g.collision_debug_instance, RID());
|
|
|
|
VS::get_singleton()->instance_set_scenario(g.collision_debug_instance, RID());
|
2015-09-20 18:03:46 +02:00
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Octant::ItemInstances>::Element *E = g.items.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_scenario(E->get().multimesh_instance, RID());
|
2017-01-14 12:26:56 +01:00
|
|
|
//VS::get_singleton()->instance_set_transform(E->get().multimesh_instance,get_global_transform());
|
2017-03-05 16:44:50 +01:00
|
|
|
VS::get_singleton()->instance_set_room(E->get().multimesh_instance, RID());
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_notification(int p_what) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
switch (p_what) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
case NOTIFICATION_ENTER_WORLD: {
|
|
|
|
|
|
|
|
_update_area_instances();
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2017-01-14 12:26:56 +01:00
|
|
|
//IndexKey ik;
|
|
|
|
//ik.key = E->key().indexkey;
|
2014-02-10 02:10:30 +01:00
|
|
|
_octant_enter_world(E->key());
|
|
|
|
_octant_update(E->key());
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
awaiting_update = false;
|
2014-06-11 15:41:03 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
last_transform = get_global_transform();
|
2014-06-11 15:41:03 +02:00
|
|
|
|
2014-02-10 02:10:30 +01:00
|
|
|
} break;
|
|
|
|
case NOTIFICATION_TRANSFORM_CHANGED: {
|
|
|
|
|
|
|
|
Transform new_xform = get_global_transform();
|
2017-03-05 16:44:50 +01:00
|
|
|
if (new_xform == last_transform)
|
2014-02-10 02:10:30 +01:00
|
|
|
break;
|
|
|
|
//update run
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
_octant_transform(E->key());
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
last_transform = new_xform;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
} break;
|
|
|
|
case NOTIFICATION_EXIT_WORLD: {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
_octant_exit_world(E->key());
|
|
|
|
}
|
|
|
|
|
|
|
|
//_queue_dirty_map(MAP_DIRTY_INSTANCES|MAP_DIRTY_TRANSFORMS);
|
|
|
|
//_update_dirty_map_callback();
|
|
|
|
//_update_area_instances();
|
|
|
|
|
|
|
|
} break;
|
2016-04-20 20:19:05 +02:00
|
|
|
case NOTIFICATION_ENTER_TREE: {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Spatial *c = this;
|
|
|
|
while (c) {
|
|
|
|
navigation = c->cast_to<Navigation>();
|
2016-04-20 20:19:05 +02:00
|
|
|
if (navigation) {
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
c = c->get_parent()->cast_to<Spatial>();
|
2016-04-20 20:19:05 +02:00
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (navigation) {
|
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2016-04-20 20:19:05 +02:00
|
|
|
if (navigation) {
|
|
|
|
_octant_enter_tree(E->key());
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
_queue_dirty_map();
|
2016-04-20 20:19:05 +02:00
|
|
|
} break;
|
|
|
|
case NOTIFICATION_EXIT_TREE: {
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2016-04-20 20:19:05 +02:00
|
|
|
if (navigation) {
|
|
|
|
_octant_clear_navmesh(E->key());
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
navigation = NULL;
|
2016-04-20 20:19:05 +02:00
|
|
|
|
|
|
|
} break;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_queue_dirty_map() {
|
|
|
|
|
|
|
|
if (awaiting_update)
|
2016-03-09 00:00:52 +01:00
|
|
|
return;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
if (is_inside_world()) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
MessageQueue::get_singleton()->push_call(this, "_update_dirty_map_callback");
|
|
|
|
awaiting_update = true;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_recreate_octant_data() {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Map<IndexKey, Cell> cell_copy = cell_map;
|
2014-02-10 02:10:30 +01:00
|
|
|
_clear_internal(true);
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<IndexKey, Cell>::Element *E = cell_copy.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
set_cell_item(E->key().x, E->key().y, E->key().z, E->get().item, E->get().rot);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_clear_internal(bool p_keep_areas) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
if (is_inside_world())
|
|
|
|
_octant_exit_world(E->key());
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Octant::ItemInstances>::Element *F = E->get()->items.front(); F; F = F->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
VS::get_singleton()->free(F->get().multimesh_instance);
|
|
|
|
}
|
|
|
|
|
2015-09-20 18:03:46 +02:00
|
|
|
if (E->get()->collision_debug.is_valid())
|
|
|
|
VS::get_singleton()->free(E->get()->collision_debug);
|
|
|
|
if (E->get()->collision_debug_instance.is_valid())
|
|
|
|
VS::get_singleton()->free(E->get()->collision_debug_instance);
|
|
|
|
|
2014-02-10 02:10:30 +01:00
|
|
|
PhysicsServer::get_singleton()->free(E->get()->static_body);
|
|
|
|
memdelete(E->get());
|
|
|
|
}
|
|
|
|
|
|
|
|
octant_map.clear();
|
|
|
|
cell_map.clear();
|
|
|
|
|
|
|
|
if (p_keep_areas)
|
|
|
|
return;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
VS::get_singleton()->free(E->get()->base_portal);
|
|
|
|
VS::get_singleton()->free(E->get()->instance);
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < E->get()->portals.size(); i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
VS::get_singleton()->free(E->get()->portals[i].instance);
|
|
|
|
}
|
|
|
|
|
|
|
|
memdelete(E->get());
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::clear() {
|
|
|
|
|
|
|
|
_clear_internal();
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::resource_changed(const RES &p_res) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_update_dirty_map_callback() {
|
|
|
|
|
|
|
|
if (!awaiting_update)
|
|
|
|
return;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
_octant_update(E->key());
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
awaiting_update = false;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_bind_methods() {
|
|
|
|
|
2017-08-09 13:19:41 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("set_theme", "theme"), &GridMap::set_theme);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_theme"), &GridMap::get_theme);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ClassDB::bind_method(D_METHOD("set_cell_size", "size"), &GridMap::set_cell_size);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_cell_size"), &GridMap::get_cell_size);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ClassDB::bind_method(D_METHOD("set_octant_size", "size"), &GridMap::set_octant_size);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_octant_size"), &GridMap::get_octant_size);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ClassDB::bind_method(D_METHOD("set_cell_item", "x", "y", "z", "item", "orientation"), &GridMap::set_cell_item, DEFVAL(0));
|
|
|
|
ClassDB::bind_method(D_METHOD("get_cell_item", "x", "y", "z"), &GridMap::get_cell_item);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_cell_item_orientation", "x", "y", "z"), &GridMap::get_cell_item_orientation);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-02-13 12:47:24 +01:00
|
|
|
//ClassDB::bind_method(D_METHOD("_recreate_octants"),&GridMap::_recreate_octants);
|
2017-03-05 16:44:50 +01:00
|
|
|
ClassDB::bind_method(D_METHOD("_update_dirty_map_callback"), &GridMap::_update_dirty_map_callback);
|
|
|
|
ClassDB::bind_method(D_METHOD("resource_changed", "resource"), &GridMap::resource_changed);
|
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("set_center_x", "enable"), &GridMap::set_center_x);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_center_x"), &GridMap::get_center_x);
|
|
|
|
ClassDB::bind_method(D_METHOD("set_center_y", "enable"), &GridMap::set_center_y);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_center_y"), &GridMap::get_center_y);
|
|
|
|
ClassDB::bind_method(D_METHOD("set_center_z", "enable"), &GridMap::set_center_z);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_center_z"), &GridMap::get_center_z);
|
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("set_clip", "enabled", "clipabove", "floor", "axis"), &GridMap::set_clip, DEFVAL(true), DEFVAL(0), DEFVAL(Vector3::AXIS_X));
|
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("create_area", "id", "area"), &GridMap::create_area);
|
2017-08-09 13:54:55 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("area_get_bounds", "area"), &GridMap::area_get_bounds);
|
2017-03-05 16:44:50 +01:00
|
|
|
ClassDB::bind_method(D_METHOD("area_set_exterior_portal", "area", "enable"), &GridMap::area_set_exterior_portal);
|
|
|
|
ClassDB::bind_method(D_METHOD("area_set_name", "area", "name"), &GridMap::area_set_name);
|
|
|
|
ClassDB::bind_method(D_METHOD("area_get_name", "area"), &GridMap::area_get_name);
|
|
|
|
ClassDB::bind_method(D_METHOD("area_is_exterior_portal", "area"), &GridMap::area_is_exterior_portal);
|
|
|
|
ClassDB::bind_method(D_METHOD("area_set_portal_disable_distance", "area", "distance"), &GridMap::area_set_portal_disable_distance);
|
|
|
|
ClassDB::bind_method(D_METHOD("area_get_portal_disable_distance", "area"), &GridMap::area_get_portal_disable_distance);
|
|
|
|
ClassDB::bind_method(D_METHOD("area_set_portal_disable_color", "area", "color"), &GridMap::area_set_portal_disable_color);
|
|
|
|
ClassDB::bind_method(D_METHOD("area_get_portal_disable_color", "area"), &GridMap::area_get_portal_disable_color);
|
|
|
|
ClassDB::bind_method(D_METHOD("erase_area", "area"), &GridMap::erase_area);
|
2017-08-09 13:54:55 +02:00
|
|
|
ClassDB::bind_method(D_METHOD("get_unused_area_id"), &GridMap::get_unused_area_id);
|
2017-03-05 16:44:50 +01:00
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("clear"), &GridMap::clear);
|
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("get_meshes"), &GridMap::get_meshes);
|
|
|
|
|
|
|
|
BIND_CONSTANT(INVALID_CELL_ITEM);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::set_clip(bool p_enabled, bool p_clip_above, int p_floor, Vector3::Axis p_axis) {
|
|
|
|
|
|
|
|
if (!p_enabled && !clip)
|
|
|
|
return;
|
2017-03-05 16:44:50 +01:00
|
|
|
if (clip && p_enabled && clip_floor == p_floor && p_clip_above == clip_above && p_axis == clip_axis)
|
2014-02-10 02:10:30 +01:00
|
|
|
return;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
clip = p_enabled;
|
|
|
|
clip_floor = p_floor;
|
|
|
|
clip_axis = p_axis;
|
|
|
|
clip_above = p_clip_above;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
//make it all update
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<OctantKey, Octant *>::Element *E = octant_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Octant *g = E->get();
|
|
|
|
g->dirty = true;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
awaiting_update = true;
|
2014-02-10 02:10:30 +01:00
|
|
|
_update_dirty_map_callback();
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_update_areas() {
|
|
|
|
|
|
|
|
//clear the portals
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
//this should somehow be faster...
|
2017-03-05 16:44:50 +01:00
|
|
|
Area &a = *E->get();
|
2014-02-10 02:10:30 +01:00
|
|
|
a.portals.clear();
|
|
|
|
if (a.instance.is_valid()) {
|
|
|
|
VisualServer::get_singleton()->free(a.instance);
|
2017-03-05 16:44:50 +01:00
|
|
|
a.instance = RID();
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
//test all areas against all areas and create portals - this sucks (slow :( )
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
|
|
|
Area &a = *E->get();
|
2014-02-10 02:10:30 +01:00
|
|
|
if (a.exterior_portal) //that's pretty much all it does... yes it is
|
|
|
|
continue;
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 from_a(a.from.x, a.from.y, a.from.z);
|
|
|
|
Vector3 to_a(a.to.x, a.to.y, a.to.z);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Area *>::Element *F = area_map.front(); F; F = F->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Area &b = *F->get();
|
|
|
|
Vector3 from_b(b.from.x, b.from.y, b.from.z);
|
|
|
|
Vector3 to_b(b.to.x, b.to.y, b.to.z);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
// initially test intersection and discards
|
2017-03-05 16:44:50 +01:00
|
|
|
int axis = -1;
|
|
|
|
float sign = 0;
|
|
|
|
bool valid = true;
|
|
|
|
Vector3 axmin, axmax;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < 3; i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (from_a[i] == to_b[i]) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (axis != -1) {
|
|
|
|
valid = false;
|
2014-02-10 02:10:30 +01:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
axis = i;
|
|
|
|
sign = -1;
|
|
|
|
} else if (from_b[i] == to_a[i]) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (axis != -1) {
|
|
|
|
valid = false;
|
2014-02-10 02:10:30 +01:00
|
|
|
break;
|
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
axis = i;
|
|
|
|
sign = +1;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (from_a[i] > to_b[i] || to_a[i] < from_b[i]) {
|
|
|
|
valid = false;
|
2014-02-10 02:10:30 +01:00
|
|
|
break;
|
|
|
|
} else {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
axmin[i] = (from_a[i] > from_b[i]) ? from_a[i] : from_b[i];
|
|
|
|
axmax[i] = (to_a[i] < to_b[i]) ? to_a[i] : to_b[i];
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (axis == -1 || !valid)
|
2014-02-10 02:10:30 +01:00
|
|
|
continue;
|
|
|
|
|
|
|
|
Transform xf;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < 3; i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
int ax = (axis + i) % 3;
|
2014-02-10 02:10:30 +01:00
|
|
|
Vector3 axis_vec;
|
2017-03-05 16:44:50 +01:00
|
|
|
float scale = (i == 0) ? sign : ((axmax[ax] - axmin[ax]) * cell_size);
|
|
|
|
axis_vec[ax] = scale;
|
|
|
|
xf.basis.set_axis((2 + i) % 3, axis_vec);
|
|
|
|
xf.origin[i] = axmin[i] * cell_size;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
Area::Portal portal;
|
2017-03-05 16:44:50 +01:00
|
|
|
portal.xform = xf;
|
2014-02-10 02:10:30 +01:00
|
|
|
a.portals.push_back(portal);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
_update_area_instances();
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::_update_area_instances() {
|
|
|
|
|
|
|
|
Transform base_xform;
|
|
|
|
if (_in_tree)
|
2017-03-05 16:44:50 +01:00
|
|
|
base_xform = get_global_transform();
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
//this should somehow be faster...
|
2017-03-05 16:44:50 +01:00
|
|
|
Area &a = *E->get();
|
|
|
|
if (a.instance.is_valid() != _in_tree) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
if (!_in_tree) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < a.portals.size(); i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Area::Portal &p = a.portals[i];
|
2014-02-10 02:10:30 +01:00
|
|
|
ERR_CONTINUE(!p.instance.is_valid());
|
|
|
|
VisualServer::get_singleton()->free(p.instance);
|
2017-03-05 16:44:50 +01:00
|
|
|
p.instance = RID();
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
VisualServer::get_singleton()->free(a.instance);
|
2017-03-05 16:44:50 +01:00
|
|
|
a.instance = RID();
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
} else {
|
|
|
|
|
|
|
|
//a.instance = VisualServer::get_singleton()->instance_create2(base_room,get_world()->get_scenario());
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < a.portals.size(); i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Area::Portal &p = a.portals[i];
|
2014-02-10 02:10:30 +01:00
|
|
|
ERR_CONTINUE(p.instance.is_valid());
|
2017-03-05 16:44:50 +01:00
|
|
|
p.instance = VisualServer::get_singleton()->instance_create2(a.base_portal, get_world()->get_scenario());
|
|
|
|
VisualServer::get_singleton()->instance_set_room(p.instance, a.instance);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (a.instance.is_valid()) {
|
|
|
|
Transform xform;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 from_a(a.from.x, a.from.y, a.from.z);
|
|
|
|
Vector3 to_a(a.to.x, a.to.y, a.to.z);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < 3; i++) {
|
|
|
|
xform.origin[i] = from_a[i] * cell_size;
|
2014-02-10 02:10:30 +01:00
|
|
|
Vector3 s;
|
2017-03-05 16:44:50 +01:00
|
|
|
s[i] = (to_a[i] - from_a[i]) * cell_size;
|
|
|
|
xform.basis.set_axis(i, s);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
VisualServer::get_singleton()->instance_set_transform(a.instance, base_xform * xform);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (int i = 0; i < a.portals.size(); i++) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Area::Portal &p = a.portals[i];
|
2014-02-10 02:10:30 +01:00
|
|
|
ERR_CONTINUE(!p.instance.is_valid());
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
VisualServer::get_singleton()->instance_set_transform(p.instance, base_xform * xform);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-12 18:52:50 +02:00
|
|
|
Error GridMap::create_area(int p_id, const Rect3 &p_area) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(area_map.has(p_id), ERR_ALREADY_EXISTS);
|
2014-02-10 02:10:30 +01:00
|
|
|
ERR_EXPLAIN("ID 0 is taken as global area, start from 1");
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(p_id == 0, ERR_INVALID_PARAMETER);
|
2017-08-12 18:52:50 +02:00
|
|
|
ERR_FAIL_COND_V(p_area.has_no_area(), ERR_INVALID_PARAMETER);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
// FIRST VALIDATE AREA
|
2017-03-05 16:44:50 +01:00
|
|
|
IndexKey from, to;
|
2017-08-12 18:52:50 +02:00
|
|
|
from.x = p_area.position.x;
|
|
|
|
from.y = p_area.position.y;
|
|
|
|
from.z = p_area.position.z;
|
|
|
|
to.x = p_area.position.x + p_area.size.x;
|
|
|
|
to.y = p_area.position.y + p_area.size.y;
|
|
|
|
to.z = p_area.position.z + p_area.size.z;
|
2017-03-05 16:44:50 +01:00
|
|
|
|
|
|
|
for (Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
//this should somehow be faster...
|
2017-03-05 16:44:50 +01:00
|
|
|
Area &a = *E->get();
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
//does it interset with anything else?
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (from.x >= a.to.x ||
|
|
|
|
to.x <= a.from.x ||
|
|
|
|
from.y >= a.to.y ||
|
|
|
|
to.y <= a.from.y ||
|
|
|
|
from.z >= a.to.z ||
|
|
|
|
to.z <= a.from.z) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
// all good
|
|
|
|
} else {
|
|
|
|
|
|
|
|
return ERR_INVALID_PARAMETER;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Area *area = memnew(Area);
|
|
|
|
area->from = from;
|
|
|
|
area->to = to;
|
|
|
|
area->portal_disable_distance = 0;
|
|
|
|
area->exterior_portal = false;
|
|
|
|
area->name = "Area " + itos(p_id);
|
|
|
|
area_map[p_id] = area;
|
2014-02-10 02:10:30 +01:00
|
|
|
_recreate_octant_data();
|
|
|
|
return OK;
|
|
|
|
}
|
|
|
|
|
2017-01-11 04:52:51 +01:00
|
|
|
Rect3 GridMap::area_get_bounds(int p_area) const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(!area_map.has(p_area), Rect3());
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
const Area *a = area_map[p_area];
|
2017-01-11 04:52:51 +01:00
|
|
|
Rect3 aabb;
|
2017-06-06 20:33:51 +02:00
|
|
|
aabb.position = Vector3(a->from.x, a->from.y, a->from.z);
|
|
|
|
aabb.size = Vector3(a->to.x, a->to.y, a->to.z) - aabb.position;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
return aabb;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::area_set_name(int p_area, const String &p_name) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
ERR_FAIL_COND(!area_map.has(p_area));
|
|
|
|
|
|
|
|
Area *a = area_map[p_area];
|
2017-03-05 16:44:50 +01:00
|
|
|
a->name = p_name;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
String GridMap::area_get_name(int p_area) const {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(!area_map.has(p_area), "");
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
const Area *a = area_map[p_area];
|
|
|
|
return a->name;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void GridMap::area_set_exterior_portal(int p_area, bool p_enable) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
ERR_FAIL_COND(!area_map.has(p_area));
|
|
|
|
|
|
|
|
Area *a = area_map[p_area];
|
2017-03-05 16:44:50 +01:00
|
|
|
if (a->exterior_portal == p_enable)
|
2014-02-10 02:10:30 +01:00
|
|
|
return;
|
2017-03-05 16:44:50 +01:00
|
|
|
a->exterior_portal = p_enable;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
|
|
|
|
|
|
|
bool GridMap::area_is_exterior_portal(int p_area) const {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(!area_map.has(p_area), false);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
const Area *a = area_map[p_area];
|
|
|
|
return a->exterior_portal;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::area_set_portal_disable_distance(int p_area, float p_distance) {
|
|
|
|
|
|
|
|
ERR_FAIL_COND(!area_map.has(p_area));
|
|
|
|
|
|
|
|
Area *a = area_map[p_area];
|
2017-03-05 16:44:50 +01:00
|
|
|
a->portal_disable_distance = p_distance;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
float GridMap::area_get_portal_disable_distance(int p_area) const {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(!area_map.has(p_area), 0);
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
const Area *a = area_map[p_area];
|
|
|
|
return a->portal_disable_distance;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::area_set_portal_disable_color(int p_area, Color p_color) {
|
|
|
|
|
|
|
|
ERR_FAIL_COND(!area_map.has(p_area));
|
|
|
|
|
|
|
|
Area *a = area_map[p_area];
|
2017-03-05 16:44:50 +01:00
|
|
|
a->portal_disable_color = p_color;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
Color GridMap::area_get_portal_disable_color(int p_area) const {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(!area_map.has(p_area), Color());
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
const Area *a = area_map[p_area];
|
|
|
|
return a->portal_disable_color;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::get_area_list(List<int> *p_areas) const {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (const Map<int, Area *>::Element *E = area_map.front(); E; E = E->next()) {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
p_areas->push_back(E->key());
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
GridMap::Area::Portal::~Portal() {
|
|
|
|
|
|
|
|
if (instance.is_valid())
|
|
|
|
VisualServer::get_singleton()->free(instance);
|
|
|
|
}
|
|
|
|
|
|
|
|
GridMap::Area::Area() {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
base_portal = VisualServer::get_singleton()->portal_create();
|
|
|
|
Vector<Point2> points;
|
|
|
|
points.push_back(Point2(0, 1));
|
|
|
|
points.push_back(Point2(1, 1));
|
|
|
|
points.push_back(Point2(1, 0));
|
|
|
|
points.push_back(Point2(0, 0));
|
|
|
|
VisualServer::get_singleton()->portal_set_shape(base_portal, points);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
GridMap::Area::~Area() {
|
|
|
|
|
|
|
|
if (instance.is_valid())
|
|
|
|
VisualServer::get_singleton()->free(instance);
|
|
|
|
VisualServer::get_singleton()->free(base_portal);
|
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::erase_area(int p_area) {
|
|
|
|
|
|
|
|
ERR_FAIL_COND(!area_map.has(p_area));
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Area *a = area_map[p_area];
|
2014-02-10 02:10:30 +01:00
|
|
|
memdelete(a);
|
|
|
|
area_map.erase(p_area);
|
|
|
|
_recreate_octant_data();
|
|
|
|
}
|
|
|
|
|
|
|
|
int GridMap::get_unused_area_id() const {
|
|
|
|
|
|
|
|
if (area_map.empty())
|
|
|
|
return 1;
|
|
|
|
else
|
2017-03-05 16:44:50 +01:00
|
|
|
return area_map.back()->key() + 1;
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
void GridMap::set_cell_scale(float p_scale) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
cell_scale = p_scale;
|
2014-02-10 02:10:30 +01:00
|
|
|
_queue_dirty_map();
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
float GridMap::get_cell_scale() const {
|
2014-02-10 02:10:30 +01:00
|
|
|
|
|
|
|
return cell_scale;
|
|
|
|
}
|
|
|
|
|
2017-02-15 12:29:46 +01:00
|
|
|
Array GridMap::get_meshes() {
|
2014-06-11 15:41:03 +02:00
|
|
|
|
|
|
|
if (theme.is_null())
|
|
|
|
return Array();
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 ofs(cell_size * 0.5 * int(center_x), cell_size * 0.5 * int(center_y), cell_size * 0.5 * int(center_z));
|
2014-06-11 15:41:03 +02:00
|
|
|
Array meshes;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
for (Map<IndexKey, Cell>::Element *E = cell_map.front(); E; E = E->next()) {
|
2014-06-11 15:41:03 +02:00
|
|
|
|
|
|
|
int id = E->get().item;
|
|
|
|
if (!theme->has_item(id))
|
|
|
|
continue;
|
2017-03-05 16:44:50 +01:00
|
|
|
Ref<Mesh> mesh = theme->get_item_mesh(id);
|
2014-06-11 15:41:03 +02:00
|
|
|
if (mesh.is_null())
|
|
|
|
continue;
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
IndexKey ik = E->key();
|
2014-06-11 15:41:03 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Vector3 cellpos = Vector3(ik.x, ik.y, ik.z);
|
2014-06-11 15:41:03 +02:00
|
|
|
|
|
|
|
Transform xform;
|
|
|
|
|
|
|
|
xform.basis.set_orthogonal_index(E->get().rot);
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
xform.set_origin(cellpos * cell_size + ofs);
|
|
|
|
xform.basis.scale(Vector3(cell_scale, cell_scale, cell_scale));
|
2014-06-11 15:41:03 +02:00
|
|
|
|
|
|
|
meshes.push_back(xform);
|
|
|
|
meshes.push_back(mesh);
|
|
|
|
}
|
|
|
|
|
|
|
|
return meshes;
|
|
|
|
}
|
|
|
|
|
2014-02-10 02:10:30 +01:00
|
|
|
GridMap::GridMap() {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
cell_size = 2;
|
|
|
|
octant_size = 4;
|
|
|
|
awaiting_update = false;
|
|
|
|
_in_tree = false;
|
|
|
|
center_x = true;
|
|
|
|
center_y = true;
|
|
|
|
center_z = true;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
clip = false;
|
|
|
|
clip_floor = 0;
|
|
|
|
clip_axis = Vector3::AXIS_Z;
|
|
|
|
clip_above = true;
|
|
|
|
cell_scale = 1.0;
|
2014-02-10 02:10:30 +01:00
|
|
|
|
2016-06-10 12:47:38 +02:00
|
|
|
navigation = NULL;
|
2017-01-13 00:35:46 +01:00
|
|
|
set_notify_transform(true);
|
2014-02-10 02:10:30 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
GridMap::~GridMap() {
|
|
|
|
|
|
|
|
if (!theme.is_null())
|
|
|
|
theme->unregister_owner(this);
|
|
|
|
|
|
|
|
clear();
|
|
|
|
}
|