Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / u-boot / board / ep8260 / mii_phy.c

diff --git a/qemu/roms/u-boot/board/ep8260/mii_phy.c b/qemu/roms/u-boot/board/ep8260/mii_phy.c
new file mode 100644 (file)
index 0000000..c7aa275
--- /dev/null
+++ b/qemu/roms/u-boot/board/ep8260/mii_phy.c
@@ -0,0 +1,107 @@
+#include <common.h>
+#include <mii_phy.h>
+#include "ep8260.h"
+
+#define MII_MDIO       0x01
+#define MII_MDCK       0x02
+#define MII_MDIR       0x04
+
+void
+mii_discover_phy(void)
+{
+    int known;
+    unsigned short phy_reg;
+    unsigned long phy_id;
+
+    known = 0;
+    printf("Discovering phy @ 0: ");
+    phy_id = mii_phy_read(2) << 16;
+    phy_id |= mii_phy_read(3);
+    if ((phy_id & 0xFFFFFC00) == 0x00137800) {
+       printf("Level One ");
+       if ((phy_id & 0x000003F0) == 0xE0) {
+           printf("LXT971A Revision %d\n", (int)(phy_id & 0xF));
+           known = 1;
+       }
+       else printf("unknown type\n");
+    }
+    else printf("unknown OUI = 0x%08lX\n", phy_id);
+
+    phy_reg = mii_phy_read(1);
+    if (!(phy_reg & 0x0004)) printf("Link is down\n");
+    if (!(phy_reg & 0x0020)) printf("Auto-negotiation not complete\n");
+    if (phy_reg & 0x0002) printf("Jabber condition detected\n");
+    if (phy_reg & 0x0010) printf("Remote fault condition detected \n");
+
+    if (known) {
+       phy_reg = mii_phy_read(17);
+       if (phy_reg & 0x0400)
+           printf("Phy operating at %d MBit/s in %s-duplex mode\n",
+               phy_reg & 0x4000 ? 100 : 10,
+               phy_reg & 0x0200 ? "full" : "half");
+       else
+           printf("bad link!!\n");
+/*
+left  off: no link, green 100MBit, yellow 10MBit
+right off: no activity, green full-duplex, yellow half-duplex
+*/
+       mii_phy_write(20, 0x0452);
+    }
+}
+
+unsigned short
+mii_phy_read(unsigned short reg)
+{
+    int i;
+    unsigned short tmp, val = 0, adr = 0;
+    t_ep_regs *regs = (t_ep_regs*)CONFIG_SYS_REGS_BASE;
+
+    tmp = 0x6002 | (adr << 7) | (reg << 2);
+    regs->bcsr4 = 0xC3;
+    for (i = 0; i < 64; i++) {
+       regs->bcsr4 ^= MII_MDCK;
+    }
+    for (i = 0; i < 16; i++) {
+       regs->bcsr4 &= ~MII_MDCK;
+       if (tmp & 0x8000) regs->bcsr4 |= MII_MDIO;
+       else regs->bcsr4 &= ~MII_MDIO;
+       regs->bcsr4 |= MII_MDCK;
+       tmp <<= 1;
+    }
+    regs->bcsr4 |= MII_MDIR;
+    for (i = 0; i < 16; i++) {
+       val <<= 1;
+       regs->bcsr4 = MII_MDIO | (regs->bcsr4 | MII_MDCK);
+       if (regs->bcsr4 & MII_MDIO) val |= 1;
+       regs->bcsr4 = MII_MDIO | (regs->bcsr4 &= ~MII_MDCK);
+    }
+    return val;
+}
+
+void
+mii_phy_write(unsigned short reg, unsigned short val)
+{
+    int i;
+    unsigned short tmp, adr = 0;
+    t_ep_regs *regs = (t_ep_regs*)CONFIG_SYS_REGS_BASE;
+
+    tmp = 0x5002 | (adr << 7) | (reg << 2);
+    regs->bcsr4 = 0xC3;
+    for (i = 0; i < 64; i++) {
+       regs->bcsr4 ^= MII_MDCK;
+    }
+    for (i = 0; i < 16; i++) {
+       regs->bcsr4 &= ~MII_MDCK;
+       if (tmp & 0x8000) regs->bcsr4 |= MII_MDIO;
+       else regs->bcsr4 &= ~MII_MDIO;
+       regs->bcsr4 |= MII_MDCK;
+       tmp <<= 1;
+    }
+    for (i = 0; i < 16; i++) {
+       regs->bcsr4 &= ~MII_MDCK;
+       if (val & 0x8000) regs->bcsr4 |= MII_MDIO;
+       else regs->bcsr4 &= ~MII_MDIO;
+       regs->bcsr4 |= MII_MDCK;
+       val <<= 1;
+    }
+}