MIPS: lantiq: adds code for booting GPHY

The XRX200 family of SoCs has embedded gigabit PHYs. This patch adds code to
boot them up.

Signed-off-by: John Crispin <blogic@openwrt.org>
Patchwork: http://patchwork.linux-mips.org/patch/4522

diff --git a/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h b/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h
index 6a2df709c576956a4c58541d2fad5c2f9c726917..133336b493b67c4822e79a2965e93300adbab853 100644 (file)
--- a/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h
+++ b/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h
@@ -82,6 +82,9 @@ extern __iomem void *ltq_cgu_membase;
 #define LTQ_MPS_BASE_ADDR      (KSEG1 + 0x1F107000)
 #define LTQ_MPS_CHIPID         ((u32 *)(LTQ_MPS_BASE_ADDR + 0x0344))
 
+/* allow booting xrx200 phys */
+int xrx200_gphy_boot(struct device *dev, unsigned int id, dma_addr_t dev_addr);
+
 /* request a non-gpio and set the PIO config */
 #define PMU_PPE                         BIT(13)
 extern void ltq_pmu_enable(unsigned int module);

diff --git a/arch/mips/lantiq/xway/reset.c b/arch/mips/lantiq/xway/reset.c
index 2799212ab7db8525dc7121af469a9a33698896e6..544dbb7fb421e03ac01200e226255390f26499f7 100644 (file)
--- a/arch/mips/lantiq/xway/reset.c
+++ b/arch/mips/lantiq/xway/reset.c
@@ -28,9 +28,15 @@
 #define RCU_RST_REQ            0x0010
 /* reset status register */
 #define RCU_RST_STAT           0x0014
+/* vr9 gphy registers */
+#define RCU_GFS_ADD0_XRX200    0x0020
+#define RCU_GFS_ADD1_XRX200    0x0068
 
 /* reboot bit */
+#define RCU_RD_GPHY0_XRX200    BIT(31)
 #define RCU_RD_SRST            BIT(30)
+#define RCU_RD_GPHY1_XRX200    BIT(29)
+
 /* reset cause */
 #define RCU_STAT_SHIFT         26
 /* boot selection */
@@ -60,6 +66,36 @@ unsigned char ltq_boot_select(void)
        return RCU_BOOT_SEL(val);
 }
 
+/* reset / boot a gphy */
+static struct ltq_xrx200_gphy_reset {
+       u32 rd;
+       u32 addr;
+} xrx200_gphy[] = {
+       {RCU_RD_GPHY0_XRX200, RCU_GFS_ADD0_XRX200},
+       {RCU_RD_GPHY1_XRX200, RCU_GFS_ADD1_XRX200},
+};
+
+/* reset and boot a gphy. these phys only exist on xrx200 SoC */
+int xrx200_gphy_boot(struct device *dev, unsigned int id, dma_addr_t dev_addr)
+{
+       if (!of_device_is_compatible(ltq_rcu_np, "lantiq,rcu-xrx200")) {
+               dev_err(dev, "this SoC has no GPHY\n");
+               return -EINVAL;
+       }
+       if (id > 1) {
+               dev_err(dev, "%u is an invalid gphy id\n", id);
+               return -EINVAL;
+       }
+       dev_info(dev, "booting GPHY%u firmware at %X\n", id, dev_addr);
+
+       ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) | xrx200_gphy[id].rd,
+                       RCU_RST_REQ);
+       ltq_rcu_w32(dev_addr, xrx200_gphy[id].addr);
+       ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) & ~xrx200_gphy[id].rd,
+                       RCU_RST_REQ);
+       return 0;
+}
+
 /* reset a io domain for u micro seconds */
 void ltq_reset_once(unsigned int module, ulong u)
 {