qemu/hw/net/etraxfs_eth.c
<<
>>
Prefs
   1/*
   2 * QEMU ETRAX Ethernet Controller.
   3 *
   4 * Copyright (c) 2008 Edgar E. Iglesias, Axis Communications AB.
   5 *
   6 * Permission is hereby granted, free of charge, to any person obtaining a copy
   7 * of this software and associated documentation files (the "Software"), to deal
   8 * in the Software without restriction, including without limitation the rights
   9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10 * copies of the Software, and to permit persons to whom the Software is
  11 * furnished to do so, subject to the following conditions:
  12 *
  13 * The above copyright notice and this permission notice shall be included in
  14 * all copies or substantial portions of the Software.
  15 *
  16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22 * THE SOFTWARE.
  23 */
  24
  25#include "qemu/osdep.h"
  26#include "hw/sysbus.h"
  27#include "net/net.h"
  28#include "hw/cris/etraxfs.h"
  29#include "qemu/error-report.h"
  30#include "trace.h"
  31
  32#define D(x)
  33
  34/* Advertisement control register. */
  35#define ADVERTISE_10HALF        0x0020  /* Try for 10mbps half-duplex  */
  36#define ADVERTISE_10FULL        0x0040  /* Try for 10mbps full-duplex  */
  37#define ADVERTISE_100HALF       0x0080  /* Try for 100mbps half-duplex */
  38#define ADVERTISE_100FULL       0x0100  /* Try for 100mbps full-duplex */
  39
  40/*
  41 * The MDIO extensions in the TDK PHY model were reversed engineered from the
  42 * linux driver (PHYID and Diagnostics reg).
  43 * TODO: Add friendly names for the register nums.
  44 */
  45struct qemu_phy
  46{
  47    uint32_t regs[32];
  48
  49    int link;
  50
  51    unsigned int (*read)(struct qemu_phy *phy, unsigned int req);
  52    void (*write)(struct qemu_phy *phy, unsigned int req, unsigned int data);
  53};
  54
  55static unsigned int tdk_read(struct qemu_phy *phy, unsigned int req)
  56{
  57    int regnum;
  58    unsigned r = 0;
  59
  60    regnum = req & 0x1f;
  61
  62    switch (regnum) {
  63    case 1:
  64        if (!phy->link) {
  65            break;
  66        }
  67        /* MR1.     */
  68        /* Speeds and modes.  */
  69        r |= (1 << 13) | (1 << 14);
  70        r |= (1 << 11) | (1 << 12);
  71        r |= (1 << 5); /* Autoneg complete.  */
  72        r |= (1 << 3); /* Autoneg able.     */
  73        r |= (1 << 2); /* link.     */
  74        break;
  75    case 5:
  76        /* Link partner ability.
  77           We are kind; always agree with whatever best mode
  78           the guest advertises.  */
  79        r = 1 << 14; /* Success.  */
  80        /* Copy advertised modes.  */
  81        r |= phy->regs[4] & (15 << 5);
  82        /* Autoneg support.  */
  83        r |= 1;
  84        break;
  85    case 18:
  86    {
  87        /* Diagnostics reg.  */
  88        int duplex = 0;
  89        int speed_100 = 0;
  90
  91        if (!phy->link) {
  92            break;
  93        }
  94
  95        /* Are we advertising 100 half or 100 duplex ? */
  96        speed_100 = !!(phy->regs[4] & ADVERTISE_100HALF);
  97        speed_100 |= !!(phy->regs[4] & ADVERTISE_100FULL);
  98
  99        /* Are we advertising 10 duplex or 100 duplex ? */
 100        duplex = !!(phy->regs[4] & ADVERTISE_100FULL);
 101        duplex |= !!(phy->regs[4] & ADVERTISE_10FULL);
 102        r = (speed_100 << 10) | (duplex << 11);
 103    }
 104    break;
 105
 106    default:
 107        r = phy->regs[regnum];
 108        break;
 109    }
 110    trace_mdio_phy_read(regnum, r);
 111    return r;
 112}
 113
 114static void
 115tdk_write(struct qemu_phy *phy, unsigned int req, unsigned int data)
 116{
 117    int regnum;
 118
 119    regnum = req & 0x1f;
 120    trace_mdio_phy_write(regnum, data);
 121    switch (regnum) {
 122    default:
 123        phy->regs[regnum] = data;
 124        break;
 125    }
 126}
 127
 128static void
 129tdk_init(struct qemu_phy *phy)
 130{
 131    phy->regs[0] = 0x3100;
 132    /* PHY Id.  */
 133    phy->regs[2] = 0x0300;
 134    phy->regs[3] = 0xe400;
 135    /* Autonegotiation advertisement reg.  */
 136    phy->regs[4] = 0x01E1;
 137    phy->link = 1;
 138
 139    phy->read = tdk_read;
 140    phy->write = tdk_write;
 141}
 142
 143struct qemu_mdio
 144{
 145    /* bus.     */
 146    int mdc;
 147    int mdio;
 148
 149    /* decoder.  */
 150    enum {
 151        PREAMBLE,
 152        SOF,
 153        OPC,
 154        ADDR,
 155        REQ,
 156        TURNAROUND,
 157        DATA
 158    } state;
 159    unsigned int drive;
 160
 161    unsigned int cnt;
 162    unsigned int addr;
 163    unsigned int opc;
 164    unsigned int req;
 165    unsigned int data;
 166
 167    struct qemu_phy *devs[32];
 168};
 169
 170static void
 171mdio_attach(struct qemu_mdio *bus, struct qemu_phy *phy, unsigned int addr)
 172{
 173    bus->devs[addr & 0x1f] = phy;
 174}
 175
 176#ifdef USE_THIS_DEAD_CODE
 177static void
 178mdio_detach(struct qemu_mdio *bus, struct qemu_phy *phy, unsigned int addr)
 179{
 180    bus->devs[addr & 0x1f] = NULL;
 181}
 182#endif
 183
 184static void mdio_read_req(struct qemu_mdio *bus)
 185{
 186    struct qemu_phy *phy;
 187
 188    phy = bus->devs[bus->addr];
 189    if (phy && phy->read) {
 190        bus->data = phy->read(phy, bus->req);
 191    } else {
 192        bus->data = 0xffff;
 193    }
 194}
 195
 196static void mdio_write_req(struct qemu_mdio *bus)
 197{
 198    struct qemu_phy *phy;
 199
 200    phy = bus->devs[bus->addr];
 201    if (phy && phy->write) {
 202        phy->write(phy, bus->req, bus->data);
 203    }
 204}
 205
 206static void mdio_cycle(struct qemu_mdio *bus)
 207{
 208    bus->cnt++;
 209
 210    trace_mdio_bitbang(bus->mdc, bus->mdio, bus->state, bus->cnt, bus->drive);
 211#if 0
 212    if (bus->mdc) {
 213        printf("%d", bus->mdio);
 214    }
 215#endif
 216    switch (bus->state) {
 217    case PREAMBLE:
 218        if (bus->mdc) {
 219            if (bus->cnt >= (32 * 2) && !bus->mdio) {
 220                bus->cnt = 0;
 221                bus->state = SOF;
 222                bus->data = 0;
 223            }
 224        }
 225        break;
 226    case SOF:
 227        if (bus->mdc) {
 228            if (bus->mdio != 1) {
 229                printf("WARNING: no SOF\n");
 230            }
 231            if (bus->cnt == 1*2) {
 232                bus->cnt = 0;
 233                bus->opc = 0;
 234                bus->state = OPC;
 235            }
 236        }
 237        break;
 238    case OPC:
 239        if (bus->mdc) {
 240            bus->opc <<= 1;
 241            bus->opc |= bus->mdio & 1;
 242            if (bus->cnt == 2*2) {
 243                bus->cnt = 0;
 244                bus->addr = 0;
 245                bus->state = ADDR;
 246            }
 247        }
 248        break;
 249    case ADDR:
 250        if (bus->mdc) {
 251            bus->addr <<= 1;
 252            bus->addr |= bus->mdio & 1;
 253
 254            if (bus->cnt == 5*2) {
 255                bus->cnt = 0;
 256                bus->req = 0;
 257                bus->state = REQ;
 258            }
 259        }
 260        break;
 261    case REQ:
 262        if (bus->mdc) {
 263            bus->req <<= 1;
 264            bus->req |= bus->mdio & 1;
 265            if (bus->cnt == 5*2) {
 266                bus->cnt = 0;
 267                bus->state = TURNAROUND;
 268            }
 269        }
 270        break;
 271    case TURNAROUND:
 272        if (bus->mdc && bus->cnt == 2*2) {
 273            bus->mdio = 0;
 274            bus->cnt = 0;
 275
 276            if (bus->opc == 2) {
 277                bus->drive = 1;
 278                mdio_read_req(bus);
 279                bus->mdio = bus->data & 1;
 280            }
 281            bus->state = DATA;
 282        }
 283        break;
 284    case DATA:
 285        if (!bus->mdc) {
 286            if (bus->drive) {
 287                bus->mdio = !!(bus->data & (1 << 15));
 288                bus->data <<= 1;
 289            }
 290        } else {
 291            if (!bus->drive) {
 292                bus->data <<= 1;
 293                bus->data |= bus->mdio;
 294            }
 295            if (bus->cnt == 16 * 2) {
 296                bus->cnt = 0;
 297                bus->state = PREAMBLE;
 298                if (!bus->drive) {
 299                    mdio_write_req(bus);
 300                }
 301                bus->drive = 0;
 302            }
 303        }
 304        break;
 305    default:
 306        break;
 307    }
 308}
 309
 310/* ETRAX-FS Ethernet MAC block starts here.  */
 311
 312#define RW_MA0_LO      0x00
 313#define RW_MA0_HI      0x01
 314#define RW_MA1_LO      0x02
 315#define RW_MA1_HI      0x03
 316#define RW_GA_LO      0x04
 317#define RW_GA_HI      0x05
 318#define RW_GEN_CTRL      0x06
 319#define RW_REC_CTRL      0x07
 320#define RW_TR_CTRL      0x08
 321#define RW_CLR_ERR      0x09
 322#define RW_MGM_CTRL      0x0a
 323#define R_STAT          0x0b
 324#define FS_ETH_MAX_REGS      0x17
 325
 326#define TYPE_ETRAX_FS_ETH "etraxfs-eth"
 327#define ETRAX_FS_ETH(obj) \
 328    OBJECT_CHECK(ETRAXFSEthState, (obj), TYPE_ETRAX_FS_ETH)
 329
 330typedef struct ETRAXFSEthState
 331{
 332    SysBusDevice parent_obj;
 333
 334    MemoryRegion mmio;
 335    NICState *nic;
 336    NICConf conf;
 337
 338    /* Two addrs in the filter.  */
 339    uint8_t macaddr[2][6];
 340    uint32_t regs[FS_ETH_MAX_REGS];
 341
 342    union {
 343        void *vdma_out;
 344        struct etraxfs_dma_client *dma_out;
 345    };
 346    union {
 347        void *vdma_in;
 348        struct etraxfs_dma_client *dma_in;
 349    };
 350
 351    /* MDIO bus.  */
 352    struct qemu_mdio mdio_bus;
 353    unsigned int phyaddr;
 354    int duplex_mismatch;
 355
 356    /* PHY.     */
 357    struct qemu_phy phy;
 358} ETRAXFSEthState;
 359
 360static void eth_validate_duplex(ETRAXFSEthState *eth)
 361{
 362    struct qemu_phy *phy;
 363    unsigned int phy_duplex;
 364    unsigned int mac_duplex;
 365    int new_mm = 0;
 366
 367    phy = eth->mdio_bus.devs[eth->phyaddr];
 368    phy_duplex = !!(phy->read(phy, 18) & (1 << 11));
 369    mac_duplex = !!(eth->regs[RW_REC_CTRL] & 128);
 370
 371    if (mac_duplex != phy_duplex) {
 372        new_mm = 1;
 373    }
 374
 375    if (eth->regs[RW_GEN_CTRL] & 1) {
 376        if (new_mm != eth->duplex_mismatch) {
 377            if (new_mm) {
 378                printf("HW: WARNING ETH duplex mismatch MAC=%d PHY=%d\n",
 379                       mac_duplex, phy_duplex);
 380            } else {
 381                printf("HW: ETH duplex ok.\n");
 382            }
 383        }
 384        eth->duplex_mismatch = new_mm;
 385    }
 386}
 387
 388static uint64_t
 389eth_read(void *opaque, hwaddr addr, unsigned int size)
 390{
 391    ETRAXFSEthState *eth = opaque;
 392    uint32_t r = 0;
 393
 394    addr >>= 2;
 395
 396    switch (addr) {
 397    case R_STAT:
 398        r = eth->mdio_bus.mdio & 1;
 399        break;
 400    default:
 401        r = eth->regs[addr];
 402        D(printf("%s %x\n", __func__, addr * 4));
 403        break;
 404    }
 405    return r;
 406}
 407
 408static void eth_update_ma(ETRAXFSEthState *eth, int ma)
 409{
 410    int reg;
 411    int i = 0;
 412
 413    ma &= 1;
 414
 415    reg = RW_MA0_LO;
 416    if (ma) {
 417        reg = RW_MA1_LO;
 418    }
 419
 420    eth->macaddr[ma][i++] = eth->regs[reg];
 421    eth->macaddr[ma][i++] = eth->regs[reg] >> 8;
 422    eth->macaddr[ma][i++] = eth->regs[reg] >> 16;
 423    eth->macaddr[ma][i++] = eth->regs[reg] >> 24;
 424    eth->macaddr[ma][i++] = eth->regs[reg + 1];
 425    eth->macaddr[ma][i] = eth->regs[reg + 1] >> 8;
 426
 427    D(printf("set mac%d=%x.%x.%x.%x.%x.%x\n", ma,
 428             eth->macaddr[ma][0], eth->macaddr[ma][1],
 429             eth->macaddr[ma][2], eth->macaddr[ma][3],
 430             eth->macaddr[ma][4], eth->macaddr[ma][5]));
 431}
 432
 433static void
 434eth_write(void *opaque, hwaddr addr,
 435          uint64_t val64, unsigned int size)
 436{
 437    ETRAXFSEthState *eth = opaque;
 438    uint32_t value = val64;
 439
 440    addr >>= 2;
 441    switch (addr) {
 442    case RW_MA0_LO:
 443    case RW_MA0_HI:
 444        eth->regs[addr] = value;
 445        eth_update_ma(eth, 0);
 446        break;
 447    case RW_MA1_LO:
 448    case RW_MA1_HI:
 449        eth->regs[addr] = value;
 450        eth_update_ma(eth, 1);
 451        break;
 452
 453    case RW_MGM_CTRL:
 454        /* Attach an MDIO/PHY abstraction.  */
 455        if (value & 2) {
 456            eth->mdio_bus.mdio = value & 1;
 457        }
 458        if (eth->mdio_bus.mdc != (value & 4)) {
 459            mdio_cycle(&eth->mdio_bus);
 460            eth_validate_duplex(eth);
 461        }
 462        eth->mdio_bus.mdc = !!(value & 4);
 463        eth->regs[addr] = value;
 464        break;
 465
 466    case RW_REC_CTRL:
 467        eth->regs[addr] = value;
 468        eth_validate_duplex(eth);
 469        break;
 470
 471    default:
 472        eth->regs[addr] = value;
 473        D(printf("%s %x %x\n", __func__, addr, value));
 474        break;
 475    }
 476}
 477
 478/* The ETRAX FS has a groupt address table (GAT) which works like a k=1 bloom
 479   filter dropping group addresses we have not joined.    The filter has 64
 480   bits (m). The has function is a simple nible xor of the group addr.    */
 481static int eth_match_groupaddr(ETRAXFSEthState *eth, const unsigned char *sa)
 482{
 483    unsigned int hsh;
 484    int m_individual = eth->regs[RW_REC_CTRL] & 4;
 485    int match;
 486
 487    /* First bit on the wire of a MAC address signals multicast or
 488       physical address.  */
 489    if (!m_individual && !(sa[0] & 1)) {
 490        return 0;
 491    }
 492
 493    /* Calculate the hash index for the GA registers. */
 494    hsh = 0;
 495    hsh ^= (*sa) & 0x3f;
 496    hsh ^= ((*sa) >> 6) & 0x03;
 497    ++sa;
 498    hsh ^= ((*sa) << 2) & 0x03c;
 499    hsh ^= ((*sa) >> 4) & 0xf;
 500    ++sa;
 501    hsh ^= ((*sa) << 4) & 0x30;
 502    hsh ^= ((*sa) >> 2) & 0x3f;
 503    ++sa;
 504    hsh ^= (*sa) & 0x3f;
 505    hsh ^= ((*sa) >> 6) & 0x03;
 506    ++sa;
 507    hsh ^= ((*sa) << 2) & 0x03c;
 508    hsh ^= ((*sa) >> 4) & 0xf;
 509    ++sa;
 510    hsh ^= ((*sa) << 4) & 0x30;
 511    hsh ^= ((*sa) >> 2) & 0x3f;
 512
 513    hsh &= 63;
 514    if (hsh > 31) {
 515        match = eth->regs[RW_GA_HI] & (1 << (hsh - 32));
 516    } else {
 517        match = eth->regs[RW_GA_LO] & (1 << hsh);
 518    }
 519    D(printf("hsh=%x ga=%x.%x mtch=%d\n", hsh,
 520             eth->regs[RW_GA_HI], eth->regs[RW_GA_LO], match));
 521    return match;
 522}
 523
 524static ssize_t eth_receive(NetClientState *nc, const uint8_t *buf, size_t size)
 525{
 526    unsigned char sa_bcast[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
 527    ETRAXFSEthState *eth = qemu_get_nic_opaque(nc);
 528    int use_ma0 = eth->regs[RW_REC_CTRL] & 1;
 529    int use_ma1 = eth->regs[RW_REC_CTRL] & 2;
 530    int r_bcast = eth->regs[RW_REC_CTRL] & 8;
 531
 532    if (size < 12) {
 533        return -1;
 534    }
 535
 536    D(printf("%x.%x.%x.%x.%x.%x ma=%d %d bc=%d\n",
 537         buf[0], buf[1], buf[2], buf[3], buf[4], buf[5],
 538         use_ma0, use_ma1, r_bcast));
 539
 540    /* Does the frame get through the address filters?  */
 541    if ((!use_ma0 || memcmp(buf, eth->macaddr[0], 6))
 542        && (!use_ma1 || memcmp(buf, eth->macaddr[1], 6))
 543        && (!r_bcast || memcmp(buf, sa_bcast, 6))
 544        && !eth_match_groupaddr(eth, buf)) {
 545        return size;
 546    }
 547
 548    /* FIXME: Find another way to pass on the fake csum.  */
 549    etraxfs_dmac_input(eth->dma_in, (void *)buf, size + 4, 1);
 550
 551    return size;
 552}
 553
 554static int eth_tx_push(void *opaque, unsigned char *buf, int len, bool eop)
 555{
 556    ETRAXFSEthState *eth = opaque;
 557
 558    D(printf("%s buf=%p len=%d\n", __func__, buf, len));
 559    qemu_send_packet(qemu_get_queue(eth->nic), buf, len);
 560    return len;
 561}
 562
 563static void eth_set_link(NetClientState *nc)
 564{
 565    ETRAXFSEthState *eth = qemu_get_nic_opaque(nc);
 566    D(printf("%s %d\n", __func__, nc->link_down));
 567    eth->phy.link = !nc->link_down;
 568}
 569
 570static const MemoryRegionOps eth_ops = {
 571    .read = eth_read,
 572    .write = eth_write,
 573    .endianness = DEVICE_LITTLE_ENDIAN,
 574    .valid = {
 575        .min_access_size = 4,
 576        .max_access_size = 4
 577    }
 578};
 579
 580static NetClientInfo net_etraxfs_info = {
 581    .type = NET_CLIENT_DRIVER_NIC,
 582    .size = sizeof(NICState),
 583    .receive = eth_receive,
 584    .link_status_changed = eth_set_link,
 585};
 586
 587static int fs_eth_init(SysBusDevice *sbd)
 588{
 589    DeviceState *dev = DEVICE(sbd);
 590    ETRAXFSEthState *s = ETRAX_FS_ETH(dev);
 591
 592    if (!s->dma_out || !s->dma_in) {
 593        error_report("Unconnected ETRAX-FS Ethernet MAC");
 594        return -1;
 595    }
 596
 597    s->dma_out->client.push = eth_tx_push;
 598    s->dma_out->client.opaque = s;
 599    s->dma_in->client.opaque = s;
 600    s->dma_in->client.pull = NULL;
 601
 602    memory_region_init_io(&s->mmio, OBJECT(dev), &eth_ops, s,
 603                          "etraxfs-eth", 0x5c);
 604    sysbus_init_mmio(sbd, &s->mmio);
 605
 606    qemu_macaddr_default_if_unset(&s->conf.macaddr);
 607    s->nic = qemu_new_nic(&net_etraxfs_info, &s->conf,
 608                          object_get_typename(OBJECT(s)), dev->id, s);
 609    qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a);
 610
 611
 612    tdk_init(&s->phy);
 613    mdio_attach(&s->mdio_bus, &s->phy, s->phyaddr);
 614    return 0;
 615}
 616
 617static Property etraxfs_eth_properties[] = {
 618    DEFINE_PROP_UINT32("phyaddr", ETRAXFSEthState, phyaddr, 1),
 619    DEFINE_PROP_PTR("dma_out", ETRAXFSEthState, vdma_out),
 620    DEFINE_PROP_PTR("dma_in", ETRAXFSEthState, vdma_in),
 621    DEFINE_NIC_PROPERTIES(ETRAXFSEthState, conf),
 622    DEFINE_PROP_END_OF_LIST(),
 623};
 624
 625static void etraxfs_eth_class_init(ObjectClass *klass, void *data)
 626{
 627    DeviceClass *dc = DEVICE_CLASS(klass);
 628    SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
 629
 630    k->init = fs_eth_init;
 631    dc->props = etraxfs_eth_properties;
 632    /* Reason: pointer properties "dma_out", "dma_in" */
 633    dc->user_creatable = false;
 634}
 635
 636static const TypeInfo etraxfs_eth_info = {
 637    .name          = TYPE_ETRAX_FS_ETH,
 638    .parent        = TYPE_SYS_BUS_DEVICE,
 639    .instance_size = sizeof(ETRAXFSEthState),
 640    .class_init    = etraxfs_eth_class_init,
 641};
 642
 643static void etraxfs_eth_register_types(void)
 644{
 645    type_register_static(&etraxfs_eth_info);
 646}
 647
 648type_init(etraxfs_eth_register_types)
 649