mirror of
https://github.com/WiVRn/WiVRn.git
synced 2026-11-20 00:51:32 -08:00
246 lines
6.8 KiB
C++
246 lines
6.8 KiB
C++
/*
|
|
* WiVRn VR streaming
|
|
* Copyright (C) 2022 Guillaume Meunier <[email protected]>
|
|
* Copyright (C) 2022 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 "wivrn_client.h"
|
|
#include "hardware.h"
|
|
#include "protocol_version.h"
|
|
#include "secrets.h"
|
|
#include "smp.h"
|
|
#include "spdlog/common.h"
|
|
#include "utils/i18n.h"
|
|
#include "wivrn_packets.h"
|
|
#include <arpa/inet.h>
|
|
#include <ifaddrs.h>
|
|
#include <linux/ipv6.h>
|
|
#include <net/if.h>
|
|
#include <netinet/ip.h>
|
|
#include <poll.h>
|
|
#include <spdlog/spdlog.h>
|
|
#include <stdexcept>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/socket.h>
|
|
#include <unistd.h>
|
|
|
|
#ifndef IPTOS_DSCP_EF
|
|
// constant is not defined in Android ip.h
|
|
#define IPTOS_DSCP_EF 0xb8
|
|
#endif
|
|
|
|
using namespace std::chrono_literals;
|
|
|
|
const size_t num_streams = 5;
|
|
|
|
const char * handshake_error::what() const noexcept
|
|
{
|
|
return message.c_str();
|
|
}
|
|
|
|
handshake_error::handshake_error(std::string_view message) :
|
|
message(message) {}
|
|
|
|
namespace
|
|
{
|
|
template <typename T>
|
|
void init_stream(T & stream)
|
|
{
|
|
stream.set_receive_buffer_size(1024 * 1024 * 5);
|
|
}
|
|
} // namespace
|
|
|
|
template <typename T>
|
|
void wivrn_session::handshake(T address, bool tcp_only, crypto::key & headset_keypair, std::function<std::string(int fd)> pin_enter)
|
|
{
|
|
// FIXME this comment
|
|
// Wait for handshake on control socket,
|
|
// then send ours on stream or control socket,
|
|
// finally wait for second server handshake
|
|
|
|
auto receive = [](auto & socket, std::chrono::milliseconds timeout) {
|
|
auto timeout_abs = std::chrono::steady_clock::now() + timeout;
|
|
|
|
pollfd fds{
|
|
.fd = socket.get_fd(),
|
|
.events = POLLIN,
|
|
};
|
|
|
|
while (true)
|
|
{
|
|
auto ms = std::chrono::duration_cast<std::chrono::milliseconds>(timeout_abs - std::chrono::steady_clock::now());
|
|
int r = ::poll(&fds, 1, std::max<int>(ms.count(), 100));
|
|
if (r < 0)
|
|
throw std::system_error(errno, std::system_category());
|
|
|
|
if (r > 0 && (fds.revents & POLLIN))
|
|
{
|
|
auto packet = socket.receive();
|
|
if (not packet)
|
|
continue;
|
|
|
|
return std::move(*packet);
|
|
}
|
|
|
|
if (std::chrono::steady_clock::now() >= timeout_abs)
|
|
throw std::runtime_error(_("Timeout"));
|
|
}
|
|
};
|
|
|
|
send_control(from_headset::crypto_handshake{
|
|
.protocol_version = wivrn::protocol_version,
|
|
.public_key = headset_keypair.public_key(),
|
|
.name = model_name(),
|
|
});
|
|
|
|
to_headset::crypto_handshake crypto_handshake = std::get<to_headset::crypto_handshake>(receive(control, 10s));
|
|
|
|
std::string pin = "000000";
|
|
switch (crypto_handshake.state)
|
|
{
|
|
case to_headset::crypto_handshake::crypto_state::encryption_disabled: {
|
|
spdlog::info("Encryption is disabled on server");
|
|
|
|
send_control(from_headset::crypto_handshake{});
|
|
|
|
to_headset::handshake h{std::get<to_headset::handshake>(receive(control, 10s))};
|
|
if (h.stream_port > 0 && !tcp_only)
|
|
{
|
|
for (size_t i = 0; i < num_streams; ++i)
|
|
{
|
|
auto & s = streams.emplace_back();
|
|
s.connect(address, h.stream_port);
|
|
init_stream(s);
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
|
|
case to_headset::crypto_handshake::crypto_state::pin_needed:
|
|
pin = pin_enter(control.get_fd());
|
|
|
|
// Check the PIN
|
|
try
|
|
{
|
|
crypto::smp pin_check;
|
|
|
|
auto msg1 = pin_check.step1(pin);
|
|
send_control(from_headset::pin_check_1{msg1});
|
|
|
|
auto msg2 = std::get<to_headset::pin_check_2>(receive(control, 10s)).message;
|
|
|
|
auto msg3 = pin_check.step3(msg2);
|
|
send_control(from_headset::pin_check_3{msg3});
|
|
|
|
auto msg4 = std::get<to_headset::pin_check_4>(receive(control, 10s)).message;
|
|
bool pin_match = pin_check.step5(msg4);
|
|
|
|
if (not pin_match)
|
|
throw std::runtime_error(_("Incorrect PIN"));
|
|
}
|
|
catch (crypto::smp_cheated &)
|
|
{
|
|
throw std::runtime_error(_("Unable to check PIN"));
|
|
}
|
|
|
|
[[fallthrough]];
|
|
|
|
case to_headset::crypto_handshake::crypto_state::client_already_paired: {
|
|
spdlog::info("Using pin \"{}\"", pin);
|
|
|
|
crypto::key server_key = crypto::key::from_public_key(crypto_handshake.public_key);
|
|
secrets s{headset_keypair, server_key, pin};
|
|
control.set_aes_key_and_ivs(s.control_key, s.control_iv_to_headset, s.control_iv_from_headset);
|
|
|
|
// Confirm that encryption is set up
|
|
send_control(from_headset::crypto_handshake{});
|
|
|
|
to_headset::handshake h{std::get<to_headset::handshake>(receive(control, 10s))};
|
|
if (h.stream_port > 0 && !tcp_only)
|
|
{
|
|
for (size_t i = 0; i < num_streams; ++i)
|
|
{
|
|
auto & st = streams.emplace_back();
|
|
st.set_aes_key_and_ivs(s.stream_key, s.stream_iv_header_to_headset, s.stream_iv_header_from_headset);
|
|
st.connect(address, h.stream_port);
|
|
init_stream(st);
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
|
|
case to_headset::crypto_handshake::crypto_state::pairing_disabled:
|
|
spdlog::info("Pairing is disabled on server");
|
|
throw std::runtime_error(_("Pairing is disabled on server"));
|
|
|
|
case to_headset::crypto_handshake::crypto_state::incompatible_version:
|
|
spdlog::error("Incompatible protocol versions");
|
|
throw std::runtime_error(_("Incompatible server version"));
|
|
}
|
|
|
|
// Send the desired number of UDP streams
|
|
control.send(from_headset::handshake{.num_udp_streams = uint8_t(streams.size())});
|
|
std::get<to_headset::handshake>(receive(control, 2s));
|
|
|
|
// Initialize UDP streams
|
|
auto timeout = std::chrono::steady_clock::now() + 8s;
|
|
for (auto & s: streams)
|
|
{
|
|
while (true)
|
|
{
|
|
try
|
|
{
|
|
s.send(from_headset::handshake{});
|
|
auto p = receive(s, 100ms);
|
|
break;
|
|
}
|
|
catch (std::runtime_error & e)
|
|
{
|
|
// timeout, send a new packet and continue as packets may be lost
|
|
}
|
|
|
|
if (std::chrono::steady_clock::now() >= timeout)
|
|
throw std::runtime_error(_("Timeout"));
|
|
}
|
|
}
|
|
}
|
|
|
|
wivrn_session::wivrn_session(in6_addr address, int port, bool tcp_only, crypto::key & headset_keypair, std::function<std::string(int fd)> pin_enter) :
|
|
control(address, port), streams(-1), address(address)
|
|
{
|
|
try
|
|
{
|
|
handshake(address, tcp_only, headset_keypair, pin_enter);
|
|
}
|
|
catch (std::exception & e)
|
|
{
|
|
throw handshake_error{e.what()};
|
|
}
|
|
}
|
|
|
|
wivrn_session::wivrn_session(in_addr address, int port, bool tcp_only, crypto::key & headset_keypair, std::function<std::string(int fd)> pin_enter) :
|
|
control(address, port), address(address)
|
|
{
|
|
try
|
|
{
|
|
handshake(address, tcp_only, headset_keypair, pin_enter);
|
|
}
|
|
catch (std::exception & e)
|
|
{
|
|
throw handshake_error{e.what()};
|
|
}
|
|
}
|