diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig index d04431f..7d924cf 100644 --- a/drivers/mfd/Kconfig +++ b/drivers/mfd/Kconfig @@ -61,4 +61,10 @@ Select this to get support for the Supervisory Processor device found on several devices in RAVE line of hardware. +config MFD_STPMIC1 + depends on I2C + bool "STPMIC1 MFD driver" + help + Select this to support communication with the STPMIC1. + endmenu diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile index 8b23a10..16a74ab 100644 --- a/drivers/mfd/Makefile +++ b/drivers/mfd/Makefile @@ -11,3 +11,4 @@ obj-$(CONFIG_MFD_TWL4030) += twl4030.o obj-$(CONFIG_MFD_TWL6030) += twl6030.o obj-$(CONFIG_RAVE_SP_CORE) += rave-sp.o +obj-$(CONFIG_MFD_STPMIC1) += stpmic1.o diff --git a/drivers/mfd/stpmic1.c b/drivers/mfd/stpmic1.c new file mode 100644 index 0000000..88c7921 --- /dev/null +++ b/drivers/mfd/stpmic1.c @@ -0,0 +1,99 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (C) 2019 Ahmad Fatoum, Pengutronix + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define VERSION_SR 0x6 + +struct stpmic1 { + struct device_d *dev; + struct i2c_client *client; +}; + +static int stpmic1_i2c_reg_read(void *ctx, unsigned int reg, unsigned int *val) +{ + struct stpmic1 *stpmic1 = ctx; + u8 buf[1]; + int ret; + + ret = i2c_read_reg(stpmic1->client, reg, buf, 1); + *val = buf[0]; + + return ret == 1 ? 0 : ret; +} + +static int stpmic1_i2c_reg_write(void *ctx, unsigned int reg, unsigned int val) +{ + struct stpmic1 *stpmic1 = ctx; + u8 buf[] = { + val & 0xff, + }; + int ret; + + ret = i2c_write_reg(stpmic1->client, reg, buf, 1); + + return ret == 1 ? 0 : ret; +} + +static struct regmap_bus regmap_stpmic1_i2c_bus = { + .reg_write = stpmic1_i2c_reg_write, + .reg_read = stpmic1_i2c_reg_read, +}; + +static const struct regmap_config stpmic1_regmap_i2c_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = 0xB3, +}; + +static int __init stpmic1_probe(struct device_d *dev) +{ + struct stpmic1 *stpmic1; + struct regmap *regmap; + u32 reg; + int ret; + + stpmic1 = xzalloc(sizeof(*stpmic1)); + stpmic1->dev = dev; + + stpmic1->client = to_i2c_client(dev); + regmap = regmap_init(dev, ®map_stpmic1_i2c_bus, + stpmic1, &stpmic1_regmap_i2c_config); + dev->priv = regmap; + + ret = regmap_register_cdev(regmap, NULL); + if (ret) + return ret; + + ret = regmap_read(regmap, VERSION_SR, ®); + if (ret) { + dev_err(dev, "Unable to read PMIC version\n"); + return ret; + } + dev_info(dev, "PMIC Chip Version: 0x%x\n", reg); + + return of_platform_populate(dev->device_node, NULL, dev); +} + +static __maybe_unused struct of_device_id stpmic1_dt_ids[] = { + { .compatible = "st,stpmic1" }, + { /* sentinel */ } +}; + +static struct driver_d stpmic1_i2c_driver = { + .name = "stpmic1-i2c", + .probe = stpmic1_probe, + .of_compatible = DRV_OF_COMPAT(stpmic1_dt_ids), +}; + +device_i2c_driver(stpmic1_i2c_driver);