1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2015 Samsung Electronics
4 * Przemyslaw Marczak <p.marczak@samsung.com>
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 {
29 static int sandbox_i2c_pmic_read_data(struct udevice *emul, uchar chip,
30 uchar *buffer, int len)
32 struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
34 if (plat->rw_idx + len > plat->buf_size) {
35 pr_err("Request exceeds PMIC register range! Max register: %#x",
40 debug("Read PMIC: %#x at register: %#x idx: %#x count: %d\n",
41 (unsigned int)chip & 0xff, plat->rw_reg, plat->rw_idx, len);
43 memcpy(buffer, plat->reg + plat->rw_idx, len);
48 static int sandbox_i2c_pmic_write_data(struct udevice *emul, uchar chip,
49 uchar *buffer, int len,
52 struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
58 /* Set PMIC register for I/O */
59 plat->rw_reg = *buffer;
60 plat->rw_idx = plat->rw_reg * plat->trans_len;
62 debug("Write PMIC: %#x at register: %#x idx: %#x count: %d\n",
63 (unsigned int)chip & 0xff, plat->rw_reg, plat->rw_idx, len);
65 /* For read operation, set (write) only chip reg */
72 if (plat->rw_idx + len > plat->buf_size) {
73 pr_err("Request exceeds PMIC register range! Max register: %#x",
77 memcpy(plat->reg + plat->rw_idx, buffer, len);
82 static int sandbox_i2c_pmic_xfer(struct udevice *emul, struct i2c_msg *msg,
87 for (; nmsgs > 0; nmsgs--, msg++) {
88 bool next_is_read = nmsgs > 1 && (msg[1].flags & I2C_M_RD);
89 if (msg->flags & I2C_M_RD) {
90 ret = sandbox_i2c_pmic_read_data(emul, msg->addr,
93 ret = sandbox_i2c_pmic_write_data(emul, msg->addr,
105 static int sandbox_i2c_pmic_ofdata_to_platdata(struct udevice *emul)
107 struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
108 struct udevice *pmic_dev = i2c_emul_get_device(emul);
110 debug("%s:%d Setting PMIC default registers\n", __func__, __LINE__);
111 plat->reg_count = pmic_reg_count(pmic_dev);
116 static int sandbox_i2c_pmic_probe(struct udevice *emul)
118 struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
119 struct udevice *pmic_dev = i2c_emul_get_device(emul);
120 struct uc_pmic_priv *upriv = dev_get_uclass_priv(pmic_dev);
121 const u8 *reg_defaults;
123 plat->trans_len = upriv->trans_len;
124 plat->buf_size = plat->reg_count * plat->trans_len;
126 plat->reg = calloc(1, plat->buf_size);
128 debug("Canot allocate memory (%d B) for PMIC I2C emulation!\n",
133 reg_defaults = dev_read_u8_array_ptr(emul, "reg-defaults",
137 pr_err("Property \"reg-defaults\" not found for device: %s!",
143 memcpy(plat->reg, reg_defaults, plat->buf_size);
148 struct dm_i2c_ops sandbox_i2c_pmic_emul_ops = {
149 .xfer = sandbox_i2c_pmic_xfer,
152 static const struct udevice_id sandbox_i2c_pmic_ids[] = {
153 { .compatible = "sandbox,i2c-pmic" },
157 U_BOOT_DRIVER(sandbox_i2c_pmic_emul) = {
158 .name = "sandbox_i2c_pmic_emul",
159 .id = UCLASS_I2C_EMUL,
160 .of_match = sandbox_i2c_pmic_ids,
161 .ofdata_to_platdata = sandbox_i2c_pmic_ofdata_to_platdata,
162 .probe = sandbox_i2c_pmic_probe,
163 .platdata_auto_alloc_size = sizeof(struct sandbox_i2c_pmic_plat_data),
164 .ops = &sandbox_i2c_pmic_emul_ops,