1 /*
2  * Copyright (C) 2016 Rockchip Electronics Co., Ltd
3  *
4  * Based on kernel drivers/regulator/pwm-regulator.c
5  * Copyright (C) 2014 - STMicroelectronics Inc.
6  * Author: Lee Jones <lee.jones@linaro.org>
7  *
8  * SPDX-License-Identifier:	GPL-2.0+
9  */
10 
11 #include <common.h>
12 #include <dm.h>
13 #include <errno.h>
14 #include <pwm.h>
15 #include <power/regulator.h>
16 #include <linux/libfdt.h>
17 #include <fdt_support.h>
18 #include <fdtdec.h>
19 
20 DECLARE_GLOBAL_DATA_PTR;
21 
22 struct pwm_regulator_info {
23 	/* pwm id corresponding to the PWM driver */
24 	int pwm_id;
25 	/* the period of one PWM cycle */
26 	int period_ns;
27 	/*
28 	 * the polarity of one PWM
29 	 * 0: normal polarity
30 	 * 1: inverted polarity
31 	 */
32 	bool polarity;
33 	struct udevice *pwm;
34 	/* initialize voltage of regulator */
35 	int init_voltage;
36 	/* the maximum voltage of regulator */
37 	int max_voltage;
38 	/* the minimum voltage of regulator */
39 	int min_voltage;
40 	/* the current voltage of regulator */
41 	int volt_uV;
42 };
43 
44 static int pwm_regulator_enable(struct udevice *dev, bool enable)
45 {
46 	struct pwm_regulator_info *priv = dev_get_priv(dev);
47 
48 	return pwm_set_enable(priv->pwm, priv->pwm_id, enable);
49 }
50 
51 static int pwm_voltage_to_duty_cycle_percentage(struct udevice *dev, int req_uV)
52 {
53 	struct pwm_regulator_info *priv = dev_get_priv(dev);
54 	int min_uV = priv->min_voltage;
55 	int max_uV = priv->max_voltage;
56 	int diff = max_uV - min_uV;
57 
58 	return ((req_uV * 100) - (min_uV * 100)) / diff;
59 }
60 
61 static int pwm_regulator_get_voltage(struct udevice *dev)
62 {
63 	struct pwm_regulator_info *priv = dev_get_priv(dev);
64 
65 	return priv->volt_uV;
66 }
67 
68 static int pwm_regulator_set_voltage(struct udevice *dev, int uvolt)
69 {
70 	struct pwm_regulator_info *priv = dev_get_priv(dev);
71 	int duty_cycle;
72 	int ret = 0;
73 
74 	duty_cycle = pwm_voltage_to_duty_cycle_percentage(dev, uvolt);
75 
76 	ret = pwm_set_invert(priv->pwm, priv->pwm_id, priv->polarity);
77 	if (ret) {
78 		dev_err(dev, "Failed to init PWM\n");
79 		return ret;
80 	}
81 
82 	ret = pwm_set_config(priv->pwm, priv->pwm_id,
83 			priv->period_ns, (priv->period_ns / 100) * duty_cycle);
84 	if (ret) {
85 		dev_err(dev, "Failed to configure PWM\n");
86 		return ret;
87 	}
88 
89 	priv->volt_uV = uvolt;
90 
91 	return ret;
92 }
93 
94 static int pwm_regulator_ofdata_to_platdata(struct udevice *dev)
95 {
96 	struct pwm_regulator_info *priv = dev_get_priv(dev);
97 	struct fdtdec_phandle_args args;
98 	const void *blob = gd->fdt_blob;
99 	int node = dev_of_offset(dev);
100 	int ret;
101 
102 	ret = fdtdec_parse_phandle_with_args(blob, node, "pwms", "#pwm-cells",
103 					     0, 0, &args);
104 	if (ret) {
105 		debug("%s: Cannot get PWM phandle: ret=%d\n", __func__, ret);
106 		return ret;
107 	}
108 
109 	priv->period_ns = args.args[1];
110 	priv->polarity = args.args[2];
111 
112 	priv->init_voltage = fdtdec_get_int(blob, node,
113 			"regulator-init-microvolt", -1);
114 	if (priv->init_voltage < 0) {
115 		printf("Cannot find regulator pwm init_voltage\n");
116 		return -EINVAL;
117 	}
118 
119 	ret = uclass_get_device_by_of_offset(UCLASS_PWM, args.node, &priv->pwm);
120 	if (ret) {
121 		debug("%s: Cannot get PWM: ret=%d\n", __func__, ret);
122 		return ret;
123 	}
124 
125 	return 0;
126 }
127 
128 static int pwm_regulator_probe(struct udevice *dev)
129 {
130 	struct pwm_regulator_info *priv = dev_get_priv(dev);
131 	struct dm_regulator_uclass_platdata *uc_pdata;
132 
133 	uc_pdata = dev_get_uclass_platdata(dev);
134 
135 	uc_pdata->type = REGULATOR_TYPE_BUCK;
136 	uc_pdata->mode_count = 0;
137 	priv->max_voltage = uc_pdata->max_uV;
138 	priv->min_voltage = uc_pdata->min_uV;
139 
140 	if (priv->init_voltage)
141 		pwm_regulator_set_voltage(dev, priv->init_voltage);
142 
143 	return 0;
144 }
145 
146 static const struct dm_regulator_ops pwm_regulator_ops = {
147 	.get_value  = pwm_regulator_get_voltage,
148 	.set_value  = pwm_regulator_set_voltage,
149 	.set_enable = pwm_regulator_enable,
150 };
151 
152 static const struct udevice_id pwm_regulator_ids[] = {
153 	{ .compatible = "pwm-regulator" },
154 	{ }
155 };
156 
157 U_BOOT_DRIVER(pwm_regulator) = {
158 	.name = "pwm_regulator",
159 	.id = UCLASS_REGULATOR,
160 	.ops = &pwm_regulator_ops,
161 	.probe = pwm_regulator_probe,
162 	.of_match = pwm_regulator_ids,
163 	.ofdata_to_platdata	= pwm_regulator_ofdata_to_platdata,
164 	.priv_auto_alloc_size	= sizeof(struct pwm_regulator_info),
165 };
166