| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | /**************************************************************************/ | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | /*  nav_link_3d.cpp                                                       */ | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | /**************************************************************************/ | 
					
						
							|  |  |  | /*                         This file is part of:                          */ | 
					
						
							|  |  |  | /*                             GODOT ENGINE                               */ | 
					
						
							|  |  |  | /*                        https://godotengine.org                         */ | 
					
						
							|  |  |  | /**************************************************************************/ | 
					
						
							|  |  |  | /* Copyright (c) 2014-present Godot Engine contributors (see AUTHORS.md). */ | 
					
						
							|  |  |  | /* Copyright (c) 2007-2014 Juan Linietsky, Ariel Manzur.                  */ | 
					
						
							|  |  |  | /*                                                                        */ | 
					
						
							|  |  |  | /* Permission is hereby granted, free of charge, to any person obtaining  */ | 
					
						
							|  |  |  | /* a copy of this software and associated documentation files (the        */ | 
					
						
							|  |  |  | /* "Software"), to deal in the Software without restriction, including    */ | 
					
						
							|  |  |  | /* without limitation the rights to use, copy, modify, merge, publish,    */ | 
					
						
							|  |  |  | /* distribute, sublicense, and/or sell copies of the Software, and to     */ | 
					
						
							|  |  |  | /* permit persons to whom the Software is furnished to do so, subject to  */ | 
					
						
							|  |  |  | /* the following conditions:                                              */ | 
					
						
							|  |  |  | /*                                                                        */ | 
					
						
							|  |  |  | /* The above copyright notice and this permission notice shall be         */ | 
					
						
							|  |  |  | /* included in all copies or substantial portions of the Software.        */ | 
					
						
							|  |  |  | /*                                                                        */ | 
					
						
							|  |  |  | /* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,        */ | 
					
						
							|  |  |  | /* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF     */ | 
					
						
							|  |  |  | /* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. */ | 
					
						
							|  |  |  | /* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY   */ | 
					
						
							|  |  |  | /* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,   */ | 
					
						
							|  |  |  | /* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE      */ | 
					
						
							|  |  |  | /* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.                 */ | 
					
						
							|  |  |  | /**************************************************************************/ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | #include "nav_link_3d.h"
 | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | #include "nav_map_3d.h"
 | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_map(NavMap3D *p_map) { | 
					
						
							| 
									
										
										
										
											2023-04-05 02:15:25 +02:00
										 |  |  | 	if (map == p_map) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2023-06-25 05:28:21 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 	cancel_sync_request(); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-06-25 05:28:21 +02:00
										 |  |  | 	if (map) { | 
					
						
							|  |  |  | 		map->remove_link(this); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 	map = p_map; | 
					
						
							|  |  |  | 	link_dirty = true; | 
					
						
							| 
									
										
										
										
											2023-06-25 05:28:21 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (map) { | 
					
						
							|  |  |  | 		map->add_link(this); | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 		request_sync(); | 
					
						
							| 
									
										
										
										
											2023-06-25 05:28:21 +02:00
										 |  |  | 	} | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_enabled(bool p_enabled) { | 
					
						
							| 
									
										
										
										
											2023-07-06 23:01:19 +02:00
										 |  |  | 	if (enabled == p_enabled) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	enabled = p_enabled; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	// TODO: This should not require a full rebuild as the link has not really changed.
 | 
					
						
							|  |  |  | 	link_dirty = true; | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							| 
									
										
										
										
											2023-07-06 23:01:19 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_bidirectional(bool p_bidirectional) { | 
					
						
							| 
									
										
										
										
											2023-04-05 02:15:25 +02:00
										 |  |  | 	if (bidirectional == p_bidirectional) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 	bidirectional = p_bidirectional; | 
					
						
							|  |  |  | 	link_dirty = true; | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_start_position(const Vector3 p_position) { | 
					
						
							| 
									
										
										
										
											2023-04-05 02:15:25 +02:00
										 |  |  | 	if (start_position == p_position) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2022-12-06 23:32:11 +01:00
										 |  |  | 	start_position = p_position; | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 	link_dirty = true; | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_end_position(const Vector3 p_position) { | 
					
						
							| 
									
										
										
										
											2023-04-05 02:15:25 +02:00
										 |  |  | 	if (end_position == p_position) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2022-12-06 23:32:11 +01:00
										 |  |  | 	end_position = p_position; | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 	link_dirty = true; | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_navigation_layers(uint32_t p_navigation_layers) { | 
					
						
							| 
									
										
										
										
											2025-02-12 10:03:26 +01:00
										 |  |  | 	if (navigation_layers == p_navigation_layers) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	navigation_layers = p_navigation_layers; | 
					
						
							|  |  |  | 	link_dirty = true; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_enter_cost(real_t p_enter_cost) { | 
					
						
							| 
									
										
										
										
											2025-02-12 10:03:26 +01:00
										 |  |  | 	real_t new_enter_cost = MAX(p_enter_cost, 0.0); | 
					
						
							|  |  |  | 	if (enter_cost == new_enter_cost) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	enter_cost = new_enter_cost; | 
					
						
							|  |  |  | 	link_dirty = true; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_travel_cost(real_t p_travel_cost) { | 
					
						
							| 
									
										
										
										
											2025-02-12 10:03:26 +01:00
										 |  |  | 	real_t new_travel_cost = MAX(p_travel_cost, 0.0); | 
					
						
							|  |  |  | 	if (travel_cost == new_travel_cost) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	travel_cost = new_travel_cost; | 
					
						
							|  |  |  | 	link_dirty = true; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::set_owner_id(ObjectID p_owner_id) { | 
					
						
							| 
									
										
										
										
											2025-02-12 10:03:26 +01:00
										 |  |  | 	if (owner_id == p_owner_id) { | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	owner_id = p_owner_id; | 
					
						
							|  |  |  | 	link_dirty = true; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	request_sync(); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | bool NavLink3D::is_dirty() const { | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 	return link_dirty; | 
					
						
							|  |  |  | } | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::sync() { | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | 	link_dirty = false; | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::request_sync() { | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 	if (map && !sync_dirty_request_list_element.in_list()) { | 
					
						
							|  |  |  | 		map->add_link_sync_dirty_request(&sync_dirty_request_list_element); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::cancel_sync_request() { | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 	if (map && sync_dirty_request_list_element.in_list()) { | 
					
						
							|  |  |  | 		map->remove_link_sync_dirty_request(&sync_dirty_request_list_element); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | NavLink3D::NavLink3D() : | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 		sync_dirty_request_list_element(this) { | 
					
						
							|  |  |  | 	type = NavigationUtilities::PathSegmentType::PATH_SEGMENT_TYPE_LINK; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | NavLink3D::~NavLink3D() { | 
					
						
							| 
									
										
										
										
											2024-11-24 18:30:19 +01:00
										 |  |  | 	cancel_sync_request(); | 
					
						
							| 
									
										
										
										
											2022-01-30 15:39:52 -08:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2024-12-15 20:31:13 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2025-02-26 11:42:07 +01:00
										 |  |  | void NavLink3D::get_iteration_update(NavLinkIteration3D &r_iteration) { | 
					
						
							| 
									
										
										
										
											2024-12-15 20:31:13 +01:00
										 |  |  | 	r_iteration.navigation_layers = get_navigation_layers(); | 
					
						
							|  |  |  | 	r_iteration.enter_cost = get_enter_cost(); | 
					
						
							|  |  |  | 	r_iteration.travel_cost = get_travel_cost(); | 
					
						
							|  |  |  | 	r_iteration.owner_object_id = get_owner_id(); | 
					
						
							|  |  |  | 	r_iteration.owner_type = get_type(); | 
					
						
							| 
									
										
										
										
											2024-12-26 04:50:33 +01:00
										 |  |  | 	r_iteration.owner_rid = get_self(); | 
					
						
							| 
									
										
										
										
											2024-12-15 20:31:13 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2024-12-26 04:50:33 +01:00
										 |  |  | 	r_iteration.enabled = get_enabled(); | 
					
						
							|  |  |  | 	r_iteration.start_position = get_start_position(); | 
					
						
							|  |  |  | 	r_iteration.end_position = get_end_position(); | 
					
						
							|  |  |  | 	r_iteration.bidirectional = is_bidirectional(); | 
					
						
							| 
									
										
										
										
											2024-12-15 20:31:13 +01:00
										 |  |  | } |