Automatic merge of /spare/repo/netdev-2.6 branch dm9000
[linux-2.6] / drivers / ieee1394 / ieee1394_transactions.c
1 /*
2  * IEEE 1394 for Linux
3  *
4  * Transaction support.
5  *
6  * Copyright (C) 1999 Andreas E. Bombe
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/sched.h>
13 #include <linux/bitops.h>
14 #include <linux/smp_lock.h>
15 #include <linux/interrupt.h>
16
17 #include <asm/errno.h>
18
19 #include "ieee1394.h"
20 #include "ieee1394_types.h"
21 #include "hosts.h"
22 #include "ieee1394_core.h"
23 #include "highlevel.h"
24 #include "nodemgr.h"
25
26
27 #define PREP_ASYNC_HEAD_ADDRESS(tc) \
28         packet->tcode = tc; \
29         packet->header[0] = (packet->node_id << 16) | (packet->tlabel << 10) \
30                 | (1 << 8) | (tc << 4); \
31         packet->header[1] = (packet->host->node_id << 16) | (addr >> 32); \
32         packet->header[2] = addr & 0xffffffff
33
34
35 static void fill_async_readquad(struct hpsb_packet *packet, u64 addr)
36 {
37         PREP_ASYNC_HEAD_ADDRESS(TCODE_READQ);
38         packet->header_size = 12;
39         packet->data_size = 0;
40         packet->expect_response = 1;
41 }
42
43 static void fill_async_readblock(struct hpsb_packet *packet, u64 addr, int length)
44 {
45         PREP_ASYNC_HEAD_ADDRESS(TCODE_READB);
46         packet->header[3] = length << 16;
47         packet->header_size = 16;
48         packet->data_size = 0;
49         packet->expect_response = 1;
50 }
51
52 static void fill_async_writequad(struct hpsb_packet *packet, u64 addr, quadlet_t data)
53 {
54         PREP_ASYNC_HEAD_ADDRESS(TCODE_WRITEQ);
55         packet->header[3] = data;
56         packet->header_size = 16;
57         packet->data_size = 0;
58         packet->expect_response = 1;
59 }
60
61 static void fill_async_writeblock(struct hpsb_packet *packet, u64 addr, int length)
62 {
63         PREP_ASYNC_HEAD_ADDRESS(TCODE_WRITEB);
64         packet->header[3] = length << 16;
65         packet->header_size = 16;
66         packet->expect_response = 1;
67         packet->data_size = length + (length % 4 ? 4 - (length % 4) : 0);
68 }
69
70 static void fill_async_lock(struct hpsb_packet *packet, u64 addr, int extcode,
71                      int length)
72 {
73         PREP_ASYNC_HEAD_ADDRESS(TCODE_LOCK_REQUEST);
74         packet->header[3] = (length << 16) | extcode;
75         packet->header_size = 16;
76         packet->data_size = length;
77         packet->expect_response = 1;
78 }
79
80 static void fill_iso_packet(struct hpsb_packet *packet, int length, int channel,
81                      int tag, int sync)
82 {
83         packet->header[0] = (length << 16) | (tag << 14) | (channel << 8)
84                 | (TCODE_ISO_DATA << 4) | sync;
85
86         packet->header_size = 4;
87         packet->data_size = length;
88         packet->type = hpsb_iso;
89         packet->tcode = TCODE_ISO_DATA;
90 }
91
92 static void fill_phy_packet(struct hpsb_packet *packet, quadlet_t data)
93 {
94         packet->header[0] = data;
95         packet->header[1] = ~data;
96         packet->header_size = 8;
97         packet->data_size = 0;
98         packet->expect_response = 0;
99         packet->type = hpsb_raw;             /* No CRC added */
100         packet->speed_code = IEEE1394_SPEED_100; /* Force speed to be 100Mbps */
101 }
102
103 static void fill_async_stream_packet(struct hpsb_packet *packet, int length,
104                                      int channel, int tag, int sync)
105 {
106         packet->header[0] = (length << 16) | (tag << 14) | (channel << 8)
107                           | (TCODE_STREAM_DATA << 4) | sync;
108
109         packet->header_size = 4;
110         packet->data_size = length;
111         packet->type = hpsb_async;
112         packet->tcode = TCODE_ISO_DATA;
113 }
114
115 /**
116  * hpsb_get_tlabel - allocate a transaction label
117  * @packet: the packet who's tlabel/tpool we set
118  *
119  * Every asynchronous transaction on the 1394 bus needs a transaction
120  * label to match the response to the request.  This label has to be
121  * different from any other transaction label in an outstanding request to
122  * the same node to make matching possible without ambiguity.
123  *
124  * There are 64 different tlabels, so an allocated tlabel has to be freed
125  * with hpsb_free_tlabel() after the transaction is complete (unless it's
126  * reused again for the same target node).
127  *
128  * Return value: Zero on success, otherwise non-zero. A non-zero return
129  * generally means there are no available tlabels. If this is called out
130  * of interrupt or atomic context, then it will sleep until can return a
131  * tlabel.
132  */
133 int hpsb_get_tlabel(struct hpsb_packet *packet)
134 {
135         unsigned long flags;
136         struct hpsb_tlabel_pool *tp;
137
138         tp = &packet->host->tpool[packet->node_id & NODE_MASK];
139
140         if (irqs_disabled() || in_atomic()) {
141                 if (down_trylock(&tp->count))
142                         return 1;
143         } else {
144                 down(&tp->count);
145         }
146
147         spin_lock_irqsave(&tp->lock, flags);
148
149         packet->tlabel = find_next_zero_bit(tp->pool, 64, tp->next);
150         if (packet->tlabel > 63)
151                 packet->tlabel = find_first_zero_bit(tp->pool, 64);
152         tp->next = (packet->tlabel + 1) % 64;
153         /* Should _never_ happen */
154         BUG_ON(test_and_set_bit(packet->tlabel, tp->pool));
155         tp->allocations++;
156         spin_unlock_irqrestore(&tp->lock, flags);
157
158         return 0;
159 }
160
161 /**
162  * hpsb_free_tlabel - free an allocated transaction label
163  * @packet: packet whos tlabel/tpool needs to be cleared
164  *
165  * Frees the transaction label allocated with hpsb_get_tlabel().  The
166  * tlabel has to be freed after the transaction is complete (i.e. response
167  * was received for a split transaction or packet was sent for a unified
168  * transaction).
169  *
170  * A tlabel must not be freed twice.
171  */
172 void hpsb_free_tlabel(struct hpsb_packet *packet)
173 {
174         unsigned long flags;
175         struct hpsb_tlabel_pool *tp;
176
177         tp = &packet->host->tpool[packet->node_id & NODE_MASK];
178
179         BUG_ON(packet->tlabel > 63 || packet->tlabel < 0);
180
181         spin_lock_irqsave(&tp->lock, flags);
182         BUG_ON(!test_and_clear_bit(packet->tlabel, tp->pool));
183         spin_unlock_irqrestore(&tp->lock, flags);
184
185         up(&tp->count);
186 }
187
188
189
190 int hpsb_packet_success(struct hpsb_packet *packet)
191 {
192         switch (packet->ack_code) {
193         case ACK_PENDING:
194                 switch ((packet->header[1] >> 12) & 0xf) {
195                 case RCODE_COMPLETE:
196                         return 0;
197                 case RCODE_CONFLICT_ERROR:
198                         return -EAGAIN;
199                 case RCODE_DATA_ERROR:
200                         return -EREMOTEIO;
201                 case RCODE_TYPE_ERROR:
202                         return -EACCES;
203                 case RCODE_ADDRESS_ERROR:
204                         return -EINVAL;
205                 default:
206                         HPSB_ERR("received reserved rcode %d from node %d",
207                                  (packet->header[1] >> 12) & 0xf,
208                                  packet->node_id);
209                         return -EAGAIN;
210                 }
211                 HPSB_PANIC("reached unreachable code 1 in %s", __FUNCTION__);
212
213         case ACK_BUSY_X:
214         case ACK_BUSY_A:
215         case ACK_BUSY_B:
216                 return -EBUSY;
217
218         case ACK_TYPE_ERROR:
219                 return -EACCES;
220
221         case ACK_COMPLETE:
222                 if (packet->tcode == TCODE_WRITEQ
223                     || packet->tcode == TCODE_WRITEB) {
224                         return 0;
225                 } else {
226                         HPSB_ERR("impossible ack_complete from node %d "
227                                  "(tcode %d)", packet->node_id, packet->tcode);
228                         return -EAGAIN;
229                 }
230
231
232         case ACK_DATA_ERROR:
233                 if (packet->tcode == TCODE_WRITEB
234                     || packet->tcode == TCODE_LOCK_REQUEST) {
235                         return -EAGAIN;
236                 } else {
237                         HPSB_ERR("impossible ack_data_error from node %d "
238                                  "(tcode %d)", packet->node_id, packet->tcode);
239                         return -EAGAIN;
240                 }
241
242         case ACK_ADDRESS_ERROR:
243                 return -EINVAL;
244
245         case ACK_TARDY:
246         case ACK_CONFLICT_ERROR:
247         case ACKX_NONE:
248         case ACKX_SEND_ERROR:
249         case ACKX_ABORTED:
250         case ACKX_TIMEOUT:
251                 /* error while sending */
252                 return -EAGAIN;
253
254         default:
255                 HPSB_ERR("got invalid ack %d from node %d (tcode %d)",
256                          packet->ack_code, packet->node_id, packet->tcode);
257                 return -EAGAIN;
258         }
259
260         HPSB_PANIC("reached unreachable code 2 in %s", __FUNCTION__);
261 }
262
263 struct hpsb_packet *hpsb_make_readpacket(struct hpsb_host *host, nodeid_t node,
264                                          u64 addr, size_t length)
265 {
266         struct hpsb_packet *packet;
267
268         if (length == 0)
269                 return NULL;
270
271         packet = hpsb_alloc_packet(length);
272         if (!packet)
273                 return NULL;
274
275         packet->host = host;
276         packet->node_id = node;
277
278         if (hpsb_get_tlabel(packet)) {
279                 hpsb_free_packet(packet);
280                 return NULL;
281         }
282
283         if (length == 4)
284                 fill_async_readquad(packet, addr);
285         else
286                 fill_async_readblock(packet, addr, length);
287
288         return packet;
289 }
290
291 struct hpsb_packet *hpsb_make_writepacket (struct hpsb_host *host, nodeid_t node,
292                                            u64 addr, quadlet_t *buffer, size_t length)
293 {
294         struct hpsb_packet *packet;
295
296         if (length == 0)
297                 return NULL;
298
299         packet = hpsb_alloc_packet(length);
300         if (!packet)
301                 return NULL;
302
303         if (length % 4) { /* zero padding bytes */
304                 packet->data[length >> 2] = 0;
305         }
306         packet->host = host;
307         packet->node_id = node;
308
309         if (hpsb_get_tlabel(packet)) {
310                 hpsb_free_packet(packet);
311                 return NULL;
312         }
313
314         if (length == 4) {
315                 fill_async_writequad(packet, addr, buffer ? *buffer : 0);
316         } else {
317                 fill_async_writeblock(packet, addr, length);
318                 if (buffer)
319                         memcpy(packet->data, buffer, length);
320         }
321
322         return packet;
323 }
324
325 struct hpsb_packet *hpsb_make_streampacket(struct hpsb_host *host, u8 *buffer, int length,
326                                            int channel, int tag, int sync)
327 {
328         struct hpsb_packet *packet;
329
330         if (length == 0)
331                 return NULL;
332
333         packet = hpsb_alloc_packet(length);
334         if (!packet)
335                 return NULL;
336
337         if (length % 4) { /* zero padding bytes */
338                 packet->data[length >> 2] = 0;
339         }
340         packet->host = host;
341
342         if (hpsb_get_tlabel(packet)) {
343                 hpsb_free_packet(packet);
344                 return NULL;
345         }
346
347         fill_async_stream_packet(packet, length, channel, tag, sync);
348         if (buffer)
349                 memcpy(packet->data, buffer, length);
350
351         return packet;
352 }
353
354 struct hpsb_packet *hpsb_make_lockpacket(struct hpsb_host *host, nodeid_t node,
355                                          u64 addr, int extcode, quadlet_t *data,
356                                          quadlet_t arg)
357 {
358         struct hpsb_packet *p;
359         u32 length;
360
361         p = hpsb_alloc_packet(8);
362         if (!p) return NULL;
363
364         p->host = host;
365         p->node_id = node;
366         if (hpsb_get_tlabel(p)) {
367                 hpsb_free_packet(p);
368                 return NULL;
369         }
370
371         switch (extcode) {
372         case EXTCODE_FETCH_ADD:
373         case EXTCODE_LITTLE_ADD:
374                 length = 4;
375                 if (data)
376                         p->data[0] = *data;
377                 break;
378         default:
379                 length = 8;
380                 if (data) {
381                         p->data[0] = arg;
382                         p->data[1] = *data;
383                 }
384                 break;
385         }
386         fill_async_lock(p, addr, extcode, length);
387
388         return p;
389 }
390
391 struct hpsb_packet *hpsb_make_lock64packet(struct hpsb_host *host, nodeid_t node,
392                                            u64 addr, int extcode, octlet_t *data,
393                                            octlet_t arg)
394 {
395         struct hpsb_packet *p;
396         u32 length;
397
398         p = hpsb_alloc_packet(16);
399         if (!p) return NULL;
400
401         p->host = host;
402         p->node_id = node;
403         if (hpsb_get_tlabel(p)) {
404                 hpsb_free_packet(p);
405                 return NULL;
406         }
407
408         switch (extcode) {
409         case EXTCODE_FETCH_ADD:
410         case EXTCODE_LITTLE_ADD:
411                 length = 8;
412                 if (data) {
413                         p->data[0] = *data >> 32;
414                         p->data[1] = *data & 0xffffffff;
415                 }
416                 break;
417         default:
418                 length = 16;
419                 if (data) {
420                         p->data[0] = arg >> 32;
421                         p->data[1] = arg & 0xffffffff;
422                         p->data[2] = *data >> 32;
423                         p->data[3] = *data & 0xffffffff;
424                 }
425                 break;
426         }
427         fill_async_lock(p, addr, extcode, length);
428
429         return p;
430 }
431
432 struct hpsb_packet *hpsb_make_phypacket(struct hpsb_host *host,
433                                         quadlet_t data)
434 {
435         struct hpsb_packet *p;
436
437         p = hpsb_alloc_packet(0);
438         if (!p) return NULL;
439
440         p->host = host;
441         fill_phy_packet(p, data);
442
443         return p;
444 }
445
446 struct hpsb_packet *hpsb_make_isopacket(struct hpsb_host *host,
447                                         int length, int channel,
448                                         int tag, int sync)
449 {
450         struct hpsb_packet *p;
451
452         p = hpsb_alloc_packet(length);
453         if (!p) return NULL;
454
455         p->host = host;
456         fill_iso_packet(p, length, channel, tag, sync);
457
458         p->generation = get_hpsb_generation(host);
459
460         return p;
461 }
462
463 /*
464  * FIXME - these functions should probably read from / write to user space to
465  * avoid in kernel buffers for user space callers
466  */
467
468 int hpsb_read(struct hpsb_host *host, nodeid_t node, unsigned int generation,
469               u64 addr, quadlet_t *buffer, size_t length)
470 {
471         struct hpsb_packet *packet;
472         int retval = 0;
473
474         if (length == 0)
475                 return -EINVAL;
476
477         BUG_ON(in_interrupt()); // We can't be called in an interrupt, yet
478
479         packet = hpsb_make_readpacket(host, node, addr, length);
480
481         if (!packet) {
482                 return -ENOMEM;
483         }
484
485         packet->generation = generation;
486         retval = hpsb_send_packet_and_wait(packet);
487         if (retval < 0)
488                 goto hpsb_read_fail;
489
490         retval = hpsb_packet_success(packet);
491
492         if (retval == 0) {
493                 if (length == 4) {
494                         *buffer = packet->header[3];
495                 } else {
496                         memcpy(buffer, packet->data, length);
497                 }
498         }
499
500 hpsb_read_fail:
501         hpsb_free_tlabel(packet);
502         hpsb_free_packet(packet);
503
504         return retval;
505 }
506
507
508 int hpsb_write(struct hpsb_host *host, nodeid_t node, unsigned int generation,
509                u64 addr, quadlet_t *buffer, size_t length)
510 {
511         struct hpsb_packet *packet;
512         int retval;
513
514         if (length == 0)
515                 return -EINVAL;
516
517         BUG_ON(in_interrupt()); // We can't be called in an interrupt, yet
518
519         packet = hpsb_make_writepacket (host, node, addr, buffer, length);
520
521         if (!packet)
522                 return -ENOMEM;
523
524         packet->generation = generation;
525         retval = hpsb_send_packet_and_wait(packet);
526         if (retval < 0)
527                 goto hpsb_write_fail;
528
529         retval = hpsb_packet_success(packet);
530
531 hpsb_write_fail:
532         hpsb_free_tlabel(packet);
533         hpsb_free_packet(packet);
534
535         return retval;
536 }
537
538 #if 0
539
540 int hpsb_lock(struct hpsb_host *host, nodeid_t node, unsigned int generation,
541               u64 addr, int extcode, quadlet_t *data, quadlet_t arg)
542 {
543         struct hpsb_packet *packet;
544         int retval = 0;
545
546         BUG_ON(in_interrupt()); // We can't be called in an interrupt, yet
547
548         packet = hpsb_make_lockpacket(host, node, addr, extcode, data, arg);
549         if (!packet)
550                 return -ENOMEM;
551
552         packet->generation = generation;
553         retval = hpsb_send_packet_and_wait(packet);
554         if (retval < 0)
555                 goto hpsb_lock_fail;
556
557         retval = hpsb_packet_success(packet);
558
559         if (retval == 0) {
560                 *data = packet->data[0];
561         }
562
563 hpsb_lock_fail:
564         hpsb_free_tlabel(packet);
565         hpsb_free_packet(packet);
566
567         return retval;
568 }
569
570
571 int hpsb_send_gasp(struct hpsb_host *host, int channel, unsigned int generation,
572                    quadlet_t *buffer, size_t length, u32 specifier_id,
573                    unsigned int version)
574 {
575         struct hpsb_packet *packet;
576         int retval = 0;
577         u16 specifier_id_hi = (specifier_id & 0x00ffff00) >> 8;
578         u8 specifier_id_lo = specifier_id & 0xff;
579
580         HPSB_VERBOSE("Send GASP: channel = %d, length = %Zd", channel, length);
581
582         length += 8;
583
584         packet = hpsb_make_streampacket(host, NULL, length, channel, 3, 0);
585         if (!packet)
586                 return -ENOMEM;
587
588         packet->data[0] = cpu_to_be32((host->node_id << 16) | specifier_id_hi);
589         packet->data[1] = cpu_to_be32((specifier_id_lo << 24) | (version & 0x00ffffff));
590
591         memcpy(&(packet->data[2]), buffer, length - 8);
592
593         packet->generation = generation;
594
595         packet->no_waiter = 1;
596
597         retval = hpsb_send_packet(packet);
598         if (retval < 0)
599                 hpsb_free_packet(packet);
600
601         return retval;
602 }
603
604 #endif  /*  0  */