2 * Copyright (C) 2015-2016 Wills Wang <wills.wang@live.com>
4 * SPDX-License-Identifier: GPL-2.0+
8 #include <linux/errno.h>
10 #include <asm/addrspace.h>
11 #include <asm/types.h>
12 #include <mach/ath79.h>
13 #include <mach/ar71xx_regs.h>
15 void _machine_restart(void)
20 base = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
23 reg = AR71XX_RESET_REG_RESET_MODULE;
24 else if (soc_is_ar724x())
25 reg = AR724X_RESET_REG_RESET_MODULE;
26 else if (soc_is_ar913x())
27 reg = AR913X_RESET_REG_RESET_MODULE;
28 else if (soc_is_ar933x())
29 reg = AR933X_RESET_REG_RESET_MODULE;
30 else if (soc_is_ar934x())
31 reg = AR934X_RESET_REG_RESET_MODULE;
32 else if (soc_is_qca953x())
33 reg = QCA953X_RESET_REG_RESET_MODULE;
34 else if (soc_is_qca955x())
35 reg = QCA955X_RESET_REG_RESET_MODULE;
36 else if (soc_is_qca956x())
37 reg = QCA956X_RESET_REG_RESET_MODULE;
39 puts("Reset register not defined for this SOC\n");
42 setbits_be32(base + reg, AR71XX_RESET_FULL_CHIP);
48 u32 ath79_get_bootstrap(void)
53 base = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
56 reg = AR933X_RESET_REG_BOOTSTRAP;
57 else if (soc_is_ar934x())
58 reg = AR934X_RESET_REG_BOOTSTRAP;
59 else if (soc_is_qca953x())
60 reg = QCA953X_RESET_REG_BOOTSTRAP;
61 else if (soc_is_qca955x())
62 reg = QCA955X_RESET_REG_BOOTSTRAP;
63 else if (soc_is_qca956x())
64 reg = QCA956X_RESET_REG_BOOTSTRAP;
66 puts("Bootstrap register not defined for this SOC\n");
69 return readl(base + reg);
74 static int eth_init_ar933x(void)
76 void __iomem *rregs = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
78 void __iomem *pregs = map_physmem(AR71XX_PLL_BASE, AR71XX_PLL_SIZE,
80 void __iomem *gregs = map_physmem(AR933X_GMAC_BASE, AR933X_GMAC_SIZE,
82 const u32 mask = AR933X_RESET_GE0_MAC | AR933X_RESET_GE0_MDIO |
83 AR933X_RESET_GE1_MAC | AR933X_RESET_GE1_MDIO |
84 AR933X_RESET_ETH_SWITCH |
85 AR933X_RESET_ETH_SWITCH_ANALOG;
87 /* Clear MDIO slave EN bit. */
88 clrbits_be32(rregs + AR933X_RESET_REG_BOOTSTRAP, BIT(17));
91 /* Get Atheros S26 PHY out of reset. */
92 clrsetbits_be32(pregs + AR933X_PLL_SWITCH_CLOCK_CONTROL_REG,
96 setbits_be32(rregs + AR933X_RESET_REG_RESET_MODULE, mask);
98 clrbits_be32(rregs + AR933X_RESET_REG_RESET_MODULE, mask);
101 /* Configure AR93xx GMAC register. */
102 clrsetbits_be32(gregs + AR933X_GMAC_REG_ETH_CFG,
103 AR933X_ETH_CFG_MII_GE0_MASTER |
104 AR933X_ETH_CFG_MII_GE0_SLAVE,
105 AR933X_ETH_CFG_MII_GE0_SLAVE);
109 static int eth_init_ar934x(void)
111 void __iomem *rregs = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
113 void __iomem *pregs = map_physmem(AR71XX_PLL_BASE, AR71XX_PLL_SIZE,
115 void __iomem *gregs = map_physmem(AR934X_GMAC_BASE, AR934X_GMAC_SIZE,
117 const u32 mask = AR934X_RESET_GE0_MAC | AR934X_RESET_GE0_MDIO |
118 AR934X_RESET_GE1_MAC | AR934X_RESET_GE1_MDIO |
119 AR934X_RESET_ETH_SWITCH_ANALOG;
122 reg = readl(rregs + AR934X_RESET_REG_BOOTSTRAP);
123 if (reg & AR934X_BOOTSTRAP_REF_CLK_40)
124 writel(0x570, pregs + AR934X_PLL_SWITCH_CLOCK_CONTROL_REG);
126 writel(0x271, pregs + AR934X_PLL_SWITCH_CLOCK_CONTROL_REG);
127 writel(BIT(26) | BIT(25), pregs + AR934X_PLL_ETH_XMII_CONTROL_REG);
129 setbits_be32(rregs + AR934X_RESET_REG_RESET_MODULE, mask);
131 clrbits_be32(rregs + AR934X_RESET_REG_RESET_MODULE, mask);
134 /* Configure AR934x GMAC register. */
135 writel(AR934X_ETH_CFG_RGMII_GMAC0, gregs + AR934X_GMAC_REG_ETH_CFG);
139 static int eth_init_qca953x(void)
141 void __iomem *rregs = map_physmem(AR71XX_RESET_BASE, AR71XX_RESET_SIZE,
143 const u32 mask = QCA953X_RESET_GE0_MAC | QCA953X_RESET_GE0_MDIO |
144 QCA953X_RESET_GE1_MAC | QCA953X_RESET_GE1_MDIO |
145 QCA953X_RESET_ETH_SWITCH_ANALOG |
146 QCA953X_RESET_ETH_SWITCH;
148 setbits_be32(rregs + AR934X_RESET_REG_RESET_MODULE, mask);
150 clrbits_be32(rregs + AR934X_RESET_REG_RESET_MODULE, mask);
156 int ath79_eth_reset(void)
159 * Un-reset ethernet. DM still doesn't have any notion of reset
160 * framework, so we do it by hand here.
163 return eth_init_ar933x();
165 return eth_init_ar934x();
166 if (soc_is_qca953x())
167 return eth_init_qca953x();
172 static int usb_reset_ar933x(void __iomem *reset_regs)
174 /* Ungate the USB block */
175 setbits_be32(reset_regs + AR933X_RESET_REG_RESET_MODULE,
176 AR933X_RESET_USBSUS_OVERRIDE);
178 clrbits_be32(reset_regs + AR933X_RESET_REG_RESET_MODULE,
179 AR933X_RESET_USB_HOST);
181 clrbits_be32(reset_regs + AR933X_RESET_REG_RESET_MODULE,
182 AR933X_RESET_USB_PHY);
188 static int usb_reset_ar934x(void __iomem *reset_regs)
190 /* Ungate the USB block */
191 setbits_be32(reset_regs + AR934X_RESET_REG_RESET_MODULE,
192 AR934X_RESET_USBSUS_OVERRIDE);
194 clrbits_be32(reset_regs + AR934X_RESET_REG_RESET_MODULE,
195 AR934X_RESET_USB_PHY);
197 clrbits_be32(reset_regs + AR934X_RESET_REG_RESET_MODULE,
198 AR934X_RESET_USB_PHY_ANALOG);
200 clrbits_be32(reset_regs + AR934X_RESET_REG_RESET_MODULE,
201 AR934X_RESET_USB_HOST);
207 static int usb_reset_qca953x(void __iomem *reset_regs)
209 void __iomem *pregs = map_physmem(AR71XX_PLL_BASE, AR71XX_PLL_SIZE,
212 clrsetbits_be32(pregs + QCA953X_PLL_SWITCH_CLOCK_CONTROL_REG,
216 /* Ungate the USB block */
217 setbits_be32(reset_regs + QCA953X_RESET_REG_RESET_MODULE,
218 QCA953X_RESET_USBSUS_OVERRIDE);
220 clrbits_be32(reset_regs + QCA953X_RESET_REG_RESET_MODULE,
221 QCA953X_RESET_USB_PHY);
223 clrbits_be32(reset_regs + QCA953X_RESET_REG_RESET_MODULE,
224 QCA953X_RESET_USB_PHY_ANALOG);
226 clrbits_be32(reset_regs + QCA953X_RESET_REG_RESET_MODULE,
227 QCA953X_RESET_USB_HOST);
229 clrbits_be32(reset_regs + QCA953X_RESET_REG_RESET_MODULE,
230 QCA953X_RESET_USB_PHY_PLL_PWD_EXT);
236 int ath79_usb_reset(void)
238 void __iomem *usbc_regs = map_physmem(AR71XX_USB_CTRL_BASE,
239 AR71XX_USB_CTRL_SIZE,
241 void __iomem *reset_regs = map_physmem(AR71XX_RESET_BASE,
245 * Turn on the Buff and Desc swap bits.
246 * NOTE: This write into an undocumented register in mandatory to
247 * get the USB controller operational in BigEndian mode.
249 writel(0xf0000, usbc_regs + AR71XX_USB_CTRL_REG_CONFIG);
252 return usb_reset_ar933x(reset_regs);
254 return usb_reset_ar934x(reset_regs);
255 if (soc_is_qca953x())
256 return usb_reset_qca953x(reset_regs);