[mirror_ubuntu-bionic-kernel.git] / drivers / regulator / tps6507x-regulator.c

/*
 * tps6507x-regulator.c
 *
 * Regulator driver for TPS65073 PMIC
 *
 * Copyright (C) 2009 Texas Instrument Incorporated - http://www.ti.com/
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation version 2.
 *
 * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
 * whether express or implied; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/err.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.h>
#include <linux/regulator/tps6507x.h>
#include <linux/of.h>
#include <linux/slab.h>
#include <linux/mfd/tps6507x.h>
#include <linux/regulator/of_regulator.h>

/* DCDC's */
#define TPS6507X_DCDC_1				0
#define TPS6507X_DCDC_2				1
#define TPS6507X_DCDC_3				2
/* LDOs */
#define TPS6507X_LDO_1				3
#define TPS6507X_LDO_2				4

#define TPS6507X_MAX_REG_ID			TPS6507X_LDO_2

/* Number of step-down converters available */
#define TPS6507X_NUM_DCDC			3
/* Number of LDO voltage regulators  available */
#define TPS6507X_NUM_LDO			2
/* Number of total regulators available */
#define TPS6507X_NUM_REGULATOR		(TPS6507X_NUM_DCDC + TPS6507X_NUM_LDO)

/* Supported voltage values for regulators (in microVolts) */
static const unsigned int VDCDCx_VSEL_table[] = {
	725000, 750000, 775000, 800000,
	825000, 850000, 875000, 900000,
	925000, 950000, 975000, 1000000,
	1025000, 1050000, 1075000, 1100000,
	1125000, 1150000, 1175000, 1200000,
	1225000, 1250000, 1275000, 1300000,
	1325000, 1350000, 1375000, 1400000,
	1425000, 1450000, 1475000, 1500000,
	1550000, 1600000, 1650000, 1700000,
	1750000, 1800000, 1850000, 1900000,
	1950000, 2000000, 2050000, 2100000,
	2150000, 2200000, 2250000, 2300000,
	2350000, 2400000, 2450000, 2500000,
	2550000, 2600000, 2650000, 2700000,
	2750000, 2800000, 2850000, 2900000,
	3000000, 3100000, 3200000, 3300000,
};

static const unsigned int LDO1_VSEL_table[] = {
	1000000, 1100000, 1200000, 1250000,
	1300000, 1350000, 1400000, 1500000,
	1600000, 1800000, 2500000, 2750000,
	2800000, 3000000, 3100000, 3300000,
};

/* The voltage mapping table for LDO2 is the same as VDCDCx */
#define LDO2_VSEL_table VDCDCx_VSEL_table

struct tps_info {
	const char *name;
	u8 table_len;
	const unsigned int *table;

	/* Does DCDC high or the low register defines output voltage? */
	bool defdcdc_default;
};

static struct tps_info tps6507x_pmic_regs[] = {
	{
		.name = "VDCDC1",
		.table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
		.table = VDCDCx_VSEL_table,
	},
	{
		.name = "VDCDC2",
		.table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
		.table = VDCDCx_VSEL_table,
	},
	{
		.name = "VDCDC3",
		.table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
		.table = VDCDCx_VSEL_table,
	},
	{
		.name = "LDO1",
		.table_len = ARRAY_SIZE(LDO1_VSEL_table),
		.table = LDO1_VSEL_table,
	},
	{
		.name = "LDO2",
		.table_len = ARRAY_SIZE(LDO2_VSEL_table),
		.table = LDO2_VSEL_table,
	},
};

struct tps6507x_pmic {
	struct regulator_desc desc[TPS6507X_NUM_REGULATOR];
	struct tps6507x_dev *mfd;
	struct regulator_dev *rdev[TPS6507X_NUM_REGULATOR];
	struct tps_info *info[TPS6507X_NUM_REGULATOR];
	struct mutex io_lock;
};
static inline int tps6507x_pmic_read(struct tps6507x_pmic *tps, u8 reg)
{
	u8 val;
	int err;

	err = tps->mfd->read_dev(tps->mfd, reg, 1, &val);

	if (err)
		return err;

	return val;
}

static inline int tps6507x_pmic_write(struct tps6507x_pmic *tps, u8 reg, u8 val)
{
	return tps->mfd->write_dev(tps->mfd, reg, 1, &val);
}

static int tps6507x_pmic_set_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask)
{
	int err, data;

	mutex_lock(&tps->io_lock);

	data = tps6507x_pmic_read(tps, reg);
	if (data < 0) {
		dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
		err = data;
		goto out;
	}

	data |= mask;
	err = tps6507x_pmic_write(tps, reg, data);
	if (err)
		dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);

out:
	mutex_unlock(&tps->io_lock);
	return err;
}

static int tps6507x_pmic_clear_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask)
{
	int err, data;

	mutex_lock(&tps->io_lock);

	data = tps6507x_pmic_read(tps, reg);
	if (data < 0) {
		dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
		err = data;
		goto out;
	}

	data &= ~mask;
	err = tps6507x_pmic_write(tps, reg, data);
	if (err)
		dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);

out:
	mutex_unlock(&tps->io_lock);
	return err;
}

