mirror of
https://github.com/WiVRn/WiVRn.git
synced 2026-11-20 00:51:32 -08:00
119 lines
3.5 KiB
C++
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;
|
|
}
|