mirror of
https://github.com/switchbrew/libnx.git
synced 2025-12-31 06:58:40 +01:00
569 lines
13 KiB
C
569 lines
13 KiB
C
#include <stdlib.h>
|
|
|
|
#include "types.h"
|
|
#include "arm/atomics.h"
|
|
#include "services/hid.h"
|
|
#include "services/applet.h"
|
|
#include "services/nfpu.h"
|
|
|
|
static u64 g_refCnt;
|
|
static Service g_nfpuSrv;
|
|
static Service g_nfpuInterface;
|
|
|
|
static Result _nfpuCreateInterface(void);
|
|
static Result _nfpuInterfaceInitialize(u64 aruid, const NfpuInitConfig *config);
|
|
static Result _nfpuInterfaceFinalize(void);
|
|
|
|
static Result _nfpuInterfaceCmdNoInOut(u64 cmd_id);
|
|
static Result _nfpuInterfaceCmdInIdNoOut(HidControllerID id, u64 cmd_id);
|
|
static Result _nfpuInterfaceCmdInIdOutEvent(HidControllerID id, Event *out, u64 cmd_id);
|
|
static Result _nfpuInterfaceCmdInIdOutBuffer(HidControllerID id, void *buf, size_t buf_size, u64 cmd_id);
|
|
|
|
static Result _nfpuInterfaceInitialize(u64 aruid, const NfpuInitConfig *config);
|
|
static Result _nfpuInterfaceFinalize(void);
|
|
|
|
|
|
// This is the data passed by every application this was tested with
|
|
static const NfpuInitConfig g_nfpuDefaultInitConfig = {
|
|
.unk1 = 0x00000001000a0003,
|
|
.reserved1 = {0},
|
|
.unk2 = 0x0000000300040003,
|
|
.reserved2 = {0},
|
|
};
|
|
|
|
const NfpuInitConfig *nfpuGetDefaultInitConfig(void) {
|
|
return &g_nfpuDefaultInitConfig;
|
|
}
|
|
|
|
Result nfpuInitialize(void) {
|
|
atomicIncrement64(&g_refCnt);
|
|
|
|
if (serviceIsActive(&g_nfpuInterface))
|
|
return 0;
|
|
|
|
// If this fails (for example because we're a sysmodule) aruid stays zero
|
|
u64 aruid = 0;
|
|
appletGetAppletResourceUserId(&aruid);
|
|
|
|
Result rc = smGetService(&g_nfpuSrv, "nfp:user");
|
|
|
|
if (R_SUCCEEDED(rc))
|
|
rc = serviceConvertToDomain(&g_nfpuSrv);
|
|
|
|
if (R_SUCCEEDED(rc))
|
|
rc = _nfpuCreateInterface();
|
|
|
|
if (R_SUCCEEDED(rc))
|
|
rc = _nfpuInterfaceInitialize(aruid, &g_nfpuDefaultInitConfig);
|
|
|
|
if (R_FAILED(rc))
|
|
nfpuExit();
|
|
|
|
return rc;
|
|
}
|
|
|
|
void nfpuExit(void) {
|
|
if (atomicDecrement64(&g_refCnt) == 0) {
|
|
_nfpuInterfaceFinalize();
|
|
serviceClose(&g_nfpuInterface);
|
|
serviceClose(&g_nfpuSrv);
|
|
}
|
|
}
|
|
|
|
Service *nfpuGetInterface(void) {
|
|
return &g_nfpuInterface;
|
|
}
|
|
|
|
static Result _nfpuCreateInterface(void) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuSrv, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 0;
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuSrv);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuSrv, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
|
|
if (R_SUCCEEDED(rc))
|
|
serviceCreateSubservice(&g_nfpuInterface, &g_nfpuSrv, &r, 0);
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static u32 _hidControllerIDToOfficial(HidControllerID id) {
|
|
if (id < CONTROLLER_HANDHELD) return id;
|
|
if (id == CONTROLLER_HANDHELD) return 0x20;
|
|
return 0x10;
|
|
}
|
|
|
|
static HidControllerID _hidOfficialToControllerID(u64 id) {
|
|
if (id < 8) return id;
|
|
if (id == 0x20) return CONTROLLER_HANDHELD;
|
|
return CONTROLLER_UNKNOWN;
|
|
}
|
|
|
|
static Result _nfpuInterfaceCmdNoInOut(u64 cmd_id) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = cmd_id;
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static Result _nfpuInterfaceCmdInIdNoOut(HidControllerID id, u64 cmd_id) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
u64 id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = cmd_id;
|
|
raw->id = _hidControllerIDToOfficial(id);
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static Result _nfpuInterfaceCmdInIdOutEvent(HidControllerID id, Event *out, u64 cmd_id) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
u64 id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = cmd_id;
|
|
raw->id = _hidControllerIDToOfficial(id);
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
|
|
if (R_SUCCEEDED(rc))
|
|
eventLoadRemote(out, r.Handles[0], true);
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static Result _nfpuInterfaceCmdInIdOutBuffer(HidControllerID id, void *buf, size_t buf_size, u64 cmd_id) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
ipcAddRecvStatic(&c, buf, buf_size, 0);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
u64 id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = cmd_id;
|
|
raw->id = _hidControllerIDToOfficial(id);
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static Result _nfpuInterfaceInitialize(u64 aruid, const NfpuInitConfig *config) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
ipcAddSendBuffer(&c, config, sizeof(NfpuInitConfig), BufferType_Normal);
|
|
ipcSendPid(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
u64 aruid;
|
|
u64 zero;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 0;
|
|
raw->aruid = aruid;
|
|
raw->zero = 0;
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static inline Result _nfpuInterfaceFinalize(void) {
|
|
return _nfpuInterfaceCmdNoInOut(1);
|
|
}
|
|
|
|
inline Result nfpuStartDetection(HidControllerID id) {
|
|
return _nfpuInterfaceCmdInIdNoOut(id, 3);
|
|
}
|
|
|
|
inline Result nfpuStopDetection(HidControllerID id) {
|
|
return _nfpuInterfaceCmdInIdNoOut(id, 4);
|
|
}
|
|
|
|
inline Result nfpuAttachActivateEvent(HidControllerID id, Event *out) {
|
|
return _nfpuInterfaceCmdInIdOutEvent(id, out, 17);
|
|
}
|
|
|
|
inline Result nfpuAttachDeactivateEvent(HidControllerID id, Event *out) {
|
|
return _nfpuInterfaceCmdInIdOutEvent(id, out, 18);
|
|
}
|
|
|
|
Result nfpuAttachAvailabilityChangeEvent(Event *out) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 23;
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
|
|
if (R_SUCCEEDED(rc))
|
|
eventLoadRemote(out, r.Handles[0], false);
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
Result nfpuGetState(NfpuState *out) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 19;
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
u32 state;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
|
|
if (R_SUCCEEDED(rc) && out)
|
|
*out = resp->state;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
Result nfpuGetDeviceState(HidControllerID id, NfpuDeviceState *out) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
u64 id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 20;
|
|
raw->id = _hidControllerIDToOfficial(id);
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
u32 state;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
|
|
if (R_SUCCEEDED(rc) && out)
|
|
*out = resp->state;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
Result nfpuListDevices(u32 *count, HidControllerID *out, size_t num_elements) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
size_t buf_size = num_elements * sizeof(u64);
|
|
u64 *buf = malloc(buf_size);
|
|
ipcAddRecvStatic(&c, buf, buf_size, 0);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 2;
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
u32 count;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
if (R_SUCCEEDED(rc) && count && out) {
|
|
*count = resp->count;
|
|
for (u32 i=0; i<resp->count; i++)
|
|
out[i] = _hidOfficialToControllerID(buf[i]);
|
|
}
|
|
}
|
|
|
|
free(buf);
|
|
return rc;
|
|
}
|
|
|
|
Result nfpuGetNpadId(HidControllerID id, u32 *out) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
u64 id;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 21;
|
|
raw->id = _hidControllerIDToOfficial(id);
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
u32 npad_id;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
|
|
if (R_SUCCEEDED(rc) && out)
|
|
*out = resp->npad_id;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
Result nfpuMount(HidControllerID id, NfpuDeviceType device_type, NfpuMountTarget mount_target) {
|
|
IpcCommand c;
|
|
ipcInitialize(&c);
|
|
|
|
struct {
|
|
u64 magic;
|
|
u64 cmd_id;
|
|
u64 id;
|
|
u32 device_type;
|
|
u32 mount_target;
|
|
} *raw;
|
|
|
|
raw = serviceIpcPrepareHeader(&g_nfpuInterface, &c, sizeof(*raw));
|
|
|
|
raw->magic = SFCI_MAGIC;
|
|
raw->cmd_id = 5;
|
|
raw->id = _hidControllerIDToOfficial(id);
|
|
raw->device_type = device_type;
|
|
raw->mount_target = mount_target;
|
|
|
|
Result rc = serviceIpcDispatch(&g_nfpuInterface);
|
|
|
|
if (R_SUCCEEDED(rc)) {
|
|
IpcParsedCommand r;
|
|
struct {
|
|
u64 magic;
|
|
u64 result;
|
|
} *resp;
|
|
|
|
serviceIpcParse(&g_nfpuInterface, &r, sizeof(*resp));
|
|
resp = r.Raw;
|
|
|
|
rc = resp->result;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
inline Result nfpuUnmount(HidControllerID id) {
|
|
return _nfpuInterfaceCmdInIdNoOut(id, 6);
|
|
}
|
|
|
|
inline Result nfpuGetTagInfo(HidControllerID id, NfpuTagInfo *out) {
|
|
return _nfpuInterfaceCmdInIdOutBuffer(id, out, sizeof(NfpuTagInfo), 13);
|
|
}
|
|
|
|
inline Result nfpuGetRegisterInfo(HidControllerID id, NfpuRegisterInfo *out) {
|
|
return _nfpuInterfaceCmdInIdOutBuffer(id, out, sizeof(NfpuRegisterInfo), 14);
|
|
}
|
|
|
|
inline Result nfpuGetCommonInfo(HidControllerID id, NfpuCommonInfo *out) {
|
|
return _nfpuInterfaceCmdInIdOutBuffer(id, out, sizeof(NfpuCommonInfo), 15);
|
|
}
|
|
|
|
inline Result nfpuGetModelInfo(HidControllerID id, NfpuModelInfo *out) {
|
|
return _nfpuInterfaceCmdInIdOutBuffer(id, out, sizeof(NfpuModelInfo), 16);
|
|
}
|