[u-boot.git] / drivers / power / regulator / sandbox.c

/*
 *  Copyright (C) 2015 Samsung Electronics
 *  Przemyslaw Marczak  <[email protected]>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <fdtdec.h>
#include <errno.h>
#include <dm.h>
#include <i2c.h>
#include <power/pmic.h>
#include <power/regulator.h>
#include <power/sandbox_pmic.h>

DECLARE_GLOBAL_DATA_PTR;

#define MODE(_id, _val, _name) [_id] = {  \
	.id = _id,                \
	.register_value = _val,   \
	.name = _name,            \
}

#define RANGE(_min, _max, _step) { \
	.min = _min,               \
	.max = _max,               \
	.step = _step,             \
}

/*
 * struct output_range - helper structure type to define the range of output
 * operating values (current/voltage), limited by the PMIC IC design.
 *
 * @min  - minimum value
 * @max  - maximum value
 * @step - step value
*/
struct output_range {
	int min;
	int max;
	int step;
};

/* BUCK: 1,2 - voltage range */
static struct output_range buck_voltage_range[] = {
	RANGE(OUT_BUCK1_UV_MIN, OUT_BUCK1_UV_MAX, OUT_BUCK1_UV_STEP),
	RANGE(OUT_BUCK2_UV_MIN, OUT_BUCK2_UV_MAX, OUT_BUCK2_UV_STEP),
};

/* BUCK: 1 - current range */
static struct output_range buck_current_range[] = {
	RANGE(OUT_BUCK1_UA_MIN, OUT_BUCK1_UA_MAX, OUT_BUCK1_UA_STEP),
};

/* BUCK operating modes */
static struct dm_regulator_mode sandbox_buck_modes[] = {
	MODE(BUCK_OM_OFF, OM2REG(BUCK_OM_OFF), "OFF"),
	MODE(BUCK_OM_ON, OM2REG(BUCK_OM_ON), "ON"),
	MODE(BUCK_OM_PWM, OM2REG(BUCK_OM_PWM), "PWM"),
};

/* LDO: 1,2 - voltage range */
static struct output_range ldo_voltage_range[] = {
	RANGE(OUT_LDO1_UV_MIN, OUT_LDO1_UV_MAX, OUT_LDO1_UV_STEP),
	RANGE(OUT_LDO2_UV_MIN, OUT_LDO2_UV_MAX, OUT_LDO2_UV_STEP),
};

/* LDO: 1 - current range */
static struct output_range ldo_current_range[] = {
	RANGE(OUT_LDO1_UA_MIN, OUT_LDO1_UA_MAX, OUT_LDO1_UA_STEP),
};

/* LDO operating modes */
static struct dm_regulator_mode sandbox_ldo_modes[] = {
	MODE(LDO_OM_OFF, OM2REG(LDO_OM_OFF), "OFF"),
	MODE(LDO_OM_ON, OM2REG(LDO_OM_ON), "ON"),
	MODE(LDO_OM_SLEEP, OM2REG(LDO_OM_SLEEP), "SLEEP"),
	MODE(LDO_OM_STANDBY, OM2REG(LDO_OM_STANDBY), "STANDBY"),
};

int out_get_value(struct udevice *dev, int output_count, int reg_type,
		  struct output_range *range)
{
	uint8_t reg_val;
	uint reg;
	int ret;

	if (dev->driver_data > output_count) {
		pr_err("Unknown regulator number: %lu for PMIC %s!",
		      dev->driver_data, dev->name);
		return -EINVAL;
	}

	reg = (dev->driver_data - 1) * OUT_REG_COUNT + reg_type;
	ret = pmic_read(dev->parent, reg, &reg_val, 1);
	if (ret) {
		pr_err("PMIC read failed: %d\n",  ret);
		return ret;
	}

	ret =  REG2VAL(range[dev->driver_data - 1].min,
		       range[dev->driver_data - 1].step,
		       reg_val);

	return ret;
}

static int out_set_value(struct udevice *dev, int output_count, int reg_type,
			 struct output_range *range, int value)
{
	uint8_t reg_val;
	uint reg;
	int ret;
	int max_value;

