1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * arch/arm/mach-dove/mpp.c
4 *
5 * MPP functions for Marvell Dove SoCs
6 */
7
8 #include <linux/kernel.h>
9 #include <linux/gpio.h>
10 #include <linux/io.h>
11 #include <plat/mpp.h>
12 #include <plat/orion-gpio.h>
13 #include "dove.h"
14 #include "mpp.h"
15
16 struct dove_mpp_grp {
17 int start;
18 int end;
19 };
20
21 /* Map a group to a range of GPIO pins in that group */
22 static const struct dove_mpp_grp dove_mpp_grp[] = {
23 [MPP_24_39] = {
24 .start = 24,
25 .end = 39,
26 },
27 [MPP_40_45] = {
28 .start = 40,
29 .end = 45,
30 },
31 [MPP_46_51] = {
32 .start = 46,
33 .end = 51,
34 },
35 [MPP_58_61] = {
36 .start = 58,
37 .end = 61,
38 },
39 [MPP_62_63] = {
40 .start = 62,
41 .end = 63,
42 },
43 };
44
45 /* Enable gpio for a range of pins. mode should be a combination of
46 GPIO_OUTPUT_OK | GPIO_INPUT_OK */
dove_mpp_gpio_mode(int start,int end,int gpio_mode)47 static void __init dove_mpp_gpio_mode(int start, int end, int gpio_mode)
48 {
49 int i;
50
51 for (i = start; i <= end; i++)
52 orion_gpio_set_valid(i, gpio_mode);
53 }
54
55 /* Dump all the extra MPP registers. The platform code will dump the
56 registers for pins 0-23. */
dove_mpp_dump_regs(void)57 static void __init dove_mpp_dump_regs(void)
58 {
59 pr_debug("PMU_CTRL4_CTRL: %08x\n",
60 readl(DOVE_MPP_CTRL4_VIRT_BASE));
61
62 pr_debug("PMU_MPP_GENERAL_CTRL: %08x\n",
63 readl(DOVE_PMU_MPP_GENERAL_CTRL));
64
65 pr_debug("MPP_GENERAL: %08x\n", readl(DOVE_MPP_GENERAL_VIRT_BASE));
66 }
67
dove_mpp_cfg_nfc(int sel)68 static void __init dove_mpp_cfg_nfc(int sel)
69 {
70 u32 mpp_gen_cfg = readl(DOVE_MPP_GENERAL_VIRT_BASE);
71
72 mpp_gen_cfg &= ~0x1;
73 mpp_gen_cfg |= sel;
74 writel(mpp_gen_cfg, DOVE_MPP_GENERAL_VIRT_BASE);
75
76 dove_mpp_gpio_mode(64, 71, GPIO_OUTPUT_OK);
77 }
78
dove_mpp_cfg_au1(int sel)79 static void __init dove_mpp_cfg_au1(int sel)
80 {
81 u32 mpp_ctrl4 = readl(DOVE_MPP_CTRL4_VIRT_BASE);
82 u32 ssp_ctrl1 = readl(DOVE_SSP_CTRL_STATUS_1);
83 u32 mpp_gen_ctrl = readl(DOVE_MPP_GENERAL_VIRT_BASE);
84 u32 global_cfg_2 = readl(DOVE_GLOBAL_CONFIG_2);
85
86 mpp_ctrl4 &= ~(DOVE_AU1_GPIO_SEL);
87 ssp_ctrl1 &= ~(DOVE_SSP_ON_AU1);
88 mpp_gen_ctrl &= ~(DOVE_AU1_SPDIFO_GPIO_EN);
89 global_cfg_2 &= ~(DOVE_TWSI_OPTION3_GPIO);
90
91 if (!sel || sel == 0x2)
92 dove_mpp_gpio_mode(52, 57, 0);
93 else
94 dove_mpp_gpio_mode(52, 57, GPIO_OUTPUT_OK | GPIO_INPUT_OK);
95
96 if (sel & 0x1) {
97 global_cfg_2 |= DOVE_TWSI_OPTION3_GPIO;
98 dove_mpp_gpio_mode(56, 57, 0);
99 }
100 if (sel & 0x2) {
101 mpp_gen_ctrl |= DOVE_AU1_SPDIFO_GPIO_EN;
102 dove_mpp_gpio_mode(57, 57, GPIO_OUTPUT_OK | GPIO_INPUT_OK);
103 }
104 if (sel & 0x4) {
105 ssp_ctrl1 |= DOVE_SSP_ON_AU1;
106 dove_mpp_gpio_mode(52, 55, 0);
107 }
108 if (sel & 0x8)
109 mpp_ctrl4 |= DOVE_AU1_GPIO_SEL;
110
111 writel(mpp_ctrl4, DOVE_MPP_CTRL4_VIRT_BASE);
112 writel(ssp_ctrl1, DOVE_SSP_CTRL_STATUS_1);
113 writel(mpp_gen_ctrl, DOVE_MPP_GENERAL_VIRT_BASE);
114 writel(global_cfg_2, DOVE_GLOBAL_CONFIG_2);
115 }
116
117 /* Configure the group registers, enabling GPIO if sel indicates the
118 pin is to be used for GPIO */
dove_mpp_conf_grp(unsigned int * mpp_grp_list)119 static void __init dove_mpp_conf_grp(unsigned int *mpp_grp_list)
120 {
121 u32 mpp_ctrl4 = readl(DOVE_MPP_CTRL4_VIRT_BASE);
122 int gpio_mode;
123
124 for ( ; *mpp_grp_list; mpp_grp_list++) {
125 unsigned int num = MPP_NUM(*mpp_grp_list);
126 unsigned int sel = MPP_SEL(*mpp_grp_list);
127
128 if (num > MPP_GRP_MAX) {
129 pr_err("dove: invalid MPP GRP number (%u)\n", num);
130 continue;
131 }
132
133 mpp_ctrl4 &= ~(0x1 << num);
134 mpp_ctrl4 |= sel << num;
135
136 gpio_mode = sel ? GPIO_OUTPUT_OK | GPIO_INPUT_OK : 0;
137 dove_mpp_gpio_mode(dove_mpp_grp[num].start,
138 dove_mpp_grp[num].end, gpio_mode);
139 }
140 writel(mpp_ctrl4, DOVE_MPP_CTRL4_VIRT_BASE);
141 }
142
143 /* Configure the various MPP pins on Dove */
dove_mpp_conf(unsigned int * mpp_list,unsigned int * mpp_grp_list,unsigned int grp_au1_52_57,unsigned int grp_nfc_64_71)144 void __init dove_mpp_conf(unsigned int *mpp_list,
145 unsigned int *mpp_grp_list,
146 unsigned int grp_au1_52_57,
147 unsigned int grp_nfc_64_71)
148 {
149 dove_mpp_dump_regs();
150
151 /* Use platform code for pins 0-23 */
152 orion_mpp_conf(mpp_list, 0, MPP_MAX, DOVE_MPP_VIRT_BASE);
153
154 dove_mpp_conf_grp(mpp_grp_list);
155 dove_mpp_cfg_au1(grp_au1_52_57);
156 dove_mpp_cfg_nfc(grp_nfc_64_71);
157
158 dove_mpp_dump_regs();
159 }
160