static int tps6507x_pmic_reg_read(struct tps6507x_pmic *tps, u8 reg)
{
	int data;

	mutex_lock(&tps->io_lock);

	data = tps6507x_pmic_read(tps, reg);
	if (data < 0)
		dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);

	mutex_unlock(&tps->io_lock);
	return data;
}

static int tps6507x_pmic_reg_write(struct tps6507x_pmic *tps, u8 reg, u8 val)
{
	int err;

	mutex_lock(&tps->io_lock);

	err = tps6507x_pmic_write(tps, reg, val);
	if (err < 0)
		dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);

	mutex_unlock(&tps->io_lock);
	return err;
}

static int tps6507x_pmic_is_enabled(struct regulator_dev *dev)
{
	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
	int data, rid = rdev_get_id(dev);
	u8 shift;

	if (rid < TPS6507X_DCDC_1 || rid > TPS6507X_LDO_2)
		return -EINVAL;

	shift = TPS6507X_MAX_REG_ID - rid;
	data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1);

	if (data < 0)
		return data;
	else
		return (data & 1<<shift) ? 1 : 0;
}

static int tps6507x_pmic_enable(struct regulator_dev *dev)
{
	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
	int rid = rdev_get_id(dev);
	u8 shift;

	if (rid < TPS6507X_DCDC_1 || rid > TPS6507X_LDO_2)
		return -EINVAL;

	shift = TPS6507X_MAX_REG_ID - rid;
	return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift);
}

static int tps6507x_pmic_disable(struct regulator_dev *dev)
{
	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
	int rid = rdev_get_id(dev);
	u8 shift;

	if (rid < TPS6507X_DCDC_1 || rid > TPS6507X_LDO_2)
		return -EINVAL;

	shift = TPS6507X_MAX_REG_ID - rid;
	return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1,
					1 << shift);
}

static int tps6507x_pmic_get_voltage_sel(struct regulator_dev *dev)
{
	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
	int data, rid = rdev_get_id(dev);
	u8 reg, mask;

	switch (rid) {
	case TPS6507X_DCDC_1:
		reg = TPS6507X_REG_DEFDCDC1;
		mask = TPS6507X_DEFDCDCX_DCDC_MASK;
		break;
	case TPS6507X_DCDC_2:
		if (tps->info[rid]->defdcdc_default)
			reg = TPS6507X_REG_DEFDCDC2_HIGH;
		else
			reg = TPS6507X_REG_DEFDCDC2_LOW;
		mask = TPS6507X_DEFDCDCX_DCDC_MASK;
		break;
	case TPS6507X_DCDC_3:
		if (tps->info[rid]->defdcdc_default)
			reg = TPS6507X_REG_DEFDCDC3_HIGH;
		else
			reg = TPS6507X_REG_DEFDCDC3_LOW;
		mask = TPS6507X_DEFDCDCX_DCDC_MASK;
		break;
	case TPS6507X_LDO_1:
		reg = TPS6507X_REG_LDO_CTRL1;
		mask = TPS6507X_REG_LDO_CTRL1_LDO1_MASK;
		break;
	case TPS6507X_LDO_2:
		reg = TPS6507X_REG_DEFLDO2;
		mask = TPS6507X_REG_DEFLDO2_LDO2_MASK;
		break;
	default:
		return -EINVAL;
	}

	data = tps6507x_pmic_reg_read(tps, reg);
	if (data < 0)
		return data;

	data &= mask;
	return data;
}

static int tps6507x_pmic_set_voltage_sel(struct regulator_dev *dev,
					  unsigned selector)
{
	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
	int data, rid = rdev_get_id(dev);
	u8 reg, mask;

	switch (rid) {
	case TPS6507X_DCDC_1:
		reg = TPS6507X_REG_DEFDCDC1;
		mask = TPS6507X_DEFDCDCX_DCDC_MASK;
		break;
	case TPS6507X_DCDC_2:
		if (tps->info[rid]->defdcdc_default)
			reg = TPS6507X_REG_DEFDCDC2_HIGH;
		else
			reg = TPS6507X_REG_DEFDCDC2_LOW;
		mask = TPS6507X_DEFDCDCX_DCDC_MASK;
		break;
	case TPS6507X_DCDC_3:
		if (tps->info[rid]->defdcdc_default)
			reg = TPS6507X_REG_DEFDCDC3_HIGH;
		else
			reg = TPS6507X_REG_DEFDCDC3_LOW;
		mask = TPS6507X_DEFDCDCX_DCDC_MASK;
		break;
	case TPS6507X_LDO_1:
		reg = TPS6507X_REG_LDO_CTRL1;
		mask = TPS6507X_REG_LDO_CTRL1_LDO1_MASK;
		break;
	case TPS6507X_LDO_2:
		reg = TPS6507X_REG_DEFLDO2;
		mask = TPS6507X_REG_DEFLDO2_LDO2_MASK;
		break;
	default:
		return -EINVAL;
	}

	data = tps6507x_pmic_reg_read(tps, reg);
	if (data < 0)
		return data;

	data &= ~mask;
	data |= selector;

	return tps6507x_pmic_reg_write(tps, reg, data);
}

