|
@@ -144,7 +144,6 @@ static struct b43_pio_txqueue *b43_setup_pioqueue_tx(struct b43_wldev *dev,
|
|
|
q = kzalloc(sizeof(*q), GFP_KERNEL);
|
|
|
if (!q)
|
|
|
return NULL;
|
|
|
- spin_lock_init(&q->lock);
|
|
|
q->dev = dev;
|
|
|
q->rev = dev->dev->id.revision;
|
|
|
q->mmio_base = index_to_pioqueue_base(dev, index) +
|
|
@@ -179,7 +178,6 @@ static struct b43_pio_rxqueue *b43_setup_pioqueue_rx(struct b43_wldev *dev,
|
|
|
q = kzalloc(sizeof(*q), GFP_KERNEL);
|
|
|
if (!q)
|
|
|
return NULL;
|
|
|
- spin_lock_init(&q->lock);
|
|
|
q->dev = dev;
|
|
|
q->rev = dev->dev->id.revision;
|
|
|
q->mmio_base = index_to_pioqueue_base(dev, index) +
|
|
@@ -494,7 +492,6 @@ int b43_pio_tx(struct b43_wldev *dev, struct sk_buff *skb)
|
|
|
{
|
|
|
struct b43_pio_txqueue *q;
|
|
|
struct ieee80211_hdr *hdr;
|
|
|
- unsigned long flags;
|
|
|
unsigned int hdrlen, total_len;
|
|
|
int err = 0;
|
|
|
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
|
|
@@ -512,20 +509,18 @@ int b43_pio_tx(struct b43_wldev *dev, struct sk_buff *skb)
|
|
|
q = select_queue_by_priority(dev, skb_get_queue_mapping(skb));
|
|
|
}
|
|
|
|
|
|
- spin_lock_irqsave(&q->lock, flags);
|
|
|
-
|
|
|
hdrlen = b43_txhdr_size(dev);
|
|
|
total_len = roundup(skb->len + hdrlen, 4);
|
|
|
|
|
|
if (unlikely(total_len > q->buffer_size)) {
|
|
|
err = -ENOBUFS;
|
|
|
b43dbg(dev->wl, "PIO: TX packet longer than queue.\n");
|
|
|
- goto out_unlock;
|
|
|
+ goto out;
|
|
|
}
|
|
|
if (unlikely(q->free_packet_slots == 0)) {
|
|
|
err = -ENOBUFS;
|
|
|
b43warn(dev->wl, "PIO: TX packet overflow.\n");
|
|
|
- goto out_unlock;
|
|
|
+ goto out;
|
|
|
}
|
|
|
B43_WARN_ON(q->buffer_used > q->buffer_size);
|
|
|
|
|
@@ -534,7 +529,7 @@ int b43_pio_tx(struct b43_wldev *dev, struct sk_buff *skb)
|
|
|
err = -EBUSY;
|
|
|
ieee80211_stop_queue(dev->wl->hw, skb_get_queue_mapping(skb));
|
|
|
q->stopped = 1;
|
|
|
- goto out_unlock;
|
|
|
+ goto out;
|
|
|
}
|
|
|
|
|
|
/* Assign the queue number to the ring (if not already done before)
|
|
@@ -548,11 +543,11 @@ int b43_pio_tx(struct b43_wldev *dev, struct sk_buff *skb)
|
|
|
* anymore and must not transmit it unencrypted. */
|
|
|
dev_kfree_skb_any(skb);
|
|
|
err = 0;
|
|
|
- goto out_unlock;
|
|
|
+ goto out;
|
|
|
}
|
|
|
if (unlikely(err)) {
|
|
|
b43err(dev->wl, "PIO transmission failure\n");
|
|
|
- goto out_unlock;
|
|
|
+ goto out;
|
|
|
}
|
|
|
q->nr_tx_packets++;
|
|
|
|
|
@@ -564,9 +559,7 @@ int b43_pio_tx(struct b43_wldev *dev, struct sk_buff *skb)
|
|
|
q->stopped = 1;
|
|
|
}
|
|
|
|
|
|
-out_unlock:
|
|
|
- spin_unlock_irqrestore(&q->lock, flags);
|
|
|
-
|
|
|
+out:
|
|
|
return err;
|
|
|
}
|
|
|
|
|
@@ -583,8 +576,6 @@ void b43_pio_handle_txstatus(struct b43_wldev *dev,
|
|
|
return;
|
|
|
B43_WARN_ON(!pack);
|
|
|
|
|
|
- spin_lock_irq(&q->lock);
|
|
|
-
|
|
|
info = IEEE80211_SKB_CB(pack->skb);
|
|
|
|
|
|
b43_fill_txstatus_report(dev, info, status);
|
|
@@ -602,8 +593,6 @@ void b43_pio_handle_txstatus(struct b43_wldev *dev,
|
|
|
ieee80211_wake_queue(dev->wl->hw, q->queue_prio);
|
|
|
q->stopped = 0;
|
|
|
}
|
|
|
-
|
|
|
- spin_unlock_irq(&q->lock);
|
|
|
}
|
|
|
|
|
|
void b43_pio_get_tx_stats(struct b43_wldev *dev,
|
|
@@ -611,17 +600,14 @@ void b43_pio_get_tx_stats(struct b43_wldev *dev,
|
|
|
{
|
|
|
const int nr_queues = dev->wl->hw->queues;
|
|
|
struct b43_pio_txqueue *q;
|
|
|
- unsigned long flags;
|
|
|
int i;
|
|
|
|
|
|
for (i = 0; i < nr_queues; i++) {
|
|
|
q = select_queue_by_priority(dev, i);
|
|
|
|
|
|
- spin_lock_irqsave(&q->lock, flags);
|
|
|
stats[i].len = B43_PIO_MAX_NR_TXPACKETS - q->free_packet_slots;
|
|
|
stats[i].limit = B43_PIO_MAX_NR_TXPACKETS;
|
|
|
stats[i].count = q->nr_tx_packets;
|
|
|
- spin_unlock_irqrestore(&q->lock, flags);
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -768,9 +754,9 @@ static void b43_pio_rx_work(struct work_struct *work)
|
|
|
bool stop;
|
|
|
|
|
|
do {
|
|
|
- spin_lock_irq(&q->lock);
|
|
|
+ mutex_lock(&q->dev->wl->mutex);
|
|
|
stop = (pio_rx_frame(q) == 0);
|
|
|
- spin_unlock_irq(&q->lock);
|
|
|
+ mutex_unlock(&q->dev->wl->mutex);
|
|
|
cond_resched();
|
|
|
if (stop)
|
|
|
break;
|
|
@@ -787,9 +773,6 @@ void b43_pio_rx(struct b43_pio_rxqueue *q)
|
|
|
|
|
|
static void b43_pio_tx_suspend_queue(struct b43_pio_txqueue *q)
|
|
|
{
|
|
|
- unsigned long flags;
|
|
|
-
|
|
|
- spin_lock_irqsave(&q->lock, flags);
|
|
|
if (q->rev >= 8) {
|
|
|
b43_piotx_write32(q, B43_PIO8_TXCTL,
|
|
|
b43_piotx_read32(q, B43_PIO8_TXCTL)
|
|
@@ -799,14 +782,10 @@ static void b43_pio_tx_suspend_queue(struct b43_pio_txqueue *q)
|
|
|
b43_piotx_read16(q, B43_PIO_TXCTL)
|
|
|
| B43_PIO_TXCTL_SUSPREQ);
|
|
|
}
|
|
|
- spin_unlock_irqrestore(&q->lock, flags);
|
|
|
}
|
|
|
|
|
|
static void b43_pio_tx_resume_queue(struct b43_pio_txqueue *q)
|
|
|
{
|
|
|
- unsigned long flags;
|
|
|
-
|
|
|
- spin_lock_irqsave(&q->lock, flags);
|
|
|
if (q->rev >= 8) {
|
|
|
b43_piotx_write32(q, B43_PIO8_TXCTL,
|
|
|
b43_piotx_read32(q, B43_PIO8_TXCTL)
|
|
@@ -816,7 +795,6 @@ static void b43_pio_tx_resume_queue(struct b43_pio_txqueue *q)
|
|
|
b43_piotx_read16(q, B43_PIO_TXCTL)
|
|
|
& ~B43_PIO_TXCTL_SUSPREQ);
|
|
|
}
|
|
|
- spin_unlock_irqrestore(&q->lock, flags);
|
|
|
}
|
|
|
|
|
|
void b43_pio_tx_suspend(struct b43_wldev *dev)
|