irs: Updated for new-ipc. Improved docs.

This commit is contained in:
yellows8 2019-10-11 22:35:56 -04:00
parent 5b51efe4a8
commit 58346564f7
No known key found for this signature in database
GPG Key ID: 0AF90DA3F1E60E43
2 changed files with 68 additions and 283 deletions

View File

@ -7,7 +7,7 @@
#pragma once #pragma once
#include "../types.h" #include "../types.h"
#include "../services/sm.h" #include "../sf/service.h"
#include "../services/hid.h" #include "../services/hid.h"
typedef struct { typedef struct {
@ -55,12 +55,16 @@ Result irsInitialize(void);
/// Exit irs. /// Exit irs.
void irsExit(void); void irsExit(void);
/// Gets the Service object for the actual irs service session.
Service* irsGetServiceSession(void); Service* irsGetServiceSession(void);
/// Gets the address of the SharedMemory.
void* irsGetSharedmemAddr(void); void* irsGetSharedmemAddr(void);
/// (De)activate the IR sensor, this is automatically used by \ref irsExit. Must be called after irsInitialize() to activate the IR sensor. /// (De)activate the IR sensor, this is automatically used by \ref irsExit. Must be called after irsInitialize() to activate the IR sensor.
Result irsActivateIrsensor(bool activate); Result irsActivateIrsensor(bool activate);
/// Gets the IrCameraHandle for the specified controller.
Result irsGetIrCameraHandle(u32 *IrCameraHandle, HidControllerID id); Result irsGetIrCameraHandle(u32 *IrCameraHandle, HidControllerID id);
/** /**

View File

@ -1,14 +1,11 @@
#define NX_SERVICE_ASSUME_NON_DOMAIN
#include "service_guard.h"
#include <string.h> #include <string.h>
#include "types.h"
#include "result.h"
#include "arm/atomics.h"
#include "kernel/ipc.h"
#include "kernel/shmem.h" #include "kernel/shmem.h"
#include "kernel/tmem.h" #include "kernel/tmem.h"
#include "services/applet.h" #include "services/applet.h"
#include "services/irs.h" #include "services/irs.h"
#include "services/hid.h" #include "services/hid.h"
#include "services/sm.h"
typedef struct { typedef struct {
bool initialized; bool initialized;
@ -17,7 +14,6 @@ typedef struct {
} IrsCameraEntry; } IrsCameraEntry;
static Service g_irsSrv; static Service g_irsSrv;
static u64 g_refCnt;
static SharedMemory g_irsSharedmem; static SharedMemory g_irsSharedmem;
static bool g_irsSensorActivated; static bool g_irsSensorActivated;
@ -25,14 +21,10 @@ static IrsCameraEntry g_irsCameras[8];
static Result _irsGetIrsensorSharedMemoryHandle(Handle* handle_out, u64 AppletResourceUserId); static Result _irsGetIrsensorSharedMemoryHandle(Handle* handle_out, u64 AppletResourceUserId);
Result irsInitialize(void) NX_GENERATE_SERVICE_GUARD(irs);
{
atomicIncrement64(&g_refCnt);
if (serviceIsActive(&g_irsSrv)) Result _irsInitialize(void) {
return 0; Result rc=0;
Result rc;
Handle sharedmem_handle; Handle sharedmem_handle;
g_irsSensorActivated = 0; g_irsSensorActivated = 0;
@ -48,38 +40,37 @@ Result irsInitialize(void)
rc = _irsGetIrsensorSharedMemoryHandle(&sharedmem_handle, AppletResourceUserId); rc = _irsGetIrsensorSharedMemoryHandle(&sharedmem_handle, AppletResourceUserId);
if (R_SUCCEEDED(rc)) if (R_SUCCEEDED(rc)) {
{
shmemLoadRemote(&g_irsSharedmem, sharedmem_handle, 0x8000, Perm_R); shmemLoadRemote(&g_irsSharedmem, sharedmem_handle, 0x8000, Perm_R);
rc = shmemMap(&g_irsSharedmem); rc = shmemMap(&g_irsSharedmem);
} }
if (R_FAILED(rc))
irsExit();
return rc; return rc;
} }
void irsExit(void) void _irsCleanup(void) {
{ size_t entrycount = sizeof(g_irsCameras)/sizeof(IrsCameraEntry);
if (atomicDecrement64(&g_refCnt) == 0) IrsCameraEntry *entry;
{
size_t entrycount = sizeof(g_irsCameras)/sizeof(IrsCameraEntry);
IrsCameraEntry *entry;
int i; for(size_t i=0; i<entrycount; i++) {
for(i=0; i<entrycount; i++) { entry = &g_irsCameras[i];
entry = &g_irsCameras[i]; if (!entry->initialized) continue;
if (!entry->initialized) continue; irsStopImageProcessor(entry->IrCameraHandle);
irsStopImageProcessor(entry->IrCameraHandle);
}
irsActivateIrsensor(0);
serviceClose(&g_irsSrv);
shmemClose(&g_irsSharedmem);
} }
irsActivateIrsensor(0);
serviceClose(&g_irsSrv);
shmemClose(&g_irsSharedmem);
}
Service* irsGetServiceSession(void) {
return &g_irsSrv;
}
void* irsGetSharedmemAddr(void) {
return shmemGetAddr(&g_irsSharedmem);
} }
static Result _IrsCameraEntryAlloc(u32 IrCameraHandle, IrsCameraEntry **out_entry) { static Result _IrsCameraEntryAlloc(u32 IrCameraHandle, IrsCameraEntry **out_entry) {
@ -135,14 +126,6 @@ static void _IrsCameraEntryFree(IrsCameraEntry *entry) {
memset(entry, 0, sizeof(IrsCameraEntry)); memset(entry, 0, sizeof(IrsCameraEntry));
} }
Service* irsGetServiceSession(void) {
return &g_irsSrv;
}
void* irsGetSharedmemAddr(void) {
return shmemGetAddr(&g_irsSharedmem);
}
Result irsActivateIrsensor(bool activate) { Result irsActivateIrsensor(bool activate) {
if (g_irsSensorActivated==activate) return 0; if (g_irsSensorActivated==activate) return 0;
@ -153,116 +136,30 @@ Result irsActivateIrsensor(bool activate) {
if (R_FAILED(rc)) if (R_FAILED(rc))
return rc; return rc;
IpcCommand c; rc = serviceDispatchIn(&g_irsSrv, activate ? 302 : 303, AppletResourceUserId,
ipcInitialize(&c); .in_send_pid = true,
);
struct { if (R_SUCCEEDED(rc)) g_irsSensorActivated = activate;
u64 magic;
u64 cmd_id;
u64 AppletResourceUserId;
} *raw;
ipcSendPid(&c);
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = activate ? 302 : 303;
raw->AppletResourceUserId = AppletResourceUserId;
rc = serviceIpcDispatch(&g_irsSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
ipcParse(&r);
struct {
u64 magic;
u64 result;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc)) g_irsSensorActivated = activate;
}
return rc; return rc;
} }
static Result _irsGetIrsensorSharedMemoryHandle(Handle* handle_out, u64 AppletResourceUserId) { static Result _irsGetIrsensorSharedMemoryHandle(Handle* handle_out, u64 AppletResourceUserId) {
IpcCommand c; return serviceDispatchIn(&g_irsSrv, 304, AppletResourceUserId,
ipcInitialize(&c); .in_send_pid = true,
.out_handle_attrs = { SfOutHandleAttr_HipcCopy },
struct { .out_handles = handle_out,
u64 magic; );
u64 cmd_id;
u64 AppletResourceUserId;
} *raw;
ipcSendPid(&c);
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 304;
raw->AppletResourceUserId = AppletResourceUserId;
Result rc = serviceIpcDispatch(&g_irsSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
ipcParse(&r);
struct {
u64 magic;
u64 result;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc)) {
*handle_out = r.Handles[0];
}
}
return rc;
} }
static Result _irsStopImageProcessor(u32 IrCameraHandle, u64 AppletResourceUserId) { static Result _irsStopImageProcessor(u32 IrCameraHandle, u64 AppletResourceUserId) {
IpcCommand c; const struct {
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 IrCameraHandle; u32 IrCameraHandle;
u64 AppletResourceUserId; u64 AppletResourceUserId;
} *raw; } in = { IrCameraHandle, AppletResourceUserId };
ipcSendPid(&c); return serviceDispatchIn(&g_irsSrv, 305, in,
.in_send_pid = true,
raw = ipcPrepareHeader(&c, sizeof(*raw)); );
raw->magic = SFCI_MAGIC;
raw->cmd_id = 305;
raw->IrCameraHandle = IrCameraHandle;
raw->AppletResourceUserId = AppletResourceUserId;
Result rc = serviceIpcDispatch(&g_irsSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
ipcParse(&r);
struct {
u64 magic;
u64 result;
} *resp = r.Raw;
rc = resp->result;
}
return rc;
} }
Result irsStopImageProcessor(u32 IrCameraHandle) { Result irsStopImageProcessor(u32 IrCameraHandle) {
@ -289,47 +186,19 @@ Result irsStopImageProcessor(u32 IrCameraHandle) {
return rc; return rc;
} }
static Result _irsRunImageTransferProcessor(u32 IrCameraHandle, u64 AppletResourceUserId, IrsPackedImageTransferProcessorConfig *config, Handle transfermem, u64 transfermem_size) { static Result _irsRunImageTransferProcessor(u32 IrCameraHandle, u64 AppletResourceUserId, IrsPackedImageTransferProcessorConfig *config, TransferMemory *tmem) {
IpcCommand c; const struct {
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 IrCameraHandle; u32 IrCameraHandle;
u64 AppletResourceUserId; u64 AppletResourceUserId;
IrsPackedImageTransferProcessorConfig config; IrsPackedImageTransferProcessorConfig config;
u64 TransferMemory_size; u64 TransferMemory_size;
} *raw; } in = { IrCameraHandle, AppletResourceUserId, *config, tmem->size };
ipcSendPid(&c); return serviceDispatchIn(&g_irsSrv, 308, in,
ipcSendHandleCopy(&c, transfermem); .in_send_pid = true,
.in_num_handles = 1,
raw = ipcPrepareHeader(&c, sizeof(*raw)); .in_handles = { tmem->handle },
);
raw->magic = SFCI_MAGIC;
raw->cmd_id = 308;
raw->IrCameraHandle = IrCameraHandle;
raw->AppletResourceUserId = AppletResourceUserId;
raw->TransferMemory_size = transfermem_size;
memcpy(&raw->config, config, sizeof(raw->config));
Result rc = serviceIpcDispatch(&g_irsSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
ipcParse(&r);
struct {
u64 magic;
u64 result;
} *resp = r.Raw;
rc = resp->result;
}
return rc;
} }
Result irsRunImageTransferProcessor(u32 IrCameraHandle, IrsImageTransferProcessorConfig *config, size_t size) { Result irsRunImageTransferProcessor(u32 IrCameraHandle, IrsImageTransferProcessorConfig *config, size_t size) {
@ -358,7 +227,7 @@ Result irsRunImageTransferProcessor(u32 IrCameraHandle, IrsImageTransferProcesso
rc = tmemCreate(&entry->transfermem, size, Perm_None); rc = tmemCreate(&entry->transfermem, size, Perm_None);
if (R_FAILED(rc)) return rc; if (R_FAILED(rc)) return rc;
rc = _irsRunImageTransferProcessor(IrCameraHandle, AppletResourceUserId, &packed_config, entry->transfermem.handle, size); rc = _irsRunImageTransferProcessor(IrCameraHandle, AppletResourceUserId, &packed_config, &entry->transfermem);
if (R_FAILED(rc)) _IrsCameraEntryFree(entry); if (R_FAILED(rc)) _IrsCameraEntryFree(entry);
@ -366,45 +235,16 @@ Result irsRunImageTransferProcessor(u32 IrCameraHandle, IrsImageTransferProcesso
} }
static Result _irsGetImageTransferProcessorState(u32 IrCameraHandle, u64 AppletResourceUserId, void* buffer, size_t size, IrsImageTransferProcessorState *state) { static Result _irsGetImageTransferProcessorState(u32 IrCameraHandle, u64 AppletResourceUserId, void* buffer, size_t size, IrsImageTransferProcessorState *state) {
IpcCommand c; const struct {
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 IrCameraHandle; u32 IrCameraHandle;
u64 AppletResourceUserId; u64 AppletResourceUserId;
} *raw; } in = { IrCameraHandle, AppletResourceUserId };
ipcSendPid(&c); return serviceDispatchInOut(&g_irsSrv, 309, in, *state,
ipcAddRecvBuffer(&c, buffer, size, 0); .buffer_attrs = { SfBufferAttr_HipcMapAlias | SfBufferAttr_Out },
.buffers = { { buffer, size } },
raw = ipcPrepareHeader(&c, sizeof(*raw)); .in_send_pid = true,
);
raw->magic = SFCI_MAGIC;
raw->cmd_id = 309;
raw->IrCameraHandle = IrCameraHandle;
raw->AppletResourceUserId = AppletResourceUserId;
Result rc = serviceIpcDispatch(&g_irsSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
ipcParse(&r);
struct {
u64 magic;
u64 result;
IrsImageTransferProcessorState state;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc) && state)
memcpy(state, &resp->state, sizeof(IrsImageTransferProcessorState));
}
return rc;
} }
Result irsGetImageTransferProcessorState(u32 IrCameraHandle, void* buffer, size_t size, IrsImageTransferProcessorState *state) { Result irsGetImageTransferProcessorState(u32 IrCameraHandle, void* buffer, size_t size, IrsImageTransferProcessorState *state) {
@ -430,78 +270,19 @@ void irsGetDefaultImageTransferProcessorConfig(IrsImageTransferProcessorConfig *
} }
Result irsGetIrCameraHandle(u32 *IrCameraHandle, HidControllerID id) { Result irsGetIrCameraHandle(u32 *IrCameraHandle, HidControllerID id) {
IpcCommand c; u32 tmp = hidControllerIDToOfficial(id);
ipcInitialize(&c); return serviceDispatchInOut(&g_irsSrv, 311, tmp, *IrCameraHandle);
struct {
u64 magic;
u64 cmd_id;
u32 id;
} *raw;
raw = ipcPrepareHeader(&c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 311;
raw->id = hidControllerIDToOfficial(id);
Result rc = serviceIpcDispatch(&g_irsSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
ipcParse(&r);
struct {
u64 magic;
u64 result;
u32 IrCameraHandle;
} *resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc) && IrCameraHandle) {
*IrCameraHandle = resp->IrCameraHandle;
}
}
return rc;
} }
static Result _irsSuspendImageProcessor(u32 IrCameraHandle, u64 AppletResourceUserId) { static Result _irsSuspendImageProcessor(u32 IrCameraHandle, u64 AppletResourceUserId) {
IpcCommand c; const struct {
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 IrCameraHandle; u32 IrCameraHandle;
u64 AppletResourceUserId; u64 AppletResourceUserId;
} *raw; } in = { IrCameraHandle, AppletResourceUserId };
ipcSendPid(&c); return serviceDispatchIn(&g_irsSrv, 313, in,
.in_send_pid = true,
raw = ipcPrepareHeader(&c, sizeof(*raw)); );
raw->magic = SFCI_MAGIC;
raw->cmd_id = 313;
raw->IrCameraHandle = IrCameraHandle;
raw->AppletResourceUserId = AppletResourceUserId;
Result rc = serviceIpcDispatch(&g_irsSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
ipcParse(&r);
struct {
u64 magic;
u64 result;
} *resp = r.Raw;
rc = resp->result;
}
return rc;
} }
Result irsSuspendImageProcessor(u32 IrCameraHandle) { Result irsSuspendImageProcessor(u32 IrCameraHandle) {