| /* |
| * Allwinner Sun8i Ethernet MAC emulation |
| * |
| * Copyright (C) 2019 Niek Linnenbank <nieklinnenbank@gmail.com> |
| * |
| * This program is free software: you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation, either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program. If not, see <http://www.gnu.org/licenses/>. |
| */ |
| |
| #include "qemu/osdep.h" |
| #include "qemu/units.h" |
| #include "qapi/error.h" |
| #include "hw/sysbus.h" |
| #include "migration/vmstate.h" |
| #include "net/net.h" |
| #include "hw/irq.h" |
| #include "hw/qdev-properties.h" |
| #include "qemu/log.h" |
| #include "trace.h" |
| #include "net/checksum.h" |
| #include "qemu/module.h" |
| #include "exec/cpu-common.h" |
| #include "sysemu/dma.h" |
| #include "hw/net/allwinner-sun8i-emac.h" |
| |
| /* EMAC register offsets */ |
| enum { |
| REG_BASIC_CTL_0 = 0x0000, /* Basic Control 0 */ |
| REG_BASIC_CTL_1 = 0x0004, /* Basic Control 1 */ |
| REG_INT_STA = 0x0008, /* Interrupt Status */ |
| REG_INT_EN = 0x000C, /* Interrupt Enable */ |
| REG_TX_CTL_0 = 0x0010, /* Transmit Control 0 */ |
| REG_TX_CTL_1 = 0x0014, /* Transmit Control 1 */ |
| REG_TX_FLOW_CTL = 0x001C, /* Transmit Flow Control */ |
| REG_TX_DMA_DESC_LIST = 0x0020, /* Transmit Descriptor List Address */ |
| REG_RX_CTL_0 = 0x0024, /* Receive Control 0 */ |
| REG_RX_CTL_1 = 0x0028, /* Receive Control 1 */ |
| REG_RX_DMA_DESC_LIST = 0x0034, /* Receive Descriptor List Address */ |
| REG_FRM_FLT = 0x0038, /* Receive Frame Filter */ |
| REG_RX_HASH_0 = 0x0040, /* Receive Hash Table 0 */ |
| REG_RX_HASH_1 = 0x0044, /* Receive Hash Table 1 */ |
| REG_MII_CMD = 0x0048, /* Management Interface Command */ |
| REG_MII_DATA = 0x004C, /* Management Interface Data */ |
| REG_ADDR_HIGH = 0x0050, /* MAC Address High */ |
| REG_ADDR_LOW = 0x0054, /* MAC Address Low */ |
| REG_TX_DMA_STA = 0x00B0, /* Transmit DMA Status */ |
| REG_TX_CUR_DESC = 0x00B4, /* Transmit Current Descriptor */ |
| REG_TX_CUR_BUF = 0x00B8, /* Transmit Current Buffer */ |
| REG_RX_DMA_STA = 0x00C0, /* Receive DMA Status */ |
| REG_RX_CUR_DESC = 0x00C4, /* Receive Current Descriptor */ |
| REG_RX_CUR_BUF = 0x00C8, /* Receive Current Buffer */ |
| REG_RGMII_STA = 0x00D0, /* RGMII Status */ |
| }; |
| |
| /* EMAC register flags */ |
| enum { |
| BASIC_CTL0_100Mbps = (0b11 << 2), |
| BASIC_CTL0_FD = (1 << 0), |
| BASIC_CTL1_SOFTRST = (1 << 0), |
| }; |
| |
| enum { |
| INT_STA_RGMII_LINK = (1 << 16), |
| INT_STA_RX_EARLY = (1 << 13), |
| INT_STA_RX_OVERFLOW = (1 << 12), |
| INT_STA_RX_TIMEOUT = (1 << 11), |
| INT_STA_RX_DMA_STOP = (1 << 10), |
| INT_STA_RX_BUF_UA = (1 << 9), |
| INT_STA_RX = (1 << 8), |
| INT_STA_TX_EARLY = (1 << 5), |
| INT_STA_TX_UNDERFLOW = (1 << 4), |
| INT_STA_TX_TIMEOUT = (1 << 3), |
| INT_STA_TX_BUF_UA = (1 << 2), |
| INT_STA_TX_DMA_STOP = (1 << 1), |
| INT_STA_TX = (1 << 0), |
| }; |
| |
| enum { |
| INT_EN_RX_EARLY = (1 << 13), |
| INT_EN_RX_OVERFLOW = (1 << 12), |
| INT_EN_RX_TIMEOUT = (1 << 11), |
| INT_EN_RX_DMA_STOP = (1 << 10), |
| INT_EN_RX_BUF_UA = (1 << 9), |
| INT_EN_RX = (1 << 8), |
| INT_EN_TX_EARLY = (1 << 5), |
| INT_EN_TX_UNDERFLOW = (1 << 4), |
| INT_EN_TX_TIMEOUT = (1 << 3), |
| INT_EN_TX_BUF_UA = (1 << 2), |
| INT_EN_TX_DMA_STOP = (1 << 1), |
| INT_EN_TX = (1 << 0), |
| }; |
| |
| enum { |
| TX_CTL0_TX_EN = (1 << 31), |
| TX_CTL1_TX_DMA_START = (1 << 31), |
| TX_CTL1_TX_DMA_EN = (1 << 30), |
| TX_CTL1_TX_FLUSH = (1 << 0), |
| }; |
| |
| enum { |
| RX_CTL0_RX_EN = (1 << 31), |
| RX_CTL0_STRIP_FCS = (1 << 28), |
| RX_CTL0_CRC_IPV4 = (1 << 27), |
| }; |
| |
| enum { |
| RX_CTL1_RX_DMA_START = (1 << 31), |
| RX_CTL1_RX_DMA_EN = (1 << 30), |
| RX_CTL1_RX_MD = (1 << 1), |
| }; |
| |
| enum { |
| RX_FRM_FLT_DIS_ADDR = (1 << 31), |
| }; |
| |
| enum { |
| MII_CMD_PHY_ADDR_SHIFT = (12), |
| MII_CMD_PHY_ADDR_MASK = (0xf000), |
| MII_CMD_PHY_REG_SHIFT = (4), |
| MII_CMD_PHY_REG_MASK = (0xf0), |
| MII_CMD_PHY_RW = (1 << 1), |
| MII_CMD_PHY_BUSY = (1 << 0), |
| }; |
| |
| enum { |
| TX_DMA_STA_STOP = (0b000), |
| TX_DMA_STA_RUN_FETCH = (0b001), |
| TX_DMA_STA_WAIT_STA = (0b010), |
| }; |
| |
| enum { |
| RX_DMA_STA_STOP = (0b000), |
| RX_DMA_STA_RUN_FETCH = (0b001), |
| RX_DMA_STA_WAIT_FRM = (0b011), |
| }; |
| |
| /* EMAC register reset values */ |
| enum { |
| REG_BASIC_CTL_1_RST = 0x08000000, |
| }; |
| |
| /* EMAC constants */ |
| enum { |
| AW_SUN8I_EMAC_MIN_PKT_SZ = 64 |
| }; |
| |
| /* Transmit/receive frame descriptor */ |
| typedef struct FrameDescriptor { |
| uint32_t status; |
| uint32_t status2; |
| uint32_t addr; |
| uint32_t next; |
| } FrameDescriptor; |
| |
| /* Frame descriptor flags */ |
| enum { |
| DESC_STATUS_CTL = (1 << 31), |
| DESC_STATUS2_BUF_SIZE_MASK = (0x7ff), |
| }; |
| |
| /* Transmit frame descriptor flags */ |
| enum { |
| TX_DESC_STATUS_LENGTH_ERR = (1 << 14), |
| TX_DESC_STATUS2_FIRST_DESC = (1 << 29), |
| TX_DESC_STATUS2_LAST_DESC = (1 << 30), |
| TX_DESC_STATUS2_CHECKSUM_MASK = (0x3 << 27), |
| }; |
| |
| /* Receive frame descriptor flags */ |
| enum { |
| RX_DESC_STATUS_FIRST_DESC = (1 << 9), |
| RX_DESC_STATUS_LAST_DESC = (1 << 8), |
| RX_DESC_STATUS_FRM_LEN_MASK = (0x3fff0000), |
| RX_DESC_STATUS_FRM_LEN_SHIFT = (16), |
| RX_DESC_STATUS_NO_BUF = (1 << 14), |
| RX_DESC_STATUS_HEADER_ERR = (1 << 7), |
| RX_DESC_STATUS_LENGTH_ERR = (1 << 4), |
| RX_DESC_STATUS_CRC_ERR = (1 << 1), |
| RX_DESC_STATUS_PAYLOAD_ERR = (1 << 0), |
| RX_DESC_STATUS2_RX_INT_CTL = (1 << 31), |
| }; |
| |
| /* MII register offsets */ |
| enum { |
| MII_REG_CR = (0x0), /* Control */ |
| MII_REG_ST = (0x1), /* Status */ |
| MII_REG_ID_HIGH = (0x2), /* Identifier High */ |
| MII_REG_ID_LOW = (0x3), /* Identifier Low */ |
| MII_REG_ADV = (0x4), /* Advertised abilities */ |
| MII_REG_LPA = (0x5), /* Link partner abilities */ |
| }; |
| |
| /* MII register flags */ |
| enum { |
| MII_REG_CR_RESET = (1 << 15), |
| MII_REG_CR_POWERDOWN = (1 << 11), |
| MII_REG_CR_10Mbit = (0), |
| MII_REG_CR_100Mbit = (1 << 13), |
| MII_REG_CR_1000Mbit = (1 << 6), |
| MII_REG_CR_AUTO_NEG = (1 << 12), |
| MII_REG_CR_AUTO_NEG_RESTART = (1 << 9), |
| MII_REG_CR_FULLDUPLEX = (1 << 8), |
| }; |
| |
| enum { |
| MII_REG_ST_100BASE_T4 = (1 << 15), |
| MII_REG_ST_100BASE_X_FD = (1 << 14), |
| MII_REG_ST_100BASE_X_HD = (1 << 13), |
| MII_REG_ST_10_FD = (1 << 12), |
| MII_REG_ST_10_HD = (1 << 11), |
| MII_REG_ST_100BASE_T2_FD = (1 << 10), |
| MII_REG_ST_100BASE_T2_HD = (1 << 9), |
| MII_REG_ST_AUTONEG_COMPLETE = (1 << 5), |
| MII_REG_ST_AUTONEG_AVAIL = (1 << 3), |
| MII_REG_ST_LINK_UP = (1 << 2), |
| }; |
| |
| enum { |
| MII_REG_LPA_10_HD = (1 << 5), |
| MII_REG_LPA_10_FD = (1 << 6), |
| MII_REG_LPA_100_HD = (1 << 7), |
| MII_REG_LPA_100_FD = (1 << 8), |
| MII_REG_LPA_PAUSE = (1 << 10), |
| MII_REG_LPA_ASYMPAUSE = (1 << 11), |
| }; |
| |
| /* MII constants */ |
| enum { |
| MII_PHY_ID_HIGH = 0x0044, |
| MII_PHY_ID_LOW = 0x1400, |
| }; |
| |
| static void allwinner_sun8i_emac_mii_set_link(AwSun8iEmacState *s, |
| bool link_active) |
| { |
| if (link_active) { |
| s->mii_st |= MII_REG_ST_LINK_UP; |
| } else { |
| s->mii_st &= ~MII_REG_ST_LINK_UP; |
| } |
| } |
| |
| static void allwinner_sun8i_emac_mii_reset(AwSun8iEmacState *s, |
| bool link_active) |
| { |
| s->mii_cr = MII_REG_CR_100Mbit | MII_REG_CR_AUTO_NEG | |
| MII_REG_CR_FULLDUPLEX; |
| s->mii_st = MII_REG_ST_100BASE_T4 | MII_REG_ST_100BASE_X_FD | |
| MII_REG_ST_100BASE_X_HD | MII_REG_ST_10_FD | MII_REG_ST_10_HD | |
| MII_REG_ST_100BASE_T2_FD | MII_REG_ST_100BASE_T2_HD | |
| MII_REG_ST_AUTONEG_COMPLETE | MII_REG_ST_AUTONEG_AVAIL; |
| s->mii_adv = 0; |
| |
| allwinner_sun8i_emac_mii_set_link(s, link_active); |
| } |
| |
| static void allwinner_sun8i_emac_mii_cmd(AwSun8iEmacState *s) |
| { |
| uint8_t addr, reg; |
| |
| addr = (s->mii_cmd & MII_CMD_PHY_ADDR_MASK) >> MII_CMD_PHY_ADDR_SHIFT; |
| reg = (s->mii_cmd & MII_CMD_PHY_REG_MASK) >> MII_CMD_PHY_REG_SHIFT; |
| |
| if (addr != s->mii_phy_addr) { |
| return; |
| } |
| |
| /* Read or write a PHY register? */ |
| if (s->mii_cmd & MII_CMD_PHY_RW) { |
| trace_allwinner_sun8i_emac_mii_write_reg(reg, s->mii_data); |
| |
| switch (reg) { |
| case MII_REG_CR: |
| if (s->mii_data & MII_REG_CR_RESET) { |
| allwinner_sun8i_emac_mii_reset(s, s->mii_st & |
| MII_REG_ST_LINK_UP); |
| } else { |
| s->mii_cr = s->mii_data & ~(MII_REG_CR_RESET | |
| MII_REG_CR_AUTO_NEG_RESTART); |
| } |
| break; |
| case MII_REG_ADV: |
| s->mii_adv = s->mii_data; |
| break; |
| case MII_REG_ID_HIGH: |
| case MII_REG_ID_LOW: |
| case MII_REG_LPA: |
| break; |
| default: |
| qemu_log_mask(LOG_UNIMP, "allwinner-h3-emac: write access to " |
| "unknown MII register 0x%x\n", reg); |
| break; |
| } |
| } else { |
| switch (reg) { |
| case MII_REG_CR: |
| s->mii_data = s->mii_cr; |
| break; |
| case MII_REG_ST: |
| s->mii_data = s->mii_st; |
| break; |
| case MII_REG_ID_HIGH: |
| s->mii_data = MII_PHY_ID_HIGH; |
| break; |
| case MII_REG_ID_LOW: |
| s->mii_data = MII_PHY_ID_LOW; |
| break; |
| case MII_REG_ADV: |
| s->mii_data = s->mii_adv; |
| break; |
| case MII_REG_LPA: |
| s->mii_data = MII_REG_LPA_10_HD | MII_REG_LPA_10_FD | |
| MII_REG_LPA_100_HD | MII_REG_LPA_100_FD | |
| MII_REG_LPA_PAUSE | MII_REG_LPA_ASYMPAUSE; |
| break; |
| default: |
| qemu_log_mask(LOG_UNIMP, "allwinner-h3-emac: read access to " |
| "unknown MII register 0x%x\n", reg); |
| s->mii_data = 0; |
| break; |
| } |
| |
| trace_allwinner_sun8i_emac_mii_read_reg(reg, s->mii_data); |
| } |
| } |
| |
| static void allwinner_sun8i_emac_update_irq(AwSun8iEmacState *s) |
| { |
| qemu_set_irq(s->irq, (s->int_sta & s->int_en) != 0); |
| } |
| |
| static uint32_t allwinner_sun8i_emac_next_desc(AwSun8iEmacState *s, |
| FrameDescriptor *desc, |
| size_t min_size) |
| { |
| uint32_t paddr = desc->next; |
| |
| dma_memory_read(&s->dma_as, paddr, desc, sizeof(*desc)); |
| |
| if ((desc->status & DESC_STATUS_CTL) && |
| (desc->status2 & DESC_STATUS2_BUF_SIZE_MASK) >= min_size) { |
| return paddr; |
| } else { |
| return 0; |
| } |
| } |
| |
| static uint32_t allwinner_sun8i_emac_get_desc(AwSun8iEmacState *s, |
| FrameDescriptor *desc, |
| uint32_t start_addr, |
| size_t min_size) |
| { |
| uint32_t desc_addr = start_addr; |
| |
| /* Note that the list is a cycle. Last entry points back to the head. */ |
| while (desc_addr != 0) { |
| dma_memory_read(&s->dma_as, desc_addr, desc, sizeof(*desc)); |
| |
| if ((desc->status & DESC_STATUS_CTL) && |
| (desc->status2 & DESC_STATUS2_BUF_SIZE_MASK) >= min_size) { |
| return desc_addr; |
| } else if (desc->next == start_addr) { |
| break; |
| } else { |
| desc_addr = desc->next; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static uint32_t allwinner_sun8i_emac_rx_desc(AwSun8iEmacState *s, |
| FrameDescriptor *desc, |
| size_t min_size) |
| { |
| return allwinner_sun8i_emac_get_desc(s, desc, s->rx_desc_curr, min_size); |
| } |
| |
| static uint32_t allwinner_sun8i_emac_tx_desc(AwSun8iEmacState *s, |
| FrameDescriptor *desc, |
| size_t min_size) |
| { |
| return allwinner_sun8i_emac_get_desc(s, desc, s->tx_desc_head, min_size); |
| } |
| |
| static void allwinner_sun8i_emac_flush_desc(AwSun8iEmacState *s, |
| FrameDescriptor *desc, |
| uint32_t phys_addr) |
| { |
| dma_memory_write(&s->dma_as, phys_addr, desc, sizeof(*desc)); |
| } |
| |
| static bool allwinner_sun8i_emac_can_receive(NetClientState *nc) |
| { |
| AwSun8iEmacState *s = qemu_get_nic_opaque(nc); |
| FrameDescriptor desc; |
| |
| return (s->rx_ctl0 & RX_CTL0_RX_EN) && |
| (allwinner_sun8i_emac_rx_desc(s, &desc, 0) != 0); |
| } |
| |
| static ssize_t allwinner_sun8i_emac_receive(NetClientState *nc, |
| const uint8_t *buf, |
| size_t size) |
| { |
| AwSun8iEmacState *s = qemu_get_nic_opaque(nc); |
| FrameDescriptor desc; |
| size_t bytes_left = size; |
| size_t desc_bytes = 0; |
| size_t pad_fcs_size = 4; |
| size_t padding = 0; |
| |
| if (!(s->rx_ctl0 & RX_CTL0_RX_EN)) { |
| return -1; |
| } |
| |
| s->rx_desc_curr = allwinner_sun8i_emac_rx_desc(s, &desc, |
| AW_SUN8I_EMAC_MIN_PKT_SZ); |
| if (!s->rx_desc_curr) { |
| s->int_sta |= INT_STA_RX_BUF_UA; |
| } |
| |
| /* Keep filling RX descriptors until the whole frame is written */ |
| while (s->rx_desc_curr && bytes_left > 0) { |
| desc.status &= ~DESC_STATUS_CTL; |
| desc.status &= ~RX_DESC_STATUS_FRM_LEN_MASK; |
| |
| if (bytes_left == size) { |
| desc.status |= RX_DESC_STATUS_FIRST_DESC; |
| } |
| |
| if ((desc.status2 & DESC_STATUS2_BUF_SIZE_MASK) < |
| (bytes_left + pad_fcs_size)) { |
| desc_bytes = desc.status2 & DESC_STATUS2_BUF_SIZE_MASK; |
| desc.status |= desc_bytes << RX_DESC_STATUS_FRM_LEN_SHIFT; |
| } else { |
| padding = pad_fcs_size; |
| if (bytes_left < AW_SUN8I_EMAC_MIN_PKT_SZ) { |
| padding += (AW_SUN8I_EMAC_MIN_PKT_SZ - bytes_left); |
| } |
| |
| desc_bytes = (bytes_left); |
| desc.status |= RX_DESC_STATUS_LAST_DESC; |
| desc.status |= (bytes_left + padding) |
| << RX_DESC_STATUS_FRM_LEN_SHIFT; |
| } |
| |
| dma_memory_write(&s->dma_as, desc.addr, buf, desc_bytes); |
| allwinner_sun8i_emac_flush_desc(s, &desc, s->rx_desc_curr); |
| trace_allwinner_sun8i_emac_receive(s->rx_desc_curr, desc.addr, |
| desc_bytes); |
| |
| /* Check if frame needs to raise the receive interrupt */ |
| if (!(desc.status2 & RX_DESC_STATUS2_RX_INT_CTL)) { |
| s->int_sta |= INT_STA_RX; |
| } |
| |
| /* Increment variables */ |
| buf += desc_bytes; |
| bytes_left -= desc_bytes; |
| |
| /* Move to the next descriptor */ |
| s->rx_desc_curr = allwinner_sun8i_emac_next_desc(s, &desc, 64); |
| if (!s->rx_desc_curr) { |
| /* Not enough buffer space available */ |
| s->int_sta |= INT_STA_RX_BUF_UA; |
| s->rx_desc_curr = s->rx_desc_head; |
| break; |
| } |
| } |
| |
| /* Report receive DMA is finished */ |
| s->rx_ctl1 &= ~RX_CTL1_RX_DMA_START; |
| allwinner_sun8i_emac_update_irq(s); |
| |
| return size; |
| } |
| |
| static void allwinner_sun8i_emac_transmit(AwSun8iEmacState *s) |
| { |
| NetClientState *nc = qemu_get_queue(s->nic); |
| FrameDescriptor desc; |
| size_t bytes = 0; |
| size_t packet_bytes = 0; |
| size_t transmitted = 0; |
| static uint8_t packet_buf[2048]; |
| |
| s->tx_desc_curr = allwinner_sun8i_emac_tx_desc(s, &desc, 0); |
| |
| /* Read all transmit descriptors */ |
| while (s->tx_desc_curr != 0) { |
| |
| /* Read from physical memory into packet buffer */ |
| bytes = desc.status2 & DESC_STATUS2_BUF_SIZE_MASK; |
| if (bytes + packet_bytes > sizeof(packet_buf)) { |
| desc.status |= TX_DESC_STATUS_LENGTH_ERR; |
| break; |
| } |
| dma_memory_read(&s->dma_as, desc.addr, packet_buf + packet_bytes, bytes); |
| packet_bytes += bytes; |
| desc.status &= ~DESC_STATUS_CTL; |
| allwinner_sun8i_emac_flush_desc(s, &desc, s->tx_desc_curr); |
| |
| /* After the last descriptor, send the packet */ |
| if (desc.status2 & TX_DESC_STATUS2_LAST_DESC) { |
| if (desc.status2 & TX_DESC_STATUS2_CHECKSUM_MASK) { |
| net_checksum_calculate(packet_buf, packet_bytes); |
| } |
| |
| qemu_send_packet(nc, packet_buf, packet_bytes); |
| trace_allwinner_sun8i_emac_transmit(s->tx_desc_curr, desc.addr, |
| bytes); |
| |
| packet_bytes = 0; |
| transmitted++; |
| } |
| s->tx_desc_curr = allwinner_sun8i_emac_next_desc(s, &desc, 0); |
| } |
| |
| /* Raise transmit completed interrupt */ |
| if (transmitted > 0) { |
| s->int_sta |= INT_STA_TX; |
| s->tx_ctl1 &= ~TX_CTL1_TX_DMA_START; |
| allwinner_sun8i_emac_update_irq(s); |
| } |
| } |
| |
| static void allwinner_sun8i_emac_reset(DeviceState *dev) |
| { |
| AwSun8iEmacState *s = AW_SUN8I_EMAC(dev); |
| NetClientState *nc = qemu_get_queue(s->nic); |
| |
| trace_allwinner_sun8i_emac_reset(); |
| |
| s->mii_cmd = 0; |
| s->mii_data = 0; |
| s->basic_ctl0 = 0; |
| s->basic_ctl1 = REG_BASIC_CTL_1_RST; |
| s->int_en = 0; |
| s->int_sta = 0; |
| s->frm_flt = 0; |
| s->rx_ctl0 = 0; |
| s->rx_ctl1 = RX_CTL1_RX_MD; |
| s->rx_desc_head = 0; |
| s->rx_desc_curr = 0; |
| s->tx_ctl0 = 0; |
| s->tx_ctl1 = 0; |
| s->tx_desc_head = 0; |
| s->tx_desc_curr = 0; |
| s->tx_flowctl = 0; |
| |
| allwinner_sun8i_emac_mii_reset(s, !nc->link_down); |
| } |
| |
| static uint64_t allwinner_sun8i_emac_read(void *opaque, hwaddr offset, |
| unsigned size) |
| { |
| AwSun8iEmacState *s = AW_SUN8I_EMAC(opaque); |
| uint64_t value = 0; |
| FrameDescriptor desc; |
| |
| switch (offset) { |
| case REG_BASIC_CTL_0: /* Basic Control 0 */ |
| value = s->basic_ctl0; |
| break; |
| case REG_BASIC_CTL_1: /* Basic Control 1 */ |
| value = s->basic_ctl1; |
| break; |
| case REG_INT_STA: /* Interrupt Status */ |
| value = s->int_sta; |
| break; |
| case REG_INT_EN: /* Interupt Enable */ |
| value = s->int_en; |
| break; |
| case REG_TX_CTL_0: /* Transmit Control 0 */ |
| value = s->tx_ctl0; |
| break; |
| case REG_TX_CTL_1: /* Transmit Control 1 */ |
| value = s->tx_ctl1; |
| break; |
| case REG_TX_FLOW_CTL: /* Transmit Flow Control */ |
| value = s->tx_flowctl; |
| break; |
| case REG_TX_DMA_DESC_LIST: /* Transmit Descriptor List Address */ |
| value = s->tx_desc_head; |
| break; |
| case REG_RX_CTL_0: /* Receive Control 0 */ |
| value = s->rx_ctl0; |
| break; |
| case REG_RX_CTL_1: /* Receive Control 1 */ |
| value = s->rx_ctl1; |
| break; |
| case REG_RX_DMA_DESC_LIST: /* Receive Descriptor List Address */ |
| value = s->rx_desc_head; |
| break; |
| case REG_FRM_FLT: /* Receive Frame Filter */ |
| value = s->frm_flt; |
| break; |
| case REG_RX_HASH_0: /* Receive Hash Table 0 */ |
| case REG_RX_HASH_1: /* Receive Hash Table 1 */ |
| break; |
| case REG_MII_CMD: /* Management Interface Command */ |
| value = s->mii_cmd; |
| break; |
| case REG_MII_DATA: /* Management Interface Data */ |
| value = s->mii_data; |
| break; |
| case REG_ADDR_HIGH: /* MAC Address High */ |
| value = lduw_le_p(s->conf.macaddr.a + 4); |
| break; |
| case REG_ADDR_LOW: /* MAC Address Low */ |
| value = ldl_le_p(s->conf.macaddr.a); |
| break; |
| case REG_TX_DMA_STA: /* Transmit DMA Status */ |
| break; |
| case REG_TX_CUR_DESC: /* Transmit Current Descriptor */ |
| value = s->tx_desc_curr; |
| break; |
| case REG_TX_CUR_BUF: /* Transmit Current Buffer */ |
| if (s->tx_desc_curr != 0) { |
| dma_memory_read(&s->dma_as, s->tx_desc_curr, &desc, sizeof(desc)); |
| value = desc.addr; |
| } else { |
| value = 0; |
| } |
| break; |
| case REG_RX_DMA_STA: /* Receive DMA Status */ |
| break; |
| case REG_RX_CUR_DESC: /* Receive Current Descriptor */ |
| value = s->rx_desc_curr; |
| break; |
| case REG_RX_CUR_BUF: /* Receive Current Buffer */ |
| if (s->rx_desc_curr != 0) { |
| dma_memory_read(&s->dma_as, s->rx_desc_curr, &desc, sizeof(desc)); |
| value = desc.addr; |
| } else { |
| value = 0; |
| } |
| break; |
| case REG_RGMII_STA: /* RGMII Status */ |
| break; |
| default: |
| qemu_log_mask(LOG_UNIMP, "allwinner-h3-emac: read access to unknown " |
| "EMAC register 0x" TARGET_FMT_plx "\n", |
| offset); |
| } |
| |
| trace_allwinner_sun8i_emac_read(offset, value); |
| return value; |
| } |
| |
| static void allwinner_sun8i_emac_write(void *opaque, hwaddr offset, |
| uint64_t value, unsigned size) |
| { |
| AwSun8iEmacState *s = AW_SUN8I_EMAC(opaque); |
| NetClientState *nc = qemu_get_queue(s->nic); |
| |
| trace_allwinner_sun8i_emac_write(offset, value); |
| |
| switch (offset) { |
| case REG_BASIC_CTL_0: /* Basic Control 0 */ |
| s->basic_ctl0 = value; |
| break; |
| case REG_BASIC_CTL_1: /* Basic Control 1 */ |
| if (value & BASIC_CTL1_SOFTRST) { |
| allwinner_sun8i_emac_reset(DEVICE(s)); |
| value &= ~BASIC_CTL1_SOFTRST; |
| } |
| s->basic_ctl1 = value; |
| if (allwinner_sun8i_emac_can_receive(nc)) { |
| qemu_flush_queued_packets(nc); |
| } |
| break; |
| case REG_INT_STA: /* Interrupt Status */ |
| s->int_sta &= ~value; |
| allwinner_sun8i_emac_update_irq(s); |
| break; |
| case REG_INT_EN: /* Interrupt Enable */ |
| s->int_en = value; |
| allwinner_sun8i_emac_update_irq(s); |
| break; |
| case REG_TX_CTL_0: /* Transmit Control 0 */ |
| s->tx_ctl0 = value; |
| break; |
| case REG_TX_CTL_1: /* Transmit Control 1 */ |
| s->tx_ctl1 = value; |
| if (value & TX_CTL1_TX_DMA_EN) { |
| allwinner_sun8i_emac_transmit(s); |
| } |
| break; |
| case REG_TX_FLOW_CTL: /* Transmit Flow Control */ |
| s->tx_flowctl = value; |
| break; |
| case REG_TX_DMA_DESC_LIST: /* Transmit Descriptor List Address */ |
| s->tx_desc_head = value; |
| s->tx_desc_curr = value; |
| break; |
| case REG_RX_CTL_0: /* Receive Control 0 */ |
| s->rx_ctl0 = value; |
| break; |
| case REG_RX_CTL_1: /* Receive Control 1 */ |
| s->rx_ctl1 = value | RX_CTL1_RX_MD; |
| if ((value & RX_CTL1_RX_DMA_EN) && |
| allwinner_sun8i_emac_can_receive(nc)) { |
| qemu_flush_queued_packets(nc); |
| } |
| break; |
| case REG_RX_DMA_DESC_LIST: /* Receive Descriptor List Address */ |
| s->rx_desc_head = value; |
| s->rx_desc_curr = value; |
| break; |
| case REG_FRM_FLT: /* Receive Frame Filter */ |
| s->frm_flt = value; |
| break; |
| case REG_RX_HASH_0: /* Receive Hash Table 0 */ |
| case REG_RX_HASH_1: /* Receive Hash Table 1 */ |
| break; |
| case REG_MII_CMD: /* Management Interface Command */ |
| s->mii_cmd = value & ~MII_CMD_PHY_BUSY; |
| allwinner_sun8i_emac_mii_cmd(s); |
| break; |
| case REG_MII_DATA: /* Management Interface Data */ |
| s->mii_data = value; |
| break; |
| case REG_ADDR_HIGH: /* MAC Address High */ |
| stw_le_p(s->conf.macaddr.a + 4, value); |
| break; |
| case REG_ADDR_LOW: /* MAC Address Low */ |
| stl_le_p(s->conf.macaddr.a, value); |
| break; |
| case REG_TX_DMA_STA: /* Transmit DMA Status */ |
| case REG_TX_CUR_DESC: /* Transmit Current Descriptor */ |
| case REG_TX_CUR_BUF: /* Transmit Current Buffer */ |
| case REG_RX_DMA_STA: /* Receive DMA Status */ |
| case REG_RX_CUR_DESC: /* Receive Current Descriptor */ |
| case REG_RX_CUR_BUF: /* Receive Current Buffer */ |
| case REG_RGMII_STA: /* RGMII Status */ |
| break; |
| default: |
| qemu_log_mask(LOG_UNIMP, "allwinner-h3-emac: write access to unknown " |
| "EMAC register 0x" TARGET_FMT_plx "\n", |
| offset); |
| } |
| } |
| |
| static void allwinner_sun8i_emac_set_link(NetClientState *nc) |
| { |
| AwSun8iEmacState *s = qemu_get_nic_opaque(nc); |
| |
| trace_allwinner_sun8i_emac_set_link(!nc->link_down); |
| allwinner_sun8i_emac_mii_set_link(s, !nc->link_down); |
| } |
| |
| static const MemoryRegionOps allwinner_sun8i_emac_mem_ops = { |
| .read = allwinner_sun8i_emac_read, |
| .write = allwinner_sun8i_emac_write, |
| .endianness = DEVICE_NATIVE_ENDIAN, |
| .valid = { |
| .min_access_size = 4, |
| .max_access_size = 4, |
| }, |
| .impl.min_access_size = 4, |
| }; |
| |
| static NetClientInfo net_allwinner_sun8i_emac_info = { |
| .type = NET_CLIENT_DRIVER_NIC, |
| .size = sizeof(NICState), |
| .can_receive = allwinner_sun8i_emac_can_receive, |
| .receive = allwinner_sun8i_emac_receive, |
| .link_status_changed = allwinner_sun8i_emac_set_link, |
| }; |
| |
| static void allwinner_sun8i_emac_init(Object *obj) |
| { |
| SysBusDevice *sbd = SYS_BUS_DEVICE(obj); |
| AwSun8iEmacState *s = AW_SUN8I_EMAC(obj); |
| |
| memory_region_init_io(&s->iomem, OBJECT(s), &allwinner_sun8i_emac_mem_ops, |
| s, TYPE_AW_SUN8I_EMAC, 64 * KiB); |
| sysbus_init_mmio(sbd, &s->iomem); |
| sysbus_init_irq(sbd, &s->irq); |
| } |
| |
| static void allwinner_sun8i_emac_realize(DeviceState *dev, Error **errp) |
| { |
| AwSun8iEmacState *s = AW_SUN8I_EMAC(dev); |
| |
| if (!s->dma_mr) { |
| error_setg(errp, TYPE_AW_SUN8I_EMAC " 'dma-memory' link not set"); |
| return; |
| } |
| |
| address_space_init(&s->dma_as, s->dma_mr, "emac-dma"); |
| |
| qemu_macaddr_default_if_unset(&s->conf.macaddr); |
| s->nic = qemu_new_nic(&net_allwinner_sun8i_emac_info, &s->conf, |
| object_get_typename(OBJECT(dev)), dev->id, s); |
| qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a); |
| } |
| |
| static Property allwinner_sun8i_emac_properties[] = { |
| DEFINE_NIC_PROPERTIES(AwSun8iEmacState, conf), |
| DEFINE_PROP_UINT8("phy-addr", AwSun8iEmacState, mii_phy_addr, 0), |
| DEFINE_PROP_LINK("dma-memory", AwSun8iEmacState, dma_mr, |
| TYPE_MEMORY_REGION, MemoryRegion *), |
| DEFINE_PROP_END_OF_LIST(), |
| }; |
| |
| static int allwinner_sun8i_emac_post_load(void *opaque, int version_id) |
| { |
| AwSun8iEmacState *s = opaque; |
| |
| allwinner_sun8i_emac_set_link(qemu_get_queue(s->nic)); |
| |
| return 0; |
| } |
| |
| static const VMStateDescription vmstate_aw_emac = { |
| .name = "allwinner-sun8i-emac", |
| .version_id = 1, |
| .minimum_version_id = 1, |
| .post_load = allwinner_sun8i_emac_post_load, |
| .fields = (VMStateField[]) { |
| VMSTATE_UINT8(mii_phy_addr, AwSun8iEmacState), |
| VMSTATE_UINT32(mii_cmd, AwSun8iEmacState), |
| VMSTATE_UINT32(mii_data, AwSun8iEmacState), |
| VMSTATE_UINT32(mii_cr, AwSun8iEmacState), |
| VMSTATE_UINT32(mii_st, AwSun8iEmacState), |
| VMSTATE_UINT32(mii_adv, AwSun8iEmacState), |
| VMSTATE_UINT32(basic_ctl0, AwSun8iEmacState), |
| VMSTATE_UINT32(basic_ctl1, AwSun8iEmacState), |
| VMSTATE_UINT32(int_en, AwSun8iEmacState), |
| VMSTATE_UINT32(int_sta, AwSun8iEmacState), |
| VMSTATE_UINT32(frm_flt, AwSun8iEmacState), |
| VMSTATE_UINT32(rx_ctl0, AwSun8iEmacState), |
| VMSTATE_UINT32(rx_ctl1, AwSun8iEmacState), |
| VMSTATE_UINT32(rx_desc_head, AwSun8iEmacState), |
| VMSTATE_UINT32(rx_desc_curr, AwSun8iEmacState), |
| VMSTATE_UINT32(tx_ctl0, AwSun8iEmacState), |
| VMSTATE_UINT32(tx_ctl1, AwSun8iEmacState), |
| VMSTATE_UINT32(tx_desc_head, AwSun8iEmacState), |
| VMSTATE_UINT32(tx_desc_curr, AwSun8iEmacState), |
| VMSTATE_UINT32(tx_flowctl, AwSun8iEmacState), |
| VMSTATE_END_OF_LIST() |
| } |
| }; |
| |
| static void allwinner_sun8i_emac_class_init(ObjectClass *klass, void *data) |
| { |
| DeviceClass *dc = DEVICE_CLASS(klass); |
| |
| dc->realize = allwinner_sun8i_emac_realize; |
| dc->reset = allwinner_sun8i_emac_reset; |
| dc->vmsd = &vmstate_aw_emac; |
| device_class_set_props(dc, allwinner_sun8i_emac_properties); |
| } |
| |
| static const TypeInfo allwinner_sun8i_emac_info = { |
| .name = TYPE_AW_SUN8I_EMAC, |
| .parent = TYPE_SYS_BUS_DEVICE, |
| .instance_size = sizeof(AwSun8iEmacState), |
| .instance_init = allwinner_sun8i_emac_init, |
| .class_init = allwinner_sun8i_emac_class_init, |
| }; |
| |
| static void allwinner_sun8i_emac_register_types(void) |
| { |
| type_register_static(&allwinner_sun8i_emac_info); |
| } |
| |
| type_init(allwinner_sun8i_emac_register_types) |