diff options
Diffstat (limited to 'tools/src/tps6598x.c')
| -rw-r--r-- | tools/src/tps6598x.c | 172 |
1 files changed, 172 insertions, 0 deletions
diff --git a/tools/src/tps6598x.c b/tools/src/tps6598x.c new file mode 100644 index 0000000..fdb5e11 --- /dev/null +++ b/tools/src/tps6598x.c @@ -0,0 +1,172 @@ +/* SPDX-License-Identifier: MIT */ + +#include "tps6598x.h" +#include "adt.h" +#include "i2c.h" +#include "iodev.h" +#include "malloc.h" +#include "types.h" +#include "utils.h" + +#define TPS_REG_CMD1 0x08 +#define TPS_REG_DATA1 0x09 +#define TPS_REG_INT_EVENT1 0x14 +#define TPS_REG_INT_MASK1 0x16 +#define TPS_REG_INT_CLEAR1 0x18 +#define TPS_REG_POWER_STATE 0x20 +#define TPS_CMD_INVALID 0x21434d44 // !CMD + +struct tps6598x_dev { + i2c_dev_t *i2c; + u8 addr; +}; + +tps6598x_dev_t *tps6598x_init(const char *adt_node, i2c_dev_t *i2c) +{ + int adt_offset; + adt_offset = adt_path_offset(adt, adt_node); + if (adt_offset < 0) { + printf("tps6598x: Error getting %s node\n", adt_node); + return NULL; + } + + const u8 *iic_addr = adt_getprop(adt, adt_offset, "hpm-iic-addr", NULL); + if (iic_addr == NULL) { + printf("tps6598x: Error getting %s hpm-iic-addr\n.", adt_node); + return NULL; + } + + tps6598x_dev_t *dev = malloc(sizeof(*dev)); + if (!dev) + return NULL; + + dev->i2c = i2c; + dev->addr = *iic_addr; + return dev; +} + +void tps6598x_shutdown(tps6598x_dev_t *dev) +{ + free(dev); +} + +int tps6598x_command(tps6598x_dev_t *dev, const char *cmd, const u8 *data_in, size_t len_in, + u8 *data_out, size_t len_out) +{ + if (len_in) { + if (i2c_smbus_write(dev->i2c, dev->addr, TPS_REG_DATA1, data_in, len_in) < 0) + return -1; + } + + if (i2c_smbus_write(dev->i2c, dev->addr, TPS_REG_CMD1, (const u8 *)cmd, 4) < 0) + return -1; + + u32 cmd_status; + do { + if (i2c_smbus_read32(dev->i2c, dev->addr, TPS_REG_CMD1, &cmd_status)) + return -1; + if (cmd_status == TPS_CMD_INVALID) + return -1; + udelay(100); + } while (cmd_status != 0); + + if (len_out) { + if (i2c_smbus_read(dev->i2c, dev->addr, TPS_REG_DATA1, data_out, len_out) != + (ssize_t)len_out) + return -1; + } + + return 0; +} + +int tps6598x_disable_irqs(tps6598x_dev_t *dev, tps6598x_irq_state_t *state) +{ + size_t read; + int written; + static const u8 zeros[CD3218B12_IRQ_WIDTH] = {0x00}; + static const u8 ones[CD3218B12_IRQ_WIDTH] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, + 0xFF, 0xFF, 0xFF, 0xFF}; + + // store IntEvent 1 to restore it later + read = i2c_smbus_read(dev->i2c, dev->addr, TPS_REG_INT_MASK1, state->int_mask1, + sizeof(state->int_mask1)); + if (read != CD3218B12_IRQ_WIDTH) { + printf("tps6598x: reading TPS_REG_INT_MASK1 failed\n"); + return -1; + } + state->valid = 1; + + // mask interrupts and ack all interrupt flags + written = i2c_smbus_write(dev->i2c, dev->addr, TPS_REG_INT_CLEAR1, ones, sizeof(ones)); + if (written != sizeof(zeros)) { + printf("tps6598x: writing TPS_REG_INT_CLEAR1 failed, written: %d\n", written); + return -1; + } + written = i2c_smbus_write(dev->i2c, dev->addr, TPS_REG_INT_MASK1, zeros, sizeof(zeros)); + if (written != sizeof(ones)) { + printf("tps6598x: writing TPS_REG_INT_MASK1 failed, written: %d\n", written); + return -1; + } + +#ifdef DEBUG + u8 tmp[CD3218B12_IRQ_WIDTH] = {0x00}; + read = i2c_smbus_read(dev->i2c, dev->addr, TPS_REG_INT_MASK1, tmp, CD3218B12_IRQ_WIDTH); + if (read != CD3218B12_IRQ_WIDTH) + printf("tps6598x: failed verifcation, can't read TPS_REG_INT_MASK1\n"); + else { + printf("tps6598x: verify: TPS_REG_INT_MASK1 vs. saved IntMask1\n"); + hexdump(tmp, sizeof(tmp)); + hexdump(state->int_mask1, sizeof(state->int_mask1)); + } +#endif + return 0; +} + +int tps6598x_restore_irqs(tps6598x_dev_t *dev, tps6598x_irq_state_t *state) +{ + int written; + + written = i2c_smbus_write(dev->i2c, dev->addr, TPS_REG_INT_MASK1, state->int_mask1, + sizeof(state->int_mask1)); + if (written != sizeof(state->int_mask1)) { + printf("tps6598x: restoring TPS_REG_INT_MASK1 failed\n"); + return -1; + } + +#ifdef DEBUG + int read; + u8 tmp[CD3218B12_IRQ_WIDTH]; + read = i2c_smbus_read(dev->i2c, dev->addr, TPS_REG_INT_MASK1, tmp, sizeof(tmp)); + if (read != sizeof(tmp)) + printf("tps6598x: failed verifcation, can't read TPS_REG_INT_MASK1\n"); + else { + printf("tps6598x: verify saved IntMask1 vs. TPS_REG_INT_MASK1:\n"); + hexdump(state->int_mask1, sizeof(state->int_mask1)); + hexdump(tmp, sizeof(tmp)); + } +#endif + + return 0; +} + +int tps6598x_powerup(tps6598x_dev_t *dev) +{ + u8 power_state; + + if (i2c_smbus_read8(dev->i2c, dev->addr, TPS_REG_POWER_STATE, &power_state)) + return -1; + + if (power_state == 0) + return 0; + + const u8 data = 0; + tps6598x_command(dev, "SSPS", &data, 1, NULL, 0); + + if (i2c_smbus_read8(dev->i2c, dev->addr, TPS_REG_POWER_STATE, &power_state)) + return -1; + + if (power_state != 0) + return -1; + + return 0; +} |