Differential D10106 Diff 26666 head/sys/dev/iwn/if_iwn.c

Changeset View

Standalone View

head/sys/dev/iwn/if_iwn.c

Show First 20 Lines • Show All 226 Lines • ▼ Show 20 Lines
#ifdef notyet		#ifdef notyet
static void iwn5000_reset_sched(struct iwn_softc *, int, int);		static void iwn5000_reset_sched(struct iwn_softc *, int, int);
#endif		#endif
static int iwn_tx_data(struct iwn_softc , struct mbuf ,		static int iwn_tx_data(struct iwn_softc , struct mbuf ,
struct ieee80211_node *);		struct ieee80211_node *);
static int iwn_tx_data_raw(struct iwn_softc , struct mbuf ,		static int iwn_tx_data_raw(struct iwn_softc , struct mbuf ,
struct ieee80211_node *,		struct ieee80211_node *,
const struct ieee80211_bpf_params *params);		const struct ieee80211_bpf_params *params);
		static int iwn_tx_cmd(struct iwn_softc , struct mbuf ,
		struct ieee80211_node , struct iwn_tx_ring );
static void iwn_xmit_task(void *arg0, int pending);		static void iwn_xmit_task(void *arg0, int pending);
static int iwn_raw_xmit(struct ieee80211_node , struct mbuf ,		static int iwn_raw_xmit(struct ieee80211_node , struct mbuf ,
const struct ieee80211_bpf_params *);		const struct ieee80211_bpf_params *);
static int iwn_transmit(struct ieee80211com , struct mbuf );		static int iwn_transmit(struct ieee80211com , struct mbuf );
static void iwn_scan_timeout(void *);		static void iwn_scan_timeout(void *);
static void iwn_watchdog(void *);		static void iwn_watchdog(void *);
static int iwn_ioctl(struct ieee80211com , u_long , void );		static int iwn_ioctl(struct ieee80211com , u_long , void );
static void iwn_parent(struct ieee80211com *);		static void iwn_parent(struct ieee80211com *);
▲ Show 20 Lines • Show All 4,144 Lines • ▼ Show 20 Lines	#endif

/* Failed? Start at the end */		/* Failed? Start at the end */
return (IWN_MAX_TX_RETRIES - 1);		return (IWN_MAX_TX_RETRIES - 1);
}		}