	if (dev->driver_data > output_count) {
		pr_err("Unknown regulator number: %lu for PMIC %s!",
		      dev->driver_data, dev->name);
		return -EINVAL;
	}

	max_value = range[dev->driver_data - 1].max;
	if (value > max_value) {
		pr_err("Wrong value for %s: %lu. Max is: %d.",
		      dev->name, dev->driver_data, max_value);
		return -EINVAL;
	}

	reg_val = VAL2REG(range[dev->driver_data - 1].min,
			  range[dev->driver_data - 1].step,
			  value);

	reg = (dev->driver_data - 1) * OUT_REG_COUNT + reg_type;
	ret = pmic_write(dev->parent, reg, &reg_val, 1);
	if (ret) {
		pr_err("PMIC write failed: %d\n",  ret);
		return ret;
	}

	return 0;
}

static int out_get_mode(struct udevice *dev)
{
	struct dm_regulator_uclass_platdata *uc_pdata;
	uint8_t reg_val;
	uint reg;
	int ret;
	int i;

	uc_pdata = dev_get_uclass_platdata(dev);

	reg = (dev->driver_data - 1) * OUT_REG_COUNT + OUT_REG_OM;
	ret = pmic_read(dev->parent, reg, &reg_val, 1);
	if (ret) {
		pr_err("PMIC read failed: %d\n",  ret);
		return ret;
	}

	for (i = 0; i < uc_pdata->mode_count; i++) {
		if (reg_val == uc_pdata->mode[i].register_value)
			return uc_pdata->mode[i].id;
	}

	pr_err("Unknown operation mode for %s!", dev->name);
	return -EINVAL;
}

static int out_set_mode(struct udevice *dev, int mode)
{
	struct dm_regulator_uclass_platdata *uc_pdata;
	int reg_val = -1;
	uint reg;
	int ret;
	int i;

	uc_pdata = dev_get_uclass_platdata(dev);

	if (mode >= uc_pdata->mode_count)
		return -EINVAL;

	for (i = 0; i < uc_pdata->mode_count; i++) {
		if (mode == uc_pdata->mode[i].id) {
			reg_val = uc_pdata->mode[i].register_value;
			break;
		}
	}

	if (reg_val == -1) {
		pr_err("Unknown operation mode for %s!", dev->name);
		return -EINVAL;
	}

	reg = (dev->driver_data - 1) * OUT_REG_COUNT + OUT_REG_OM;
	ret = pmic_write(dev->parent, reg, (uint8_t *)&reg_val, 1);
	if (ret) {
		pr_err("PMIC write failed: %d\n",  ret);
		return ret;
	}

	return 0;
}

static int buck_get_voltage(struct udevice *dev)
{
	return out_get_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UV,
			      buck_voltage_range);
}

static int buck_set_voltage(struct udevice *dev, int uV)
{
	return out_set_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UV,
			      buck_voltage_range, uV);
}

static int buck_get_current(struct udevice *dev)
{
	/* BUCK2 - unsupported */
	if (dev->driver_data == 2)
		return -ENOSYS;

	return out_get_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UA,
			      buck_current_range);
}

static int buck_set_current(struct udevice *dev, int uA)
{
	/* BUCK2 - unsupported */
	if (dev->driver_data == 2)
		return -ENOSYS;

	return out_set_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UA,
			      buck_current_range, uA);
}

static int buck_get_enable(struct udevice *dev)
{
	if (out_get_mode(dev) == BUCK_OM_OFF)
		return false;

	return true;
}

static int buck_set_enable(struct udevice *dev, bool enable)
{
	return out_set_mode(dev, enable ? BUCK_OM_ON : BUCK_OM_OFF);
}

static int sandbox_buck_probe(struct udevice *dev)
{
	struct dm_regulator_uclass_platdata *uc_pdata;

	uc_pdata = dev_get_uclass_platdata(dev);

	uc_pdata->type = REGULATOR_TYPE_BUCK;
	uc_pdata->mode = sandbox_buck_modes;
	uc_pdata->mode_count = ARRAY_SIZE(sandbox_buck_modes);

	return 0;
}

