device.c 56.7 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1
2
3
4
/*
 *  drivers/s390/cio/device.c
 *  bus driver for ccw devices
 *
Cornelia Huck's avatar
Cornelia Huck committed
5
 *    Copyright IBM Corp. 2002,2008
Linus Torvalds's avatar
Linus Torvalds committed
6
 *    Author(s): Arnd Bergmann (arndb@de.ibm.com)
7
 *		 Cornelia Huck (cornelia.huck@de.ibm.com)
Linus Torvalds's avatar
Linus Torvalds committed
8
9
10
11
12
13
14
15
16
17
18
 *		 Martin Schwidefsky (schwidefsky@de.ibm.com)
 */
#include <linux/module.h>
#include <linux/init.h>
#include <linux/spinlock.h>
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/slab.h>
#include <linux/list.h>
#include <linux/device.h>
#include <linux/workqueue.h>
19
#include <linux/timer.h>
Linus Torvalds's avatar
Linus Torvalds committed
20
21
22

#include <asm/ccwdev.h>
#include <asm/cio.h>
Tim Schmielau's avatar
Tim Schmielau committed
23
#include <asm/param.h>		/* HZ */
24
#include <asm/cmb.h>
25
#include <asm/isc.h>
Linus Torvalds's avatar
Linus Torvalds committed
26

27
#include "chp.h"
Linus Torvalds's avatar
Linus Torvalds committed
28
#include "cio.h"
29
#include "cio_debug.h"
Linus Torvalds's avatar
Linus Torvalds committed
30
31
32
#include "css.h"
#include "device.h"
#include "ioasm.h"
33
#include "io_sch.h"
34
#include "blacklist.h"
Linus Torvalds's avatar
Linus Torvalds committed
35

36
static struct timer_list recovery_timer;
37
static DEFINE_SPINLOCK(recovery_lock);
38
39
40
static int recovery_phase;
static const unsigned long recovery_delay[] = { 3, 30, 300 };

Linus Torvalds's avatar
Linus Torvalds committed
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
/******************* bus type handling ***********************/

/* The Linux driver model distinguishes between a bus type and
 * the bus itself. Of course we only have one channel
 * subsystem driver and one channel system per machine, but
 * we still use the abstraction. T.R. says it's a good idea. */
static int
ccw_bus_match (struct device * dev, struct device_driver * drv)
{
	struct ccw_device *cdev = to_ccwdev(dev);
	struct ccw_driver *cdrv = to_ccwdrv(drv);
	const struct ccw_device_id *ids = cdrv->ids, *found;

	if (!ids)
		return 0;

	found = ccw_device_id_match(ids, &cdev->id);
	if (!found)
		return 0;

	cdev->id.driver_info = found->driver_info;

	return 1;
}

66
67
68
/* Store modalias string delimited by prefix/suffix string into buffer with
 * specified size. Return length of resulting string (excluding trailing '\0')
 * even if string doesn't fit buffer (snprintf semantics). */
69
static int snprint_alias(char *buf, size_t size,
70
			 struct ccw_device_id *id, const char *suffix)
Linus Torvalds's avatar
Linus Torvalds committed
71
{
72
	int len;
Linus Torvalds's avatar
Linus Torvalds committed
73

74
	len = snprintf(buf, size, "ccw:t%04Xm%02X", id->cu_type, id->cu_model);
75
76
77
78
	if (len > size)
		return len;
	buf += len;
	size -= len;
Linus Torvalds's avatar
Linus Torvalds committed
79

80
81
82
83
84
	if (id->dev_type != 0)
		len += snprintf(buf, size, "dt%04Xdm%02X%s", id->dev_type,
				id->dev_model, suffix);
	else
		len += snprintf(buf, size, "dtdm%s", suffix);
Linus Torvalds's avatar
Linus Torvalds committed
85

86
87
88
89
90
	return len;
}

/* Set up environment variables for ccw device uevent. Return 0 on success,
 * non-zero otherwise. */
91
static int ccw_uevent(struct device *dev, struct kobj_uevent_env *env)
92
93
94
{
	struct ccw_device *cdev = to_ccwdev(dev);
	struct ccw_device_id *id = &(cdev->id);
95
96
	int ret;
	char modalias_buf[30];
Linus Torvalds's avatar
Linus Torvalds committed
97

98
	/* CU_TYPE= */
99
	ret = add_uevent_var(env, "CU_TYPE=%04X", id->cu_type);
100
101
	if (ret)
		return ret;
102
103

	/* CU_MODEL= */
104
	ret = add_uevent_var(env, "CU_MODEL=%02X", id->cu_model);
105
106
	if (ret)
		return ret;
Linus Torvalds's avatar
Linus Torvalds committed
107
108

	/* The next two can be zero, that's ok for us */
109
	/* DEV_TYPE= */
110
	ret = add_uevent_var(env, "DEV_TYPE=%04X", id->dev_type);
111
112
	if (ret)
		return ret;
Linus Torvalds's avatar
Linus Torvalds committed
113

114
	/* DEV_MODEL= */
115
	ret = add_uevent_var(env, "DEV_MODEL=%02X", id->dev_model);
116
117
	if (ret)
		return ret;
118
119

	/* MODALIAS=  */
120
	snprint_alias(modalias_buf, sizeof(modalias_buf), id, "");
121
122
	ret = add_uevent_var(env, "MODALIAS=%s", modalias_buf);
	return ret;
Linus Torvalds's avatar
Linus Torvalds committed
123
124
}

125
struct bus_type ccw_bus_type;
Linus Torvalds's avatar
Linus Torvalds committed
126

127
128
129
static void io_subchannel_irq(struct subchannel *);
static int io_subchannel_probe(struct subchannel *);
static int io_subchannel_remove(struct subchannel *);
130
static void io_subchannel_shutdown(struct subchannel *);
Cornelia Huck's avatar
Cornelia Huck committed
131
static int io_subchannel_sch_event(struct subchannel *, int);
132
133
static int io_subchannel_chp_event(struct subchannel *, struct chp_link *,
				   int);
Linus Torvalds's avatar
Linus Torvalds committed
134

135
136
137
138
139
140
static struct css_device_id io_subchannel_ids[] = {
	{ .match_flags = 0x1, .type = SUBCHANNEL_TYPE_IO, },
	{ /* end of list */ },
};
MODULE_DEVICE_TABLE(css, io_subchannel_ids);

141
142
143
144
145
146
147
148
149
150
151
152
153
static int io_subchannel_prepare(struct subchannel *sch)
{
	struct ccw_device *cdev;
	/*
	 * Don't allow suspend while a ccw device registration
	 * is still outstanding.
	 */
	cdev = sch_get_cdev(sch);
	if (cdev && !device_is_registered(&cdev->dev))
		return -EAGAIN;
	return 0;
}

