19e749f25SAlexander Motin /* 29e749f25SAlexander Motin * Copyright (c) 2016 Alexander Motin <mav@FreeBSD.org> 39e749f25SAlexander Motin * Copyright (c) 2015 Peter Grehan <grehan@freebsd.org> 49e749f25SAlexander Motin * Copyright (c) 2013 Jeremiah Lott, Avere Systems 59e749f25SAlexander Motin * All rights reserved. 69e749f25SAlexander Motin * 79e749f25SAlexander Motin * Redistribution and use in source and binary forms, with or without 89e749f25SAlexander Motin * modification, are permitted provided that the following conditions 99e749f25SAlexander Motin * are met: 109e749f25SAlexander Motin * 1. Redistributions of source code must retain the above copyright 119e749f25SAlexander Motin * notice, this list of conditions and the following disclaimer 129e749f25SAlexander Motin * in this position and unchanged. 139e749f25SAlexander Motin * 2. Redistributions in binary form must reproduce the above copyright 149e749f25SAlexander Motin * notice, this list of conditions and the following disclaimer in the 159e749f25SAlexander Motin * documentation and/or other materials provided with the distribution. 169e749f25SAlexander Motin * 179e749f25SAlexander Motin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 189e749f25SAlexander Motin * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 199e749f25SAlexander Motin * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 209e749f25SAlexander Motin * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 219e749f25SAlexander Motin * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 229e749f25SAlexander Motin * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 239e749f25SAlexander Motin * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 249e749f25SAlexander Motin * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 259e749f25SAlexander Motin * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 269e749f25SAlexander Motin * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 279e749f25SAlexander Motin * SUCH DAMAGE. 289e749f25SAlexander Motin */ 299e749f25SAlexander Motin 309e749f25SAlexander Motin #include <sys/cdefs.h> 319e749f25SAlexander Motin __FBSDID("$FreeBSD$"); 329e749f25SAlexander Motin 339e749f25SAlexander Motin #include <sys/types.h> 3400ef17beSBartek Rutkowski #ifndef WITHOUT_CAPSICUM 3500ef17beSBartek Rutkowski #include <sys/capsicum.h> 3600ef17beSBartek Rutkowski #endif 379e749f25SAlexander Motin #include <sys/limits.h> 389e749f25SAlexander Motin #include <sys/ioctl.h> 399e749f25SAlexander Motin #include <sys/uio.h> 409e749f25SAlexander Motin #include <net/ethernet.h> 419e749f25SAlexander Motin #include <netinet/in.h> 429e749f25SAlexander Motin #include <netinet/tcp.h> 439e749f25SAlexander Motin 4400ef17beSBartek Rutkowski #include <err.h> 459e749f25SAlexander Motin #include <errno.h> 469e749f25SAlexander Motin #include <fcntl.h> 479e749f25SAlexander Motin #include <md5.h> 489e749f25SAlexander Motin #include <stdio.h> 499e749f25SAlexander Motin #include <stdlib.h> 509e749f25SAlexander Motin #include <string.h> 5100ef17beSBartek Rutkowski #include <sysexits.h> 529e749f25SAlexander Motin #include <unistd.h> 539e749f25SAlexander Motin #include <pthread.h> 549e749f25SAlexander Motin #include <pthread_np.h> 559e749f25SAlexander Motin 569e749f25SAlexander Motin #include "e1000_regs.h" 579e749f25SAlexander Motin #include "e1000_defines.h" 589e749f25SAlexander Motin #include "mii.h" 599e749f25SAlexander Motin 609e749f25SAlexander Motin #include "bhyverun.h" 619e749f25SAlexander Motin #include "pci_emul.h" 629e749f25SAlexander Motin #include "mevent.h" 639e749f25SAlexander Motin 649e749f25SAlexander Motin /* Hardware/register definitions XXX: move some to common code. */ 659e749f25SAlexander Motin #define E82545_VENDOR_ID_INTEL 0x8086 669e749f25SAlexander Motin #define E82545_DEV_ID_82545EM_COPPER 0x100F 679e749f25SAlexander Motin #define E82545_SUBDEV_ID 0x1008 689e749f25SAlexander Motin 699e749f25SAlexander Motin #define E82545_REVISION_4 4 709e749f25SAlexander Motin 719e749f25SAlexander Motin #define E82545_MDIC_DATA_MASK 0x0000FFFF 729e749f25SAlexander Motin #define E82545_MDIC_OP_MASK 0x0c000000 739e749f25SAlexander Motin #define E82545_MDIC_IE 0x20000000 749e749f25SAlexander Motin 759e749f25SAlexander Motin #define E82545_EECD_FWE_DIS 0x00000010 /* Flash writes disabled */ 769e749f25SAlexander Motin #define E82545_EECD_FWE_EN 0x00000020 /* Flash writes enabled */ 779e749f25SAlexander Motin #define E82545_EECD_FWE_MASK 0x00000030 /* Flash writes mask */ 789e749f25SAlexander Motin 799e749f25SAlexander Motin #define E82545_BAR_REGISTER 0 809e749f25SAlexander Motin #define E82545_BAR_REGISTER_LEN (128*1024) 819e749f25SAlexander Motin #define E82545_BAR_FLASH 1 829e749f25SAlexander Motin #define E82545_BAR_FLASH_LEN (64*1024) 839e749f25SAlexander Motin #define E82545_BAR_IO 2 849e749f25SAlexander Motin #define E82545_BAR_IO_LEN 8 859e749f25SAlexander Motin 869e749f25SAlexander Motin #define E82545_IOADDR 0x00000000 879e749f25SAlexander Motin #define E82545_IODATA 0x00000004 889e749f25SAlexander Motin #define E82545_IO_REGISTER_MAX 0x0001FFFF 899e749f25SAlexander Motin #define E82545_IO_FLASH_BASE 0x00080000 909e749f25SAlexander Motin #define E82545_IO_FLASH_MAX 0x000FFFFF 919e749f25SAlexander Motin 929e749f25SAlexander Motin #define E82545_ARRAY_ENTRY(reg, offset) (reg + (offset<<2)) 939e749f25SAlexander Motin #define E82545_RAR_MAX 15 949e749f25SAlexander Motin #define E82545_MTA_MAX 127 959e749f25SAlexander Motin #define E82545_VFTA_MAX 127 969e749f25SAlexander Motin 979e749f25SAlexander Motin /* Slightly modified from the driver versions, hardcoded for 3 opcode bits, 989e749f25SAlexander Motin * followed by 6 address bits. 999e749f25SAlexander Motin * TODO: make opcode bits and addr bits configurable? 1009e749f25SAlexander Motin * NVM Commands - Microwire */ 1019e749f25SAlexander Motin #define E82545_NVM_OPCODE_BITS 3 1029e749f25SAlexander Motin #define E82545_NVM_ADDR_BITS 6 1039e749f25SAlexander Motin #define E82545_NVM_DATA_BITS 16 1049e749f25SAlexander Motin #define E82545_NVM_OPADDR_BITS (E82545_NVM_OPCODE_BITS + E82545_NVM_ADDR_BITS) 1059e749f25SAlexander Motin #define E82545_NVM_ADDR_MASK ((1 << E82545_NVM_ADDR_BITS)-1) 1069e749f25SAlexander Motin #define E82545_NVM_OPCODE_MASK \ 1079e749f25SAlexander Motin (((1 << E82545_NVM_OPCODE_BITS) - 1) << E82545_NVM_ADDR_BITS) 1089e749f25SAlexander Motin #define E82545_NVM_OPCODE_READ (0x6 << E82545_NVM_ADDR_BITS) /* read */ 1099e749f25SAlexander Motin #define E82545_NVM_OPCODE_WRITE (0x5 << E82545_NVM_ADDR_BITS) /* write */ 1109e749f25SAlexander Motin #define E82545_NVM_OPCODE_ERASE (0x7 << E82545_NVM_ADDR_BITS) /* erase */ 1119e749f25SAlexander Motin #define E82545_NVM_OPCODE_EWEN (0x4 << E82545_NVM_ADDR_BITS) /* wr-enable */ 1129e749f25SAlexander Motin 1139e749f25SAlexander Motin #define E82545_NVM_EEPROM_SIZE 64 /* 64 * 16-bit values == 128K */ 1149e749f25SAlexander Motin 1159e749f25SAlexander Motin #define E1000_ICR_SRPD 0x00010000 1169e749f25SAlexander Motin 117ee7230f4SAlexander Motin /* This is an arbitrary number. There is no hard limit on the chip. */ 118ee7230f4SAlexander Motin #define I82545_MAX_TXSEGS 64 1199e749f25SAlexander Motin 1209e749f25SAlexander Motin /* Legacy receive descriptor */ 1219e749f25SAlexander Motin struct e1000_rx_desc { 1229e749f25SAlexander Motin uint64_t buffer_addr; /* Address of the descriptor's data buffer */ 1239e749f25SAlexander Motin uint16_t length; /* Length of data DMAed into data buffer */ 1249e749f25SAlexander Motin uint16_t csum; /* Packet checksum */ 1259e749f25SAlexander Motin uint8_t status; /* Descriptor status */ 1269e749f25SAlexander Motin uint8_t errors; /* Descriptor Errors */ 1279e749f25SAlexander Motin uint16_t special; 1289e749f25SAlexander Motin }; 1299e749f25SAlexander Motin 1309e749f25SAlexander Motin /* Transmit descriptor types */ 1319e749f25SAlexander Motin #define E1000_TXD_MASK (E1000_TXD_CMD_DEXT | 0x00F00000) 1329e749f25SAlexander Motin #define E1000_TXD_TYP_L (0) 1339e749f25SAlexander Motin #define E1000_TXD_TYP_C (E1000_TXD_CMD_DEXT | E1000_TXD_DTYP_C) 1349e749f25SAlexander Motin #define E1000_TXD_TYP_D (E1000_TXD_CMD_DEXT | E1000_TXD_DTYP_D) 1359e749f25SAlexander Motin 1369e749f25SAlexander Motin /* Legacy transmit descriptor */ 1379e749f25SAlexander Motin struct e1000_tx_desc { 1389e749f25SAlexander Motin uint64_t buffer_addr; /* Address of the descriptor's data buffer */ 1399e749f25SAlexander Motin union { 1409e749f25SAlexander Motin uint32_t data; 1419e749f25SAlexander Motin struct { 1429e749f25SAlexander Motin uint16_t length; /* Data buffer length */ 1439e749f25SAlexander Motin uint8_t cso; /* Checksum offset */ 1449e749f25SAlexander Motin uint8_t cmd; /* Descriptor control */ 1459e749f25SAlexander Motin } flags; 1469e749f25SAlexander Motin } lower; 1479e749f25SAlexander Motin union { 1489e749f25SAlexander Motin uint32_t data; 1499e749f25SAlexander Motin struct { 1509e749f25SAlexander Motin uint8_t status; /* Descriptor status */ 1519e749f25SAlexander Motin uint8_t css; /* Checksum start */ 1529e749f25SAlexander Motin uint16_t special; 1539e749f25SAlexander Motin } fields; 1549e749f25SAlexander Motin } upper; 1559e749f25SAlexander Motin }; 1569e749f25SAlexander Motin 1579e749f25SAlexander Motin /* Context descriptor */ 1589e749f25SAlexander Motin struct e1000_context_desc { 1599e749f25SAlexander Motin union { 1609e749f25SAlexander Motin uint32_t ip_config; 1619e749f25SAlexander Motin struct { 1629e749f25SAlexander Motin uint8_t ipcss; /* IP checksum start */ 1639e749f25SAlexander Motin uint8_t ipcso; /* IP checksum offset */ 1649e749f25SAlexander Motin uint16_t ipcse; /* IP checksum end */ 1659e749f25SAlexander Motin } ip_fields; 1669e749f25SAlexander Motin } lower_setup; 1679e749f25SAlexander Motin union { 1689e749f25SAlexander Motin uint32_t tcp_config; 1699e749f25SAlexander Motin struct { 1709e749f25SAlexander Motin uint8_t tucss; /* TCP checksum start */ 1719e749f25SAlexander Motin uint8_t tucso; /* TCP checksum offset */ 1729e749f25SAlexander Motin uint16_t tucse; /* TCP checksum end */ 1739e749f25SAlexander Motin } tcp_fields; 1749e749f25SAlexander Motin } upper_setup; 1759e749f25SAlexander Motin uint32_t cmd_and_length; 1769e749f25SAlexander Motin union { 1779e749f25SAlexander Motin uint32_t data; 1789e749f25SAlexander Motin struct { 1799e749f25SAlexander Motin uint8_t status; /* Descriptor status */ 1809e749f25SAlexander Motin uint8_t hdr_len; /* Header length */ 1819e749f25SAlexander Motin uint16_t mss; /* Maximum segment size */ 1829e749f25SAlexander Motin } fields; 1839e749f25SAlexander Motin } tcp_seg_setup; 1849e749f25SAlexander Motin }; 1859e749f25SAlexander Motin 1869e749f25SAlexander Motin /* Data descriptor */ 1879e749f25SAlexander Motin struct e1000_data_desc { 1889e749f25SAlexander Motin uint64_t buffer_addr; /* Address of the descriptor's buffer address */ 1899e749f25SAlexander Motin union { 1909e749f25SAlexander Motin uint32_t data; 1919e749f25SAlexander Motin struct { 1929e749f25SAlexander Motin uint16_t length; /* Data buffer length */ 1939e749f25SAlexander Motin uint8_t typ_len_ext; 1949e749f25SAlexander Motin uint8_t cmd; 1959e749f25SAlexander Motin } flags; 1969e749f25SAlexander Motin } lower; 1979e749f25SAlexander Motin union { 1989e749f25SAlexander Motin uint32_t data; 1999e749f25SAlexander Motin struct { 2009e749f25SAlexander Motin uint8_t status; /* Descriptor status */ 2019e749f25SAlexander Motin uint8_t popts; /* Packet Options */ 2029e749f25SAlexander Motin uint16_t special; 2039e749f25SAlexander Motin } fields; 2049e749f25SAlexander Motin } upper; 2059e749f25SAlexander Motin }; 2069e749f25SAlexander Motin 2079e749f25SAlexander Motin union e1000_tx_udesc { 2089e749f25SAlexander Motin struct e1000_tx_desc td; 2099e749f25SAlexander Motin struct e1000_context_desc cd; 2109e749f25SAlexander Motin struct e1000_data_desc dd; 2119e749f25SAlexander Motin }; 2129e749f25SAlexander Motin 2139e749f25SAlexander Motin /* Tx checksum info for a packet. */ 2149e749f25SAlexander Motin struct ck_info { 2159e749f25SAlexander Motin int ck_valid; /* ck_info is valid */ 2169e749f25SAlexander Motin uint8_t ck_start; /* start byte of cksum calcuation */ 2179e749f25SAlexander Motin uint8_t ck_off; /* offset of cksum insertion */ 2189e749f25SAlexander Motin uint16_t ck_len; /* length of cksum calc: 0 is to packet-end */ 2199e749f25SAlexander Motin }; 2209e749f25SAlexander Motin 2219e749f25SAlexander Motin /* 2229e749f25SAlexander Motin * Debug printf 2239e749f25SAlexander Motin */ 2249e749f25SAlexander Motin static int e82545_debug = 0; 2259e749f25SAlexander Motin #define DPRINTF(msg,params...) if (e82545_debug) fprintf(stderr, "e82545: " msg, params) 2269e749f25SAlexander Motin #define WPRINTF(msg,params...) fprintf(stderr, "e82545: " msg, params) 2279e749f25SAlexander Motin 2289e749f25SAlexander Motin #define MIN(a,b) (((a)<(b))?(a):(b)) 2299e749f25SAlexander Motin #define MAX(a,b) (((a)>(b))?(a):(b)) 2309e749f25SAlexander Motin 2319e749f25SAlexander Motin /* s/w representation of the RAL/RAH regs */ 2329e749f25SAlexander Motin struct eth_uni { 2339e749f25SAlexander Motin int eu_valid; 2349e749f25SAlexander Motin int eu_addrsel; 2359e749f25SAlexander Motin struct ether_addr eu_eth; 2369e749f25SAlexander Motin }; 2379e749f25SAlexander Motin 2389e749f25SAlexander Motin 2399e749f25SAlexander Motin struct e82545_softc { 2409e749f25SAlexander Motin struct pci_devinst *esc_pi; 2419e749f25SAlexander Motin struct vmctx *esc_ctx; 2429e749f25SAlexander Motin struct mevent *esc_mevp; 2439e749f25SAlexander Motin struct mevent *esc_mevpitr; 2449e749f25SAlexander Motin pthread_mutex_t esc_mtx; 2459e749f25SAlexander Motin struct ether_addr esc_mac; 2469e749f25SAlexander Motin int esc_tapfd; 2479e749f25SAlexander Motin 2489e749f25SAlexander Motin /* General */ 2499e749f25SAlexander Motin uint32_t esc_CTRL; /* x0000 device ctl */ 2509e749f25SAlexander Motin uint32_t esc_FCAL; /* x0028 flow ctl addr lo */ 2519e749f25SAlexander Motin uint32_t esc_FCAH; /* x002C flow ctl addr hi */ 2529e749f25SAlexander Motin uint32_t esc_FCT; /* x0030 flow ctl type */ 2539e749f25SAlexander Motin uint32_t esc_VET; /* x0038 VLAN eth type */ 2549e749f25SAlexander Motin uint32_t esc_FCTTV; /* x0170 flow ctl tx timer */ 2559e749f25SAlexander Motin uint32_t esc_LEDCTL; /* x0E00 LED control */ 2569e749f25SAlexander Motin uint32_t esc_PBA; /* x1000 pkt buffer allocation */ 2579e749f25SAlexander Motin 2589e749f25SAlexander Motin /* Interrupt control */ 2599e749f25SAlexander Motin int esc_irq_asserted; 2609e749f25SAlexander Motin uint32_t esc_ICR; /* x00C0 cause read/clear */ 2619e749f25SAlexander Motin uint32_t esc_ITR; /* x00C4 intr throttling */ 2629e749f25SAlexander Motin uint32_t esc_ICS; /* x00C8 cause set */ 2639e749f25SAlexander Motin uint32_t esc_IMS; /* x00D0 mask set/read */ 2649e749f25SAlexander Motin uint32_t esc_IMC; /* x00D8 mask clear */ 2659e749f25SAlexander Motin 2669e749f25SAlexander Motin /* Transmit */ 2679e749f25SAlexander Motin union e1000_tx_udesc *esc_txdesc; 2689e749f25SAlexander Motin struct e1000_context_desc esc_txctx; 2699e749f25SAlexander Motin pthread_t esc_tx_tid; 2709e749f25SAlexander Motin pthread_cond_t esc_tx_cond; 2719e749f25SAlexander Motin int esc_tx_enabled; 2729e749f25SAlexander Motin int esc_tx_active; 2739e749f25SAlexander Motin uint32_t esc_TXCW; /* x0178 transmit config */ 2749e749f25SAlexander Motin uint32_t esc_TCTL; /* x0400 transmit ctl */ 2759e749f25SAlexander Motin uint32_t esc_TIPG; /* x0410 inter-packet gap */ 2769e749f25SAlexander Motin uint16_t esc_AIT; /* x0458 Adaptive Interframe Throttle */ 2779e749f25SAlexander Motin uint64_t esc_tdba; /* verified 64-bit desc table addr */ 2789e749f25SAlexander Motin uint32_t esc_TDBAL; /* x3800 desc table addr, low bits */ 2799e749f25SAlexander Motin uint32_t esc_TDBAH; /* x3804 desc table addr, hi 32-bits */ 2809e749f25SAlexander Motin uint32_t esc_TDLEN; /* x3808 # descriptors in bytes */ 2819e749f25SAlexander Motin uint16_t esc_TDH; /* x3810 desc table head idx */ 2829e749f25SAlexander Motin uint16_t esc_TDHr; /* internal read version of TDH */ 2839e749f25SAlexander Motin uint16_t esc_TDT; /* x3818 desc table tail idx */ 2849e749f25SAlexander Motin uint32_t esc_TIDV; /* x3820 intr delay */ 2859e749f25SAlexander Motin uint32_t esc_TXDCTL; /* x3828 desc control */ 2869e749f25SAlexander Motin uint32_t esc_TADV; /* x382C intr absolute delay */ 2879e749f25SAlexander Motin 2889e749f25SAlexander Motin /* L2 frame acceptance */ 2899e749f25SAlexander Motin struct eth_uni esc_uni[16]; /* 16 x unicast MAC addresses */ 2909e749f25SAlexander Motin uint32_t esc_fmcast[128]; /* Multicast filter bit-match */ 2919e749f25SAlexander Motin uint32_t esc_fvlan[128]; /* VLAN 4096-bit filter */ 2929e749f25SAlexander Motin 2939e749f25SAlexander Motin /* Receive */ 2949e749f25SAlexander Motin struct e1000_rx_desc *esc_rxdesc; 2959e749f25SAlexander Motin pthread_cond_t esc_rx_cond; 2969e749f25SAlexander Motin int esc_rx_enabled; 2979e749f25SAlexander Motin int esc_rx_active; 2989e749f25SAlexander Motin int esc_rx_loopback; 2999e749f25SAlexander Motin uint32_t esc_RCTL; /* x0100 receive ctl */ 3009e749f25SAlexander Motin uint32_t esc_FCRTL; /* x2160 flow cntl thresh, low */ 3019e749f25SAlexander Motin uint32_t esc_FCRTH; /* x2168 flow cntl thresh, hi */ 3029e749f25SAlexander Motin uint64_t esc_rdba; /* verified 64-bit desc table addr */ 3039e749f25SAlexander Motin uint32_t esc_RDBAL; /* x2800 desc table addr, low bits */ 3049e749f25SAlexander Motin uint32_t esc_RDBAH; /* x2804 desc table addr, hi 32-bits*/ 3059e749f25SAlexander Motin uint32_t esc_RDLEN; /* x2808 #descriptors */ 3069e749f25SAlexander Motin uint16_t esc_RDH; /* x2810 desc table head idx */ 3079e749f25SAlexander Motin uint16_t esc_RDT; /* x2818 desc table tail idx */ 3089e749f25SAlexander Motin uint32_t esc_RDTR; /* x2820 intr delay */ 3099e749f25SAlexander Motin uint32_t esc_RXDCTL; /* x2828 desc control */ 3109e749f25SAlexander Motin uint32_t esc_RADV; /* x282C intr absolute delay */ 3119e749f25SAlexander Motin uint32_t esc_RSRPD; /* x2C00 recv small packet detect */ 3129e749f25SAlexander Motin uint32_t esc_RXCSUM; /* x5000 receive cksum ctl */ 3139e749f25SAlexander Motin 3149e749f25SAlexander Motin /* IO Port register access */ 3159e749f25SAlexander Motin uint32_t io_addr; 3169e749f25SAlexander Motin 3179e749f25SAlexander Motin /* Shadow copy of MDIC */ 3189e749f25SAlexander Motin uint32_t mdi_control; 3199e749f25SAlexander Motin /* Shadow copy of EECD */ 3209e749f25SAlexander Motin uint32_t eeprom_control; 3219e749f25SAlexander Motin /* Latest NVM in/out */ 3229e749f25SAlexander Motin uint16_t nvm_data; 3239e749f25SAlexander Motin uint16_t nvm_opaddr; 3249e749f25SAlexander Motin /* stats */ 3259e749f25SAlexander Motin uint32_t missed_pkt_count; /* dropped for no room in rx queue */ 3269e749f25SAlexander Motin uint32_t pkt_rx_by_size[6]; 3279e749f25SAlexander Motin uint32_t pkt_tx_by_size[6]; 3289e749f25SAlexander Motin uint32_t good_pkt_rx_count; 3299e749f25SAlexander Motin uint32_t bcast_pkt_rx_count; 3309e749f25SAlexander Motin uint32_t mcast_pkt_rx_count; 3319e749f25SAlexander Motin uint32_t good_pkt_tx_count; 3329e749f25SAlexander Motin uint32_t bcast_pkt_tx_count; 3339e749f25SAlexander Motin uint32_t mcast_pkt_tx_count; 3349e749f25SAlexander Motin uint32_t oversize_rx_count; 3359e749f25SAlexander Motin uint32_t tso_tx_count; 3369e749f25SAlexander Motin uint64_t good_octets_rx; 3379e749f25SAlexander Motin uint64_t good_octets_tx; 3389e749f25SAlexander Motin uint64_t missed_octets; /* counts missed and oversized */ 3399e749f25SAlexander Motin 3409e749f25SAlexander Motin uint8_t nvm_bits:6; /* number of bits remaining in/out */ 3419e749f25SAlexander Motin uint8_t nvm_mode:2; 3429e749f25SAlexander Motin #define E82545_NVM_MODE_OPADDR 0x0 3439e749f25SAlexander Motin #define E82545_NVM_MODE_DATAIN 0x1 3449e749f25SAlexander Motin #define E82545_NVM_MODE_DATAOUT 0x2 3459e749f25SAlexander Motin /* EEPROM data */ 3469e749f25SAlexander Motin uint16_t eeprom_data[E82545_NVM_EEPROM_SIZE]; 3479e749f25SAlexander Motin }; 3489e749f25SAlexander Motin 3499e749f25SAlexander Motin static void e82545_reset(struct e82545_softc *sc, int dev); 3509e749f25SAlexander Motin static void e82545_rx_enable(struct e82545_softc *sc); 3519e749f25SAlexander Motin static void e82545_rx_disable(struct e82545_softc *sc); 3529e749f25SAlexander Motin static void e82545_tap_callback(int fd, enum ev_type type, void *param); 3539e749f25SAlexander Motin static void e82545_tx_start(struct e82545_softc *sc); 3549e749f25SAlexander Motin static void e82545_tx_enable(struct e82545_softc *sc); 3559e749f25SAlexander Motin static void e82545_tx_disable(struct e82545_softc *sc); 3569e749f25SAlexander Motin 3579e749f25SAlexander Motin static inline int 3589e749f25SAlexander Motin e82545_size_stat_index(uint32_t size) 3599e749f25SAlexander Motin { 3609e749f25SAlexander Motin if (size <= 64) { 3619e749f25SAlexander Motin return 0; 3629e749f25SAlexander Motin } else if (size >= 1024) { 3639e749f25SAlexander Motin return 5; 3649e749f25SAlexander Motin } else { 3659e749f25SAlexander Motin /* should be 1-4 */ 3669e749f25SAlexander Motin return (ffs(size) - 6); 3679e749f25SAlexander Motin } 3689e749f25SAlexander Motin } 3699e749f25SAlexander Motin 3709e749f25SAlexander Motin static void 3719e749f25SAlexander Motin e82545_init_eeprom(struct e82545_softc *sc) 3729e749f25SAlexander Motin { 3739e749f25SAlexander Motin uint16_t checksum, i; 3749e749f25SAlexander Motin 3759e749f25SAlexander Motin /* mac addr */ 3769e749f25SAlexander Motin sc->eeprom_data[NVM_MAC_ADDR] = ((uint16_t)sc->esc_mac.octet[0]) | 3779e749f25SAlexander Motin (((uint16_t)sc->esc_mac.octet[1]) << 8); 3789e749f25SAlexander Motin sc->eeprom_data[NVM_MAC_ADDR+1] = ((uint16_t)sc->esc_mac.octet[2]) | 3799e749f25SAlexander Motin (((uint16_t)sc->esc_mac.octet[3]) << 8); 3809e749f25SAlexander Motin sc->eeprom_data[NVM_MAC_ADDR+2] = ((uint16_t)sc->esc_mac.octet[4]) | 3819e749f25SAlexander Motin (((uint16_t)sc->esc_mac.octet[5]) << 8); 3829e749f25SAlexander Motin 3839e749f25SAlexander Motin /* pci ids */ 3849e749f25SAlexander Motin sc->eeprom_data[NVM_SUB_DEV_ID] = E82545_SUBDEV_ID; 3859e749f25SAlexander Motin sc->eeprom_data[NVM_SUB_VEN_ID] = E82545_VENDOR_ID_INTEL; 3869e749f25SAlexander Motin sc->eeprom_data[NVM_DEV_ID] = E82545_DEV_ID_82545EM_COPPER; 3879e749f25SAlexander Motin sc->eeprom_data[NVM_VEN_ID] = E82545_VENDOR_ID_INTEL; 3889e749f25SAlexander Motin 3899e749f25SAlexander Motin /* fill in the checksum */ 3909e749f25SAlexander Motin checksum = 0; 3919e749f25SAlexander Motin for (i = 0; i < NVM_CHECKSUM_REG; i++) { 3929e749f25SAlexander Motin checksum += sc->eeprom_data[i]; 3939e749f25SAlexander Motin } 3949e749f25SAlexander Motin checksum = NVM_SUM - checksum; 3959e749f25SAlexander Motin sc->eeprom_data[NVM_CHECKSUM_REG] = checksum; 3969e749f25SAlexander Motin DPRINTF("eeprom checksum: 0x%x\r\n", checksum); 3979e749f25SAlexander Motin } 3989e749f25SAlexander Motin 3999e749f25SAlexander Motin static void 4009e749f25SAlexander Motin e82545_write_mdi(struct e82545_softc *sc, uint8_t reg_addr, 4019e749f25SAlexander Motin uint8_t phy_addr, uint32_t data) 4029e749f25SAlexander Motin { 4039e749f25SAlexander Motin DPRINTF("Write mdi reg:0x%x phy:0x%x data: 0x%x\r\n", reg_addr, phy_addr, data); 4049e749f25SAlexander Motin } 4059e749f25SAlexander Motin 4069e749f25SAlexander Motin static uint32_t 4079e749f25SAlexander Motin e82545_read_mdi(struct e82545_softc *sc, uint8_t reg_addr, 4089e749f25SAlexander Motin uint8_t phy_addr) 4099e749f25SAlexander Motin { 4109e749f25SAlexander Motin //DPRINTF("Read mdi reg:0x%x phy:0x%x\r\n", reg_addr, phy_addr); 4119e749f25SAlexander Motin switch (reg_addr) { 4129e749f25SAlexander Motin case PHY_STATUS: 4139e749f25SAlexander Motin return (MII_SR_LINK_STATUS | MII_SR_AUTONEG_CAPS | 4149e749f25SAlexander Motin MII_SR_AUTONEG_COMPLETE); 4159e749f25SAlexander Motin case PHY_AUTONEG_ADV: 4169e749f25SAlexander Motin return NWAY_AR_SELECTOR_FIELD; 4179e749f25SAlexander Motin case PHY_LP_ABILITY: 4189e749f25SAlexander Motin return 0; 4199e749f25SAlexander Motin case PHY_1000T_STATUS: 4209e749f25SAlexander Motin return (SR_1000T_LP_FD_CAPS | SR_1000T_REMOTE_RX_STATUS | 4219e749f25SAlexander Motin SR_1000T_LOCAL_RX_STATUS); 4229e749f25SAlexander Motin case PHY_ID1: 4239e749f25SAlexander Motin return (M88E1011_I_PHY_ID >> 16) & 0xFFFF; 4249e749f25SAlexander Motin case PHY_ID2: 4259e749f25SAlexander Motin return (M88E1011_I_PHY_ID | E82545_REVISION_4) & 0xFFFF; 4269e749f25SAlexander Motin default: 4279e749f25SAlexander Motin DPRINTF("Unknown mdi read reg:0x%x phy:0x%x\r\n", reg_addr, phy_addr); 4289e749f25SAlexander Motin return 0; 4299e749f25SAlexander Motin } 4309e749f25SAlexander Motin /* not reached */ 4319e749f25SAlexander Motin } 4329e749f25SAlexander Motin 4339e749f25SAlexander Motin static void 4349e749f25SAlexander Motin e82545_eecd_strobe(struct e82545_softc *sc) 4359e749f25SAlexander Motin { 4369e749f25SAlexander Motin /* Microwire state machine */ 4379e749f25SAlexander Motin /* 4389e749f25SAlexander Motin DPRINTF("eeprom state machine srtobe " 4399e749f25SAlexander Motin "0x%x 0x%x 0x%x 0x%x\r\n", 4409e749f25SAlexander Motin sc->nvm_mode, sc->nvm_bits, 4419e749f25SAlexander Motin sc->nvm_opaddr, sc->nvm_data);*/ 4429e749f25SAlexander Motin 4439e749f25SAlexander Motin if (sc->nvm_bits == 0) { 4449e749f25SAlexander Motin DPRINTF("eeprom state machine not expecting data! " 4459e749f25SAlexander Motin "0x%x 0x%x 0x%x 0x%x\r\n", 4469e749f25SAlexander Motin sc->nvm_mode, sc->nvm_bits, 4479e749f25SAlexander Motin sc->nvm_opaddr, sc->nvm_data); 4489e749f25SAlexander Motin return; 4499e749f25SAlexander Motin } 4509e749f25SAlexander Motin sc->nvm_bits--; 4519e749f25SAlexander Motin if (sc->nvm_mode == E82545_NVM_MODE_DATAOUT) { 4529e749f25SAlexander Motin /* shifting out */ 4539e749f25SAlexander Motin if (sc->nvm_data & 0x8000) { 4549e749f25SAlexander Motin sc->eeprom_control |= E1000_EECD_DO; 4559e749f25SAlexander Motin } else { 4569e749f25SAlexander Motin sc->eeprom_control &= ~E1000_EECD_DO; 4579e749f25SAlexander Motin } 4589e749f25SAlexander Motin sc->nvm_data <<= 1; 4599e749f25SAlexander Motin if (sc->nvm_bits == 0) { 4609e749f25SAlexander Motin /* read done, back to opcode mode. */ 4619e749f25SAlexander Motin sc->nvm_opaddr = 0; 4629e749f25SAlexander Motin sc->nvm_mode = E82545_NVM_MODE_OPADDR; 4639e749f25SAlexander Motin sc->nvm_bits = E82545_NVM_OPADDR_BITS; 4649e749f25SAlexander Motin } 4659e749f25SAlexander Motin } else if (sc->nvm_mode == E82545_NVM_MODE_DATAIN) { 4669e749f25SAlexander Motin /* shifting in */ 4679e749f25SAlexander Motin sc->nvm_data <<= 1; 4689e749f25SAlexander Motin if (sc->eeprom_control & E1000_EECD_DI) { 4699e749f25SAlexander Motin sc->nvm_data |= 1; 4709e749f25SAlexander Motin } 4719e749f25SAlexander Motin if (sc->nvm_bits == 0) { 4729e749f25SAlexander Motin /* eeprom write */ 4739e749f25SAlexander Motin uint16_t op = sc->nvm_opaddr & E82545_NVM_OPCODE_MASK; 4749e749f25SAlexander Motin uint16_t addr = sc->nvm_opaddr & E82545_NVM_ADDR_MASK; 4759e749f25SAlexander Motin if (op != E82545_NVM_OPCODE_WRITE) { 4769e749f25SAlexander Motin DPRINTF("Illegal eeprom write op 0x%x\r\n", 4779e749f25SAlexander Motin sc->nvm_opaddr); 4789e749f25SAlexander Motin } else if (addr >= E82545_NVM_EEPROM_SIZE) { 4799e749f25SAlexander Motin DPRINTF("Illegal eeprom write addr 0x%x\r\n", 4809e749f25SAlexander Motin sc->nvm_opaddr); 4819e749f25SAlexander Motin } else { 4829e749f25SAlexander Motin DPRINTF("eeprom write eeprom[0x%x] = 0x%x\r\n", 4839e749f25SAlexander Motin addr, sc->nvm_data); 4849e749f25SAlexander Motin sc->eeprom_data[addr] = sc->nvm_data; 4859e749f25SAlexander Motin } 4869e749f25SAlexander Motin /* back to opcode mode */ 4879e749f25SAlexander Motin sc->nvm_opaddr = 0; 4889e749f25SAlexander Motin sc->nvm_mode = E82545_NVM_MODE_OPADDR; 4899e749f25SAlexander Motin sc->nvm_bits = E82545_NVM_OPADDR_BITS; 4909e749f25SAlexander Motin } 4919e749f25SAlexander Motin } else if (sc->nvm_mode == E82545_NVM_MODE_OPADDR) { 4929e749f25SAlexander Motin sc->nvm_opaddr <<= 1; 4939e749f25SAlexander Motin if (sc->eeprom_control & E1000_EECD_DI) { 4949e749f25SAlexander Motin sc->nvm_opaddr |= 1; 4959e749f25SAlexander Motin } 4969e749f25SAlexander Motin if (sc->nvm_bits == 0) { 4979e749f25SAlexander Motin uint16_t op = sc->nvm_opaddr & E82545_NVM_OPCODE_MASK; 4989e749f25SAlexander Motin switch (op) { 4999e749f25SAlexander Motin case E82545_NVM_OPCODE_EWEN: 5009e749f25SAlexander Motin DPRINTF("eeprom write enable: 0x%x\r\n", 5019e749f25SAlexander Motin sc->nvm_opaddr); 5029e749f25SAlexander Motin /* back to opcode mode */ 5039e749f25SAlexander Motin sc->nvm_opaddr = 0; 5049e749f25SAlexander Motin sc->nvm_mode = E82545_NVM_MODE_OPADDR; 5059e749f25SAlexander Motin sc->nvm_bits = E82545_NVM_OPADDR_BITS; 5069e749f25SAlexander Motin break; 5079e749f25SAlexander Motin case E82545_NVM_OPCODE_READ: 5089e749f25SAlexander Motin { 5099e749f25SAlexander Motin uint16_t addr = sc->nvm_opaddr & 5109e749f25SAlexander Motin E82545_NVM_ADDR_MASK; 5119e749f25SAlexander Motin sc->nvm_mode = E82545_NVM_MODE_DATAOUT; 5129e749f25SAlexander Motin sc->nvm_bits = E82545_NVM_DATA_BITS; 5139e749f25SAlexander Motin if (addr < E82545_NVM_EEPROM_SIZE) { 5149e749f25SAlexander Motin sc->nvm_data = sc->eeprom_data[addr]; 5159e749f25SAlexander Motin DPRINTF("eeprom read: eeprom[0x%x] = 0x%x\r\n", 5169e749f25SAlexander Motin addr, sc->nvm_data); 5179e749f25SAlexander Motin } else { 5189e749f25SAlexander Motin DPRINTF("eeprom illegal read: 0x%x\r\n", 5199e749f25SAlexander Motin sc->nvm_opaddr); 5209e749f25SAlexander Motin sc->nvm_data = 0; 5219e749f25SAlexander Motin } 5229e749f25SAlexander Motin break; 5239e749f25SAlexander Motin } 5249e749f25SAlexander Motin case E82545_NVM_OPCODE_WRITE: 5259e749f25SAlexander Motin sc->nvm_mode = E82545_NVM_MODE_DATAIN; 5269e749f25SAlexander Motin sc->nvm_bits = E82545_NVM_DATA_BITS; 5279e749f25SAlexander Motin sc->nvm_data = 0; 5289e749f25SAlexander Motin break; 5299e749f25SAlexander Motin default: 5309e749f25SAlexander Motin DPRINTF("eeprom unknown op: 0x%x\r\r", 5319e749f25SAlexander Motin sc->nvm_opaddr); 5329e749f25SAlexander Motin /* back to opcode mode */ 5339e749f25SAlexander Motin sc->nvm_opaddr = 0; 5349e749f25SAlexander Motin sc->nvm_mode = E82545_NVM_MODE_OPADDR; 5359e749f25SAlexander Motin sc->nvm_bits = E82545_NVM_OPADDR_BITS; 5369e749f25SAlexander Motin } 5379e749f25SAlexander Motin } 5389e749f25SAlexander Motin } else { 5399e749f25SAlexander Motin DPRINTF("eeprom state machine wrong state! " 5409e749f25SAlexander Motin "0x%x 0x%x 0x%x 0x%x\r\n", 5419e749f25SAlexander Motin sc->nvm_mode, sc->nvm_bits, 5429e749f25SAlexander Motin sc->nvm_opaddr, sc->nvm_data); 5439e749f25SAlexander Motin } 5449e749f25SAlexander Motin } 5459e749f25SAlexander Motin 5469e749f25SAlexander Motin static void 5479e749f25SAlexander Motin e82545_itr_callback(int fd, enum ev_type type, void *param) 5489e749f25SAlexander Motin { 5499e749f25SAlexander Motin uint32_t new; 5509e749f25SAlexander Motin struct e82545_softc *sc = param; 5519e749f25SAlexander Motin 5529e749f25SAlexander Motin pthread_mutex_lock(&sc->esc_mtx); 5539e749f25SAlexander Motin new = sc->esc_ICR & sc->esc_IMS; 5549e749f25SAlexander Motin if (new && !sc->esc_irq_asserted) { 5559e749f25SAlexander Motin DPRINTF("itr callback: lintr assert %x\r\n", new); 5569e749f25SAlexander Motin sc->esc_irq_asserted = 1; 5579e749f25SAlexander Motin pci_lintr_assert(sc->esc_pi); 5589e749f25SAlexander Motin } else { 5599e749f25SAlexander Motin mevent_delete(sc->esc_mevpitr); 5609e749f25SAlexander Motin sc->esc_mevpitr = NULL; 5619e749f25SAlexander Motin } 5629e749f25SAlexander Motin pthread_mutex_unlock(&sc->esc_mtx); 5639e749f25SAlexander Motin } 5649e749f25SAlexander Motin 5659e749f25SAlexander Motin static void 5669e749f25SAlexander Motin e82545_icr_assert(struct e82545_softc *sc, uint32_t bits) 5679e749f25SAlexander Motin { 5689e749f25SAlexander Motin uint32_t new; 5699e749f25SAlexander Motin 5709e749f25SAlexander Motin DPRINTF("icr assert: 0x%x\r\n", bits); 5719e749f25SAlexander Motin 5729e749f25SAlexander Motin /* 5739e749f25SAlexander Motin * An interrupt is only generated if bits are set that 5749e749f25SAlexander Motin * aren't already in the ICR, these bits are unmasked, 5759e749f25SAlexander Motin * and there isn't an interrupt already pending. 5769e749f25SAlexander Motin */ 5779e749f25SAlexander Motin new = bits & ~sc->esc_ICR & sc->esc_IMS; 5789e749f25SAlexander Motin sc->esc_ICR |= bits; 5799e749f25SAlexander Motin 5809e749f25SAlexander Motin if (new == 0) { 5819e749f25SAlexander Motin DPRINTF("icr assert: masked %x, ims %x\r\n", new, sc->esc_IMS); 5829e749f25SAlexander Motin } else if (sc->esc_mevpitr != NULL) { 5839e749f25SAlexander Motin DPRINTF("icr assert: throttled %x, ims %x\r\n", new, sc->esc_IMS); 5849e749f25SAlexander Motin } else if (!sc->esc_irq_asserted) { 5859e749f25SAlexander Motin DPRINTF("icr assert: lintr assert %x\r\n", new); 5869e749f25SAlexander Motin sc->esc_irq_asserted = 1; 5879e749f25SAlexander Motin pci_lintr_assert(sc->esc_pi); 5889e749f25SAlexander Motin if (sc->esc_ITR != 0) { 5899e749f25SAlexander Motin sc->esc_mevpitr = mevent_add( 5909e749f25SAlexander Motin (sc->esc_ITR + 3905) / 3906, /* 256ns -> 1ms */ 5919e749f25SAlexander Motin EVF_TIMER, e82545_itr_callback, sc); 5929e749f25SAlexander Motin } 5939e749f25SAlexander Motin } 5949e749f25SAlexander Motin } 5959e749f25SAlexander Motin 5969e749f25SAlexander Motin static void 5979e749f25SAlexander Motin e82545_ims_change(struct e82545_softc *sc, uint32_t bits) 5989e749f25SAlexander Motin { 5999e749f25SAlexander Motin uint32_t new; 6009e749f25SAlexander Motin 6019e749f25SAlexander Motin /* 6029e749f25SAlexander Motin * Changing the mask may allow previously asserted 6039e749f25SAlexander Motin * but masked interrupt requests to generate an interrupt. 6049e749f25SAlexander Motin */ 6059e749f25SAlexander Motin new = bits & sc->esc_ICR & ~sc->esc_IMS; 6069e749f25SAlexander Motin sc->esc_IMS |= bits; 6079e749f25SAlexander Motin 6089e749f25SAlexander Motin if (new == 0) { 6099e749f25SAlexander Motin DPRINTF("ims change: masked %x, ims %x\r\n", new, sc->esc_IMS); 6109e749f25SAlexander Motin } else if (sc->esc_mevpitr != NULL) { 6119e749f25SAlexander Motin DPRINTF("ims change: throttled %x, ims %x\r\n", new, sc->esc_IMS); 6129e749f25SAlexander Motin } else if (!sc->esc_irq_asserted) { 6139e749f25SAlexander Motin DPRINTF("ims change: lintr assert %x\n\r", new); 6149e749f25SAlexander Motin sc->esc_irq_asserted = 1; 6159e749f25SAlexander Motin pci_lintr_assert(sc->esc_pi); 6169e749f25SAlexander Motin if (sc->esc_ITR != 0) { 6179e749f25SAlexander Motin sc->esc_mevpitr = mevent_add( 6189e749f25SAlexander Motin (sc->esc_ITR + 3905) / 3906, /* 256ns -> 1ms */ 6199e749f25SAlexander Motin EVF_TIMER, e82545_itr_callback, sc); 6209e749f25SAlexander Motin } 6219e749f25SAlexander Motin } 6229e749f25SAlexander Motin } 6239e749f25SAlexander Motin 6249e749f25SAlexander Motin static void 6259e749f25SAlexander Motin e82545_icr_deassert(struct e82545_softc *sc, uint32_t bits) 6269e749f25SAlexander Motin { 6279e749f25SAlexander Motin 6289e749f25SAlexander Motin DPRINTF("icr deassert: 0x%x\r\n", bits); 6299e749f25SAlexander Motin sc->esc_ICR &= ~bits; 6309e749f25SAlexander Motin 6319e749f25SAlexander Motin /* 6329e749f25SAlexander Motin * If there are no longer any interrupt sources and there 6339e749f25SAlexander Motin * was an asserted interrupt, clear it 6349e749f25SAlexander Motin */ 6359e749f25SAlexander Motin if (sc->esc_irq_asserted && !(sc->esc_ICR & sc->esc_IMS)) { 6369e749f25SAlexander Motin DPRINTF("icr deassert: lintr deassert %x\r\n", bits); 6379e749f25SAlexander Motin pci_lintr_deassert(sc->esc_pi); 6389e749f25SAlexander Motin sc->esc_irq_asserted = 0; 6399e749f25SAlexander Motin } 6409e749f25SAlexander Motin } 6419e749f25SAlexander Motin 6429e749f25SAlexander Motin static void 6439e749f25SAlexander Motin e82545_intr_write(struct e82545_softc *sc, uint32_t offset, uint32_t value) 6449e749f25SAlexander Motin { 6459e749f25SAlexander Motin 6469e749f25SAlexander Motin DPRINTF("intr_write: off %x, val %x\n\r", offset, value); 6479e749f25SAlexander Motin 6489e749f25SAlexander Motin switch (offset) { 6499e749f25SAlexander Motin case E1000_ICR: 6509e749f25SAlexander Motin e82545_icr_deassert(sc, value); 6519e749f25SAlexander Motin break; 6529e749f25SAlexander Motin case E1000_ITR: 6539e749f25SAlexander Motin sc->esc_ITR = value; 6549e749f25SAlexander Motin break; 6559e749f25SAlexander Motin case E1000_ICS: 6569e749f25SAlexander Motin sc->esc_ICS = value; /* not used: store for debug */ 6579e749f25SAlexander Motin e82545_icr_assert(sc, value); 6589e749f25SAlexander Motin break; 6599e749f25SAlexander Motin case E1000_IMS: 6609e749f25SAlexander Motin e82545_ims_change(sc, value); 6619e749f25SAlexander Motin break; 6629e749f25SAlexander Motin case E1000_IMC: 6639e749f25SAlexander Motin sc->esc_IMC = value; /* for debug */ 6649e749f25SAlexander Motin sc->esc_IMS &= ~value; 6659e749f25SAlexander Motin // XXX clear interrupts if all ICR bits now masked 6669e749f25SAlexander Motin // and interrupt was pending ? 6679e749f25SAlexander Motin break; 6689e749f25SAlexander Motin default: 6699e749f25SAlexander Motin break; 6709e749f25SAlexander Motin } 6719e749f25SAlexander Motin } 6729e749f25SAlexander Motin 6739e749f25SAlexander Motin static uint32_t 6749e749f25SAlexander Motin e82545_intr_read(struct e82545_softc *sc, uint32_t offset) 6759e749f25SAlexander Motin { 6769e749f25SAlexander Motin uint32_t retval; 6779e749f25SAlexander Motin 6789e749f25SAlexander Motin retval = 0; 6799e749f25SAlexander Motin 6809e749f25SAlexander Motin DPRINTF("intr_read: off %x\n\r", offset); 6819e749f25SAlexander Motin 6829e749f25SAlexander Motin switch (offset) { 6839e749f25SAlexander Motin case E1000_ICR: 6849e749f25SAlexander Motin retval = sc->esc_ICR; 6859e749f25SAlexander Motin sc->esc_ICR = 0; 6869e749f25SAlexander Motin e82545_icr_deassert(sc, ~0); 6879e749f25SAlexander Motin break; 6889e749f25SAlexander Motin case E1000_ITR: 6899e749f25SAlexander Motin retval = sc->esc_ITR; 6909e749f25SAlexander Motin break; 6919e749f25SAlexander Motin case E1000_ICS: 6929e749f25SAlexander Motin /* write-only register */ 6939e749f25SAlexander Motin break; 6949e749f25SAlexander Motin case E1000_IMS: 6959e749f25SAlexander Motin retval = sc->esc_IMS; 6969e749f25SAlexander Motin break; 6979e749f25SAlexander Motin case E1000_IMC: 6989e749f25SAlexander Motin /* write-only register */ 6999e749f25SAlexander Motin break; 7009e749f25SAlexander Motin default: 7019e749f25SAlexander Motin break; 7029e749f25SAlexander Motin } 7039e749f25SAlexander Motin 7049e749f25SAlexander Motin return (retval); 7059e749f25SAlexander Motin } 7069e749f25SAlexander Motin 7079e749f25SAlexander Motin static void 7089e749f25SAlexander Motin e82545_devctl(struct e82545_softc *sc, uint32_t val) 7099e749f25SAlexander Motin { 7109e749f25SAlexander Motin 7119e749f25SAlexander Motin sc->esc_CTRL = val & ~E1000_CTRL_RST; 7129e749f25SAlexander Motin 7139e749f25SAlexander Motin if (val & E1000_CTRL_RST) { 7149e749f25SAlexander Motin DPRINTF("e1k: s/w reset, ctl %x\n", val); 7159e749f25SAlexander Motin e82545_reset(sc, 1); 7169e749f25SAlexander Motin } 7179e749f25SAlexander Motin /* XXX check for phy reset ? */ 7189e749f25SAlexander Motin } 7199e749f25SAlexander Motin 7209e749f25SAlexander Motin static void 7219e749f25SAlexander Motin e82545_rx_update_rdba(struct e82545_softc *sc) 7229e749f25SAlexander Motin { 7239e749f25SAlexander Motin 7249e749f25SAlexander Motin /* XXX verify desc base/len within phys mem range */ 7259e749f25SAlexander Motin sc->esc_rdba = (uint64_t)sc->esc_RDBAH << 32 | 7269e749f25SAlexander Motin sc->esc_RDBAL; 7279e749f25SAlexander Motin 7289e749f25SAlexander Motin /* Cache host mapping of guest descriptor array */ 7299e749f25SAlexander Motin sc->esc_rxdesc = paddr_guest2host(sc->esc_ctx, 7309e749f25SAlexander Motin sc->esc_rdba, sc->esc_RDLEN); 7319e749f25SAlexander Motin } 7329e749f25SAlexander Motin 7339e749f25SAlexander Motin static void 7349e749f25SAlexander Motin e82545_rx_ctl(struct e82545_softc *sc, uint32_t val) 7359e749f25SAlexander Motin { 7369e749f25SAlexander Motin int on; 7379e749f25SAlexander Motin 7389e749f25SAlexander Motin on = ((val & E1000_RCTL_EN) == E1000_RCTL_EN); 7399e749f25SAlexander Motin 7409e749f25SAlexander Motin /* Save RCTL after stripping reserved bits 31:27,24,21,14,11:10,0 */ 7419e749f25SAlexander Motin sc->esc_RCTL = val & ~0xF9204c01; 7429e749f25SAlexander Motin 7439e749f25SAlexander Motin DPRINTF("rx_ctl - %s RCTL %x, val %x\n", 7449e749f25SAlexander Motin on ? "on" : "off", sc->esc_RCTL, val); 7459e749f25SAlexander Motin 7469e749f25SAlexander Motin /* state change requested */ 7479e749f25SAlexander Motin if (on != sc->esc_rx_enabled) { 7489e749f25SAlexander Motin if (on) { 7499e749f25SAlexander Motin /* Catch disallowed/unimplemented settings */ 7509e749f25SAlexander Motin //assert(!(val & E1000_RCTL_LBM_TCVR)); 7519e749f25SAlexander Motin 7529e749f25SAlexander Motin if (sc->esc_RCTL & E1000_RCTL_LBM_TCVR) { 7539e749f25SAlexander Motin sc->esc_rx_loopback = 1; 7549e749f25SAlexander Motin } else { 7559e749f25SAlexander Motin sc->esc_rx_loopback = 0; 7569e749f25SAlexander Motin } 7579e749f25SAlexander Motin 7589e749f25SAlexander Motin e82545_rx_update_rdba(sc); 7599e749f25SAlexander Motin e82545_rx_enable(sc); 7609e749f25SAlexander Motin } else { 7619e749f25SAlexander Motin e82545_rx_disable(sc); 7629e749f25SAlexander Motin sc->esc_rx_loopback = 0; 7639e749f25SAlexander Motin sc->esc_rdba = 0; 7649e749f25SAlexander Motin sc->esc_rxdesc = NULL; 7659e749f25SAlexander Motin } 7669e749f25SAlexander Motin } 7679e749f25SAlexander Motin } 7689e749f25SAlexander Motin 7699e749f25SAlexander Motin static void 7709e749f25SAlexander Motin e82545_tx_update_tdba(struct e82545_softc *sc) 7719e749f25SAlexander Motin { 7729e749f25SAlexander Motin 7739e749f25SAlexander Motin /* XXX verify desc base/len within phys mem range */ 7749e749f25SAlexander Motin sc->esc_tdba = (uint64_t)sc->esc_TDBAH << 32 | sc->esc_TDBAL; 7759e749f25SAlexander Motin 7769e749f25SAlexander Motin /* Cache host mapping of guest descriptor array */ 7779e749f25SAlexander Motin sc->esc_txdesc = paddr_guest2host(sc->esc_ctx, sc->esc_tdba, 7789e749f25SAlexander Motin sc->esc_TDLEN); 7799e749f25SAlexander Motin } 7809e749f25SAlexander Motin 7819e749f25SAlexander Motin static void 7829e749f25SAlexander Motin e82545_tx_ctl(struct e82545_softc *sc, uint32_t val) 7839e749f25SAlexander Motin { 7849e749f25SAlexander Motin int on; 7859e749f25SAlexander Motin 7869e749f25SAlexander Motin on = ((val & E1000_TCTL_EN) == E1000_TCTL_EN); 7879e749f25SAlexander Motin 7889e749f25SAlexander Motin /* ignore TCTL_EN settings that don't change state */ 7899e749f25SAlexander Motin if (on == sc->esc_tx_enabled) 7909e749f25SAlexander Motin return; 7919e749f25SAlexander Motin 7929e749f25SAlexander Motin if (on) { 7939e749f25SAlexander Motin e82545_tx_update_tdba(sc); 7949e749f25SAlexander Motin e82545_tx_enable(sc); 7959e749f25SAlexander Motin } else { 7969e749f25SAlexander Motin e82545_tx_disable(sc); 7979e749f25SAlexander Motin sc->esc_tdba = 0; 7989e749f25SAlexander Motin sc->esc_txdesc = NULL; 7999e749f25SAlexander Motin } 8009e749f25SAlexander Motin 8019e749f25SAlexander Motin /* Save TCTL value after stripping reserved bits 31:25,23,2,0 */ 8029e749f25SAlexander Motin sc->esc_TCTL = val & ~0xFE800005; 8039e749f25SAlexander Motin } 8049e749f25SAlexander Motin 8059e749f25SAlexander Motin int 8069e749f25SAlexander Motin e82545_bufsz(uint32_t rctl) 8079e749f25SAlexander Motin { 8089e749f25SAlexander Motin 8099e749f25SAlexander Motin switch (rctl & (E1000_RCTL_BSEX | E1000_RCTL_SZ_256)) { 8109e749f25SAlexander Motin case (E1000_RCTL_SZ_2048): return (2048); 8119e749f25SAlexander Motin case (E1000_RCTL_SZ_1024): return (1024); 8129e749f25SAlexander Motin case (E1000_RCTL_SZ_512): return (512); 8139e749f25SAlexander Motin case (E1000_RCTL_SZ_256): return (256); 8149e749f25SAlexander Motin case (E1000_RCTL_BSEX|E1000_RCTL_SZ_16384): return (16384); 8159e749f25SAlexander Motin case (E1000_RCTL_BSEX|E1000_RCTL_SZ_8192): return (8192); 8169e749f25SAlexander Motin case (E1000_RCTL_BSEX|E1000_RCTL_SZ_4096): return (4096); 8179e749f25SAlexander Motin } 8189e749f25SAlexander Motin return (256); /* Forbidden value. */ 8199e749f25SAlexander Motin } 8209e749f25SAlexander Motin 8219e749f25SAlexander Motin static uint8_t dummybuf[2048]; 8229e749f25SAlexander Motin 8239e749f25SAlexander Motin /* XXX one packet at a time until this is debugged */ 8249e749f25SAlexander Motin static void 8259e749f25SAlexander Motin e82545_tap_callback(int fd, enum ev_type type, void *param) 8269e749f25SAlexander Motin { 8279e749f25SAlexander Motin struct e82545_softc *sc = param; 8289e749f25SAlexander Motin struct e1000_rx_desc *rxd; 8299e749f25SAlexander Motin struct iovec vec[64]; 8309e749f25SAlexander Motin int left, len, lim, maxpktsz, maxpktdesc, bufsz, i, n, size; 8319e749f25SAlexander Motin uint32_t cause = 0; 8329e749f25SAlexander Motin uint16_t *tp, tag, head; 8339e749f25SAlexander Motin 8349e749f25SAlexander Motin pthread_mutex_lock(&sc->esc_mtx); 8359e749f25SAlexander Motin DPRINTF("rx_run: head %x, tail %x\r\n", sc->esc_RDH, sc->esc_RDT); 8369e749f25SAlexander Motin 8379e749f25SAlexander Motin if (!sc->esc_rx_enabled || sc->esc_rx_loopback) { 8389e749f25SAlexander Motin DPRINTF("rx disabled (!%d || %d) -- packet(s) dropped\r\n", 8399e749f25SAlexander Motin sc->esc_rx_enabled, sc->esc_rx_loopback); 8409e749f25SAlexander Motin while (read(sc->esc_tapfd, dummybuf, sizeof(dummybuf)) > 0) { 8419e749f25SAlexander Motin } 8429e749f25SAlexander Motin goto done1; 8439e749f25SAlexander Motin } 8449e749f25SAlexander Motin bufsz = e82545_bufsz(sc->esc_RCTL); 8459e749f25SAlexander Motin maxpktsz = (sc->esc_RCTL & E1000_RCTL_LPE) ? 16384 : 1522; 8469e749f25SAlexander Motin maxpktdesc = (maxpktsz + bufsz - 1) / bufsz; 8479e749f25SAlexander Motin size = sc->esc_RDLEN / 16; 8489e749f25SAlexander Motin head = sc->esc_RDH; 8499e749f25SAlexander Motin left = (size + sc->esc_RDT - head) % size; 8509e749f25SAlexander Motin if (left < maxpktdesc) { 8519e749f25SAlexander Motin DPRINTF("rx overflow (%d < %d) -- packet(s) dropped\r\n", 8529e749f25SAlexander Motin left, maxpktdesc); 8539e749f25SAlexander Motin while (read(sc->esc_tapfd, dummybuf, sizeof(dummybuf)) > 0) { 8549e749f25SAlexander Motin } 8559e749f25SAlexander Motin goto done1; 8569e749f25SAlexander Motin } 8579e749f25SAlexander Motin 8589e749f25SAlexander Motin sc->esc_rx_active = 1; 8599e749f25SAlexander Motin pthread_mutex_unlock(&sc->esc_mtx); 8609e749f25SAlexander Motin 8619e749f25SAlexander Motin for (lim = size / 4; lim > 0 && left >= maxpktdesc; lim -= n) { 8629e749f25SAlexander Motin 8639e749f25SAlexander Motin /* Grab rx descriptor pointed to by the head pointer */ 8649e749f25SAlexander Motin for (i = 0; i < maxpktdesc; i++) { 8659e749f25SAlexander Motin rxd = &sc->esc_rxdesc[(head + i) % size]; 8669e749f25SAlexander Motin vec[i].iov_base = paddr_guest2host(sc->esc_ctx, 8679e749f25SAlexander Motin rxd->buffer_addr, bufsz); 8689e749f25SAlexander Motin vec[i].iov_len = bufsz; 8699e749f25SAlexander Motin } 8709e749f25SAlexander Motin len = readv(sc->esc_tapfd, vec, maxpktdesc); 8719e749f25SAlexander Motin if (len <= 0) { 8729e749f25SAlexander Motin DPRINTF("tap: readv() returned %d\n", len); 8739e749f25SAlexander Motin goto done; 8749e749f25SAlexander Motin } 8759e749f25SAlexander Motin 8769e749f25SAlexander Motin /* 8779e749f25SAlexander Motin * Adjust the packet length based on whether the CRC needs 8789e749f25SAlexander Motin * to be stripped or if the packet is less than the minimum 8799e749f25SAlexander Motin * eth packet size. 8809e749f25SAlexander Motin */ 8819e749f25SAlexander Motin if (len < ETHER_MIN_LEN - ETHER_CRC_LEN) 8829e749f25SAlexander Motin len = ETHER_MIN_LEN - ETHER_CRC_LEN; 8839e749f25SAlexander Motin if (!(sc->esc_RCTL & E1000_RCTL_SECRC)) 8849e749f25SAlexander Motin len += ETHER_CRC_LEN; 8859e749f25SAlexander Motin n = (len + bufsz - 1) / bufsz; 8869e749f25SAlexander Motin 8879e749f25SAlexander Motin DPRINTF("packet read %d bytes, %d segs, head %d\r\n", 8889e749f25SAlexander Motin len, n, head); 8899e749f25SAlexander Motin 8909e749f25SAlexander Motin /* Apply VLAN filter. */ 8919e749f25SAlexander Motin tp = (uint16_t *)vec[0].iov_base + 6; 8929e749f25SAlexander Motin if ((sc->esc_RCTL & E1000_RCTL_VFE) && 8939e749f25SAlexander Motin (ntohs(tp[0]) == sc->esc_VET)) { 8949e749f25SAlexander Motin tag = ntohs(tp[1]) & 0x0fff; 8959e749f25SAlexander Motin if ((sc->esc_fvlan[tag >> 5] & 8969e749f25SAlexander Motin (1 << (tag & 0x1f))) != 0) { 8979e749f25SAlexander Motin DPRINTF("known VLAN %d\r\n", tag); 8989e749f25SAlexander Motin } else { 8999e749f25SAlexander Motin DPRINTF("unknown VLAN %d\r\n", tag); 9009e749f25SAlexander Motin n = 0; 9019e749f25SAlexander Motin continue; 9029e749f25SAlexander Motin } 9039e749f25SAlexander Motin } 9049e749f25SAlexander Motin 9059e749f25SAlexander Motin /* Update all consumed descriptors. */ 9069e749f25SAlexander Motin for (i = 0; i < n - 1; i++) { 9079e749f25SAlexander Motin rxd = &sc->esc_rxdesc[(head + i) % size]; 9089e749f25SAlexander Motin rxd->length = bufsz; 9099e749f25SAlexander Motin rxd->csum = 0; 9109e749f25SAlexander Motin rxd->errors = 0; 9119e749f25SAlexander Motin rxd->special = 0; 9129e749f25SAlexander Motin rxd->status = E1000_RXD_STAT_DD; 9139e749f25SAlexander Motin } 9149e749f25SAlexander Motin rxd = &sc->esc_rxdesc[(head + i) % size]; 9159e749f25SAlexander Motin rxd->length = len % bufsz; 9169e749f25SAlexander Motin rxd->csum = 0; 9179e749f25SAlexander Motin rxd->errors = 0; 9189e749f25SAlexander Motin rxd->special = 0; 9199e749f25SAlexander Motin /* XXX signal no checksum for now */ 9209e749f25SAlexander Motin rxd->status = E1000_RXD_STAT_PIF | E1000_RXD_STAT_IXSM | 9219e749f25SAlexander Motin E1000_RXD_STAT_EOP | E1000_RXD_STAT_DD; 9229e749f25SAlexander Motin 9239e749f25SAlexander Motin /* Schedule receive interrupts. */ 9249e749f25SAlexander Motin if (len <= sc->esc_RSRPD) { 9259e749f25SAlexander Motin cause |= E1000_ICR_SRPD | E1000_ICR_RXT0; 9269e749f25SAlexander Motin } else { 9279e749f25SAlexander Motin /* XXX: RDRT and RADV timers should be here. */ 9289e749f25SAlexander Motin cause |= E1000_ICR_RXT0; 9299e749f25SAlexander Motin } 9309e749f25SAlexander Motin 9319e749f25SAlexander Motin head = (head + n) % size; 9329e749f25SAlexander Motin left -= n; 9339e749f25SAlexander Motin } 9349e749f25SAlexander Motin 9359e749f25SAlexander Motin done: 9369e749f25SAlexander Motin pthread_mutex_lock(&sc->esc_mtx); 9379e749f25SAlexander Motin sc->esc_rx_active = 0; 9389e749f25SAlexander Motin if (sc->esc_rx_enabled == 0) 9399e749f25SAlexander Motin pthread_cond_signal(&sc->esc_rx_cond); 9409e749f25SAlexander Motin 9419e749f25SAlexander Motin sc->esc_RDH = head; 9429e749f25SAlexander Motin /* Respect E1000_RCTL_RDMTS */ 9439e749f25SAlexander Motin left = (size + sc->esc_RDT - head) % size; 9449e749f25SAlexander Motin if (left < (size >> (((sc->esc_RCTL >> 8) & 3) + 1))) 9459e749f25SAlexander Motin cause |= E1000_ICR_RXDMT0; 9469e749f25SAlexander Motin /* Assert all accumulated interrupts. */ 9479e749f25SAlexander Motin if (cause != 0) 9489e749f25SAlexander Motin e82545_icr_assert(sc, cause); 9499e749f25SAlexander Motin done1: 9509e749f25SAlexander Motin DPRINTF("rx_run done: head %x, tail %x\r\n", sc->esc_RDH, sc->esc_RDT); 9519e749f25SAlexander Motin pthread_mutex_unlock(&sc->esc_mtx); 9529e749f25SAlexander Motin } 9539e749f25SAlexander Motin 9549e749f25SAlexander Motin static uint16_t 9559e749f25SAlexander Motin e82545_carry(uint32_t sum) 9569e749f25SAlexander Motin { 9579e749f25SAlexander Motin 9589e749f25SAlexander Motin sum = (sum & 0xFFFF) + (sum >> 16); 9599e749f25SAlexander Motin if (sum > 0xFFFF) 9609e749f25SAlexander Motin sum -= 0xFFFF; 9619e749f25SAlexander Motin return (sum); 9629e749f25SAlexander Motin } 9639e749f25SAlexander Motin 9649e749f25SAlexander Motin static uint16_t 9659e749f25SAlexander Motin e82545_buf_checksum(uint8_t *buf, int len) 9669e749f25SAlexander Motin { 9679e749f25SAlexander Motin int i; 9689e749f25SAlexander Motin uint32_t sum = 0; 9699e749f25SAlexander Motin 9709e749f25SAlexander Motin /* Checksum all the pairs of bytes first... */ 9719e749f25SAlexander Motin for (i = 0; i < (len & ~1U); i += 2) 9729e749f25SAlexander Motin sum += *((u_int16_t *)(buf + i)); 9739e749f25SAlexander Motin 9749e749f25SAlexander Motin /* 9759e749f25SAlexander Motin * If there's a single byte left over, checksum it, too. 9769e749f25SAlexander Motin * Network byte order is big-endian, so the remaining byte is 9779e749f25SAlexander Motin * the high byte. 9789e749f25SAlexander Motin */ 9799e749f25SAlexander Motin if (i < len) 9809e749f25SAlexander Motin sum += htons(buf[i] << 8); 9819e749f25SAlexander Motin 9829e749f25SAlexander Motin return (e82545_carry(sum)); 9839e749f25SAlexander Motin } 9849e749f25SAlexander Motin 9859e749f25SAlexander Motin static uint16_t 9869e749f25SAlexander Motin e82545_iov_checksum(struct iovec *iov, int iovcnt, int off, int len) 9879e749f25SAlexander Motin { 9889e749f25SAlexander Motin int now, odd; 9899e749f25SAlexander Motin uint32_t sum = 0, s; 9909e749f25SAlexander Motin 9919e749f25SAlexander Motin /* Skip completely unneeded vectors. */ 9929e749f25SAlexander Motin while (iovcnt > 0 && iov->iov_len <= off && off > 0) { 9939e749f25SAlexander Motin off -= iov->iov_len; 9949e749f25SAlexander Motin iov++; 9959e749f25SAlexander Motin iovcnt--; 9969e749f25SAlexander Motin } 9979e749f25SAlexander Motin 9989e749f25SAlexander Motin /* Calculate checksum of requested range. */ 9999e749f25SAlexander Motin odd = 0; 10009e749f25SAlexander Motin while (len > 0 && iovcnt > 0) { 10019e749f25SAlexander Motin now = MIN(len, iov->iov_len - off); 10029e749f25SAlexander Motin s = e82545_buf_checksum(iov->iov_base + off, now); 10039e749f25SAlexander Motin sum += odd ? (s << 8) : s; 10049e749f25SAlexander Motin odd ^= (now & 1); 10059e749f25SAlexander Motin len -= now; 10069e749f25SAlexander Motin off = 0; 10079e749f25SAlexander Motin iov++; 10089e749f25SAlexander Motin iovcnt--; 10099e749f25SAlexander Motin } 10109e749f25SAlexander Motin 10119e749f25SAlexander Motin return (e82545_carry(sum)); 10129e749f25SAlexander Motin } 10139e749f25SAlexander Motin 10149e749f25SAlexander Motin /* 10159e749f25SAlexander Motin * Return the transmit descriptor type. 10169e749f25SAlexander Motin */ 10179e749f25SAlexander Motin int 10189e749f25SAlexander Motin e82545_txdesc_type(uint32_t lower) 10199e749f25SAlexander Motin { 10209e749f25SAlexander Motin int type; 10219e749f25SAlexander Motin 10229e749f25SAlexander Motin type = 0; 10239e749f25SAlexander Motin 10249e749f25SAlexander Motin if (lower & E1000_TXD_CMD_DEXT) 10259e749f25SAlexander Motin type = lower & E1000_TXD_MASK; 10269e749f25SAlexander Motin 10279e749f25SAlexander Motin return (type); 10289e749f25SAlexander Motin } 10299e749f25SAlexander Motin 10309e749f25SAlexander Motin static void 10319e749f25SAlexander Motin e82545_transmit_checksum(struct iovec *iov, int iovcnt, struct ck_info *ck) 10329e749f25SAlexander Motin { 10339e749f25SAlexander Motin uint16_t cksum; 10349e749f25SAlexander Motin int cklen; 10359e749f25SAlexander Motin 10369e749f25SAlexander Motin DPRINTF("tx cksum: iovcnt/s/off/len %d/%d/%d/%d\r\n", 10379e749f25SAlexander Motin iovcnt, ck->ck_start, ck->ck_off, ck->ck_len); 10389e749f25SAlexander Motin cklen = ck->ck_len ? ck->ck_len - ck->ck_start + 1 : INT_MAX; 10399e749f25SAlexander Motin cksum = e82545_iov_checksum(iov, iovcnt, ck->ck_start, cklen); 10409e749f25SAlexander Motin *(uint16_t *)((uint8_t *)iov[0].iov_base + ck->ck_off) = ~cksum; 10419e749f25SAlexander Motin } 10429e749f25SAlexander Motin 10439e749f25SAlexander Motin static void 10449e749f25SAlexander Motin e82545_transmit_backend(struct e82545_softc *sc, struct iovec *iov, int iovcnt) 10459e749f25SAlexander Motin { 10469e749f25SAlexander Motin 10479e749f25SAlexander Motin if (sc->esc_tapfd == -1) 10489e749f25SAlexander Motin return; 10499e749f25SAlexander Motin 10509e749f25SAlexander Motin (void) writev(sc->esc_tapfd, iov, iovcnt); 10519e749f25SAlexander Motin } 10529e749f25SAlexander Motin 10539e749f25SAlexander Motin static void 1054ee7230f4SAlexander Motin e82545_transmit_done(struct e82545_softc *sc, uint16_t head, uint16_t tail, 1055ee7230f4SAlexander Motin uint16_t dsize, int *tdwb) 10569e749f25SAlexander Motin { 1057ee7230f4SAlexander Motin union e1000_tx_udesc *dsc; 10589e749f25SAlexander Motin 1059ee7230f4SAlexander Motin for ( ; head != tail; head = (head + 1) % dsize) { 1060ee7230f4SAlexander Motin dsc = &sc->esc_txdesc[head]; 1061ee7230f4SAlexander Motin if (dsc->td.lower.data & E1000_TXD_CMD_RS) { 1062ee7230f4SAlexander Motin dsc->td.upper.data |= E1000_TXD_STAT_DD; 1063ee7230f4SAlexander Motin *tdwb = 1; 1064ee7230f4SAlexander Motin } 1065ee7230f4SAlexander Motin } 10669e749f25SAlexander Motin } 10679e749f25SAlexander Motin 10689e749f25SAlexander Motin static int 10699e749f25SAlexander Motin e82545_transmit(struct e82545_softc *sc, uint16_t head, uint16_t tail, 10709e749f25SAlexander Motin uint16_t dsize, uint16_t *rhead, int *tdwb) 10719e749f25SAlexander Motin { 10729e749f25SAlexander Motin uint8_t *hdr, *hdrp; 10739e749f25SAlexander Motin struct iovec iovb[I82545_MAX_TXSEGS + 2]; 10749e749f25SAlexander Motin struct iovec tiov[I82545_MAX_TXSEGS + 2]; 10759e749f25SAlexander Motin struct e1000_context_desc *cd; 10769e749f25SAlexander Motin struct ck_info ckinfo[2]; 10779e749f25SAlexander Motin struct iovec *iov; 10789e749f25SAlexander Motin union e1000_tx_udesc *dsc; 1079ee7230f4SAlexander Motin int desc, dtype, len, ntype, iovcnt, tlen, hdrlen, vlen, tcp, tso; 10809e749f25SAlexander Motin int mss, paylen, seg, tiovcnt, left, now, nleft, nnow, pv, pvoff; 10819e749f25SAlexander Motin uint32_t tcpsum, tcpseq; 1082ee7230f4SAlexander Motin uint16_t ipcs, tcpcs, ipid, ohead; 10839e749f25SAlexander Motin 10849e749f25SAlexander Motin ckinfo[0].ck_valid = ckinfo[1].ck_valid = 0; 10859e749f25SAlexander Motin iovcnt = 0; 10869e749f25SAlexander Motin tlen = 0; 10879e749f25SAlexander Motin ntype = 0; 10889e749f25SAlexander Motin tso = 0; 1089ee7230f4SAlexander Motin ohead = head; 10909e749f25SAlexander Motin 10919e749f25SAlexander Motin /* iovb[0/1] may be used for writable copy of headers. */ 10929e749f25SAlexander Motin iov = &iovb[2]; 10939e749f25SAlexander Motin 10949e749f25SAlexander Motin for (desc = 0; ; desc++, head = (head + 1) % dsize) { 10959e749f25SAlexander Motin if (head == tail) { 10969e749f25SAlexander Motin *rhead = head; 10979e749f25SAlexander Motin return (0); 10989e749f25SAlexander Motin } 10999e749f25SAlexander Motin dsc = &sc->esc_txdesc[head]; 11009e749f25SAlexander Motin dtype = e82545_txdesc_type(dsc->td.lower.data); 11019e749f25SAlexander Motin 11029e749f25SAlexander Motin if (desc == 0) { 11039e749f25SAlexander Motin switch (dtype) { 11049e749f25SAlexander Motin case E1000_TXD_TYP_C: 11059e749f25SAlexander Motin DPRINTF("tx ctxt desc idx %d: %016jx " 11069e749f25SAlexander Motin "%08x%08x\r\n", 11079e749f25SAlexander Motin head, dsc->td.buffer_addr, 11089e749f25SAlexander Motin dsc->td.upper.data, dsc->td.lower.data); 11099e749f25SAlexander Motin /* Save context and return */ 11109e749f25SAlexander Motin sc->esc_txctx = dsc->cd; 1111ee7230f4SAlexander Motin goto done; 11129e749f25SAlexander Motin case E1000_TXD_TYP_L: 11139e749f25SAlexander Motin DPRINTF("tx legacy desc idx %d: %08x%08x\r\n", 11149e749f25SAlexander Motin head, dsc->td.upper.data, dsc->td.lower.data); 11159e749f25SAlexander Motin /* 11169e749f25SAlexander Motin * legacy cksum start valid in first descriptor 11179e749f25SAlexander Motin */ 11189e749f25SAlexander Motin ntype = dtype; 11199e749f25SAlexander Motin ckinfo[0].ck_start = dsc->td.upper.fields.css; 11209e749f25SAlexander Motin break; 11219e749f25SAlexander Motin case E1000_TXD_TYP_D: 11229e749f25SAlexander Motin DPRINTF("tx data desc idx %d: %08x%08x\r\n", 11239e749f25SAlexander Motin head, dsc->td.upper.data, dsc->td.lower.data); 11249e749f25SAlexander Motin ntype = dtype; 11259e749f25SAlexander Motin break; 11269e749f25SAlexander Motin default: 11279e749f25SAlexander Motin break; 11289e749f25SAlexander Motin } 11299e749f25SAlexander Motin } else { 11309e749f25SAlexander Motin /* Descriptor type must be consistent */ 11319e749f25SAlexander Motin assert(dtype == ntype); 11329e749f25SAlexander Motin DPRINTF("tx next desc idx %d: %08x%08x\r\n", 11339e749f25SAlexander Motin head, dsc->td.upper.data, dsc->td.lower.data); 11349e749f25SAlexander Motin } 11359e749f25SAlexander Motin 11369e749f25SAlexander Motin len = (dtype == E1000_TXD_TYP_L) ? dsc->td.lower.flags.length : 11379e749f25SAlexander Motin dsc->dd.lower.data & 0xFFFFF; 11389e749f25SAlexander Motin 11399e749f25SAlexander Motin if (len > 0) { 11409e749f25SAlexander Motin /* Strip checksum supplied by guest. */ 11419e749f25SAlexander Motin if ((dsc->td.lower.data & E1000_TXD_CMD_EOP) != 0 && 11429e749f25SAlexander Motin (dsc->td.lower.data & E1000_TXD_CMD_IFCS) == 0) 11439e749f25SAlexander Motin len -= 2; 11449e749f25SAlexander Motin tlen += len; 1145ee7230f4SAlexander Motin if (iovcnt < I82545_MAX_TXSEGS) { 1146ee7230f4SAlexander Motin iov[iovcnt].iov_base = paddr_guest2host( 1147ee7230f4SAlexander Motin sc->esc_ctx, dsc->td.buffer_addr, len); 11489e749f25SAlexander Motin iov[iovcnt].iov_len = len; 1149ee7230f4SAlexander Motin } 11509e749f25SAlexander Motin iovcnt++; 11519e749f25SAlexander Motin } 11529e749f25SAlexander Motin 11539e749f25SAlexander Motin /* 11549e749f25SAlexander Motin * Pull out info that is valid in the final descriptor 11559e749f25SAlexander Motin * and exit descriptor loop. 11569e749f25SAlexander Motin */ 11579e749f25SAlexander Motin if (dsc->td.lower.data & E1000_TXD_CMD_EOP) { 11589e749f25SAlexander Motin if (dtype == E1000_TXD_TYP_L) { 11599e749f25SAlexander Motin if (dsc->td.lower.data & E1000_TXD_CMD_IC) { 11609e749f25SAlexander Motin ckinfo[0].ck_valid = 1; 11619e749f25SAlexander Motin ckinfo[0].ck_off = 11629e749f25SAlexander Motin dsc->td.lower.flags.cso; 11639e749f25SAlexander Motin ckinfo[0].ck_len = 0; 11649e749f25SAlexander Motin } 11659e749f25SAlexander Motin } else { 11669e749f25SAlexander Motin cd = &sc->esc_txctx; 11679e749f25SAlexander Motin if (dsc->dd.lower.data & E1000_TXD_CMD_TSE) 11689e749f25SAlexander Motin tso = 1; 11699e749f25SAlexander Motin if (dsc->dd.upper.fields.popts & 11709e749f25SAlexander Motin E1000_TXD_POPTS_IXSM) 11719e749f25SAlexander Motin ckinfo[0].ck_valid = 1; 11729e749f25SAlexander Motin if (dsc->dd.upper.fields.popts & 11739e749f25SAlexander Motin E1000_TXD_POPTS_IXSM || tso) { 11749e749f25SAlexander Motin ckinfo[0].ck_start = 11759e749f25SAlexander Motin cd->lower_setup.ip_fields.ipcss; 11769e749f25SAlexander Motin ckinfo[0].ck_off = 11779e749f25SAlexander Motin cd->lower_setup.ip_fields.ipcso; 11789e749f25SAlexander Motin ckinfo[0].ck_len = 11799e749f25SAlexander Motin cd->lower_setup.ip_fields.ipcse; 11809e749f25SAlexander Motin } 11819e749f25SAlexander Motin if (dsc->dd.upper.fields.popts & 11829e749f25SAlexander Motin E1000_TXD_POPTS_TXSM) 11839e749f25SAlexander Motin ckinfo[1].ck_valid = 1; 11849e749f25SAlexander Motin if (dsc->dd.upper.fields.popts & 11859e749f25SAlexander Motin E1000_TXD_POPTS_TXSM || tso) { 11869e749f25SAlexander Motin ckinfo[1].ck_start = 11879e749f25SAlexander Motin cd->upper_setup.tcp_fields.tucss; 11889e749f25SAlexander Motin ckinfo[1].ck_off = 11899e749f25SAlexander Motin cd->upper_setup.tcp_fields.tucso; 11909e749f25SAlexander Motin ckinfo[1].ck_len = 11919e749f25SAlexander Motin cd->upper_setup.tcp_fields.tucse; 11929e749f25SAlexander Motin } 11939e749f25SAlexander Motin } 11949e749f25SAlexander Motin break; 11959e749f25SAlexander Motin } 11969e749f25SAlexander Motin } 11979e749f25SAlexander Motin 1198ee7230f4SAlexander Motin if (iovcnt > I82545_MAX_TXSEGS) { 1199ee7230f4SAlexander Motin WPRINTF("tx too many descriptors (%d > %d) -- dropped\r\n", 1200ee7230f4SAlexander Motin iovcnt, I82545_MAX_TXSEGS); 1201ee7230f4SAlexander Motin goto done; 1202ee7230f4SAlexander Motin } 1203ee7230f4SAlexander Motin 12049e749f25SAlexander Motin hdrlen = vlen = 0; 12059e749f25SAlexander Motin /* Estimate writable space for VLAN header insertion. */ 12069e749f25SAlexander Motin if ((sc->esc_CTRL & E1000_CTRL_VME) && 12079e749f25SAlexander Motin (dsc->td.lower.data & E1000_TXD_CMD_VLE)) { 12089e749f25SAlexander Motin hdrlen = ETHER_ADDR_LEN*2; 12099e749f25SAlexander Motin vlen = ETHER_VLAN_ENCAP_LEN; 12109e749f25SAlexander Motin } 12119e749f25SAlexander Motin if (!tso) { 12129e749f25SAlexander Motin /* Estimate required writable space for checksums. */ 12139e749f25SAlexander Motin if (ckinfo[0].ck_valid) 12149e749f25SAlexander Motin hdrlen = MAX(hdrlen, ckinfo[0].ck_off + 2); 12159e749f25SAlexander Motin if (ckinfo[1].ck_valid) 12169e749f25SAlexander Motin hdrlen = MAX(hdrlen, ckinfo[1].ck_off + 2); 12179e749f25SAlexander Motin /* Round up writable space to the first vector. */ 12189e749f25SAlexander Motin if (hdrlen != 0 && iov[0].iov_len > hdrlen && 12199e749f25SAlexander Motin iov[0].iov_len < hdrlen + 100) 12209e749f25SAlexander Motin hdrlen = iov[0].iov_len; 12219e749f25SAlexander Motin } else { 12229e749f25SAlexander Motin /* In case of TSO header length provided by software. */ 12239e749f25SAlexander Motin hdrlen = sc->esc_txctx.tcp_seg_setup.fields.hdr_len; 12249e749f25SAlexander Motin } 12259e749f25SAlexander Motin 12269e749f25SAlexander Motin /* Allocate, fill and prepend writable header vector. */ 12279e749f25SAlexander Motin if (hdrlen != 0) { 12289e749f25SAlexander Motin hdr = __builtin_alloca(hdrlen + vlen); 12299e749f25SAlexander Motin hdr += vlen; 12309e749f25SAlexander Motin for (left = hdrlen, hdrp = hdr; left > 0; 12319e749f25SAlexander Motin left -= now, hdrp += now) { 12329e749f25SAlexander Motin now = MIN(left, iov->iov_len); 12339e749f25SAlexander Motin memcpy(hdrp, iov->iov_base, now); 12349e749f25SAlexander Motin iov->iov_base += now; 12359e749f25SAlexander Motin iov->iov_len -= now; 12369e749f25SAlexander Motin if (iov->iov_len == 0) { 12379e749f25SAlexander Motin iov++; 12389e749f25SAlexander Motin iovcnt--; 12399e749f25SAlexander Motin } 12409e749f25SAlexander Motin } 12419e749f25SAlexander Motin iov--; 12429e749f25SAlexander Motin iovcnt++; 12439e749f25SAlexander Motin iov->iov_base = hdr; 12449e749f25SAlexander Motin iov->iov_len = hdrlen; 12459e749f25SAlexander Motin } 12469e749f25SAlexander Motin 12479e749f25SAlexander Motin /* Insert VLAN tag. */ 12489e749f25SAlexander Motin if (vlen != 0) { 12499e749f25SAlexander Motin hdr -= ETHER_VLAN_ENCAP_LEN; 12509e749f25SAlexander Motin memmove(hdr, hdr + ETHER_VLAN_ENCAP_LEN, ETHER_ADDR_LEN*2); 12519e749f25SAlexander Motin hdrlen += ETHER_VLAN_ENCAP_LEN; 12529e749f25SAlexander Motin hdr[ETHER_ADDR_LEN*2 + 0] = sc->esc_VET >> 8; 12539e749f25SAlexander Motin hdr[ETHER_ADDR_LEN*2 + 1] = sc->esc_VET & 0xff; 12549e749f25SAlexander Motin hdr[ETHER_ADDR_LEN*2 + 2] = dsc->td.upper.fields.special >> 8; 12559e749f25SAlexander Motin hdr[ETHER_ADDR_LEN*2 + 3] = dsc->td.upper.fields.special & 0xff; 12569e749f25SAlexander Motin iov->iov_base = hdr; 12579e749f25SAlexander Motin iov->iov_len += ETHER_VLAN_ENCAP_LEN; 12589e749f25SAlexander Motin /* Correct checksum offsets after VLAN tag insertion. */ 12599e749f25SAlexander Motin ckinfo[0].ck_start += ETHER_VLAN_ENCAP_LEN; 12609e749f25SAlexander Motin ckinfo[0].ck_off += ETHER_VLAN_ENCAP_LEN; 12619e749f25SAlexander Motin if (ckinfo[0].ck_len != 0) 12629e749f25SAlexander Motin ckinfo[0].ck_len += ETHER_VLAN_ENCAP_LEN; 12639e749f25SAlexander Motin ckinfo[1].ck_start += ETHER_VLAN_ENCAP_LEN; 12649e749f25SAlexander Motin ckinfo[1].ck_off += ETHER_VLAN_ENCAP_LEN; 12659e749f25SAlexander Motin if (ckinfo[1].ck_len != 0) 12669e749f25SAlexander Motin ckinfo[1].ck_len += ETHER_VLAN_ENCAP_LEN; 12679e749f25SAlexander Motin } 12689e749f25SAlexander Motin 12699e749f25SAlexander Motin /* Simple non-TSO case. */ 12709e749f25SAlexander Motin if (!tso) { 12719e749f25SAlexander Motin /* Calculate checksums and transmit. */ 12729e749f25SAlexander Motin if (ckinfo[0].ck_valid) 12739e749f25SAlexander Motin e82545_transmit_checksum(iov, iovcnt, &ckinfo[0]); 12749e749f25SAlexander Motin if (ckinfo[1].ck_valid) 12759e749f25SAlexander Motin e82545_transmit_checksum(iov, iovcnt, &ckinfo[1]); 12769e749f25SAlexander Motin e82545_transmit_backend(sc, iov, iovcnt); 12779e749f25SAlexander Motin goto done; 12789e749f25SAlexander Motin } 12799e749f25SAlexander Motin 12809e749f25SAlexander Motin /* Doing TSO. */ 12819e749f25SAlexander Motin tcp = (sc->esc_txctx.cmd_and_length & E1000_TXD_CMD_TCP) != 0; 12829e749f25SAlexander Motin mss = sc->esc_txctx.tcp_seg_setup.fields.mss; 12839e749f25SAlexander Motin paylen = (sc->esc_txctx.cmd_and_length & 0x000fffff); 12849e749f25SAlexander Motin DPRINTF("tx %s segmentation offload %d+%d/%d bytes %d iovs\r\n", 12859e749f25SAlexander Motin tcp ? "TCP" : "UDP", hdrlen, paylen, mss, iovcnt); 12869e749f25SAlexander Motin ipid = ntohs(*(uint16_t *)&hdr[ckinfo[0].ck_start + 4]); 12879e749f25SAlexander Motin tcpseq = ntohl(*(uint32_t *)&hdr[ckinfo[1].ck_start + 4]); 12889e749f25SAlexander Motin ipcs = *(uint16_t *)&hdr[ckinfo[0].ck_off]; 12899e749f25SAlexander Motin tcpcs = 0; 12909e749f25SAlexander Motin if (ckinfo[1].ck_valid) /* Save partial pseudo-header checksum. */ 12919e749f25SAlexander Motin tcpcs = *(uint16_t *)&hdr[ckinfo[1].ck_off]; 12929e749f25SAlexander Motin pv = 1; 12939e749f25SAlexander Motin pvoff = 0; 12949e749f25SAlexander Motin for (seg = 0, left = paylen; left > 0; seg++, left -= now) { 12959e749f25SAlexander Motin now = MIN(left, mss); 12969e749f25SAlexander Motin 12979e749f25SAlexander Motin /* Construct IOVs for the segment. */ 12989e749f25SAlexander Motin /* Include whole original header. */ 12999e749f25SAlexander Motin tiov[0].iov_base = hdr; 13009e749f25SAlexander Motin tiov[0].iov_len = hdrlen; 13019e749f25SAlexander Motin tiovcnt = 1; 13029e749f25SAlexander Motin /* Include respective part of payload IOV. */ 13039e749f25SAlexander Motin for (nleft = now; pv < iovcnt && nleft > 0; nleft -= nnow) { 13049e749f25SAlexander Motin nnow = MIN(nleft, iov[pv].iov_len - pvoff); 13059e749f25SAlexander Motin tiov[tiovcnt].iov_base = iov[pv].iov_base + pvoff; 13069e749f25SAlexander Motin tiov[tiovcnt++].iov_len = nnow; 13079e749f25SAlexander Motin if (pvoff + nnow == iov[pv].iov_len) { 13089e749f25SAlexander Motin pv++; 13099e749f25SAlexander Motin pvoff = 0; 13109e749f25SAlexander Motin } else 13119e749f25SAlexander Motin pvoff += nnow; 13129e749f25SAlexander Motin } 13139e749f25SAlexander Motin DPRINTF("tx segment %d %d+%d bytes %d iovs\r\n", 13149e749f25SAlexander Motin seg, hdrlen, now, tiovcnt); 13159e749f25SAlexander Motin 13169e749f25SAlexander Motin /* Update IP header. */ 13179e749f25SAlexander Motin if (sc->esc_txctx.cmd_and_length & E1000_TXD_CMD_IP) { 13189e749f25SAlexander Motin /* IPv4 -- set length and ID */ 13199e749f25SAlexander Motin *(uint16_t *)&hdr[ckinfo[0].ck_start + 2] = 13209e749f25SAlexander Motin htons(hdrlen - ckinfo[0].ck_start + now); 13219e749f25SAlexander Motin *(uint16_t *)&hdr[ckinfo[0].ck_start + 4] = 13229e749f25SAlexander Motin htons(ipid + seg); 13239e749f25SAlexander Motin } else { 13249e749f25SAlexander Motin /* IPv6 -- set length */ 13259e749f25SAlexander Motin *(uint16_t *)&hdr[ckinfo[0].ck_start + 4] = 13269e749f25SAlexander Motin htons(hdrlen - ckinfo[0].ck_start - 40 + 13279e749f25SAlexander Motin now); 13289e749f25SAlexander Motin } 13299e749f25SAlexander Motin 13309e749f25SAlexander Motin /* Update pseudo-header checksum. */ 13319e749f25SAlexander Motin tcpsum = tcpcs; 13329e749f25SAlexander Motin tcpsum += htons(hdrlen - ckinfo[1].ck_start + now); 13339e749f25SAlexander Motin 13349e749f25SAlexander Motin /* Update TCP/UDP headers. */ 13359e749f25SAlexander Motin if (tcp) { 13369e749f25SAlexander Motin /* Update sequence number and FIN/PUSH flags. */ 13379e749f25SAlexander Motin *(uint32_t *)&hdr[ckinfo[1].ck_start + 4] = 13389e749f25SAlexander Motin htonl(tcpseq + paylen - left); 13399e749f25SAlexander Motin if (now < left) { 13409e749f25SAlexander Motin hdr[ckinfo[1].ck_start + 13] &= 13419e749f25SAlexander Motin ~(TH_FIN | TH_PUSH); 13429e749f25SAlexander Motin } 13439e749f25SAlexander Motin } else { 13449e749f25SAlexander Motin /* Update payload length. */ 13459e749f25SAlexander Motin *(uint32_t *)&hdr[ckinfo[1].ck_start + 4] = 13469e749f25SAlexander Motin hdrlen - ckinfo[1].ck_start + now; 13479e749f25SAlexander Motin } 13489e749f25SAlexander Motin 13499e749f25SAlexander Motin /* Calculate checksums and transmit. */ 13509e749f25SAlexander Motin if (ckinfo[0].ck_valid) { 13519e749f25SAlexander Motin *(uint16_t *)&hdr[ckinfo[0].ck_off] = ipcs; 13529e749f25SAlexander Motin e82545_transmit_checksum(tiov, tiovcnt, &ckinfo[0]); 13539e749f25SAlexander Motin } 13549e749f25SAlexander Motin if (ckinfo[1].ck_valid) { 13559e749f25SAlexander Motin *(uint16_t *)&hdr[ckinfo[1].ck_off] = 13569e749f25SAlexander Motin e82545_carry(tcpsum); 13579e749f25SAlexander Motin e82545_transmit_checksum(tiov, tiovcnt, &ckinfo[1]); 13589e749f25SAlexander Motin } 13599e749f25SAlexander Motin e82545_transmit_backend(sc, tiov, tiovcnt); 13609e749f25SAlexander Motin } 13619e749f25SAlexander Motin 13629e749f25SAlexander Motin done: 1363ee7230f4SAlexander Motin head = (head + 1) % dsize; 1364ee7230f4SAlexander Motin e82545_transmit_done(sc, ohead, head, dsize, tdwb); 13659e749f25SAlexander Motin 1366ee7230f4SAlexander Motin *rhead = head; 13679e749f25SAlexander Motin return (desc + 1); 13689e749f25SAlexander Motin } 13699e749f25SAlexander Motin 13709e749f25SAlexander Motin static void 13719e749f25SAlexander Motin e82545_tx_run(struct e82545_softc *sc) 13729e749f25SAlexander Motin { 13739e749f25SAlexander Motin uint32_t cause; 13749e749f25SAlexander Motin uint16_t head, rhead, tail, size; 13759e749f25SAlexander Motin int lim, tdwb, sent; 13769e749f25SAlexander Motin 13779e749f25SAlexander Motin head = sc->esc_TDH; 13789e749f25SAlexander Motin tail = sc->esc_TDT; 13799e749f25SAlexander Motin size = sc->esc_TDLEN / 16; 13809e749f25SAlexander Motin DPRINTF("tx_run: head %x, rhead %x, tail %x\r\n", 13819e749f25SAlexander Motin sc->esc_TDH, sc->esc_TDHr, sc->esc_TDT); 13829e749f25SAlexander Motin 13839e749f25SAlexander Motin pthread_mutex_unlock(&sc->esc_mtx); 13849e749f25SAlexander Motin rhead = head; 13859e749f25SAlexander Motin tdwb = 0; 13869e749f25SAlexander Motin for (lim = size / 4; sc->esc_tx_enabled && lim > 0; lim -= sent) { 13879e749f25SAlexander Motin sent = e82545_transmit(sc, head, tail, size, &rhead, &tdwb); 13889e749f25SAlexander Motin if (sent == 0) 13899e749f25SAlexander Motin break; 13909e749f25SAlexander Motin head = rhead; 13919e749f25SAlexander Motin } 13929e749f25SAlexander Motin pthread_mutex_lock(&sc->esc_mtx); 13939e749f25SAlexander Motin 13949e749f25SAlexander Motin sc->esc_TDH = head; 13959e749f25SAlexander Motin sc->esc_TDHr = rhead; 13969e749f25SAlexander Motin cause = 0; 13979e749f25SAlexander Motin if (tdwb) 13989e749f25SAlexander Motin cause |= E1000_ICR_TXDW; 13999e749f25SAlexander Motin if (lim != size / 4 && sc->esc_TDH == sc->esc_TDT) 14009e749f25SAlexander Motin cause |= E1000_ICR_TXQE; 14019e749f25SAlexander Motin if (cause) 14029e749f25SAlexander Motin e82545_icr_assert(sc, cause); 14039e749f25SAlexander Motin 14049e749f25SAlexander Motin DPRINTF("tx_run done: head %x, rhead %x, tail %x\r\n", 14059e749f25SAlexander Motin sc->esc_TDH, sc->esc_TDHr, sc->esc_TDT); 14069e749f25SAlexander Motin } 14079e749f25SAlexander Motin 1408*558e4950SRyan Libby static _Noreturn void * 14099e749f25SAlexander Motin e82545_tx_thread(void *param) 14109e749f25SAlexander Motin { 14119e749f25SAlexander Motin struct e82545_softc *sc = param; 14129e749f25SAlexander Motin 14139e749f25SAlexander Motin pthread_mutex_lock(&sc->esc_mtx); 14149e749f25SAlexander Motin for (;;) { 14159e749f25SAlexander Motin while (!sc->esc_tx_enabled || sc->esc_TDHr == sc->esc_TDT) { 14169e749f25SAlexander Motin if (sc->esc_tx_enabled && sc->esc_TDHr != sc->esc_TDT) 14179e749f25SAlexander Motin break; 14189e749f25SAlexander Motin sc->esc_tx_active = 0; 14199e749f25SAlexander Motin if (sc->esc_tx_enabled == 0) 14209e749f25SAlexander Motin pthread_cond_signal(&sc->esc_tx_cond); 14219e749f25SAlexander Motin pthread_cond_wait(&sc->esc_tx_cond, &sc->esc_mtx); 14229e749f25SAlexander Motin } 14239e749f25SAlexander Motin sc->esc_tx_active = 1; 14249e749f25SAlexander Motin 14259e749f25SAlexander Motin /* Process some tx descriptors. Lock dropped inside. */ 14269e749f25SAlexander Motin e82545_tx_run(sc); 14279e749f25SAlexander Motin } 14289e749f25SAlexander Motin } 14299e749f25SAlexander Motin 14309e749f25SAlexander Motin static void 14319e749f25SAlexander Motin e82545_tx_start(struct e82545_softc *sc) 14329e749f25SAlexander Motin { 14339e749f25SAlexander Motin 14349e749f25SAlexander Motin if (sc->esc_tx_active == 0) 14359e749f25SAlexander Motin pthread_cond_signal(&sc->esc_tx_cond); 14369e749f25SAlexander Motin } 14379e749f25SAlexander Motin 14389e749f25SAlexander Motin static void 14399e749f25SAlexander Motin e82545_tx_enable(struct e82545_softc *sc) 14409e749f25SAlexander Motin { 14419e749f25SAlexander Motin 14429e749f25SAlexander Motin sc->esc_tx_enabled = 1; 14439e749f25SAlexander Motin } 14449e749f25SAlexander Motin 14459e749f25SAlexander Motin static void 14469e749f25SAlexander Motin e82545_tx_disable(struct e82545_softc *sc) 14479e749f25SAlexander Motin { 14489e749f25SAlexander Motin 14499e749f25SAlexander Motin sc->esc_tx_enabled = 0; 14509e749f25SAlexander Motin while (sc->esc_tx_active) 14519e749f25SAlexander Motin pthread_cond_wait(&sc->esc_tx_cond, &sc->esc_mtx); 14529e749f25SAlexander Motin } 14539e749f25SAlexander Motin 14549e749f25SAlexander Motin static void 14559e749f25SAlexander Motin e82545_rx_enable(struct e82545_softc *sc) 14569e749f25SAlexander Motin { 14579e749f25SAlexander Motin 14589e749f25SAlexander Motin sc->esc_rx_enabled = 1; 14599e749f25SAlexander Motin } 14609e749f25SAlexander Motin 14619e749f25SAlexander Motin static void 14629e749f25SAlexander Motin e82545_rx_disable(struct e82545_softc *sc) 14639e749f25SAlexander Motin { 14649e749f25SAlexander Motin 14659e749f25SAlexander Motin sc->esc_rx_enabled = 0; 14669e749f25SAlexander Motin while (sc->esc_rx_active) 14679e749f25SAlexander Motin pthread_cond_wait(&sc->esc_rx_cond, &sc->esc_mtx); 14689e749f25SAlexander Motin } 14699e749f25SAlexander Motin 14709e749f25SAlexander Motin static void 14719e749f25SAlexander Motin e82545_write_ra(struct e82545_softc *sc, int reg, uint32_t wval) 14729e749f25SAlexander Motin { 14739e749f25SAlexander Motin struct eth_uni *eu; 14749e749f25SAlexander Motin int idx; 14759e749f25SAlexander Motin 14769e749f25SAlexander Motin idx = reg >> 1; 14779e749f25SAlexander Motin assert(idx < 15); 14789e749f25SAlexander Motin 14799e749f25SAlexander Motin eu = &sc->esc_uni[idx]; 14809e749f25SAlexander Motin 14819e749f25SAlexander Motin if (reg & 0x1) { 14829e749f25SAlexander Motin /* RAH */ 14839e749f25SAlexander Motin eu->eu_valid = ((wval & E1000_RAH_AV) == E1000_RAH_AV); 14849e749f25SAlexander Motin eu->eu_addrsel = (wval >> 16) & 0x3; 14859e749f25SAlexander Motin eu->eu_eth.octet[5] = wval >> 8; 14869e749f25SAlexander Motin eu->eu_eth.octet[4] = wval; 14879e749f25SAlexander Motin } else { 14889e749f25SAlexander Motin /* RAL */ 14899e749f25SAlexander Motin eu->eu_eth.octet[3] = wval >> 24; 14909e749f25SAlexander Motin eu->eu_eth.octet[2] = wval >> 16; 14919e749f25SAlexander Motin eu->eu_eth.octet[1] = wval >> 8; 14929e749f25SAlexander Motin eu->eu_eth.octet[0] = wval; 14939e749f25SAlexander Motin } 14949e749f25SAlexander Motin } 14959e749f25SAlexander Motin 14969e749f25SAlexander Motin static uint32_t 14979e749f25SAlexander Motin e82545_read_ra(struct e82545_softc *sc, int reg) 14989e749f25SAlexander Motin { 14999e749f25SAlexander Motin struct eth_uni *eu; 15009e749f25SAlexander Motin uint32_t retval; 15019e749f25SAlexander Motin int idx; 15029e749f25SAlexander Motin 15039e749f25SAlexander Motin idx = reg >> 1; 15049e749f25SAlexander Motin assert(idx < 15); 15059e749f25SAlexander Motin 15069e749f25SAlexander Motin eu = &sc->esc_uni[idx]; 15079e749f25SAlexander Motin 15089e749f25SAlexander Motin if (reg & 0x1) { 15099e749f25SAlexander Motin /* RAH */ 15109e749f25SAlexander Motin retval = (eu->eu_valid << 31) | 15119e749f25SAlexander Motin (eu->eu_addrsel << 16) | 15129e749f25SAlexander Motin (eu->eu_eth.octet[5] << 8) | 15139e749f25SAlexander Motin eu->eu_eth.octet[4]; 15149e749f25SAlexander Motin } else { 15159e749f25SAlexander Motin /* RAL */ 15169e749f25SAlexander Motin retval = (eu->eu_eth.octet[3] << 24) | 15179e749f25SAlexander Motin (eu->eu_eth.octet[2] << 16) | 15189e749f25SAlexander Motin (eu->eu_eth.octet[1] << 8) | 15199e749f25SAlexander Motin eu->eu_eth.octet[0]; 15209e749f25SAlexander Motin } 15219e749f25SAlexander Motin 15229e749f25SAlexander Motin return (retval); 15239e749f25SAlexander Motin } 15249e749f25SAlexander Motin 15259e749f25SAlexander Motin static void 15269e749f25SAlexander Motin e82545_write_register(struct e82545_softc *sc, uint32_t offset, uint32_t value) 15279e749f25SAlexander Motin { 15289e749f25SAlexander Motin int ridx; 15299e749f25SAlexander Motin 15309e749f25SAlexander Motin if (offset & 0x3) { 15319e749f25SAlexander Motin DPRINTF("Unaligned register write offset:0x%x value:0x%x\r\n", offset, value); 15329e749f25SAlexander Motin return; 15339e749f25SAlexander Motin } 15349e749f25SAlexander Motin DPRINTF("Register write: 0x%x value: 0x%x\r\n", offset, value); 15359e749f25SAlexander Motin 15369e749f25SAlexander Motin switch (offset) { 15379e749f25SAlexander Motin case E1000_CTRL: 15389e749f25SAlexander Motin case E1000_CTRL_DUP: 15399e749f25SAlexander Motin e82545_devctl(sc, value); 15409e749f25SAlexander Motin break; 15419e749f25SAlexander Motin case E1000_FCAL: 15429e749f25SAlexander Motin sc->esc_FCAL = value; 15439e749f25SAlexander Motin break; 15449e749f25SAlexander Motin case E1000_FCAH: 15459e749f25SAlexander Motin sc->esc_FCAH = value & ~0xFFFF0000; 15469e749f25SAlexander Motin break; 15479e749f25SAlexander Motin case E1000_FCT: 15489e749f25SAlexander Motin sc->esc_FCT = value & ~0xFFFF0000; 15499e749f25SAlexander Motin break; 15509e749f25SAlexander Motin case E1000_VET: 15519e749f25SAlexander Motin sc->esc_VET = value & ~0xFFFF0000; 15529e749f25SAlexander Motin break; 15539e749f25SAlexander Motin case E1000_FCTTV: 15549e749f25SAlexander Motin sc->esc_FCTTV = value & ~0xFFFF0000; 15559e749f25SAlexander Motin break; 15569e749f25SAlexander Motin case E1000_LEDCTL: 15579e749f25SAlexander Motin sc->esc_LEDCTL = value & ~0x30303000; 15589e749f25SAlexander Motin break; 15599e749f25SAlexander Motin case E1000_PBA: 15609e749f25SAlexander Motin sc->esc_PBA = value & 0x0000FF80; 15619e749f25SAlexander Motin break; 15629e749f25SAlexander Motin case E1000_ICR: 15639e749f25SAlexander Motin case E1000_ITR: 15649e749f25SAlexander Motin case E1000_ICS: 15659e749f25SAlexander Motin case E1000_IMS: 15669e749f25SAlexander Motin case E1000_IMC: 15679e749f25SAlexander Motin e82545_intr_write(sc, offset, value); 15689e749f25SAlexander Motin break; 15699e749f25SAlexander Motin case E1000_RCTL: 15709e749f25SAlexander Motin e82545_rx_ctl(sc, value); 15719e749f25SAlexander Motin break; 15729e749f25SAlexander Motin case E1000_FCRTL: 15739e749f25SAlexander Motin sc->esc_FCRTL = value & ~0xFFFF0007; 15749e749f25SAlexander Motin break; 15759e749f25SAlexander Motin case E1000_FCRTH: 15769e749f25SAlexander Motin sc->esc_FCRTH = value & ~0xFFFF0007; 15779e749f25SAlexander Motin break; 15789e749f25SAlexander Motin case E1000_RDBAL(0): 15799e749f25SAlexander Motin sc->esc_RDBAL = value & ~0xF; 15809e749f25SAlexander Motin if (sc->esc_rx_enabled) { 15819e749f25SAlexander Motin /* Apparently legal: update cached address */ 15829e749f25SAlexander Motin e82545_rx_update_rdba(sc); 15839e749f25SAlexander Motin } 15849e749f25SAlexander Motin break; 15859e749f25SAlexander Motin case E1000_RDBAH(0): 15869e749f25SAlexander Motin assert(!sc->esc_rx_enabled); 15879e749f25SAlexander Motin sc->esc_RDBAH = value; 15889e749f25SAlexander Motin break; 15899e749f25SAlexander Motin case E1000_RDLEN(0): 15909e749f25SAlexander Motin assert(!sc->esc_rx_enabled); 15919e749f25SAlexander Motin sc->esc_RDLEN = value & ~0xFFF0007F; 15929e749f25SAlexander Motin break; 15939e749f25SAlexander Motin case E1000_RDH(0): 15949e749f25SAlexander Motin /* XXX should only ever be zero ? Range check ? */ 15959e749f25SAlexander Motin sc->esc_RDH = value; 15969e749f25SAlexander Motin break; 15979e749f25SAlexander Motin case E1000_RDT(0): 15989e749f25SAlexander Motin /* XXX if this opens up the rx ring, do something ? */ 15999e749f25SAlexander Motin sc->esc_RDT = value; 16009e749f25SAlexander Motin break; 16019e749f25SAlexander Motin case E1000_RDTR: 16029e749f25SAlexander Motin /* ignore FPD bit 31 */ 16039e749f25SAlexander Motin sc->esc_RDTR = value & ~0xFFFF0000; 16049e749f25SAlexander Motin break; 16059e749f25SAlexander Motin case E1000_RXDCTL(0): 16069e749f25SAlexander Motin sc->esc_RXDCTL = value & ~0xFEC0C0C0; 16079e749f25SAlexander Motin break; 16089e749f25SAlexander Motin case E1000_RADV: 16099e749f25SAlexander Motin sc->esc_RADV = value & ~0xFFFF0000; 16109e749f25SAlexander Motin break; 16119e749f25SAlexander Motin case E1000_RSRPD: 16129e749f25SAlexander Motin sc->esc_RSRPD = value & ~0xFFFFF000; 16139e749f25SAlexander Motin break; 16149e749f25SAlexander Motin case E1000_RXCSUM: 16159e749f25SAlexander Motin sc->esc_RXCSUM = value & ~0xFFFFF800; 16169e749f25SAlexander Motin break; 16179e749f25SAlexander Motin case E1000_TXCW: 16189e749f25SAlexander Motin sc->esc_TXCW = value & ~0x3FFF0000; 16199e749f25SAlexander Motin break; 16209e749f25SAlexander Motin case E1000_TCTL: 16219e749f25SAlexander Motin e82545_tx_ctl(sc, value); 16229e749f25SAlexander Motin break; 16239e749f25SAlexander Motin case E1000_TIPG: 16249e749f25SAlexander Motin sc->esc_TIPG = value; 16259e749f25SAlexander Motin break; 16269e749f25SAlexander Motin case E1000_AIT: 16279e749f25SAlexander Motin sc->esc_AIT = value; 16289e749f25SAlexander Motin break; 16299e749f25SAlexander Motin case E1000_TDBAL(0): 16309e749f25SAlexander Motin sc->esc_TDBAL = value & ~0xF; 16319e749f25SAlexander Motin if (sc->esc_tx_enabled) { 16329e749f25SAlexander Motin /* Apparently legal */ 16339e749f25SAlexander Motin e82545_tx_update_tdba(sc); 16349e749f25SAlexander Motin } 16359e749f25SAlexander Motin break; 16369e749f25SAlexander Motin case E1000_TDBAH(0): 16379e749f25SAlexander Motin //assert(!sc->esc_tx_enabled); 16389e749f25SAlexander Motin sc->esc_TDBAH = value; 16399e749f25SAlexander Motin break; 16409e749f25SAlexander Motin case E1000_TDLEN(0): 16419e749f25SAlexander Motin //assert(!sc->esc_tx_enabled); 16429e749f25SAlexander Motin sc->esc_TDLEN = value & ~0xFFF0007F; 16439e749f25SAlexander Motin break; 16449e749f25SAlexander Motin case E1000_TDH(0): 16459e749f25SAlexander Motin //assert(!sc->esc_tx_enabled); 16469e749f25SAlexander Motin /* XXX should only ever be zero ? Range check ? */ 16479e749f25SAlexander Motin sc->esc_TDHr = sc->esc_TDH = value; 16489e749f25SAlexander Motin break; 16499e749f25SAlexander Motin case E1000_TDT(0): 16509e749f25SAlexander Motin /* XXX range check ? */ 16519e749f25SAlexander Motin sc->esc_TDT = value; 16529e749f25SAlexander Motin if (sc->esc_tx_enabled) 16539e749f25SAlexander Motin e82545_tx_start(sc); 16549e749f25SAlexander Motin break; 16559e749f25SAlexander Motin case E1000_TIDV: 16569e749f25SAlexander Motin sc->esc_TIDV = value & ~0xFFFF0000; 16579e749f25SAlexander Motin break; 16589e749f25SAlexander Motin case E1000_TXDCTL(0): 16599e749f25SAlexander Motin //assert(!sc->esc_tx_enabled); 16609e749f25SAlexander Motin sc->esc_TXDCTL = value & ~0xC0C0C0; 16619e749f25SAlexander Motin break; 16629e749f25SAlexander Motin case E1000_TADV: 16639e749f25SAlexander Motin sc->esc_TADV = value & ~0xFFFF0000; 16649e749f25SAlexander Motin break; 16659e749f25SAlexander Motin case E1000_RAL(0) ... E1000_RAH(15): 16669e749f25SAlexander Motin /* convert to u32 offset */ 16679e749f25SAlexander Motin ridx = (offset - E1000_RAL(0)) >> 2; 16689e749f25SAlexander Motin e82545_write_ra(sc, ridx, value); 16699e749f25SAlexander Motin break; 16709e749f25SAlexander Motin case E1000_MTA ... (E1000_MTA + (127*4)): 16719e749f25SAlexander Motin sc->esc_fmcast[(offset - E1000_MTA) >> 2] = value; 16729e749f25SAlexander Motin break; 16739e749f25SAlexander Motin case E1000_VFTA ... (E1000_VFTA + (127*4)): 16749e749f25SAlexander Motin sc->esc_fvlan[(offset - E1000_VFTA) >> 2] = value; 16759e749f25SAlexander Motin break; 16769e749f25SAlexander Motin case E1000_EECD: 16779e749f25SAlexander Motin { 16789e749f25SAlexander Motin //DPRINTF("EECD write 0x%x -> 0x%x\r\n", sc->eeprom_control, value); 16799e749f25SAlexander Motin /* edge triggered low->high */ 16809e749f25SAlexander Motin uint32_t eecd_strobe = ((sc->eeprom_control & E1000_EECD_SK) ? 16819e749f25SAlexander Motin 0 : (value & E1000_EECD_SK)); 16829e749f25SAlexander Motin uint32_t eecd_mask = (E1000_EECD_SK|E1000_EECD_CS| 16839e749f25SAlexander Motin E1000_EECD_DI|E1000_EECD_REQ); 16849e749f25SAlexander Motin sc->eeprom_control &= ~eecd_mask; 16859e749f25SAlexander Motin sc->eeprom_control |= (value & eecd_mask); 16869e749f25SAlexander Motin /* grant/revoke immediately */ 16879e749f25SAlexander Motin if (value & E1000_EECD_REQ) { 16889e749f25SAlexander Motin sc->eeprom_control |= E1000_EECD_GNT; 16899e749f25SAlexander Motin } else { 16909e749f25SAlexander Motin sc->eeprom_control &= ~E1000_EECD_GNT; 16919e749f25SAlexander Motin } 16929e749f25SAlexander Motin if (eecd_strobe && (sc->eeprom_control & E1000_EECD_CS)) { 16939e749f25SAlexander Motin e82545_eecd_strobe(sc); 16949e749f25SAlexander Motin } 16959e749f25SAlexander Motin return; 16969e749f25SAlexander Motin } 16979e749f25SAlexander Motin case E1000_MDIC: 16989e749f25SAlexander Motin { 16999e749f25SAlexander Motin uint8_t reg_addr = (uint8_t)((value & E1000_MDIC_REG_MASK) >> 17009e749f25SAlexander Motin E1000_MDIC_REG_SHIFT); 17019e749f25SAlexander Motin uint8_t phy_addr = (uint8_t)((value & E1000_MDIC_PHY_MASK) >> 17029e749f25SAlexander Motin E1000_MDIC_PHY_SHIFT); 17039e749f25SAlexander Motin sc->mdi_control = 17049e749f25SAlexander Motin (value & ~(E1000_MDIC_ERROR|E1000_MDIC_DEST)); 17059e749f25SAlexander Motin if ((value & E1000_MDIC_READY) != 0) { 17069e749f25SAlexander Motin DPRINTF("Incorrect MDIC ready bit: 0x%x\r\n", value); 17079e749f25SAlexander Motin return; 17089e749f25SAlexander Motin } 17099e749f25SAlexander Motin switch (value & E82545_MDIC_OP_MASK) { 17109e749f25SAlexander Motin case E1000_MDIC_OP_READ: 17119e749f25SAlexander Motin sc->mdi_control &= ~E82545_MDIC_DATA_MASK; 17129e749f25SAlexander Motin sc->mdi_control |= e82545_read_mdi(sc, reg_addr, phy_addr); 17139e749f25SAlexander Motin break; 17149e749f25SAlexander Motin case E1000_MDIC_OP_WRITE: 17159e749f25SAlexander Motin e82545_write_mdi(sc, reg_addr, phy_addr, 17169e749f25SAlexander Motin value & E82545_MDIC_DATA_MASK); 17179e749f25SAlexander Motin break; 17189e749f25SAlexander Motin default: 17199e749f25SAlexander Motin DPRINTF("Unknown MDIC op: 0x%x\r\n", value); 17209e749f25SAlexander Motin return; 17219e749f25SAlexander Motin } 17229e749f25SAlexander Motin /* TODO: barrier? */ 17239e749f25SAlexander Motin sc->mdi_control |= E1000_MDIC_READY; 17249e749f25SAlexander Motin if (value & E82545_MDIC_IE) { 17259e749f25SAlexander Motin // TODO: generate interrupt 17269e749f25SAlexander Motin } 17279e749f25SAlexander Motin return; 17289e749f25SAlexander Motin } 17299e749f25SAlexander Motin case E1000_MANC: 17309e749f25SAlexander Motin case E1000_STATUS: 17319e749f25SAlexander Motin return; 17329e749f25SAlexander Motin default: 17339e749f25SAlexander Motin DPRINTF("Unknown write register: 0x%x value:%x\r\n", offset, value); 17349e749f25SAlexander Motin return; 17359e749f25SAlexander Motin } 17369e749f25SAlexander Motin } 17379e749f25SAlexander Motin 17389e749f25SAlexander Motin static uint32_t 17399e749f25SAlexander Motin e82545_read_register(struct e82545_softc *sc, uint32_t offset) 17409e749f25SAlexander Motin { 17419e749f25SAlexander Motin uint32_t retval; 17429e749f25SAlexander Motin int ridx; 17439e749f25SAlexander Motin 17449e749f25SAlexander Motin if (offset & 0x3) { 17459e749f25SAlexander Motin DPRINTF("Unaligned register read offset:0x%x\r\n", offset); 17469e749f25SAlexander Motin return 0; 17479e749f25SAlexander Motin } 17489e749f25SAlexander Motin 17499e749f25SAlexander Motin DPRINTF("Register read: 0x%x\r\n", offset); 17509e749f25SAlexander Motin 17519e749f25SAlexander Motin switch (offset) { 17529e749f25SAlexander Motin case E1000_CTRL: 17539e749f25SAlexander Motin retval = sc->esc_CTRL; 17549e749f25SAlexander Motin break; 17559e749f25SAlexander Motin case E1000_STATUS: 17569e749f25SAlexander Motin retval = E1000_STATUS_FD | E1000_STATUS_LU | 17579e749f25SAlexander Motin E1000_STATUS_SPEED_1000; 17589e749f25SAlexander Motin break; 17599e749f25SAlexander Motin case E1000_FCAL: 17609e749f25SAlexander Motin retval = sc->esc_FCAL; 17619e749f25SAlexander Motin break; 17629e749f25SAlexander Motin case E1000_FCAH: 17639e749f25SAlexander Motin retval = sc->esc_FCAH; 17649e749f25SAlexander Motin break; 17659e749f25SAlexander Motin case E1000_FCT: 17669e749f25SAlexander Motin retval = sc->esc_FCT; 17679e749f25SAlexander Motin break; 17689e749f25SAlexander Motin case E1000_VET: 17699e749f25SAlexander Motin retval = sc->esc_VET; 17709e749f25SAlexander Motin break; 17719e749f25SAlexander Motin case E1000_FCTTV: 17729e749f25SAlexander Motin retval = sc->esc_FCTTV; 17739e749f25SAlexander Motin break; 17749e749f25SAlexander Motin case E1000_LEDCTL: 17759e749f25SAlexander Motin retval = sc->esc_LEDCTL; 17769e749f25SAlexander Motin break; 17779e749f25SAlexander Motin case E1000_PBA: 17789e749f25SAlexander Motin retval = sc->esc_PBA; 17799e749f25SAlexander Motin break; 17809e749f25SAlexander Motin case E1000_ICR: 17819e749f25SAlexander Motin case E1000_ITR: 17829e749f25SAlexander Motin case E1000_ICS: 17839e749f25SAlexander Motin case E1000_IMS: 17849e749f25SAlexander Motin case E1000_IMC: 17859e749f25SAlexander Motin retval = e82545_intr_read(sc, offset); 17869e749f25SAlexander Motin break; 17879e749f25SAlexander Motin case E1000_RCTL: 17889e749f25SAlexander Motin retval = sc->esc_RCTL; 17899e749f25SAlexander Motin break; 17909e749f25SAlexander Motin case E1000_FCRTL: 17919e749f25SAlexander Motin retval = sc->esc_FCRTL; 17929e749f25SAlexander Motin break; 17939e749f25SAlexander Motin case E1000_FCRTH: 17949e749f25SAlexander Motin retval = sc->esc_FCRTH; 17959e749f25SAlexander Motin break; 17969e749f25SAlexander Motin case E1000_RDBAL(0): 17979e749f25SAlexander Motin retval = sc->esc_RDBAL; 17989e749f25SAlexander Motin break; 17999e749f25SAlexander Motin case E1000_RDBAH(0): 18009e749f25SAlexander Motin retval = sc->esc_RDBAH; 18019e749f25SAlexander Motin break; 18029e749f25SAlexander Motin case E1000_RDLEN(0): 18039e749f25SAlexander Motin retval = sc->esc_RDLEN; 18049e749f25SAlexander Motin break; 18059e749f25SAlexander Motin case E1000_RDH(0): 18069e749f25SAlexander Motin retval = sc->esc_RDH; 18079e749f25SAlexander Motin break; 18089e749f25SAlexander Motin case E1000_RDT(0): 18099e749f25SAlexander Motin retval = sc->esc_RDT; 18109e749f25SAlexander Motin break; 18119e749f25SAlexander Motin case E1000_RDTR: 18129e749f25SAlexander Motin retval = sc->esc_RDTR; 18139e749f25SAlexander Motin break; 18149e749f25SAlexander Motin case E1000_RXDCTL(0): 18159e749f25SAlexander Motin retval = sc->esc_RXDCTL; 18169e749f25SAlexander Motin break; 18179e749f25SAlexander Motin case E1000_RADV: 18189e749f25SAlexander Motin retval = sc->esc_RADV; 18199e749f25SAlexander Motin break; 18209e749f25SAlexander Motin case E1000_RSRPD: 18219e749f25SAlexander Motin retval = sc->esc_RSRPD; 18229e749f25SAlexander Motin break; 18239e749f25SAlexander Motin case E1000_RXCSUM: 18249e749f25SAlexander Motin retval = sc->esc_RXCSUM; 18259e749f25SAlexander Motin break; 18269e749f25SAlexander Motin case E1000_TXCW: 18279e749f25SAlexander Motin retval = sc->esc_TXCW; 18289e749f25SAlexander Motin break; 18299e749f25SAlexander Motin case E1000_TCTL: 18309e749f25SAlexander Motin retval = sc->esc_TCTL; 18319e749f25SAlexander Motin break; 18329e749f25SAlexander Motin case E1000_TIPG: 18339e749f25SAlexander Motin retval = sc->esc_TIPG; 18349e749f25SAlexander Motin break; 18359e749f25SAlexander Motin case E1000_AIT: 18369e749f25SAlexander Motin retval = sc->esc_AIT; 18379e749f25SAlexander Motin break; 18389e749f25SAlexander Motin case E1000_TDBAL(0): 18399e749f25SAlexander Motin retval = sc->esc_TDBAL; 18409e749f25SAlexander Motin break; 18419e749f25SAlexander Motin case E1000_TDBAH(0): 18429e749f25SAlexander Motin retval = sc->esc_TDBAH; 18439e749f25SAlexander Motin break; 18449e749f25SAlexander Motin case E1000_TDLEN(0): 18459e749f25SAlexander Motin retval = sc->esc_TDLEN; 18469e749f25SAlexander Motin break; 18479e749f25SAlexander Motin case E1000_TDH(0): 18489e749f25SAlexander Motin retval = sc->esc_TDH; 18499e749f25SAlexander Motin break; 18509e749f25SAlexander Motin case E1000_TDT(0): 18519e749f25SAlexander Motin retval = sc->esc_TDT; 18529e749f25SAlexander Motin break; 18539e749f25SAlexander Motin case E1000_TIDV: 18549e749f25SAlexander Motin retval = sc->esc_TIDV; 18559e749f25SAlexander Motin break; 18569e749f25SAlexander Motin case E1000_TXDCTL(0): 18579e749f25SAlexander Motin retval = sc->esc_TXDCTL; 18589e749f25SAlexander Motin break; 18599e749f25SAlexander Motin case E1000_TADV: 18609e749f25SAlexander Motin retval = sc->esc_TADV; 18619e749f25SAlexander Motin break; 18629e749f25SAlexander Motin case E1000_RAL(0) ... E1000_RAH(15): 18639e749f25SAlexander Motin /* convert to u32 offset */ 18649e749f25SAlexander Motin ridx = (offset - E1000_RAL(0)) >> 2; 18659e749f25SAlexander Motin retval = e82545_read_ra(sc, ridx); 18669e749f25SAlexander Motin break; 18679e749f25SAlexander Motin case E1000_MTA ... (E1000_MTA + (127*4)): 18689e749f25SAlexander Motin retval = sc->esc_fmcast[(offset - E1000_MTA) >> 2]; 18699e749f25SAlexander Motin break; 18709e749f25SAlexander Motin case E1000_VFTA ... (E1000_VFTA + (127*4)): 18719e749f25SAlexander Motin retval = sc->esc_fvlan[(offset - E1000_VFTA) >> 2]; 18729e749f25SAlexander Motin break; 18739e749f25SAlexander Motin case E1000_EECD: 18749e749f25SAlexander Motin //DPRINTF("EECD read %x\r\n", sc->eeprom_control); 18759e749f25SAlexander Motin retval = sc->eeprom_control; 18769e749f25SAlexander Motin break; 18779e749f25SAlexander Motin case E1000_MDIC: 18789e749f25SAlexander Motin retval = sc->mdi_control; 18799e749f25SAlexander Motin break; 18809e749f25SAlexander Motin case E1000_MANC: 18819e749f25SAlexander Motin retval = 0; 18829e749f25SAlexander Motin break; 18839e749f25SAlexander Motin /* stats that we emulate. */ 18849e749f25SAlexander Motin case E1000_MPC: 18859e749f25SAlexander Motin retval = sc->missed_pkt_count; 18869e749f25SAlexander Motin break; 18879e749f25SAlexander Motin case E1000_PRC64: 18889e749f25SAlexander Motin retval = sc->pkt_rx_by_size[0]; 18899e749f25SAlexander Motin break; 18909e749f25SAlexander Motin case E1000_PRC127: 18919e749f25SAlexander Motin retval = sc->pkt_rx_by_size[1]; 18929e749f25SAlexander Motin break; 18939e749f25SAlexander Motin case E1000_PRC255: 18949e749f25SAlexander Motin retval = sc->pkt_rx_by_size[2]; 18959e749f25SAlexander Motin break; 18969e749f25SAlexander Motin case E1000_PRC511: 18979e749f25SAlexander Motin retval = sc->pkt_rx_by_size[3]; 18989e749f25SAlexander Motin break; 18999e749f25SAlexander Motin case E1000_PRC1023: 19009e749f25SAlexander Motin retval = sc->pkt_rx_by_size[4]; 19019e749f25SAlexander Motin break; 19029e749f25SAlexander Motin case E1000_PRC1522: 19039e749f25SAlexander Motin retval = sc->pkt_rx_by_size[5]; 19049e749f25SAlexander Motin break; 19059e749f25SAlexander Motin case E1000_GPRC: 19069e749f25SAlexander Motin retval = sc->good_pkt_rx_count; 19079e749f25SAlexander Motin break; 19089e749f25SAlexander Motin case E1000_BPRC: 19099e749f25SAlexander Motin retval = sc->bcast_pkt_rx_count; 19109e749f25SAlexander Motin break; 19119e749f25SAlexander Motin case E1000_MPRC: 19129e749f25SAlexander Motin retval = sc->mcast_pkt_rx_count; 19139e749f25SAlexander Motin break; 19149e749f25SAlexander Motin case E1000_GPTC: 19159e749f25SAlexander Motin case E1000_TPT: 19169e749f25SAlexander Motin retval = sc->good_pkt_tx_count; 19179e749f25SAlexander Motin break; 19189e749f25SAlexander Motin case E1000_GORCL: 19199e749f25SAlexander Motin retval = (uint32_t)sc->good_octets_rx; 19209e749f25SAlexander Motin break; 19219e749f25SAlexander Motin case E1000_GORCH: 19229e749f25SAlexander Motin retval = (uint32_t)(sc->good_octets_rx >> 32); 19239e749f25SAlexander Motin break; 19249e749f25SAlexander Motin case E1000_TOTL: 19259e749f25SAlexander Motin case E1000_GOTCL: 19269e749f25SAlexander Motin retval = (uint32_t)sc->good_octets_tx; 19279e749f25SAlexander Motin break; 19289e749f25SAlexander Motin case E1000_TOTH: 19299e749f25SAlexander Motin case E1000_GOTCH: 19309e749f25SAlexander Motin retval = (uint32_t)(sc->good_octets_tx >> 32); 19319e749f25SAlexander Motin break; 19329e749f25SAlexander Motin case E1000_ROC: 19339e749f25SAlexander Motin retval = sc->oversize_rx_count; 19349e749f25SAlexander Motin break; 19359e749f25SAlexander Motin case E1000_TORL: 19369e749f25SAlexander Motin retval = (uint32_t)(sc->good_octets_rx + sc->missed_octets); 19379e749f25SAlexander Motin break; 19389e749f25SAlexander Motin case E1000_TORH: 19399e749f25SAlexander Motin retval = (uint32_t)((sc->good_octets_rx + 19409e749f25SAlexander Motin sc->missed_octets) >> 32); 19419e749f25SAlexander Motin break; 19429e749f25SAlexander Motin case E1000_TPR: 19439e749f25SAlexander Motin retval = sc->good_pkt_rx_count + sc->missed_pkt_count + 19449e749f25SAlexander Motin sc->oversize_rx_count; 19459e749f25SAlexander Motin break; 19469e749f25SAlexander Motin case E1000_PTC64: 19479e749f25SAlexander Motin retval = sc->pkt_tx_by_size[0]; 19489e749f25SAlexander Motin break; 19499e749f25SAlexander Motin case E1000_PTC127: 19509e749f25SAlexander Motin retval = sc->pkt_tx_by_size[1]; 19519e749f25SAlexander Motin break; 19529e749f25SAlexander Motin case E1000_PTC255: 19539e749f25SAlexander Motin retval = sc->pkt_tx_by_size[2]; 19549e749f25SAlexander Motin break; 19559e749f25SAlexander Motin case E1000_PTC511: 19569e749f25SAlexander Motin retval = sc->pkt_tx_by_size[3]; 19579e749f25SAlexander Motin break; 19589e749f25SAlexander Motin case E1000_PTC1023: 19599e749f25SAlexander Motin retval = sc->pkt_tx_by_size[4]; 19609e749f25SAlexander Motin break; 19619e749f25SAlexander Motin case E1000_PTC1522: 19629e749f25SAlexander Motin retval = sc->pkt_tx_by_size[5]; 19639e749f25SAlexander Motin break; 19649e749f25SAlexander Motin case E1000_MPTC: 19659e749f25SAlexander Motin retval = sc->mcast_pkt_tx_count; 19669e749f25SAlexander Motin break; 19679e749f25SAlexander Motin case E1000_BPTC: 19689e749f25SAlexander Motin retval = sc->bcast_pkt_tx_count; 19699e749f25SAlexander Motin break; 19709e749f25SAlexander Motin case E1000_TSCTC: 19719e749f25SAlexander Motin retval = sc->tso_tx_count; 19729e749f25SAlexander Motin break; 19739e749f25SAlexander Motin /* stats that are always 0. */ 19749e749f25SAlexander Motin case E1000_CRCERRS: 19759e749f25SAlexander Motin case E1000_ALGNERRC: 19769e749f25SAlexander Motin case E1000_SYMERRS: 19779e749f25SAlexander Motin case E1000_RXERRC: 19789e749f25SAlexander Motin case E1000_SCC: 19799e749f25SAlexander Motin case E1000_ECOL: 19809e749f25SAlexander Motin case E1000_MCC: 19819e749f25SAlexander Motin case E1000_LATECOL: 19829e749f25SAlexander Motin case E1000_COLC: 19839e749f25SAlexander Motin case E1000_DC: 19849e749f25SAlexander Motin case E1000_TNCRS: 19859e749f25SAlexander Motin case E1000_SEC: 19869e749f25SAlexander Motin case E1000_CEXTERR: 19879e749f25SAlexander Motin case E1000_RLEC: 19889e749f25SAlexander Motin case E1000_XONRXC: 19899e749f25SAlexander Motin case E1000_XONTXC: 19909e749f25SAlexander Motin case E1000_XOFFRXC: 19919e749f25SAlexander Motin case E1000_XOFFTXC: 19929e749f25SAlexander Motin case E1000_FCRUC: 19939e749f25SAlexander Motin case E1000_RNBC: 19949e749f25SAlexander Motin case E1000_RUC: 19959e749f25SAlexander Motin case E1000_RFC: 19969e749f25SAlexander Motin case E1000_RJC: 19979e749f25SAlexander Motin case E1000_MGTPRC: 19989e749f25SAlexander Motin case E1000_MGTPDC: 19999e749f25SAlexander Motin case E1000_MGTPTC: 20009e749f25SAlexander Motin case E1000_TSCTFC: 20019e749f25SAlexander Motin retval = 0; 20029e749f25SAlexander Motin break; 20039e749f25SAlexander Motin default: 20049e749f25SAlexander Motin DPRINTF("Unknown read register: 0x%x\r\n", offset); 2005e95b7573SAlexander Motin retval = 0; 20069e749f25SAlexander Motin break; 20079e749f25SAlexander Motin } 20089e749f25SAlexander Motin 20099e749f25SAlexander Motin return (retval); 20109e749f25SAlexander Motin } 20119e749f25SAlexander Motin 20129e749f25SAlexander Motin static void 20139e749f25SAlexander Motin e82545_write(struct vmctx *ctx, int vcpu, struct pci_devinst *pi, int baridx, 20149e749f25SAlexander Motin uint64_t offset, int size, uint64_t value) 20159e749f25SAlexander Motin { 20169e749f25SAlexander Motin struct e82545_softc *sc; 20179e749f25SAlexander Motin 20189e749f25SAlexander Motin //DPRINTF("Write bar:%d offset:0x%lx value:0x%lx size:%d\r\n", baridx, offset, value, size); 20199e749f25SAlexander Motin 20209e749f25SAlexander Motin sc = pi->pi_arg; 20219e749f25SAlexander Motin 20229e749f25SAlexander Motin pthread_mutex_lock(&sc->esc_mtx); 20239e749f25SAlexander Motin 20249e749f25SAlexander Motin switch (baridx) { 20259e749f25SAlexander Motin case E82545_BAR_IO: 20269e749f25SAlexander Motin switch (offset) { 20279e749f25SAlexander Motin case E82545_IOADDR: 20289e749f25SAlexander Motin if (size != 4) { 20299e749f25SAlexander Motin DPRINTF("Wrong io addr write sz:%d value:0x%lx\r\n", size, value); 20309e749f25SAlexander Motin } else 20319e749f25SAlexander Motin sc->io_addr = (uint32_t)value; 20329e749f25SAlexander Motin break; 20339e749f25SAlexander Motin case E82545_IODATA: 20349e749f25SAlexander Motin if (size != 4) { 20359e749f25SAlexander Motin DPRINTF("Wrong io data write size:%d value:0x%lx\r\n", size, value); 20369e749f25SAlexander Motin } else if (sc->io_addr > E82545_IO_REGISTER_MAX) { 20379e749f25SAlexander Motin DPRINTF("Non-register io write addr:0x%x value:0x%lx\r\n", sc->io_addr, value); 20389e749f25SAlexander Motin } else 20399e749f25SAlexander Motin e82545_write_register(sc, sc->io_addr, 20409e749f25SAlexander Motin (uint32_t)value); 20419e749f25SAlexander Motin break; 20429e749f25SAlexander Motin default: 20439e749f25SAlexander Motin DPRINTF("Unknown io bar write offset:0x%lx value:0x%lx size:%d\r\n", offset, value, size); 20449e749f25SAlexander Motin break; 20459e749f25SAlexander Motin } 2046a88b19f9SAlexander Motin break; 20479e749f25SAlexander Motin case E82545_BAR_REGISTER: 20489e749f25SAlexander Motin if (size != 4) { 20499e749f25SAlexander Motin DPRINTF("Wrong register write size:%d offset:0x%lx value:0x%lx\r\n", size, offset, value); 20509e749f25SAlexander Motin } else 20519e749f25SAlexander Motin e82545_write_register(sc, (uint32_t)offset, 20529e749f25SAlexander Motin (uint32_t)value); 20539e749f25SAlexander Motin break; 20549e749f25SAlexander Motin default: 20559e749f25SAlexander Motin DPRINTF("Unknown write bar:%d off:0x%lx val:0x%lx size:%d\r\n", 20569e749f25SAlexander Motin baridx, offset, value, size); 20579e749f25SAlexander Motin } 20589e749f25SAlexander Motin 20599e749f25SAlexander Motin pthread_mutex_unlock(&sc->esc_mtx); 20609e749f25SAlexander Motin } 20619e749f25SAlexander Motin 20629e749f25SAlexander Motin static uint64_t 20639e749f25SAlexander Motin e82545_read(struct vmctx *ctx, int vcpu, struct pci_devinst *pi, int baridx, 20649e749f25SAlexander Motin uint64_t offset, int size) 20659e749f25SAlexander Motin { 20669e749f25SAlexander Motin struct e82545_softc *sc; 20679e749f25SAlexander Motin uint64_t retval; 20689e749f25SAlexander Motin 20699e749f25SAlexander Motin //DPRINTF("Read bar:%d offset:0x%lx size:%d\r\n", baridx, offset, size); 20709e749f25SAlexander Motin sc = pi->pi_arg; 20719e749f25SAlexander Motin retval = 0; 20729e749f25SAlexander Motin 20739e749f25SAlexander Motin pthread_mutex_lock(&sc->esc_mtx); 20749e749f25SAlexander Motin 20759e749f25SAlexander Motin switch (baridx) { 20769e749f25SAlexander Motin case E82545_BAR_IO: 20779e749f25SAlexander Motin switch (offset) { 20789e749f25SAlexander Motin case E82545_IOADDR: 20799e749f25SAlexander Motin if (size != 4) { 20809e749f25SAlexander Motin DPRINTF("Wrong io addr read sz:%d\r\n", size); 20819e749f25SAlexander Motin } else 20829e749f25SAlexander Motin retval = sc->io_addr; 20839e749f25SAlexander Motin break; 20849e749f25SAlexander Motin case E82545_IODATA: 20859e749f25SAlexander Motin if (size != 4) { 20869e749f25SAlexander Motin DPRINTF("Wrong io data read sz:%d\r\n", size); 20879e749f25SAlexander Motin } 20889e749f25SAlexander Motin if (sc->io_addr > E82545_IO_REGISTER_MAX) { 20899e749f25SAlexander Motin DPRINTF("Non-register io read addr:0x%x\r\n", 20909e749f25SAlexander Motin sc->io_addr); 20919e749f25SAlexander Motin } else 20929e749f25SAlexander Motin retval = e82545_read_register(sc, sc->io_addr); 20939e749f25SAlexander Motin break; 20949e749f25SAlexander Motin default: 20959e749f25SAlexander Motin DPRINTF("Unknown io bar read offset:0x%lx size:%d\r\n", 20969e749f25SAlexander Motin offset, size); 20979e749f25SAlexander Motin break; 20989e749f25SAlexander Motin } 2099a88b19f9SAlexander Motin break; 21009e749f25SAlexander Motin case E82545_BAR_REGISTER: 21019e749f25SAlexander Motin if (size != 4) { 21029e749f25SAlexander Motin DPRINTF("Wrong register read size:%d offset:0x%lx\r\n", 21039e749f25SAlexander Motin size, offset); 21049e749f25SAlexander Motin } else 21059e749f25SAlexander Motin retval = e82545_read_register(sc, (uint32_t)offset); 21069e749f25SAlexander Motin break; 21079e749f25SAlexander Motin default: 21089e749f25SAlexander Motin DPRINTF("Unknown read bar:%d offset:0x%lx size:%d\r\n", 21099e749f25SAlexander Motin baridx, offset, size); 21109e749f25SAlexander Motin break; 21119e749f25SAlexander Motin } 21129e749f25SAlexander Motin 21139e749f25SAlexander Motin pthread_mutex_unlock(&sc->esc_mtx); 21149e749f25SAlexander Motin 21159e749f25SAlexander Motin return (retval); 21169e749f25SAlexander Motin } 21179e749f25SAlexander Motin 21189e749f25SAlexander Motin static void 21199e749f25SAlexander Motin e82545_reset(struct e82545_softc *sc, int drvr) 21209e749f25SAlexander Motin { 21219e749f25SAlexander Motin int i; 21229e749f25SAlexander Motin 21239e749f25SAlexander Motin e82545_rx_disable(sc); 21249e749f25SAlexander Motin e82545_tx_disable(sc); 21259e749f25SAlexander Motin 21269e749f25SAlexander Motin /* clear outstanding interrupts */ 21279e749f25SAlexander Motin if (sc->esc_irq_asserted) 21289e749f25SAlexander Motin pci_lintr_deassert(sc->esc_pi); 21299e749f25SAlexander Motin 21309e749f25SAlexander Motin /* misc */ 21319e749f25SAlexander Motin if (!drvr) { 21329e749f25SAlexander Motin sc->esc_FCAL = 0; 21339e749f25SAlexander Motin sc->esc_FCAH = 0; 21349e749f25SAlexander Motin sc->esc_FCT = 0; 21359e749f25SAlexander Motin sc->esc_VET = 0; 21369e749f25SAlexander Motin sc->esc_FCTTV = 0; 21379e749f25SAlexander Motin } 21389e749f25SAlexander Motin sc->esc_LEDCTL = 0x07061302; 21399e749f25SAlexander Motin sc->esc_PBA = 0x00100030; 21409e749f25SAlexander Motin 21419e749f25SAlexander Motin /* start nvm in opcode mode. */ 21429e749f25SAlexander Motin sc->nvm_opaddr = 0; 21439e749f25SAlexander Motin sc->nvm_mode = E82545_NVM_MODE_OPADDR; 21449e749f25SAlexander Motin sc->nvm_bits = E82545_NVM_OPADDR_BITS; 21459e749f25SAlexander Motin sc->eeprom_control = E1000_EECD_PRES | E82545_EECD_FWE_EN; 21469e749f25SAlexander Motin e82545_init_eeprom(sc); 21479e749f25SAlexander Motin 21489e749f25SAlexander Motin /* interrupt */ 21499e749f25SAlexander Motin sc->esc_ICR = 0; 21509e749f25SAlexander Motin sc->esc_ITR = 250; 21519e749f25SAlexander Motin sc->esc_ICS = 0; 21529e749f25SAlexander Motin sc->esc_IMS = 0; 21539e749f25SAlexander Motin sc->esc_IMC = 0; 21549e749f25SAlexander Motin 21559e749f25SAlexander Motin /* L2 filters */ 21569e749f25SAlexander Motin if (!drvr) { 21579e749f25SAlexander Motin memset(sc->esc_fvlan, 0, sizeof(sc->esc_fvlan)); 21589e749f25SAlexander Motin memset(sc->esc_fmcast, 0, sizeof(sc->esc_fmcast)); 21599e749f25SAlexander Motin memset(sc->esc_uni, 0, sizeof(sc->esc_uni)); 21609e749f25SAlexander Motin 21619e749f25SAlexander Motin /* XXX not necessary on 82545 ?? */ 21629e749f25SAlexander Motin sc->esc_uni[0].eu_valid = 1; 21639e749f25SAlexander Motin memcpy(sc->esc_uni[0].eu_eth.octet, sc->esc_mac.octet, 21649e749f25SAlexander Motin ETHER_ADDR_LEN); 21659e749f25SAlexander Motin } else { 21669e749f25SAlexander Motin /* Clear RAH valid bits */ 21679e749f25SAlexander Motin for (i = 0; i < 16; i++) 21689e749f25SAlexander Motin sc->esc_uni[i].eu_valid = 0; 21699e749f25SAlexander Motin } 21709e749f25SAlexander Motin 21719e749f25SAlexander Motin /* receive */ 21729e749f25SAlexander Motin if (!drvr) { 21739e749f25SAlexander Motin sc->esc_RDBAL = 0; 21749e749f25SAlexander Motin sc->esc_RDBAH = 0; 21759e749f25SAlexander Motin } 21769e749f25SAlexander Motin sc->esc_RCTL = 0; 21779e749f25SAlexander Motin sc->esc_FCRTL = 0; 21789e749f25SAlexander Motin sc->esc_FCRTH = 0; 21799e749f25SAlexander Motin sc->esc_RDLEN = 0; 21809e749f25SAlexander Motin sc->esc_RDH = 0; 21819e749f25SAlexander Motin sc->esc_RDT = 0; 21829e749f25SAlexander Motin sc->esc_RDTR = 0; 21839e749f25SAlexander Motin sc->esc_RXDCTL = (1 << 24) | (1 << 16); /* default GRAN/WTHRESH */ 21849e749f25SAlexander Motin sc->esc_RADV = 0; 21859e749f25SAlexander Motin sc->esc_RXCSUM = 0; 21869e749f25SAlexander Motin 21879e749f25SAlexander Motin /* transmit */ 21889e749f25SAlexander Motin if (!drvr) { 21899e749f25SAlexander Motin sc->esc_TDBAL = 0; 21909e749f25SAlexander Motin sc->esc_TDBAH = 0; 21919e749f25SAlexander Motin sc->esc_TIPG = 0; 21929e749f25SAlexander Motin sc->esc_AIT = 0; 21939e749f25SAlexander Motin sc->esc_TIDV = 0; 21949e749f25SAlexander Motin sc->esc_TADV = 0; 21959e749f25SAlexander Motin } 21969e749f25SAlexander Motin sc->esc_tdba = 0; 21979e749f25SAlexander Motin sc->esc_txdesc = NULL; 21989e749f25SAlexander Motin sc->esc_TXCW = 0; 21999e749f25SAlexander Motin sc->esc_TCTL = 0; 22009e749f25SAlexander Motin sc->esc_TDLEN = 0; 22019e749f25SAlexander Motin sc->esc_TDT = 0; 22029e749f25SAlexander Motin sc->esc_TDHr = sc->esc_TDH = 0; 22039e749f25SAlexander Motin sc->esc_TXDCTL = 0; 22049e749f25SAlexander Motin } 22059e749f25SAlexander Motin 22069e749f25SAlexander Motin static void 22079e749f25SAlexander Motin e82545_open_tap(struct e82545_softc *sc, char *opts) 22089e749f25SAlexander Motin { 22099e749f25SAlexander Motin char tbuf[80]; 221000ef17beSBartek Rutkowski #ifndef WITHOUT_CAPSICUM 221100ef17beSBartek Rutkowski cap_rights_t rights; 221200ef17beSBartek Rutkowski #endif 22139e749f25SAlexander Motin 22149e749f25SAlexander Motin if (opts == NULL) { 22159e749f25SAlexander Motin sc->esc_tapfd = -1; 22169e749f25SAlexander Motin return; 22179e749f25SAlexander Motin } 22189e749f25SAlexander Motin 22199e749f25SAlexander Motin strcpy(tbuf, "/dev/"); 22209e749f25SAlexander Motin strlcat(tbuf, opts, sizeof(tbuf)); 22219e749f25SAlexander Motin 22229e749f25SAlexander Motin sc->esc_tapfd = open(tbuf, O_RDWR); 22239e749f25SAlexander Motin if (sc->esc_tapfd == -1) { 22249e749f25SAlexander Motin DPRINTF("unable to open tap device %s\n", opts); 22259e749f25SAlexander Motin exit(1); 22269e749f25SAlexander Motin } 22279e749f25SAlexander Motin 22289e749f25SAlexander Motin /* 22299e749f25SAlexander Motin * Set non-blocking and register for read 22309e749f25SAlexander Motin * notifications with the event loop 22319e749f25SAlexander Motin */ 22329e749f25SAlexander Motin int opt = 1; 22339e749f25SAlexander Motin if (ioctl(sc->esc_tapfd, FIONBIO, &opt) < 0) { 22349e749f25SAlexander Motin WPRINTF("tap device O_NONBLOCK failed: %d\n", errno); 22359e749f25SAlexander Motin close(sc->esc_tapfd); 22369e749f25SAlexander Motin sc->esc_tapfd = -1; 22379e749f25SAlexander Motin } 22389e749f25SAlexander Motin 223900ef17beSBartek Rutkowski #ifndef WITHOUT_CAPSICUM 224000ef17beSBartek Rutkowski cap_rights_init(&rights, CAP_EVENT, CAP_READ, CAP_WRITE); 224100ef17beSBartek Rutkowski if (cap_rights_limit(sc->esc_tapfd, &rights) == -1 && errno != ENOSYS) 224200ef17beSBartek Rutkowski errx(EX_OSERR, "Unable to apply rights for sandbox"); 224300ef17beSBartek Rutkowski #endif 224400ef17beSBartek Rutkowski 22459e749f25SAlexander Motin sc->esc_mevp = mevent_add(sc->esc_tapfd, 22469e749f25SAlexander Motin EVF_READ, 22479e749f25SAlexander Motin e82545_tap_callback, 22489e749f25SAlexander Motin sc); 22499e749f25SAlexander Motin if (sc->esc_mevp == NULL) { 22509e749f25SAlexander Motin DPRINTF("Could not register mevent %d\n", EVF_READ); 22519e749f25SAlexander Motin close(sc->esc_tapfd); 22529e749f25SAlexander Motin sc->esc_tapfd = -1; 22539e749f25SAlexander Motin } 22549e749f25SAlexander Motin } 22559e749f25SAlexander Motin 22569e749f25SAlexander Motin static int 22579e749f25SAlexander Motin e82545_parsemac(char *mac_str, uint8_t *mac_addr) 22589e749f25SAlexander Motin { 22599e749f25SAlexander Motin struct ether_addr *ea; 22609e749f25SAlexander Motin char *tmpstr; 22619e749f25SAlexander Motin char zero_addr[ETHER_ADDR_LEN] = { 0, 0, 0, 0, 0, 0 }; 22629e749f25SAlexander Motin 22639e749f25SAlexander Motin tmpstr = strsep(&mac_str,"="); 22649e749f25SAlexander Motin if ((mac_str != NULL) && (!strcmp(tmpstr,"mac"))) { 22659e749f25SAlexander Motin ea = ether_aton(mac_str); 22669e749f25SAlexander Motin if (ea == NULL || ETHER_IS_MULTICAST(ea->octet) || 22679e749f25SAlexander Motin memcmp(ea->octet, zero_addr, ETHER_ADDR_LEN) == 0) { 22689e749f25SAlexander Motin fprintf(stderr, "Invalid MAC %s\n", mac_str); 22699e749f25SAlexander Motin return (1); 22709e749f25SAlexander Motin } else 22719e749f25SAlexander Motin memcpy(mac_addr, ea->octet, ETHER_ADDR_LEN); 22729e749f25SAlexander Motin } 22739e749f25SAlexander Motin return (0); 22749e749f25SAlexander Motin } 22759e749f25SAlexander Motin 22769e749f25SAlexander Motin static int 22779e749f25SAlexander Motin e82545_init(struct vmctx *ctx, struct pci_devinst *pi, char *opts) 22789e749f25SAlexander Motin { 22799e749f25SAlexander Motin DPRINTF("Loading with options: %s\r\n", opts); 22809e749f25SAlexander Motin 22819e749f25SAlexander Motin MD5_CTX mdctx; 22829e749f25SAlexander Motin unsigned char digest[16]; 22839e749f25SAlexander Motin char nstr[80]; 22849e749f25SAlexander Motin struct e82545_softc *sc; 22859e749f25SAlexander Motin char *devname; 22869e749f25SAlexander Motin char *vtopts; 22879e749f25SAlexander Motin int mac_provided; 22889e749f25SAlexander Motin 22899e749f25SAlexander Motin /* Setup our softc */ 22909287c032SMarcelo Araujo sc = calloc(1, sizeof(*sc)); 22919e749f25SAlexander Motin 22929e749f25SAlexander Motin pi->pi_arg = sc; 22939e749f25SAlexander Motin sc->esc_pi = pi; 22949e749f25SAlexander Motin sc->esc_ctx = ctx; 22959e749f25SAlexander Motin 22969e749f25SAlexander Motin pthread_mutex_init(&sc->esc_mtx, NULL); 22979e749f25SAlexander Motin pthread_cond_init(&sc->esc_rx_cond, NULL); 22989e749f25SAlexander Motin pthread_cond_init(&sc->esc_tx_cond, NULL); 22999e749f25SAlexander Motin pthread_create(&sc->esc_tx_tid, NULL, e82545_tx_thread, sc); 23009e749f25SAlexander Motin snprintf(nstr, sizeof(nstr), "e82545-%d:%d tx", pi->pi_slot, 23019e749f25SAlexander Motin pi->pi_func); 23029e749f25SAlexander Motin pthread_set_name_np(sc->esc_tx_tid, nstr); 23039e749f25SAlexander Motin 23049e749f25SAlexander Motin pci_set_cfgdata16(pi, PCIR_DEVICE, E82545_DEV_ID_82545EM_COPPER); 23059e749f25SAlexander Motin pci_set_cfgdata16(pi, PCIR_VENDOR, E82545_VENDOR_ID_INTEL); 23069e749f25SAlexander Motin pci_set_cfgdata8(pi, PCIR_CLASS, PCIC_NETWORK); 23079e749f25SAlexander Motin pci_set_cfgdata8(pi, PCIR_SUBCLASS, PCIS_NETWORK_ETHERNET); 23089e749f25SAlexander Motin pci_set_cfgdata16(pi, PCIR_SUBDEV_0, E82545_SUBDEV_ID); 23099e749f25SAlexander Motin pci_set_cfgdata16(pi, PCIR_SUBVEND_0, E82545_VENDOR_ID_INTEL); 23109e749f25SAlexander Motin 23119e749f25SAlexander Motin pci_set_cfgdata8(pi, PCIR_HDRTYPE, PCIM_HDRTYPE_NORMAL); 23129e749f25SAlexander Motin pci_set_cfgdata8(pi, PCIR_INTPIN, 0x1); 23139e749f25SAlexander Motin 23149e749f25SAlexander Motin /* TODO: this card also supports msi, but the freebsd driver for it 23159e749f25SAlexander Motin * does not, so I have not implemented it. */ 23169e749f25SAlexander Motin pci_lintr_request(pi); 23179e749f25SAlexander Motin 23189e749f25SAlexander Motin pci_emul_alloc_bar(pi, E82545_BAR_REGISTER, PCIBAR_MEM32, 23199e749f25SAlexander Motin E82545_BAR_REGISTER_LEN); 23209e749f25SAlexander Motin pci_emul_alloc_bar(pi, E82545_BAR_FLASH, PCIBAR_MEM32, 23219e749f25SAlexander Motin E82545_BAR_FLASH_LEN); 23229e749f25SAlexander Motin pci_emul_alloc_bar(pi, E82545_BAR_IO, PCIBAR_IO, 23239e749f25SAlexander Motin E82545_BAR_IO_LEN); 23249e749f25SAlexander Motin 23259e749f25SAlexander Motin /* 23269e749f25SAlexander Motin * Attempt to open the tap device and read the MAC address 23279e749f25SAlexander Motin * if specified. Copied from virtio-net, slightly modified. 23289e749f25SAlexander Motin */ 23299e749f25SAlexander Motin mac_provided = 0; 23309e749f25SAlexander Motin sc->esc_tapfd = -1; 23319e749f25SAlexander Motin if (opts != NULL) { 23329e749f25SAlexander Motin int err; 23339e749f25SAlexander Motin 23349e749f25SAlexander Motin devname = vtopts = strdup(opts); 23359e749f25SAlexander Motin (void) strsep(&vtopts, ","); 23369e749f25SAlexander Motin 23379e749f25SAlexander Motin if (vtopts != NULL) { 23389e749f25SAlexander Motin err = e82545_parsemac(vtopts, sc->esc_mac.octet); 23399e749f25SAlexander Motin if (err != 0) { 23409e749f25SAlexander Motin free(devname); 23419e749f25SAlexander Motin return (err); 23429e749f25SAlexander Motin } 23439e749f25SAlexander Motin mac_provided = 1; 23449e749f25SAlexander Motin } 23459e749f25SAlexander Motin 23469e749f25SAlexander Motin if (strncmp(devname, "tap", 3) == 0 || 23479e749f25SAlexander Motin strncmp(devname, "vmnet", 5) == 0) 23489e749f25SAlexander Motin e82545_open_tap(sc, devname); 23499e749f25SAlexander Motin 23509e749f25SAlexander Motin free(devname); 23519e749f25SAlexander Motin } 23529e749f25SAlexander Motin 23539e749f25SAlexander Motin /* 23549e749f25SAlexander Motin * The default MAC address is the standard NetApp OUI of 00-a0-98, 23559e749f25SAlexander Motin * followed by an MD5 of the PCI slot/func number and dev name 23569e749f25SAlexander Motin */ 23579e749f25SAlexander Motin if (!mac_provided) { 23589e749f25SAlexander Motin snprintf(nstr, sizeof(nstr), "%d-%d-%s", pi->pi_slot, 23599e749f25SAlexander Motin pi->pi_func, vmname); 23609e749f25SAlexander Motin 23619e749f25SAlexander Motin MD5Init(&mdctx); 23629e749f25SAlexander Motin MD5Update(&mdctx, nstr, strlen(nstr)); 23639e749f25SAlexander Motin MD5Final(digest, &mdctx); 23649e749f25SAlexander Motin 23659e749f25SAlexander Motin sc->esc_mac.octet[0] = 0x00; 23669e749f25SAlexander Motin sc->esc_mac.octet[1] = 0xa0; 23679e749f25SAlexander Motin sc->esc_mac.octet[2] = 0x98; 23689e749f25SAlexander Motin sc->esc_mac.octet[3] = digest[0]; 23699e749f25SAlexander Motin sc->esc_mac.octet[4] = digest[1]; 23709e749f25SAlexander Motin sc->esc_mac.octet[5] = digest[2]; 23719e749f25SAlexander Motin } 23729e749f25SAlexander Motin 23739e749f25SAlexander Motin /* H/w initiated reset */ 23749e749f25SAlexander Motin e82545_reset(sc, 0); 23759e749f25SAlexander Motin 23769e749f25SAlexander Motin return (0); 23779e749f25SAlexander Motin } 23789e749f25SAlexander Motin 23799e749f25SAlexander Motin struct pci_devemu pci_de_e82545 = { 23809e749f25SAlexander Motin .pe_emu = "e1000", 23819e749f25SAlexander Motin .pe_init = e82545_init, 23829e749f25SAlexander Motin .pe_barwrite = e82545_write, 23839e749f25SAlexander Motin .pe_barread = e82545_read 23849e749f25SAlexander Motin }; 23859e749f25SAlexander Motin PCI_EMUL_SET(pci_de_e82545); 23869e749f25SAlexander Motin 2387