static int		static int
iwn_tx_data(struct iwn_softc sc, struct mbuf m, struct ieee80211_node *ni)		iwn_tx_data(struct iwn_softc sc, struct mbuf m, struct ieee80211_node *ni)
{		{
struct iwn_ops *ops = &sc->ops;
const struct ieee80211_txparam *tp = ni->ni_txparms;		const struct ieee80211_txparam *tp = ni->ni_txparms;
struct ieee80211vap *vap = ni->ni_vap;		struct ieee80211vap *vap = ni->ni_vap;
struct ieee80211com *ic = ni->ni_ic;		struct ieee80211com *ic = ni->ni_ic;
struct iwn_node wn = (void )ni;		struct iwn_node wn = (void )ni;
struct iwn_tx_ring *ring;		struct iwn_tx_ring *ring;
struct iwn_tx_desc *desc;
struct iwn_tx_data *data;
struct iwn_tx_cmd *cmd;		struct iwn_tx_cmd *cmd;
struct iwn_cmd_data *tx;		struct iwn_cmd_data *tx;
struct ieee80211_frame *wh;		struct ieee80211_frame *wh;
struct ieee80211_key *k = NULL;		struct ieee80211_key *k = NULL;
struct mbuf *m1;
uint32_t flags;		uint32_t flags;
uint16_t qos;		uint16_t seqno, qos;
u_int hdrlen;
bus_dma_segment_t *seg, segs[IWN_MAX_SCATTER];
uint8_t tid, type;		uint8_t tid, type;
int ac, i, totlen, error, pad, nsegs = 0, rate;		int ac, totlen, rate;

DPRINTF(sc, IWN_DEBUG_TRACE, "->%s begin\n", __func__);		DPRINTF(sc, IWN_DEBUG_TRACE, "->%s begin\n", __func__);

IWN_LOCK_ASSERT(sc);		IWN_LOCK_ASSERT(sc);

wh = mtod(m, struct ieee80211_frame *);		wh = mtod(m, struct ieee80211_frame *);
hdrlen = ieee80211_anyhdrsize(wh);
type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;		type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;

/* Select EDCA Access Category and TX ring for this frame. */		/* Select EDCA Access Category and TX ring for this frame. */
if (IEEE80211_QOS_HAS_SEQ(wh)) {		if (IEEE80211_QOS_HAS_SEQ(wh)) {
qos = ((const struct ieee80211_qosframe *)wh)->i_qos[0];		qos = ((const struct ieee80211_qosframe *)wh)->i_qos[0];
tid = qos & IEEE80211_QOS_TID;		tid = qos & IEEE80211_QOS_TID;
} else {		} else {
qos = 0;		qos = 0;
tid = 0;		tid = 0;
}		}
ac = M_WME_GETAC(m);

		/* Choose a TX rate index. */
		if (type == IEEE80211_FC0_TYPE_MGT \|\|
		type == IEEE80211_FC0_TYPE_CTL \|\|
		(m->m_flags & M_EAPOL) != 0)
		rate = tp->mgmtrate;
		else if (IEEE80211_IS_MULTICAST(wh->i_addr1))
		rate = tp->mcastrate;
		else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE)
		rate = tp->ucastrate;
		else {
		/* XXX pass pktlen */
		(void) ieee80211_ratectl_rate(ni, NULL, 0);
		rate = ni->ni_txrate;
		}

/*		/*
* XXX TODO: Group addressed frames aren't aggregated and must		* XXX TODO: Group addressed frames aren't aggregated and must
* go to the normal non-aggregation queue, and have a NONQOS TID		* go to the normal non-aggregation queue, and have a NONQOS TID
* assigned from net80211.		* assigned from net80211.
*/		*/

		ac = M_WME_GETAC(m);
		seqno = ni->ni_txseqs[tid];
if (m->m_flags & M_AMPDU_MPDU) {		if (m->m_flags & M_AMPDU_MPDU) {
uint16_t seqno;
struct ieee80211_tx_ampdu *tap = &ni->ni_tx_ampdu[ac];		struct ieee80211_tx_ampdu *tap = &ni->ni_tx_ampdu[ac];

if (!IEEE80211_AMPDU_RUNNING(tap)) {		if (!IEEE80211_AMPDU_RUNNING(tap)) {
return EINVAL;		return (EINVAL);
}		}

/*		/*
* Queue this frame to the hardware ring that we've		* Queue this frame to the hardware ring that we've
* negotiated AMPDU TX on.		* negotiated AMPDU TX on.
*		*
* Note that the sequence number must match the TX slot		* Note that the sequence number must match the TX slot
* being used!		* being used!
*/		*/
ac = (int )tap->txa_private;		ac = (int )tap->txa_private;
seqno = ni->ni_txseqs[tid];
(uint16_t )wh->i_seq =		(uint16_t )wh->i_seq =
htole16(seqno << IEEE80211_SEQ_SEQ_SHIFT);		htole16(seqno << IEEE80211_SEQ_SEQ_SHIFT);
ring = &sc->txq[ac];
if ((seqno % 256) != ring->cur) {
device_printf(sc->sc_dev,
"%s: m=%p: seqno (%d) (%d) != ring index (%d) !\n",
__func__,
m,
seqno,
seqno % 256,
ring->cur);
}
ni->ni_txseqs[tid]++;		ni->ni_txseqs[tid]++;
}		}
ring = &sc->txq[ac];
desc = &ring->desc[ring->cur];
data = &ring->data[ring->cur];

/* Choose a TX rate index. */
if (type == IEEE80211_FC0_TYPE_MGT \|\|
type == IEEE80211_FC0_TYPE_CTL \|\|
(m->m_flags & M_EAPOL) != 0)
rate = tp->mgmtrate;
else if (IEEE80211_IS_MULTICAST(wh->i_addr1))
rate = tp->mcastrate;
else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE)
rate = tp->ucastrate;
else {
/* XXX pass pktlen */
(void) ieee80211_ratectl_rate(ni, NULL, 0);
rate = ni->ni_txrate;
}

/* Encrypt the frame if need be. */		/* Encrypt the frame if need be. */
if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {		if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {
/* Retrieve key for TX. */		/* Retrieve key for TX. */
k = ieee80211_crypto_encap(ni, m);		k = ieee80211_crypto_encap(ni, m);
if (k == NULL) {		if (k == NULL) {
return ENOBUFS;		return ENOBUFS;
}		}
/* 802.11 header may have moved. */		/* 802.11 header may have moved. */
wh = mtod(m, struct ieee80211_frame *);		wh = mtod(m, struct ieee80211_frame *);
}		}
totlen = m->m_pkthdr.len;		totlen = m->m_pkthdr.len;

