Merge tag 'locking-urgent-2020-12-27' of git://git.kernel.org/pub/scm/linux/kernel...
[linux/fpc-iii.git] / arch / arm / mach-mmp / devices.c
blob18bee66a671ffd99265f89fce84e284ce8648817
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * linux/arch/arm/mach-mmp/devices.c
4 */
6 #include <linux/init.h>
7 #include <linux/platform_device.h>
8 #include <linux/dma-mapping.h>
9 #include <linux/delay.h>
11 #include <asm/irq.h>
12 #include "irqs.h"
13 #include "devices.h"
14 #include <linux/soc/mmp/cputype.h>
15 #include "regs-usb.h"
17 int __init pxa_register_device(struct pxa_device_desc *desc,
18 void *data, size_t size)
20 struct platform_device *pdev;
21 struct resource res[2 + MAX_RESOURCE_DMA];
22 int i, ret = 0, nres = 0;
24 pdev = platform_device_alloc(desc->drv_name, desc->id);
25 if (pdev == NULL)
26 return -ENOMEM;
28 pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
30 memset(res, 0, sizeof(res));
32 if (desc->start != -1ul && desc->size > 0) {
33 res[nres].start = desc->start;
34 res[nres].end = desc->start + desc->size - 1;
35 res[nres].flags = IORESOURCE_MEM;
36 nres++;
39 if (desc->irq != NO_IRQ) {
40 res[nres].start = desc->irq;
41 res[nres].end = desc->irq;
42 res[nres].flags = IORESOURCE_IRQ;
43 nres++;
46 for (i = 0; i < MAX_RESOURCE_DMA; i++, nres++) {
47 if (desc->dma[i] == 0)
48 break;
50 res[nres].start = desc->dma[i];
51 res[nres].end = desc->dma[i];
52 res[nres].flags = IORESOURCE_DMA;
55 ret = platform_device_add_resources(pdev, res, nres);
56 if (ret) {
57 platform_device_put(pdev);
58 return ret;
61 if (data && size) {
62 ret = platform_device_add_data(pdev, data, size);
63 if (ret) {
64 platform_device_put(pdev);
65 return ret;
69 return platform_device_add(pdev);
72 #if IS_ENABLED(CONFIG_USB) || IS_ENABLED(CONFIG_USB_GADGET)
73 #if IS_ENABLED(CONFIG_USB_MV_UDC) || IS_ENABLED(CONFIG_USB_EHCI_MV)
74 #if IS_ENABLED(CONFIG_CPU_PXA910) || IS_ENABLED(CONFIG_CPU_PXA168)
76 /*****************************************************************************
77 * The registers read/write routines
78 *****************************************************************************/
80 static unsigned int u2o_get(void __iomem *base, unsigned int offset)
82 return readl_relaxed(base + offset);
85 static void u2o_set(void __iomem *base, unsigned int offset,
86 unsigned int value)
88 u32 reg;
90 reg = readl_relaxed(base + offset);
91 reg |= value;
92 writel_relaxed(reg, base + offset);
93 readl_relaxed(base + offset);
96 static void u2o_clear(void __iomem *base, unsigned int offset,
97 unsigned int value)
99 u32 reg;
101 reg = readl_relaxed(base + offset);
102 reg &= ~value;
103 writel_relaxed(reg, base + offset);
104 readl_relaxed(base + offset);
107 static void u2o_write(void __iomem *base, unsigned int offset,
108 unsigned int value)
110 writel_relaxed(value, base + offset);
111 readl_relaxed(base + offset);
115 static DEFINE_MUTEX(phy_lock);
116 static int phy_init_cnt;
118 static int usb_phy_init_internal(void __iomem *base)
120 int loops;
122 pr_info("Init usb phy!!!\n");
124 /* Initialize the USB PHY power */
125 if (cpu_is_pxa910()) {
126 u2o_set(base, UTMI_CTRL, (1<<UTMI_CTRL_INPKT_DELAY_SOF_SHIFT)
127 | (1<<UTMI_CTRL_PU_REF_SHIFT));
130 u2o_set(base, UTMI_CTRL, 1<<UTMI_CTRL_PLL_PWR_UP_SHIFT);
131 u2o_set(base, UTMI_CTRL, 1<<UTMI_CTRL_PWR_UP_SHIFT);
133 /* UTMI_PLL settings */
134 u2o_clear(base, UTMI_PLL, UTMI_PLL_PLLVDD18_MASK
135 | UTMI_PLL_PLLVDD12_MASK | UTMI_PLL_PLLCALI12_MASK
136 | UTMI_PLL_FBDIV_MASK | UTMI_PLL_REFDIV_MASK
137 | UTMI_PLL_ICP_MASK | UTMI_PLL_KVCO_MASK);
139 u2o_set(base, UTMI_PLL, 0xee<<UTMI_PLL_FBDIV_SHIFT
140 | 0xb<<UTMI_PLL_REFDIV_SHIFT | 3<<UTMI_PLL_PLLVDD18_SHIFT
141 | 3<<UTMI_PLL_PLLVDD12_SHIFT | 3<<UTMI_PLL_PLLCALI12_SHIFT
142 | 1<<UTMI_PLL_ICP_SHIFT | 3<<UTMI_PLL_KVCO_SHIFT);
144 /* UTMI_TX */
145 u2o_clear(base, UTMI_TX, UTMI_TX_REG_EXT_FS_RCAL_EN_MASK
146 | UTMI_TX_TXVDD12_MASK | UTMI_TX_CK60_PHSEL_MASK
147 | UTMI_TX_IMPCAL_VTH_MASK | UTMI_TX_REG_EXT_FS_RCAL_MASK
148 | UTMI_TX_AMP_MASK);
149 u2o_set(base, UTMI_TX, 3<<UTMI_TX_TXVDD12_SHIFT
150 | 4<<UTMI_TX_CK60_PHSEL_SHIFT | 4<<UTMI_TX_IMPCAL_VTH_SHIFT
151 | 8<<UTMI_TX_REG_EXT_FS_RCAL_SHIFT | 3<<UTMI_TX_AMP_SHIFT);
153 /* UTMI_RX */
154 u2o_clear(base, UTMI_RX, UTMI_RX_SQ_THRESH_MASK
155 | UTMI_REG_SQ_LENGTH_MASK);
156 u2o_set(base, UTMI_RX, 7<<UTMI_RX_SQ_THRESH_SHIFT
157 | 2<<UTMI_REG_SQ_LENGTH_SHIFT);
159 /* UTMI_IVREF */
160 if (cpu_is_pxa168())
161 /* fixing Microsoft Altair board interface with NEC hub issue -
162 * Set UTMI_IVREF from 0x4a3 to 0x4bf */
163 u2o_write(base, UTMI_IVREF, 0x4bf);
165 /* toggle VCOCAL_START bit of UTMI_PLL */
166 udelay(200);
167 u2o_set(base, UTMI_PLL, VCOCAL_START);
168 udelay(40);
169 u2o_clear(base, UTMI_PLL, VCOCAL_START);
171 /* toggle REG_RCAL_START bit of UTMI_TX */
172 udelay(400);
173 u2o_set(base, UTMI_TX, REG_RCAL_START);
174 udelay(40);
175 u2o_clear(base, UTMI_TX, REG_RCAL_START);
176 udelay(400);
178 /* Make sure PHY PLL is ready */
179 loops = 0;
180 while ((u2o_get(base, UTMI_PLL) & PLL_READY) == 0) {
181 mdelay(1);
182 loops++;
183 if (loops > 100) {
184 printk(KERN_WARNING "calibrate timeout, UTMI_PLL %x\n",
185 u2o_get(base, UTMI_PLL));
186 break;
190 if (cpu_is_pxa168()) {
191 u2o_set(base, UTMI_RESERVE, 1 << 5);
192 /* Turn on UTMI PHY OTG extension */
193 u2o_write(base, UTMI_OTG_ADDON, 1);
196 return 0;
199 static int usb_phy_deinit_internal(void __iomem *base)
201 pr_info("Deinit usb phy!!!\n");
203 if (cpu_is_pxa168())
204 u2o_clear(base, UTMI_OTG_ADDON, UTMI_OTG_ADDON_OTG_ON);
206 u2o_clear(base, UTMI_CTRL, UTMI_CTRL_RXBUF_PDWN);
207 u2o_clear(base, UTMI_CTRL, UTMI_CTRL_TXBUF_PDWN);
208 u2o_clear(base, UTMI_CTRL, UTMI_CTRL_USB_CLK_EN);
209 u2o_clear(base, UTMI_CTRL, 1<<UTMI_CTRL_PWR_UP_SHIFT);
210 u2o_clear(base, UTMI_CTRL, 1<<UTMI_CTRL_PLL_PWR_UP_SHIFT);
212 return 0;
215 int pxa_usb_phy_init(void __iomem *phy_reg)
217 mutex_lock(&phy_lock);
218 if (phy_init_cnt++ == 0)
219 usb_phy_init_internal(phy_reg);
220 mutex_unlock(&phy_lock);
221 return 0;
224 void pxa_usb_phy_deinit(void __iomem *phy_reg)
226 WARN_ON(phy_init_cnt == 0);
228 mutex_lock(&phy_lock);
229 if (--phy_init_cnt == 0)
230 usb_phy_deinit_internal(phy_reg);
231 mutex_unlock(&phy_lock);
233 #endif
234 #endif
235 #endif
237 #if IS_ENABLED(CONFIG_USB_SUPPORT)
238 static u64 __maybe_unused usb_dma_mask = ~(u32)0;
240 #if IS_ENABLED(CONFIG_PHY_PXA_USB)
241 struct resource pxa168_usb_phy_resources[] = {
242 [0] = {
243 .start = PXA168_U2O_PHYBASE,
244 .end = PXA168_U2O_PHYBASE + USB_PHY_RANGE,
245 .flags = IORESOURCE_MEM,
249 struct platform_device pxa168_device_usb_phy = {
250 .name = "pxa-usb-phy",
251 .id = -1,
252 .resource = pxa168_usb_phy_resources,
253 .num_resources = ARRAY_SIZE(pxa168_usb_phy_resources),
254 .dev = {
255 .dma_mask = &usb_dma_mask,
256 .coherent_dma_mask = 0xffffffff,
259 #endif /* CONFIG_PHY_PXA_USB */
261 #if IS_ENABLED(CONFIG_USB_MV_UDC)
262 struct resource pxa168_u2o_resources[] = {
263 /* regbase */
264 [0] = {
265 .start = PXA168_U2O_REGBASE + U2x_CAPREGS_OFFSET,
266 .end = PXA168_U2O_REGBASE + USB_REG_RANGE,
267 .flags = IORESOURCE_MEM,
268 .name = "capregs",
270 /* phybase */
271 [1] = {
272 .start = PXA168_U2O_PHYBASE,
273 .end = PXA168_U2O_PHYBASE + USB_PHY_RANGE,
274 .flags = IORESOURCE_MEM,
275 .name = "phyregs",
277 [2] = {
278 .start = IRQ_PXA168_USB1,
279 .end = IRQ_PXA168_USB1,
280 .flags = IORESOURCE_IRQ,
284 struct platform_device pxa168_device_u2o = {
285 .name = "mv-udc",
286 .id = -1,
287 .resource = pxa168_u2o_resources,
288 .num_resources = ARRAY_SIZE(pxa168_u2o_resources),
289 .dev = {
290 .dma_mask = &usb_dma_mask,
291 .coherent_dma_mask = 0xffffffff,
294 #endif /* CONFIG_USB_MV_UDC */
296 #if IS_ENABLED(CONFIG_USB_EHCI_MV_U2O)
297 struct resource pxa168_u2oehci_resources[] = {
298 [0] = {
299 .start = PXA168_U2O_REGBASE,
300 .end = PXA168_U2O_REGBASE + USB_REG_RANGE,
301 .flags = IORESOURCE_MEM,
303 [1] = {
304 .start = IRQ_PXA168_USB1,
305 .end = IRQ_PXA168_USB1,
306 .flags = IORESOURCE_IRQ,
310 struct platform_device pxa168_device_u2oehci = {
311 .name = "pxa-u2oehci",
312 .id = -1,
313 .dev = {
314 .dma_mask = &usb_dma_mask,
315 .coherent_dma_mask = 0xffffffff,
318 .num_resources = ARRAY_SIZE(pxa168_u2oehci_resources),
319 .resource = pxa168_u2oehci_resources,
321 #endif
323 #if IS_ENABLED(CONFIG_USB_MV_OTG)
324 struct resource pxa168_u2ootg_resources[] = {
325 /* regbase */
326 [0] = {
327 .start = PXA168_U2O_REGBASE + U2x_CAPREGS_OFFSET,
328 .end = PXA168_U2O_REGBASE + USB_REG_RANGE,
329 .flags = IORESOURCE_MEM,
330 .name = "capregs",
332 /* phybase */
333 [1] = {
334 .start = PXA168_U2O_PHYBASE,
335 .end = PXA168_U2O_PHYBASE + USB_PHY_RANGE,
336 .flags = IORESOURCE_MEM,
337 .name = "phyregs",
339 [2] = {
340 .start = IRQ_PXA168_USB1,
341 .end = IRQ_PXA168_USB1,
342 .flags = IORESOURCE_IRQ,
346 struct platform_device pxa168_device_u2ootg = {
347 .name = "mv-otg",
348 .id = -1,
349 .dev = {
350 .dma_mask = &usb_dma_mask,
351 .coherent_dma_mask = 0xffffffff,
354 .num_resources = ARRAY_SIZE(pxa168_u2ootg_resources),
355 .resource = pxa168_u2ootg_resources,
357 #endif /* CONFIG_USB_MV_OTG */
359 #endif