2 * bus driver for ccw devices
4 * Copyright IBM Corp. 2002, 2008
5 * Author(s): Arnd Bergmann (arndb@de.ibm.com)
6 * Cornelia Huck (cornelia.huck@de.ibm.com)
7 * Martin Schwidefsky (schwidefsky@de.ibm.com)
10 #define KMSG_COMPONENT "cio"
11 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/spinlock.h>
16 #include <linux/errno.h>
17 #include <linux/err.h>
18 #include <linux/slab.h>
19 #include <linux/list.h>
20 #include <linux/device.h>
21 #include <linux/workqueue.h>
22 #include <linux/delay.h>
23 #include <linux/timer.h>
24 #include <linux/kernel_stat.h>
26 #include <asm/ccwdev.h>
28 #include <asm/param.h> /* HZ */
34 #include "cio_debug.h"
39 #include "blacklist.h"
42 static struct timer_list recovery_timer;
43 static DEFINE_SPINLOCK(recovery_lock);
44 static int recovery_phase;
45 static const unsigned long recovery_delay[] = { 3, 30, 300 };
47 static atomic_t ccw_device_init_count = ATOMIC_INIT(0);
48 static DECLARE_WAIT_QUEUE_HEAD(ccw_device_init_wq);
49 static struct bus_type ccw_bus_type;
51 /******************* bus type handling ***********************/
53 /* The Linux driver model distinguishes between a bus type and
54 * the bus itself. Of course we only have one channel
55 * subsystem driver and one channel system per machine, but
56 * we still use the abstraction. T.R. says it's a good idea. */
58 ccw_bus_match (struct device * dev, struct device_driver * drv)
60 struct ccw_device *cdev = to_ccwdev(dev);
61 struct ccw_driver *cdrv = to_ccwdrv(drv);
62 const struct ccw_device_id *ids = cdrv->ids, *found;
67 found = ccw_device_id_match(ids, &cdev->id);
71 cdev->id.driver_info = found->driver_info;
76 /* Store modalias string delimited by prefix/suffix string into buffer with
77 * specified size. Return length of resulting string (excluding trailing '\0')
78 * even if string doesn't fit buffer (snprintf semantics). */
79 static int snprint_alias(char *buf, size_t size,
80 struct ccw_device_id *id, const char *suffix)
84 len = snprintf(buf, size, "ccw:t%04Xm%02X", id->cu_type, id->cu_model);
90 if (id->dev_type != 0)
91 len += snprintf(buf, size, "dt%04Xdm%02X%s", id->dev_type,
92 id->dev_model, suffix);
94 len += snprintf(buf, size, "dtdm%s", suffix);
99 /* Set up environment variables for ccw device uevent. Return 0 on success,
100 * non-zero otherwise. */
101 static int ccw_uevent(struct device *dev, struct kobj_uevent_env *env)
103 struct ccw_device *cdev = to_ccwdev(dev);
104 struct ccw_device_id *id = &(cdev->id);
106 char modalias_buf[30];
109 ret = add_uevent_var(env, "CU_TYPE=%04X", id->cu_type);
114 ret = add_uevent_var(env, "CU_MODEL=%02X", id->cu_model);
118 /* The next two can be zero, that's ok for us */
120 ret = add_uevent_var(env, "DEV_TYPE=%04X", id->dev_type);
125 ret = add_uevent_var(env, "DEV_MODEL=%02X", id->dev_model);
130 snprint_alias(modalias_buf, sizeof(modalias_buf), id, "");
131 ret = add_uevent_var(env, "MODALIAS=%s", modalias_buf);
135 static void io_subchannel_irq(struct subchannel *);
136 static int io_subchannel_probe(struct subchannel *);
137 static int io_subchannel_remove(struct subchannel *);
138 static void io_subchannel_shutdown(struct subchannel *);
139 static int io_subchannel_sch_event(struct subchannel *, int);
140 static int io_subchannel_chp_event(struct subchannel *, struct chp_link *,
142 static void recovery_func(unsigned long data);
144 static struct css_device_id io_subchannel_ids[] = {
145 { .match_flags = 0x1, .type = SUBCHANNEL_TYPE_IO, },
146 { /* end of list */ },
148 MODULE_DEVICE_TABLE(css, io_subchannel_ids);
150 static int io_subchannel_prepare(struct subchannel *sch)
152 struct ccw_device *cdev;
154 * Don't allow suspend while a ccw device registration
155 * is still outstanding.
157 cdev = sch_get_cdev(sch);
158 if (cdev && !device_is_registered(&cdev->dev))
163 static int io_subchannel_settle(void)
167 ret = wait_event_interruptible(ccw_device_init_wq,
168 atomic_read(&ccw_device_init_count) == 0);
171 flush_workqueue(cio_work_q);
175 static struct css_driver io_subchannel_driver = {
177 .owner = THIS_MODULE,
178 .name = "io_subchannel",
180 .subchannel_type = io_subchannel_ids,
181 .irq = io_subchannel_irq,
182 .sch_event = io_subchannel_sch_event,
183 .chp_event = io_subchannel_chp_event,
184 .probe = io_subchannel_probe,
185 .remove = io_subchannel_remove,
186 .shutdown = io_subchannel_shutdown,
187 .prepare = io_subchannel_prepare,
188 .settle = io_subchannel_settle,
191 int __init io_subchannel_init(void)
195 setup_timer(&recovery_timer, recovery_func, 0);
196 ret = bus_register(&ccw_bus_type);
199 ret = css_driver_register(&io_subchannel_driver);
201 bus_unregister(&ccw_bus_type);
207 /************************ device handling **************************/
210 * A ccw_device has some interfaces in sysfs in addition to the
212 * The following entries are designed to export the information which
213 * resided in 2.4 in /proc/subchannels. Subchannel and device number
214 * are obvious, so they don't have an entry :)
215 * TODO: Split chpids and pimpampom up? Where is "in use" in the tree?
218 chpids_show (struct device * dev, struct device_attribute *attr, char * buf)
220 struct subchannel *sch = to_subchannel(dev);
221 struct chsc_ssd_info *ssd = &sch->ssd_info;
226 for (chp = 0; chp < 8; chp++) {
228 if (ssd->path_mask & mask)
229 ret += sprintf(buf + ret, "%02x ", ssd->chpid[chp].id);
231 ret += sprintf(buf + ret, "00 ");
233 ret += sprintf (buf+ret, "\n");
234 return min((ssize_t)PAGE_SIZE, ret);
238 pimpampom_show (struct device * dev, struct device_attribute *attr, char * buf)
240 struct subchannel *sch = to_subchannel(dev);
241 struct pmcw *pmcw = &sch->schib.pmcw;
243 return sprintf (buf, "%02x %02x %02x\n",
244 pmcw->pim, pmcw->pam, pmcw->pom);
248 devtype_show (struct device *dev, struct device_attribute *attr, char *buf)
250 struct ccw_device *cdev = to_ccwdev(dev);
251 struct ccw_device_id *id = &(cdev->id);
253 if (id->dev_type != 0)
254 return sprintf(buf, "%04x/%02x\n",
255 id->dev_type, id->dev_model);
257 return sprintf(buf, "n/a\n");
261 cutype_show (struct device *dev, struct device_attribute *attr, char *buf)
263 struct ccw_device *cdev = to_ccwdev(dev);
264 struct ccw_device_id *id = &(cdev->id);
266 return sprintf(buf, "%04x/%02x\n",
267 id->cu_type, id->cu_model);
271 modalias_show (struct device *dev, struct device_attribute *attr, char *buf)
273 struct ccw_device *cdev = to_ccwdev(dev);
274 struct ccw_device_id *id = &(cdev->id);
277 len = snprint_alias(buf, PAGE_SIZE, id, "\n");
279 return len > PAGE_SIZE ? PAGE_SIZE : len;
283 online_show (struct device *dev, struct device_attribute *attr, char *buf)
285 struct ccw_device *cdev = to_ccwdev(dev);
287 return sprintf(buf, cdev->online ? "1\n" : "0\n");
290 int ccw_device_is_orphan(struct ccw_device *cdev)
292 return sch_is_pseudo_sch(to_subchannel(cdev->dev.parent));
295 static void ccw_device_unregister(struct ccw_device *cdev)
297 if (device_is_registered(&cdev->dev)) {
298 /* Undo device_add(). */
299 device_del(&cdev->dev);
301 if (cdev->private->flags.initialized) {
302 cdev->private->flags.initialized = 0;
303 /* Release reference from device_initialize(). */
304 put_device(&cdev->dev);
308 static void io_subchannel_quiesce(struct subchannel *);
311 * ccw_device_set_offline() - disable a ccw device for I/O
312 * @cdev: target ccw device
314 * This function calls the driver's set_offline() function for @cdev, if
315 * given, and then disables @cdev.
317 * %0 on success and a negative error value on failure.
319 * enabled, ccw device lock not held
321 int ccw_device_set_offline(struct ccw_device *cdev)
323 struct subchannel *sch;
328 if (!cdev->online || !cdev->drv)
331 if (cdev->drv->set_offline) {
332 ret = cdev->drv->set_offline(cdev);
336 spin_lock_irq(cdev->ccwlock);
337 sch = to_subchannel(cdev->dev.parent);
339 /* Wait until a final state or DISCONNECTED is reached */
340 while (!dev_fsm_final_state(cdev) &&
341 cdev->private->state != DEV_STATE_DISCONNECTED) {
342 spin_unlock_irq(cdev->ccwlock);
343 wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
344 cdev->private->state == DEV_STATE_DISCONNECTED));
345 spin_lock_irq(cdev->ccwlock);
348 ret = ccw_device_offline(cdev);
351 CIO_MSG_EVENT(0, "ccw_device_offline returned %d, device "
352 "0.%x.%04x\n", ret, cdev->private->dev_id.ssid,
353 cdev->private->dev_id.devno);
356 state = cdev->private->state;
357 spin_unlock_irq(cdev->ccwlock);
358 io_subchannel_quiesce(sch);
359 spin_lock_irq(cdev->ccwlock);
360 cdev->private->state = state;
361 } while (ret == -EBUSY);
362 spin_unlock_irq(cdev->ccwlock);
363 wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
364 cdev->private->state == DEV_STATE_DISCONNECTED));
365 /* Inform the user if set offline failed. */
366 if (cdev->private->state == DEV_STATE_BOXED) {
367 pr_warning("%s: The device entered boxed state while "
368 "being set offline\n", dev_name(&cdev->dev));
369 } else if (cdev->private->state == DEV_STATE_NOT_OPER) {
370 pr_warning("%s: The device stopped operating while "
371 "being set offline\n", dev_name(&cdev->dev));
373 /* Give up reference from ccw_device_set_online(). */
374 put_device(&cdev->dev);
378 cdev->private->state = DEV_STATE_OFFLINE;
379 dev_fsm_event(cdev, DEV_EVENT_NOTOPER);
380 spin_unlock_irq(cdev->ccwlock);
381 /* Give up reference from ccw_device_set_online(). */
382 put_device(&cdev->dev);
387 * ccw_device_set_online() - enable a ccw device for I/O
388 * @cdev: target ccw device
390 * This function first enables @cdev and then calls the driver's set_online()
391 * function for @cdev, if given. If set_online() returns an error, @cdev is
394 * %0 on success and a negative error value on failure.
396 * enabled, ccw device lock not held
398 int ccw_device_set_online(struct ccw_device *cdev)
405 if (cdev->online || !cdev->drv)
407 /* Hold on to an extra reference while device is online. */
408 if (!get_device(&cdev->dev))
411 spin_lock_irq(cdev->ccwlock);
412 ret = ccw_device_online(cdev);
413 spin_unlock_irq(cdev->ccwlock);
415 wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev));
417 CIO_MSG_EVENT(0, "ccw_device_online returned %d, "
418 "device 0.%x.%04x\n",
419 ret, cdev->private->dev_id.ssid,
420 cdev->private->dev_id.devno);
421 /* Give up online reference since onlining failed. */
422 put_device(&cdev->dev);
425 spin_lock_irq(cdev->ccwlock);
426 /* Check if online processing was successful */
427 if ((cdev->private->state != DEV_STATE_ONLINE) &&
428 (cdev->private->state != DEV_STATE_W4SENSE)) {
429 spin_unlock_irq(cdev->ccwlock);
430 /* Inform the user that set online failed. */
431 if (cdev->private->state == DEV_STATE_BOXED) {
432 pr_warning("%s: Setting the device online failed "
433 "because it is boxed\n",
434 dev_name(&cdev->dev));
435 } else if (cdev->private->state == DEV_STATE_NOT_OPER) {
436 pr_warning("%s: Setting the device online failed "
437 "because it is not operational\n",
438 dev_name(&cdev->dev));
440 /* Give up online reference since onlining failed. */
441 put_device(&cdev->dev);
444 spin_unlock_irq(cdev->ccwlock);
445 if (cdev->drv->set_online)
446 ret = cdev->drv->set_online(cdev);
450 spin_lock_irq(cdev->ccwlock);
452 spin_unlock_irq(cdev->ccwlock);
456 spin_lock_irq(cdev->ccwlock);
457 /* Wait until a final state or DISCONNECTED is reached */
458 while (!dev_fsm_final_state(cdev) &&
459 cdev->private->state != DEV_STATE_DISCONNECTED) {
460 spin_unlock_irq(cdev->ccwlock);
461 wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
462 cdev->private->state == DEV_STATE_DISCONNECTED));
463 spin_lock_irq(cdev->ccwlock);
465 ret2 = ccw_device_offline(cdev);
468 spin_unlock_irq(cdev->ccwlock);
469 wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
470 cdev->private->state == DEV_STATE_DISCONNECTED));
471 /* Give up online reference since onlining failed. */
472 put_device(&cdev->dev);
476 CIO_MSG_EVENT(0, "rollback ccw_device_offline returned %d, "
477 "device 0.%x.%04x\n",
478 ret2, cdev->private->dev_id.ssid,
479 cdev->private->dev_id.devno);
480 cdev->private->state = DEV_STATE_OFFLINE;
481 spin_unlock_irq(cdev->ccwlock);
482 /* Give up online reference since onlining failed. */
483 put_device(&cdev->dev);
487 static int online_store_handle_offline(struct ccw_device *cdev)
489 if (cdev->private->state == DEV_STATE_DISCONNECTED) {
490 spin_lock_irq(cdev->ccwlock);
491 ccw_device_sched_todo(cdev, CDEV_TODO_UNREG_EVAL);
492 spin_unlock_irq(cdev->ccwlock);
495 if (cdev->drv && cdev->drv->set_offline)
496 return ccw_device_set_offline(cdev);
500 static int online_store_recog_and_online(struct ccw_device *cdev)
502 /* Do device recognition, if needed. */
503 if (cdev->private->state == DEV_STATE_BOXED) {
504 spin_lock_irq(cdev->ccwlock);
505 ccw_device_recognition(cdev);
506 spin_unlock_irq(cdev->ccwlock);
507 wait_event(cdev->private->wait_q,
508 cdev->private->flags.recog_done);
509 if (cdev->private->state != DEV_STATE_OFFLINE)
510 /* recognition failed */
513 if (cdev->drv && cdev->drv->set_online)
514 return ccw_device_set_online(cdev);
518 static int online_store_handle_online(struct ccw_device *cdev, int force)
522 ret = online_store_recog_and_online(cdev);
525 if (force && cdev->private->state == DEV_STATE_BOXED) {
526 ret = ccw_device_stlck(cdev);
529 if (cdev->id.cu_type == 0)
530 cdev->private->state = DEV_STATE_NOT_OPER;
531 ret = online_store_recog_and_online(cdev);
538 static ssize_t online_store (struct device *dev, struct device_attribute *attr,
539 const char *buf, size_t count)
541 struct ccw_device *cdev = to_ccwdev(dev);
545 /* Prevent conflict between multiple on-/offline processing requests. */
546 if (atomic_cmpxchg(&cdev->private->onoff, 0, 1) != 0)
548 /* Prevent conflict between internal I/Os and on-/offline processing. */
549 if (!dev_fsm_final_state(cdev) &&
550 cdev->private->state != DEV_STATE_DISCONNECTED) {
554 /* Prevent conflict between pending work and on-/offline processing.*/
555 if (work_pending(&cdev->private->todo_work)) {
559 if (!strncmp(buf, "force\n", count)) {
565 ret = kstrtoul(buf, 16, &i);
573 ret = online_store_handle_offline(cdev);
576 ret = online_store_handle_online(cdev, force);
584 atomic_set(&cdev->private->onoff, 0);
585 return (ret < 0) ? ret : count;
589 available_show (struct device *dev, struct device_attribute *attr, char *buf)
591 struct ccw_device *cdev = to_ccwdev(dev);
592 struct subchannel *sch;
594 if (ccw_device_is_orphan(cdev))
595 return sprintf(buf, "no device\n");
596 switch (cdev->private->state) {
597 case DEV_STATE_BOXED:
598 return sprintf(buf, "boxed\n");
599 case DEV_STATE_DISCONNECTED:
600 case DEV_STATE_DISCONNECTED_SENSE_ID:
601 case DEV_STATE_NOT_OPER:
602 sch = to_subchannel(dev->parent);
604 return sprintf(buf, "no path\n");
606 return sprintf(buf, "no device\n");
608 /* All other states considered fine. */
609 return sprintf(buf, "good\n");
614 initiate_logging(struct device *dev, struct device_attribute *attr,
615 const char *buf, size_t count)
617 struct subchannel *sch = to_subchannel(dev);
620 rc = chsc_siosl(sch->schid);
622 pr_warning("Logging for subchannel 0.%x.%04x failed with "
624 sch->schid.ssid, sch->schid.sch_no, rc);
627 pr_notice("Logging for subchannel 0.%x.%04x was triggered\n",
628 sch->schid.ssid, sch->schid.sch_no);
632 static ssize_t vpm_show(struct device *dev, struct device_attribute *attr,
635 struct subchannel *sch = to_subchannel(dev);
637 return sprintf(buf, "%02x\n", sch->vpm);
640 static DEVICE_ATTR(chpids, 0444, chpids_show, NULL);
641 static DEVICE_ATTR(pimpampom, 0444, pimpampom_show, NULL);
642 static DEVICE_ATTR(devtype, 0444, devtype_show, NULL);
643 static DEVICE_ATTR(cutype, 0444, cutype_show, NULL);
644 static DEVICE_ATTR(modalias, 0444, modalias_show, NULL);
645 static DEVICE_ATTR(online, 0644, online_show, online_store);
646 static DEVICE_ATTR(availability, 0444, available_show, NULL);
647 static DEVICE_ATTR(logging, 0200, NULL, initiate_logging);
648 static DEVICE_ATTR(vpm, 0444, vpm_show, NULL);
650 static struct attribute *io_subchannel_attrs[] = {
651 &dev_attr_chpids.attr,
652 &dev_attr_pimpampom.attr,
653 &dev_attr_logging.attr,
658 static struct attribute_group io_subchannel_attr_group = {
659 .attrs = io_subchannel_attrs,
662 static struct attribute * ccwdev_attrs[] = {
663 &dev_attr_devtype.attr,
664 &dev_attr_cutype.attr,
665 &dev_attr_modalias.attr,
666 &dev_attr_online.attr,
667 &dev_attr_cmb_enable.attr,
668 &dev_attr_availability.attr,
672 static struct attribute_group ccwdev_attr_group = {
673 .attrs = ccwdev_attrs,
676 static const struct attribute_group *ccwdev_attr_groups[] = {
681 static int ccw_device_add(struct ccw_device *cdev)
683 struct device *dev = &cdev->dev;
685 dev->bus = &ccw_bus_type;
686 return device_add(dev);
689 static int match_dev_id(struct device *dev, void *data)
691 struct ccw_device *cdev = to_ccwdev(dev);
692 struct ccw_dev_id *dev_id = data;
694 return ccw_dev_id_is_equal(&cdev->private->dev_id, dev_id);
698 * get_ccwdev_by_dev_id() - obtain device from a ccw device id
699 * @dev_id: id of the device to be searched
701 * This function searches all devices attached to the ccw bus for a device
704 * If a device is found its reference count is increased and returned;
705 * else %NULL is returned.
707 struct ccw_device *get_ccwdev_by_dev_id(struct ccw_dev_id *dev_id)
711 dev = bus_find_device(&ccw_bus_type, NULL, dev_id, match_dev_id);
713 return dev ? to_ccwdev(dev) : NULL;
715 EXPORT_SYMBOL_GPL(get_ccwdev_by_dev_id);
717 static void ccw_device_do_unbind_bind(struct ccw_device *cdev)
721 if (device_is_registered(&cdev->dev)) {
722 device_release_driver(&cdev->dev);
723 ret = device_attach(&cdev->dev);
724 WARN_ON(ret == -ENODEV);
729 ccw_device_release(struct device *dev)
731 struct ccw_device *cdev;
733 cdev = to_ccwdev(dev);
734 /* Release reference of parent subchannel. */
735 put_device(cdev->dev.parent);
736 kfree(cdev->private);
740 static struct ccw_device * io_subchannel_allocate_dev(struct subchannel *sch)
742 struct ccw_device *cdev;
744 cdev = kzalloc(sizeof(*cdev), GFP_KERNEL);
746 cdev->private = kzalloc(sizeof(struct ccw_device_private),
747 GFP_KERNEL | GFP_DMA);
752 return ERR_PTR(-ENOMEM);
755 static void ccw_device_todo(struct work_struct *work);
757 static int io_subchannel_initialize_dev(struct subchannel *sch,
758 struct ccw_device *cdev)
760 struct ccw_device_private *priv = cdev->private;
764 priv->int_class = IRQIO_CIO;
765 priv->state = DEV_STATE_NOT_OPER;
766 priv->dev_id.devno = sch->schib.pmcw.dev;
767 priv->dev_id.ssid = sch->schid.ssid;
768 priv->schid = sch->schid;
770 INIT_WORK(&priv->todo_work, ccw_device_todo);
771 INIT_LIST_HEAD(&priv->cmb_list);
772 init_waitqueue_head(&priv->wait_q);
773 init_timer(&priv->timer);
775 atomic_set(&priv->onoff, 0);
776 cdev->ccwlock = sch->lock;
777 cdev->dev.parent = &sch->dev;
778 cdev->dev.release = ccw_device_release;
779 cdev->dev.groups = ccwdev_attr_groups;
780 /* Do first half of device_register. */
781 device_initialize(&cdev->dev);
782 ret = dev_set_name(&cdev->dev, "0.%x.%04x", cdev->private->dev_id.ssid,
783 cdev->private->dev_id.devno);
786 if (!get_device(&sch->dev)) {
790 priv->flags.initialized = 1;
791 spin_lock_irq(sch->lock);
792 sch_set_cdev(sch, cdev);
793 spin_unlock_irq(sch->lock);
797 /* Release reference from device_initialize(). */
798 put_device(&cdev->dev);
802 static struct ccw_device * io_subchannel_create_ccwdev(struct subchannel *sch)
804 struct ccw_device *cdev;
807 cdev = io_subchannel_allocate_dev(sch);
809 ret = io_subchannel_initialize_dev(sch, cdev);
816 static void io_subchannel_recog(struct ccw_device *, struct subchannel *);
818 static void sch_create_and_recog_new_device(struct subchannel *sch)
820 struct ccw_device *cdev;
822 /* Need to allocate a new ccw device. */
823 cdev = io_subchannel_create_ccwdev(sch);
825 /* OK, we did everything we could... */
826 css_sch_device_unregister(sch);
829 /* Start recognition for the new ccw device. */
830 io_subchannel_recog(cdev, sch);
834 * Register recognized device.
836 static void io_subchannel_register(struct ccw_device *cdev)
838 struct subchannel *sch;
839 int ret, adjust_init_count = 1;
842 sch = to_subchannel(cdev->dev.parent);
844 * Check if subchannel is still registered. It may have become
845 * unregistered if a machine check hit us after finishing
846 * device recognition but before the register work could be
849 if (!device_is_registered(&sch->dev))
851 css_update_ssd_info(sch);
853 * io_subchannel_register() will also be called after device
854 * recognition has been done for a boxed device (which will already
855 * be registered). We need to reprobe since we may now have sense id
858 if (device_is_registered(&cdev->dev)) {
860 ret = device_reprobe(&cdev->dev);
862 /* We can't do much here. */
863 CIO_MSG_EVENT(0, "device_reprobe() returned"
864 " %d for 0.%x.%04x\n", ret,
865 cdev->private->dev_id.ssid,
866 cdev->private->dev_id.devno);
868 adjust_init_count = 0;
872 * Now we know this subchannel will stay, we can throw
873 * our delayed uevent.
875 if (dev_get_uevent_suppress(&sch->dev)) {
876 dev_set_uevent_suppress(&sch->dev, 0);
877 kobject_uevent(&sch->dev.kobj, KOBJ_ADD);
879 /* make it known to the system */
880 ret = ccw_device_add(cdev);
882 CIO_MSG_EVENT(0, "Could not register ccw dev 0.%x.%04x: %d\n",
883 cdev->private->dev_id.ssid,
884 cdev->private->dev_id.devno, ret);
885 spin_lock_irqsave(sch->lock, flags);
886 sch_set_cdev(sch, NULL);
887 spin_unlock_irqrestore(sch->lock, flags);
888 /* Release initial device reference. */
889 put_device(&cdev->dev);
893 cdev->private->flags.recog_done = 1;
894 wake_up(&cdev->private->wait_q);
896 if (adjust_init_count && atomic_dec_and_test(&ccw_device_init_count))
897 wake_up(&ccw_device_init_wq);
900 static void ccw_device_call_sch_unregister(struct ccw_device *cdev)
902 struct subchannel *sch;
904 /* Get subchannel reference for local processing. */
905 if (!get_device(cdev->dev.parent))
907 sch = to_subchannel(cdev->dev.parent);
908 css_sch_device_unregister(sch);
909 /* Release subchannel reference for local processing. */
910 put_device(&sch->dev);
914 * subchannel recognition done. Called from the state machine.
917 io_subchannel_recog_done(struct ccw_device *cdev)
919 if (css_init_done == 0) {
920 cdev->private->flags.recog_done = 1;
923 switch (cdev->private->state) {
924 case DEV_STATE_BOXED:
925 /* Device did not respond in time. */
926 case DEV_STATE_NOT_OPER:
927 cdev->private->flags.recog_done = 1;
928 /* Remove device found not operational. */
929 ccw_device_sched_todo(cdev, CDEV_TODO_UNREG);
930 if (atomic_dec_and_test(&ccw_device_init_count))
931 wake_up(&ccw_device_init_wq);
933 case DEV_STATE_OFFLINE:
935 * We can't register the device in interrupt context so
936 * we schedule a work item.
938 ccw_device_sched_todo(cdev, CDEV_TODO_REGISTER);
943 static void io_subchannel_recog(struct ccw_device *cdev, struct subchannel *sch)
945 /* Increase counter of devices currently in recognition. */
946 atomic_inc(&ccw_device_init_count);
948 /* Start async. device sensing. */
949 spin_lock_irq(sch->lock);
950 ccw_device_recognition(cdev);
951 spin_unlock_irq(sch->lock);
954 static int ccw_device_move_to_sch(struct ccw_device *cdev,
955 struct subchannel *sch)
957 struct subchannel *old_sch;
958 int rc, old_enabled = 0;
960 old_sch = to_subchannel(cdev->dev.parent);
961 /* Obtain child reference for new parent. */
962 if (!get_device(&sch->dev))
965 if (!sch_is_pseudo_sch(old_sch)) {
966 spin_lock_irq(old_sch->lock);
967 old_enabled = old_sch->schib.pmcw.ena;
970 rc = cio_disable_subchannel(old_sch);
971 spin_unlock_irq(old_sch->lock);
973 /* Release child reference for new parent. */
974 put_device(&sch->dev);
979 mutex_lock(&sch->reg_mutex);
980 rc = device_move(&cdev->dev, &sch->dev, DPM_ORDER_PARENT_BEFORE_DEV);
981 mutex_unlock(&sch->reg_mutex);
983 CIO_MSG_EVENT(0, "device_move(0.%x.%04x,0.%x.%04x)=%d\n",
984 cdev->private->dev_id.ssid,
985 cdev->private->dev_id.devno, sch->schid.ssid,
986 sch->schib.pmcw.dev, rc);
988 /* Try to reenable the old subchannel. */
989 spin_lock_irq(old_sch->lock);
990 cio_enable_subchannel(old_sch, (u32)(addr_t)old_sch);
991 spin_unlock_irq(old_sch->lock);
993 /* Release child reference for new parent. */
994 put_device(&sch->dev);
997 /* Clean up old subchannel. */
998 if (!sch_is_pseudo_sch(old_sch)) {
999 spin_lock_irq(old_sch->lock);
1000 sch_set_cdev(old_sch, NULL);
1001 spin_unlock_irq(old_sch->lock);
1002 css_schedule_eval(old_sch->schid);
1004 /* Release child reference for old parent. */
1005 put_device(&old_sch->dev);
1006 /* Initialize new subchannel. */
1007 spin_lock_irq(sch->lock);
1008 cdev->private->schid = sch->schid;
1009 cdev->ccwlock = sch->lock;
1010 if (!sch_is_pseudo_sch(sch))
1011 sch_set_cdev(sch, cdev);
1012 spin_unlock_irq(sch->lock);
1013 if (!sch_is_pseudo_sch(sch))
1014 css_update_ssd_info(sch);
1018 static int ccw_device_move_to_orph(struct ccw_device *cdev)
1020 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1021 struct channel_subsystem *css = to_css(sch->dev.parent);
1023 return ccw_device_move_to_sch(cdev, css->pseudo_subchannel);
1026 static void io_subchannel_irq(struct subchannel *sch)
1028 struct ccw_device *cdev;
1030 cdev = sch_get_cdev(sch);
1032 CIO_TRACE_EVENT(6, "IRQ");
1033 CIO_TRACE_EVENT(6, dev_name(&sch->dev));
1035 dev_fsm_event(cdev, DEV_EVENT_INTERRUPT);
1037 inc_irq_stat(IRQIO_CIO);
1040 void io_subchannel_init_config(struct subchannel *sch)
1042 memset(&sch->config, 0, sizeof(sch->config));
1043 sch->config.csense = 1;
1046 static void io_subchannel_init_fields(struct subchannel *sch)
1048 if (cio_is_console(sch->schid))
1051 sch->opm = chp_get_sch_opm(sch);
1052 sch->lpm = sch->schib.pmcw.pam & sch->opm;
1053 sch->isc = cio_is_console(sch->schid) ? CONSOLE_ISC : IO_SCH_ISC;
1055 CIO_MSG_EVENT(6, "Detected device %04x on subchannel 0.%x.%04X"
1056 " - PIM = %02X, PAM = %02X, POM = %02X\n",
1057 sch->schib.pmcw.dev, sch->schid.ssid,
1058 sch->schid.sch_no, sch->schib.pmcw.pim,
1059 sch->schib.pmcw.pam, sch->schib.pmcw.pom);
1061 io_subchannel_init_config(sch);
1065 * Note: We always return 0 so that we bind to the device even on error.
1066 * This is needed so that our remove function is called on unregister.
1068 static int io_subchannel_probe(struct subchannel *sch)
1070 struct io_subchannel_private *io_priv;
1071 struct ccw_device *cdev;
1074 if (cio_is_console(sch->schid)) {
1075 rc = sysfs_create_group(&sch->dev.kobj,
1076 &io_subchannel_attr_group);
1078 CIO_MSG_EVENT(0, "Failed to create io subchannel "
1079 "attributes for subchannel "
1080 "0.%x.%04x (rc=%d)\n",
1081 sch->schid.ssid, sch->schid.sch_no, rc);
1083 * The console subchannel already has an associated ccw_device.
1084 * Throw the delayed uevent for the subchannel, register
1085 * the ccw_device and exit.
1087 if (dev_get_uevent_suppress(&sch->dev)) {
1088 /* should always be the case for the console */
1089 dev_set_uevent_suppress(&sch->dev, 0);
1090 kobject_uevent(&sch->dev.kobj, KOBJ_ADD);
1092 cdev = sch_get_cdev(sch);
1093 rc = ccw_device_add(cdev);
1095 /* Release online reference. */
1096 put_device(&cdev->dev);
1099 if (atomic_dec_and_test(&ccw_device_init_count))
1100 wake_up(&ccw_device_init_wq);
1103 io_subchannel_init_fields(sch);
1104 rc = cio_commit_config(sch);
1107 rc = sysfs_create_group(&sch->dev.kobj,
1108 &io_subchannel_attr_group);
1111 /* Allocate I/O subchannel private data. */
1112 io_priv = kzalloc(sizeof(*io_priv), GFP_KERNEL | GFP_DMA);
1116 set_io_private(sch, io_priv);
1117 css_schedule_eval(sch->schid);
1121 spin_lock_irq(sch->lock);
1122 css_sched_sch_todo(sch, SCH_TODO_UNREG);
1123 spin_unlock_irq(sch->lock);
1128 io_subchannel_remove (struct subchannel *sch)
1130 struct io_subchannel_private *io_priv = to_io_private(sch);
1131 struct ccw_device *cdev;
1133 cdev = sch_get_cdev(sch);
1136 io_subchannel_quiesce(sch);
1137 /* Set ccw device to not operational and drop reference. */
1138 spin_lock_irq(cdev->ccwlock);
1139 sch_set_cdev(sch, NULL);
1140 set_io_private(sch, NULL);
1141 cdev->private->state = DEV_STATE_NOT_OPER;
1142 spin_unlock_irq(cdev->ccwlock);
1143 ccw_device_unregister(cdev);
1146 sysfs_remove_group(&sch->dev.kobj, &io_subchannel_attr_group);
1150 static void io_subchannel_verify(struct subchannel *sch)
1152 struct ccw_device *cdev;
1154 cdev = sch_get_cdev(sch);
1156 dev_fsm_event(cdev, DEV_EVENT_VERIFY);
1159 static void io_subchannel_terminate_path(struct subchannel *sch, u8 mask)
1161 struct ccw_device *cdev;
1163 cdev = sch_get_cdev(sch);
1166 if (cio_update_schib(sch))
1168 /* Check for I/O on path. */
1169 if (scsw_actl(&sch->schib.scsw) == 0 || sch->schib.pmcw.lpum != mask)
1171 if (cdev->private->state == DEV_STATE_ONLINE) {
1172 ccw_device_kill_io(cdev);
1178 /* Trigger path verification. */
1179 dev_fsm_event(cdev, DEV_EVENT_VERIFY);
1183 dev_fsm_event(cdev, DEV_EVENT_NOTOPER);
1186 static int io_subchannel_chp_event(struct subchannel *sch,
1187 struct chp_link *link, int event)
1189 struct ccw_device *cdev = sch_get_cdev(sch);
1192 mask = chp_ssd_get_mask(&sch->ssd_info, link);
1200 cdev->private->path_gone_mask |= mask;
1201 io_subchannel_terminate_path(sch, mask);
1207 cdev->private->path_new_mask |= mask;
1208 io_subchannel_verify(sch);
1211 if (cio_update_schib(sch))
1214 cdev->private->path_gone_mask |= mask;
1215 io_subchannel_terminate_path(sch, mask);
1218 if (cio_update_schib(sch))
1220 sch->lpm |= mask & sch->opm;
1222 cdev->private->path_new_mask |= mask;
1223 io_subchannel_verify(sch);
1229 static void io_subchannel_quiesce(struct subchannel *sch)
1231 struct ccw_device *cdev;
1234 spin_lock_irq(sch->lock);
1235 cdev = sch_get_cdev(sch);
1236 if (cio_is_console(sch->schid))
1238 if (!sch->schib.pmcw.ena)
1240 ret = cio_disable_subchannel(sch);
1244 cdev->handler(cdev, cdev->private->intparm, ERR_PTR(-EIO));
1245 while (ret == -EBUSY) {
1246 cdev->private->state = DEV_STATE_QUIESCE;
1247 cdev->private->iretry = 255;
1248 ret = ccw_device_cancel_halt_clear(cdev);
1249 if (ret == -EBUSY) {
1250 ccw_device_set_timeout(cdev, HZ/10);
1251 spin_unlock_irq(sch->lock);
1252 wait_event(cdev->private->wait_q,
1253 cdev->private->state != DEV_STATE_QUIESCE);
1254 spin_lock_irq(sch->lock);
1256 ret = cio_disable_subchannel(sch);
1259 spin_unlock_irq(sch->lock);
1262 static void io_subchannel_shutdown(struct subchannel *sch)
1264 io_subchannel_quiesce(sch);
1267 static int device_is_disconnected(struct ccw_device *cdev)
1271 return (cdev->private->state == DEV_STATE_DISCONNECTED ||
1272 cdev->private->state == DEV_STATE_DISCONNECTED_SENSE_ID);
1275 static int recovery_check(struct device *dev, void *data)
1277 struct ccw_device *cdev = to_ccwdev(dev);
1280 spin_lock_irq(cdev->ccwlock);
1281 switch (cdev->private->state) {
1282 case DEV_STATE_DISCONNECTED:
1283 CIO_MSG_EVENT(3, "recovery: trigger 0.%x.%04x\n",
1284 cdev->private->dev_id.ssid,
1285 cdev->private->dev_id.devno);
1286 dev_fsm_event(cdev, DEV_EVENT_VERIFY);
1289 case DEV_STATE_DISCONNECTED_SENSE_ID:
1293 spin_unlock_irq(cdev->ccwlock);
1298 static void recovery_work_func(struct work_struct *unused)
1302 bus_for_each_dev(&ccw_bus_type, NULL, &redo, recovery_check);
1304 spin_lock_irq(&recovery_lock);
1305 if (!timer_pending(&recovery_timer)) {
1306 if (recovery_phase < ARRAY_SIZE(recovery_delay) - 1)
1308 mod_timer(&recovery_timer, jiffies +
1309 recovery_delay[recovery_phase] * HZ);
1311 spin_unlock_irq(&recovery_lock);
1313 CIO_MSG_EVENT(4, "recovery: end\n");
1316 static DECLARE_WORK(recovery_work, recovery_work_func);
1318 static void recovery_func(unsigned long data)
1321 * We can't do our recovery in softirq context and it's not
1322 * performance critical, so we schedule it.
1324 schedule_work(&recovery_work);
1327 static void ccw_device_schedule_recovery(void)
1329 unsigned long flags;
1331 CIO_MSG_EVENT(4, "recovery: schedule\n");
1332 spin_lock_irqsave(&recovery_lock, flags);
1333 if (!timer_pending(&recovery_timer) || (recovery_phase != 0)) {
1335 mod_timer(&recovery_timer, jiffies + recovery_delay[0] * HZ);
1337 spin_unlock_irqrestore(&recovery_lock, flags);
1340 static int purge_fn(struct device *dev, void *data)
1342 struct ccw_device *cdev = to_ccwdev(dev);
1343 struct ccw_dev_id *id = &cdev->private->dev_id;
1345 spin_lock_irq(cdev->ccwlock);
1346 if (is_blacklisted(id->ssid, id->devno) &&
1347 (cdev->private->state == DEV_STATE_OFFLINE) &&
1348 (atomic_cmpxchg(&cdev->private->onoff, 0, 1) == 0)) {
1349 CIO_MSG_EVENT(3, "ccw: purging 0.%x.%04x\n", id->ssid,
1351 ccw_device_sched_todo(cdev, CDEV_TODO_UNREG);
1352 atomic_set(&cdev->private->onoff, 0);
1354 spin_unlock_irq(cdev->ccwlock);
1355 /* Abort loop in case of pending signal. */
1356 if (signal_pending(current))
1363 * ccw_purge_blacklisted - purge unused, blacklisted devices
1365 * Unregister all ccw devices that are offline and on the blacklist.
1367 int ccw_purge_blacklisted(void)
1369 CIO_MSG_EVENT(2, "ccw: purging blacklisted devices\n");
1370 bus_for_each_dev(&ccw_bus_type, NULL, NULL, purge_fn);
1374 void ccw_device_set_disconnected(struct ccw_device *cdev)
1378 ccw_device_set_timeout(cdev, 0);
1379 cdev->private->flags.fake_irb = 0;
1380 cdev->private->state = DEV_STATE_DISCONNECTED;
1382 ccw_device_schedule_recovery();
1385 void ccw_device_set_notoper(struct ccw_device *cdev)
1387 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1389 CIO_TRACE_EVENT(2, "notoper");
1390 CIO_TRACE_EVENT(2, dev_name(&sch->dev));
1391 ccw_device_set_timeout(cdev, 0);
1392 cio_disable_subchannel(sch);
1393 cdev->private->state = DEV_STATE_NOT_OPER;
1396 enum io_sch_action {
1400 IO_SCH_UNREG_ATTACH,
1408 static enum io_sch_action sch_get_action(struct subchannel *sch)
1410 struct ccw_device *cdev;
1412 cdev = sch_get_cdev(sch);
1413 if (cio_update_schib(sch)) {
1414 /* Not operational. */
1416 return IO_SCH_UNREG;
1417 if (ccw_device_notify(cdev, CIO_GONE) != NOTIFY_OK)
1418 return IO_SCH_UNREG;
1419 return IO_SCH_ORPH_UNREG;
1423 return IO_SCH_ATTACH;
1424 if (sch->schib.pmcw.dev != cdev->private->dev_id.devno) {
1425 if (ccw_device_notify(cdev, CIO_GONE) != NOTIFY_OK)
1426 return IO_SCH_UNREG_ATTACH;
1427 return IO_SCH_ORPH_ATTACH;
1429 if ((sch->schib.pmcw.pam & sch->opm) == 0) {
1430 if (ccw_device_notify(cdev, CIO_NO_PATH) != NOTIFY_OK)
1431 return IO_SCH_UNREG;
1434 if (device_is_disconnected(cdev))
1435 return IO_SCH_REPROBE;
1436 if (cdev->online && !cdev->private->flags.resuming)
1437 return IO_SCH_VERIFY;
1438 if (cdev->private->state == DEV_STATE_NOT_OPER)
1439 return IO_SCH_UNREG_ATTACH;
1444 * io_subchannel_sch_event - process subchannel event
1446 * @process: non-zero if function is called in process context
1448 * An unspecified event occurred for this subchannel. Adjust data according
1449 * to the current operational state of the subchannel and device. Return
1450 * zero when the event has been handled sufficiently or -EAGAIN when this
1451 * function should be called again in process context.
1453 static int io_subchannel_sch_event(struct subchannel *sch, int process)
1455 unsigned long flags;
1456 struct ccw_device *cdev;
1457 struct ccw_dev_id dev_id;
1458 enum io_sch_action action;
1461 spin_lock_irqsave(sch->lock, flags);
1462 if (!device_is_registered(&sch->dev))
1464 if (work_pending(&sch->todo_work))
1466 cdev = sch_get_cdev(sch);
1467 if (cdev && work_pending(&cdev->private->todo_work))
1469 action = sch_get_action(sch);
1470 CIO_MSG_EVENT(2, "event: sch 0.%x.%04x, process=%d, action=%d\n",
1471 sch->schid.ssid, sch->schid.sch_no, process,
1473 /* Perform immediate actions while holding the lock. */
1475 case IO_SCH_REPROBE:
1476 /* Trigger device recognition. */
1477 ccw_device_trigger_reprobe(cdev);
1481 /* Trigger path verification. */
1482 io_subchannel_verify(sch);
1486 ccw_device_set_disconnected(cdev);
1489 case IO_SCH_ORPH_UNREG:
1490 case IO_SCH_ORPH_ATTACH:
1491 ccw_device_set_disconnected(cdev);
1493 case IO_SCH_UNREG_ATTACH:
1497 if (cdev->private->state == DEV_STATE_SENSE_ID) {
1499 * Note: delayed work triggered by this event
1500 * and repeated calls to sch_event are synchronized
1501 * by the above check for work_pending(cdev).
1503 dev_fsm_event(cdev, DEV_EVENT_NOTOPER);
1505 ccw_device_set_notoper(cdev);
1513 spin_unlock_irqrestore(sch->lock, flags);
1514 /* All other actions require process context. */
1517 /* Handle attached ccw device. */
1519 case IO_SCH_ORPH_UNREG:
1520 case IO_SCH_ORPH_ATTACH:
1521 /* Move ccw device to orphanage. */
1522 rc = ccw_device_move_to_orph(cdev);
1526 case IO_SCH_UNREG_ATTACH:
1527 spin_lock_irqsave(sch->lock, flags);
1528 if (cdev->private->flags.resuming) {
1529 /* Device will be handled later. */
1533 sch_set_cdev(sch, NULL);
1534 spin_unlock_irqrestore(sch->lock, flags);
1535 /* Unregister ccw device. */
1536 ccw_device_unregister(cdev);
1541 /* Handle subchannel. */
1543 case IO_SCH_ORPH_UNREG:
1545 if (!cdev || !cdev->private->flags.resuming)
1546 css_sch_device_unregister(sch);
1548 case IO_SCH_ORPH_ATTACH:
1549 case IO_SCH_UNREG_ATTACH:
1551 dev_id.ssid = sch->schid.ssid;
1552 dev_id.devno = sch->schib.pmcw.dev;
1553 cdev = get_ccwdev_by_dev_id(&dev_id);
1555 sch_create_and_recog_new_device(sch);
1558 rc = ccw_device_move_to_sch(cdev, sch);
1560 /* Release reference from get_ccwdev_by_dev_id() */
1561 put_device(&cdev->dev);
1564 spin_lock_irqsave(sch->lock, flags);
1565 ccw_device_trigger_reprobe(cdev);
1566 spin_unlock_irqrestore(sch->lock, flags);
1567 /* Release reference from get_ccwdev_by_dev_id() */
1568 put_device(&cdev->dev);
1576 spin_unlock_irqrestore(sch->lock, flags);
1581 static void ccw_device_set_int_class(struct ccw_device *cdev)
1583 struct ccw_driver *cdrv = cdev->drv;
1585 /* Note: we interpret class 0 in this context as an uninitialized
1586 * field since it translates to a non-I/O interrupt class. */
1587 if (cdrv->int_class != 0)
1588 cdev->private->int_class = cdrv->int_class;
1590 cdev->private->int_class = IRQIO_CIO;
1593 #ifdef CONFIG_CCW_CONSOLE
1594 int __init ccw_device_enable_console(struct ccw_device *cdev)
1596 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1599 if (!cdev->drv || !cdev->handler)
1602 io_subchannel_init_fields(sch);
1603 rc = cio_commit_config(sch);
1606 sch->driver = &io_subchannel_driver;
1607 io_subchannel_recog(cdev, sch);
1608 /* Now wait for the async. recognition to come to an end. */
1609 spin_lock_irq(cdev->ccwlock);
1610 while (!dev_fsm_final_state(cdev))
1611 ccw_device_wait_idle(cdev);
1613 /* Hold on to an extra reference while device is online. */
1614 get_device(&cdev->dev);
1615 rc = ccw_device_online(cdev);
1619 while (!dev_fsm_final_state(cdev))
1620 ccw_device_wait_idle(cdev);
1622 if (cdev->private->state == DEV_STATE_ONLINE)
1627 spin_unlock_irq(cdev->ccwlock);
1628 if (rc) /* Give up online reference since onlining failed. */
1629 put_device(&cdev->dev);
1633 struct ccw_device * __init ccw_device_create_console(struct ccw_driver *drv)
1635 struct io_subchannel_private *io_priv;
1636 struct ccw_device *cdev;
1637 struct subchannel *sch;
1639 sch = cio_probe_console();
1641 return ERR_CAST(sch);
1643 io_priv = kzalloc(sizeof(*io_priv), GFP_KERNEL | GFP_DMA);
1645 put_device(&sch->dev);
1646 return ERR_PTR(-ENOMEM);
1648 set_io_private(sch, io_priv);
1649 cdev = io_subchannel_create_ccwdev(sch);
1651 put_device(&sch->dev);
1656 ccw_device_set_int_class(cdev);
1660 void __init ccw_device_destroy_console(struct ccw_device *cdev)
1662 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1663 struct io_subchannel_private *io_priv = to_io_private(sch);
1665 set_io_private(sch, NULL);
1666 put_device(&sch->dev);
1667 put_device(&cdev->dev);
1672 * ccw_device_wait_idle() - busy wait for device to become idle
1675 * Poll until activity control is zero, that is, no function or data
1676 * transfer is pending/active.
1677 * Called with device lock being held.
1679 void ccw_device_wait_idle(struct ccw_device *cdev)
1681 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1685 if (sch->schib.scsw.cmd.actl == 0)
1691 static int ccw_device_pm_restore(struct device *dev);
1693 int ccw_device_force_console(struct ccw_device *cdev)
1695 return ccw_device_pm_restore(&cdev->dev);
1697 EXPORT_SYMBOL_GPL(ccw_device_force_console);
1701 * get ccw_device matching the busid, but only if owned by cdrv
1704 __ccwdev_check_busid(struct device *dev, void *id)
1710 return (strcmp(bus_id, dev_name(dev)) == 0);
1715 * get_ccwdev_by_busid() - obtain device from a bus id
1716 * @cdrv: driver the device is owned by
1717 * @bus_id: bus id of the device to be searched
1719 * This function searches all devices owned by @cdrv for a device with a bus
1720 * id matching @bus_id.
1722 * If a match is found, its reference count of the found device is increased
1723 * and it is returned; else %NULL is returned.
1725 struct ccw_device *get_ccwdev_by_busid(struct ccw_driver *cdrv,
1730 dev = driver_find_device(&cdrv->driver, NULL, (void *)bus_id,
1731 __ccwdev_check_busid);
1733 return dev ? to_ccwdev(dev) : NULL;
1736 /************************** device driver handling ************************/
1738 /* This is the implementation of the ccw_driver class. The probe, remove
1739 * and release methods are initially very similar to the device_driver
1740 * implementations, with the difference that they have ccw_device
1743 * A ccw driver also contains the information that is needed for
1747 ccw_device_probe (struct device *dev)
1749 struct ccw_device *cdev = to_ccwdev(dev);
1750 struct ccw_driver *cdrv = to_ccwdrv(dev->driver);
1753 cdev->drv = cdrv; /* to let the driver call _set_online */
1754 ccw_device_set_int_class(cdev);
1755 ret = cdrv->probe ? cdrv->probe(cdev) : -ENODEV;
1758 cdev->private->int_class = IRQIO_CIO;
1765 static int ccw_device_remove(struct device *dev)
1767 struct ccw_device *cdev = to_ccwdev(dev);
1768 struct ccw_driver *cdrv = cdev->drv;
1774 spin_lock_irq(cdev->ccwlock);
1777 ret = ccw_device_offline(cdev);
1778 spin_unlock_irq(cdev->ccwlock);
1780 wait_event(cdev->private->wait_q,
1781 dev_fsm_final_state(cdev));
1783 CIO_MSG_EVENT(0, "ccw_device_offline returned %d, "
1784 "device 0.%x.%04x\n",
1785 ret, cdev->private->dev_id.ssid,
1786 cdev->private->dev_id.devno);
1787 /* Give up reference obtained in ccw_device_set_online(). */
1788 put_device(&cdev->dev);
1789 spin_lock_irq(cdev->ccwlock);
1791 ccw_device_set_timeout(cdev, 0);
1793 cdev->private->int_class = IRQIO_CIO;
1794 spin_unlock_irq(cdev->ccwlock);
1795 __disable_cmf(cdev);
1800 static void ccw_device_shutdown(struct device *dev)
1802 struct ccw_device *cdev;
1804 cdev = to_ccwdev(dev);
1805 if (cdev->drv && cdev->drv->shutdown)
1806 cdev->drv->shutdown(cdev);
1807 __disable_cmf(cdev);
1810 static int ccw_device_pm_prepare(struct device *dev)
1812 struct ccw_device *cdev = to_ccwdev(dev);
1814 if (work_pending(&cdev->private->todo_work))
1816 /* Fail while device is being set online/offline. */
1817 if (atomic_read(&cdev->private->onoff))
1820 if (cdev->online && cdev->drv && cdev->drv->prepare)
1821 return cdev->drv->prepare(cdev);
1826 static void ccw_device_pm_complete(struct device *dev)
1828 struct ccw_device *cdev = to_ccwdev(dev);
1830 if (cdev->online && cdev->drv && cdev->drv->complete)
1831 cdev->drv->complete(cdev);
1834 static int ccw_device_pm_freeze(struct device *dev)
1836 struct ccw_device *cdev = to_ccwdev(dev);
1837 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1838 int ret, cm_enabled;
1840 /* Fail suspend while device is in transistional state. */
1841 if (!dev_fsm_final_state(cdev))
1845 if (cdev->drv && cdev->drv->freeze) {
1846 ret = cdev->drv->freeze(cdev);
1851 spin_lock_irq(sch->lock);
1852 cm_enabled = cdev->private->cmb != NULL;
1853 spin_unlock_irq(sch->lock);
1855 /* Don't have the css write on memory. */
1856 ret = ccw_set_cmf(cdev, 0);
1860 /* From here on, disallow device driver I/O. */
1861 spin_lock_irq(sch->lock);
1862 ret = cio_disable_subchannel(sch);
1863 spin_unlock_irq(sch->lock);
1868 static int ccw_device_pm_thaw(struct device *dev)
1870 struct ccw_device *cdev = to_ccwdev(dev);
1871 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1872 int ret, cm_enabled;
1877 spin_lock_irq(sch->lock);
1878 /* Allow device driver I/O again. */
1879 ret = cio_enable_subchannel(sch, (u32)(addr_t)sch);
1880 cm_enabled = cdev->private->cmb != NULL;
1881 spin_unlock_irq(sch->lock);
1886 ret = ccw_set_cmf(cdev, 1);
1891 if (cdev->drv && cdev->drv->thaw)
1892 ret = cdev->drv->thaw(cdev);
1897 static void __ccw_device_pm_restore(struct ccw_device *cdev)
1899 struct subchannel *sch = to_subchannel(cdev->dev.parent);
1901 spin_lock_irq(sch->lock);
1902 if (cio_is_console(sch->schid)) {
1903 cio_enable_subchannel(sch, (u32)(addr_t)sch);
1907 * While we were sleeping, devices may have gone or become
1908 * available again. Kick re-detection.
1910 cdev->private->flags.resuming = 1;
1911 cdev->private->path_new_mask = LPM_ANYPATH;
1912 css_sched_sch_todo(sch, SCH_TODO_EVAL);
1913 spin_unlock_irq(sch->lock);
1914 css_wait_for_slow_path();
1916 /* cdev may have been moved to a different subchannel. */
1917 sch = to_subchannel(cdev->dev.parent);
1918 spin_lock_irq(sch->lock);
1919 if (cdev->private->state != DEV_STATE_ONLINE &&
1920 cdev->private->state != DEV_STATE_OFFLINE)
1923 ccw_device_recognition(cdev);
1924 spin_unlock_irq(sch->lock);
1925 wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev) ||
1926 cdev->private->state == DEV_STATE_DISCONNECTED);
1927 spin_lock_irq(sch->lock);
1930 cdev->private->flags.resuming = 0;
1931 spin_unlock_irq(sch->lock);
1934 static int resume_handle_boxed(struct ccw_device *cdev)
1936 cdev->private->state = DEV_STATE_BOXED;
1937 if (ccw_device_notify(cdev, CIO_BOXED) == NOTIFY_OK)
1939 ccw_device_sched_todo(cdev, CDEV_TODO_UNREG);
1943 static int resume_handle_disc(struct ccw_device *cdev)
1945 cdev->private->state = DEV_STATE_DISCONNECTED;
1946 if (ccw_device_notify(cdev, CIO_GONE) == NOTIFY_OK)
1948 ccw_device_sched_todo(cdev, CDEV_TODO_UNREG);
1952 static int ccw_device_pm_restore(struct device *dev)
1954 struct ccw_device *cdev = to_ccwdev(dev);
1955 struct subchannel *sch;
1958 __ccw_device_pm_restore(cdev);
1959 sch = to_subchannel(cdev->dev.parent);
1960 spin_lock_irq(sch->lock);
1961 if (cio_is_console(sch->schid))
1964 /* check recognition results */
1965 switch (cdev->private->state) {
1966 case DEV_STATE_OFFLINE:
1967 case DEV_STATE_ONLINE:
1968 cdev->private->flags.donotify = 0;
1970 case DEV_STATE_BOXED:
1971 ret = resume_handle_boxed(cdev);
1976 ret = resume_handle_disc(cdev);
1981 /* check if the device type has changed */
1982 if (!ccw_device_test_sense_data(cdev)) {
1983 ccw_device_update_sense_data(cdev);
1984 ccw_device_sched_todo(cdev, CDEV_TODO_REBIND);
1991 if (ccw_device_online(cdev)) {
1992 ret = resume_handle_disc(cdev);
1997 spin_unlock_irq(sch->lock);
1998 wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev));
1999 spin_lock_irq(sch->lock);
2001 if (ccw_device_notify(cdev, CIO_OPER) == NOTIFY_BAD) {
2002 ccw_device_sched_todo(cdev, CDEV_TODO_UNREG);
2007 /* reenable cmf, if needed */
2008 if (cdev->private->cmb) {
2009 spin_unlock_irq(sch->lock);
2010 ret = ccw_set_cmf(cdev, 1);
2011 spin_lock_irq(sch->lock);
2013 CIO_MSG_EVENT(2, "resume: cdev 0.%x.%04x: cmf failed "
2014 "(rc=%d)\n", cdev->private->dev_id.ssid,
2015 cdev->private->dev_id.devno, ret);
2021 spin_unlock_irq(sch->lock);
2022 if (cdev->online && cdev->drv && cdev->drv->restore)
2023 ret = cdev->drv->restore(cdev);
2027 spin_unlock_irq(sch->lock);
2031 static const struct dev_pm_ops ccw_pm_ops = {
2032 .prepare = ccw_device_pm_prepare,
2033 .complete = ccw_device_pm_complete,
2034 .freeze = ccw_device_pm_freeze,
2035 .thaw = ccw_device_pm_thaw,
2036 .restore = ccw_device_pm_restore,
2039 static struct bus_type ccw_bus_type = {
2041 .match = ccw_bus_match,
2042 .uevent = ccw_uevent,
2043 .probe = ccw_device_probe,
2044 .remove = ccw_device_remove,
2045 .shutdown = ccw_device_shutdown,
2050 * ccw_driver_register() - register a ccw driver
2051 * @cdriver: driver to be registered
2053 * This function is mainly a wrapper around driver_register().
2055 * %0 on success and a negative error value on failure.
2057 int ccw_driver_register(struct ccw_driver *cdriver)
2059 struct device_driver *drv = &cdriver->driver;
2061 drv->bus = &ccw_bus_type;
2063 return driver_register(drv);
2067 * ccw_driver_unregister() - deregister a ccw driver
2068 * @cdriver: driver to be deregistered
2070 * This function is mainly a wrapper around driver_unregister().
2072 void ccw_driver_unregister(struct ccw_driver *cdriver)
2074 driver_unregister(&cdriver->driver);
2077 static void ccw_device_todo(struct work_struct *work)
2079 struct ccw_device_private *priv;
2080 struct ccw_device *cdev;
2081 struct subchannel *sch;
2082 enum cdev_todo todo;
2084 priv = container_of(work, struct ccw_device_private, todo_work);
2086 sch = to_subchannel(cdev->dev.parent);
2087 /* Find out todo. */
2088 spin_lock_irq(cdev->ccwlock);
2090 priv->todo = CDEV_TODO_NOTHING;
2091 CIO_MSG_EVENT(4, "cdev_todo: cdev=0.%x.%04x todo=%d\n",
2092 priv->dev_id.ssid, priv->dev_id.devno, todo);
2093 spin_unlock_irq(cdev->ccwlock);
2096 case CDEV_TODO_ENABLE_CMF:
2099 case CDEV_TODO_REBIND:
2100 ccw_device_do_unbind_bind(cdev);
2102 case CDEV_TODO_REGISTER:
2103 io_subchannel_register(cdev);
2105 case CDEV_TODO_UNREG_EVAL:
2106 if (!sch_is_pseudo_sch(sch))
2107 css_schedule_eval(sch->schid);
2109 case CDEV_TODO_UNREG:
2110 if (sch_is_pseudo_sch(sch))
2111 ccw_device_unregister(cdev);
2113 ccw_device_call_sch_unregister(cdev);
2118 /* Release workqueue ref. */
2119 put_device(&cdev->dev);
2123 * ccw_device_sched_todo - schedule ccw device operation
2127 * Schedule the operation identified by @todo to be performed on the slow path
2128 * workqueue. Do nothing if another operation with higher priority is already
2129 * scheduled. Needs to be called with ccwdev lock held.
2131 void ccw_device_sched_todo(struct ccw_device *cdev, enum cdev_todo todo)
2133 CIO_MSG_EVENT(4, "cdev_todo: sched cdev=0.%x.%04x todo=%d\n",
2134 cdev->private->dev_id.ssid, cdev->private->dev_id.devno,
2136 if (cdev->private->todo >= todo)
2138 cdev->private->todo = todo;
2139 /* Get workqueue ref. */
2140 if (!get_device(&cdev->dev))
2142 if (!queue_work(cio_work_q, &cdev->private->todo_work)) {
2143 /* Already queued, release workqueue ref. */
2144 put_device(&cdev->dev);
2149 * ccw_device_siosl() - initiate logging
2152 * This function is used to invoke model-dependent logging within the channel
2155 int ccw_device_siosl(struct ccw_device *cdev)
2157 struct subchannel *sch = to_subchannel(cdev->dev.parent);
2159 return chsc_siosl(sch->schid);
2161 EXPORT_SYMBOL_GPL(ccw_device_siosl);
2163 MODULE_LICENSE("GPL");
2164 EXPORT_SYMBOL(ccw_device_set_online);
2165 EXPORT_SYMBOL(ccw_device_set_offline);
2166 EXPORT_SYMBOL(ccw_driver_register);
2167 EXPORT_SYMBOL(ccw_driver_unregister);
2168 EXPORT_SYMBOL(get_ccwdev_by_busid);