static struct regulator_ops tps6507x_pmic_ops = {
	.is_enabled = tps6507x_pmic_is_enabled,
	.enable = tps6507x_pmic_enable,
	.disable = tps6507x_pmic_disable,
	.get_voltage_sel = tps6507x_pmic_get_voltage_sel,
	.set_voltage_sel = tps6507x_pmic_set_voltage_sel,
	.list_voltage = regulator_list_voltage_table,
	.map_voltage = regulator_map_voltage_ascend,
};

static struct of_regulator_match tps6507x_matches[] = {
	{ .name = "VDCDC1"},
	{ .name = "VDCDC2"},
	{ .name = "VDCDC3"},
	{ .name = "LDO1"},
	{ .name = "LDO2"},
};

static struct tps6507x_board *tps6507x_parse_dt_reg_data(
		struct platform_device *pdev,
		struct of_regulator_match **tps6507x_reg_matches)
{
	struct tps6507x_board *tps_board;
	struct device_node *np = pdev->dev.parent->of_node;
	struct device_node *regulators;
	struct of_regulator_match *matches;
	struct regulator_init_data *reg_data;
	int idx = 0, count, ret;

	tps_board = devm_kzalloc(&pdev->dev, sizeof(*tps_board),
					GFP_KERNEL);
	if (!tps_board)
		return NULL;

	regulators = of_get_child_by_name(np, "regulators");
	if (!regulators) {
		dev_err(&pdev->dev, "regulator node not found\n");
		return NULL;
	}

	count = ARRAY_SIZE(tps6507x_matches);
	matches = tps6507x_matches;

	ret = of_regulator_match(&pdev->dev, regulators, matches, count);
	of_node_put(regulators);
	if (ret < 0) {
		dev_err(&pdev->dev, "Error parsing regulator init data: %d\n",
			ret);
		return NULL;
	}

	*tps6507x_reg_matches = matches;

	reg_data = devm_kzalloc(&pdev->dev, (sizeof(struct regulator_init_data)
					* TPS6507X_NUM_REGULATOR), GFP_KERNEL);
	if (!reg_data)
		return NULL;

	tps_board->tps6507x_pmic_init_data = reg_data;

	for (idx = 0; idx < count; idx++) {
		if (!matches[idx].init_data || !matches[idx].of_node)
			continue;

		memcpy(&reg_data[idx], matches[idx].init_data,
				sizeof(struct regulator_init_data));

	}

	return tps_board;
}

static int tps6507x_pmic_probe(struct platform_device *pdev)
{
	struct tps6507x_dev *tps6507x_dev = dev_get_drvdata(pdev->dev.parent);
	struct tps_info *info = &tps6507x_pmic_regs[0];
	struct regulator_config config = { };
	struct regulator_init_data *init_data;
	struct regulator_dev *rdev;
	struct tps6507x_pmic *tps;
	struct tps6507x_board *tps_board;
	struct of_regulator_match *tps6507x_reg_matches = NULL;
	int i;
	int error;
	unsigned int prop;

	/**
	 * tps_board points to pmic related constants
	 * coming from the board-evm file.
	 */

	tps_board = dev_get_platdata(tps6507x_dev->dev);
	if (IS_ENABLED(CONFIG_OF) && !tps_board &&
		tps6507x_dev->dev->of_node)
		tps_board = tps6507x_parse_dt_reg_data(pdev,
				&tps6507x_reg_matches);
	if (!tps_board)
		return -EINVAL;

	/**
	 * init_data points to array of regulator_init structures
	 * coming from the board-evm file.
	 */
	init_data = tps_board->tps6507x_pmic_init_data;
	if (!init_data)
		return -EINVAL;

	tps = devm_kzalloc(&pdev->dev, sizeof(*tps), GFP_KERNEL);
	if (!tps)
		return -ENOMEM;

	mutex_init(&tps->io_lock);

	/* common for all regulators */
	tps->mfd = tps6507x_dev;

	for (i = 0; i < TPS6507X_NUM_REGULATOR; i++, info++, init_data++) {
		/* Register the regulators */
		tps->info[i] = info;
		if (init_data->driver_data) {
			struct tps6507x_reg_platform_data *data =
					init_data->driver_data;
			tps->info[i]->defdcdc_default = data->defdcdc_default;
		}

		tps->desc[i].name = info->name;
		tps->desc[i].id = i;
		tps->desc[i].n_voltages = info->table_len;
		tps->desc[i].volt_table = info->table;
		tps->desc[i].ops = &tps6507x_pmic_ops;
		tps->desc[i].type = REGULATOR_VOLTAGE;
		tps->desc[i].owner = THIS_MODULE;

		config.dev = tps6507x_dev->dev;
		config.init_data = init_data;
		config.driver_data = tps;

		if (tps6507x_reg_matches) {
			error = of_property_read_u32(
				tps6507x_reg_matches[i].of_node,
					"ti,defdcdc_default", &prop);

			if (!error)
				tps->info[i]->defdcdc_default = prop;

			config.of_node = tps6507x_reg_matches[i].of_node;
		}

		rdev = devm_regulator_register(&pdev->dev, &tps->desc[i],
					       &config);
		if (IS_ERR(rdev)) {
			dev_err(tps6507x_dev->dev,
				"failed to register %s regulator\n",
				pdev->name);
			return PTR_ERR(rdev);
		}

		/* Save regulator for cleanup */
		tps->rdev[i] = rdev;
	}

	tps6507x_dev->pmic = tps;
	platform_set_drvdata(pdev, tps6507x_dev);

	return 0;
}

