1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2015 Masahiro Yamada <yamada.masahiro@socionext.com>
4 */
5
6 #include <common.h>
7 #include <linux/libfdt.h>
8 #include <linux/err.h>
9 #include <linux/list.h>
10 #include <dm.h>
11 #include <dm/lists.h>
12 #include <dm/pinctrl.h>
13 #include <dm/util.h>
14 #include <dm/of_access.h>
15
16 DECLARE_GLOBAL_DATA_PTR;
17
pinctrl_decode_pin_config(const void * blob,int node)18 int pinctrl_decode_pin_config(const void *blob, int node)
19 {
20 int flags = 0;
21
22 if (fdtdec_get_bool(blob, node, "bias-pull-up"))
23 flags |= 1 << PIN_CONFIG_BIAS_PULL_UP;
24 else if (fdtdec_get_bool(blob, node, "bias-pull-down"))
25 flags |= 1 << PIN_CONFIG_BIAS_PULL_DOWN;
26
27 return flags;
28 }
29
30 #if CONFIG_IS_ENABLED(PINCTRL_FULL)
31 /**
32 * pinctrl_config_one() - apply pinctrl settings for a single node
33 *
34 * @config: pin configuration node
35 * @return: 0 on success, or negative error code on failure
36 */
pinctrl_config_one(struct udevice * config)37 static int pinctrl_config_one(struct udevice *config)
38 {
39 struct udevice *pctldev;
40 const struct pinctrl_ops *ops;
41
42 pctldev = config;
43 for (;;) {
44 pctldev = dev_get_parent(pctldev);
45 if (!pctldev) {
46 dev_err(config, "could not find pctldev\n");
47 return -EINVAL;
48 }
49 if (pctldev->uclass->uc_drv->id == UCLASS_PINCTRL)
50 break;
51 }
52
53 ops = pinctrl_get_ops(pctldev);
54 return ops->set_state(pctldev, config);
55 }
56
57 /**
58 * pinctrl_select_state_full() - full implementation of pinctrl_select_state
59 *
60 * @dev: peripheral device
61 * @statename: state name, like "default"
62 * @return: 0 on success, or negative error code on failure
63 */
pinctrl_select_state_full(struct udevice * dev,const char * statename)64 static int pinctrl_select_state_full(struct udevice *dev, const char *statename)
65 {
66 char propname[32]; /* long enough */
67 const fdt32_t *list;
68 uint32_t phandle;
69 struct udevice *config;
70 int state, size, i, ret;
71
72 state = dev_read_stringlist_search(dev, "pinctrl-names", statename);
73 if (state < 0) {
74 char *end;
75 /*
76 * If statename is not found in "pinctrl-names",
77 * assume statename is just the integer state ID.
78 */
79 state = simple_strtoul(statename, &end, 10);
80 if (*end)
81 return -EINVAL;
82 }
83
84 snprintf(propname, sizeof(propname), "pinctrl-%d", state);
85 list = dev_read_prop(dev, propname, &size);
86 if (!list)
87 return -EINVAL;
88
89 size /= sizeof(*list);
90 for (i = 0; i < size; i++) {
91 phandle = fdt32_to_cpu(*list++);
92 ret = uclass_get_device_by_phandle_id(UCLASS_PINCONFIG, phandle,
93 &config);
94 if (ret)
95 return ret;
96
97 ret = pinctrl_config_one(config);
98 if (ret)
99 return ret;
100 }
101
102 return 0;
103 }
104
105 /**
106 * pinconfig_post_bind() - post binding for PINCONFIG uclass
107 * Recursively bind its children as pinconfig devices.
108 *
109 * @dev: pinconfig device
110 * @return: 0 on success, or negative error code on failure
111 */
pinconfig_post_bind(struct udevice * dev)112 static int pinconfig_post_bind(struct udevice *dev)
113 {
114 bool pre_reloc_only = !(gd->flags & GD_FLG_RELOC);
115 const char *name;
116 ofnode node;
117 int ret;
118
119 dev_for_each_subnode(node, dev) {
120 if (pre_reloc_only &&
121 !ofnode_pre_reloc(node))
122 continue;
123 /*
124 * If this node has "compatible" property, this is not
125 * a pin configuration node, but a normal device. skip.
126 */
127 ofnode_get_property(node, "compatible", &ret);
128 if (ret >= 0)
129 continue;
130
131 if (ret != -FDT_ERR_NOTFOUND)
132 return ret;
133
134 name = ofnode_get_name(node);
135 if (!name)
136 return -EINVAL;
137 ret = device_bind_driver_to_node(dev, "pinconfig", name,
138 node, NULL);
139 if (ret)
140 return ret;
141 }
142
143 return 0;
144 }
145
146 UCLASS_DRIVER(pinconfig) = {
147 .id = UCLASS_PINCONFIG,
148 .post_bind = pinconfig_post_bind,
149 .name = "pinconfig",
150 };
151
152 U_BOOT_DRIVER(pinconfig_generic) = {
153 .name = "pinconfig",
154 .id = UCLASS_PINCONFIG,
155 };
156
157 #else
pinctrl_select_state_full(struct udevice * dev,const char * statename)158 static int pinctrl_select_state_full(struct udevice *dev, const char *statename)
159 {
160 return -ENODEV;
161 }
162
pinconfig_post_bind(struct udevice * dev)163 static int pinconfig_post_bind(struct udevice *dev)
164 {
165 return 0;
166 }
167 #endif
168
169 /**
170 * pinctrl_select_state_simple() - simple implementation of pinctrl_select_state
171 *
172 * @dev: peripheral device
173 * @return: 0 on success, or negative error code on failure
174 */
pinctrl_select_state_simple(struct udevice * dev)175 static int pinctrl_select_state_simple(struct udevice *dev)
176 {
177 struct udevice *pctldev;
178 struct pinctrl_ops *ops;
179 int ret;
180
181 /*
182 * For simplicity, assume the first device of PINCTRL uclass
183 * is the correct one. This is most likely OK as there is
184 * usually only one pinctrl device on the system.
185 */
186 ret = uclass_get_device(UCLASS_PINCTRL, 0, &pctldev);
187 if (ret)
188 return ret;
189
190 ops = pinctrl_get_ops(pctldev);
191 if (!ops->set_state_simple) {
192 dev_dbg(dev, "set_state_simple op missing\n");
193 return -ENOSYS;
194 }
195
196 return ops->set_state_simple(pctldev, dev);
197 }
198
pinctrl_select_state(struct udevice * dev,const char * statename)199 int pinctrl_select_state(struct udevice *dev, const char *statename)
200 {
201 /*
202 * Some device which is logical like mmc.blk, do not have
203 * a valid ofnode.
204 */
205 if (!ofnode_valid(dev->node))
206 return 0;
207 /*
208 * Try full-implemented pinctrl first.
209 * If it fails or is not implemented, try simple one.
210 */
211 if (pinctrl_select_state_full(dev, statename))
212 return pinctrl_select_state_simple(dev);
213
214 return 0;
215 }
216
pinctrl_request(struct udevice * dev,int func,int flags)217 int pinctrl_request(struct udevice *dev, int func, int flags)
218 {
219 struct pinctrl_ops *ops = pinctrl_get_ops(dev);
220
221 if (!ops->request)
222 return -ENOSYS;
223
224 return ops->request(dev, func, flags);
225 }
226
pinctrl_request_noflags(struct udevice * dev,int func)227 int pinctrl_request_noflags(struct udevice *dev, int func)
228 {
229 return pinctrl_request(dev, func, 0);
230 }
231
pinctrl_get_periph_id(struct udevice * dev,struct udevice * periph)232 int pinctrl_get_periph_id(struct udevice *dev, struct udevice *periph)
233 {
234 struct pinctrl_ops *ops = pinctrl_get_ops(dev);
235
236 if (!ops->get_periph_id)
237 return -ENOSYS;
238
239 return ops->get_periph_id(dev, periph);
240 }
241
pinctrl_get_gpio_mux(struct udevice * dev,int banknum,int index)242 int pinctrl_get_gpio_mux(struct udevice *dev, int banknum, int index)
243 {
244 struct pinctrl_ops *ops = pinctrl_get_ops(dev);
245
246 if (!ops->get_gpio_mux)
247 return -ENOSYS;
248
249 return ops->get_gpio_mux(dev, banknum, index);
250 }
251
252 /**
253 * pinconfig_post_bind() - post binding for PINCTRL uclass
254 * Recursively bind child nodes as pinconfig devices in case of full pinctrl.
255 *
256 * @dev: pinctrl device
257 * @return: 0 on success, or negative error code on failure
258 */
pinctrl_post_bind(struct udevice * dev)259 static int pinctrl_post_bind(struct udevice *dev)
260 {
261 const struct pinctrl_ops *ops = pinctrl_get_ops(dev);
262
263 if (!ops) {
264 dev_dbg(dev, "ops is not set. Do not bind.\n");
265 return -EINVAL;
266 }
267
268 /*
269 * If set_state callback is set, we assume this pinctrl driver is the
270 * full implementation. In this case, its child nodes should be bound
271 * so that peripheral devices can easily search in parent devices
272 * during later DT-parsing.
273 */
274 if (ops->set_state)
275 return pinconfig_post_bind(dev);
276
277 return 0;
278 }
279
280 UCLASS_DRIVER(pinctrl) = {
281 .id = UCLASS_PINCTRL,
282 .post_bind = pinctrl_post_bind,
283 .flags = DM_UC_FLAG_SEQ_ALIAS,
284 .name = "pinctrl",
285 };
286