patch-2_6_7-vs1_9_1_12
[linux-2.6.git] / drivers / ieee1394 / highlevel.c
1 /*
2  * IEEE 1394 for Linux
3  *
4  * Copyright (C) 1999 Andreas E. Bombe
5  *
6  * This code is licensed under the GPL.  See the file COPYING in the root
7  * directory of the kernel sources for details.
8  *
9  *
10  * Contributions:
11  *
12  * Christian Toegel <christian.toegel@gmx.at>
13  *        unregister address space
14  *
15  * Manfred Weihs <weihs@ict.tuwien.ac.at>
16  *        unregister address space
17  *
18  */
19
20 #include <linux/config.h>
21 #include <linux/slab.h>
22 #include <linux/list.h>
23 #include <linux/bitops.h>
24
25 #include "ieee1394.h"
26 #include "ieee1394_types.h"
27 #include "hosts.h"
28 #include "ieee1394_core.h"
29 #include "highlevel.h"
30 #include "nodemgr.h"
31
32
33 struct hl_host_info {
34         struct list_head list;
35         struct hpsb_host *host;
36         size_t size;
37         unsigned long key;
38         void *data;
39 };
40
41
42 static LIST_HEAD(hl_drivers);
43 static DECLARE_RWSEM(hl_drivers_sem);
44
45 static LIST_HEAD(hl_irqs);
46 static rwlock_t hl_irqs_lock = RW_LOCK_UNLOCKED;
47
48 static rwlock_t addr_space_lock = RW_LOCK_UNLOCKED;
49
50 /* addr_space list will have zero and max already included as bounds */
51 static struct hpsb_address_ops dummy_ops = { NULL, NULL, NULL, NULL };
52 static struct hpsb_address_serve dummy_zero_addr, dummy_max_addr;
53
54
55 static struct hl_host_info *hl_get_hostinfo(struct hpsb_highlevel *hl,
56                                               struct hpsb_host *host)
57 {
58         struct hl_host_info *hi = NULL;
59
60         if (!hl || !host)
61                 return NULL;
62
63         read_lock(&hl->host_info_lock);
64         list_for_each_entry(hi, &hl->host_info_list, list) {
65                 if (hi->host == host) {
66                         read_unlock(&hl->host_info_lock);
67                         return hi;
68                 }
69         }
70         read_unlock(&hl->host_info_lock);
71
72         return NULL;
73 }
74
75
76 /* Returns a per host/driver data structure that was previously stored by
77  * hpsb_create_hostinfo. */
78 void *hpsb_get_hostinfo(struct hpsb_highlevel *hl, struct hpsb_host *host)
79 {
80         struct hl_host_info *hi = hl_get_hostinfo(hl, host);
81
82         if (hi)
83                 return hi->data;
84
85         return NULL;
86 }
87
88
89 /* If size is zero, then the return here is only valid for error checking */
90 void *hpsb_create_hostinfo(struct hpsb_highlevel *hl, struct hpsb_host *host,
91                            size_t data_size)
92 {
93         struct hl_host_info *hi;
94         void *data;
95         unsigned long flags;
96
97         hi = hl_get_hostinfo(hl, host);
98         if (hi) {
99                 HPSB_ERR("%s called hpsb_create_hostinfo when hostinfo already exists",
100                          hl->name);
101                 return NULL;
102         }
103
104         hi = kmalloc(sizeof(*hi) + data_size, GFP_ATOMIC);
105         if (!hi)
106                 return NULL;
107
108         memset(hi, 0, sizeof(*hi) + data_size);
109
110         if (data_size) {
111                 data = hi->data = hi + 1;
112                 hi->size = data_size;
113         } else
114                 data = hi;
115
116         hi->host = host;
117
118         write_lock_irqsave(&hl->host_info_lock, flags);
119         list_add_tail(&hi->list, &hl->host_info_list);
120         write_unlock_irqrestore(&hl->host_info_lock, flags);
121
122         return data;
123 }
124
125
126 int hpsb_set_hostinfo(struct hpsb_highlevel *hl, struct hpsb_host *host,
127                       void *data)
128 {
129         struct hl_host_info *hi;
130
131         hi = hl_get_hostinfo(hl, host);
132         if (hi) {
133                 if (!hi->size && !hi->data) {
134                         hi->data = data;
135                         return 0;
136                 } else
137                         HPSB_ERR("%s called hpsb_set_hostinfo when hostinfo already has data",
138                                  hl->name);
139         } else
140                 HPSB_ERR("%s called hpsb_set_hostinfo when no hostinfo exists",
141                          hl->name);
142
143         return -EINVAL;
144 }
145
146
147 void hpsb_destroy_hostinfo(struct hpsb_highlevel *hl, struct hpsb_host *host)
148 {
149         struct hl_host_info *hi;
150
151         hi = hl_get_hostinfo(hl, host);
152         if (hi) {
153                 unsigned long flags;
154                 write_lock_irqsave(&hl->host_info_lock, flags);
155                 list_del(&hi->list);
156                 write_unlock_irqrestore(&hl->host_info_lock, flags);
157                 kfree(hi);
158         }
159
160         return;
161 }
162
163
164 void hpsb_set_hostinfo_key(struct hpsb_highlevel *hl, struct hpsb_host *host, unsigned long key)
165 {
166         struct hl_host_info *hi;
167
168         hi = hl_get_hostinfo(hl, host);
169         if (hi)
170                 hi->key = key;
171
172         return;
173 }
174
175
176 unsigned long hpsb_get_hostinfo_key(struct hpsb_highlevel *hl, struct hpsb_host *host)
177 {
178         struct hl_host_info *hi;
179
180         hi = hl_get_hostinfo(hl, host);
181         if (hi)
182                 return hi->key;
183
184         return 0;
185 }
186
187
188 void *hpsb_get_hostinfo_bykey(struct hpsb_highlevel *hl, unsigned long key)
189 {
190         struct hl_host_info *hi;
191         void *data = NULL;
192
193         if (!hl)
194                 return NULL;
195
196         read_lock(&hl->host_info_lock);
197         list_for_each_entry(hi, &hl->host_info_list, list) {
198                 if (hi->key == key) {
199                         data = hi->data;
200                         break;
201                 }
202         }
203         read_unlock(&hl->host_info_lock);
204
205         return data;
206 }
207
208
209 struct hpsb_host *hpsb_get_host_bykey(struct hpsb_highlevel *hl, unsigned long key)
210 {
211         struct hl_host_info *hi;
212         struct hpsb_host *host = NULL;
213
214         if (!hl)
215                 return NULL;
216
217         read_lock(&hl->host_info_lock);
218         list_for_each_entry(hi, &hl->host_info_list, list) {
219                 if (hi->key == key) {
220                         host = hi->host;
221                         break;
222                 }
223         }
224         read_unlock(&hl->host_info_lock);
225
226         return host;
227 }
228
229 static int highlevel_for_each_host_reg(struct hpsb_host *host, void *__data)
230 {
231         struct hpsb_highlevel *hl = __data;
232
233         hl->add_host(host);
234
235         if (host->update_config_rom) {
236                 if (hpsb_update_config_rom_image(host) < 0) {
237                         HPSB_ERR("Failed to generate Configuration ROM image for host "
238                                  "%s-%d", hl->name, host->id);
239                 }
240         }
241
242         return 0;
243 }
244
245 void hpsb_register_highlevel(struct hpsb_highlevel *hl)
246 {
247         INIT_LIST_HEAD(&hl->addr_list);
248         INIT_LIST_HEAD(&hl->host_info_list);
249
250         rwlock_init(&hl->host_info_lock);
251
252         down_write(&hl_drivers_sem);
253         list_add_tail(&hl->hl_list, &hl_drivers);
254         up_write(&hl_drivers_sem);
255
256         write_lock(&hl_irqs_lock);
257         list_add_tail(&hl->irq_list, &hl_irqs);
258         write_unlock(&hl_irqs_lock);
259
260         if (hl->add_host)
261                 nodemgr_for_each_host(hl, highlevel_for_each_host_reg);
262
263         return;
264 }
265
266 static void __delete_addr(struct hpsb_address_serve *as)
267 {
268         list_del(&as->host_list);
269         list_del(&as->hl_list);
270         kfree(as);
271 }
272
273 static void __unregister_host(struct hpsb_highlevel *hl, struct hpsb_host *host, int update_cr)
274 {
275         unsigned long flags;
276         struct list_head *lh, *next;
277         struct hpsb_address_serve *as;
278
279         /* First, let the highlevel driver unreg */
280         if (hl->remove_host)
281                 hl->remove_host(host);
282
283         /* Remove any addresses that are matched for this highlevel driver
284          * and this particular host. */
285         write_lock_irqsave(&addr_space_lock, flags);
286         list_for_each_safe (lh, next, &hl->addr_list) {
287                 as = list_entry(lh, struct hpsb_address_serve, hl_list);
288
289                 if (as->host == host)
290                         __delete_addr(as);
291         }
292         write_unlock_irqrestore(&addr_space_lock, flags);
293
294         /* Now update the config-rom to reflect anything removed by the
295          * highlevel driver. */
296         if (update_cr && host->update_config_rom) {
297                 if (hpsb_update_config_rom_image(host) < 0) {
298                         HPSB_ERR("Failed to generate Configuration ROM image for host "
299                                  "%s-%d", hl->name, host->id);
300                 }
301         }
302
303         /* And finally, remove all the host info associated between these
304          * two. */
305         hpsb_destroy_hostinfo(hl, host);
306 }
307
308 static int highlevel_for_each_host_unreg(struct hpsb_host *host, void *__data)
309 {
310         struct hpsb_highlevel *hl = __data;
311
312         __unregister_host(hl, host, 1);
313
314         return 0;
315 }
316
317 void hpsb_unregister_highlevel(struct hpsb_highlevel *hl)
318 {
319         write_lock(&hl_irqs_lock);
320         list_del(&hl->irq_list);
321         write_unlock(&hl_irqs_lock);
322
323         down_write(&hl_drivers_sem);
324         list_del(&hl->hl_list);
325         up_write(&hl_drivers_sem);
326
327         nodemgr_for_each_host(hl, highlevel_for_each_host_unreg);
328 }
329
330 u64 hpsb_allocate_and_register_addrspace(struct hpsb_highlevel *hl,
331                                          struct hpsb_host *host,
332                                          struct hpsb_address_ops *ops,
333                                          u64 size, u64 alignment,
334                                          u64 start, u64 end)
335 {
336         struct hpsb_address_serve *as, *a1, *a2;
337         struct list_head *entry;
338         u64 retval = ~0ULL;
339         unsigned long flags;
340         u64 align_mask = ~(alignment - 1);
341
342         if ((alignment & 3) || (alignment > 0x800000000000ULL) ||
343             ((hweight32(alignment >> 32) +
344               hweight32(alignment & 0xffffffff) != 1))) {
345                 HPSB_ERR("%s called with invalid alignment: 0x%048llx",
346                          __FUNCTION__, (unsigned long long)alignment);
347                 return retval;
348         }
349
350         if (start == ~0ULL && end == ~0ULL) {
351                 start = CSR1212_ALL_SPACE_BASE + 0xffff00000000ULL;  /* ohci1394.c limit */
352                 end = CSR1212_ALL_SPACE_END;
353         }
354
355         if (((start|end) & ~align_mask) || (start >= end) || (end > 0x1000000000000ULL)) {
356                 HPSB_ERR("%s called with invalid addresses (start = %012Lx    end = %012Lx)",
357                          __FUNCTION__, (unsigned long long)start, (unsigned long long)end);
358                 return retval;
359         }
360
361         as = (struct hpsb_address_serve *)
362                 kmalloc(sizeof(struct hpsb_address_serve), GFP_KERNEL);
363         if (as == NULL) {
364                 return retval;
365         }
366
367         INIT_LIST_HEAD(&as->host_list);
368         INIT_LIST_HEAD(&as->hl_list);
369         as->op = ops;
370         as->host = host;
371
372         write_lock_irqsave(&addr_space_lock, flags);
373
374         list_for_each(entry, &host->addr_space) {
375                 u64 a1sa, a1ea;
376                 u64 a2sa, a2ea;
377
378                 a1 = list_entry(entry, struct hpsb_address_serve, host_list);
379                 a2 = list_entry(entry->next, struct hpsb_address_serve, host_list);
380
381                 a1sa = a1->start & align_mask;
382                 a1ea = (a1->end + alignment -1) & align_mask;
383                 a2sa = a2->start & align_mask;
384                 a2ea = (a2->end + alignment -1) & align_mask;
385
386                 if ((a2sa - a1ea >= size) && (a2sa - start >= size) && (a2sa > start)) {
387                         as->start = max(start, a1ea);
388                         as->end = as->start + size;
389                         list_add(&as->host_list, entry);
390                         list_add_tail(&as->hl_list, &hl->addr_list);
391                         retval = as->start;
392                         break;
393                 }
394         }
395
396         write_unlock_irqrestore(&addr_space_lock, flags);
397
398         if (retval == ~0ULL) {
399                 kfree(as);
400         }
401
402         return retval;
403 }
404
405 int hpsb_register_addrspace(struct hpsb_highlevel *hl, struct hpsb_host *host,
406                             struct hpsb_address_ops *ops, u64 start, u64 end)
407 {
408         struct hpsb_address_serve *as;
409         struct list_head *lh;
410         int retval = 0;
411         unsigned long flags;
412
413         if (((start|end) & 3) || (start >= end) || (end > 0x1000000000000ULL)) {
414                 HPSB_ERR("%s called with invalid addresses", __FUNCTION__);
415                 return 0;
416         }
417
418         as = (struct hpsb_address_serve *)
419                 kmalloc(sizeof(struct hpsb_address_serve), GFP_KERNEL);
420         if (as == NULL) {
421                 return 0;
422         }
423
424         INIT_LIST_HEAD(&as->host_list);
425         INIT_LIST_HEAD(&as->hl_list);
426         as->op = ops;
427         as->start = start;
428         as->end = end;
429         as->host = host;
430
431         write_lock_irqsave(&addr_space_lock, flags);
432
433         list_for_each(lh, &host->addr_space) {
434                 struct hpsb_address_serve *as_this =
435                         list_entry(lh, struct hpsb_address_serve, host_list);
436                 struct hpsb_address_serve *as_next =
437                         list_entry(lh->next, struct hpsb_address_serve, host_list);
438
439                 if (as_this->end > as->start)
440                         break;
441
442                 if (as_next->start >= as->end) {
443                         list_add(&as->host_list, lh);
444                         list_add_tail(&as->hl_list, &hl->addr_list);
445                         retval = 1;
446                         break;
447                 }
448         }
449         write_unlock_irqrestore(&addr_space_lock, flags);
450
451         if (retval == 0)
452                 kfree(as);
453
454         return retval;
455 }
456
457 int hpsb_unregister_addrspace(struct hpsb_highlevel *hl, struct hpsb_host *host,
458                               u64 start)
459 {
460         int retval = 0;
461         struct hpsb_address_serve *as;
462         struct list_head *lh, *next;
463         unsigned long flags;
464
465         write_lock_irqsave(&addr_space_lock, flags);
466
467         list_for_each_safe (lh, next, &hl->addr_list) {
468                 as = list_entry(lh, struct hpsb_address_serve, hl_list);
469                 if (as->start == start && as->host == host) {
470                         __delete_addr(as);
471                         retval = 1;
472                         break;
473                 }
474         }
475
476         write_unlock_irqrestore(&addr_space_lock, flags);
477
478         return retval;
479 }
480
481 int hpsb_listen_channel(struct hpsb_highlevel *hl, struct hpsb_host *host,
482                          unsigned int channel)
483 {
484         if (channel > 63) {
485                 HPSB_ERR("%s called with invalid channel", __FUNCTION__);
486                 return -EINVAL;
487         }
488
489         if (host->iso_listen_count[channel]++ == 0) {
490                 return host->driver->devctl(host, ISO_LISTEN_CHANNEL, channel);
491         }
492
493         return 0;
494 }
495
496 void hpsb_unlisten_channel(struct hpsb_highlevel *hl, struct hpsb_host *host,
497                            unsigned int channel)
498 {
499         if (channel > 63) {
500                 HPSB_ERR("%s called with invalid channel", __FUNCTION__);
501                 return;
502         }
503
504         if (--host->iso_listen_count[channel] == 0) {
505                 host->driver->devctl(host, ISO_UNLISTEN_CHANNEL, channel);
506         }
507 }
508
509 static void init_hpsb_highlevel(struct hpsb_host *host)
510 {
511         INIT_LIST_HEAD(&dummy_zero_addr.host_list);
512         INIT_LIST_HEAD(&dummy_zero_addr.hl_list);
513         INIT_LIST_HEAD(&dummy_max_addr.host_list);
514         INIT_LIST_HEAD(&dummy_max_addr.hl_list);
515
516         dummy_zero_addr.op = dummy_max_addr.op = &dummy_ops;
517
518         dummy_zero_addr.start = dummy_zero_addr.end = 0;
519         dummy_max_addr.start = dummy_max_addr.end = ((u64) 1) << 48;
520
521         list_add_tail(&dummy_zero_addr.host_list, &host->addr_space);
522         list_add_tail(&dummy_max_addr.host_list, &host->addr_space);
523 }
524
525 void highlevel_add_host(struct hpsb_host *host)
526 {
527         struct hpsb_highlevel *hl;
528
529         init_hpsb_highlevel(host);
530
531         down_read(&hl_drivers_sem);
532         list_for_each_entry(hl, &hl_drivers, hl_list) {
533                 if (hl->add_host)
534                         hl->add_host(host);
535         }
536         up_read(&hl_drivers_sem);
537         if (host->update_config_rom) {
538                 if (hpsb_update_config_rom_image(host) < 0)
539                         HPSB_ERR("Failed to generate Configuration ROM image for "
540                                  "host %s-%d", hl->name, host->id);
541         }
542 }
543
544 void highlevel_remove_host(struct hpsb_host *host)
545 {
546         struct hpsb_highlevel *hl;
547
548         down_read(&hl_drivers_sem);
549         list_for_each_entry(hl, &hl_drivers, hl_list)
550                 __unregister_host(hl, host, 0);
551         up_read(&hl_drivers_sem);
552 }
553
554 void highlevel_host_reset(struct hpsb_host *host)
555 {
556         struct hpsb_highlevel *hl;
557
558         read_lock(&hl_irqs_lock);
559         list_for_each_entry(hl, &hl_irqs, irq_list) {
560                 if (hl->host_reset)
561                         hl->host_reset(host);
562         }
563         read_unlock(&hl_irqs_lock);
564 }
565
566 void highlevel_iso_receive(struct hpsb_host *host, void *data, size_t length)
567 {
568         struct hpsb_highlevel *hl;
569         int channel = (((quadlet_t *)data)[0] >> 8) & 0x3f;
570
571         read_lock(&hl_irqs_lock);
572         list_for_each_entry(hl, &hl_irqs, irq_list) {
573                 if (hl->iso_receive)
574                         hl->iso_receive(host, channel, data, length);
575         }
576         read_unlock(&hl_irqs_lock);
577 }
578
579 void highlevel_fcp_request(struct hpsb_host *host, int nodeid, int direction,
580                            void *data, size_t length)
581 {
582         struct hpsb_highlevel *hl;
583         int cts = ((quadlet_t *)data)[0] >> 4;
584
585         read_lock(&hl_irqs_lock);
586         list_for_each_entry(hl, &hl_irqs, irq_list) {
587                 if (hl->fcp_request)
588                         hl->fcp_request(host, nodeid, direction, cts, data,
589                                         length);
590         }
591         read_unlock(&hl_irqs_lock);
592 }
593
594 int highlevel_read(struct hpsb_host *host, int nodeid, void *data,
595                    u64 addr, unsigned int length, u16 flags)
596 {
597         struct hpsb_address_serve *as;
598         unsigned int partlength;
599         int rcode = RCODE_ADDRESS_ERROR;
600
601         read_lock(&addr_space_lock);
602
603         list_for_each_entry(as, &host->addr_space, host_list) {
604                 if (as->start > addr)
605                         break;
606
607                 if (as->end > addr) {
608                         partlength = min(as->end - addr, (u64) length);
609
610                         if (as->op->read) {
611                                 rcode = as->op->read(host, nodeid, data,
612                                                      addr, partlength, flags);
613                         } else {
614                                 rcode = RCODE_TYPE_ERROR;
615                         }
616
617                         data += partlength;
618                         length -= partlength;
619                         addr += partlength;
620
621                         if ((rcode != RCODE_COMPLETE) || !length) {
622                                 break;
623                         }
624                 }
625         }
626
627         read_unlock(&addr_space_lock);
628
629         if (length && (rcode == RCODE_COMPLETE)) {
630                 rcode = RCODE_ADDRESS_ERROR;
631         }
632
633         return rcode;
634 }
635
636 int highlevel_write(struct hpsb_host *host, int nodeid, int destid,
637                     void *data, u64 addr, unsigned int length, u16 flags)
638 {
639         struct hpsb_address_serve *as;
640         unsigned int partlength;
641         int rcode = RCODE_ADDRESS_ERROR;
642
643         read_lock(&addr_space_lock);
644
645         list_for_each_entry(as, &host->addr_space, host_list) {
646                 if (as->start > addr)
647                         break;
648
649                 if (as->end > addr) {
650                         partlength = min(as->end - addr, (u64) length);
651
652                         if (as->op->write) {
653                                 rcode = as->op->write(host, nodeid, destid,
654                                                       data, addr, partlength, flags);
655                         } else {
656                                 rcode = RCODE_TYPE_ERROR;
657                         }
658
659                         data += partlength;
660                         length -= partlength;
661                         addr += partlength;
662
663                         if ((rcode != RCODE_COMPLETE) || !length) {
664                                 break;
665                         }
666                 }
667         }
668
669         read_unlock(&addr_space_lock);
670
671         if (length && (rcode == RCODE_COMPLETE)) {
672                 rcode = RCODE_ADDRESS_ERROR;
673         }
674
675         return rcode;
676 }
677
678
679 int highlevel_lock(struct hpsb_host *host, int nodeid, quadlet_t *store,
680                    u64 addr, quadlet_t data, quadlet_t arg, int ext_tcode, u16 flags)
681 {
682         struct hpsb_address_serve *as;
683         int rcode = RCODE_ADDRESS_ERROR;
684
685         read_lock(&addr_space_lock);
686
687         list_for_each_entry(as, &host->addr_space, host_list) {
688                 if (as->start > addr)
689                         break;
690
691                 if (as->end > addr) {
692                         if (as->op->lock) {
693                                 rcode = as->op->lock(host, nodeid, store, addr,
694                                                      data, arg, ext_tcode, flags);
695                         } else {
696                                 rcode = RCODE_TYPE_ERROR;
697                         }
698
699                         break;
700                 }
701         }
702
703         read_unlock(&addr_space_lock);
704
705         return rcode;
706 }
707
708 int highlevel_lock64(struct hpsb_host *host, int nodeid, octlet_t *store,
709                      u64 addr, octlet_t data, octlet_t arg, int ext_tcode, u16 flags)
710 {
711         struct hpsb_address_serve *as;
712         int rcode = RCODE_ADDRESS_ERROR;
713
714         read_lock(&addr_space_lock);
715
716         list_for_each_entry(as, &host->addr_space, host_list) {
717                 if (as->start > addr)
718                         break;
719
720                 if (as->end > addr) {
721                         if (as->op->lock64) {
722                                 rcode = as->op->lock64(host, nodeid, store,
723                                                        addr, data, arg,
724                                                        ext_tcode, flags);
725                         } else {
726                                 rcode = RCODE_TYPE_ERROR;
727                         }
728
729                         break;
730                 }
731         }
732
733         read_unlock(&addr_space_lock);
734
735         return rcode;
736 }