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;
|
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,
|
||||||
|
|
Loading…
Reference in a new issue