mirror of
				https://github.com/godotengine/godot.git
				synced 2025-11-03 23:21:15 +00:00 
			
		
		
		
	Happy new year to the wonderful Godot community!
2020 has been a tough year for most of us personally, but a good year for
Godot development nonetheless with a huge amount of work done towards Godot
4.0 and great improvements backported to the long-lived 3.2 branch.
We've had close to 400 contributors to engine code this year, authoring near
7,000 commit! (And that's only for the `master` branch and for the engine code,
there's a lot more when counting docs, demos and other first-party repos.)
Here's to a great year 2021 for all Godot users 🎆
		
	
			
		
			
				
	
	
		
			234 lines
		
	
	
	
		
			8.5 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			234 lines
		
	
	
	
		
			8.5 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
/*************************************************************************/
 | 
						|
/*  xr_positional_tracker.cpp                                            */
 | 
						|
/*************************************************************************/
 | 
						|
/*                       This file is part of:                           */
 | 
						|
/*                           GODOT ENGINE                                */
 | 
						|
/*                      https://godotengine.org                          */
 | 
						|
/*************************************************************************/
 | 
						|
/* Copyright (c) 2007-2021 Juan Linietsky, Ariel Manzur.                 */
 | 
						|
/* Copyright (c) 2014-2021 Godot Engine contributors (cf. AUTHORS.md).   */
 | 
						|
/*                                                                       */
 | 
						|
/* 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 "xr_positional_tracker.h"
 | 
						|
 | 
						|
#include "core/input/input.h"
 | 
						|
 | 
						|
void XRPositionalTracker::_bind_methods() {
 | 
						|
	BIND_ENUM_CONSTANT(TRACKER_HAND_UNKNOWN);
 | 
						|
	BIND_ENUM_CONSTANT(TRACKER_HAND_LEFT);
 | 
						|
	BIND_ENUM_CONSTANT(TRACKER_HAND_RIGHT);
 | 
						|
 | 
						|
	// this class is read only from GDScript, so we only have access to getters..
 | 
						|
	ClassDB::bind_method(D_METHOD("get_tracker_type"), &XRPositionalTracker::get_tracker_type);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_tracker_id"), &XRPositionalTracker::get_tracker_id);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_tracker_name"), &XRPositionalTracker::get_tracker_name);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_joy_id"), &XRPositionalTracker::get_joy_id);
 | 
						|
	ClassDB::bind_method(D_METHOD("is_tracking_orientation"), &XRPositionalTracker::is_tracking_orientation);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_orientation"), &XRPositionalTracker::get_orientation);
 | 
						|
	ClassDB::bind_method(D_METHOD("is_tracking_position"), &XRPositionalTracker::is_tracking_position);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_position"), &XRPositionalTracker::get_position);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_tracker_hand"), &XRPositionalTracker::get_tracker_hand);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_transform", "adjust_by_reference_frame"), &XRPositionalTracker::get_transform);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_mesh"), &XRPositionalTracker::get_mesh);
 | 
						|
 | 
						|
	// these functions we don't want to expose to normal users but do need to be callable from GDNative
 | 
						|
	ClassDB::bind_method(D_METHOD("_set_tracker_type", "type"), &XRPositionalTracker::set_tracker_type);
 | 
						|
	ClassDB::bind_method(D_METHOD("_set_tracker_name", "name"), &XRPositionalTracker::set_tracker_name);
 | 
						|
	ClassDB::bind_method(D_METHOD("_set_joy_id", "joy_id"), &XRPositionalTracker::set_joy_id);
 | 
						|
	ClassDB::bind_method(D_METHOD("_set_orientation", "orientation"), &XRPositionalTracker::set_orientation);
 | 
						|
	ClassDB::bind_method(D_METHOD("_set_rw_position", "rw_position"), &XRPositionalTracker::set_rw_position);
 | 
						|
	ClassDB::bind_method(D_METHOD("_set_mesh", "mesh"), &XRPositionalTracker::set_mesh);
 | 
						|
	ClassDB::bind_method(D_METHOD("get_rumble"), &XRPositionalTracker::get_rumble);
 | 
						|
	ClassDB::bind_method(D_METHOD("set_rumble", "rumble"), &XRPositionalTracker::set_rumble);
 | 
						|
 | 
						|
	ADD_PROPERTY(PropertyInfo(Variant::FLOAT, "rumble"), "set_rumble", "get_rumble");
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_tracker_type(XRServer::TrackerType p_type) {
 | 
						|
	if (type != p_type) {
 | 
						|
		type = p_type;
 | 
						|
		hand = XRPositionalTracker::TRACKER_HAND_UNKNOWN;
 | 
						|
 | 
						|
		XRServer *xr_server = XRServer::get_singleton();
 | 
						|
		ERR_FAIL_NULL(xr_server);
 | 
						|
 | 
						|
		// get a tracker id for our type
 | 
						|
		// note if this is a controller this will be 3 or higher but we may change it later.
 | 
						|
		tracker_id = xr_server->get_free_tracker_id_for_type(p_type);
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
XRServer::TrackerType XRPositionalTracker::get_tracker_type() const {
 | 
						|
	return type;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_tracker_name(const String &p_name) {
 | 
						|
	name = p_name;
 | 
						|
};
 | 
						|
 | 
						|
StringName XRPositionalTracker::get_tracker_name() const {
 | 
						|
	return name;
 | 
						|
};
 | 
						|
 | 
						|
int XRPositionalTracker::get_tracker_id() const {
 | 
						|
	return tracker_id;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_joy_id(int p_joy_id) {
 | 
						|
	joy_id = p_joy_id;
 | 
						|
};
 | 
						|
 | 
						|
int XRPositionalTracker::get_joy_id() const {
 | 
						|
	return joy_id;
 | 
						|
};
 | 
						|
 | 
						|
bool XRPositionalTracker::is_tracking_orientation() const {
 | 
						|
	return tracking_orientation;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_orientation(const Basis &p_orientation) {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	tracking_orientation = true; // obviously we have this
 | 
						|
	orientation = p_orientation;
 | 
						|
};
 | 
						|
 | 
						|
Basis XRPositionalTracker::get_orientation() const {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	return orientation;
 | 
						|
};
 | 
						|
 | 
						|
bool XRPositionalTracker::is_tracking_position() const {
 | 
						|
	return tracking_position;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_position(const Vector3 &p_position) {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	XRServer *xr_server = XRServer::get_singleton();
 | 
						|
	ERR_FAIL_NULL(xr_server);
 | 
						|
	real_t world_scale = xr_server->get_world_scale();
 | 
						|
	ERR_FAIL_COND(world_scale == 0);
 | 
						|
 | 
						|
	tracking_position = true; // obviously we have this
 | 
						|
	rw_position = p_position / world_scale;
 | 
						|
};
 | 
						|
 | 
						|
Vector3 XRPositionalTracker::get_position() const {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	XRServer *xr_server = XRServer::get_singleton();
 | 
						|
	ERR_FAIL_NULL_V(xr_server, rw_position);
 | 
						|
	real_t world_scale = xr_server->get_world_scale();
 | 
						|
 | 
						|
	return rw_position * world_scale;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_rw_position(const Vector3 &p_rw_position) {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	tracking_position = true; // obviously we have this
 | 
						|
	rw_position = p_rw_position;
 | 
						|
};
 | 
						|
 | 
						|
Vector3 XRPositionalTracker::get_rw_position() const {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	return rw_position;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_mesh(const Ref<Mesh> &p_mesh) {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	mesh = p_mesh;
 | 
						|
};
 | 
						|
 | 
						|
Ref<Mesh> XRPositionalTracker::get_mesh() const {
 | 
						|
	_THREAD_SAFE_METHOD_
 | 
						|
 | 
						|
	return mesh;
 | 
						|
};
 | 
						|
 | 
						|
XRPositionalTracker::TrackerHand XRPositionalTracker::get_tracker_hand() const {
 | 
						|
	return hand;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_tracker_hand(const XRPositionalTracker::TrackerHand p_hand) {
 | 
						|
	XRServer *xr_server = XRServer::get_singleton();
 | 
						|
	ERR_FAIL_NULL(xr_server);
 | 
						|
 | 
						|
	if (hand != p_hand) {
 | 
						|
		// we can only set this if we've previously set this to be a controller!!
 | 
						|
		ERR_FAIL_COND((type != XRServer::TRACKER_CONTROLLER) && (p_hand != XRPositionalTracker::TRACKER_HAND_UNKNOWN));
 | 
						|
 | 
						|
		hand = p_hand;
 | 
						|
		if (hand == XRPositionalTracker::TRACKER_HAND_LEFT) {
 | 
						|
			if (!xr_server->is_tracker_id_in_use_for_type(type, 1)) {
 | 
						|
				tracker_id = 1;
 | 
						|
			};
 | 
						|
		} else if (hand == XRPositionalTracker::TRACKER_HAND_RIGHT) {
 | 
						|
			if (!xr_server->is_tracker_id_in_use_for_type(type, 2)) {
 | 
						|
				tracker_id = 2;
 | 
						|
			};
 | 
						|
		};
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
Transform XRPositionalTracker::get_transform(bool p_adjust_by_reference_frame) const {
 | 
						|
	Transform new_transform;
 | 
						|
 | 
						|
	new_transform.basis = get_orientation();
 | 
						|
	new_transform.origin = get_position();
 | 
						|
 | 
						|
	if (p_adjust_by_reference_frame) {
 | 
						|
		XRServer *xr_server = XRServer::get_singleton();
 | 
						|
		ERR_FAIL_NULL_V(xr_server, new_transform);
 | 
						|
 | 
						|
		new_transform = xr_server->get_reference_frame() * new_transform;
 | 
						|
	};
 | 
						|
 | 
						|
	return new_transform;
 | 
						|
};
 | 
						|
 | 
						|
real_t XRPositionalTracker::get_rumble() const {
 | 
						|
	return rumble;
 | 
						|
};
 | 
						|
 | 
						|
void XRPositionalTracker::set_rumble(real_t p_rumble) {
 | 
						|
	if (p_rumble > 0.0) {
 | 
						|
		rumble = p_rumble;
 | 
						|
	} else {
 | 
						|
		rumble = 0.0;
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
XRPositionalTracker::XRPositionalTracker() {
 | 
						|
	type = XRServer::TRACKER_UNKNOWN;
 | 
						|
	name = "Unknown";
 | 
						|
	joy_id = -1;
 | 
						|
	tracker_id = 0;
 | 
						|
	tracking_orientation = false;
 | 
						|
	tracking_position = false;
 | 
						|
	hand = TRACKER_HAND_UNKNOWN;
 | 
						|
	rumble = 0.0;
 | 
						|
};
 |