broadcom/b43legacy/pio.c

22 static void tx_start(struct b43legacy_pioqueue *queue)
24 	b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
28 static void tx_octet(struct b43legacy_pioqueue *queue,
31 	if (queue->need_workarounds) {
32 		b43legacy_pio_write(queue, B43legacy_PIO_TXDATA, octet);
33 		b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
36 		b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
38 		b43legacy_pio_write(queue, B43legacy_PIO_TXDATA, octet);
63 static void tx_data(struct b43legacy_pioqueue *queue,
71 	if (queue->need_workarounds) {
74 		b43legacy_pio_write(queue, B43legacy_PIO_TXDATA, data);
76 	b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
82 		b43legacy_pio_write(queue, B43legacy_PIO_TXDATA, data);
85 		tx_octet(queue, packet[octets -
89 static void tx_complete(struct b43legacy_pioqueue *queue,
92 	if (queue->need_workarounds) {
93 		b43legacy_pio_write(queue, B43legacy_PIO_TXDATA,
95 		b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
99 		b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
103 static u16 generate_cookie(struct b43legacy_pioqueue *queue,
113 	switch (queue->mmio_base) {
141 	struct b43legacy_pioqueue *queue = NULL;
146 		queue = pio->queue0;
149 		queue = pio->queue1;
152 		queue = pio->queue2;
155 		queue = pio->queue3;
163 	*packet = &(queue->tx_packets_cache[packetindex]);
165 	return queue;
172 static int pio_tx_write_fragment(struct b43legacy_pioqueue *queue,
185 	err = b43legacy_generate_txhdr(queue->dev,
188 				 generate_cookie(queue, packet));
192 	tx_start(queue);
194 	if (queue->need_workarounds)
196 	tx_data(queue, txhdr, (u8 *)skb->data, octets);
197 	tx_complete(queue, skb);
205 	struct b43legacy_pioqueue *queue = packet->queue;
213 	list_move(&packet->list, &queue->txfree);
214 	queue->nr_txfree++;
219 	struct b43legacy_pioqueue *queue = packet->queue;
225 	if (queue->tx_devq_size < octets) {
226 		b43legacywarn(queue->dev->wl, "PIO queue too small. "
232 	B43legacy_WARN_ON(queue->tx_devq_packets >
234 	B43legacy_WARN_ON(queue->tx_devq_used > queue->tx_devq_size);
236 	 * TX queue. If not, return and let the TX tasklet
239 	if (queue->tx_devq_packets == B43legacy_PIO_MAXTXDEVQPACKETS)
241 	if (queue->tx_devq_used + octets > queue->tx_devq_size)
244 	err = pio_tx_write_fragment(queue, skb, packet,
254 	 * (We must not overflow the device TX queue)
256 	queue->tx_devq_packets++;
257 	queue->tx_devq_used += octets;
262 	list_move_tail(&packet->list, &queue->txrunning);
269 	struct b43legacy_pioqueue *queue = from_tasklet(queue, t, txtask);
270 	struct b43legacy_wldev *dev = queue->dev;
277 	if (queue->tx_frozen)
279 	txctl = b43legacy_pio_read(queue, B43legacy_PIO_TXCTL);
283 	list_for_each_entry_safe(packet, tmp_packet, &queue->txqueue, list) {
285 		 * the device queue is full. In case of failure, the
299 static void setup_txqueues(struct b43legacy_pioqueue *queue)
304 	queue->nr_txfree = B43legacy_PIO_MAXTXPACKETS;
306 		packet = &(queue->tx_packets_cache[i]);
308 		packet->queue = queue;
311 		list_add(&packet->list, &queue->txfree);
319 	struct b43legacy_pioqueue *queue;
323 	queue = kzalloc(sizeof(*queue), GFP_KERNEL);
324 	if (!queue)
327 	queue->dev = dev;
328 	queue->mmio_base = pio_mmio_base;
329 	queue->need_workarounds = (dev->dev->id.revision < 3);
331 	INIT_LIST_HEAD(&queue->txfree);
332 	INIT_LIST_HEAD(&queue->txqueue);
333 	INIT_LIST_HEAD(&queue->txrunning);
334 	tasklet_setup(&queue->txtask, tx_tasklet);
340 	qsize = b43legacy_read16(dev, queue->mmio_base
349 		b43legacyerr(dev->wl, "PIO tx device-queue too small (%u)\n",
354 	queue->tx_devq_size = qsize;
356 	setup_txqueues(queue);
359 	return queue;
362 	kfree(queue);
363 	queue = NULL;
367 static void cancel_transfers(struct b43legacy_pioqueue *queue)
371 	tasklet_kill(&queue->txtask);
373 	list_for_each_entry_safe(packet, tmp_packet, &queue->txrunning, list)
375 	list_for_each_entry_safe(packet, tmp_packet, &queue->txqueue, list)
379 static void b43legacy_destroy_pioqueue(struct b43legacy_pioqueue *queue)
381 	if (!queue)
384 	cancel_transfers(queue);
385 	kfree(queue);
409 	struct b43legacy_pioqueue *queue;
412 	queue = b43legacy_setup_pioqueue(dev, B43legacy_MMIO_PIO1_BASE);
413 	if (!queue)
415 	pio->queue0 = queue;
417 	queue = b43legacy_setup_pioqueue(dev, B43legacy_MMIO_PIO2_BASE);
418 	if (!queue)
420 	pio->queue1 = queue;
422 	queue = b43legacy_setup_pioqueue(dev, B43legacy_MMIO_PIO3_BASE);
423 	if (!queue)
425 	pio->queue2 = queue;
427 	queue = b43legacy_setup_pioqueue(dev, B43legacy_MMIO_PIO4_BASE);
428 	if (!queue)
430 	pio->queue3 = queue;
455 	struct b43legacy_pioqueue *queue = dev->pio.queue1;
458 	B43legacy_WARN_ON(queue->tx_suspended);
459 	B43legacy_WARN_ON(list_empty(&queue->txfree));
461 	packet = list_entry(queue->txfree.next, struct b43legacy_pio_txpacket,
465 	list_move_tail(&packet->list, &queue->txqueue);
466 	queue->nr_txfree--;
467 	B43legacy_WARN_ON(queue->nr_txfree >= B43legacy_PIO_MAXTXPACKETS);
469 	tasklet_schedule(&queue->txtask);
477 	struct b43legacy_pioqueue *queue;
482 	queue = parse_cookie(dev, status->cookie, &packet);
483 	B43legacy_WARN_ON(!queue);
488 	queue->tx_devq_packets--;
489 	queue->tx_devq_used -= (packet->skb->len +
531 	if (!list_empty(&queue->txqueue))
532 		tasklet_schedule(&queue->txtask);
535 static void pio_rx_error(struct b43legacy_pioqueue *queue,
541 	b43legacyerr(queue->dev->wl, "PIO RX error: %s\n", error);
542 	b43legacy_pio_write(queue, B43legacy_PIO_RXCTL,
545 		B43legacy_WARN_ON(queue->mmio_base != B43legacy_MMIO_PIO1_BASE);
548 			b43legacy_pio_read(queue, B43legacy_PIO_RXDATA);
553 void b43legacy_pio_rx(struct b43legacy_pioqueue *queue)
564 	tmp = b43legacy_pio_read(queue, B43legacy_PIO_RXCTL);
567 	b43legacy_pio_write(queue, B43legacy_PIO_RXCTL,
571 		tmp = b43legacy_pio_read(queue, B43legacy_PIO_RXCTL);
576 	b43legacydbg(queue->dev->wl, "PIO RX timed out\n");
580 	len = b43legacy_pio_read(queue, B43legacy_PIO_RXDATA);
582 		pio_rx_error(queue, 0, "len > 0x700");
585 	if (unlikely(len == 0 && queue->mmio_base !=
587 		pio_rx_error(queue, 0, "len == 0");
591 	if (queue->mmio_base == B43legacy_MMIO_PIO4_BASE)
596 		tmp = b43legacy_pio_read(queue, B43legacy_PIO_RXDATA);
602 		pio_rx_error(queue,
603 			     (queue->mmio_base == B43legacy_MMIO_PIO1_BASE),
607 	if (queue->mmio_base == B43legacy_MMIO_PIO4_BASE) {
612 		b43legacy_handle_hwtxstatus(queue->dev, hw);
619 		pio_rx_error(queue, 1, "OOM");
624 		tmp = b43legacy_pio_read(queue, B43legacy_PIO_RXDATA);
628 		tmp = b43legacy_pio_read(queue, B43legacy_PIO_RXDATA);
631 	b43legacy_rx(queue->dev, skb, rxhdr);
634 void b43legacy_pio_tx_suspend(struct b43legacy_pioqueue *queue)
636 	b43legacy_power_saving_ctl_bits(queue->dev, -1, 1);
637 	b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
638 			    b43legacy_pio_read(queue, B43legacy_PIO_TXCTL)
642 void b43legacy_pio_tx_resume(struct b43legacy_pioqueue *queue)
644 	b43legacy_pio_write(queue, B43legacy_PIO_TXCTL,
645 			    b43legacy_pio_read(queue, B43legacy_PIO_TXCTL)
647 	b43legacy_power_saving_ctl_bits(queue->dev, -1, -1);
648 	tasklet_schedule(&queue->txtask);