firewire net: Introduce fwnet_fifo_{start, stop}() helpers.

Signed-off-by: YOSHIFUJI Hideaki <yoshfuji@linux-ipv6.org>
Signed-off-by: Stefan Richter <stefanr@s5r6.in-berlin.de>
This commit is contained in:
YOSHIFUJI Hideaki 2013-03-08 10:42:26 +09:00 committed by Stefan Richter
parent 5104a03d7d
commit 9d39c90abc

View file

@ -1116,6 +1116,36 @@ static int fwnet_send_packet(struct fwnet_packet_task *ptask)
return 0; return 0;
} }
static void fwnet_fifo_stop(struct fwnet_device *dev)
{
if (dev->local_fifo == FWNET_NO_FIFO_ADDR)
return;
fw_core_remove_address_handler(&dev->handler);
dev->local_fifo = FWNET_NO_FIFO_ADDR;
}
static int fwnet_fifo_start(struct fwnet_device *dev)
{
int retval;
if (dev->local_fifo != FWNET_NO_FIFO_ADDR)
return 0;
dev->handler.length = 4096;
dev->handler.address_callback = fwnet_receive_packet;
dev->handler.callback_data = dev;
retval = fw_core_add_address_handler(&dev->handler,
&fw_high_memory_region);
if (retval < 0)
return retval;
dev->local_fifo = dev->handler.offset;
return 0;
}
static int fwnet_broadcast_start(struct fwnet_device *dev) static int fwnet_broadcast_start(struct fwnet_device *dev)
{ {
struct fw_iso_context *context; struct fw_iso_context *context;
@ -1126,18 +1156,9 @@ static int fwnet_broadcast_start(struct fwnet_device *dev)
unsigned long offset; unsigned long offset;
unsigned u; unsigned u;
if (dev->local_fifo == FWNET_NO_FIFO_ADDR) { retval = fwnet_fifo_start(dev);
dev->handler.length = 4096; if (retval < 0)
dev->handler.address_callback = fwnet_receive_packet; goto failed_initial;
dev->handler.callback_data = dev;
retval = fw_core_add_address_handler(&dev->handler,
&fw_high_memory_region);
if (retval < 0)
goto failed_initial;
dev->local_fifo = dev->handler.offset;
}
max_receive = 1U << (dev->card->max_receive + 1); max_receive = 1U << (dev->card->max_receive + 1);
num_packets = (FWNET_ISO_PAGE_COUNT * PAGE_SIZE) / max_receive; num_packets = (FWNET_ISO_PAGE_COUNT * PAGE_SIZE) / max_receive;
@ -1219,8 +1240,7 @@ static int fwnet_broadcast_start(struct fwnet_device *dev)
fw_iso_context_destroy(context); fw_iso_context_destroy(context);
dev->broadcast_rcv_context = NULL; dev->broadcast_rcv_context = NULL;
failed_context_create: failed_context_create:
fw_core_remove_address_handler(&dev->handler); fwnet_fifo_stop(dev);
dev->local_fifo = FWNET_NO_FIFO_ADDR;
failed_initial: failed_initial:
return retval; return retval;
@ -1600,8 +1620,7 @@ static int fwnet_remove(struct device *_dev)
if (list_empty(&dev->peer_list)) { if (list_empty(&dev->peer_list)) {
unregister_netdev(net); unregister_netdev(net);
if (dev->local_fifo != FWNET_NO_FIFO_ADDR) fwnet_fifo_stop(dev);
fw_core_remove_address_handler(&dev->handler);
if (dev->broadcast_rcv_context) { if (dev->broadcast_rcv_context) {
fw_iso_context_stop(dev->broadcast_rcv_context); fw_iso_context_stop(dev->broadcast_rcv_context);
fw_iso_buffer_destroy(&dev->broadcast_rcv_buffer, fw_iso_buffer_destroy(&dev->broadcast_rcv_buffer,