2 * Copyright (C) 2015 Samsung Electronics
3 * Przemyslaw Marczak <p.marczak@samsung.com>
5 * SPDX-License-Identifier: GPL-2.0+
12 #include <power/pmic.h>
13 #include <power/sandbox_pmic.h>
16 * struct sandbox_i2c_pmic_plat_data - platform data for the PMIC
18 * @rw_reg: PMICs register of the chip I/O transaction
19 * @reg: PMICs registers array
21 struct sandbox_i2c_pmic_plat_data {
23 u8 reg[SANDBOX_PMIC_REG_COUNT];
26 static int sandbox_i2c_pmic_read_data(struct udevice *emul, uchar chip,
27 uchar *buffer, int len)
29 struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
31 if (plat->rw_reg + len > SANDBOX_PMIC_REG_COUNT) {
32 pr_err("Request exceeds PMIC register range! Max register: %#x",
33 SANDBOX_PMIC_REG_COUNT);
37 debug("Read PMIC: %#x at register: %#x count: %d\n",
38 (unsigned)chip & 0xff, plat->rw_reg, len);
40 memcpy(buffer, &plat->reg[plat->rw_reg], len);
45 static int sandbox_i2c_pmic_write_data(struct udevice *emul, uchar chip,
46 uchar *buffer, int len,
49 struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
55 /* Set PMIC register for I/O */
56 plat->rw_reg = *buffer;
58 debug("Write PMIC: %#x at register: %#x count: %d\n",
59 (unsigned)chip & 0xff, plat->rw_reg, len);
61 /* For read operation, set (write) only chip reg */
68 if (plat->rw_reg + len > SANDBOX_PMIC_REG_COUNT) {
69 pr_err("Request exceeds PMIC register range! Max register: %#x",
70 SANDBOX_PMIC_REG_COUNT);
73 memcpy(&plat->reg[plat->rw_reg], buffer, len);
78 static int sandbox_i2c_pmic_xfer(struct udevice *emul, struct i2c_msg *msg,
83 for (; nmsgs > 0; nmsgs--, msg++) {
84 bool next_is_read = nmsgs > 1 && (msg[1].flags & I2C_M_RD);
85 if (msg->flags & I2C_M_RD) {
86 ret = sandbox_i2c_pmic_read_data(emul, msg->addr,
89 ret = sandbox_i2c_pmic_write_data(emul, msg->addr,
101 static int sandbox_i2c_pmic_ofdata_to_platdata(struct udevice *emul)
103 struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
104 const u8 *reg_defaults;
106 debug("%s:%d Setting PMIC default registers\n", __func__, __LINE__);
108 reg_defaults = dev_read_u8_array_ptr(emul, "reg-defaults",
109 SANDBOX_PMIC_REG_COUNT);
112 pr_err("Property \"reg-defaults\" not found for device: %s!",
117 memcpy(&plat->reg, reg_defaults, SANDBOX_PMIC_REG_COUNT);
122 struct dm_i2c_ops sandbox_i2c_pmic_emul_ops = {
123 .xfer = sandbox_i2c_pmic_xfer,
126 static const struct udevice_id sandbox_i2c_pmic_ids[] = {
127 { .compatible = "sandbox,i2c-pmic" },
131 U_BOOT_DRIVER(sandbox_i2c_pmic_emul) = {
132 .name = "sandbox_i2c_pmic_emul",
133 .id = UCLASS_I2C_EMUL,
134 .of_match = sandbox_i2c_pmic_ids,
135 .ofdata_to_platdata = sandbox_i2c_pmic_ofdata_to_platdata,
136 .platdata_auto_alloc_size = sizeof(struct sandbox_i2c_pmic_plat_data),
137 .ops = &sandbox_i2c_pmic_emul_ops,