forked from Minki/linux
cd354f1ae7
After Al Viro (finally) succeeded in removing the sched.h #include in module.h recently, it makes sense again to remove other superfluous sched.h includes. There are quite a lot of files which include it but don't actually need anything defined in there. Presumably these includes were once needed for macros that used to live in sched.h, but moved to other header files in the course of cleaning it up. To ease the pain, this time I did not fiddle with any header files and only removed #includes from .c-files, which tend to cause less trouble. Compile tested against 2.6.20-rc2 and 2.6.20-rc2-mm2 (with offsets) on alpha, arm, i386, ia64, mips, powerpc, and x86_64 with allnoconfig, defconfig, allmodconfig, and allyesconfig as well as a few randconfigs on x86_64 and all configs in arch/arm/configs on arm. I also checked that no new warnings were introduced by the patch (actually, some warnings are removed that were emitted by unnecessarily included header files). Signed-off-by: Tim Schmielau <tim@physik3.uni-rostock.de> Acked-by: Russell King <rmk+kernel@arm.linux.org.uk> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
487 lines
11 KiB
C
487 lines
11 KiB
C
/*
|
|
* IEEE 1394 for Linux
|
|
*
|
|
* kernel ISO transmission/reception
|
|
*
|
|
* Copyright (C) 2002 Maas Digital LLC
|
|
*
|
|
* This code is licensed under the GPL. See the file COPYING in the root
|
|
* directory of the kernel sources for details.
|
|
*/
|
|
|
|
#include <linux/pci.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include "hosts.h"
|
|
#include "iso.h"
|
|
|
|
void hpsb_iso_stop(struct hpsb_iso *iso)
|
|
{
|
|
if (!(iso->flags & HPSB_ISO_DRIVER_STARTED))
|
|
return;
|
|
|
|
iso->host->driver->isoctl(iso, iso->type == HPSB_ISO_XMIT ?
|
|
XMIT_STOP : RECV_STOP, 0);
|
|
iso->flags &= ~HPSB_ISO_DRIVER_STARTED;
|
|
}
|
|
|
|
void hpsb_iso_shutdown(struct hpsb_iso *iso)
|
|
{
|
|
if (iso->flags & HPSB_ISO_DRIVER_INIT) {
|
|
hpsb_iso_stop(iso);
|
|
iso->host->driver->isoctl(iso, iso->type == HPSB_ISO_XMIT ?
|
|
XMIT_SHUTDOWN : RECV_SHUTDOWN, 0);
|
|
iso->flags &= ~HPSB_ISO_DRIVER_INIT;
|
|
}
|
|
|
|
dma_region_free(&iso->data_buf);
|
|
kfree(iso);
|
|
}
|
|
|
|
static struct hpsb_iso *hpsb_iso_common_init(struct hpsb_host *host,
|
|
enum hpsb_iso_type type,
|
|
unsigned int data_buf_size,
|
|
unsigned int buf_packets,
|
|
int channel, int dma_mode,
|
|
int irq_interval,
|
|
void (*callback) (struct hpsb_iso
|
|
*))
|
|
{
|
|
struct hpsb_iso *iso;
|
|
int dma_direction;
|
|
|
|
/* make sure driver supports the ISO API */
|
|
if (!host->driver->isoctl) {
|
|
printk(KERN_INFO
|
|
"ieee1394: host driver '%s' does not support the rawiso API\n",
|
|
host->driver->name);
|
|
return NULL;
|
|
}
|
|
|
|
/* sanitize parameters */
|
|
|
|
if (buf_packets < 2)
|
|
buf_packets = 2;
|
|
|
|
if ((dma_mode < HPSB_ISO_DMA_DEFAULT)
|
|
|| (dma_mode > HPSB_ISO_DMA_PACKET_PER_BUFFER))
|
|
dma_mode = HPSB_ISO_DMA_DEFAULT;
|
|
|
|
if ((irq_interval < 0) || (irq_interval > buf_packets / 4))
|
|
irq_interval = buf_packets / 4;
|
|
if (irq_interval == 0) /* really interrupt for each packet */
|
|
irq_interval = 1;
|
|
|
|
if (channel < -1 || channel >= 64)
|
|
return NULL;
|
|
|
|
/* channel = -1 is OK for multi-channel recv but not for xmit */
|
|
if (type == HPSB_ISO_XMIT && channel < 0)
|
|
return NULL;
|
|
|
|
/* allocate and write the struct hpsb_iso */
|
|
|
|
iso =
|
|
kmalloc(sizeof(*iso) +
|
|
buf_packets * sizeof(struct hpsb_iso_packet_info),
|
|
GFP_KERNEL);
|
|
if (!iso)
|
|
return NULL;
|
|
|
|
iso->infos = (struct hpsb_iso_packet_info *)(iso + 1);
|
|
|
|
iso->type = type;
|
|
iso->host = host;
|
|
iso->hostdata = NULL;
|
|
iso->callback = callback;
|
|
init_waitqueue_head(&iso->waitq);
|
|
iso->channel = channel;
|
|
iso->irq_interval = irq_interval;
|
|
iso->dma_mode = dma_mode;
|
|
dma_region_init(&iso->data_buf);
|
|
iso->buf_size = PAGE_ALIGN(data_buf_size);
|
|
iso->buf_packets = buf_packets;
|
|
iso->pkt_dma = 0;
|
|
iso->first_packet = 0;
|
|
spin_lock_init(&iso->lock);
|
|
|
|
if (iso->type == HPSB_ISO_XMIT) {
|
|
iso->n_ready_packets = iso->buf_packets;
|
|
dma_direction = PCI_DMA_TODEVICE;
|
|
} else {
|
|
iso->n_ready_packets = 0;
|
|
dma_direction = PCI_DMA_FROMDEVICE;
|
|
}
|
|
|
|
atomic_set(&iso->overflows, 0);
|
|
iso->bytes_discarded = 0;
|
|
iso->flags = 0;
|
|
iso->prebuffer = 0;
|
|
|
|
/* allocate the packet buffer */
|
|
if (dma_region_alloc
|
|
(&iso->data_buf, iso->buf_size, host->pdev, dma_direction))
|
|
goto err;
|
|
|
|
return iso;
|
|
|
|
err:
|
|
hpsb_iso_shutdown(iso);
|
|
return NULL;
|
|
}
|
|
|
|
int hpsb_iso_n_ready(struct hpsb_iso *iso)
|
|
{
|
|
unsigned long flags;
|
|
int val;
|
|
|
|
spin_lock_irqsave(&iso->lock, flags);
|
|
val = iso->n_ready_packets;
|
|
spin_unlock_irqrestore(&iso->lock, flags);
|
|
|
|
return val;
|
|
}
|
|
|
|
struct hpsb_iso *hpsb_iso_xmit_init(struct hpsb_host *host,
|
|
unsigned int data_buf_size,
|
|
unsigned int buf_packets,
|
|
int channel,
|
|
int speed,
|
|
int irq_interval,
|
|
void (*callback) (struct hpsb_iso *))
|
|
{
|
|
struct hpsb_iso *iso = hpsb_iso_common_init(host, HPSB_ISO_XMIT,
|
|
data_buf_size, buf_packets,
|
|
channel,
|
|
HPSB_ISO_DMA_DEFAULT,
|
|
irq_interval, callback);
|
|
if (!iso)
|
|
return NULL;
|
|
|
|
iso->speed = speed;
|
|
|
|
/* tell the driver to start working */
|
|
if (host->driver->isoctl(iso, XMIT_INIT, 0))
|
|
goto err;
|
|
|
|
iso->flags |= HPSB_ISO_DRIVER_INIT;
|
|
return iso;
|
|
|
|
err:
|
|
hpsb_iso_shutdown(iso);
|
|
return NULL;
|
|
}
|
|
|
|
struct hpsb_iso *hpsb_iso_recv_init(struct hpsb_host *host,
|
|
unsigned int data_buf_size,
|
|
unsigned int buf_packets,
|
|
int channel,
|
|
int dma_mode,
|
|
int irq_interval,
|
|
void (*callback) (struct hpsb_iso *))
|
|
{
|
|
struct hpsb_iso *iso = hpsb_iso_common_init(host, HPSB_ISO_RECV,
|
|
data_buf_size, buf_packets,
|
|
channel, dma_mode,
|
|
irq_interval, callback);
|
|
if (!iso)
|
|
return NULL;
|
|
|
|
/* tell the driver to start working */
|
|
if (host->driver->isoctl(iso, RECV_INIT, 0))
|
|
goto err;
|
|
|
|
iso->flags |= HPSB_ISO_DRIVER_INIT;
|
|
return iso;
|
|
|
|
err:
|
|
hpsb_iso_shutdown(iso);
|
|
return NULL;
|
|
}
|
|
|
|
int hpsb_iso_recv_listen_channel(struct hpsb_iso *iso, unsigned char channel)
|
|
{
|
|
if (iso->type != HPSB_ISO_RECV || iso->channel != -1 || channel >= 64)
|
|
return -EINVAL;
|
|
return iso->host->driver->isoctl(iso, RECV_LISTEN_CHANNEL, channel);
|
|
}
|
|
|
|
int hpsb_iso_recv_unlisten_channel(struct hpsb_iso *iso, unsigned char channel)
|
|
{
|
|
if (iso->type != HPSB_ISO_RECV || iso->channel != -1 || channel >= 64)
|
|
return -EINVAL;
|
|
return iso->host->driver->isoctl(iso, RECV_UNLISTEN_CHANNEL, channel);
|
|
}
|
|
|
|
int hpsb_iso_recv_set_channel_mask(struct hpsb_iso *iso, u64 mask)
|
|
{
|
|
if (iso->type != HPSB_ISO_RECV || iso->channel != -1)
|
|
return -EINVAL;
|
|
return iso->host->driver->isoctl(iso, RECV_SET_CHANNEL_MASK,
|
|
(unsigned long)&mask);
|
|
}
|
|
|
|
int hpsb_iso_recv_flush(struct hpsb_iso *iso)
|
|
{
|
|
if (iso->type != HPSB_ISO_RECV)
|
|
return -EINVAL;
|
|
return iso->host->driver->isoctl(iso, RECV_FLUSH, 0);
|
|
}
|
|
|
|
static int do_iso_xmit_start(struct hpsb_iso *iso, int cycle)
|
|
{
|
|
int retval = iso->host->driver->isoctl(iso, XMIT_START, cycle);
|
|
if (retval)
|
|
return retval;
|
|
|
|
iso->flags |= HPSB_ISO_DRIVER_STARTED;
|
|
return retval;
|
|
}
|
|
|
|
int hpsb_iso_xmit_start(struct hpsb_iso *iso, int cycle, int prebuffer)
|
|
{
|
|
if (iso->type != HPSB_ISO_XMIT)
|
|
return -1;
|
|
|
|
if (iso->flags & HPSB_ISO_DRIVER_STARTED)
|
|
return 0;
|
|
|
|
if (cycle < -1)
|
|
cycle = -1;
|
|
else if (cycle >= 8000)
|
|
cycle %= 8000;
|
|
|
|
iso->xmit_cycle = cycle;
|
|
|
|
if (prebuffer < 0)
|
|
prebuffer = iso->buf_packets - 1;
|
|
else if (prebuffer == 0)
|
|
prebuffer = 1;
|
|
|
|
if (prebuffer >= iso->buf_packets)
|
|
prebuffer = iso->buf_packets - 1;
|
|
|
|
iso->prebuffer = prebuffer;
|
|
|
|
/* remember the starting cycle; DMA will commence from xmit_queue_packets()
|
|
once enough packets have been buffered */
|
|
iso->start_cycle = cycle;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int hpsb_iso_recv_start(struct hpsb_iso *iso, int cycle, int tag_mask, int sync)
|
|
{
|
|
int retval = 0;
|
|
int isoctl_args[3];
|
|
|
|
if (iso->type != HPSB_ISO_RECV)
|
|
return -1;
|
|
|
|
if (iso->flags & HPSB_ISO_DRIVER_STARTED)
|
|
return 0;
|
|
|
|
if (cycle < -1)
|
|
cycle = -1;
|
|
else if (cycle >= 8000)
|
|
cycle %= 8000;
|
|
|
|
isoctl_args[0] = cycle;
|
|
|
|
if (tag_mask < 0)
|
|
/* match all tags */
|
|
tag_mask = 0xF;
|
|
isoctl_args[1] = tag_mask;
|
|
|
|
isoctl_args[2] = sync;
|
|
|
|
retval =
|
|
iso->host->driver->isoctl(iso, RECV_START,
|
|
(unsigned long)&isoctl_args[0]);
|
|
if (retval)
|
|
return retval;
|
|
|
|
iso->flags |= HPSB_ISO_DRIVER_STARTED;
|
|
return retval;
|
|
}
|
|
|
|
/* check to make sure the user has not supplied bogus values of offset/len
|
|
that would cause the kernel to access memory outside the buffer */
|
|
|
|
static int hpsb_iso_check_offset_len(struct hpsb_iso *iso,
|
|
unsigned int offset, unsigned short len,
|
|
unsigned int *out_offset,
|
|
unsigned short *out_len)
|
|
{
|
|
if (offset >= iso->buf_size)
|
|
return -EFAULT;
|
|
|
|
/* make sure the packet does not go beyond the end of the buffer */
|
|
if (offset + len > iso->buf_size)
|
|
return -EFAULT;
|
|
|
|
/* check for wrap-around */
|
|
if (offset + len < offset)
|
|
return -EFAULT;
|
|
|
|
/* now we can trust 'offset' and 'length' */
|
|
*out_offset = offset;
|
|
*out_len = len;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int hpsb_iso_xmit_queue_packet(struct hpsb_iso *iso, u32 offset, u16 len,
|
|
u8 tag, u8 sy)
|
|
{
|
|
struct hpsb_iso_packet_info *info;
|
|
unsigned long flags;
|
|
int rv;
|
|
|
|
if (iso->type != HPSB_ISO_XMIT)
|
|
return -EINVAL;
|
|
|
|
/* is there space in the buffer? */
|
|
if (iso->n_ready_packets <= 0) {
|
|
return -EBUSY;
|
|
}
|
|
|
|
info = &iso->infos[iso->first_packet];
|
|
|
|
/* check for bogus offset/length */
|
|
if (hpsb_iso_check_offset_len
|
|
(iso, offset, len, &info->offset, &info->len))
|
|
return -EFAULT;
|
|
|
|
info->tag = tag;
|
|
info->sy = sy;
|
|
|
|
spin_lock_irqsave(&iso->lock, flags);
|
|
|
|
rv = iso->host->driver->isoctl(iso, XMIT_QUEUE, (unsigned long)info);
|
|
if (rv)
|
|
goto out;
|
|
|
|
/* increment cursors */
|
|
iso->first_packet = (iso->first_packet + 1) % iso->buf_packets;
|
|
iso->xmit_cycle = (iso->xmit_cycle + 1) % 8000;
|
|
iso->n_ready_packets--;
|
|
|
|
if (iso->prebuffer != 0) {
|
|
iso->prebuffer--;
|
|
if (iso->prebuffer <= 0) {
|
|
iso->prebuffer = 0;
|
|
rv = do_iso_xmit_start(iso, iso->start_cycle);
|
|
}
|
|
}
|
|
|
|
out:
|
|
spin_unlock_irqrestore(&iso->lock, flags);
|
|
return rv;
|
|
}
|
|
|
|
int hpsb_iso_xmit_sync(struct hpsb_iso *iso)
|
|
{
|
|
if (iso->type != HPSB_ISO_XMIT)
|
|
return -EINVAL;
|
|
|
|
return wait_event_interruptible(iso->waitq,
|
|
hpsb_iso_n_ready(iso) ==
|
|
iso->buf_packets);
|
|
}
|
|
|
|
void hpsb_iso_packet_sent(struct hpsb_iso *iso, int cycle, int error)
|
|
{
|
|
unsigned long flags;
|
|
spin_lock_irqsave(&iso->lock, flags);
|
|
|
|
/* predict the cycle of the next packet to be queued */
|
|
|
|
/* jump ahead by the number of packets that are already buffered */
|
|
cycle += iso->buf_packets - iso->n_ready_packets;
|
|
cycle %= 8000;
|
|
|
|
iso->xmit_cycle = cycle;
|
|
iso->n_ready_packets++;
|
|
iso->pkt_dma = (iso->pkt_dma + 1) % iso->buf_packets;
|
|
|
|
if (iso->n_ready_packets == iso->buf_packets || error != 0) {
|
|
/* the buffer has run empty! */
|
|
atomic_inc(&iso->overflows);
|
|
}
|
|
|
|
spin_unlock_irqrestore(&iso->lock, flags);
|
|
}
|
|
|
|
void hpsb_iso_packet_received(struct hpsb_iso *iso, u32 offset, u16 len,
|
|
u16 total_len, u16 cycle, u8 channel, u8 tag,
|
|
u8 sy)
|
|
{
|
|
unsigned long flags;
|
|
spin_lock_irqsave(&iso->lock, flags);
|
|
|
|
if (iso->n_ready_packets == iso->buf_packets) {
|
|
/* overflow! */
|
|
atomic_inc(&iso->overflows);
|
|
/* Record size of this discarded packet */
|
|
iso->bytes_discarded += total_len;
|
|
} else {
|
|
struct hpsb_iso_packet_info *info = &iso->infos[iso->pkt_dma];
|
|
info->offset = offset;
|
|
info->len = len;
|
|
info->total_len = total_len;
|
|
info->cycle = cycle;
|
|
info->channel = channel;
|
|
info->tag = tag;
|
|
info->sy = sy;
|
|
|
|
iso->pkt_dma = (iso->pkt_dma + 1) % iso->buf_packets;
|
|
iso->n_ready_packets++;
|
|
}
|
|
|
|
spin_unlock_irqrestore(&iso->lock, flags);
|
|
}
|
|
|
|
int hpsb_iso_recv_release_packets(struct hpsb_iso *iso, unsigned int n_packets)
|
|
{
|
|
unsigned long flags;
|
|
unsigned int i;
|
|
int rv = 0;
|
|
|
|
if (iso->type != HPSB_ISO_RECV)
|
|
return -1;
|
|
|
|
spin_lock_irqsave(&iso->lock, flags);
|
|
for (i = 0; i < n_packets; i++) {
|
|
rv = iso->host->driver->isoctl(iso, RECV_RELEASE,
|
|
(unsigned long)&iso->infos[iso->
|
|
first_packet]);
|
|
if (rv)
|
|
break;
|
|
|
|
iso->first_packet = (iso->first_packet + 1) % iso->buf_packets;
|
|
iso->n_ready_packets--;
|
|
|
|
/* release memory from packets discarded when queue was full */
|
|
if (iso->n_ready_packets == 0) { /* Release only after all prior packets handled */
|
|
if (iso->bytes_discarded != 0) {
|
|
struct hpsb_iso_packet_info inf;
|
|
inf.total_len = iso->bytes_discarded;
|
|
iso->host->driver->isoctl(iso, RECV_RELEASE,
|
|
(unsigned long)&inf);
|
|
iso->bytes_discarded = 0;
|
|
}
|
|
}
|
|
}
|
|
spin_unlock_irqrestore(&iso->lock, flags);
|
|
return rv;
|
|
}
|
|
|
|
void hpsb_iso_wake(struct hpsb_iso *iso)
|
|
{
|
|
wake_up_interruptible(&iso->waitq);
|
|
|
|
if (iso->callback)
|
|
iso->callback(iso);
|
|
}
|