static struct platform_driver tps6507x_pmic_driver = {
	.driver = {
		.name = "tps6507x-pmic",
	},
	.probe = tps6507x_pmic_probe,
};

static int __init tps6507x_pmic_init(void)
{
	return platform_driver_register(&tps6507x_pmic_driver);
}
subsys_initcall(tps6507x_pmic_init);

static void __exit tps6507x_pmic_cleanup(void)
{
	platform_driver_unregister(&tps6507x_pmic_driver);
}
module_exit(tps6507x_pmic_cleanup);

MODULE_AUTHOR("Texas Instruments");
MODULE_DESCRIPTION("TPS6507x voltage regulator driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:tps6507x-pmic");
Commit	Line	Data
3fa5b8e0 AA	1	/*
	2	* tps6507x-regulator.c
	3	*
	4	* Regulator driver for TPS65073 PMIC
	5	*
	6	* Copyright (C) 2009 Texas Instrument Incorporated - http://www.ti.com/
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License as
	10	* published by the Free Software Foundation version 2.
	11	*
	12	* This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
	13	* whether express or implied; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	15	* General Public License for more details.
	16	*/
	17
	18	#include <linux/kernel.h>
	19	#include <linux/module.h>
	20	#include <linux/init.h>
	21	#include <linux/err.h>
	22	#include <linux/platform_device.h>
	23	#include <linux/regulator/driver.h>
	24	#include <linux/regulator/machine.h>
7d14831e	25	#include <linux/regulator/tps6507x.h>
6116ad94	26	#include <linux/of.h>
5a0e3ad6	27	#include <linux/slab.h>
d183fcc9	28	#include <linux/mfd/tps6507x.h>
6116ad94	29	#include <linux/regulator/of_regulator.h>
3fa5b8e0 AA	30
	31	/* DCDC's */
	32	#define TPS6507X_DCDC_1 0
	33	#define TPS6507X_DCDC_2 1
	34	#define TPS6507X_DCDC_3 2
	35	/* LDOs */
	36	#define TPS6507X_LDO_1 3
	37	#define TPS6507X_LDO_2 4
	38
	39	#define TPS6507X_MAX_REG_ID TPS6507X_LDO_2
	40
	41	/* Number of step-down converters available */
	42	#define TPS6507X_NUM_DCDC 3
	43	/* Number of LDO voltage regulators available */
	44	#define TPS6507X_NUM_LDO 2
	45	/* Number of total regulators available */
	46	#define TPS6507X_NUM_REGULATOR (TPS6507X_NUM_DCDC + TPS6507X_NUM_LDO)
	47
055917ac AL	48	/* Supported voltage values for regulators (in microVolts) */
	49	static const unsigned int VDCDCx_VSEL_table[] = {
	50	725000, 750000, 775000, 800000,
	51	825000, 850000, 875000, 900000,
	52	925000, 950000, 975000, 1000000,
	53	1025000, 1050000, 1075000, 1100000,
	54	1125000, 1150000, 1175000, 1200000,
	55	1225000, 1250000, 1275000, 1300000,
	56	1325000, 1350000, 1375000, 1400000,
	57	1425000, 1450000, 1475000, 1500000,
	58	1550000, 1600000, 1650000, 1700000,
	59	1750000, 1800000, 1850000, 1900000,
	60	1950000, 2000000, 2050000, 2100000,
	61	2150000, 2200000, 2250000, 2300000,
	62	2350000, 2400000, 2450000, 2500000,
	63	2550000, 2600000, 2650000, 2700000,
	64	2750000, 2800000, 2850000, 2900000,
	65	3000000, 3100000, 3200000, 3300000,
3fa5b8e0 AA	66	};
3fa5b8e0 AA	67
055917ac AL	68	static const unsigned int LDO1_VSEL_table[] = {
	69	1000000, 1100000, 1200000, 1250000,
	70	1300000, 1350000, 1400000, 1500000,
	71	1600000, 1800000, 2500000, 2750000,
	72	2800000, 3000000, 3100000, 3300000,
3fa5b8e0 AA	73	};
3fa5b8e0 AA	74
93b07e7b AL	75	/* The voltage mapping table for LDO2 is the same as VDCDCx */
93b07e7b AL	76	#define LDO2_VSEL_table VDCDCx_VSEL_table
3fa5b8e0	77
3fa5b8e0 AA	78	struct tps_info {
3fa5b8e0 AA	79	const char *name;
3fa5b8e0	80	u8 table_len;
055917ac	81	const unsigned int *table;
7d14831e AA	82
	83	/* Does DCDC high or the low register defines output voltage? */
	84	bool defdcdc_default;
3fa5b8e0 AA	85	};
3fa5b8e0 AA	86
7d14831e	87	static struct tps_info tps6507x_pmic_regs[] = {
31dd6a26 TF	88	{
31dd6a26 TF	89	.name = "VDCDC1",
31dd6a26 TF	90	.table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
	91	.table = VDCDCx_VSEL_table,
	92	},
	93	{
	94	.name = "VDCDC2",
31dd6a26 TF	95	.table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
	96	.table = VDCDCx_VSEL_table,
	97	},
	98	{
	99	.name = "VDCDC3",
31dd6a26 TF	100	.table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
	101	.table = VDCDCx_VSEL_table,
	102	},
	103	{
	104	.name = "LDO1",
31dd6a26 TF	105	.table_len = ARRAY_SIZE(LDO1_VSEL_table),
	106	.table = LDO1_VSEL_table,
	107	},
	108	{
	109	.name = "LDO2",
31dd6a26 TF	110	.table_len = ARRAY_SIZE(LDO2_VSEL_table),
	111	.table = LDO2_VSEL_table,
	112	},
	113	};
	114