154
static struct css_driver io_subchannel_driver = {
155
	.owner = THIS_MODULE,
156
	.subchannel_type = io_subchannel_ids,
157
	.name = "io_subchannel",
Linus Torvalds's avatar
Linus Torvalds committed
158
	.irq = io_subchannel_irq,
Cornelia Huck's avatar
Cornelia Huck committed
159
160
	.sch_event = io_subchannel_sch_event,
	.chp_event = io_subchannel_chp_event,
161
162
163
	.probe = io_subchannel_probe,
	.remove = io_subchannel_remove,
	.shutdown = io_subchannel_shutdown,
164
	.prepare = io_subchannel_prepare,
Linus Torvalds's avatar
Linus Torvalds committed
165
166
167
};

struct workqueue_struct *ccw_device_work;
168
169
wait_queue_head_t ccw_device_init_wq;
atomic_t ccw_device_init_count;
Linus Torvalds's avatar
Linus Torvalds committed
170

171
172
static void recovery_func(unsigned long data);

Linus Torvalds's avatar
Linus Torvalds committed
173
174
175
176
177
178
179
static int __init
init_ccw_bus_type (void)
{
	int ret;

	init_waitqueue_head(&ccw_device_init_wq);
	atomic_set(&ccw_device_init_count, 0);
180
	setup_timer(&recovery_timer, recovery_func, 0);
Linus Torvalds's avatar
Linus Torvalds committed
181
182
183
184
185
186
187
188
189
190
191
192

	ccw_device_work = create_singlethread_workqueue("cio");
	if (!ccw_device_work)
		return -ENOMEM; /* FIXME: better errno ? */
	slow_path_wq = create_singlethread_workqueue("kslowcrw");
	if (!slow_path_wq) {
		ret = -ENOMEM; /* FIXME: better errno ? */
		goto out_err;
	}
	if ((ret = bus_register (&ccw_bus_type)))
		goto out_err;

193
194
	ret = css_driver_register(&io_subchannel_driver);
	if (ret)
Linus Torvalds's avatar
Linus Torvalds committed
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
		goto out_err;

	wait_event(ccw_device_init_wq,
		   atomic_read(&ccw_device_init_count) == 0);
	flush_workqueue(ccw_device_work);
	return 0;
out_err:
	if (ccw_device_work)
		destroy_workqueue(ccw_device_work);
	if (slow_path_wq)
		destroy_workqueue(slow_path_wq);
	return ret;
}

static void __exit
cleanup_ccw_bus_type (void)
{
212
	css_driver_unregister(&io_subchannel_driver);
Linus Torvalds's avatar
Linus Torvalds committed
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
	bus_unregister(&ccw_bus_type);
	destroy_workqueue(ccw_device_work);
}

subsys_initcall(init_ccw_bus_type);
module_exit(cleanup_ccw_bus_type);

/************************ device handling **************************/

/*
 * A ccw_device has some interfaces in sysfs in addition to the
 * standard ones.
 * The following entries are designed to export the information which
 * resided in 2.4 in /proc/subchannels. Subchannel and device number
 * are obvious, so they don't have an entry :)
 * TODO: Split chpids and pimpampom up? Where is "in use" in the tree?
 */
static ssize_t
231
chpids_show (struct device * dev, struct device_attribute *attr, char * buf)
Linus Torvalds's avatar
Linus Torvalds committed
232
233
{
	struct subchannel *sch = to_subchannel(dev);
234
	struct chsc_ssd_info *ssd = &sch->ssd_info;
Linus Torvalds's avatar
Linus Torvalds committed
235
236
	ssize_t ret = 0;
	int chp;
237
238
239
240
241
242
243
244
245
	int mask;

	for (chp = 0; chp < 8; chp++) {
		mask = 0x80 >> chp;
		if (ssd->path_mask & mask)
			ret += sprintf(buf + ret, "%02x ", ssd->chpid[chp].id);
		else
			ret += sprintf(buf + ret, "00 ");
	}
Linus Torvalds's avatar
Linus Torvalds committed
246
247
248
249
250
	ret += sprintf (buf+ret, "\n");
	return min((ssize_t)PAGE_SIZE, ret);
}

static ssize_t
251
pimpampom_show (struct device * dev, struct device_attribute *attr, char * buf)
Linus Torvalds's avatar
Linus Torvalds committed
252
253
254
255
256
257
258
259
260
{
	struct subchannel *sch = to_subchannel(dev);
	struct pmcw *pmcw = &sch->schib.pmcw;

	return sprintf (buf, "%02x %02x %02x\n",
			pmcw->pim, pmcw->pam, pmcw->pom);
}

static ssize_t
261
devtype_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds's avatar
Linus Torvalds committed
262
263
264
265
266
267
268
269
270
271
272
273
{
	struct ccw_device *cdev = to_ccwdev(dev);
	struct ccw_device_id *id = &(cdev->id);

	if (id->dev_type != 0)
		return sprintf(buf, "%04x/%02x\n",
				id->dev_type, id->dev_model);
	else
		return sprintf(buf, "n/a\n");
}

static ssize_t
274
cutype_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds's avatar
Linus Torvalds committed
275
276
277
278
279
280
281
282
{
	struct ccw_device *cdev = to_ccwdev(dev);
	struct ccw_device_id *id = &(cdev->id);

	return sprintf(buf, "%04x/%02x\n",
		       id->cu_type, id->cu_model);
}

283
284
285
286
287
static ssize_t
modalias_show (struct device *dev, struct device_attribute *attr, char *buf)
{
	struct ccw_device *cdev = to_ccwdev(dev);
	struct ccw_device_id *id = &(cdev->id);
288
	int len;
289

290
	len = snprint_alias(buf, PAGE_SIZE, id, "\n");
291
292

	return len > PAGE_SIZE ? PAGE_SIZE : len;
293
294
}

Linus Torvalds's avatar
Linus Torvalds committed
295
static ssize_t
296
online_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds's avatar
Linus Torvalds committed
297
298
299
300
301
302
{
	struct ccw_device *cdev = to_ccwdev(dev);

	return sprintf(buf, cdev->online ? "1\n" : "0\n");
}

303
304
305
306
307
int ccw_device_is_orphan(struct ccw_device *cdev)
{
	return sch_is_pseudo_sch(to_subchannel(cdev->dev.parent));
}

