#include "igb_sw.h"
static boolean_t igb_tx(igb_tx_ring_t *, mblk_t *);
static int igb_tx_copy(igb_tx_ring_t *, tx_control_block_t *, mblk_t *,
uint32_t, boolean_t);
static int igb_tx_bind(igb_tx_ring_t *, tx_control_block_t *, mblk_t *,
uint32_t);
static int igb_tx_fill_ring(igb_tx_ring_t *, link_list_t *, tx_context_t *,
size_t);
static void igb_save_desc(tx_control_block_t *, uint64_t, size_t);
static tx_control_block_t *igb_get_free_list(igb_tx_ring_t *);
static int igb_get_tx_context(mblk_t *, tx_context_t *);
static boolean_t igb_check_tx_context(igb_tx_ring_t *, tx_context_t *);
static void igb_fill_tx_context(struct e1000_adv_tx_context_desc *,
tx_context_t *, uint32_t);
mblk_t *
igb_tx_ring_send(void *arg, mblk_t *mp)
{
igb_tx_ring_t *tx_ring = (igb_tx_ring_t *)arg;
igb_t *igb;
ASSERT(tx_ring != NULL);
igb = tx_ring->igb;
if ((igb->igb_state & IGB_SUSPENDED) ||
(igb->igb_state & IGB_ERROR) ||
!(igb->igb_state & IGB_STARTED) ||
igb->link_state != LINK_STATE_UP) {
freemsg(mp);
return (NULL);
}
return ((igb_tx(tx_ring, mp)) ? NULL : mp);
}
static boolean_t
igb_tx(igb_tx_ring_t *tx_ring, mblk_t *mp)
{
igb_t *igb = tx_ring->igb;
tx_type_t current_flag, next_flag;
uint32_t current_len, next_len;
uint32_t desc_total;
size_t mbsize;
int desc_num;
boolean_t copy_done, eop;
mblk_t *current_mp, *next_mp, *nmp;
tx_control_block_t *tcb;
tx_context_t tx_context, *ctx;
link_list_t pending_list;
mblk_t *hdr_new_mp = NULL;
mblk_t *hdr_previous_mp = NULL;
mblk_t *hdr_current_mp = NULL;
uint32_t hdr_frag_len;
uint32_t hdr_len, len;
uint32_t copy_thresh;
copy_thresh = igb->tx_copy_thresh;
mbsize = 0;
for (nmp = mp; nmp != NULL; nmp = nmp->b_cont) {
mbsize += MBLKL(nmp);
}
if (igb->tx_hcksum_enable) {
ctx = &tx_context;
if (igb_get_tx_context(mp, ctx) != TX_CXT_SUCCESS) {
freemsg(mp);
return (B_TRUE);
}
if ((ctx->lso_flag &&
(mbsize > (ctx->mac_hdr_len + IGB_LSO_MAXLEN))) ||
(!ctx->lso_flag &&
(mbsize > (igb->max_frame_size - ETHERFCSL)))) {
freemsg(mp);
igb_log(igb, IGB_LOG_INFO, "igb_tx: packet oversize");
return (B_TRUE);
}
} else {
ctx = NULL;
if (mbsize > (igb->max_frame_size - ETHERFCSL)) {
freemsg(mp);
igb_log(igb, IGB_LOG_INFO, "igb_tx: packet oversize");
return (B_TRUE);
}
}
if (tx_ring->tbd_free < igb->tx_recycle_thresh)
tx_ring->tx_recycle(tx_ring);
if (tx_ring->tbd_free < igb->tx_overload_thresh) {
tx_ring->reschedule = B_TRUE;
IGB_DEBUG_STAT(tx_ring->stat_overload);
return (B_FALSE);
}
if (ctx && ctx->lso_flag) {
hdr_len = ctx->mac_hdr_len + ctx->ip_hdr_len + ctx->l4_hdr_len;
len = MBLKL(mp);
hdr_current_mp = mp;
while (len < hdr_len) {
hdr_previous_mp = hdr_current_mp;
hdr_current_mp = hdr_current_mp->b_cont;
len += MBLKL(hdr_current_mp);
}
if (len == hdr_len)
goto adjust_threshold;
hdr_frag_len = hdr_len - (len - MBLKL(hdr_current_mp));
if ((hdr_current_mp != mp) ||
(P2NPHASE((uintptr_t)hdr_current_mp->b_rptr, igb->page_size)
< hdr_len)) {
hdr_new_mp = allocb(hdr_frag_len, 0);
if (!hdr_new_mp) {
return (B_FALSE);
}
bcopy(hdr_current_mp->b_rptr,
hdr_new_mp->b_rptr, hdr_frag_len);
hdr_new_mp->b_wptr = hdr_new_mp->b_rptr + hdr_frag_len;
hdr_new_mp->b_cont = hdr_current_mp;
if (hdr_previous_mp)
hdr_previous_mp->b_cont = hdr_new_mp;
else
mp = hdr_new_mp;
hdr_current_mp->b_rptr += hdr_frag_len;
}
adjust_threshold:
if (copy_thresh < hdr_len)
copy_thresh = hdr_len;
}
LINK_LIST_INIT(&pending_list);
desc_num = 0;
desc_total = 0;
current_mp = mp;
current_len = MBLKL(current_mp);
current_flag = (current_len <= copy_thresh) ?
USE_COPY : USE_DMA;
copy_done = B_TRUE;
while (current_mp) {
next_mp = current_mp->b_cont;
eop = (next_mp == NULL);
next_len = eop ? 0: MBLKL(next_mp);
if ((current_len == 0) && (copy_done)) {
current_mp = next_mp;
current_len = next_len;
current_flag = (current_len <= copy_thresh) ?
USE_COPY : USE_DMA;
continue;
}
if (copy_done) {
tcb = igb_get_free_list(tx_ring);
if (tcb == NULL) {
IGB_DEBUG_STAT(tx_ring->stat_fail_no_tcb);
goto tx_failure;
}
LIST_PUSH_TAIL(&pending_list, &tcb->link);
}
if (current_flag == USE_COPY) {
ASSERT((tcb->tx_buf.len + current_len) <=
tcb->tx_buf.size);
if (eop) {
next_flag = USE_NONE;
copy_done = B_TRUE;
} else if ((tcb->tx_buf.len + current_len + next_len) >
tcb->tx_buf.size) {
next_flag = (next_len > copy_thresh) ?
USE_DMA: USE_COPY;
copy_done = B_TRUE;
} else if (next_len > copy_thresh) {
next_flag = USE_DMA;
copy_done = B_TRUE;
} else {
next_flag = USE_COPY;
copy_done = B_FALSE;
}
desc_num = igb_tx_copy(tx_ring, tcb, current_mp,
current_len, copy_done);
} else {
next_flag = (next_len > copy_thresh) ?
USE_DMA: USE_COPY;
ASSERT(copy_done == B_TRUE);
desc_num = igb_tx_bind(tx_ring, tcb, current_mp,
current_len);
}
if (desc_num > 0)
desc_total += desc_num;
else if (desc_num < 0)
goto tx_failure;
current_mp = next_mp;
current_len = next_len;
current_flag = next_flag;
}
ASSERT(tcb);
ASSERT(tcb->mp == NULL);
tcb->mp = mp;
if (tx_ring->tbd_free <= (desc_total + 1)) {
tx_ring->tx_recycle(tx_ring);
}
mutex_enter(&tx_ring->tx_lock);
if (tx_ring->tbd_free <= (desc_total + 1)) {
IGB_DEBUG_STAT(tx_ring->stat_fail_no_tbd);
mutex_exit(&tx_ring->tx_lock);
goto tx_failure;
}
desc_num = igb_tx_fill_ring(tx_ring, &pending_list, ctx, mbsize);
ASSERT((desc_num == desc_total) || (desc_num == (desc_total + 1)));
tx_ring->tx_pkts++;
tx_ring->tx_bytes += mbsize;
mutex_exit(&tx_ring->tx_lock);
return (B_TRUE);
tx_failure:
if (hdr_new_mp) {
hdr_new_mp->b_cont = NULL;
freeb(hdr_new_mp);
hdr_current_mp->b_rptr -= hdr_frag_len;
if (hdr_previous_mp)
hdr_previous_mp->b_cont = hdr_current_mp;
else
mp = hdr_current_mp;
}
tcb = (tx_control_block_t *)LIST_GET_HEAD(&pending_list);
while (tcb) {
tcb->mp = NULL;
igb_free_tcb(tcb);
tcb = (tx_control_block_t *)
LIST_GET_NEXT(&pending_list, &tcb->link);
}
igb_put_free_list(tx_ring, &pending_list);
tx_ring->reschedule = B_TRUE;
return (B_FALSE);
}
static int
igb_tx_copy(igb_tx_ring_t *tx_ring, tx_control_block_t *tcb, mblk_t *mp,
uint32_t len, boolean_t copy_done)
{
dma_buffer_t *tx_buf;
uint32_t desc_num;
_NOTE(ARGUNUSED(tx_ring));
tx_buf = &tcb->tx_buf;
if (len > 0) {
bcopy(mp->b_rptr, tx_buf->address + tx_buf->len, len);
tx_buf->len += len;
tcb->frag_num++;
}
desc_num = 0;
if (copy_done) {
DMA_SYNC(tx_buf, DDI_DMA_SYNC_FORDEV);
tcb->tx_type = USE_COPY;
igb_save_desc(tcb, tx_buf->dma_address, tx_buf->len);
desc_num++;
}
return (desc_num);
}
static int
igb_tx_bind(igb_tx_ring_t *tx_ring, tx_control_block_t *tcb, mblk_t *mp,
uint32_t len)
{
int status, i;
ddi_dma_cookie_t dma_cookie;
uint_t ncookies;
int desc_num;
status = ddi_dma_addr_bind_handle(tcb->tx_dma_handle, NULL,
(caddr_t)mp->b_rptr, len,
DDI_DMA_WRITE | DDI_DMA_STREAMING, DDI_DMA_DONTWAIT,
0, &dma_cookie, &ncookies);
if (status != DDI_DMA_MAPPED) {
IGB_DEBUG_STAT(tx_ring->stat_fail_dma_bind);
return (-1);
}
tcb->frag_num++;
tcb->tx_type = USE_DMA;
desc_num = 0;
for (i = ncookies; i > 0; i--) {
igb_save_desc(tcb,
dma_cookie.dmac_laddress,
dma_cookie.dmac_size);
desc_num++;
if (i > 1)
ddi_dma_nextcookie(tcb->tx_dma_handle, &dma_cookie);
}
return (desc_num);
}
static int
igb_get_tx_context(mblk_t *mp, tx_context_t *ctx)
{
uint32_t start;
uint32_t flags;
uint32_t lso_flag;
uint32_t lso_cksum;
uint32_t mss;
uint32_t len;
uint32_t size;
uint32_t offset;
unsigned char *pos;
ushort_t etype;
uint32_t mac_hdr_len;
uint32_t l4_proto;
uint32_t l4_hdr_len;
ASSERT(mp != NULL);
mac_hcksum_get(mp, &start, NULL, NULL, NULL, &flags);
bzero(ctx, sizeof (tx_context_t));
ctx->hcksum_flags = flags;
if (flags == 0)
return (TX_CXT_SUCCESS);
mac_lso_get(mp, &mss, &lso_flag);
ctx->mss = mss;
ctx->lso_flag = (lso_flag == HW_LSO);
etype = 0;
mac_hdr_len = 0;
l4_proto = 0;
size = len = MBLKL(mp);
offset = offsetof(struct ether_header, ether_type);
while (size <= offset) {
mp = mp->b_cont;
ASSERT(mp != NULL);
len = MBLKL(mp);
size += len;
}
pos = mp->b_rptr + offset + len - size;
etype = ntohs(*(ushort_t *)(uintptr_t)pos);
if (etype == ETHERTYPE_VLAN) {
offset = offsetof(struct ether_vlan_header, ether_type);
while (size <= offset) {
mp = mp->b_cont;
ASSERT(mp != NULL);
len = MBLKL(mp);
size += len;
}
pos = mp->b_rptr + offset + len - size;
etype = ntohs(*(ushort_t *)(uintptr_t)pos);
mac_hdr_len = sizeof (struct ether_vlan_header);
} else {
mac_hdr_len = sizeof (struct ether_header);
}
lso_cksum = HCK_PARTIALCKSUM;
ctx->l3_proto = etype;
switch (etype) {
case ETHERTYPE_IP:
offset = mac_hdr_len;
while (size <= offset) {
mp = mp->b_cont;
ASSERT(mp != NULL);
len = MBLKL(mp);
size += len;
}
pos = mp->b_rptr + offset + len - size;
if (ctx->lso_flag) {
*((uint16_t *)(uintptr_t)(pos + offsetof(ipha_t,
ipha_length))) = 0;
lso_cksum |= HCK_IPV4_HDRCKSUM;
}
l4_proto = *(uint8_t *)(pos + offsetof(ipha_t, ipha_protocol));
break;
case ETHERTYPE_IPV6:
if (ctx->lso_flag) {
offset = offsetof(ip6_t, ip6_plen) + mac_hdr_len;
while (size <= offset) {
mp = mp->b_cont;
ASSERT(mp != NULL);
len = MBLKL(mp);
size += len;
}
pos = mp->b_rptr + offset + len - size;
*((uint16_t *)(uintptr_t)(pos)) = 0;
}
offset = offsetof(ip6_t, ip6_nxt) + mac_hdr_len;
while (size <= offset) {
mp = mp->b_cont;
ASSERT(mp != NULL);
len = MBLKL(mp);
size += len;
}
pos = mp->b_rptr + offset + len - size;
l4_proto = *(uint8_t *)pos;
break;
default:
igb_log(NULL, IGB_LOG_INFO, "Ethernet type field error with "
"tx hcksum flag set");
return (TX_CXT_E_ETHER_TYPE);
}
if (ctx->lso_flag) {
if ((ctx->hcksum_flags & lso_cksum) != lso_cksum) {
igb_log(NULL, IGB_LOG_INFO, "igb_tx: h/w "
"checksum flags are not set for LSO, found "
"0x%x, needed bits 0x%x", ctx->hcksum_flags,
lso_cksum);
return (TX_CXT_E_LSO_CSUM);
}
offset = mac_hdr_len + start;
while (size <= offset) {
mp = mp->b_cont;
ASSERT(mp != NULL);
len = MBLKL(mp);
size += len;
}
pos = mp->b_rptr + offset + len - size;
l4_hdr_len = TCP_HDR_LENGTH((tcph_t *)pos);
} else {
l4_hdr_len = 0;
}
ctx->mac_hdr_len = mac_hdr_len;
ctx->ip_hdr_len = start;
ctx->l4_proto = l4_proto;
ctx->l4_hdr_len = l4_hdr_len;
return (TX_CXT_SUCCESS);
}
static boolean_t
igb_check_tx_context(igb_tx_ring_t *tx_ring, tx_context_t *ctx)
{
tx_context_t *last;
if (ctx == NULL)
return (B_FALSE);
last = &tx_ring->tx_context;
if (ctx->hcksum_flags != 0) {
if ((ctx->hcksum_flags != last->hcksum_flags) ||
(ctx->l4_proto != last->l4_proto) ||
(ctx->l3_proto != last->l3_proto) ||
(ctx->lso_flag && ((ctx->mss != last->mss) ||
(ctx->l4_hdr_len != last->l4_hdr_len))) ||
(ctx->ip_hdr_len != last->ip_hdr_len) ||
(ctx->mac_hdr_len != last->mac_hdr_len)) {
return (B_TRUE);
}
}
return (B_FALSE);
}
static void
igb_fill_tx_context(struct e1000_adv_tx_context_desc *ctx_tbd,
tx_context_t *ctx, uint32_t ring_index)
{
ctx_tbd->vlan_macip_lens = ctx->ip_hdr_len;
ctx_tbd->vlan_macip_lens |= ctx->mac_hdr_len <<
E1000_ADVTXD_MACLEN_SHIFT;
ctx_tbd->type_tucmd_mlhl =
E1000_ADVTXD_DCMD_DEXT | E1000_ADVTXD_DTYP_CTXT;
if (ctx->lso_flag || ctx->hcksum_flags & HCK_IPV4_HDRCKSUM) {
if (ctx->l3_proto == ETHERTYPE_IP) {
ctx_tbd->type_tucmd_mlhl |= E1000_ADVTXD_TUCMD_IPV4;
} else {
ctx_tbd->type_tucmd_mlhl |= E1000_ADVTXD_TUCMD_IPV6;
}
}
if (ctx->lso_flag || ctx->hcksum_flags & HCK_PARTIALCKSUM) {
switch (ctx->l4_proto) {
case IPPROTO_TCP:
ctx_tbd->type_tucmd_mlhl |= E1000_ADVTXD_TUCMD_L4T_TCP;
break;
case IPPROTO_UDP:
break;
default:
igb_log(NULL, IGB_LOG_INFO,
"L4 type error with tx hcksum");
break;
}
}
ctx_tbd->seqnum_seed = 0;
ctx_tbd->mss_l4len_idx = ring_index << 4;
if (ctx->lso_flag) {
ctx_tbd->mss_l4len_idx |=
(ctx->l4_hdr_len << E1000_ADVTXD_L4LEN_SHIFT) |
(ctx->mss << E1000_ADVTXD_MSS_SHIFT);
}
}
static int
igb_tx_fill_ring(igb_tx_ring_t *tx_ring, link_list_t *pending_list,
tx_context_t *ctx, size_t mbsize)
{
struct e1000_hw *hw = &tx_ring->igb->hw;
boolean_t load_context;
uint32_t index, tcb_index, desc_num;
union e1000_adv_tx_desc *tbd, *first_tbd;
tx_control_block_t *tcb, *first_tcb;
uint32_t hcksum_flags;
int i;
igb_t *igb = tx_ring->igb;
ASSERT(mutex_owned(&tx_ring->tx_lock));
tbd = NULL;
first_tbd = NULL;
first_tcb = NULL;
desc_num = 0;
hcksum_flags = 0;
load_context = B_FALSE;
index = tx_ring->tbd_tail;
tcb_index = tx_ring->tbd_tail;
if (ctx != NULL) {
hcksum_flags = ctx->hcksum_flags;
load_context = igb_check_tx_context(tx_ring, ctx);
if (load_context) {
tbd = &tx_ring->tbd_ring[index];
igb_fill_tx_context(
(struct e1000_adv_tx_context_desc *)tbd,
ctx, tx_ring->index);
index = NEXT_INDEX(index, 1, tx_ring->ring_size);
desc_num++;
tx_ring->tx_context = *ctx;
}
}
first_tbd = &tx_ring->tbd_ring[index];
tcb = (tx_control_block_t *)LIST_POP_HEAD(pending_list);
first_tcb = tcb;
while (tcb != NULL) {
for (i = 0; i < tcb->desc_num; i++) {
tbd = &tx_ring->tbd_ring[index];
tbd->read.buffer_addr = tcb->desc[i].address;
tbd->read.cmd_type_len = tcb->desc[i].length;
tbd->read.cmd_type_len |= E1000_ADVTXD_DCMD_RS |
E1000_ADVTXD_DCMD_DEXT | E1000_ADVTXD_DTYP_DATA |
E1000_ADVTXD_DCMD_IFCS;
tbd->read.olinfo_status = 0;
index = NEXT_INDEX(index, 1, tx_ring->ring_size);
desc_num++;
}
ASSERT(tx_ring->work_list[tcb_index] == NULL);
tx_ring->work_list[tcb_index] = tcb;
tcb_index = index;
tcb = (tx_control_block_t *)LIST_POP_HEAD(pending_list);
}
if (load_context) {
first_tcb->desc_num++;
}
first_tcb->last_index = PREV_INDEX(index, 1, tx_ring->ring_size);
ASSERT(first_tbd != NULL);
first_tbd->read.cmd_type_len |= E1000_ADVTXD_DCMD_IFCS;
if (ctx != NULL && ctx->lso_flag) {
first_tbd->read.cmd_type_len |= E1000_ADVTXD_DCMD_TSE;
first_tbd->read.olinfo_status |=
(mbsize - ctx->mac_hdr_len - ctx->ip_hdr_len
- ctx->l4_hdr_len) << E1000_ADVTXD_PAYLEN_SHIFT;
} else {
if (hw->mac.type >= e1000_82576) {
first_tbd->read.olinfo_status |=
(mbsize << E1000_ADVTXD_PAYLEN_SHIFT);
}
}
if (hcksum_flags != 0) {
if (hcksum_flags & HCK_IPV4_HDRCKSUM)
first_tbd->read.olinfo_status |=
E1000_TXD_POPTS_IXSM << 8;
if (hcksum_flags & HCK_PARTIALCKSUM)
first_tbd->read.olinfo_status |=
E1000_TXD_POPTS_TXSM << 8;
first_tbd->read.olinfo_status |= tx_ring->index << 4;
}
ASSERT(tbd != NULL);
tbd->read.cmd_type_len |=
E1000_ADVTXD_DCMD_EOP | E1000_ADVTXD_DCMD_RS;
IGB_DEBUG_STAT(tx_ring->stat_pkt_cnt);
DMA_SYNC(&tx_ring->tbd_area, DDI_DMA_SYNC_FORDEV);
i = igb_atomic_reserve(&tx_ring->tbd_free, desc_num);
ASSERT(i >= 0);
tx_ring->tbd_tail = index;
E1000_WRITE_REG(hw, E1000_TDT(tx_ring->index), index);
if (igb_check_acc_handle(igb->osdep.reg_handle) != DDI_FM_OK) {
ddi_fm_service_impact(igb->dip, DDI_SERVICE_DEGRADED);
atomic_or_32(&igb->igb_state, IGB_ERROR);
}
return (desc_num);
}
static void
igb_save_desc(tx_control_block_t *tcb, uint64_t address, size_t length)
{
sw_desc_t *desc;
desc = &tcb->desc[tcb->desc_num];
desc->address = address;
desc->length = length;
tcb->desc_num++;
}
uint32_t
igb_tx_recycle_legacy(igb_tx_ring_t *tx_ring)
{
uint32_t index, last_index, next_index;
int desc_num;
boolean_t desc_done;
tx_control_block_t *tcb;
link_list_t pending_list;
igb_t *igb = tx_ring->igb;
if (mutex_tryenter(&tx_ring->recycle_lock) == 0)
return (0);
ASSERT(tx_ring->tbd_free <= tx_ring->ring_size);
if (tx_ring->tbd_free == tx_ring->ring_size) {
tx_ring->recycle_fail = 0;
tx_ring->stall_watchdog = 0;
mutex_exit(&tx_ring->recycle_lock);
return (0);
}
DMA_SYNC(&tx_ring->tbd_area, DDI_DMA_SYNC_FORKERNEL);
if (igb_check_dma_handle(
tx_ring->tbd_area.dma_handle) != DDI_FM_OK) {
mutex_exit(&tx_ring->recycle_lock);
ddi_fm_service_impact(igb->dip, DDI_SERVICE_DEGRADED);
atomic_or_32(&igb->igb_state, IGB_ERROR);
return (0);
}
LINK_LIST_INIT(&pending_list);
desc_num = 0;
index = tx_ring->tbd_head;
tcb = tx_ring->work_list[index];
ASSERT(tcb != NULL);
while (tcb != NULL) {
last_index = tcb->last_index;
if (last_index == MAX_TX_RING_SIZE)
break;
next_index = NEXT_INDEX(last_index, 1, tx_ring->ring_size);
desc_done = tx_ring->tbd_ring[last_index].wb.status &
E1000_TXD_STAT_DD;
if (desc_done) {
while (tcb != NULL) {
tx_ring->work_list[index] = NULL;
LIST_PUSH_TAIL(&pending_list, &tcb->link);
desc_num += tcb->desc_num;
index = NEXT_INDEX(index, tcb->desc_num,
tx_ring->ring_size);
tcb = tx_ring->work_list[index];
if (index == next_index)
break;
}
} else {
break;
}
}
if (desc_num == 0) {
tx_ring->recycle_fail++;
mutex_exit(&tx_ring->recycle_lock);
return (0);
}
tx_ring->recycle_fail = 0;
tx_ring->stall_watchdog = 0;
tx_ring->tbd_head = index;
atomic_add_32(&tx_ring->tbd_free, desc_num);
mutex_exit(&tx_ring->recycle_lock);
tcb = (tx_control_block_t *)LIST_GET_HEAD(&pending_list);
while (tcb != NULL) {
igb_free_tcb(tcb);
tcb = (tx_control_block_t *)
LIST_GET_NEXT(&pending_list, &tcb->link);
}
igb_put_free_list(tx_ring, &pending_list);
return (desc_num);
}
uint32_t
igb_tx_recycle_head_wb(igb_tx_ring_t *tx_ring)
{
uint32_t index;
uint32_t head_wb;
int desc_num;
tx_control_block_t *tcb;
link_list_t pending_list;
igb_t *igb = tx_ring->igb;
if (mutex_tryenter(&tx_ring->recycle_lock) == 0)
return (0);
ASSERT(tx_ring->tbd_free <= tx_ring->ring_size);
if (tx_ring->tbd_free == tx_ring->ring_size) {
tx_ring->recycle_fail = 0;
tx_ring->stall_watchdog = 0;
mutex_exit(&tx_ring->recycle_lock);
return (0);
}
(void) ddi_dma_sync(tx_ring->tbd_area.dma_handle,
sizeof (union e1000_adv_tx_desc) * tx_ring->ring_size,
sizeof (uint32_t),
DDI_DMA_SYNC_FORKERNEL);
if (igb_check_dma_handle(
tx_ring->tbd_area.dma_handle) != DDI_FM_OK) {
mutex_exit(&tx_ring->recycle_lock);
ddi_fm_service_impact(igb->dip, DDI_SERVICE_DEGRADED);
atomic_or_32(&igb->igb_state, IGB_ERROR);
return (0);
}
LINK_LIST_INIT(&pending_list);
desc_num = 0;
index = tx_ring->tbd_head;
head_wb = *tx_ring->tbd_head_wb;
while (index != head_wb) {
tcb = tx_ring->work_list[index];
ASSERT(tcb != NULL);
if (OFFSET(index, head_wb, tx_ring->ring_size) <
tcb->desc_num) {
break;
}
tx_ring->work_list[index] = NULL;
LIST_PUSH_TAIL(&pending_list, &tcb->link);
index = NEXT_INDEX(index, tcb->desc_num, tx_ring->ring_size);
desc_num += tcb->desc_num;
}
if (desc_num == 0) {
tx_ring->recycle_fail++;
mutex_exit(&tx_ring->recycle_lock);
return (0);
}
tx_ring->recycle_fail = 0;
tx_ring->stall_watchdog = 0;
tx_ring->tbd_head = index;
atomic_add_32(&tx_ring->tbd_free, desc_num);
mutex_exit(&tx_ring->recycle_lock);
tcb = (tx_control_block_t *)LIST_GET_HEAD(&pending_list);
while (tcb) {
igb_free_tcb(tcb);
tcb = (tx_control_block_t *)
LIST_GET_NEXT(&pending_list, &tcb->link);
}
igb_put_free_list(tx_ring, &pending_list);
return (desc_num);
}
void
igb_free_tcb(tx_control_block_t *tcb)
{
switch (tcb->tx_type) {
case USE_COPY:
tcb->tx_buf.len = 0;
break;
case USE_DMA:
(void) ddi_dma_unbind_handle(tcb->tx_dma_handle);
break;
default:
break;
}
if (tcb->mp != NULL) {
freemsg(tcb->mp);
tcb->mp = NULL;
}
tcb->tx_type = USE_NONE;
tcb->last_index = MAX_TX_RING_SIZE;
tcb->frag_num = 0;
tcb->desc_num = 0;
}
static tx_control_block_t *
igb_get_free_list(igb_tx_ring_t *tx_ring)
{
tx_control_block_t *tcb;
if (igb_atomic_reserve(&tx_ring->tcb_free, 1) < 0)
return (NULL);
mutex_enter(&tx_ring->tcb_head_lock);
tcb = tx_ring->free_list[tx_ring->tcb_head];
ASSERT(tcb != NULL);
tx_ring->free_list[tx_ring->tcb_head] = NULL;
tx_ring->tcb_head = NEXT_INDEX(tx_ring->tcb_head, 1,
tx_ring->free_list_size);
mutex_exit(&tx_ring->tcb_head_lock);
return (tcb);
}
void
igb_put_free_list(igb_tx_ring_t *tx_ring, link_list_t *pending_list)
{
uint32_t index;
int tcb_num;
tx_control_block_t *tcb;
mutex_enter(&tx_ring->tcb_tail_lock);
index = tx_ring->tcb_tail;
tcb_num = 0;
tcb = (tx_control_block_t *)LIST_POP_HEAD(pending_list);
while (tcb != NULL) {
ASSERT(tx_ring->free_list[index] == NULL);
tx_ring->free_list[index] = tcb;
tcb_num++;
index = NEXT_INDEX(index, 1, tx_ring->free_list_size);
tcb = (tx_control_block_t *)LIST_POP_HEAD(pending_list);
}
tx_ring->tcb_tail = index;
atomic_add_32(&tx_ring->tcb_free, tcb_num);
mutex_exit(&tx_ring->tcb_tail_lock);
}