static void ar5523_tx(struct ieee80211_hw *hw,
struct ieee80211_tx_control *control,
struct sk_buff *skb)
{
struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb);
struct ar5523_tx_data *data = (struct ar5523_tx_data *)
txi->driver_data;
struct ar5523 *ar = hw->priv;
unsigned long flags;
ar5523_dbg(ar, "tx called\n");
if (atomic_inc_return(&ar->tx_nr_total) >= AR5523_TX_DATA_COUNT) {
ar5523_dbg(ar, "tx queue full\n");
ar5523_dbg(ar, "stop queues (tot %d pend %d)\n",
atomic_read(&ar->tx_nr_total),
atomic_read(&ar->tx_nr_pending));
ieee80211_stop_queues(hw);
}
spin_lock_irqsave(&ar->tx_data_list_lock, flags);
list_add_tail(&data->list, &ar->tx_queue_pending);
spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
ieee80211_queue_work(ar->hw, &ar->tx_work);
}
static void ar5523_data_tx_cb(struct urb *urb)
{
struct sk_buff *skb = urb->context;
struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb);
struct ar5523_tx_data *data = (struct ar5523_tx_data *)
txi->driver_data;
struct ar5523 *ar = data->ar;
unsigned long flags;
ar5523_dbg(ar, "data tx urb completed: %d\n", urb->status);
spin_lock_irqsave(&ar->tx_data_list_lock, flags);
list_del(&data->list);
spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
if (urb->status) {
ar5523_dbg(ar, "%s: urb status: %d\n", __func__, urb->status);
ar5523_data_tx_pkt_put(ar);
ieee80211_free_txskb(ar->hw, skb);
} else {
skb_pull(skb, sizeof(struct ar5523_tx_desc) + sizeof(__be32));
ieee80211_tx_status_irqsafe(ar->hw, skb);
}
usb_free_urb(urb);
}
static int ar5523_hwconfig(struct ieee80211_hw *hw, u32 changed)
{
struct ar5523 *ar = hw->priv;
ar5523_dbg(ar, "config called\n");
mutex_lock(&ar->mutex);
if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
ar5523_dbg(ar, "Do channel switch\n");
ar5523_flush_tx(ar);
ar5523_switch_chan(ar);
}
mutex_unlock(&ar->mutex);
return 0;
}
static void ar5523_tx_wd_timer(unsigned long arg)
{
struct ar5523 *ar = (struct ar5523 *) arg;
ar5523_dbg(ar, "TX watchdog timer triggered\n");
ieee80211_queue_work(ar->hw, &ar->tx_wd_work);
}
static void ar5523_configure_filter(struct ieee80211_hw *hw,
unsigned int changed_flags,
unsigned int *total_flags,
u64 multicast)
{
struct ar5523 *ar = hw->priv;
u32 filter = 0;
ar5523_dbg(ar, "configure_filter called\n");
mutex_lock(&ar->mutex);
ar5523_flush_tx(ar);
*total_flags &= AR5523_SUPPORTED_FILTERS;
/* The filters seems strange. UATH_FILTER_RX_BCAST and
* UATH_FILTER_RX_MCAST does not result in those frames being RXed.
* The only way I have found to get [mb]cast frames seems to be
* to set UATH_FILTER_RX_PROM. */
filter |= UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST |
UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON |
UATH_FILTER_RX_PROM;
ar5523_set_rxfilter(ar, 0, UATH_FILTER_OP_INIT);
ar5523_set_rxfilter(ar, filter, UATH_FILTER_OP_SET);
mutex_unlock(&ar->mutex);
}
static void ar5523_flush(struct ieee80211_hw *hw, bool drop)
{
struct ar5523 *ar = hw->priv;
ar5523_dbg(ar, "flush called\n");
ar5523_flush_tx(ar);
}
static void ar5523_remove_interface(struct ieee80211_hw *hw,
struct ieee80211_vif *vif)
{
struct ar5523 *ar = hw->priv;
ar5523_dbg(ar, "remove interface called\n");
ar->vif = NULL;
}
static int ar5523_reset_tx_queues(struct ar5523 *ar)
{
__be32 qid = cpu_to_be32(0);
ar5523_dbg(ar, "resetting Tx queue\n");
return ar5523_cmd_write(ar, WDCMSG_RELEASE_TX_QUEUE,
&qid, sizeof(qid), 0);
}
static void ar5523_tx_work(struct work_struct *work)
{
struct ar5523 *ar = container_of(work, struct ar5523, tx_work);
ar5523_dbg(ar, "%s\n", __func__);
mutex_lock(&ar->mutex);
ar5523_tx_work_locked(ar);
mutex_unlock(&ar->mutex);
}
static int ar5523_set_rxfilter(struct ar5523 *ar, u32 bits, u32 op)
{
struct ar5523_cmd_rx_filter rxfilter;
rxfilter.bits = cpu_to_be32(bits);
rxfilter.op = cpu_to_be32(op);
ar5523_dbg(ar, "setting Rx filter=0x%x flags=0x%x\n", bits, op);
return ar5523_cmd_write(ar, WDCMSG_RX_FILTER, &rxfilter,
sizeof(rxfilter), 0);
}
static int ar5523_add_interface(struct ieee80211_hw *hw,
struct ieee80211_vif *vif)
{
struct ar5523 *ar = hw->priv;
ar5523_dbg(ar, "add interface called\n");
if (ar->vif) {
ar5523_dbg(ar, "invalid add_interface\n");
return -EOPNOTSUPP;
}
switch (vif->type) {
case NL80211_IFTYPE_STATION:
ar->vif = vif;
break;
default:
return -EOPNOTSUPP;
}
return 0;
}
static void ar5523_data_tx_pkt_put(struct ar5523 *ar)
{
atomic_dec(&ar->tx_nr_total);
if (!atomic_dec_return(&ar->tx_nr_pending)) {
del_timer(&ar->tx_wd_timer);
wake_up(&ar->tx_flush_waitq);
}
if (atomic_read(&ar->tx_nr_total) < AR5523_TX_DATA_RESTART_COUNT) {
ar5523_dbg(ar, "restart tx queue\n");
ieee80211_wake_queues(ar->hw);
}
}
static int ar5523_set_ledsteady(struct ar5523 *ar, int lednum, int ledmode)
{
struct ar5523_cmd_ledsteady led;
led.lednum = cpu_to_be32(lednum);
led.ledmode = cpu_to_be32(ledmode);
ar5523_dbg(ar, "set %s led %s (steady)\n",
(lednum == UATH_LED_LINK) ? "link" : "activity",
ledmode ? "on" : "off");
return ar5523_cmd_write(ar, WDCMSG_SET_LED_STEADY, &led, sizeof(led),
0);
}
static int ar5523_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
{
struct ar5523 *ar = hw->priv;
int ret;
ar5523_dbg(ar, "set_rts_threshold called\n");
mutex_lock(&ar->mutex);
ret = ar5523_config(ar, CFG_USER_RTS_THRESHOLD, value);
mutex_unlock(&ar->mutex);
return ret;
}
static void ar5523_rx_refill_work(struct work_struct *work)
{
struct ar5523 *ar = container_of(work, struct ar5523, rx_refill_work);
struct ar5523_rx_data *data;
unsigned long flags;
int error;
ar5523_dbg(ar, "%s\n", __func__);
do {
spin_lock_irqsave(&ar->rx_data_list_lock, flags);
if (!list_empty(&ar->rx_data_free))
data = (struct ar5523_rx_data *) ar->rx_data_free.next;
else
data = NULL;
spin_unlock_irqrestore(&ar->rx_data_list_lock, flags);
if (!data)
goto done;
data->skb = alloc_skb(ar->rxbufsz, GFP_KERNEL);
if (!data->skb) {
ar5523_err(ar, "could not allocate rx skbuff\n");
return;
}
usb_fill_bulk_urb(data->urb, ar->dev,
ar5523_data_rx_pipe(ar->dev), data->skb->data,
ar->rxbufsz, ar5523_data_rx_cb, data);
spin_lock_irqsave(&ar->rx_data_list_lock, flags);
list_move(&data->list, &ar->rx_data_used);
spin_unlock_irqrestore(&ar->rx_data_list_lock, flags);
atomic_dec(&ar->rx_data_free_cnt);
error = usb_submit_urb(data->urb, GFP_KERNEL);
if (error) {
kfree_skb(data->skb);
if (error != -ENODEV)
ar5523_err(ar, "Err sending rx data urb %d\n",
error);
ar5523_rx_data_put(ar, data);
atomic_inc(&ar->rx_data_free_cnt);
return;
}
} while (true);
done:
return;
}
static void ar5523_create_rateset(struct ar5523 *ar,
struct ieee80211_bss_conf *bss_conf,
struct ar5523_cmd_rateset *rs,
bool basic)
{
struct ieee80211_supported_band *band;
struct ieee80211_sta *sta;
int bit, i = 0;
u32 sta_rate_set, basic_rate_set;
sta = ieee80211_find_sta(ar->vif, bss_conf->bssid);
basic_rate_set = bss_conf->basic_rates;
if (!sta) {
ar5523_info(ar, "STA not found. Cannot set rates\n");
sta_rate_set = bss_conf->basic_rates;
} else
sta_rate_set = sta->supp_rates[ar->hw->conf.chandef.chan->band];
ar5523_dbg(ar, "sta rate_set = %08x\n", sta_rate_set);
band = ar->hw->wiphy->bands[ar->hw->conf.chandef.chan->band];
for (bit = 0; bit < band->n_bitrates; bit++) {
BUG_ON(i >= AR5523_MAX_NRATES);
ar5523_dbg(ar, "Considering rate %d : %d\n",
band->bitrates[bit].hw_value, sta_rate_set & 1);
if (sta_rate_set & 1) {
rs->set[i] = band->bitrates[bit].hw_value;
if (basic_rate_set & 1 && basic)
rs->set[i] |= 0x80;
i++;
}
sta_rate_set >>= 1;
basic_rate_set >>= 1;
}
rs->length = i;
}
static void ar5523_bss_info_changed(struct ieee80211_hw *hw,
struct ieee80211_vif *vif,
struct ieee80211_bss_conf *bss,
u32 changed)
{
struct ar5523 *ar = hw->priv;
int error;
ar5523_dbg(ar, "bss_info_changed called\n");
mutex_lock(&ar->mutex);
if (!(changed & BSS_CHANGED_ASSOC))
goto out_unlock;
if (bss->assoc) {
error = ar5523_create_connection(ar, vif, bss);
if (error) {
ar5523_err(ar, "could not create connection\n");
goto out_unlock;
}
error = ar5523_set_basic_rates(ar, bss);
if (error) {
ar5523_err(ar, "could not set negotiated rate set\n");
goto out_unlock;
}
error = ar5523_write_associd(ar, bss);
if (error) {
ar5523_err(ar, "could not set association\n");
goto out_unlock;
}
/* turn link LED on */
ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_ON);
set_bit(AR5523_CONNECTED, &ar->flags);
ieee80211_queue_delayed_work(hw, &ar->stat_work, HZ);
} else {
cancel_delayed_work(&ar->stat_work);
clear_bit(AR5523_CONNECTED, &ar->flags);
ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_OFF);
}
out_unlock:
mutex_unlock(&ar->mutex);
}
static int ar5523_queue_init(struct ar5523 *ar)
{
struct ar5523_cmd_txq_setup qinfo;
ar5523_dbg(ar, "setting up Tx queue\n");
qinfo.qid = cpu_to_be32(0);
qinfo.len = cpu_to_be32(sizeof(qinfo.attr));
qinfo.attr.priority = cpu_to_be32(0); /* XXX */
qinfo.attr.aifs = cpu_to_be32(3);
qinfo.attr.logcwmin = cpu_to_be32(4);
qinfo.attr.logcwmax = cpu_to_be32(10);
qinfo.attr.bursttime = cpu_to_be32(0);
qinfo.attr.mode = cpu_to_be32(0);
qinfo.attr.qflags = cpu_to_be32(1); /* XXX? */
return ar5523_cmd_write(ar, WDCMSG_SETUP_TX_QUEUE, &qinfo,
sizeof(qinfo), 0);
}
static int ar5523_cmd(struct ar5523 *ar, u32 code, const void *idata,
int ilen, void *odata, int olen, int flags)
{
struct ar5523_cmd_hdr *hdr;
struct ar5523_tx_cmd *cmd = &ar->tx_cmd;
int xferlen, error;
/* always bulk-out a multiple of 4 bytes */
xferlen = (sizeof(struct ar5523_cmd_hdr) + ilen + 3) & ~3;
hdr = (struct ar5523_cmd_hdr *)cmd->buf_tx;
memset(hdr, 0, sizeof(struct ar5523_cmd_hdr));
hdr->len = cpu_to_be32(xferlen);
hdr->code = cpu_to_be32(code);
hdr->priv = AR5523_CMD_ID;
if (flags & AR5523_CMD_FLAG_MAGIC)
hdr->magic = cpu_to_be32(1 << 24);
memcpy(hdr + 1, idata, ilen);
cmd->odata = odata;
cmd->olen = olen;
cmd->flags = flags;
ar5523_dbg(ar, "do cmd %02x\n", code);
usb_fill_bulk_urb(cmd->urb_tx, ar->dev, ar5523_cmd_tx_pipe(ar->dev),
cmd->buf_tx, xferlen, ar5523_cmd_tx_cb, cmd);
cmd->urb_tx->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
error = usb_submit_urb(cmd->urb_tx, GFP_KERNEL);
if (error) {
ar5523_err(ar, "could not send command 0x%x, error=%d\n",
code, error);
return error;
}
if (!wait_for_completion_timeout(&cmd->done, 2 * HZ)) {
cmd->odata = NULL;
ar5523_err(ar, "timeout waiting for command %02x reply\n",
code);
cmd->res = -ETIMEDOUT;
}
return cmd->res;
}
/*
* This function is called periodically (every second) when associated to
* query device statistics.
*/
static void ar5523_stat_work(struct work_struct *work)
{
struct ar5523 *ar = container_of(work, struct ar5523, stat_work.work);
int error;
ar5523_dbg(ar, "%s\n", __func__);
mutex_lock(&ar->mutex);
/*
* Send request for statistics asynchronously once a second. This
* seems to be important. Throughput is a lot better if this is done.
*/
error = ar5523_cmd_write(ar, WDCMSG_TARGET_GET_STATS, NULL, 0, 0);
if (error)
ar5523_err(ar, "could not query stats, error %d\n", error);
mutex_unlock(&ar->mutex);
ieee80211_queue_delayed_work(ar->hw, &ar->stat_work, HZ);
}
static int ar5523_set_chan(struct ar5523 *ar)
{
struct ieee80211_conf *conf = &ar->hw->conf;
struct ar5523_cmd_reset reset;
memset(&reset, 0, sizeof(reset));
reset.flags |= cpu_to_be32(UATH_CHAN_2GHZ);
reset.flags |= cpu_to_be32(UATH_CHAN_OFDM);
reset.freq = cpu_to_be32(conf->chandef.chan->center_freq);
reset.maxrdpower = cpu_to_be32(50); /* XXX */
reset.channelchange = cpu_to_be32(1);
reset.keeprccontent = cpu_to_be32(0);
ar5523_dbg(ar, "set chan flags 0x%x freq %d\n",
be32_to_cpu(reset.flags),
conf->chandef.chan->center_freq);
return ar5523_cmd_write(ar, WDCMSG_RESET, &reset, sizeof(reset), 0);
}
static void ar5523_read_reply(struct ar5523 *ar, struct ar5523_cmd_hdr *hdr,
struct ar5523_tx_cmd *cmd)
{
int dlen, olen;
__be32 *rp;
dlen = be32_to_cpu(hdr->len) - sizeof(*hdr);
if (dlen < 0) {
WARN_ON(1);
goto out;
}
ar5523_dbg(ar, "Code = %d len = %d\n", be32_to_cpu(hdr->code) & 0xff,
dlen);
rp = (__be32 *)(hdr + 1);
if (dlen >= sizeof(u32)) {
olen = be32_to_cpu(rp[0]);
dlen -= sizeof(u32);
if (olen == 0) {
/* convention is 0 =>'s one word */
olen = sizeof(u32);
}
} else
olen = 0;
if (cmd->odata) {
if (cmd->olen < olen) {
ar5523_err(ar, "olen to small %d < %d\n",
cmd->olen, olen);
cmd->olen = 0;
cmd->res = -EOVERFLOW;
} else {
cmd->olen = olen;
memcpy(cmd->odata, &rp[1], olen);
cmd->res = 0;
}
}
out:
complete(&cmd->done);
}
static void ar5523_disconnect(struct usb_interface *intf)
{
struct ieee80211_hw *hw = usb_get_intfdata(intf);
struct ar5523 *ar = hw->priv;
ar5523_dbg(ar, "detaching\n");
set_bit(AR5523_USB_DISCONNECTED, &ar->flags);
ieee80211_unregister_hw(hw);
ar5523_cancel_rx_cmd(ar);
ar5523_free_tx_cmd(ar);
ar5523_free_rx_cmd(ar);
ar5523_free_rx_bufs(ar);
destroy_workqueue(ar->wq);
ieee80211_free_hw(hw);
usb_set_intfdata(intf, NULL);
}
static void ar5523_stop(struct ieee80211_hw *hw)
{
struct ar5523 *ar = hw->priv;
ar5523_dbg(ar, "stop called\n");
cancel_delayed_work_sync(&ar->stat_work);
mutex_lock(&ar->mutex);
clear_bit(AR5523_HW_UP, &ar->flags);
ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_OFF);
ar5523_set_ledsteady(ar, UATH_LED_ACTIVITY, UATH_LED_OFF);
ar5523_cmd_write(ar, WDCMSG_TARGET_STOP, NULL, 0, 0);
del_timer_sync(&ar->tx_wd_timer);
cancel_work_sync(&ar->tx_wd_work);
cancel_work_sync(&ar->rx_refill_work);
ar5523_cancel_rx_bufs(ar);
mutex_unlock(&ar->mutex);
}
static int ar5523_get_max_rxsz(struct ar5523 *ar)
{
int error;
__be32 rxsize;
/* Get max rx size */
error = ar5523_get_status(ar, ST_WDC_TRANSPORT_CHUNK_SIZE, &rxsize,
sizeof(rxsize));
if (error != 0) {
ar5523_err(ar, "could not read max RX size\n");
return error;
}
ar->rxbufsz = be32_to_cpu(rxsize);
if (!ar->rxbufsz || ar->rxbufsz > AR5523_SANE_RXBUFSZ) {
ar5523_err(ar, "Bad rxbufsz from device. Using %d instead\n",
AR5523_SANE_RXBUFSZ);
ar->rxbufsz = AR5523_SANE_RXBUFSZ;
}
ar5523_dbg(ar, "Max RX buf size: %d\n", ar->rxbufsz);
return 0;
}
static void ar5523_cmd_rx_cb(struct urb *urb)
{
struct ar5523 *ar = urb->context;
struct ar5523_tx_cmd *cmd = &ar->tx_cmd;
struct ar5523_cmd_hdr *hdr = ar->rx_cmd_buf;
int dlen;
u32 code, hdrlen;
if (urb->status) {
if (urb->status != -ESHUTDOWN)
ar5523_err(ar, "RX USB error %d.\n", urb->status);
goto skip;
}
if (urb->actual_length < sizeof(struct ar5523_cmd_hdr)) {
ar5523_err(ar, "RX USB to short.\n");
goto skip;
}
ar5523_dbg(ar, "%s code %02x priv %d\n", __func__,
be32_to_cpu(hdr->code) & 0xff, hdr->priv);
code = be32_to_cpu(hdr->code);
hdrlen = be32_to_cpu(hdr->len);
switch (code & 0xff) {
default:
/* reply to a read command */
if (hdr->priv != AR5523_CMD_ID) {
ar5523_err(ar, "Unexpected command id: %02x\n",
code & 0xff);
goto skip;
}
ar5523_read_reply(ar, hdr, cmd);
break;
case WDCMSG_DEVICE_AVAIL:
ar5523_dbg(ar, "WDCMSG_DEVICE_AVAIL\n");
cmd->res = 0;
cmd->olen = 0;
complete(&cmd->done);
break;
case WDCMSG_SEND_COMPLETE:
ar5523_dbg(ar, "WDCMSG_SEND_COMPLETE: %d pending\n",
atomic_read(&ar->tx_nr_pending));
if (!test_bit(AR5523_HW_UP, &ar->flags))
ar5523_dbg(ar, "Unexpected WDCMSG_SEND_COMPLETE\n");
else {
mod_timer(&ar->tx_wd_timer,
jiffies + AR5523_TX_WD_TIMEOUT);
ar5523_data_tx_pkt_put(ar);
}
break;
case WDCMSG_TARGET_START:
/* This command returns a bogus id so it needs special
handling */
dlen = hdrlen - sizeof(*hdr);
if (dlen != (int)sizeof(u32)) {
ar5523_err(ar, "Invalid reply to WDCMSG_TARGET_START");
return;
}
memcpy(cmd->odata, hdr + 1, sizeof(u32));
cmd->olen = sizeof(u32);
cmd->res = 0;
complete(&cmd->done);
break;
case WDCMSG_STATS_UPDATE:
ar5523_dbg(ar, "WDCMSG_STATS_UPDATE\n");
break;
}
skip:
ar5523_submit_rx_cmd(ar);
}
static void ar5523_tx_work_locked(struct ar5523 *ar)
{
struct ar5523_tx_data *data;
struct ar5523_tx_desc *desc;
struct ar5523_chunk *chunk;
struct ieee80211_tx_info *txi;
struct urb *urb;
struct sk_buff *skb;
int error = 0, paylen;
u32 txqid;
unsigned long flags;
BUILD_BUG_ON(sizeof(struct ar5523_tx_data) >
IEEE80211_TX_INFO_DRIVER_DATA_SIZE);
ar5523_dbg(ar, "%s\n", __func__);
do {
spin_lock_irqsave(&ar->tx_data_list_lock, flags);
if (!list_empty(&ar->tx_queue_pending)) {
data = (struct ar5523_tx_data *)
ar->tx_queue_pending.next;
list_del(&data->list);
} else
data = NULL;
spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
if (!data)
break;
txi = container_of((void *)data, struct ieee80211_tx_info,
driver_data);
txqid = 0;
skb = container_of((void *)txi, struct sk_buff, cb);
paylen = skb->len;
urb = usb_alloc_urb(0, GFP_KERNEL);
if (!urb) {
ar5523_err(ar, "Failed to allocate TX urb\n");
ieee80211_free_txskb(ar->hw, skb);
continue;
}
data->ar = ar;
data->urb = urb;
desc = (struct ar5523_tx_desc *)skb_push(skb, sizeof(*desc));
chunk = (struct ar5523_chunk *)skb_push(skb, sizeof(*chunk));
chunk->seqnum = 0;
chunk->flags = UATH_CFLAGS_FINAL;
chunk->length = cpu_to_be16(skb->len);
desc->msglen = cpu_to_be32(skb->len);
desc->msgid = AR5523_DATA_ID;
desc->buflen = cpu_to_be32(paylen);
desc->type = cpu_to_be32(WDCMSG_SEND);
desc->flags = cpu_to_be32(UATH_TX_NOTIFY);
if (test_bit(AR5523_CONNECTED, &ar->flags))
desc->connid = cpu_to_be32(AR5523_ID_BSS);
else
desc->connid = cpu_to_be32(AR5523_ID_BROADCAST);
if (txi->flags & IEEE80211_TX_CTL_USE_MINRATE)
txqid |= UATH_TXQID_MINRATE;
desc->txqid = cpu_to_be32(txqid);
urb->transfer_flags = URB_ZERO_PACKET;
usb_fill_bulk_urb(urb, ar->dev, ar5523_data_tx_pipe(ar->dev),
skb->data, skb->len, ar5523_data_tx_cb, skb);
spin_lock_irqsave(&ar->tx_data_list_lock, flags);
list_add_tail(&data->list, &ar->tx_queue_submitted);
spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
mod_timer(&ar->tx_wd_timer, jiffies + AR5523_TX_WD_TIMEOUT);
atomic_inc(&ar->tx_nr_pending);
ar5523_dbg(ar, "TX Frame (%d pending)\n",
atomic_read(&ar->tx_nr_pending));
error = usb_submit_urb(urb, GFP_KERNEL);
if (error) {
ar5523_err(ar, "error %d when submitting tx urb\n",
error);
spin_lock_irqsave(&ar->tx_data_list_lock, flags);
list_del(&data->list);
spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
atomic_dec(&ar->tx_nr_pending);
ar5523_data_tx_pkt_put(ar);
usb_free_urb(urb);
ieee80211_free_txskb(ar->hw, skb);
}
} while (true);
}
/*
* Interface routines to the mac80211 stack.
*/
static int ar5523_start(struct ieee80211_hw *hw)
{
struct ar5523 *ar = hw->priv;
int error;
__be32 val;
ar5523_dbg(ar, "start called\n");
mutex_lock(&ar->mutex);
val = cpu_to_be32(0);
ar5523_cmd_write(ar, WDCMSG_BIND, &val, sizeof(val), 0);
/* set MAC address */
ar5523_config_multi(ar, CFG_MAC_ADDR, &ar->hw->wiphy->perm_addr,
ETH_ALEN);
/* XXX honor net80211 state */
ar5523_config(ar, CFG_RATE_CONTROL_ENABLE, 0x00000001);
ar5523_config(ar, CFG_DIVERSITY_CTL, 0x00000001);
ar5523_config(ar, CFG_ABOLT, 0x0000003f);
ar5523_config(ar, CFG_WME_ENABLED, 0x00000000);
ar5523_config(ar, CFG_SERVICE_TYPE, 1);
ar5523_config(ar, CFG_TP_SCALE, 0x00000000);
ar5523_config(ar, CFG_TPC_HALF_DBM5, 0x0000003c);
ar5523_config(ar, CFG_TPC_HALF_DBM2, 0x0000003c);
ar5523_config(ar, CFG_OVERRD_TX_POWER, 0x00000000);
ar5523_config(ar, CFG_GMODE_PROTECTION, 0x00000000);
ar5523_config(ar, CFG_GMODE_PROTECT_RATE_INDEX, 0x00000003);
ar5523_config(ar, CFG_PROTECTION_TYPE, 0x00000000);
ar5523_config(ar, CFG_MODE_CTS, 0x00000002);
error = ar5523_cmd_read(ar, WDCMSG_TARGET_START, NULL, 0,
&val, sizeof(val), AR5523_CMD_FLAG_MAGIC);
if (error) {
ar5523_dbg(ar, "could not start target, error %d\n", error);
goto err;
}
ar5523_dbg(ar, "WDCMSG_TARGET_START returns handle: 0x%x\n",
be32_to_cpu(val));
ar5523_switch_chan(ar);
val = cpu_to_be32(TARGET_DEVICE_AWAKE);
ar5523_cmd_write(ar, WDCMSG_SET_PWR_MODE, &val, sizeof(val), 0);
/* XXX? check */
ar5523_cmd_write(ar, WDCMSG_RESET_KEY_CACHE, NULL, 0, 0);
set_bit(AR5523_HW_UP, &ar->flags);
queue_work(ar->wq, &ar->rx_refill_work);
/* enable Rx */
ar5523_set_rxfilter(ar, 0, UATH_FILTER_OP_INIT);
ar5523_set_rxfilter(ar,
UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST |
UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON,
UATH_FILTER_OP_SET);
ar5523_set_ledsteady(ar, UATH_LED_ACTIVITY, UATH_LED_ON);
ar5523_dbg(ar, "start OK\n");
err:
mutex_unlock(&ar->mutex);
return error;
}
static void ar5523_data_rx_cb(struct urb *urb)
{
struct ar5523_rx_data *data = urb->context;
struct ar5523 *ar = data->ar;
struct ar5523_rx_desc *desc;
struct ar5523_chunk *chunk;
struct ieee80211_hw *hw = ar->hw;
struct ieee80211_rx_status *rx_status;
u32 rxlen;
int usblen = urb->actual_length;
int hdrlen, pad;
ar5523_dbg(ar, "%s\n", __func__);
/* sync/async unlink faults aren't errors */
if (urb->status) {
if (urb->status != -ESHUTDOWN)
ar5523_err(ar, "%s: USB err: %d\n", __func__,
urb->status);
goto skip;
}
if (usblen < AR5523_MIN_RXBUFSZ) {
ar5523_err(ar, "RX: wrong xfer size (usblen=%d)\n", usblen);
goto skip;
}
chunk = (struct ar5523_chunk *) data->skb->data;
if (((chunk->flags & UATH_CFLAGS_FINAL) == 0) ||
chunk->seqnum != 0) {
ar5523_dbg(ar, "RX: No final flag. s: %d f: %02x l: %d\n",
chunk->seqnum, chunk->flags,
be16_to_cpu(chunk->length));
goto skip;
}
/* Rx descriptor is located at the end, 32-bit aligned */
desc = (struct ar5523_rx_desc *)
(data->skb->data + usblen - sizeof(struct ar5523_rx_desc));
rxlen = be32_to_cpu(desc->len);
if (rxlen > ar->rxbufsz) {
ar5523_dbg(ar, "RX: Bad descriptor (len=%d)\n",
be32_to_cpu(desc->len));
goto skip;
}
if (!rxlen) {
ar5523_dbg(ar, "RX: rxlen is 0\n");
goto skip;
}
if (be32_to_cpu(desc->status) != 0) {
ar5523_dbg(ar, "Bad RX status (0x%x len = %d). Skip\n",
be32_to_cpu(desc->status), be32_to_cpu(desc->len));
goto skip;
}
skb_reserve(data->skb, sizeof(*chunk));
skb_put(data->skb, rxlen - sizeof(struct ar5523_rx_desc));
hdrlen = ieee80211_get_hdrlen_from_skb(data->skb);
if (!IS_ALIGNED(hdrlen, 4)) {
ar5523_dbg(ar, "eek, alignment workaround activated\n");
pad = ALIGN(hdrlen, 4) - hdrlen;
memmove(data->skb->data + pad, data->skb->data, hdrlen);
skb_pull(data->skb, pad);
skb_put(data->skb, pad);
}
rx_status = IEEE80211_SKB_RXCB(data->skb);
memset(rx_status, 0, sizeof(*rx_status));
rx_status->freq = be32_to_cpu(desc->channel);
rx_status->band = hw->conf.chandef.chan->band;
rx_status->signal = -95 + be32_to_cpu(desc->rssi);
ieee80211_rx_irqsafe(hw, data->skb);
data->skb = NULL;
skip:
if (data->skb) {
dev_kfree_skb_irq(data->skb);
data->skb = NULL;
}
ar5523_rx_data_put(ar, data);
if (atomic_inc_return(&ar->rx_data_free_cnt) >=
AR5523_RX_DATA_REFILL_COUNT &&
test_bit(AR5523_HW_UP, &ar->flags))
queue_work(ar->wq, &ar->rx_refill_work);
}