308
static void ccw_device_unregister(struct ccw_device *cdev)
309
310
{
	if (test_and_clear_bit(1, &cdev->private->registered))
311
		device_del(&cdev->dev);
312
313
}

314
static void ccw_device_remove_orphan_cb(struct work_struct *work)
315
{
316
317
	struct ccw_device_private *priv;
	struct ccw_device *cdev;
318

319
320
	priv = container_of(work, struct ccw_device_private, kick_work);
	cdev = priv->cdev;
321
322
	ccw_device_unregister(cdev);
	put_device(&cdev->dev);
323
324
	/* Release cdev reference for workqueue processing. */
	put_device(&cdev->dev);
325
326
}

Linus Torvalds's avatar
Linus Torvalds committed
327
328
329
static void
ccw_device_remove_disconnected(struct ccw_device *cdev)
{
330
	unsigned long flags;
331

Linus Torvalds's avatar
Linus Torvalds committed
332
333
334
335
	/*
	 * Forced offline in disconnected state means
	 * 'throw away device'.
	 */
336
	if (ccw_device_is_orphan(cdev)) {
337
338
339
340
341
		/*
		 * Deregister ccw device.
		 * Unfortunately, we cannot do this directly from the
		 * attribute method.
		 */
342
343
344
		/* Get cdev reference for workqueue processing. */
		if (!get_device(&cdev->dev))
			return;
345
346
347
		spin_lock_irqsave(cdev->ccwlock, flags);
		cdev->private->state = DEV_STATE_NOT_OPER;
		spin_unlock_irqrestore(cdev->ccwlock, flags);
348
349
		PREPARE_WORK(&cdev->private->kick_work,
				ccw_device_remove_orphan_cb);
350
		queue_work(slow_path_wq, &cdev->private->kick_work);
351
352
	} else
		/* Deregister subchannel, which will kill the ccw device. */
353
		ccw_device_schedule_sch_unregister(cdev);
Linus Torvalds's avatar
Linus Torvalds committed
354
355
}

356
357
358
359
360
361
362
363
364
365
366
367
/**
 * ccw_device_set_offline() - disable a ccw device for I/O
 * @cdev: target ccw device
 *
 * This function calls the driver's set_offline() function for @cdev, if
 * given, and then disables @cdev.
 * Returns:
 *   %0 on success and a negative error value on failure.
 * Context:
 *  enabled, ccw device lock not held
 */
int ccw_device_set_offline(struct ccw_device *cdev)
Linus Torvalds's avatar
Linus Torvalds committed
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
{
	int ret;

	if (!cdev)
		return -ENODEV;
	if (!cdev->online || !cdev->drv)
		return -EINVAL;

	if (cdev->drv->set_offline) {
		ret = cdev->drv->set_offline(cdev);
		if (ret != 0)
			return ret;
	}
	cdev->online = 0;
	spin_lock_irq(cdev->ccwlock);
383
384
385
	/* Wait until a final state or DISCONNECTED is reached */
	while (!dev_fsm_final_state(cdev) &&
	       cdev->private->state != DEV_STATE_DISCONNECTED) {
Linus Torvalds's avatar
Linus Torvalds committed
386
		spin_unlock_irq(cdev->ccwlock);
387
388
389
		wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
			   cdev->private->state == DEV_STATE_DISCONNECTED));
		spin_lock_irq(cdev->ccwlock);
Linus Torvalds's avatar
Linus Torvalds committed
390
	}
391
392
393
	ret = ccw_device_offline(cdev);
	if (ret)
		goto error;
Linus Torvalds's avatar
Linus Torvalds committed
394
	spin_unlock_irq(cdev->ccwlock);
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
	wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
		   cdev->private->state == DEV_STATE_DISCONNECTED));
	/* Give up reference from ccw_device_set_online(). */
	put_device(&cdev->dev);
	return 0;

error:
	CIO_MSG_EVENT(0, "ccw_device_offline returned %d, device 0.%x.%04x\n",
		      ret, cdev->private->dev_id.ssid,
		      cdev->private->dev_id.devno);
	cdev->private->state = DEV_STATE_OFFLINE;
	dev_fsm_event(cdev, DEV_EVENT_NOTOPER);
	spin_unlock_irq(cdev->ccwlock);
	/* Give up reference from ccw_device_set_online(). */
	put_device(&cdev->dev);
	return -ENODEV;
Linus Torvalds's avatar
Linus Torvalds committed
411
412
}

413
414
415
416
417
418
419
420
421
422
423
424
425
/**
 * ccw_device_set_online() - enable a ccw device for I/O
 * @cdev: target ccw device
 *
 * This function first enables @cdev and then calls the driver's set_online()
 * function for @cdev, if given. If set_online() returns an error, @cdev is
 * disabled again.
 * Returns:
 *   %0 on success and a negative error value on failure.
 * Context:
 *  enabled, ccw device lock not held
 */
int ccw_device_set_online(struct ccw_device *cdev)
Linus Torvalds's avatar
Linus Torvalds committed
426
427
{
	int ret;
428
	int ret2;
Linus Torvalds's avatar
Linus Torvalds committed
429
430
431
432
433

	if (!cdev)
		return -ENODEV;
	if (cdev->online || !cdev->drv)
		return -EINVAL;
434
435
436
	/* Hold on to an extra reference while device is online. */
	if (!get_device(&cdev->dev))
		return -ENODEV;
Linus Torvalds's avatar
Linus Torvalds committed
437
438
439
440
441
442
443

	spin_lock_irq(cdev->ccwlock);
	ret = ccw_device_online(cdev);
	spin_unlock_irq(cdev->ccwlock);
	if (ret == 0)
		wait_event(cdev->private->wait_q, dev_fsm_final_state(cdev));
	else {
444
		CIO_MSG_EVENT(0, "ccw_device_online returned %d, "
Cornelia Huck's avatar
Cornelia Huck committed
445
446
447
			      "device 0.%x.%04x\n",
			      ret, cdev->private->dev_id.ssid,
			      cdev->private->dev_id.devno);
448
449
		/* Give up online reference since onlining failed. */
		put_device(&cdev->dev);
Linus Torvalds's avatar
Linus Torvalds committed
450
451
		return ret;
	}
452
453
454
455
456
	spin_lock_irq(cdev->ccwlock);
	/* Check if online processing was successful */
	if ((cdev->private->state != DEV_STATE_ONLINE) &&
	    (cdev->private->state != DEV_STATE_W4SENSE)) {
		spin_unlock_irq(cdev->ccwlock);
457
458
		/* Give up online reference since onlining failed. */
		put_device(&cdev->dev);
Linus Torvalds's avatar
Linus Torvalds committed
459
		return -ENODEV;
460
	}
461
462
463
464
465
466
467
468
469
	spin_unlock_irq(cdev->ccwlock);
	if (cdev->drv->set_online)
		ret = cdev->drv->set_online(cdev);
	if (ret)
		goto rollback;
	cdev->online = 1;
	return 0;

rollback:
Linus Torvalds's avatar
Linus Torvalds committed
470
	spin_lock_irq(cdev->ccwlock);
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
	/* Wait until a final state or DISCONNECTED is reached */
	while (!dev_fsm_final_state(cdev) &&
	       cdev->private->state != DEV_STATE_DISCONNECTED) {
		spin_unlock_irq(cdev->ccwlock);
		wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
			   cdev->private->state == DEV_STATE_DISCONNECTED));
		spin_lock_irq(cdev->ccwlock);
	}
	ret2 = ccw_device_offline(cdev);
	if (ret2)
		goto error;
	spin_unlock_irq(cdev->ccwlock);
	wait_event(cdev->private->wait_q, (dev_fsm_final_state(cdev) ||
		   cdev->private->state == DEV_STATE_DISCONNECTED));
	/* Give up online reference since onlining failed. */
	put_device(&cdev->dev);
	return ret;