4ce5ba5b	115	struct tps6507x_pmic {
3fa5b8e0	116	struct regulator_desc desc[TPS6507X_NUM_REGULATOR];
31dd6a26	117	struct tps6507x_dev *mfd;
3fa5b8e0	118	struct regulator_dev *rdev[TPS6507X_NUM_REGULATOR];
7d14831e	119	struct tps_info *info[TPS6507X_NUM_REGULATOR];
3fa5b8e0 AA	120	struct mutex io_lock;
3fa5b8e0 AA	121	};
4ce5ba5b	122	static inline int tps6507x_pmic_read(struct tps6507x_pmic *tps, u8 reg)
3fa5b8e0	123	{
31dd6a26 TF	124	u8 val;
	125	int err;
	126
	127	err = tps->mfd->read_dev(tps->mfd, reg, 1, &val);
	128
	129	if (err)
	130	return err;
	131
	132	return val;
3fa5b8e0 AA	133	}
3fa5b8e0 AA	134
4ce5ba5b	135	static inline int tps6507x_pmic_write(struct tps6507x_pmic *tps, u8 reg, u8 val)
3fa5b8e0	136	{
31dd6a26	137	return tps->mfd->write_dev(tps->mfd, reg, 1, &val);
3fa5b8e0 AA	138	}
3fa5b8e0 AA	139
4ce5ba5b	140	static int tps6507x_pmic_set_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask)
3fa5b8e0 AA	141	{
	142	int err, data;
	143
	144	mutex_lock(&tps->io_lock);
	145
4ce5ba5b	146	data = tps6507x_pmic_read(tps, reg);
3fa5b8e0	147	if (data < 0) {
31dd6a26	148	dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
3fa5b8e0 AA	149	err = data;
	150	goto out;
	151	}
	152
	153	data \|= mask;
4ce5ba5b	154	err = tps6507x_pmic_write(tps, reg, data);
3fa5b8e0	155	if (err)
31dd6a26	156	dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);
3fa5b8e0 AA	157
	158	out:
	159	mutex_unlock(&tps->io_lock);
	160	return err;
	161	}
	162
4ce5ba5b	163	static int tps6507x_pmic_clear_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask)
3fa5b8e0 AA	164	{
	165	int err, data;
	166
	167	mutex_lock(&tps->io_lock);
	168
4ce5ba5b	169	data = tps6507x_pmic_read(tps, reg);
3fa5b8e0	170	if (data < 0) {
31dd6a26	171	dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
3fa5b8e0 AA	172	err = data;
	173	goto out;
	174	}
	175
	176	data &= ~mask;
4ce5ba5b	177	err = tps6507x_pmic_write(tps, reg, data);
3fa5b8e0	178	if (err)
31dd6a26	179	dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);
3fa5b8e0 AA	180
	181	out:
	182	mutex_unlock(&tps->io_lock);
	183	return err;
	184	}
	185
4ce5ba5b	186	static int tps6507x_pmic_reg_read(struct tps6507x_pmic *tps, u8 reg)
3fa5b8e0 AA	187	{
	188	int data;
	189
	190	mutex_lock(&tps->io_lock);
	191
4ce5ba5b	192	data = tps6507x_pmic_read(tps, reg);
3fa5b8e0	193	if (data < 0)
31dd6a26	194	dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
3fa5b8e0 AA	195
	196	mutex_unlock(&tps->io_lock);
	197	return data;
	198	}
	199
4ce5ba5b	200	static int tps6507x_pmic_reg_write(struct tps6507x_pmic *tps, u8 reg, u8 val)
3fa5b8e0 AA	201	{
	202	int err;
	203
	204	mutex_lock(&tps->io_lock);
	205
4ce5ba5b	206	err = tps6507x_pmic_write(tps, reg, val);
3fa5b8e0	207	if (err < 0)
31dd6a26	208	dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);
3fa5b8e0 AA	209
	210	mutex_unlock(&tps->io_lock);
	211	return err;
	212	}
	213
f2933d33	214	static int tps6507x_pmic_is_enabled(struct regulator_dev *dev)
3fa5b8e0	215	{
4ce5ba5b	216	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
f2933d33	217	int data, rid = rdev_get_id(dev);
3fa5b8e0 AA	218	u8 shift;
3fa5b8e0 AA	219
f2933d33	220	if (rid < TPS6507X_DCDC_1 \|\| rid > TPS6507X_LDO_2)
3fa5b8e0 AA	221	return -EINVAL;
3fa5b8e0 AA	222
f2933d33	223	shift = TPS6507X_MAX_REG_ID - rid;
4ce5ba5b	224	data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1);
3fa5b8e0 AA	225
	226	if (data < 0)
	227	return data;
	228	else
	229	return (data & 1<<shift) ? 1 : 0;
	230	}
	231
