blob: 9fd6d9087dc508ca7731d7f1e868988e0e320cc2 [file] [log] [blame]
Linus Walleij2744e8a2011-05-02 20:50:54 +02001/*
2 * Core driver for the pin muxing portions of the pin control subsystem
3 *
Linus Walleije93bcee2012-02-09 07:23:28 +01004 * Copyright (C) 2011-2012 ST-Ericsson SA
Linus Walleij2744e8a2011-05-02 20:50:54 +02005 * Written on behalf of Linaro for ST-Ericsson
6 * Based on bits of regulator core, gpio core and clk core
7 *
8 * Author: Linus Walleij <linus.walleij@linaro.org>
9 *
Stephen Warren7ecdb162012-03-02 13:05:45 -070010 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
11 *
Linus Walleij2744e8a2011-05-02 20:50:54 +020012 * License terms: GNU General Public License (GPL) version 2
13 */
14#define pr_fmt(fmt) "pinmux core: " fmt
15
16#include <linux/kernel.h>
17#include <linux/module.h>
18#include <linux/init.h>
19#include <linux/device.h>
20#include <linux/slab.h>
21#include <linux/radix-tree.h>
22#include <linux/err.h>
23#include <linux/list.h>
Linus Walleij97607d12011-11-29 12:52:39 +010024#include <linux/string.h>
Linus Walleij2744e8a2011-05-02 20:50:54 +020025#include <linux/sysfs.h>
26#include <linux/debugfs.h>
27#include <linux/seq_file.h>
28#include <linux/pinctrl/machine.h>
29#include <linux/pinctrl/pinmux.h>
30#include "core.h"
Linus Walleijbefe5bd2012-02-09 19:47:48 +010031#include "pinmux.h"
Linus Walleij2744e8a2011-05-02 20:50:54 +020032
Stephen Warren03665e02012-02-19 23:45:45 -070033int pinmux_check_ops(struct pinctrl_dev *pctldev)
34{
35 const struct pinmux_ops *ops = pctldev->desc->pmxops;
Dong Aishenga1d31f72012-04-06 20:18:09 +080036 unsigned nfuncs;
Stephen Warren03665e02012-02-19 23:45:45 -070037 unsigned selector = 0;
38
39 /* Check that we implement required operations */
Dong Aishenga1d31f72012-04-06 20:18:09 +080040 if (!ops ||
41 !ops->get_functions_count ||
Stephen Warren03665e02012-02-19 23:45:45 -070042 !ops->get_function_name ||
43 !ops->get_function_groups ||
Linus Walleij03e9f0c2014-09-03 13:02:56 +020044 !ops->set_mux) {
John Crispinad6e1102012-04-26 16:47:11 +020045 dev_err(pctldev->dev, "pinmux ops lacks necessary functions\n");
Stephen Warren03665e02012-02-19 23:45:45 -070046 return -EINVAL;
John Crispinad6e1102012-04-26 16:47:11 +020047 }
Stephen Warren03665e02012-02-19 23:45:45 -070048 /* Check that all functions registered have names */
Dong Aishenga1d31f72012-04-06 20:18:09 +080049 nfuncs = ops->get_functions_count(pctldev);
Viresh Kumard1e90e92012-03-30 11:25:40 +053050 while (selector < nfuncs) {
Stephen Warren03665e02012-02-19 23:45:45 -070051 const char *fname = ops->get_function_name(pctldev,
52 selector);
53 if (!fname) {
Dong Aishenga1d31f72012-04-06 20:18:09 +080054 dev_err(pctldev->dev, "pinmux ops has no name for function%u\n",
Stephen Warren03665e02012-02-19 23:45:45 -070055 selector);
56 return -EINVAL;
57 }
58 selector++;
59 }
60
61 return 0;
62}
63
Stephen Warren1e2082b2012-03-02 13:05:48 -070064int pinmux_validate_map(struct pinctrl_map const *map, int i)
65{
66 if (!map->data.mux.function) {
67 pr_err("failed to register map %s (%d): no function given\n",
68 map->name, i);
69 return -EINVAL;
70 }
71
72 return 0;
73}
74
Linus Walleij2744e8a2011-05-02 20:50:54 +020075/**
Linus Walleij2744e8a2011-05-02 20:50:54 +020076 * pin_request() - request a single pin to be muxed in, typically for GPIO
77 * @pin: the pin number in the global pin space
Stephen Warren3cc70ed2012-02-19 23:45:44 -070078 * @owner: a representation of the owner of this pin; typically the device
79 * name that controls its mux function, or the requested GPIO name
Linus Walleij2744e8a2011-05-02 20:50:54 +020080 * @gpio_range: the range matching the GPIO pin if this is a request for a
81 * single GPIO pin
82 */
83static int pin_request(struct pinctrl_dev *pctldev,
Stephen Warren3cc70ed2012-02-19 23:45:44 -070084 int pin, const char *owner,
Linus Walleij2744e8a2011-05-02 20:50:54 +020085 struct pinctrl_gpio_range *gpio_range)
86{
87 struct pin_desc *desc;
88 const struct pinmux_ops *ops = pctldev->desc->pmxops;
89 int status = -EINVAL;
90
Linus Walleij2744e8a2011-05-02 20:50:54 +020091 desc = pin_desc_get(pctldev, pin);
92 if (desc == NULL) {
Stephen Warren51cd24e2011-12-09 16:59:05 -070093 dev_err(pctldev->dev,
Stephen Warrend4705312012-05-01 11:14:15 -060094 "pin %d is not registered so it cannot be requested\n",
95 pin);
Linus Walleij2744e8a2011-05-02 20:50:54 +020096 goto out;
97 }
98
Dong Aishengd0bd8df2012-04-17 15:00:45 +080099 dev_dbg(pctldev->dev, "request pin %d (%s) for %s\n",
100 pin, desc->name, owner);
101
Vladimir Zapolskiyb1eb8fa2016-12-25 02:59:28 +0200102 if ((!gpio_range || ops->strict) &&
103 desc->mux_usecount && strcmp(desc->mux_owner, owner)) {
104 dev_err(pctldev->dev,
105 "pin %s already requested by %s; cannot claim for %s\n",
106 desc->name, desc->mux_owner, owner);
107 goto out;
108 }
Stephen Warren652162d2012-03-05 17:22:15 -0700109
Vladimir Zapolskiyb1eb8fa2016-12-25 02:59:28 +0200110 if ((gpio_range || ops->strict) && desc->gpio_owner) {
111 dev_err(pctldev->dev,
112 "pin %s already requested by %s; cannot claim for %s\n",
113 desc->name, desc->gpio_owner, owner);
114 goto out;
115 }
116
117 if (gpio_range) {
Stephen Warren652162d2012-03-05 17:22:15 -0700118 desc->gpio_owner = owner;
119 } else {
Stephen Warren652162d2012-03-05 17:22:15 -0700120 desc->mux_usecount++;
121 if (desc->mux_usecount > 1)
122 return 0;
123
124 desc->mux_owner = owner;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200125 }
Stephen Warren0e3db1732012-03-02 13:05:46 -0700126
Linus Walleij2744e8a2011-05-02 20:50:54 +0200127 /* Let each pin increase references to this module */
128 if (!try_module_get(pctldev->owner)) {
Stephen Warren51cd24e2011-12-09 16:59:05 -0700129 dev_err(pctldev->dev,
Linus Walleij2744e8a2011-05-02 20:50:54 +0200130 "could not increase module refcount for pin %d\n",
131 pin);
132 status = -EINVAL;
133 goto out_free_pin;
134 }
135
136 /*
137 * If there is no kind of request function for the pin we just assume
138 * we got it by default and proceed.
139 */
Stephen Warren3712a3c2011-10-21 12:25:53 -0600140 if (gpio_range && ops->gpio_request_enable)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200141 /* This requests and enables a single GPIO pin */
142 status = ops->gpio_request_enable(pctldev, gpio_range, pin);
143 else if (ops->request)
144 status = ops->request(pctldev, pin);
145 else
146 status = 0;
147
Stephen Warren0e3db1732012-03-02 13:05:46 -0700148 if (status) {
Stephen Warrend4705312012-05-01 11:14:15 -0600149 dev_err(pctldev->dev, "request() failed for pin %d\n", pin);
Stephen Warren0e3db1732012-03-02 13:05:46 -0700150 module_put(pctldev->owner);
151 }
152
Linus Walleij2744e8a2011-05-02 20:50:54 +0200153out_free_pin:
Stephen Warren0e3db1732012-03-02 13:05:46 -0700154 if (status) {
Stephen Warren652162d2012-03-05 17:22:15 -0700155 if (gpio_range) {
156 desc->gpio_owner = NULL;
157 } else {
158 desc->mux_usecount--;
159 if (!desc->mux_usecount)
160 desc->mux_owner = NULL;
161 }
Stephen Warren0e3db1732012-03-02 13:05:46 -0700162 }
Linus Walleij2744e8a2011-05-02 20:50:54 +0200163out:
164 if (status)
Stephen Warren51cd24e2011-12-09 16:59:05 -0700165 dev_err(pctldev->dev, "pin-%d (%s) status %d\n",
Stephen Warrend4705312012-05-01 11:14:15 -0600166 pin, owner, status);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200167
168 return status;
169}
170
171/**
172 * pin_free() - release a single muxed in pin so something else can be muxed
173 * @pctldev: pin controller device handling this pin
174 * @pin: the pin to free
Stephen Warren3712a3c2011-10-21 12:25:53 -0600175 * @gpio_range: the range matching the GPIO pin if this is a request for a
176 * single GPIO pin
Linus Walleij336cdba02011-11-10 09:27:41 +0100177 *
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700178 * This function returns a pointer to the previous owner. This is used
179 * for callers that dynamically allocate an owner name so it can be freed
Linus Walleij336cdba02011-11-10 09:27:41 +0100180 * once the pin is free. This is done for GPIO request functions.
Linus Walleij2744e8a2011-05-02 20:50:54 +0200181 */
Stephen Warren3712a3c2011-10-21 12:25:53 -0600182static const char *pin_free(struct pinctrl_dev *pctldev, int pin,
183 struct pinctrl_gpio_range *gpio_range)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200184{
185 const struct pinmux_ops *ops = pctldev->desc->pmxops;
186 struct pin_desc *desc;
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700187 const char *owner;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200188
189 desc = pin_desc_get(pctldev, pin);
190 if (desc == NULL) {
Stephen Warren51cd24e2011-12-09 16:59:05 -0700191 dev_err(pctldev->dev,
Linus Walleij2744e8a2011-05-02 20:50:54 +0200192 "pin is not registered so it cannot be freed\n");
Stephen Warren3712a3c2011-10-21 12:25:53 -0600193 return NULL;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200194 }
195
Stephen Warren652162d2012-03-05 17:22:15 -0700196 if (!gpio_range) {
Richard Genoud740924a2013-03-21 12:21:47 +0100197 /*
198 * A pin should not be freed more times than allocated.
199 */
200 if (WARN_ON(!desc->mux_usecount))
201 return NULL;
Stephen Warren652162d2012-03-05 17:22:15 -0700202 desc->mux_usecount--;
203 if (desc->mux_usecount)
204 return NULL;
205 }
Stephen Warren0e3db1732012-03-02 13:05:46 -0700206
Stephen Warren3712a3c2011-10-21 12:25:53 -0600207 /*
208 * If there is no kind of request function for the pin we just assume
209 * we got it by default and proceed.
210 */
211 if (gpio_range && ops->gpio_disable_free)
212 ops->gpio_disable_free(pctldev, gpio_range, pin);
213 else if (ops->free)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200214 ops->free(pctldev, pin);
215
Stephen Warren652162d2012-03-05 17:22:15 -0700216 if (gpio_range) {
217 owner = desc->gpio_owner;
218 desc->gpio_owner = NULL;
219 } else {
220 owner = desc->mux_owner;
221 desc->mux_owner = NULL;
222 desc->mux_setting = NULL;
223 }
224
Linus Walleij2744e8a2011-05-02 20:50:54 +0200225 module_put(pctldev->owner);
Stephen Warren3712a3c2011-10-21 12:25:53 -0600226
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700227 return owner;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200228}
229
230/**
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100231 * pinmux_request_gpio() - request pinmuxing for a GPIO pin
232 * @pctldev: pin controller device affected
233 * @pin: the pin to mux in for GPIO
234 * @range: the applicable GPIO range
Linus Walleij2744e8a2011-05-02 20:50:54 +0200235 */
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100236int pinmux_request_gpio(struct pinctrl_dev *pctldev,
237 struct pinctrl_gpio_range *range,
238 unsigned pin, unsigned gpio)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200239{
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700240 const char *owner;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200241 int ret;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200242
243 /* Conjure some name stating what chip and pin this is taken by */
Thomas Petazzoni23a895a2012-09-13 21:48:14 +0200244 owner = kasprintf(GFP_KERNEL, "%s:%d", range->name, gpio);
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700245 if (!owner)
Masahiro Yamada1fb1f052016-05-25 20:14:13 +0900246 return -ENOMEM;
Stephen Warren5d2eaf82011-10-19 16:19:28 -0600247
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700248 ret = pin_request(pctldev, pin, owner, range);
Stephen Warren5d2eaf82011-10-19 16:19:28 -0600249 if (ret < 0)
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700250 kfree(owner);
Stephen Warren5d2eaf82011-10-19 16:19:28 -0600251
252 return ret;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200253}
Linus Walleij2744e8a2011-05-02 20:50:54 +0200254
255/**
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100256 * pinmux_free_gpio() - release a pin from GPIO muxing
257 * @pctldev: the pin controller device for the pin
258 * @pin: the affected currently GPIO-muxed in pin
259 * @range: applicable GPIO range
Linus Walleij2744e8a2011-05-02 20:50:54 +0200260 */
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100261void pinmux_free_gpio(struct pinctrl_dev *pctldev, unsigned pin,
262 struct pinctrl_gpio_range *range)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200263{
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700264 const char *owner;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200265
Stephen Warren3cc70ed2012-02-19 23:45:44 -0700266 owner = pin_free(pctldev, pin, range);
267 kfree(owner);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200268}
Linus Walleij2744e8a2011-05-02 20:50:54 +0200269
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100270/**
271 * pinmux_gpio_direction() - set the direction of a single muxed-in GPIO pin
272 * @pctldev: the pin controller handling this pin
273 * @range: applicable GPIO range
274 * @pin: the affected GPIO pin in this controller
275 * @input: true if we set the pin as input, false for output
276 */
277int pinmux_gpio_direction(struct pinctrl_dev *pctldev,
278 struct pinctrl_gpio_range *range,
279 unsigned pin, bool input)
Linus Walleij542e7042011-11-14 10:06:22 +0100280{
Linus Walleij542e7042011-11-14 10:06:22 +0100281 const struct pinmux_ops *ops;
282 int ret;
Linus Walleij542e7042011-11-14 10:06:22 +0100283
284 ops = pctldev->desc->pmxops;
285
Linus Walleij542e7042011-11-14 10:06:22 +0100286 if (ops->gpio_set_direction)
287 ret = ops->gpio_set_direction(pctldev, range, pin, input);
288 else
289 ret = 0;
290
291 return ret;
292}
293
Stephen Warren7ecdb162012-03-02 13:05:45 -0700294static int pinmux_func_name_to_selector(struct pinctrl_dev *pctldev,
295 const char *function)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200296{
297 const struct pinmux_ops *ops = pctldev->desc->pmxops;
Viresh Kumard1e90e92012-03-30 11:25:40 +0530298 unsigned nfuncs = ops->get_functions_count(pctldev);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200299 unsigned selector = 0;
300
301 /* See if this pctldev has this function */
Viresh Kumard1e90e92012-03-30 11:25:40 +0530302 while (selector < nfuncs) {
Masahiro Yamada163dc9f2015-08-01 13:22:38 +0900303 const char *fname = ops->get_function_name(pctldev, selector);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200304
Stephen Warren7ecdb162012-03-02 13:05:45 -0700305 if (!strcmp(function, fname))
306 return selector;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200307
Linus Walleij2744e8a2011-05-02 20:50:54 +0200308 selector++;
309 }
310
Masahiro Yamadae3249572015-07-21 15:25:27 +0900311 dev_err(pctldev->dev, "function '%s' not supported\n", function);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200312 return -EINVAL;
313}
314
Stephen Warren7ecdb162012-03-02 13:05:45 -0700315int pinmux_map_to_setting(struct pinctrl_map const *map,
316 struct pinctrl_setting *setting)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200317{
Stephen Warren7ecdb162012-03-02 13:05:45 -0700318 struct pinctrl_dev *pctldev = setting->pctldev;
319 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
Stephen Warren7ecdb162012-03-02 13:05:45 -0700320 char const * const *groups;
321 unsigned num_groups;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200322 int ret;
Stephen Warren7ecdb162012-03-02 13:05:45 -0700323 const char *group;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200324
Dong Aishengad8bb722012-04-10 12:41:34 +0800325 if (!pmxops) {
326 dev_err(pctldev->dev, "does not support mux function\n");
327 return -EINVAL;
328 }
329
John Crispin15f70e12012-04-23 19:01:58 +0200330 ret = pinmux_func_name_to_selector(pctldev, map->data.mux.function);
John Crispinad6e1102012-04-26 16:47:11 +0200331 if (ret < 0) {
332 dev_err(pctldev->dev, "invalid function %s in map table\n",
333 map->data.mux.function);
John Crispin15f70e12012-04-23 19:01:58 +0200334 return ret;
John Crispinad6e1102012-04-26 16:47:11 +0200335 }
John Crispin15f70e12012-04-23 19:01:58 +0200336 setting->data.mux.func = ret;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200337
Stephen Warren1e2082b2012-03-02 13:05:48 -0700338 ret = pmxops->get_function_groups(pctldev, setting->data.mux.func,
Stephen Warren7ecdb162012-03-02 13:05:45 -0700339 &groups, &num_groups);
John Crispinad6e1102012-04-26 16:47:11 +0200340 if (ret < 0) {
341 dev_err(pctldev->dev, "can't query groups for function %s\n",
342 map->data.mux.function);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200343 return ret;
John Crispinad6e1102012-04-26 16:47:11 +0200344 }
345 if (!num_groups) {
346 dev_err(pctldev->dev,
347 "function %s can't be selected on any group\n",
348 map->data.mux.function);
Stephen Warren7ecdb162012-03-02 13:05:45 -0700349 return -EINVAL;
John Crispinad6e1102012-04-26 16:47:11 +0200350 }
Stephen Warren1e2082b2012-03-02 13:05:48 -0700351 if (map->data.mux.group) {
Stephen Warren1e2082b2012-03-02 13:05:48 -0700352 group = map->data.mux.group;
Andy Shevchenkodff43592016-03-17 14:22:20 -0700353 ret = match_string(groups, num_groups, group);
354 if (ret < 0) {
John Crispinad6e1102012-04-26 16:47:11 +0200355 dev_err(pctldev->dev,
356 "invalid group \"%s\" for function \"%s\"\n",
357 group, map->data.mux.function);
Andy Shevchenkodff43592016-03-17 14:22:20 -0700358 return ret;
John Crispinad6e1102012-04-26 16:47:11 +0200359 }
Stephen Warren7ecdb162012-03-02 13:05:45 -0700360 } else {
361 group = groups[0];
362 }
363
John Crispin15f70e12012-04-23 19:01:58 +0200364 ret = pinctrl_get_group_selector(pctldev, group);
John Crispinad6e1102012-04-26 16:47:11 +0200365 if (ret < 0) {
366 dev_err(pctldev->dev, "invalid group %s in map table\n",
367 map->data.mux.group);
John Crispin15f70e12012-04-23 19:01:58 +0200368 return ret;
John Crispinad6e1102012-04-26 16:47:11 +0200369 }
John Crispin15f70e12012-04-23 19:01:58 +0200370 setting->data.mux.group = ret;
Stephen Warren7ecdb162012-03-02 13:05:45 -0700371
Linus Walleij2744e8a2011-05-02 20:50:54 +0200372 return 0;
373}
374
Stephen Warren7ecdb162012-03-02 13:05:45 -0700375void pinmux_free_setting(struct pinctrl_setting const *setting)
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100376{
Linus Walleij1a789582012-10-17 20:51:54 +0200377 /* This function is currently unused */
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100378}
379
Stephen Warren7ecdb162012-03-02 13:05:45 -0700380int pinmux_enable_setting(struct pinctrl_setting const *setting)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200381{
Stephen Warren7ecdb162012-03-02 13:05:45 -0700382 struct pinctrl_dev *pctldev = setting->pctldev;
Stephen Warrenba110d92012-03-02 13:05:49 -0700383 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
Linus Walleijbefe5bd2012-02-09 19:47:48 +0100384 const struct pinmux_ops *ops = pctldev->desc->pmxops;
Antoine Ténarte5b3b2d2014-04-10 15:07:50 +0200385 int ret = 0;
386 const unsigned *pins = NULL;
387 unsigned num_pins = 0;
Stephen Warrenba110d92012-03-02 13:05:49 -0700388 int i;
389 struct pin_desc *desc;
390
Antoine Ténarte5b3b2d2014-04-10 15:07:50 +0200391 if (pctlops->get_group_pins)
392 ret = pctlops->get_group_pins(pctldev, setting->data.mux.group,
393 &pins, &num_pins);
394
Stephen Warrenba110d92012-03-02 13:05:49 -0700395 if (ret) {
Linus Walleij1c8e7942013-08-14 18:23:33 +0200396 const char *gname;
397
Stephen Warrenba110d92012-03-02 13:05:49 -0700398 /* errors only affect debug data, so just warn */
Linus Walleij1c8e7942013-08-14 18:23:33 +0200399 gname = pctlops->get_group_name(pctldev,
400 setting->data.mux.group);
Stephen Warrenba110d92012-03-02 13:05:49 -0700401 dev_warn(pctldev->dev,
Linus Walleij1c8e7942013-08-14 18:23:33 +0200402 "could not get pins for group %s\n",
403 gname);
Stephen Warrenba110d92012-03-02 13:05:49 -0700404 num_pins = 0;
405 }
406
Linus Walleij1a789582012-10-17 20:51:54 +0200407 /* Try to allocate all pins in this group, one by one */
408 for (i = 0; i < num_pins; i++) {
409 ret = pin_request(pctldev, pins[i], setting->dev_name, NULL);
410 if (ret) {
Linus Walleij1c8e7942013-08-14 18:23:33 +0200411 const char *gname;
412 const char *pname;
413
414 desc = pin_desc_get(pctldev, pins[i]);
415 pname = desc ? desc->name : "non-existing";
416 gname = pctlops->get_group_name(pctldev,
417 setting->data.mux.group);
Linus Walleij1a789582012-10-17 20:51:54 +0200418 dev_err(pctldev->dev,
Linus Walleij1c8e7942013-08-14 18:23:33 +0200419 "could not request pin %d (%s) from group %s "
420 " on device %s\n",
421 pins[i], pname, gname,
422 pinctrl_dev_get_name(pctldev));
Axel Line38d4572012-11-10 21:53:20 +0800423 goto err_pin_request;
Linus Walleij1a789582012-10-17 20:51:54 +0200424 }
425 }
426
427 /* Now that we have acquired the pins, encode the mux setting */
Stephen Warrenba110d92012-03-02 13:05:49 -0700428 for (i = 0; i < num_pins; i++) {
429 desc = pin_desc_get(pctldev, pins[i]);
430 if (desc == NULL) {
431 dev_warn(pctldev->dev,
432 "could not get pin desc for pin %d\n",
433 pins[i]);
434 continue;
435 }
436 desc->mux_setting = &(setting->data.mux);
437 }
Linus Walleij2744e8a2011-05-02 20:50:54 +0200438
Linus Walleij03e9f0c2014-09-03 13:02:56 +0200439 ret = ops->set_mux(pctldev, setting->data.mux.func,
440 setting->data.mux.group);
Axel Line38d4572012-11-10 21:53:20 +0800441
442 if (ret)
Linus Walleij03e9f0c2014-09-03 13:02:56 +0200443 goto err_set_mux;
Axel Line38d4572012-11-10 21:53:20 +0800444
445 return 0;
446
Linus Walleij03e9f0c2014-09-03 13:02:56 +0200447err_set_mux:
Axel Line38d4572012-11-10 21:53:20 +0800448 for (i = 0; i < num_pins; i++) {
449 desc = pin_desc_get(pctldev, pins[i]);
450 if (desc)
451 desc->mux_setting = NULL;
452 }
453err_pin_request:
454 /* On error release all taken pins */
455 while (--i >= 0)
456 pin_free(pctldev, pins[i], NULL);
457
458 return ret;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200459}
Linus Walleij2744e8a2011-05-02 20:50:54 +0200460
Stephen Warren7ecdb162012-03-02 13:05:45 -0700461void pinmux_disable_setting(struct pinctrl_setting const *setting)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200462{
Stephen Warren7ecdb162012-03-02 13:05:45 -0700463 struct pinctrl_dev *pctldev = setting->pctldev;
Stephen Warrenba110d92012-03-02 13:05:49 -0700464 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
Antoine Ténarte5b3b2d2014-04-10 15:07:50 +0200465 int ret = 0;
466 const unsigned *pins = NULL;
467 unsigned num_pins = 0;
Stephen Warrenba110d92012-03-02 13:05:49 -0700468 int i;
469 struct pin_desc *desc;
470
Antoine Ténarte5b3b2d2014-04-10 15:07:50 +0200471 if (pctlops->get_group_pins)
472 ret = pctlops->get_group_pins(pctldev, setting->data.mux.group,
473 &pins, &num_pins);
Stephen Warrenba110d92012-03-02 13:05:49 -0700474 if (ret) {
Linus Walleij1c8e7942013-08-14 18:23:33 +0200475 const char *gname;
476
Stephen Warrenba110d92012-03-02 13:05:49 -0700477 /* errors only affect debug data, so just warn */
Linus Walleij1c8e7942013-08-14 18:23:33 +0200478 gname = pctlops->get_group_name(pctldev,
479 setting->data.mux.group);
Stephen Warrenba110d92012-03-02 13:05:49 -0700480 dev_warn(pctldev->dev,
Linus Walleij1c8e7942013-08-14 18:23:33 +0200481 "could not get pins for group %s\n",
482 gname);
Stephen Warrenba110d92012-03-02 13:05:49 -0700483 num_pins = 0;
484 }
485
Linus Walleij1a789582012-10-17 20:51:54 +0200486 /* Flag the descs that no setting is active */
Stephen Warrenba110d92012-03-02 13:05:49 -0700487 for (i = 0; i < num_pins; i++) {
488 desc = pin_desc_get(pctldev, pins[i]);
489 if (desc == NULL) {
490 dev_warn(pctldev->dev,
491 "could not get pin desc for pin %d\n",
492 pins[i]);
493 continue;
494 }
Sonic Zhang744f0a92013-08-14 13:26:43 +0800495 if (desc->mux_setting == &(setting->data.mux)) {
496 desc->mux_setting = NULL;
497 /* And release the pin */
498 pin_free(pctldev, pins[i], NULL);
Linus Walleij1c8e7942013-08-14 18:23:33 +0200499 } else {
500 const char *gname;
Linus Walleij1c8e7942013-08-14 18:23:33 +0200501
Linus Walleij1c8e7942013-08-14 18:23:33 +0200502 gname = pctlops->get_group_name(pctldev,
503 setting->data.mux.group);
504 dev_warn(pctldev->dev,
505 "not freeing pin %d (%s) as part of "
506 "deactivating group %s - it is already "
507 "used for some other setting",
Michael Opdenacker808e6572013-10-29 04:50:45 +0100508 pins[i], desc->name, gname);
Sonic Zhang744f0a92013-08-14 13:26:43 +0800509 }
Stephen Warrenba110d92012-03-02 13:05:49 -0700510 }
Linus Walleij2744e8a2011-05-02 20:50:54 +0200511}
Linus Walleij2744e8a2011-05-02 20:50:54 +0200512
Linus Walleij2744e8a2011-05-02 20:50:54 +0200513#ifdef CONFIG_DEBUG_FS
514
515/* Called from pincontrol core */
516static int pinmux_functions_show(struct seq_file *s, void *what)
517{
518 struct pinctrl_dev *pctldev = s->private;
519 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
Dong Aishengad8bb722012-04-10 12:41:34 +0800520 unsigned nfuncs;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200521 unsigned func_selector = 0;
522
Dong Aishengad8bb722012-04-10 12:41:34 +0800523 if (!pmxops)
524 return 0;
Stephen Warren57b676f2012-03-02 13:05:44 -0700525
Patrice Chotard42fed7b2013-04-11 11:01:27 +0200526 mutex_lock(&pctldev->mutex);
Dong Aishengad8bb722012-04-10 12:41:34 +0800527 nfuncs = pmxops->get_functions_count(pctldev);
Viresh Kumard1e90e92012-03-30 11:25:40 +0530528 while (func_selector < nfuncs) {
Linus Walleij2744e8a2011-05-02 20:50:54 +0200529 const char *func = pmxops->get_function_name(pctldev,
530 func_selector);
531 const char * const *groups;
532 unsigned num_groups;
533 int ret;
534 int i;
535
536 ret = pmxops->get_function_groups(pctldev, func_selector,
537 &groups, &num_groups);
Ludovic Desroches9d7ebbb2015-06-08 17:16:37 +0200538 if (ret) {
Linus Walleij2744e8a2011-05-02 20:50:54 +0200539 seq_printf(s, "function %s: COULD NOT GET GROUPS\n",
540 func);
Ludovic Desroches9d7ebbb2015-06-08 17:16:37 +0200541 func_selector++;
542 continue;
543 }
Linus Walleij2744e8a2011-05-02 20:50:54 +0200544
545 seq_printf(s, "function: %s, groups = [ ", func);
546 for (i = 0; i < num_groups; i++)
547 seq_printf(s, "%s ", groups[i]);
548 seq_puts(s, "]\n");
549
550 func_selector++;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200551 }
552
Patrice Chotard42fed7b2013-04-11 11:01:27 +0200553 mutex_unlock(&pctldev->mutex);
Stephen Warren57b676f2012-03-02 13:05:44 -0700554
Linus Walleij2744e8a2011-05-02 20:50:54 +0200555 return 0;
556}
557
558static int pinmux_pins_show(struct seq_file *s, void *what)
559{
560 struct pinctrl_dev *pctldev = s->private;
Stephen Warrenba110d92012-03-02 13:05:49 -0700561 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
562 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
Chanho Park706e8522012-01-03 16:47:50 +0900563 unsigned i, pin;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200564
Dong Aishengad8bb722012-04-10 12:41:34 +0800565 if (!pmxops)
566 return 0;
567
Linus Walleij2744e8a2011-05-02 20:50:54 +0200568 seq_puts(s, "Pinmux settings per pin\n");
Linus Walleij81508852015-05-28 10:11:19 +0200569 if (pmxops->strict)
570 seq_puts(s,
571 "Format: pin (name): mux_owner|gpio_owner (strict) hog?\n");
572 else
573 seq_puts(s,
574 "Format: pin (name): mux_owner gpio_owner hog?\n");
Linus Walleij2744e8a2011-05-02 20:50:54 +0200575
Patrice Chotard42fed7b2013-04-11 11:01:27 +0200576 mutex_lock(&pctldev->mutex);
Stephen Warren57b676f2012-03-02 13:05:44 -0700577
Chanho Park706e8522012-01-03 16:47:50 +0900578 /* The pin number can be retrived from the pin controller descriptor */
579 for (i = 0; i < pctldev->desc->npins; i++) {
Linus Walleij2744e8a2011-05-02 20:50:54 +0200580 struct pin_desc *desc;
Linus Walleij1cf94c42012-02-24 06:53:04 +0100581 bool is_hog = false;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200582
Chanho Park706e8522012-01-03 16:47:50 +0900583 pin = pctldev->desc->pins[i].number;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200584 desc = pin_desc_get(pctldev, pin);
Chanho Park706e8522012-01-03 16:47:50 +0900585 /* Skip if we cannot search the pin */
Linus Walleij2744e8a2011-05-02 20:50:54 +0200586 if (desc == NULL)
587 continue;
588
Stephen Warren652162d2012-03-05 17:22:15 -0700589 if (desc->mux_owner &&
590 !strcmp(desc->mux_owner, pinctrl_dev_get_name(pctldev)))
Linus Walleij1cf94c42012-02-24 06:53:04 +0100591 is_hog = true;
592
Linus Walleij81508852015-05-28 10:11:19 +0200593 if (pmxops->strict) {
594 if (desc->mux_owner)
595 seq_printf(s, "pin %d (%s): device %s%s",
Masahiro Yamadacf9d9942016-05-24 14:26:26 +0900596 pin, desc->name, desc->mux_owner,
Linus Walleij81508852015-05-28 10:11:19 +0200597 is_hog ? " (HOG)" : "");
598 else if (desc->gpio_owner)
599 seq_printf(s, "pin %d (%s): GPIO %s",
Masahiro Yamadacf9d9942016-05-24 14:26:26 +0900600 pin, desc->name, desc->gpio_owner);
Linus Walleij81508852015-05-28 10:11:19 +0200601 else
602 seq_printf(s, "pin %d (%s): UNCLAIMED",
Masahiro Yamadacf9d9942016-05-24 14:26:26 +0900603 pin, desc->name);
Linus Walleij81508852015-05-28 10:11:19 +0200604 } else {
605 /* For non-strict controllers */
Masahiro Yamadacf9d9942016-05-24 14:26:26 +0900606 seq_printf(s, "pin %d (%s): %s %s%s", pin, desc->name,
Linus Walleij81508852015-05-28 10:11:19 +0200607 desc->mux_owner ? desc->mux_owner
608 : "(MUX UNCLAIMED)",
609 desc->gpio_owner ? desc->gpio_owner
610 : "(GPIO UNCLAIMED)",
611 is_hog ? " (HOG)" : "");
612 }
Stephen Warrenba110d92012-03-02 13:05:49 -0700613
Linus Walleij81508852015-05-28 10:11:19 +0200614 /* If mux: print function+group claiming the pin */
Stephen Warrenba110d92012-03-02 13:05:49 -0700615 if (desc->mux_setting)
616 seq_printf(s, " function %s group %s\n",
617 pmxops->get_function_name(pctldev,
618 desc->mux_setting->func),
619 pctlops->get_group_name(pctldev,
620 desc->mux_setting->group));
621 else
622 seq_printf(s, "\n");
Linus Walleij2744e8a2011-05-02 20:50:54 +0200623 }
624
Patrice Chotard42fed7b2013-04-11 11:01:27 +0200625 mutex_unlock(&pctldev->mutex);
Stephen Warren57b676f2012-03-02 13:05:44 -0700626
Linus Walleij2744e8a2011-05-02 20:50:54 +0200627 return 0;
628}
629
Stephen Warren1e2082b2012-03-02 13:05:48 -0700630void pinmux_show_map(struct seq_file *s, struct pinctrl_map const *map)
631{
632 seq_printf(s, "group %s\nfunction %s\n",
633 map->data.mux.group ? map->data.mux.group : "(default)",
634 map->data.mux.function);
635}
636
637void pinmux_show_setting(struct seq_file *s,
638 struct pinctrl_setting const *setting)
Linus Walleij2744e8a2011-05-02 20:50:54 +0200639{
Stephen Warren7ecdb162012-03-02 13:05:45 -0700640 struct pinctrl_dev *pctldev = setting->pctldev;
641 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
642 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
Linus Walleij2744e8a2011-05-02 20:50:54 +0200643
Stephen Warren1e2082b2012-03-02 13:05:48 -0700644 seq_printf(s, "group: %s (%u) function: %s (%u)\n",
645 pctlops->get_group_name(pctldev, setting->data.mux.group),
646 setting->data.mux.group,
647 pmxops->get_function_name(pctldev, setting->data.mux.func),
648 setting->data.mux.func);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200649}
650
651static int pinmux_functions_open(struct inode *inode, struct file *file)
652{
653 return single_open(file, pinmux_functions_show, inode->i_private);
654}
655
656static int pinmux_pins_open(struct inode *inode, struct file *file)
657{
658 return single_open(file, pinmux_pins_show, inode->i_private);
659}
660
Linus Walleij2744e8a2011-05-02 20:50:54 +0200661static const struct file_operations pinmux_functions_ops = {
662 .open = pinmux_functions_open,
663 .read = seq_read,
664 .llseek = seq_lseek,
665 .release = single_release,
666};
667
668static const struct file_operations pinmux_pins_ops = {
669 .open = pinmux_pins_open,
670 .read = seq_read,
671 .llseek = seq_lseek,
672 .release = single_release,
673};
674
Linus Walleij2744e8a2011-05-02 20:50:54 +0200675void pinmux_init_device_debugfs(struct dentry *devroot,
676 struct pinctrl_dev *pctldev)
677{
678 debugfs_create_file("pinmux-functions", S_IFREG | S_IRUGO,
679 devroot, pctldev, &pinmux_functions_ops);
680 debugfs_create_file("pinmux-pins", S_IFREG | S_IRUGO,
681 devroot, pctldev, &pinmux_pins_ops);
Linus Walleij2744e8a2011-05-02 20:50:54 +0200682}
683
684#endif /* CONFIG_DEBUG_FS */
Tony Lindgrena76edc82016-12-27 09:20:01 -0800685
686#ifdef CONFIG_GENERIC_PINMUX_FUNCTIONS
687
688/**
689 * pinmux_generic_get_function_count() - returns number of functions
690 * @pctldev: pin controller device
691 */
692int pinmux_generic_get_function_count(struct pinctrl_dev *pctldev)
693{
694 return pctldev->num_functions;
695}
696EXPORT_SYMBOL_GPL(pinmux_generic_get_function_count);
697
698/**
699 * pinmux_generic_get_function_name() - returns the function name
700 * @pctldev: pin controller device
701 * @selector: function number
702 */
703const char *
704pinmux_generic_get_function_name(struct pinctrl_dev *pctldev,
705 unsigned int selector)
706{
707 struct function_desc *function;
708
709 function = radix_tree_lookup(&pctldev->pin_function_tree,
710 selector);
711 if (!function)
712 return NULL;
713
714 return function->name;
715}
716EXPORT_SYMBOL_GPL(pinmux_generic_get_function_name);
717
718/**
719 * pinmux_generic_get_function_groups() - gets the function groups
720 * @pctldev: pin controller device
721 * @selector: function number
722 * @groups: array of pin groups
723 * @num_groups: number of pin groups
724 */
725int pinmux_generic_get_function_groups(struct pinctrl_dev *pctldev,
726 unsigned int selector,
727 const char * const **groups,
728 unsigned * const num_groups)
729{
730 struct function_desc *function;
731
732 function = radix_tree_lookup(&pctldev->pin_function_tree,
733 selector);
734 if (!function) {
735 dev_err(pctldev->dev, "%s could not find function%i\n",
736 __func__, selector);
737 return -EINVAL;
738 }
739 *groups = function->group_names;
740 *num_groups = function->num_group_names;
741
742 return 0;
743}
744EXPORT_SYMBOL_GPL(pinmux_generic_get_function_groups);
745
746/**
747 * pinmux_generic_get_function() - returns a function based on the number
748 * @pctldev: pin controller device
749 * @group_selector: function number
750 */
751struct function_desc *pinmux_generic_get_function(struct pinctrl_dev *pctldev,
752 unsigned int selector)
753{
754 struct function_desc *function;
755
756 function = radix_tree_lookup(&pctldev->pin_function_tree,
757 selector);
758 if (!function)
759 return NULL;
760
761 return function;
762}
763EXPORT_SYMBOL_GPL(pinmux_generic_get_function);
764
765/**
Geert Uytterhoeven6bffa7e2017-04-03 10:32:42 +0200766 * pinmux_generic_add_function() - adds a function group
Tony Lindgrena76edc82016-12-27 09:20:01 -0800767 * @pctldev: pin controller device
768 * @name: name of the function
769 * @groups: array of pin groups
770 * @num_groups: number of pin groups
771 * @data: pin controller driver specific data
772 */
773int pinmux_generic_add_function(struct pinctrl_dev *pctldev,
774 const char *name,
775 const char **groups,
776 const unsigned int num_groups,
777 void *data)
778{
779 struct function_desc *function;
780
781 function = devm_kzalloc(pctldev->dev, sizeof(*function), GFP_KERNEL);
782 if (!function)
783 return -ENOMEM;
784
785 function->name = name;
786 function->group_names = groups;
787 function->num_group_names = num_groups;
788 function->data = data;
789
790 radix_tree_insert(&pctldev->pin_function_tree, pctldev->num_functions,
791 function);
792
793 pctldev->num_functions++;
794
795 return 0;
796}
797EXPORT_SYMBOL_GPL(pinmux_generic_add_function);
798
799/**
800 * pinmux_generic_remove_function() - removes a numbered function
801 * @pctldev: pin controller device
802 * @selector: function number
803 *
804 * Note that the caller must take care of locking.
805 */
806int pinmux_generic_remove_function(struct pinctrl_dev *pctldev,
807 unsigned int selector)
808{
809 struct function_desc *function;
810
811 function = radix_tree_lookup(&pctldev->pin_function_tree,
812 selector);
813 if (!function)
814 return -ENOENT;
815
816 radix_tree_delete(&pctldev->pin_function_tree, selector);
817 devm_kfree(pctldev->dev, function);
818
819 pctldev->num_functions--;
820
821 return 0;
822}
823EXPORT_SYMBOL_GPL(pinmux_generic_remove_function);
824
825/**
826 * pinmux_generic_free_functions() - removes all functions
827 * @pctldev: pin controller device
828 *
829 * Note that the caller must take care of locking.
830 */
831void pinmux_generic_free_functions(struct pinctrl_dev *pctldev)
832{
833 struct radix_tree_iter iter;
834 struct function_desc *function;
835 unsigned long *indices;
836 void **slot;
837 int i = 0;
838
839 indices = devm_kzalloc(pctldev->dev, sizeof(*indices) *
840 pctldev->num_functions, GFP_KERNEL);
841 if (!indices)
842 return;
843
844 radix_tree_for_each_slot(slot, &pctldev->pin_function_tree, &iter, 0)
845 indices[i++] = iter.index;
846
847 for (i = 0; i < pctldev->num_functions; i++) {
848 function = radix_tree_lookup(&pctldev->pin_function_tree,
849 indices[i]);
850 radix_tree_delete(&pctldev->pin_function_tree, indices[i]);
851 devm_kfree(pctldev->dev, function);
852 }
853
854 pctldev->num_functions = 0;
855}
856
857#endif /* CONFIG_GENERIC_PINMUX_FUNCTIONS */