mika/libnx
1
0
Fork 0
mirror of https://github.com/switchbrew/libnx.git synced 2025-06-21 12:32:40 +02:00
Code Issues Packages Projects Releases Wiki Activity

pcv: update for new-ipc

Browse Source
This commit is contained in:
Michael Scire 2019-10-18 22:42:01 -07:00 committed by fincs
parent 16fde00323
commit 960f99e7a2
No known key found for this signature in database
GPG Key ID: 62C7609ADA219C60
2 changed files with 33 additions and 167 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
nx/include/switch/services/pcv.h
View File

@ -6,7 +6,7 @@
*/
#pragma once
#include "../types.h"
#include "../services/sm.h"
#include "../sf/service.h"
typedef enum {
PcvModule_CpuBus = 0,
@ -197,7 +197,11 @@ Service* pcvGetServiceSession(void);
Result pcvGetModuleId(PcvModuleId *module_id, PcvModule module);
/// Only available on [1.0.0-7.0.1].
Result pcvGetClockRate(PcvModule module, u32 *out_hz);
/// Only available on [1.0.0-7.0.1].
Result pcvSetClockRate(PcvModule module, u32 hz);
Result pcvSetVoltageEnabled(bool state, u32 voltage);
Result pcvGetVoltageEnabled(bool *isEnabled, u32 voltage);
/// Only available on [1.0.0-7.0.1].
Result pcvSetVoltageEnabled(u32 power_domain, bool state);
/// Only available on [1.0.0-7.0.1].
Result pcvGetVoltageEnabled(bool *isEnabled, u32 power_domain);

190
nx/source/services/pcv.c
View File

@ -1,33 +1,18 @@
#include "types.h"
#include "result.h"
#include "arm/atomics.h"
#include "kernel/ipc.h"
#include "runtime/hosversion.h"
#define NX_SERVICE_ASSUME_NON_DOMAIN
#include "service_guard.h"
#include "services/pcv.h"
#include "services/sm.h"
#include "runtime/hosversion.h"
static Service g_pcvSrv;
static u64 g_refCnt;
Result pcvInitialize(void) {
Result rc = 0;
atomicIncrement64(&g_refCnt);
NX_GENERATE_SERVICE_GUARD(pcv);
if (serviceIsActive(&g_pcvSrv))
return 0;
rc = smGetService(&g_pcvSrv, "pcv");
if (R_FAILED(rc)) pcvExit();
return rc;
Result _pcvInitialize(void) {
return smGetService(&g_pcvSrv, "pcv");
}
void pcvExit(void) {
if (atomicDecrement64(&g_refCnt) == 0) {
serviceClose(&g_pcvSrv);
}
void _pcvCleanup(void) {
serviceClose(&g_pcvSrv);
}
Service* pcvGetServiceSession(void) {
@ -69,166 +54,43 @@ Result pcvGetModuleId(PcvModuleId *module_id, PcvModule module) {
}
Result pcvSetClockRate(PcvModule module, u32 hz) {
if(hosversionAtLeast(8,0,0)) {
if(hosversionAtLeast(8,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
}
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
const struct {
u32 module;
u32 hz;
} *raw;
raw = serviceIpcPrepareHeader(&g_pcvSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 2;
raw->module = module;
raw->hz = hz;
Result rc = serviceIpcDispatch(&g_pcvSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_pcvSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
} in = { module, hz };
return serviceDispatchIn(&g_pcvSrv, 2, in);
}
Result pcvGetClockRate(PcvModule module, u32 *out_hz) {
if(hosversionAtLeast(8,0,0)) {
if(hosversionAtLeast(8,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
}
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
u32 module;
} *raw;
raw = serviceIpcPrepareHeader(&g_pcvSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 3;
raw->module = module;
Result rc = serviceIpcDispatch(&g_pcvSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
u32 hz;
} *resp;
serviceIpcParse(&g_pcvSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
if (R_SUCCEEDED(rc)) {
*out_hz = resp->hz;
}
}
return rc;
const u32 in = module;
return serviceDispatchInOut(&g_pcvSrv, 3, in, *out_hz);
}
Result pcvSetVoltageEnabled(bool state, u32 voltage) {
if(hosversionAtLeast(8,0,0)) {
Result pcvSetVoltageEnabled(u32 power_domain, bool state) {
if(hosversionAtLeast(8,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
}
IpcCommand c;
ipcInitialize(&c);
struct {
u64 magic;
u64 cmd_id;
const struct {
u8 state;
u32 voltage;
} *raw;
raw = serviceIpcPrepareHeader(&g_pcvSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 8;
raw->state = (u8)state;
raw->voltage = voltage;
Result rc = serviceIpcDispatch(&g_pcvSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&g_pcvSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
u32 power_domain;
} in = { state != 0, power_domain };
return serviceDispatchIn(&g_pcvSrv, 8, in);
}
Result pcvGetVoltageEnabled(bool *isEnabled, u32 voltage) {
if(hosversionAtLeast(8,0,0)) {
Result pcvGetVoltageEnabled(bool *isEnabled, u32 power_domain) {
if(hosversionAtLeast(8,0,0))
return MAKERESULT(Module_Libnx, LibnxError_IncompatSysVer);
}
IpcCommand c;
ipcInitialize(&c);
u8 tmp = 0;
Result rc = serviceDispatchInOut(&g_pcvSrv, 9, power_domain, tmp);
struct {
u64 magic;
u64 cmd_id;
u32 voltage;
} *raw;
raw = serviceIpcPrepareHeader(&g_pcvSrv, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 9;
raw->voltage = voltage;
Result rc = serviceIpcDispatch(&g_pcvSrv);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
u8 isEnabled;
} *resp;
serviceIpcParse(&g_pcvSrv, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
if(R_SUCCEEDED(rc) && isEnabled) {
*isEnabled = (bool)resp->isEnabled;
}
}
if (R_SUCCEEDED(rc) && isEnabled) *isEnabled = tmp & 1;
return rc;
}