target/linux/lantiq/patches-3.7/0005-MIPS-lantiq-adds-code-for-booting-GPHY.patch

   1 From af14a456c58c153c6d761e6c0af48157692b52ad Mon Sep 17 00:00:00 2001
   2 From: John Crispin <blogic@openwrt.org>
   3 Date: Fri, 9 Nov 2012 13:43:30 +0100
   4 Subject: [PATCH 5/6] MIPS: lantiq: adds code for booting GPHY
   5
   6 The XRX200 family of SoCs has embedded gigabit PHYs. This patch adds code to
   7 boot them up.
   8
   9 Signed-off-by: John Crispin <blogic@openwrt.org>
  10 Patchwork: http://patchwork.linux-mips.org/patch/4522
  11 ---
  12  .../mips/include/asm/mach-lantiq/xway/lantiq_soc.h |    3 ++
  13  arch/mips/lantiq/xway/reset.c                      |   36 ++++++++++++++++++++
  14  2 files changed, 39 insertions(+)
  15
  16 --- a/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h
  17 +++ b/arch/mips/include/asm/mach-lantiq/xway/lantiq_soc.h
  18 @@ -82,6 +82,9 @@ extern __iomem void *ltq_cgu_membase;
  19  #define LTQ_MPS_BASE_ADDR      (KSEG1 + 0x1F107000)
  20  #define LTQ_MPS_CHIPID         ((u32 *)(LTQ_MPS_BASE_ADDR + 0x0344))
  21
  22 +/* allow booting xrx200 phys */
  23 +int xrx200_gphy_boot(struct device *dev, unsigned int id, dma_addr_t dev_addr);
  24 +
  25  /* request a non-gpio and set the PIO config */
  26  #define PMU_PPE                         BIT(13)
  27  extern void ltq_pmu_enable(unsigned int module);
  28 --- a/arch/mips/lantiq/xway/reset.c
  29 +++ b/arch/mips/lantiq/xway/reset.c
  30 @@ -28,9 +28,15 @@
  31  #define RCU_RST_REQ            0x0010
  32  /* reset status register */
  33  #define RCU_RST_STAT           0x0014
  34 +/* vr9 gphy registers */
  35 +#define RCU_GFS_ADD0_XRX200    0x0020
  36 +#define RCU_GFS_ADD1_XRX200    0x0068
  37
  38  /* reboot bit */
  39 +#define RCU_RD_GPHY0_XRX200    BIT(31)
  40  #define RCU_RD_SRST            BIT(30)
  41 +#define RCU_RD_GPHY1_XRX200    BIT(29)
  42 +
  43  /* reset cause */
  44  #define RCU_STAT_SHIFT         26
  45  /* boot selection */
  46 @@ -60,6 +66,36 @@ unsigned char ltq_boot_select(void)
  47         return RCU_BOOT_SEL(val);
  48  }
  49
  50 +/* reset / boot a gphy */
  51 +static struct ltq_xrx200_gphy_reset {
  52 +       u32 rd;
  53 +       u32 addr;
  54 +} xrx200_gphy[] = {
  55 +       {RCU_RD_GPHY0_XRX200, RCU_GFS_ADD0_XRX200},
  56 +       {RCU_RD_GPHY1_XRX200, RCU_GFS_ADD1_XRX200},
  57 +};
  58 +
  59 +/* reset and boot a gphy. these phys only exist on xrx200 SoC */
  60 +int xrx200_gphy_boot(struct device *dev, unsigned int id, dma_addr_t dev_addr)
  61 +{
  62 +       if (!of_device_is_compatible(ltq_rcu_np, "lantiq,rcu-xrx200")) {
  63 +               dev_err(dev, "this SoC has no GPHY\n");
  64 +               return -EINVAL;
  65 +       }
  66 +       if (id > 1) {
  67 +               dev_err(dev, "%u is an invalid gphy id\n", id);
  68 +               return -EINVAL;
  69 +       }
  70 +       dev_info(dev, "booting GPHY%u firmware at %X\n", id, dev_addr);
  71 +
  72 +       ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) | xrx200_gphy[id].rd,
  73 +                       RCU_RST_REQ);
  74 +       ltq_rcu_w32(dev_addr, xrx200_gphy[id].addr);
  75 +       ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) & ~xrx200_gphy[id].rd,
  76 +                       RCU_RST_REQ);
  77 +       return 0;
  78 +}
  79 +
  80  /* reset a io domain for u micro seconds */
  81  void ltq_reset_once(unsigned int module, ulong u)
  82  {