65c2ab8085
On resume igb_vm_state_change() always calls igb_autoneg_resume()
that sets link_down to false, and thus activates the link even
if we have disabled it.
The problem can be reproduced starting qemu in paused state (-S) and
then set the link to down. When we resume the machine the link appears
to be up.
Reproducer:
# qemu-system-x86_64 ... -device igb,netdev=netdev0,id=net0 -S
{"execute": "qmp_capabilities" }
{"execute": "set_link", "arguments": {"name": "net0", "up": false}}
{"execute": "cont" }
To fix the problem, merge the content of igb_vm_state_change()
into igb_core_post_load() as e1000 does.
Buglink: https://issues.redhat.com/browse/RHEL-21867
Fixes: 3a977deebe
("Intrdocue igb device emulation")
Cc: akihiko.odaki@daynix.com
Suggested-by: Akihiko Odaki <akihiko.odaki@daynix.com>
Signed-off-by: Laurent Vivier <lvivier@redhat.com>
Signed-off-by: Jason Wang <jasowang@redhat.com>
4554 lines
132 KiB
C
4554 lines
132 KiB
C
/*
|
|
* Core code for QEMU igb emulation
|
|
*
|
|
* Datasheet:
|
|
* https://www.intel.com/content/dam/www/public/us/en/documents/datasheets/82576eg-gbe-datasheet.pdf
|
|
*
|
|
* Copyright (c) 2020-2023 Red Hat, Inc.
|
|
* Copyright (c) 2015 Ravello Systems LTD (http://ravellosystems.com)
|
|
* Developed by Daynix Computing LTD (http://www.daynix.com)
|
|
*
|
|
* Authors:
|
|
* Akihiko Odaki <akihiko.odaki@daynix.com>
|
|
* Gal Hammmer <gal.hammer@sap.com>
|
|
* Marcel Apfelbaum <marcel.apfelbaum@gmail.com>
|
|
* Dmitry Fleytman <dmitry@daynix.com>
|
|
* Leonid Bloch <leonid@daynix.com>
|
|
* Yan Vugenfirer <yan@daynix.com>
|
|
*
|
|
* Based on work done by:
|
|
* Nir Peleg, Tutis Systems Ltd. for Qumranet Inc.
|
|
* Copyright (c) 2008 Qumranet
|
|
* Based on work done by:
|
|
* Copyright (c) 2007 Dan Aloni
|
|
* Copyright (c) 2004 Antony T Curtis
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2.1 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "qemu/log.h"
|
|
#include "net/net.h"
|
|
#include "net/tap.h"
|
|
#include "hw/net/mii.h"
|
|
#include "hw/pci/msi.h"
|
|
#include "hw/pci/msix.h"
|
|
#include "sysemu/runstate.h"
|
|
|
|
#include "net_tx_pkt.h"
|
|
#include "net_rx_pkt.h"
|
|
|
|
#include "igb_common.h"
|
|
#include "e1000x_common.h"
|
|
#include "igb_core.h"
|
|
|
|
#include "trace.h"
|
|
|
|
#define E1000E_MAX_TX_FRAGS (64)
|
|
|
|
union e1000_rx_desc_union {
|
|
struct e1000_rx_desc legacy;
|
|
union e1000_adv_rx_desc adv;
|
|
};
|
|
|
|
typedef struct IGBTxPktVmdqCallbackContext {
|
|
IGBCore *core;
|
|
NetClientState *nc;
|
|
} IGBTxPktVmdqCallbackContext;
|
|
|
|
typedef struct L2Header {
|
|
struct eth_header eth;
|
|
struct vlan_header vlan[2];
|
|
} L2Header;
|
|
|
|
typedef struct PTP2 {
|
|
uint8_t message_id_transport_specific;
|
|
uint8_t version_ptp;
|
|
uint16_t message_length;
|
|
uint8_t subdomain_number;
|
|
uint8_t reserved0;
|
|
uint16_t flags;
|
|
uint64_t correction;
|
|
uint8_t reserved1[5];
|
|
uint8_t source_communication_technology;
|
|
uint32_t source_uuid_lo;
|
|
uint16_t source_uuid_hi;
|
|
uint16_t source_port_id;
|
|
uint16_t sequence_id;
|
|
uint8_t control;
|
|
uint8_t log_message_period;
|
|
} PTP2;
|
|
|
|
static ssize_t
|
|
igb_receive_internal(IGBCore *core, const struct iovec *iov, int iovcnt,
|
|
bool has_vnet, bool *external_tx);
|
|
|
|
static void igb_raise_interrupts(IGBCore *core, size_t index, uint32_t causes);
|
|
static void igb_reset(IGBCore *core, bool sw);
|
|
|
|
static inline void
|
|
igb_raise_legacy_irq(IGBCore *core)
|
|
{
|
|
trace_e1000e_irq_legacy_notify(true);
|
|
e1000x_inc_reg_if_not_full(core->mac, IAC);
|
|
pci_set_irq(core->owner, 1);
|
|
}
|
|
|
|
static inline void
|
|
igb_lower_legacy_irq(IGBCore *core)
|
|
{
|
|
trace_e1000e_irq_legacy_notify(false);
|
|
pci_set_irq(core->owner, 0);
|
|
}
|
|
|
|
static void igb_msix_notify(IGBCore *core, unsigned int cause)
|
|
{
|
|
PCIDevice *dev = core->owner;
|
|
uint16_t vfn;
|
|
uint32_t effective_eiac;
|
|
unsigned int vector;
|
|
|
|
vfn = 8 - (cause + 2) / IGBVF_MSIX_VEC_NUM;
|
|
if (vfn < pcie_sriov_num_vfs(core->owner)) {
|
|
dev = pcie_sriov_get_vf_at_index(core->owner, vfn);
|
|
assert(dev);
|
|
vector = (cause + 2) % IGBVF_MSIX_VEC_NUM;
|
|
} else if (cause >= IGB_MSIX_VEC_NUM) {
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
"igb: Tried to use vector unavailable for PF");
|
|
return;
|
|
} else {
|
|
vector = cause;
|
|
}
|
|
|
|
msix_notify(dev, vector);
|
|
|
|
trace_e1000e_irq_icr_clear_eiac(core->mac[EICR], core->mac[EIAC]);
|
|
effective_eiac = core->mac[EIAC] & BIT(cause);
|
|
core->mac[EICR] &= ~effective_eiac;
|
|
}
|
|
|
|
static inline void
|
|
igb_intrmgr_rearm_timer(IGBIntrDelayTimer *timer)
|
|
{
|
|
int64_t delay_ns = (int64_t) timer->core->mac[timer->delay_reg] *
|
|
timer->delay_resolution_ns;
|
|
|
|
trace_e1000e_irq_rearm_timer(timer->delay_reg << 2, delay_ns);
|
|
|
|
timer_mod(timer->timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + delay_ns);
|
|
|
|
timer->running = true;
|
|
}
|
|
|
|
static void
|
|
igb_intmgr_timer_resume(IGBIntrDelayTimer *timer)
|
|
{
|
|
if (timer->running) {
|
|
igb_intrmgr_rearm_timer(timer);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_intrmgr_on_msix_throttling_timer(void *opaque)
|
|
{
|
|
IGBIntrDelayTimer *timer = opaque;
|
|
int idx = timer - &timer->core->eitr[0];
|
|
|
|
timer->running = false;
|
|
|
|
trace_e1000e_irq_msix_notify_postponed_vec(idx);
|
|
igb_msix_notify(timer->core, idx);
|
|
}
|
|
|
|
static void
|
|
igb_intrmgr_initialize_all_timers(IGBCore *core, bool create)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < IGB_INTR_NUM; i++) {
|
|
core->eitr[i].core = core;
|
|
core->eitr[i].delay_reg = EITR0 + i;
|
|
core->eitr[i].delay_resolution_ns = E1000_INTR_DELAY_NS_RES;
|
|
}
|
|
|
|
if (!create) {
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < IGB_INTR_NUM; i++) {
|
|
core->eitr[i].timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
|
|
igb_intrmgr_on_msix_throttling_timer,
|
|
&core->eitr[i]);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_intrmgr_resume(IGBCore *core)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < IGB_INTR_NUM; i++) {
|
|
igb_intmgr_timer_resume(&core->eitr[i]);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_intrmgr_reset(IGBCore *core)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < IGB_INTR_NUM; i++) {
|
|
if (core->eitr[i].running) {
|
|
timer_del(core->eitr[i].timer);
|
|
igb_intrmgr_on_msix_throttling_timer(&core->eitr[i]);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_intrmgr_pci_unint(IGBCore *core)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < IGB_INTR_NUM; i++) {
|
|
timer_free(core->eitr[i].timer);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_intrmgr_pci_realize(IGBCore *core)
|
|
{
|
|
igb_intrmgr_initialize_all_timers(core, true);
|
|
}
|
|
|
|
static inline bool
|
|
igb_rx_csum_enabled(IGBCore *core)
|
|
{
|
|
return (core->mac[RXCSUM] & E1000_RXCSUM_PCSD) ? false : true;
|
|
}
|
|
|
|
static inline bool
|
|
igb_rx_use_legacy_descriptor(IGBCore *core)
|
|
{
|
|
/*
|
|
* TODO: If SRRCTL[n],DESCTYPE = 000b, the 82576 uses the legacy Rx
|
|
* descriptor.
|
|
*/
|
|
return false;
|
|
}
|
|
|
|
typedef struct E1000ERingInfo {
|
|
int dbah;
|
|
int dbal;
|
|
int dlen;
|
|
int dh;
|
|
int dt;
|
|
int idx;
|
|
} E1000ERingInfo;
|
|
|
|
static uint32_t
|
|
igb_rx_queue_desctyp_get(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
return core->mac[E1000_SRRCTL(r->idx) >> 2] & E1000_SRRCTL_DESCTYPE_MASK;
|
|
}
|
|
|
|
static bool
|
|
igb_rx_use_ps_descriptor(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
uint32_t desctyp = igb_rx_queue_desctyp_get(core, r);
|
|
return desctyp == E1000_SRRCTL_DESCTYPE_HDR_SPLIT ||
|
|
desctyp == E1000_SRRCTL_DESCTYPE_HDR_SPLIT_ALWAYS;
|
|
}
|
|
|
|
static inline bool
|
|
igb_rss_enabled(IGBCore *core)
|
|
{
|
|
return (core->mac[MRQC] & 3) == E1000_MRQC_ENABLE_RSS_MQ &&
|
|
!igb_rx_csum_enabled(core) &&
|
|
!igb_rx_use_legacy_descriptor(core);
|
|
}
|
|
|
|
typedef struct E1000E_RSSInfo_st {
|
|
bool enabled;
|
|
uint32_t hash;
|
|
uint32_t queue;
|
|
uint32_t type;
|
|
} E1000E_RSSInfo;
|
|
|
|
static uint32_t
|
|
igb_rss_get_hash_type(IGBCore *core, struct NetRxPkt *pkt)
|
|
{
|
|
bool hasip4, hasip6;
|
|
EthL4HdrProto l4hdr_proto;
|
|
|
|
assert(igb_rss_enabled(core));
|
|
|
|
net_rx_pkt_get_protocols(pkt, &hasip4, &hasip6, &l4hdr_proto);
|
|
|
|
if (hasip4) {
|
|
trace_e1000e_rx_rss_ip4(l4hdr_proto, core->mac[MRQC],
|
|
E1000_MRQC_EN_TCPIPV4(core->mac[MRQC]),
|
|
E1000_MRQC_EN_IPV4(core->mac[MRQC]));
|
|
|
|
if (l4hdr_proto == ETH_L4_HDR_PROTO_TCP &&
|
|
E1000_MRQC_EN_TCPIPV4(core->mac[MRQC])) {
|
|
return E1000_MRQ_RSS_TYPE_IPV4TCP;
|
|
}
|
|
|
|
if (l4hdr_proto == ETH_L4_HDR_PROTO_UDP &&
|
|
(core->mac[MRQC] & E1000_MRQC_RSS_FIELD_IPV4_UDP)) {
|
|
return E1000_MRQ_RSS_TYPE_IPV4UDP;
|
|
}
|
|
|
|
if (E1000_MRQC_EN_IPV4(core->mac[MRQC])) {
|
|
return E1000_MRQ_RSS_TYPE_IPV4;
|
|
}
|
|
} else if (hasip6) {
|
|
eth_ip6_hdr_info *ip6info = net_rx_pkt_get_ip6_info(pkt);
|
|
|
|
bool ex_dis = core->mac[RFCTL] & E1000_RFCTL_IPV6_EX_DIS;
|
|
bool new_ex_dis = core->mac[RFCTL] & E1000_RFCTL_NEW_IPV6_EXT_DIS;
|
|
|
|
/*
|
|
* Following two traces must not be combined because resulting
|
|
* event will have 11 arguments totally and some trace backends
|
|
* (at least "ust") have limitation of maximum 10 arguments per
|
|
* event. Events with more arguments fail to compile for
|
|
* backends like these.
|
|
*/
|
|
trace_e1000e_rx_rss_ip6_rfctl(core->mac[RFCTL]);
|
|
trace_e1000e_rx_rss_ip6(ex_dis, new_ex_dis, l4hdr_proto,
|
|
ip6info->has_ext_hdrs,
|
|
ip6info->rss_ex_dst_valid,
|
|
ip6info->rss_ex_src_valid,
|
|
core->mac[MRQC],
|
|
E1000_MRQC_EN_TCPIPV6EX(core->mac[MRQC]),
|
|
E1000_MRQC_EN_IPV6EX(core->mac[MRQC]),
|
|
E1000_MRQC_EN_IPV6(core->mac[MRQC]));
|
|
|
|
if ((!ex_dis || !ip6info->has_ext_hdrs) &&
|
|
(!new_ex_dis || !(ip6info->rss_ex_dst_valid ||
|
|
ip6info->rss_ex_src_valid))) {
|
|
|
|
if (l4hdr_proto == ETH_L4_HDR_PROTO_TCP &&
|
|
E1000_MRQC_EN_TCPIPV6EX(core->mac[MRQC])) {
|
|
return E1000_MRQ_RSS_TYPE_IPV6TCPEX;
|
|
}
|
|
|
|
if (l4hdr_proto == ETH_L4_HDR_PROTO_UDP &&
|
|
(core->mac[MRQC] & E1000_MRQC_RSS_FIELD_IPV6_UDP)) {
|
|
return E1000_MRQ_RSS_TYPE_IPV6UDP;
|
|
}
|
|
|
|
if (E1000_MRQC_EN_IPV6EX(core->mac[MRQC])) {
|
|
return E1000_MRQ_RSS_TYPE_IPV6EX;
|
|
}
|
|
|
|
}
|
|
|
|
if (E1000_MRQC_EN_IPV6(core->mac[MRQC])) {
|
|
return E1000_MRQ_RSS_TYPE_IPV6;
|
|
}
|
|
|
|
}
|
|
|
|
return E1000_MRQ_RSS_TYPE_NONE;
|
|
}
|
|
|
|
static uint32_t
|
|
igb_rss_calc_hash(IGBCore *core, struct NetRxPkt *pkt, E1000E_RSSInfo *info)
|
|
{
|
|
NetRxPktRssType type;
|
|
|
|
assert(igb_rss_enabled(core));
|
|
|
|
switch (info->type) {
|
|
case E1000_MRQ_RSS_TYPE_IPV4:
|
|
type = NetPktRssIpV4;
|
|
break;
|
|
case E1000_MRQ_RSS_TYPE_IPV4TCP:
|
|
type = NetPktRssIpV4Tcp;
|
|
break;
|
|
case E1000_MRQ_RSS_TYPE_IPV6TCPEX:
|
|
type = NetPktRssIpV6TcpEx;
|
|
break;
|
|
case E1000_MRQ_RSS_TYPE_IPV6:
|
|
type = NetPktRssIpV6;
|
|
break;
|
|
case E1000_MRQ_RSS_TYPE_IPV6EX:
|
|
type = NetPktRssIpV6Ex;
|
|
break;
|
|
case E1000_MRQ_RSS_TYPE_IPV4UDP:
|
|
type = NetPktRssIpV4Udp;
|
|
break;
|
|
case E1000_MRQ_RSS_TYPE_IPV6UDP:
|
|
type = NetPktRssIpV6Udp;
|
|
break;
|
|
default:
|
|
assert(false);
|
|
return 0;
|
|
}
|
|
|
|
return net_rx_pkt_calc_rss_hash(pkt, type, (uint8_t *) &core->mac[RSSRK]);
|
|
}
|
|
|
|
static void
|
|
igb_rss_parse_packet(IGBCore *core, struct NetRxPkt *pkt, bool tx,
|
|
E1000E_RSSInfo *info)
|
|
{
|
|
trace_e1000e_rx_rss_started();
|
|
|
|
if (tx || !igb_rss_enabled(core)) {
|
|
info->enabled = false;
|
|
info->hash = 0;
|
|
info->queue = 0;
|
|
info->type = 0;
|
|
trace_e1000e_rx_rss_disabled();
|
|
return;
|
|
}
|
|
|
|
info->enabled = true;
|
|
|
|
info->type = igb_rss_get_hash_type(core, pkt);
|
|
|
|
trace_e1000e_rx_rss_type(info->type);
|
|
|
|
if (info->type == E1000_MRQ_RSS_TYPE_NONE) {
|
|
info->hash = 0;
|
|
info->queue = 0;
|
|
return;
|
|
}
|
|
|
|
info->hash = igb_rss_calc_hash(core, pkt, info);
|
|
info->queue = E1000_RSS_QUEUE(&core->mac[RETA], info->hash);
|
|
}
|
|
|
|
static void
|
|
igb_tx_insert_vlan(IGBCore *core, uint16_t qn, struct igb_tx *tx,
|
|
uint16_t vlan, bool insert_vlan)
|
|
{
|
|
if (core->mac[MRQC] & 1) {
|
|
uint16_t pool = qn % IGB_NUM_VM_POOLS;
|
|
|
|
if (core->mac[VMVIR0 + pool] & E1000_VMVIR_VLANA_DEFAULT) {
|
|
/* always insert default VLAN */
|
|
insert_vlan = true;
|
|
vlan = core->mac[VMVIR0 + pool] & 0xffff;
|
|
} else if (core->mac[VMVIR0 + pool] & E1000_VMVIR_VLANA_NEVER) {
|
|
insert_vlan = false;
|
|
}
|
|
}
|
|
|
|
if (insert_vlan) {
|
|
net_tx_pkt_setup_vlan_header_ex(tx->tx_pkt, vlan,
|
|
core->mac[VET] & 0xffff);
|
|
}
|
|
}
|
|
|
|
static bool
|
|
igb_setup_tx_offloads(IGBCore *core, struct igb_tx *tx)
|
|
{
|
|
uint32_t idx = (tx->first_olinfo_status >> 4) & 1;
|
|
|
|
if (tx->first_cmd_type_len & E1000_ADVTXD_DCMD_TSE) {
|
|
uint32_t mss = tx->ctx[idx].mss_l4len_idx >> E1000_ADVTXD_MSS_SHIFT;
|
|
if (!net_tx_pkt_build_vheader(tx->tx_pkt, true, true, mss)) {
|
|
return false;
|
|
}
|
|
|
|
net_tx_pkt_update_ip_checksums(tx->tx_pkt);
|
|
e1000x_inc_reg_if_not_full(core->mac, TSCTC);
|
|
return true;
|
|
}
|
|
|
|
if ((tx->first_olinfo_status & E1000_ADVTXD_POTS_TXSM) &&
|
|
!((tx->ctx[idx].type_tucmd_mlhl & E1000_ADVTXD_TUCMD_L4T_SCTP) ?
|
|
net_tx_pkt_update_sctp_checksum(tx->tx_pkt) :
|
|
net_tx_pkt_build_vheader(tx->tx_pkt, false, true, 0))) {
|
|
return false;
|
|
}
|
|
|
|
if (tx->first_olinfo_status & E1000_ADVTXD_POTS_IXSM) {
|
|
net_tx_pkt_update_ip_hdr_checksum(tx->tx_pkt);
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static void igb_tx_pkt_mac_callback(void *core,
|
|
const struct iovec *iov,
|
|
int iovcnt,
|
|
const struct iovec *virt_iov,
|
|
int virt_iovcnt)
|
|
{
|
|
igb_receive_internal(core, virt_iov, virt_iovcnt, true, NULL);
|
|
}
|
|
|
|
static void igb_tx_pkt_vmdq_callback(void *opaque,
|
|
const struct iovec *iov,
|
|
int iovcnt,
|
|
const struct iovec *virt_iov,
|
|
int virt_iovcnt)
|
|
{
|
|
IGBTxPktVmdqCallbackContext *context = opaque;
|
|
bool external_tx;
|
|
|
|
igb_receive_internal(context->core, virt_iov, virt_iovcnt, true,
|
|
&external_tx);
|
|
|
|
if (external_tx) {
|
|
if (context->core->has_vnet) {
|
|
qemu_sendv_packet(context->nc, virt_iov, virt_iovcnt);
|
|
} else {
|
|
qemu_sendv_packet(context->nc, iov, iovcnt);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* TX Packets Switching (7.10.3.6) */
|
|
static bool igb_tx_pkt_switch(IGBCore *core, struct igb_tx *tx,
|
|
NetClientState *nc)
|
|
{
|
|
IGBTxPktVmdqCallbackContext context;
|
|
|
|
/* TX switching is only used to serve VM to VM traffic. */
|
|
if (!(core->mac[MRQC] & 1)) {
|
|
goto send_out;
|
|
}
|
|
|
|
/* TX switching requires DTXSWC.Loopback_en bit enabled. */
|
|
if (!(core->mac[DTXSWC] & E1000_DTXSWC_VMDQ_LOOPBACK_EN)) {
|
|
goto send_out;
|
|
}
|
|
|
|
context.core = core;
|
|
context.nc = nc;
|
|
|
|
return net_tx_pkt_send_custom(tx->tx_pkt, false,
|
|
igb_tx_pkt_vmdq_callback, &context);
|
|
|
|
send_out:
|
|
return net_tx_pkt_send(tx->tx_pkt, nc);
|
|
}
|
|
|
|
static bool
|
|
igb_tx_pkt_send(IGBCore *core, struct igb_tx *tx, int queue_index)
|
|
{
|
|
int target_queue = MIN(core->max_queue_num, queue_index);
|
|
NetClientState *queue = qemu_get_subqueue(core->owner_nic, target_queue);
|
|
|
|
if (!igb_setup_tx_offloads(core, tx)) {
|
|
return false;
|
|
}
|
|
|
|
net_tx_pkt_dump(tx->tx_pkt);
|
|
|
|
if ((core->phy[MII_BMCR] & MII_BMCR_LOOPBACK) ||
|
|
((core->mac[RCTL] & E1000_RCTL_LBM_MAC) == E1000_RCTL_LBM_MAC)) {
|
|
return net_tx_pkt_send_custom(tx->tx_pkt, false,
|
|
igb_tx_pkt_mac_callback, core);
|
|
} else {
|
|
return igb_tx_pkt_switch(core, tx, queue);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_on_tx_done_update_stats(IGBCore *core, struct NetTxPkt *tx_pkt, int qn)
|
|
{
|
|
static const int PTCregs[6] = { PTC64, PTC127, PTC255, PTC511,
|
|
PTC1023, PTC1522 };
|
|
|
|
size_t tot_len = net_tx_pkt_get_total_len(tx_pkt) + 4;
|
|
|
|
e1000x_increase_size_stats(core->mac, PTCregs, tot_len);
|
|
e1000x_inc_reg_if_not_full(core->mac, TPT);
|
|
e1000x_grow_8reg_if_not_full(core->mac, TOTL, tot_len);
|
|
|
|
switch (net_tx_pkt_get_packet_type(tx_pkt)) {
|
|
case ETH_PKT_BCAST:
|
|
e1000x_inc_reg_if_not_full(core->mac, BPTC);
|
|
break;
|
|
case ETH_PKT_MCAST:
|
|
e1000x_inc_reg_if_not_full(core->mac, MPTC);
|
|
break;
|
|
case ETH_PKT_UCAST:
|
|
break;
|
|
default:
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
e1000x_inc_reg_if_not_full(core->mac, GPTC);
|
|
e1000x_grow_8reg_if_not_full(core->mac, GOTCL, tot_len);
|
|
|
|
if (core->mac[MRQC] & 1) {
|
|
uint16_t pool = qn % IGB_NUM_VM_POOLS;
|
|
|
|
core->mac[PVFGOTC0 + (pool * 64)] += tot_len;
|
|
core->mac[PVFGPTC0 + (pool * 64)]++;
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_process_tx_desc(IGBCore *core,
|
|
PCIDevice *dev,
|
|
struct igb_tx *tx,
|
|
union e1000_adv_tx_desc *tx_desc,
|
|
int queue_index)
|
|
{
|
|
struct e1000_adv_tx_context_desc *tx_ctx_desc;
|
|
uint32_t cmd_type_len;
|
|
uint32_t idx;
|
|
uint64_t buffer_addr;
|
|
uint16_t length;
|
|
|
|
cmd_type_len = le32_to_cpu(tx_desc->read.cmd_type_len);
|
|
|
|
if (cmd_type_len & E1000_ADVTXD_DCMD_DEXT) {
|
|
if ((cmd_type_len & E1000_ADVTXD_DTYP_DATA) ==
|
|
E1000_ADVTXD_DTYP_DATA) {
|
|
/* advanced transmit data descriptor */
|
|
if (tx->first) {
|
|
tx->first_cmd_type_len = cmd_type_len;
|
|
tx->first_olinfo_status = le32_to_cpu(tx_desc->read.olinfo_status);
|
|
tx->first = false;
|
|
}
|
|
} else if ((cmd_type_len & E1000_ADVTXD_DTYP_CTXT) ==
|
|
E1000_ADVTXD_DTYP_CTXT) {
|
|
/* advanced transmit context descriptor */
|
|
tx_ctx_desc = (struct e1000_adv_tx_context_desc *)tx_desc;
|
|
idx = (le32_to_cpu(tx_ctx_desc->mss_l4len_idx) >> 4) & 1;
|
|
tx->ctx[idx].vlan_macip_lens = le32_to_cpu(tx_ctx_desc->vlan_macip_lens);
|
|
tx->ctx[idx].seqnum_seed = le32_to_cpu(tx_ctx_desc->seqnum_seed);
|
|
tx->ctx[idx].type_tucmd_mlhl = le32_to_cpu(tx_ctx_desc->type_tucmd_mlhl);
|
|
tx->ctx[idx].mss_l4len_idx = le32_to_cpu(tx_ctx_desc->mss_l4len_idx);
|
|
return;
|
|
} else {
|
|
/* unknown descriptor type */
|
|
return;
|
|
}
|
|
} else {
|
|
/* legacy descriptor */
|
|
|
|
/* TODO: Implement a support for legacy descriptors (7.2.2.1). */
|
|
}
|
|
|
|
buffer_addr = le64_to_cpu(tx_desc->read.buffer_addr);
|
|
length = cmd_type_len & 0xFFFF;
|
|
|
|
if (!tx->skip_cp) {
|
|
if (!net_tx_pkt_add_raw_fragment_pci(tx->tx_pkt, dev,
|
|
buffer_addr, length)) {
|
|
tx->skip_cp = true;
|
|
}
|
|
}
|
|
|
|
if (cmd_type_len & E1000_TXD_CMD_EOP) {
|
|
if (!tx->skip_cp && net_tx_pkt_parse(tx->tx_pkt)) {
|
|
idx = (tx->first_olinfo_status >> 4) & 1;
|
|
igb_tx_insert_vlan(core, queue_index, tx,
|
|
tx->ctx[idx].vlan_macip_lens >> IGB_TX_FLAGS_VLAN_SHIFT,
|
|
!!(tx->first_cmd_type_len & E1000_TXD_CMD_VLE));
|
|
|
|
if ((tx->first_cmd_type_len & E1000_ADVTXD_MAC_TSTAMP) &&
|
|
(core->mac[TSYNCTXCTL] & E1000_TSYNCTXCTL_ENABLED) &&
|
|
!(core->mac[TSYNCTXCTL] & E1000_TSYNCTXCTL_VALID)) {
|
|
core->mac[TSYNCTXCTL] |= E1000_TSYNCTXCTL_VALID;
|
|
e1000x_timestamp(core->mac, core->timadj, TXSTMPL, TXSTMPH);
|
|
}
|
|
|
|
if (igb_tx_pkt_send(core, tx, queue_index)) {
|
|
igb_on_tx_done_update_stats(core, tx->tx_pkt, queue_index);
|
|
}
|
|
}
|
|
|
|
tx->first = true;
|
|
tx->skip_cp = false;
|
|
net_tx_pkt_reset(tx->tx_pkt, net_tx_pkt_unmap_frag_pci, dev);
|
|
}
|
|
}
|
|
|
|
static uint32_t igb_tx_wb_eic(IGBCore *core, int queue_idx)
|
|
{
|
|
uint32_t n, ent = 0;
|
|
|
|
n = igb_ivar_entry_tx(queue_idx);
|
|
ent = (core->mac[IVAR0 + n / 4] >> (8 * (n % 4))) & 0xff;
|
|
|
|
return (ent & E1000_IVAR_VALID) ? BIT(ent & 0x1f) : 0;
|
|
}
|
|
|
|
static uint32_t igb_rx_wb_eic(IGBCore *core, int queue_idx)
|
|
{
|
|
uint32_t n, ent = 0;
|
|
|
|
n = igb_ivar_entry_rx(queue_idx);
|
|
ent = (core->mac[IVAR0 + n / 4] >> (8 * (n % 4))) & 0xff;
|
|
|
|
return (ent & E1000_IVAR_VALID) ? BIT(ent & 0x1f) : 0;
|
|
}
|
|
|
|
static inline bool
|
|
igb_ring_empty(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
return core->mac[r->dh] == core->mac[r->dt] ||
|
|
core->mac[r->dt] >= core->mac[r->dlen] / E1000_RING_DESC_LEN;
|
|
}
|
|
|
|
static inline uint64_t
|
|
igb_ring_base(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
uint64_t bah = core->mac[r->dbah];
|
|
uint64_t bal = core->mac[r->dbal];
|
|
|
|
return (bah << 32) + bal;
|
|
}
|
|
|
|
static inline uint64_t
|
|
igb_ring_head_descr(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
return igb_ring_base(core, r) + E1000_RING_DESC_LEN * core->mac[r->dh];
|
|
}
|
|
|
|
static inline void
|
|
igb_ring_advance(IGBCore *core, const E1000ERingInfo *r, uint32_t count)
|
|
{
|
|
core->mac[r->dh] += count;
|
|
|
|
if (core->mac[r->dh] * E1000_RING_DESC_LEN >= core->mac[r->dlen]) {
|
|
core->mac[r->dh] = 0;
|
|
}
|
|
}
|
|
|
|
static inline uint32_t
|
|
igb_ring_free_descr_num(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
trace_e1000e_ring_free_space(r->idx, core->mac[r->dlen],
|
|
core->mac[r->dh], core->mac[r->dt]);
|
|
|
|
if (core->mac[r->dh] <= core->mac[r->dt]) {
|
|
return core->mac[r->dt] - core->mac[r->dh];
|
|
}
|
|
|
|
if (core->mac[r->dh] > core->mac[r->dt]) {
|
|
return core->mac[r->dlen] / E1000_RING_DESC_LEN +
|
|
core->mac[r->dt] - core->mac[r->dh];
|
|
}
|
|
|
|
g_assert_not_reached();
|
|
return 0;
|
|
}
|
|
|
|
static inline bool
|
|
igb_ring_enabled(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
return core->mac[r->dlen] > 0;
|
|
}
|
|
|
|
typedef struct IGB_TxRing_st {
|
|
const E1000ERingInfo *i;
|
|
struct igb_tx *tx;
|
|
} IGB_TxRing;
|
|
|
|
static inline int
|
|
igb_mq_queue_idx(int base_reg_idx, int reg_idx)
|
|
{
|
|
return (reg_idx - base_reg_idx) / 16;
|
|
}
|
|
|
|
static inline void
|
|
igb_tx_ring_init(IGBCore *core, IGB_TxRing *txr, int idx)
|
|
{
|
|
static const E1000ERingInfo i[IGB_NUM_QUEUES] = {
|
|
{ TDBAH0, TDBAL0, TDLEN0, TDH0, TDT0, 0 },
|
|
{ TDBAH1, TDBAL1, TDLEN1, TDH1, TDT1, 1 },
|
|
{ TDBAH2, TDBAL2, TDLEN2, TDH2, TDT2, 2 },
|
|
{ TDBAH3, TDBAL3, TDLEN3, TDH3, TDT3, 3 },
|
|
{ TDBAH4, TDBAL4, TDLEN4, TDH4, TDT4, 4 },
|
|
{ TDBAH5, TDBAL5, TDLEN5, TDH5, TDT5, 5 },
|
|
{ TDBAH6, TDBAL6, TDLEN6, TDH6, TDT6, 6 },
|
|
{ TDBAH7, TDBAL7, TDLEN7, TDH7, TDT7, 7 },
|
|
{ TDBAH8, TDBAL8, TDLEN8, TDH8, TDT8, 8 },
|
|
{ TDBAH9, TDBAL9, TDLEN9, TDH9, TDT9, 9 },
|
|
{ TDBAH10, TDBAL10, TDLEN10, TDH10, TDT10, 10 },
|
|
{ TDBAH11, TDBAL11, TDLEN11, TDH11, TDT11, 11 },
|
|
{ TDBAH12, TDBAL12, TDLEN12, TDH12, TDT12, 12 },
|
|
{ TDBAH13, TDBAL13, TDLEN13, TDH13, TDT13, 13 },
|
|
{ TDBAH14, TDBAL14, TDLEN14, TDH14, TDT14, 14 },
|
|
{ TDBAH15, TDBAL15, TDLEN15, TDH15, TDT15, 15 }
|
|
};
|
|
|
|
assert(idx < ARRAY_SIZE(i));
|
|
|
|
txr->i = &i[idx];
|
|
txr->tx = &core->tx[idx];
|
|
}
|
|
|
|
typedef struct E1000E_RxRing_st {
|
|
const E1000ERingInfo *i;
|
|
} E1000E_RxRing;
|
|
|
|
static inline void
|
|
igb_rx_ring_init(IGBCore *core, E1000E_RxRing *rxr, int idx)
|
|
{
|
|
static const E1000ERingInfo i[IGB_NUM_QUEUES] = {
|
|
{ RDBAH0, RDBAL0, RDLEN0, RDH0, RDT0, 0 },
|
|
{ RDBAH1, RDBAL1, RDLEN1, RDH1, RDT1, 1 },
|
|
{ RDBAH2, RDBAL2, RDLEN2, RDH2, RDT2, 2 },
|
|
{ RDBAH3, RDBAL3, RDLEN3, RDH3, RDT3, 3 },
|
|
{ RDBAH4, RDBAL4, RDLEN4, RDH4, RDT4, 4 },
|
|
{ RDBAH5, RDBAL5, RDLEN5, RDH5, RDT5, 5 },
|
|
{ RDBAH6, RDBAL6, RDLEN6, RDH6, RDT6, 6 },
|
|
{ RDBAH7, RDBAL7, RDLEN7, RDH7, RDT7, 7 },
|
|
{ RDBAH8, RDBAL8, RDLEN8, RDH8, RDT8, 8 },
|
|
{ RDBAH9, RDBAL9, RDLEN9, RDH9, RDT9, 9 },
|
|
{ RDBAH10, RDBAL10, RDLEN10, RDH10, RDT10, 10 },
|
|
{ RDBAH11, RDBAL11, RDLEN11, RDH11, RDT11, 11 },
|
|
{ RDBAH12, RDBAL12, RDLEN12, RDH12, RDT12, 12 },
|
|
{ RDBAH13, RDBAL13, RDLEN13, RDH13, RDT13, 13 },
|
|
{ RDBAH14, RDBAL14, RDLEN14, RDH14, RDT14, 14 },
|
|
{ RDBAH15, RDBAL15, RDLEN15, RDH15, RDT15, 15 }
|
|
};
|
|
|
|
assert(idx < ARRAY_SIZE(i));
|
|
|
|
rxr->i = &i[idx];
|
|
}
|
|
|
|
static uint32_t
|
|
igb_txdesc_writeback(IGBCore *core, dma_addr_t base,
|
|
union e1000_adv_tx_desc *tx_desc,
|
|
const E1000ERingInfo *txi)
|
|
{
|
|
PCIDevice *d;
|
|
uint32_t cmd_type_len = le32_to_cpu(tx_desc->read.cmd_type_len);
|
|
uint64_t tdwba;
|
|
|
|
tdwba = core->mac[E1000_TDWBAL(txi->idx) >> 2];
|
|
tdwba |= (uint64_t)core->mac[E1000_TDWBAH(txi->idx) >> 2] << 32;
|
|
|
|
if (!(cmd_type_len & E1000_TXD_CMD_RS)) {
|
|
return 0;
|
|
}
|
|
|
|
d = pcie_sriov_get_vf_at_index(core->owner, txi->idx % 8);
|
|
if (!d) {
|
|
d = core->owner;
|
|
}
|
|
|
|
if (tdwba & 1) {
|
|
uint32_t buffer = cpu_to_le32(core->mac[txi->dh]);
|
|
pci_dma_write(d, tdwba & ~3, &buffer, sizeof(buffer));
|
|
} else {
|
|
uint32_t status = le32_to_cpu(tx_desc->wb.status) | E1000_TXD_STAT_DD;
|
|
|
|
tx_desc->wb.status = cpu_to_le32(status);
|
|
pci_dma_write(d, base + offsetof(union e1000_adv_tx_desc, wb),
|
|
&tx_desc->wb, sizeof(tx_desc->wb));
|
|
}
|
|
|
|
return igb_tx_wb_eic(core, txi->idx);
|
|
}
|
|
|
|
static inline bool
|
|
igb_tx_enabled(IGBCore *core, const E1000ERingInfo *txi)
|
|
{
|
|
bool vmdq = core->mac[MRQC] & 1;
|
|
uint16_t qn = txi->idx;
|
|
uint16_t pool = qn % IGB_NUM_VM_POOLS;
|
|
|
|
return (core->mac[TCTL] & E1000_TCTL_EN) &&
|
|
(!vmdq || core->mac[VFTE] & BIT(pool)) &&
|
|
(core->mac[TXDCTL0 + (qn * 16)] & E1000_TXDCTL_QUEUE_ENABLE);
|
|
}
|
|
|
|
static void
|
|
igb_start_xmit(IGBCore *core, const IGB_TxRing *txr)
|
|
{
|
|
PCIDevice *d;
|
|
dma_addr_t base;
|
|
union e1000_adv_tx_desc desc;
|
|
const E1000ERingInfo *txi = txr->i;
|
|
uint32_t eic = 0;
|
|
|
|
if (!igb_tx_enabled(core, txi)) {
|
|
trace_e1000e_tx_disabled();
|
|
return;
|
|
}
|
|
|
|
d = pcie_sriov_get_vf_at_index(core->owner, txi->idx % 8);
|
|
if (!d) {
|
|
d = core->owner;
|
|
}
|
|
|
|
while (!igb_ring_empty(core, txi)) {
|
|
base = igb_ring_head_descr(core, txi);
|
|
|
|
pci_dma_read(d, base, &desc, sizeof(desc));
|
|
|
|
trace_e1000e_tx_descr((void *)(intptr_t)desc.read.buffer_addr,
|
|
desc.read.cmd_type_len, desc.wb.status);
|
|
|
|
igb_process_tx_desc(core, d, txr->tx, &desc, txi->idx);
|
|
igb_ring_advance(core, txi, 1);
|
|
eic |= igb_txdesc_writeback(core, base, &desc, txi);
|
|
}
|
|
|
|
if (eic) {
|
|
igb_raise_interrupts(core, EICR, eic);
|
|
igb_raise_interrupts(core, ICR, E1000_ICR_TXDW);
|
|
}
|
|
|
|
net_tx_pkt_reset(txr->tx->tx_pkt, net_tx_pkt_unmap_frag_pci, d);
|
|
}
|
|
|
|
static uint32_t
|
|
igb_rxbufsize(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
uint32_t srrctl = core->mac[E1000_SRRCTL(r->idx) >> 2];
|
|
uint32_t bsizepkt = srrctl & E1000_SRRCTL_BSIZEPKT_MASK;
|
|
if (bsizepkt) {
|
|
return bsizepkt << E1000_SRRCTL_BSIZEPKT_SHIFT;
|
|
}
|
|
|
|
return e1000x_rxbufsize(core->mac[RCTL]);
|
|
}
|
|
|
|
static bool
|
|
igb_has_rxbufs(IGBCore *core, const E1000ERingInfo *r, size_t total_size)
|
|
{
|
|
uint32_t bufs = igb_ring_free_descr_num(core, r);
|
|
uint32_t bufsize = igb_rxbufsize(core, r);
|
|
|
|
trace_e1000e_rx_has_buffers(r->idx, bufs, total_size, bufsize);
|
|
|
|
return total_size <= bufs / (core->rx_desc_len / E1000_MIN_RX_DESC_LEN) *
|
|
bufsize;
|
|
}
|
|
|
|
static uint32_t
|
|
igb_rxhdrbufsize(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
uint32_t srrctl = core->mac[E1000_SRRCTL(r->idx) >> 2];
|
|
return (srrctl & E1000_SRRCTL_BSIZEHDRSIZE_MASK) >>
|
|
E1000_SRRCTL_BSIZEHDRSIZE_SHIFT;
|
|
}
|
|
|
|
void
|
|
igb_start_recv(IGBCore *core)
|
|
{
|
|
int i;
|
|
|
|
trace_e1000e_rx_start_recv();
|
|
|
|
for (i = 0; i <= core->max_queue_num; i++) {
|
|
qemu_flush_queued_packets(qemu_get_subqueue(core->owner_nic, i));
|
|
}
|
|
}
|
|
|
|
bool
|
|
igb_can_receive(IGBCore *core)
|
|
{
|
|
int i;
|
|
|
|
if (!e1000x_rx_ready(core->owner, core->mac)) {
|
|
return false;
|
|
}
|
|
|
|
for (i = 0; i < IGB_NUM_QUEUES; i++) {
|
|
E1000E_RxRing rxr;
|
|
if (!(core->mac[RXDCTL0 + (i * 16)] & E1000_RXDCTL_QUEUE_ENABLE)) {
|
|
continue;
|
|
}
|
|
|
|
igb_rx_ring_init(core, &rxr, i);
|
|
if (igb_ring_enabled(core, rxr.i) && igb_has_rxbufs(core, rxr.i, 1)) {
|
|
trace_e1000e_rx_can_recv();
|
|
return true;
|
|
}
|
|
}
|
|
|
|
trace_e1000e_rx_can_recv_rings_full();
|
|
return false;
|
|
}
|
|
|
|
ssize_t
|
|
igb_receive(IGBCore *core, const uint8_t *buf, size_t size)
|
|
{
|
|
const struct iovec iov = {
|
|
.iov_base = (uint8_t *)buf,
|
|
.iov_len = size
|
|
};
|
|
|
|
return igb_receive_iov(core, &iov, 1);
|
|
}
|
|
|
|
static inline bool
|
|
igb_rx_l3_cso_enabled(IGBCore *core)
|
|
{
|
|
return !!(core->mac[RXCSUM] & E1000_RXCSUM_IPOFLD);
|
|
}
|
|
|
|
static inline bool
|
|
igb_rx_l4_cso_enabled(IGBCore *core)
|
|
{
|
|
return !!(core->mac[RXCSUM] & E1000_RXCSUM_TUOFLD);
|
|
}
|
|
|
|
static bool igb_rx_is_oversized(IGBCore *core, const struct eth_header *ehdr,
|
|
size_t size, size_t vlan_num,
|
|
bool lpe, uint16_t rlpml)
|
|
{
|
|
size_t vlan_header_size = sizeof(struct vlan_header) * vlan_num;
|
|
size_t header_size = sizeof(struct eth_header) + vlan_header_size;
|
|
return lpe ? size + ETH_FCS_LEN > rlpml : size > header_size + ETH_MTU;
|
|
}
|
|
|
|
static uint16_t igb_receive_assign(IGBCore *core, const struct iovec *iov,
|
|
size_t iovcnt, size_t iov_ofs,
|
|
const L2Header *l2_header, size_t size,
|
|
E1000E_RSSInfo *rss_info,
|
|
uint16_t *etqf, bool *ts, bool *external_tx)
|
|
{
|
|
static const int ta_shift[] = { 4, 3, 2, 0 };
|
|
const struct eth_header *ehdr = &l2_header->eth;
|
|
uint32_t f, ra[2], *macp, rctl = core->mac[RCTL];
|
|
uint16_t queues = 0;
|
|
uint16_t oversized = 0;
|
|
size_t vlan_num = 0;
|
|
PTP2 ptp2;
|
|
bool lpe;
|
|
uint16_t rlpml;
|
|
int i;
|
|
|
|
memset(rss_info, 0, sizeof(E1000E_RSSInfo));
|
|
*ts = false;
|
|
|
|
if (external_tx) {
|
|
*external_tx = true;
|
|
}
|
|
|
|
if (core->mac[CTRL_EXT] & BIT(26)) {
|
|
if (be16_to_cpu(ehdr->h_proto) == core->mac[VET] >> 16 &&
|
|
be16_to_cpu(l2_header->vlan[0].h_proto) == (core->mac[VET] & 0xffff)) {
|
|
vlan_num = 2;
|
|
}
|
|
} else {
|
|
if (be16_to_cpu(ehdr->h_proto) == (core->mac[VET] & 0xffff)) {
|
|
vlan_num = 1;
|
|
}
|
|
}
|
|
|
|
lpe = !!(core->mac[RCTL] & E1000_RCTL_LPE);
|
|
rlpml = core->mac[RLPML];
|
|
if (!(core->mac[RCTL] & E1000_RCTL_SBP) &&
|
|
igb_rx_is_oversized(core, ehdr, size, vlan_num, lpe, rlpml)) {
|
|
trace_e1000x_rx_oversized(size);
|
|
return queues;
|
|
}
|
|
|
|
for (*etqf = 0; *etqf < 8; (*etqf)++) {
|
|
if ((core->mac[ETQF0 + *etqf] & E1000_ETQF_FILTER_ENABLE) &&
|
|
be16_to_cpu(ehdr->h_proto) == (core->mac[ETQF0 + *etqf] & E1000_ETQF_ETYPE_MASK)) {
|
|
if ((core->mac[ETQF0 + *etqf] & E1000_ETQF_1588) &&
|
|
(core->mac[TSYNCRXCTL] & E1000_TSYNCRXCTL_ENABLED) &&
|
|
!(core->mac[TSYNCRXCTL] & E1000_TSYNCRXCTL_VALID) &&
|
|
iov_to_buf(iov, iovcnt, iov_ofs + ETH_HLEN, &ptp2, sizeof(ptp2)) >= sizeof(ptp2) &&
|
|
(ptp2.version_ptp & 15) == 2 &&
|
|
ptp2.message_id_transport_specific == ((core->mac[TSYNCRXCFG] >> 8) & 255)) {
|
|
e1000x_timestamp(core->mac, core->timadj, RXSTMPL, RXSTMPH);
|
|
*ts = true;
|
|
core->mac[TSYNCRXCTL] |= E1000_TSYNCRXCTL_VALID;
|
|
core->mac[RXSATRL] = le32_to_cpu(ptp2.source_uuid_lo);
|
|
core->mac[RXSATRH] = le16_to_cpu(ptp2.source_uuid_hi) |
|
|
(le16_to_cpu(ptp2.sequence_id) << 16);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (vlan_num &&
|
|
!e1000x_rx_vlan_filter(core->mac, l2_header->vlan + vlan_num - 1)) {
|
|
return queues;
|
|
}
|
|
|
|
if (core->mac[MRQC] & 1) {
|
|
if (is_broadcast_ether_addr(ehdr->h_dest)) {
|
|
for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
|
|
if (core->mac[VMOLR0 + i] & E1000_VMOLR_BAM) {
|
|
queues |= BIT(i);
|
|
}
|
|
}
|
|
} else {
|
|
for (macp = core->mac + RA; macp < core->mac + RA + 32; macp += 2) {
|
|
if (!(macp[1] & E1000_RAH_AV)) {
|
|
continue;
|
|
}
|
|
ra[0] = cpu_to_le32(macp[0]);
|
|
ra[1] = cpu_to_le32(macp[1]);
|
|
if (!memcmp(ehdr->h_dest, (uint8_t *)ra, ETH_ALEN)) {
|
|
queues |= (macp[1] & E1000_RAH_POOL_MASK) / E1000_RAH_POOL_1;
|
|
}
|
|
}
|
|
|
|
for (macp = core->mac + RA2; macp < core->mac + RA2 + 16; macp += 2) {
|
|
if (!(macp[1] & E1000_RAH_AV)) {
|
|
continue;
|
|
}
|
|
ra[0] = cpu_to_le32(macp[0]);
|
|
ra[1] = cpu_to_le32(macp[1]);
|
|
if (!memcmp(ehdr->h_dest, (uint8_t *)ra, ETH_ALEN)) {
|
|
queues |= (macp[1] & E1000_RAH_POOL_MASK) / E1000_RAH_POOL_1;
|
|
}
|
|
}
|
|
|
|
if (!queues) {
|
|
macp = core->mac + (is_multicast_ether_addr(ehdr->h_dest) ? MTA : UTA);
|
|
|
|
f = ta_shift[(rctl >> E1000_RCTL_MO_SHIFT) & 3];
|
|
f = (((ehdr->h_dest[5] << 8) | ehdr->h_dest[4]) >> f) & 0xfff;
|
|
if (macp[f >> 5] & (1 << (f & 0x1f))) {
|
|
for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
|
|
if (core->mac[VMOLR0 + i] & E1000_VMOLR_ROMPE) {
|
|
queues |= BIT(i);
|
|
}
|
|
}
|
|
}
|
|
} else if (is_unicast_ether_addr(ehdr->h_dest) && external_tx) {
|
|
*external_tx = false;
|
|
}
|
|
}
|
|
|
|
if (e1000x_vlan_rx_filter_enabled(core->mac)) {
|
|
uint16_t mask = 0;
|
|
|
|
if (vlan_num) {
|
|
uint16_t vid = be16_to_cpu(l2_header->vlan[vlan_num - 1].h_tci) & VLAN_VID_MASK;
|
|
|
|
for (i = 0; i < E1000_VLVF_ARRAY_SIZE; i++) {
|
|
if ((core->mac[VLVF0 + i] & E1000_VLVF_VLANID_MASK) == vid &&
|
|
(core->mac[VLVF0 + i] & E1000_VLVF_VLANID_ENABLE)) {
|
|
uint32_t poolsel = core->mac[VLVF0 + i] & E1000_VLVF_POOLSEL_MASK;
|
|
mask |= poolsel >> E1000_VLVF_POOLSEL_SHIFT;
|
|
}
|
|
}
|
|
} else {
|
|
for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
|
|
if (core->mac[VMOLR0 + i] & E1000_VMOLR_AUPE) {
|
|
mask |= BIT(i);
|
|
}
|
|
}
|
|
}
|
|
|
|
queues &= mask;
|
|
}
|
|
|
|
if (is_unicast_ether_addr(ehdr->h_dest) && !queues && !external_tx &&
|
|
!(core->mac[VT_CTL] & E1000_VT_CTL_DISABLE_DEF_POOL)) {
|
|
uint32_t def_pl = core->mac[VT_CTL] & E1000_VT_CTL_DEFAULT_POOL_MASK;
|
|
queues = BIT(def_pl >> E1000_VT_CTL_DEFAULT_POOL_SHIFT);
|
|
}
|
|
|
|
queues &= core->mac[VFRE];
|
|
if (queues) {
|
|
for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
|
|
lpe = !!(core->mac[VMOLR0 + i] & E1000_VMOLR_LPE);
|
|
rlpml = core->mac[VMOLR0 + i] & E1000_VMOLR_RLPML_MASK;
|
|
if ((queues & BIT(i)) &&
|
|
igb_rx_is_oversized(core, ehdr, size, vlan_num,
|
|
lpe, rlpml)) {
|
|
oversized |= BIT(i);
|
|
}
|
|
}
|
|
/* 8.19.37 increment ROC if packet is oversized for all queues */
|
|
if (oversized == queues) {
|
|
trace_e1000x_rx_oversized(size);
|
|
e1000x_inc_reg_if_not_full(core->mac, ROC);
|
|
}
|
|
queues &= ~oversized;
|
|
}
|
|
|
|
if (queues) {
|
|
igb_rss_parse_packet(core, core->rx_pkt,
|
|
external_tx != NULL, rss_info);
|
|
/* Sec 8.26.1: PQn = VFn + VQn*8 */
|
|
if (rss_info->queue & 1) {
|
|
for (i = 0; i < IGB_NUM_VM_POOLS; i++) {
|
|
if ((queues & BIT(i)) &&
|
|
(core->mac[VMOLR0 + i] & E1000_VMOLR_RSSE)) {
|
|
queues |= BIT(i + IGB_NUM_VM_POOLS);
|
|
queues &= ~BIT(i);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
} else {
|
|
bool accepted = e1000x_rx_group_filter(core->mac, ehdr);
|
|
if (!accepted) {
|
|
for (macp = core->mac + RA2; macp < core->mac + RA2 + 16; macp += 2) {
|
|
if (!(macp[1] & E1000_RAH_AV)) {
|
|
continue;
|
|
}
|
|
ra[0] = cpu_to_le32(macp[0]);
|
|
ra[1] = cpu_to_le32(macp[1]);
|
|
if (!memcmp(ehdr->h_dest, (uint8_t *)ra, ETH_ALEN)) {
|
|
trace_e1000x_rx_flt_ucast_match((int)(macp - core->mac - RA2) / 2,
|
|
MAC_ARG(ehdr->h_dest));
|
|
|
|
accepted = true;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (accepted) {
|
|
igb_rss_parse_packet(core, core->rx_pkt, false, rss_info);
|
|
queues = BIT(rss_info->queue);
|
|
}
|
|
}
|
|
|
|
return queues;
|
|
}
|
|
|
|
static inline void
|
|
igb_read_lgcy_rx_descr(IGBCore *core, struct e1000_rx_desc *desc,
|
|
hwaddr *buff_addr)
|
|
{
|
|
*buff_addr = le64_to_cpu(desc->buffer_addr);
|
|
}
|
|
|
|
static inline void
|
|
igb_read_adv_rx_single_buf_descr(IGBCore *core, union e1000_adv_rx_desc *desc,
|
|
hwaddr *buff_addr)
|
|
{
|
|
*buff_addr = le64_to_cpu(desc->read.pkt_addr);
|
|
}
|
|
|
|
static inline void
|
|
igb_read_adv_rx_split_buf_descr(IGBCore *core, union e1000_adv_rx_desc *desc,
|
|
hwaddr *buff_addr)
|
|
{
|
|
buff_addr[0] = le64_to_cpu(desc->read.hdr_addr);
|
|
buff_addr[1] = le64_to_cpu(desc->read.pkt_addr);
|
|
}
|
|
|
|
typedef struct IGBBAState {
|
|
uint16_t written[IGB_MAX_PS_BUFFERS];
|
|
uint8_t cur_idx;
|
|
} IGBBAState;
|
|
|
|
typedef struct IGBSplitDescriptorData {
|
|
bool sph;
|
|
bool hbo;
|
|
size_t hdr_len;
|
|
} IGBSplitDescriptorData;
|
|
|
|
typedef struct IGBPacketRxDMAState {
|
|
size_t size;
|
|
size_t total_size;
|
|
size_t ps_hdr_len;
|
|
size_t desc_size;
|
|
size_t desc_offset;
|
|
uint32_t rx_desc_packet_buf_size;
|
|
uint32_t rx_desc_header_buf_size;
|
|
struct iovec *iov;
|
|
size_t iov_ofs;
|
|
bool do_ps;
|
|
bool is_first;
|
|
IGBBAState bastate;
|
|
hwaddr ba[IGB_MAX_PS_BUFFERS];
|
|
IGBSplitDescriptorData ps_desc_data;
|
|
} IGBPacketRxDMAState;
|
|
|
|
static inline void
|
|
igb_read_rx_descr(IGBCore *core,
|
|
union e1000_rx_desc_union *desc,
|
|
IGBPacketRxDMAState *pdma_st,
|
|
const E1000ERingInfo *r)
|
|
{
|
|
uint32_t desc_type;
|
|
|
|
if (igb_rx_use_legacy_descriptor(core)) {
|
|
igb_read_lgcy_rx_descr(core, &desc->legacy, &pdma_st->ba[1]);
|
|
pdma_st->ba[0] = 0;
|
|
return;
|
|
}
|
|
|
|
/* advanced header split descriptor */
|
|
if (igb_rx_use_ps_descriptor(core, r)) {
|
|
igb_read_adv_rx_split_buf_descr(core, &desc->adv, &pdma_st->ba[0]);
|
|
return;
|
|
}
|
|
|
|
/* descriptor replication modes not supported */
|
|
desc_type = igb_rx_queue_desctyp_get(core, r);
|
|
if (desc_type != E1000_SRRCTL_DESCTYPE_ADV_ONEBUF) {
|
|
trace_igb_wrn_rx_desc_modes_not_supp(desc_type);
|
|
}
|
|
|
|
/* advanced single buffer descriptor */
|
|
igb_read_adv_rx_single_buf_descr(core, &desc->adv, &pdma_st->ba[1]);
|
|
pdma_st->ba[0] = 0;
|
|
}
|
|
|
|
static void
|
|
igb_verify_csum_in_sw(IGBCore *core,
|
|
struct NetRxPkt *pkt,
|
|
uint32_t *status_flags,
|
|
EthL4HdrProto l4hdr_proto)
|
|
{
|
|
bool csum_valid;
|
|
uint32_t csum_error;
|
|
|
|
if (igb_rx_l3_cso_enabled(core)) {
|
|
if (!net_rx_pkt_validate_l3_csum(pkt, &csum_valid)) {
|
|
trace_e1000e_rx_metadata_l3_csum_validation_failed();
|
|
} else {
|
|
csum_error = csum_valid ? 0 : E1000_RXDEXT_STATERR_IPE;
|
|
*status_flags |= E1000_RXD_STAT_IPCS | csum_error;
|
|
}
|
|
} else {
|
|
trace_e1000e_rx_metadata_l3_cso_disabled();
|
|
}
|
|
|
|
if (!igb_rx_l4_cso_enabled(core)) {
|
|
trace_e1000e_rx_metadata_l4_cso_disabled();
|
|
return;
|
|
}
|
|
|
|
if (!net_rx_pkt_validate_l4_csum(pkt, &csum_valid)) {
|
|
trace_e1000e_rx_metadata_l4_csum_validation_failed();
|
|
return;
|
|
}
|
|
|
|
csum_error = csum_valid ? 0 : E1000_RXDEXT_STATERR_TCPE;
|
|
*status_flags |= E1000_RXD_STAT_TCPCS | csum_error;
|
|
|
|
if (l4hdr_proto == ETH_L4_HDR_PROTO_UDP) {
|
|
*status_flags |= E1000_RXD_STAT_UDPCS;
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_build_rx_metadata_common(IGBCore *core,
|
|
struct NetRxPkt *pkt,
|
|
bool is_eop,
|
|
uint32_t *status_flags,
|
|
uint16_t *vlan_tag)
|
|
{
|
|
struct virtio_net_hdr *vhdr;
|
|
bool hasip4, hasip6, csum_valid;
|
|
EthL4HdrProto l4hdr_proto;
|
|
|
|
*status_flags = E1000_RXD_STAT_DD;
|
|
|
|
/* No additional metadata needed for non-EOP descriptors */
|
|
if (!is_eop) {
|
|
goto func_exit;
|
|
}
|
|
|
|
*status_flags |= E1000_RXD_STAT_EOP;
|
|
|
|
net_rx_pkt_get_protocols(pkt, &hasip4, &hasip6, &l4hdr_proto);
|
|
trace_e1000e_rx_metadata_protocols(hasip4, hasip6, l4hdr_proto);
|
|
|
|
/* VLAN state */
|
|
if (net_rx_pkt_is_vlan_stripped(pkt)) {
|
|
*status_flags |= E1000_RXD_STAT_VP;
|
|
*vlan_tag = cpu_to_le16(net_rx_pkt_get_vlan_tag(pkt));
|
|
trace_e1000e_rx_metadata_vlan(*vlan_tag);
|
|
}
|
|
|
|
/* RX CSO information */
|
|
if (hasip6 && (core->mac[RFCTL] & E1000_RFCTL_IPV6_XSUM_DIS)) {
|
|
trace_e1000e_rx_metadata_ipv6_sum_disabled();
|
|
goto func_exit;
|
|
}
|
|
|
|
vhdr = net_rx_pkt_get_vhdr(pkt);
|
|
|
|
if (!(vhdr->flags & VIRTIO_NET_HDR_F_DATA_VALID) &&
|
|
!(vhdr->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM)) {
|
|
trace_e1000e_rx_metadata_virthdr_no_csum_info();
|
|
igb_verify_csum_in_sw(core, pkt, status_flags, l4hdr_proto);
|
|
goto func_exit;
|
|
}
|
|
|
|
if (igb_rx_l3_cso_enabled(core)) {
|
|
*status_flags |= hasip4 ? E1000_RXD_STAT_IPCS : 0;
|
|
} else {
|
|
trace_e1000e_rx_metadata_l3_cso_disabled();
|
|
}
|
|
|
|
if (igb_rx_l4_cso_enabled(core)) {
|
|
switch (l4hdr_proto) {
|
|
case ETH_L4_HDR_PROTO_SCTP:
|
|
if (!net_rx_pkt_validate_l4_csum(pkt, &csum_valid)) {
|
|
trace_e1000e_rx_metadata_l4_csum_validation_failed();
|
|
goto func_exit;
|
|
}
|
|
if (!csum_valid) {
|
|
*status_flags |= E1000_RXDEXT_STATERR_TCPE;
|
|
}
|
|
/* fall through */
|
|
case ETH_L4_HDR_PROTO_TCP:
|
|
*status_flags |= E1000_RXD_STAT_TCPCS;
|
|
break;
|
|
|
|
case ETH_L4_HDR_PROTO_UDP:
|
|
*status_flags |= E1000_RXD_STAT_TCPCS | E1000_RXD_STAT_UDPCS;
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
} else {
|
|
trace_e1000e_rx_metadata_l4_cso_disabled();
|
|
}
|
|
|
|
func_exit:
|
|
trace_e1000e_rx_metadata_status_flags(*status_flags);
|
|
*status_flags = cpu_to_le32(*status_flags);
|
|
}
|
|
|
|
static inline void
|
|
igb_write_lgcy_rx_descr(IGBCore *core, struct e1000_rx_desc *desc,
|
|
struct NetRxPkt *pkt,
|
|
const E1000E_RSSInfo *rss_info,
|
|
uint16_t length)
|
|
{
|
|
uint32_t status_flags;
|
|
|
|
assert(!rss_info->enabled);
|
|
|
|
memset(desc, 0, sizeof(*desc));
|
|
desc->length = cpu_to_le16(length);
|
|
igb_build_rx_metadata_common(core, pkt, pkt != NULL,
|
|
&status_flags,
|
|
&desc->special);
|
|
|
|
desc->errors = (uint8_t) (le32_to_cpu(status_flags) >> 24);
|
|
desc->status = (uint8_t) le32_to_cpu(status_flags);
|
|
}
|
|
|
|
static bool
|
|
igb_rx_ps_descriptor_split_always(IGBCore *core, const E1000ERingInfo *r)
|
|
{
|
|
uint32_t desctyp = igb_rx_queue_desctyp_get(core, r);
|
|
return desctyp == E1000_SRRCTL_DESCTYPE_HDR_SPLIT_ALWAYS;
|
|
}
|
|
|
|
static uint16_t
|
|
igb_rx_desc_get_packet_type(IGBCore *core, struct NetRxPkt *pkt, uint16_t etqf)
|
|
{
|
|
uint16_t pkt_type;
|
|
bool hasip4, hasip6;
|
|
EthL4HdrProto l4hdr_proto;
|
|
|
|
if (etqf < 8) {
|
|
pkt_type = BIT(11) | etqf;
|
|
return pkt_type;
|
|
}
|
|
|
|
net_rx_pkt_get_protocols(pkt, &hasip4, &hasip6, &l4hdr_proto);
|
|
|
|
if (hasip6 && !(core->mac[RFCTL] & E1000_RFCTL_IPV6_DIS)) {
|
|
eth_ip6_hdr_info *ip6hdr_info = net_rx_pkt_get_ip6_info(pkt);
|
|
pkt_type = ip6hdr_info->has_ext_hdrs ? E1000_ADVRXD_PKT_IP6E :
|
|
E1000_ADVRXD_PKT_IP6;
|
|
} else if (hasip4) {
|
|
pkt_type = E1000_ADVRXD_PKT_IP4;
|
|
} else {
|
|
pkt_type = 0;
|
|
}
|
|
|
|
switch (l4hdr_proto) {
|
|
case ETH_L4_HDR_PROTO_TCP:
|
|
pkt_type |= E1000_ADVRXD_PKT_TCP;
|
|
break;
|
|
case ETH_L4_HDR_PROTO_UDP:
|
|
pkt_type |= E1000_ADVRXD_PKT_UDP;
|
|
break;
|
|
case ETH_L4_HDR_PROTO_SCTP:
|
|
pkt_type |= E1000_ADVRXD_PKT_SCTP;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return pkt_type;
|
|
}
|
|
|
|
static inline void
|
|
igb_write_adv_rx_descr(IGBCore *core, union e1000_adv_rx_desc *desc,
|
|
struct NetRxPkt *pkt,
|
|
const E1000E_RSSInfo *rss_info, uint16_t etqf, bool ts,
|
|
uint16_t length)
|
|
{
|
|
bool hasip4, hasip6;
|
|
EthL4HdrProto l4hdr_proto;
|
|
uint16_t rss_type = 0, pkt_type;
|
|
bool eop = (pkt != NULL);
|
|
uint32_t adv_desc_status_error = 0;
|
|
memset(&desc->wb, 0, sizeof(desc->wb));
|
|
|
|
desc->wb.upper.length = cpu_to_le16(length);
|
|
igb_build_rx_metadata_common(core, pkt, eop,
|
|
&desc->wb.upper.status_error,
|
|
&desc->wb.upper.vlan);
|
|
|
|
if (!eop) {
|
|
return;
|
|
}
|
|
|
|
net_rx_pkt_get_protocols(pkt, &hasip4, &hasip6, &l4hdr_proto);
|
|
|
|
if ((core->mac[RXCSUM] & E1000_RXCSUM_PCSD) != 0) {
|
|
if (rss_info->enabled) {
|
|
desc->wb.lower.hi_dword.rss = cpu_to_le32(rss_info->hash);
|
|
rss_type = rss_info->type;
|
|
trace_igb_rx_metadata_rss(desc->wb.lower.hi_dword.rss, rss_type);
|
|
}
|
|
} else if (hasip4) {
|
|
adv_desc_status_error |= E1000_RXD_STAT_IPIDV;
|
|
desc->wb.lower.hi_dword.csum_ip.ip_id =
|
|
cpu_to_le16(net_rx_pkt_get_ip_id(pkt));
|
|
trace_e1000e_rx_metadata_ip_id(
|
|
desc->wb.lower.hi_dword.csum_ip.ip_id);
|
|
}
|
|
|
|
if (ts) {
|
|
adv_desc_status_error |= BIT(16);
|
|
}
|
|
|
|
pkt_type = igb_rx_desc_get_packet_type(core, pkt, etqf);
|
|
trace_e1000e_rx_metadata_pkt_type(pkt_type);
|
|
desc->wb.lower.lo_dword.pkt_info = cpu_to_le16(rss_type | (pkt_type << 4));
|
|
desc->wb.upper.status_error |= cpu_to_le32(adv_desc_status_error);
|
|
}
|
|
|
|
static inline void
|
|
igb_write_adv_ps_rx_descr(IGBCore *core,
|
|
union e1000_adv_rx_desc *desc,
|
|
struct NetRxPkt *pkt,
|
|
const E1000E_RSSInfo *rss_info,
|
|
const E1000ERingInfo *r,
|
|
uint16_t etqf,
|
|
bool ts,
|
|
IGBPacketRxDMAState *pdma_st)
|
|
{
|
|
size_t pkt_len;
|
|
uint16_t hdr_info = 0;
|
|
|
|
if (pdma_st->do_ps) {
|
|
pkt_len = pdma_st->bastate.written[1];
|
|
} else {
|
|
pkt_len = pdma_st->bastate.written[0] + pdma_st->bastate.written[1];
|
|
}
|
|
|
|
igb_write_adv_rx_descr(core, desc, pkt, rss_info, etqf, ts, pkt_len);
|
|
|
|
hdr_info = (pdma_st->ps_desc_data.hdr_len << E1000_ADVRXD_HDR_LEN_OFFSET) &
|
|
E1000_ADVRXD_ADV_HDR_LEN_MASK;
|
|
hdr_info |= pdma_st->ps_desc_data.sph ? E1000_ADVRXD_HDR_SPH : 0;
|
|
desc->wb.lower.lo_dword.hdr_info = cpu_to_le16(hdr_info);
|
|
|
|
desc->wb.upper.status_error |= cpu_to_le32(
|
|
pdma_st->ps_desc_data.hbo ? E1000_ADVRXD_ST_ERR_HBO_OFFSET : 0);
|
|
}
|
|
|
|
static inline void
|
|
igb_write_rx_descr(IGBCore *core,
|
|
union e1000_rx_desc_union *desc,
|
|
struct NetRxPkt *pkt,
|
|
const E1000E_RSSInfo *rss_info,
|
|
uint16_t etqf,
|
|
bool ts,
|
|
IGBPacketRxDMAState *pdma_st,
|
|
const E1000ERingInfo *r)
|
|
{
|
|
if (igb_rx_use_legacy_descriptor(core)) {
|
|
igb_write_lgcy_rx_descr(core, &desc->legacy, pkt, rss_info,
|
|
pdma_st->bastate.written[1]);
|
|
} else if (igb_rx_use_ps_descriptor(core, r)) {
|
|
igb_write_adv_ps_rx_descr(core, &desc->adv, pkt, rss_info, r, etqf, ts,
|
|
pdma_st);
|
|
} else {
|
|
igb_write_adv_rx_descr(core, &desc->adv, pkt, rss_info,
|
|
etqf, ts, pdma_st->bastate.written[1]);
|
|
}
|
|
}
|
|
|
|
static inline void
|
|
igb_pci_dma_write_rx_desc(IGBCore *core, PCIDevice *dev, dma_addr_t addr,
|
|
union e1000_rx_desc_union *desc, dma_addr_t len)
|
|
{
|
|
if (igb_rx_use_legacy_descriptor(core)) {
|
|
struct e1000_rx_desc *d = &desc->legacy;
|
|
size_t offset = offsetof(struct e1000_rx_desc, status);
|
|
uint8_t status = d->status;
|
|
|
|
d->status &= ~E1000_RXD_STAT_DD;
|
|
pci_dma_write(dev, addr, desc, len);
|
|
|
|
if (status & E1000_RXD_STAT_DD) {
|
|
d->status = status;
|
|
pci_dma_write(dev, addr + offset, &status, sizeof(status));
|
|
}
|
|
} else {
|
|
union e1000_adv_rx_desc *d = &desc->adv;
|
|
size_t offset =
|
|
offsetof(union e1000_adv_rx_desc, wb.upper.status_error);
|
|
uint32_t status = d->wb.upper.status_error;
|
|
|
|
d->wb.upper.status_error &= ~E1000_RXD_STAT_DD;
|
|
pci_dma_write(dev, addr, desc, len);
|
|
|
|
if (status & E1000_RXD_STAT_DD) {
|
|
d->wb.upper.status_error = status;
|
|
pci_dma_write(dev, addr + offset, &status, sizeof(status));
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_update_rx_stats(IGBCore *core, const E1000ERingInfo *rxi,
|
|
size_t pkt_size, size_t pkt_fcs_size)
|
|
{
|
|
eth_pkt_types_e pkt_type = net_rx_pkt_get_packet_type(core->rx_pkt);
|
|
e1000x_update_rx_total_stats(core->mac, pkt_type, pkt_size, pkt_fcs_size);
|
|
|
|
if (core->mac[MRQC] & 1) {
|
|
uint16_t pool = rxi->idx % IGB_NUM_VM_POOLS;
|
|
|
|
core->mac[PVFGORC0 + (pool * 64)] += pkt_size + 4;
|
|
core->mac[PVFGPRC0 + (pool * 64)]++;
|
|
if (pkt_type == ETH_PKT_MCAST) {
|
|
core->mac[PVFMPRC0 + (pool * 64)]++;
|
|
}
|
|
}
|
|
}
|
|
|
|
static inline bool
|
|
igb_rx_descr_threshold_hit(IGBCore *core, const E1000ERingInfo *rxi)
|
|
{
|
|
return igb_ring_free_descr_num(core, rxi) ==
|
|
((core->mac[E1000_SRRCTL(rxi->idx) >> 2] >> 20) & 31) * 16;
|
|
}
|
|
|
|
static bool
|
|
igb_do_ps(IGBCore *core,
|
|
const E1000ERingInfo *r,
|
|
struct NetRxPkt *pkt,
|
|
IGBPacketRxDMAState *pdma_st)
|
|
{
|
|
bool hasip4, hasip6;
|
|
EthL4HdrProto l4hdr_proto;
|
|
bool fragment;
|
|
bool split_always;
|
|
size_t bheader_size;
|
|
size_t total_pkt_len;
|
|
|
|
if (!igb_rx_use_ps_descriptor(core, r)) {
|
|
return false;
|
|
}
|
|
|
|
total_pkt_len = net_rx_pkt_get_total_len(pkt);
|
|
bheader_size = igb_rxhdrbufsize(core, r);
|
|
split_always = igb_rx_ps_descriptor_split_always(core, r);
|
|
if (split_always && total_pkt_len <= bheader_size) {
|
|
pdma_st->ps_hdr_len = total_pkt_len;
|
|
pdma_st->ps_desc_data.hdr_len = total_pkt_len;
|
|
return true;
|
|
}
|
|
|
|
net_rx_pkt_get_protocols(pkt, &hasip4, &hasip6, &l4hdr_proto);
|
|
|
|
if (hasip4) {
|
|
fragment = net_rx_pkt_get_ip4_info(pkt)->fragment;
|
|
} else if (hasip6) {
|
|
fragment = net_rx_pkt_get_ip6_info(pkt)->fragment;
|
|
} else {
|
|
pdma_st->ps_desc_data.hdr_len = bheader_size;
|
|
goto header_not_handled;
|
|
}
|
|
|
|
if (fragment && (core->mac[RFCTL] & E1000_RFCTL_IPFRSP_DIS)) {
|
|
pdma_st->ps_desc_data.hdr_len = bheader_size;
|
|
goto header_not_handled;
|
|
}
|
|
|
|
/* no header splitting for SCTP */
|
|
if (!fragment && (l4hdr_proto == ETH_L4_HDR_PROTO_UDP ||
|
|
l4hdr_proto == ETH_L4_HDR_PROTO_TCP)) {
|
|
pdma_st->ps_hdr_len = net_rx_pkt_get_l5_hdr_offset(pkt);
|
|
} else {
|
|
pdma_st->ps_hdr_len = net_rx_pkt_get_l4_hdr_offset(pkt);
|
|
}
|
|
|
|
pdma_st->ps_desc_data.sph = true;
|
|
pdma_st->ps_desc_data.hdr_len = pdma_st->ps_hdr_len;
|
|
|
|
if (pdma_st->ps_hdr_len > bheader_size) {
|
|
pdma_st->ps_desc_data.hbo = true;
|
|
goto header_not_handled;
|
|
}
|
|
|
|
return true;
|
|
|
|
header_not_handled:
|
|
if (split_always) {
|
|
pdma_st->ps_hdr_len = bheader_size;
|
|
return true;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static void
|
|
igb_truncate_to_descriptor_size(IGBPacketRxDMAState *pdma_st, size_t *size)
|
|
{
|
|
if (pdma_st->do_ps && pdma_st->is_first) {
|
|
if (*size > pdma_st->rx_desc_packet_buf_size + pdma_st->ps_hdr_len) {
|
|
*size = pdma_st->rx_desc_packet_buf_size + pdma_st->ps_hdr_len;
|
|
}
|
|
} else {
|
|
if (*size > pdma_st->rx_desc_packet_buf_size) {
|
|
*size = pdma_st->rx_desc_packet_buf_size;
|
|
}
|
|
}
|
|
}
|
|
|
|
static inline void
|
|
igb_write_hdr_frag_to_rx_buffers(IGBCore *core,
|
|
PCIDevice *d,
|
|
IGBPacketRxDMAState *pdma_st,
|
|
const char *data,
|
|
dma_addr_t data_len)
|
|
{
|
|
assert(data_len <= pdma_st->rx_desc_header_buf_size -
|
|
pdma_st->bastate.written[0]);
|
|
pci_dma_write(d,
|
|
pdma_st->ba[0] + pdma_st->bastate.written[0],
|
|
data, data_len);
|
|
pdma_st->bastate.written[0] += data_len;
|
|
pdma_st->bastate.cur_idx = 1;
|
|
}
|
|
|
|
static void
|
|
igb_write_header_to_rx_buffers(IGBCore *core,
|
|
struct NetRxPkt *pkt,
|
|
PCIDevice *d,
|
|
IGBPacketRxDMAState *pdma_st,
|
|
size_t *copy_size)
|
|
{
|
|
size_t iov_copy;
|
|
size_t ps_hdr_copied = 0;
|
|
|
|
if (!pdma_st->is_first) {
|
|
/* Leave buffer 0 of each descriptor except first */
|
|
/* empty */
|
|
pdma_st->bastate.cur_idx = 1;
|
|
return;
|
|
}
|
|
|
|
do {
|
|
iov_copy = MIN(pdma_st->ps_hdr_len - ps_hdr_copied,
|
|
pdma_st->iov->iov_len - pdma_st->iov_ofs);
|
|
|
|
igb_write_hdr_frag_to_rx_buffers(core, d, pdma_st,
|
|
pdma_st->iov->iov_base,
|
|
iov_copy);
|
|
|
|
*copy_size -= iov_copy;
|
|
ps_hdr_copied += iov_copy;
|
|
|
|
pdma_st->iov_ofs += iov_copy;
|
|
if (pdma_st->iov_ofs == pdma_st->iov->iov_len) {
|
|
pdma_st->iov++;
|
|
pdma_st->iov_ofs = 0;
|
|
}
|
|
} while (ps_hdr_copied < pdma_st->ps_hdr_len);
|
|
|
|
pdma_st->is_first = false;
|
|
}
|
|
|
|
static void
|
|
igb_write_payload_frag_to_rx_buffers(IGBCore *core,
|
|
PCIDevice *d,
|
|
IGBPacketRxDMAState *pdma_st,
|
|
const char *data,
|
|
dma_addr_t data_len)
|
|
{
|
|
while (data_len > 0) {
|
|
assert(pdma_st->bastate.cur_idx < IGB_MAX_PS_BUFFERS);
|
|
|
|
uint32_t cur_buf_bytes_left =
|
|
pdma_st->rx_desc_packet_buf_size -
|
|
pdma_st->bastate.written[pdma_st->bastate.cur_idx];
|
|
uint32_t bytes_to_write = MIN(data_len, cur_buf_bytes_left);
|
|
|
|
trace_igb_rx_desc_buff_write(
|
|
pdma_st->bastate.cur_idx,
|
|
pdma_st->ba[pdma_st->bastate.cur_idx],
|
|
pdma_st->bastate.written[pdma_st->bastate.cur_idx],
|
|
data,
|
|
bytes_to_write);
|
|
|
|
pci_dma_write(d,
|
|
pdma_st->ba[pdma_st->bastate.cur_idx] +
|
|
pdma_st->bastate.written[pdma_st->bastate.cur_idx],
|
|
data, bytes_to_write);
|
|
|
|
pdma_st->bastate.written[pdma_st->bastate.cur_idx] += bytes_to_write;
|
|
data += bytes_to_write;
|
|
data_len -= bytes_to_write;
|
|
|
|
if (pdma_st->bastate.written[pdma_st->bastate.cur_idx] ==
|
|
pdma_st->rx_desc_packet_buf_size) {
|
|
pdma_st->bastate.cur_idx++;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_write_payload_to_rx_buffers(IGBCore *core,
|
|
struct NetRxPkt *pkt,
|
|
PCIDevice *d,
|
|
IGBPacketRxDMAState *pdma_st,
|
|
size_t *copy_size)
|
|
{
|
|
static const uint32_t fcs_pad;
|
|
size_t iov_copy;
|
|
|
|
/* Copy packet payload */
|
|
while (*copy_size) {
|
|
iov_copy = MIN(*copy_size, pdma_st->iov->iov_len - pdma_st->iov_ofs);
|
|
igb_write_payload_frag_to_rx_buffers(core, d,
|
|
pdma_st,
|
|
pdma_st->iov->iov_base +
|
|
pdma_st->iov_ofs,
|
|
iov_copy);
|
|
|
|
*copy_size -= iov_copy;
|
|
pdma_st->iov_ofs += iov_copy;
|
|
if (pdma_st->iov_ofs == pdma_st->iov->iov_len) {
|
|
pdma_st->iov++;
|
|
pdma_st->iov_ofs = 0;
|
|
}
|
|
}
|
|
|
|
if (pdma_st->desc_offset + pdma_st->desc_size >= pdma_st->total_size) {
|
|
/* Simulate FCS checksum presence in the last descriptor */
|
|
igb_write_payload_frag_to_rx_buffers(core, d,
|
|
pdma_st,
|
|
(const char *) &fcs_pad,
|
|
e1000x_fcs_len(core->mac));
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_write_to_rx_buffers(IGBCore *core,
|
|
struct NetRxPkt *pkt,
|
|
PCIDevice *d,
|
|
IGBPacketRxDMAState *pdma_st)
|
|
{
|
|
size_t copy_size;
|
|
|
|
if (!(pdma_st->ba)[1] || (pdma_st->do_ps && !(pdma_st->ba[0]))) {
|
|
/* as per intel docs; skip descriptors with null buf addr */
|
|
trace_e1000e_rx_null_descriptor();
|
|
return;
|
|
}
|
|
|
|
if (pdma_st->desc_offset >= pdma_st->size) {
|
|
return;
|
|
}
|
|
|
|
pdma_st->desc_size = pdma_st->total_size - pdma_st->desc_offset;
|
|
igb_truncate_to_descriptor_size(pdma_st, &pdma_st->desc_size);
|
|
copy_size = pdma_st->size - pdma_st->desc_offset;
|
|
igb_truncate_to_descriptor_size(pdma_st, ©_size);
|
|
|
|
/* For PS mode copy the packet header first */
|
|
if (pdma_st->do_ps) {
|
|
igb_write_header_to_rx_buffers(core, pkt, d, pdma_st, ©_size);
|
|
} else {
|
|
pdma_st->bastate.cur_idx = 1;
|
|
}
|
|
|
|
igb_write_payload_to_rx_buffers(core, pkt, d, pdma_st, ©_size);
|
|
}
|
|
|
|
static void
|
|
igb_write_packet_to_guest(IGBCore *core, struct NetRxPkt *pkt,
|
|
const E1000E_RxRing *rxr,
|
|
const E1000E_RSSInfo *rss_info,
|
|
uint16_t etqf, bool ts)
|
|
{
|
|
PCIDevice *d;
|
|
dma_addr_t base;
|
|
union e1000_rx_desc_union desc;
|
|
const E1000ERingInfo *rxi;
|
|
size_t rx_desc_len;
|
|
|
|
IGBPacketRxDMAState pdma_st = {0};
|
|
pdma_st.is_first = true;
|
|
pdma_st.size = net_rx_pkt_get_total_len(pkt);
|
|
pdma_st.total_size = pdma_st.size + e1000x_fcs_len(core->mac);
|
|
|
|
rxi = rxr->i;
|
|
rx_desc_len = core->rx_desc_len;
|
|
pdma_st.rx_desc_packet_buf_size = igb_rxbufsize(core, rxi);
|
|
pdma_st.rx_desc_header_buf_size = igb_rxhdrbufsize(core, rxi);
|
|
pdma_st.iov = net_rx_pkt_get_iovec(pkt);
|
|
d = pcie_sriov_get_vf_at_index(core->owner, rxi->idx % 8);
|
|
if (!d) {
|
|
d = core->owner;
|
|
}
|
|
|
|
pdma_st.do_ps = igb_do_ps(core, rxi, pkt, &pdma_st);
|
|
|
|
do {
|
|
memset(&pdma_st.bastate, 0, sizeof(IGBBAState));
|
|
bool is_last = false;
|
|
|
|
if (igb_ring_empty(core, rxi)) {
|
|
return;
|
|
}
|
|
|
|
base = igb_ring_head_descr(core, rxi);
|
|
pci_dma_read(d, base, &desc, rx_desc_len);
|
|
trace_e1000e_rx_descr(rxi->idx, base, rx_desc_len);
|
|
|
|
igb_read_rx_descr(core, &desc, &pdma_st, rxi);
|
|
|
|
igb_write_to_rx_buffers(core, pkt, d, &pdma_st);
|
|
pdma_st.desc_offset += pdma_st.desc_size;
|
|
if (pdma_st.desc_offset >= pdma_st.total_size) {
|
|
is_last = true;
|
|
}
|
|
|
|
igb_write_rx_descr(core, &desc,
|
|
is_last ? pkt : NULL,
|
|
rss_info,
|
|
etqf, ts,
|
|
&pdma_st,
|
|
rxi);
|
|
igb_pci_dma_write_rx_desc(core, d, base, &desc, rx_desc_len);
|
|
igb_ring_advance(core, rxi, rx_desc_len / E1000_MIN_RX_DESC_LEN);
|
|
} while (pdma_st.desc_offset < pdma_st.total_size);
|
|
|
|
igb_update_rx_stats(core, rxi, pdma_st.size, pdma_st.total_size);
|
|
}
|
|
|
|
static bool
|
|
igb_rx_strip_vlan(IGBCore *core, const E1000ERingInfo *rxi)
|
|
{
|
|
if (core->mac[MRQC] & 1) {
|
|
uint16_t pool = rxi->idx % IGB_NUM_VM_POOLS;
|
|
/* Sec 7.10.3.8: CTRL.VME is ignored, only VMOLR/RPLOLR is used */
|
|
return (net_rx_pkt_get_packet_type(core->rx_pkt) == ETH_PKT_MCAST) ?
|
|
core->mac[RPLOLR] & E1000_RPLOLR_STRVLAN :
|
|
core->mac[VMOLR0 + pool] & E1000_VMOLR_STRVLAN;
|
|
}
|
|
|
|
return e1000x_vlan_enabled(core->mac);
|
|
}
|
|
|
|
static inline void
|
|
igb_rx_fix_l4_csum(IGBCore *core, struct NetRxPkt *pkt)
|
|
{
|
|
struct virtio_net_hdr *vhdr = net_rx_pkt_get_vhdr(pkt);
|
|
|
|
if (vhdr->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM) {
|
|
net_rx_pkt_fix_l4_csum(pkt);
|
|
}
|
|
}
|
|
|
|
ssize_t
|
|
igb_receive_iov(IGBCore *core, const struct iovec *iov, int iovcnt)
|
|
{
|
|
return igb_receive_internal(core, iov, iovcnt, core->has_vnet, NULL);
|
|
}
|
|
|
|
static ssize_t
|
|
igb_receive_internal(IGBCore *core, const struct iovec *iov, int iovcnt,
|
|
bool has_vnet, bool *external_tx)
|
|
{
|
|
uint16_t queues = 0;
|
|
uint32_t causes = 0;
|
|
uint32_t ecauses = 0;
|
|
union {
|
|
L2Header l2_header;
|
|
uint8_t octets[ETH_ZLEN];
|
|
} buf;
|
|
struct iovec min_iov;
|
|
size_t size, orig_size;
|
|
size_t iov_ofs = 0;
|
|
E1000E_RxRing rxr;
|
|
E1000E_RSSInfo rss_info;
|
|
uint16_t etqf;
|
|
bool ts;
|
|
size_t total_size;
|
|
int strip_vlan_index;
|
|
int i;
|
|
|
|
trace_e1000e_rx_receive_iov(iovcnt);
|
|
|
|
if (external_tx) {
|
|
*external_tx = true;
|
|
}
|
|
|
|
if (!e1000x_hw_rx_enabled(core->mac)) {
|
|
return -1;
|
|
}
|
|
|
|
/* Pull virtio header in */
|
|
if (has_vnet) {
|
|
net_rx_pkt_set_vhdr_iovec(core->rx_pkt, iov, iovcnt);
|
|
iov_ofs = sizeof(struct virtio_net_hdr);
|
|
} else {
|
|
net_rx_pkt_unset_vhdr(core->rx_pkt);
|
|
}
|
|
|
|
orig_size = iov_size(iov, iovcnt);
|
|
size = orig_size - iov_ofs;
|
|
|
|
/* Pad to minimum Ethernet frame length */
|
|
if (size < sizeof(buf)) {
|
|
iov_to_buf(iov, iovcnt, iov_ofs, &buf, size);
|
|
memset(&buf.octets[size], 0, sizeof(buf) - size);
|
|
e1000x_inc_reg_if_not_full(core->mac, RUC);
|
|
min_iov.iov_base = &buf;
|
|
min_iov.iov_len = size = sizeof(buf);
|
|
iovcnt = 1;
|
|
iov = &min_iov;
|
|
iov_ofs = 0;
|
|
} else {
|
|
iov_to_buf(iov, iovcnt, iov_ofs, &buf, sizeof(buf.l2_header));
|
|
}
|
|
|
|
net_rx_pkt_set_packet_type(core->rx_pkt,
|
|
get_eth_packet_type(&buf.l2_header.eth));
|
|
net_rx_pkt_set_protocols(core->rx_pkt, iov, iovcnt, iov_ofs);
|
|
|
|
queues = igb_receive_assign(core, iov, iovcnt, iov_ofs,
|
|
&buf.l2_header, size,
|
|
&rss_info, &etqf, &ts, external_tx);
|
|
if (!queues) {
|
|
trace_e1000e_rx_flt_dropped();
|
|
return orig_size;
|
|
}
|
|
|
|
for (i = 0; i < IGB_NUM_QUEUES; i++) {
|
|
if (!(queues & BIT(i)) ||
|
|
!(core->mac[RXDCTL0 + (i * 16)] & E1000_RXDCTL_QUEUE_ENABLE)) {
|
|
continue;
|
|
}
|
|
|
|
igb_rx_ring_init(core, &rxr, i);
|
|
|
|
if (!igb_rx_strip_vlan(core, rxr.i)) {
|
|
strip_vlan_index = -1;
|
|
} else if (core->mac[CTRL_EXT] & BIT(26)) {
|
|
strip_vlan_index = 1;
|
|
} else {
|
|
strip_vlan_index = 0;
|
|
}
|
|
|
|
net_rx_pkt_attach_iovec_ex(core->rx_pkt, iov, iovcnt, iov_ofs,
|
|
strip_vlan_index,
|
|
core->mac[VET] & 0xffff,
|
|
core->mac[VET] >> 16);
|
|
|
|
total_size = net_rx_pkt_get_total_len(core->rx_pkt) +
|
|
e1000x_fcs_len(core->mac);
|
|
|
|
if (!igb_has_rxbufs(core, rxr.i, total_size)) {
|
|
causes |= E1000_ICS_RXO;
|
|
trace_e1000e_rx_not_written_to_guest(rxr.i->idx);
|
|
continue;
|
|
}
|
|
|
|
causes |= E1000_ICR_RXDW;
|
|
|
|
igb_rx_fix_l4_csum(core, core->rx_pkt);
|
|
igb_write_packet_to_guest(core, core->rx_pkt, &rxr, &rss_info, etqf, ts);
|
|
|
|
/* Check if receive descriptor minimum threshold hit */
|
|
if (igb_rx_descr_threshold_hit(core, rxr.i)) {
|
|
causes |= E1000_ICS_RXDMT0;
|
|
}
|
|
|
|
ecauses |= igb_rx_wb_eic(core, rxr.i->idx);
|
|
|
|
trace_e1000e_rx_written_to_guest(rxr.i->idx);
|
|
}
|
|
|
|
trace_e1000e_rx_interrupt_set(causes);
|
|
igb_raise_interrupts(core, EICR, ecauses);
|
|
igb_raise_interrupts(core, ICR, causes);
|
|
|
|
return orig_size;
|
|
}
|
|
|
|
static inline bool
|
|
igb_have_autoneg(IGBCore *core)
|
|
{
|
|
return core->phy[MII_BMCR] & MII_BMCR_AUTOEN;
|
|
}
|
|
|
|
static void igb_update_flowctl_status(IGBCore *core)
|
|
{
|
|
if (igb_have_autoneg(core) && core->phy[MII_BMSR] & MII_BMSR_AN_COMP) {
|
|
trace_e1000e_link_autoneg_flowctl(true);
|
|
core->mac[CTRL] |= E1000_CTRL_TFCE | E1000_CTRL_RFCE;
|
|
} else {
|
|
trace_e1000e_link_autoneg_flowctl(false);
|
|
}
|
|
}
|
|
|
|
static inline void
|
|
igb_link_down(IGBCore *core)
|
|
{
|
|
e1000x_update_regs_on_link_down(core->mac, core->phy);
|
|
igb_update_flowctl_status(core);
|
|
}
|
|
|
|
static inline void
|
|
igb_set_phy_ctrl(IGBCore *core, uint16_t val)
|
|
{
|
|
/* bits 0-5 reserved; MII_BMCR_[ANRESTART,RESET] are self clearing */
|
|
core->phy[MII_BMCR] = val & ~(0x3f | MII_BMCR_RESET | MII_BMCR_ANRESTART);
|
|
|
|
if ((val & MII_BMCR_ANRESTART) && igb_have_autoneg(core)) {
|
|
e1000x_restart_autoneg(core->mac, core->phy, core->autoneg_timer);
|
|
}
|
|
}
|
|
|
|
void igb_core_set_link_status(IGBCore *core)
|
|
{
|
|
NetClientState *nc = qemu_get_queue(core->owner_nic);
|
|
uint32_t old_status = core->mac[STATUS];
|
|
|
|
trace_e1000e_link_status_changed(nc->link_down ? false : true);
|
|
|
|
if (nc->link_down) {
|
|
e1000x_update_regs_on_link_down(core->mac, core->phy);
|
|
} else {
|
|
if (igb_have_autoneg(core) &&
|
|
!(core->phy[MII_BMSR] & MII_BMSR_AN_COMP)) {
|
|
e1000x_restart_autoneg(core->mac, core->phy,
|
|
core->autoneg_timer);
|
|
} else {
|
|
e1000x_update_regs_on_link_up(core->mac, core->phy);
|
|
igb_start_recv(core);
|
|
}
|
|
}
|
|
|
|
if (core->mac[STATUS] != old_status) {
|
|
igb_raise_interrupts(core, ICR, E1000_ICR_LSC);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_ctrl(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
trace_e1000e_core_ctrl_write(index, val);
|
|
|
|
/* RST is self clearing */
|
|
core->mac[CTRL] = val & ~E1000_CTRL_RST;
|
|
core->mac[CTRL_DUP] = core->mac[CTRL];
|
|
|
|
trace_e1000e_link_set_params(
|
|
!!(val & E1000_CTRL_ASDE),
|
|
(val & E1000_CTRL_SPD_SEL) >> E1000_CTRL_SPD_SHIFT,
|
|
!!(val & E1000_CTRL_FRCSPD),
|
|
!!(val & E1000_CTRL_FRCDPX),
|
|
!!(val & E1000_CTRL_RFCE),
|
|
!!(val & E1000_CTRL_TFCE));
|
|
|
|
if (val & E1000_CTRL_RST) {
|
|
trace_e1000e_core_ctrl_sw_reset();
|
|
igb_reset(core, true);
|
|
}
|
|
|
|
if (val & E1000_CTRL_PHY_RST) {
|
|
trace_e1000e_core_ctrl_phy_reset();
|
|
core->mac[STATUS] |= E1000_STATUS_PHYRA;
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_rfctl(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
trace_e1000e_rx_set_rfctl(val);
|
|
|
|
if (!(val & E1000_RFCTL_ISCSI_DIS)) {
|
|
trace_e1000e_wrn_iscsi_filtering_not_supported();
|
|
}
|
|
|
|
if (!(val & E1000_RFCTL_NFSW_DIS)) {
|
|
trace_e1000e_wrn_nfsw_filtering_not_supported();
|
|
}
|
|
|
|
if (!(val & E1000_RFCTL_NFSR_DIS)) {
|
|
trace_e1000e_wrn_nfsr_filtering_not_supported();
|
|
}
|
|
|
|
core->mac[RFCTL] = val;
|
|
}
|
|
|
|
static void
|
|
igb_calc_rxdesclen(IGBCore *core)
|
|
{
|
|
if (igb_rx_use_legacy_descriptor(core)) {
|
|
core->rx_desc_len = sizeof(struct e1000_rx_desc);
|
|
} else {
|
|
core->rx_desc_len = sizeof(union e1000_adv_rx_desc);
|
|
}
|
|
trace_e1000e_rx_desc_len(core->rx_desc_len);
|
|
}
|
|
|
|
static void
|
|
igb_set_rx_control(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[RCTL] = val;
|
|
trace_e1000e_rx_set_rctl(core->mac[RCTL]);
|
|
|
|
if (val & E1000_RCTL_DTYP_MASK) {
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
"igb: RCTL.DTYP must be zero for compatibility");
|
|
}
|
|
|
|
if (val & E1000_RCTL_EN) {
|
|
igb_calc_rxdesclen(core);
|
|
igb_start_recv(core);
|
|
}
|
|
}
|
|
|
|
static inline bool
|
|
igb_postpone_interrupt(IGBIntrDelayTimer *timer)
|
|
{
|
|
if (timer->running) {
|
|
trace_e1000e_irq_postponed_by_xitr(timer->delay_reg << 2);
|
|
|
|
return true;
|
|
}
|
|
|
|
if (timer->core->mac[timer->delay_reg] != 0) {
|
|
igb_intrmgr_rearm_timer(timer);
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static inline bool
|
|
igb_eitr_should_postpone(IGBCore *core, int idx)
|
|
{
|
|
return igb_postpone_interrupt(&core->eitr[idx]);
|
|
}
|
|
|
|
static void igb_send_msix(IGBCore *core, uint32_t causes)
|
|
{
|
|
int vector;
|
|
|
|
for (vector = 0; vector < IGB_INTR_NUM; ++vector) {
|
|
if ((causes & BIT(vector)) && !igb_eitr_should_postpone(core, vector)) {
|
|
|
|
trace_e1000e_irq_msix_notify_vec(vector);
|
|
igb_msix_notify(core, vector);
|
|
}
|
|
}
|
|
}
|
|
|
|
static inline void
|
|
igb_fix_icr_asserted(IGBCore *core)
|
|
{
|
|
core->mac[ICR] &= ~E1000_ICR_ASSERTED;
|
|
if (core->mac[ICR]) {
|
|
core->mac[ICR] |= E1000_ICR_ASSERTED;
|
|
}
|
|
|
|
trace_e1000e_irq_fix_icr_asserted(core->mac[ICR]);
|
|
}
|
|
|
|
static void igb_raise_interrupts(IGBCore *core, size_t index, uint32_t causes)
|
|
{
|
|
uint32_t old_causes = core->mac[ICR] & core->mac[IMS];
|
|
uint32_t old_ecauses = core->mac[EICR] & core->mac[EIMS];
|
|
uint32_t raised_causes;
|
|
uint32_t raised_ecauses;
|
|
uint32_t int_alloc;
|
|
|
|
trace_e1000e_irq_set(index << 2,
|
|
core->mac[index], core->mac[index] | causes);
|
|
|
|
core->mac[index] |= causes;
|
|
|
|
if (core->mac[GPIE] & E1000_GPIE_MSIX_MODE) {
|
|
raised_causes = core->mac[ICR] & core->mac[IMS] & ~old_causes;
|
|
|
|
if (raised_causes & E1000_ICR_DRSTA) {
|
|
int_alloc = core->mac[IVAR_MISC] & 0xff;
|
|
if (int_alloc & E1000_IVAR_VALID) {
|
|
core->mac[EICR] |= BIT(int_alloc & 0x1f);
|
|
}
|
|
}
|
|
/* Check if other bits (excluding the TCP Timer) are enabled. */
|
|
if (raised_causes & ~E1000_ICR_DRSTA) {
|
|
int_alloc = (core->mac[IVAR_MISC] >> 8) & 0xff;
|
|
if (int_alloc & E1000_IVAR_VALID) {
|
|
core->mac[EICR] |= BIT(int_alloc & 0x1f);
|
|
}
|
|
}
|
|
|
|
raised_ecauses = core->mac[EICR] & core->mac[EIMS] & ~old_ecauses;
|
|
if (!raised_ecauses) {
|
|
return;
|
|
}
|
|
|
|
igb_send_msix(core, raised_ecauses);
|
|
} else {
|
|
igb_fix_icr_asserted(core);
|
|
|
|
raised_causes = core->mac[ICR] & core->mac[IMS] & ~old_causes;
|
|
if (!raised_causes) {
|
|
return;
|
|
}
|
|
|
|
core->mac[EICR] |= (raised_causes & E1000_ICR_DRSTA) | E1000_EICR_OTHER;
|
|
|
|
if (msix_enabled(core->owner)) {
|
|
trace_e1000e_irq_msix_notify_vec(0);
|
|
msix_notify(core->owner, 0);
|
|
} else if (msi_enabled(core->owner)) {
|
|
trace_e1000e_irq_msi_notify(raised_causes);
|
|
msi_notify(core->owner, 0);
|
|
} else {
|
|
igb_raise_legacy_irq(core);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void igb_lower_interrupts(IGBCore *core, size_t index, uint32_t causes)
|
|
{
|
|
trace_e1000e_irq_clear(index << 2,
|
|
core->mac[index], core->mac[index] & ~causes);
|
|
|
|
core->mac[index] &= ~causes;
|
|
|
|
trace_e1000e_irq_pending_interrupts(core->mac[ICR] & core->mac[IMS],
|
|
core->mac[ICR], core->mac[IMS]);
|
|
|
|
if (!(core->mac[ICR] & core->mac[IMS]) &&
|
|
!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE)) {
|
|
core->mac[EICR] &= ~E1000_EICR_OTHER;
|
|
|
|
if (!msix_enabled(core->owner) && !msi_enabled(core->owner)) {
|
|
igb_lower_legacy_irq(core);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void igb_set_eics(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
|
|
uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
|
|
|
|
trace_igb_irq_write_eics(val, msix);
|
|
igb_raise_interrupts(core, EICR, val & mask);
|
|
}
|
|
|
|
static void igb_set_eims(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
|
|
uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
|
|
|
|
trace_igb_irq_write_eims(val, msix);
|
|
igb_raise_interrupts(core, EIMS, val & mask);
|
|
}
|
|
|
|
static void mailbox_interrupt_to_vf(IGBCore *core, uint16_t vfn)
|
|
{
|
|
uint32_t ent = core->mac[VTIVAR_MISC + vfn];
|
|
uint32_t causes;
|
|
|
|
if ((ent & E1000_IVAR_VALID)) {
|
|
causes = (ent & 0x3) << (22 - vfn * IGBVF_MSIX_VEC_NUM);
|
|
igb_raise_interrupts(core, EICR, causes);
|
|
}
|
|
}
|
|
|
|
static void mailbox_interrupt_to_pf(IGBCore *core)
|
|
{
|
|
igb_raise_interrupts(core, ICR, E1000_ICR_VMMB);
|
|
}
|
|
|
|
static void igb_set_pfmailbox(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = index - P2VMAILBOX0;
|
|
|
|
trace_igb_set_pfmailbox(vfn, val);
|
|
|
|
if (val & E1000_P2VMAILBOX_STS) {
|
|
core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_PFSTS;
|
|
mailbox_interrupt_to_vf(core, vfn);
|
|
}
|
|
|
|
if (val & E1000_P2VMAILBOX_ACK) {
|
|
core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_PFACK;
|
|
mailbox_interrupt_to_vf(core, vfn);
|
|
}
|
|
|
|
/* Buffer Taken by PF (can be set only if the VFU is cleared). */
|
|
if (val & E1000_P2VMAILBOX_PFU) {
|
|
if (!(core->mac[index] & E1000_P2VMAILBOX_VFU)) {
|
|
core->mac[index] |= E1000_P2VMAILBOX_PFU;
|
|
core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_PFU;
|
|
}
|
|
} else {
|
|
core->mac[index] &= ~E1000_P2VMAILBOX_PFU;
|
|
core->mac[V2PMAILBOX0 + vfn] &= ~E1000_V2PMAILBOX_PFU;
|
|
}
|
|
|
|
if (val & E1000_P2VMAILBOX_RVFU) {
|
|
core->mac[V2PMAILBOX0 + vfn] &= ~E1000_V2PMAILBOX_VFU;
|
|
core->mac[MBVFICR] &= ~((E1000_MBVFICR_VFACK_VF1 << vfn) |
|
|
(E1000_MBVFICR_VFREQ_VF1 << vfn));
|
|
}
|
|
}
|
|
|
|
static void igb_set_vfmailbox(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = index - V2PMAILBOX0;
|
|
|
|
trace_igb_set_vfmailbox(vfn, val);
|
|
|
|
if (val & E1000_V2PMAILBOX_REQ) {
|
|
core->mac[MBVFICR] |= E1000_MBVFICR_VFREQ_VF1 << vfn;
|
|
mailbox_interrupt_to_pf(core);
|
|
}
|
|
|
|
if (val & E1000_V2PMAILBOX_ACK) {
|
|
core->mac[MBVFICR] |= E1000_MBVFICR_VFACK_VF1 << vfn;
|
|
mailbox_interrupt_to_pf(core);
|
|
}
|
|
|
|
/* Buffer Taken by VF (can be set only if the PFU is cleared). */
|
|
if (val & E1000_V2PMAILBOX_VFU) {
|
|
if (!(core->mac[index] & E1000_V2PMAILBOX_PFU)) {
|
|
core->mac[index] |= E1000_V2PMAILBOX_VFU;
|
|
core->mac[P2VMAILBOX0 + vfn] |= E1000_P2VMAILBOX_VFU;
|
|
}
|
|
} else {
|
|
core->mac[index] &= ~E1000_V2PMAILBOX_VFU;
|
|
core->mac[P2VMAILBOX0 + vfn] &= ~E1000_P2VMAILBOX_VFU;
|
|
}
|
|
}
|
|
|
|
void igb_core_vf_reset(IGBCore *core, uint16_t vfn)
|
|
{
|
|
uint16_t qn0 = vfn;
|
|
uint16_t qn1 = vfn + IGB_NUM_VM_POOLS;
|
|
|
|
trace_igb_core_vf_reset(vfn);
|
|
|
|
/* disable Rx and Tx for the VF*/
|
|
core->mac[RXDCTL0 + (qn0 * 16)] &= ~E1000_RXDCTL_QUEUE_ENABLE;
|
|
core->mac[RXDCTL0 + (qn1 * 16)] &= ~E1000_RXDCTL_QUEUE_ENABLE;
|
|
core->mac[TXDCTL0 + (qn0 * 16)] &= ~E1000_TXDCTL_QUEUE_ENABLE;
|
|
core->mac[TXDCTL0 + (qn1 * 16)] &= ~E1000_TXDCTL_QUEUE_ENABLE;
|
|
core->mac[VFRE] &= ~BIT(vfn);
|
|
core->mac[VFTE] &= ~BIT(vfn);
|
|
/* indicate VF reset to PF */
|
|
core->mac[VFLRE] |= BIT(vfn);
|
|
/* VFLRE and mailbox use the same interrupt cause */
|
|
mailbox_interrupt_to_pf(core);
|
|
}
|
|
|
|
static void igb_w1c(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[index] &= ~val;
|
|
}
|
|
|
|
static void igb_set_eimc(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
|
|
uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
|
|
|
|
trace_igb_irq_write_eimc(val, msix);
|
|
|
|
/* Interrupts are disabled via a write to EIMC and reflected in EIMS. */
|
|
igb_lower_interrupts(core, EIMS, val & mask);
|
|
}
|
|
|
|
static void igb_set_eiac(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
|
|
|
|
if (msix) {
|
|
trace_igb_irq_write_eiac(val);
|
|
|
|
/*
|
|
* TODO: When using IOV, the bits that correspond to MSI-X vectors
|
|
* that are assigned to a VF are read-only.
|
|
*/
|
|
core->mac[EIAC] |= (val & E1000_EICR_MSIX_MASK);
|
|
}
|
|
}
|
|
|
|
static void igb_set_eiam(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
|
|
|
|
/*
|
|
* TODO: When using IOV, the bits that correspond to MSI-X vectors that
|
|
* are assigned to a VF are read-only.
|
|
*/
|
|
core->mac[EIAM] |=
|
|
~(val & (msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK));
|
|
|
|
trace_igb_irq_write_eiam(val, msix);
|
|
}
|
|
|
|
static void igb_set_eicr(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
bool msix = !!(core->mac[GPIE] & E1000_GPIE_MSIX_MODE);
|
|
|
|
/*
|
|
* TODO: In IOV mode, only bit zero of this vector is available for the PF
|
|
* function.
|
|
*/
|
|
uint32_t mask = msix ? E1000_EICR_MSIX_MASK : E1000_EICR_LEGACY_MASK;
|
|
|
|
trace_igb_irq_write_eicr(val, msix);
|
|
igb_lower_interrupts(core, EICR, val & mask);
|
|
}
|
|
|
|
static void igb_set_vtctrl(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn;
|
|
|
|
if (val & E1000_CTRL_RST) {
|
|
vfn = (index - PVTCTRL0) / 0x40;
|
|
igb_core_vf_reset(core, vfn);
|
|
}
|
|
}
|
|
|
|
static void igb_set_vteics(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = (index - PVTEICS0) / 0x40;
|
|
|
|
core->mac[index] = val;
|
|
igb_set_eics(core, EICS, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
|
|
}
|
|
|
|
static void igb_set_vteims(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = (index - PVTEIMS0) / 0x40;
|
|
|
|
core->mac[index] = val;
|
|
igb_set_eims(core, EIMS, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
|
|
}
|
|
|
|
static void igb_set_vteimc(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = (index - PVTEIMC0) / 0x40;
|
|
|
|
core->mac[index] = val;
|
|
igb_set_eimc(core, EIMC, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
|
|
}
|
|
|
|
static void igb_set_vteiac(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = (index - PVTEIAC0) / 0x40;
|
|
|
|
core->mac[index] = val;
|
|
igb_set_eiac(core, EIAC, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
|
|
}
|
|
|
|
static void igb_set_vteiam(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = (index - PVTEIAM0) / 0x40;
|
|
|
|
core->mac[index] = val;
|
|
igb_set_eiam(core, EIAM, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
|
|
}
|
|
|
|
static void igb_set_vteicr(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = (index - PVTEICR0) / 0x40;
|
|
|
|
core->mac[index] = val;
|
|
igb_set_eicr(core, EICR, (val & 0x7) << (22 - vfn * IGBVF_MSIX_VEC_NUM));
|
|
}
|
|
|
|
static void igb_set_vtivar(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint16_t vfn = (index - VTIVAR);
|
|
uint16_t qn = vfn;
|
|
uint8_t ent;
|
|
int n;
|
|
|
|
core->mac[index] = val;
|
|
|
|
/* Get assigned vector associated with queue Rx#0. */
|
|
if ((val & E1000_IVAR_VALID)) {
|
|
n = igb_ivar_entry_rx(qn);
|
|
ent = E1000_IVAR_VALID | (24 - vfn * IGBVF_MSIX_VEC_NUM - (2 - (val & 0x7)));
|
|
core->mac[IVAR0 + n / 4] |= ent << 8 * (n % 4);
|
|
}
|
|
|
|
/* Get assigned vector associated with queue Tx#0 */
|
|
ent = val >> 8;
|
|
if ((ent & E1000_IVAR_VALID)) {
|
|
n = igb_ivar_entry_tx(qn);
|
|
ent = E1000_IVAR_VALID | (24 - vfn * IGBVF_MSIX_VEC_NUM - (2 - (ent & 0x7)));
|
|
core->mac[IVAR0 + n / 4] |= ent << 8 * (n % 4);
|
|
}
|
|
|
|
/*
|
|
* Ignoring assigned vectors associated with queues Rx#1 and Tx#1 for now.
|
|
*/
|
|
}
|
|
|
|
static inline void
|
|
igb_autoneg_timer(void *opaque)
|
|
{
|
|
IGBCore *core = opaque;
|
|
if (!qemu_get_queue(core->owner_nic)->link_down) {
|
|
e1000x_update_regs_on_autoneg_done(core->mac, core->phy);
|
|
igb_start_recv(core);
|
|
|
|
igb_update_flowctl_status(core);
|
|
/* signal link status change to the guest */
|
|
igb_raise_interrupts(core, ICR, E1000_ICR_LSC);
|
|
}
|
|
}
|
|
|
|
static inline uint16_t
|
|
igb_get_reg_index_with_offset(const uint16_t *mac_reg_access, hwaddr addr)
|
|
{
|
|
uint16_t index = (addr & 0x1ffff) >> 2;
|
|
return index + (mac_reg_access[index] & 0xfffe);
|
|
}
|
|
|
|
static const char igb_phy_regcap[MAX_PHY_REG_ADDRESS + 1] = {
|
|
[MII_BMCR] = PHY_RW,
|
|
[MII_BMSR] = PHY_R,
|
|
[MII_PHYID1] = PHY_R,
|
|
[MII_PHYID2] = PHY_R,
|
|
[MII_ANAR] = PHY_RW,
|
|
[MII_ANLPAR] = PHY_R,
|
|
[MII_ANER] = PHY_R,
|
|
[MII_ANNP] = PHY_RW,
|
|
[MII_ANLPRNP] = PHY_R,
|
|
[MII_CTRL1000] = PHY_RW,
|
|
[MII_STAT1000] = PHY_R,
|
|
[MII_EXTSTAT] = PHY_R,
|
|
|
|
[IGP01E1000_PHY_PORT_CONFIG] = PHY_RW,
|
|
[IGP01E1000_PHY_PORT_STATUS] = PHY_R,
|
|
[IGP01E1000_PHY_PORT_CTRL] = PHY_RW,
|
|
[IGP01E1000_PHY_LINK_HEALTH] = PHY_R,
|
|
[IGP02E1000_PHY_POWER_MGMT] = PHY_RW,
|
|
[IGP01E1000_PHY_PAGE_SELECT] = PHY_W
|
|
};
|
|
|
|
static void
|
|
igb_phy_reg_write(IGBCore *core, uint32_t addr, uint16_t data)
|
|
{
|
|
assert(addr <= MAX_PHY_REG_ADDRESS);
|
|
|
|
if (addr == MII_BMCR) {
|
|
igb_set_phy_ctrl(core, data);
|
|
} else {
|
|
core->phy[addr] = data;
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_mdic(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint32_t data = val & E1000_MDIC_DATA_MASK;
|
|
uint32_t addr = ((val & E1000_MDIC_REG_MASK) >> E1000_MDIC_REG_SHIFT);
|
|
|
|
if ((val & E1000_MDIC_PHY_MASK) >> E1000_MDIC_PHY_SHIFT != 1) { /* phy # */
|
|
val = core->mac[MDIC] | E1000_MDIC_ERROR;
|
|
} else if (val & E1000_MDIC_OP_READ) {
|
|
if (!(igb_phy_regcap[addr] & PHY_R)) {
|
|
trace_igb_core_mdic_read_unhandled(addr);
|
|
val |= E1000_MDIC_ERROR;
|
|
} else {
|
|
val = (val ^ data) | core->phy[addr];
|
|
trace_igb_core_mdic_read(addr, val);
|
|
}
|
|
} else if (val & E1000_MDIC_OP_WRITE) {
|
|
if (!(igb_phy_regcap[addr] & PHY_W)) {
|
|
trace_igb_core_mdic_write_unhandled(addr);
|
|
val |= E1000_MDIC_ERROR;
|
|
} else {
|
|
trace_igb_core_mdic_write(addr, data);
|
|
igb_phy_reg_write(core, addr, data);
|
|
}
|
|
}
|
|
core->mac[MDIC] = val | E1000_MDIC_READY;
|
|
|
|
if (val & E1000_MDIC_INT_EN) {
|
|
igb_raise_interrupts(core, ICR, E1000_ICR_MDAC);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_rdt(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[index] = val & 0xffff;
|
|
trace_e1000e_rx_set_rdt(igb_mq_queue_idx(RDT0, index), val);
|
|
igb_start_recv(core);
|
|
}
|
|
|
|
static void
|
|
igb_set_status(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
if ((val & E1000_STATUS_PHYRA) == 0) {
|
|
core->mac[index] &= ~E1000_STATUS_PHYRA;
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_ctrlext(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
trace_igb_link_set_ext_params(!!(val & E1000_CTRL_EXT_ASDCHK),
|
|
!!(val & E1000_CTRL_EXT_SPD_BYPS),
|
|
!!(val & E1000_CTRL_EXT_PFRSTD));
|
|
|
|
/* Zero self-clearing bits */
|
|
val &= ~(E1000_CTRL_EXT_ASDCHK | E1000_CTRL_EXT_EE_RST);
|
|
core->mac[CTRL_EXT] = val;
|
|
|
|
if (core->mac[CTRL_EXT] & E1000_CTRL_EXT_PFRSTD) {
|
|
for (int vfn = 0; vfn < IGB_MAX_VF_FUNCTIONS; vfn++) {
|
|
core->mac[V2PMAILBOX0 + vfn] &= ~E1000_V2PMAILBOX_RSTI;
|
|
core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_RSTD;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_pbaclr(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
int i;
|
|
|
|
core->mac[PBACLR] = val & E1000_PBACLR_VALID_MASK;
|
|
|
|
if (!msix_enabled(core->owner)) {
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < IGB_INTR_NUM; i++) {
|
|
if (core->mac[PBACLR] & BIT(i)) {
|
|
msix_clr_pending(core->owner, i);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_fcrth(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[FCRTH] = val & 0xFFF8;
|
|
}
|
|
|
|
static void
|
|
igb_set_fcrtl(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[FCRTL] = val & 0x8000FFF8;
|
|
}
|
|
|
|
#define IGB_LOW_BITS_SET_FUNC(num) \
|
|
static void \
|
|
igb_set_##num##bit(IGBCore *core, int index, uint32_t val) \
|
|
{ \
|
|
core->mac[index] = val & (BIT(num) - 1); \
|
|
}
|
|
|
|
IGB_LOW_BITS_SET_FUNC(4)
|
|
IGB_LOW_BITS_SET_FUNC(13)
|
|
IGB_LOW_BITS_SET_FUNC(16)
|
|
|
|
static void
|
|
igb_set_dlen(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[index] = val & 0xffff0;
|
|
}
|
|
|
|
static void
|
|
igb_set_dbal(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[index] = val & E1000_XDBAL_MASK;
|
|
}
|
|
|
|
static void
|
|
igb_set_tdt(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
IGB_TxRing txr;
|
|
int qn = igb_mq_queue_idx(TDT0, index);
|
|
|
|
core->mac[index] = val & 0xffff;
|
|
|
|
igb_tx_ring_init(core, &txr, qn);
|
|
igb_start_xmit(core, &txr);
|
|
}
|
|
|
|
static void
|
|
igb_set_ics(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
trace_e1000e_irq_write_ics(val);
|
|
igb_raise_interrupts(core, ICR, val);
|
|
}
|
|
|
|
static void
|
|
igb_set_imc(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
trace_e1000e_irq_ims_clear_set_imc(val);
|
|
igb_lower_interrupts(core, IMS, val);
|
|
}
|
|
|
|
static void
|
|
igb_set_ims(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
igb_raise_interrupts(core, IMS, val & 0x77D4FBFD);
|
|
}
|
|
|
|
static void igb_nsicr(IGBCore *core)
|
|
{
|
|
/*
|
|
* If GPIE.NSICR = 0, then the clear of IMS will occur only if at
|
|
* least one bit is set in the IMS and there is a true interrupt as
|
|
* reflected in ICR.INTA.
|
|
*/
|
|
if ((core->mac[GPIE] & E1000_GPIE_NSICR) ||
|
|
(core->mac[IMS] && (core->mac[ICR] & E1000_ICR_INT_ASSERTED))) {
|
|
igb_lower_interrupts(core, IMS, core->mac[IAM]);
|
|
}
|
|
}
|
|
|
|
static void igb_set_icr(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
igb_nsicr(core);
|
|
igb_lower_interrupts(core, ICR, val);
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_readreg(IGBCore *core, int index)
|
|
{
|
|
return core->mac[index];
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_ics_read(IGBCore *core, int index)
|
|
{
|
|
trace_e1000e_irq_read_ics(core->mac[ICS]);
|
|
return core->mac[ICS];
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_ims_read(IGBCore *core, int index)
|
|
{
|
|
trace_e1000e_irq_read_ims(core->mac[IMS]);
|
|
return core->mac[IMS];
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_swsm_read(IGBCore *core, int index)
|
|
{
|
|
uint32_t val = core->mac[SWSM];
|
|
core->mac[SWSM] = val | E1000_SWSM_SMBI;
|
|
return val;
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_eitr_read(IGBCore *core, int index)
|
|
{
|
|
return core->eitr_guest_value[index - EITR0];
|
|
}
|
|
|
|
static uint32_t igb_mac_vfmailbox_read(IGBCore *core, int index)
|
|
{
|
|
uint32_t val = core->mac[index];
|
|
|
|
core->mac[index] &= ~(E1000_V2PMAILBOX_PFSTS | E1000_V2PMAILBOX_PFACK |
|
|
E1000_V2PMAILBOX_RSTD);
|
|
|
|
return val;
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_icr_read(IGBCore *core, int index)
|
|
{
|
|
uint32_t ret = core->mac[ICR];
|
|
|
|
if (core->mac[GPIE] & E1000_GPIE_NSICR) {
|
|
trace_igb_irq_icr_clear_gpie_nsicr();
|
|
igb_lower_interrupts(core, ICR, 0xffffffff);
|
|
} else if (core->mac[IMS] == 0) {
|
|
trace_e1000e_irq_icr_clear_zero_ims();
|
|
igb_lower_interrupts(core, ICR, 0xffffffff);
|
|
} else if (core->mac[ICR] & E1000_ICR_INT_ASSERTED) {
|
|
igb_lower_interrupts(core, ICR, 0xffffffff);
|
|
} else if (!msix_enabled(core->owner)) {
|
|
trace_e1000e_irq_icr_clear_nonmsix_icr_read();
|
|
igb_lower_interrupts(core, ICR, 0xffffffff);
|
|
}
|
|
|
|
igb_nsicr(core);
|
|
return ret;
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_read_clr4(IGBCore *core, int index)
|
|
{
|
|
uint32_t ret = core->mac[index];
|
|
|
|
core->mac[index] = 0;
|
|
return ret;
|
|
}
|
|
|
|
static uint32_t
|
|
igb_mac_read_clr8(IGBCore *core, int index)
|
|
{
|
|
uint32_t ret = core->mac[index];
|
|
|
|
core->mac[index] = 0;
|
|
core->mac[index - 1] = 0;
|
|
return ret;
|
|
}
|
|
|
|
static uint32_t
|
|
igb_get_ctrl(IGBCore *core, int index)
|
|
{
|
|
uint32_t val = core->mac[CTRL];
|
|
|
|
trace_e1000e_link_read_params(
|
|
!!(val & E1000_CTRL_ASDE),
|
|
(val & E1000_CTRL_SPD_SEL) >> E1000_CTRL_SPD_SHIFT,
|
|
!!(val & E1000_CTRL_FRCSPD),
|
|
!!(val & E1000_CTRL_FRCDPX),
|
|
!!(val & E1000_CTRL_RFCE),
|
|
!!(val & E1000_CTRL_TFCE));
|
|
|
|
return val;
|
|
}
|
|
|
|
static uint32_t igb_get_status(IGBCore *core, int index)
|
|
{
|
|
uint32_t res = core->mac[STATUS];
|
|
uint16_t num_vfs = pcie_sriov_num_vfs(core->owner);
|
|
|
|
if (core->mac[CTRL] & E1000_CTRL_FRCDPX) {
|
|
res |= (core->mac[CTRL] & E1000_CTRL_FD) ? E1000_STATUS_FD : 0;
|
|
} else {
|
|
res |= E1000_STATUS_FD;
|
|
}
|
|
|
|
if ((core->mac[CTRL] & E1000_CTRL_FRCSPD) ||
|
|
(core->mac[CTRL_EXT] & E1000_CTRL_EXT_SPD_BYPS)) {
|
|
switch (core->mac[CTRL] & E1000_CTRL_SPD_SEL) {
|
|
case E1000_CTRL_SPD_10:
|
|
res |= E1000_STATUS_SPEED_10;
|
|
break;
|
|
case E1000_CTRL_SPD_100:
|
|
res |= E1000_STATUS_SPEED_100;
|
|
break;
|
|
case E1000_CTRL_SPD_1000:
|
|
default:
|
|
res |= E1000_STATUS_SPEED_1000;
|
|
break;
|
|
}
|
|
} else {
|
|
res |= E1000_STATUS_SPEED_1000;
|
|
}
|
|
|
|
if (num_vfs) {
|
|
res |= num_vfs << E1000_STATUS_NUM_VFS_SHIFT;
|
|
res |= E1000_STATUS_IOV_MODE;
|
|
}
|
|
|
|
if (!(core->mac[CTRL] & E1000_CTRL_GIO_MASTER_DISABLE)) {
|
|
res |= E1000_STATUS_GIO_MASTER_ENABLE;
|
|
}
|
|
|
|
return res;
|
|
}
|
|
|
|
static void
|
|
igb_mac_writereg(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[index] = val;
|
|
}
|
|
|
|
static void
|
|
igb_mac_setmacaddr(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint32_t macaddr[2];
|
|
|
|
core->mac[index] = val;
|
|
|
|
macaddr[0] = cpu_to_le32(core->mac[RA]);
|
|
macaddr[1] = cpu_to_le32(core->mac[RA + 1]);
|
|
qemu_format_nic_info_str(qemu_get_queue(core->owner_nic),
|
|
(uint8_t *) macaddr);
|
|
|
|
trace_e1000e_mac_set_sw(MAC_ARG(macaddr));
|
|
}
|
|
|
|
static void
|
|
igb_set_eecd(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
static const uint32_t ro_bits = E1000_EECD_PRES |
|
|
E1000_EECD_AUTO_RD |
|
|
E1000_EECD_SIZE_EX_MASK;
|
|
|
|
core->mac[EECD] = (core->mac[EECD] & ro_bits) | (val & ~ro_bits);
|
|
}
|
|
|
|
static void
|
|
igb_set_eerd(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint32_t addr = (val >> E1000_EERW_ADDR_SHIFT) & E1000_EERW_ADDR_MASK;
|
|
uint32_t flags = 0;
|
|
uint32_t data = 0;
|
|
|
|
if ((addr < IGB_EEPROM_SIZE) && (val & E1000_EERW_START)) {
|
|
data = core->eeprom[addr];
|
|
flags = E1000_EERW_DONE;
|
|
}
|
|
|
|
core->mac[EERD] = flags |
|
|
(addr << E1000_EERW_ADDR_SHIFT) |
|
|
(data << E1000_EERW_DATA_SHIFT);
|
|
}
|
|
|
|
static void
|
|
igb_set_eitr(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint32_t eitr_num = index - EITR0;
|
|
|
|
trace_igb_irq_eitr_set(eitr_num, val);
|
|
|
|
core->eitr_guest_value[eitr_num] = val & ~E1000_EITR_CNT_IGNR;
|
|
core->mac[index] = val & 0x7FFE;
|
|
}
|
|
|
|
static void
|
|
igb_update_rx_offloads(IGBCore *core)
|
|
{
|
|
int cso_state = igb_rx_l4_cso_enabled(core);
|
|
|
|
trace_e1000e_rx_set_cso(cso_state);
|
|
|
|
if (core->has_vnet) {
|
|
qemu_set_offload(qemu_get_queue(core->owner_nic)->peer,
|
|
cso_state, 0, 0, 0, 0, 0, 0);
|
|
}
|
|
}
|
|
|
|
static void
|
|
igb_set_rxcsum(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[RXCSUM] = val;
|
|
igb_update_rx_offloads(core);
|
|
}
|
|
|
|
static void
|
|
igb_set_gcr(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
uint32_t ro_bits = core->mac[GCR] & E1000_GCR_RO_BITS;
|
|
core->mac[GCR] = (val & ~E1000_GCR_RO_BITS) | ro_bits;
|
|
}
|
|
|
|
static uint32_t igb_get_systiml(IGBCore *core, int index)
|
|
{
|
|
e1000x_timestamp(core->mac, core->timadj, SYSTIML, SYSTIMH);
|
|
return core->mac[SYSTIML];
|
|
}
|
|
|
|
static uint32_t igb_get_rxsatrh(IGBCore *core, int index)
|
|
{
|
|
core->mac[TSYNCRXCTL] &= ~E1000_TSYNCRXCTL_VALID;
|
|
return core->mac[RXSATRH];
|
|
}
|
|
|
|
static uint32_t igb_get_txstmph(IGBCore *core, int index)
|
|
{
|
|
core->mac[TSYNCTXCTL] &= ~E1000_TSYNCTXCTL_VALID;
|
|
return core->mac[TXSTMPH];
|
|
}
|
|
|
|
static void igb_set_timinca(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
e1000x_set_timinca(core->mac, &core->timadj, val);
|
|
}
|
|
|
|
static void igb_set_timadjh(IGBCore *core, int index, uint32_t val)
|
|
{
|
|
core->mac[TIMADJH] = val;
|
|
core->timadj += core->mac[TIMADJL] | ((int64_t)core->mac[TIMADJH] << 32);
|
|
}
|
|
|
|
#define igb_getreg(x) [x] = igb_mac_readreg
|
|
typedef uint32_t (*readops)(IGBCore *, int);
|
|
static const readops igb_macreg_readops[] = {
|
|
igb_getreg(WUFC),
|
|
igb_getreg(MANC),
|
|
igb_getreg(TOTL),
|
|
igb_getreg(RDT0),
|
|
igb_getreg(RDT1),
|
|
igb_getreg(RDT2),
|
|
igb_getreg(RDT3),
|
|
igb_getreg(RDT4),
|
|
igb_getreg(RDT5),
|
|
igb_getreg(RDT6),
|
|
igb_getreg(RDT7),
|
|
igb_getreg(RDT8),
|
|
igb_getreg(RDT9),
|
|
igb_getreg(RDT10),
|
|
igb_getreg(RDT11),
|
|
igb_getreg(RDT12),
|
|
igb_getreg(RDT13),
|
|
igb_getreg(RDT14),
|
|
igb_getreg(RDT15),
|
|
igb_getreg(RDBAH0),
|
|
igb_getreg(RDBAH1),
|
|
igb_getreg(RDBAH2),
|
|
igb_getreg(RDBAH3),
|
|
igb_getreg(RDBAH4),
|
|
igb_getreg(RDBAH5),
|
|
igb_getreg(RDBAH6),
|
|
igb_getreg(RDBAH7),
|
|
igb_getreg(RDBAH8),
|
|
igb_getreg(RDBAH9),
|
|
igb_getreg(RDBAH10),
|
|
igb_getreg(RDBAH11),
|
|
igb_getreg(RDBAH12),
|
|
igb_getreg(RDBAH13),
|
|
igb_getreg(RDBAH14),
|
|
igb_getreg(RDBAH15),
|
|
igb_getreg(TDBAL0),
|
|
igb_getreg(TDBAL1),
|
|
igb_getreg(TDBAL2),
|
|
igb_getreg(TDBAL3),
|
|
igb_getreg(TDBAL4),
|
|
igb_getreg(TDBAL5),
|
|
igb_getreg(TDBAL6),
|
|
igb_getreg(TDBAL7),
|
|
igb_getreg(TDBAL8),
|
|
igb_getreg(TDBAL9),
|
|
igb_getreg(TDBAL10),
|
|
igb_getreg(TDBAL11),
|
|
igb_getreg(TDBAL12),
|
|
igb_getreg(TDBAL13),
|
|
igb_getreg(TDBAL14),
|
|
igb_getreg(TDBAL15),
|
|
igb_getreg(RDLEN0),
|
|
igb_getreg(RDLEN1),
|
|
igb_getreg(RDLEN2),
|
|
igb_getreg(RDLEN3),
|
|
igb_getreg(RDLEN4),
|
|
igb_getreg(RDLEN5),
|
|
igb_getreg(RDLEN6),
|
|
igb_getreg(RDLEN7),
|
|
igb_getreg(RDLEN8),
|
|
igb_getreg(RDLEN9),
|
|
igb_getreg(RDLEN10),
|
|
igb_getreg(RDLEN11),
|
|
igb_getreg(RDLEN12),
|
|
igb_getreg(RDLEN13),
|
|
igb_getreg(RDLEN14),
|
|
igb_getreg(RDLEN15),
|
|
igb_getreg(SRRCTL0),
|
|
igb_getreg(SRRCTL1),
|
|
igb_getreg(SRRCTL2),
|
|
igb_getreg(SRRCTL3),
|
|
igb_getreg(SRRCTL4),
|
|
igb_getreg(SRRCTL5),
|
|
igb_getreg(SRRCTL6),
|
|
igb_getreg(SRRCTL7),
|
|
igb_getreg(SRRCTL8),
|
|
igb_getreg(SRRCTL9),
|
|
igb_getreg(SRRCTL10),
|
|
igb_getreg(SRRCTL11),
|
|
igb_getreg(SRRCTL12),
|
|
igb_getreg(SRRCTL13),
|
|
igb_getreg(SRRCTL14),
|
|
igb_getreg(SRRCTL15),
|
|
igb_getreg(LATECOL),
|
|
igb_getreg(XONTXC),
|
|
igb_getreg(TDFH),
|
|
igb_getreg(TDFT),
|
|
igb_getreg(TDFHS),
|
|
igb_getreg(TDFTS),
|
|
igb_getreg(TDFPC),
|
|
igb_getreg(WUS),
|
|
igb_getreg(RDFH),
|
|
igb_getreg(RDFT),
|
|
igb_getreg(RDFHS),
|
|
igb_getreg(RDFTS),
|
|
igb_getreg(RDFPC),
|
|
igb_getreg(GORCL),
|
|
igb_getreg(MGTPRC),
|
|
igb_getreg(EERD),
|
|
igb_getreg(EIAC),
|
|
igb_getreg(MANC2H),
|
|
igb_getreg(RXCSUM),
|
|
igb_getreg(GSCL_3),
|
|
igb_getreg(GSCN_2),
|
|
igb_getreg(FCAH),
|
|
igb_getreg(FCRTH),
|
|
igb_getreg(FLOP),
|
|
igb_getreg(RXSTMPH),
|
|
igb_getreg(TXSTMPL),
|
|
igb_getreg(TIMADJL),
|
|
igb_getreg(RDH0),
|
|
igb_getreg(RDH1),
|
|
igb_getreg(RDH2),
|
|
igb_getreg(RDH3),
|
|
igb_getreg(RDH4),
|
|
igb_getreg(RDH5),
|
|
igb_getreg(RDH6),
|
|
igb_getreg(RDH7),
|
|
igb_getreg(RDH8),
|
|
igb_getreg(RDH9),
|
|
igb_getreg(RDH10),
|
|
igb_getreg(RDH11),
|
|
igb_getreg(RDH12),
|
|
igb_getreg(RDH13),
|
|
igb_getreg(RDH14),
|
|
igb_getreg(RDH15),
|
|
igb_getreg(TDT0),
|
|
igb_getreg(TDT1),
|
|
igb_getreg(TDT2),
|
|
igb_getreg(TDT3),
|
|
igb_getreg(TDT4),
|
|
igb_getreg(TDT5),
|
|
igb_getreg(TDT6),
|
|
igb_getreg(TDT7),
|
|
igb_getreg(TDT8),
|
|
igb_getreg(TDT9),
|
|
igb_getreg(TDT10),
|
|
igb_getreg(TDT11),
|
|
igb_getreg(TDT12),
|
|
igb_getreg(TDT13),
|
|
igb_getreg(TDT14),
|
|
igb_getreg(TDT15),
|
|
igb_getreg(TNCRS),
|
|
igb_getreg(RJC),
|
|
igb_getreg(IAM),
|
|
igb_getreg(GSCL_2),
|
|
igb_getreg(TIPG),
|
|
igb_getreg(FLMNGCTL),
|
|
igb_getreg(FLMNGCNT),
|
|
igb_getreg(TSYNCTXCTL),
|
|
igb_getreg(EEMNGDATA),
|
|
igb_getreg(CTRL_EXT),
|
|
igb_getreg(SYSTIMH),
|
|
igb_getreg(EEMNGCTL),
|
|
igb_getreg(FLMNGDATA),
|
|
igb_getreg(TSYNCRXCTL),
|
|
igb_getreg(LEDCTL),
|
|
igb_getreg(TCTL),
|
|
igb_getreg(TCTL_EXT),
|
|
igb_getreg(DTXCTL),
|
|
igb_getreg(RXPBS),
|
|
igb_getreg(TDH0),
|
|
igb_getreg(TDH1),
|
|
igb_getreg(TDH2),
|
|
igb_getreg(TDH3),
|
|
igb_getreg(TDH4),
|
|
igb_getreg(TDH5),
|
|
igb_getreg(TDH6),
|
|
igb_getreg(TDH7),
|
|
igb_getreg(TDH8),
|
|
igb_getreg(TDH9),
|
|
igb_getreg(TDH10),
|
|
igb_getreg(TDH11),
|
|
igb_getreg(TDH12),
|
|
igb_getreg(TDH13),
|
|
igb_getreg(TDH14),
|
|
igb_getreg(TDH15),
|
|
igb_getreg(ECOL),
|
|
igb_getreg(DC),
|
|
igb_getreg(RLEC),
|
|
igb_getreg(XOFFTXC),
|
|
igb_getreg(RFC),
|
|
igb_getreg(RNBC),
|
|
igb_getreg(MGTPTC),
|
|
igb_getreg(TIMINCA),
|
|
igb_getreg(FACTPS),
|
|
igb_getreg(GSCL_1),
|
|
igb_getreg(GSCN_0),
|
|
igb_getreg(PBACLR),
|
|
igb_getreg(FCTTV),
|
|
igb_getreg(RXSATRL),
|
|
igb_getreg(TORL),
|
|
igb_getreg(TDLEN0),
|
|
igb_getreg(TDLEN1),
|
|
igb_getreg(TDLEN2),
|
|
igb_getreg(TDLEN3),
|
|
igb_getreg(TDLEN4),
|
|
igb_getreg(TDLEN5),
|
|
igb_getreg(TDLEN6),
|
|
igb_getreg(TDLEN7),
|
|
igb_getreg(TDLEN8),
|
|
igb_getreg(TDLEN9),
|
|
igb_getreg(TDLEN10),
|
|
igb_getreg(TDLEN11),
|
|
igb_getreg(TDLEN12),
|
|
igb_getreg(TDLEN13),
|
|
igb_getreg(TDLEN14),
|
|
igb_getreg(TDLEN15),
|
|
igb_getreg(MCC),
|
|
igb_getreg(WUC),
|
|
igb_getreg(EECD),
|
|
igb_getreg(FCRTV),
|
|
igb_getreg(TXDCTL0),
|
|
igb_getreg(TXDCTL1),
|
|
igb_getreg(TXDCTL2),
|
|
igb_getreg(TXDCTL3),
|
|
igb_getreg(TXDCTL4),
|
|
igb_getreg(TXDCTL5),
|
|
igb_getreg(TXDCTL6),
|
|
igb_getreg(TXDCTL7),
|
|
igb_getreg(TXDCTL8),
|
|
igb_getreg(TXDCTL9),
|
|
igb_getreg(TXDCTL10),
|
|
igb_getreg(TXDCTL11),
|
|
igb_getreg(TXDCTL12),
|
|
igb_getreg(TXDCTL13),
|
|
igb_getreg(TXDCTL14),
|
|
igb_getreg(TXDCTL15),
|
|
igb_getreg(TXCTL0),
|
|
igb_getreg(TXCTL1),
|
|
igb_getreg(TXCTL2),
|
|
igb_getreg(TXCTL3),
|
|
igb_getreg(TXCTL4),
|
|
igb_getreg(TXCTL5),
|
|
igb_getreg(TXCTL6),
|
|
igb_getreg(TXCTL7),
|
|
igb_getreg(TXCTL8),
|
|
igb_getreg(TXCTL9),
|
|
igb_getreg(TXCTL10),
|
|
igb_getreg(TXCTL11),
|
|
igb_getreg(TXCTL12),
|
|
igb_getreg(TXCTL13),
|
|
igb_getreg(TXCTL14),
|
|
igb_getreg(TXCTL15),
|
|
igb_getreg(TDWBAL0),
|
|
igb_getreg(TDWBAL1),
|
|
igb_getreg(TDWBAL2),
|
|
igb_getreg(TDWBAL3),
|
|
igb_getreg(TDWBAL4),
|
|
igb_getreg(TDWBAL5),
|
|
igb_getreg(TDWBAL6),
|
|
igb_getreg(TDWBAL7),
|
|
igb_getreg(TDWBAL8),
|
|
igb_getreg(TDWBAL9),
|
|
igb_getreg(TDWBAL10),
|
|
igb_getreg(TDWBAL11),
|
|
igb_getreg(TDWBAL12),
|
|
igb_getreg(TDWBAL13),
|
|
igb_getreg(TDWBAL14),
|
|
igb_getreg(TDWBAL15),
|
|
igb_getreg(TDWBAH0),
|
|
igb_getreg(TDWBAH1),
|
|
igb_getreg(TDWBAH2),
|
|
igb_getreg(TDWBAH3),
|
|
igb_getreg(TDWBAH4),
|
|
igb_getreg(TDWBAH5),
|
|
igb_getreg(TDWBAH6),
|
|
igb_getreg(TDWBAH7),
|
|
igb_getreg(TDWBAH8),
|
|
igb_getreg(TDWBAH9),
|
|
igb_getreg(TDWBAH10),
|
|
igb_getreg(TDWBAH11),
|
|
igb_getreg(TDWBAH12),
|
|
igb_getreg(TDWBAH13),
|
|
igb_getreg(TDWBAH14),
|
|
igb_getreg(TDWBAH15),
|
|
igb_getreg(PVTCTRL0),
|
|
igb_getreg(PVTCTRL1),
|
|
igb_getreg(PVTCTRL2),
|
|
igb_getreg(PVTCTRL3),
|
|
igb_getreg(PVTCTRL4),
|
|
igb_getreg(PVTCTRL5),
|
|
igb_getreg(PVTCTRL6),
|
|
igb_getreg(PVTCTRL7),
|
|
igb_getreg(PVTEIMS0),
|
|
igb_getreg(PVTEIMS1),
|
|
igb_getreg(PVTEIMS2),
|
|
igb_getreg(PVTEIMS3),
|
|
igb_getreg(PVTEIMS4),
|
|
igb_getreg(PVTEIMS5),
|
|
igb_getreg(PVTEIMS6),
|
|
igb_getreg(PVTEIMS7),
|
|
igb_getreg(PVTEIAC0),
|
|
igb_getreg(PVTEIAC1),
|
|
igb_getreg(PVTEIAC2),
|
|
igb_getreg(PVTEIAC3),
|
|
igb_getreg(PVTEIAC4),
|
|
igb_getreg(PVTEIAC5),
|
|
igb_getreg(PVTEIAC6),
|
|
igb_getreg(PVTEIAC7),
|
|
igb_getreg(PVTEIAM0),
|
|
igb_getreg(PVTEIAM1),
|
|
igb_getreg(PVTEIAM2),
|
|
igb_getreg(PVTEIAM3),
|
|
igb_getreg(PVTEIAM4),
|
|
igb_getreg(PVTEIAM5),
|
|
igb_getreg(PVTEIAM6),
|
|
igb_getreg(PVTEIAM7),
|
|
igb_getreg(PVFGPRC0),
|
|
igb_getreg(PVFGPRC1),
|
|
igb_getreg(PVFGPRC2),
|
|
igb_getreg(PVFGPRC3),
|
|
igb_getreg(PVFGPRC4),
|
|
igb_getreg(PVFGPRC5),
|
|
igb_getreg(PVFGPRC6),
|
|
igb_getreg(PVFGPRC7),
|
|
igb_getreg(PVFGPTC0),
|
|
igb_getreg(PVFGPTC1),
|
|
igb_getreg(PVFGPTC2),
|
|
igb_getreg(PVFGPTC3),
|
|
igb_getreg(PVFGPTC4),
|
|
igb_getreg(PVFGPTC5),
|
|
igb_getreg(PVFGPTC6),
|
|
igb_getreg(PVFGPTC7),
|
|
igb_getreg(PVFGORC0),
|
|
igb_getreg(PVFGORC1),
|
|
igb_getreg(PVFGORC2),
|
|
igb_getreg(PVFGORC3),
|
|
igb_getreg(PVFGORC4),
|
|
igb_getreg(PVFGORC5),
|
|
igb_getreg(PVFGORC6),
|
|
igb_getreg(PVFGORC7),
|
|
igb_getreg(PVFGOTC0),
|
|
igb_getreg(PVFGOTC1),
|
|
igb_getreg(PVFGOTC2),
|
|
igb_getreg(PVFGOTC3),
|
|
igb_getreg(PVFGOTC4),
|
|
igb_getreg(PVFGOTC5),
|
|
igb_getreg(PVFGOTC6),
|
|
igb_getreg(PVFGOTC7),
|
|
igb_getreg(PVFMPRC0),
|
|
igb_getreg(PVFMPRC1),
|
|
igb_getreg(PVFMPRC2),
|
|
igb_getreg(PVFMPRC3),
|
|
igb_getreg(PVFMPRC4),
|
|
igb_getreg(PVFMPRC5),
|
|
igb_getreg(PVFMPRC6),
|
|
igb_getreg(PVFMPRC7),
|
|
igb_getreg(PVFGPRLBC0),
|
|
igb_getreg(PVFGPRLBC1),
|
|
igb_getreg(PVFGPRLBC2),
|
|
igb_getreg(PVFGPRLBC3),
|
|
igb_getreg(PVFGPRLBC4),
|
|
igb_getreg(PVFGPRLBC5),
|
|
igb_getreg(PVFGPRLBC6),
|
|
igb_getreg(PVFGPRLBC7),
|
|
igb_getreg(PVFGPTLBC0),
|
|
igb_getreg(PVFGPTLBC1),
|
|
igb_getreg(PVFGPTLBC2),
|
|
igb_getreg(PVFGPTLBC3),
|
|
igb_getreg(PVFGPTLBC4),
|
|
igb_getreg(PVFGPTLBC5),
|
|
igb_getreg(PVFGPTLBC6),
|
|
igb_getreg(PVFGPTLBC7),
|
|
igb_getreg(PVFGORLBC0),
|
|
igb_getreg(PVFGORLBC1),
|
|
igb_getreg(PVFGORLBC2),
|
|
igb_getreg(PVFGORLBC3),
|
|
igb_getreg(PVFGORLBC4),
|
|
igb_getreg(PVFGORLBC5),
|
|
igb_getreg(PVFGORLBC6),
|
|
igb_getreg(PVFGORLBC7),
|
|
igb_getreg(PVFGOTLBC0),
|
|
igb_getreg(PVFGOTLBC1),
|
|
igb_getreg(PVFGOTLBC2),
|
|
igb_getreg(PVFGOTLBC3),
|
|
igb_getreg(PVFGOTLBC4),
|
|
igb_getreg(PVFGOTLBC5),
|
|
igb_getreg(PVFGOTLBC6),
|
|
igb_getreg(PVFGOTLBC7),
|
|
igb_getreg(RCTL),
|
|
igb_getreg(MDIC),
|
|
igb_getreg(FCRUC),
|
|
igb_getreg(VET),
|
|
igb_getreg(RDBAL0),
|
|
igb_getreg(RDBAL1),
|
|
igb_getreg(RDBAL2),
|
|
igb_getreg(RDBAL3),
|
|
igb_getreg(RDBAL4),
|
|
igb_getreg(RDBAL5),
|
|
igb_getreg(RDBAL6),
|
|
igb_getreg(RDBAL7),
|
|
igb_getreg(RDBAL8),
|
|
igb_getreg(RDBAL9),
|
|
igb_getreg(RDBAL10),
|
|
igb_getreg(RDBAL11),
|
|
igb_getreg(RDBAL12),
|
|
igb_getreg(RDBAL13),
|
|
igb_getreg(RDBAL14),
|
|
igb_getreg(RDBAL15),
|
|
igb_getreg(TDBAH0),
|
|
igb_getreg(TDBAH1),
|
|
igb_getreg(TDBAH2),
|
|
igb_getreg(TDBAH3),
|
|
igb_getreg(TDBAH4),
|
|
igb_getreg(TDBAH5),
|
|
igb_getreg(TDBAH6),
|
|
igb_getreg(TDBAH7),
|
|
igb_getreg(TDBAH8),
|
|
igb_getreg(TDBAH9),
|
|
igb_getreg(TDBAH10),
|
|
igb_getreg(TDBAH11),
|
|
igb_getreg(TDBAH12),
|
|
igb_getreg(TDBAH13),
|
|
igb_getreg(TDBAH14),
|
|
igb_getreg(TDBAH15),
|
|
igb_getreg(SCC),
|
|
igb_getreg(COLC),
|
|
igb_getreg(XOFFRXC),
|
|
igb_getreg(IPAV),
|
|
igb_getreg(GOTCL),
|
|
igb_getreg(MGTPDC),
|
|
igb_getreg(GCR),
|
|
igb_getreg(MFVAL),
|
|
igb_getreg(FUNCTAG),
|
|
igb_getreg(GSCL_4),
|
|
igb_getreg(GSCN_3),
|
|
igb_getreg(MRQC),
|
|
igb_getreg(FCT),
|
|
igb_getreg(FLA),
|
|
igb_getreg(RXDCTL0),
|
|
igb_getreg(RXDCTL1),
|
|
igb_getreg(RXDCTL2),
|
|
igb_getreg(RXDCTL3),
|
|
igb_getreg(RXDCTL4),
|
|
igb_getreg(RXDCTL5),
|
|
igb_getreg(RXDCTL6),
|
|
igb_getreg(RXDCTL7),
|
|
igb_getreg(RXDCTL8),
|
|
igb_getreg(RXDCTL9),
|
|
igb_getreg(RXDCTL10),
|
|
igb_getreg(RXDCTL11),
|
|
igb_getreg(RXDCTL12),
|
|
igb_getreg(RXDCTL13),
|
|
igb_getreg(RXDCTL14),
|
|
igb_getreg(RXDCTL15),
|
|
igb_getreg(RXSTMPL),
|
|
igb_getreg(TIMADJH),
|
|
igb_getreg(FCRTL),
|
|
igb_getreg(XONRXC),
|
|
igb_getreg(RFCTL),
|
|
igb_getreg(GSCN_1),
|
|
igb_getreg(FCAL),
|
|
igb_getreg(GPIE),
|
|
igb_getreg(TXPBS),
|
|
igb_getreg(RLPML),
|
|
|
|
[TOTH] = igb_mac_read_clr8,
|
|
[GOTCH] = igb_mac_read_clr8,
|
|
[PRC64] = igb_mac_read_clr4,
|
|
[PRC255] = igb_mac_read_clr4,
|
|
[PRC1023] = igb_mac_read_clr4,
|
|
[PTC64] = igb_mac_read_clr4,
|
|
[PTC255] = igb_mac_read_clr4,
|
|
[PTC1023] = igb_mac_read_clr4,
|
|
[GPRC] = igb_mac_read_clr4,
|
|
[TPT] = igb_mac_read_clr4,
|
|
[RUC] = igb_mac_read_clr4,
|
|
[BPRC] = igb_mac_read_clr4,
|
|
[MPTC] = igb_mac_read_clr4,
|
|
[IAC] = igb_mac_read_clr4,
|
|
[ICR] = igb_mac_icr_read,
|
|
[STATUS] = igb_get_status,
|
|
[ICS] = igb_mac_ics_read,
|
|
/*
|
|
* 8.8.10: Reading the IMC register returns the value of the IMS register.
|
|
*/
|
|
[IMC] = igb_mac_ims_read,
|
|
[TORH] = igb_mac_read_clr8,
|
|
[GORCH] = igb_mac_read_clr8,
|
|
[PRC127] = igb_mac_read_clr4,
|
|
[PRC511] = igb_mac_read_clr4,
|
|
[PRC1522] = igb_mac_read_clr4,
|
|
[PTC127] = igb_mac_read_clr4,
|
|
[PTC511] = igb_mac_read_clr4,
|
|
[PTC1522] = igb_mac_read_clr4,
|
|
[GPTC] = igb_mac_read_clr4,
|
|
[TPR] = igb_mac_read_clr4,
|
|
[ROC] = igb_mac_read_clr4,
|
|
[MPRC] = igb_mac_read_clr4,
|
|
[BPTC] = igb_mac_read_clr4,
|
|
[TSCTC] = igb_mac_read_clr4,
|
|
[CTRL] = igb_get_ctrl,
|
|
[SWSM] = igb_mac_swsm_read,
|
|
[IMS] = igb_mac_ims_read,
|
|
[SYSTIML] = igb_get_systiml,
|
|
[RXSATRH] = igb_get_rxsatrh,
|
|
[TXSTMPH] = igb_get_txstmph,
|
|
|
|
[CRCERRS ... MPC] = igb_mac_readreg,
|
|
[IP6AT ... IP6AT + 3] = igb_mac_readreg,
|
|
[IP4AT ... IP4AT + 6] = igb_mac_readreg,
|
|
[RA ... RA + 31] = igb_mac_readreg,
|
|
[RA2 ... RA2 + 31] = igb_mac_readreg,
|
|
[WUPM ... WUPM + 31] = igb_mac_readreg,
|
|
[MTA ... MTA + E1000_MC_TBL_SIZE - 1] = igb_mac_readreg,
|
|
[VFTA ... VFTA + E1000_VLAN_FILTER_TBL_SIZE - 1] = igb_mac_readreg,
|
|
[FFMT ... FFMT + 254] = igb_mac_readreg,
|
|
[MDEF ... MDEF + 7] = igb_mac_readreg,
|
|
[FTFT ... FTFT + 254] = igb_mac_readreg,
|
|
[RETA ... RETA + 31] = igb_mac_readreg,
|
|
[RSSRK ... RSSRK + 9] = igb_mac_readreg,
|
|
[MAVTV0 ... MAVTV3] = igb_mac_readreg,
|
|
[EITR0 ... EITR0 + IGB_INTR_NUM - 1] = igb_mac_eitr_read,
|
|
[PVTEICR0] = igb_mac_read_clr4,
|
|
[PVTEICR1] = igb_mac_read_clr4,
|
|
[PVTEICR2] = igb_mac_read_clr4,
|
|
[PVTEICR3] = igb_mac_read_clr4,
|
|
[PVTEICR4] = igb_mac_read_clr4,
|
|
[PVTEICR5] = igb_mac_read_clr4,
|
|
[PVTEICR6] = igb_mac_read_clr4,
|
|
[PVTEICR7] = igb_mac_read_clr4,
|
|
|
|
/* IGB specific: */
|
|
[FWSM] = igb_mac_readreg,
|
|
[SW_FW_SYNC] = igb_mac_readreg,
|
|
[HTCBDPC] = igb_mac_read_clr4,
|
|
[EICR] = igb_mac_read_clr4,
|
|
[EIMS] = igb_mac_readreg,
|
|
[EIAM] = igb_mac_readreg,
|
|
[IVAR0 ... IVAR0 + 7] = igb_mac_readreg,
|
|
igb_getreg(IVAR_MISC),
|
|
igb_getreg(TSYNCRXCFG),
|
|
[ETQF0 ... ETQF0 + 7] = igb_mac_readreg,
|
|
igb_getreg(VT_CTL),
|
|
[P2VMAILBOX0 ... P2VMAILBOX7] = igb_mac_readreg,
|
|
[V2PMAILBOX0 ... V2PMAILBOX7] = igb_mac_vfmailbox_read,
|
|
igb_getreg(MBVFICR),
|
|
[VMBMEM0 ... VMBMEM0 + 127] = igb_mac_readreg,
|
|
igb_getreg(MBVFIMR),
|
|
igb_getreg(VFLRE),
|
|
igb_getreg(VFRE),
|
|
igb_getreg(VFTE),
|
|
igb_getreg(QDE),
|
|
igb_getreg(DTXSWC),
|
|
igb_getreg(RPLOLR),
|
|
[VLVF0 ... VLVF0 + E1000_VLVF_ARRAY_SIZE - 1] = igb_mac_readreg,
|
|
[VMVIR0 ... VMVIR7] = igb_mac_readreg,
|
|
[VMOLR0 ... VMOLR7] = igb_mac_readreg,
|
|
[WVBR] = igb_mac_read_clr4,
|
|
[RQDPC0] = igb_mac_read_clr4,
|
|
[RQDPC1] = igb_mac_read_clr4,
|
|
[RQDPC2] = igb_mac_read_clr4,
|
|
[RQDPC3] = igb_mac_read_clr4,
|
|
[RQDPC4] = igb_mac_read_clr4,
|
|
[RQDPC5] = igb_mac_read_clr4,
|
|
[RQDPC6] = igb_mac_read_clr4,
|
|
[RQDPC7] = igb_mac_read_clr4,
|
|
[RQDPC8] = igb_mac_read_clr4,
|
|
[RQDPC9] = igb_mac_read_clr4,
|
|
[RQDPC10] = igb_mac_read_clr4,
|
|
[RQDPC11] = igb_mac_read_clr4,
|
|
[RQDPC12] = igb_mac_read_clr4,
|
|
[RQDPC13] = igb_mac_read_clr4,
|
|
[RQDPC14] = igb_mac_read_clr4,
|
|
[RQDPC15] = igb_mac_read_clr4,
|
|
[VTIVAR ... VTIVAR + 7] = igb_mac_readreg,
|
|
[VTIVAR_MISC ... VTIVAR_MISC + 7] = igb_mac_readreg,
|
|
};
|
|
enum { IGB_NREADOPS = ARRAY_SIZE(igb_macreg_readops) };
|
|
|
|
#define igb_putreg(x) [x] = igb_mac_writereg
|
|
typedef void (*writeops)(IGBCore *, int, uint32_t);
|
|
static const writeops igb_macreg_writeops[] = {
|
|
igb_putreg(SWSM),
|
|
igb_putreg(WUFC),
|
|
igb_putreg(RDBAH0),
|
|
igb_putreg(RDBAH1),
|
|
igb_putreg(RDBAH2),
|
|
igb_putreg(RDBAH3),
|
|
igb_putreg(RDBAH4),
|
|
igb_putreg(RDBAH5),
|
|
igb_putreg(RDBAH6),
|
|
igb_putreg(RDBAH7),
|
|
igb_putreg(RDBAH8),
|
|
igb_putreg(RDBAH9),
|
|
igb_putreg(RDBAH10),
|
|
igb_putreg(RDBAH11),
|
|
igb_putreg(RDBAH12),
|
|
igb_putreg(RDBAH13),
|
|
igb_putreg(RDBAH14),
|
|
igb_putreg(RDBAH15),
|
|
igb_putreg(SRRCTL0),
|
|
igb_putreg(SRRCTL1),
|
|
igb_putreg(SRRCTL2),
|
|
igb_putreg(SRRCTL3),
|
|
igb_putreg(SRRCTL4),
|
|
igb_putreg(SRRCTL5),
|
|
igb_putreg(SRRCTL6),
|
|
igb_putreg(SRRCTL7),
|
|
igb_putreg(SRRCTL8),
|
|
igb_putreg(SRRCTL9),
|
|
igb_putreg(SRRCTL10),
|
|
igb_putreg(SRRCTL11),
|
|
igb_putreg(SRRCTL12),
|
|
igb_putreg(SRRCTL13),
|
|
igb_putreg(SRRCTL14),
|
|
igb_putreg(SRRCTL15),
|
|
igb_putreg(RXDCTL0),
|
|
igb_putreg(RXDCTL1),
|
|
igb_putreg(RXDCTL2),
|
|
igb_putreg(RXDCTL3),
|
|
igb_putreg(RXDCTL4),
|
|
igb_putreg(RXDCTL5),
|
|
igb_putreg(RXDCTL6),
|
|
igb_putreg(RXDCTL7),
|
|
igb_putreg(RXDCTL8),
|
|
igb_putreg(RXDCTL9),
|
|
igb_putreg(RXDCTL10),
|
|
igb_putreg(RXDCTL11),
|
|
igb_putreg(RXDCTL12),
|
|
igb_putreg(RXDCTL13),
|
|
igb_putreg(RXDCTL14),
|
|
igb_putreg(RXDCTL15),
|
|
igb_putreg(LEDCTL),
|
|
igb_putreg(TCTL),
|
|
igb_putreg(TCTL_EXT),
|
|
igb_putreg(DTXCTL),
|
|
igb_putreg(RXPBS),
|
|
igb_putreg(RQDPC0),
|
|
igb_putreg(FCAL),
|
|
igb_putreg(FCRUC),
|
|
igb_putreg(WUC),
|
|
igb_putreg(WUS),
|
|
igb_putreg(IPAV),
|
|
igb_putreg(TDBAH0),
|
|
igb_putreg(TDBAH1),
|
|
igb_putreg(TDBAH2),
|
|
igb_putreg(TDBAH3),
|
|
igb_putreg(TDBAH4),
|
|
igb_putreg(TDBAH5),
|
|
igb_putreg(TDBAH6),
|
|
igb_putreg(TDBAH7),
|
|
igb_putreg(TDBAH8),
|
|
igb_putreg(TDBAH9),
|
|
igb_putreg(TDBAH10),
|
|
igb_putreg(TDBAH11),
|
|
igb_putreg(TDBAH12),
|
|
igb_putreg(TDBAH13),
|
|
igb_putreg(TDBAH14),
|
|
igb_putreg(TDBAH15),
|
|
igb_putreg(IAM),
|
|
igb_putreg(MANC),
|
|
igb_putreg(MANC2H),
|
|
igb_putreg(MFVAL),
|
|
igb_putreg(FACTPS),
|
|
igb_putreg(FUNCTAG),
|
|
igb_putreg(GSCL_1),
|
|
igb_putreg(GSCL_2),
|
|
igb_putreg(GSCL_3),
|
|
igb_putreg(GSCL_4),
|
|
igb_putreg(GSCN_0),
|
|
igb_putreg(GSCN_1),
|
|
igb_putreg(GSCN_2),
|
|
igb_putreg(GSCN_3),
|
|
igb_putreg(MRQC),
|
|
igb_putreg(FLOP),
|
|
igb_putreg(FLA),
|
|
igb_putreg(TXDCTL0),
|
|
igb_putreg(TXDCTL1),
|
|
igb_putreg(TXDCTL2),
|
|
igb_putreg(TXDCTL3),
|
|
igb_putreg(TXDCTL4),
|
|
igb_putreg(TXDCTL5),
|
|
igb_putreg(TXDCTL6),
|
|
igb_putreg(TXDCTL7),
|
|
igb_putreg(TXDCTL8),
|
|
igb_putreg(TXDCTL9),
|
|
igb_putreg(TXDCTL10),
|
|
igb_putreg(TXDCTL11),
|
|
igb_putreg(TXDCTL12),
|
|
igb_putreg(TXDCTL13),
|
|
igb_putreg(TXDCTL14),
|
|
igb_putreg(TXDCTL15),
|
|
igb_putreg(TXCTL0),
|
|
igb_putreg(TXCTL1),
|
|
igb_putreg(TXCTL2),
|
|
igb_putreg(TXCTL3),
|
|
igb_putreg(TXCTL4),
|
|
igb_putreg(TXCTL5),
|
|
igb_putreg(TXCTL6),
|
|
igb_putreg(TXCTL7),
|
|
igb_putreg(TXCTL8),
|
|
igb_putreg(TXCTL9),
|
|
igb_putreg(TXCTL10),
|
|
igb_putreg(TXCTL11),
|
|
igb_putreg(TXCTL12),
|
|
igb_putreg(TXCTL13),
|
|
igb_putreg(TXCTL14),
|
|
igb_putreg(TXCTL15),
|
|
igb_putreg(TDWBAL0),
|
|
igb_putreg(TDWBAL1),
|
|
igb_putreg(TDWBAL2),
|
|
igb_putreg(TDWBAL3),
|
|
igb_putreg(TDWBAL4),
|
|
igb_putreg(TDWBAL5),
|
|
igb_putreg(TDWBAL6),
|
|
igb_putreg(TDWBAL7),
|
|
igb_putreg(TDWBAL8),
|
|
igb_putreg(TDWBAL9),
|
|
igb_putreg(TDWBAL10),
|
|
igb_putreg(TDWBAL11),
|
|
igb_putreg(TDWBAL12),
|
|
igb_putreg(TDWBAL13),
|
|
igb_putreg(TDWBAL14),
|
|
igb_putreg(TDWBAL15),
|
|
igb_putreg(TDWBAH0),
|
|
igb_putreg(TDWBAH1),
|
|
igb_putreg(TDWBAH2),
|
|
igb_putreg(TDWBAH3),
|
|
igb_putreg(TDWBAH4),
|
|
igb_putreg(TDWBAH5),
|
|
igb_putreg(TDWBAH6),
|
|
igb_putreg(TDWBAH7),
|
|
igb_putreg(TDWBAH8),
|
|
igb_putreg(TDWBAH9),
|
|
igb_putreg(TDWBAH10),
|
|
igb_putreg(TDWBAH11),
|
|
igb_putreg(TDWBAH12),
|
|
igb_putreg(TDWBAH13),
|
|
igb_putreg(TDWBAH14),
|
|
igb_putreg(TDWBAH15),
|
|
igb_putreg(TIPG),
|
|
igb_putreg(RXSTMPH),
|
|
igb_putreg(RXSTMPL),
|
|
igb_putreg(RXSATRL),
|
|
igb_putreg(RXSATRH),
|
|
igb_putreg(TXSTMPL),
|
|
igb_putreg(TXSTMPH),
|
|
igb_putreg(SYSTIML),
|
|
igb_putreg(SYSTIMH),
|
|
igb_putreg(TIMADJL),
|
|
igb_putreg(TSYNCRXCTL),
|
|
igb_putreg(TSYNCTXCTL),
|
|
igb_putreg(EEMNGCTL),
|
|
igb_putreg(GPIE),
|
|
igb_putreg(TXPBS),
|
|
igb_putreg(RLPML),
|
|
igb_putreg(VET),
|
|
|
|
[TDH0] = igb_set_16bit,
|
|
[TDH1] = igb_set_16bit,
|
|
[TDH2] = igb_set_16bit,
|
|
[TDH3] = igb_set_16bit,
|
|
[TDH4] = igb_set_16bit,
|
|
[TDH5] = igb_set_16bit,
|
|
[TDH6] = igb_set_16bit,
|
|
[TDH7] = igb_set_16bit,
|
|
[TDH8] = igb_set_16bit,
|
|
[TDH9] = igb_set_16bit,
|
|
[TDH10] = igb_set_16bit,
|
|
[TDH11] = igb_set_16bit,
|
|
[TDH12] = igb_set_16bit,
|
|
[TDH13] = igb_set_16bit,
|
|
[TDH14] = igb_set_16bit,
|
|
[TDH15] = igb_set_16bit,
|
|
[TDT0] = igb_set_tdt,
|
|
[TDT1] = igb_set_tdt,
|
|
[TDT2] = igb_set_tdt,
|
|
[TDT3] = igb_set_tdt,
|
|
[TDT4] = igb_set_tdt,
|
|
[TDT5] = igb_set_tdt,
|
|
[TDT6] = igb_set_tdt,
|
|
[TDT7] = igb_set_tdt,
|
|
[TDT8] = igb_set_tdt,
|
|
[TDT9] = igb_set_tdt,
|
|
[TDT10] = igb_set_tdt,
|
|
[TDT11] = igb_set_tdt,
|
|
[TDT12] = igb_set_tdt,
|
|
[TDT13] = igb_set_tdt,
|
|
[TDT14] = igb_set_tdt,
|
|
[TDT15] = igb_set_tdt,
|
|
[MDIC] = igb_set_mdic,
|
|
[ICS] = igb_set_ics,
|
|
[RDH0] = igb_set_16bit,
|
|
[RDH1] = igb_set_16bit,
|
|
[RDH2] = igb_set_16bit,
|
|
[RDH3] = igb_set_16bit,
|
|
[RDH4] = igb_set_16bit,
|
|
[RDH5] = igb_set_16bit,
|
|
[RDH6] = igb_set_16bit,
|
|
[RDH7] = igb_set_16bit,
|
|
[RDH8] = igb_set_16bit,
|
|
[RDH9] = igb_set_16bit,
|
|
[RDH10] = igb_set_16bit,
|
|
[RDH11] = igb_set_16bit,
|
|
[RDH12] = igb_set_16bit,
|
|
[RDH13] = igb_set_16bit,
|
|
[RDH14] = igb_set_16bit,
|
|
[RDH15] = igb_set_16bit,
|
|
[RDT0] = igb_set_rdt,
|
|
[RDT1] = igb_set_rdt,
|
|
[RDT2] = igb_set_rdt,
|
|
[RDT3] = igb_set_rdt,
|
|
[RDT4] = igb_set_rdt,
|
|
[RDT5] = igb_set_rdt,
|
|
[RDT6] = igb_set_rdt,
|
|
[RDT7] = igb_set_rdt,
|
|
[RDT8] = igb_set_rdt,
|
|
[RDT9] = igb_set_rdt,
|
|
[RDT10] = igb_set_rdt,
|
|
[RDT11] = igb_set_rdt,
|
|
[RDT12] = igb_set_rdt,
|
|
[RDT13] = igb_set_rdt,
|
|
[RDT14] = igb_set_rdt,
|
|
[RDT15] = igb_set_rdt,
|
|
[IMC] = igb_set_imc,
|
|
[IMS] = igb_set_ims,
|
|
[ICR] = igb_set_icr,
|
|
[EECD] = igb_set_eecd,
|
|
[RCTL] = igb_set_rx_control,
|
|
[CTRL] = igb_set_ctrl,
|
|
[EERD] = igb_set_eerd,
|
|
[TDFH] = igb_set_13bit,
|
|
[TDFT] = igb_set_13bit,
|
|
[TDFHS] = igb_set_13bit,
|
|
[TDFTS] = igb_set_13bit,
|
|
[TDFPC] = igb_set_13bit,
|
|
[RDFH] = igb_set_13bit,
|
|
[RDFT] = igb_set_13bit,
|
|
[RDFHS] = igb_set_13bit,
|
|
[RDFTS] = igb_set_13bit,
|
|
[RDFPC] = igb_set_13bit,
|
|
[GCR] = igb_set_gcr,
|
|
[RXCSUM] = igb_set_rxcsum,
|
|
[TDLEN0] = igb_set_dlen,
|
|
[TDLEN1] = igb_set_dlen,
|
|
[TDLEN2] = igb_set_dlen,
|
|
[TDLEN3] = igb_set_dlen,
|
|
[TDLEN4] = igb_set_dlen,
|
|
[TDLEN5] = igb_set_dlen,
|
|
[TDLEN6] = igb_set_dlen,
|
|
[TDLEN7] = igb_set_dlen,
|
|
[TDLEN8] = igb_set_dlen,
|
|
[TDLEN9] = igb_set_dlen,
|
|
[TDLEN10] = igb_set_dlen,
|
|
[TDLEN11] = igb_set_dlen,
|
|
[TDLEN12] = igb_set_dlen,
|
|
[TDLEN13] = igb_set_dlen,
|
|
[TDLEN14] = igb_set_dlen,
|
|
[TDLEN15] = igb_set_dlen,
|
|
[RDLEN0] = igb_set_dlen,
|
|
[RDLEN1] = igb_set_dlen,
|
|
[RDLEN2] = igb_set_dlen,
|
|
[RDLEN3] = igb_set_dlen,
|
|
[RDLEN4] = igb_set_dlen,
|
|
[RDLEN5] = igb_set_dlen,
|
|
[RDLEN6] = igb_set_dlen,
|
|
[RDLEN7] = igb_set_dlen,
|
|
[RDLEN8] = igb_set_dlen,
|
|
[RDLEN9] = igb_set_dlen,
|
|
[RDLEN10] = igb_set_dlen,
|
|
[RDLEN11] = igb_set_dlen,
|
|
[RDLEN12] = igb_set_dlen,
|
|
[RDLEN13] = igb_set_dlen,
|
|
[RDLEN14] = igb_set_dlen,
|
|
[RDLEN15] = igb_set_dlen,
|
|
[TDBAL0] = igb_set_dbal,
|
|
[TDBAL1] = igb_set_dbal,
|
|
[TDBAL2] = igb_set_dbal,
|
|
[TDBAL3] = igb_set_dbal,
|
|
[TDBAL4] = igb_set_dbal,
|
|
[TDBAL5] = igb_set_dbal,
|
|
[TDBAL6] = igb_set_dbal,
|
|
[TDBAL7] = igb_set_dbal,
|
|
[TDBAL8] = igb_set_dbal,
|
|
[TDBAL9] = igb_set_dbal,
|
|
[TDBAL10] = igb_set_dbal,
|
|
[TDBAL11] = igb_set_dbal,
|
|
[TDBAL12] = igb_set_dbal,
|
|
[TDBAL13] = igb_set_dbal,
|
|
[TDBAL14] = igb_set_dbal,
|
|
[TDBAL15] = igb_set_dbal,
|
|
[RDBAL0] = igb_set_dbal,
|
|
[RDBAL1] = igb_set_dbal,
|
|
[RDBAL2] = igb_set_dbal,
|
|
[RDBAL3] = igb_set_dbal,
|
|
[RDBAL4] = igb_set_dbal,
|
|
[RDBAL5] = igb_set_dbal,
|
|
[RDBAL6] = igb_set_dbal,
|
|
[RDBAL7] = igb_set_dbal,
|
|
[RDBAL8] = igb_set_dbal,
|
|
[RDBAL9] = igb_set_dbal,
|
|
[RDBAL10] = igb_set_dbal,
|
|
[RDBAL11] = igb_set_dbal,
|
|
[RDBAL12] = igb_set_dbal,
|
|
[RDBAL13] = igb_set_dbal,
|
|
[RDBAL14] = igb_set_dbal,
|
|
[RDBAL15] = igb_set_dbal,
|
|
[STATUS] = igb_set_status,
|
|
[PBACLR] = igb_set_pbaclr,
|
|
[CTRL_EXT] = igb_set_ctrlext,
|
|
[FCAH] = igb_set_16bit,
|
|
[FCT] = igb_set_16bit,
|
|
[FCTTV] = igb_set_16bit,
|
|
[FCRTV] = igb_set_16bit,
|
|
[FCRTH] = igb_set_fcrth,
|
|
[FCRTL] = igb_set_fcrtl,
|
|
[CTRL_DUP] = igb_set_ctrl,
|
|
[RFCTL] = igb_set_rfctl,
|
|
[TIMINCA] = igb_set_timinca,
|
|
[TIMADJH] = igb_set_timadjh,
|
|
|
|
[IP6AT ... IP6AT + 3] = igb_mac_writereg,
|
|
[IP4AT ... IP4AT + 6] = igb_mac_writereg,
|
|
[RA] = igb_mac_writereg,
|
|
[RA + 1] = igb_mac_setmacaddr,
|
|
[RA + 2 ... RA + 31] = igb_mac_writereg,
|
|
[RA2 ... RA2 + 31] = igb_mac_writereg,
|
|
[WUPM ... WUPM + 31] = igb_mac_writereg,
|
|
[MTA ... MTA + E1000_MC_TBL_SIZE - 1] = igb_mac_writereg,
|
|
[VFTA ... VFTA + E1000_VLAN_FILTER_TBL_SIZE - 1] = igb_mac_writereg,
|
|
[FFMT ... FFMT + 254] = igb_set_4bit,
|
|
[MDEF ... MDEF + 7] = igb_mac_writereg,
|
|
[FTFT ... FTFT + 254] = igb_mac_writereg,
|
|
[RETA ... RETA + 31] = igb_mac_writereg,
|
|
[RSSRK ... RSSRK + 9] = igb_mac_writereg,
|
|
[MAVTV0 ... MAVTV3] = igb_mac_writereg,
|
|
[EITR0 ... EITR0 + IGB_INTR_NUM - 1] = igb_set_eitr,
|
|
|
|
/* IGB specific: */
|
|
[FWSM] = igb_mac_writereg,
|
|
[SW_FW_SYNC] = igb_mac_writereg,
|
|
[EICR] = igb_set_eicr,
|
|
[EICS] = igb_set_eics,
|
|
[EIAC] = igb_set_eiac,
|
|
[EIAM] = igb_set_eiam,
|
|
[EIMC] = igb_set_eimc,
|
|
[EIMS] = igb_set_eims,
|
|
[IVAR0 ... IVAR0 + 7] = igb_mac_writereg,
|
|
igb_putreg(IVAR_MISC),
|
|
igb_putreg(TSYNCRXCFG),
|
|
[ETQF0 ... ETQF0 + 7] = igb_mac_writereg,
|
|
igb_putreg(VT_CTL),
|
|
[P2VMAILBOX0 ... P2VMAILBOX7] = igb_set_pfmailbox,
|
|
[V2PMAILBOX0 ... V2PMAILBOX7] = igb_set_vfmailbox,
|
|
[MBVFICR] = igb_w1c,
|
|
[VMBMEM0 ... VMBMEM0 + 127] = igb_mac_writereg,
|
|
igb_putreg(MBVFIMR),
|
|
[VFLRE] = igb_w1c,
|
|
igb_putreg(VFRE),
|
|
igb_putreg(VFTE),
|
|
igb_putreg(QDE),
|
|
igb_putreg(DTXSWC),
|
|
igb_putreg(RPLOLR),
|
|
[VLVF0 ... VLVF0 + E1000_VLVF_ARRAY_SIZE - 1] = igb_mac_writereg,
|
|
[VMVIR0 ... VMVIR7] = igb_mac_writereg,
|
|
[VMOLR0 ... VMOLR7] = igb_mac_writereg,
|
|
[UTA ... UTA + E1000_MC_TBL_SIZE - 1] = igb_mac_writereg,
|
|
[PVTCTRL0] = igb_set_vtctrl,
|
|
[PVTCTRL1] = igb_set_vtctrl,
|
|
[PVTCTRL2] = igb_set_vtctrl,
|
|
[PVTCTRL3] = igb_set_vtctrl,
|
|
[PVTCTRL4] = igb_set_vtctrl,
|
|
[PVTCTRL5] = igb_set_vtctrl,
|
|
[PVTCTRL6] = igb_set_vtctrl,
|
|
[PVTCTRL7] = igb_set_vtctrl,
|
|
[PVTEICS0] = igb_set_vteics,
|
|
[PVTEICS1] = igb_set_vteics,
|
|
[PVTEICS2] = igb_set_vteics,
|
|
[PVTEICS3] = igb_set_vteics,
|
|
[PVTEICS4] = igb_set_vteics,
|
|
[PVTEICS5] = igb_set_vteics,
|
|
[PVTEICS6] = igb_set_vteics,
|
|
[PVTEICS7] = igb_set_vteics,
|
|
[PVTEIMS0] = igb_set_vteims,
|
|
[PVTEIMS1] = igb_set_vteims,
|
|
[PVTEIMS2] = igb_set_vteims,
|
|
[PVTEIMS3] = igb_set_vteims,
|
|
[PVTEIMS4] = igb_set_vteims,
|
|
[PVTEIMS5] = igb_set_vteims,
|
|
[PVTEIMS6] = igb_set_vteims,
|
|
[PVTEIMS7] = igb_set_vteims,
|
|
[PVTEIMC0] = igb_set_vteimc,
|
|
[PVTEIMC1] = igb_set_vteimc,
|
|
[PVTEIMC2] = igb_set_vteimc,
|
|
[PVTEIMC3] = igb_set_vteimc,
|
|
[PVTEIMC4] = igb_set_vteimc,
|
|
[PVTEIMC5] = igb_set_vteimc,
|
|
[PVTEIMC6] = igb_set_vteimc,
|
|
[PVTEIMC7] = igb_set_vteimc,
|
|
[PVTEIAC0] = igb_set_vteiac,
|
|
[PVTEIAC1] = igb_set_vteiac,
|
|
[PVTEIAC2] = igb_set_vteiac,
|
|
[PVTEIAC3] = igb_set_vteiac,
|
|
[PVTEIAC4] = igb_set_vteiac,
|
|
[PVTEIAC5] = igb_set_vteiac,
|
|
[PVTEIAC6] = igb_set_vteiac,
|
|
[PVTEIAC7] = igb_set_vteiac,
|
|
[PVTEIAM0] = igb_set_vteiam,
|
|
[PVTEIAM1] = igb_set_vteiam,
|
|
[PVTEIAM2] = igb_set_vteiam,
|
|
[PVTEIAM3] = igb_set_vteiam,
|
|
[PVTEIAM4] = igb_set_vteiam,
|
|
[PVTEIAM5] = igb_set_vteiam,
|
|
[PVTEIAM6] = igb_set_vteiam,
|
|
[PVTEIAM7] = igb_set_vteiam,
|
|
[PVTEICR0] = igb_set_vteicr,
|
|
[PVTEICR1] = igb_set_vteicr,
|
|
[PVTEICR2] = igb_set_vteicr,
|
|
[PVTEICR3] = igb_set_vteicr,
|
|
[PVTEICR4] = igb_set_vteicr,
|
|
[PVTEICR5] = igb_set_vteicr,
|
|
[PVTEICR6] = igb_set_vteicr,
|
|
[PVTEICR7] = igb_set_vteicr,
|
|
[VTIVAR ... VTIVAR + 7] = igb_set_vtivar,
|
|
[VTIVAR_MISC ... VTIVAR_MISC + 7] = igb_mac_writereg
|
|
};
|
|
enum { IGB_NWRITEOPS = ARRAY_SIZE(igb_macreg_writeops) };
|
|
|
|
enum { MAC_ACCESS_PARTIAL = 1 };
|
|
|
|
/*
|
|
* The array below combines alias offsets of the index values for the
|
|
* MAC registers that have aliases, with the indication of not fully
|
|
* implemented registers (lowest bit). This combination is possible
|
|
* because all of the offsets are even.
|
|
*/
|
|
static const uint16_t mac_reg_access[E1000E_MAC_SIZE] = {
|
|
/* Alias index offsets */
|
|
[FCRTL_A] = 0x07fe,
|
|
[RDFH_A] = 0xe904, [RDFT_A] = 0xe904,
|
|
[TDFH_A] = 0xed00, [TDFT_A] = 0xed00,
|
|
[RA_A ... RA_A + 31] = 0x14f0,
|
|
[VFTA_A ... VFTA_A + E1000_VLAN_FILTER_TBL_SIZE - 1] = 0x1400,
|
|
|
|
[RDBAL0_A] = 0x2600,
|
|
[RDBAH0_A] = 0x2600,
|
|
[RDLEN0_A] = 0x2600,
|
|
[SRRCTL0_A] = 0x2600,
|
|
[RDH0_A] = 0x2600,
|
|
[RDT0_A] = 0x2600,
|
|
[RXDCTL0_A] = 0x2600,
|
|
[RXCTL0_A] = 0x2600,
|
|
[RQDPC0_A] = 0x2600,
|
|
[RDBAL1_A] = 0x25D0,
|
|
[RDBAL2_A] = 0x25A0,
|
|
[RDBAL3_A] = 0x2570,
|
|
[RDBAH1_A] = 0x25D0,
|
|
[RDBAH2_A] = 0x25A0,
|
|
[RDBAH3_A] = 0x2570,
|
|
[RDLEN1_A] = 0x25D0,
|
|
[RDLEN2_A] = 0x25A0,
|
|
[RDLEN3_A] = 0x2570,
|
|
[SRRCTL1_A] = 0x25D0,
|
|
[SRRCTL2_A] = 0x25A0,
|
|
[SRRCTL3_A] = 0x2570,
|
|
[RDH1_A] = 0x25D0,
|
|
[RDH2_A] = 0x25A0,
|
|
[RDH3_A] = 0x2570,
|
|
[RDT1_A] = 0x25D0,
|
|
[RDT2_A] = 0x25A0,
|
|
[RDT3_A] = 0x2570,
|
|
[RXDCTL1_A] = 0x25D0,
|
|
[RXDCTL2_A] = 0x25A0,
|
|
[RXDCTL3_A] = 0x2570,
|
|
[RXCTL1_A] = 0x25D0,
|
|
[RXCTL2_A] = 0x25A0,
|
|
[RXCTL3_A] = 0x2570,
|
|
[RQDPC1_A] = 0x25D0,
|
|
[RQDPC2_A] = 0x25A0,
|
|
[RQDPC3_A] = 0x2570,
|
|
[TDBAL0_A] = 0x2A00,
|
|
[TDBAH0_A] = 0x2A00,
|
|
[TDLEN0_A] = 0x2A00,
|
|
[TDH0_A] = 0x2A00,
|
|
[TDT0_A] = 0x2A00,
|
|
[TXCTL0_A] = 0x2A00,
|
|
[TDWBAL0_A] = 0x2A00,
|
|
[TDWBAH0_A] = 0x2A00,
|
|
[TDBAL1_A] = 0x29D0,
|
|
[TDBAL2_A] = 0x29A0,
|
|
[TDBAL3_A] = 0x2970,
|
|
[TDBAH1_A] = 0x29D0,
|
|
[TDBAH2_A] = 0x29A0,
|
|
[TDBAH3_A] = 0x2970,
|
|
[TDLEN1_A] = 0x29D0,
|
|
[TDLEN2_A] = 0x29A0,
|
|
[TDLEN3_A] = 0x2970,
|
|
[TDH1_A] = 0x29D0,
|
|
[TDH2_A] = 0x29A0,
|
|
[TDH3_A] = 0x2970,
|
|
[TDT1_A] = 0x29D0,
|
|
[TDT2_A] = 0x29A0,
|
|
[TDT3_A] = 0x2970,
|
|
[TXDCTL0_A] = 0x2A00,
|
|
[TXDCTL1_A] = 0x29D0,
|
|
[TXDCTL2_A] = 0x29A0,
|
|
[TXDCTL3_A] = 0x2970,
|
|
[TXCTL1_A] = 0x29D0,
|
|
[TXCTL2_A] = 0x29A0,
|
|
[TXCTL3_A] = 0x29D0,
|
|
[TDWBAL1_A] = 0x29D0,
|
|
[TDWBAL2_A] = 0x29A0,
|
|
[TDWBAL3_A] = 0x2970,
|
|
[TDWBAH1_A] = 0x29D0,
|
|
[TDWBAH2_A] = 0x29A0,
|
|
[TDWBAH3_A] = 0x2970,
|
|
|
|
/* Access options */
|
|
[RDFH] = MAC_ACCESS_PARTIAL, [RDFT] = MAC_ACCESS_PARTIAL,
|
|
[RDFHS] = MAC_ACCESS_PARTIAL, [RDFTS] = MAC_ACCESS_PARTIAL,
|
|
[RDFPC] = MAC_ACCESS_PARTIAL,
|
|
[TDFH] = MAC_ACCESS_PARTIAL, [TDFT] = MAC_ACCESS_PARTIAL,
|
|
[TDFHS] = MAC_ACCESS_PARTIAL, [TDFTS] = MAC_ACCESS_PARTIAL,
|
|
[TDFPC] = MAC_ACCESS_PARTIAL, [EECD] = MAC_ACCESS_PARTIAL,
|
|
[FLA] = MAC_ACCESS_PARTIAL,
|
|
[FCAL] = MAC_ACCESS_PARTIAL, [FCAH] = MAC_ACCESS_PARTIAL,
|
|
[FCT] = MAC_ACCESS_PARTIAL, [FCTTV] = MAC_ACCESS_PARTIAL,
|
|
[FCRTV] = MAC_ACCESS_PARTIAL, [FCRTL] = MAC_ACCESS_PARTIAL,
|
|
[FCRTH] = MAC_ACCESS_PARTIAL,
|
|
[MAVTV0 ... MAVTV3] = MAC_ACCESS_PARTIAL
|
|
};
|
|
|
|
void
|
|
igb_core_write(IGBCore *core, hwaddr addr, uint64_t val, unsigned size)
|
|
{
|
|
uint16_t index = igb_get_reg_index_with_offset(mac_reg_access, addr);
|
|
|
|
if (index < IGB_NWRITEOPS && igb_macreg_writeops[index]) {
|
|
if (mac_reg_access[index] & MAC_ACCESS_PARTIAL) {
|
|
trace_e1000e_wrn_regs_write_trivial(index << 2);
|
|
}
|
|
trace_e1000e_core_write(index << 2, size, val);
|
|
igb_macreg_writeops[index](core, index, val);
|
|
} else if (index < IGB_NREADOPS && igb_macreg_readops[index]) {
|
|
trace_e1000e_wrn_regs_write_ro(index << 2, size, val);
|
|
} else {
|
|
trace_e1000e_wrn_regs_write_unknown(index << 2, size, val);
|
|
}
|
|
}
|
|
|
|
uint64_t
|
|
igb_core_read(IGBCore *core, hwaddr addr, unsigned size)
|
|
{
|
|
uint64_t val;
|
|
uint16_t index = igb_get_reg_index_with_offset(mac_reg_access, addr);
|
|
|
|
if (index < IGB_NREADOPS && igb_macreg_readops[index]) {
|
|
if (mac_reg_access[index] & MAC_ACCESS_PARTIAL) {
|
|
trace_e1000e_wrn_regs_read_trivial(index << 2);
|
|
}
|
|
val = igb_macreg_readops[index](core, index);
|
|
trace_e1000e_core_read(index << 2, size, val);
|
|
return val;
|
|
} else {
|
|
trace_e1000e_wrn_regs_read_unknown(index << 2, size);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
igb_autoneg_resume(IGBCore *core)
|
|
{
|
|
if (igb_have_autoneg(core) &&
|
|
!(core->phy[MII_BMSR] & MII_BMSR_AN_COMP)) {
|
|
qemu_get_queue(core->owner_nic)->link_down = false;
|
|
timer_mod(core->autoneg_timer,
|
|
qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 500);
|
|
}
|
|
}
|
|
|
|
void
|
|
igb_core_pci_realize(IGBCore *core,
|
|
const uint16_t *eeprom_templ,
|
|
uint32_t eeprom_size,
|
|
const uint8_t *macaddr)
|
|
{
|
|
int i;
|
|
|
|
core->autoneg_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL,
|
|
igb_autoneg_timer, core);
|
|
igb_intrmgr_pci_realize(core);
|
|
|
|
for (i = 0; i < IGB_NUM_QUEUES; i++) {
|
|
net_tx_pkt_init(&core->tx[i].tx_pkt, E1000E_MAX_TX_FRAGS);
|
|
}
|
|
|
|
net_rx_pkt_init(&core->rx_pkt);
|
|
|
|
e1000x_core_prepare_eeprom(core->eeprom,
|
|
eeprom_templ,
|
|
eeprom_size,
|
|
PCI_DEVICE_GET_CLASS(core->owner)->device_id,
|
|
macaddr);
|
|
igb_update_rx_offloads(core);
|
|
}
|
|
|
|
void
|
|
igb_core_pci_uninit(IGBCore *core)
|
|
{
|
|
int i;
|
|
|
|
timer_free(core->autoneg_timer);
|
|
|
|
igb_intrmgr_pci_unint(core);
|
|
|
|
for (i = 0; i < IGB_NUM_QUEUES; i++) {
|
|
net_tx_pkt_uninit(core->tx[i].tx_pkt);
|
|
}
|
|
|
|
net_rx_pkt_uninit(core->rx_pkt);
|
|
}
|
|
|
|
static const uint16_t
|
|
igb_phy_reg_init[] = {
|
|
[MII_BMCR] = MII_BMCR_SPEED1000 |
|
|
MII_BMCR_FD |
|
|
MII_BMCR_AUTOEN,
|
|
|
|
[MII_BMSR] = MII_BMSR_EXTCAP |
|
|
MII_BMSR_LINK_ST |
|
|
MII_BMSR_AUTONEG |
|
|
MII_BMSR_MFPS |
|
|
MII_BMSR_EXTSTAT |
|
|
MII_BMSR_10T_HD |
|
|
MII_BMSR_10T_FD |
|
|
MII_BMSR_100TX_HD |
|
|
MII_BMSR_100TX_FD,
|
|
|
|
[MII_PHYID1] = IGP03E1000_E_PHY_ID >> 16,
|
|
[MII_PHYID2] = (IGP03E1000_E_PHY_ID & 0xfff0) | 1,
|
|
[MII_ANAR] = MII_ANAR_CSMACD | MII_ANAR_10 |
|
|
MII_ANAR_10FD | MII_ANAR_TX |
|
|
MII_ANAR_TXFD | MII_ANAR_PAUSE |
|
|
MII_ANAR_PAUSE_ASYM,
|
|
[MII_ANLPAR] = MII_ANLPAR_10 | MII_ANLPAR_10FD |
|
|
MII_ANLPAR_TX | MII_ANLPAR_TXFD |
|
|
MII_ANLPAR_T4 | MII_ANLPAR_PAUSE,
|
|
[MII_ANER] = MII_ANER_NP | MII_ANER_NWAY,
|
|
[MII_ANNP] = 0x1 | MII_ANNP_MP,
|
|
[MII_CTRL1000] = MII_CTRL1000_HALF | MII_CTRL1000_FULL |
|
|
MII_CTRL1000_PORT | MII_CTRL1000_MASTER,
|
|
[MII_STAT1000] = MII_STAT1000_HALF | MII_STAT1000_FULL |
|
|
MII_STAT1000_ROK | MII_STAT1000_LOK,
|
|
[MII_EXTSTAT] = MII_EXTSTAT_1000T_HD | MII_EXTSTAT_1000T_FD,
|
|
|
|
[IGP01E1000_PHY_PORT_CONFIG] = BIT(5) | BIT(8),
|
|
[IGP01E1000_PHY_PORT_STATUS] = IGP01E1000_PSSR_SPEED_1000MBPS,
|
|
[IGP02E1000_PHY_POWER_MGMT] = BIT(0) | BIT(3) | IGP02E1000_PM_D3_LPLU |
|
|
IGP01E1000_PSCFR_SMART_SPEED
|
|
};
|
|
|
|
static const uint32_t igb_mac_reg_init[] = {
|
|
[LEDCTL] = 2 | (3 << 8) | BIT(15) | (6 << 16) | (7 << 24),
|
|
[EEMNGCTL] = BIT(31),
|
|
[TXDCTL0] = E1000_TXDCTL_QUEUE_ENABLE,
|
|
[RXDCTL0] = E1000_RXDCTL_QUEUE_ENABLE | (1 << 16),
|
|
[RXDCTL1] = 1 << 16,
|
|
[RXDCTL2] = 1 << 16,
|
|
[RXDCTL3] = 1 << 16,
|
|
[RXDCTL4] = 1 << 16,
|
|
[RXDCTL5] = 1 << 16,
|
|
[RXDCTL6] = 1 << 16,
|
|
[RXDCTL7] = 1 << 16,
|
|
[RXDCTL8] = 1 << 16,
|
|
[RXDCTL9] = 1 << 16,
|
|
[RXDCTL10] = 1 << 16,
|
|
[RXDCTL11] = 1 << 16,
|
|
[RXDCTL12] = 1 << 16,
|
|
[RXDCTL13] = 1 << 16,
|
|
[RXDCTL14] = 1 << 16,
|
|
[RXDCTL15] = 1 << 16,
|
|
[TIPG] = 0x08 | (0x04 << 10) | (0x06 << 20),
|
|
[CTRL] = E1000_CTRL_FD | E1000_CTRL_LRST | E1000_CTRL_SPD_1000 |
|
|
E1000_CTRL_ADVD3WUC,
|
|
[STATUS] = E1000_STATUS_PHYRA | BIT(31),
|
|
[EECD] = E1000_EECD_FWE_DIS | E1000_EECD_PRES |
|
|
(2 << E1000_EECD_SIZE_EX_SHIFT),
|
|
[GCR] = E1000_L0S_ADJUST |
|
|
E1000_GCR_CMPL_TMOUT_RESEND |
|
|
E1000_GCR_CAP_VER2 |
|
|
E1000_L1_ENTRY_LATENCY_MSB |
|
|
E1000_L1_ENTRY_LATENCY_LSB,
|
|
[RXCSUM] = E1000_RXCSUM_IPOFLD | E1000_RXCSUM_TUOFLD,
|
|
[TXPBS] = 0x28,
|
|
[RXPBS] = 0x40,
|
|
[TCTL] = E1000_TCTL_PSP | (0xF << E1000_CT_SHIFT) |
|
|
(0x40 << E1000_COLD_SHIFT) | (0x1 << 26) | (0xA << 28),
|
|
[TCTL_EXT] = 0x40 | (0x42 << 10),
|
|
[DTXCTL] = E1000_DTXCTL_8023LL | E1000_DTXCTL_SPOOF_INT,
|
|
[VET] = ETH_P_VLAN | (ETH_P_VLAN << 16),
|
|
|
|
[V2PMAILBOX0 ... V2PMAILBOX0 + IGB_MAX_VF_FUNCTIONS - 1] = E1000_V2PMAILBOX_RSTI,
|
|
[MBVFIMR] = 0xFF,
|
|
[VFRE] = 0xFF,
|
|
[VFTE] = 0xFF,
|
|
[VMOLR0 ... VMOLR0 + 7] = 0x2600 | E1000_VMOLR_STRCRC,
|
|
[RPLOLR] = E1000_RPLOLR_STRCRC,
|
|
[RLPML] = 0x2600,
|
|
[TXCTL0] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL1] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL2] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL3] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL4] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL5] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL6] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL7] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL8] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL9] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL10] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL11] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL12] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL13] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL14] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
[TXCTL15] = E1000_DCA_TXCTRL_DATA_RRO_EN |
|
|
E1000_DCA_TXCTRL_TX_WB_RO_EN |
|
|
E1000_DCA_TXCTRL_DESC_RRO_EN,
|
|
};
|
|
|
|
static void igb_reset(IGBCore *core, bool sw)
|
|
{
|
|
struct igb_tx *tx;
|
|
int i;
|
|
|
|
timer_del(core->autoneg_timer);
|
|
|
|
igb_intrmgr_reset(core);
|
|
|
|
memset(core->phy, 0, sizeof core->phy);
|
|
memcpy(core->phy, igb_phy_reg_init, sizeof igb_phy_reg_init);
|
|
|
|
for (i = 0; i < E1000E_MAC_SIZE; i++) {
|
|
if (sw &&
|
|
(i == RXPBS || i == TXPBS ||
|
|
(i >= EITR0 && i < EITR0 + IGB_INTR_NUM))) {
|
|
continue;
|
|
}
|
|
|
|
core->mac[i] = i < ARRAY_SIZE(igb_mac_reg_init) ?
|
|
igb_mac_reg_init[i] : 0;
|
|
}
|
|
|
|
if (qemu_get_queue(core->owner_nic)->link_down) {
|
|
igb_link_down(core);
|
|
}
|
|
|
|
e1000x_reset_mac_addr(core->owner_nic, core->mac, core->permanent_mac);
|
|
|
|
for (int vfn = 0; vfn < IGB_MAX_VF_FUNCTIONS; vfn++) {
|
|
/* Set RSTI, so VF can identify a PF reset is in progress */
|
|
core->mac[V2PMAILBOX0 + vfn] |= E1000_V2PMAILBOX_RSTI;
|
|
}
|
|
|
|
for (i = 0; i < ARRAY_SIZE(core->tx); i++) {
|
|
tx = &core->tx[i];
|
|
memset(tx->ctx, 0, sizeof(tx->ctx));
|
|
tx->first = true;
|
|
tx->skip_cp = false;
|
|
}
|
|
}
|
|
|
|
void
|
|
igb_core_reset(IGBCore *core)
|
|
{
|
|
igb_reset(core, false);
|
|
}
|
|
|
|
void igb_core_pre_save(IGBCore *core)
|
|
{
|
|
int i;
|
|
NetClientState *nc = qemu_get_queue(core->owner_nic);
|
|
|
|
/*
|
|
* If link is down and auto-negotiation is supported and ongoing,
|
|
* complete auto-negotiation immediately. This allows us to look
|
|
* at MII_BMSR_AN_COMP to infer link status on load.
|
|
*/
|
|
if (nc->link_down && igb_have_autoneg(core)) {
|
|
core->phy[MII_BMSR] |= MII_BMSR_AN_COMP;
|
|
igb_update_flowctl_status(core);
|
|
}
|
|
|
|
for (i = 0; i < ARRAY_SIZE(core->tx); i++) {
|
|
if (net_tx_pkt_has_fragments(core->tx[i].tx_pkt)) {
|
|
core->tx[i].skip_cp = true;
|
|
}
|
|
}
|
|
}
|
|
|
|
int
|
|
igb_core_post_load(IGBCore *core)
|
|
{
|
|
NetClientState *nc = qemu_get_queue(core->owner_nic);
|
|
|
|
/*
|
|
* nc.link_down can't be migrated, so infer link_down according
|
|
* to link status bit in core.mac[STATUS].
|
|
*/
|
|
nc->link_down = (core->mac[STATUS] & E1000_STATUS_LU) == 0;
|
|
|
|
/*
|
|
* we need to restart intrmgr timers, as an older version of
|
|
* QEMU can have stopped them before migration
|
|
*/
|
|
igb_intrmgr_resume(core);
|
|
igb_autoneg_resume(core);
|
|
|
|
return 0;
|
|
}
|