2 * Core driver for the imx pin controller in imx1/21/27
4 * Copyright (C) 2013 Pengutronix
5 * Author: Markus Pargmann <mpa@pengutronix.de>
7 * Based on pinctrl-imx.c:
8 * Author: Dong Aisheng <dong.aisheng@linaro.org>
9 * Copyright (C) 2012 Freescale Semiconductor, Inc.
10 * Copyright (C) 2012 Linaro Ltd.
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or
15 * (at your option) any later version.
18 #include <linux/bitops.h>
19 #include <linux/err.h>
20 #include <linux/init.h>
22 #include <linux/module.h>
24 #include <linux/of_device.h>
25 #include <linux/pinctrl/machine.h>
26 #include <linux/pinctrl/pinconf.h>
27 #include <linux/pinctrl/pinctrl.h>
28 #include <linux/pinctrl/pinmux.h>
29 #include <linux/slab.h>
32 #include "pinctrl-imx1.h"
36 struct pinctrl_dev
*pctl
;
38 const struct imx1_pinctrl_soc_info
*info
;
42 * MX1 register offsets
47 #define MX1_ICONFA 0x0c
48 #define MX1_ICONFB 0x14
53 #define MX1_PORT_STRIDE 0x100
57 * MUX_ID format defines
59 #define MX1_MUX_FUNCTION(val) (BIT(0) & val)
60 #define MX1_MUX_GPIO(val) ((BIT(1) & val) >> 1)
61 #define MX1_MUX_DIR(val) ((BIT(2) & val) >> 2)
62 #define MX1_MUX_OCONF(val) (((BIT(4) | BIT(5)) & val) >> 4)
63 #define MX1_MUX_ICONFA(val) (((BIT(8) | BIT(9)) & val) >> 8)
64 #define MX1_MUX_ICONFB(val) (((BIT(10) | BIT(11)) & val) >> 10)
68 * IMX1 IOMUXC manages the pins based on ports. Each port has 32 pins. IOMUX
69 * control register are seperated into function, output configuration, input
70 * configuration A, input configuration B, GPIO in use and data direction.
72 * Those controls that are represented by 1 bit have a direct mapping between
73 * bit position and pin id. If they are represented by 2 bit, the lower 16 pins
74 * are in the first register and the upper 16 pins in the second (next)
75 * register. pin_id is stored in bit (pin_id%16)*2 and the bit above.
79 * Calculates the register offset from a pin_id
81 static void __iomem
*imx1_mem(struct imx1_pinctrl
*ipctl
, unsigned int pin_id
)
83 unsigned int port
= pin_id
/ 32;
84 return ipctl
->base
+ port
* MX1_PORT_STRIDE
;
88 * Write to a register with 2 bits per pin. The function will automatically
89 * use the next register if the pin is managed in the second register.
91 static void imx1_write_2bit(struct imx1_pinctrl
*ipctl
, unsigned int pin_id
,
92 u32 value
, u32 reg_offset
)
94 void __iomem
*reg
= imx1_mem(ipctl
, pin_id
) + reg_offset
;
95 int offset
= (pin_id
% 16) * 2; /* offset, regardless of register used */
96 int mask
= ~(0x3 << offset
); /* Mask for 2 bits at offset */
100 /* Use the next register if the pin's port pin number is >=16 */
101 if (pin_id
% 32 >= 16)
104 dev_dbg(ipctl
->dev
, "write: register 0x%p offset %d value 0x%x\n",
107 /* Get current state of pins */
108 old_val
= readl(reg
);
111 new_val
= value
& 0x3; /* Make sure value is really 2 bit */
113 new_val
|= old_val
;/* Set new state for pin_id */
115 writel(new_val
, reg
);
118 static void imx1_write_bit(struct imx1_pinctrl
*ipctl
, unsigned int pin_id
,
119 u32 value
, u32 reg_offset
)
121 void __iomem
*reg
= imx1_mem(ipctl
, pin_id
) + reg_offset
;
122 int offset
= pin_id
% 32;
123 int mask
= ~BIT_MASK(offset
);
127 /* Get current state of pins */
128 old_val
= readl(reg
);
131 new_val
= value
& 0x1; /* Make sure value is really 1 bit */
133 new_val
|= old_val
;/* Set new state for pin_id */
135 writel(new_val
, reg
);
138 static int imx1_read_2bit(struct imx1_pinctrl
*ipctl
, unsigned int pin_id
,
141 void __iomem
*reg
= imx1_mem(ipctl
, pin_id
) + reg_offset
;
142 int offset
= (pin_id
% 16) * 2;
144 /* Use the next register if the pin's port pin number is >=16 */
145 if (pin_id
% 32 >= 16)
148 return (readl(reg
) & (BIT(offset
) | BIT(offset
+1))) >> offset
;
151 static int imx1_read_bit(struct imx1_pinctrl
*ipctl
, unsigned int pin_id
,
154 void __iomem
*reg
= imx1_mem(ipctl
, pin_id
) + reg_offset
;
155 int offset
= pin_id
% 32;
157 return !!(readl(reg
) & BIT(offset
));
160 static const inline struct imx1_pin_group
*imx1_pinctrl_find_group_by_name(
161 const struct imx1_pinctrl_soc_info
*info
,
164 const struct imx1_pin_group
*grp
= NULL
;
167 for (i
= 0; i
< info
->ngroups
; i
++) {
168 if (!strcmp(info
->groups
[i
].name
, name
)) {
169 grp
= &info
->groups
[i
];
177 static int imx1_get_groups_count(struct pinctrl_dev
*pctldev
)
179 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
180 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
182 return info
->ngroups
;
185 static const char *imx1_get_group_name(struct pinctrl_dev
*pctldev
,
188 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
189 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
191 return info
->groups
[selector
].name
;
194 static int imx1_get_group_pins(struct pinctrl_dev
*pctldev
, unsigned selector
,
195 const unsigned int **pins
,
198 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
199 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
201 if (selector
>= info
->ngroups
)
204 *pins
= info
->groups
[selector
].pin_ids
;
205 *npins
= info
->groups
[selector
].npins
;
210 static void imx1_pin_dbg_show(struct pinctrl_dev
*pctldev
, struct seq_file
*s
,
213 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
215 seq_printf(s
, "GPIO %d, function %d, direction %d, oconf %d, iconfa %d, iconfb %d",
216 imx1_read_bit(ipctl
, offset
, MX1_GIUS
),
217 imx1_read_bit(ipctl
, offset
, MX1_GPR
),
218 imx1_read_bit(ipctl
, offset
, MX1_DDIR
),
219 imx1_read_2bit(ipctl
, offset
, MX1_OCR
),
220 imx1_read_2bit(ipctl
, offset
, MX1_ICONFA
),
221 imx1_read_2bit(ipctl
, offset
, MX1_ICONFB
));
224 static int imx1_dt_node_to_map(struct pinctrl_dev
*pctldev
,
225 struct device_node
*np
,
226 struct pinctrl_map
**map
, unsigned *num_maps
)
228 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
229 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
230 const struct imx1_pin_group
*grp
;
231 struct pinctrl_map
*new_map
;
232 struct device_node
*parent
;
237 * first find the group of this node and check if we need create
238 * config maps for pins
240 grp
= imx1_pinctrl_find_group_by_name(info
, np
->name
);
242 dev_err(info
->dev
, "unable to find group for node %s\n",
247 for (i
= 0; i
< grp
->npins
; i
++)
250 new_map
= kmalloc(sizeof(struct pinctrl_map
) * map_num
, GFP_KERNEL
);
258 parent
= of_get_parent(np
);
263 new_map
[0].type
= PIN_MAP_TYPE_MUX_GROUP
;
264 new_map
[0].data
.mux
.function
= parent
->name
;
265 new_map
[0].data
.mux
.group
= np
->name
;
268 /* create config map */
270 for (i
= j
= 0; i
< grp
->npins
; i
++) {
271 new_map
[j
].type
= PIN_MAP_TYPE_CONFIGS_PIN
;
272 new_map
[j
].data
.configs
.group_or_pin
=
273 pin_get_name(pctldev
, grp
->pins
[i
].pin_id
);
274 new_map
[j
].data
.configs
.configs
= &grp
->pins
[i
].config
;
275 new_map
[j
].data
.configs
.num_configs
= 1;
279 dev_dbg(pctldev
->dev
, "maps: function %s group %s num %d\n",
280 (*map
)->data
.mux
.function
, (*map
)->data
.mux
.group
, map_num
);
285 static void imx1_dt_free_map(struct pinctrl_dev
*pctldev
,
286 struct pinctrl_map
*map
, unsigned num_maps
)
291 static const struct pinctrl_ops imx1_pctrl_ops
= {
292 .get_groups_count
= imx1_get_groups_count
,
293 .get_group_name
= imx1_get_group_name
,
294 .get_group_pins
= imx1_get_group_pins
,
295 .pin_dbg_show
= imx1_pin_dbg_show
,
296 .dt_node_to_map
= imx1_dt_node_to_map
,
297 .dt_free_map
= imx1_dt_free_map
,
301 static int imx1_pmx_set(struct pinctrl_dev
*pctldev
, unsigned selector
,
304 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
305 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
306 const struct imx1_pin
*pins
;
311 * Configure the mux mode for each pin in the group for a specific
314 pins
= info
->groups
[group
].pins
;
315 npins
= info
->groups
[group
].npins
;
317 WARN_ON(!pins
|| !npins
);
319 dev_dbg(ipctl
->dev
, "enable function %s group %s\n",
320 info
->functions
[selector
].name
, info
->groups
[group
].name
);
322 for (i
= 0; i
< npins
; i
++) {
323 unsigned int mux
= pins
[i
].mux_id
;
324 unsigned int pin_id
= pins
[i
].pin_id
;
325 unsigned int afunction
= MX1_MUX_FUNCTION(mux
);
326 unsigned int gpio_in_use
= MX1_MUX_GPIO(mux
);
327 unsigned int direction
= MX1_MUX_DIR(mux
);
328 unsigned int gpio_oconf
= MX1_MUX_OCONF(mux
);
329 unsigned int gpio_iconfa
= MX1_MUX_ICONFA(mux
);
330 unsigned int gpio_iconfb
= MX1_MUX_ICONFB(mux
);
332 dev_dbg(pctldev
->dev
, "%s, pin 0x%x, function %d, gpio %d, direction %d, oconf %d, iconfa %d, iconfb %d\n",
333 __func__
, pin_id
, afunction
, gpio_in_use
,
334 direction
, gpio_oconf
, gpio_iconfa
,
337 imx1_write_bit(ipctl
, pin_id
, gpio_in_use
, MX1_GIUS
);
338 imx1_write_bit(ipctl
, pin_id
, direction
, MX1_DDIR
);
341 imx1_write_2bit(ipctl
, pin_id
, gpio_oconf
, MX1_OCR
);
342 imx1_write_2bit(ipctl
, pin_id
, gpio_iconfa
,
344 imx1_write_2bit(ipctl
, pin_id
, gpio_iconfb
,
347 imx1_write_bit(ipctl
, pin_id
, afunction
, MX1_GPR
);
354 static int imx1_pmx_get_funcs_count(struct pinctrl_dev
*pctldev
)
356 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
357 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
359 return info
->nfunctions
;
362 static const char *imx1_pmx_get_func_name(struct pinctrl_dev
*pctldev
,
365 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
366 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
368 return info
->functions
[selector
].name
;
371 static int imx1_pmx_get_groups(struct pinctrl_dev
*pctldev
, unsigned selector
,
372 const char * const **groups
,
373 unsigned * const num_groups
)
375 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
376 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
378 *groups
= info
->functions
[selector
].groups
;
379 *num_groups
= info
->functions
[selector
].num_groups
;
384 static const struct pinmux_ops imx1_pmx_ops
= {
385 .get_functions_count
= imx1_pmx_get_funcs_count
,
386 .get_function_name
= imx1_pmx_get_func_name
,
387 .get_function_groups
= imx1_pmx_get_groups
,
388 .set_mux
= imx1_pmx_set
,
391 static int imx1_pinconf_get(struct pinctrl_dev
*pctldev
,
392 unsigned pin_id
, unsigned long *config
)
394 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
396 *config
= imx1_read_bit(ipctl
, pin_id
, MX1_PUEN
);
401 static int imx1_pinconf_set(struct pinctrl_dev
*pctldev
,
402 unsigned pin_id
, unsigned long *configs
,
403 unsigned num_configs
)
405 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
408 for (i
= 0; i
!= num_configs
; ++i
) {
409 imx1_write_bit(ipctl
, pin_id
, configs
[i
] & 0x01, MX1_PUEN
);
411 dev_dbg(ipctl
->dev
, "pinconf set pullup pin %s\n",
412 pin_desc_get(pctldev
, pin_id
)->name
);
418 static void imx1_pinconf_dbg_show(struct pinctrl_dev
*pctldev
,
419 struct seq_file
*s
, unsigned pin_id
)
421 unsigned long config
;
423 imx1_pinconf_get(pctldev
, pin_id
, &config
);
424 seq_printf(s
, "0x%lx", config
);
427 static void imx1_pinconf_group_dbg_show(struct pinctrl_dev
*pctldev
,
428 struct seq_file
*s
, unsigned group
)
430 struct imx1_pinctrl
*ipctl
= pinctrl_dev_get_drvdata(pctldev
);
431 const struct imx1_pinctrl_soc_info
*info
= ipctl
->info
;
432 struct imx1_pin_group
*grp
;
433 unsigned long config
;
437 if (group
> info
->ngroups
)
441 grp
= &info
->groups
[group
];
442 for (i
= 0; i
< grp
->npins
; i
++) {
443 name
= pin_get_name(pctldev
, grp
->pins
[i
].pin_id
);
444 ret
= imx1_pinconf_get(pctldev
, grp
->pins
[i
].pin_id
, &config
);
447 seq_printf(s
, "%s: 0x%lx", name
, config
);
451 static const struct pinconf_ops imx1_pinconf_ops
= {
452 .pin_config_get
= imx1_pinconf_get
,
453 .pin_config_set
= imx1_pinconf_set
,
454 .pin_config_dbg_show
= imx1_pinconf_dbg_show
,
455 .pin_config_group_dbg_show
= imx1_pinconf_group_dbg_show
,
458 static struct pinctrl_desc imx1_pinctrl_desc
= {
459 .pctlops
= &imx1_pctrl_ops
,
460 .pmxops
= &imx1_pmx_ops
,
461 .confops
= &imx1_pinconf_ops
,
462 .owner
= THIS_MODULE
,
465 static int imx1_pinctrl_parse_groups(struct device_node
*np
,
466 struct imx1_pin_group
*grp
,
467 struct imx1_pinctrl_soc_info
*info
,
474 dev_dbg(info
->dev
, "group(%d): %s\n", index
, np
->name
);
476 /* Initialise group */
477 grp
->name
= np
->name
;
480 * the binding format is fsl,pins = <PIN MUX_ID CONFIG>
482 list
= of_get_property(np
, "fsl,pins", &size
);
483 /* we do not check return since it's safe node passed down */
484 if (!size
|| size
% 12) {
485 dev_notice(info
->dev
, "Not a valid fsl,pins property (%s)\n",
490 grp
->npins
= size
/ 12;
491 grp
->pins
= devm_kzalloc(info
->dev
,
492 grp
->npins
* sizeof(struct imx1_pin
), GFP_KERNEL
);
493 grp
->pin_ids
= devm_kzalloc(info
->dev
,
494 grp
->npins
* sizeof(unsigned int), GFP_KERNEL
);
496 if (!grp
->pins
|| !grp
->pin_ids
)
499 for (i
= 0; i
< grp
->npins
; i
++) {
500 grp
->pins
[i
].pin_id
= be32_to_cpu(*list
++);
501 grp
->pins
[i
].mux_id
= be32_to_cpu(*list
++);
502 grp
->pins
[i
].config
= be32_to_cpu(*list
++);
504 grp
->pin_ids
[i
] = grp
->pins
[i
].pin_id
;
510 static int imx1_pinctrl_parse_functions(struct device_node
*np
,
511 struct imx1_pinctrl_soc_info
*info
,
514 struct device_node
*child
;
515 struct imx1_pmx_func
*func
;
516 struct imx1_pin_group
*grp
;
518 static u32 grp_index
;
521 dev_dbg(info
->dev
, "parse function(%d): %s\n", index
, np
->name
);
523 func
= &info
->functions
[index
];
525 /* Initialise function */
526 func
->name
= np
->name
;
527 func
->num_groups
= of_get_child_count(np
);
528 if (func
->num_groups
== 0)
531 func
->groups
= devm_kzalloc(info
->dev
,
532 func
->num_groups
* sizeof(char *), GFP_KERNEL
);
537 for_each_child_of_node(np
, child
) {
538 func
->groups
[i
] = child
->name
;
539 grp
= &info
->groups
[grp_index
++];
540 ret
= imx1_pinctrl_parse_groups(child
, grp
, info
, i
++);
541 if (ret
== -ENOMEM
) {
550 static int imx1_pinctrl_parse_dt(struct platform_device
*pdev
,
551 struct imx1_pinctrl
*pctl
, struct imx1_pinctrl_soc_info
*info
)
553 struct device_node
*np
= pdev
->dev
.of_node
;
554 struct device_node
*child
;
563 for_each_child_of_node(np
, child
) {
565 ngroups
+= of_get_child_count(child
);
569 dev_err(&pdev
->dev
, "No pin functions defined\n");
573 info
->nfunctions
= nfuncs
;
574 info
->functions
= devm_kzalloc(&pdev
->dev
,
575 nfuncs
* sizeof(struct imx1_pmx_func
), GFP_KERNEL
);
577 info
->ngroups
= ngroups
;
578 info
->groups
= devm_kzalloc(&pdev
->dev
,
579 ngroups
* sizeof(struct imx1_pin_group
), GFP_KERNEL
);
582 if (!info
->functions
|| !info
->groups
)
585 for_each_child_of_node(np
, child
) {
586 ret
= imx1_pinctrl_parse_functions(child
, info
, ifunc
++);
587 if (ret
== -ENOMEM
) {
596 int imx1_pinctrl_core_probe(struct platform_device
*pdev
,
597 struct imx1_pinctrl_soc_info
*info
)
599 struct imx1_pinctrl
*ipctl
;
600 struct resource
*res
;
601 struct pinctrl_desc
*pctl_desc
;
604 if (!info
|| !info
->pins
|| !info
->npins
) {
605 dev_err(&pdev
->dev
, "wrong pinctrl info\n");
608 info
->dev
= &pdev
->dev
;
610 /* Create state holders etc for this driver */
611 ipctl
= devm_kzalloc(&pdev
->dev
, sizeof(*ipctl
), GFP_KERNEL
);
615 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
619 ipctl
->base
= devm_ioremap_nocache(&pdev
->dev
, res
->start
,
624 pctl_desc
= &imx1_pinctrl_desc
;
625 pctl_desc
->name
= dev_name(&pdev
->dev
);
626 pctl_desc
->pins
= info
->pins
;
627 pctl_desc
->npins
= info
->npins
;
629 ret
= imx1_pinctrl_parse_dt(pdev
, ipctl
, info
);
631 dev_err(&pdev
->dev
, "fail to probe dt properties\n");
636 ipctl
->dev
= info
->dev
;
637 platform_set_drvdata(pdev
, ipctl
);
638 ipctl
->pctl
= devm_pinctrl_register(&pdev
->dev
, pctl_desc
, ipctl
);
639 if (IS_ERR(ipctl
->pctl
)) {
640 dev_err(&pdev
->dev
, "could not register IMX pinctrl driver\n");
641 return PTR_ERR(ipctl
->pctl
);
644 ret
= of_platform_populate(pdev
->dev
.of_node
, NULL
, NULL
, &pdev
->dev
);
646 pinctrl_unregister(ipctl
->pctl
);
647 dev_err(&pdev
->dev
, "Failed to populate subdevices\n");
651 dev_info(&pdev
->dev
, "initialized IMX pinctrl driver\n");