blob: 7da0b371fd652a04ac7d55ecf89c55c915d19f8b [file] [log] [blame]
Stephen Warren971dac72012-02-01 14:04:47 -07001/*
2 * Driver for the NVIDIA Tegra pinmux
3 *
Stephen Warren52f48fe2012-04-11 12:53:09 -06004 * Copyright (c) 2011-2012, NVIDIA CORPORATION. All rights reserved.
Stephen Warren971dac72012-02-01 14:04:47 -07005 *
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>
Stephen Warren52f48fe2012-04-11 12:53:09 -060025#include <linux/of.h>
26#include <linux/platform_device.h>
Stephen Warren60f7f502012-04-04 09:27:50 -060027#include <linux/pinctrl/machine.h>
Stephen Warren971dac72012-02-01 14:04:47 -070028#include <linux/pinctrl/pinctrl.h>
29#include <linux/pinctrl/pinmux.h>
30#include <linux/pinctrl/pinconf.h>
Stephen Warren60f7f502012-04-04 09:27:50 -060031#include <linux/slab.h>
Stephen Warren971dac72012-02-01 14:04:47 -070032
Stephen Warren52f48fe2012-04-11 12:53:09 -060033#include "core.h"
Stephen Warren971dac72012-02-01 14:04:47 -070034#include "pinctrl-tegra.h"
35
Stephen Warren971dac72012-02-01 14:04:47 -070036struct tegra_pmx {
37 struct device *dev;
38 struct pinctrl_dev *pctl;
39
40 const struct tegra_pinctrl_soc_data *soc;
41
42 int nbanks;
43 void __iomem **regs;
44};
45
46static inline u32 pmx_readl(struct tegra_pmx *pmx, u32 bank, u32 reg)
47{
48 return readl(pmx->regs[bank] + reg);
49}
50
51static inline void pmx_writel(struct tegra_pmx *pmx, u32 val, u32 bank, u32 reg)
52{
53 writel(val, pmx->regs[bank] + reg);
54}
55
Viresh Kumard1e90e92012-03-30 11:25:40 +053056static int tegra_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
Stephen Warren971dac72012-02-01 14:04:47 -070057{
58 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
59
Viresh Kumard1e90e92012-03-30 11:25:40 +053060 return pmx->soc->ngroups;
Stephen Warren971dac72012-02-01 14:04:47 -070061}
62
63static const char *tegra_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
64 unsigned group)
65{
66 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
67
Stephen Warren971dac72012-02-01 14:04:47 -070068 return pmx->soc->groups[group].name;
69}
70
71static int tegra_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
72 unsigned group,
73 const unsigned **pins,
74 unsigned *num_pins)
75{
76 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
77
Stephen Warren971dac72012-02-01 14:04:47 -070078 *pins = pmx->soc->groups[group].pins;
79 *num_pins = pmx->soc->groups[group].npins;
80
81 return 0;
82}
83
Stephen Warrenb5badba2012-04-11 15:42:56 -060084#ifdef CONFIG_DEBUG_FS
Stephen Warren971dac72012-02-01 14:04:47 -070085static void tegra_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev,
86 struct seq_file *s,
87 unsigned offset)
88{
Stephen Warren52f48fe2012-04-11 12:53:09 -060089 seq_printf(s, " %s", dev_name(pctldev->dev));
Stephen Warren971dac72012-02-01 14:04:47 -070090}
Stephen Warrenb5badba2012-04-11 15:42:56 -060091#endif
Stephen Warren971dac72012-02-01 14:04:47 -070092
Stephen Warrenaef77042012-04-23 10:05:22 -060093static int reserve_map(struct device *dev, struct pinctrl_map **map,
94 unsigned *reserved_maps, unsigned *num_maps,
95 unsigned reserve)
Stephen Warren60f7f502012-04-04 09:27:50 -060096{
97 unsigned old_num = *reserved_maps;
98 unsigned new_num = *num_maps + reserve;
99 struct pinctrl_map *new_map;
100
101 if (old_num >= new_num)
102 return 0;
103
104 new_map = krealloc(*map, sizeof(*new_map) * new_num, GFP_KERNEL);
Stephen Warrenaef77042012-04-23 10:05:22 -0600105 if (!new_map) {
106 dev_err(dev, "krealloc(map) failed\n");
Stephen Warren60f7f502012-04-04 09:27:50 -0600107 return -ENOMEM;
Stephen Warrenaef77042012-04-23 10:05:22 -0600108 }
Stephen Warren60f7f502012-04-04 09:27:50 -0600109
110 memset(new_map + old_num, 0, (new_num - old_num) * sizeof(*new_map));
111
112 *map = new_map;
113 *reserved_maps = new_num;
114
115 return 0;
116}
117
118static int add_map_mux(struct pinctrl_map **map, unsigned *reserved_maps,
119 unsigned *num_maps, const char *group,
120 const char *function)
121{
Stephen Warrenaef77042012-04-23 10:05:22 -0600122 if (WARN_ON(*num_maps == *reserved_maps))
Stephen Warren60f7f502012-04-04 09:27:50 -0600123 return -ENOSPC;
124
125 (*map)[*num_maps].type = PIN_MAP_TYPE_MUX_GROUP;
126 (*map)[*num_maps].data.mux.group = group;
127 (*map)[*num_maps].data.mux.function = function;
128 (*num_maps)++;
129
130 return 0;
131}
132
Stephen Warrenaef77042012-04-23 10:05:22 -0600133static int add_map_configs(struct device *dev, struct pinctrl_map **map,
134 unsigned *reserved_maps, unsigned *num_maps,
135 const char *group, unsigned long *configs,
136 unsigned num_configs)
Stephen Warren60f7f502012-04-04 09:27:50 -0600137{
138 unsigned long *dup_configs;
139
Stephen Warrenaef77042012-04-23 10:05:22 -0600140 if (WARN_ON(*num_maps == *reserved_maps))
Stephen Warren60f7f502012-04-04 09:27:50 -0600141 return -ENOSPC;
142
143 dup_configs = kmemdup(configs, num_configs * sizeof(*dup_configs),
144 GFP_KERNEL);
Stephen Warrenaef77042012-04-23 10:05:22 -0600145 if (!dup_configs) {
146 dev_err(dev, "kmemdup(configs) failed\n");
Stephen Warren60f7f502012-04-04 09:27:50 -0600147 return -ENOMEM;
Stephen Warrenaef77042012-04-23 10:05:22 -0600148 }
Stephen Warren60f7f502012-04-04 09:27:50 -0600149
150 (*map)[*num_maps].type = PIN_MAP_TYPE_CONFIGS_GROUP;
151 (*map)[*num_maps].data.configs.group_or_pin = group;
152 (*map)[*num_maps].data.configs.configs = dup_configs;
153 (*map)[*num_maps].data.configs.num_configs = num_configs;
154 (*num_maps)++;
155
156 return 0;
157}
158
Stephen Warrenaef77042012-04-23 10:05:22 -0600159static int add_config(struct device *dev, unsigned long **configs,
160 unsigned *num_configs, unsigned long config)
Stephen Warren60f7f502012-04-04 09:27:50 -0600161{
162 unsigned old_num = *num_configs;
163 unsigned new_num = old_num + 1;
164 unsigned long *new_configs;
165
166 new_configs = krealloc(*configs, sizeof(*new_configs) * new_num,
167 GFP_KERNEL);
Stephen Warrenaef77042012-04-23 10:05:22 -0600168 if (!new_configs) {
169 dev_err(dev, "krealloc(configs) failed\n");
Stephen Warren60f7f502012-04-04 09:27:50 -0600170 return -ENOMEM;
Stephen Warrenaef77042012-04-23 10:05:22 -0600171 }
Stephen Warren60f7f502012-04-04 09:27:50 -0600172
173 new_configs[old_num] = config;
174
175 *configs = new_configs;
176 *num_configs = new_num;
177
178 return 0;
179}
180
181void tegra_pinctrl_dt_free_map(struct pinctrl_dev *pctldev,
182 struct pinctrl_map *map, unsigned num_maps)
183{
184 int i;
185
186 for (i = 0; i < num_maps; i++)
187 if (map[i].type == PIN_MAP_TYPE_CONFIGS_GROUP)
188 kfree(map[i].data.configs.configs);
189
190 kfree(map);
191}
192
193static const struct cfg_param {
194 const char *property;
195 enum tegra_pinconf_param param;
196} cfg_params[] = {
197 {"nvidia,pull", TEGRA_PINCONF_PARAM_PULL},
198 {"nvidia,tristate", TEGRA_PINCONF_PARAM_TRISTATE},
199 {"nvidia,enable-input", TEGRA_PINCONF_PARAM_ENABLE_INPUT},
200 {"nvidia,open-drain", TEGRA_PINCONF_PARAM_OPEN_DRAIN},
201 {"nvidia,lock", TEGRA_PINCONF_PARAM_LOCK},
202 {"nvidia,io-reset", TEGRA_PINCONF_PARAM_IORESET},
203 {"nvidia,high-speed-mode", TEGRA_PINCONF_PARAM_HIGH_SPEED_MODE},
204 {"nvidia,schmitt", TEGRA_PINCONF_PARAM_SCHMITT},
205 {"nvidia,low-power-mode", TEGRA_PINCONF_PARAM_LOW_POWER_MODE},
206 {"nvidia,pull-down-strength", TEGRA_PINCONF_PARAM_DRIVE_DOWN_STRENGTH},
207 {"nvidia,pull-up-strength", TEGRA_PINCONF_PARAM_DRIVE_UP_STRENGTH},
208 {"nvidia,slew-rate-falling", TEGRA_PINCONF_PARAM_SLEW_RATE_FALLING},
209 {"nvidia,slew-rate-rising", TEGRA_PINCONF_PARAM_SLEW_RATE_RISING},
210};
211
Stephen Warrenaef77042012-04-23 10:05:22 -0600212int tegra_pinctrl_dt_subnode_to_map(struct device *dev,
213 struct device_node *np,
Stephen Warren60f7f502012-04-04 09:27:50 -0600214 struct pinctrl_map **map,
215 unsigned *reserved_maps,
216 unsigned *num_maps)
217{
218 int ret, i;
219 const char *function;
220 u32 val;
221 unsigned long config;
222 unsigned long *configs = NULL;
223 unsigned num_configs = 0;
224 unsigned reserve;
225 struct property *prop;
226 const char *group;
227
228 ret = of_property_read_string(np, "nvidia,function", &function);
Stephen Warrenaef77042012-04-23 10:05:22 -0600229 if (ret < 0) {
230 /* EINVAL=missing, which is fine since it's optional */
231 if (ret != -EINVAL)
232 dev_err(dev,
233 "could not parse property nvidia,function\n");
Stephen Warren60f7f502012-04-04 09:27:50 -0600234 function = NULL;
Stephen Warrenaef77042012-04-23 10:05:22 -0600235 }
Stephen Warren60f7f502012-04-04 09:27:50 -0600236
237 for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
238 ret = of_property_read_u32(np, cfg_params[i].property, &val);
239 if (!ret) {
240 config = TEGRA_PINCONF_PACK(cfg_params[i].param, val);
Stephen Warrenaef77042012-04-23 10:05:22 -0600241 ret = add_config(dev, &configs, &num_configs, config);
Stephen Warren60f7f502012-04-04 09:27:50 -0600242 if (ret < 0)
243 goto exit;
Stephen Warrenaef77042012-04-23 10:05:22 -0600244 /* EINVAL=missing, which is fine since it's optional */
245 } else if (ret != -EINVAL) {
246 dev_err(dev, "could not parse property %s\n",
247 cfg_params[i].property);
Stephen Warren60f7f502012-04-04 09:27:50 -0600248 }
249 }
250
251 reserve = 0;
252 if (function != NULL)
253 reserve++;
254 if (num_configs)
255 reserve++;
256 ret = of_property_count_strings(np, "nvidia,pins");
Stephen Warrenaef77042012-04-23 10:05:22 -0600257 if (ret < 0) {
258 dev_err(dev, "could not parse property nvidia,pins\n");
Stephen Warren60f7f502012-04-04 09:27:50 -0600259 goto exit;
Stephen Warrenaef77042012-04-23 10:05:22 -0600260 }
Stephen Warren60f7f502012-04-04 09:27:50 -0600261 reserve *= ret;
262
Stephen Warrenaef77042012-04-23 10:05:22 -0600263 ret = reserve_map(dev, map, reserved_maps, num_maps, reserve);
Stephen Warren60f7f502012-04-04 09:27:50 -0600264 if (ret < 0)
265 goto exit;
266
267 of_property_for_each_string(np, "nvidia,pins", prop, group) {
268 if (function) {
269 ret = add_map_mux(map, reserved_maps, num_maps,
270 group, function);
271 if (ret < 0)
272 goto exit;
273 }
274
275 if (num_configs) {
Stephen Warrenaef77042012-04-23 10:05:22 -0600276 ret = add_map_configs(dev, map, reserved_maps,
277 num_maps, group, configs,
278 num_configs);
Stephen Warren60f7f502012-04-04 09:27:50 -0600279 if (ret < 0)
280 goto exit;
281 }
282 }
283
284 ret = 0;
285
286exit:
287 kfree(configs);
288 return ret;
289}
290
291int tegra_pinctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
292 struct device_node *np_config,
293 struct pinctrl_map **map, unsigned *num_maps)
294{
295 unsigned reserved_maps;
296 struct device_node *np;
297 int ret;
298
299 reserved_maps = 0;
300 *map = NULL;
301 *num_maps = 0;
302
303 for_each_child_of_node(np_config, np) {
Stephen Warrenaef77042012-04-23 10:05:22 -0600304 ret = tegra_pinctrl_dt_subnode_to_map(pctldev->dev, np, map,
305 &reserved_maps, num_maps);
Stephen Warren60f7f502012-04-04 09:27:50 -0600306 if (ret < 0) {
307 tegra_pinctrl_dt_free_map(pctldev, *map, *num_maps);
308 return ret;
309 }
310 }
311
312 return 0;
313}
314
Stephen Warren971dac72012-02-01 14:04:47 -0700315static struct pinctrl_ops tegra_pinctrl_ops = {
Viresh Kumard1e90e92012-03-30 11:25:40 +0530316 .get_groups_count = tegra_pinctrl_get_groups_count,
Stephen Warren971dac72012-02-01 14:04:47 -0700317 .get_group_name = tegra_pinctrl_get_group_name,
318 .get_group_pins = tegra_pinctrl_get_group_pins,
Stephen Warrenb5badba2012-04-11 15:42:56 -0600319#ifdef CONFIG_DEBUG_FS
Stephen Warren971dac72012-02-01 14:04:47 -0700320 .pin_dbg_show = tegra_pinctrl_pin_dbg_show,
Stephen Warrenb5badba2012-04-11 15:42:56 -0600321#endif
Stephen Warren60f7f502012-04-04 09:27:50 -0600322 .dt_node_to_map = tegra_pinctrl_dt_node_to_map,
323 .dt_free_map = tegra_pinctrl_dt_free_map,
Stephen Warren971dac72012-02-01 14:04:47 -0700324};
325
Viresh Kumard1e90e92012-03-30 11:25:40 +0530326static int tegra_pinctrl_get_funcs_count(struct pinctrl_dev *pctldev)
Stephen Warren971dac72012-02-01 14:04:47 -0700327{
328 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
329
Viresh Kumard1e90e92012-03-30 11:25:40 +0530330 return pmx->soc->nfunctions;
Stephen Warren971dac72012-02-01 14:04:47 -0700331}
332
333static const char *tegra_pinctrl_get_func_name(struct pinctrl_dev *pctldev,
334 unsigned function)
335{
336 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
337
Stephen Warren971dac72012-02-01 14:04:47 -0700338 return pmx->soc->functions[function].name;
339}
340
341static int tegra_pinctrl_get_func_groups(struct pinctrl_dev *pctldev,
342 unsigned function,
343 const char * const **groups,
344 unsigned * const num_groups)
345{
346 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
347
Stephen Warren971dac72012-02-01 14:04:47 -0700348 *groups = pmx->soc->functions[function].groups;
349 *num_groups = pmx->soc->functions[function].ngroups;
350
351 return 0;
352}
353
354static int tegra_pinctrl_enable(struct pinctrl_dev *pctldev, unsigned function,
355 unsigned group)
356{
357 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
358 const struct tegra_pingroup *g;
359 int i;
360 u32 val;
361
Stephen Warren971dac72012-02-01 14:04:47 -0700362 g = &pmx->soc->groups[group];
363
Stephen Warrenaef77042012-04-23 10:05:22 -0600364 if (WARN_ON(g->mux_reg < 0))
Stephen Warren971dac72012-02-01 14:04:47 -0700365 return -EINVAL;
366
367 for (i = 0; i < ARRAY_SIZE(g->funcs); i++) {
368 if (g->funcs[i] == function)
369 break;
370 }
Stephen Warrenaef77042012-04-23 10:05:22 -0600371 if (WARN_ON(i == ARRAY_SIZE(g->funcs)))
Stephen Warren971dac72012-02-01 14:04:47 -0700372 return -EINVAL;
373
374 val = pmx_readl(pmx, g->mux_bank, g->mux_reg);
375 val &= ~(0x3 << g->mux_bit);
376 val |= i << g->mux_bit;
377 pmx_writel(pmx, val, g->mux_bank, g->mux_reg);
378
379 return 0;
380}
381
382static void tegra_pinctrl_disable(struct pinctrl_dev *pctldev,
383 unsigned function, unsigned group)
384{
385 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
386 const struct tegra_pingroup *g;
387 u32 val;
388
Stephen Warren971dac72012-02-01 14:04:47 -0700389 g = &pmx->soc->groups[group];
390
Stephen Warrenaef77042012-04-23 10:05:22 -0600391 if (WARN_ON(g->mux_reg < 0))
Stephen Warren971dac72012-02-01 14:04:47 -0700392 return;
393
394 val = pmx_readl(pmx, g->mux_bank, g->mux_reg);
395 val &= ~(0x3 << g->mux_bit);
396 val |= g->func_safe << g->mux_bit;
397 pmx_writel(pmx, val, g->mux_bank, g->mux_reg);
398}
399
400static struct pinmux_ops tegra_pinmux_ops = {
Viresh Kumard1e90e92012-03-30 11:25:40 +0530401 .get_functions_count = tegra_pinctrl_get_funcs_count,
Stephen Warren971dac72012-02-01 14:04:47 -0700402 .get_function_name = tegra_pinctrl_get_func_name,
403 .get_function_groups = tegra_pinctrl_get_func_groups,
404 .enable = tegra_pinctrl_enable,
405 .disable = tegra_pinctrl_disable,
406};
407
408static int tegra_pinconf_reg(struct tegra_pmx *pmx,
409 const struct tegra_pingroup *g,
410 enum tegra_pinconf_param param,
Stephen Warrenb5badba2012-04-11 15:42:56 -0600411 bool report_err,
Stephen Warren971dac72012-02-01 14:04:47 -0700412 s8 *bank, s16 *reg, s8 *bit, s8 *width)
413{
414 switch (param) {
415 case TEGRA_PINCONF_PARAM_PULL:
416 *bank = g->pupd_bank;
417 *reg = g->pupd_reg;
418 *bit = g->pupd_bit;
419 *width = 2;
420 break;
421 case TEGRA_PINCONF_PARAM_TRISTATE:
422 *bank = g->tri_bank;
423 *reg = g->tri_reg;
424 *bit = g->tri_bit;
425 *width = 1;
426 break;
427 case TEGRA_PINCONF_PARAM_ENABLE_INPUT:
428 *bank = g->einput_bank;
429 *reg = g->einput_reg;
430 *bit = g->einput_bit;
431 *width = 1;
432 break;
433 case TEGRA_PINCONF_PARAM_OPEN_DRAIN:
434 *bank = g->odrain_bank;
435 *reg = g->odrain_reg;
436 *bit = g->odrain_bit;
437 *width = 1;
438 break;
439 case TEGRA_PINCONF_PARAM_LOCK:
440 *bank = g->lock_bank;
441 *reg = g->lock_reg;
442 *bit = g->lock_bit;
443 *width = 1;
444 break;
445 case TEGRA_PINCONF_PARAM_IORESET:
446 *bank = g->ioreset_bank;
447 *reg = g->ioreset_reg;
448 *bit = g->ioreset_bit;
449 *width = 1;
450 break;
451 case TEGRA_PINCONF_PARAM_HIGH_SPEED_MODE:
452 *bank = g->drv_bank;
453 *reg = g->drv_reg;
454 *bit = g->hsm_bit;
455 *width = 1;
456 break;
457 case TEGRA_PINCONF_PARAM_SCHMITT:
458 *bank = g->drv_bank;
459 *reg = g->drv_reg;
460 *bit = g->schmitt_bit;
461 *width = 1;
462 break;
463 case TEGRA_PINCONF_PARAM_LOW_POWER_MODE:
464 *bank = g->drv_bank;
465 *reg = g->drv_reg;
466 *bit = g->lpmd_bit;
Pritesh Raithatha154f3eb2012-10-17 17:09:36 +0530467 *width = 2;
Stephen Warren971dac72012-02-01 14:04:47 -0700468 break;
469 case TEGRA_PINCONF_PARAM_DRIVE_DOWN_STRENGTH:
470 *bank = g->drv_bank;
471 *reg = g->drv_reg;
472 *bit = g->drvdn_bit;
473 *width = g->drvdn_width;
474 break;
475 case TEGRA_PINCONF_PARAM_DRIVE_UP_STRENGTH:
476 *bank = g->drv_bank;
477 *reg = g->drv_reg;
478 *bit = g->drvup_bit;
479 *width = g->drvup_width;
480 break;
481 case TEGRA_PINCONF_PARAM_SLEW_RATE_FALLING:
482 *bank = g->drv_bank;
483 *reg = g->drv_reg;
484 *bit = g->slwf_bit;
485 *width = g->slwf_width;
486 break;
487 case TEGRA_PINCONF_PARAM_SLEW_RATE_RISING:
488 *bank = g->drv_bank;
489 *reg = g->drv_reg;
490 *bit = g->slwr_bit;
491 *width = g->slwr_width;
492 break;
493 default:
494 dev_err(pmx->dev, "Invalid config param %04x\n", param);
495 return -ENOTSUPP;
496 }
497
498 if (*reg < 0) {
Stephen Warrenb5badba2012-04-11 15:42:56 -0600499 if (report_err)
500 dev_err(pmx->dev,
501 "Config param %04x not supported on group %s\n",
502 param, g->name);
Stephen Warren971dac72012-02-01 14:04:47 -0700503 return -ENOTSUPP;
504 }
505
506 return 0;
507}
508
509static int tegra_pinconf_get(struct pinctrl_dev *pctldev,
510 unsigned pin, unsigned long *config)
511{
Stephen Warrenaef77042012-04-23 10:05:22 -0600512 dev_err(pctldev->dev, "pin_config_get op not supported\n");
Stephen Warren971dac72012-02-01 14:04:47 -0700513 return -ENOTSUPP;
514}
515
516static int tegra_pinconf_set(struct pinctrl_dev *pctldev,
517 unsigned pin, unsigned long config)
518{
Stephen Warrenaef77042012-04-23 10:05:22 -0600519 dev_err(pctldev->dev, "pin_config_set op not supported\n");
Stephen Warren971dac72012-02-01 14:04:47 -0700520 return -ENOTSUPP;
521}
522
523static int tegra_pinconf_group_get(struct pinctrl_dev *pctldev,
524 unsigned group, unsigned long *config)
525{
526 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
527 enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(*config);
528 u16 arg;
529 const struct tegra_pingroup *g;
530 int ret;
531 s8 bank, bit, width;
532 s16 reg;
533 u32 val, mask;
534
Stephen Warren971dac72012-02-01 14:04:47 -0700535 g = &pmx->soc->groups[group];
536
Stephen Warrenb5badba2012-04-11 15:42:56 -0600537 ret = tegra_pinconf_reg(pmx, g, param, true, &bank, &reg, &bit,
538 &width);
Stephen Warren971dac72012-02-01 14:04:47 -0700539 if (ret < 0)
540 return ret;
541
542 val = pmx_readl(pmx, bank, reg);
543 mask = (1 << width) - 1;
544 arg = (val >> bit) & mask;
545
546 *config = TEGRA_PINCONF_PACK(param, arg);
547
548 return 0;
549}
550
551static int tegra_pinconf_group_set(struct pinctrl_dev *pctldev,
552 unsigned group, unsigned long config)
553{
554 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
555 enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(config);
556 u16 arg = TEGRA_PINCONF_UNPACK_ARG(config);
557 const struct tegra_pingroup *g;
558 int ret;
559 s8 bank, bit, width;
560 s16 reg;
561 u32 val, mask;
562
Stephen Warren971dac72012-02-01 14:04:47 -0700563 g = &pmx->soc->groups[group];
564
Stephen Warrenb5badba2012-04-11 15:42:56 -0600565 ret = tegra_pinconf_reg(pmx, g, param, true, &bank, &reg, &bit,
566 &width);
Stephen Warren971dac72012-02-01 14:04:47 -0700567 if (ret < 0)
568 return ret;
569
570 val = pmx_readl(pmx, bank, reg);
571
572 /* LOCK can't be cleared */
573 if (param == TEGRA_PINCONF_PARAM_LOCK) {
Stephen Warrenaef77042012-04-23 10:05:22 -0600574 if ((val & BIT(bit)) && !arg) {
575 dev_err(pctldev->dev, "LOCK bit cannot be cleared\n");
Stephen Warren971dac72012-02-01 14:04:47 -0700576 return -EINVAL;
Stephen Warrenaef77042012-04-23 10:05:22 -0600577 }
Stephen Warren971dac72012-02-01 14:04:47 -0700578 }
579
580 /* Special-case Boolean values; allow any non-zero as true */
581 if (width == 1)
582 arg = !!arg;
583
584 /* Range-check user-supplied value */
585 mask = (1 << width) - 1;
Stephen Warrenaef77042012-04-23 10:05:22 -0600586 if (arg & ~mask) {
587 dev_err(pctldev->dev,
588 "config %lx: %x too big for %d bit register\n",
589 config, arg, width);
Stephen Warren971dac72012-02-01 14:04:47 -0700590 return -EINVAL;
Stephen Warrenaef77042012-04-23 10:05:22 -0600591 }
Stephen Warren971dac72012-02-01 14:04:47 -0700592
593 /* Update register */
594 val &= ~(mask << bit);
595 val |= arg << bit;
596 pmx_writel(pmx, val, bank, reg);
597
598 return 0;
599}
600
Stephen Warrenb5badba2012-04-11 15:42:56 -0600601#ifdef CONFIG_DEBUG_FS
Stephen Warren971dac72012-02-01 14:04:47 -0700602static void tegra_pinconf_dbg_show(struct pinctrl_dev *pctldev,
603 struct seq_file *s, unsigned offset)
604{
605}
606
Stephen Warrenb5badba2012-04-11 15:42:56 -0600607static const char *strip_prefix(const char *s)
Stephen Warren971dac72012-02-01 14:04:47 -0700608{
Stephen Warrenb5badba2012-04-11 15:42:56 -0600609 const char *comma = strchr(s, ',');
610 if (!comma)
611 return s;
612
613 return comma + 1;
Stephen Warren971dac72012-02-01 14:04:47 -0700614}
615
Stephen Warrenb5badba2012-04-11 15:42:56 -0600616static void tegra_pinconf_group_dbg_show(struct pinctrl_dev *pctldev,
617 struct seq_file *s, unsigned group)
618{
619 struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
620 const struct tegra_pingroup *g;
621 int i, ret;
622 s8 bank, bit, width;
623 s16 reg;
624 u32 val;
625
626 g = &pmx->soc->groups[group];
627
628 for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
629 ret = tegra_pinconf_reg(pmx, g, cfg_params[i].param, false,
630 &bank, &reg, &bit, &width);
631 if (ret < 0)
632 continue;
633
634 val = pmx_readl(pmx, bank, reg);
635 val >>= bit;
636 val &= (1 << width) - 1;
637
638 seq_printf(s, "\n\t%s=%u",
639 strip_prefix(cfg_params[i].property), val);
640 }
641}
642
643static void tegra_pinconf_config_dbg_show(struct pinctrl_dev *pctldev,
644 struct seq_file *s,
645 unsigned long config)
646{
647 enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(config);
648 u16 arg = TEGRA_PINCONF_UNPACK_ARG(config);
649 const char *pname = "unknown";
650 int i;
651
652 for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
653 if (cfg_params[i].param == param) {
654 pname = cfg_params[i].property;
655 break;
656 }
657 }
658
659 seq_printf(s, "%s=%d", strip_prefix(pname), arg);
660}
661#endif
662
Stephen Warren971dac72012-02-01 14:04:47 -0700663struct pinconf_ops tegra_pinconf_ops = {
664 .pin_config_get = tegra_pinconf_get,
665 .pin_config_set = tegra_pinconf_set,
666 .pin_config_group_get = tegra_pinconf_group_get,
667 .pin_config_group_set = tegra_pinconf_group_set,
Stephen Warrenb5badba2012-04-11 15:42:56 -0600668#ifdef CONFIG_DEBUG_FS
Stephen Warren971dac72012-02-01 14:04:47 -0700669 .pin_config_dbg_show = tegra_pinconf_dbg_show,
670 .pin_config_group_dbg_show = tegra_pinconf_group_dbg_show,
Stephen Warrenb5badba2012-04-11 15:42:56 -0600671 .pin_config_config_dbg_show = tegra_pinconf_config_dbg_show,
672#endif
Stephen Warren971dac72012-02-01 14:04:47 -0700673};
674
675static struct pinctrl_gpio_range tegra_pinctrl_gpio_range = {
676 .name = "Tegra GPIOs",
677 .id = 0,
678 .base = 0,
679};
680
681static struct pinctrl_desc tegra_pinctrl_desc = {
Stephen Warren971dac72012-02-01 14:04:47 -0700682 .pctlops = &tegra_pinctrl_ops,
683 .pmxops = &tegra_pinmux_ops,
684 .confops = &tegra_pinconf_ops,
685 .owner = THIS_MODULE,
686};
687
Stephen Warren52f48fe2012-04-11 12:53:09 -0600688int __devinit tegra_pinctrl_probe(struct platform_device *pdev,
689 const struct tegra_pinctrl_soc_data *soc_data)
Stephen Warren971dac72012-02-01 14:04:47 -0700690{
Stephen Warren971dac72012-02-01 14:04:47 -0700691 struct tegra_pmx *pmx;
692 struct resource *res;
693 int i;
694
Stephen Warren971dac72012-02-01 14:04:47 -0700695 pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);
696 if (!pmx) {
697 dev_err(&pdev->dev, "Can't alloc tegra_pmx\n");
698 return -ENOMEM;
699 }
700 pmx->dev = &pdev->dev;
Stephen Warren52f48fe2012-04-11 12:53:09 -0600701 pmx->soc = soc_data;
Stephen Warren971dac72012-02-01 14:04:47 -0700702
703 tegra_pinctrl_gpio_range.npins = pmx->soc->ngpios;
Stephen Warren52f48fe2012-04-11 12:53:09 -0600704 tegra_pinctrl_desc.name = dev_name(&pdev->dev);
Stephen Warren971dac72012-02-01 14:04:47 -0700705 tegra_pinctrl_desc.pins = pmx->soc->pins;
706 tegra_pinctrl_desc.npins = pmx->soc->npins;
707
708 for (i = 0; ; i++) {
709 res = platform_get_resource(pdev, IORESOURCE_MEM, i);
710 if (!res)
711 break;
712 }
713 pmx->nbanks = i;
714
715 pmx->regs = devm_kzalloc(&pdev->dev, pmx->nbanks * sizeof(*pmx->regs),
716 GFP_KERNEL);
717 if (!pmx->regs) {
718 dev_err(&pdev->dev, "Can't alloc regs pointer\n");
719 return -ENODEV;
720 }
721
722 for (i = 0; i < pmx->nbanks; i++) {
723 res = platform_get_resource(pdev, IORESOURCE_MEM, i);
724 if (!res) {
725 dev_err(&pdev->dev, "Missing MEM resource\n");
726 return -ENODEV;
727 }
728
729 if (!devm_request_mem_region(&pdev->dev, res->start,
730 resource_size(res),
731 dev_name(&pdev->dev))) {
732 dev_err(&pdev->dev,
733 "Couldn't request MEM resource %d\n", i);
734 return -ENODEV;
735 }
736
737 pmx->regs[i] = devm_ioremap(&pdev->dev, res->start,
738 resource_size(res));
739 if (!pmx->regs[i]) {
740 dev_err(&pdev->dev, "Couldn't ioremap regs %d\n", i);
741 return -ENODEV;
742 }
743 }
744
745 pmx->pctl = pinctrl_register(&tegra_pinctrl_desc, &pdev->dev, pmx);
Devendra Nagacb0f7d32012-06-18 23:14:31 +0530746 if (!pmx->pctl) {
Stephen Warren971dac72012-02-01 14:04:47 -0700747 dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");
Devendra Nagacb0f7d32012-06-18 23:14:31 +0530748 return -ENODEV;
Stephen Warren971dac72012-02-01 14:04:47 -0700749 }
750
751 pinctrl_add_gpio_range(pmx->pctl, &tegra_pinctrl_gpio_range);
752
753 platform_set_drvdata(pdev, pmx);
754
755 dev_dbg(&pdev->dev, "Probed Tegra pinctrl driver\n");
756
757 return 0;
758}
Stephen Warren52f48fe2012-04-11 12:53:09 -0600759EXPORT_SYMBOL_GPL(tegra_pinctrl_probe);
Stephen Warren971dac72012-02-01 14:04:47 -0700760
Stephen Warren52f48fe2012-04-11 12:53:09 -0600761int __devexit tegra_pinctrl_remove(struct platform_device *pdev)
Stephen Warren971dac72012-02-01 14:04:47 -0700762{
763 struct tegra_pmx *pmx = platform_get_drvdata(pdev);
764
Stephen Warren971dac72012-02-01 14:04:47 -0700765 pinctrl_unregister(pmx->pctl);
766
767 return 0;
768}
Stephen Warren52f48fe2012-04-11 12:53:09 -0600769EXPORT_SYMBOL_GPL(tegra_pinctrl_remove);