blob: c349911708ef8e98b868dc0ed39ceec9b72f3605 [file] [log] [blame]
James Hoganb58f0272013-06-20 10:26:29 +01001/*
2 * Pinctrl driver for the Toumaz Xenif TZ1090 PowerDown Controller pins
3 *
4 * Copyright (c) 2013, Imagination Technologies Ltd.
5 *
6 * Derived from Tegra code:
7 * Copyright (c) 2011-2012, NVIDIA CORPORATION. All rights reserved.
8 *
9 * Derived from code:
10 * Copyright (C) 2010 Google, Inc.
11 * Copyright (C) 2010 NVIDIA Corporation
12 * Copyright (C) 2009-2011 ST-Ericsson AB
13 *
14 * This program is free software; you can redistribute it and/or modify it
15 * under the terms and conditions of the GNU General Public License,
16 * version 2, as published by the Free Software Foundation.
17 *
18 * This program is distributed in the hope it will be useful, but WITHOUT
19 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
20 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
21 * more details.
22 */
23
24#include <linux/bitops.h>
25#include <linux/io.h>
26#include <linux/module.h>
27#include <linux/of.h>
28#include <linux/platform_device.h>
29#include <linux/pinctrl/machine.h>
30#include <linux/pinctrl/pinconf-generic.h>
31#include <linux/pinctrl/pinctrl.h>
32#include <linux/pinctrl/pinmux.h>
33#include <linux/slab.h>
34
35/*
36 * The registers may be shared with other threads/cores, so we need to use the
37 * metag global lock2 for atomicity.
38 */
39#include <asm/global_lock.h>
40
41#include "core.h"
42#include "pinconf.h"
43
44/* Register offsets from bank base address */
45#define REG_GPIO_CONTROL0 0x00
46#define REG_GPIO_CONTROL2 0x08
47
48/* Register field information */
49#define REG_GPIO_CONTROL2_PU_PD_S 16
50#define REG_GPIO_CONTROL2_PDC_POS_S 4
51#define REG_GPIO_CONTROL2_PDC_DR_S 2
52#define REG_GPIO_CONTROL2_PDC_SR_S 1
53#define REG_GPIO_CONTROL2_PDC_SCHMITT_S 0
54
55/* PU_PD field values */
56#define REG_PU_PD_TRISTATE 0
57#define REG_PU_PD_UP 1
58#define REG_PU_PD_DOWN 2
59#define REG_PU_PD_REPEATER 3
60
61/* DR field values */
62#define REG_DR_2mA 0
63#define REG_DR_4mA 1
64#define REG_DR_8mA 2
65#define REG_DR_12mA 3
66
67/**
68 * struct tz1090_pdc_function - TZ1090 PDC pinctrl mux function
69 * @name: The name of the function, exported to pinctrl core.
70 * @groups: An array of pin groups that may select this function.
71 * @ngroups: The number of entries in @groups.
72 */
73struct tz1090_pdc_function {
74 const char *name;
75 const char * const *groups;
76 unsigned int ngroups;
77};
78
79/**
80 * struct tz1090_pdc_pingroup - TZ1090 PDC pin group
81 * @name: Name of pin group.
82 * @pins: Array of pin numbers in this pin group.
83 * @npins: Number of pins in this pin group.
84 * @func: Function enabled by the mux.
85 * @reg: Mux register offset.
86 * @bit: Mux register bit.
87 * @drv: Drive control supported, otherwise it's a mux.
88 * This means Schmitt, Slew, and Drive strength.
89 *
90 * A representation of a group of pins (possibly just one pin) in the TZ1090
91 * PDC pin controller. Each group allows some parameter or parameters to be
92 * configured. The most common is mux function selection.
93 */
94struct tz1090_pdc_pingroup {
95 const char *name;
96 const unsigned int *pins;
97 unsigned int npins;
98 int func;
99 u16 reg;
100 u8 bit;
101 bool drv;
102};
103
104/*
105 * All PDC pins can be GPIOs. Define these first to match how the GPIO driver
106 * names/numbers its pins.
107 */
108
109enum tz1090_pdc_pin {
110 TZ1090_PDC_PIN_GPIO0,
111 TZ1090_PDC_PIN_GPIO1,
112 TZ1090_PDC_PIN_SYS_WAKE0,
113 TZ1090_PDC_PIN_SYS_WAKE1,
114 TZ1090_PDC_PIN_SYS_WAKE2,
115 TZ1090_PDC_PIN_IR_DATA,
116 TZ1090_PDC_PIN_EXT_POWER,
117};
118
119/* Pin names */
120
121static const struct pinctrl_pin_desc tz1090_pdc_pins[] = {
122 /* PDC GPIOs */
123 PINCTRL_PIN(TZ1090_PDC_PIN_GPIO0, "gpio0"),
124 PINCTRL_PIN(TZ1090_PDC_PIN_GPIO1, "gpio1"),
125 PINCTRL_PIN(TZ1090_PDC_PIN_SYS_WAKE0, "sys_wake0"),
126 PINCTRL_PIN(TZ1090_PDC_PIN_SYS_WAKE1, "sys_wake1"),
127 PINCTRL_PIN(TZ1090_PDC_PIN_SYS_WAKE2, "sys_wake2"),
128 PINCTRL_PIN(TZ1090_PDC_PIN_IR_DATA, "ir_data"),
129 PINCTRL_PIN(TZ1090_PDC_PIN_EXT_POWER, "ext_power"),
130};
131
132/* Pin group pins */
133
134static const unsigned int gpio0_pins[] = {
135 TZ1090_PDC_PIN_GPIO0,
136};
137
138static const unsigned int gpio1_pins[] = {
139 TZ1090_PDC_PIN_GPIO1,
140};
141
142static const unsigned int pdc_pins[] = {
143 TZ1090_PDC_PIN_GPIO0,
144 TZ1090_PDC_PIN_GPIO1,
145 TZ1090_PDC_PIN_SYS_WAKE0,
146 TZ1090_PDC_PIN_SYS_WAKE1,
147 TZ1090_PDC_PIN_SYS_WAKE2,
148 TZ1090_PDC_PIN_IR_DATA,
149 TZ1090_PDC_PIN_EXT_POWER,
150};
151
152/* Mux functions */
153
154enum tz1090_pdc_mux {
155 /* PDC_GPIO0 mux */
156 TZ1090_PDC_MUX_IR_MOD_STABLE_OUT,
157 /* PDC_GPIO1 mux */
158 TZ1090_PDC_MUX_IR_MOD_POWER_OUT,
159};
160
161/* Pin groups a function can be muxed to */
162
163static const char * const gpio0_groups[] = {
164 "gpio0",
165};
166
167static const char * const gpio1_groups[] = {
168 "gpio1",
169};
170
171#define FUNCTION(mux, fname, group) \
172 [(TZ1090_PDC_MUX_ ## mux)] = { \
173 .name = #fname, \
174 .groups = group##_groups, \
175 .ngroups = ARRAY_SIZE(group##_groups), \
176 }
177
178/* Must correlate with enum tz1090_pdc_mux */
179static const struct tz1090_pdc_function tz1090_pdc_functions[] = {
180 /* MUX fn pingroups */
181 FUNCTION(IR_MOD_STABLE_OUT, ir_mod_stable_out, gpio0),
182 FUNCTION(IR_MOD_POWER_OUT, ir_mod_power_out, gpio1),
183};
184
185/**
186 * MUX_PG() - Initialise a pin group with mux control
187 * @pg_name: Pin group name (stringified, _pins appended to get pins array)
188 * @f0: Function 0 (TZ1090_PDC_MUX_ is prepended)
189 * @mux_r: Mux register (REG_PINCTRL_ is prepended)
190 * @mux_b: Bit number in register of mux field
191 */
192#define MUX_PG(pg_name, f0, mux_r, mux_b) \
193 { \
194 .name = #pg_name, \
195 .pins = pg_name##_pins, \
196 .npins = ARRAY_SIZE(pg_name##_pins), \
197 .func = TZ1090_PDC_MUX_ ## f0, \
198 .reg = (REG_ ## mux_r), \
199 .bit = (mux_b), \
200 }
201
202/**
203 * DRV_PG() - Initialise a pin group with drive control
204 * @pg_name: Pin group name (stringified, _pins appended to get pins array)
205 */
206#define DRV_PG(pg_name) \
207 { \
208 .name = #pg_name, \
209 .pins = pg_name##_pins, \
210 .npins = ARRAY_SIZE(pg_name##_pins), \
211 .drv = true, \
212 }
213
214static const struct tz1090_pdc_pingroup tz1090_pdc_groups[] = {
215 /* Muxing pin groups */
216 /* pg_name, f0, mux register, mux bit */
217 MUX_PG(gpio0, IR_MOD_STABLE_OUT, GPIO_CONTROL0, 7),
218 MUX_PG(gpio1, IR_MOD_POWER_OUT, GPIO_CONTROL0, 6),
219
220 /* Drive pin groups */
221 /* pg_name */
222 DRV_PG(pdc),
223};
224
225/**
226 * struct tz1090_pdc_pmx - Private pinctrl data
227 * @dev: Platform device
228 * @pctl: Pin control device
229 * @regs: Register region
230 * @lock: Lock protecting coherency of mux_en and gpio_en
231 * @mux_en: Muxes that have been enabled
232 * @gpio_en: Muxable GPIOs that have been enabled
233 */
234struct tz1090_pdc_pmx {
235 struct device *dev;
236 struct pinctrl_dev *pctl;
237 void __iomem *regs;
238 spinlock_t lock;
239 u32 mux_en;
240 u32 gpio_en;
241};
242
243static inline u32 pmx_read(struct tz1090_pdc_pmx *pmx, u32 reg)
244{
245 return ioread32(pmx->regs + reg);
246}
247
248static inline void pmx_write(struct tz1090_pdc_pmx *pmx, u32 val, u32 reg)
249{
250 iowrite32(val, pmx->regs + reg);
251}
252
253/*
254 * Pin control operations
255 */
256
257static int tz1090_pdc_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
258{
259 return ARRAY_SIZE(tz1090_pdc_groups);
260}
261
262static const char *tz1090_pdc_pinctrl_get_group_name(struct pinctrl_dev *pctl,
263 unsigned int group)
264{
265 return tz1090_pdc_groups[group].name;
266}
267
268static int tz1090_pdc_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
269 unsigned int group,
270 const unsigned int **pins,
271 unsigned int *num_pins)
272{
273 *pins = tz1090_pdc_groups[group].pins;
274 *num_pins = tz1090_pdc_groups[group].npins;
275
276 return 0;
277}
278
279#ifdef CONFIG_DEBUG_FS
280static void tz1090_pdc_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev,
281 struct seq_file *s,
282 unsigned int offset)
283{
284 seq_printf(s, " %s", dev_name(pctldev->dev));
285}
286#endif
287
288static int reserve_map(struct device *dev, struct pinctrl_map **map,
289 unsigned int *reserved_maps, unsigned int *num_maps,
290 unsigned int reserve)
291{
292 unsigned int old_num = *reserved_maps;
293 unsigned int new_num = *num_maps + reserve;
294 struct pinctrl_map *new_map;
295
296 if (old_num >= new_num)
297 return 0;
298
299 new_map = krealloc(*map, sizeof(*new_map) * new_num, GFP_KERNEL);
300 if (!new_map) {
301 dev_err(dev, "krealloc(map) failed\n");
302 return -ENOMEM;
303 }
304
305 memset(new_map + old_num, 0, (new_num - old_num) * sizeof(*new_map));
306
307 *map = new_map;
308 *reserved_maps = new_num;
309
310 return 0;
311}
312
313static int add_map_mux(struct pinctrl_map **map, unsigned int *reserved_maps,
314 unsigned int *num_maps, const char *group,
315 const char *function)
316{
317 if (WARN_ON(*num_maps == *reserved_maps))
318 return -ENOSPC;
319
320 (*map)[*num_maps].type = PIN_MAP_TYPE_MUX_GROUP;
321 (*map)[*num_maps].data.mux.group = group;
322 (*map)[*num_maps].data.mux.function = function;
323 (*num_maps)++;
324
325 return 0;
326}
327
328/**
329 * get_group_selector() - returns the group selector for a group
330 * @pin_group: the pin group to look up
331 *
332 * This is the same as pinctrl_get_group_selector except it doesn't produce an
333 * error message if the group isn't found or debug messages.
334 */
335static int get_group_selector(const char *pin_group)
336{
337 unsigned int group;
338
339 for (group = 0; group < ARRAY_SIZE(tz1090_pdc_groups); ++group)
340 if (!strcmp(tz1090_pdc_groups[group].name, pin_group))
341 return group;
342
343 return -EINVAL;
344}
345
346static int add_map_configs(struct device *dev,
347 struct pinctrl_map **map,
348 unsigned int *reserved_maps, unsigned int *num_maps,
349 const char *group, unsigned long *configs,
350 unsigned int num_configs)
351{
352 unsigned long *dup_configs;
353 enum pinctrl_map_type type;
354
355 if (WARN_ON(*num_maps == *reserved_maps))
356 return -ENOSPC;
357
358 dup_configs = kmemdup(configs, num_configs * sizeof(*dup_configs),
359 GFP_KERNEL);
360 if (!dup_configs) {
361 dev_err(dev, "kmemdup(configs) failed\n");
362 return -ENOMEM;
363 }
364
365 /*
366 * We support both pins and pin groups, but we need to figure out which
367 * one we have.
368 */
369 if (get_group_selector(group) >= 0)
370 type = PIN_MAP_TYPE_CONFIGS_GROUP;
371 else
372 type = PIN_MAP_TYPE_CONFIGS_PIN;
373 (*map)[*num_maps].type = type;
374 (*map)[*num_maps].data.configs.group_or_pin = group;
375 (*map)[*num_maps].data.configs.configs = dup_configs;
376 (*map)[*num_maps].data.configs.num_configs = num_configs;
377 (*num_maps)++;
378
379 return 0;
380}
381
382static void tz1090_pdc_pinctrl_dt_free_map(struct pinctrl_dev *pctldev,
383 struct pinctrl_map *map,
384 unsigned int num_maps)
385{
386 int i;
387
388 for (i = 0; i < num_maps; i++)
389 if (map[i].type == PIN_MAP_TYPE_CONFIGS_GROUP)
390 kfree(map[i].data.configs.configs);
391
392 kfree(map);
393}
394
395static int tz1090_pdc_pinctrl_dt_subnode_to_map(struct device *dev,
396 struct device_node *np,
397 struct pinctrl_map **map,
398 unsigned int *reserved_maps,
399 unsigned int *num_maps)
400{
401 int ret;
402 const char *function;
403 unsigned long *configs = NULL;
404 unsigned int num_configs = 0;
405 unsigned int reserve;
406 struct property *prop;
407 const char *group;
408
409 ret = of_property_read_string(np, "tz1090,function", &function);
410 if (ret < 0) {
411 /* EINVAL=missing, which is fine since it's optional */
412 if (ret != -EINVAL)
413 dev_err(dev,
414 "could not parse property function\n");
415 function = NULL;
416 }
417
Soren Brinkmanndd4d01f2015-01-09 07:43:46 -0800418 ret = pinconf_generic_parse_dt_config(np, NULL, &configs, &num_configs);
James Hoganb58f0272013-06-20 10:26:29 +0100419 if (ret)
420 return ret;
421
422 reserve = 0;
423 if (function != NULL)
424 reserve++;
425 if (num_configs)
426 reserve++;
427 ret = of_property_count_strings(np, "tz1090,pins");
428 if (ret < 0) {
429 dev_err(dev, "could not parse property pins\n");
430 goto exit;
431 }
432 reserve *= ret;
433
434 ret = reserve_map(dev, map, reserved_maps, num_maps, reserve);
435 if (ret < 0)
436 goto exit;
437
438 of_property_for_each_string(np, "tz1090,pins", prop, group) {
439 if (function) {
440 ret = add_map_mux(map, reserved_maps, num_maps,
441 group, function);
442 if (ret < 0)
443 goto exit;
444 }
445
446 if (num_configs) {
447 ret = add_map_configs(dev, map, reserved_maps,
448 num_maps, group, configs,
449 num_configs);
450 if (ret < 0)
451 goto exit;
452 }
453 }
454
455 ret = 0;
456
457exit:
458 kfree(configs);
459 return ret;
460}
461
462static int tz1090_pdc_pinctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
463 struct device_node *np_config,
464 struct pinctrl_map **map,
465 unsigned int *num_maps)
466{
467 unsigned int reserved_maps;
468 struct device_node *np;
469 int ret;
470
471 reserved_maps = 0;
472 *map = NULL;
473 *num_maps = 0;
474
475 for_each_child_of_node(np_config, np) {
476 ret = tz1090_pdc_pinctrl_dt_subnode_to_map(pctldev->dev, np,
477 map, &reserved_maps,
478 num_maps);
479 if (ret < 0) {
480 tz1090_pdc_pinctrl_dt_free_map(pctldev, *map,
481 *num_maps);
482 return ret;
483 }
484 }
485
486 return 0;
487}
488
489static struct pinctrl_ops tz1090_pdc_pinctrl_ops = {
490 .get_groups_count = tz1090_pdc_pinctrl_get_groups_count,
491 .get_group_name = tz1090_pdc_pinctrl_get_group_name,
492 .get_group_pins = tz1090_pdc_pinctrl_get_group_pins,
493#ifdef CONFIG_DEBUG_FS
494 .pin_dbg_show = tz1090_pdc_pinctrl_pin_dbg_show,
495#endif
496 .dt_node_to_map = tz1090_pdc_pinctrl_dt_node_to_map,
497 .dt_free_map = tz1090_pdc_pinctrl_dt_free_map,
498};
499
500/*
501 * Pin mux operations
502 */
503
504static int tz1090_pdc_pinctrl_get_funcs_count(struct pinctrl_dev *pctldev)
505{
506 return ARRAY_SIZE(tz1090_pdc_functions);
507}
508
509static const char *tz1090_pdc_pinctrl_get_func_name(struct pinctrl_dev *pctldev,
510 unsigned int function)
511{
512 return tz1090_pdc_functions[function].name;
513}
514
515static int tz1090_pdc_pinctrl_get_func_groups(struct pinctrl_dev *pctldev,
516 unsigned int function,
517 const char * const **groups,
518 unsigned int * const num_groups)
519{
520 *groups = tz1090_pdc_functions[function].groups;
521 *num_groups = tz1090_pdc_functions[function].ngroups;
522
523 return 0;
524}
525
526/**
527 * tz1090_pdc_pinctrl_mux() - update mux bit
528 * @pmx: Pinmux data
529 * @grp: Pin mux group
530 */
531static void tz1090_pdc_pinctrl_mux(struct tz1090_pdc_pmx *pmx,
532 const struct tz1090_pdc_pingroup *grp)
533{
534 u32 reg, select;
535 unsigned int pin_shift = grp->pins[0];
536 unsigned long flags;
537
538 /* select = mux && !gpio */
539 select = ((pmx->mux_en & ~pmx->gpio_en) >> pin_shift) & 1;
540
541 /* set up the mux */
542 __global_lock2(flags);
543 reg = pmx_read(pmx, grp->reg);
544 reg &= ~BIT(grp->bit);
545 reg |= select << grp->bit;
546 pmx_write(pmx, reg, grp->reg);
547 __global_unlock2(flags);
548}
549
Linus Walleij03e9f0c2014-09-03 13:02:56 +0200550static int tz1090_pdc_pinctrl_set_mux(struct pinctrl_dev *pctldev,
551 unsigned int function,
552 unsigned int group)
James Hoganb58f0272013-06-20 10:26:29 +0100553{
554 struct tz1090_pdc_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
555 const struct tz1090_pdc_pingroup *grp = &tz1090_pdc_groups[group];
556
557 dev_dbg(pctldev->dev, "%s(func=%u (%s), group=%u (%s))\n",
558 __func__,
559 function, tz1090_pdc_functions[function].name,
560 group, tz1090_pdc_groups[group].name);
561
562 /* is it even a mux? */
563 if (grp->drv)
564 return -EINVAL;
565
566 /* does this group even control the function? */
567 if (function != grp->func)
568 return -EINVAL;
569
570 /* record the pin being muxed and update mux bit */
571 spin_lock(&pmx->lock);
572 pmx->mux_en |= BIT(grp->pins[0]);
573 tz1090_pdc_pinctrl_mux(pmx, grp);
574 spin_unlock(&pmx->lock);
575 return 0;
576}
577
James Hoganb58f0272013-06-20 10:26:29 +0100578static const struct tz1090_pdc_pingroup *find_mux_group(
579 struct tz1090_pdc_pmx *pmx,
580 unsigned int pin)
581{
582 const struct tz1090_pdc_pingroup *grp;
583 unsigned int group;
584
585 grp = tz1090_pdc_groups;
586 for (group = 0; group < ARRAY_SIZE(tz1090_pdc_groups); ++group, ++grp) {
587 /* only match muxes */
588 if (grp->drv)
589 continue;
590
591 /* with a matching pin */
592 if (grp->pins[0] == pin)
593 return grp;
594 }
595
596 return NULL;
597}
598
599static int tz1090_pdc_pinctrl_gpio_request_enable(
600 struct pinctrl_dev *pctldev,
601 struct pinctrl_gpio_range *range,
602 unsigned int pin)
603{
604 struct tz1090_pdc_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
605 const struct tz1090_pdc_pingroup *grp = find_mux_group(pmx, pin);
606
607 if (grp) {
608 /* record the pin in GPIO use and update mux bit */
609 spin_lock(&pmx->lock);
610 pmx->gpio_en |= BIT(pin);
611 tz1090_pdc_pinctrl_mux(pmx, grp);
612 spin_unlock(&pmx->lock);
613 }
614 return 0;
615}
616
617static void tz1090_pdc_pinctrl_gpio_disable_free(
618 struct pinctrl_dev *pctldev,
619 struct pinctrl_gpio_range *range,
620 unsigned int pin)
621{
622 struct tz1090_pdc_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
623 const struct tz1090_pdc_pingroup *grp = find_mux_group(pmx, pin);
624
625 if (grp) {
626 /* record the pin not in GPIO use and update mux bit */
627 spin_lock(&pmx->lock);
628 pmx->gpio_en &= ~BIT(pin);
629 tz1090_pdc_pinctrl_mux(pmx, grp);
630 spin_unlock(&pmx->lock);
631 }
632}
633
634static struct pinmux_ops tz1090_pdc_pinmux_ops = {
635 .get_functions_count = tz1090_pdc_pinctrl_get_funcs_count,
636 .get_function_name = tz1090_pdc_pinctrl_get_func_name,
637 .get_function_groups = tz1090_pdc_pinctrl_get_func_groups,
Linus Walleij03e9f0c2014-09-03 13:02:56 +0200638 .set_mux = tz1090_pdc_pinctrl_set_mux,
James Hoganb58f0272013-06-20 10:26:29 +0100639 .gpio_request_enable = tz1090_pdc_pinctrl_gpio_request_enable,
640 .gpio_disable_free = tz1090_pdc_pinctrl_gpio_disable_free,
641};
642
643/*
644 * Pin config operations
645 */
646
647static int tz1090_pdc_pinconf_reg(struct pinctrl_dev *pctldev,
648 unsigned int pin,
649 enum pin_config_param param,
650 bool report_err,
651 u32 *reg, u32 *width, u32 *mask, u32 *shift,
652 u32 *val)
653{
654 /* Find information about parameter's register */
655 switch (param) {
656 case PIN_CONFIG_BIAS_DISABLE:
657 case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
658 *val = REG_PU_PD_TRISTATE;
659 break;
660 case PIN_CONFIG_BIAS_PULL_UP:
661 *val = REG_PU_PD_UP;
662 break;
663 case PIN_CONFIG_BIAS_PULL_DOWN:
664 *val = REG_PU_PD_DOWN;
665 break;
666 case PIN_CONFIG_BIAS_BUS_HOLD:
667 *val = REG_PU_PD_REPEATER;
668 break;
669 default:
670 return -ENOTSUPP;
671 };
672
673 /* Only input bias parameters supported */
674 *reg = REG_GPIO_CONTROL2;
675 *shift = REG_GPIO_CONTROL2_PU_PD_S + pin*2;
676 *width = 2;
677
678 /* Calculate field information */
679 *mask = (BIT(*width) - 1) << *shift;
680
681 return 0;
682}
683
684static int tz1090_pdc_pinconf_get(struct pinctrl_dev *pctldev,
685 unsigned int pin, unsigned long *config)
686{
687 struct tz1090_pdc_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
688 enum pin_config_param param = pinconf_to_config_param(*config);
689 int ret;
690 u32 reg, width, mask, shift, val, tmp, arg;
691
692 /* Get register information */
693 ret = tz1090_pdc_pinconf_reg(pctldev, pin, param, true,
694 &reg, &width, &mask, &shift, &val);
695 if (ret < 0)
696 return ret;
697
698 /* Extract field from register */
699 tmp = pmx_read(pmx, reg);
700 arg = ((tmp & mask) >> shift) == val;
701
702 /* Config not active */
703 if (!arg)
704 return -EINVAL;
705
706 /* And pack config */
707 *config = pinconf_to_config_packed(param, arg);
708
709 return 0;
710}
711
712static int tz1090_pdc_pinconf_set(struct pinctrl_dev *pctldev,
Sherman Yin03b054e2013-08-27 11:32:12 -0700713 unsigned int pin, unsigned long *configs,
714 unsigned num_configs)
James Hoganb58f0272013-06-20 10:26:29 +0100715{
716 struct tz1090_pdc_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
Sherman Yin03b054e2013-08-27 11:32:12 -0700717 enum pin_config_param param;
718 unsigned int arg;
James Hoganb58f0272013-06-20 10:26:29 +0100719 int ret;
720 u32 reg, width, mask, shift, val, tmp;
721 unsigned long flags;
Sherman Yin03b054e2013-08-27 11:32:12 -0700722 int i;
James Hoganb58f0272013-06-20 10:26:29 +0100723
Sherman Yin03b054e2013-08-27 11:32:12 -0700724 for (i = 0; i < num_configs; i++) {
725 param = pinconf_to_config_param(configs[i]);
726 arg = pinconf_to_config_argument(configs[i]);
James Hoganb58f0272013-06-20 10:26:29 +0100727
Sherman Yin03b054e2013-08-27 11:32:12 -0700728 dev_dbg(pctldev->dev, "%s(pin=%s, config=%#lx)\n",
729 __func__, tz1090_pdc_pins[pin].name, configs[i]);
James Hoganb58f0272013-06-20 10:26:29 +0100730
Sherman Yin03b054e2013-08-27 11:32:12 -0700731 /* Get register information */
732 ret = tz1090_pdc_pinconf_reg(pctldev, pin, param, true,
733 &reg, &width, &mask, &shift, &val);
734 if (ret < 0)
735 return ret;
James Hoganb58f0272013-06-20 10:26:29 +0100736
Sherman Yin03b054e2013-08-27 11:32:12 -0700737 /* Unpack argument and range check it */
738 if (arg > 1) {
739 dev_dbg(pctldev->dev, "%s: arg %u out of range\n",
740 __func__, arg);
741 return -EINVAL;
742 }
743
744 /* Write register field */
745 __global_lock2(flags);
746 tmp = pmx_read(pmx, reg);
747 tmp &= ~mask;
748 if (arg)
749 tmp |= val << shift;
750 pmx_write(pmx, tmp, reg);
751 __global_unlock2(flags);
752 } /* for each config */
James Hoganb58f0272013-06-20 10:26:29 +0100753
754 return 0;
755}
756
757static const int tz1090_pdc_boolean_map[] = {
758 [0] = -EINVAL,
759 [1] = 1,
760};
761
762static const int tz1090_pdc_dr_map[] = {
763 [REG_DR_2mA] = 2,
764 [REG_DR_4mA] = 4,
765 [REG_DR_8mA] = 8,
766 [REG_DR_12mA] = 12,
767};
768
769static int tz1090_pdc_pinconf_group_reg(struct pinctrl_dev *pctldev,
770 const struct tz1090_pdc_pingroup *g,
771 enum pin_config_param param,
772 bool report_err, u32 *reg, u32 *width,
773 u32 *mask, u32 *shift, const int **map)
774{
775 /* Drive configuration applies in groups, but not to all groups. */
776 if (!g->drv) {
777 if (report_err)
778 dev_dbg(pctldev->dev,
779 "%s: group %s has no drive control\n",
780 __func__, g->name);
781 return -ENOTSUPP;
782 }
783
784 /* Find information about drive parameter's register */
785 *reg = REG_GPIO_CONTROL2;
786 switch (param) {
787 case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
788 *shift = REG_GPIO_CONTROL2_PDC_SCHMITT_S;
789 *width = 1;
790 *map = tz1090_pdc_boolean_map;
791 break;
James Hoganb58f0272013-06-20 10:26:29 +0100792 case PIN_CONFIG_DRIVE_STRENGTH:
793 *shift = REG_GPIO_CONTROL2_PDC_DR_S;
794 *width = 2;
795 *map = tz1090_pdc_dr_map;
796 break;
797 case PIN_CONFIG_LOW_POWER_MODE:
798 *shift = REG_GPIO_CONTROL2_PDC_POS_S;
799 *width = 1;
800 *map = tz1090_pdc_boolean_map;
801 break;
802 default:
803 return -ENOTSUPP;
804 };
805
806 /* Calculate field information */
807 *mask = (BIT(*width) - 1) << *shift;
808
809 return 0;
810}
811
812static int tz1090_pdc_pinconf_group_get(struct pinctrl_dev *pctldev,
813 unsigned int group,
814 unsigned long *config)
815{
816 struct tz1090_pdc_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
817 const struct tz1090_pdc_pingroup *g = &tz1090_pdc_groups[group];
818 enum pin_config_param param = pinconf_to_config_param(*config);
819 int ret, arg;
820 u32 reg, width, mask, shift, val;
821 const int *map;
822
823 /* Get register information */
824 ret = tz1090_pdc_pinconf_group_reg(pctldev, g, param, true,
825 &reg, &width, &mask, &shift, &map);
826 if (ret < 0)
827 return ret;
828
829 /* Extract field from register */
830 val = pmx_read(pmx, reg);
831 arg = map[(val & mask) >> shift];
832 if (arg < 0)
833 return arg;
834
835 /* And pack config */
836 *config = pinconf_to_config_packed(param, arg);
837
838 return 0;
839}
840
841static int tz1090_pdc_pinconf_group_set(struct pinctrl_dev *pctldev,
842 unsigned int group,
Sherman Yin03b054e2013-08-27 11:32:12 -0700843 unsigned long *configs,
844 unsigned num_configs)
James Hoganb58f0272013-06-20 10:26:29 +0100845{
846 struct tz1090_pdc_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
847 const struct tz1090_pdc_pingroup *g = &tz1090_pdc_groups[group];
Sherman Yin03b054e2013-08-27 11:32:12 -0700848 enum pin_config_param param;
James Hoganb58f0272013-06-20 10:26:29 +0100849 const unsigned int *pit;
850 unsigned int i;
851 int ret, arg;
852 u32 reg, width, mask, shift, val;
853 unsigned long flags;
854 const int *map;
Sherman Yin03b054e2013-08-27 11:32:12 -0700855 int j;
James Hoganb58f0272013-06-20 10:26:29 +0100856
Sherman Yin03b054e2013-08-27 11:32:12 -0700857 for (j = 0; j < num_configs; j++) {
858 param = pinconf_to_config_param(configs[j]);
James Hoganb58f0272013-06-20 10:26:29 +0100859
Sherman Yin03b054e2013-08-27 11:32:12 -0700860 dev_dbg(pctldev->dev, "%s(group=%s, config=%#lx)\n",
861 __func__, g->name, configs[j]);
James Hoganb58f0272013-06-20 10:26:29 +0100862
Sherman Yin03b054e2013-08-27 11:32:12 -0700863 /* Get register information */
864 ret = tz1090_pdc_pinconf_group_reg(pctldev, g, param, true,
865 &reg, &width, &mask, &shift,
866 &map);
867 if (ret < 0) {
868 /*
869 * Maybe we're trying to set a per-pin configuration
870 * of a group, so do the pins one by one. This is
871 * mainly as a convenience.
872 */
873 for (i = 0, pit = g->pins; i < g->npins; ++i, ++pit) {
874 ret = tz1090_pdc_pinconf_set(pctldev, *pit,
875 configs, num_configs);
876 if (ret)
877 return ret;
878 }
James Hoganb58f0272013-06-20 10:26:29 +0100879 return 0;
880 }
James Hoganb58f0272013-06-20 10:26:29 +0100881
Sherman Yin03b054e2013-08-27 11:32:12 -0700882 /* Unpack argument and map it to register value */
883 arg = pinconf_to_config_argument(configs[j]);
884 for (i = 0; i < BIT(width); ++i) {
885 if (map[i] == arg || (map[i] == -EINVAL && !arg)) {
886 /* Write register field */
887 __global_lock2(flags);
888 val = pmx_read(pmx, reg);
889 val &= ~mask;
890 val |= i << shift;
891 pmx_write(pmx, val, reg);
892 __global_unlock2(flags);
893 goto next_config;
894 }
895 }
896
897 dev_dbg(pctldev->dev, "%s: arg %u not supported\n",
898 __func__, arg);
899 return 0;
900
901next_config:
902 ;
903 } /* for each config */
904
James Hoganb58f0272013-06-20 10:26:29 +0100905 return 0;
906}
907
908static struct pinconf_ops tz1090_pdc_pinconf_ops = {
909 .is_generic = true,
910 .pin_config_get = tz1090_pdc_pinconf_get,
911 .pin_config_set = tz1090_pdc_pinconf_set,
912 .pin_config_group_get = tz1090_pdc_pinconf_group_get,
913 .pin_config_group_set = tz1090_pdc_pinconf_group_set,
914 .pin_config_config_dbg_show = pinconf_generic_dump_config,
915};
916
917/*
918 * Pin control driver setup
919 */
920
921static struct pinctrl_desc tz1090_pdc_pinctrl_desc = {
922 .pctlops = &tz1090_pdc_pinctrl_ops,
923 .pmxops = &tz1090_pdc_pinmux_ops,
924 .confops = &tz1090_pdc_pinconf_ops,
925 .owner = THIS_MODULE,
926};
927
928static int tz1090_pdc_pinctrl_probe(struct platform_device *pdev)
929{
930 struct tz1090_pdc_pmx *pmx;
931 struct resource *res;
932
933 pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);
934 if (!pmx) {
935 dev_err(&pdev->dev, "Can't alloc tz1090_pdc_pmx\n");
936 return -ENOMEM;
937 }
938 pmx->dev = &pdev->dev;
939 spin_lock_init(&pmx->lock);
940
941 tz1090_pdc_pinctrl_desc.name = dev_name(&pdev->dev);
942 tz1090_pdc_pinctrl_desc.pins = tz1090_pdc_pins;
943 tz1090_pdc_pinctrl_desc.npins = ARRAY_SIZE(tz1090_pdc_pins);
944
945 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
Axel Linf5ba9c52013-08-26 10:22:31 +0800946 pmx->regs = devm_ioremap_resource(&pdev->dev, res);
947 if (IS_ERR(pmx->regs))
948 return PTR_ERR(pmx->regs);
James Hoganb58f0272013-06-20 10:26:29 +0100949
950 pmx->pctl = pinctrl_register(&tz1090_pdc_pinctrl_desc, &pdev->dev, pmx);
Masahiro Yamada323de9e2015-06-09 13:01:16 +0900951 if (IS_ERR(pmx->pctl)) {
James Hoganb58f0272013-06-20 10:26:29 +0100952 dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");
Masahiro Yamada323de9e2015-06-09 13:01:16 +0900953 return PTR_ERR(pmx->pctl);
James Hoganb58f0272013-06-20 10:26:29 +0100954 }
955
956 platform_set_drvdata(pdev, pmx);
957
958 dev_info(&pdev->dev, "TZ1090 PDC pinctrl driver initialised\n");
959
960 return 0;
961}
962
963static int tz1090_pdc_pinctrl_remove(struct platform_device *pdev)
964{
965 struct tz1090_pdc_pmx *pmx = platform_get_drvdata(pdev);
966
967 pinctrl_unregister(pmx->pctl);
968
969 return 0;
970}
971
Fabian Frederickbaa9946e2015-03-16 20:59:09 +0100972static const struct of_device_id tz1090_pdc_pinctrl_of_match[] = {
James Hoganb58f0272013-06-20 10:26:29 +0100973 { .compatible = "img,tz1090-pdc-pinctrl", },
974 { },
975};
976
977static struct platform_driver tz1090_pdc_pinctrl_driver = {
978 .driver = {
979 .name = "tz1090-pdc-pinctrl",
James Hoganb58f0272013-06-20 10:26:29 +0100980 .of_match_table = tz1090_pdc_pinctrl_of_match,
981 },
982 .probe = tz1090_pdc_pinctrl_probe,
983 .remove = tz1090_pdc_pinctrl_remove,
984};
985
986static int __init tz1090_pdc_pinctrl_init(void)
987{
988 return platform_driver_register(&tz1090_pdc_pinctrl_driver);
989}
990arch_initcall(tz1090_pdc_pinctrl_init);
991
992static void __exit tz1090_pdc_pinctrl_exit(void)
993{
994 platform_driver_unregister(&tz1090_pdc_pinctrl_driver);
995}
996module_exit(tz1090_pdc_pinctrl_exit);
997
998MODULE_AUTHOR("Imagination Technologies Ltd.");
999MODULE_DESCRIPTION("Toumaz Xenif TZ1090 PDC pinctrl driver");
1000MODULE_LICENSE("GPL v2");
1001MODULE_DEVICE_TABLE(of, tz1090_pdc_pinctrl_of_match);