blob: d3d3716ff84b6b317d6244fd67971eb494fa6cca [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * drivers/s390/cio/device.c
3 * bus driver for ccw devices
Linus Torvalds1da177e2005-04-16 15:20:36 -07004 *
5 * Copyright (C) 2002 IBM Deutschland Entwicklung GmbH,
6 * IBM Corporation
7 * Author(s): Arnd Bergmann (arndb@de.ibm.com)
Cornelia Huck4ce3b302006-01-14 13:21:04 -08008 * Cornelia Huck (cornelia.huck@de.ibm.com)
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 * Martin Schwidefsky (schwidefsky@de.ibm.com)
10 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070011#include <linux/module.h>
12#include <linux/init.h>
13#include <linux/spinlock.h>
14#include <linux/errno.h>
15#include <linux/err.h>
16#include <linux/slab.h>
17#include <linux/list.h>
18#include <linux/device.h>
19#include <linux/workqueue.h>
20
21#include <asm/ccwdev.h>
22#include <asm/cio.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -080023#include <asm/param.h> /* HZ */
Linus Torvalds1da177e2005-04-16 15:20:36 -070024
25#include "cio.h"
26#include "css.h"
27#include "device.h"
28#include "ioasm.h"
29
30/******************* bus type handling ***********************/
31
32/* The Linux driver model distinguishes between a bus type and
33 * the bus itself. Of course we only have one channel
34 * subsystem driver and one channel system per machine, but
35 * we still use the abstraction. T.R. says it's a good idea. */
36static int
37ccw_bus_match (struct device * dev, struct device_driver * drv)
38{
39 struct ccw_device *cdev = to_ccwdev(dev);
40 struct ccw_driver *cdrv = to_ccwdrv(drv);
41 const struct ccw_device_id *ids = cdrv->ids, *found;
42
43 if (!ids)
44 return 0;
45
46 found = ccw_device_id_match(ids, &cdev->id);
47 if (!found)
48 return 0;
49
50 cdev->id.driver_info = found->driver_info;
51
52 return 1;
53}
54
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +020055/* Store modalias string delimited by prefix/suffix string into buffer with
56 * specified size. Return length of resulting string (excluding trailing '\0')
57 * even if string doesn't fit buffer (snprintf semantics). */
58static int snprint_alias(char *buf, size_t size, const char *prefix,
59 struct ccw_device_id *id, const char *suffix)
60{
61 int len;
62
63 len = snprintf(buf, size, "%sccw:t%04Xm%02X", prefix, id->cu_type,
64 id->cu_model);
65 if (len > size)
66 return len;
67 buf += len;
68 size -= len;
69
70 if (id->dev_type != 0)
71 len += snprintf(buf, size, "dt%04Xdm%02X%s", id->dev_type,
72 id->dev_model, suffix);
73 else
74 len += snprintf(buf, size, "dtdm%s", suffix);
75
76 return len;
77}
78
79/* Set up environment variables for ccw device uevent. Return 0 on success,
80 * non-zero otherwise. */
81static int ccw_uevent(struct device *dev, char **envp, int num_envp,
82 char *buffer, int buffer_size)
Linus Torvalds1da177e2005-04-16 15:20:36 -070083{
84 struct ccw_device *cdev = to_ccwdev(dev);
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +020085 struct ccw_device_id *id = &(cdev->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 int i = 0;
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +020087 int len;
Linus Torvalds1da177e2005-04-16 15:20:36 -070088
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +020089 /* CU_TYPE= */
90 len = snprintf(buffer, buffer_size, "CU_TYPE=%04X", id->cu_type) + 1;
91 if (len > buffer_size || i >= num_envp)
Linus Torvalds1da177e2005-04-16 15:20:36 -070092 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -070093 envp[i++] = buffer;
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +020094 buffer += len;
95 buffer_size -= len;
96
97 /* CU_MODEL= */
98 len = snprintf(buffer, buffer_size, "CU_MODEL=%02X", id->cu_model) + 1;
99 if (len > buffer_size || i >= num_envp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100 return -ENOMEM;
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +0200101 envp[i++] = buffer;
102 buffer += len;
103 buffer_size -= len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104
105 /* The next two can be zero, that's ok for us */
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +0200106 /* DEV_TYPE= */
107 len = snprintf(buffer, buffer_size, "DEV_TYPE=%04X", id->dev_type) + 1;
108 if (len > buffer_size || i >= num_envp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 return -ENOMEM;
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +0200110 envp[i++] = buffer;
111 buffer += len;
112 buffer_size -= len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +0200114 /* DEV_MODEL= */
115 len = snprintf(buffer, buffer_size, "DEV_MODEL=%02X",
116 (unsigned char) id->dev_model) + 1;
117 if (len > buffer_size || i >= num_envp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118 return -ENOMEM;
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +0200119 envp[i++] = buffer;
120 buffer += len;
121 buffer_size -= len;
122
123 /* MODALIAS= */
124 len = snprint_alias(buffer, buffer_size, "MODALIAS=", id, "") + 1;
125 if (len > buffer_size || i >= num_envp)
126 return -ENOMEM;
127 envp[i++] = buffer;
128 buffer += len;
129 buffer_size -= len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130
Heiko Carstensd2c993d2006-07-12 16:41:55 +0200131 envp[i] = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132
133 return 0;
134}
135
Cornelia Huck8bbace72006-01-11 10:56:22 +0100136struct bus_type ccw_bus_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137
Cornelia Huck8bbace72006-01-11 10:56:22 +0100138static int io_subchannel_probe (struct subchannel *);
139static int io_subchannel_remove (struct subchannel *);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140void io_subchannel_irq (struct device *);
141static int io_subchannel_notify(struct device *, int);
142static void io_subchannel_verify(struct device *);
143static void io_subchannel_ioterm(struct device *);
Cornelia Huck8bbace72006-01-11 10:56:22 +0100144static void io_subchannel_shutdown(struct subchannel *);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145
146struct css_driver io_subchannel_driver = {
147 .subchannel_type = SUBCHANNEL_TYPE_IO,
148 .drv = {
149 .name = "io_subchannel",
150 .bus = &css_bus_type,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151 },
152 .irq = io_subchannel_irq,
153 .notify = io_subchannel_notify,
154 .verify = io_subchannel_verify,
155 .termination = io_subchannel_ioterm,
Cornelia Huck8bbace72006-01-11 10:56:22 +0100156 .probe = io_subchannel_probe,
157 .remove = io_subchannel_remove,
158 .shutdown = io_subchannel_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159};
160
161struct workqueue_struct *ccw_device_work;
162struct workqueue_struct *ccw_device_notify_work;
Peter Oberparleiter40154b82006-06-29 14:57:03 +0200163wait_queue_head_t ccw_device_init_wq;
164atomic_t ccw_device_init_count;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165
166static int __init
167init_ccw_bus_type (void)
168{
169 int ret;
170
171 init_waitqueue_head(&ccw_device_init_wq);
172 atomic_set(&ccw_device_init_count, 0);
173
174 ccw_device_work = create_singlethread_workqueue("cio");
175 if (!ccw_device_work)
176 return -ENOMEM; /* FIXME: better errno ? */
177 ccw_device_notify_work = create_singlethread_workqueue("cio_notify");
178 if (!ccw_device_notify_work) {
179 ret = -ENOMEM; /* FIXME: better errno ? */
180 goto out_err;
181 }
182 slow_path_wq = create_singlethread_workqueue("kslowcrw");
183 if (!slow_path_wq) {
184 ret = -ENOMEM; /* FIXME: better errno ? */
185 goto out_err;
186 }
187 if ((ret = bus_register (&ccw_bus_type)))
188 goto out_err;
189
190 if ((ret = driver_register(&io_subchannel_driver.drv)))
191 goto out_err;
192
193 wait_event(ccw_device_init_wq,
194 atomic_read(&ccw_device_init_count) == 0);
195 flush_workqueue(ccw_device_work);
196 return 0;
197out_err:
198 if (ccw_device_work)
199 destroy_workqueue(ccw_device_work);
200 if (ccw_device_notify_work)
201 destroy_workqueue(ccw_device_notify_work);
202 if (slow_path_wq)
203 destroy_workqueue(slow_path_wq);
204 return ret;
205}
206
207static void __exit
208cleanup_ccw_bus_type (void)
209{
210 driver_unregister(&io_subchannel_driver.drv);
211 bus_unregister(&ccw_bus_type);
212 destroy_workqueue(ccw_device_notify_work);
213 destroy_workqueue(ccw_device_work);
214}
215
216subsys_initcall(init_ccw_bus_type);
217module_exit(cleanup_ccw_bus_type);
218
219/************************ device handling **************************/
220
221/*
222 * A ccw_device has some interfaces in sysfs in addition to the
223 * standard ones.
224 * The following entries are designed to export the information which
225 * resided in 2.4 in /proc/subchannels. Subchannel and device number
226 * are obvious, so they don't have an entry :)
227 * TODO: Split chpids and pimpampom up? Where is "in use" in the tree?
228 */
229static ssize_t
Yani Ioannou3fd3c0a2005-05-17 06:43:27 -0400230chpids_show (struct device * dev, struct device_attribute *attr, char * buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231{
232 struct subchannel *sch = to_subchannel(dev);
233 struct ssd_info *ssd = &sch->ssd_info;
234 ssize_t ret = 0;
235 int chp;
236
237 for (chp = 0; chp < 8; chp++)
238 ret += sprintf (buf+ret, "%02x ", ssd->chpid[chp]);
239
240 ret += sprintf (buf+ret, "\n");
241 return min((ssize_t)PAGE_SIZE, ret);
242}
243
244static ssize_t
Yani Ioannou3fd3c0a2005-05-17 06:43:27 -0400245pimpampom_show (struct device * dev, struct device_attribute *attr, char * buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246{
247 struct subchannel *sch = to_subchannel(dev);
248 struct pmcw *pmcw = &sch->schib.pmcw;
249
250 return sprintf (buf, "%02x %02x %02x\n",
251 pmcw->pim, pmcw->pam, pmcw->pom);
252}
253
254static ssize_t
Yani Ioannou3fd3c0a2005-05-17 06:43:27 -0400255devtype_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256{
257 struct ccw_device *cdev = to_ccwdev(dev);
258 struct ccw_device_id *id = &(cdev->id);
259
260 if (id->dev_type != 0)
261 return sprintf(buf, "%04x/%02x\n",
262 id->dev_type, id->dev_model);
263 else
264 return sprintf(buf, "n/a\n");
265}
266
267static ssize_t
Yani Ioannou3fd3c0a2005-05-17 06:43:27 -0400268cutype_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269{
270 struct ccw_device *cdev = to_ccwdev(dev);
271 struct ccw_device_id *id = &(cdev->id);
272
273 return sprintf(buf, "%04x/%02x\n",
274 id->cu_type, id->cu_model);
275}
276
277static ssize_t
Bastian Blankf1fc78a2005-10-30 15:00:12 -0800278modalias_show (struct device *dev, struct device_attribute *attr, char *buf)
279{
280 struct ccw_device *cdev = to_ccwdev(dev);
281 struct ccw_device_id *id = &(cdev->id);
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +0200282 int len;
Bastian Blankf1fc78a2005-10-30 15:00:12 -0800283
Peter Oberparleiterdb0c2d52006-09-20 15:59:49 +0200284 len = snprint_alias(buf, PAGE_SIZE, "", id, "\n") + 1;
285
286 return len > PAGE_SIZE ? PAGE_SIZE : len;
Bastian Blankf1fc78a2005-10-30 15:00:12 -0800287}
288
289static ssize_t
Yani Ioannou3fd3c0a2005-05-17 06:43:27 -0400290online_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291{
292 struct ccw_device *cdev = to_ccwdev(dev);
293
294 return sprintf(buf, cdev->online ? "1\n" : "0\n");
295}
296
297static void
298ccw_device_remove_disconnected(struct ccw_device *cdev)
299{
300 struct subchannel *sch;
301 /*
302 * Forced offline in disconnected state means
303 * 'throw away device'.
304 */
305 sch = to_subchannel(cdev->dev.parent);
Cornelia Huck6ab48792006-07-12 16:39:50 +0200306 css_sch_device_unregister(sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307 /* Reset intparm to zeroes. */
308 sch->schib.pmcw.intparm = 0;
309 cio_modify(sch);
310 put_device(&sch->dev);
311}
312
313int
314ccw_device_set_offline(struct ccw_device *cdev)
315{
316 int ret;
317
318 if (!cdev)
319 return -ENODEV;
320 if (!cdev->online || !cdev->drv)
321 return -EINVAL;
322
323 if (cdev->drv->set_offline) {
324 ret = cdev->drv->set_offline(cdev);
325 if (ret != 0)
326 return ret;
327 }
328 cdev->online = 0;
329 spin_lock_irq(cdev->ccwlock);
330 ret = ccw_device_offline(cdev);
331 if (ret == -ENODEV) {
332 if (cdev->private->state != DEV_STATE_NOT_OPER) {
333 cdev->private->state = DEV_STATE_OFFLINE;
334 dev_fsm_event(cdev, DEV_EVENT_NOTOPER);
335 }
336 spin_unlock_irq(cdev->ccwlock);
337 return ret;
338 }
339 spin_unlock_irq(cdev->ccwlock);
340 if (ret == 0)
341 wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev));
342 else {
343 pr_debug("ccw_device_offline returned %d, device %s\n",
344 ret, cdev->dev.bus_id);
345 cdev->online = 1;
346 }
347 return ret;
348}
349
350int
351ccw_device_set_online(struct ccw_device *cdev)
352{
353 int ret;
354
355 if (!cdev)
356 return -ENODEV;
357 if (cdev->online || !cdev->drv)
358 return -EINVAL;
359
360 spin_lock_irq(cdev->ccwlock);
361 ret = ccw_device_online(cdev);
362 spin_unlock_irq(cdev->ccwlock);
363 if (ret == 0)
364 wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev));
365 else {
366 pr_debug("ccw_device_online returned %d, device %s\n",
367 ret, cdev->dev.bus_id);
368 return ret;
369 }
370 if (cdev->private->state != DEV_STATE_ONLINE)
371 return -ENODEV;
372 if (!cdev->drv->set_online || cdev->drv->set_online(cdev) == 0) {
373 cdev->online = 1;
374 return 0;
375 }
376 spin_lock_irq(cdev->ccwlock);
377 ret = ccw_device_offline(cdev);
378 spin_unlock_irq(cdev->ccwlock);
379 if (ret == 0)
380 wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev));
381 else
382 pr_debug("ccw_device_offline returned %d, device %s\n",
383 ret, cdev->dev.bus_id);
Cornelia Huck6cadb782006-02-17 13:52:49 -0800384 return (ret == 0) ? -ENODEV : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385}
386
387static ssize_t
Yani Ioannou3fd3c0a2005-05-17 06:43:27 -0400388online_store (struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389{
390 struct ccw_device *cdev = to_ccwdev(dev);
391 int i, force, ret;
392 char *tmp;
393
Martin Schwidefsky973bd992006-01-06 00:19:07 -0800394 if (atomic_cmpxchg(&cdev->private->onoff, 0, 1) != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 return -EAGAIN;
396
397 if (cdev->drv && !try_module_get(cdev->drv->owner)) {
398 atomic_set(&cdev->private->onoff, 0);
399 return -EINVAL;
400 }
401 if (!strncmp(buf, "force\n", count)) {
402 force = 1;
403 i = 1;
404 } else {
405 force = 0;
406 i = simple_strtoul(buf, &tmp, 16);
407 }
408 if (i == 1) {
409 /* Do device recognition, if needed. */
410 if (cdev->id.cu_type == 0) {
411 ret = ccw_device_recognition(cdev);
412 if (ret) {
413 printk(KERN_WARNING"Couldn't start recognition "
414 "for device %s (ret=%d)\n",
415 cdev->dev.bus_id, ret);
416 goto out;
417 }
418 wait_event(cdev->private->wait_q,
419 cdev->private->flags.recog_done);
420 }
421 if (cdev->drv && cdev->drv->set_online)
422 ccw_device_set_online(cdev);
423 } else if (i == 0) {
424 if (cdev->private->state == DEV_STATE_DISCONNECTED)
425 ccw_device_remove_disconnected(cdev);
426 else if (cdev->drv && cdev->drv->set_offline)
427 ccw_device_set_offline(cdev);
428 }
429 if (force && cdev->private->state == DEV_STATE_BOXED) {
430 ret = ccw_device_stlck(cdev);
431 if (ret) {
432 printk(KERN_WARNING"ccw_device_stlck for device %s "
433 "returned %d!\n", cdev->dev.bus_id, ret);
434 goto out;
435 }
436 /* Do device recognition, if needed. */
437 if (cdev->id.cu_type == 0) {
438 cdev->private->state = DEV_STATE_NOT_OPER;
439 ret = ccw_device_recognition(cdev);
440 if (ret) {
441 printk(KERN_WARNING"Couldn't start recognition "
442 "for device %s (ret=%d)\n",
443 cdev->dev.bus_id, ret);
444 goto out;
445 }
446 wait_event(cdev->private->wait_q,
447 cdev->private->flags.recog_done);
448 }
449 if (cdev->drv && cdev->drv->set_online)
450 ccw_device_set_online(cdev);
451 }
452 out:
453 if (cdev->drv)
454 module_put(cdev->drv->owner);
455 atomic_set(&cdev->private->onoff, 0);
456 return count;
457}
458
459static ssize_t
Yani Ioannou3fd3c0a2005-05-17 06:43:27 -0400460available_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461{
462 struct ccw_device *cdev = to_ccwdev(dev);
463 struct subchannel *sch;
464
465 switch (cdev->private->state) {
466 case DEV_STATE_BOXED:
467 return sprintf(buf, "boxed\n");
468 case DEV_STATE_DISCONNECTED:
469 case DEV_STATE_DISCONNECTED_SENSE_ID:
470 case DEV_STATE_NOT_OPER:
471 sch = to_subchannel(dev->parent);
472 if (!sch->lpm)
473 return sprintf(buf, "no path\n");
474 else
475 return sprintf(buf, "no device\n");
476 default:
477 /* All other states considered fine. */
478 return sprintf(buf, "good\n");
479 }
480}
481
482static DEVICE_ATTR(chpids, 0444, chpids_show, NULL);
483static DEVICE_ATTR(pimpampom, 0444, pimpampom_show, NULL);
484static DEVICE_ATTR(devtype, 0444, devtype_show, NULL);
485static DEVICE_ATTR(cutype, 0444, cutype_show, NULL);
Bastian Blankf1fc78a2005-10-30 15:00:12 -0800486static DEVICE_ATTR(modalias, 0444, modalias_show, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487static DEVICE_ATTR(online, 0644, online_show, online_store);
488extern struct device_attribute dev_attr_cmb_enable;
489static DEVICE_ATTR(availability, 0444, available_show, NULL);
490
491static struct attribute * subch_attrs[] = {
492 &dev_attr_chpids.attr,
493 &dev_attr_pimpampom.attr,
494 NULL,
495};
496
497static struct attribute_group subch_attr_group = {
498 .attrs = subch_attrs,
499};
500
501static inline int
502subchannel_add_files (struct device *dev)
503{
504 return sysfs_create_group(&dev->kobj, &subch_attr_group);
505}
506
507static struct attribute * ccwdev_attrs[] = {
508 &dev_attr_devtype.attr,
509 &dev_attr_cutype.attr,
Bastian Blankf1fc78a2005-10-30 15:00:12 -0800510 &dev_attr_modalias.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511 &dev_attr_online.attr,
512 &dev_attr_cmb_enable.attr,
513 &dev_attr_availability.attr,
514 NULL,
515};
516
517static struct attribute_group ccwdev_attr_group = {
518 .attrs = ccwdev_attrs,
519};
520
521static inline int
522device_add_files (struct device *dev)
523{
524 return sysfs_create_group(&dev->kobj, &ccwdev_attr_group);
525}
526
527static inline void
528device_remove_files(struct device *dev)
529{
530 sysfs_remove_group(&dev->kobj, &ccwdev_attr_group);
531}
532
533/* this is a simple abstraction for device_register that sets the
534 * correct bus type and adds the bus specific files */
Cornelia Huck3c9da7b2006-10-27 12:39:33 +0200535static int ccw_device_register(struct ccw_device *cdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536{
537 struct device *dev = &cdev->dev;
538 int ret;
539
540 dev->bus = &ccw_bus_type;
541
542 if ((ret = device_add(dev)))
543 return ret;
544
545 set_bit(1, &cdev->private->registered);
546 if ((ret = device_add_files(dev))) {
547 if (test_and_clear_bit(1, &cdev->private->registered))
548 device_del(dev);
549 }
550 return ret;
551}
552
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700553struct match_data {
Cornelia Huck78964262006-10-11 15:31:38 +0200554 struct ccw_dev_id dev_id;
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700555 struct ccw_device * sibling;
556};
557
558static int
559match_devno(struct device * dev, void * data)
560{
Cornelia Huck78964262006-10-11 15:31:38 +0200561 struct match_data * d = data;
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700562 struct ccw_device * cdev;
563
564 cdev = to_ccwdev(dev);
565 if ((cdev->private->state == DEV_STATE_DISCONNECTED) &&
Cornelia Huck78964262006-10-11 15:31:38 +0200566 ccw_dev_id_is_equal(&cdev->private->dev_id, &d->dev_id) &&
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700567 (cdev != d->sibling)) {
568 cdev->private->state = DEV_STATE_NOT_OPER;
569 return 1;
570 }
571 return 0;
572}
573
Cornelia Huck78964262006-10-11 15:31:38 +0200574static struct ccw_device * get_disc_ccwdev_by_dev_id(struct ccw_dev_id *dev_id,
575 struct ccw_device *sibling)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700577 struct device *dev;
Heiko Carstens292888c2006-08-30 14:33:35 +0200578 struct match_data data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579
Cornelia Huck78964262006-10-11 15:31:38 +0200580 data.dev_id = *dev_id;
Heiko Carstens292888c2006-08-30 14:33:35 +0200581 data.sibling = sibling;
Cornelia Hucke5945b42005-10-11 08:28:59 -0700582 dev = bus_find_device(&ccw_bus_type, NULL, &data, match_devno);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700584 return dev ? to_ccwdev(dev) : NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585}
586
587static void
588ccw_device_add_changed(void *data)
589{
590
591 struct ccw_device *cdev;
592
Cornelia Huck12975ae2006-10-11 15:31:47 +0200593 cdev = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594 if (device_add(&cdev->dev)) {
595 put_device(&cdev->dev);
596 return;
597 }
598 set_bit(1, &cdev->private->registered);
599 if (device_add_files(&cdev->dev)) {
600 if (test_and_clear_bit(1, &cdev->private->registered))
601 device_unregister(&cdev->dev);
602 }
603}
604
605extern int css_get_ssd_info(struct subchannel *sch);
606
607void
608ccw_device_do_unreg_rereg(void *data)
609{
610 struct ccw_device *cdev;
611 struct subchannel *sch;
612 int need_rename;
613
Cornelia Huck12975ae2006-10-11 15:31:47 +0200614 cdev = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615 sch = to_subchannel(cdev->dev.parent);
Cornelia Huck78964262006-10-11 15:31:38 +0200616 if (cdev->private->dev_id.devno != sch->schib.pmcw.dev) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617 /*
618 * The device number has changed. This is usually only when
619 * a device has been detached under VM and then re-appeared
620 * on another subchannel because of a different attachment
621 * order than before. Ideally, we should should just switch
622 * subchannels, but unfortunately, this is not possible with
623 * the current implementation.
624 * Instead, we search for the old subchannel for this device
625 * number and deregister so there are no collisions with the
626 * newly registered ccw_device.
627 * FIXME: Find another solution so the block layer doesn't
628 * get possibly sick...
629 */
630 struct ccw_device *other_cdev;
Cornelia Huck78964262006-10-11 15:31:38 +0200631 struct ccw_dev_id dev_id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632
633 need_rename = 1;
Cornelia Huck78964262006-10-11 15:31:38 +0200634 dev_id.devno = sch->schib.pmcw.dev;
635 dev_id.ssid = sch->schid.ssid;
636 other_cdev = get_disc_ccwdev_by_dev_id(&dev_id, cdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637 if (other_cdev) {
638 struct subchannel *other_sch;
639
640 other_sch = to_subchannel(other_cdev->dev.parent);
641 if (get_device(&other_sch->dev)) {
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800642 stsch(other_sch->schid, &other_sch->schib);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643 if (other_sch->schib.pmcw.dnv) {
644 other_sch->schib.pmcw.intparm = 0;
645 cio_modify(other_sch);
646 }
Cornelia Huck6ab48792006-07-12 16:39:50 +0200647 css_sch_device_unregister(other_sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 }
649 }
650 /* Update ssd info here. */
651 css_get_ssd_info(sch);
Cornelia Huck78964262006-10-11 15:31:38 +0200652 cdev->private->dev_id.devno = sch->schib.pmcw.dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653 } else
654 need_rename = 0;
655 device_remove_files(&cdev->dev);
656 if (test_and_clear_bit(1, &cdev->private->registered))
657 device_del(&cdev->dev);
658 if (need_rename)
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800659 snprintf (cdev->dev.bus_id, BUS_ID_SIZE, "0.%x.%04x",
660 sch->schid.ssid, sch->schib.pmcw.dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661 PREPARE_WORK(&cdev->private->kick_work,
Cornelia Huck12975ae2006-10-11 15:31:47 +0200662 ccw_device_add_changed, cdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700663 queue_work(ccw_device_work, &cdev->private->kick_work);
664}
665
666static void
667ccw_device_release(struct device *dev)
668{
669 struct ccw_device *cdev;
670
671 cdev = to_ccwdev(dev);
672 kfree(cdev->private);
673 kfree(cdev);
674}
675
676/*
677 * Register recognized device.
678 */
679static void
680io_subchannel_register(void *data)
681{
682 struct ccw_device *cdev;
683 struct subchannel *sch;
684 int ret;
685 unsigned long flags;
686
Cornelia Huck12975ae2006-10-11 15:31:47 +0200687 cdev = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700688 sch = to_subchannel(cdev->dev.parent);
689
Cornelia Huck47af5512006-12-04 15:41:07 +0100690 /*
691 * io_subchannel_register() will also be called after device
692 * recognition has been done for a boxed device (which will already
693 * be registered). We need to reprobe since we may now have sense id
694 * information.
695 */
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700696 if (klist_node_attached(&cdev->dev.knode_parent)) {
Cornelia Huck47af5512006-12-04 15:41:07 +0100697 if (!cdev->drv) {
698 ret = device_reprobe(&cdev->dev);
699 if (ret)
700 /* We can't do much here. */
701 dev_info(&cdev->dev, "device_reprobe() returned"
702 " %d\n", ret);
703 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700704 goto out;
705 }
706 /* make it known to the system */
707 ret = ccw_device_register(cdev);
708 if (ret) {
709 printk (KERN_WARNING "%s: could not register %s\n",
710 __func__, cdev->dev.bus_id);
711 put_device(&cdev->dev);
712 spin_lock_irqsave(&sch->lock, flags);
713 sch->dev.driver_data = NULL;
714 spin_unlock_irqrestore(&sch->lock, flags);
715 kfree (cdev->private);
716 kfree (cdev);
717 put_device(&sch->dev);
718 if (atomic_dec_and_test(&ccw_device_init_count))
719 wake_up(&ccw_device_init_wq);
720 return;
721 }
722
723 ret = subchannel_add_files(cdev->dev.parent);
724 if (ret)
725 printk(KERN_WARNING "%s: could not add attributes to %s\n",
726 __func__, sch->dev.bus_id);
727 put_device(&cdev->dev);
728out:
729 cdev->private->flags.recog_done = 1;
730 put_device(&sch->dev);
731 wake_up(&cdev->private->wait_q);
732 if (atomic_dec_and_test(&ccw_device_init_count))
733 wake_up(&ccw_device_init_wq);
734}
735
736void
737ccw_device_call_sch_unregister(void *data)
738{
739 struct ccw_device *cdev = data;
740 struct subchannel *sch;
741
742 sch = to_subchannel(cdev->dev.parent);
Cornelia Huck6ab48792006-07-12 16:39:50 +0200743 css_sch_device_unregister(sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744 /* Reset intparm to zeroes. */
745 sch->schib.pmcw.intparm = 0;
746 cio_modify(sch);
747 put_device(&cdev->dev);
748 put_device(&sch->dev);
749}
750
751/*
752 * subchannel recognition done. Called from the state machine.
753 */
754void
755io_subchannel_recog_done(struct ccw_device *cdev)
756{
757 struct subchannel *sch;
758
759 if (css_init_done == 0) {
760 cdev->private->flags.recog_done = 1;
761 return;
762 }
763 switch (cdev->private->state) {
764 case DEV_STATE_NOT_OPER:
765 cdev->private->flags.recog_done = 1;
766 /* Remove device found not operational. */
767 if (!get_device(&cdev->dev))
768 break;
769 sch = to_subchannel(cdev->dev.parent);
770 PREPARE_WORK(&cdev->private->kick_work,
Cornelia Huck12975ae2006-10-11 15:31:47 +0200771 ccw_device_call_sch_unregister, cdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772 queue_work(slow_path_wq, &cdev->private->kick_work);
773 if (atomic_dec_and_test(&ccw_device_init_count))
774 wake_up(&ccw_device_init_wq);
775 break;
776 case DEV_STATE_BOXED:
777 /* Device did not respond in time. */
778 case DEV_STATE_OFFLINE:
779 /*
780 * We can't register the device in interrupt context so
781 * we schedule a work item.
782 */
783 if (!get_device(&cdev->dev))
784 break;
785 PREPARE_WORK(&cdev->private->kick_work,
Cornelia Huck12975ae2006-10-11 15:31:47 +0200786 io_subchannel_register, cdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 queue_work(slow_path_wq, &cdev->private->kick_work);
788 break;
789 }
790}
791
792static int
793io_subchannel_recog(struct ccw_device *cdev, struct subchannel *sch)
794{
795 int rc;
796 struct ccw_device_private *priv;
797
798 sch->dev.driver_data = cdev;
799 sch->driver = &io_subchannel_driver;
800 cdev->ccwlock = &sch->lock;
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800801
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802 /* Init private data. */
803 priv = cdev->private;
Cornelia Huck78964262006-10-11 15:31:38 +0200804 priv->dev_id.devno = sch->schib.pmcw.dev;
805 priv->dev_id.ssid = sch->schid.ssid;
806 priv->schid = sch->schid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807 priv->state = DEV_STATE_NOT_OPER;
808 INIT_LIST_HEAD(&priv->cmb_list);
809 init_waitqueue_head(&priv->wait_q);
810 init_timer(&priv->timer);
811
812 /* Set an initial name for the device. */
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800813 snprintf (cdev->dev.bus_id, BUS_ID_SIZE, "0.%x.%04x",
814 sch->schid.ssid, sch->schib.pmcw.dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700815
816 /* Increase counter of devices currently in recognition. */
817 atomic_inc(&ccw_device_init_count);
818
819 /* Start async. device sensing. */
820 spin_lock_irq(&sch->lock);
821 rc = ccw_device_recognition(cdev);
822 spin_unlock_irq(&sch->lock);
823 if (rc) {
824 if (atomic_dec_and_test(&ccw_device_init_count))
825 wake_up(&ccw_device_init_wq);
826 }
827 return rc;
828}
829
830static int
Cornelia Huck8bbace72006-01-11 10:56:22 +0100831io_subchannel_probe (struct subchannel *sch)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833 struct ccw_device *cdev;
834 int rc;
835 unsigned long flags;
836
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 if (sch->dev.driver_data) {
838 /*
839 * This subchannel already has an associated ccw_device.
840 * Register it and exit. This happens for all early
841 * device, e.g. the console.
842 */
843 cdev = sch->dev.driver_data;
844 device_initialize(&cdev->dev);
845 ccw_device_register(cdev);
846 subchannel_add_files(&sch->dev);
847 /*
848 * Check if the device is already online. If it is
849 * the reference count needs to be corrected
850 * (see ccw_device_online and css_init_done for the
851 * ugly details).
852 */
853 if (cdev->private->state != DEV_STATE_NOT_OPER &&
854 cdev->private->state != DEV_STATE_OFFLINE &&
855 cdev->private->state != DEV_STATE_BOXED)
856 get_device(&cdev->dev);
857 return 0;
858 }
Eric Sesterhenn88abaab2006-03-24 03:15:31 -0800859 cdev = kzalloc (sizeof(*cdev), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860 if (!cdev)
861 return -ENOMEM;
Eric Sesterhenn88abaab2006-03-24 03:15:31 -0800862 cdev->private = kzalloc(sizeof(struct ccw_device_private),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700863 GFP_KERNEL | GFP_DMA);
864 if (!cdev->private) {
865 kfree(cdev);
866 return -ENOMEM;
867 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868 atomic_set(&cdev->private->onoff, 0);
Heiko Carstens292888c2006-08-30 14:33:35 +0200869 cdev->dev.parent = &sch->dev;
870 cdev->dev.release = ccw_device_release;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871 INIT_LIST_HEAD(&cdev->private->kick_work.entry);
872 /* Do first half of device_register. */
873 device_initialize(&cdev->dev);
874
875 if (!get_device(&sch->dev)) {
876 if (cdev->dev.release)
877 cdev->dev.release(&cdev->dev);
878 return -ENODEV;
879 }
880
Cornelia Huck8bbace72006-01-11 10:56:22 +0100881 rc = io_subchannel_recog(cdev, sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882 if (rc) {
883 spin_lock_irqsave(&sch->lock, flags);
884 sch->dev.driver_data = NULL;
885 spin_unlock_irqrestore(&sch->lock, flags);
886 if (cdev->dev.release)
887 cdev->dev.release(&cdev->dev);
888 }
889
890 return rc;
891}
892
893static void
894ccw_device_unregister(void *data)
895{
896 struct ccw_device *cdev;
897
898 cdev = (struct ccw_device *)data;
899 if (test_and_clear_bit(1, &cdev->private->registered))
900 device_unregister(&cdev->dev);
901 put_device(&cdev->dev);
902}
903
904static int
Cornelia Huck8bbace72006-01-11 10:56:22 +0100905io_subchannel_remove (struct subchannel *sch)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700906{
907 struct ccw_device *cdev;
908 unsigned long flags;
909
Cornelia Huck8bbace72006-01-11 10:56:22 +0100910 if (!sch->dev.driver_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911 return 0;
Cornelia Huck8bbace72006-01-11 10:56:22 +0100912 cdev = sch->dev.driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700913 /* Set ccw device to not operational and drop reference. */
914 spin_lock_irqsave(cdev->ccwlock, flags);
Cornelia Huck8bbace72006-01-11 10:56:22 +0100915 sch->dev.driver_data = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700916 cdev->private->state = DEV_STATE_NOT_OPER;
917 spin_unlock_irqrestore(cdev->ccwlock, flags);
918 /*
919 * Put unregistration on workqueue to avoid livelocks on the css bus
920 * semaphore.
921 */
922 if (get_device(&cdev->dev)) {
923 PREPARE_WORK(&cdev->private->kick_work,
Cornelia Huck12975ae2006-10-11 15:31:47 +0200924 ccw_device_unregister, cdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925 queue_work(ccw_device_work, &cdev->private->kick_work);
926 }
927 return 0;
928}
929
930static int
931io_subchannel_notify(struct device *dev, int event)
932{
933 struct ccw_device *cdev;
934
935 cdev = dev->driver_data;
936 if (!cdev)
937 return 0;
938 if (!cdev->drv)
939 return 0;
940 if (!cdev->online)
941 return 0;
942 return cdev->drv->notify ? cdev->drv->notify(cdev, event) : 0;
943}
944
945static void
946io_subchannel_verify(struct device *dev)
947{
948 struct ccw_device *cdev;
949
950 cdev = dev->driver_data;
951 if (cdev)
952 dev_fsm_event(cdev, DEV_EVENT_VERIFY);
953}
954
955static void
956io_subchannel_ioterm(struct device *dev)
957{
958 struct ccw_device *cdev;
959
960 cdev = dev->driver_data;
961 if (!cdev)
962 return;
Cornelia Huckd23861f2006-12-04 15:41:04 +0100963 /* Internal I/O will be retried by the interrupt handler. */
964 if (cdev->private->flags.intretry)
965 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966 cdev->private->state = DEV_STATE_CLEAR_VERIFY;
967 if (cdev->handler)
968 cdev->handler(cdev, cdev->private->intparm,
969 ERR_PTR(-EIO));
970}
971
972static void
Cornelia Huck8bbace72006-01-11 10:56:22 +0100973io_subchannel_shutdown(struct subchannel *sch)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700975 struct ccw_device *cdev;
976 int ret;
977
Cornelia Huck8bbace72006-01-11 10:56:22 +0100978 cdev = sch->dev.driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700979
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800980 if (cio_is_console(sch->schid))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981 return;
982 if (!sch->schib.pmcw.ena)
983 /* Nothing to do. */
984 return;
985 ret = cio_disable_subchannel(sch);
986 if (ret != -EBUSY)
987 /* Subchannel is disabled, we're done. */
988 return;
989 cdev->private->state = DEV_STATE_QUIESCE;
990 if (cdev->handler)
991 cdev->handler(cdev, cdev->private->intparm,
992 ERR_PTR(-EIO));
993 ret = ccw_device_cancel_halt_clear(cdev);
994 if (ret == -EBUSY) {
995 ccw_device_set_timeout(cdev, HZ/10);
996 wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev));
997 }
998 cio_disable_subchannel(sch);
999}
1000
1001#ifdef CONFIG_CCW_CONSOLE
1002static struct ccw_device console_cdev;
1003static struct ccw_device_private console_private;
1004static int console_cdev_in_use;
1005
1006static int
1007ccw_device_console_enable (struct ccw_device *cdev, struct subchannel *sch)
1008{
1009 int rc;
1010
1011 /* Initialize the ccw_device structure. */
Heiko Carstens292888c2006-08-30 14:33:35 +02001012 cdev->dev.parent= &sch->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001013 rc = io_subchannel_recog(cdev, sch);
1014 if (rc)
1015 return rc;
1016
1017 /* Now wait for the async. recognition to come to an end. */
1018 spin_lock_irq(cdev->ccwlock);
1019 while (!dev_fsm_final_state(cdev))
1020 wait_cons_dev();
1021 rc = -EIO;
1022 if (cdev->private->state != DEV_STATE_OFFLINE)
1023 goto out_unlock;
1024 ccw_device_online(cdev);
1025 while (!dev_fsm_final_state(cdev))
1026 wait_cons_dev();
1027 if (cdev->private->state != DEV_STATE_ONLINE)
1028 goto out_unlock;
1029 rc = 0;
1030out_unlock:
1031 spin_unlock_irq(cdev->ccwlock);
1032 return 0;
1033}
1034
1035struct ccw_device *
1036ccw_device_probe_console(void)
1037{
1038 struct subchannel *sch;
1039 int ret;
1040
1041 if (xchg(&console_cdev_in_use, 1) != 0)
Peter Oberparleiter600b5d12006-02-01 03:06:35 -08001042 return ERR_PTR(-EBUSY);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043 sch = cio_probe_console();
1044 if (IS_ERR(sch)) {
1045 console_cdev_in_use = 0;
1046 return (void *) sch;
1047 }
1048 memset(&console_cdev, 0, sizeof(struct ccw_device));
1049 memset(&console_private, 0, sizeof(struct ccw_device_private));
1050 console_cdev.private = &console_private;
1051 ret = ccw_device_console_enable(&console_cdev, sch);
1052 if (ret) {
1053 cio_release_console();
1054 console_cdev_in_use = 0;
1055 return ERR_PTR(ret);
1056 }
1057 console_cdev.online = 1;
1058 return &console_cdev;
1059}
1060#endif
1061
1062/*
1063 * get ccw_device matching the busid, but only if owned by cdrv
1064 */
Cornelia Huckb0744bd2005-06-25 14:55:27 -07001065static int
1066__ccwdev_check_busid(struct device *dev, void *id)
1067{
1068 char *bus_id;
1069
Cornelia Huck12975ae2006-10-11 15:31:47 +02001070 bus_id = id;
Cornelia Huckb0744bd2005-06-25 14:55:27 -07001071
1072 return (strncmp(bus_id, dev->bus_id, BUS_ID_SIZE) == 0);
1073}
1074
1075
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076struct ccw_device *
1077get_ccwdev_by_busid(struct ccw_driver *cdrv, const char *bus_id)
1078{
Cornelia Huckb0744bd2005-06-25 14:55:27 -07001079 struct device *dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001080 struct device_driver *drv;
1081
1082 drv = get_driver(&cdrv->driver);
1083 if (!drv)
Cornelia Huckb0744bd2005-06-25 14:55:27 -07001084 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001085
Cornelia Huckb0744bd2005-06-25 14:55:27 -07001086 dev = driver_find_device(drv, NULL, (void *)bus_id,
1087 __ccwdev_check_busid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088 put_driver(drv);
1089
Heiko Carstensd2c993d2006-07-12 16:41:55 +02001090 return dev ? to_ccwdev(dev) : NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001091}
1092
1093/************************** device driver handling ************************/
1094
1095/* This is the implementation of the ccw_driver class. The probe, remove
1096 * and release methods are initially very similar to the device_driver
1097 * implementations, with the difference that they have ccw_device
1098 * arguments.
1099 *
1100 * A ccw driver also contains the information that is needed for
1101 * device matching.
1102 */
1103static int
1104ccw_device_probe (struct device *dev)
1105{
1106 struct ccw_device *cdev = to_ccwdev(dev);
1107 struct ccw_driver *cdrv = to_ccwdrv(dev->driver);
1108 int ret;
1109
1110 cdev->drv = cdrv; /* to let the driver call _set_online */
1111
1112 ret = cdrv->probe ? cdrv->probe(cdev) : -ENODEV;
1113
1114 if (ret) {
Heiko Carstensd2c993d2006-07-12 16:41:55 +02001115 cdev->drv = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001116 return ret;
1117 }
1118
1119 return 0;
1120}
1121
1122static int
1123ccw_device_remove (struct device *dev)
1124{
1125 struct ccw_device *cdev = to_ccwdev(dev);
1126 struct ccw_driver *cdrv = cdev->drv;
1127 int ret;
1128
1129 pr_debug("removing device %s\n", cdev->dev.bus_id);
1130 if (cdrv->remove)
1131 cdrv->remove(cdev);
1132 if (cdev->online) {
1133 cdev->online = 0;
1134 spin_lock_irq(cdev->ccwlock);
1135 ret = ccw_device_offline(cdev);
1136 spin_unlock_irq(cdev->ccwlock);
1137 if (ret == 0)
1138 wait_event(cdev->private->wait_q,
1139 dev_fsm_final_state(cdev));
1140 else
1141 //FIXME: we can't fail!
1142 pr_debug("ccw_device_offline returned %d, device %s\n",
1143 ret, cdev->dev.bus_id);
1144 }
1145 ccw_device_set_timeout(cdev, 0);
Heiko Carstensd2c993d2006-07-12 16:41:55 +02001146 cdev->drv = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001147 return 0;
1148}
1149
Cornelia Huck8bbace72006-01-11 10:56:22 +01001150struct bus_type ccw_bus_type = {
1151 .name = "ccw",
1152 .match = ccw_bus_match,
1153 .uevent = ccw_uevent,
1154 .probe = ccw_device_probe,
1155 .remove = ccw_device_remove,
1156};
1157
Linus Torvalds1da177e2005-04-16 15:20:36 -07001158int
1159ccw_driver_register (struct ccw_driver *cdriver)
1160{
1161 struct device_driver *drv = &cdriver->driver;
1162
1163 drv->bus = &ccw_bus_type;
1164 drv->name = cdriver->name;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001165
1166 return driver_register(drv);
1167}
1168
1169void
1170ccw_driver_unregister (struct ccw_driver *cdriver)
1171{
1172 driver_unregister(&cdriver->driver);
1173}
1174
Cornelia Hucka8237fc2006-01-06 00:19:21 -08001175/* Helper func for qdio. */
1176struct subchannel_id
1177ccw_device_get_subchannel_id(struct ccw_device *cdev)
1178{
1179 struct subchannel *sch;
1180
1181 sch = to_subchannel(cdev->dev.parent);
1182 return sch->schid;
1183}
1184
Linus Torvalds1da177e2005-04-16 15:20:36 -07001185MODULE_LICENSE("GPL");
1186EXPORT_SYMBOL(ccw_device_set_online);
1187EXPORT_SYMBOL(ccw_device_set_offline);
1188EXPORT_SYMBOL(ccw_driver_register);
1189EXPORT_SYMBOL(ccw_driver_unregister);
1190EXPORT_SYMBOL(get_ccwdev_by_busid);
1191EXPORT_SYMBOL(ccw_bus_type);
1192EXPORT_SYMBOL(ccw_device_work);
1193EXPORT_SYMBOL(ccw_device_notify_work);
Cornelia Hucka8237fc2006-01-06 00:19:21 -08001194EXPORT_SYMBOL_GPL(ccw_device_get_subchannel_id);