if (ieee80211_radiotap_active_vap(vap)) {		if (ieee80211_radiotap_active_vap(vap)) {
struct iwn_tx_radiotap_header *tap = &sc->sc_txtap;		struct iwn_tx_radiotap_header *tap = &sc->sc_txtap;

tap->wt_flags = 0;		tap->wt_flags = 0;
tap->wt_rate = rate;		tap->wt_rate = rate;
if (k != NULL)		if (k != NULL)
tap->wt_flags \|= IEEE80211_RADIOTAP_F_WEP;		tap->wt_flags \|= IEEE80211_RADIOTAP_F_WEP;

ieee80211_radiotap_tx(vap, m);		ieee80211_radiotap_tx(vap, m);
}		}

/* Prepare TX firmware command. */
cmd = &ring->cmd[ring->cur];
cmd->code = IWN_CMD_TX_DATA;
cmd->flags = 0;
cmd->qid = ring->qid;
cmd->idx = ring->cur;

tx = (struct iwn_cmd_data *)cmd->data;
/* NB: No need to clear tx, all fields are reinitialized here. */
tx->scratch = 0; /* clear "scratch" area */

flags = 0;		flags = 0;
if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {		if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
/* Unicast frame, check if an ACK is expected. */		/* Unicast frame, check if an ACK is expected. */
if (!qos \|\| (qos & IEEE80211_QOS_ACKPOLICY) !=		if (!qos \|\| (qos & IEEE80211_QOS_ACKPOLICY) !=
IEEE80211_QOS_ACKPOLICY_NOACK)		IEEE80211_QOS_ACKPOLICY_NOACK)
flags \|= IWN_TX_NEED_ACK;		flags \|= IWN_TX_NEED_ACK;
}		}
if ((wh->i_fc[0] &		if ((wh->i_fc[0] &
Show All 26 Lines	if (flags & (IWN_TX_NEED_RTS \| IWN_TX_NEED_CTS)) {
/* 5000 autoselects RTS/CTS or CTS-to-self. */		/* 5000 autoselects RTS/CTS or CTS-to-self. */
flags &= ~(IWN_TX_NEED_RTS \| IWN_TX_NEED_CTS);		flags &= ~(IWN_TX_NEED_RTS \| IWN_TX_NEED_CTS);
flags \|= IWN_TX_NEED_PROTECTION;		flags \|= IWN_TX_NEED_PROTECTION;
} else		} else
flags \|= IWN_TX_FULL_TXOP;		flags \|= IWN_TX_FULL_TXOP;
}		}
}		}

		ring = &sc->txq[ac];
		if ((m->m_flags & M_AMPDU_MPDU) != 0 &&
		(seqno % 256) != ring->cur) {
		device_printf(sc->sc_dev,
		"%s: m=%p: seqno (%d) (%d) != ring index (%d) !\n",
		__func__,
		m,
		seqno,
		seqno % 256,
		ring->cur);
		}

		/* Prepare TX firmware command. */
		cmd = &ring->cmd[ring->cur];
		tx = (struct iwn_cmd_data *)cmd->data;

		/* NB: No need to clear tx, all fields are reinitialized here. */
		tx->scratch = 0; /* clear "scratch" area */

if (IEEE80211_IS_MULTICAST(wh->i_addr1) \|\|		if (IEEE80211_IS_MULTICAST(wh->i_addr1) \|\|
type != IEEE80211_FC0_TYPE_DATA)		type != IEEE80211_FC0_TYPE_DATA)
tx->id = sc->broadcast_id;		tx->id = sc->broadcast_id;
else		else
tx->id = wn->id;		tx->id = wn->id;

