Files
WiVRn/client/wivrn_client.cpp
T

237 lines
6.7 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 "application.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 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
pollfd fds{};
fds.events = POLLIN;
fds.fd = control.get_fd();
auto receive = [&](std::optional<std::chrono::seconds> timeout = std::nullopt) {
std::chrono::steady_clock::time_point timeout_abs{};
if (timeout)
timeout_abs = std::chrono::steady_clock::now() + *timeout;
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 = control.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 = application::get_hmd_traits().model_name(),
});
to_headset::crypto_handshake crypto_handshake = std::get<to_headset::crypto_handshake>(receive(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(10s))};
if (h.stream_port > 0 && !tcp_only)
{
stream = decltype(stream)();
stream.connect(address, h.stream_port);
init_stream(stream);
}
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(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(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(10s))};
if (h.stream_port > 0 && !tcp_only)
{
stream = decltype(stream)();
stream.set_aes_key_and_ivs(s.stream_key, s.stream_iv_header_to_headset, s.stream_iv_header_from_headset);
stream.connect(address, h.stream_port);
init_stream(stream);
}
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"));
}
// may be on control socket if forced TCP
send_stream(from_headset::handshake{});
// Wait for second handshake
auto timeout = std::chrono::steady_clock::now() + 10s;
while (true)
{
if (poll([](const auto && packet) { return std::is_same_v<std::remove_cvref_t<decltype(packet)>, to_headset::handshake>; }, 100ms))
{
return;
}
if (std::chrono::steady_clock::now() >= timeout)
throw std::runtime_error(_("Timeout"));
// If using stream socket, the handshake might be lost
if (stream)
{
stream.send(from_headset::handshake{});
}
}
}
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), stream(-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), stream(-1), address(address)
{
try
{
handshake(address, tcp_only, headset_keypair, pin_enter);
}
catch (std::exception & e)
{
throw handshake_error{e.what()};
}
}