error:
	CIO_MSG_EVENT(0, "rollback ccw_device_offline returned %d, "
		      "device 0.%x.%04x\n",
		      ret2, cdev->private->dev_id.ssid,
		      cdev->private->dev_id.devno);
	cdev->private->state = DEV_STATE_OFFLINE;
Linus Torvalds's avatar
Linus Torvalds committed
495
	spin_unlock_irq(cdev->ccwlock);
496
497
	/* Give up online reference since onlining failed. */
	put_device(&cdev->dev);
498
	return ret;
Linus Torvalds's avatar
Linus Torvalds committed
499
500
}

501
static int online_store_handle_offline(struct ccw_device *cdev)
502
503
504
{
	if (cdev->private->state == DEV_STATE_DISCONNECTED)
		ccw_device_remove_disconnected(cdev);
505
506
507
	else if (cdev->online && cdev->drv && cdev->drv->set_offline)
		return ccw_device_set_offline(cdev);
	return 0;
508
509
510
511
512
513
514
}

static int online_store_recog_and_online(struct ccw_device *cdev)
{
	int ret;

	/* Do device recognition, if needed. */
515
	if (cdev->private->state == DEV_STATE_BOXED) {
516
517
		ret = ccw_device_recognition(cdev);
		if (ret) {
Cornelia Huck's avatar
Cornelia Huck committed
518
519
520
521
			CIO_MSG_EVENT(0, "Couldn't start recognition "
				      "for device 0.%x.%04x (ret=%d)\n",
				      cdev->private->dev_id.ssid,
				      cdev->private->dev_id.devno, ret);
522
523
524
525
			return ret;
		}
		wait_event(cdev->private->wait_q,
			   cdev->private->flags.recog_done);
526
527
528
		if (cdev->private->state != DEV_STATE_OFFLINE)
			/* recognition failed */
			return -EAGAIN;
529
530
531
532
533
	}
	if (cdev->drv && cdev->drv->set_online)
		ccw_device_set_online(cdev);
	return 0;
}
534

535
static int online_store_handle_online(struct ccw_device *cdev, int force)
536
537
538
539
{
	int ret;

	ret = online_store_recog_and_online(cdev);
540
	if (ret && !force)
541
		return ret;
542
543
	if (force && cdev->private->state == DEV_STATE_BOXED) {
		ret = ccw_device_stlck(cdev);
544
545
		if (ret)
			return ret;
546
547
		if (cdev->id.cu_type == 0)
			cdev->private->state = DEV_STATE_NOT_OPER;
548
549
550
		ret = online_store_recog_and_online(cdev);
		if (ret)
			return ret;
551
	}
552
	return 0;
553
554
555
556
}

static ssize_t online_store (struct device *dev, struct device_attribute *attr,
			     const char *buf, size_t count)
Linus Torvalds's avatar
Linus Torvalds committed
557
558
{
	struct ccw_device *cdev = to_ccwdev(dev);
559
560
	int force, ret;
	unsigned long i;
Linus Torvalds's avatar
Linus Torvalds committed
561

562
563
564
565
566
	if ((cdev->private->state != DEV_STATE_OFFLINE &&
	     cdev->private->state != DEV_STATE_ONLINE &&
	     cdev->private->state != DEV_STATE_BOXED &&
	     cdev->private->state != DEV_STATE_DISCONNECTED) ||
	    atomic_cmpxchg(&cdev->private->onoff, 0, 1) != 0)
Linus Torvalds's avatar
Linus Torvalds committed
567
568
569
570
571
572
573
574
575
		return -EAGAIN;

	if (cdev->drv && !try_module_get(cdev->drv->owner)) {
		atomic_set(&cdev->private->onoff, 0);
		return -EINVAL;
	}
	if (!strncmp(buf, "force\n", count)) {
		force = 1;
		i = 1;
576
		ret = 0;
Linus Torvalds's avatar
Linus Torvalds committed
577
578
	} else {
		force = 0;
579
		ret = strict_strtoul(buf, 16, &i);
Linus Torvalds's avatar
Linus Torvalds committed
580
	}
581
582
	if (ret)
		goto out;
583
584
	switch (i) {
	case 0:
585
		ret = online_store_handle_offline(cdev);
586
587
		break;
	case 1:
588
		ret = online_store_handle_online(cdev, force);
589
590
		break;
	default:
591
		ret = -EINVAL;
Linus Torvalds's avatar
Linus Torvalds committed
592
	}
593
out:
Linus Torvalds's avatar
Linus Torvalds committed
594
595
596
	if (cdev->drv)
		module_put(cdev->drv->owner);
	atomic_set(&cdev->private->onoff, 0);
597
	return (ret < 0) ? ret : count;
Linus Torvalds's avatar
Linus Torvalds committed
598
599
600
}

