Files
WiVRn/client/xr/htc_body_tracker.cpp

119 lines
3.5 KiB
C++

/*
* WiVRn VR streaming
* Copyright (C) 2025 Awzri <[email protected]>
* Copyright (C) 2025 Sapphire <[email protected]>
* Copyright (C) 2025 Patrick Nicolas <[email protected]>
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <https://www.gnu.org/licenses/>.
*/
#include "htc_body_tracker.h"
#include "wivrn_packets.h"
#include "xr/details/enumerate.h"
#include "xr/session.h"
#include "xr/to_string.h"
#include <openxr/openxr.h>
// Note: This utilizes extensions not present in the OpenXR spec!
// For more info see:
// https://hub.vive.com/apidoc/api/VIVE.OpenXR.Tracker.ViveXRTracker.html
// https://hub.vive.com/apidoc/api/VIVE.OpenXR.VivePathEnumerationHelper.xrEnumeratePathsForInteractionProfileHTCDelegate.html
xr::vive_xr_tracker::vive_xr_tracker(XrPath path, xr::space & space, XrSession session) :
path(path),
space(space)
{
update_active(session);
}
void xr::vive_xr_tracker::update_active(XrSession session)
{
XrInputSourceLocalizedNameGetInfo get_info{
.type = XR_TYPE_INPUT_SOURCE_LOCALIZED_NAME_GET_INFO,
.next = nullptr,
.sourcePath = path,
.whichComponents = XR_INPUT_SOURCE_LOCALIZED_NAME_USER_PATH_BIT,
};
auto role = xr::details::enumerate<char>(xrGetInputSourceLocalizedName, session, &get_info);
is_active = not role.contains("_");
}
bool xr::vive_xr_tracker::get_active() const
{
return is_active;
}
XrSpace xr::vive_xr_tracker::get_space() const
{
return space;
}
static wivrn::from_headset::htc_body::pose locate_space(XrSpace space, XrSpace reference, XrTime time)
{
XrSpaceVelocity velocity{
.type = XR_TYPE_SPACE_VELOCITY,
};
XrSpaceLocation location{
.type = XR_TYPE_SPACE_LOCATION,
.next = &velocity,
};
if (auto res = xrLocateSpace(space, reference, time, &location); !XR_SUCCEEDED(res))
{
spdlog::warn("xrLocateSpace failed for HTC body tracker: {}", xr::to_string(res));
return {};
}
wivrn::from_headset::htc_body::pose res{
.pose = location.pose,
.linear_velocity = velocity.linearVelocity,
.angular_velocity = velocity.angularVelocity,
.flags = wivrn::from_headset::to_pose_flags(location.locationFlags, velocity.velocityFlags),
};
return res;
}
xr::htc_body_tracker::htc_body_tracker(session & s, std::vector<std::pair<XrPath, xr::space>> & trackers) :
s(s)
{
this->trackers.reserve(trackers.size());
for (auto & [path, space]: trackers)
this->trackers.emplace_back(path, space, s);
}
void xr::htc_body_tracker::update_active()
{
for (auto & tracker: trackers)
tracker.update_active(s);
}
xr::htc_body_tracker::packet_type xr::htc_body_tracker::locate_spaces(XrTime time, XrSpace reference)
{
xr::htc_body_tracker::packet_type ret{};
for (size_t i = 0; i < trackers.size(); i++)
{
auto & tracker = trackers[i];
wivrn::from_headset::htc_body::pose pose{};
if (tracker.get_active())
pose = locate_space(tracker.get_space(), reference, time);
ret.poses[i] = pose;
}
return ret;
}