libnx/nx/source/services/hiddbg.c
2019-06-28 21:39:33 -04:00

728 lines
17 KiB
C

#include <string.h>
#include "types.h"
#include "result.h"
#include "arm/atomics.h"
#include "kernel/ipc.h"
#include "kernel/tmem.h"
#include "services/hiddbg.h"
#include "services/hid.h"
#include "services/sm.h"
#include "runtime/hosversion.h"
static Service g_hiddbgSrv;
static u64 g_hiddbgRefCnt;
static size_t g_hiddbgPtrbufsize;
static bool g_hiddbgHdlsInitialized;
static TransferMemory g_hiddbgHdlsTmem;
Result hiddbgInitialize(void) {
atomicIncrement64(&g_hiddbgRefCnt);
if (serviceIsActive(&g_hiddbgSrv))
return 0;
Result rc = smGetService(&g_hiddbgSrv, "hid:dbg");
if (R_SUCCEEDED(rc)) rc = ipcQueryPointerBufferSize(g_hiddbgSrv.handle, &g_hiddbgPtrbufsize);
if (R_FAILED(rc)) hiddbgExit();
return rc;
}
void hiddbgExit(void) {
if (atomicDecrement64(&g_hiddbgRefCnt) == 0) {
serviceClose(&g_hiddbgSrv);
}
}
static Result _hiddbgCmdNoIO(u64 cmd_id) {
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = cmd_id;
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
static Result _hiddbgCmdInU8NoOut(u64 cmd_id, u8 val) {
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u8 val;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = cmd_id;
raw->val = val;
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
static Result _hiddbgCmdInU64NoOut(u64 cmd_id, u64 val) {
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u64 val;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = cmd_id;
raw->val = val;
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
Result hiddbgUpdateControllerColor(u32 colorBody, u32 colorButtons, u64 UniquePadId) {
if (hosversionBefore(3,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 colorBody;
u32 colorButtons;
u64 UniquePadId;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 221;
raw->colorBody = colorBody;
raw->colorButtons = colorButtons;
raw->UniquePadId = UniquePadId;
Result rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
Result hiddbgUpdateDesignInfo(u32 colorBody, u32 colorButtons, u32 colorLeftGrip, u32 colorRightGrip, u8 inval, u64 UniquePadId) {
if (hosversionBefore(5,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 colorBody;
u32 colorButtons;
u32 colorLeftGrip;
u32 colorRightGrip;
u8 inval;
u64 UniquePadId;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 224;
raw->colorBody = colorBody;
raw->colorButtons = colorButtons;
raw->colorLeftGrip = colorLeftGrip;
raw->colorRightGrip = colorRightGrip;
raw->inval = inval;
raw->UniquePadId = UniquePadId;
Result rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
static Result _hiddbgReadSerialFlash(TransferMemory *tmem, u32 offset, u64 size, u64 UniquePadId) {
IpcCommand c;
ipcInitialize(&c);
ipcSendHandleCopy(&c, tmem->handle);
struct {
u64 magic;
u64 cmd_id;
u32 offset;
u64 size;
u64 UniquePadId;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 229;
raw->offset = offset;
raw->size = size;
raw->UniquePadId = UniquePadId;
Result rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
Result hiddbgReadSerialFlash(u32 offset, void* buffer, size_t size, u64 UniquePadId) {
Result rc=0;
TransferMemory tmem;
size_t sizealign = (size+0x1000) & ~0xfff;
if (hosversionBefore(6,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
rc = tmemCreate(&tmem, sizealign, Perm_Rw);
if (R_FAILED(rc)) return rc;
rc = _hiddbgReadSerialFlash(&tmem, offset, size, UniquePadId);
if (R_SUCCEEDED(rc)) memcpy(buffer, tmem.src_addr, size);
tmemClose(&g_hiddbgHdlsTmem);
return rc;
}
Result hiddbgGetAbstractedPadHandles(u64 *AbstractedPadHandles, s32 count, s32 *total_entries) {
if (hosversionBefore(5,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
} *raw;
ipcAddRecvStatic(&c, AbstractedPadHandles, sizeof(u64)*count, 0);
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 301;
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
s32 total_entries;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
if (R_SUCCEEDED(rc) && total_entries) *total_entries = resp->total_entries;
}
return rc;
}
Result hiddbgGetAbstractedPadState(u64 AbstractedPadHandle, HiddbgAbstractedPadState *state) {
if (hosversionBefore(5,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u64 AbstractedPadHandle;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 302;
raw->AbstractedPadHandle = AbstractedPadHandle;
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
HiddbgAbstractedPadState state;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
if (R_SUCCEEDED(rc) && state) memcpy(state, &resp->state, sizeof(*state));
}
return rc;
}
Result hiddbgGetAbstractedPadsState(u64 *AbstractedPadHandles, HiddbgAbstractedPadState *states, s32 count, s32 *total_entries) {
if (hosversionBefore(5,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
} *raw;
ipcAddRecvStatic(&c, AbstractedPadHandles, sizeof(u64)*count, 0);
ipcAddRecvSmart(&c, g_hiddbgPtrbufsize, states, sizeof(HiddbgAbstractedPadState)*count, 0);
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 303;
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
s32 total_entries;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
if (R_SUCCEEDED(rc) && total_entries) *total_entries = resp->total_entries;
}
return rc;
}
Result hiddbgSetAutoPilotVirtualPadState(s8 AbstractedVirtualPadId, const HiddbgAbstractedPadState *state) {
if (hosversionBefore(5,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
s8 AbstractedVirtualPadId;
u8 pad[7];
HiddbgAbstractedPadState state;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 321;
raw->AbstractedVirtualPadId = AbstractedVirtualPadId;
memcpy(&raw->state, state, sizeof(*state));
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
}
return rc;
}
Result hiddbgUnsetAutoPilotVirtualPadState(s8 AbstractedVirtualPadId) {
if (hosversionBefore(5,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
Result rc;
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
s8 AbstractedVirtualPadId;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 322;
raw->AbstractedVirtualPadId = AbstractedVirtualPadId;
rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
}
return rc;
}
Result hiddbgUnsetAllAutoPilotVirtualPadState(void) {
if (hosversionBefore(5,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
return _hiddbgCmdNoIO(323);
}
static Result _hiddbgAttachHdlsWorkBuffer(TransferMemory *tmem) {
IpcCommand c;
ipcInitialize(&c);
ipcSendHandleCopy(&c, tmem->handle);
struct {
u64 magic;
u64 cmd_id;
u64 size;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 324;
raw->size = tmem->size;
Result rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
Result hiddbgAttachHdlsWorkBuffer(void) {
Result rc=0;
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_AlreadyInitialized);
rc = tmemCreate(&g_hiddbgHdlsTmem, 0x1000, Perm_Rw);
if (R_FAILED(rc)) return rc;
rc = _hiddbgAttachHdlsWorkBuffer(&g_hiddbgHdlsTmem);
if (R_FAILED(rc)) tmemClose(&g_hiddbgHdlsTmem);
if (R_SUCCEEDED(rc)) g_hiddbgHdlsInitialized = true;
return rc;
}
Result hiddbgReleaseHdlsWorkBuffer(void) {
Result rc=0;
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
g_hiddbgHdlsInitialized = false;
rc = _hiddbgCmdNoIO(325);
tmemClose(&g_hiddbgHdlsTmem);
return rc;
}
Result hiddbgDumpHdlsNpadAssignmentState(HiddbgHdlsNpadAssignment *state) {
Result rc=0;
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
rc = _hiddbgCmdNoIO(326);
if (R_FAILED(rc)) return rc;
if (state) memcpy(state, g_hiddbgHdlsTmem.src_addr, sizeof(*state));
return rc;
}
Result hiddbgDumpHdlsStates(HiddbgHdlsStateList *state) {
Result rc=0;
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
rc = _hiddbgCmdNoIO(327);
if (R_FAILED(rc)) return rc;
if (state) memcpy(state, g_hiddbgHdlsTmem.src_addr, sizeof(*state));
return rc;
}
Result hiddbgApplyHdlsNpadAssignmentState(const HiddbgHdlsNpadAssignment *state, bool flag) {
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
if (state==NULL)
return MAKERESULT(Module_Libnx, LibnxError_BadInput);
memcpy(g_hiddbgHdlsTmem.src_addr, state, sizeof(*state));
return _hiddbgCmdInU8NoOut(328, flag!=0);
}
Result hiddbgApplyHdlsStateList(const HiddbgHdlsStateList *state) {
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
if (state==NULL)
return MAKERESULT(Module_Libnx, LibnxError_BadInput);
memcpy(g_hiddbgHdlsTmem.src_addr, state, sizeof(*state));
return _hiddbgCmdNoIO(329);
}
static Result _hiddbgAttachHdlsVirtualDevice(u64 *HdlsHandle, const HiddbgHdlsDeviceInfo *info) {
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
HiddbgHdlsDeviceInfo info;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 330;
raw->info = *info;
Result rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
u64 handle;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc) && HdlsHandle) *HdlsHandle = resp->handle;
}
return rc;
}
Result hiddbgAttachHdlsVirtualDevice(u64 *HdlsHandle, const HiddbgHdlsDeviceInfo *info) {
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
return _hiddbgAttachHdlsVirtualDevice(HdlsHandle, info);
}
Result hiddbgDetachHdlsVirtualDevice(u64 HdlsHandle) {
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
return _hiddbgCmdInU64NoOut(331, HdlsHandle);
}
static Result _hiddbgSetHdlsState(u64 HdlsHandle, const HiddbgHdlsState *state) {
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
HiddbgHdlsState state;
u64 handle;
} *raw;
raw = serviceIpcPrepareHeader(&g_hiddbgSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 332;
memcpy(&raw->state, state, sizeof(*state));
raw->handle = HdlsHandle;
Result rc = serviceIpcDispatch(&g_hiddbgSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_hiddbgSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
Result hiddbgSetHdlsState(u64 HdlsHandle, const HiddbgHdlsState *state) {
if (hosversionBefore(7,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
if (!g_hiddbgHdlsInitialized)
return MAKERESULT(Module_Libnx, LibnxError_NotInitialized);
return _hiddbgSetHdlsState(HdlsHandle, state);
}