if (type == IEEE80211_FC0_TYPE_MGT) {		if (type == IEEE80211_FC0_TYPE_MGT) {
uint8_t subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;		uint8_t subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;

/* Tell HW to set timestamp in probe responses. */		/* Tell HW to set timestamp in probe responses. */
if (subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)		if (subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)
flags \|= IWN_TX_INSERT_TSTAMP;		flags \|= IWN_TX_INSERT_TSTAMP;
if (subtype == IEEE80211_FC0_SUBTYPE_ASSOC_REQ \|\|		if (subtype == IEEE80211_FC0_SUBTYPE_ASSOC_REQ \|\|
subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ)		subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ)
tx->timeout = htole16(3);		tx->timeout = htole16(3);
else		else
tx->timeout = htole16(2);		tx->timeout = htole16(2);
} else		} else
tx->timeout = htole16(0);		tx->timeout = htole16(0);

if (hdrlen & 3) {
/* First segment length must be a multiple of 4. */
flags \|= IWN_TX_NEED_PADDING;
pad = 4 - (hdrlen & 3);
} else
pad = 0;

tx->len = htole16(totlen);
tx->tid = tid;
tx->rts_ntries = 60;
tx->data_ntries = 15;
tx->lifetime = htole32(IWN_LIFETIME_INFINITE);
tx->rate = iwn_rate_to_plcp(sc, ni, rate);
if (tx->id == sc->broadcast_id) {		if (tx->id == sc->broadcast_id) {
/* Group or management frame. */		/* Group or management frame. */
tx->linkq = 0;		tx->linkq = 0;
} else {		} else {
tx->linkq = iwn_tx_rate_to_linkq_offset(sc, ni, rate);		tx->linkq = iwn_tx_rate_to_linkq_offset(sc, ni, rate);
flags \|= IWN_TX_LINKQ; /* enable MRR */		flags \|= IWN_TX_LINKQ; /* enable MRR */
}		}

/* Set physical address of "scratch area". */		tx->tid = tid;
tx->loaddr = htole32(IWN_LOADDR(data->scratch_paddr));		tx->rts_ntries = 60;
tx->hiaddr = IWN_HIADDR(data->scratch_paddr);		tx->data_ntries = 15;
		tx->lifetime = htole32(IWN_LIFETIME_INFINITE);
/* Copy 802.11 header in TX command. */		tx->rate = iwn_rate_to_plcp(sc, ni, rate);
memcpy((uint8_t *)(tx + 1), wh, hdrlen);

/* Trim 802.11 header. */
m_adj(m, hdrlen);
tx->security = 0;		tx->security = 0;
tx->flags = htole32(flags);		tx->flags = htole32(flags);

error = bus_dmamap_load_mbuf_sg(ring->data_dmat, data->map, m, segs,		return (iwn_tx_cmd(sc, m, ni, ring));
&nsegs, BUS_DMA_NOWAIT);
if (error != 0) {
if (error != EFBIG) {
device_printf(sc->sc_dev,
"%s: can't map mbuf (error %d)\n", __func__, error);
return error;
}		}
/* Too many DMA segments, linearize mbuf. */
m1 = m_collapse(m, M_NOWAIT, IWN_MAX_SCATTER - 1);
if (m1 == NULL) {
device_printf(sc->sc_dev,
"%s: could not defrag mbuf\n", __func__);
return ENOBUFS;
}
m = m1;

error = bus_dmamap_load_mbuf_sg(ring->data_dmat, data->map, m,
segs, &nsegs, BUS_DMA_NOWAIT);
if (error != 0) {
device_printf(sc->sc_dev,
"%s: can't map mbuf (error %d)\n", __func__, error);
return error;
}
}

data->m = m;
data->ni = ni;

DPRINTF(sc, IWN_DEBUG_XMIT,
"%s: qid %d idx %d len %d nsegs %d flags 0x%08x rate 0x%04x plcp 0x%08x\n",
__func__,
ring->qid,
ring->cur,
m->m_pkthdr.len,
nsegs,
flags,
rate,
tx->rate);

/* Fill TX descriptor. */
desc->nsegs = 1;
if (m->m_len != 0)
desc->nsegs += nsegs;
/* First DMA segment is used by the TX command. */
desc->segs[0].addr = htole32(IWN_LOADDR(data->cmd_paddr));
desc->segs[0].len = htole16(IWN_HIADDR(data->cmd_paddr) \|
(4 + sizeof (*tx) + hdrlen + pad) << 4);
/* Other DMA segments are for data payload. */
seg = &segs[0];
for (i = 1; i <= nsegs; i++) {
desc->segs[i].addr = htole32(IWN_LOADDR(seg->ds_addr));
desc->segs[i].len = htole16(IWN_HIADDR(seg->ds_addr) \|
seg->ds_len << 4);
seg++;
}