static ssize_t
601
available_show (struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds's avatar
Linus Torvalds committed
602
603
604
605
{
	struct ccw_device *cdev = to_ccwdev(dev);
	struct subchannel *sch;

606
607
	if (ccw_device_is_orphan(cdev))
		return sprintf(buf, "no device\n");
Linus Torvalds's avatar
Linus Torvalds committed
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
	switch (cdev->private->state) {
	case DEV_STATE_BOXED:
		return sprintf(buf, "boxed\n");
	case DEV_STATE_DISCONNECTED:
	case DEV_STATE_DISCONNECTED_SENSE_ID:
	case DEV_STATE_NOT_OPER:
		sch = to_subchannel(dev->parent);
		if (!sch->lpm)
			return sprintf(buf, "no path\n");
		else
			return sprintf(buf, "no device\n");
	default:
		/* All other states considered fine. */
		return sprintf(buf, "good\n");
	}
}

static DEVICE_ATTR(chpids, 0444, chpids_show, NULL);
static DEVICE_ATTR(pimpampom, 0444, pimpampom_show, NULL);
static DEVICE_ATTR(devtype, 0444, devtype_show, NULL);
static DEVICE_ATTR(cutype, 0444, cutype_show, NULL);
629
static DEVICE_ATTR(modalias, 0444, modalias_show, NULL);
Linus Torvalds's avatar
Linus Torvalds committed
630
631
632
static DEVICE_ATTR(online, 0644, online_show, online_store);
static DEVICE_ATTR(availability, 0444, available_show, NULL);

633
static struct attribute *io_subchannel_attrs[] = {
Linus Torvalds's avatar
Linus Torvalds committed
634
635
636
637
638
	&dev_attr_chpids.attr,
	&dev_attr_pimpampom.attr,
	NULL,
};

639
640
static struct attribute_group io_subchannel_attr_group = {
	.attrs = io_subchannel_attrs,
641
};
Linus Torvalds's avatar
Linus Torvalds committed
642
643
644
645

static struct attribute * ccwdev_attrs[] = {
	&dev_attr_devtype.attr,
	&dev_attr_cutype.attr,
646
	&dev_attr_modalias.attr,
Linus Torvalds's avatar
Linus Torvalds committed
647
648
649
650
651
652
653
654
655
656
	&dev_attr_online.attr,
	&dev_attr_cmb_enable.attr,
	&dev_attr_availability.attr,
	NULL,
};

static struct attribute_group ccwdev_attr_group = {
	.attrs = ccwdev_attrs,
};

657
static struct attribute_group *ccwdev_attr_groups[] = {
658
659
660
	&ccwdev_attr_group,
	NULL,
};
Linus Torvalds's avatar
Linus Torvalds committed
661
662
663

/* this is a simple abstraction for device_register that sets the
 * correct bus type and adds the bus specific files */
664
static int ccw_device_register(struct ccw_device *cdev)
Linus Torvalds's avatar
Linus Torvalds committed
665
666
667
668
669
670
671
672
673
674
675
676
677
{
	struct device *dev = &cdev->dev;
	int ret;

	dev->bus = &ccw_bus_type;

	if ((ret = device_add(dev)))
		return ret;

	set_bit(1, &cdev->private->registered);
	return ret;
}

678
struct match_data {
679
	struct ccw_dev_id dev_id;
680
681
682
683
684
685
	struct ccw_device * sibling;
};

static int
match_devno(struct device * dev, void * data)
{
686
	struct match_data * d = data;
687
688
689
690
	struct ccw_device * cdev;

	cdev = to_ccwdev(dev);
	if ((cdev->private->state == DEV_STATE_DISCONNECTED) &&
691
	    !ccw_device_is_orphan(cdev) &&
692
	    ccw_dev_id_is_equal(&cdev->private->dev_id, &d->dev_id) &&
693
	    (cdev != d->sibling))
694
695
696
697
		return 1;
	return 0;
}

698
699
static struct ccw_device * get_disc_ccwdev_by_dev_id(struct ccw_dev_id *dev_id,
						     struct ccw_device *sibling)
Linus Torvalds's avatar
Linus Torvalds committed
700
701
{
	struct device *dev;
702
	struct match_data data;
Linus Torvalds's avatar
Linus Torvalds committed
703

704
	data.dev_id = *dev_id;
705
	data.sibling = sibling;
706
	dev = bus_find_device(&ccw_bus_type, NULL, &data, match_devno);
Linus Torvalds's avatar
Linus Torvalds committed
707

708
	return dev ? to_ccwdev(dev) : NULL;
Linus Torvalds's avatar
Linus Torvalds committed
709
710
}

711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
static int match_orphan(struct device *dev, void *data)
{
	struct ccw_dev_id *dev_id;
	struct ccw_device *cdev;

	dev_id = data;
	cdev = to_ccwdev(dev);
	return ccw_dev_id_is_equal(&cdev->private->dev_id, dev_id);
}

static struct ccw_device *
get_orphaned_ccwdev_by_dev_id(struct channel_subsystem *css,
			      struct ccw_dev_id *dev_id)
{
	struct device *dev;

	dev = device_find_child(&css->pseudo_subchannel->dev, dev_id,
				match_orphan);

	return dev ? to_ccwdev(dev) : NULL;
}

733
void ccw_device_do_unbind_bind(struct work_struct *work)
Linus Torvalds's avatar
Linus Torvalds committed
734
{
735
	struct ccw_device_private *priv;
Linus Torvalds's avatar
Linus Torvalds committed
736
737
	struct ccw_device *cdev;
	struct subchannel *sch;
738
	int ret;
Linus Torvalds's avatar
Linus Torvalds committed
739

740
741
	priv = container_of(work, struct ccw_device_private, kick_work);
	cdev = priv->cdev;
Linus Torvalds's avatar
Linus Torvalds committed
742
	sch = to_subchannel(cdev->dev.parent);
743

744
745
746
747
748
	if (test_bit(1, &cdev->private->registered)) {
		device_release_driver(&cdev->dev);
		ret = device_attach(&cdev->dev);
		WARN_ON(ret == -ENODEV);
	}
Linus Torvalds's avatar
Linus Torvalds committed
749
750
751
752
753
754
755
756
}

static void
ccw_device_release(struct device *dev)
{
	struct ccw_device *cdev;

	cdev = to_ccwdev(dev);
757
758
	/* Release reference of parent subchannel. */
	put_device(cdev->dev.parent);
Linus Torvalds's avatar
Linus Torvalds committed
759
760
761
762
	kfree(cdev->private);
	kfree(cdev);
}

763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
static struct ccw_device * io_subchannel_allocate_dev(struct subchannel *sch)
{
	struct ccw_device *cdev;

	cdev  = kzalloc(sizeof(*cdev), GFP_KERNEL);
	if (cdev) {
		cdev->private = kzalloc(sizeof(struct ccw_device_private),
					GFP_KERNEL | GFP_DMA);
		if (cdev->private)
			return cdev;
	}
	kfree(cdev);
	return ERR_PTR(-ENOMEM);
}

static int io_subchannel_initialize_dev(struct subchannel *sch,
					struct ccw_device *cdev)
{
	cdev->private->cdev = cdev;
	atomic_set(&cdev->private->onoff, 0);
	cdev->dev.parent = &sch->dev;
	cdev->dev.release = ccw_device_release;
785
	INIT_WORK(&cdev->private->kick_work, NULL);
786
	cdev->dev.groups = ccwdev_attr_groups;
787
788
789
	/* Do first half of device_register. */
	device_initialize(&cdev->dev);
	if (!get_device(&sch->dev)) {
790
791
		/* Release reference from device_initialize(). */
		put_device(&cdev->dev);
792
793
794
795
796
797
798
799
800
801
802
803
804
		return -ENODEV;
	}
	return 0;
}

static struct ccw_device * io_subchannel_create_ccwdev(struct subchannel *sch)
{
	struct ccw_device *cdev;
	int ret;

	cdev = io_subchannel_allocate_dev(sch);
	if (!IS_ERR(cdev)) {
		ret = io_subchannel_initialize_dev(sch, cdev);
805
		if (ret)
806
807
808
809
810
			cdev = ERR_PTR(ret);
	}
	return cdev;
}

811
812
813
814
815
static int io_subchannel_recog(struct ccw_device *, struct subchannel *);

static void sch_attach_device(struct subchannel *sch,
			      struct ccw_device *cdev)
{
816
	css_update_ssd_info(sch);
817
	spin_lock_irq(sch->lock);
818
	sch_set_cdev(sch, cdev);
819
820
	cdev->private->schid = sch->schid;
	cdev->ccwlock = sch->lock;
Cornelia Huck's avatar
Cornelia Huck committed
821
	ccw_device_trigger_reprobe(cdev);
822
823
824
825
826
827
828
829
830
	spin_unlock_irq(sch->lock);
}

static void sch_attach_disconnected_device(struct subchannel *sch,
					   struct ccw_device *cdev)
{
	struct subchannel *other_sch;
	int ret;

831
832
833
834
835
	/* Get reference for new parent. */
	if (!get_device(&sch->dev))
		return;
	other_sch = to_subchannel(cdev->dev.parent);
	/* Note: device_move() changes cdev->dev.parent */
836
	ret = device_move(&cdev->dev, &sch->dev, DPM_ORDER_PARENT_BEFORE_DEV);
837
	if (ret) {
838
		CIO_MSG_EVENT(0, "Moving disconnected device 0.%x.%04x failed "
839
840
			      "(ret=%d)!\n", cdev->private->dev_id.ssid,
			      cdev->private->dev_id.devno, ret);
841
842
		/* Put reference for new parent. */
		put_device(&sch->dev);
843
844
		return;
	}
845
	sch_set_cdev(other_sch, NULL);
846
847
848
	/* No need to keep a subchannel without ccw device around. */
	css_sch_device_unregister(other_sch);
	sch_attach_device(sch, cdev);
849
850
	/* Put reference for old parent. */
	put_device(&other_sch->dev);
851
852
853
854
855
856
}

static void sch_attach_orphaned_device(struct subchannel *sch,
				       struct ccw_device *cdev)
{
	int ret;
857
	struct subchannel *pseudo_sch;
858

859
860
861
862
863
864
865
866
	/* Get reference for new parent. */
	if (!get_device(&sch->dev))
		return;
	pseudo_sch = to_subchannel(cdev->dev.parent);
	/*
	 * Try to move the ccw device to its new subchannel.
	 * Note: device_move() changes cdev->dev.parent
	 */
867
	ret = device_move(&cdev->dev, &sch->dev, DPM_ORDER_PARENT_BEFORE_DEV);
868
869
870
871
872
	if (ret) {
		CIO_MSG_EVENT(0, "Moving device 0.%x.%04x from orphanage "
			      "failed (ret=%d)!\n",
			      cdev->private->dev_id.ssid,
			      cdev->private->dev_id.devno, ret);
873
874
		/* Put reference for new parent. */
		put_device(&sch->dev);
875
876
877
		return;
	}
	sch_attach_device(sch, cdev);
878
879
	/* Put reference on pseudo subchannel. */
	put_device(&pseudo_sch->dev);
880
881
882
883
884
885
886
887
888
889
890
891
892
893
}

static void sch_create_and_recog_new_device(struct subchannel *sch)
{
	struct ccw_device *cdev;

	/* Need to allocate a new ccw device. */
	cdev = io_subchannel_create_ccwdev(sch);
	if (IS_ERR(cdev)) {
		/* OK, we did everything we could... */
		css_sch_device_unregister(sch);
		return;
	}
	spin_lock_irq(sch->lock);
894
	sch_set_cdev(sch, cdev);
895
896
897
898
	spin_unlock_irq(sch->lock);
	/* Start recognition for the new ccw device. */
	if (io_subchannel_recog(cdev, sch)) {
		spin_lock_irq(sch->lock);
899
		sch_set_cdev(sch, NULL);
900
901
		spin_unlock_irq(sch->lock);
		css_sch_device_unregister(sch);
902
903
904
905
		/* Put reference from io_subchannel_create_ccwdev(). */
		put_device(&sch->dev);
		/* Give up initial reference. */
		put_device(&cdev->dev);
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
	}
}


void ccw_device_move_to_orphanage(struct work_struct *work)
{
	struct ccw_device_private *priv;
	struct ccw_device *cdev;
	struct ccw_device *replacing_cdev;
	struct subchannel *sch;
	int ret;
	struct channel_subsystem *css;
	struct ccw_dev_id dev_id;

	priv = container_of(work, struct ccw_device_private, kick_work);
	cdev = priv->cdev;
	sch = to_subchannel(cdev->dev.parent);
	css = to_css(sch->dev.parent);
	dev_id.devno = sch->schib.pmcw.dev;
	dev_id.ssid = sch->schid.ssid;

927
928
	/* Increase refcount for pseudo subchannel. */
	get_device(&css->pseudo_subchannel->dev);
929
930
931
	/*
	 * Move the orphaned ccw device to the orphanage so the replacing
	 * ccw device can take its place on the subchannel.
932
	 * Note: device_move() changes cdev->dev.parent
933
	 */
934
935
	ret = device_move(&cdev->dev, &css->pseudo_subchannel->dev,
		DPM_ORDER_NONE);
936
937
938
939
	if (ret) {
		CIO_MSG_EVENT(0, "Moving device 0.%x.%04x to orphanage failed "
			      "(ret=%d)!\n", cdev->private->dev_id.ssid,
			      cdev->private->dev_id.devno, ret);
940
941
		/* Decrease refcount for pseudo subchannel again. */
		put_device(&css->pseudo_subchannel->dev);
942
943
944
945
946
947
948
949
950
951
952
		return;
	}
	cdev->ccwlock = css->pseudo_subchannel->lock;
	/*
	 * Search for the replacing ccw device
	 * - among the disconnected devices
	 * - in the orphanage
	 */
	replacing_cdev = get_disc_ccwdev_by_dev_id(&dev_id, cdev);
	if (replacing_cdev) {
		sch_attach_disconnected_device(sch, replacing_cdev);
953
		/* Release reference from get_disc_ccwdev_by_dev_id() */
954
		put_device(&replacing_cdev->dev);
955
956
		/* Release reference of subchannel from old cdev. */
		put_device(&sch->dev);
957
958
959
960
961
		return;
	}
	replacing_cdev = get_orphaned_ccwdev_by_dev_id(css, &dev_id);
	if (replacing_cdev) {
		sch_attach_orphaned_device(sch, replacing_cdev);
962
		/* Release reference from get_orphaned_ccwdev_by_dev_id() */
963
		put_device(&replacing_cdev->dev);
964
965
		/* Release reference of subchannel from old cdev. */
		put_device(&sch->dev);
966
967
968
		return;
	}
	sch_create_and_recog_new_device(sch);
969
970
	/* Release reference of subchannel from old cdev. */
	put_device(&sch->dev);
971
972
}

Linus Torvalds's avatar
Linus Torvalds committed
973
974
975
976
/*
 * Register recognized device.
 */
static void
977
io_subchannel_register(struct work_struct *work)
Linus Torvalds's avatar
Linus Torvalds committed
978
{
979
	struct ccw_device_private *priv;
Linus Torvalds's avatar
Linus Torvalds committed
980
981
982
983
984
	struct ccw_device *cdev;
	struct subchannel *sch;
	int ret;
	unsigned long flags;

985
986
	priv = container_of(work, struct ccw_device_private, kick_work);
	cdev = priv->cdev;
Linus Torvalds's avatar
Linus Torvalds committed
987
	sch = to_subchannel(cdev->dev.parent);
988
989
990
991
992
993
994
995
	/*
	 * Check if subchannel is still registered. It may have become
	 * unregistered if a machine check hit us after finishing
	 * device recognition but before the register work could be
	 * queued.
	 */
	if (!device_is_registered(&sch->dev))
		goto out_err;
996
	css_update_ssd_info(sch);
997
998
999
1000
1001
1002
	/*
	 * io_subchannel_register() will also be called after device
	 * recognition has been done for a boxed device (which will already
	 * be registered). We need to reprobe since we may now have sense id
	 * information.
	 */
1003
	if (device_is_registered(&cdev->dev)) {
1004
1005
1006
1007
		if (!cdev->drv) {
			ret = device_reprobe(&cdev->dev);
			if (ret)
				/* We can't do much here. */
1008
				CIO_MSG_EVENT(0, "device_reprobe() returned"
Cornelia Huck's avatar
Cornelia Huck committed
1009
1010
1011
					      " %d for 0.%x.%04x\n", ret,
					      cdev->private->dev_id.ssid,
					      cdev->private->dev_id.devno);
1012
		}
Linus Torvalds's avatar
Linus Torvalds committed
1013
1014
		goto out;
	}
1015
1016
1017
1018
	/*
	 * Now we know this subchannel will stay, we can throw
	 * our delayed uevent.
	 */
1019
	dev_set_uevent_suppress(&sch->dev, 0);
1020
	kobject_uevent(&sch->dev.kobj, KOBJ_ADD);
Linus Torvalds's avatar
Linus Torvalds committed
1021
1022
1023
	/* make it known to the system */
	ret = ccw_device_register(cdev);
	if (ret) {
Cornelia Huck's avatar
Cornelia Huck committed
1024
1025
1026
		CIO_MSG_EVENT(0, "Could not register ccw dev 0.%x.%04x: %d\n",
			      cdev->private->dev_id.ssid,
			      cdev->private->dev_id.devno, ret);
1027
		spin_lock_irqsave(sch->lock, flags);
1028
		sch_set_cdev(sch, NULL);
1029
		spin_unlock_irqrestore(sch->lock, flags);
1030
1031
		/* Release initial device reference. */
		put_device(&cdev->dev);
1032
		goto out_err;
Linus Torvalds's avatar
Linus Torvalds committed
1033
1034
1035
1036
	}
out:
	cdev->private->flags.recog_done = 1;
	wake_up(&cdev->private->wait_q);
1037
1038
1039
out_err:
	/* Release reference for workqueue processing. */
	put_device(&cdev->dev);
Linus Torvalds's avatar
Linus Torvalds committed
1040
1041
1042
1043
	if (atomic_dec_and_test(&ccw_device_init_count))
		wake_up(&ccw_device_init_wq);
}

1044
static void ccw_device_call_sch_unregister(struct work_struct *work)
Linus Torvalds's avatar
Linus Torvalds committed
1045
{
1046
1047
	struct ccw_device_private *priv;
	struct ccw_device *cdev;
Linus Torvalds's avatar
Linus Torvalds committed
1048
1049
	struct subchannel *sch;

1050
1051
	priv = container_of(work, struct ccw_device_private, kick_work);
	cdev = priv->cdev;
1052
1053
1054
	/* Get subchannel reference for local processing. */
	if (!get_device(cdev->dev.parent))
		return;
Linus Torvalds's avatar
Linus Torvalds committed
1055
	sch = to_subchannel(cdev->dev.parent);
1056
	css_sch_device_unregister(sch);
1057
	/* Release cdev reference for workqueue processing.*/
Linus Torvalds's avatar
Linus Torvalds committed
1058
	put_device(&cdev->dev);
1059
	/* Release subchannel reference for local processing. */
Linus Torvalds's avatar
Linus Torvalds committed
1060
1061
1062
	put_device(&sch->dev);
}

1063
1064
void ccw_device_schedule_sch_unregister(struct ccw_device *cdev)
{
1065
1066
1067
	/* Get cdev reference for workqueue processing. */
	if (!get_device(&cdev->dev))
		return;
1068
1069
1070
1071
1072
	PREPARE_WORK(&cdev->private->kick_work,
		     ccw_device_call_sch_unregister);
	queue_work(slow_path_wq, &cdev->private->kick_work);
}

Linus Torvalds's avatar
Linus Torvalds committed
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
/*
 * subchannel recognition done. Called from the state machine.
 */
void
io_subchannel_recog_done(struct ccw_device *cdev)
{
	if (css_init_done == 0) {
		cdev->private->flags.recog_done = 1;
		return;
	}
	switch (cdev->private->state) {
1084
1085
	case DEV_STATE_BOXED:
		/* Device did not respond in time. */
Linus Torvalds's avatar
Linus Torvalds committed
1086
1087
	case DEV_STATE_NOT_OPER:
		cdev->private->flags.recog_done = 1;
1088
		ccw_device_schedule_sch_unregister(cdev);
Linus Torvalds's avatar
Linus Torvalds committed
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
		if (atomic_dec_and_test(&ccw_device_init_count))
			wake_up(&ccw_device_init_wq);
		break;
	case DEV_STATE_OFFLINE:
		/* 
		 * We can't register the device in interrupt context so
		 * we schedule a work item.
		 */
		if (!get_device(&cdev->dev))
			break;
		PREPARE_WORK(&cdev->private->kick_work,
1100
			     io_subchannel_register);
Linus Torvalds's avatar
Linus Torvalds committed
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
		queue_work(slow_path_wq, &cdev->private->kick_work);
		break;
	}
}

static int
io_subchannel_recog(struct ccw_device *cdev, struct subchannel *sch)
{
	int rc;
	struct ccw_device_private *priv;

1112
	sch_set_cdev(sch, cdev);
1113
	cdev->ccwlock = sch->lock;
1114

Linus Torvalds's avatar
Linus Torvalds committed
1115
1116
	/* Init private data. */
	priv = cdev->private;
1117
1118
1119
	priv->dev_id.devno = sch->schib.pmcw.dev;
	priv->dev_id.ssid = sch->schid.ssid;
	priv->schid = sch->schid;
Linus Torvalds's avatar
Linus Torvalds committed
1120
1121
1122
1123
1124
1125
	priv->state = DEV_STATE_NOT_OPER;
	INIT_LIST_HEAD(&priv->cmb_list);
	init_waitqueue_head(&priv->wait_q);
	init_timer(&priv->timer);

	/* Set an initial name for the device. */
1126
1127
1128
1129
1130
	if (cio_is_console(sch->schid))
		cdev->dev.init_name = cio_get_console_cdev_name(sch);
	else
		dev_set_name(&cdev->dev, "0.%x.%04x",
			     sch->schid.ssid, sch->schib.pmcw.dev);
Linus Torvalds's avatar
Linus Torvalds committed
1131
1132
1133
1134
1135

	/* Increase counter of devices currently in recognition. */
	atomic_inc(&ccw_device_init_count);

	/* Start async. device sensing. */
1136
	spin_lock_irq(sch->lock);
Linus Torvalds's avatar
Linus Torvalds committed
1137
	rc = ccw_device_recognition(cdev);
1138
	spin_unlock_irq(sch->lock);
Linus Torvalds's avatar
Linus Torvalds committed
1139
1140
1141
1142
1143
1144
1145
	if (rc) {
		if (atomic_dec_and_test(&ccw_device_init_count))
			wake_up(&ccw_device_init_wq);
	}
	return rc;
}

1146
1147
1148
1149
1150
1151
1152
1153
1154
1155
1156
static void ccw_device_move_to_sch(struct work_struct *work)
{
	struct ccw_device_private *priv;
	int rc;
	struct subchannel *sch;
	struct ccw_device *cdev;
	struct subchannel *former_parent;

	priv = container_of(work, struct ccw_device_private, kick_work);
	sch = priv->sch;
	cdev = priv->cdev;
1157
1158
1159
1160
	former_parent = to_subchannel(cdev->dev.parent);
	/* Get reference for new parent. */
	if (!get_device(&sch->dev))
		return;
1161
	mutex_lock(&sch->reg_mutex);
1162
1163
1164
1165
	/*
	 * Try to move the ccw device to its new subchannel.
	 * Note: device_move() changes cdev->dev.parent
	 */
1166
	rc = device_move(&cdev->dev, &sch->dev, DPM_ORDER_PARENT_BEFORE_DEV);
1167
1168
	mutex_unlock(&sch->reg_mutex);
	if (rc) {
1169
		CIO_MSG_EVENT(0, "Moving device 0.%x.%04x to subchannel "
1170
1171
1172
1173
1174
			      "0.%x.%04x failed (ret=%d)!\n",
			      cdev->private->dev_id.ssid,
			      cdev->private->dev_id.devno, sch->schid.ssid,
			      sch->schid.sch_no, rc);
		css_sch_device_unregister(sch);
1175
1176
		/* Put reference for new parent again. */
		put_device(&sch->dev);
1177
1178
		goto out;
	}
1179
	if (!sch_is_pseudo_sch(former_parent)) {
1180
		spin_lock_irq(former_parent->lock);
1181
		sch_set_cdev(former_parent, NULL);
1182
1183
1184
		spin_unlock_irq(former_parent->lock);
		css_sch_device_unregister(former_parent);
		/* Reset intparm to zeroes. */
1185
1186
		former_parent->config.intparm = 0;
		cio_commit_config(former_parent);
1187
1188
1189
	}
	sch_attach_device(sch, cdev);
out:
1190
1191
	/* Put reference for old parent. */
	put_device(&former_parent->dev);
1192
1193
1194
	put_device(&cdev->dev);
}

1195
1196
1197
1198
static void io_subchannel_irq(struct subchannel *sch)
{
	struct ccw_device *cdev;

1199
	cdev = sch_get_cdev(sch);
1200

1201
1202
	CIO_TRACE_EVENT(6, "IRQ");
	CIO_TRACE_EVENT(6, dev_name(&sch->dev));
1203
1204
1205
1206
	if (cdev)
		dev_fsm_event(cdev, DEV_EVENT_INTERRUPT);
}

1207
1208
1209
1210
void io_subchannel_init_config(struct subchannel *sch)
{
	memset(&sch->config, 0, sizeof(sch->config));
	sch->config.csense = 1;
1211
1212
	/* Use subchannel mp mode when there is more than 1 installed CHPID. */
	if ((sch->schib.pmcw.pim & (sch->schib.pmcw.pim - 1)) != 0)
1213
1214
1215
		sch->config.mp = 1;
}

1216
1217
1218
1219
1220
1221
1222
static void io_subchannel_init_fields(struct subchannel *sch)
{
	if (cio_is_console(sch->schid))
		sch->opm = 0xff;
	else
		sch->opm = chp_get_sch_opm(sch);
	sch->lpm = sch->schib.pmcw.pam & sch->opm;
1223
	sch->isc = cio_is_console(sch->schid) ? CONSOLE_ISC : IO_SCH_ISC;
1224
1225
1226
1227
1228
1229

	CIO_MSG_EVENT(6, "Detected device %04x on subchannel 0.%x.%04X"