1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Copyright (C) 2016 IBM Corp.
6 #include <linux/mfd/syscon.h>
7 #include <linux/platform_device.h>
8 #include <linux/slab.h>
9 #include <linux/string.h>
11 #include "pinctrl-aspeed.h"
13 int aspeed_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
15 struct aspeed_pinctrl_data *pdata = pinctrl_dev_get_drvdata(pctldev);
17 return pdata->pinmux.ngroups;
20 const char *aspeed_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
23 struct aspeed_pinctrl_data *pdata = pinctrl_dev_get_drvdata(pctldev);
25 return pdata->pinmux.groups[group].name;
28 int aspeed_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
29 unsigned int group, const unsigned int **pins,
32 struct aspeed_pinctrl_data *pdata = pinctrl_dev_get_drvdata(pctldev);
34 *pins = &pdata->pinmux.groups[group].pins[0];
35 *npins = pdata->pinmux.groups[group].npins;
40 void aspeed_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev,
41 struct seq_file *s, unsigned int offset)
43 seq_printf(s, " %s", dev_name(pctldev->dev));
46 int aspeed_pinmux_get_fn_count(struct pinctrl_dev *pctldev)
48 struct aspeed_pinctrl_data *pdata = pinctrl_dev_get_drvdata(pctldev);
50 return pdata->pinmux.nfunctions;
53 const char *aspeed_pinmux_get_fn_name(struct pinctrl_dev *pctldev,
54 unsigned int function)
56 struct aspeed_pinctrl_data *pdata = pinctrl_dev_get_drvdata(pctldev);
58 return pdata->pinmux.functions[function].name;
61 int aspeed_pinmux_get_fn_groups(struct pinctrl_dev *pctldev,
62 unsigned int function,
63 const char * const **groups,
64 unsigned int * const num_groups)
66 struct aspeed_pinctrl_data *pdata = pinctrl_dev_get_drvdata(pctldev);
68 *groups = pdata->pinmux.functions[function].groups;
69 *num_groups = pdata->pinmux.functions[function].ngroups;
74 static int aspeed_sig_expr_enable(const struct aspeed_pinmux_data *ctx,
75 const struct aspeed_sig_expr *expr)
79 ret = aspeed_sig_expr_eval(ctx, expr, true);
84 return aspeed_sig_expr_set(ctx, expr, true);
89 static int aspeed_sig_expr_disable(const struct aspeed_pinmux_data *ctx,
90 const struct aspeed_sig_expr *expr)
94 ret = aspeed_sig_expr_eval(ctx, expr, true);
99 return aspeed_sig_expr_set(ctx, expr, false);
105 * Disable a signal on a pin by disabling all provided signal expressions.
107 * @ctx: The pinmux context
108 * @exprs: The list of signal expressions (from a priority level on a pin)
110 * Return: 0 if all expressions are disabled, otherwise a negative error code
112 static int aspeed_disable_sig(const struct aspeed_pinmux_data *ctx,
113 const struct aspeed_sig_expr **exprs)
120 while (*exprs && !ret) {
121 ret = aspeed_sig_expr_disable(ctx, *exprs);
129 * Search for the signal expression needed to enable the pin's signal for the
130 * requested function.
132 * @exprs: List of signal expressions (haystack)
133 * @name: The name of the requested function (needle)
135 * Return: A pointer to the signal expression whose function tag matches the
136 * provided name, otherwise NULL.
139 static const struct aspeed_sig_expr *aspeed_find_expr_by_name(
140 const struct aspeed_sig_expr **exprs, const char *name)
143 if (strcmp((*exprs)->function, name) == 0)
151 static char *get_defined_attribute(const struct aspeed_pin_desc *pdesc,
153 const struct aspeed_sig_expr *))
157 const struct aspeed_sig_expr ***prios, **funcs, *expr;
159 prios = pdesc->prios;
161 while ((funcs = *prios)) {
162 while ((expr = *funcs)) {
163 const char *str = get(expr);
164 size_t delta = strlen(str) + 2;
167 expanded = krealloc(found, len + delta + 1, GFP_KERNEL);
190 found[len - 2] = '\0';
195 static const char *aspeed_sig_expr_function(const struct aspeed_sig_expr *expr)
197 return expr->function;
200 static char *get_defined_functions(const struct aspeed_pin_desc *pdesc)
202 return get_defined_attribute(pdesc, aspeed_sig_expr_function);
205 static const char *aspeed_sig_expr_signal(const struct aspeed_sig_expr *expr)
210 static char *get_defined_signals(const struct aspeed_pin_desc *pdesc)
212 return get_defined_attribute(pdesc, aspeed_sig_expr_signal);
215 int aspeed_pinmux_set_mux(struct pinctrl_dev *pctldev, unsigned int function,
220 const struct aspeed_pinctrl_data *pdata =
221 pinctrl_dev_get_drvdata(pctldev);
222 const struct aspeed_pin_group *pgroup = &pdata->pinmux.groups[group];
223 const struct aspeed_pin_function *pfunc =
224 &pdata->pinmux.functions[function];
226 for (i = 0; i < pgroup->npins; i++) {
227 int pin = pgroup->pins[i];
228 const struct aspeed_pin_desc *pdesc = pdata->pins[pin].drv_data;
229 const struct aspeed_sig_expr *expr = NULL;
230 const struct aspeed_sig_expr **funcs;
231 const struct aspeed_sig_expr ***prios;
233 pr_debug("Muxing pin %d for %s\n", pin, pfunc->name);
238 prios = pdesc->prios;
243 /* Disable functions at a higher priority than that requested */
244 while ((funcs = *prios)) {
245 expr = aspeed_find_expr_by_name(funcs, pfunc->name);
250 ret = aspeed_disable_sig(&pdata->pinmux, funcs);
258 char *functions = get_defined_functions(pdesc);
259 char *signals = get_defined_signals(pdesc);
261 pr_warn("No function %s found on pin %s (%d). Found signal(s) %s for function(s) %s\n",
262 pfunc->name, pdesc->name, pin, signals,
270 ret = aspeed_sig_expr_enable(&pdata->pinmux, expr);
278 static bool aspeed_expr_is_gpio(const struct aspeed_sig_expr *expr)
281 * The signal type is GPIO if the signal name has "GPIO" as a prefix.
282 * strncmp (rather than strcmp) is used to implement the prefix
285 * expr->signal might look like "GPIOT3" in the GPIO case.
287 return strncmp(expr->signal, "GPIO", 4) == 0;
290 static bool aspeed_gpio_in_exprs(const struct aspeed_sig_expr **exprs)
296 if (aspeed_expr_is_gpio(*exprs))
304 int aspeed_gpio_request_enable(struct pinctrl_dev *pctldev,
305 struct pinctrl_gpio_range *range,
309 const struct aspeed_pinctrl_data *pdata =
310 pinctrl_dev_get_drvdata(pctldev);
311 const struct aspeed_pin_desc *pdesc = pdata->pins[offset].drv_data;
312 const struct aspeed_sig_expr ***prios, **funcs, *expr;
317 prios = pdesc->prios;
322 /* Disable any functions of higher priority than GPIO */
323 while ((funcs = *prios)) {
324 if (aspeed_gpio_in_exprs(funcs))
327 ret = aspeed_disable_sig(&pdata->pinmux, funcs);
335 char *signals = get_defined_signals(pdesc);
337 pr_warn("No GPIO signal type found on pin %s (%d). Found: %s\n",
338 pdesc->name, offset, signals);
347 * Disabling all higher-priority expressions is enough to enable the
348 * lowest-priority signal type. As such it has no associated
355 * If GPIO is not the lowest priority signal type, assume there is only
356 * one expression defined to enable the GPIO function
358 return aspeed_sig_expr_enable(&pdata->pinmux, expr);
361 int aspeed_pinctrl_probe(struct platform_device *pdev,
362 struct pinctrl_desc *pdesc,
363 struct aspeed_pinctrl_data *pdata)
365 struct device *parent;
366 struct pinctrl_dev *pctl;
368 parent = pdev->dev.parent;
370 dev_err(&pdev->dev, "No parent for syscon pincontroller\n");
374 pdata->scu = syscon_node_to_regmap(parent->of_node);
375 if (IS_ERR(pdata->scu)) {
376 dev_err(&pdev->dev, "No regmap for syscon pincontroller parent\n");
377 return PTR_ERR(pdata->scu);
380 pdata->pinmux.maps[ASPEED_IP_SCU] = pdata->scu;
382 pctl = pinctrl_register(pdesc, &pdev->dev, pdata);
385 dev_err(&pdev->dev, "Failed to register pinctrl\n");
386 return PTR_ERR(pctl);
389 platform_set_drvdata(pdev, pdata);
394 static inline bool pin_in_config_range(unsigned int offset,
395 const struct aspeed_pin_config *config)
397 return offset >= config->pins[0] && offset <= config->pins[1];
400 static inline const struct aspeed_pin_config *find_pinconf_config(
401 const struct aspeed_pinctrl_data *pdata,
403 enum pin_config_param param)
407 for (i = 0; i < pdata->nconfigs; i++) {
408 if (param == pdata->configs[i].param &&
409 pin_in_config_range(offset, &pdata->configs[i]))
410 return &pdata->configs[i];
417 * Aspeed pin configuration description.
419 * @param: pinconf configuration parameter
420 * @arg: The supported argument for @param, or -1 if any value is supported
421 * @val: The register value to write to configure @arg for @param
423 * The map is to be used in conjunction with the configuration array supplied
424 * by the driver implementation.
426 struct aspeed_pin_config_map {
427 enum pin_config_param param;
432 enum aspeed_pin_config_map_type { MAP_TYPE_ARG, MAP_TYPE_VAL };
434 /* Aspeed consistently both:
436 * 1. Defines "disable bits" for internal pull-downs
437 * 2. Uses 8mA or 16mA drive strengths
439 static const struct aspeed_pin_config_map pin_config_map[] = {
440 { PIN_CONFIG_BIAS_PULL_DOWN, 0, 1 },
441 { PIN_CONFIG_BIAS_PULL_DOWN, -1, 0 },
442 { PIN_CONFIG_BIAS_DISABLE, -1, 1 },
443 { PIN_CONFIG_DRIVE_STRENGTH, 8, 0 },
444 { PIN_CONFIG_DRIVE_STRENGTH, 16, 1 },
447 static const struct aspeed_pin_config_map *find_pinconf_map(
448 enum pin_config_param param,
449 enum aspeed_pin_config_map_type type,
454 for (i = 0; i < ARRAY_SIZE(pin_config_map); i++) {
455 const struct aspeed_pin_config_map *elem;
458 elem = &pin_config_map[i];
462 match = (elem->arg == -1 || elem->arg == value);
465 match = (elem->val == value);
469 if (param == elem->param && match)
476 int aspeed_pin_config_get(struct pinctrl_dev *pctldev, unsigned int offset,
477 unsigned long *config)
479 const enum pin_config_param param = pinconf_to_config_param(*config);
480 const struct aspeed_pin_config_map *pmap;
481 const struct aspeed_pinctrl_data *pdata;
482 const struct aspeed_pin_config *pconf;
487 pdata = pinctrl_dev_get_drvdata(pctldev);
488 pconf = find_pinconf_config(pdata, offset, param);
492 rc = regmap_read(pdata->scu, pconf->reg, &val);
496 pmap = find_pinconf_map(param, MAP_TYPE_VAL,
497 (val & BIT(pconf->bit)) >> pconf->bit);
502 if (param == PIN_CONFIG_DRIVE_STRENGTH)
503 arg = (u32) pmap->arg;
504 else if (param == PIN_CONFIG_BIAS_PULL_DOWN)
512 *config = pinconf_to_config_packed(param, arg);
517 int aspeed_pin_config_set(struct pinctrl_dev *pctldev, unsigned int offset,
518 unsigned long *configs, unsigned int num_configs)
520 const struct aspeed_pinctrl_data *pdata;
524 pdata = pinctrl_dev_get_drvdata(pctldev);
526 for (i = 0; i < num_configs; i++) {
527 const struct aspeed_pin_config_map *pmap;
528 const struct aspeed_pin_config *pconf;
529 enum pin_config_param param;
533 param = pinconf_to_config_param(configs[i]);
534 arg = pinconf_to_config_argument(configs[i]);
536 pconf = find_pinconf_config(pdata, offset, param);
540 pmap = find_pinconf_map(param, MAP_TYPE_ARG, arg);
545 val = pmap->val << pconf->bit;
547 rc = regmap_update_bits(pdata->scu, pconf->reg,
548 BIT(pconf->bit), val);
553 pr_debug("%s: Set SCU%02X[%d]=%d for param %d(=%d) on pin %d\n",
554 __func__, pconf->reg, pconf->bit, pmap->val,
561 int aspeed_pin_config_group_get(struct pinctrl_dev *pctldev,
562 unsigned int selector,
563 unsigned long *config)
565 const unsigned int *pins;
569 rc = aspeed_pinctrl_get_group_pins(pctldev, selector, &pins, &npins);
576 rc = aspeed_pin_config_get(pctldev, pins[0], config);
581 int aspeed_pin_config_group_set(struct pinctrl_dev *pctldev,
582 unsigned int selector,
583 unsigned long *configs,
584 unsigned int num_configs)
586 const unsigned int *pins;
591 pr_debug("%s: Fetching pins for group selector %d\n",
593 rc = aspeed_pinctrl_get_group_pins(pctldev, selector, &pins, &npins);
597 for (i = 0; i < npins; i++) {
598 rc = aspeed_pin_config_set(pctldev, pins[i], configs,