board/rpxsuper/mii_phy.c

   1 #include <common.h>
   2 #include <mii_phy.h>
   3 #include "rpxsuper.h"
   4
   5 #define MII_MDIO        0x01
   6 #define MII_MDCK        0x02
   7 #define MII_MDIR        0x04
   8
   9 void
  10 mii_discover_phy(void)
  11 {
  12     int known;
  13     unsigned short phy_reg;
  14     unsigned long phy_id;
  15
  16     known = 0;
  17     printf("Discovering phy @ 0: ");
  18     phy_id = mii_phy_read(2) << 16;
  19     phy_id |= mii_phy_read(3);
  20     if ((phy_id & 0xFFFFFC00) == 0x00137800) {
  21         printf("Level One ");
  22         if ((phy_id & 0x000003F0) == 0xE0) {
  23             printf("LXT971A Revision %d\n", (int)(phy_id & 0xF));
  24             known = 1;
  25         }
  26         else printf("unknown type\n");
  27     }
  28     else printf("unknown OUI = 0x%08lX\n", phy_id);
  29
  30     phy_reg = mii_phy_read(1);
  31     if (!(phy_reg & 0x0004)) printf("Link is down\n");
  32     if (!(phy_reg & 0x0020)) printf("Auto-negotiation not complete\n");
  33     if (phy_reg & 0x0002) printf("Jabber condition detected\n");
  34     if (phy_reg & 0x0010) printf("Remote fault condition detected \n");
  35
  36     if (known) {
  37         phy_reg = mii_phy_read(17);
  38         if (phy_reg & 0x0400)
  39             printf("Phy operating at %d MBit/s in %s-duplex mode\n",
  40                 phy_reg & 0x4000 ? 100 : 10,
  41                 phy_reg & 0x0200 ? "full" : "half");
  42         else
  43             printf("bad link!!\n");
  44 /*
  45 left  off: no link, green 100MBit, yellow 10MBit
  46 right off: no activity, green full-duplex, yellow half-duplex
  47 */
  48         mii_phy_write(20, 0x0452);
  49     }
  50 }
  51
  52 unsigned short
  53 mii_phy_read(unsigned short reg)
  54 {
  55     int i;
  56     unsigned short tmp, val = 0, adr = 0;
  57     t_rpx_regs *regs = (t_rpx_regs*)CONFIG_SYS_REGS_BASE;
  58
  59     tmp = 0x6002 | (adr << 7) | (reg << 2);
  60     regs->bcsr4 = 0xC3;
  61     for (i = 0; i < 64; i++) {
  62         regs->bcsr4 ^= MII_MDCK;
  63     }
  64     for (i = 0; i < 16; i++) {
  65         regs->bcsr4 &= ~MII_MDCK;
  66         if (tmp & 0x8000) regs->bcsr4 |= MII_MDIO;
  67         else regs->bcsr4 &= ~MII_MDIO;
  68         regs->bcsr4 |= MII_MDCK;
  69         tmp <<= 1;
  70     }
  71     regs->bcsr4 |= MII_MDIR;
  72     for (i = 0; i < 16; i++) {
  73         val <<= 1;
  74         regs->bcsr4 = MII_MDIO | (regs->bcsr4 | MII_MDCK);
  75         if (regs->bcsr4 & MII_MDIO) val |= 1;
  76         regs->bcsr4 = MII_MDIO | (regs->bcsr4 &= ~MII_MDCK);
  77     }
  78     return val;
  79 }
  80
  81 void
  82 mii_phy_write(unsigned short reg, unsigned short val)
  83 {
  84     int i;
  85     unsigned short tmp, adr = 0;
  86     t_rpx_regs *regs = (t_rpx_regs*)CONFIG_SYS_REGS_BASE;
  87
  88     tmp = 0x5002 | (adr << 7) | (reg << 2);
  89     regs->bcsr4 = 0xC3;
  90     for (i = 0; i < 64; i++) {
  91         regs->bcsr4 ^= MII_MDCK;
  92     }
  93     for (i = 0; i < 16; i++) {
  94         regs->bcsr4 &= ~MII_MDCK;
  95         if (tmp & 0x8000) regs->bcsr4 |= MII_MDIO;
  96         else regs->bcsr4 &= ~MII_MDIO;
  97         regs->bcsr4 |= MII_MDCK;
  98         tmp <<= 1;
  99     }
 100     for (i = 0; i < 16; i++) {
 101         regs->bcsr4 &= ~MII_MDCK;
 102         if (val & 0x8000) regs->bcsr4 |= MII_MDIO;
 103         else regs->bcsr4 &= ~MII_MDIO;
 104         regs->bcsr4 |= MII_MDCK;
 105         val <<= 1;
 106     }
 107 }