| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * linux/arch/arm/mach-mmp/devices.c |
| */ |
| |
| #include <linux/init.h> |
| #include <linux/platform_device.h> |
| #include <linux/dma-mapping.h> |
| #include <linux/delay.h> |
| |
| #include <asm/irq.h> |
| #include "irqs.h" |
| #include "devices.h" |
| #include <linux/soc/mmp/cputype.h> |
| #include "regs-usb.h" |
| |
| int __init mmp_register_device(struct mmp_device_desc *desc, |
| void *data, size_t size) |
| { |
| struct platform_device *pdev; |
| struct resource res[2 + MAX_RESOURCE_DMA]; |
| int i, ret = 0, nres = 0; |
| |
| pdev = platform_device_alloc(desc->drv_name, desc->id); |
| if (pdev == NULL) |
| return -ENOMEM; |
| |
| pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32); |
| |
| memset(res, 0, sizeof(res)); |
| |
| if (desc->start != -1ul && desc->size > 0) { |
| res[nres].start = desc->start; |
| res[nres].end = desc->start + desc->size - 1; |
| res[nres].flags = IORESOURCE_MEM; |
| nres++; |
| } |
| |
| if (desc->irq != NO_IRQ) { |
| res[nres].start = desc->irq; |
| res[nres].end = desc->irq; |
| res[nres].flags = IORESOURCE_IRQ; |
| nres++; |
| } |
| |
| for (i = 0; i < MAX_RESOURCE_DMA; i++, nres++) { |
| if (desc->dma[i] == 0) |
| break; |
| |
| res[nres].start = desc->dma[i]; |
| res[nres].end = desc->dma[i]; |
| res[nres].flags = IORESOURCE_DMA; |
| } |
| |
| ret = platform_device_add_resources(pdev, res, nres); |
| if (ret) { |
| platform_device_put(pdev); |
| return ret; |
| } |
| |
| if (data && size) { |
| ret = platform_device_add_data(pdev, data, size); |
| if (ret) { |
| platform_device_put(pdev); |
| return ret; |
| } |
| } |
| |
| return platform_device_add(pdev); |
| } |
| |
| #if IS_ENABLED(CONFIG_USB) || IS_ENABLED(CONFIG_USB_GADGET) |
| #if IS_ENABLED(CONFIG_USB_MV_UDC) || IS_ENABLED(CONFIG_USB_EHCI_MV) |
| #if IS_ENABLED(CONFIG_CPU_PXA910) || IS_ENABLED(CONFIG_CPU_PXA168) |
| |
| /***************************************************************************** |
| * The registers read/write routines |
| *****************************************************************************/ |
| |
| static unsigned int u2o_get(void __iomem *base, unsigned int offset) |
| { |
| return readl_relaxed(base + offset); |
| } |
| |
| static void u2o_set(void __iomem *base, unsigned int offset, |
| unsigned int value) |
| { |
| u32 reg; |
| |
| reg = readl_relaxed(base + offset); |
| reg |= value; |
| writel_relaxed(reg, base + offset); |
| readl_relaxed(base + offset); |
| } |
| |
| static void u2o_clear(void __iomem *base, unsigned int offset, |
| unsigned int value) |
| { |
| u32 reg; |
| |
| reg = readl_relaxed(base + offset); |
| reg &= ~value; |
| writel_relaxed(reg, base + offset); |
| readl_relaxed(base + offset); |
| } |
| |
| static void u2o_write(void __iomem *base, unsigned int offset, |
| unsigned int value) |
| { |
| writel_relaxed(value, base + offset); |
| readl_relaxed(base + offset); |
| } |
| |
| |
| static DEFINE_MUTEX(phy_lock); |
| static int phy_init_cnt; |
| |
| static int usb_phy_init_internal(void __iomem *base) |
| { |
| int loops; |
| |
| pr_info("Init usb phy!!!\n"); |
| |
| /* Initialize the USB PHY power */ |
| if (cpu_is_pxa910()) { |
| u2o_set(base, UTMI_CTRL, (1<<UTMI_CTRL_INPKT_DELAY_SOF_SHIFT) |
| | (1<<UTMI_CTRL_PU_REF_SHIFT)); |
| } |
| |
| u2o_set(base, UTMI_CTRL, 1<<UTMI_CTRL_PLL_PWR_UP_SHIFT); |
| u2o_set(base, UTMI_CTRL, 1<<UTMI_CTRL_PWR_UP_SHIFT); |
| |
| /* UTMI_PLL settings */ |
| u2o_clear(base, UTMI_PLL, UTMI_PLL_PLLVDD18_MASK |
| | UTMI_PLL_PLLVDD12_MASK | UTMI_PLL_PLLCALI12_MASK |
| | UTMI_PLL_FBDIV_MASK | UTMI_PLL_REFDIV_MASK |
| | UTMI_PLL_ICP_MASK | UTMI_PLL_KVCO_MASK); |
| |
| u2o_set(base, UTMI_PLL, 0xee<<UTMI_PLL_FBDIV_SHIFT |
| | 0xb<<UTMI_PLL_REFDIV_SHIFT | 3<<UTMI_PLL_PLLVDD18_SHIFT |
| | 3<<UTMI_PLL_PLLVDD12_SHIFT | 3<<UTMI_PLL_PLLCALI12_SHIFT |
| | 1<<UTMI_PLL_ICP_SHIFT | 3<<UTMI_PLL_KVCO_SHIFT); |
| |
| /* UTMI_TX */ |
| u2o_clear(base, UTMI_TX, UTMI_TX_REG_EXT_FS_RCAL_EN_MASK |
| | UTMI_TX_TXVDD12_MASK | UTMI_TX_CK60_PHSEL_MASK |
| | UTMI_TX_IMPCAL_VTH_MASK | UTMI_TX_REG_EXT_FS_RCAL_MASK |
| | UTMI_TX_AMP_MASK); |
| u2o_set(base, UTMI_TX, 3<<UTMI_TX_TXVDD12_SHIFT |
| | 4<<UTMI_TX_CK60_PHSEL_SHIFT | 4<<UTMI_TX_IMPCAL_VTH_SHIFT |
| | 8<<UTMI_TX_REG_EXT_FS_RCAL_SHIFT | 3<<UTMI_TX_AMP_SHIFT); |
| |
| /* UTMI_RX */ |
| u2o_clear(base, UTMI_RX, UTMI_RX_SQ_THRESH_MASK |
| | UTMI_REG_SQ_LENGTH_MASK); |
| u2o_set(base, UTMI_RX, 7<<UTMI_RX_SQ_THRESH_SHIFT |
| | 2<<UTMI_REG_SQ_LENGTH_SHIFT); |
| |
| /* UTMI_IVREF */ |
| if (cpu_is_pxa168()) |
| /* fixing Microsoft Altair board interface with NEC hub issue - |
| * Set UTMI_IVREF from 0x4a3 to 0x4bf */ |
| u2o_write(base, UTMI_IVREF, 0x4bf); |
| |
| /* toggle VCOCAL_START bit of UTMI_PLL */ |
| udelay(200); |
| u2o_set(base, UTMI_PLL, VCOCAL_START); |
| udelay(40); |
| u2o_clear(base, UTMI_PLL, VCOCAL_START); |
| |
| /* toggle REG_RCAL_START bit of UTMI_TX */ |
| udelay(400); |
| u2o_set(base, UTMI_TX, REG_RCAL_START); |
| udelay(40); |
| u2o_clear(base, UTMI_TX, REG_RCAL_START); |
| udelay(400); |
| |
| /* Make sure PHY PLL is ready */ |
| loops = 0; |
| while ((u2o_get(base, UTMI_PLL) & PLL_READY) == 0) { |
| mdelay(1); |
| loops++; |
| if (loops > 100) { |
| printk(KERN_WARNING "calibrate timeout, UTMI_PLL %x\n", |
| u2o_get(base, UTMI_PLL)); |
| break; |
| } |
| } |
| |
| if (cpu_is_pxa168()) { |
| u2o_set(base, UTMI_RESERVE, 1 << 5); |
| /* Turn on UTMI PHY OTG extension */ |
| u2o_write(base, UTMI_OTG_ADDON, 1); |
| } |
| |
| return 0; |
| } |
| |
| static int usb_phy_deinit_internal(void __iomem *base) |
| { |
| pr_info("Deinit usb phy!!!\n"); |
| |
| if (cpu_is_pxa168()) |
| u2o_clear(base, UTMI_OTG_ADDON, UTMI_OTG_ADDON_OTG_ON); |
| |
| u2o_clear(base, UTMI_CTRL, UTMI_CTRL_RXBUF_PDWN); |
| u2o_clear(base, UTMI_CTRL, UTMI_CTRL_TXBUF_PDWN); |
| u2o_clear(base, UTMI_CTRL, UTMI_CTRL_USB_CLK_EN); |
| u2o_clear(base, UTMI_CTRL, 1<<UTMI_CTRL_PWR_UP_SHIFT); |
| u2o_clear(base, UTMI_CTRL, 1<<UTMI_CTRL_PLL_PWR_UP_SHIFT); |
| |
| return 0; |
| } |
| |
| int pxa_usb_phy_init(void __iomem *phy_reg) |
| { |
| mutex_lock(&phy_lock); |
| if (phy_init_cnt++ == 0) |
| usb_phy_init_internal(phy_reg); |
| mutex_unlock(&phy_lock); |
| return 0; |
| } |
| |
| void pxa_usb_phy_deinit(void __iomem *phy_reg) |
| { |
| WARN_ON(phy_init_cnt == 0); |
| |
| mutex_lock(&phy_lock); |
| if (--phy_init_cnt == 0) |
| usb_phy_deinit_internal(phy_reg); |
| mutex_unlock(&phy_lock); |
| } |
| #endif |
| #endif |
| #endif |
| |
| #if IS_ENABLED(CONFIG_USB_SUPPORT) |
| static u64 __maybe_unused usb_dma_mask = ~(u32)0; |
| |
| #if IS_ENABLED(CONFIG_PHY_PXA_USB) |
| static struct resource pxa168_usb_phy_resources[] = { |
| [0] = { |
| .start = PXA168_U2O_PHYBASE, |
| .end = PXA168_U2O_PHYBASE + USB_PHY_RANGE, |
| .flags = IORESOURCE_MEM, |
| }, |
| }; |
| |
| struct platform_device pxa168_device_usb_phy = { |
| .name = "pxa-usb-phy", |
| .id = -1, |
| .resource = pxa168_usb_phy_resources, |
| .num_resources = ARRAY_SIZE(pxa168_usb_phy_resources), |
| .dev = { |
| .dma_mask = &usb_dma_mask, |
| .coherent_dma_mask = 0xffffffff, |
| } |
| }; |
| #endif /* CONFIG_PHY_PXA_USB */ |
| |
| #if IS_ENABLED(CONFIG_USB_MV_UDC) |
| static struct resource pxa168_u2o_resources[] = { |
| /* regbase */ |
| [0] = { |
| .start = PXA168_U2O_REGBASE + U2x_CAPREGS_OFFSET, |
| .end = PXA168_U2O_REGBASE + USB_REG_RANGE, |
| .flags = IORESOURCE_MEM, |
| .name = "capregs", |
| }, |
| /* phybase */ |
| [1] = { |
| .start = PXA168_U2O_PHYBASE, |
| .end = PXA168_U2O_PHYBASE + USB_PHY_RANGE, |
| .flags = IORESOURCE_MEM, |
| .name = "phyregs", |
| }, |
| [2] = { |
| .start = IRQ_PXA168_USB1, |
| .end = IRQ_PXA168_USB1, |
| .flags = IORESOURCE_IRQ, |
| }, |
| }; |
| |
| struct platform_device pxa168_device_u2o = { |
| .name = "mv-udc", |
| .id = -1, |
| .resource = pxa168_u2o_resources, |
| .num_resources = ARRAY_SIZE(pxa168_u2o_resources), |
| .dev = { |
| .dma_mask = &usb_dma_mask, |
| .coherent_dma_mask = 0xffffffff, |
| } |
| }; |
| #endif /* CONFIG_USB_MV_UDC */ |
| |
| #if IS_ENABLED(CONFIG_USB_EHCI_MV_U2O) |
| static struct resource pxa168_u2oehci_resources[] = { |
| [0] = { |
| .start = PXA168_U2O_REGBASE, |
| .end = PXA168_U2O_REGBASE + USB_REG_RANGE, |
| .flags = IORESOURCE_MEM, |
| }, |
| [1] = { |
| .start = IRQ_PXA168_USB1, |
| .end = IRQ_PXA168_USB1, |
| .flags = IORESOURCE_IRQ, |
| }, |
| }; |
| |
| struct platform_device pxa168_device_u2oehci = { |
| .name = "pxa-u2oehci", |
| .id = -1, |
| .dev = { |
| .dma_mask = &usb_dma_mask, |
| .coherent_dma_mask = 0xffffffff, |
| }, |
| |
| .num_resources = ARRAY_SIZE(pxa168_u2oehci_resources), |
| .resource = pxa168_u2oehci_resources, |
| }; |
| #endif |
| |
| #if IS_ENABLED(CONFIG_USB_MV_OTG) |
| static struct resource pxa168_u2ootg_resources[] = { |
| /* regbase */ |
| [0] = { |
| .start = PXA168_U2O_REGBASE + U2x_CAPREGS_OFFSET, |
| .end = PXA168_U2O_REGBASE + USB_REG_RANGE, |
| .flags = IORESOURCE_MEM, |
| .name = "capregs", |
| }, |
| /* phybase */ |
| [1] = { |
| .start = PXA168_U2O_PHYBASE, |
| .end = PXA168_U2O_PHYBASE + USB_PHY_RANGE, |
| .flags = IORESOURCE_MEM, |
| .name = "phyregs", |
| }, |
| [2] = { |
| .start = IRQ_PXA168_USB1, |
| .end = IRQ_PXA168_USB1, |
| .flags = IORESOURCE_IRQ, |
| }, |
| }; |
| |
| struct platform_device pxa168_device_u2ootg = { |
| .name = "mv-otg", |
| .id = -1, |
| .dev = { |
| .dma_mask = &usb_dma_mask, |
| .coherent_dma_mask = 0xffffffff, |
| }, |
| |
| .num_resources = ARRAY_SIZE(pxa168_u2ootg_resources), |
| .resource = pxa168_u2ootg_resources, |
| }; |
| #endif /* CONFIG_USB_MV_OTG */ |
| |
| #endif |