2023-01-05 20:25:55 +08:00
|
|
|
/**************************************************************************/
|
|
|
|
/* xr_positional_tracker.cpp */
|
|
|
|
/**************************************************************************/
|
|
|
|
/* 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. */
|
|
|
|
/**************************************************************************/
|
2018-01-05 07:50:27 +08:00
|
|
|
|
2020-04-08 22:47:36 +08:00
|
|
|
#include "xr_positional_tracker.h"
|
2020-04-28 21:19:37 +08:00
|
|
|
|
|
|
|
#include "core/input/input.h"
|
2017-04-23 20:10:41 +08:00
|
|
|
|
2020-04-08 22:47:36 +08:00
|
|
|
void XRPositionalTracker::_bind_methods() {
|
2017-09-10 14:15:11 +08:00
|
|
|
BIND_ENUM_CONSTANT(TRACKER_HAND_UNKNOWN);
|
2020-12-10 18:30:37 +08:00
|
|
|
BIND_ENUM_CONSTANT(TRACKER_HAND_LEFT);
|
|
|
|
BIND_ENUM_CONSTANT(TRACKER_HAND_RIGHT);
|
2017-09-10 14:15:11 +08:00
|
|
|
|
2020-04-16 03:22:14 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("get_tracker_type"), &XRPositionalTracker::get_tracker_type);
|
2021-08-29 14:05:11 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("set_tracker_type", "type"), &XRPositionalTracker::set_tracker_type);
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::INT, "type"), "set_tracker_type", "get_tracker_type");
|
|
|
|
|
2020-04-16 03:22:14 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("get_tracker_name"), &XRPositionalTracker::get_tracker_name);
|
2021-08-29 14:05:11 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("set_tracker_name", "name"), &XRPositionalTracker::set_tracker_name);
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::STRING, "name"), "set_tracker_name", "get_tracker_name");
|
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("get_tracker_desc"), &XRPositionalTracker::get_tracker_desc);
|
|
|
|
ClassDB::bind_method(D_METHOD("set_tracker_desc", "description"), &XRPositionalTracker::set_tracker_desc);
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::STRING, "description"), "set_tracker_desc", "get_tracker_desc");
|
|
|
|
|
2022-03-05 18:09:21 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("get_tracker_profile"), &XRPositionalTracker::get_tracker_profile);
|
|
|
|
ClassDB::bind_method(D_METHOD("set_tracker_profile", "profile"), &XRPositionalTracker::set_tracker_profile);
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::STRING, "profile"), "set_tracker_profile", "get_tracker_profile");
|
|
|
|
|
2020-12-10 19:16:14 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("get_tracker_hand"), &XRPositionalTracker::get_tracker_hand);
|
2021-08-29 14:05:11 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("set_tracker_hand", "hand"), &XRPositionalTracker::set_tracker_hand);
|
|
|
|
ADD_PROPERTY(PropertyInfo(Variant::INT, "hand", PROPERTY_HINT_ENUM, "Unknown,Left,Right"), "set_tracker_hand", "get_tracker_hand");
|
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("has_pose", "name"), &XRPositionalTracker::has_pose);
|
|
|
|
ClassDB::bind_method(D_METHOD("get_pose", "name"), &XRPositionalTracker::get_pose);
|
|
|
|
ClassDB::bind_method(D_METHOD("invalidate_pose", "name"), &XRPositionalTracker::invalidate_pose);
|
2022-01-19 16:21:06 +08:00
|
|
|
ClassDB::bind_method(D_METHOD("set_pose", "name", "transform", "linear_velocity", "angular_velocity", "tracking_confidence"), &XRPositionalTracker::set_pose);
|
2021-08-29 14:05:11 +08:00
|
|
|
ADD_SIGNAL(MethodInfo("pose_changed", PropertyInfo(Variant::OBJECT, "pose", PROPERTY_HINT_RESOURCE_TYPE, "XRPose")));
|
|
|
|
|
|
|
|
ClassDB::bind_method(D_METHOD("get_input", "name"), &XRPositionalTracker::get_input);
|
|
|
|
ClassDB::bind_method(D_METHOD("set_input", "name", "value"), &XRPositionalTracker::set_input);
|
|
|
|
ADD_SIGNAL(MethodInfo("button_pressed", PropertyInfo(Variant::STRING, "name")));
|
|
|
|
ADD_SIGNAL(MethodInfo("button_released", PropertyInfo(Variant::STRING, "name")));
|
2023-01-22 10:17:20 +08:00
|
|
|
ADD_SIGNAL(MethodInfo("input_float_changed", PropertyInfo(Variant::STRING, "name"), PropertyInfo(Variant::FLOAT, "value")));
|
|
|
|
ADD_SIGNAL(MethodInfo("input_vector2_changed", PropertyInfo(Variant::STRING, "name"), PropertyInfo(Variant::VECTOR2, "vector")));
|
2022-03-05 18:09:21 +08:00
|
|
|
ADD_SIGNAL(MethodInfo("profile_changed", PropertyInfo(Variant::STRING, "role")));
|
2017-04-23 20:10:41 +08:00
|
|
|
};
|
|
|
|
|
2020-12-10 19:16:14 +08:00
|
|
|
void XRPositionalTracker::set_tracker_type(XRServer::TrackerType p_type) {
|
2017-04-23 20:10:41 +08:00
|
|
|
if (type != p_type) {
|
|
|
|
type = p_type;
|
2020-04-08 22:47:36 +08:00
|
|
|
hand = XRPositionalTracker::TRACKER_HAND_UNKNOWN;
|
2017-12-21 20:10:44 +08:00
|
|
|
};
|
2017-04-23 20:10:41 +08:00
|
|
|
};
|
|
|
|
|
2020-04-16 03:22:14 +08:00
|
|
|
XRServer::TrackerType XRPositionalTracker::get_tracker_type() const {
|
2017-04-23 20:10:41 +08:00
|
|
|
return type;
|
|
|
|
};
|
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
void XRPositionalTracker::set_tracker_name(const StringName &p_name) {
|
|
|
|
// Note: this should not be changed after the tracker is registered with the XRServer!
|
2017-04-23 20:10:41 +08:00
|
|
|
name = p_name;
|
|
|
|
};
|
|
|
|
|
2020-04-16 03:22:14 +08:00
|
|
|
StringName XRPositionalTracker::get_tracker_name() const {
|
2017-04-23 20:10:41 +08:00
|
|
|
return name;
|
|
|
|
};
|
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
void XRPositionalTracker::set_tracker_desc(const String &p_desc) {
|
|
|
|
description = p_desc;
|
|
|
|
}
|
2019-02-05 18:02:13 +08:00
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
String XRPositionalTracker::get_tracker_desc() const {
|
|
|
|
return description;
|
|
|
|
}
|
2019-02-05 18:02:13 +08:00
|
|
|
|
2022-03-05 18:09:21 +08:00
|
|
|
void XRPositionalTracker::set_tracker_profile(const String &p_profile) {
|
|
|
|
if (profile != p_profile) {
|
|
|
|
profile = p_profile;
|
|
|
|
|
|
|
|
emit_signal("profile_changed", profile);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
String XRPositionalTracker::get_tracker_profile() const {
|
|
|
|
return profile;
|
|
|
|
}
|
|
|
|
|
2020-12-10 19:16:14 +08:00
|
|
|
XRPositionalTracker::TrackerHand XRPositionalTracker::get_tracker_hand() const {
|
2017-09-10 14:15:11 +08:00
|
|
|
return hand;
|
|
|
|
};
|
|
|
|
|
2020-12-10 19:16:14 +08:00
|
|
|
void XRPositionalTracker::set_tracker_hand(const XRPositionalTracker::TrackerHand p_hand) {
|
2020-04-08 22:47:36 +08:00
|
|
|
XRServer *xr_server = XRServer::get_singleton();
|
|
|
|
ERR_FAIL_NULL(xr_server);
|
2017-12-21 20:10:44 +08:00
|
|
|
|
|
|
|
if (hand != p_hand) {
|
|
|
|
// we can only set this if we've previously set this to be a controller!!
|
2020-04-08 22:47:36 +08:00
|
|
|
ERR_FAIL_COND((type != XRServer::TRACKER_CONTROLLER) && (p_hand != XRPositionalTracker::TRACKER_HAND_UNKNOWN));
|
2017-12-21 20:10:44 +08:00
|
|
|
|
|
|
|
hand = p_hand;
|
|
|
|
};
|
2017-09-10 14:15:11 +08:00
|
|
|
};
|
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
bool XRPositionalTracker::has_pose(const StringName &p_action_name) const {
|
|
|
|
return poses.has(p_action_name);
|
|
|
|
}
|
2017-04-23 20:10:41 +08:00
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
Ref<XRPose> XRPositionalTracker::get_pose(const StringName &p_action_name) const {
|
|
|
|
Ref<XRPose> pose;
|
2017-04-23 20:10:41 +08:00
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
if (poses.has(p_action_name)) {
|
|
|
|
pose = poses[p_action_name];
|
|
|
|
}
|
2017-04-23 20:10:41 +08:00
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
return pose;
|
|
|
|
}
|
2017-04-23 20:10:41 +08:00
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
void XRPositionalTracker::invalidate_pose(const StringName &p_action_name) {
|
|
|
|
// only update this if we were tracking this pose
|
|
|
|
if (poses.has(p_action_name)) {
|
|
|
|
// We just set tracking data as invalid, we leave our current transform and velocity data as is so controllers don't suddenly jump to origin.
|
|
|
|
poses[p_action_name]->set_has_tracking_data(false);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2022-01-19 16:21:06 +08:00
|
|
|
void XRPositionalTracker::set_pose(const StringName &p_action_name, const Transform3D &p_transform, const Vector3 &p_linear_velocity, const Vector3 &p_angular_velocity, const XRPose::TrackingConfidence p_tracking_confidence) {
|
2021-08-29 14:05:11 +08:00
|
|
|
Ref<XRPose> new_pose;
|
|
|
|
|
2023-08-03 09:49:56 +08:00
|
|
|
if (poses.has(p_action_name)) {
|
|
|
|
new_pose = poses[p_action_name];
|
|
|
|
} else {
|
|
|
|
new_pose.instantiate();
|
|
|
|
poses[p_action_name] = new_pose;
|
|
|
|
}
|
|
|
|
|
2021-08-29 14:05:11 +08:00
|
|
|
new_pose->set_name(p_action_name);
|
|
|
|
new_pose->set_has_tracking_data(true);
|
|
|
|
new_pose->set_transform(p_transform);
|
|
|
|
new_pose->set_linear_velocity(p_linear_velocity);
|
|
|
|
new_pose->set_angular_velocity(p_angular_velocity);
|
2022-01-19 16:21:06 +08:00
|
|
|
new_pose->set_tracking_confidence(p_tracking_confidence);
|
2021-08-29 14:05:11 +08:00
|
|
|
|
2022-02-06 22:53:53 +08:00
|
|
|
emit_signal(SNAME("pose_changed"), new_pose);
|
2021-08-29 14:05:11 +08:00
|
|
|
|
|
|
|
// TODO discuss whether we also want to create and emit an InputEventXRPose event
|
|
|
|
}
|
|
|
|
|
|
|
|
Variant XRPositionalTracker::get_input(const StringName &p_action_name) const {
|
|
|
|
if (inputs.has(p_action_name)) {
|
|
|
|
return inputs[p_action_name];
|
|
|
|
} else {
|
|
|
|
return Variant();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void XRPositionalTracker::set_input(const StringName &p_action_name, const Variant &p_value) {
|
|
|
|
bool changed = false;
|
|
|
|
|
|
|
|
// XR inputs
|
|
|
|
|
|
|
|
if (inputs.has(p_action_name)) {
|
|
|
|
changed = inputs[p_action_name] != p_value;
|
|
|
|
} else {
|
|
|
|
changed = true;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (changed) {
|
|
|
|
// store the new value
|
|
|
|
inputs[p_action_name] = p_value;
|
|
|
|
|
|
|
|
// emit signals to let the rest of the world know
|
|
|
|
switch (p_value.get_type()) {
|
|
|
|
case Variant::BOOL: {
|
|
|
|
bool pressed = p_value;
|
|
|
|
if (pressed) {
|
2022-02-06 22:53:53 +08:00
|
|
|
emit_signal(SNAME("button_pressed"), p_action_name);
|
2021-08-29 14:05:11 +08:00
|
|
|
} else {
|
2022-02-06 22:53:53 +08:00
|
|
|
emit_signal(SNAME("button_released"), p_action_name);
|
2021-08-29 14:05:11 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
// TODO discuss whether we also want to create and emit an InputEventXRButton event
|
|
|
|
} break;
|
|
|
|
case Variant::FLOAT: {
|
2023-01-22 10:17:20 +08:00
|
|
|
emit_signal(SNAME("input_float_changed"), p_action_name, p_value);
|
2021-08-29 14:05:11 +08:00
|
|
|
|
|
|
|
// TODO discuss whether we also want to create and emit an InputEventXRValue event
|
|
|
|
} break;
|
|
|
|
case Variant::VECTOR2: {
|
2023-01-22 10:17:20 +08:00
|
|
|
emit_signal(SNAME("input_vector2_changed"), p_action_name, p_value);
|
2021-08-29 14:05:11 +08:00
|
|
|
|
|
|
|
// TODO discuss whether we also want to create and emit an InputEventXRAxis event
|
|
|
|
} break;
|
|
|
|
default: {
|
|
|
|
// ???
|
|
|
|
} break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2017-04-23 20:10:41 +08:00
|
|
|
|
2020-04-08 22:47:36 +08:00
|
|
|
XRPositionalTracker::XRPositionalTracker() {
|
|
|
|
type = XRServer::TRACKER_UNKNOWN;
|
2017-04-23 20:10:41 +08:00
|
|
|
name = "Unknown";
|
2017-09-10 14:15:11 +08:00
|
|
|
hand = TRACKER_HAND_UNKNOWN;
|
2017-04-23 20:10:41 +08:00
|
|
|
};
|