static const struct dm_regulator_ops sandbox_buck_ops = {
	.get_value   = buck_get_voltage,
	.set_value   = buck_set_voltage,
	.get_current = buck_get_current,
	.set_current = buck_set_current,
	.get_enable  = buck_get_enable,
	.set_enable  = buck_set_enable,
	.get_mode    = out_get_mode,
	.set_mode    = out_set_mode,
};

U_BOOT_DRIVER(sandbox_buck) = {
	.name = SANDBOX_BUCK_DRIVER,
	.id = UCLASS_REGULATOR,
	.ops = &sandbox_buck_ops,
	.probe = sandbox_buck_probe,
};

static int ldo_get_voltage(struct udevice *dev)
{
	return out_get_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UV,
			     ldo_voltage_range);
}

static int ldo_set_voltage(struct udevice *dev, int uV)
{
	return out_set_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UV,
			     ldo_voltage_range, uV);
}

static int ldo_get_current(struct udevice *dev)
{
	/* LDO2 - unsupported */
	if (dev->driver_data == 2)
		return -ENOSYS;

	return out_get_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UA,
			     ldo_current_range);
}

static int ldo_set_current(struct udevice *dev, int uA)
{
	/* LDO2 - unsupported */
	if (dev->driver_data == 2)
		return -ENOSYS;

	return out_set_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UA,
			     ldo_current_range, uA);
}

static int ldo_get_enable(struct udevice *dev)
{
	if (out_get_mode(dev) == LDO_OM_OFF)
		return false;

	return true;
}

static int ldo_set_enable(struct udevice *dev, bool enable)
{
	return out_set_mode(dev, enable ? LDO_OM_ON : LDO_OM_OFF);
}

static int sandbox_ldo_probe(struct udevice *dev)
{
	struct dm_regulator_uclass_platdata *uc_pdata;

	uc_pdata = dev_get_uclass_platdata(dev);

	uc_pdata->type = REGULATOR_TYPE_LDO;
	uc_pdata->mode = sandbox_ldo_modes;
	uc_pdata->mode_count = ARRAY_SIZE(sandbox_ldo_modes);

	return 0;
}

static const struct dm_regulator_ops sandbox_ldo_ops = {
	.get_value   = ldo_get_voltage,
	.set_value   = ldo_set_voltage,
	.get_current = ldo_get_current,
	.set_current = ldo_set_current,
	.get_enable  = ldo_get_enable,
	.set_enable  = ldo_set_enable,
	.get_mode    = out_get_mode,
	.set_mode    = out_set_mode,
};