bus_dmamap_sync(ring->data_dmat, data->map, BUS_DMASYNC_PREWRITE);
bus_dmamap_sync(ring->cmd_dma.tag, ring->cmd_dma.map,
BUS_DMASYNC_PREWRITE);
bus_dmamap_sync(ring->desc_dma.tag, ring->desc_dma.map,
BUS_DMASYNC_PREWRITE);

/* Update TX scheduler. */
if (ring->qid >= sc->firstaggqueue)
ops->update_sched(sc, ring->qid, ring->cur, tx->id, totlen);

/* Kick TX ring. */
ring->cur = (ring->cur + 1) % IWN_TX_RING_COUNT;
IWN_WRITE(sc, IWN_HBUS_TARG_WRPTR, ring->qid << 8 \| ring->cur);

/* Mark TX ring as full if we reach a certain threshold. */
if (++ring->queued > IWN_TX_RING_HIMARK)
sc->qfullmsk \|= 1 << ring->qid;

DPRINTF(sc, IWN_DEBUG_TRACE, "->%s: end\n",__func__);

return 0;
}

static int		static int
iwn_tx_data_raw(struct iwn_softc sc, struct mbuf m,		iwn_tx_data_raw(struct iwn_softc sc, struct mbuf m,
struct ieee80211_node ni, const struct ieee80211_bpf_params params)		struct ieee80211_node ni, const struct ieee80211_bpf_params params)
{		{
struct iwn_ops *ops = &sc->ops;
struct ieee80211vap *vap = ni->ni_vap;		struct ieee80211vap *vap = ni->ni_vap;
struct iwn_tx_cmd *cmd;		struct iwn_tx_cmd *cmd;
struct iwn_cmd_data *tx;		struct iwn_cmd_data *tx;
struct ieee80211_frame *wh;		struct ieee80211_frame *wh;
struct iwn_tx_ring *ring;		struct iwn_tx_ring *ring;
struct iwn_tx_desc *desc;
struct iwn_tx_data *data;
struct mbuf *m1;
bus_dma_segment_t *seg, segs[IWN_MAX_SCATTER];
uint32_t flags;		uint32_t flags;
u_int hdrlen;		int ac, rate;
int ac, totlen, error, pad, nsegs = 0, i, rate;
uint8_t type;		uint8_t type;

DPRINTF(sc, IWN_DEBUG_TRACE, "->%s begin\n", __func__);		DPRINTF(sc, IWN_DEBUG_TRACE, "->%s begin\n", __func__);

IWN_LOCK_ASSERT(sc);		IWN_LOCK_ASSERT(sc);

wh = mtod(m, struct ieee80211_frame *);		wh = mtod(m, struct ieee80211_frame *);
hdrlen = ieee80211_anyhdrsize(wh);
type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;		type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;

ac = params->ibp_pri & 3;		ac = params->ibp_pri & 3;

ring = &sc->txq[ac];
desc = &ring->desc[ring->cur];
data = &ring->data[ring->cur];

/* Choose a TX rate. */		/* Choose a TX rate. */
rate = params->ibp_rate0;		rate = params->ibp_rate0;
totlen = m->m_pkthdr.len;

/* Prepare TX firmware command. */
cmd = &ring->cmd[ring->cur];
cmd->code = IWN_CMD_TX_DATA;
cmd->flags = 0;
cmd->qid = ring->qid;
cmd->idx = ring->cur;

tx = (struct iwn_cmd_data *)cmd->data;
/* NB: No need to clear tx, all fields are reinitialized here. */
tx->scratch = 0; /* clear "scratch" area */

flags = 0;		flags = 0;
if ((params->ibp_flags & IEEE80211_BPF_NOACK) == 0)		if ((params->ibp_flags & IEEE80211_BPF_NOACK) == 0)
flags \|= IWN_TX_NEED_ACK;		flags \|= IWN_TX_NEED_ACK;
if (params->ibp_flags & IEEE80211_BPF_RTS) {		if (params->ibp_flags & IEEE80211_BPF_RTS) {
if (sc->hw_type != IWN_HW_REV_TYPE_4965) {		if (sc->hw_type != IWN_HW_REV_TYPE_4965) {
/* 5000 autoselects RTS/CTS or CTS-to-self. */		/* 5000 autoselects RTS/CTS or CTS-to-self. */
flags &= ~IWN_TX_NEED_RTS;		flags &= ~IWN_TX_NEED_RTS;
flags \|= IWN_TX_NEED_PROTECTION;		flags \|= IWN_TX_NEED_PROTECTION;
} else		} else
flags \|= IWN_TX_NEED_RTS \| IWN_TX_FULL_TXOP;		flags \|= IWN_TX_NEED_RTS \| IWN_TX_FULL_TXOP;
}		}
if (params->ibp_flags & IEEE80211_BPF_CTS) {		if (params->ibp_flags & IEEE80211_BPF_CTS) {
if (sc->hw_type != IWN_HW_REV_TYPE_4965) {		if (sc->hw_type != IWN_HW_REV_TYPE_4965) {
/* 5000 autoselects RTS/CTS or CTS-to-self. */		/* 5000 autoselects RTS/CTS or CTS-to-self. */
flags &= ~IWN_TX_NEED_CTS;		flags &= ~IWN_TX_NEED_CTS;
flags \|= IWN_TX_NEED_PROTECTION;		flags \|= IWN_TX_NEED_PROTECTION;
} else		} else
flags \|= IWN_TX_NEED_CTS \| IWN_TX_FULL_TXOP;		flags \|= IWN_TX_NEED_CTS \| IWN_TX_FULL_TXOP;
}		}

		if (ieee80211_radiotap_active_vap(vap)) {
		struct iwn_tx_radiotap_header *tap = &sc->sc_txtap;

		tap->wt_flags = 0;
		tap->wt_rate = rate;

		ieee80211_radiotap_tx(vap, m);
		}

		ring = &sc->txq[ac];
		cmd = &ring->cmd[ring->cur];

		tx = (struct iwn_cmd_data *)cmd->data;
		/* NB: No need to clear tx, all fields are reinitialized here. */
		tx->scratch = 0; /* clear "scratch" area */

if (type == IEEE80211_FC0_TYPE_MGT) {		if (type == IEEE80211_FC0_TYPE_MGT) {
uint8_t subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;		uint8_t subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;

/* Tell HW to set timestamp in probe responses. */		/* Tell HW to set timestamp in probe responses. */
if (subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)		if (subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)
flags \|= IWN_TX_INSERT_TSTAMP;		flags \|= IWN_TX_INSERT_TSTAMP;

if (subtype == IEEE80211_FC0_SUBTYPE_ASSOC_REQ \|\|		if (subtype == IEEE80211_FC0_SUBTYPE_ASSOC_REQ \|\|
subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ)		subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ)
tx->timeout = htole16(3);		tx->timeout = htole16(3);
else		else
tx->timeout = htole16(2);		tx->timeout = htole16(2);
} else		} else
tx->timeout = htole16(0);		tx->timeout = htole16(0);

if (hdrlen & 3) {
/* First segment length must be a multiple of 4. */
flags \|= IWN_TX_NEED_PADDING;
pad = 4 - (hdrlen & 3);
} else
pad = 0;

if (ieee80211_radiotap_active_vap(vap)) {
struct iwn_tx_radiotap_header *tap = &sc->sc_txtap;

tap->wt_flags = 0;
tap->wt_rate = rate;

ieee80211_radiotap_tx(vap, m);
}

tx->len = htole16(totlen);
tx->tid = 0;		tx->tid = 0;
tx->id = sc->broadcast_id;		tx->id = sc->broadcast_id;
tx->rts_ntries = params->ibp_try1;		tx->rts_ntries = params->ibp_try1;
tx->data_ntries = params->ibp_try0;		tx->data_ntries = params->ibp_try0;
tx->lifetime = htole32(IWN_LIFETIME_INFINITE);		tx->lifetime = htole32(IWN_LIFETIME_INFINITE);
tx->rate = iwn_rate_to_plcp(sc, ni, rate);		tx->rate = iwn_rate_to_plcp(sc, ni, rate);
		tx->security = 0;
		tx->flags = htole32(flags);

/* Group or management frame. */		/* Group or management frame. */
tx->linkq = 0;		tx->linkq = 0;

		return (iwn_tx_cmd(sc, m, ni, ring));
		}

