1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36#define KMSG_COMPONENT "iucv"
37#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
38
39#include <linux/kernel_stat.h>
40#include <linux/module.h>
41#include <linux/moduleparam.h>
42#include <linux/spinlock.h>
43#include <linux/kernel.h>
44#include <linux/slab.h>
45#include <linux/init.h>
46#include <linux/interrupt.h>
47#include <linux/list.h>
48#include <linux/errno.h>
49#include <linux/err.h>
50#include <linux/device.h>
51#include <linux/cpu.h>
52#include <linux/reboot.h>
53#include <net/iucv/iucv.h>
54#include <linux/atomic.h>
55#include <asm/ebcdic.h>
56#include <asm/io.h>
57#include <asm/irq.h>
58#include <asm/smp.h>
59
60
61
62
63
64
65
66
67
68
69
70
71#define IUCV_IPSRCCLS 0x01
72#define IUCV_IPTRGCLS 0x01
73#define IUCV_IPFGPID 0x02
74#define IUCV_IPFGMID 0x04
75#define IUCV_IPNORPY 0x10
76#define IUCV_IPALL 0x80
77
78static int iucv_bus_match(struct device *dev, struct device_driver *drv)
79{
80 return 0;
81}
82
83enum iucv_pm_states {
84 IUCV_PM_INITIAL = 0,
85 IUCV_PM_FREEZING = 1,
86 IUCV_PM_THAWING = 2,
87 IUCV_PM_RESTORING = 3,
88};
89static enum iucv_pm_states iucv_pm_state;
90
91static int iucv_pm_prepare(struct device *);
92static void iucv_pm_complete(struct device *);
93static int iucv_pm_freeze(struct device *);
94static int iucv_pm_thaw(struct device *);
95static int iucv_pm_restore(struct device *);
96
97static const struct dev_pm_ops iucv_pm_ops = {
98 .prepare = iucv_pm_prepare,
99 .complete = iucv_pm_complete,
100 .freeze = iucv_pm_freeze,
101 .thaw = iucv_pm_thaw,
102 .restore = iucv_pm_restore,
103};
104
105struct bus_type iucv_bus = {
106 .name = "iucv",
107 .match = iucv_bus_match,
108 .pm = &iucv_pm_ops,
109};
110EXPORT_SYMBOL(iucv_bus);
111
112struct device *iucv_root;
113EXPORT_SYMBOL(iucv_root);
114
115static int iucv_available;
116
117
118struct iucv_irq_data {
119 u16 ippathid;
120 u8 ipflags1;
121 u8 iptype;
122 u32 res2[8];
123};
124
125struct iucv_irq_list {
126 struct list_head list;
127 struct iucv_irq_data data;
128};
129
130static struct iucv_irq_data *iucv_irq_data[NR_CPUS];
131static cpumask_t iucv_buffer_cpumask = { CPU_BITS_NONE };
132static cpumask_t iucv_irq_cpumask = { CPU_BITS_NONE };
133
134
135
136
137
138static LIST_HEAD(iucv_task_queue);
139
140
141
142
143static void iucv_tasklet_fn(unsigned long);
144static DECLARE_TASKLET(iucv_tasklet, iucv_tasklet_fn,0);
145
146
147
148
149
150static LIST_HEAD(iucv_work_queue);
151
152
153
154
155static void iucv_work_fn(struct work_struct *work);
156static DECLARE_WORK(iucv_work, iucv_work_fn);
157
158
159
160
161static DEFINE_SPINLOCK(iucv_queue_lock);
162
163enum iucv_command_codes {
164 IUCV_QUERY = 0,
165 IUCV_RETRIEVE_BUFFER = 2,
166 IUCV_SEND = 4,
167 IUCV_RECEIVE = 5,
168 IUCV_REPLY = 6,
169 IUCV_REJECT = 8,
170 IUCV_PURGE = 9,
171 IUCV_ACCEPT = 10,
172 IUCV_CONNECT = 11,
173 IUCV_DECLARE_BUFFER = 12,
174 IUCV_QUIESCE = 13,
175 IUCV_RESUME = 14,
176 IUCV_SEVER = 15,
177 IUCV_SETMASK = 16,
178 IUCV_SETCONTROLMASK = 17,
179};
180
181
182
183
184
185static char iucv_error_no_listener[16] = "NO LISTENER";
186static char iucv_error_no_memory[16] = "NO MEMORY";
187static char iucv_error_pathid[16] = "INVALID PATHID";
188
189
190
191
192static LIST_HEAD(iucv_handler_list);
193
194
195
196
197static struct iucv_path **iucv_path_table;
198static unsigned long iucv_max_pathid;
199
200
201
202
203static DEFINE_SPINLOCK(iucv_table_lock);
204
205
206
207
208
209static int iucv_active_cpu = -1;
210
211
212
213
214static DEFINE_MUTEX(iucv_register_mutex);
215
216
217
218
219static int iucv_nonsmp_handler;
220
221
222
223
224
225struct iucv_cmd_control {
226 u16 ippathid;
227 u8 ipflags1;
228 u8 iprcode;
229 u16 ipmsglim;
230 u16 res1;
231 u8 ipvmid[8];
232 u8 ipuser[16];
233 u8 iptarget[8];
234} __attribute__ ((packed,aligned(8)));
235
236
237
238
239
240struct iucv_cmd_dpl {
241 u16 ippathid;
242 u8 ipflags1;
243 u8 iprcode;
244 u32 ipmsgid;
245 u32 iptrgcls;
246 u8 iprmmsg[8];
247 u32 ipsrccls;
248 u32 ipmsgtag;
249 u32 ipbfadr2;
250 u32 ipbfln2f;
251 u32 res;
252} __attribute__ ((packed,aligned(8)));
253
254
255
256
257
258
259struct iucv_cmd_db {
260 u16 ippathid;
261 u8 ipflags1;
262 u8 iprcode;
263 u32 ipmsgid;
264 u32 iptrgcls;
265 u32 ipbfadr1;
266 u32 ipbfln1f;
267 u32 ipsrccls;
268 u32 ipmsgtag;
269 u32 ipbfadr2;
270 u32 ipbfln2f;
271 u32 res;
272} __attribute__ ((packed,aligned(8)));
273
274
275
276
277struct iucv_cmd_purge {
278 u16 ippathid;
279 u8 ipflags1;
280 u8 iprcode;
281 u32 ipmsgid;
282 u8 ipaudit[3];
283 u8 res1[5];
284 u32 res2;
285 u32 ipsrccls;
286 u32 ipmsgtag;
287 u32 res3[3];
288} __attribute__ ((packed,aligned(8)));
289
290
291
292
293struct iucv_cmd_set_mask {
294 u8 ipmask;
295 u8 res1[2];
296 u8 iprcode;
297 u32 res2[9];
298} __attribute__ ((packed,aligned(8)));
299
300union iucv_param {
301 struct iucv_cmd_control ctrl;
302 struct iucv_cmd_dpl dpl;
303 struct iucv_cmd_db db;
304 struct iucv_cmd_purge purge;
305 struct iucv_cmd_set_mask set_mask;
306};
307
308
309
310
311static union iucv_param *iucv_param[NR_CPUS];
312static union iucv_param *iucv_param_irq[NR_CPUS];
313
314
315
316
317
318
319
320
321
322
323static inline int iucv_call_b2f0(int command, union iucv_param *parm)
324{
325 register unsigned long reg0 asm ("0");
326 register unsigned long reg1 asm ("1");
327 int ccode;
328
329 reg0 = command;
330 reg1 = virt_to_phys(parm);
331 asm volatile(
332 " .long 0xb2f01000\n"
333 " ipm %0\n"
334 " srl %0,28\n"
335 : "=d" (ccode), "=m" (*parm), "+d" (reg0), "+a" (reg1)
336 : "m" (*parm) : "cc");
337 return (ccode == 1) ? parm->ctrl.iprcode : ccode;
338}
339
340
341
342
343
344
345
346
347
348static int iucv_query_maxconn(void)
349{
350 register unsigned long reg0 asm ("0");
351 register unsigned long reg1 asm ("1");
352 void *param;
353 int ccode;
354
355 param = kzalloc(sizeof(union iucv_param), GFP_KERNEL|GFP_DMA);
356 if (!param)
357 return -ENOMEM;
358 reg0 = IUCV_QUERY;
359 reg1 = (unsigned long) param;
360 asm volatile (
361 " .long 0xb2f01000\n"
362 " ipm %0\n"
363 " srl %0,28\n"
364 : "=d" (ccode), "+d" (reg0), "+d" (reg1) : : "cc");
365 if (ccode == 0)
366 iucv_max_pathid = reg1;
367 kfree(param);
368 return ccode ? -EPERM : 0;
369}
370
371
372
373
374
375
376
377static void iucv_allow_cpu(void *data)
378{
379 int cpu = smp_processor_id();
380 union iucv_param *parm;
381
382
383
384
385
386
387
388
389
390
391 parm = iucv_param_irq[cpu];
392 memset(parm, 0, sizeof(union iucv_param));
393 parm->set_mask.ipmask = 0xf8;
394 iucv_call_b2f0(IUCV_SETMASK, parm);
395
396
397
398
399
400
401
402
403
404
405 memset(parm, 0, sizeof(union iucv_param));
406 parm->set_mask.ipmask = 0xf8;
407 iucv_call_b2f0(IUCV_SETCONTROLMASK, parm);
408
409 cpumask_set_cpu(cpu, &iucv_irq_cpumask);
410}
411
412
413
414
415
416
417
418static void iucv_block_cpu(void *data)
419{
420 int cpu = smp_processor_id();
421 union iucv_param *parm;
422
423
424 parm = iucv_param_irq[cpu];
425 memset(parm, 0, sizeof(union iucv_param));
426 iucv_call_b2f0(IUCV_SETMASK, parm);
427
428
429 cpumask_clear_cpu(cpu, &iucv_irq_cpumask);
430}
431
432
433
434
435
436
437
438static void iucv_block_cpu_almost(void *data)
439{
440 int cpu = smp_processor_id();
441 union iucv_param *parm;
442
443
444 parm = iucv_param_irq[cpu];
445 memset(parm, 0, sizeof(union iucv_param));
446 parm->set_mask.ipmask = 0x08;
447 iucv_call_b2f0(IUCV_SETMASK, parm);
448
449 memset(parm, 0, sizeof(union iucv_param));
450 parm->set_mask.ipmask = 0x20;
451 iucv_call_b2f0(IUCV_SETCONTROLMASK, parm);
452
453
454 cpumask_clear_cpu(cpu, &iucv_irq_cpumask);
455}
456
457
458
459
460
461
462
463static void iucv_declare_cpu(void *data)
464{
465 int cpu = smp_processor_id();
466 union iucv_param *parm;
467 int rc;
468
469 if (cpumask_test_cpu(cpu, &iucv_buffer_cpumask))
470 return;
471
472
473 parm = iucv_param_irq[cpu];
474 memset(parm, 0, sizeof(union iucv_param));
475 parm->db.ipbfadr1 = virt_to_phys(iucv_irq_data[cpu]);
476 rc = iucv_call_b2f0(IUCV_DECLARE_BUFFER, parm);
477 if (rc) {
478 char *err = "Unknown";
479 switch (rc) {
480 case 0x03:
481 err = "Directory error";
482 break;
483 case 0x0a:
484 err = "Invalid length";
485 break;
486 case 0x13:
487 err = "Buffer already exists";
488 break;
489 case 0x3e:
490 err = "Buffer overlap";
491 break;
492 case 0x5c:
493 err = "Paging or storage error";
494 break;
495 }
496 pr_warn("Defining an interrupt buffer on CPU %i failed with 0x%02x (%s)\n",
497 cpu, rc, err);
498 return;
499 }
500
501
502 cpumask_set_cpu(cpu, &iucv_buffer_cpumask);
503
504 if (iucv_nonsmp_handler == 0 || cpumask_empty(&iucv_irq_cpumask))
505
506 iucv_allow_cpu(NULL);
507 else
508
509 iucv_block_cpu(NULL);
510}
511
512
513
514
515
516
517
518static void iucv_retrieve_cpu(void *data)
519{
520 int cpu = smp_processor_id();
521 union iucv_param *parm;
522
523 if (!cpumask_test_cpu(cpu, &iucv_buffer_cpumask))
524 return;
525
526
527 iucv_block_cpu(NULL);
528
529
530 parm = iucv_param_irq[cpu];
531 iucv_call_b2f0(IUCV_RETRIEVE_BUFFER, parm);
532
533
534 cpumask_clear_cpu(cpu, &iucv_buffer_cpumask);
535}
536
537
538
539
540
541
542static void iucv_setmask_mp(void)
543{
544 int cpu;
545
546 get_online_cpus();
547 for_each_online_cpu(cpu)
548
549 if (cpumask_test_cpu(cpu, &iucv_buffer_cpumask) &&
550 !cpumask_test_cpu(cpu, &iucv_irq_cpumask))
551 smp_call_function_single(cpu, iucv_allow_cpu,
552 NULL, 1);
553 put_online_cpus();
554}
555
556
557
558
559
560
561static void iucv_setmask_up(void)
562{
563 cpumask_t cpumask;
564 int cpu;
565
566
567 cpumask_copy(&cpumask, &iucv_irq_cpumask);
568 cpumask_clear_cpu(cpumask_first(&iucv_irq_cpumask), &cpumask);
569 for_each_cpu(cpu, &cpumask)
570 smp_call_function_single(cpu, iucv_block_cpu, NULL, 1);
571}
572
573
574
575
576
577
578
579
580
581static int iucv_enable(void)
582{
583 size_t alloc_size;
584 int cpu, rc;
585
586 get_online_cpus();
587 rc = -ENOMEM;
588 alloc_size = iucv_max_pathid * sizeof(struct iucv_path);
589 iucv_path_table = kzalloc(alloc_size, GFP_KERNEL);
590 if (!iucv_path_table)
591 goto out;
592
593 rc = -EIO;
594 for_each_online_cpu(cpu)
595 smp_call_function_single(cpu, iucv_declare_cpu, NULL, 1);
596 if (cpumask_empty(&iucv_buffer_cpumask))
597
598 goto out;
599 put_online_cpus();
600 return 0;
601out:
602 kfree(iucv_path_table);
603 iucv_path_table = NULL;
604 put_online_cpus();
605 return rc;
606}
607
608
609
610
611
612
613
614
615static void iucv_disable(void)
616{
617 get_online_cpus();
618 on_each_cpu(iucv_retrieve_cpu, NULL, 1);
619 kfree(iucv_path_table);
620 iucv_path_table = NULL;
621 put_online_cpus();
622}
623
624static void free_iucv_data(int cpu)
625{
626 kfree(iucv_param_irq[cpu]);
627 iucv_param_irq[cpu] = NULL;
628 kfree(iucv_param[cpu]);
629 iucv_param[cpu] = NULL;
630 kfree(iucv_irq_data[cpu]);
631 iucv_irq_data[cpu] = NULL;
632}
633
634static int alloc_iucv_data(int cpu)
635{
636
637 iucv_irq_data[cpu] = kmalloc_node(sizeof(struct iucv_irq_data),
638 GFP_KERNEL|GFP_DMA, cpu_to_node(cpu));
639 if (!iucv_irq_data[cpu])
640 goto out_free;
641
642
643 iucv_param[cpu] = kmalloc_node(sizeof(union iucv_param),
644 GFP_KERNEL|GFP_DMA, cpu_to_node(cpu));
645 if (!iucv_param[cpu])
646 goto out_free;
647
648 iucv_param_irq[cpu] = kmalloc_node(sizeof(union iucv_param),
649 GFP_KERNEL|GFP_DMA, cpu_to_node(cpu));
650 if (!iucv_param_irq[cpu])
651 goto out_free;
652
653 return 0;
654
655out_free:
656 free_iucv_data(cpu);
657 return -ENOMEM;
658}
659
660static int iucv_cpu_notify(struct notifier_block *self,
661 unsigned long action, void *hcpu)
662{
663 cpumask_t cpumask;
664 long cpu = (long) hcpu;
665
666 switch (action) {
667 case CPU_UP_PREPARE:
668 case CPU_UP_PREPARE_FROZEN:
669 if (alloc_iucv_data(cpu))
670 return notifier_from_errno(-ENOMEM);
671 break;
672 case CPU_UP_CANCELED:
673 case CPU_UP_CANCELED_FROZEN:
674 case CPU_DEAD:
675 case CPU_DEAD_FROZEN:
676 free_iucv_data(cpu);
677 break;
678 case CPU_ONLINE:
679 case CPU_ONLINE_FROZEN:
680 case CPU_DOWN_FAILED:
681 case CPU_DOWN_FAILED_FROZEN:
682 if (!iucv_path_table)
683 break;
684 smp_call_function_single(cpu, iucv_declare_cpu, NULL, 1);
685 break;
686 case CPU_DOWN_PREPARE:
687 case CPU_DOWN_PREPARE_FROZEN:
688 if (!iucv_path_table)
689 break;
690 cpumask_copy(&cpumask, &iucv_buffer_cpumask);
691 cpumask_clear_cpu(cpu, &cpumask);
692 if (cpumask_empty(&cpumask))
693
694 return notifier_from_errno(-EINVAL);
695 smp_call_function_single(cpu, iucv_retrieve_cpu, NULL, 1);
696 if (cpumask_empty(&iucv_irq_cpumask))
697 smp_call_function_single(
698 cpumask_first(&iucv_buffer_cpumask),
699 iucv_allow_cpu, NULL, 1);
700 break;
701 }
702 return NOTIFY_OK;
703}
704
705static struct notifier_block __refdata iucv_cpu_notifier = {
706 .notifier_call = iucv_cpu_notify,
707};
708
709
710
711
712
713
714
715
716static int iucv_sever_pathid(u16 pathid, u8 *userdata)
717{
718 union iucv_param *parm;
719
720 parm = iucv_param_irq[smp_processor_id()];
721 memset(parm, 0, sizeof(union iucv_param));
722 if (userdata)
723 memcpy(parm->ctrl.ipuser, userdata, sizeof(parm->ctrl.ipuser));
724 parm->ctrl.ippathid = pathid;
725 return iucv_call_b2f0(IUCV_SEVER, parm);
726}
727
728
729
730
731
732
733
734
735static void __iucv_cleanup_queue(void *dummy)
736{
737}
738
739
740
741
742
743
744
745
746static void iucv_cleanup_queue(void)
747{
748 struct iucv_irq_list *p, *n;
749
750
751
752
753
754
755
756
757
758
759 smp_call_function(__iucv_cleanup_queue, NULL, 1);
760 spin_lock_irq(&iucv_queue_lock);
761 list_for_each_entry_safe(p, n, &iucv_task_queue, list) {
762
763 if (iucv_path_table[p->data.ippathid] == NULL) {
764 list_del(&p->list);
765 kfree(p);
766 }
767 }
768 spin_unlock_irq(&iucv_queue_lock);
769}
770
771
772
773
774
775
776
777
778
779
780
781int iucv_register(struct iucv_handler *handler, int smp)
782{
783 int rc;
784
785 if (!iucv_available)
786 return -ENOSYS;
787 mutex_lock(&iucv_register_mutex);
788 if (!smp)
789 iucv_nonsmp_handler++;
790 if (list_empty(&iucv_handler_list)) {
791 rc = iucv_enable();
792 if (rc)
793 goto out_mutex;
794 } else if (!smp && iucv_nonsmp_handler == 1)
795 iucv_setmask_up();
796 INIT_LIST_HEAD(&handler->paths);
797
798 spin_lock_bh(&iucv_table_lock);
799 list_add_tail(&handler->list, &iucv_handler_list);
800 spin_unlock_bh(&iucv_table_lock);
801 rc = 0;
802out_mutex:
803 mutex_unlock(&iucv_register_mutex);
804 return rc;
805}
806EXPORT_SYMBOL(iucv_register);
807
808
809
810
811
812
813
814
815void iucv_unregister(struct iucv_handler *handler, int smp)
816{
817 struct iucv_path *p, *n;
818
819 mutex_lock(&iucv_register_mutex);
820 spin_lock_bh(&iucv_table_lock);
821
822 list_del_init(&handler->list);
823
824 list_for_each_entry_safe(p, n, &handler->paths, list) {
825 iucv_sever_pathid(p->pathid, NULL);
826 iucv_path_table[p->pathid] = NULL;
827 list_del(&p->list);
828 iucv_path_free(p);
829 }
830 spin_unlock_bh(&iucv_table_lock);
831 if (!smp)
832 iucv_nonsmp_handler--;
833 if (list_empty(&iucv_handler_list))
834 iucv_disable();
835 else if (!smp && iucv_nonsmp_handler == 0)
836 iucv_setmask_mp();
837 mutex_unlock(&iucv_register_mutex);
838}
839EXPORT_SYMBOL(iucv_unregister);
840
841static int iucv_reboot_event(struct notifier_block *this,
842 unsigned long event, void *ptr)
843{
844 int i;
845
846 if (cpumask_empty(&iucv_irq_cpumask))
847 return NOTIFY_DONE;
848
849 get_online_cpus();
850 on_each_cpu_mask(&iucv_irq_cpumask, iucv_block_cpu, NULL, 1);
851 preempt_disable();
852 for (i = 0; i < iucv_max_pathid; i++) {
853 if (iucv_path_table[i])
854 iucv_sever_pathid(i, NULL);
855 }
856 preempt_enable();
857 put_online_cpus();
858 iucv_disable();
859 return NOTIFY_DONE;
860}
861
862static struct notifier_block iucv_reboot_notifier = {
863 .notifier_call = iucv_reboot_event,
864};
865
866
867
868
869
870
871
872
873
874
875
876
877
878int iucv_path_accept(struct iucv_path *path, struct iucv_handler *handler,
879 u8 *userdata, void *private)
880{
881 union iucv_param *parm;
882 int rc;
883
884 local_bh_disable();
885 if (cpumask_empty(&iucv_buffer_cpumask)) {
886 rc = -EIO;
887 goto out;
888 }
889
890 parm = iucv_param[smp_processor_id()];
891 memset(parm, 0, sizeof(union iucv_param));
892 parm->ctrl.ippathid = path->pathid;
893 parm->ctrl.ipmsglim = path->msglim;
894 if (userdata)
895 memcpy(parm->ctrl.ipuser, userdata, sizeof(parm->ctrl.ipuser));
896 parm->ctrl.ipflags1 = path->flags;
897
898 rc = iucv_call_b2f0(IUCV_ACCEPT, parm);
899 if (!rc) {
900 path->private = private;
901 path->msglim = parm->ctrl.ipmsglim;
902 path->flags = parm->ctrl.ipflags1;
903 }
904out:
905 local_bh_enable();
906 return rc;
907}
908EXPORT_SYMBOL(iucv_path_accept);
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925int iucv_path_connect(struct iucv_path *path, struct iucv_handler *handler,
926 u8 *userid, u8 *system, u8 *userdata,
927 void *private)
928{
929 union iucv_param *parm;
930 int rc;
931
932 spin_lock_bh(&iucv_table_lock);
933 iucv_cleanup_queue();
934 if (cpumask_empty(&iucv_buffer_cpumask)) {
935 rc = -EIO;
936 goto out;
937 }
938 parm = iucv_param[smp_processor_id()];
939 memset(parm, 0, sizeof(union iucv_param));
940 parm->ctrl.ipmsglim = path->msglim;
941 parm->ctrl.ipflags1 = path->flags;
942 if (userid) {
943 memcpy(parm->ctrl.ipvmid, userid, sizeof(parm->ctrl.ipvmid));
944 ASCEBC(parm->ctrl.ipvmid, sizeof(parm->ctrl.ipvmid));
945 EBC_TOUPPER(parm->ctrl.ipvmid, sizeof(parm->ctrl.ipvmid));
946 }
947 if (system) {
948 memcpy(parm->ctrl.iptarget, system,
949 sizeof(parm->ctrl.iptarget));
950 ASCEBC(parm->ctrl.iptarget, sizeof(parm->ctrl.iptarget));
951 EBC_TOUPPER(parm->ctrl.iptarget, sizeof(parm->ctrl.iptarget));
952 }
953 if (userdata)
954 memcpy(parm->ctrl.ipuser, userdata, sizeof(parm->ctrl.ipuser));
955
956 rc = iucv_call_b2f0(IUCV_CONNECT, parm);
957 if (!rc) {
958 if (parm->ctrl.ippathid < iucv_max_pathid) {
959 path->pathid = parm->ctrl.ippathid;
960 path->msglim = parm->ctrl.ipmsglim;
961 path->flags = parm->ctrl.ipflags1;
962 path->handler = handler;
963 path->private = private;
964 list_add_tail(&path->list, &handler->paths);
965 iucv_path_table[path->pathid] = path;
966 } else {
967 iucv_sever_pathid(parm->ctrl.ippathid,
968 iucv_error_pathid);
969 rc = -EIO;
970 }
971 }
972out:
973 spin_unlock_bh(&iucv_table_lock);
974 return rc;
975}
976EXPORT_SYMBOL(iucv_path_connect);
977
978
979
980
981
982
983
984
985
986
987
988int iucv_path_quiesce(struct iucv_path *path, u8 *userdata)
989{
990 union iucv_param *parm;
991 int rc;
992
993 local_bh_disable();
994 if (cpumask_empty(&iucv_buffer_cpumask)) {
995 rc = -EIO;
996 goto out;
997 }
998 parm = iucv_param[smp_processor_id()];
999 memset(parm, 0, sizeof(union iucv_param));
1000 if (userdata)
1001 memcpy(parm->ctrl.ipuser, userdata, sizeof(parm->ctrl.ipuser));
1002 parm->ctrl.ippathid = path->pathid;
1003 rc = iucv_call_b2f0(IUCV_QUIESCE, parm);
1004out:
1005 local_bh_enable();
1006 return rc;
1007}
1008EXPORT_SYMBOL(iucv_path_quiesce);
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020int iucv_path_resume(struct iucv_path *path, u8 *userdata)
1021{
1022 union iucv_param *parm;
1023 int rc;
1024
1025 local_bh_disable();
1026 if (cpumask_empty(&iucv_buffer_cpumask)) {
1027 rc = -EIO;
1028 goto out;
1029 }
1030 parm = iucv_param[smp_processor_id()];
1031 memset(parm, 0, sizeof(union iucv_param));
1032 if (userdata)
1033 memcpy(parm->ctrl.ipuser, userdata, sizeof(parm->ctrl.ipuser));
1034 parm->ctrl.ippathid = path->pathid;
1035 rc = iucv_call_b2f0(IUCV_RESUME, parm);
1036out:
1037 local_bh_enable();
1038 return rc;
1039}
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050int iucv_path_sever(struct iucv_path *path, u8 *userdata)
1051{
1052 int rc;
1053
1054 preempt_disable();
1055 if (cpumask_empty(&iucv_buffer_cpumask)) {
1056 rc = -EIO;
1057 goto out;
1058 }
1059 if (iucv_active_cpu != smp_processor_id())
1060 spin_lock_bh(&iucv_table_lock);
1061 rc = iucv_sever_pathid(path->pathid, userdata);
1062 iucv_path_table[path->pathid] = NULL;
1063 list_del_init(&path->list);
1064 if (iucv_active_cpu != smp_processor_id())
1065 spin_unlock_bh(&iucv_table_lock);
1066out:
1067 preempt_enable();
1068 return rc;
1069}
1070EXPORT_SYMBOL(iucv_path_sever);
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082int iucv_message_purge(struct iucv_path *path, struct iucv_message *msg,
1083 u32 srccls)
1084{
1085 union iucv_param *parm;
1086 int rc;
1087
1088 local_bh_disable();
1089 if (cpumask_empty(&iucv_buffer_cpumask)) {
1090 rc = -EIO;
1091 goto out;
1092 }
1093 parm = iucv_param[smp_processor_id()];
1094 memset(parm, 0, sizeof(union iucv_param));
1095 parm->purge.ippathid = path->pathid;
1096 parm->purge.ipmsgid = msg->id;
1097 parm->purge.ipsrccls = srccls;
1098 parm->purge.ipflags1 = IUCV_IPSRCCLS | IUCV_IPFGMID | IUCV_IPFGPID;
1099 rc = iucv_call_b2f0(IUCV_PURGE, parm);
1100 if (!rc) {
1101 msg->audit = (*(u32 *) &parm->purge.ipaudit) >> 8;
1102 msg->tag = parm->purge.ipmsgtag;
1103 }
1104out:
1105 local_bh_enable();
1106 return rc;
1107}
1108EXPORT_SYMBOL(iucv_message_purge);
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122static int iucv_message_receive_iprmdata(struct iucv_path *path,
1123 struct iucv_message *msg,
1124 u8 flags, void *buffer,
1125 size_t size, size_t *residual)
1126{
1127 struct iucv_array *array;
1128 u8 *rmmsg;
1129 size_t copy;
1130
1131
1132
1133
1134
1135 if (residual)
1136 *residual = abs(size - 8);
1137 rmmsg = msg->rmmsg;
1138 if (flags & IUCV_IPBUFLST) {
1139
1140 size = (size < 8) ? size : 8;
1141 for (array = buffer; size > 0; array++) {
1142 copy = min_t(size_t, size, array->length);
1143 memcpy((u8 *)(addr_t) array->address,
1144 rmmsg, copy);
1145 rmmsg += copy;
1146 size -= copy;
1147 }
1148 } else {
1149
1150 memcpy(buffer, rmmsg, min_t(size_t, size, 8));
1151 }
1152 return 0;
1153}
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172int __iucv_message_receive(struct iucv_path *path, struct iucv_message *msg,
1173 u8 flags, void *buffer, size_t size, size_t *residual)
1174{
1175 union iucv_param *parm;
1176 int rc;
1177
1178 if (msg->flags & IUCV_IPRMDATA)
1179 return iucv_message_receive_iprmdata(path, msg, flags,
1180 buffer, size, residual);
1181 if (cpumask_empty(&iucv_buffer_cpumask)) {
1182 rc = -EIO;
1183 goto out;
1184 }
1185 parm = iucv_param[smp_processor_id()];
1186 memset(parm, 0, sizeof(union iucv_param));
1187 parm->db.ipbfadr1 = (u32)(addr_t) buffer;
1188 parm->db.ipbfln1f = (u32) size;
1189 parm->db.ipmsgid = msg->id;
1190 parm->db.ippathid = path->pathid;
1191 parm->db.iptrgcls = msg->class;
1192 parm->db.ipflags1 = (flags | IUCV_IPFGPID |
1193 IUCV_IPFGMID | IUCV_IPTRGCLS);
1194 rc = iucv_call_b2f0(IUCV_RECEIVE, parm);
1195 if (!rc || rc == 5) {
1196 msg->flags = parm->db.ipflags1;
1197 if (residual)
1198 *residual = parm->db.ipbfln1f;
1199 }
1200out:
1201 return rc;
1202}
1203EXPORT_SYMBOL(__iucv_message_receive);
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222int iucv_message_receive(struct iucv_path *path, struct iucv_message *msg,
1223 u8 flags, void *buffer, size_t size, size_t *residual)
1224{
1225 int rc;
1226
1227 if (msg->flags & IUCV_IPRMDATA)
1228 return iucv_message_receive_iprmdata(path, msg, flags,
1229 buffer, size, residual);
1230 local_bh_disable();
1231 rc = __iucv_message_receive(path, msg, flags, buffer, size, residual);
1232 local_bh_enable();
1233 return rc;
1234}
1235EXPORT_SYMBOL(iucv_message_receive);
1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
1247
1248int iucv_message_reject(struct iucv_path *path, struct iucv_message *msg)
1249{
1250 union iucv_param *parm;
1251 int rc;
1252
1253 local_bh_disable();
1254 if (cpumask_empty(&iucv_buffer_cpumask)) {
1255 rc = -EIO;
1256 goto out;
1257 }
1258 parm = iucv_param[smp_processor_id()];
1259 memset(parm, 0, sizeof(union iucv_param));
1260 parm->db.ippathid = path->pathid;
1261 parm->db.ipmsgid = msg->id;
1262 parm->db.iptrgcls = msg->class;
1263 parm->db.ipflags1 = (IUCV_IPTRGCLS | IUCV_IPFGMID | IUCV_IPFGPID);
1264 rc = iucv_call_b2f0(IUCV_REJECT, parm);
1265out:
1266 local_bh_enable();
1267 return rc;
1268}
1269EXPORT_SYMBOL(iucv_message_reject);
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281
1282
1283
1284
1285
1286int iucv_message_reply(struct iucv_path *path, struct iucv_message *msg,
1287 u8 flags, void *reply, size_t size)
1288{
1289 union iucv_param *parm;
1290 int rc;
1291
1292 local_bh_disable();
1293 if (cpumask_empty(&iucv_buffer_cpumask)) {
1294 rc = -EIO;
1295 goto out;
1296 }
1297 parm = iucv_param[smp_processor_id()];
1298 memset(parm, 0, sizeof(union iucv_param));
1299 if (flags & IUCV_IPRMDATA) {
1300 parm->dpl.ippathid = path->pathid;
1301 parm->dpl.ipflags1 = flags;
1302 parm->dpl.ipmsgid = msg->id;
1303 parm->dpl.iptrgcls = msg->class;
1304 memcpy(parm->dpl.iprmmsg, reply, min_t(size_t, size, 8));
1305 } else {
1306 parm->db.ipbfadr1 = (u32)(addr_t) reply;
1307 parm->db.ipbfln1f = (u32) size;
1308 parm->db.ippathid = path->pathid;
1309 parm->db.ipflags1 = flags;
1310 parm->db.ipmsgid = msg->id;
1311 parm->db.iptrgcls = msg->class;
1312 }
1313 rc = iucv_call_b2f0(IUCV_REPLY, parm);
1314out:
1315 local_bh_enable();
1316 return rc;
1317}
1318EXPORT_SYMBOL(iucv_message_reply);
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336
1337int __iucv_message_send(struct iucv_path *path, struct iucv_message *msg,
1338 u8 flags, u32 srccls, void *buffer, size_t size)
1339{
1340 union iucv_param *parm;
1341 int rc;
1342
1343 if (cpumask_empty(&iucv_buffer_cpumask)) {
1344 rc = -EIO;
1345 goto out;
1346 }
1347 parm = iucv_param[smp_processor_id()];
1348 memset(parm, 0, sizeof(union iucv_param));
1349 if (flags & IUCV_IPRMDATA) {
1350
1351 parm->dpl.ippathid = path->pathid;
1352 parm->dpl.ipflags1 = flags | IUCV_IPNORPY;
1353 parm->dpl.iptrgcls = msg->class;
1354 parm->dpl.ipsrccls = srccls;
1355 parm->dpl.ipmsgtag = msg->tag;
1356 memcpy(parm->dpl.iprmmsg, buffer, 8);
1357 } else {
1358 parm->db.ipbfadr1 = (u32)(addr_t) buffer;
1359 parm->db.ipbfln1f = (u32) size;
1360 parm->db.ippathid = path->pathid;
1361 parm->db.ipflags1 = flags | IUCV_IPNORPY;
1362 parm->db.iptrgcls = msg->class;
1363 parm->db.ipsrccls = srccls;
1364 parm->db.ipmsgtag = msg->tag;
1365 }
1366 rc = iucv_call_b2f0(IUCV_SEND, parm);
1367 if (!rc)
1368 msg->id = parm->db.ipmsgid;
1369out:
1370 return rc;
1371}
1372EXPORT_SYMBOL(__iucv_message_send);
1373
1374
1375
1376
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
1391int iucv_message_send(struct iucv_path *path, struct iucv_message *msg,
1392 u8 flags, u32 srccls, void *buffer, size_t size)
1393{
1394 int rc;
1395
1396 local_bh_disable();
1397 rc = __iucv_message_send(path, msg, flags, srccls, buffer, size);
1398 local_bh_enable();
1399 return rc;
1400}
1401EXPORT_SYMBOL(iucv_message_send);
1402
1403
1404
1405
1406
1407
1408
1409
1410
1411
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422int iucv_message_send2way(struct iucv_path *path, struct iucv_message *msg,
1423 u8 flags, u32 srccls, void *buffer, size_t size,
1424 void *answer, size_t asize, size_t *residual)
1425{
1426 union iucv_param *parm;
1427 int rc;
1428
1429 local_bh_disable();
1430 if (cpumask_empty(&iucv_buffer_cpumask)) {
1431 rc = -EIO;
1432 goto out;
1433 }
1434 parm = iucv_param[smp_processor_id()];
1435 memset(parm, 0, sizeof(union iucv_param));
1436 if (flags & IUCV_IPRMDATA) {
1437 parm->dpl.ippathid = path->pathid;
1438 parm->dpl.ipflags1 = path->flags;
1439 parm->dpl.iptrgcls = msg->class;
1440 parm->dpl.ipsrccls = srccls;
1441 parm->dpl.ipmsgtag = msg->tag;
1442 parm->dpl.ipbfadr2 = (u32)(addr_t) answer;
1443 parm->dpl.ipbfln2f = (u32) asize;
1444 memcpy(parm->dpl.iprmmsg, buffer, 8);
1445 } else {
1446 parm->db.ippathid = path->pathid;
1447 parm->db.ipflags1 = path->flags;
1448 parm->db.iptrgcls = msg->class;
1449 parm->db.ipsrccls = srccls;
1450 parm->db.ipmsgtag = msg->tag;
1451 parm->db.ipbfadr1 = (u32)(addr_t) buffer;
1452 parm->db.ipbfln1f = (u32) size;
1453 parm->db.ipbfadr2 = (u32)(addr_t) answer;
1454 parm->db.ipbfln2f = (u32) asize;
1455 }
1456 rc = iucv_call_b2f0(IUCV_SEND, parm);
1457 if (!rc)
1458 msg->id = parm->db.ipmsgid;
1459out:
1460 local_bh_enable();
1461 return rc;
1462}
1463EXPORT_SYMBOL(iucv_message_send2way);
1464
1465
1466
1467
1468
1469
1470
1471
1472struct iucv_path_pending {
1473 u16 ippathid;
1474 u8 ipflags1;
1475 u8 iptype;
1476 u16 ipmsglim;
1477 u16 res1;
1478 u8 ipvmid[8];
1479 u8 ipuser[16];
1480 u32 res3;
1481 u8 ippollfg;
1482 u8 res4[3];
1483} __packed;
1484
1485static void iucv_path_pending(struct iucv_irq_data *data)
1486{
1487 struct iucv_path_pending *ipp = (void *) data;
1488 struct iucv_handler *handler;
1489 struct iucv_path *path;
1490 char *error;
1491
1492 BUG_ON(iucv_path_table[ipp->ippathid]);
1493
1494 error = iucv_error_no_memory;
1495 path = iucv_path_alloc(ipp->ipmsglim, ipp->ipflags1, GFP_ATOMIC);
1496 if (!path)
1497 goto out_sever;
1498 path->pathid = ipp->ippathid;
1499 iucv_path_table[path->pathid] = path;
1500 EBCASC(ipp->ipvmid, 8);
1501
1502
1503 list_for_each_entry(handler, &iucv_handler_list, list) {
1504 if (!handler->path_pending)
1505 continue;
1506
1507
1508
1509
1510
1511 list_add(&path->list, &handler->paths);
1512 path->handler = handler;
1513 if (!handler->path_pending(path, ipp->ipvmid, ipp->ipuser))
1514 return;
1515 list_del(&path->list);
1516 path->handler = NULL;
1517 }
1518
1519 iucv_path_table[path->pathid] = NULL;
1520 iucv_path_free(path);
1521 error = iucv_error_no_listener;
1522out_sever:
1523 iucv_sever_pathid(ipp->ippathid, error);
1524}
1525
1526
1527
1528
1529
1530
1531
1532
1533struct iucv_path_complete {
1534 u16 ippathid;
1535 u8 ipflags1;
1536 u8 iptype;
1537 u16 ipmsglim;
1538 u16 res1;
1539 u8 res2[8];
1540 u8 ipuser[16];
1541 u32 res3;
1542 u8 ippollfg;
1543 u8 res4[3];
1544} __packed;
1545
1546static void iucv_path_complete(struct iucv_irq_data *data)
1547{
1548 struct iucv_path_complete *ipc = (void *) data;
1549 struct iucv_path *path = iucv_path_table[ipc->ippathid];
1550
1551 if (path)
1552 path->flags = ipc->ipflags1;
1553 if (path && path->handler && path->handler->path_complete)
1554 path->handler->path_complete(path, ipc->ipuser);
1555}
1556
1557
1558
1559
1560
1561
1562
1563
1564struct iucv_path_severed {
1565 u16 ippathid;
1566 u8 res1;
1567 u8 iptype;
1568 u32 res2;
1569 u8 res3[8];
1570 u8 ipuser[16];
1571 u32 res4;
1572 u8 ippollfg;
1573 u8 res5[3];
1574} __packed;
1575
1576static void iucv_path_severed(struct iucv_irq_data *data)
1577{
1578 struct iucv_path_severed *ips = (void *) data;
1579 struct iucv_path *path = iucv_path_table[ips->ippathid];
1580
1581 if (!path || !path->handler)
1582 return;
1583 if (path->handler->path_severed)
1584 path->handler->path_severed(path, ips->ipuser);
1585 else {
1586 iucv_sever_pathid(path->pathid, NULL);
1587 iucv_path_table[path->pathid] = NULL;
1588 list_del(&path->list);
1589 iucv_path_free(path);
1590 }
1591}
1592
1593
1594
1595
1596
1597
1598
1599
1600struct iucv_path_quiesced {
1601 u16 ippathid;
1602 u8 res1;
1603 u8 iptype;
1604 u32 res2;
1605 u8 res3[8];
1606 u8 ipuser[16];
1607 u32 res4;
1608 u8 ippollfg;
1609 u8 res5[3];
1610} __packed;
1611
1612static void iucv_path_quiesced(struct iucv_irq_data *data)
1613{
1614 struct iucv_path_quiesced *ipq = (void *) data;
1615 struct iucv_path *path = iucv_path_table[ipq->ippathid];
1616
1617 if (path && path->handler && path->handler->path_quiesced)
1618 path->handler->path_quiesced(path, ipq->ipuser);
1619}
1620
1621
1622
1623
1624
1625
1626
1627
1628struct iucv_path_resumed {
1629 u16 ippathid;
1630 u8 res1;
1631 u8 iptype;
1632 u32 res2;
1633 u8 res3[8];
1634 u8 ipuser[16];
1635 u32 res4;
1636 u8 ippollfg;
1637 u8 res5[3];
1638} __packed;
1639
1640static void iucv_path_resumed(struct iucv_irq_data *data)
1641{
1642 struct iucv_path_resumed *ipr = (void *) data;
1643 struct iucv_path *path = iucv_path_table[ipr->ippathid];
1644
1645 if (path && path->handler && path->handler->path_resumed)
1646 path->handler->path_resumed(path, ipr->ipuser);
1647}
1648
1649
1650
1651
1652
1653
1654
1655
1656struct iucv_message_complete {
1657 u16 ippathid;
1658 u8 ipflags1;
1659 u8 iptype;
1660 u32 ipmsgid;
1661 u32 ipaudit;
1662 u8 iprmmsg[8];
1663 u32 ipsrccls;
1664 u32 ipmsgtag;
1665 u32 res;
1666 u32 ipbfln2f;
1667 u8 ippollfg;
1668 u8 res2[3];
1669} __packed;
1670
1671static void iucv_message_complete(struct iucv_irq_data *data)
1672{
1673 struct iucv_message_complete *imc = (void *) data;
1674 struct iucv_path *path = iucv_path_table[imc->ippathid];
1675 struct iucv_message msg;
1676
1677 if (path && path->handler && path->handler->message_complete) {
1678 msg.flags = imc->ipflags1;
1679 msg.id = imc->ipmsgid;
1680 msg.audit = imc->ipaudit;
1681 memcpy(msg.rmmsg, imc->iprmmsg, 8);
1682 msg.class = imc->ipsrccls;
1683 msg.tag = imc->ipmsgtag;
1684 msg.length = imc->ipbfln2f;
1685 path->handler->message_complete(path, &msg);
1686 }
1687}
1688
1689
1690
1691
1692
1693
1694
1695
1696struct iucv_message_pending {
1697 u16 ippathid;
1698 u8 ipflags1;
1699 u8 iptype;
1700 u32 ipmsgid;
1701 u32 iptrgcls;
1702 union {
1703 u32 iprmmsg1_u32;
1704 u8 iprmmsg1[4];
1705 } ln1msg1;
1706 union {
1707 u32 ipbfln1f;
1708 u8 iprmmsg2[4];
1709 } ln1msg2;
1710 u32 res1[3];
1711 u32 ipbfln2f;
1712 u8 ippollfg;
1713 u8 res2[3];
1714} __packed;
1715
1716static void iucv_message_pending(struct iucv_irq_data *data)
1717{
1718 struct iucv_message_pending *imp = (void *) data;
1719 struct iucv_path *path = iucv_path_table[imp->ippathid];
1720 struct iucv_message msg;
1721
1722 if (path && path->handler && path->handler->message_pending) {
1723 msg.flags = imp->ipflags1;
1724 msg.id = imp->ipmsgid;
1725 msg.class = imp->iptrgcls;
1726 if (imp->ipflags1 & IUCV_IPRMDATA) {
1727 memcpy(msg.rmmsg, imp->ln1msg1.iprmmsg1, 8);
1728 msg.length = 8;
1729 } else
1730 msg.length = imp->ln1msg2.ipbfln1f;
1731 msg.reply_size = imp->ipbfln2f;
1732 path->handler->message_pending(path, &msg);
1733 }
1734}
1735
1736
1737
1738
1739
1740
1741
1742
1743static void iucv_tasklet_fn(unsigned long ignored)
1744{
1745 typedef void iucv_irq_fn(struct iucv_irq_data *);
1746 static iucv_irq_fn *irq_fn[] = {
1747 [0x02] = iucv_path_complete,
1748 [0x03] = iucv_path_severed,
1749 [0x04] = iucv_path_quiesced,
1750 [0x05] = iucv_path_resumed,
1751 [0x06] = iucv_message_complete,
1752 [0x07] = iucv_message_complete,
1753 [0x08] = iucv_message_pending,
1754 [0x09] = iucv_message_pending,
1755 };
1756 LIST_HEAD(task_queue);
1757 struct iucv_irq_list *p, *n;
1758
1759
1760 if (!spin_trylock(&iucv_table_lock)) {
1761 tasklet_schedule(&iucv_tasklet);
1762 return;
1763 }
1764 iucv_active_cpu = smp_processor_id();
1765
1766 spin_lock_irq(&iucv_queue_lock);
1767 list_splice_init(&iucv_task_queue, &task_queue);
1768 spin_unlock_irq(&iucv_queue_lock);
1769
1770 list_for_each_entry_safe(p, n, &task_queue, list) {
1771 list_del_init(&p->list);
1772 irq_fn[p->data.iptype](&p->data);
1773 kfree(p);
1774 }
1775
1776 iucv_active_cpu = -1;
1777 spin_unlock(&iucv_table_lock);
1778}
1779
1780
1781
1782
1783
1784
1785
1786
1787static void iucv_work_fn(struct work_struct *work)
1788{
1789 LIST_HEAD(work_queue);
1790 struct iucv_irq_list *p, *n;
1791
1792
1793 spin_lock_bh(&iucv_table_lock);
1794 iucv_active_cpu = smp_processor_id();
1795
1796 spin_lock_irq(&iucv_queue_lock);
1797 list_splice_init(&iucv_work_queue, &work_queue);
1798 spin_unlock_irq(&iucv_queue_lock);
1799
1800 iucv_cleanup_queue();
1801 list_for_each_entry_safe(p, n, &work_queue, list) {
1802 list_del_init(&p->list);
1803 iucv_path_pending(&p->data);
1804 kfree(p);
1805 }
1806
1807 iucv_active_cpu = -1;
1808 spin_unlock_bh(&iucv_table_lock);
1809}
1810
1811
1812
1813
1814
1815
1816
1817
1818static void iucv_external_interrupt(struct ext_code ext_code,
1819 unsigned int param32, unsigned long param64)
1820{
1821 struct iucv_irq_data *p;
1822 struct iucv_irq_list *work;
1823
1824 inc_irq_stat(IRQEXT_IUC);
1825 p = iucv_irq_data[smp_processor_id()];
1826 if (p->ippathid >= iucv_max_pathid) {
1827 WARN_ON(p->ippathid >= iucv_max_pathid);
1828 iucv_sever_pathid(p->ippathid, iucv_error_no_listener);
1829 return;
1830 }
1831 BUG_ON(p->iptype < 0x01 || p->iptype > 0x09);
1832 work = kmalloc(sizeof(struct iucv_irq_list), GFP_ATOMIC);
1833 if (!work) {
1834 pr_warn("iucv_external_interrupt: out of memory\n");
1835 return;
1836 }
1837 memcpy(&work->data, p, sizeof(work->data));
1838 spin_lock(&iucv_queue_lock);
1839 if (p->iptype == 0x01) {
1840
1841 list_add_tail(&work->list, &iucv_work_queue);
1842 schedule_work(&iucv_work);
1843 } else {
1844
1845 list_add_tail(&work->list, &iucv_task_queue);
1846 tasklet_schedule(&iucv_tasklet);
1847 }
1848 spin_unlock(&iucv_queue_lock);
1849}
1850
1851static int iucv_pm_prepare(struct device *dev)
1852{
1853 int rc = 0;
1854
1855#ifdef CONFIG_PM_DEBUG
1856 printk(KERN_INFO "iucv_pm_prepare\n");
1857#endif
1858 if (dev->driver && dev->driver->pm && dev->driver->pm->prepare)
1859 rc = dev->driver->pm->prepare(dev);
1860 return rc;
1861}
1862
1863static void iucv_pm_complete(struct device *dev)
1864{
1865#ifdef CONFIG_PM_DEBUG
1866 printk(KERN_INFO "iucv_pm_complete\n");
1867#endif
1868 if (dev->driver && dev->driver->pm && dev->driver->pm->complete)
1869 dev->driver->pm->complete(dev);
1870}
1871
1872
1873
1874
1875
1876
1877
1878int iucv_path_table_empty(void)
1879{
1880 int i;
1881
1882 for (i = 0; i < iucv_max_pathid; i++) {
1883 if (iucv_path_table[i])
1884 return 0;
1885 }
1886 return 1;
1887}
1888
1889
1890
1891
1892
1893
1894
1895
1896
1897static int iucv_pm_freeze(struct device *dev)
1898{
1899 int cpu;
1900 struct iucv_irq_list *p, *n;
1901 int rc = 0;
1902
1903#ifdef CONFIG_PM_DEBUG
1904 printk(KERN_WARNING "iucv_pm_freeze\n");
1905#endif
1906 if (iucv_pm_state != IUCV_PM_FREEZING) {
1907 for_each_cpu(cpu, &iucv_irq_cpumask)
1908 smp_call_function_single(cpu, iucv_block_cpu_almost,
1909 NULL, 1);
1910 cancel_work_sync(&iucv_work);
1911 list_for_each_entry_safe(p, n, &iucv_work_queue, list) {
1912 list_del_init(&p->list);
1913 iucv_sever_pathid(p->data.ippathid,
1914 iucv_error_no_listener);
1915 kfree(p);
1916 }
1917 }
1918 iucv_pm_state = IUCV_PM_FREEZING;
1919 if (dev->driver && dev->driver->pm && dev->driver->pm->freeze)
1920 rc = dev->driver->pm->freeze(dev);
1921 if (iucv_path_table_empty())
1922 iucv_disable();
1923 return rc;
1924}
1925
1926
1927
1928
1929
1930
1931
1932
1933
1934static int iucv_pm_thaw(struct device *dev)
1935{
1936 int rc = 0;
1937
1938#ifdef CONFIG_PM_DEBUG
1939 printk(KERN_WARNING "iucv_pm_thaw\n");
1940#endif
1941 iucv_pm_state = IUCV_PM_THAWING;
1942 if (!iucv_path_table) {
1943 rc = iucv_enable();
1944 if (rc)
1945 goto out;
1946 }
1947 if (cpumask_empty(&iucv_irq_cpumask)) {
1948 if (iucv_nonsmp_handler)
1949
1950 iucv_allow_cpu(NULL);
1951 else
1952
1953 iucv_setmask_mp();
1954 }
1955 if (dev->driver && dev->driver->pm && dev->driver->pm->thaw)
1956 rc = dev->driver->pm->thaw(dev);
1957out:
1958 return rc;
1959}
1960
1961
1962
1963
1964
1965
1966
1967
1968
1969static int iucv_pm_restore(struct device *dev)
1970{
1971 int rc = 0;
1972
1973#ifdef CONFIG_PM_DEBUG
1974 printk(KERN_WARNING "iucv_pm_restore %p\n", iucv_path_table);
1975#endif
1976 if ((iucv_pm_state != IUCV_PM_RESTORING) && iucv_path_table)
1977 pr_warn("Suspending Linux did not completely close all IUCV connections\n");
1978 iucv_pm_state = IUCV_PM_RESTORING;
1979 if (cpumask_empty(&iucv_irq_cpumask)) {
1980 rc = iucv_query_maxconn();
1981 rc = iucv_enable();
1982 if (rc)
1983 goto out;
1984 }
1985 if (dev->driver && dev->driver->pm && dev->driver->pm->restore)
1986 rc = dev->driver->pm->restore(dev);
1987out:
1988 return rc;
1989}
1990
1991struct iucv_interface iucv_if = {
1992 .message_receive = iucv_message_receive,
1993 .__message_receive = __iucv_message_receive,
1994 .message_reply = iucv_message_reply,
1995 .message_reject = iucv_message_reject,
1996 .message_send = iucv_message_send,
1997 .__message_send = __iucv_message_send,
1998 .message_send2way = iucv_message_send2way,
1999 .message_purge = iucv_message_purge,
2000 .path_accept = iucv_path_accept,
2001 .path_connect = iucv_path_connect,
2002 .path_quiesce = iucv_path_quiesce,
2003 .path_resume = iucv_path_resume,
2004 .path_sever = iucv_path_sever,
2005 .iucv_register = iucv_register,
2006 .iucv_unregister = iucv_unregister,
2007 .bus = NULL,
2008 .root = NULL,
2009};
2010EXPORT_SYMBOL(iucv_if);
2011
2012
2013
2014
2015
2016
2017static int __init iucv_init(void)
2018{
2019 int rc;
2020 int cpu;
2021
2022 if (!MACHINE_IS_VM) {
2023 rc = -EPROTONOSUPPORT;
2024 goto out;
2025 }
2026 ctl_set_bit(0, 1);
2027 rc = iucv_query_maxconn();
2028 if (rc)
2029 goto out_ctl;
2030 rc = register_external_irq(EXT_IRQ_IUCV, iucv_external_interrupt);
2031 if (rc)
2032 goto out_ctl;
2033 iucv_root = root_device_register("iucv");
2034 if (IS_ERR(iucv_root)) {
2035 rc = PTR_ERR(iucv_root);
2036 goto out_int;
2037 }
2038
2039 cpu_notifier_register_begin();
2040
2041 for_each_online_cpu(cpu) {
2042 if (alloc_iucv_data(cpu)) {
2043 rc = -ENOMEM;
2044 goto out_free;
2045 }
2046 }
2047 rc = __register_hotcpu_notifier(&iucv_cpu_notifier);
2048 if (rc)
2049 goto out_free;
2050
2051 cpu_notifier_register_done();
2052
2053 rc = register_reboot_notifier(&iucv_reboot_notifier);
2054 if (rc)
2055 goto out_cpu;
2056 ASCEBC(iucv_error_no_listener, 16);
2057 ASCEBC(iucv_error_no_memory, 16);
2058 ASCEBC(iucv_error_pathid, 16);
2059 iucv_available = 1;
2060 rc = bus_register(&iucv_bus);
2061 if (rc)
2062 goto out_reboot;
2063 iucv_if.root = iucv_root;
2064 iucv_if.bus = &iucv_bus;
2065 return 0;
2066
2067out_reboot:
2068 unregister_reboot_notifier(&iucv_reboot_notifier);
2069out_cpu:
2070 cpu_notifier_register_begin();
2071 __unregister_hotcpu_notifier(&iucv_cpu_notifier);
2072out_free:
2073 for_each_possible_cpu(cpu)
2074 free_iucv_data(cpu);
2075
2076 cpu_notifier_register_done();
2077
2078 root_device_unregister(iucv_root);
2079out_int:
2080 unregister_external_irq(EXT_IRQ_IUCV, iucv_external_interrupt);
2081out_ctl:
2082 ctl_clear_bit(0, 1);
2083out:
2084 return rc;
2085}
2086
2087
2088
2089
2090
2091
2092static void __exit iucv_exit(void)
2093{
2094 struct iucv_irq_list *p, *n;
2095 int cpu;
2096
2097 spin_lock_irq(&iucv_queue_lock);
2098 list_for_each_entry_safe(p, n, &iucv_task_queue, list)
2099 kfree(p);
2100 list_for_each_entry_safe(p, n, &iucv_work_queue, list)
2101 kfree(p);
2102 spin_unlock_irq(&iucv_queue_lock);
2103 unregister_reboot_notifier(&iucv_reboot_notifier);
2104 cpu_notifier_register_begin();
2105 __unregister_hotcpu_notifier(&iucv_cpu_notifier);
2106 for_each_possible_cpu(cpu)
2107 free_iucv_data(cpu);
2108 cpu_notifier_register_done();
2109 root_device_unregister(iucv_root);
2110 bus_unregister(&iucv_bus);
2111 unregister_external_irq(EXT_IRQ_IUCV, iucv_external_interrupt);
2112}
2113
2114subsys_initcall(iucv_init);
2115module_exit(iucv_exit);
2116
2117MODULE_AUTHOR("(C) 2001 IBM Corp. by Fritz Elfert (felfert@millenux.com)");
2118MODULE_DESCRIPTION("Linux for S/390 IUCV lowlevel driver");
2119MODULE_LICENSE("GPL");
2120