]> git.karo-electronics.de Git - mv-sheeva.git/blob - drivers/ieee1394/iso.c
Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/sparc-2.6
[mv-sheeva.git] / drivers / ieee1394 / iso.c
1 /*
2  * IEEE 1394 for Linux
3  *
4  * kernel ISO transmission/reception
5  *
6  * Copyright (C) 2002 Maas Digital LLC
7  *
8  * This code is licensed under the GPL.  See the file COPYING in the root
9  * directory of the kernel sources for details.
10  */
11
12 #include <linux/pci.h>
13 #include <linux/sched.h>
14 #include <linux/mm.h>
15 #include <linux/slab.h>
16
17 #include "hosts.h"
18 #include "iso.h"
19
20 /**
21  * hpsb_iso_stop - stop DMA
22  */
23 void hpsb_iso_stop(struct hpsb_iso *iso)
24 {
25         if (!(iso->flags & HPSB_ISO_DRIVER_STARTED))
26                 return;
27
28         iso->host->driver->isoctl(iso, iso->type == HPSB_ISO_XMIT ?
29                                   XMIT_STOP : RECV_STOP, 0);
30         iso->flags &= ~HPSB_ISO_DRIVER_STARTED;
31 }
32
33 /**
34  * hpsb_iso_shutdown - deallocate buffer and DMA context
35  */
36 void hpsb_iso_shutdown(struct hpsb_iso *iso)
37 {
38         if (iso->flags & HPSB_ISO_DRIVER_INIT) {
39                 hpsb_iso_stop(iso);
40                 iso->host->driver->isoctl(iso, iso->type == HPSB_ISO_XMIT ?
41                                           XMIT_SHUTDOWN : RECV_SHUTDOWN, 0);
42                 iso->flags &= ~HPSB_ISO_DRIVER_INIT;
43         }
44
45         dma_region_free(&iso->data_buf);
46         kfree(iso);
47 }
48
49 static struct hpsb_iso *hpsb_iso_common_init(struct hpsb_host *host,
50                                              enum hpsb_iso_type type,
51                                              unsigned int data_buf_size,
52                                              unsigned int buf_packets,
53                                              int channel, int dma_mode,
54                                              int irq_interval,
55                                              void (*callback) (struct hpsb_iso
56                                                                *))
57 {
58         struct hpsb_iso *iso;
59         int dma_direction;
60
61         /* make sure driver supports the ISO API */
62         if (!host->driver->isoctl) {
63                 printk(KERN_INFO
64                        "ieee1394: host driver '%s' does not support the rawiso API\n",
65                        host->driver->name);
66                 return NULL;
67         }
68
69         /* sanitize parameters */
70
71         if (buf_packets < 2)
72                 buf_packets = 2;
73
74         if ((dma_mode < HPSB_ISO_DMA_DEFAULT)
75             || (dma_mode > HPSB_ISO_DMA_PACKET_PER_BUFFER))
76                 dma_mode = HPSB_ISO_DMA_DEFAULT;
77
78         if ((irq_interval < 0) || (irq_interval > buf_packets / 4))
79                 irq_interval = buf_packets / 4;
80         if (irq_interval == 0)  /* really interrupt for each packet */
81                 irq_interval = 1;
82
83         if (channel < -1 || channel >= 64)
84                 return NULL;
85
86         /* channel = -1 is OK for multi-channel recv but not for xmit */
87         if (type == HPSB_ISO_XMIT && channel < 0)
88                 return NULL;
89
90         /* allocate and write the struct hpsb_iso */
91
92         iso =
93             kmalloc(sizeof(*iso) +
94                     buf_packets * sizeof(struct hpsb_iso_packet_info),
95                     GFP_KERNEL);
96         if (!iso)
97                 return NULL;
98
99         iso->infos = (struct hpsb_iso_packet_info *)(iso + 1);
100
101         iso->type = type;
102         iso->host = host;
103         iso->hostdata = NULL;
104         iso->callback = callback;
105         init_waitqueue_head(&iso->waitq);
106         iso->channel = channel;
107         iso->irq_interval = irq_interval;
108         iso->dma_mode = dma_mode;
109         dma_region_init(&iso->data_buf);
110         iso->buf_size = PAGE_ALIGN(data_buf_size);
111         iso->buf_packets = buf_packets;
112         iso->pkt_dma = 0;
113         iso->first_packet = 0;
114         spin_lock_init(&iso->lock);
115
116         if (iso->type == HPSB_ISO_XMIT) {
117                 iso->n_ready_packets = iso->buf_packets;
118                 dma_direction = PCI_DMA_TODEVICE;
119         } else {
120                 iso->n_ready_packets = 0;
121                 dma_direction = PCI_DMA_FROMDEVICE;
122         }
123
124         atomic_set(&iso->overflows, 0);
125         iso->bytes_discarded = 0;
126         iso->flags = 0;
127         iso->prebuffer = 0;
128
129         /* allocate the packet buffer */
130         if (dma_region_alloc
131             (&iso->data_buf, iso->buf_size, host->pdev, dma_direction))
132                 goto err;
133
134         return iso;
135
136       err:
137         hpsb_iso_shutdown(iso);
138         return NULL;
139 }
140
141 /**
142  * hpsb_iso_n_ready - returns number of packets ready to send or receive
143  */
144 int hpsb_iso_n_ready(struct hpsb_iso *iso)
145 {
146         unsigned long flags;
147         int val;
148
149         spin_lock_irqsave(&iso->lock, flags);
150         val = iso->n_ready_packets;
151         spin_unlock_irqrestore(&iso->lock, flags);
152
153         return val;
154 }
155
156 /**
157  * hpsb_iso_xmit_init - allocate the buffer and DMA context
158  */
159 struct hpsb_iso *hpsb_iso_xmit_init(struct hpsb_host *host,
160                                     unsigned int data_buf_size,
161                                     unsigned int buf_packets,
162                                     int channel,
163                                     int speed,
164                                     int irq_interval,
165                                     void (*callback) (struct hpsb_iso *))
166 {
167         struct hpsb_iso *iso = hpsb_iso_common_init(host, HPSB_ISO_XMIT,
168                                                     data_buf_size, buf_packets,
169                                                     channel,
170                                                     HPSB_ISO_DMA_DEFAULT,
171                                                     irq_interval, callback);
172         if (!iso)
173                 return NULL;
174
175         iso->speed = speed;
176
177         /* tell the driver to start working */
178         if (host->driver->isoctl(iso, XMIT_INIT, 0))
179                 goto err;
180
181         iso->flags |= HPSB_ISO_DRIVER_INIT;
182         return iso;
183
184       err:
185         hpsb_iso_shutdown(iso);
186         return NULL;
187 }
188
189 /**
190  * hpsb_iso_recv_init - allocate the buffer and DMA context
191  *
192  * Note, if channel = -1, multi-channel receive is enabled.
193  */
194 struct hpsb_iso *hpsb_iso_recv_init(struct hpsb_host *host,
195                                     unsigned int data_buf_size,
196                                     unsigned int buf_packets,
197                                     int channel,
198                                     int dma_mode,
199                                     int irq_interval,
200                                     void (*callback) (struct hpsb_iso *))
201 {
202         struct hpsb_iso *iso = hpsb_iso_common_init(host, HPSB_ISO_RECV,
203                                                     data_buf_size, buf_packets,
204                                                     channel, dma_mode,
205                                                     irq_interval, callback);
206         if (!iso)
207                 return NULL;
208
209         /* tell the driver to start working */
210         if (host->driver->isoctl(iso, RECV_INIT, 0))
211                 goto err;
212
213         iso->flags |= HPSB_ISO_DRIVER_INIT;
214         return iso;
215
216       err:
217         hpsb_iso_shutdown(iso);
218         return NULL;
219 }
220
221 /**
222  * hpsb_iso_recv_listen_channel
223  *
224  * multi-channel only
225  */
226 int hpsb_iso_recv_listen_channel(struct hpsb_iso *iso, unsigned char channel)
227 {
228         if (iso->type != HPSB_ISO_RECV || iso->channel != -1 || channel >= 64)
229                 return -EINVAL;
230         return iso->host->driver->isoctl(iso, RECV_LISTEN_CHANNEL, channel);
231 }
232
233 /**
234  * hpsb_iso_recv_unlisten_channel
235  *
236  * multi-channel only
237  */
238 int hpsb_iso_recv_unlisten_channel(struct hpsb_iso *iso, unsigned char channel)
239 {
240         if (iso->type != HPSB_ISO_RECV || iso->channel != -1 || channel >= 64)
241                 return -EINVAL;
242         return iso->host->driver->isoctl(iso, RECV_UNLISTEN_CHANNEL, channel);
243 }
244
245 /**
246  * hpsb_iso_recv_set_channel_mask
247  *
248  * multi-channel only
249  */
250 int hpsb_iso_recv_set_channel_mask(struct hpsb_iso *iso, u64 mask)
251 {
252         if (iso->type != HPSB_ISO_RECV || iso->channel != -1)
253                 return -EINVAL;
254         return iso->host->driver->isoctl(iso, RECV_SET_CHANNEL_MASK,
255                                          (unsigned long)&mask);
256 }
257
258 /**
259  * hpsb_iso_recv_flush - check for arrival of new packets
260  *
261  * check for arrival of new packets immediately (even if irq_interval
262  * has not yet been reached)
263  */
264 int hpsb_iso_recv_flush(struct hpsb_iso *iso)
265 {
266         if (iso->type != HPSB_ISO_RECV)
267                 return -EINVAL;
268         return iso->host->driver->isoctl(iso, RECV_FLUSH, 0);
269 }
270
271 static int do_iso_xmit_start(struct hpsb_iso *iso, int cycle)
272 {
273         int retval = iso->host->driver->isoctl(iso, XMIT_START, cycle);
274         if (retval)
275                 return retval;
276
277         iso->flags |= HPSB_ISO_DRIVER_STARTED;
278         return retval;
279 }
280
281 /**
282  * hpsb_iso_xmit_start - start DMA
283  */
284 int hpsb_iso_xmit_start(struct hpsb_iso *iso, int cycle, int prebuffer)
285 {
286         if (iso->type != HPSB_ISO_XMIT)
287                 return -1;
288
289         if (iso->flags & HPSB_ISO_DRIVER_STARTED)
290                 return 0;
291
292         if (cycle < -1)
293                 cycle = -1;
294         else if (cycle >= 8000)
295                 cycle %= 8000;
296
297         iso->xmit_cycle = cycle;
298
299         if (prebuffer < 0)
300                 prebuffer = iso->buf_packets - 1;
301         else if (prebuffer == 0)
302                 prebuffer = 1;
303
304         if (prebuffer >= iso->buf_packets)
305                 prebuffer = iso->buf_packets - 1;
306
307         iso->prebuffer = prebuffer;
308
309         /* remember the starting cycle; DMA will commence from xmit_queue_packets()
310            once enough packets have been buffered */
311         iso->start_cycle = cycle;
312
313         return 0;
314 }
315
316 /**
317  * hpsb_iso_recv_start - start DMA
318  */
319 int hpsb_iso_recv_start(struct hpsb_iso *iso, int cycle, int tag_mask, int sync)
320 {
321         int retval = 0;
322         int isoctl_args[3];
323
324         if (iso->type != HPSB_ISO_RECV)
325                 return -1;
326
327         if (iso->flags & HPSB_ISO_DRIVER_STARTED)
328                 return 0;
329
330         if (cycle < -1)
331                 cycle = -1;
332         else if (cycle >= 8000)
333                 cycle %= 8000;
334
335         isoctl_args[0] = cycle;
336
337         if (tag_mask < 0)
338                 /* match all tags */
339                 tag_mask = 0xF;
340         isoctl_args[1] = tag_mask;
341
342         isoctl_args[2] = sync;
343
344         retval =
345             iso->host->driver->isoctl(iso, RECV_START,
346                                       (unsigned long)&isoctl_args[0]);
347         if (retval)
348                 return retval;
349
350         iso->flags |= HPSB_ISO_DRIVER_STARTED;
351         return retval;
352 }
353
354 /* check to make sure the user has not supplied bogus values of offset/len
355  * that would cause the kernel to access memory outside the buffer */
356 static int hpsb_iso_check_offset_len(struct hpsb_iso *iso,
357                                      unsigned int offset, unsigned short len,
358                                      unsigned int *out_offset,
359                                      unsigned short *out_len)
360 {
361         if (offset >= iso->buf_size)
362                 return -EFAULT;
363
364         /* make sure the packet does not go beyond the end of the buffer */
365         if (offset + len > iso->buf_size)
366                 return -EFAULT;
367
368         /* check for wrap-around */
369         if (offset + len < offset)
370                 return -EFAULT;
371
372         /* now we can trust 'offset' and 'length' */
373         *out_offset = offset;
374         *out_len = len;
375
376         return 0;
377 }
378
379 /**
380  * hpsb_iso_xmit_queue_packet - queue a packet for transmission.
381  *
382  * @offset is relative to the beginning of the DMA buffer, where the packet's
383  * data payload should already have been placed.
384  */
385 int hpsb_iso_xmit_queue_packet(struct hpsb_iso *iso, u32 offset, u16 len,
386                                u8 tag, u8 sy)
387 {
388         struct hpsb_iso_packet_info *info;
389         unsigned long flags;
390         int rv;
391
392         if (iso->type != HPSB_ISO_XMIT)
393                 return -EINVAL;
394
395         /* is there space in the buffer? */
396         if (iso->n_ready_packets <= 0) {
397                 return -EBUSY;
398         }
399
400         info = &iso->infos[iso->first_packet];
401
402         /* check for bogus offset/length */
403         if (hpsb_iso_check_offset_len
404             (iso, offset, len, &info->offset, &info->len))
405                 return -EFAULT;
406
407         info->tag = tag;
408         info->sy = sy;
409
410         spin_lock_irqsave(&iso->lock, flags);
411
412         rv = iso->host->driver->isoctl(iso, XMIT_QUEUE, (unsigned long)info);
413         if (rv)
414                 goto out;
415
416         /* increment cursors */
417         iso->first_packet = (iso->first_packet + 1) % iso->buf_packets;
418         iso->xmit_cycle = (iso->xmit_cycle + 1) % 8000;
419         iso->n_ready_packets--;
420
421         if (iso->prebuffer != 0) {
422                 iso->prebuffer--;
423                 if (iso->prebuffer <= 0) {
424                         iso->prebuffer = 0;
425                         rv = do_iso_xmit_start(iso, iso->start_cycle);
426                 }
427         }
428
429       out:
430         spin_unlock_irqrestore(&iso->lock, flags);
431         return rv;
432 }
433
434 /**
435  * hpsb_iso_xmit_sync - wait until all queued packets have been transmitted
436  */
437 int hpsb_iso_xmit_sync(struct hpsb_iso *iso)
438 {
439         if (iso->type != HPSB_ISO_XMIT)
440                 return -EINVAL;
441
442         return wait_event_interruptible(iso->waitq,
443                                         hpsb_iso_n_ready(iso) ==
444                                         iso->buf_packets);
445 }
446
447 /**
448  * hpsb_iso_packet_sent
449  *
450  * Available to low-level drivers.
451  *
452  * Call after a packet has been transmitted to the bus (interrupt context is
453  * OK).  @cycle is the _exact_ cycle the packet was sent on.  @error should be
454  * non-zero if some sort of error occurred when sending the packet.
455  */
456 void hpsb_iso_packet_sent(struct hpsb_iso *iso, int cycle, int error)
457 {
458         unsigned long flags;
459         spin_lock_irqsave(&iso->lock, flags);
460
461         /* predict the cycle of the next packet to be queued */
462
463         /* jump ahead by the number of packets that are already buffered */
464         cycle += iso->buf_packets - iso->n_ready_packets;
465         cycle %= 8000;
466
467         iso->xmit_cycle = cycle;
468         iso->n_ready_packets++;
469         iso->pkt_dma = (iso->pkt_dma + 1) % iso->buf_packets;
470
471         if (iso->n_ready_packets == iso->buf_packets || error != 0) {
472                 /* the buffer has run empty! */
473                 atomic_inc(&iso->overflows);
474         }
475
476         spin_unlock_irqrestore(&iso->lock, flags);
477 }
478
479 /**
480  * hpsb_iso_packet_received
481  *
482  * Available to low-level drivers.
483  *
484  * Call after a packet has been received (interrupt context is OK).
485  */
486 void hpsb_iso_packet_received(struct hpsb_iso *iso, u32 offset, u16 len,
487                               u16 total_len, u16 cycle, u8 channel, u8 tag,
488                               u8 sy)
489 {
490         unsigned long flags;
491         spin_lock_irqsave(&iso->lock, flags);
492
493         if (iso->n_ready_packets == iso->buf_packets) {
494                 /* overflow! */
495                 atomic_inc(&iso->overflows);
496                 /* Record size of this discarded packet */
497                 iso->bytes_discarded += total_len;
498         } else {
499                 struct hpsb_iso_packet_info *info = &iso->infos[iso->pkt_dma];
500                 info->offset = offset;
501                 info->len = len;
502                 info->total_len = total_len;
503                 info->cycle = cycle;
504                 info->channel = channel;
505                 info->tag = tag;
506                 info->sy = sy;
507
508                 iso->pkt_dma = (iso->pkt_dma + 1) % iso->buf_packets;
509                 iso->n_ready_packets++;
510         }
511
512         spin_unlock_irqrestore(&iso->lock, flags);
513 }
514
515 /**
516  * hpsb_iso_recv_release_packets - release packets, reuse buffer
517  *
518  * @n_packets have been read out of the buffer, re-use the buffer space
519  */
520 int hpsb_iso_recv_release_packets(struct hpsb_iso *iso, unsigned int n_packets)
521 {
522         unsigned long flags;
523         unsigned int i;
524         int rv = 0;
525
526         if (iso->type != HPSB_ISO_RECV)
527                 return -1;
528
529         spin_lock_irqsave(&iso->lock, flags);
530         for (i = 0; i < n_packets; i++) {
531                 rv = iso->host->driver->isoctl(iso, RECV_RELEASE,
532                                                (unsigned long)&iso->infos[iso->
533                                                                           first_packet]);
534                 if (rv)
535                         break;
536
537                 iso->first_packet = (iso->first_packet + 1) % iso->buf_packets;
538                 iso->n_ready_packets--;
539
540                 /* release memory from packets discarded when queue was full  */
541                 if (iso->n_ready_packets == 0) {        /* Release only after all prior packets handled */
542                         if (iso->bytes_discarded != 0) {
543                                 struct hpsb_iso_packet_info inf;
544                                 inf.total_len = iso->bytes_discarded;
545                                 iso->host->driver->isoctl(iso, RECV_RELEASE,
546                                                           (unsigned long)&inf);
547                                 iso->bytes_discarded = 0;
548                         }
549                 }
550         }
551         spin_unlock_irqrestore(&iso->lock, flags);
552         return rv;
553 }
554
555 /**
556  * hpsb_iso_wake
557  *
558  * Available to low-level drivers.
559  *
560  * Call to wake waiting processes after buffer space has opened up.
561  */
562 void hpsb_iso_wake(struct hpsb_iso *iso)
563 {
564         wake_up_interruptible(&iso->waitq);
565
566         if (iso->callback)
567                 iso->callback(iso);
568 }