U_BOOT_DRIVER(sandbox_ldo) = {
	.name = SANDBOX_LDO_DRIVER,
	.id = UCLASS_REGULATOR,
	.ops = &sandbox_ldo_ops,
	.probe = sandbox_ldo_probe,
};
Commit	Line	Data
5d387d0d PM	1	/*
	2	* Copyright (C) 2015 Samsung Electronics
	3	* Przemyslaw Marczak <[email protected]>
	4	*
	5	* SPDX-License-Identifier: GPL-2.0+
	6	*/
	7
	8	#include <common.h>
	9	#include <fdtdec.h>
	10	#include <errno.h>
	11	#include <dm.h>
	12	#include <i2c.h>
	13	#include <power/pmic.h>
	14	#include <power/regulator.h>
	15	#include <power/sandbox_pmic.h>
	16
	17	DECLARE_GLOBAL_DATA_PTR;
	18
	19	#define MODE(_id, _val, _name) [_id] = { \
	20	.id = _id, \
	21	.register_value = _val, \
	22	.name = _name, \
	23	}
	24
	25	#define RANGE(_min, _max, _step) { \
	26	.min = _min, \
	27	.max = _max, \
	28	.step = _step, \
	29	}
	30
	31	/*
	32	* struct output_range - helper structure type to define the range of output
	33	* operating values (current/voltage), limited by the PMIC IC design.
	34	*
	35	* @min - minimum value
	36	* @max - maximum value
	37	* @step - step value
	38	*/
	39	struct output_range {
	40	int min;
	41	int max;
	42	int step;
	43	};
	44
	45	/* BUCK: 1,2 - voltage range */
	46	static struct output_range buck_voltage_range[] = {
	47	RANGE(OUT_BUCK1_UV_MIN, OUT_BUCK1_UV_MAX, OUT_BUCK1_UV_STEP),
	48	RANGE(OUT_BUCK2_UV_MIN, OUT_BUCK2_UV_MAX, OUT_BUCK2_UV_STEP),
	49	};
	50
	51	/* BUCK: 1 - current range */
	52	static struct output_range buck_current_range[] = {
	53	RANGE(OUT_BUCK1_UA_MIN, OUT_BUCK1_UA_MAX, OUT_BUCK1_UA_STEP),
	54	};
	55
	56	/* BUCK operating modes */
	57	static struct dm_regulator_mode sandbox_buck_modes[] = {
	58	MODE(BUCK_OM_OFF, OM2REG(BUCK_OM_OFF), "OFF"),
	59	MODE(BUCK_OM_ON, OM2REG(BUCK_OM_ON), "ON"),
	60	MODE(BUCK_OM_PWM, OM2REG(BUCK_OM_PWM), "PWM"),
	61	};
	62
	63	/* LDO: 1,2 - voltage range */
	64	static struct output_range ldo_voltage_range[] = {
65	RANGE(OUT_LDO1_UV_MIN, OUT_LDO1_UV_MAX, OUT_LDO1_UV_STEP),
66	RANGE(OUT_LDO2_UV_MIN, OUT_LDO2_UV_MAX, OUT_LDO2_UV_STEP),
67	};
68
69	/* LDO: 1 - current range */
70	static struct output_range ldo_current_range[] = {
71	RANGE(OUT_LDO1_UA_MIN, OUT_LDO1_UA_MAX, OUT_LDO1_UA_STEP),
72	};
73
74	/* LDO operating modes */
75	static struct dm_regulator_mode sandbox_ldo_modes[] = {
76	MODE(LDO_OM_OFF, OM2REG(LDO_OM_OFF), "OFF"),
77	MODE(LDO_OM_ON, OM2REG(LDO_OM_ON), "ON"),
78	MODE(LDO_OM_SLEEP, OM2REG(LDO_OM_SLEEP), "SLEEP"),
79	MODE(LDO_OM_STANDBY, OM2REG(LDO_OM_STANDBY), "STANDBY"),
80	};
81
82	int out_get_value(struct udevice *dev, int output_count, int reg_type,
83	struct output_range *range)
84	{
85	uint8_t reg_val;
86	uint reg;
87	int ret;
88
89	if (dev->driver_data > output_count) {
9b643e31	90	pr_err("Unknown regulator number: %lu for PMIC %s!",
5d387d0d PM	91	dev->driver_data, dev->name);
	92	return -EINVAL;
	93	}
	94
	95	reg = (dev->driver_data - 1) * OUT_REG_COUNT + reg_type;
	96	ret = pmic_read(dev->parent, reg, &reg_val, 1);
	97	if (ret) {
9b643e31	98	pr_err("PMIC read failed: %d\n", ret);
5d387d0d PM	99	return ret;
	100	}
	101
	102	ret = REG2VAL(range[dev->driver_data - 1].min,
	103	range[dev->driver_data - 1].step,
	104	reg_val);
	105
	106	return ret;
	107	}
	108
	109	static int out_set_value(struct udevice *dev, int output_count, int reg_type,
	110	struct output_range *range, int value)
	111	{
	112	uint8_t reg_val;
	113	uint reg;
	114	int ret;
	115	int max_value;
	116
	117	if (dev->driver_data > output_count) {
9b643e31	118	pr_err("Unknown regulator number: %lu for PMIC %s!",
5d387d0d PM	119	dev->driver_data, dev->name);
	120	return -EINVAL;
	121	}
	122
	123	max_value = range[dev->driver_data - 1].max;
	124	if (value > max_value) {
9b643e31	125	pr_err("Wrong value for %s: %lu. Max is: %d.",
5d387d0d PM	126	dev->name, dev->driver_data, max_value);
	127	return -EINVAL;
	128	}
	129
	130	reg_val = VAL2REG(range[dev->driver_data - 1].min,
	131	range[dev->driver_data - 1].step,
	132	value);
	133
	134	reg = (dev->driver_data - 1) * OUT_REG_COUNT + reg_type;
	135	ret = pmic_write(dev->parent, reg, &reg_val, 1);
	136	if (ret) {
9b643e31	137	pr_err("PMIC write failed: %d\n", ret);
5d387d0d PM	138	return ret;
	139	}
	140
	141	return 0;
	142	}
	143
	144	static int out_get_mode(struct udevice *dev)
	145	{
	146	struct dm_regulator_uclass_platdata *uc_pdata;
	147	uint8_t reg_val;
	148	uint reg;
	149	int ret;
	150	int i;
	151
	152	uc_pdata = dev_get_uclass_platdata(dev);
	153
	154	reg = (dev->driver_data - 1) * OUT_REG_COUNT + OUT_REG_OM;
	155	ret = pmic_read(dev->parent, reg, &reg_val, 1);
	156	if (ret) {
9b643e31	157	pr_err("PMIC read failed: %d\n", ret);
5d387d0d PM	158	return ret;
	159	}
	160
	161	for (i = 0; i < uc_pdata->mode_count; i++) {
	162	if (reg_val == uc_pdata->mode[i].register_value)
	163	return uc_pdata->mode[i].id;
	164	}
	165
9b643e31	166	pr_err("Unknown operation mode for %s!", dev->name);
5d387d0d PM	167	return -EINVAL;
	168	}
	169
	170	static int out_set_mode(struct udevice *dev, int mode)
	171	{
	172	struct dm_regulator_uclass_platdata *uc_pdata;
	173	int reg_val = -1;
	174	uint reg;
	175	int ret;
	176	int i;
	177
	178	uc_pdata = dev_get_uclass_platdata(dev);
	179
	180	if (mode >= uc_pdata->mode_count)
	181	return -EINVAL;
	182
	183	for (i = 0; i < uc_pdata->mode_count; i++) {
	184	if (mode == uc_pdata->mode[i].id) {
	185	reg_val = uc_pdata->mode[i].register_value;
	186	break;
	187	}
	188	}
	189
	190	if (reg_val == -1) {
9b643e31	191	pr_err("Unknown operation mode for %s!", dev->name);
5d387d0d PM	192	return -EINVAL;
	193	}
	194
	195	reg = (dev->driver_data - 1) * OUT_REG_COUNT + OUT_REG_OM;
	196	ret = pmic_write(dev->parent, reg, (uint8_t *)&reg_val, 1);
	197	if (ret) {
9b643e31	198	pr_err("PMIC write failed: %d\n", ret);
5d387d0d PM	199	return ret;
	200	}
	201
	202	return 0;
	203	}
	204
	205	static int buck_get_voltage(struct udevice *dev)
	206	{
	207	return out_get_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UV,
	208	buck_voltage_range);
	209	}
	210
	211	static int buck_set_voltage(struct udevice *dev, int uV)
	212	{
	213	return out_set_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UV,
	214	buck_voltage_range, uV);
	215	}
	216
	217	static int buck_get_current(struct udevice *dev)
	218	{
	219	/* BUCK2 - unsupported */
	220	if (dev->driver_data == 2)
	221	return -ENOSYS;
	222
	223	return out_get_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UA,
	224	buck_current_range);
	225	}
	226
	227	static int buck_set_current(struct udevice *dev, int uA)
	228	{
	229	/* BUCK2 - unsupported */
	230	if (dev->driver_data == 2)
	231	return -ENOSYS;
	232
	233	return out_set_value(dev, SANDBOX_BUCK_COUNT, OUT_REG_UA,
	234	buck_current_range, uA);
	235	}
	236