		static int
		iwn_tx_cmd(struct iwn_softc sc, struct mbuf m, struct ieee80211_node *ni,
		struct iwn_tx_ring *ring)
		{
		struct iwn_ops *ops = &sc->ops;
		struct iwn_tx_cmd *cmd;
		struct iwn_cmd_data *tx;
		struct ieee80211_frame *wh;
		struct iwn_tx_desc *desc;
		struct iwn_tx_data *data;
		bus_dma_segment_t *seg, segs[IWN_MAX_SCATTER];
		struct mbuf *m1;
		u_int hdrlen;
		int totlen, error, pad, nsegs = 0, i;

		wh = mtod(m, struct ieee80211_frame *);
		hdrlen = ieee80211_anyhdrsize(wh);
		totlen = m->m_pkthdr.len;

		desc = &ring->desc[ring->cur];
		data = &ring->data[ring->cur];

		/* Prepare TX firmware command. */
		cmd = &ring->cmd[ring->cur];
		cmd->code = IWN_CMD_TX_DATA;
		cmd->flags = 0;
		cmd->qid = ring->qid;
		cmd->idx = ring->cur;

		tx = (struct iwn_cmd_data *)cmd->data;
		tx->len = htole16(totlen);

/* Set physical address of "scratch area". */		/* Set physical address of "scratch area". */
tx->loaddr = htole32(IWN_LOADDR(data->scratch_paddr));		tx->loaddr = htole32(IWN_LOADDR(data->scratch_paddr));
tx->hiaddr = IWN_HIADDR(data->scratch_paddr);		tx->hiaddr = IWN_HIADDR(data->scratch_paddr);
		if (hdrlen & 3) {
		/* First segment length must be a multiple of 4. */
		tx->flags \|= htole32(IWN_TX_NEED_PADDING);
		pad = 4 - (hdrlen & 3);
		} else
		pad = 0;

/* Copy 802.11 header in TX command. */		/* Copy 802.11 header in TX command. */
memcpy((uint8_t *)(tx + 1), wh, hdrlen);		memcpy((uint8_t *)(tx + 1), wh, hdrlen);

/* Trim 802.11 header. */		/* Trim 802.11 header. */
m_adj(m, hdrlen);		m_adj(m, hdrlen);
tx->security = 0;
tx->flags = htole32(flags);

error = bus_dmamap_load_mbuf_sg(ring->data_dmat, data->map, m, segs,		error = bus_dmamap_load_mbuf_sg(ring->data_dmat, data->map, m, segs,
&nsegs, BUS_DMA_NOWAIT);		&nsegs, BUS_DMA_NOWAIT);
if (error != 0) {		if (error != 0) {
if (error != EFBIG) {		if (error != EFBIG) {
device_printf(sc->sc_dev,		device_printf(sc->sc_dev,
"%s: can't map mbuf (error %d)\n", __func__, error);		"%s: can't map mbuf (error %d)\n", __func__, error);
return error;		return error;
Show All 14 Lines	if (error != 0) {
"%s: can't map mbuf (error %d)\n", __func__, error);		"%s: can't map mbuf (error %d)\n", __func__, error);
return error;		return error;
}		}
}		}

data->m = m;		data->m = m;
data->ni = ni;		data->ni = ni;

DPRINTF(sc, IWN_DEBUG_XMIT, "%s: qid %d idx %d len %d nsegs %d\n",		DPRINTF(sc, IWN_DEBUG_XMIT, "%s: qid %d idx %d len %d nsegs %d "
__func__, ring->qid, ring->cur, m->m_pkthdr.len, nsegs);		"plcp %d\n",
		__func__, ring->qid, ring->cur, totlen, nsegs, tx->rate);

/* Fill TX descriptor. */		/* Fill TX descriptor. */
desc->nsegs = 1;		desc->nsegs = 1;
if (m->m_len != 0)		if (m->m_len != 0)
desc->nsegs += nsegs;		desc->nsegs += nsegs;
/* First DMA segment is used by the TX command. */		/* First DMA segment is used by the TX command. */
desc->segs[0].addr = htole32(IWN_LOADDR(data->cmd_paddr));		desc->segs[0].addr = htole32(IWN_LOADDR(data->cmd_paddr));
desc->segs[0].len = htole16(IWN_HIADDR(data->cmd_paddr) \|		desc->segs[0].len = htole16(IWN_HIADDR(data->cmd_paddr) \|
▲ Show 20 Lines • Show All 4,284 Lines • Show Last 20 Lines