paulbsd/pinephone-keyboard
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Make charger tool read/write data from charger via MCU I2C proxy commands

Browse Source
This commit is contained in:
Ondrej Jirman 2021-09-05 01:59:38 +02:00
parent 21374993b3
commit a049cd5107
1 changed files with 68 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

74
i2c-charger-ctl.c
View File

@ -18,6 +18,7 @@
*/ */
#include "common.c" #include "common.c"
#include "firmware/registers.h"
/* /*
* - Independent control of * - Independent control of
@ -113,9 +114,11 @@ uint8_t read_power(int fd, uint8_t reg)
{ {
int ret; int ret;
uint8_t val; uint8_t val;
// initiate read of data from the charger
uint8_t buf[4] = { REG_SYS_CHG_ADDR, reg, 0xAA, REG_SYS_COMMAND_CHG_READ };
struct i2c_msg msgs[] = { struct i2c_msg msgs[] = {
{ POWER_ADDR, 0, 1, &reg }, // address { KB_ADDR, 0, 4, buf },
{ POWER_ADDR, I2C_M_RD, 1, &val },
}; };
struct i2c_rdwr_ioctl_data msg = { struct i2c_rdwr_ioctl_data msg = {
@ -126,19 +129,50 @@ uint8_t read_power(int fd, uint8_t reg)
ret = ioctl(fd, I2C_RDWR, &msg); ret = ioctl(fd, I2C_RDWR, &msg);
syscall_error(ret < 0, "I2C_RDWR failed"); syscall_error(ret < 0, "I2C_RDWR failed");
return val; for (int i = 0; i < 5; i++) {
usleep(2000);
// read the result
uint8_t buf2[1] = { REG_SYS_CHG_DATA, };
uint8_t buf3[2] = { };
struct i2c_msg msgs2[] = {
{ KB_ADDR, 0, 1, buf2 },
{ KB_ADDR, I2C_M_RD, sizeof(buf3), buf3 },
};
struct i2c_rdwr_ioctl_data msg2 = {
.msgs = msgs2,
.nmsgs = sizeof(msgs2) / sizeof(msgs2[0])
};
ret = ioctl(fd, I2C_RDWR, &msg2);
syscall_error(ret < 0, "I2C_RDWR failed");
// debug("rd %02x %02x\n", buf3[0], buf3[1]);
if (buf3[1] == REG_SYS_COMMAND_CHG_READ)
continue;
if (buf3[1] == 0)
return buf3[0];
if (buf3[1] == 0xff)
error("Proxy read failed with %x\n", buf3[1]);
}
error("Proxy read timed out\n");
return 0;
} }
void write_power(int fd, uint8_t reg, uint8_t val) void write_power(int fd, uint8_t reg, uint8_t val)
{ {
int ret; int ret;
uint8_t buf[] = {reg, val};
uint8_t buf[4] = { REG_SYS_CHG_ADDR, reg, val, REG_SYS_COMMAND_CHG_WRITE };
struct i2c_msg msgs[] = { struct i2c_msg msgs[] = {
{ POWER_ADDR, 0, 2, buf }, { KB_ADDR, 0, 4, buf },
}; };
debug("wr 0x%02hhx: %02hhx\n", reg, val); // debug("wr 0x%02hhx: %02hhx\n", reg, val);
struct i2c_rdwr_ioctl_data msg = { struct i2c_rdwr_ioctl_data msg = {
.msgs = msgs, .msgs = msgs,
@ -147,6 +181,34 @@ void write_power(int fd, uint8_t reg, uint8_t val)
ret = ioctl(fd, I2C_RDWR, &msg); ret = ioctl(fd, I2C_RDWR, &msg);
syscall_error(ret < 0, "I2C_RDWR failed"); syscall_error(ret < 0, "I2C_RDWR failed");
for (int i = 0; i < 5; i++) {
usleep(2000);
// read the result
uint8_t buf2[1] = { REG_SYS_COMMAND, };
uint8_t buf3[1] = { };
struct i2c_msg msgs2[] = {
{ KB_ADDR, 0, 1, buf2 },
{ KB_ADDR, I2C_M_RD, sizeof(buf3), buf3 },
};
struct i2c_rdwr_ioctl_data msg2 = {
.msgs = msgs2,
.nmsgs = sizeof(msgs2) / sizeof(msgs2[0])
};
ret = ioctl(fd, I2C_RDWR, &msg2);
syscall_error(ret < 0, "I2C_RDWR failed");
if (buf3[1] == REG_SYS_COMMAND_CHG_WRITE)
continue;
if (buf3[1] == 0)
return;
if (buf3[1] == 0xff)
error("Proxy write failed with %x\n", buf3[0]);
}
} }
void update_power(int fd, uint8_t reg, uint8_t mask, uint8_t val) void update_power(int fd, uint8_t reg, uint8_t mask, uint8_t val)