Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1/*
2 * drivers/s390/cio/css.c
3 * driver for channel subsystem
4 *
5 * Copyright IBM Corp. 2002,2008
6 * Author(s): Arnd Bergmann (arndb@de.ibm.com)
7 * Cornelia Huck (cornelia.huck@de.ibm.com)
8 */
9
10#define KMSG_COMPONENT "cio"
11#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
12
13#include <linux/module.h>
14#include <linux/init.h>
15#include <linux/device.h>
16#include <linux/slab.h>
17#include <linux/errno.h>
18#include <linux/list.h>
19#include <linux/reboot.h>
20#include <asm/isc.h>
21
22#include "../s390mach.h"
23#include "css.h"
24#include "cio.h"
25#include "cio_debug.h"
26#include "ioasm.h"
27#include "chsc.h"
28#include "device.h"
29#include "idset.h"
30#include "chp.h"
31
32int css_init_done = 0;
33static int need_reprobe = 0;
34static int max_ssid = 0;
35
36struct channel_subsystem *channel_subsystems[__MAX_CSSID + 1];
37
38int
39for_each_subchannel(int(*fn)(struct subchannel_id, void *), void *data)
40{
41 struct subchannel_id schid;
42 int ret;
43
44 init_subchannel_id(&schid);
45 ret = -ENODEV;
46 do {
47 do {
48 ret = fn(schid, data);
49 if (ret)
50 break;
51 } while (schid.sch_no++ < __MAX_SUBCHANNEL);
52 schid.sch_no = 0;
53 } while (schid.ssid++ < max_ssid);
54 return ret;
55}
56
57struct cb_data {
58 void *data;
59 struct idset *set;
60 int (*fn_known_sch)(struct subchannel *, void *);
61 int (*fn_unknown_sch)(struct subchannel_id, void *);
62};
63
64static int call_fn_known_sch(struct device *dev, void *data)
65{
66 struct subchannel *sch = to_subchannel(dev);
67 struct cb_data *cb = data;
68 int rc = 0;
69
70 idset_sch_del(cb->set, sch->schid);
71 if (cb->fn_known_sch)
72 rc = cb->fn_known_sch(sch, cb->data);
73 return rc;
74}
75
76static int call_fn_unknown_sch(struct subchannel_id schid, void *data)
77{
78 struct cb_data *cb = data;
79 int rc = 0;
80
81 if (idset_sch_contains(cb->set, schid))
82 rc = cb->fn_unknown_sch(schid, cb->data);
83 return rc;
84}
85
86int for_each_subchannel_staged(int (*fn_known)(struct subchannel *, void *),
87 int (*fn_unknown)(struct subchannel_id,
88 void *), void *data)
89{
90 struct cb_data cb;
91 int rc;
92
93 cb.set = idset_sch_new();
94 if (!cb.set)
95 return -ENOMEM;
96 idset_fill(cb.set);
97 cb.data = data;
98 cb.fn_known_sch = fn_known;
99 cb.fn_unknown_sch = fn_unknown;
100 /* Process registered subchannels. */
101 rc = bus_for_each_dev(&css_bus_type, NULL, &cb, call_fn_known_sch);
102 if (rc)
103 goto out;
104 /* Process unregistered subchannels. */
105 if (fn_unknown)
106 rc = for_each_subchannel(call_fn_unknown_sch, &cb);
107out:
108 idset_free(cb.set);
109
110 return rc;
111}
112
113static struct subchannel *
114css_alloc_subchannel(struct subchannel_id schid)
115{
116 struct subchannel *sch;
117 int ret;
118
119 sch = kmalloc (sizeof (*sch), GFP_KERNEL | GFP_DMA);
120 if (sch == NULL)
121 return ERR_PTR(-ENOMEM);
122 ret = cio_validate_subchannel (sch, schid);
123 if (ret < 0) {
124 kfree(sch);
125 return ERR_PTR(ret);
126 }
127 return sch;
128}
129
130static void
131css_free_subchannel(struct subchannel *sch)
132{
133 if (sch) {
134 /* Reset intparm to zeroes. */
135 sch->config.intparm = 0;
136 cio_commit_config(sch);
137 kfree(sch->lock);
138 kfree(sch);
139 }
140}
141
142static void
143css_subchannel_release(struct device *dev)
144{
145 struct subchannel *sch;
146
147 sch = to_subchannel(dev);
148 if (!cio_is_console(sch->schid)) {
149 kfree(sch->lock);
150 kfree(sch);
151 }
152}
153
154static int css_sch_device_register(struct subchannel *sch)
155{
156 int ret;
157
158 mutex_lock(&sch->reg_mutex);
159 ret = device_register(&sch->dev);
160 mutex_unlock(&sch->reg_mutex);
161 return ret;
162}
163
164/**
165 * css_sch_device_unregister - unregister a subchannel
166 * @sch: subchannel to be unregistered
167 */
168void css_sch_device_unregister(struct subchannel *sch)
169{
170 mutex_lock(&sch->reg_mutex);
171 if (device_is_registered(&sch->dev))
172 device_unregister(&sch->dev);
173 mutex_unlock(&sch->reg_mutex);
174}
175EXPORT_SYMBOL_GPL(css_sch_device_unregister);
176
177static void ssd_from_pmcw(struct chsc_ssd_info *ssd, struct pmcw *pmcw)
178{
179 int i;
180 int mask;
181
182 memset(ssd, 0, sizeof(struct chsc_ssd_info));
183 ssd->path_mask = pmcw->pim;
184 for (i = 0; i < 8; i++) {
185 mask = 0x80 >> i;
186 if (pmcw->pim & mask) {
187 chp_id_init(&ssd->chpid[i]);
188 ssd->chpid[i].id = pmcw->chpid[i];
189 }
190 }
191}
192
193static void ssd_register_chpids(struct chsc_ssd_info *ssd)
194{
195 int i;
196 int mask;
197
198 for (i = 0; i < 8; i++) {
199 mask = 0x80 >> i;
200 if (ssd->path_mask & mask)
201 if (!chp_is_registered(ssd->chpid[i]))
202 chp_new(ssd->chpid[i]);
203 }
204}
205
206void css_update_ssd_info(struct subchannel *sch)
207{
208 int ret;
209
210 if (cio_is_console(sch->schid)) {
211 /* Console is initialized too early for functions requiring
212 * memory allocation. */
213 ssd_from_pmcw(&sch->ssd_info, &sch->schib.pmcw);
214 } else {
215 ret = chsc_get_ssd_info(sch->schid, &sch->ssd_info);
216 if (ret)
217 ssd_from_pmcw(&sch->ssd_info, &sch->schib.pmcw);
218 ssd_register_chpids(&sch->ssd_info);
219 }
220}
221
222static ssize_t type_show(struct device *dev, struct device_attribute *attr,
223 char *buf)
224{
225 struct subchannel *sch = to_subchannel(dev);
226
227 return sprintf(buf, "%01x\n", sch->st);
228}
229
230static DEVICE_ATTR(type, 0444, type_show, NULL);
231
232static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
233 char *buf)
234{
235 struct subchannel *sch = to_subchannel(dev);
236
237 return sprintf(buf, "css:t%01X\n", sch->st);
238}
239
240static DEVICE_ATTR(modalias, 0444, modalias_show, NULL);
241
242static struct attribute *subch_attrs[] = {
243 &dev_attr_type.attr,
244 &dev_attr_modalias.attr,
245 NULL,
246};
247
248static struct attribute_group subch_attr_group = {
249 .attrs = subch_attrs,
250};
251
252static struct attribute_group *default_subch_attr_groups[] = {
253 &subch_attr_group,
254 NULL,
255};
256
257static int css_register_subchannel(struct subchannel *sch)
258{
259 int ret;
260
261 /* Initialize the subchannel structure */
262 sch->dev.parent = &channel_subsystems[0]->device;
263 sch->dev.bus = &css_bus_type;
264 sch->dev.release = &css_subchannel_release;
265 sch->dev.groups = default_subch_attr_groups;
266 /*
267 * We don't want to generate uevents for I/O subchannels that don't
268 * have a working ccw device behind them since they will be
269 * unregistered before they can be used anyway, so we delay the add
270 * uevent until after device recognition was successful.
271 * Note that we suppress the uevent for all subchannel types;
272 * the subchannel driver can decide itself when it wants to inform
273 * userspace of its existence.
274 */
275 sch->dev.uevent_suppress = 1;
276 css_update_ssd_info(sch);
277 /* make it known to the system */
278 ret = css_sch_device_register(sch);
279 if (ret) {
280 CIO_MSG_EVENT(0, "Could not register sch 0.%x.%04x: %d\n",
281 sch->schid.ssid, sch->schid.sch_no, ret);
282 return ret;
283 }
284 if (!sch->driver) {
285 /*
286 * No driver matched. Generate the uevent now so that
287 * a fitting driver module may be loaded based on the
288 * modalias.
289 */
290 sch->dev.uevent_suppress = 0;
291 kobject_uevent(&sch->dev.kobj, KOBJ_ADD);
292 }
293 return ret;
294}
295
296int css_probe_device(struct subchannel_id schid)
297{
298 int ret;
299 struct subchannel *sch;
300
301 sch = css_alloc_subchannel(schid);
302 if (IS_ERR(sch))
303 return PTR_ERR(sch);
304 ret = css_register_subchannel(sch);
305 if (ret)
306 css_free_subchannel(sch);
307 return ret;
308}
309
310static int
311check_subchannel(struct device * dev, void * data)
312{
313 struct subchannel *sch;
314 struct subchannel_id *schid = data;
315
316 sch = to_subchannel(dev);
317 return schid_equal(&sch->schid, schid);
318}
319
320struct subchannel *
321get_subchannel_by_schid(struct subchannel_id schid)
322{
323 struct device *dev;
324
325 dev = bus_find_device(&css_bus_type, NULL,
326 &schid, check_subchannel);
327
328 return dev ? to_subchannel(dev) : NULL;
329}
330
331/**
332 * css_sch_is_valid() - check if a subchannel is valid
333 * @schib: subchannel information block for the subchannel
334 */
335int css_sch_is_valid(struct schib *schib)
336{
337 if ((schib->pmcw.st == SUBCHANNEL_TYPE_IO) && !schib->pmcw.dnv)
338 return 0;
339 if ((schib->pmcw.st == SUBCHANNEL_TYPE_MSG) && !schib->pmcw.w)
340 return 0;
341 return 1;
342}
343EXPORT_SYMBOL_GPL(css_sch_is_valid);
344
345static int css_evaluate_new_subchannel(struct subchannel_id schid, int slow)
346{
347 struct schib schib;
348
349 if (!slow) {
350 /* Will be done on the slow path. */
351 return -EAGAIN;
352 }
353 if (stsch_err(schid, &schib) || !css_sch_is_valid(&schib)) {
354 /* Unusable - ignore. */
355 return 0;
356 }
357 CIO_MSG_EVENT(4, "Evaluating schid 0.%x.%04x, event %d, unknown, "
358 "slow path.\n", schid.ssid, schid.sch_no, CIO_OPER);
359
360 return css_probe_device(schid);
361}
362
363static int css_evaluate_known_subchannel(struct subchannel *sch, int slow)
364{
365 int ret = 0;
366
367 if (sch->driver) {
368 if (sch->driver->sch_event)
369 ret = sch->driver->sch_event(sch, slow);
370 else
371 dev_dbg(&sch->dev,
372 "Got subchannel machine check but "
373 "no sch_event handler provided.\n");
374 }
375 return ret;
376}
377
378static void css_evaluate_subchannel(struct subchannel_id schid, int slow)
379{
380 struct subchannel *sch;
381 int ret;
382
383 sch = get_subchannel_by_schid(schid);
384 if (sch) {
385 ret = css_evaluate_known_subchannel(sch, slow);
386 put_device(&sch->dev);
387 } else
388 ret = css_evaluate_new_subchannel(schid, slow);
389 if (ret == -EAGAIN)
390 css_schedule_eval(schid);
391}
392
393static struct idset *slow_subchannel_set;
394static spinlock_t slow_subchannel_lock;
395
396static int __init slow_subchannel_init(void)
397{
398 spin_lock_init(&slow_subchannel_lock);
399 slow_subchannel_set = idset_sch_new();
400 if (!slow_subchannel_set) {
401 CIO_MSG_EVENT(0, "could not allocate slow subchannel set\n");
402 return -ENOMEM;
403 }
404 return 0;
405}
406
407static int slow_eval_known_fn(struct subchannel *sch, void *data)
408{
409 int eval;
410 int rc;
411
412 spin_lock_irq(&slow_subchannel_lock);
413 eval = idset_sch_contains(slow_subchannel_set, sch->schid);
414 idset_sch_del(slow_subchannel_set, sch->schid);
415 spin_unlock_irq(&slow_subchannel_lock);
416 if (eval) {
417 rc = css_evaluate_known_subchannel(sch, 1);
418 if (rc == -EAGAIN)
419 css_schedule_eval(sch->schid);
420 }
421 return 0;
422}
423
424static int slow_eval_unknown_fn(struct subchannel_id schid, void *data)
425{
426 int eval;
427 int rc = 0;
428
429 spin_lock_irq(&slow_subchannel_lock);
430 eval = idset_sch_contains(slow_subchannel_set, schid);
431 idset_sch_del(slow_subchannel_set, schid);
432 spin_unlock_irq(&slow_subchannel_lock);
433 if (eval) {
434 rc = css_evaluate_new_subchannel(schid, 1);
435 switch (rc) {
436 case -EAGAIN:
437 css_schedule_eval(schid);
438 rc = 0;
439 break;
440 case -ENXIO:
441 case -ENOMEM:
442 case -EIO:
443 /* These should abort looping */
444 break;
445 default:
446 rc = 0;
447 }
448 }
449 return rc;
450}
451
452static void css_slow_path_func(struct work_struct *unused)
453{
454 CIO_TRACE_EVENT(4, "slowpath");
455 for_each_subchannel_staged(slow_eval_known_fn, slow_eval_unknown_fn,
456 NULL);
457}
458
459static DECLARE_WORK(slow_path_work, css_slow_path_func);
460struct workqueue_struct *slow_path_wq;
461
462void css_schedule_eval(struct subchannel_id schid)
463{
464 unsigned long flags;
465
466 spin_lock_irqsave(&slow_subchannel_lock, flags);
467 idset_sch_add(slow_subchannel_set, schid);
468 queue_work(slow_path_wq, &slow_path_work);
469 spin_unlock_irqrestore(&slow_subchannel_lock, flags);
470}
471
472void css_schedule_eval_all(void)
473{
474 unsigned long flags;
475
476 spin_lock_irqsave(&slow_subchannel_lock, flags);
477 idset_fill(slow_subchannel_set);
478 queue_work(slow_path_wq, &slow_path_work);
479 spin_unlock_irqrestore(&slow_subchannel_lock, flags);
480}
481
482void css_wait_for_slow_path(void)
483{
484 flush_workqueue(slow_path_wq);
485}
486
487/* Reprobe subchannel if unregistered. */
488static int reprobe_subchannel(struct subchannel_id schid, void *data)
489{
490 int ret;
491
492 CIO_MSG_EVENT(6, "cio: reprobe 0.%x.%04x\n",
493 schid.ssid, schid.sch_no);
494 if (need_reprobe)
495 return -EAGAIN;
496
497 ret = css_probe_device(schid);
498 switch (ret) {
499 case 0:
500 break;
501 case -ENXIO:
502 case -ENOMEM:
503 case -EIO:
504 /* These should abort looping */
505 break;
506 default:
507 ret = 0;
508 }
509
510 return ret;
511}
512
513/* Work function used to reprobe all unregistered subchannels. */
514static void reprobe_all(struct work_struct *unused)
515{
516 int ret;
517
518 CIO_MSG_EVENT(4, "reprobe start\n");
519
520 need_reprobe = 0;
521 /* Make sure initial subchannel scan is done. */
522 wait_event(ccw_device_init_wq,
523 atomic_read(&ccw_device_init_count) == 0);
524 ret = for_each_subchannel_staged(NULL, reprobe_subchannel, NULL);
525
526 CIO_MSG_EVENT(4, "reprobe done (rc=%d, need_reprobe=%d)\n", ret,
527 need_reprobe);
528}
529
530static DECLARE_WORK(css_reprobe_work, reprobe_all);
531
532/* Schedule reprobing of all unregistered subchannels. */
533void css_schedule_reprobe(void)
534{
535 need_reprobe = 1;
536 queue_work(slow_path_wq, &css_reprobe_work);
537}
538
539EXPORT_SYMBOL_GPL(css_schedule_reprobe);
540
541/*
542 * Called from the machine check handler for subchannel report words.
543 */
544static void css_process_crw(struct crw *crw0, struct crw *crw1, int overflow)
545{
546 struct subchannel_id mchk_schid;
547
548 if (overflow) {
549 css_schedule_eval_all();
550 return;
551 }
552 CIO_CRW_EVENT(2, "CRW0 reports slct=%d, oflw=%d, "
553 "chn=%d, rsc=%X, anc=%d, erc=%X, rsid=%X\n",
554 crw0->slct, crw0->oflw, crw0->chn, crw0->rsc, crw0->anc,
555 crw0->erc, crw0->rsid);
556 if (crw1)
557 CIO_CRW_EVENT(2, "CRW1 reports slct=%d, oflw=%d, "
558 "chn=%d, rsc=%X, anc=%d, erc=%X, rsid=%X\n",
559 crw1->slct, crw1->oflw, crw1->chn, crw1->rsc,
560 crw1->anc, crw1->erc, crw1->rsid);
561 init_subchannel_id(&mchk_schid);
562 mchk_schid.sch_no = crw0->rsid;
563 if (crw1)
564 mchk_schid.ssid = (crw1->rsid >> 8) & 3;
565
566 /*
567 * Since we are always presented with IPI in the CRW, we have to
568 * use stsch() to find out if the subchannel in question has come
569 * or gone.
570 */
571 css_evaluate_subchannel(mchk_schid, 0);
572}
573
574static int __init
575__init_channel_subsystem(struct subchannel_id schid, void *data)
576{
577 struct subchannel *sch;
578 int ret;
579
580 if (cio_is_console(schid))
581 sch = cio_get_console_subchannel();
582 else {
583 sch = css_alloc_subchannel(schid);
584 if (IS_ERR(sch))
585 ret = PTR_ERR(sch);
586 else
587 ret = 0;
588 switch (ret) {
589 case 0:
590 break;
591 case -ENOMEM:
592 panic("Out of memory in init_channel_subsystem\n");
593 /* -ENXIO: no more subchannels. */
594 case -ENXIO:
595 return ret;
596 /* -EIO: this subchannel set not supported. */
597 case -EIO:
598 return ret;
599 default:
600 return 0;
601 }
602 }
603 /*
604 * We register ALL valid subchannels in ioinfo, even those
605 * that have been present before init_channel_subsystem.
606 * These subchannels can't have been registered yet (kmalloc
607 * not working) so we do it now. This is true e.g. for the
608 * console subchannel.
609 */
610 css_register_subchannel(sch);
611 return 0;
612}
613
614static void __init
615css_generate_pgid(struct channel_subsystem *css, u32 tod_high)
616{
617 if (css_general_characteristics.mcss) {
618 css->global_pgid.pgid_high.ext_cssid.version = 0x80;
619 css->global_pgid.pgid_high.ext_cssid.cssid = css->cssid;
620 } else {
621#ifdef CONFIG_SMP
622 css->global_pgid.pgid_high.cpu_addr = hard_smp_processor_id();
623#else
624 css->global_pgid.pgid_high.cpu_addr = 0;
625#endif
626 }
627 css->global_pgid.cpu_id = ((cpuid_t *) __LC_CPUID)->ident;
628 css->global_pgid.cpu_model = ((cpuid_t *) __LC_CPUID)->machine;
629 css->global_pgid.tod_high = tod_high;
630
631}
632
633static void
634channel_subsystem_release(struct device *dev)
635{
636 struct channel_subsystem *css;
637
638 css = to_css(dev);
639 mutex_destroy(&css->mutex);
640 if (css->pseudo_subchannel) {
641 /* Implies that it has been generated but never registered. */
642 css_subchannel_release(&css->pseudo_subchannel->dev);
643 css->pseudo_subchannel = NULL;
644 }
645 kfree(css);
646}
647
648static ssize_t
649css_cm_enable_show(struct device *dev, struct device_attribute *attr,
650 char *buf)
651{
652 struct channel_subsystem *css = to_css(dev);
653 int ret;
654
655 if (!css)
656 return 0;
657 mutex_lock(&css->mutex);
658 ret = sprintf(buf, "%x\n", css->cm_enabled);
659 mutex_unlock(&css->mutex);
660 return ret;
661}
662
663static ssize_t
664css_cm_enable_store(struct device *dev, struct device_attribute *attr,
665 const char *buf, size_t count)
666{
667 struct channel_subsystem *css = to_css(dev);
668 int ret;
669 unsigned long val;
670
671 ret = strict_strtoul(buf, 16, &val);
672 if (ret)
673 return ret;
674 mutex_lock(&css->mutex);
675 switch (val) {
676 case 0:
677 ret = css->cm_enabled ? chsc_secm(css, 0) : 0;
678 break;
679 case 1:
680 ret = css->cm_enabled ? 0 : chsc_secm(css, 1);
681 break;
682 default:
683 ret = -EINVAL;
684 }
685 mutex_unlock(&css->mutex);
686 return ret < 0 ? ret : count;
687}
688
689static DEVICE_ATTR(cm_enable, 0644, css_cm_enable_show, css_cm_enable_store);
690
691static int __init setup_css(int nr)
692{
693 u32 tod_high;
694 int ret;
695 struct channel_subsystem *css;
696
697 css = channel_subsystems[nr];
698 memset(css, 0, sizeof(struct channel_subsystem));
699 css->pseudo_subchannel =
700 kzalloc(sizeof(*css->pseudo_subchannel), GFP_KERNEL);
701 if (!css->pseudo_subchannel)
702 return -ENOMEM;
703 css->pseudo_subchannel->dev.parent = &css->device;
704 css->pseudo_subchannel->dev.release = css_subchannel_release;
705 dev_set_name(&css->pseudo_subchannel->dev, "defunct");
706 ret = cio_create_sch_lock(css->pseudo_subchannel);
707 if (ret) {
708 kfree(css->pseudo_subchannel);
709 return ret;
710 }
711 mutex_init(&css->mutex);
712 css->valid = 1;
713 css->cssid = nr;
714 dev_set_name(&css->device, "css%x", nr);
715 css->device.release = channel_subsystem_release;
716 tod_high = (u32) (get_clock() >> 32);
717 css_generate_pgid(css, tod_high);
718 return 0;
719}
720
721static int css_reboot_event(struct notifier_block *this,
722 unsigned long event,
723 void *ptr)
724{
725 int ret, i;
726
727 ret = NOTIFY_DONE;
728 for (i = 0; i <= __MAX_CSSID; i++) {
729 struct channel_subsystem *css;
730
731 css = channel_subsystems[i];
732 mutex_lock(&css->mutex);
733 if (css->cm_enabled)
734 if (chsc_secm(css, 0))
735 ret = NOTIFY_BAD;
736 mutex_unlock(&css->mutex);
737 }
738
739 return ret;
740}
741
742static struct notifier_block css_reboot_notifier = {
743 .notifier_call = css_reboot_event,
744};
745
746/*
747 * Now that the driver core is running, we can setup our channel subsystem.
748 * The struct subchannel's are created during probing (except for the
749 * static console subchannel).
750 */
751static int __init
752init_channel_subsystem (void)
753{
754 int ret, i;
755
756 ret = chsc_determine_css_characteristics();
757 if (ret == -ENOMEM)
758 goto out; /* No need to continue. */
759
760 ret = chsc_alloc_sei_area();
761 if (ret)
762 goto out;
763
764 ret = slow_subchannel_init();
765 if (ret)
766 goto out;
767
768 ret = s390_register_crw_handler(CRW_RSC_SCH, css_process_crw);
769 if (ret)
770 goto out;
771
772 if ((ret = bus_register(&css_bus_type)))
773 goto out;
774
775 /* Try to enable MSS. */
776 ret = chsc_enable_facility(CHSC_SDA_OC_MSS);
777 switch (ret) {
778 case 0: /* Success. */
779 max_ssid = __MAX_SSID;
780 break;
781 case -ENOMEM:
782 goto out_bus;
783 default:
784 max_ssid = 0;
785 }
786 /* Setup css structure. */
787 for (i = 0; i <= __MAX_CSSID; i++) {
788 struct channel_subsystem *css;
789
790 css = kmalloc(sizeof(struct channel_subsystem), GFP_KERNEL);
791 if (!css) {
792 ret = -ENOMEM;
793 goto out_unregister;
794 }
795 channel_subsystems[i] = css;
796 ret = setup_css(i);
797 if (ret) {
798 kfree(channel_subsystems[i]);
799 goto out_unregister;
800 }
801 ret = device_register(&css->device);
802 if (ret) {
803 put_device(&css->device);
804 goto out_unregister;
805 }
806 if (css_chsc_characteristics.secm) {
807 ret = device_create_file(&css->device,
808 &dev_attr_cm_enable);
809 if (ret)
810 goto out_device;
811 }
812 ret = device_register(&css->pseudo_subchannel->dev);
813 if (ret)
814 goto out_file;
815 }
816 ret = register_reboot_notifier(&css_reboot_notifier);
817 if (ret)
818 goto out_unregister;
819 css_init_done = 1;
820
821 /* Enable default isc for I/O subchannels. */
822 isc_register(IO_SCH_ISC);
823
824 for_each_subchannel(__init_channel_subsystem, NULL);
825 return 0;
826out_file:
827 if (css_chsc_characteristics.secm)
828 device_remove_file(&channel_subsystems[i]->device,
829 &dev_attr_cm_enable);
830out_device:
831 device_unregister(&channel_subsystems[i]->device);
832out_unregister:
833 while (i > 0) {
834 struct channel_subsystem *css;
835
836 i--;
837 css = channel_subsystems[i];
838 device_unregister(&css->pseudo_subchannel->dev);
839 css->pseudo_subchannel = NULL;
840 if (css_chsc_characteristics.secm)
841 device_remove_file(&css->device,
842 &dev_attr_cm_enable);
843 device_unregister(&css->device);
844 }
845out_bus:
846 bus_unregister(&css_bus_type);
847out:
848 s390_unregister_crw_handler(CRW_RSC_CSS);
849 chsc_free_sei_area();
850 kfree(slow_subchannel_set);
851 pr_alert("The CSS device driver initialization failed with "
852 "errno=%d\n", ret);
853 return ret;
854}
855
856int sch_is_pseudo_sch(struct subchannel *sch)
857{
858 return sch == to_css(sch->dev.parent)->pseudo_subchannel;
859}
860
861static int css_bus_match(struct device *dev, struct device_driver *drv)
862{
863 struct subchannel *sch = to_subchannel(dev);
864 struct css_driver *driver = to_cssdriver(drv);
865 struct css_device_id *id;
866
867 for (id = driver->subchannel_type; id->match_flags; id++) {
868 if (sch->st == id->type)
869 return 1;
870 }
871
872 return 0;
873}
874
875static int css_probe(struct device *dev)
876{
877 struct subchannel *sch;
878 int ret;
879
880 sch = to_subchannel(dev);
881 sch->driver = to_cssdriver(dev->driver);
882 ret = sch->driver->probe ? sch->driver->probe(sch) : 0;
883 if (ret)
884 sch->driver = NULL;
885 return ret;
886}
887
888static int css_remove(struct device *dev)
889{
890 struct subchannel *sch;
891 int ret;
892
893 sch = to_subchannel(dev);
894 ret = sch->driver->remove ? sch->driver->remove(sch) : 0;
895 sch->driver = NULL;
896 return ret;
897}
898
899static void css_shutdown(struct device *dev)
900{
901 struct subchannel *sch;
902
903 sch = to_subchannel(dev);
904 if (sch->driver && sch->driver->shutdown)
905 sch->driver->shutdown(sch);
906}
907
908static int css_uevent(struct device *dev, struct kobj_uevent_env *env)
909{
910 struct subchannel *sch = to_subchannel(dev);
911 int ret;
912
913 ret = add_uevent_var(env, "ST=%01X", sch->st);
914 if (ret)
915 return ret;
916 ret = add_uevent_var(env, "MODALIAS=css:t%01X", sch->st);
917 return ret;
918}
919
920struct bus_type css_bus_type = {
921 .name = "css",
922 .match = css_bus_match,
923 .probe = css_probe,
924 .remove = css_remove,
925 .shutdown = css_shutdown,
926 .uevent = css_uevent,
927};
928
929/**
930 * css_driver_register - register a css driver
931 * @cdrv: css driver to register
932 *
933 * This is mainly a wrapper around driver_register that sets name
934 * and bus_type in the embedded struct device_driver correctly.
935 */
936int css_driver_register(struct css_driver *cdrv)
937{
938 cdrv->drv.name = cdrv->name;
939 cdrv->drv.bus = &css_bus_type;
940 cdrv->drv.owner = cdrv->owner;
941 return driver_register(&cdrv->drv);
942}
943EXPORT_SYMBOL_GPL(css_driver_register);
944
945/**
946 * css_driver_unregister - unregister a css driver
947 * @cdrv: css driver to unregister
948 *
949 * This is a wrapper around driver_unregister.
950 */
951void css_driver_unregister(struct css_driver *cdrv)
952{
953 driver_unregister(&cdrv->drv);
954}
955EXPORT_SYMBOL_GPL(css_driver_unregister);
956
957subsys_initcall(init_channel_subsystem);
958
959MODULE_LICENSE("GPL");
960EXPORT_SYMBOL(css_bus_type);