f2933d33	232	static int tps6507x_pmic_enable(struct regulator_dev *dev)
3fa5b8e0	233	{
4ce5ba5b	234	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
f2933d33	235	int rid = rdev_get_id(dev);
3fa5b8e0 AA	236	u8 shift;
3fa5b8e0 AA	237
f2933d33	238	if (rid < TPS6507X_DCDC_1 \|\| rid > TPS6507X_LDO_2)
3fa5b8e0 AA	239	return -EINVAL;
3fa5b8e0 AA	240
f2933d33	241	shift = TPS6507X_MAX_REG_ID - rid;
4ce5ba5b	242	return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift);
3fa5b8e0 AA	243	}
3fa5b8e0 AA	244
f2933d33	245	static int tps6507x_pmic_disable(struct regulator_dev *dev)
3fa5b8e0	246	{
4ce5ba5b	247	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
f2933d33	248	int rid = rdev_get_id(dev);
3fa5b8e0 AA	249	u8 shift;
3fa5b8e0 AA	250
f2933d33	251	if (rid < TPS6507X_DCDC_1 \|\| rid > TPS6507X_LDO_2)
3fa5b8e0 AA	252	return -EINVAL;
3fa5b8e0 AA	253
f2933d33	254	shift = TPS6507X_MAX_REG_ID - rid;
4ce5ba5b TF	255	return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1,
4ce5ba5b TF	256	1 << shift);
3fa5b8e0 AA	257	}
3fa5b8e0 AA	258
7c842a1d	259	static int tps6507x_pmic_get_voltage_sel(struct regulator_dev *dev)
3fa5b8e0	260	{
4ce5ba5b	261	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
f2933d33 AL	262	int data, rid = rdev_get_id(dev);
f2933d33 AL	263	u8 reg, mask;
3fa5b8e0	264
f2933d33	265	switch (rid) {
3fa5b8e0 AA	266	case TPS6507X_DCDC_1:
3fa5b8e0 AA	267	reg = TPS6507X_REG_DEFDCDC1;
f2933d33	268	mask = TPS6507X_DEFDCDCX_DCDC_MASK;
3fa5b8e0 AA	269	break;
3fa5b8e0 AA	270	case TPS6507X_DCDC_2:
f2933d33	271	if (tps->info[rid]->defdcdc_default)
7d14831e AA	272	reg = TPS6507X_REG_DEFDCDC2_HIGH;
	273	else
	274	reg = TPS6507X_REG_DEFDCDC2_LOW;
f2933d33	275	mask = TPS6507X_DEFDCDCX_DCDC_MASK;
3fa5b8e0 AA	276	break;
3fa5b8e0 AA	277	case TPS6507X_DCDC_3:
f2933d33	278	if (tps->info[rid]->defdcdc_default)
7d14831e AA	279	reg = TPS6507X_REG_DEFDCDC3_HIGH;
	280	else
	281	reg = TPS6507X_REG_DEFDCDC3_LOW;
f2933d33 AL	282	mask = TPS6507X_DEFDCDCX_DCDC_MASK;
	283	break;
	284	case TPS6507X_LDO_1:
	285	reg = TPS6507X_REG_LDO_CTRL1;
	286	mask = TPS6507X_REG_LDO_CTRL1_LDO1_MASK;
	287	break;
	288	case TPS6507X_LDO_2:
	289	reg = TPS6507X_REG_DEFLDO2;
	290	mask = TPS6507X_REG_DEFLDO2_LDO2_MASK;
3fa5b8e0 AA	291	break;
	292	default:
	293	return -EINVAL;
	294	}
	295
4ce5ba5b	296	data = tps6507x_pmic_reg_read(tps, reg);
3fa5b8e0 AA	297	if (data < 0)
	298	return data;
	299
f2933d33	300	data &= mask;
7c842a1d	301	return data;
3fa5b8e0 AA	302	}
3fa5b8e0 AA	303
ca61a7bf AL	304	static int tps6507x_pmic_set_voltage_sel(struct regulator_dev *dev,
ca61a7bf AL	305	unsigned selector)
3fa5b8e0	306	{
4ce5ba5b	307	struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
ca61a7bf	308	int data, rid = rdev_get_id(dev);
f2933d33	309	u8 reg, mask;
3fa5b8e0	310
f2933d33	311	switch (rid) {
3fa5b8e0 AA	312	case TPS6507X_DCDC_1:
3fa5b8e0 AA	313	reg = TPS6507X_REG_DEFDCDC1;
f2933d33	314	mask = TPS6507X_DEFDCDCX_DCDC_MASK;
3fa5b8e0 AA	315	break;
3fa5b8e0 AA	316	case TPS6507X_DCDC_2:
f2933d33	317	if (tps->info[rid]->defdcdc_default)
7d14831e AA	318	reg = TPS6507X_REG_DEFDCDC2_HIGH;
	319	else
	320	reg = TPS6507X_REG_DEFDCDC2_LOW;
f2933d33	321	mask = TPS6507X_DEFDCDCX_DCDC_MASK;
3fa5b8e0 AA	322	break;
3fa5b8e0 AA	323	case TPS6507X_DCDC_3:
f2933d33	324	if (tps->info[rid]->defdcdc_default)
7d14831e AA	325	reg = TPS6507X_REG_DEFDCDC3_HIGH;
	326	else
	327	reg = TPS6507X_REG_DEFDCDC3_LOW;
f2933d33 AL	328	mask = TPS6507X_DEFDCDCX_DCDC_MASK;
	329	break;
	330	case TPS6507X_LDO_1:
	331	reg = TPS6507X_REG_LDO_CTRL1;
	332	mask = TPS6507X_REG_LDO_CTRL1_LDO1_MASK;
	333	break;
	334	case TPS6507X_LDO_2:
	335	reg = TPS6507X_REG_DEFLDO2;
	336	mask = TPS6507X_REG_DEFLDO2_LDO2_MASK;
3fa5b8e0 AA	337	break;
	338	default:
	339	return -EINVAL;
	340	}
	341
4ce5ba5b	342	data = tps6507x_pmic_reg_read(tps, reg);
3fa5b8e0 AA	343	if (data < 0)
	344	return data;
	345
	346	data &= ~mask;
ca61a7bf	347	data \|= selector;
3fa5b8e0	348
4ce5ba5b	349	return tps6507x_pmic_reg_write(tps, reg, data);
3fa5b8e0 AA	350	}
3fa5b8e0 AA	351
f2933d33 AL	352	static struct regulator_ops tps6507x_pmic_ops = {
	353	.is_enabled = tps6507x_pmic_is_enabled,
	354	.enable = tps6507x_pmic_enable,
	355	.disable = tps6507x_pmic_disable,
7c842a1d	356	.get_voltage_sel = tps6507x_pmic_get_voltage_sel,
ca61a7bf	357	.set_voltage_sel = tps6507x_pmic_set_voltage_sel,
055917ac	358	.list_voltage = regulator_list_voltage_table,
a1bb63a8	359	.map_voltage = regulator_map_voltage_ascend,
3fa5b8e0 AA	360	};
3fa5b8e0 AA	361
6116ad94 VBM	362	static struct of_regulator_match tps6507x_matches[] = {
	363	{ .name = "VDCDC1"},
	364	{ .name = "VDCDC2"},
	365	{ .name = "VDCDC3"},
	366	{ .name = "LDO1"},
	367	{ .name = "LDO2"},
	368	};
	369
	370	static struct tps6507x_board *tps6507x_parse_dt_reg_data(
	371	struct platform_device *pdev,
	372	struct of_regulator_match **tps6507x_reg_matches)
	373	{
	374	struct tps6507x_board *tps_board;
	375	struct device_node *np = pdev->dev.parent->of_node;
	376	struct device_node *regulators;
	377	struct of_regulator_match *matches;
e98d5fef	378	struct regulator_init_data *reg_data;
6116ad94 VBM	379	int idx = 0, count, ret;
	380
	381	tps_board = devm_kzalloc(&pdev->dev, sizeof(*tps_board),
	382	GFP_KERNEL);
fe23ce08	383	if (!tps_board)
6116ad94	384	return NULL;
6116ad94	385
e3d4edfd	386	regulators = of_get_child_by_name(np, "regulators");
6116ad94 VBM	387	if (!regulators) {
	388	dev_err(&pdev->dev, "regulator node not found\n");
	389	return NULL;
	390	}
	391
	392	count = ARRAY_SIZE(tps6507x_matches);
	393	matches = tps6507x_matches;
	394
0ce7d00d	395	ret = of_regulator_match(&pdev->dev, regulators, matches, count);
aaacb0e9	396	of_node_put(regulators);
6116ad94 VBM	397	if (ret < 0) {
	398	dev_err(&pdev->dev, "Error parsing regulator init data: %d\n",
	399	ret);
	400	return NULL;
	401	}
	402
	403	*tps6507x_reg_matches = matches;
	404
	405	reg_data = devm_kzalloc(&pdev->dev, (sizeof(struct regulator_init_data)
	406	* TPS6507X_NUM_REGULATOR), GFP_KERNEL);
fe23ce08	407	if (!reg_data)
6116ad94	408	return NULL;
6116ad94 VBM	409
	410	tps_board->tps6507x_pmic_init_data = reg_data;
	411
	412	for (idx = 0; idx < count; idx++) {
	413	if (!matches[idx].init_data \|\| !matches[idx].of_node)
	414	continue;
	415
	416	memcpy(&reg_data[idx], matches[idx].init_data,
	417	sizeof(struct regulator_init_data));
	418
	419	}
	420
	421	return tps_board;
	422	}
