hoc-overlay: add fan control feature to sysmodule
This commit is contained in:
82
Source/sys-clk/sysmodule/src/i2c.h
Normal file
82
Source/sys-clk/sysmodule/src/i2c.h
Normal file
@@ -0,0 +1,82 @@
|
||||
#ifndef I2C_H
|
||||
#define I2C_H
|
||||
|
||||
#include <switch.h>
|
||||
|
||||
Result I2cReadRegHandler16(u8 reg, I2cDevice dev, u16 *out)
|
||||
{
|
||||
struct readReg {
|
||||
u8 send;
|
||||
u8 sendLength;
|
||||
u8 sendData;
|
||||
u8 receive;
|
||||
u8 receiveLength;
|
||||
};
|
||||
|
||||
I2cSession _session;
|
||||
|
||||
Result res = i2cOpenSession(&_session, dev);
|
||||
if (res)
|
||||
return res;
|
||||
|
||||
u16 val;
|
||||
|
||||
struct readReg readRegister = {
|
||||
.send = 0 | (I2cTransactionOption_Start << 6),
|
||||
.sendLength = sizeof(reg),
|
||||
.sendData = reg,
|
||||
.receive = 1 | (I2cTransactionOption_All << 6),
|
||||
.receiveLength = sizeof(val),
|
||||
};
|
||||
|
||||
res = i2csessionExecuteCommandList(&_session, &val, sizeof(val), &readRegister, sizeof(readRegister));
|
||||
if (res)
|
||||
{
|
||||
i2csessionClose(&_session);
|
||||
return res;
|
||||
}
|
||||
|
||||
*out = val;
|
||||
i2csessionClose(&_session);
|
||||
return 0;
|
||||
}
|
||||
|
||||
Result I2cReadRegHandler8(u8 reg, I2cDevice dev, u8 *out)
|
||||
{
|
||||
struct readReg {
|
||||
u8 send;
|
||||
u8 sendLength;
|
||||
u8 sendData;
|
||||
u8 receive;
|
||||
u8 receiveLength;
|
||||
};
|
||||
|
||||
I2cSession _session;
|
||||
|
||||
Result res = i2cOpenSession(&_session, dev);
|
||||
if (res)
|
||||
return res;
|
||||
|
||||
u8 val;
|
||||
|
||||
struct readReg readRegister = {
|
||||
.send = 0 | (I2cTransactionOption_Start << 6),
|
||||
.sendLength = sizeof(reg),
|
||||
.sendData = reg,
|
||||
.receive = 1 | (I2cTransactionOption_All << 6),
|
||||
.receiveLength = sizeof(val),
|
||||
};
|
||||
|
||||
res = i2csessionExecuteCommandList(&_session, &val, sizeof(val), &readRegister, sizeof(readRegister));
|
||||
if (res)
|
||||
{
|
||||
i2csessionClose(&_session);
|
||||
return res;
|
||||
}
|
||||
|
||||
*out = val;
|
||||
i2csessionClose(&_session);
|
||||
return 0;
|
||||
}
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user