Merge branch 'fixes' of git://git.linaro.org/people/rmk/linux-arm
[deliverable/linux.git] / drivers / pinctrl / pinctrl-tegra.c
CommitLineData
971dac71
SW
1/*
2 * Driver for the NVIDIA Tegra pinmux
3 *
52f48fe0 4 * Copyright (c) 2011-2012, NVIDIA CORPORATION. All rights reserved.
971dac71
SW
5 *
6 * Derived from code:
7 * Copyright (C) 2010 Google, Inc.
8 * Copyright (C) 2010 NVIDIA Corporation
9 * Copyright (C) 2009-2011 ST-Ericsson AB
10 *
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms and conditions of the GNU General Public License,
13 * version 2, as published by the Free Software Foundation.
14 *
15 * This program is distributed in the hope it will be useful, but WITHOUT
16 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
17 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
18 * more details.
19 */
20
21#include <linux/err.h>
22#include <linux/init.h>
23#include <linux/io.h>
24#include <linux/module.h>
52f48fe0
SW
25#include <linux/of.h>
26#include <linux/platform_device.h>
60f7f500 27#include <linux/pinctrl/machine.h>
971dac71
SW
28#include <linux/pinctrl/pinctrl.h>
29#include <linux/pinctrl/pinmux.h>
30#include <linux/pinctrl/pinconf.h>
60f7f500 31#include <linux/slab.h>
971dac71
SW
32
33#include <mach/pinconf-tegra.h>
34
52f48fe0 35#include "core.h"
971dac71
SW
36#include "pinctrl-tegra.h"
37
971dac71
SW
38struct tegra_pmx {
39 struct device *dev;
40 struct pinctrl_dev *pctl;
41
42 const struct tegra_pinctrl_soc_data *soc;
43
44 int nbanks;
45 void __iomem **regs;
46};
47
48static inline u32 pmx_readl(struct tegra_pmx *pmx, u32 bank, u32 reg)
49{
50 return readl(pmx->regs[bank] + reg);
51}
52
53static inline void pmx_writel(struct tegra_pmx *pmx, u32 val, u32 bank, u32 reg)
54{
55 writel(val, pmx->regs[bank] + reg);
56}
57
d1e90e9e 58static int tegra_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
971dac71
SW
59{
60 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
61
d1e90e9e 62 return pmx->soc->ngroups;
971dac71
SW
63}
64
65static const char *tegra_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
66 unsigned group)
67{
68 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
69
971dac71
SW
70 return pmx->soc->groups[group].name;
71}
72
73static int tegra_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
74 unsigned group,
75 const unsigned **pins,
76 unsigned *num_pins)
77{
78 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
79
971dac71
SW
80 *pins = pmx->soc->groups[group].pins;
81 *num_pins = pmx->soc->groups[group].npins;
82
83 return 0;
84}
85
b5badbaa 86#ifdef CONFIG_DEBUG_FS
971dac71
SW
87static void tegra_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev,
88 struct seq_file *s,
89 unsigned offset)
90{
52f48fe0 91 seq_printf(s, " %s", dev_name(pctldev->dev));
971dac71 92}
b5badbaa 93#endif
971dac71 94
aef7704c
SW
95static int reserve_map(struct device *dev, struct pinctrl_map **map,
96 unsigned *reserved_maps, unsigned *num_maps,
97 unsigned reserve)
60f7f500
SW
98{
99 unsigned old_num = *reserved_maps;
100 unsigned new_num = *num_maps + reserve;
101 struct pinctrl_map *new_map;
102
103 if (old_num >= new_num)
104 return 0;
105
106 new_map = krealloc(*map, sizeof(*new_map) * new_num, GFP_KERNEL);
aef7704c
SW
107 if (!new_map) {
108 dev_err(dev, "krealloc(map) failed\n");
60f7f500 109 return -ENOMEM;
aef7704c 110 }
60f7f500
SW
111
112 memset(new_map + old_num, 0, (new_num - old_num) * sizeof(*new_map));
113
114 *map = new_map;
115 *reserved_maps = new_num;
116
117 return 0;
118}
119
120static int add_map_mux(struct pinctrl_map **map, unsigned *reserved_maps,
121 unsigned *num_maps, const char *group,
122 const char *function)
123{
aef7704c 124 if (WARN_ON(*num_maps == *reserved_maps))
60f7f500
SW
125 return -ENOSPC;
126
127 (*map)[*num_maps].type = PIN_MAP_TYPE_MUX_GROUP;
128 (*map)[*num_maps].data.mux.group = group;
129 (*map)[*num_maps].data.mux.function = function;
130 (*num_maps)++;
131
132 return 0;
133}
134
aef7704c
SW
135static int add_map_configs(struct device *dev, struct pinctrl_map **map,
136 unsigned *reserved_maps, unsigned *num_maps,
137 const char *group, unsigned long *configs,
138 unsigned num_configs)
60f7f500
SW
139{
140 unsigned long *dup_configs;
141
aef7704c 142 if (WARN_ON(*num_maps == *reserved_maps))
60f7f500
SW
143 return -ENOSPC;
144
145 dup_configs = kmemdup(configs, num_configs * sizeof(*dup_configs),
146 GFP_KERNEL);
aef7704c
SW
147 if (!dup_configs) {
148 dev_err(dev, "kmemdup(configs) failed\n");
60f7f500 149 return -ENOMEM;
aef7704c 150 }
60f7f500
SW
151
152 (*map)[*num_maps].type = PIN_MAP_TYPE_CONFIGS_GROUP;
153 (*map)[*num_maps].data.configs.group_or_pin = group;
154 (*map)[*num_maps].data.configs.configs = dup_configs;
155 (*map)[*num_maps].data.configs.num_configs = num_configs;
156 (*num_maps)++;
157
158 return 0;
159}
160
aef7704c
SW
161static int add_config(struct device *dev, unsigned long **configs,
162 unsigned *num_configs, unsigned long config)
60f7f500
SW
163{
164 unsigned old_num = *num_configs;
165 unsigned new_num = old_num + 1;
166 unsigned long *new_configs;
167
168 new_configs = krealloc(*configs, sizeof(*new_configs) * new_num,
169 GFP_KERNEL);
aef7704c
SW
170 if (!new_configs) {
171 dev_err(dev, "krealloc(configs) failed\n");
60f7f500 172 return -ENOMEM;
aef7704c 173 }
60f7f500
SW
174
175 new_configs[old_num] = config;
176
177 *configs = new_configs;
178 *num_configs = new_num;
179
180 return 0;
181}
182
183void tegra_pinctrl_dt_free_map(struct pinctrl_dev *pctldev,
184 struct pinctrl_map *map, unsigned num_maps)
185{
186 int i;
187
188 for (i = 0; i < num_maps; i++)
189 if (map[i].type == PIN_MAP_TYPE_CONFIGS_GROUP)
190 kfree(map[i].data.configs.configs);
191
192 kfree(map);
193}
194
195static const struct cfg_param {
196 const char *property;
197 enum tegra_pinconf_param param;
198} cfg_params[] = {
199 {"nvidia,pull", TEGRA_PINCONF_PARAM_PULL},
200 {"nvidia,tristate", TEGRA_PINCONF_PARAM_TRISTATE},
201 {"nvidia,enable-input", TEGRA_PINCONF_PARAM_ENABLE_INPUT},
202 {"nvidia,open-drain", TEGRA_PINCONF_PARAM_OPEN_DRAIN},
203 {"nvidia,lock", TEGRA_PINCONF_PARAM_LOCK},
204 {"nvidia,io-reset", TEGRA_PINCONF_PARAM_IORESET},
205 {"nvidia,high-speed-mode", TEGRA_PINCONF_PARAM_HIGH_SPEED_MODE},
206 {"nvidia,schmitt", TEGRA_PINCONF_PARAM_SCHMITT},
207 {"nvidia,low-power-mode", TEGRA_PINCONF_PARAM_LOW_POWER_MODE},
208 {"nvidia,pull-down-strength", TEGRA_PINCONF_PARAM_DRIVE_DOWN_STRENGTH},
209 {"nvidia,pull-up-strength", TEGRA_PINCONF_PARAM_DRIVE_UP_STRENGTH},
210 {"nvidia,slew-rate-falling", TEGRA_PINCONF_PARAM_SLEW_RATE_FALLING},
211 {"nvidia,slew-rate-rising", TEGRA_PINCONF_PARAM_SLEW_RATE_RISING},
212};
213
aef7704c
SW
214int tegra_pinctrl_dt_subnode_to_map(struct device *dev,
215 struct device_node *np,
60f7f500
SW
216 struct pinctrl_map **map,
217 unsigned *reserved_maps,
218 unsigned *num_maps)
219{
220 int ret, i;
221 const char *function;
222 u32 val;
223 unsigned long config;
224 unsigned long *configs = NULL;
225 unsigned num_configs = 0;
226 unsigned reserve;
227 struct property *prop;
228 const char *group;
229
230 ret = of_property_read_string(np, "nvidia,function", &function);
aef7704c
SW
231 if (ret < 0) {
232 /* EINVAL=missing, which is fine since it's optional */
233 if (ret != -EINVAL)
234 dev_err(dev,
235 "could not parse property nvidia,function\n");
60f7f500 236 function = NULL;
aef7704c 237 }
60f7f500
SW
238
239 for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
240 ret = of_property_read_u32(np, cfg_params[i].property, &val);
241 if (!ret) {
242 config = TEGRA_PINCONF_PACK(cfg_params[i].param, val);
aef7704c 243 ret = add_config(dev, &configs, &num_configs, config);
60f7f500
SW
244 if (ret < 0)
245 goto exit;
aef7704c
SW
246 /* EINVAL=missing, which is fine since it's optional */
247 } else if (ret != -EINVAL) {
248 dev_err(dev, "could not parse property %s\n",
249 cfg_params[i].property);
60f7f500
SW
250 }
251 }
252
253 reserve = 0;
254 if (function != NULL)
255 reserve++;
256 if (num_configs)
257 reserve++;
258 ret = of_property_count_strings(np, "nvidia,pins");
aef7704c
SW
259 if (ret < 0) {
260 dev_err(dev, "could not parse property nvidia,pins\n");
60f7f500 261 goto exit;
aef7704c 262 }
60f7f500
SW
263 reserve *= ret;
264
aef7704c 265 ret = reserve_map(dev, map, reserved_maps, num_maps, reserve);
60f7f500
SW
266 if (ret < 0)
267 goto exit;
268
269 of_property_for_each_string(np, "nvidia,pins", prop, group) {
270 if (function) {
271 ret = add_map_mux(map, reserved_maps, num_maps,
272 group, function);
273 if (ret < 0)
274 goto exit;
275 }
276
277 if (num_configs) {
aef7704c
SW
278 ret = add_map_configs(dev, map, reserved_maps,
279 num_maps, group, configs,
280 num_configs);
60f7f500
SW
281 if (ret < 0)
282 goto exit;
283 }
284 }
285
286 ret = 0;
287
288exit:
289 kfree(configs);
290 return ret;
291}
292
293int tegra_pinctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
294 struct device_node *np_config,
295 struct pinctrl_map **map, unsigned *num_maps)
296{
297 unsigned reserved_maps;
298 struct device_node *np;
299 int ret;
300
301 reserved_maps = 0;
302 *map = NULL;
303 *num_maps = 0;
304
305 for_each_child_of_node(np_config, np) {
aef7704c
SW
306 ret = tegra_pinctrl_dt_subnode_to_map(pctldev->dev, np, map,
307 &reserved_maps, num_maps);
60f7f500
SW
308 if (ret < 0) {
309 tegra_pinctrl_dt_free_map(pctldev, *map, *num_maps);
310 return ret;
311 }
312 }
313
314 return 0;
315}
316
971dac71 317static struct pinctrl_ops tegra_pinctrl_ops = {
d1e90e9e 318 .get_groups_count = tegra_pinctrl_get_groups_count,
971dac71
SW
319 .get_group_name = tegra_pinctrl_get_group_name,
320 .get_group_pins = tegra_pinctrl_get_group_pins,
b5badbaa 321#ifdef CONFIG_DEBUG_FS
971dac71 322 .pin_dbg_show = tegra_pinctrl_pin_dbg_show,
b5badbaa 323#endif
60f7f500
SW
324 .dt_node_to_map = tegra_pinctrl_dt_node_to_map,
325 .dt_free_map = tegra_pinctrl_dt_free_map,
971dac71
SW
326};
327
d1e90e9e 328static int tegra_pinctrl_get_funcs_count(struct pinctrl_dev *pctldev)
971dac71
SW
329{
330 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
331
d1e90e9e 332 return pmx->soc->nfunctions;
971dac71
SW
333}
334
335static const char *tegra_pinctrl_get_func_name(struct pinctrl_dev *pctldev,
336 unsigned function)
337{
338 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
339
971dac71
SW
340 return pmx->soc->functions[function].name;
341}
342
343static int tegra_pinctrl_get_func_groups(struct pinctrl_dev *pctldev,
344 unsigned function,
345 const char * const **groups,
346 unsigned * const num_groups)
347{
348 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
349
971dac71
SW
350 *groups = pmx->soc->functions[function].groups;
351 *num_groups = pmx->soc->functions[function].ngroups;
352
353 return 0;
354}
355
356static int tegra_pinctrl_enable(struct pinctrl_dev *pctldev, unsigned function,
357 unsigned group)
358{
359 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
360 const struct tegra_pingroup *g;
361 int i;
362 u32 val;
363
971dac71
SW
364 g = &pmx->soc->groups[group];
365
aef7704c 366 if (WARN_ON(g->mux_reg < 0))
971dac71
SW
367 return -EINVAL;
368
369 for (i = 0; i < ARRAY_SIZE(g->funcs); i++) {
370 if (g->funcs[i] == function)
371 break;
372 }
aef7704c 373 if (WARN_ON(i == ARRAY_SIZE(g->funcs)))
971dac71
SW
374 return -EINVAL;
375
376 val = pmx_readl(pmx, g->mux_bank, g->mux_reg);
377 val &= ~(0x3 << g->mux_bit);
378 val |= i << g->mux_bit;
379 pmx_writel(pmx, val, g->mux_bank, g->mux_reg);
380
381 return 0;
382}
383
384static void tegra_pinctrl_disable(struct pinctrl_dev *pctldev,
385 unsigned function, unsigned group)
386{
387 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
388 const struct tegra_pingroup *g;
389 u32 val;
390
971dac71
SW
391 g = &pmx->soc->groups[group];
392
aef7704c 393 if (WARN_ON(g->mux_reg < 0))
971dac71
SW
394 return;
395
396 val = pmx_readl(pmx, g->mux_bank, g->mux_reg);
397 val &= ~(0x3 << g->mux_bit);
398 val |= g->func_safe << g->mux_bit;
399 pmx_writel(pmx, val, g->mux_bank, g->mux_reg);
400}
401
402static struct pinmux_ops tegra_pinmux_ops = {
d1e90e9e 403 .get_functions_count = tegra_pinctrl_get_funcs_count,
971dac71
SW
404 .get_function_name = tegra_pinctrl_get_func_name,
405 .get_function_groups = tegra_pinctrl_get_func_groups,
406 .enable = tegra_pinctrl_enable,
407 .disable = tegra_pinctrl_disable,
408};
409
410static int tegra_pinconf_reg(struct tegra_pmx *pmx,
411 const struct tegra_pingroup *g,
412 enum tegra_pinconf_param param,
b5badbaa 413 bool report_err,
971dac71
SW
414 s8 *bank, s16 *reg, s8 *bit, s8 *width)
415{
416 switch (param) {
417 case TEGRA_PINCONF_PARAM_PULL:
418 *bank = g->pupd_bank;
419 *reg = g->pupd_reg;
420 *bit = g->pupd_bit;
421 *width = 2;
422 break;
423 case TEGRA_PINCONF_PARAM_TRISTATE:
424 *bank = g->tri_bank;
425 *reg = g->tri_reg;
426 *bit = g->tri_bit;
427 *width = 1;
428 break;
429 case TEGRA_PINCONF_PARAM_ENABLE_INPUT:
430 *bank = g->einput_bank;
431 *reg = g->einput_reg;
432 *bit = g->einput_bit;
433 *width = 1;
434 break;
435 case TEGRA_PINCONF_PARAM_OPEN_DRAIN:
436 *bank = g->odrain_bank;
437 *reg = g->odrain_reg;
438 *bit = g->odrain_bit;
439 *width = 1;
440 break;
441 case TEGRA_PINCONF_PARAM_LOCK:
442 *bank = g->lock_bank;
443 *reg = g->lock_reg;
444 *bit = g->lock_bit;
445 *width = 1;
446 break;
447 case TEGRA_PINCONF_PARAM_IORESET:
448 *bank = g->ioreset_bank;
449 *reg = g->ioreset_reg;
450 *bit = g->ioreset_bit;
451 *width = 1;
452 break;
453 case TEGRA_PINCONF_PARAM_HIGH_SPEED_MODE:
454 *bank = g->drv_bank;
455 *reg = g->drv_reg;
456 *bit = g->hsm_bit;
457 *width = 1;
458 break;
459 case TEGRA_PINCONF_PARAM_SCHMITT:
460 *bank = g->drv_bank;
461 *reg = g->drv_reg;
462 *bit = g->schmitt_bit;
463 *width = 1;
464 break;
465 case TEGRA_PINCONF_PARAM_LOW_POWER_MODE:
466 *bank = g->drv_bank;
467 *reg = g->drv_reg;
468 *bit = g->lpmd_bit;
469 *width = 1;
470 break;
471 case TEGRA_PINCONF_PARAM_DRIVE_DOWN_STRENGTH:
472 *bank = g->drv_bank;
473 *reg = g->drv_reg;
474 *bit = g->drvdn_bit;
475 *width = g->drvdn_width;
476 break;
477 case TEGRA_PINCONF_PARAM_DRIVE_UP_STRENGTH:
478 *bank = g->drv_bank;
479 *reg = g->drv_reg;
480 *bit = g->drvup_bit;
481 *width = g->drvup_width;
482 break;
483 case TEGRA_PINCONF_PARAM_SLEW_RATE_FALLING:
484 *bank = g->drv_bank;
485 *reg = g->drv_reg;
486 *bit = g->slwf_bit;
487 *width = g->slwf_width;
488 break;
489 case TEGRA_PINCONF_PARAM_SLEW_RATE_RISING:
490 *bank = g->drv_bank;
491 *reg = g->drv_reg;
492 *bit = g->slwr_bit;
493 *width = g->slwr_width;
494 break;
495 default:
496 dev_err(pmx->dev, "Invalid config param %04x\n", param);
497 return -ENOTSUPP;
498 }
499
500 if (*reg < 0) {
b5badbaa
SW
501 if (report_err)
502 dev_err(pmx->dev,
503 "Config param %04x not supported on group %s\n",
504 param, g->name);
971dac71
SW
505 return -ENOTSUPP;
506 }
507
508 return 0;
509}
510
511static int tegra_pinconf_get(struct pinctrl_dev *pctldev,
512 unsigned pin, unsigned long *config)
513{
aef7704c 514 dev_err(pctldev->dev, "pin_config_get op not supported\n");
971dac71
SW
515 return -ENOTSUPP;
516}
517
518static int tegra_pinconf_set(struct pinctrl_dev *pctldev,
519 unsigned pin, unsigned long config)
520{
aef7704c 521 dev_err(pctldev->dev, "pin_config_set op not supported\n");
971dac71
SW
522 return -ENOTSUPP;
523}
524
525static int tegra_pinconf_group_get(struct pinctrl_dev *pctldev,
526 unsigned group, unsigned long *config)
527{
528 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
529 enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(*config);
530 u16 arg;
531 const struct tegra_pingroup *g;
532 int ret;
533 s8 bank, bit, width;
534 s16 reg;
535 u32 val, mask;
536
971dac71
SW
537 g = &pmx->soc->groups[group];
538
b5badbaa
SW
539 ret = tegra_pinconf_reg(pmx, g, param, true, &bank, &reg, &bit,
540 &width);
971dac71
SW
541 if (ret < 0)
542 return ret;
543
544 val = pmx_readl(pmx, bank, reg);
545 mask = (1 << width) - 1;
546 arg = (val >> bit) & mask;
547
548 *config = TEGRA_PINCONF_PACK(param, arg);
549
550 return 0;
551}
552
553static int tegra_pinconf_group_set(struct pinctrl_dev *pctldev,
554 unsigned group, unsigned long config)
555{
556 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
557 enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(config);
558 u16 arg = TEGRA_PINCONF_UNPACK_ARG(config);
559 const struct tegra_pingroup *g;
560 int ret;
561 s8 bank, bit, width;
562 s16 reg;
563 u32 val, mask;
564
971dac71
SW
565 g = &pmx->soc->groups[group];
566
b5badbaa
SW
567 ret = tegra_pinconf_reg(pmx, g, param, true, &bank, &reg, &bit,
568 &width);
971dac71
SW
569 if (ret < 0)
570 return ret;
571
572 val = pmx_readl(pmx, bank, reg);
573
574 /* LOCK can't be cleared */
575 if (param == TEGRA_PINCONF_PARAM_LOCK) {
aef7704c
SW
576 if ((val & BIT(bit)) && !arg) {
577 dev_err(pctldev->dev, "LOCK bit cannot be cleared\n");
971dac71 578 return -EINVAL;
aef7704c 579 }
971dac71
SW
580 }
581
582 /* Special-case Boolean values; allow any non-zero as true */
583 if (width == 1)
584 arg = !!arg;
585
586 /* Range-check user-supplied value */
587 mask = (1 << width) - 1;
aef7704c
SW
588 if (arg & ~mask) {
589 dev_err(pctldev->dev,
590 "config %lx: %x too big for %d bit register\n",
591 config, arg, width);
971dac71 592 return -EINVAL;
aef7704c 593 }
971dac71
SW
594
595 /* Update register */
596 val &= ~(mask << bit);
597 val |= arg << bit;
598 pmx_writel(pmx, val, bank, reg);
599
600 return 0;
601}
602
b5badbaa 603#ifdef CONFIG_DEBUG_FS
971dac71
SW
604static void tegra_pinconf_dbg_show(struct pinctrl_dev *pctldev,
605 struct seq_file *s, unsigned offset)
606{
607}
608
b5badbaa
SW
609static const char *strip_prefix(const char *s)
610{
611 const char *comma = strchr(s, ',');
612 if (!comma)
613 return s;
614
615 return comma + 1;
616}
617
971dac71 618static void tegra_pinconf_group_dbg_show(struct pinctrl_dev *pctldev,
b5badbaa
SW
619 struct seq_file *s, unsigned group)
620{
621 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
622 const struct tegra_pingroup *g;
623 int i, ret;
624 s8 bank, bit, width;
625 s16 reg;
626 u32 val;
627
628 g = &pmx->soc->groups[group];
629
630 for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
631 ret = tegra_pinconf_reg(pmx, g, cfg_params[i].param, false,
632 &bank, &reg, &bit, &width);
633 if (ret < 0)
634 continue;
635
636 val = pmx_readl(pmx, bank, reg);
637 val >>= bit;
638 val &= (1 << width) - 1;
639
640 seq_printf(s, "\n\t%s=%u",
641 strip_prefix(cfg_params[i].property), val);
642 }
643}
644
645static void tegra_pinconf_config_dbg_show(struct pinctrl_dev *pctldev,
646 struct seq_file *s,
647 unsigned long config)
971dac71 648{
b5badbaa
SW
649 enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(config);
650 u16 arg = TEGRA_PINCONF_UNPACK_ARG(config);
651 const char *pname = "unknown";
652 int i;
653
654 for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
655 if (cfg_params[i].param == param) {
656 pname = cfg_params[i].property;
657 break;
658 }
659 }
660
661 seq_printf(s, "%s=%d", strip_prefix(pname), arg);
971dac71 662}
b5badbaa 663#endif
971dac71
SW
664
665struct pinconf_ops tegra_pinconf_ops = {
666 .pin_config_get = tegra_pinconf_get,
667 .pin_config_set = tegra_pinconf_set,
668 .pin_config_group_get = tegra_pinconf_group_get,
669 .pin_config_group_set = tegra_pinconf_group_set,
b5badbaa 670#ifdef CONFIG_DEBUG_FS
971dac71
SW
671 .pin_config_dbg_show = tegra_pinconf_dbg_show,
672 .pin_config_group_dbg_show = tegra_pinconf_group_dbg_show,
b5badbaa
SW
673 .pin_config_config_dbg_show = tegra_pinconf_config_dbg_show,
674#endif
971dac71
SW
675};
676
677static struct pinctrl_gpio_range tegra_pinctrl_gpio_range = {
678 .name = "Tegra GPIOs",
679 .id = 0,
680 .base = 0,
681};
682
683static struct pinctrl_desc tegra_pinctrl_desc = {
971dac71
SW
684 .pctlops = &tegra_pinctrl_ops,
685 .pmxops = &tegra_pinmux_ops,
686 .confops = &tegra_pinconf_ops,
687 .owner = THIS_MODULE,
688};
689
52f48fe0
SW
690int __devinit tegra_pinctrl_probe(struct platform_device *pdev,
691 const struct tegra_pinctrl_soc_data *soc_data)
971dac71 692{
971dac71
SW
693 struct tegra_pmx *pmx;
694 struct resource *res;
695 int i;
696
971dac71
SW
697 pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);
698 if (!pmx) {
699 dev_err(&pdev->dev, "Can't alloc tegra_pmx\n");
700 return -ENOMEM;
701 }
702 pmx->dev = &pdev->dev;
52f48fe0 703 pmx->soc = soc_data;
971dac71
SW
704
705 tegra_pinctrl_gpio_range.npins = pmx->soc->ngpios;
52f48fe0 706 tegra_pinctrl_desc.name = dev_name(&pdev->dev);
971dac71
SW
707 tegra_pinctrl_desc.pins = pmx->soc->pins;
708 tegra_pinctrl_desc.npins = pmx->soc->npins;
709
710 for (i = 0; ; i++) {
711 res = platform_get_resource(pdev, IORESOURCE_MEM, i);
712 if (!res)
713 break;
714 }
715 pmx->nbanks = i;
716
717 pmx->regs = devm_kzalloc(&pdev->dev, pmx->nbanks * sizeof(*pmx->regs),
718 GFP_KERNEL);
719 if (!pmx->regs) {
720 dev_err(&pdev->dev, "Can't alloc regs pointer\n");
721 return -ENODEV;
722 }
723
724 for (i = 0; i < pmx->nbanks; i++) {
725 res = platform_get_resource(pdev, IORESOURCE_MEM, i);
726 if (!res) {
727 dev_err(&pdev->dev, "Missing MEM resource\n");
728 return -ENODEV;
729 }
730
731 if (!devm_request_mem_region(&pdev->dev, res->start,
732 resource_size(res),
733 dev_name(&pdev->dev))) {
734 dev_err(&pdev->dev,
735 "Couldn't request MEM resource %d\n", i);
736 return -ENODEV;
737 }
738
739 pmx->regs[i] = devm_ioremap(&pdev->dev, res->start,
740 resource_size(res));
741 if (!pmx->regs[i]) {
742 dev_err(&pdev->dev, "Couldn't ioremap regs %d\n", i);
743 return -ENODEV;
744 }
745 }
746
747 pmx->pctl = pinctrl_register(&tegra_pinctrl_desc, &pdev->dev, pmx);
cb0f7d35 748 if (!pmx->pctl) {
971dac71 749 dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");
cb0f7d35 750 return -ENODEV;
971dac71
SW
751 }
752
753 pinctrl_add_gpio_range(pmx->pctl, &tegra_pinctrl_gpio_range);
754
755 platform_set_drvdata(pdev, pmx);
756
757 dev_dbg(&pdev->dev, "Probed Tegra pinctrl driver\n");
758
759 return 0;
760}
52f48fe0 761EXPORT_SYMBOL_GPL(tegra_pinctrl_probe);
971dac71 762
52f48fe0 763int __devexit tegra_pinctrl_remove(struct platform_device *pdev)
971dac71
SW
764{
765 struct tegra_pmx *pmx = platform_get_drvdata(pdev);
766
971dac71
SW
767 pinctrl_unregister(pmx->pctl);
768
769 return 0;
770}
52f48fe0 771EXPORT_SYMBOL_GPL(tegra_pinctrl_remove);
This page took 0.100088 seconds and 5 git commands to generate.