4246e55f	423
a5023574	424	static int tps6507x_pmic_probe(struct platform_device *pdev)
3fa5b8e0	425	{
31dd6a26	426	struct tps6507x_dev *tps6507x_dev = dev_get_drvdata(pdev->dev.parent);
7d14831e	427	struct tps_info *info = &tps6507x_pmic_regs[0];
c172708d	428	struct regulator_config config = { };
3fa5b8e0 AA	429	struct regulator_init_data *init_data;
3fa5b8e0 AA	430	struct regulator_dev *rdev;
4ce5ba5b	431	struct tps6507x_pmic *tps;
0bc20bba	432	struct tps6507x_board *tps_board;
6116ad94	433	struct of_regulator_match *tps6507x_reg_matches = NULL;
3fa5b8e0	434	int i;
56c23492	435	int error;
6116ad94	436	unsigned int prop;
3fa5b8e0	437
0bc20bba TF	438	/**
	439	* tps_board points to pmic related constants
	440	* coming from the board-evm file.
	441	*/
	442
31dd6a26	443	tps_board = dev_get_platdata(tps6507x_dev->dev);
4246e55f MB	444	if (IS_ENABLED(CONFIG_OF) && !tps_board &&
4246e55f MB	445	tps6507x_dev->dev->of_node)
6116ad94	446	tps_board = tps6507x_parse_dt_reg_data(pdev,
4246e55f	447	&tps6507x_reg_matches);
0bc20bba TF	448	if (!tps_board)
	449	return -EINVAL;
	450
3fa5b8e0 AA	451	/**
	452	* init_data points to array of regulator_init structures
	453	* coming from the board-evm file.
	454	*/
0bc20bba	455	init_data = tps_board->tps6507x_pmic_init_data;
3fa5b8e0	456	if (!init_data)
0bc20bba	457	return -EINVAL;
3fa5b8e0	458
9eb0c421	459	tps = devm_kzalloc(&pdev->dev, sizeof(*tps), GFP_KERNEL);
3fa5b8e0 AA	460	if (!tps)
	461	return -ENOMEM;
	462
	463	mutex_init(&tps->io_lock);
	464
	465	/* common for all regulators */
31dd6a26	466	tps->mfd = tps6507x_dev;
3fa5b8e0 AA	467
	468	for (i = 0; i < TPS6507X_NUM_REGULATOR; i++, info++, init_data++) {
	469	/* Register the regulators */
	470	tps->info[i] = info;
7d14831e AA	471	if (init_data->driver_data) {
7d14831e AA	472	struct tps6507x_reg_platform_data *data =
4246e55f	473	init_data->driver_data;
7d14831e AA	474	tps->info[i]->defdcdc_default = data->defdcdc_default;
	475	}
	476
3fa5b8e0	477	tps->desc[i].name = info->name;
77fa44d0	478	tps->desc[i].id = i;
0fcdb109	479	tps->desc[i].n_voltages = info->table_len;
055917ac	480	tps->desc[i].volt_table = info->table;
f2933d33	481	tps->desc[i].ops = &tps6507x_pmic_ops;
3fa5b8e0 AA	482	tps->desc[i].type = REGULATOR_VOLTAGE;
	483	tps->desc[i].owner = THIS_MODULE;
	484
c172708d MB	485	config.dev = tps6507x_dev->dev;
	486	config.init_data = init_data;
	487	config.driver_data = tps;
	488
6116ad94 VBM	489	if (tps6507x_reg_matches) {
	490	error = of_property_read_u32(
	491	tps6507x_reg_matches[i].of_node,
	492	"ti,defdcdc_default", &prop);
	493
	494	if (!error)
	495	tps->info[i]->defdcdc_default = prop;
	496
	497	config.of_node = tps6507x_reg_matches[i].of_node;
	498	}
	499
71b710e7 SK	500	rdev = devm_regulator_register(&pdev->dev, &tps->desc[i],
71b710e7 SK	501	&config);
3fa5b8e0	502	if (IS_ERR(rdev)) {
31dd6a26 TF	503	dev_err(tps6507x_dev->dev,
	504	"failed to register %s regulator\n",
	505	pdev->name);
71b710e7	506	return PTR_ERR(rdev);
3fa5b8e0 AA	507	}
	508
	509	/* Save regulator for cleanup */
	510	tps->rdev[i] = rdev;
	511	}
	512
31dd6a26	513	tps6507x_dev->pmic = tps;
d7399fa8	514	platform_set_drvdata(pdev, tps6507x_dev);
3fa5b8e0 AA	515
3fa5b8e0 AA	516	return 0;
3fa5b8e0 AA	517	}
3fa5b8e0 AA	518
31dd6a26	519	static struct platform_driver tps6507x_pmic_driver = {
3fa5b8e0	520	.driver = {
31dd6a26	521	.name = "tps6507x-pmic",
3fa5b8e0	522	},
4ce5ba5b	523	.probe = tps6507x_pmic_probe,
3fa5b8e0 AA	524	};
3fa5b8e0 AA	525
4ce5ba5b	526	static int __init tps6507x_pmic_init(void)
3fa5b8e0	527	{
31dd6a26	528	return platform_driver_register(&tps6507x_pmic_driver);
3fa5b8e0	529	}
4ce5ba5b	530	subsys_initcall(tps6507x_pmic_init);
3fa5b8e0	531
4ce5ba5b	532	static void __exit tps6507x_pmic_cleanup(void)
3fa5b8e0	533	{
31dd6a26	534	platform_driver_unregister(&tps6507x_pmic_driver);
3fa5b8e0	535	}
4ce5ba5b	536	module_exit(tps6507x_pmic_cleanup);
3fa5b8e0 AA	537
	538	MODULE_AUTHOR("Texas Instruments");
	539	MODULE_DESCRIPTION("TPS6507x voltage regulator driver");
9e108d33	540	MODULE_LICENSE("GPL v2");
31dd6a26	541	MODULE_ALIAS("platform:tps6507x-pmic");