/* * WiVRn VR streaming * Copyright (C) 2022 Guillaume Meunier * Copyright (C) 2022 Patrick Nicolas * * 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 . */ #include "wivrn_session.h" #include "audio_setup.h" #include "main/comp_target.h" #include "os/os_time.h" #include "util/u_logging.h" #include "wivrn_comp_target.h" #include "wivrn_controller.h" #include "wivrn_hmd.h" #include struct wivrn_comp_target_factory : public comp_target_factory { std::shared_ptr session; float fps; wivrn_comp_target_factory(std::shared_ptr session, float fps) : comp_target_factory{ .name = "WiVRn", .identifier = "wivrn", .requires_vulkan_for_create = false, .is_deferred = false, .required_instance_extensions = {}, .required_instance_extension_count = 0, .detect = wivrn_comp_target_factory::detect, .create_target = wivrn_comp_target_factory::create_target}, session(session), fps(fps) {} static bool detect(const struct comp_target_factory * ctf, struct comp_compositor * c) { return true; } static bool create_target(const struct comp_target_factory * ctf, struct comp_compositor * c, struct comp_target ** out_ct) { auto self = (wivrn_comp_target_factory *)ctf; *out_ct = comp_target_wivrn_create(self->session, c, self->fps); return true; } }; xrt::drivers::wivrn::wivrn_session::wivrn_session(xrt::drivers::wivrn::TCP && tcp) : connection(std::move(tcp)) { } wivrn_system_devices * xrt::drivers::wivrn::wivrn_session::create_session(xrt::drivers::wivrn::TCP && tcp) { std::shared_ptr self; std::optional control; try { self = std::shared_ptr(new wivrn_session(std::move(tcp))); while (not(control = self->connection.poll_control(-1))) { } } catch (std::exception & e) { U_LOG_E("Error creating WiVRn session: %s", e.what()); return nullptr; } const auto & info = std::get(*control); try { self->audio_handle = audio_device::create( "wivrn.source", "WiVRn microphone", "wivrn.sink", "WiVRn", info, *self); self->send_control(self->audio_handle->description()); } catch (const std::exception & e) { U_LOG_E("Failed to register audio device: %s", e.what()); } self->hmd = std::make_unique(self, info); self->left_hand = std::make_unique(0, self->hmd.get(), self); self->right_hand = std::make_unique(1, self->hmd.get(), self); wivrn_system_devices * devices = new wivrn_system_devices{}; int n = 0; if (self->hmd) devices->roles.head = devices->xdevs[n++] = self->hmd.get(); if (self->left_hand) devices->roles.left = devices->xdevs[n++] = self->left_hand.get(); if (self->right_hand) devices->roles.right = devices->xdevs[n++] = self->right_hand.get(); devices->xdev_count = n; devices->ctf = new wivrn_comp_target_factory(self, info.preferred_refresh_rate); devices->destroy = [](xrt_system_devices * xsd) { // TODO }; auto dump_file = std::getenv("WIVRN_DUMP_TIMINGS"); if (dump_file) { self->feedback_csv.open(dump_file); } self->thread = std::thread(&wivrn_session::run, self); return devices; } clock_offset wivrn_session::get_offset() { std::lock_guard lock(mutex); return offset; } void wivrn_session::operator()(from_headset::headset_info_packet &&) { U_LOG_W("unexpected headset info packet, ignoring"); } void wivrn_session::operator()(from_headset::tracking && tracking) { if (offset.epoch_offset.count() == 0) return; hmd->update_tracking(tracking, offset); left_hand->update_tracking(tracking, offset); right_hand->update_tracking(tracking, offset); } void wivrn_session::operator()(from_headset::inputs && inputs) { auto offset = get_offset(); left_hand->set_inputs(inputs, offset); right_hand->set_inputs(inputs, offset); } template static auto lerp(std::chrono::duration a, std::chrono::duration b, double t) { return std::chrono::duration(Rep(std::lerp(a.count(), b.count(), t))); } void wivrn_session::operator()(from_headset::timesync_response && timesync) { auto now = os_monotonic_get_ns(); std::lock_guard lock(mutex); offset = offset_est.get_offset(timesync, now, offset); } void wivrn_session::operator()(from_headset::feedback && feedback) { clock_offset o; { std::lock_guard lock(mutex); o = offset; } if (feedback.received_first_packet) dump_time("receive_start", feedback.frame_index, o.from_headset(feedback.received_first_packet), feedback.stream_index); if (feedback.received_last_packet) dump_time("receive_end", feedback.frame_index, o.from_headset(feedback.received_last_packet), feedback.stream_index); if (feedback.reconstructed) dump_time("reconstructed", feedback.frame_index, o.from_headset(feedback.reconstructed), feedback.stream_index); if (feedback.sent_to_decoder) dump_time("decode_start", feedback.frame_index, o.from_headset(feedback.sent_to_decoder), feedback.stream_index); if (feedback.received_from_decoder) dump_time("decode_end", feedback.frame_index, o.from_headset(feedback.received_from_decoder), feedback.stream_index); if (feedback.blitted) dump_time("blit", feedback.frame_index, o.from_headset(feedback.blitted), feedback.stream_index); if (feedback.displayed) dump_time("display", feedback.frame_index, o.from_headset(feedback.displayed), feedback.stream_index); } void wivrn_session::operator()(audio_data && data) { if (audio_handle) audio_handle->process_mic_data(std::move(data)); } uint64_t clock_offset::from_headset(uint64_t ts) const { return ts - epoch_offset.count(); } std::chrono::nanoseconds clock_offset::to_headset(uint64_t timestamp_ns) const { return std::chrono::nanoseconds(timestamp_ns) + epoch_offset; } void wivrn_session::run(std::weak_ptr weak_self) { while (true) { try { auto self = weak_self.lock(); if (self and not self->quit) { if (std::chrono::steady_clock::now() > self->offset_expiration) { self->offset_expiration = std::chrono::steady_clock::now() + std::chrono::seconds(1); to_headset::timesync_query timesync{}; timesync.query = std::chrono::nanoseconds(os_monotonic_get_ns()); self->connection.send_stream(timesync); } self->connection.poll(*self, 20); } else return; } catch (const std::exception & e) { U_LOG_E("Exception in network thread: %s", e.what()); auto self = weak_self.lock(); if (self) { self->quit = true; exit(0); } return; } } } std::array wivrn_session::get_foveation_parameters() { return hmd->get_foveation_parameters(); } void wivrn_session::dump_time(const std::string & event, uint64_t frame, uint64_t time, uint8_t stream) { if (feedback_csv) { std::lock_guard lock(csv_mutex); feedback_csv << std::quoted(event) << "," << frame << "," << time << "," << (int)stream << std::endl; } }