mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-18 18:59:44 +00:00
83d290c56f
When U-Boot started using SPDX tags we were among the early adopters and there weren't a lot of other examples to borrow from. So we picked the area of the file that usually had a full license text and replaced it with an appropriate SPDX-License-Identifier: entry. Since then, the Linux Kernel has adopted SPDX tags and they place it as the very first line in a file (except where shebangs are used, then it's second line) and with slightly different comment styles than us. In part due to community overlap, in part due to better tag visibility and in part for other minor reasons, switch over to that style. This commit changes all instances where we have a single declared license in the tag as both the before and after are identical in tag contents. There's also a few places where I found we did not have a tag and have introduced one. Signed-off-by: Tom Rini <trini@konsulko.com>
137 lines
3.2 KiB
C
137 lines
3.2 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2015 Samsung Electronics
|
|
* Przemyslaw Marczak <p.marczak@samsung.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <errno.h>
|
|
#include <dm.h>
|
|
#include <i2c.h>
|
|
#include <power/pmic.h>
|
|
#include <power/sandbox_pmic.h>
|
|
|
|
/**
|
|
* struct sandbox_i2c_pmic_plat_data - platform data for the PMIC
|
|
*
|
|
* @rw_reg: PMICs register of the chip I/O transaction
|
|
* @reg: PMICs registers array
|
|
*/
|
|
struct sandbox_i2c_pmic_plat_data {
|
|
u8 rw_reg;
|
|
u8 reg[SANDBOX_PMIC_REG_COUNT];
|
|
};
|
|
|
|
static int sandbox_i2c_pmic_read_data(struct udevice *emul, uchar chip,
|
|
uchar *buffer, int len)
|
|
{
|
|
struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
|
|
|
|
if (plat->rw_reg + len > SANDBOX_PMIC_REG_COUNT) {
|
|
pr_err("Request exceeds PMIC register range! Max register: %#x",
|
|
SANDBOX_PMIC_REG_COUNT);
|
|
return -EFAULT;
|
|
}
|
|
|
|
debug("Read PMIC: %#x at register: %#x count: %d\n",
|
|
(unsigned)chip & 0xff, plat->rw_reg, len);
|
|
|
|
memcpy(buffer, &plat->reg[plat->rw_reg], len);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sandbox_i2c_pmic_write_data(struct udevice *emul, uchar chip,
|
|
uchar *buffer, int len,
|
|
bool next_is_read)
|
|
{
|
|
struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
|
|
|
|
/* Probe only */
|
|
if (!len)
|
|
return 0;
|
|
|
|
/* Set PMIC register for I/O */
|
|
plat->rw_reg = *buffer;
|
|
|
|
debug("Write PMIC: %#x at register: %#x count: %d\n",
|
|
(unsigned)chip & 0xff, plat->rw_reg, len);
|
|
|
|
/* For read operation, set (write) only chip reg */
|
|
if (next_is_read)
|
|
return 0;
|
|
|
|
buffer++;
|
|
len--;
|
|
|
|
if (plat->rw_reg + len > SANDBOX_PMIC_REG_COUNT) {
|
|
pr_err("Request exceeds PMIC register range! Max register: %#x",
|
|
SANDBOX_PMIC_REG_COUNT);
|
|
}
|
|
|
|
memcpy(&plat->reg[plat->rw_reg], buffer, len);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sandbox_i2c_pmic_xfer(struct udevice *emul, struct i2c_msg *msg,
|
|
int nmsgs)
|
|
{
|
|
int ret = 0;
|
|
|
|
for (; nmsgs > 0; nmsgs--, msg++) {
|
|
bool next_is_read = nmsgs > 1 && (msg[1].flags & I2C_M_RD);
|
|
if (msg->flags & I2C_M_RD) {
|
|
ret = sandbox_i2c_pmic_read_data(emul, msg->addr,
|
|
msg->buf, msg->len);
|
|
} else {
|
|
ret = sandbox_i2c_pmic_write_data(emul, msg->addr,
|
|
msg->buf, msg->len,
|
|
next_is_read);
|
|
}
|
|
|
|
if (ret)
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int sandbox_i2c_pmic_ofdata_to_platdata(struct udevice *emul)
|
|
{
|
|
struct sandbox_i2c_pmic_plat_data *plat = dev_get_platdata(emul);
|
|
const u8 *reg_defaults;
|
|
|
|
debug("%s:%d Setting PMIC default registers\n", __func__, __LINE__);
|
|
|
|
reg_defaults = dev_read_u8_array_ptr(emul, "reg-defaults",
|
|
SANDBOX_PMIC_REG_COUNT);
|
|
|
|
if (!reg_defaults) {
|
|
pr_err("Property \"reg-defaults\" not found for device: %s!",
|
|
emul->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
memcpy(&plat->reg, reg_defaults, SANDBOX_PMIC_REG_COUNT);
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct dm_i2c_ops sandbox_i2c_pmic_emul_ops = {
|
|
.xfer = sandbox_i2c_pmic_xfer,
|
|
};
|
|
|
|
static const struct udevice_id sandbox_i2c_pmic_ids[] = {
|
|
{ .compatible = "sandbox,i2c-pmic" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(sandbox_i2c_pmic_emul) = {
|
|
.name = "sandbox_i2c_pmic_emul",
|
|
.id = UCLASS_I2C_EMUL,
|
|
.of_match = sandbox_i2c_pmic_ids,
|
|
.ofdata_to_platdata = sandbox_i2c_pmic_ofdata_to_platdata,
|
|
.platdata_auto_alloc_size = sizeof(struct sandbox_i2c_pmic_plat_data),
|
|
.ops = &sandbox_i2c_pmic_emul_ops,
|
|
};
|