Services/UDS: Initial support for hosting local-wlan networks.

Currently it will let games create a network as hosts, but will not broadcast it anywhere and will not allow clients to connect.
This commit is contained in:
Subv 2017-03-13 16:53:20 -05:00
parent eb435816e3
commit 9771615f16
2 changed files with 334 additions and 42 deletions

View File

@ -1,16 +1,48 @@
// Copyright 2014 Citra Emulator Project // Copyright 2017 Citra Emulator Project
// Licensed under GPLv2 or any later version // Licensed under GPLv2 or any later version
// Refer to the license.txt file included. // Refer to the license.txt file included.
#include <cstring>
#include <unordered_map>
#include <vector>
#include "common/common_types.h" #include "common/common_types.h"
#include "common/logging/log.h" #include "common/logging/log.h"
#include "core/hle/kernel/event.h" #include "core/hle/kernel/event.h"
#include "core/hle/kernel/shared_memory.h"
#include "core/hle/result.h"
#include "core/hle/service/nwm/nwm_uds.h" #include "core/hle/service/nwm/nwm_uds.h"
#include "core/memory.h"
namespace Service { namespace Service {
namespace NWM { namespace NWM {
static Kernel::SharedPtr<Kernel::Event> uds_handle_event; // Event that is signaled every time the connection status changes.
static Kernel::SharedPtr<Kernel::Event> connection_status_event;
// Shared memory provided by the application to store the receive buffer.
// This is not currently used.
static Kernel::SharedPtr<Kernel::SharedMemory> recv_buffer_memory;
// Connection status of this 3DS.
static ConnectionStatus connection_status{};
// Node information about the current 3DS.
// TODO(Subv): Keep an array of all nodes connected to the network,
// that data has to be retransmitted in every beacon frame.
static NodeInfo node_info;
// Mapping of bind node ids to their respective events.
static std::unordered_map<u32, Kernel::SharedPtr<Kernel::Event>> bind_node_events;
// The wifi network channel that the network is currently on.
// Since we're not actually interacting with physical radio waves, this is just a dummy value.
static u8 network_channel = DefaultNetworkChannel;
// The identifier of the network kind, this is used to filter away networks that we're not interested in.
static u32 wlan_comm_id = 0;
// Application data that is sent when broadcasting the beacon frames.
static std::vector<u8> application_data;
/** /**
* NWM_UDS::Shutdown service function * NWM_UDS::Shutdown service function
@ -32,14 +64,14 @@ static void Shutdown(Interface* self) {
/** /**
* NWM_UDS::RecvBeaconBroadcastData service function * NWM_UDS::RecvBeaconBroadcastData service function
* Returns the raw beacon data for nearby networks that match the supplied WlanCommId.
* Inputs: * Inputs:
* 1 : Output buffer max size * 1 : Output buffer max size
* 2 : Unknown * 2-3 : Unknown
* 3 : Unknown * 4-5 : Host MAC address.
* 4 : MAC address? * 6-14 : Unused
* 6-14 : Unknown, usually zero / uninitialized? * 15 : WLan Comm Id
* 15 : WLan Comm ID * 16 : Id
* 16 : This is the ID also located at offset 0xE in the CTR-generation structure.
* 17 : Value 0 * 17 : Value 0
* 18 : Input handle * 18 : Input handle
* 19 : (Size<<4) | 12 * 19 : (Size<<4) | 12
@ -77,42 +109,234 @@ static void RecvBeaconBroadcastData(Interface* self) {
/** /**
* NWM_UDS::Initialize service function * NWM_UDS::Initialize service function
* Inputs: * Inputs:
* 1 : Unknown * 1 : Shared memory size
* 2-11 : Input Structure * 2-11 : Input NodeInfo Structure
* 12 : Unknown u16 * 12 : 2-byte Version
* 13 : Value 0 * 13 : Value 0
* 14 : Handle * 14 : Shared memory handle
* Outputs: * Outputs:
* 0 : Return header * 0 : Return header
* 1 : Result of function, 0 on success, otherwise error code * 1 : Result of function, 0 on success, otherwise error code
* 2 : Value 0 * 2 : Value 0
* 3 : Output handle * 3 : Output event handle
*/ */
static void InitializeWithVersion(Interface* self) { static void InitializeWithVersion(Interface* self) {
u32* cmd_buff = Kernel::GetCommandBuffer(); IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x1B, 12, 2);
u32 unk1 = cmd_buff[1];
u32 unk2 = cmd_buff[12];
u32 value = cmd_buff[13];
u32 handle = cmd_buff[14];
// Because NWM service is not implemented at all, we stub the Initialize function with an error u32 sharedmem_size = rp.Pop<u32>();
// code instead of success to prevent games from using the service and from causing more issues.
// The error code is from a real 3DS with wifi off, thus believed to be "network disabled". // Update the node information with the data the game gave us.
/* rp.PopRaw(node_info);
cmd_buff[1] = RESULT_SUCCESS.raw;
cmd_buff[2] = 0; u16 version;
cmd_buff[3] = Kernel::g_handle_table.Create(uds_handle_event) rp.PopRaw(version);
.MoveFrom(); // TODO(purpasmart): Verify if this is a event handle Kernel::Handle sharedmem_handle = rp.PopHandle();
recv_buffer_memory = Kernel::g_handle_table.Get<Kernel::SharedMemory>(sharedmem_handle);
ASSERT_MSG(recv_buffer_memory->size == sharedmem_size, "Invalid shared memory size.");
// Reset the connection status, it contains all zeros after initialization,
// except for the actual status value.
connection_status = {};
connection_status.status = static_cast<u32>(NetworkStatus::NotConnected);
IPC::RequestBuilder rb = rp.MakeBuilder(1, 2);
rb.Push(RESULT_SUCCESS);
rb.PushCopyHandles(Kernel::g_handle_table.Create(connection_status_event).MoveFrom());
LOG_DEBUG(Service_NWM, "called sharedmem_size=0x%08X, version=0x%08X, sharedmem_handle=0x%08X",
sharedmem_size, version, sharedmem_handle);
}
/**
* NWM_UDS::GetConnectionStatus service function.
* Returns the connection status structure for the currently open network connection.
* This structure contains information about the connection,
* like the number of connected nodes, etc.
* Inputs:
* 0 : Command header.
* Outputs:
* 0 : Return header
* 1 : Result of function, 0 on success, otherwise error code
* 2-13 : Channel of the current WiFi network connection.
*/ */
cmd_buff[0] = IPC::MakeHeader(0x1B, 1, 2); static void GetConnectionStatus(Interface* self) {
cmd_buff[1] = ResultCode(static_cast<ErrorDescription>(2), ErrorModule::UDS, IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0xB, 0, 0);
ErrorSummary::StatusChanged, ErrorLevel::Status) IPC::RequestBuilder rb = rp.MakeBuilder(13, 0);
.raw;
cmd_buff[2] = 0;
cmd_buff[3] = 0;
LOG_WARNING(Service_NWM, "(STUBBED) called unk1=0x%08X, unk2=0x%08X, value=%u, handle=0x%08X", rb.Push(RESULT_SUCCESS);
unk1, unk2, value, handle); rb.PushRaw(connection_status);
LOG_DEBUG(Service_NWM, "called");
}
/**
* NWM_UDS::Bind service function.
* Binds a BindNodeId to a data channel and retrieves a data event.
* Inputs:
* 1 : BindNodeId
* 2 : Receive buffer size.
* 3 : u8 Data channel to bind to.
* 4 : Network node id.
* Outputs:
* 0 : Return header
* 1 : Result of function, 0 on success, otherwise error code
* 2 : Copy handle descriptor.
* 3 : Data available event handle.
*/
static void Bind(Interface* self) {
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x12, 4, 0);
u32 bind_node_id = rp.Pop<u32>();
u32 recv_buffer_size = rp.Pop<u32>();
u8 data_channel;
rp.PopRaw(data_channel);
u16 network_node_id;
rp.PopRaw(network_node_id);
// TODO(Subv): Store the data channel and verify it when receiving data frames.
LOG_DEBUG(Service_NWM, "called");
if (data_channel == 0) {
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
rb.Push(ResultCode(ErrorDescription::NotAuthorized, ErrorModule::UDS,
ErrorSummary::WrongArgument, ErrorLevel::Usage));
return;
}
// Create a new event for this bind node.
// TODO(Subv): Signal this event when new data is received on this data channel.
auto event = Kernel::Event::Create(Kernel::ResetType::OneShot,
"NWM::BindNodeEvent" + std::to_string(bind_node_id));
bind_node_events[bind_node_id] = event;
IPC::RequestBuilder rb = rp.MakeBuilder(1, 2);
rb.Push(RESULT_SUCCESS);
rb.PushCopyHandles(Kernel::g_handle_table.Create(event).MoveFrom());
}
/**
* NWM_UDS::BeginHostingNetwork service function.
* Creates a network and starts broadcasting its presence.
* Inputs:
* 1 : Passphrase buffer size.
* 3 : VAddr of the NetworkInfo structure.
* 5 : VAddr of the passphrase.
* Outputs:
* 0 : Return header
* 1 : Result of function, 0 on success, otherwise error code
*/
static void BeginHostingNetwork(Interface* self) {
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x1D, 1, 4);
const u32 passphrase_size = rp.Pop<u32>();
size_t desc_size;
const VAddr network_info_address = rp.PopStaticBuffer(&desc_size, false);
ASSERT(desc_size == sizeof(NetworkInfo));
const VAddr passphrase_address = rp.PopStaticBuffer(&desc_size, false);
ASSERT(desc_size == passphrase_size);
// TODO(Subv): Store the passphrase and verify it when attempting a connection.
LOG_DEBUG(Service_NWM, "called");
NetworkInfo network_info;
Memory::ReadBlock(network_info_address, &network_info, sizeof(NetworkInfo));
connection_status.status = static_cast<u32>(NetworkStatus::ConnectedAsHost);
connection_status.max_nodes = network_info.max_nodes;
wlan_comm_id = network_info.wlan_comm_id;
// There's currently only one node in the network (the host).
connection_status.total_nodes = 1;
// The host is always the first node
connection_status.network_node_id = 1;
node_info.network_node_id = 1;
// Set the bit 0 in the nodes bitmask to indicate that node 1 is already taken.
connection_status.node_bitmask |= 1;
// If the game has a preferred channel, use that instead.
if (network_info.channel != 0)
network_channel = network_info.channel;
// Clear the pre-existing application data.
application_data.clear();
connection_status_event->Signal();
// TODO(Subv): Start broadcasting the network, send a beacon frame every 102.4ms.
LOG_WARNING(Service_NWM,
"An UDS network has been created, but broadcasting it is unimplemented.");
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
rb.Push(RESULT_SUCCESS);
}
/**
* NWM_UDS::GetChannel service function.
* Returns the WiFi channel in which the network we're connected to is transmitting.
* Inputs:
* 0 : Command header.
* Outputs:
* 0 : Return header
* 1 : Result of function, 0 on success, otherwise error code
* 2 : Channel of the current WiFi network connection.
*/
static void GetChannel(Interface* self) {
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x1A, 0, 0);
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
u8 channel = network_channel;
if (connection_status.status == static_cast<u32>(NetworkStatus::NotConnected))
channel = 0;
rb.Push(RESULT_SUCCESS);
rb.PushRaw(channel);
LOG_DEBUG(Service_NWM, "called");
}
/**
* NWM_UDS::SetApplicationData service function.
* Updates the application data that is being broadcast in the beacon frames
* for the network that we're hosting.
* Inputs:
* 1 : Data size.
* 3 : VAddr of the data.
* Outputs:
* 0 : Return header
* 1 : Result of function, 0 on success, otherwise error code
* 2 : Channel of the current WiFi network connection.
*/
static void SetApplicationData(Interface* self) {
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x1A, 1, 2);
u32 size = rp.Pop<u32>();
size_t desc_size;
const VAddr address = rp.PopStaticBuffer(&desc_size, false);
ASSERT(desc_size == size);
LOG_DEBUG(Service_NWM, "called");
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
if (size > ApplicationDataSize) {
rb.Push(ResultCode(ErrorDescription::TooLarge, ErrorModule::UDS,
ErrorSummary::WrongArgument, ErrorLevel::Usage));
return;
}
application_data.resize(size);
Memory::ReadBlock(address, application_data.data(), size);
rb.Push(RESULT_SUCCESS);
} }
const Interface::FunctionInfo FunctionTable[] = { const Interface::FunctionInfo FunctionTable[] = {
@ -126,20 +350,20 @@ const Interface::FunctionInfo FunctionTable[] = {
{0x00080000, nullptr, "DestroyNetwork"}, {0x00080000, nullptr, "DestroyNetwork"},
{0x00090442, nullptr, "ConnectNetwork (deprecated)"}, {0x00090442, nullptr, "ConnectNetwork (deprecated)"},
{0x000A0000, nullptr, "DisconnectNetwork"}, {0x000A0000, nullptr, "DisconnectNetwork"},
{0x000B0000, nullptr, "GetConnectionStatus"}, {0x000B0000, GetConnectionStatus, "GetConnectionStatus"},
{0x000D0040, nullptr, "GetNodeInformation"}, {0x000D0040, nullptr, "GetNodeInformation"},
{0x000E0006, nullptr, "DecryptBeaconData (deprecated)"}, {0x000E0006, nullptr, "DecryptBeaconData (deprecated)"},
{0x000F0404, RecvBeaconBroadcastData, "RecvBeaconBroadcastData"}, {0x000F0404, RecvBeaconBroadcastData, "RecvBeaconBroadcastData"},
{0x00100042, nullptr, "SetApplicationData"}, {0x00100042, SetApplicationData, "SetApplicationData"},
{0x00110040, nullptr, "GetApplicationData"}, {0x00110040, nullptr, "GetApplicationData"},
{0x00120100, nullptr, "Bind"}, {0x00120100, Bind, "Bind"},
{0x00130040, nullptr, "Unbind"}, {0x00130040, nullptr, "Unbind"},
{0x001400C0, nullptr, "PullPacket"}, {0x001400C0, nullptr, "PullPacket"},
{0x00150080, nullptr, "SetMaxSendDelay"}, {0x00150080, nullptr, "SetMaxSendDelay"},
{0x00170182, nullptr, "SendTo"}, {0x00170182, nullptr, "SendTo"},
{0x001A0000, nullptr, "GetChannel"}, {0x001A0000, GetChannel, "GetChannel"},
{0x001B0302, InitializeWithVersion, "InitializeWithVersion"}, {0x001B0302, InitializeWithVersion, "InitializeWithVersion"},
{0x001D0044, nullptr, "BeginHostingNetwork"}, {0x001D0044, BeginHostingNetwork, "BeginHostingNetwork"},
{0x001E0084, nullptr, "ConnectToNetwork"}, {0x001E0084, nullptr, "ConnectToNetwork"},
{0x001F0006, nullptr, "DecryptBeaconData"}, {0x001F0006, nullptr, "DecryptBeaconData"},
{0x00200040, nullptr, "Flush"}, {0x00200040, nullptr, "Flush"},
@ -148,13 +372,20 @@ const Interface::FunctionInfo FunctionTable[] = {
}; };
NWM_UDS::NWM_UDS() { NWM_UDS::NWM_UDS() {
uds_handle_event = Kernel::Event::Create(Kernel::ResetType::OneShot, "NWM::uds_handle_event"); connection_status_event =
Kernel::Event::Create(Kernel::ResetType::OneShot, "NWM::connection_status_event");
Register(FunctionTable); Register(FunctionTable);
} }
NWM_UDS::~NWM_UDS() { NWM_UDS::~NWM_UDS() {
uds_handle_event = nullptr; application_data.clear();
bind_node_events.clear();
connection_status_event = nullptr;
recv_buffer_memory = nullptr;
connection_status = {};
connection_status.status = static_cast<u32>(NetworkStatus::NotConnected);
} }
} // namespace NWM } // namespace NWM

View File

@ -4,6 +4,10 @@
#pragma once #pragma once
#include <array>
#include <cstddef>
#include "common/common_types.h"
#include "common/swap.h"
#include "core/hle/service/service.h" #include "core/hle/service/service.h"
// Local-WLAN service // Local-WLAN service
@ -11,6 +15,63 @@
namespace Service { namespace Service {
namespace NWM { namespace NWM {
const size_t ApplicationDataSize = 0xC8;
const u8 DefaultNetworkChannel = 11;
struct NodeInfo {
u64_le friend_code_seed;
std::array<u16_le, 10> username;
INSERT_PADDING_BYTES(4);
u16_le network_node_id;
INSERT_PADDING_BYTES(6);
};
static_assert(sizeof(NodeInfo) == 40, "NodeInfo has incorrect size.");
enum class NetworkStatus {
NotConnected = 3,
ConnectedAsHost = 6,
ConnectedAsClient = 9,
ConnectedAsSpectator = 10,
};
struct ConnectionStatus {
u32_le status;
INSERT_PADDING_WORDS(1);
u16_le network_node_id;
INSERT_PADDING_BYTES(2);
INSERT_PADDING_BYTES(32);
u8 total_nodes;
u8 max_nodes;
u16_le node_bitmask;
};
static_assert(sizeof(ConnectionStatus) == 0x30, "ConnectionStatus has incorrect size.");
struct NetworkInfo {
std::array<u8, 6> host_mac_address;
u8 channel;
INSERT_PADDING_BYTES(1);
u8 initialized;
INSERT_PADDING_BYTES(3);
std::array<u8, 3> oui_value;
u8 oui_type;
// This field is received as BigEndian from the game.
u32_be wlan_comm_id;
u8 id;
INSERT_PADDING_BYTES(1);
u16_be attributes;
u32_be network_id;
u8 total_nodes;
u8 max_nodes;
INSERT_PADDING_BYTES(2);
INSERT_PADDING_BYTES(0x1F);
u8 application_data_size;
std::array<u8, ApplicationDataSize> application_data;
};
static_assert(sizeof(NetworkInfo) == 0x108, "NetworkInfo has incorrect size.");
class NWM_UDS final : public Interface { class NWM_UDS final : public Interface {
public: public:
NWM_UDS(); NWM_UDS();