3bbe7c13	237	static int buck_get_enable(struct udevice *dev)
5d387d0d PM	238	{
	239	if (out_get_mode(dev) == BUCK_OM_OFF)
	240	return false;
	241
	242	return true;
	243	}
	244
	245	static int buck_set_enable(struct udevice *dev, bool enable)
	246	{
	247	return out_set_mode(dev, enable ? BUCK_OM_ON : BUCK_OM_OFF);
	248	}
	249
	250	static int sandbox_buck_probe(struct udevice *dev)
	251	{
	252	struct dm_regulator_uclass_platdata *uc_pdata;
	253
	254	uc_pdata = dev_get_uclass_platdata(dev);
	255
	256	uc_pdata->type = REGULATOR_TYPE_BUCK;
	257	uc_pdata->mode = sandbox_buck_modes;
	258	uc_pdata->mode_count = ARRAY_SIZE(sandbox_buck_modes);
	259
	260	return 0;
	261	}
	262
	263	static const struct dm_regulator_ops sandbox_buck_ops = {
	264	.get_value = buck_get_voltage,
	265	.set_value = buck_set_voltage,
	266	.get_current = buck_get_current,
	267	.set_current = buck_set_current,
	268	.get_enable = buck_get_enable,
	269	.set_enable = buck_set_enable,
	270	.get_mode = out_get_mode,
	271	.set_mode = out_set_mode,
	272	};
	273
	274	U_BOOT_DRIVER(sandbox_buck) = {
	275	.name = SANDBOX_BUCK_DRIVER,
	276	.id = UCLASS_REGULATOR,
	277	.ops = &sandbox_buck_ops,
	278	.probe = sandbox_buck_probe,
	279	};
	280
	281	static int ldo_get_voltage(struct udevice *dev)
	282	{
	283	return out_get_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UV,
	284	ldo_voltage_range);
	285	}
	286
	287	static int ldo_set_voltage(struct udevice *dev, int uV)
	288	{
	289	return out_set_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UV,
	290	ldo_voltage_range, uV);
	291	}
	292
	293	static int ldo_get_current(struct udevice *dev)
	294	{
	295	/* LDO2 - unsupported */
	296	if (dev->driver_data == 2)
	297	return -ENOSYS;
	298
	299	return out_get_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UA,
	300	ldo_current_range);
	301	}
