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:
parent
5104a03d7d
commit
9d39c90abc
1 changed files with 35 additions and 16 deletions
|
@ -1116,6 +1116,36 @@ static int fwnet_send_packet(struct fwnet_packet_task *ptask)
|
|||
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)
|
||||
{
|
||||
struct fw_iso_context *context;
|
||||
|
@ -1126,19 +1156,10 @@ static int fwnet_broadcast_start(struct fwnet_device *dev)
|
|||
unsigned long offset;
|
||||
unsigned u;
|
||||
|
||||
if (dev->local_fifo == FWNET_NO_FIFO_ADDR) {
|
||||
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);
|
||||
retval = fwnet_fifo_start(dev);
|
||||
if (retval < 0)
|
||||
goto failed_initial;
|
||||
|
||||
dev->local_fifo = dev->handler.offset;
|
||||
}
|
||||
|
||||
max_receive = 1U << (dev->card->max_receive + 1);
|
||||
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);
|
||||
dev->broadcast_rcv_context = NULL;
|
||||
failed_context_create:
|
||||
fw_core_remove_address_handler(&dev->handler);
|
||||
dev->local_fifo = FWNET_NO_FIFO_ADDR;
|
||||
fwnet_fifo_stop(dev);
|
||||
failed_initial:
|
||||
|
||||
return retval;
|
||||
|
@ -1600,8 +1620,7 @@ static int fwnet_remove(struct device *_dev)
|
|||
if (list_empty(&dev->peer_list)) {
|
||||
unregister_netdev(net);
|
||||
|
||||
if (dev->local_fifo != FWNET_NO_FIFO_ADDR)
|
||||
fw_core_remove_address_handler(&dev->handler);
|
||||
fwnet_fifo_stop(dev);
|
||||
if (dev->broadcast_rcv_context) {
|
||||
fw_iso_context_stop(dev->broadcast_rcv_context);
|
||||
fw_iso_buffer_destroy(&dev->broadcast_rcv_buffer,
|
||||
|
|
Loading…
Reference in a new issue