1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
21a016956SKever Yang /*
31a016956SKever Yang  * Copyright (C) 2016 Rockchip Electronics Co., Ltd
41a016956SKever Yang  *
51a016956SKever Yang  * Based on kernel drivers/regulator/pwm-regulator.c
61a016956SKever Yang  * Copyright (C) 2014 - STMicroelectronics Inc.
71a016956SKever Yang  * Author: Lee Jones <lee.jones@linaro.org>
81a016956SKever Yang  */
91a016956SKever Yang 
101a016956SKever Yang #include <common.h>
111a016956SKever Yang #include <dm.h>
121a016956SKever Yang #include <errno.h>
131a016956SKever Yang #include <pwm.h>
141a016956SKever Yang #include <power/regulator.h>
15b08c8c48SMasahiro Yamada #include <linux/libfdt.h>
161a016956SKever Yang #include <fdt_support.h>
171a016956SKever Yang #include <fdtdec.h>
181a016956SKever Yang 
191a016956SKever Yang DECLARE_GLOBAL_DATA_PTR;
201a016956SKever Yang 
211a016956SKever Yang struct pwm_regulator_info {
221a016956SKever Yang 	/* pwm id corresponding to the PWM driver */
231a016956SKever Yang 	int pwm_id;
241a016956SKever Yang 	/* the period of one PWM cycle */
251a016956SKever Yang 	int period_ns;
260b60111aSKever Yang 	/*
270b60111aSKever Yang 	 * the polarity of one PWM
280b60111aSKever Yang 	 * 0: normal polarity
290b60111aSKever Yang 	 * 1: inverted polarity
300b60111aSKever Yang 	 */
310b60111aSKever Yang 	bool polarity;
321a016956SKever Yang 	struct udevice *pwm;
331a016956SKever Yang 	/* initialize voltage of regulator */
34c40d48bbSMark Kettenis 	int init_voltage;
351a016956SKever Yang 	/* the maximum voltage of regulator */
36c40d48bbSMark Kettenis 	int max_voltage;
371a016956SKever Yang 	/* the minimum voltage of regulator */
38c40d48bbSMark Kettenis 	int min_voltage;
391a016956SKever Yang 	/* the current voltage of regulator */
40c40d48bbSMark Kettenis 	int volt_uV;
411a016956SKever Yang };
421a016956SKever Yang 
431a016956SKever Yang static int pwm_regulator_enable(struct udevice *dev, bool enable)
441a016956SKever Yang {
451a016956SKever Yang 	struct pwm_regulator_info *priv = dev_get_priv(dev);
461a016956SKever Yang 
471a016956SKever Yang 	return pwm_set_enable(priv->pwm, priv->pwm_id, enable);
481a016956SKever Yang }
491a016956SKever Yang 
501a016956SKever Yang static int pwm_voltage_to_duty_cycle_percentage(struct udevice *dev, int req_uV)
511a016956SKever Yang {
521a016956SKever Yang 	struct pwm_regulator_info *priv = dev_get_priv(dev);
531a016956SKever Yang 	int min_uV = priv->min_voltage;
541a016956SKever Yang 	int max_uV = priv->max_voltage;
551a016956SKever Yang 	int diff = max_uV - min_uV;
561a016956SKever Yang 
570b60111aSKever Yang 	return ((req_uV * 100) - (min_uV * 100)) / diff;
581a016956SKever Yang }
591a016956SKever Yang 
601a016956SKever Yang static int pwm_regulator_get_voltage(struct udevice *dev)
611a016956SKever Yang {
621a016956SKever Yang 	struct pwm_regulator_info *priv = dev_get_priv(dev);
631a016956SKever Yang 
641a016956SKever Yang 	return priv->volt_uV;
651a016956SKever Yang }
661a016956SKever Yang 
671a016956SKever Yang static int pwm_regulator_set_voltage(struct udevice *dev, int uvolt)
681a016956SKever Yang {
691a016956SKever Yang 	struct pwm_regulator_info *priv = dev_get_priv(dev);
701a016956SKever Yang 	int duty_cycle;
711a016956SKever Yang 	int ret = 0;
721a016956SKever Yang 
731a016956SKever Yang 	duty_cycle = pwm_voltage_to_duty_cycle_percentage(dev, uvolt);
741a016956SKever Yang 
750b60111aSKever Yang 	ret = pwm_set_invert(priv->pwm, priv->pwm_id, priv->polarity);
760b60111aSKever Yang 	if (ret) {
770b60111aSKever Yang 		dev_err(dev, "Failed to init PWM\n");
780b60111aSKever Yang 		return ret;
790b60111aSKever Yang 	}
800b60111aSKever Yang 
811a016956SKever Yang 	ret = pwm_set_config(priv->pwm, priv->pwm_id,
82f339bca2SKever Yang 			priv->period_ns, (priv->period_ns / 100) * duty_cycle);
831a016956SKever Yang 	if (ret) {
841a016956SKever Yang 		dev_err(dev, "Failed to configure PWM\n");
851a016956SKever Yang 		return ret;
861a016956SKever Yang 	}
871a016956SKever Yang 
881a016956SKever Yang 	priv->volt_uV = uvolt;
893030c951SKever Yang 
901a016956SKever Yang 	return ret;
911a016956SKever Yang }
921a016956SKever Yang 
931a016956SKever Yang static int pwm_regulator_ofdata_to_platdata(struct udevice *dev)
941a016956SKever Yang {
951a016956SKever Yang 	struct pwm_regulator_info *priv = dev_get_priv(dev);
961a016956SKever Yang 	struct fdtdec_phandle_args args;
971a016956SKever Yang 	const void *blob = gd->fdt_blob;
98e160f7d4SSimon Glass 	int node = dev_of_offset(dev);
991a016956SKever Yang 	int ret;
1001a016956SKever Yang 
1011a016956SKever Yang 	ret = fdtdec_parse_phandle_with_args(blob, node, "pwms", "#pwm-cells",
1021a016956SKever Yang 					     0, 0, &args);
1031a016956SKever Yang 	if (ret) {
1041a016956SKever Yang 		debug("%s: Cannot get PWM phandle: ret=%d\n", __func__, ret);
1051a016956SKever Yang 		return ret;
1061a016956SKever Yang 	}
1071a016956SKever Yang 
1081a016956SKever Yang 	priv->period_ns = args.args[1];
1090b60111aSKever Yang 	priv->polarity = args.args[2];
1101a016956SKever Yang 
1111a016956SKever Yang 	priv->init_voltage = fdtdec_get_int(blob, node,
1121a016956SKever Yang 			"regulator-init-microvolt", -1);
1131a016956SKever Yang 	if (priv->init_voltage < 0) {
1141a016956SKever Yang 		printf("Cannot find regulator pwm init_voltage\n");
1151a016956SKever Yang 		return -EINVAL;
1161a016956SKever Yang 	}
1171a016956SKever Yang 
1181a016956SKever Yang 	ret = uclass_get_device_by_of_offset(UCLASS_PWM, args.node, &priv->pwm);
1191a016956SKever Yang 	if (ret) {
1201a016956SKever Yang 		debug("%s: Cannot get PWM: ret=%d\n", __func__, ret);
1211a016956SKever Yang 		return ret;
1221a016956SKever Yang 	}
1231a016956SKever Yang 
1241a016956SKever Yang 	return 0;
1251a016956SKever Yang }
1261a016956SKever Yang 
1271a016956SKever Yang static int pwm_regulator_probe(struct udevice *dev)
1281a016956SKever Yang {
1291a016956SKever Yang 	struct pwm_regulator_info *priv = dev_get_priv(dev);
1301a016956SKever Yang 	struct dm_regulator_uclass_platdata *uc_pdata;
1311a016956SKever Yang 
1321a016956SKever Yang 	uc_pdata = dev_get_uclass_platdata(dev);
1331a016956SKever Yang 
1341a016956SKever Yang 	uc_pdata->type = REGULATOR_TYPE_BUCK;
1351a016956SKever Yang 	uc_pdata->mode_count = 0;
1361a016956SKever Yang 	priv->max_voltage = uc_pdata->max_uV;
1371a016956SKever Yang 	priv->min_voltage = uc_pdata->min_uV;
1381a016956SKever Yang 
1391a016956SKever Yang 	if (priv->init_voltage)
1401a016956SKever Yang 		pwm_regulator_set_voltage(dev, priv->init_voltage);
1411a016956SKever Yang 
1421a016956SKever Yang 	return 0;
1431a016956SKever Yang }
1441a016956SKever Yang 
1451a016956SKever Yang static const struct dm_regulator_ops pwm_regulator_ops = {
1461a016956SKever Yang 	.get_value  = pwm_regulator_get_voltage,
1471a016956SKever Yang 	.set_value  = pwm_regulator_set_voltage,
1481a016956SKever Yang 	.set_enable = pwm_regulator_enable,
1491a016956SKever Yang };
1501a016956SKever Yang 
1511a016956SKever Yang static const struct udevice_id pwm_regulator_ids[] = {
1521a016956SKever Yang 	{ .compatible = "pwm-regulator" },
1531a016956SKever Yang 	{ }
1541a016956SKever Yang };
1551a016956SKever Yang 
1561a016956SKever Yang U_BOOT_DRIVER(pwm_regulator) = {
1571a016956SKever Yang 	.name = "pwm_regulator",
1581a016956SKever Yang 	.id = UCLASS_REGULATOR,
1591a016956SKever Yang 	.ops = &pwm_regulator_ops,
1601a016956SKever Yang 	.probe = pwm_regulator_probe,
1611a016956SKever Yang 	.of_match = pwm_regulator_ids,
1621a016956SKever Yang 	.ofdata_to_platdata	= pwm_regulator_ofdata_to_platdata,
1631a016956SKever Yang 	.priv_auto_alloc_size	= sizeof(struct pwm_regulator_info),
1641a016956SKever Yang };
165