i2c: add ReceiveAudo and ExecuteCommandList

Also make buf const in SendAuto.
This commit is contained in:
Thomas Guillemard 2019-05-17 21:20:05 +02:00
parent d966bee9fa
commit e05d0b0cb6
No known key found for this signature in database
GPG Key ID: 0CD291558FAFDBC6
2 changed files with 73 additions and 2 deletions

View File

@ -60,5 +60,7 @@ void i2cExit(void);
Result i2cOpenSession(I2cSession *out, I2cDevice dev);
Result i2csessionSendAuto(I2cSession *s, void *buf, size_t size, I2cTransactionOption option);
Result i2csessionSendAuto(I2cSession *s, const void *buf, size_t size, I2cTransactionOption option);
Result i2csessionReceiveAuto(I2cSession *s, void *buf, size_t size, I2cTransactionOption option);
Result i2csessionExecuteCommandList(I2cSession *s, void *dst, size_t dst_size, const void *cmd_list, size_t cmd_list_size);
void i2csessionClose(I2cSession *s);

View File

@ -71,7 +71,7 @@ Result i2cOpenSession(I2cSession *out, I2cDevice dev) {
return rc;
}
Result i2csessionSendAuto(I2cSession *s, void *buf, size_t size, I2cTransactionOption option) {
Result i2csessionSendAuto(I2cSession *s, const void *buf, size_t size, I2cTransactionOption option) {
IpcCommand c;
ipcInitialize(&c);
ipcAddSendSmart(&c, g_i2cSrvPtrBufSize, buf, size, 0);
@ -106,6 +106,75 @@ Result i2csessionSendAuto(I2cSession *s, void *buf, size_t size, I2cTransactionO
return rc;
}
Result i2csessionReceiveAuto(I2cSession *s, void *buf, size_t size, I2cTransactionOption option) {
IpcCommand c;
ipcInitialize(&c);
ipcAddRecvSmart(&c, g_i2cSrvPtrBufSize, buf, size, 0);
struct {
u64 magic;
u64 cmd_id;
u32 option;
} *raw;
raw = serviceIpcPrepareHeader(&s->s, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 11;
raw->option = option;
Result rc = serviceIpcDispatch(&s->s);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&s->s, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
Result i2csessionExecuteCommandList(I2cSession *s, void *dst, size_t dst_size, const void *cmd_list, size_t cmd_list_size) {
IpcCommand c;
ipcInitialize(&c);
ipcAddSendStatic(&c, cmd_list, cmd_list_size, 0);
ipcAddRecvSmart(&c, g_i2cSrvPtrBufSize, dst, dst_size, 0);
struct {
u64 magic;
u64 cmd_id;
} *raw;
raw = serviceIpcPrepareHeader(&s->s, &c, sizeof(*raw));
raw->magic = SFCI_MAGIC;
raw->cmd_id = 12;
Result rc = serviceIpcDispatch(&s->s);
if (R_SUCCEEDED(rc)) {
IpcParsedCommand r;
struct {
u64 magic;
u64 result;
} *resp;
serviceIpcParse(&s->s, &r, sizeof(*resp));
resp = r.Raw;
rc = resp->result;
}
return rc;
}
void i2csessionClose(I2cSession *s) {
serviceClose(&s->s);
}