302
303	static int ldo_set_current(struct udevice *dev, int uA)
304	{
305	/* LDO2 - unsupported */
306	if (dev->driver_data == 2)
307	return -ENOSYS;
308
309	return out_set_value(dev, SANDBOX_LDO_COUNT, OUT_REG_UA,
310	ldo_current_range, uA);
311	}
312
3bbe7c13	313	static int ldo_get_enable(struct udevice *dev)
5d387d0d PM	314	{
	315	if (out_get_mode(dev) == LDO_OM_OFF)
	316	return false;
	317
	318	return true;
	319	}
	320
	321	static int ldo_set_enable(struct udevice *dev, bool enable)
	322	{
	323	return out_set_mode(dev, enable ? LDO_OM_ON : LDO_OM_OFF);
	324	}
	325
	326	static int sandbox_ldo_probe(struct udevice *dev)
	327	{
	328	struct dm_regulator_uclass_platdata *uc_pdata;
	329
	330	uc_pdata = dev_get_uclass_platdata(dev);
	331
	332	uc_pdata->type = REGULATOR_TYPE_LDO;
	333	uc_pdata->mode = sandbox_ldo_modes;
	334	uc_pdata->mode_count = ARRAY_SIZE(sandbox_ldo_modes);
	335
	336	return 0;
	337	}
	338
	339	static const struct dm_regulator_ops sandbox_ldo_ops = {
	340	.get_value = ldo_get_voltage,
	341	.set_value = ldo_set_voltage,
	342	.get_current = ldo_get_current,
	343	.set_current = ldo_set_current,
	344	.get_enable = ldo_get_enable,
	345	.set_enable = ldo_set_enable,
	346	.get_mode = out_get_mode,
	347	.set_mode = out_set_mode,
	348	};
	349
	350	U_BOOT_DRIVER(sandbox_ldo) = {
	351	.name = SANDBOX_LDO_DRIVER,
	352	.id = UCLASS_REGULATOR,
	353	.ops = &sandbox_ldo_ops,
	354	.probe = sandbox_ldo_probe,
	355	};