?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
um: switch to use of drivers/Kconfig
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / s390 / block / dasd.c
bloba1d3ddba99ccad4b90d4a9a06af1fd371b2d0033
1 /*
2 * File...........: linux/drivers/s390/block/dasd.c
3 * Author(s)......: Holger Smolinski <Holger.Smolinski@de.ibm.com>
4 * Horst Hummel <Horst.Hummel@de.ibm.com>
5 * Carsten Otte <Cotte@de.ibm.com>
6 * Martin Schwidefsky <schwidefsky@de.ibm.com>
7 * Bugreports.to..: <Linux390@de.ibm.com>
8 * Copyright IBM Corp. 1999, 2009
9 */
10
11 #define KMSG_COMPONENT "dasd"
12 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
13
14 #include <linux/kernel_stat.h>
15 #include <linux/kmod.h>
16 #include <linux/init.h>
17 #include <linux/interrupt.h>
18 #include <linux/ctype.h>
19 #include <linux/major.h>
20 #include <linux/slab.h>
21 #include <linux/buffer_head.h>
22 #include <linux/hdreg.h>
23 #include <linux/async.h>
24 #include <linux/mutex.h>
25 #include <linux/debugfs.h>
26 #include <linux/seq_file.h>
27 #include <linux/vmalloc.h>
28
29 #include <asm/ccwdev.h>
30 #include <asm/ebcdic.h>
31 #include <asm/idals.h>
32 #include <asm/itcw.h>
33 #include <asm/diag.h>
34
35 /* This is ugly... */
36 #define PRINTK_HEADER "dasd:"
37
38 #include "dasd_int.h"
39 /*
40 * SECTION: Constant definitions to be used within this file
41 */
42 #define DASD_CHANQ_MAX_SIZE 4
43
44 #define DASD_SLEEPON_START_TAG (void *) 1
45 #define DASD_SLEEPON_END_TAG (void *) 2
46
47 /*
48 * SECTION: exported variables of dasd.c
49 */
50 debug_info_t *dasd_debug_area;
51 static struct dentry *dasd_debugfs_root_entry;
52 struct dasd_discipline *dasd_diag_discipline_pointer;
53 void dasd_int_handler(struct ccw_device *, unsigned long, struct irb *);
54
55 MODULE_AUTHOR("Holger Smolinski <Holger.Smolinski@de.ibm.com>");
56 MODULE_DESCRIPTION("Linux on S/390 DASD device driver,"
57 " Copyright 2000 IBM Corporation");
58 MODULE_SUPPORTED_DEVICE("dasd");
59 MODULE_LICENSE("GPL");
60
61 /*
62 * SECTION: prototypes for static functions of dasd.c
63 */
64 static int dasd_alloc_queue(struct dasd_block *);
65 static void dasd_setup_queue(struct dasd_block *);
66 static void dasd_free_queue(struct dasd_block *);
67 static void dasd_flush_request_queue(struct dasd_block *);
68 static int dasd_flush_block_queue(struct dasd_block *);
69 static void dasd_device_tasklet(struct dasd_device *);
70 static void dasd_block_tasklet(struct dasd_block *);
71 static void do_kick_device(struct work_struct *);
72 static void do_restore_device(struct work_struct *);
73 static void do_reload_device(struct work_struct *);
74 static void dasd_return_cqr_cb(struct dasd_ccw_req *, void *);
75 static void dasd_device_timeout(unsigned long);
76 static void dasd_block_timeout(unsigned long);
77 static void __dasd_process_erp(struct dasd_device *, struct dasd_ccw_req *);
78 static void dasd_profile_init(struct dasd_profile *, struct dentry *);
79 static void dasd_profile_exit(struct dasd_profile *);
80
81 /*
82 * SECTION: Operations on the device structure.
83 */
84 static wait_queue_head_t dasd_init_waitq;
85 static wait_queue_head_t dasd_flush_wq;
86 static wait_queue_head_t generic_waitq;
87
88 /*
89 * Allocate memory for a new device structure.
90 */
91 struct dasd_device *dasd_alloc_device(void)
92 {
93 struct dasd_device *device;
94
95 device = kzalloc(sizeof(struct dasd_device), GFP_ATOMIC);
96 if (!device)
97 return ERR_PTR(-ENOMEM);
98
99 /* Get two pages for normal block device operations. */
100 device->ccw_mem = (void *) __get_free_pages(GFP_ATOMIC | GFP_DMA, 1);
101 if (!device->ccw_mem) {
102 kfree(device);
103 return ERR_PTR(-ENOMEM);
104 }
105 /* Get one page for error recovery. */
106 device->erp_mem = (void *) get_zeroed_page(GFP_ATOMIC | GFP_DMA);
107 if (!device->erp_mem) {
108 free_pages((unsigned long) device->ccw_mem, 1);
109 kfree(device);
110 return ERR_PTR(-ENOMEM);
111 }
112
113 dasd_init_chunklist(&device->ccw_chunks, device->ccw_mem, PAGE_SIZE*2);
114 dasd_init_chunklist(&device->erp_chunks, device->erp_mem, PAGE_SIZE);
115 spin_lock_init(&device->mem_lock);
116 atomic_set(&device->tasklet_scheduled, 0);
117 tasklet_init(&device->tasklet,
118 (void (*)(unsigned long)) dasd_device_tasklet,
119 (unsigned long) device);
120 INIT_LIST_HEAD(&device->ccw_queue);
121 init_timer(&device->timer);
122 device->timer.function = dasd_device_timeout;
123 device->timer.data = (unsigned long) device;
124 INIT_WORK(&device->kick_work, do_kick_device);
125 INIT_WORK(&device->restore_device, do_restore_device);
126 INIT_WORK(&device->reload_device, do_reload_device);
127 device->state = DASD_STATE_NEW;
128 device->target = DASD_STATE_NEW;
129 mutex_init(&device->state_mutex);
130 spin_lock_init(&device->profile.lock);
131 return device;
132 }
133
134 /*
135 * Free memory of a device structure.
136 */
137 void dasd_free_device(struct dasd_device *device)
138 {
139 kfree(device->private);
140 free_page((unsigned long) device->erp_mem);
141 free_pages((unsigned long) device->ccw_mem, 1);
142 kfree(device);
143 }
144
145 /*
146 * Allocate memory for a new device structure.
147 */
148 struct dasd_block *dasd_alloc_block(void)
149 {
150 struct dasd_block *block;
151
152 block = kzalloc(sizeof(*block), GFP_ATOMIC);
153 if (!block)
154 return ERR_PTR(-ENOMEM);
155 /* open_count = 0 means device online but not in use */
156 atomic_set(&block->open_count, -1);
157
158 spin_lock_init(&block->request_queue_lock);
159 atomic_set(&block->tasklet_scheduled, 0);
160 tasklet_init(&block->tasklet,
161 (void (*)(unsigned long)) dasd_block_tasklet,
162 (unsigned long) block);
163 INIT_LIST_HEAD(&block->ccw_queue);
164 spin_lock_init(&block->queue_lock);
165 init_timer(&block->timer);
166 block->timer.function = dasd_block_timeout;
167 block->timer.data = (unsigned long) block;
168 spin_lock_init(&block->profile.lock);
169
170 return block;
171 }
172
173 /*
174 * Free memory of a device structure.
175 */
176 void dasd_free_block(struct dasd_block *block)
177 {
178 kfree(block);
179 }
180
181 /*
182 * Make a new device known to the system.
183 */
184 static int dasd_state_new_to_known(struct dasd_device *device)
185 {
186 int rc;
187
188 /*
189 * As long as the device is not in state DASD_STATE_NEW we want to
190 * keep the reference count > 0.
191 */
192 dasd_get_device(device);
193
194 if (device->block) {
195 rc = dasd_alloc_queue(device->block);
196 if (rc) {
197 dasd_put_device(device);
198 return rc;
199 }
200 }
201 device->state = DASD_STATE_KNOWN;
202 return 0;
203 }
204
205 /*
206 * Let the system forget about a device.
207 */
208 static int dasd_state_known_to_new(struct dasd_device *device)
209 {
210 /* Disable extended error reporting for this device. */
211 dasd_eer_disable(device);
212 /* Forget the discipline information. */
213 if (device->discipline) {
214 if (device->discipline->uncheck_device)
215 device->discipline->uncheck_device(device);
216 module_put(device->discipline->owner);
217 }
218 device->discipline = NULL;
219 if (device->base_discipline)
220 module_put(device->base_discipline->owner);
221 device->base_discipline = NULL;
222 device->state = DASD_STATE_NEW;
223
224 if (device->block)
225 dasd_free_queue(device->block);
226
227 /* Give up reference we took in dasd_state_new_to_known. */
228 dasd_put_device(device);
229 return 0;
230 }
231
232 static struct dentry *dasd_debugfs_setup(const char *name,
233 struct dentry *base_dentry)
234 {
235 struct dentry *pde;
236
237 if (!base_dentry)
238 return NULL;
239 pde = debugfs_create_dir(name, base_dentry);
240 if (!pde || IS_ERR(pde))
241 return NULL;
242 return pde;
243 }
244
245 /*
246 * Request the irq line for the device.
247 */
248 static int dasd_state_known_to_basic(struct dasd_device *device)
249 {
250 struct dasd_block *block = device->block;
251 int rc;
252
253 /* Allocate and register gendisk structure. */
254 if (block) {
255 rc = dasd_gendisk_alloc(block);
256 if (rc)
257 return rc;
258 block->debugfs_dentry =
259 dasd_debugfs_setup(block->gdp->disk_name,
260 dasd_debugfs_root_entry);
261 dasd_profile_init(&block->profile, block->debugfs_dentry);
262 if (dasd_global_profile_level == DASD_PROFILE_ON)
263 dasd_profile_on(&device->block->profile);
264 }
265 device->debugfs_dentry =
266 dasd_debugfs_setup(dev_name(&device->cdev->dev),
267 dasd_debugfs_root_entry);
268 dasd_profile_init(&device->profile, device->debugfs_dentry);
269
270 /* register 'device' debug area, used for all DBF_DEV_XXX calls */
271 device->debug_area = debug_register(dev_name(&device->cdev->dev), 4, 1,
272 8 * sizeof(long));
273 debug_register_view(device->debug_area, &debug_sprintf_view);
274 debug_set_level(device->debug_area, DBF_WARNING);
275 DBF_DEV_EVENT(DBF_EMERG, device, "%s", "debug area created");
276
277 device->state = DASD_STATE_BASIC;
278 return 0;
279 }
280
281 /*
282 * Release the irq line for the device. Terminate any running i/o.
283 */
284 static int dasd_state_basic_to_known(struct dasd_device *device)
285 {
286 int rc;
287 if (device->block) {
288 dasd_profile_exit(&device->block->profile);
289 if (device->block->debugfs_dentry)
290 debugfs_remove(device->block->debugfs_dentry);
291 dasd_gendisk_free(device->block);
292 dasd_block_clear_timer(device->block);
293 }
294 rc = dasd_flush_device_queue(device);
295 if (rc)
296 return rc;
297 dasd_device_clear_timer(device);
298 dasd_profile_exit(&device->profile);
299 if (device->debugfs_dentry)
300 debugfs_remove(device->debugfs_dentry);
301
302 DBF_DEV_EVENT(DBF_EMERG, device, "%p debug area deleted", device);
303 if (device->debug_area != NULL) {
304 debug_unregister(device->debug_area);
305 device->debug_area = NULL;
306 }
307 device->state = DASD_STATE_KNOWN;
308 return 0;
309 }
310
311 /*
312 * Do the initial analysis. The do_analysis function may return
313 * -EAGAIN in which case the device keeps the state DASD_STATE_BASIC
314 * until the discipline decides to continue the startup sequence
315 * by calling the function dasd_change_state. The eckd disciplines
316 * uses this to start a ccw that detects the format. The completion
317 * interrupt for this detection ccw uses the kernel event daemon to
318 * trigger the call to dasd_change_state. All this is done in the
319 * discipline code, see dasd_eckd.c.
320 * After the analysis ccw is done (do_analysis returned 0) the block
321 * device is setup.
322 * In case the analysis returns an error, the device setup is stopped
323 * (a fake disk was already added to allow formatting).
324 */
325 static int dasd_state_basic_to_ready(struct dasd_device *device)
326 {
327 int rc;
328 struct dasd_block *block;
329
330 rc = 0;
331 block = device->block;
332 /* make disk known with correct capacity */
333 if (block) {
334 if (block->base->discipline->do_analysis != NULL)
335 rc = block->base->discipline->do_analysis(block);
336 if (rc) {
337 if (rc != -EAGAIN)
338 device->state = DASD_STATE_UNFMT;
339 return rc;
340 }
341 dasd_setup_queue(block);
342 set_capacity(block->gdp,
343 block->blocks << block->s2b_shift);
344 device->state = DASD_STATE_READY;
345 rc = dasd_scan_partitions(block);
346 if (rc)
347 device->state = DASD_STATE_BASIC;
348 } else {
349 device->state = DASD_STATE_READY;
350 }
351 return rc;
352 }
353
354 /*
355 * Remove device from block device layer. Destroy dirty buffers.
356 * Forget format information. Check if the target level is basic
357 * and if it is create fake disk for formatting.
358 */
359 static int dasd_state_ready_to_basic(struct dasd_device *device)
360 {
361 int rc;
362
363 device->state = DASD_STATE_BASIC;
364 if (device->block) {
365 struct dasd_block *block = device->block;
366 rc = dasd_flush_block_queue(block);
367 if (rc) {
368 device->state = DASD_STATE_READY;
369 return rc;
370 }
371 dasd_flush_request_queue(block);
372 dasd_destroy_partitions(block);
373 block->blocks = 0;
374 block->bp_block = 0;
375 block->s2b_shift = 0;
376 }
377 return 0;
378 }
379
380 /*
381 * Back to basic.
382 */
383 static int dasd_state_unfmt_to_basic(struct dasd_device *device)
384 {
385 device->state = DASD_STATE_BASIC;
386 return 0;
387 }
388
389 /*
390 * Make the device online and schedule the bottom half to start
391 * the requeueing of requests from the linux request queue to the
392 * ccw queue.
393 */
394 static int
395 dasd_state_ready_to_online(struct dasd_device * device)
396 {
397 int rc;
398 struct gendisk *disk;
399 struct disk_part_iter piter;
400 struct hd_struct *part;
401
402 if (device->discipline->ready_to_online) {
403 rc = device->discipline->ready_to_online(device);
404 if (rc)
405 return rc;
406 }
407 device->state = DASD_STATE_ONLINE;
408 if (device->block) {
409 dasd_schedule_block_bh(device->block);
410 if ((device->features & DASD_FEATURE_USERAW)) {
411 disk = device->block->gdp;
412 kobject_uevent(&disk_to_dev(disk)->kobj, KOBJ_CHANGE);
413 return 0;
414 }
415 disk = device->block->bdev->bd_disk;
416 disk_part_iter_init(&piter, disk, DISK_PITER_INCL_PART0);
417 while ((part = disk_part_iter_next(&piter)))
418 kobject_uevent(&part_to_dev(part)->kobj, KOBJ_CHANGE);
419 disk_part_iter_exit(&piter);
420 }
421 return 0;
422 }
423
424 /*
425 * Stop the requeueing of requests again.
426 */
427 static int dasd_state_online_to_ready(struct dasd_device *device)
428 {
429 int rc;
430 struct gendisk *disk;
431 struct disk_part_iter piter;
432 struct hd_struct *part;
433
434 if (device->discipline->online_to_ready) {
435 rc = device->discipline->online_to_ready(device);
436 if (rc)
437 return rc;
438 }
439 device->state = DASD_STATE_READY;
440 if (device->block && !(device->features & DASD_FEATURE_USERAW)) {
441 disk = device->block->bdev->bd_disk;
442 disk_part_iter_init(&piter, disk, DISK_PITER_INCL_PART0);
443 while ((part = disk_part_iter_next(&piter)))
444 kobject_uevent(&part_to_dev(part)->kobj, KOBJ_CHANGE);
445 disk_part_iter_exit(&piter);
446 }
447 return 0;
448 }
449
450 /*
451 * Device startup state changes.
452 */
453 static int dasd_increase_state(struct dasd_device *device)
454 {
455 int rc;
456
457 rc = 0;
458 if (device->state == DASD_STATE_NEW &&
459 device->target >= DASD_STATE_KNOWN)
460 rc = dasd_state_new_to_known(device);
461
462 if (!rc &&
463 device->state == DASD_STATE_KNOWN &&
464 device->target >= DASD_STATE_BASIC)
465 rc = dasd_state_known_to_basic(device);
466
467 if (!rc &&
468 device->state == DASD_STATE_BASIC &&
469 device->target >= DASD_STATE_READY)
470 rc = dasd_state_basic_to_ready(device);
471
472 if (!rc &&
473 device->state == DASD_STATE_UNFMT &&
474 device->target > DASD_STATE_UNFMT)
475 rc = -EPERM;
476
477 if (!rc &&
478 device->state == DASD_STATE_READY &&
479 device->target >= DASD_STATE_ONLINE)
480 rc = dasd_state_ready_to_online(device);
481
482 return rc;
483 }
484
485 /*
486 * Device shutdown state changes.
487 */
488 static int dasd_decrease_state(struct dasd_device *device)
489 {
490 int rc;
491
492 rc = 0;
493 if (device->state == DASD_STATE_ONLINE &&
494 device->target <= DASD_STATE_READY)
495 rc = dasd_state_online_to_ready(device);
496
497 if (!rc &&
498 device->state == DASD_STATE_READY &&
499 device->target <= DASD_STATE_BASIC)
500 rc = dasd_state_ready_to_basic(device);
501
502 if (!rc &&
503 device->state == DASD_STATE_UNFMT &&
504 device->target <= DASD_STATE_BASIC)
505 rc = dasd_state_unfmt_to_basic(device);
506
507 if (!rc &&
508 device->state == DASD_STATE_BASIC &&
509 device->target <= DASD_STATE_KNOWN)
510 rc = dasd_state_basic_to_known(device);
511
512 if (!rc &&
513 device->state == DASD_STATE_KNOWN &&
514 device->target <= DASD_STATE_NEW)
515 rc = dasd_state_known_to_new(device);
516
517 return rc;
518 }
519
520 /*
521 * This is the main startup/shutdown routine.
522 */
523 static void dasd_change_state(struct dasd_device *device)
524 {
525 int rc;
526
527 if (device->state == device->target)
528 /* Already where we want to go today... */
529 return;
530 if (device->state < device->target)
531 rc = dasd_increase_state(device);
532 else
533 rc = dasd_decrease_state(device);
534 if (rc == -EAGAIN)
535 return;
536 if (rc)
537 device->target = device->state;
538
539 if (device->state == device->target)
540 wake_up(&dasd_init_waitq);
541
542 /* let user-space know that the device status changed */
543 kobject_uevent(&device->cdev->dev.kobj, KOBJ_CHANGE);
544 }
545
546 /*
547 * Kick starter for devices that did not complete the startup/shutdown
548 * procedure or were sleeping because of a pending state.
549 * dasd_kick_device will schedule a call do do_kick_device to the kernel
550 * event daemon.
551 */
552 static void do_kick_device(struct work_struct *work)
553 {
554 struct dasd_device *device = container_of(work, struct dasd_device, kick_work);
555 mutex_lock(&device->state_mutex);
556 dasd_change_state(device);
557 mutex_unlock(&device->state_mutex);
558 dasd_schedule_device_bh(device);
559 dasd_put_device(device);
560 }
561
562 void dasd_kick_device(struct dasd_device *device)
563 {
564 dasd_get_device(device);
565 /* queue call to dasd_kick_device to the kernel event daemon. */
566 schedule_work(&device->kick_work);
567 }
568
569 /*
570 * dasd_reload_device will schedule a call do do_reload_device to the kernel
571 * event daemon.
572 */
573 static void do_reload_device(struct work_struct *work)
574 {
575 struct dasd_device *device = container_of(work, struct dasd_device,
576 reload_device);
577 device->discipline->reload(device);
578 dasd_put_device(device);
579 }
580
581 void dasd_reload_device(struct dasd_device *device)
582 {
583 dasd_get_device(device);
584 /* queue call to dasd_reload_device to the kernel event daemon. */
585 schedule_work(&device->reload_device);
586 }
587 EXPORT_SYMBOL(dasd_reload_device);
588
589 /*
590 * dasd_restore_device will schedule a call do do_restore_device to the kernel
591 * event daemon.
592 */
593 static void do_restore_device(struct work_struct *work)
594 {
595 struct dasd_device *device = container_of(work, struct dasd_device,
596 restore_device);
597 device->cdev->drv->restore(device->cdev);
598 dasd_put_device(device);
599 }
600
601 void dasd_restore_device(struct dasd_device *device)
602 {
603 dasd_get_device(device);
604 /* queue call to dasd_restore_device to the kernel event daemon. */
605 schedule_work(&device->restore_device);
606 }
607
608 /*
609 * Set the target state for a device and starts the state change.
610 */
611 void dasd_set_target_state(struct dasd_device *device, int target)
612 {
613 dasd_get_device(device);
614 mutex_lock(&device->state_mutex);
615 /* If we are in probeonly mode stop at DASD_STATE_READY. */
616 if (dasd_probeonly && target > DASD_STATE_READY)
617 target = DASD_STATE_READY;
618 if (device->target != target) {
619 if (device->state == target)
620 wake_up(&dasd_init_waitq);
621 device->target = target;
622 }
623 if (device->state != device->target)
624 dasd_change_state(device);
625 mutex_unlock(&device->state_mutex);
626 dasd_put_device(device);
627 }
628
629 /*
630 * Enable devices with device numbers in [from..to].
631 */
632 static inline int _wait_for_device(struct dasd_device *device)
633 {
634 return (device->state == device->target);
635 }
636
637 void dasd_enable_device(struct dasd_device *device)
638 {
639 dasd_set_target_state(device, DASD_STATE_ONLINE);
640 if (device->state <= DASD_STATE_KNOWN)
641 /* No discipline for device found. */
642 dasd_set_target_state(device, DASD_STATE_NEW);
643 /* Now wait for the devices to come up. */
644 wait_event(dasd_init_waitq, _wait_for_device(device));
645 }
646
647 /*
648 * SECTION: device operation (interrupt handler, start i/o, term i/o ...)
649 */
650
651 unsigned int dasd_global_profile_level = DASD_PROFILE_OFF;
652
653 #ifdef CONFIG_DASD_PROFILE
654 struct dasd_profile_info dasd_global_profile_data;
655 static struct dentry *dasd_global_profile_dentry;
656 static struct dentry *dasd_debugfs_global_entry;
657
658 /*
659 * Add profiling information for cqr before execution.
660 */
661 static void dasd_profile_start(struct dasd_block *block,
662 struct dasd_ccw_req *cqr,
663 struct request *req)
664 {
665 struct list_head *l;
666 unsigned int counter;
667 struct dasd_device *device;
668
669 /* count the length of the chanq for statistics */
670 counter = 0;
671 if (dasd_global_profile_level || block->profile.data)
672 list_for_each(l, &block->ccw_queue)
673 if (++counter >= 31)
674 break;
675
676 if (dasd_global_profile_level) {
677 dasd_global_profile_data.dasd_io_nr_req[counter]++;
678 if (rq_data_dir(req) == READ)
679 dasd_global_profile_data.dasd_read_nr_req[counter]++;
680 }
681
682 spin_lock(&block->profile.lock);
683 if (block->profile.data)
684 block->profile.data->dasd_io_nr_req[counter]++;
685 if (rq_data_dir(req) == READ)
686 block->profile.data->dasd_read_nr_req[counter]++;
687 spin_unlock(&block->profile.lock);
688
689 /*
690 * We count the request for the start device, even though it may run on
691 * some other device due to error recovery. This way we make sure that
692 * we count each request only once.
693 */
694 device = cqr->startdev;
695 if (device->profile.data) {
696 counter = 1; /* request is not yet queued on the start device */
697 list_for_each(l, &device->ccw_queue)
698 if (++counter >= 31)
699 break;
700 }
701 spin_lock(&device->profile.lock);
702 if (device->profile.data) {
703 device->profile.data->dasd_io_nr_req[counter]++;
704 if (rq_data_dir(req) == READ)
705 device->profile.data->dasd_read_nr_req[counter]++;
706 }
707 spin_unlock(&device->profile.lock);
708 }
709
710 /*
711 * Add profiling information for cqr after execution.
712 */
713
714 #define dasd_profile_counter(value, index) \
715 { \
716 for (index = 0; index < 31 && value >> (2+index); index++) \
717 ; \
718 }
719
720 static void dasd_profile_end_add_data(struct dasd_profile_info *data,
721 int is_alias,
722 int is_tpm,
723 int is_read,
724 long sectors,
725 int sectors_ind,
726 int tottime_ind,
727 int tottimeps_ind,
728 int strtime_ind,
729 int irqtime_ind,
730 int irqtimeps_ind,
731 int endtime_ind)
732 {
733 /* in case of an overflow, reset the whole profile */
734 if (data->dasd_io_reqs == UINT_MAX) {
735 memset(data, 0, sizeof(*data));
736 getnstimeofday(&data->starttod);
737 }
738 data->dasd_io_reqs++;
739 data->dasd_io_sects += sectors;
740 if (is_alias)
741 data->dasd_io_alias++;
742 if (is_tpm)
743 data->dasd_io_tpm++;
744
745 data->dasd_io_secs[sectors_ind]++;
746 data->dasd_io_times[tottime_ind]++;
747 data->dasd_io_timps[tottimeps_ind]++;
748 data->dasd_io_time1[strtime_ind]++;
749 data->dasd_io_time2[irqtime_ind]++;
750 data->dasd_io_time2ps[irqtimeps_ind]++;
751 data->dasd_io_time3[endtime_ind]++;
752
753 if (is_read) {
754 data->dasd_read_reqs++;
755 data->dasd_read_sects += sectors;
756 if (is_alias)
757 data->dasd_read_alias++;
758 if (is_tpm)
759 data->dasd_read_tpm++;
760 data->dasd_read_secs[sectors_ind]++;
761 data->dasd_read_times[tottime_ind]++;
762 data->dasd_read_time1[strtime_ind]++;
763 data->dasd_read_time2[irqtime_ind]++;
764 data->dasd_read_time3[endtime_ind]++;
765 }
766 }
767
768 static void dasd_profile_end(struct dasd_block *block,
769 struct dasd_ccw_req *cqr,
770 struct request *req)
771 {
772 long strtime, irqtime, endtime, tottime; /* in microseconds */
773 long tottimeps, sectors;
774 struct dasd_device *device;
775 int sectors_ind, tottime_ind, tottimeps_ind, strtime_ind;
776 int irqtime_ind, irqtimeps_ind, endtime_ind;
777
778 device = cqr->startdev;
779 if (!(dasd_global_profile_level ||
780 block->profile.data ||
781 device->profile.data))
782 return;
783
784 sectors = blk_rq_sectors(req);
785 if (!cqr->buildclk || !cqr->startclk ||
786 !cqr->stopclk || !cqr->endclk ||
787 !sectors)
788 return;
789
790 strtime = ((cqr->startclk - cqr->buildclk) >> 12);
791 irqtime = ((cqr->stopclk - cqr->startclk) >> 12);
792 endtime = ((cqr->endclk - cqr->stopclk) >> 12);
793 tottime = ((cqr->endclk - cqr->buildclk) >> 12);
794 tottimeps = tottime / sectors;
795
796 dasd_profile_counter(sectors, sectors_ind);
797 dasd_profile_counter(tottime, tottime_ind);
798 dasd_profile_counter(tottimeps, tottimeps_ind);
799 dasd_profile_counter(strtime, strtime_ind);
800 dasd_profile_counter(irqtime, irqtime_ind);
801 dasd_profile_counter(irqtime / sectors, irqtimeps_ind);
802 dasd_profile_counter(endtime, endtime_ind);
803
804 if (dasd_global_profile_level) {
805 dasd_profile_end_add_data(&dasd_global_profile_data,
806 cqr->startdev != block->base,
807 cqr->cpmode == 1,
808 rq_data_dir(req) == READ,
809 sectors, sectors_ind, tottime_ind,
810 tottimeps_ind, strtime_ind,
811 irqtime_ind, irqtimeps_ind,
812 endtime_ind);
813 }
814
815 spin_lock(&block->profile.lock);
816 if (block->profile.data)
817 dasd_profile_end_add_data(block->profile.data,
818 cqr->startdev != block->base,
819 cqr->cpmode == 1,
820 rq_data_dir(req) == READ,
821 sectors, sectors_ind, tottime_ind,
822 tottimeps_ind, strtime_ind,
823 irqtime_ind, irqtimeps_ind,
824 endtime_ind);
825 spin_unlock(&block->profile.lock);
826
827 spin_lock(&device->profile.lock);
828 if (device->profile.data)
829 dasd_profile_end_add_data(device->profile.data,
830 cqr->startdev != block->base,
831 cqr->cpmode == 1,
832 rq_data_dir(req) == READ,
833 sectors, sectors_ind, tottime_ind,
834 tottimeps_ind, strtime_ind,
835 irqtime_ind, irqtimeps_ind,
836 endtime_ind);
837 spin_unlock(&device->profile.lock);
838 }
839
840 void dasd_profile_reset(struct dasd_profile *profile)
841 {
842 struct dasd_profile_info *data;
843
844 spin_lock_bh(&profile->lock);
845 data = profile->data;
846 if (!data) {
847 spin_unlock_bh(&profile->lock);
848 return;
849 }
850 memset(data, 0, sizeof(*data));
851 getnstimeofday(&data->starttod);
852 spin_unlock_bh(&profile->lock);
853 }
854
855 void dasd_global_profile_reset(void)
856 {
857 memset(&dasd_global_profile_data, 0, sizeof(dasd_global_profile_data));
858 getnstimeofday(&dasd_global_profile_data.starttod);
859 }
860
861 int dasd_profile_on(struct dasd_profile *profile)
862 {
863 struct dasd_profile_info *data;
864
865 data = kzalloc(sizeof(*data), GFP_KERNEL);
866 if (!data)
867 return -ENOMEM;
868 spin_lock_bh(&profile->lock);
869 if (profile->data) {
870 spin_unlock_bh(&profile->lock);
871 kfree(data);
872 return 0;
873 }
874 getnstimeofday(&data->starttod);
875 profile->data = data;
876 spin_unlock_bh(&profile->lock);
877 return 0;
878 }
879
880 void dasd_profile_off(struct dasd_profile *profile)
881 {
882 spin_lock_bh(&profile->lock);
883 kfree(profile->data);
884 profile->data = NULL;
885 spin_unlock_bh(&profile->lock);
886 }
887
888 char *dasd_get_user_string(const char __user *user_buf, size_t user_len)
889 {
890 char *buffer;
891
892 buffer = vmalloc(user_len + 1);
893 if (buffer == NULL)
894 return ERR_PTR(-ENOMEM);
895 if (copy_from_user(buffer, user_buf, user_len) != 0) {
896 vfree(buffer);
897 return ERR_PTR(-EFAULT);
898 }
899 /* got the string, now strip linefeed. */
900 if (buffer[user_len - 1] == '\n')
901 buffer[user_len - 1] = 0;
902 else
903 buffer[user_len] = 0;
904 return buffer;
905 }
906
907 static ssize_t dasd_stats_write(struct file *file,
908 const char __user *user_buf,
909 size_t user_len, loff_t *pos)
910 {
911 char *buffer, *str;
912 int rc;
913 struct seq_file *m = (struct seq_file *)file->private_data;
914 struct dasd_profile *prof = m->private;
915
916 if (user_len > 65536)
917 user_len = 65536;
918 buffer = dasd_get_user_string(user_buf, user_len);
919 if (IS_ERR(buffer))
920 return PTR_ERR(buffer);
921
922 str = skip_spaces(buffer);
923 rc = user_len;
924 if (strncmp(str, "reset", 5) == 0) {
925 dasd_profile_reset(prof);
926 } else if (strncmp(str, "on", 2) == 0) {
927 rc = dasd_profile_on(prof);
928 if (!rc)
929 rc = user_len;
930 } else if (strncmp(str, "off", 3) == 0) {
931 dasd_profile_off(prof);
932 } else
933 rc = -EINVAL;
934 vfree(buffer);
935 return rc;
936 }
937
938 static void dasd_stats_array(struct seq_file *m, unsigned int *array)
939 {
940 int i;
941
942 for (i = 0; i < 32; i++)
943 seq_printf(m, "%u ", array[i]);
944 seq_putc(m, '\n');
945 }
946
947 static void dasd_stats_seq_print(struct seq_file *m,
948 struct dasd_profile_info *data)
949 {
950 seq_printf(m, "start_time %ld.%09ld\n",
951 data->starttod.tv_sec, data->starttod.tv_nsec);
952 seq_printf(m, "total_requests %u\n", data->dasd_io_reqs);
953 seq_printf(m, "total_sectors %u\n", data->dasd_io_sects);
954 seq_printf(m, "total_pav %u\n", data->dasd_io_alias);
955 seq_printf(m, "total_hpf %u\n", data->dasd_io_tpm);
956 seq_printf(m, "histogram_sectors ");
957 dasd_stats_array(m, data->dasd_io_secs);
958 seq_printf(m, "histogram_io_times ");
959 dasd_stats_array(m, data->dasd_io_times);
960 seq_printf(m, "histogram_io_times_weighted ");
961 dasd_stats_array(m, data->dasd_io_timps);
962 seq_printf(m, "histogram_time_build_to_ssch ");
963 dasd_stats_array(m, data->dasd_io_time1);
964 seq_printf(m, "histogram_time_ssch_to_irq ");
965 dasd_stats_array(m, data->dasd_io_time2);
966 seq_printf(m, "histogram_time_ssch_to_irq_weighted ");
967 dasd_stats_array(m, data->dasd_io_time2ps);
968 seq_printf(m, "histogram_time_irq_to_end ");
969 dasd_stats_array(m, data->dasd_io_time3);
970 seq_printf(m, "histogram_ccw_queue_length ");
971 dasd_stats_array(m, data->dasd_io_nr_req);
972 seq_printf(m, "total_read_requests %u\n", data->dasd_read_reqs);
973 seq_printf(m, "total_read_sectors %u\n", data->dasd_read_sects);
974 seq_printf(m, "total_read_pav %u\n", data->dasd_read_alias);
975 seq_printf(m, "total_read_hpf %u\n", data->dasd_read_tpm);
976 seq_printf(m, "histogram_read_sectors ");
977 dasd_stats_array(m, data->dasd_read_secs);
978 seq_printf(m, "histogram_read_times ");
979 dasd_stats_array(m, data->dasd_read_times);
980 seq_printf(m, "histogram_read_time_build_to_ssch ");
981 dasd_stats_array(m, data->dasd_read_time1);
982 seq_printf(m, "histogram_read_time_ssch_to_irq ");
983 dasd_stats_array(m, data->dasd_read_time2);
984 seq_printf(m, "histogram_read_time_irq_to_end ");
985 dasd_stats_array(m, data->dasd_read_time3);
986 seq_printf(m, "histogram_read_ccw_queue_length ");
987 dasd_stats_array(m, data->dasd_read_nr_req);
988 }
989
990 static int dasd_stats_show(struct seq_file *m, void *v)
991 {
992 struct dasd_profile *profile;
993 struct dasd_profile_info *data;
994
995 profile = m->private;
996 spin_lock_bh(&profile->lock);
997 data = profile->data;
998 if (!data) {
999 spin_unlock_bh(&profile->lock);
1000 seq_printf(m, "disabled\n");
1001 return 0;
1002 }
1003 dasd_stats_seq_print(m, data);
1004 spin_unlock_bh(&profile->lock);
1005 return 0;
1006 }
1007
1008 static int dasd_stats_open(struct inode *inode, struct file *file)
1009 {
1010 struct dasd_profile *profile = inode->i_private;
1011 return single_open(file, dasd_stats_show, profile);
1012 }
1013
1014 static const struct file_operations dasd_stats_raw_fops = {
1015 .owner = THIS_MODULE,
1016 .open = dasd_stats_open,
1017 .read = seq_read,
1018 .llseek = seq_lseek,
1019 .release = single_release,
1020 .write = dasd_stats_write,
1021 };
1022
1023 static ssize_t dasd_stats_global_write(struct file *file,
1024 const char __user *user_buf,
1025 size_t user_len, loff_t *pos)
1026 {
1027 char *buffer, *str;
1028 ssize_t rc;
1029
1030 if (user_len > 65536)
1031 user_len = 65536;
1032 buffer = dasd_get_user_string(user_buf, user_len);
1033 if (IS_ERR(buffer))
1034 return PTR_ERR(buffer);
1035 str = skip_spaces(buffer);
1036 rc = user_len;
1037 if (strncmp(str, "reset", 5) == 0) {
1038 dasd_global_profile_reset();
1039 } else if (strncmp(str, "on", 2) == 0) {
1040 dasd_global_profile_reset();
1041 dasd_global_profile_level = DASD_PROFILE_GLOBAL_ONLY;
1042 } else if (strncmp(str, "off", 3) == 0) {
1043 dasd_global_profile_level = DASD_PROFILE_OFF;
1044 } else
1045 rc = -EINVAL;
1046 vfree(buffer);
1047 return rc;
1048 }
1049
1050 static int dasd_stats_global_show(struct seq_file *m, void *v)
1051 {
1052 if (!dasd_global_profile_level) {
1053 seq_printf(m, "disabled\n");
1054 return 0;
1055 }
1056 dasd_stats_seq_print(m, &dasd_global_profile_data);
1057 return 0;
1058 }
1059
1060 static int dasd_stats_global_open(struct inode *inode, struct file *file)
1061 {
1062 return single_open(file, dasd_stats_global_show, NULL);
1063 }
1064
1065 static const struct file_operations dasd_stats_global_fops = {
1066 .owner = THIS_MODULE,
1067 .open = dasd_stats_global_open,
1068 .read = seq_read,
1069 .llseek = seq_lseek,
1070 .release = single_release,
1071 .write = dasd_stats_global_write,
1072 };
1073
1074 static void dasd_profile_init(struct dasd_profile *profile,
1075 struct dentry *base_dentry)
1076 {
1077 mode_t mode;
1078 struct dentry *pde;
1079
1080 if (!base_dentry)
1081 return;
1082 profile->dentry = NULL;
1083 profile->data = NULL;
1084 mode = (S_IRUSR | S_IWUSR | S_IFREG);
1085 pde = debugfs_create_file("statistics", mode, base_dentry,
1086 profile, &dasd_stats_raw_fops);
1087 if (pde && !IS_ERR(pde))
1088 profile->dentry = pde;
1089 return;
1090 }
1091
1092 static void dasd_profile_exit(struct dasd_profile *profile)
1093 {
1094 dasd_profile_off(profile);
1095 if (profile->dentry) {
1096 debugfs_remove(profile->dentry);
1097 profile->dentry = NULL;
1098 }
1099 }
1100
1101 static void dasd_statistics_removeroot(void)
1102 {
1103 dasd_global_profile_level = DASD_PROFILE_OFF;
1104 if (dasd_global_profile_dentry) {
1105 debugfs_remove(dasd_global_profile_dentry);
1106 dasd_global_profile_dentry = NULL;
1107 }
1108 if (dasd_debugfs_global_entry)
1109 debugfs_remove(dasd_debugfs_global_entry);
1110 if (dasd_debugfs_root_entry)
1111 debugfs_remove(dasd_debugfs_root_entry);
1112 }
1113
1114 static void dasd_statistics_createroot(void)
1115 {
1116 mode_t mode;
1117 struct dentry *pde;
1118
1119 dasd_debugfs_root_entry = NULL;
1120 dasd_debugfs_global_entry = NULL;
1121 dasd_global_profile_dentry = NULL;
1122 pde = debugfs_create_dir("dasd", NULL);
1123 if (!pde || IS_ERR(pde))
1124 goto error;
1125 dasd_debugfs_root_entry = pde;
1126 pde = debugfs_create_dir("global", dasd_debugfs_root_entry);
1127 if (!pde || IS_ERR(pde))
1128 goto error;
1129 dasd_debugfs_global_entry = pde;
1130
1131 mode = (S_IRUSR | S_IWUSR | S_IFREG);
1132 pde = debugfs_create_file("statistics", mode, dasd_debugfs_global_entry,
1133 NULL, &dasd_stats_global_fops);
1134 if (!pde || IS_ERR(pde))
1135 goto error;
1136 dasd_global_profile_dentry = pde;
1137 return;
1138
1139 error:
1140 DBF_EVENT(DBF_ERR, "%s",
1141 "Creation of the dasd debugfs interface failed");
1142 dasd_statistics_removeroot();
1143 return;
1144 }
1145
1146 #else
1147 #define dasd_profile_start(block, cqr, req) do {} while (0)
1148 #define dasd_profile_end(block, cqr, req) do {} while (0)
1149
1150 static void dasd_statistics_createroot(void)
1151 {
1152 return;
1153 }
1154
1155 static void dasd_statistics_removeroot(void)
1156 {
1157 return;
1158 }
1159
1160 int dasd_stats_generic_show(struct seq_file *m, void *v)
1161 {
1162 seq_printf(m, "Statistics are not activated in this kernel\n");
1163 return 0;
1164 }
1165
1166 static void dasd_profile_init(struct dasd_profile *profile,
1167 struct dentry *base_dentry)
1168 {
1169 return;
1170 }
1171
1172 static void dasd_profile_exit(struct dasd_profile *profile)
1173 {
1174 return;
1175 }
1176
1177 int dasd_profile_on(struct dasd_profile *profile)
1178 {
1179 return 0;
1180 }
1181
1182 #endif /* CONFIG_DASD_PROFILE */
1183
1184 /*
1185 * Allocate memory for a channel program with 'cplength' channel
1186 * command words and 'datasize' additional space. There are two
1187 * variantes: 1) dasd_kmalloc_request uses kmalloc to get the needed
1188 * memory and 2) dasd_smalloc_request uses the static ccw memory
1189 * that gets allocated for each device.
1190 */
1191 struct dasd_ccw_req *dasd_kmalloc_request(int magic, int cplength,
1192 int datasize,
1193 struct dasd_device *device)
1194 {
1195 struct dasd_ccw_req *cqr;
1196
1197 /* Sanity checks */
1198 BUG_ON(datasize > PAGE_SIZE ||
1199 (cplength*sizeof(struct ccw1)) > PAGE_SIZE);
1200
1201 cqr = kzalloc(sizeof(struct dasd_ccw_req), GFP_ATOMIC);
1202 if (cqr == NULL)
1203 return ERR_PTR(-ENOMEM);
1204 cqr->cpaddr = NULL;
1205 if (cplength > 0) {
1206 cqr->cpaddr = kcalloc(cplength, sizeof(struct ccw1),
1207 GFP_ATOMIC | GFP_DMA);
1208 if (cqr->cpaddr == NULL) {
1209 kfree(cqr);
1210 return ERR_PTR(-ENOMEM);
1211 }
1212 }
1213 cqr->data = NULL;
1214 if (datasize > 0) {
1215 cqr->data = kzalloc(datasize, GFP_ATOMIC | GFP_DMA);
1216 if (cqr->data == NULL) {
1217 kfree(cqr->cpaddr);
1218 kfree(cqr);
1219 return ERR_PTR(-ENOMEM);
1220 }
1221 }
1222 cqr->magic = magic;
1223 set_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags);
1224 dasd_get_device(device);
1225 return cqr;
1226 }
1227
1228 struct dasd_ccw_req *dasd_smalloc_request(int magic, int cplength,
1229 int datasize,
1230 struct dasd_device *device)
1231 {
1232 unsigned long flags;
1233 struct dasd_ccw_req *cqr;
1234 char *data;
1235 int size;
1236
1237 size = (sizeof(struct dasd_ccw_req) + 7L) & -8L;
1238 if (cplength > 0)
1239 size += cplength * sizeof(struct ccw1);
1240 if (datasize > 0)
1241 size += datasize;
1242 spin_lock_irqsave(&device->mem_lock, flags);
1243 cqr = (struct dasd_ccw_req *)
1244 dasd_alloc_chunk(&device->ccw_chunks, size);
1245 spin_unlock_irqrestore(&device->mem_lock, flags);
1246 if (cqr == NULL)
1247 return ERR_PTR(-ENOMEM);
1248 memset(cqr, 0, sizeof(struct dasd_ccw_req));
1249 data = (char *) cqr + ((sizeof(struct dasd_ccw_req) + 7L) & -8L);
1250 cqr->cpaddr = NULL;
1251 if (cplength > 0) {
1252 cqr->cpaddr = (struct ccw1 *) data;
1253 data += cplength*sizeof(struct ccw1);
1254 memset(cqr->cpaddr, 0, cplength*sizeof(struct ccw1));
1255 }
1256 cqr->data = NULL;
1257 if (datasize > 0) {
1258 cqr->data = data;
1259 memset(cqr->data, 0, datasize);
1260 }
1261 cqr->magic = magic;
1262 set_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags);
1263 dasd_get_device(device);
1264 return cqr;
1265 }
1266
1267 /*
1268 * Free memory of a channel program. This function needs to free all the
1269 * idal lists that might have been created by dasd_set_cda and the
1270 * struct dasd_ccw_req itself.
1271 */
1272 void dasd_kfree_request(struct dasd_ccw_req *cqr, struct dasd_device *device)
1273 {
1274 #ifdef CONFIG_64BIT
1275 struct ccw1 *ccw;
1276
1277 /* Clear any idals used for the request. */
1278 ccw = cqr->cpaddr;
1279 do {
1280 clear_normalized_cda(ccw);
1281 } while (ccw++->flags & (CCW_FLAG_CC | CCW_FLAG_DC));
1282 #endif
1283 kfree(cqr->cpaddr);
1284 kfree(cqr->data);
1285 kfree(cqr);
1286 dasd_put_device(device);
1287 }
1288
1289 void dasd_sfree_request(struct dasd_ccw_req *cqr, struct dasd_device *device)
1290 {
1291 unsigned long flags;
1292
1293 spin_lock_irqsave(&device->mem_lock, flags);
1294 dasd_free_chunk(&device->ccw_chunks, cqr);
1295 spin_unlock_irqrestore(&device->mem_lock, flags);
1296 dasd_put_device(device);
1297 }
1298
1299 /*
1300 * Check discipline magic in cqr.
1301 */
1302 static inline int dasd_check_cqr(struct dasd_ccw_req *cqr)
1303 {
1304 struct dasd_device *device;
1305
1306 if (cqr == NULL)
1307 return -EINVAL;
1308 device = cqr->startdev;
1309 if (strncmp((char *) &cqr->magic, device->discipline->ebcname, 4)) {
1310 DBF_DEV_EVENT(DBF_WARNING, device,
1311 " dasd_ccw_req 0x%08x magic doesn't match"
1312 " discipline 0x%08x",
1313 cqr->magic,
1314 *(unsigned int *) device->discipline->name);
1315 return -EINVAL;
1316 }
1317 return 0;
1318 }
1319
1320 /*
1321 * Terminate the current i/o and set the request to clear_pending.
1322 * Timer keeps device runnig.
1323 * ccw_device_clear can fail if the i/o subsystem
1324 * is in a bad mood.
1325 */
1326 int dasd_term_IO(struct dasd_ccw_req *cqr)
1327 {
1328 struct dasd_device *device;
1329 int retries, rc;
1330 char errorstring[ERRORLENGTH];
1331
1332 /* Check the cqr */
1333 rc = dasd_check_cqr(cqr);
1334 if (rc)
1335 return rc;
1336 retries = 0;
1337 device = (struct dasd_device *) cqr->startdev;
1338 while ((retries < 5) && (cqr->status == DASD_CQR_IN_IO)) {
1339 rc = ccw_device_clear(device->cdev, (long) cqr);
1340 switch (rc) {
1341 case 0: /* termination successful */
1342 cqr->status = DASD_CQR_CLEAR_PENDING;
1343 cqr->stopclk = get_clock();
1344 cqr->starttime = 0;
1345 DBF_DEV_EVENT(DBF_DEBUG, device,
1346 "terminate cqr %p successful",
1347 cqr);
1348 break;
1349 case -ENODEV:
1350 DBF_DEV_EVENT(DBF_ERR, device, "%s",
1351 "device gone, retry");
1352 break;
1353 case -EIO:
1354 DBF_DEV_EVENT(DBF_ERR, device, "%s",
1355 "I/O error, retry");
1356 break;
1357 case -EINVAL:
1358 case -EBUSY:
1359 DBF_DEV_EVENT(DBF_ERR, device, "%s",
1360 "device busy, retry later");
1361 break;
1362 default:
1363 /* internal error 10 - unknown rc*/
1364 snprintf(errorstring, ERRORLENGTH, "10 %d", rc);
1365 dev_err(&device->cdev->dev, "An error occurred in the "
1366 "DASD device driver, reason=%s\n", errorstring);
1367 BUG();
1368 break;
1369 }
1370 retries++;
1371 }
1372 dasd_schedule_device_bh(device);
1373 return rc;
1374 }
1375
1376 /*
1377 * Start the i/o. This start_IO can fail if the channel is really busy.
1378 * In that case set up a timer to start the request later.
1379 */
1380 int dasd_start_IO(struct dasd_ccw_req *cqr)
1381 {
1382 struct dasd_device *device;
1383 int rc;
1384 char errorstring[ERRORLENGTH];
1385
1386 /* Check the cqr */
1387 rc = dasd_check_cqr(cqr);
1388 if (rc) {
1389 cqr->intrc = rc;
1390 return rc;
1391 }
1392 device = (struct dasd_device *) cqr->startdev;
1393 if (((cqr->block &&
1394 test_bit(DASD_FLAG_LOCK_STOLEN, &cqr->block->base->flags)) ||
1395 test_bit(DASD_FLAG_LOCK_STOLEN, &device->flags)) &&
1396 !test_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags)) {
1397 DBF_DEV_EVENT(DBF_DEBUG, device, "start_IO: return request %p "
1398 "because of stolen lock", cqr);
1399 cqr->status = DASD_CQR_ERROR;
1400 cqr->intrc = -EPERM;
1401 return -EPERM;
1402 }
1403 if (cqr->retries < 0) {
1404 /* internal error 14 - start_IO run out of retries */
1405 sprintf(errorstring, "14 %p", cqr);
1406 dev_err(&device->cdev->dev, "An error occurred in the DASD "
1407 "device driver, reason=%s\n", errorstring);
1408 cqr->status = DASD_CQR_ERROR;
1409 return -EIO;
1410 }
1411 cqr->startclk = get_clock();
1412 cqr->starttime = jiffies;
1413 cqr->retries--;
1414 if (!test_bit(DASD_CQR_VERIFY_PATH, &cqr->flags)) {
1415 cqr->lpm &= device->path_data.opm;
1416 if (!cqr->lpm)
1417 cqr->lpm = device->path_data.opm;
1418 }
1419 if (cqr->cpmode == 1) {
1420 rc = ccw_device_tm_start(device->cdev, cqr->cpaddr,
1421 (long) cqr, cqr->lpm);
1422 } else {
1423 rc = ccw_device_start(device->cdev, cqr->cpaddr,
1424 (long) cqr, cqr->lpm, 0);
1425 }
1426 switch (rc) {
1427 case 0:
1428 cqr->status = DASD_CQR_IN_IO;
1429 break;
1430 case -EBUSY:
1431 DBF_DEV_EVENT(DBF_WARNING, device, "%s",
1432 "start_IO: device busy, retry later");
1433 break;
1434 case -ETIMEDOUT:
1435 DBF_DEV_EVENT(DBF_WARNING, device, "%s",
1436 "start_IO: request timeout, retry later");
1437 break;
1438 case -EACCES:
1439 /* -EACCES indicates that the request used only a subset of the
1440 * available paths and all these paths are gone. If the lpm of
1441 * this request was only a subset of the opm (e.g. the ppm) then
1442 * we just do a retry with all available paths.
1443 * If we already use the full opm, something is amiss, and we
1444 * need a full path verification.
1445 */
1446 if (test_bit(DASD_CQR_VERIFY_PATH, &cqr->flags)) {
1447 DBF_DEV_EVENT(DBF_WARNING, device,
1448 "start_IO: selected paths gone (%x)",
1449 cqr->lpm);
1450 } else if (cqr->lpm != device->path_data.opm) {
1451 cqr->lpm = device->path_data.opm;
1452 DBF_DEV_EVENT(DBF_DEBUG, device, "%s",
1453 "start_IO: selected paths gone,"
1454 " retry on all paths");
1455 } else {
1456 DBF_DEV_EVENT(DBF_WARNING, device, "%s",
1457 "start_IO: all paths in opm gone,"
1458 " do path verification");
1459 dasd_generic_last_path_gone(device);
1460 device->path_data.opm = 0;
1461 device->path_data.ppm = 0;
1462 device->path_data.npm = 0;
1463 device->path_data.tbvpm =
1464 ccw_device_get_path_mask(device->cdev);
1465 }
1466 break;
1467 case -ENODEV:
1468 DBF_DEV_EVENT(DBF_WARNING, device, "%s",
1469 "start_IO: -ENODEV device gone, retry");
1470 break;
1471 case -EIO:
1472 DBF_DEV_EVENT(DBF_WARNING, device, "%s",
1473 "start_IO: -EIO device gone, retry");
1474 break;
1475 case -EINVAL:
1476 /* most likely caused in power management context */
1477 DBF_DEV_EVENT(DBF_WARNING, device, "%s",
1478 "start_IO: -EINVAL device currently "
1479 "not accessible");
1480 break;
1481 default:
1482 /* internal error 11 - unknown rc */
1483 snprintf(errorstring, ERRORLENGTH, "11 %d", rc);
1484 dev_err(&device->cdev->dev,
1485 "An error occurred in the DASD device driver, "
1486 "reason=%s\n", errorstring);
1487 BUG();
1488 break;
1489 }
1490 cqr->intrc = rc;
1491 return rc;
1492 }
1493
1494 /*
1495 * Timeout function for dasd devices. This is used for different purposes
1496 * 1) missing interrupt handler for normal operation
1497 * 2) delayed start of request where start_IO failed with -EBUSY
1498 * 3) timeout for missing state change interrupts
1499 * The head of the ccw queue will have status DASD_CQR_IN_IO for 1),
1500 * DASD_CQR_QUEUED for 2) and 3).
1501 */
1502 static void dasd_device_timeout(unsigned long ptr)
1503 {
1504 unsigned long flags;
1505 struct dasd_device *device;
1506
1507 device = (struct dasd_device *) ptr;
1508 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags);
1509 /* re-activate request queue */
1510 dasd_device_remove_stop_bits(device, DASD_STOPPED_PENDING);
1511 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags);
1512 dasd_schedule_device_bh(device);
1513 }
1514
1515 /*
1516 * Setup timeout for a device in jiffies.
1517 */
1518 void dasd_device_set_timer(struct dasd_device *device, int expires)
1519 {
1520 if (expires == 0)
1521 del_timer(&device->timer);
1522 else
1523 mod_timer(&device->timer, jiffies + expires);
1524 }
1525
1526 /*
1527 * Clear timeout for a device.
1528 */
1529 void dasd_device_clear_timer(struct dasd_device *device)
1530 {
1531 del_timer(&device->timer);
1532 }
1533
1534 static void dasd_handle_killed_request(struct ccw_device *cdev,
1535 unsigned long intparm)
1536 {
1537 struct dasd_ccw_req *cqr;
1538 struct dasd_device *device;
1539
1540 if (!intparm)
1541 return;
1542 cqr = (struct dasd_ccw_req *) intparm;
1543 if (cqr->status != DASD_CQR_IN_IO) {
1544 DBF_EVENT_DEVID(DBF_DEBUG, cdev,
1545 "invalid status in handle_killed_request: "
1546 "%02x", cqr->status);
1547 return;
1548 }
1549
1550 device = dasd_device_from_cdev_locked(cdev);
1551 if (IS_ERR(device)) {
1552 DBF_EVENT_DEVID(DBF_DEBUG, cdev, "%s",
1553 "unable to get device from cdev");
1554 return;
1555 }
1556
1557 if (!cqr->startdev ||
1558 device != cqr->startdev ||
1559 strncmp(cqr->startdev->discipline->ebcname,
1560 (char *) &cqr->magic, 4)) {
1561 DBF_EVENT_DEVID(DBF_DEBUG, cdev, "%s",
1562 "invalid device in request");
1563 dasd_put_device(device);
1564 return;
1565 }
1566
1567 /* Schedule request to be retried. */
1568 cqr->status = DASD_CQR_QUEUED;
1569
1570 dasd_device_clear_timer(device);
1571 dasd_schedule_device_bh(device);
1572 dasd_put_device(device);
1573 }
1574
1575 void dasd_generic_handle_state_change(struct dasd_device *device)
1576 {
1577 /* First of all start sense subsystem status request. */
1578 dasd_eer_snss(device);
1579
1580 dasd_device_remove_stop_bits(device, DASD_STOPPED_PENDING);
1581 dasd_schedule_device_bh(device);
1582 if (device->block)
1583 dasd_schedule_block_bh(device->block);
1584 }
1585
1586 /*
1587 * Interrupt handler for "normal" ssch-io based dasd devices.
1588 */
1589 void dasd_int_handler(struct ccw_device *cdev, unsigned long intparm,
1590 struct irb *irb)
1591 {
1592 struct dasd_ccw_req *cqr, *next;
1593 struct dasd_device *device;
1594 unsigned long long now;
1595 int expires;
1596
1597 kstat_cpu(smp_processor_id()).irqs[IOINT_DAS]++;
1598 if (IS_ERR(irb)) {
1599 switch (PTR_ERR(irb)) {
1600 case -EIO:
1601 break;
1602 case -ETIMEDOUT:
1603 DBF_EVENT_DEVID(DBF_WARNING, cdev, "%s: "
1604 "request timed out\n", __func__);
1605 break;
1606 default:
1607 DBF_EVENT_DEVID(DBF_WARNING, cdev, "%s: "
1608 "unknown error %ld\n", __func__,
1609 PTR_ERR(irb));
1610 }
1611 dasd_handle_killed_request(cdev, intparm);
1612 return;
1613 }
1614
1615 now = get_clock();
1616 cqr = (struct dasd_ccw_req *) intparm;
1617 /* check for conditions that should be handled immediately */
1618 if (!cqr ||
1619 !(scsw_dstat(&irb->scsw) == (DEV_STAT_CHN_END | DEV_STAT_DEV_END) &&
1620 scsw_cstat(&irb->scsw) == 0)) {
1621 if (cqr)
1622 memcpy(&cqr->irb, irb, sizeof(*irb));
1623 device = dasd_device_from_cdev_locked(cdev);
1624 if (IS_ERR(device))
1625 return;
1626 /* ignore unsolicited interrupts for DIAG discipline */
1627 if (device->discipline == dasd_diag_discipline_pointer) {
1628 dasd_put_device(device);
1629 return;
1630 }
1631 device->discipline->dump_sense_dbf(device, irb, "int");
1632 if (device->features & DASD_FEATURE_ERPLOG)
1633 device->discipline->dump_sense(device, cqr, irb);
1634 device->discipline->check_for_device_change(device, cqr, irb);
1635 dasd_put_device(device);
1636 }
1637 if (!cqr)
1638 return;
1639
1640 device = (struct dasd_device *) cqr->startdev;
1641 if (!device ||
1642 strncmp(device->discipline->ebcname, (char *) &cqr->magic, 4)) {
1643 DBF_EVENT_DEVID(DBF_DEBUG, cdev, "%s",
1644 "invalid device in request");
1645 return;
1646 }
1647
1648 /* Check for clear pending */
1649 if (cqr->status == DASD_CQR_CLEAR_PENDING &&
1650 scsw_fctl(&irb->scsw) & SCSW_FCTL_CLEAR_FUNC) {
1651 cqr->status = DASD_CQR_CLEARED;
1652 dasd_device_clear_timer(device);
1653 wake_up(&dasd_flush_wq);
1654 dasd_schedule_device_bh(device);
1655 return;
1656 }
1657
1658 /* check status - the request might have been killed by dyn detach */
1659 if (cqr->status != DASD_CQR_IN_IO) {
1660 DBF_DEV_EVENT(DBF_DEBUG, device, "invalid status: bus_id %s, "
1661 "status %02x", dev_name(&cdev->dev), cqr->status);
1662 return;
1663 }
1664
1665 next = NULL;
1666 expires = 0;
1667 if (scsw_dstat(&irb->scsw) == (DEV_STAT_CHN_END | DEV_STAT_DEV_END) &&
1668 scsw_cstat(&irb->scsw) == 0) {
1669 /* request was completed successfully */
1670 cqr->status = DASD_CQR_SUCCESS;
1671 cqr->stopclk = now;
1672 /* Start first request on queue if possible -> fast_io. */
1673 if (cqr->devlist.next != &device->ccw_queue) {
1674 next = list_entry(cqr->devlist.next,
1675 struct dasd_ccw_req, devlist);
1676 }
1677 } else { /* error */
1678 /*
1679 * If we don't want complex ERP for this request, then just
1680 * reset this and retry it in the fastpath
1681 */
1682 if (!test_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags) &&
1683 cqr->retries > 0) {
1684 if (cqr->lpm == device->path_data.opm)
1685 DBF_DEV_EVENT(DBF_DEBUG, device,
1686 "default ERP in fastpath "
1687 "(%i retries left)",
1688 cqr->retries);
1689 if (!test_bit(DASD_CQR_VERIFY_PATH, &cqr->flags))
1690 cqr->lpm = device->path_data.opm;
1691 cqr->status = DASD_CQR_QUEUED;
1692 next = cqr;
1693 } else
1694 cqr->status = DASD_CQR_ERROR;
1695 }
1696 if (next && (next->status == DASD_CQR_QUEUED) &&
1697 (!device->stopped)) {
1698 if (device->discipline->start_IO(next) == 0)
1699 expires = next->expires;
1700 }
1701 if (expires != 0)
1702 dasd_device_set_timer(device, expires);
1703 else
1704 dasd_device_clear_timer(device);
1705 dasd_schedule_device_bh(device);
1706 }
1707
1708 enum uc_todo dasd_generic_uc_handler(struct ccw_device *cdev, struct irb *irb)
1709 {
1710 struct dasd_device *device;
1711
1712 device = dasd_device_from_cdev_locked(cdev);
1713
1714 if (IS_ERR(device))
1715 goto out;
1716 if (test_bit(DASD_FLAG_OFFLINE, &device->flags) ||
1717 device->state != device->target ||
1718 !device->discipline->check_for_device_change){
1719 dasd_put_device(device);
1720 goto out;
1721 }
1722 if (device->discipline->dump_sense_dbf)
1723 device->discipline->dump_sense_dbf(device, irb, "uc");
1724 device->discipline->check_for_device_change(device, NULL, irb);
1725 dasd_put_device(device);
1726 out:
1727 return UC_TODO_RETRY;
1728 }
1729 EXPORT_SYMBOL_GPL(dasd_generic_uc_handler);
1730
1731 /*
1732 * If we have an error on a dasd_block layer request then we cancel
1733 * and return all further requests from the same dasd_block as well.
1734 */
1735 static void __dasd_device_recovery(struct dasd_device *device,
1736 struct dasd_ccw_req *ref_cqr)
1737 {
1738 struct list_head *l, *n;
1739 struct dasd_ccw_req *cqr;
1740
1741 /*
1742 * only requeue request that came from the dasd_block layer
1743 */
1744 if (!ref_cqr->block)
1745 return;
1746
1747 list_for_each_safe(l, n, &device->ccw_queue) {
1748 cqr = list_entry(l, struct dasd_ccw_req, devlist);
1749 if (cqr->status == DASD_CQR_QUEUED &&
1750 ref_cqr->block == cqr->block) {
1751 cqr->status = DASD_CQR_CLEARED;
1752 }
1753 }
1754 };
1755
1756 /*
1757 * Remove those ccw requests from the queue that need to be returned
1758 * to the upper layer.
1759 */
1760 static void __dasd_device_process_ccw_queue(struct dasd_device *device,
1761 struct list_head *final_queue)
1762 {
1763 struct list_head *l, *n;
1764 struct dasd_ccw_req *cqr;
1765
1766 /* Process request with final status. */
1767 list_for_each_safe(l, n, &device->ccw_queue) {
1768 cqr = list_entry(l, struct dasd_ccw_req, devlist);
1769
1770 /* Stop list processing at the first non-final request. */
1771 if (cqr->status == DASD_CQR_QUEUED ||
1772 cqr->status == DASD_CQR_IN_IO ||
1773 cqr->status == DASD_CQR_CLEAR_PENDING)
1774 break;
1775 if (cqr->status == DASD_CQR_ERROR) {
1776 __dasd_device_recovery(device, cqr);
1777 }
1778 /* Rechain finished requests to final queue */
1779 list_move_tail(&cqr->devlist, final_queue);
1780 }
1781 }
1782
1783 /*
1784 * the cqrs from the final queue are returned to the upper layer
1785 * by setting a dasd_block state and calling the callback function
1786 */
1787 static void __dasd_device_process_final_queue(struct dasd_device *device,
1788 struct list_head *final_queue)
1789 {
1790 struct list_head *l, *n;
1791 struct dasd_ccw_req *cqr;
1792 struct dasd_block *block;
1793 void (*callback)(struct dasd_ccw_req *, void *data);
1794 void *callback_data;
1795 char errorstring[ERRORLENGTH];
1796
1797 list_for_each_safe(l, n, final_queue) {
1798 cqr = list_entry(l, struct dasd_ccw_req, devlist);
1799 list_del_init(&cqr->devlist);
1800 block = cqr->block;
1801 callback = cqr->callback;
1802 callback_data = cqr->callback_data;
1803 if (block)
1804 spin_lock_bh(&block->queue_lock);
1805 switch (cqr->status) {
1806 case DASD_CQR_SUCCESS:
1807 cqr->status = DASD_CQR_DONE;
1808 break;
1809 case DASD_CQR_ERROR:
1810 cqr->status = DASD_CQR_NEED_ERP;
1811 break;
1812 case DASD_CQR_CLEARED:
1813 cqr->status = DASD_CQR_TERMINATED;
1814 break;
1815 default:
1816 /* internal error 12 - wrong cqr status*/
1817 snprintf(errorstring, ERRORLENGTH, "12 %p %x02", cqr, cqr->status);
1818 dev_err(&device->cdev->dev,
1819 "An error occurred in the DASD device driver, "
1820 "reason=%s\n", errorstring);
1821 BUG();
1822 }
1823 if (cqr->callback != NULL)
1824 (callback)(cqr, callback_data);
1825 if (block)
1826 spin_unlock_bh(&block->queue_lock);
1827 }
1828 }
1829
1830 /*
1831 * Take a look at the first request on the ccw queue and check
1832 * if it reached its expire time. If so, terminate the IO.
1833 */
1834 static void __dasd_device_check_expire(struct dasd_device *device)
1835 {
1836 struct dasd_ccw_req *cqr;
1837
1838 if (list_empty(&device->ccw_queue))
1839 return;
1840 cqr = list_entry(device->ccw_queue.next, struct dasd_ccw_req, devlist);
1841 if ((cqr->status == DASD_CQR_IN_IO && cqr->expires != 0) &&
1842 (time_after_eq(jiffies, cqr->expires + cqr->starttime))) {
1843 if (device->discipline->term_IO(cqr) != 0) {
1844 /* Hmpf, try again in 5 sec */
1845 dev_err(&device->cdev->dev,
1846 "cqr %p timed out (%lus) but cannot be "
1847 "ended, retrying in 5 s\n",
1848 cqr, (cqr->expires/HZ));
1849 cqr->expires += 5*HZ;
1850 dasd_device_set_timer(device, 5*HZ);
1851 } else {
1852 dev_err(&device->cdev->dev,
1853 "cqr %p timed out (%lus), %i retries "
1854 "remaining\n", cqr, (cqr->expires/HZ),
1855 cqr->retries);
1856 }
1857 }
1858 }
1859
1860 /*
1861 * Take a look at the first request on the ccw queue and check
1862 * if it needs to be started.
1863 */
1864 static void __dasd_device_start_head(struct dasd_device *device)
1865 {
1866 struct dasd_ccw_req *cqr;
1867 int rc;
1868
1869 if (list_empty(&device->ccw_queue))
1870 return;
1871 cqr = list_entry(device->ccw_queue.next, struct dasd_ccw_req, devlist);
1872 if (cqr->status != DASD_CQR_QUEUED)
1873 return;
1874 /* when device is stopped, return request to previous layer
1875 * exception: only the disconnect or unresumed bits are set and the
1876 * cqr is a path verification request
1877 */
1878 if (device->stopped &&
1879 !(!(device->stopped & ~(DASD_STOPPED_DC_WAIT | DASD_UNRESUMED_PM))
1880 && test_bit(DASD_CQR_VERIFY_PATH, &cqr->flags))) {
1881 cqr->intrc = -EAGAIN;
1882 cqr->status = DASD_CQR_CLEARED;
1883 dasd_schedule_device_bh(device);
1884 return;
1885 }
1886
1887 rc = device->discipline->start_IO(cqr);
1888 if (rc == 0)
1889 dasd_device_set_timer(device, cqr->expires);
1890 else if (rc == -EACCES) {
1891 dasd_schedule_device_bh(device);
1892 } else
1893 /* Hmpf, try again in 1/2 sec */
1894 dasd_device_set_timer(device, 50);
1895 }
1896
1897 static void __dasd_device_check_path_events(struct dasd_device *device)
1898 {
1899 int rc;
1900
1901 if (device->path_data.tbvpm) {
1902 if (device->stopped & ~(DASD_STOPPED_DC_WAIT |
1903 DASD_UNRESUMED_PM))
1904 return;
1905 rc = device->discipline->verify_path(
1906 device, device->path_data.tbvpm);
1907 if (rc)
1908 dasd_device_set_timer(device, 50);
1909 else
1910 device->path_data.tbvpm = 0;
1911 }
1912 };
1913
1914 /*
1915 * Go through all request on the dasd_device request queue,
1916 * terminate them on the cdev if necessary, and return them to the
1917 * submitting layer via callback.
1918 * Note:
1919 * Make sure that all 'submitting layers' still exist when
1920 * this function is called!. In other words, when 'device' is a base
1921 * device then all block layer requests must have been removed before
1922 * via dasd_flush_block_queue.
1923 */
1924 int dasd_flush_device_queue(struct dasd_device *device)
1925 {
1926 struct dasd_ccw_req *cqr, *n;
1927 int rc;
1928 struct list_head flush_queue;
1929
1930 INIT_LIST_HEAD(&flush_queue);
1931 spin_lock_irq(get_ccwdev_lock(device->cdev));
1932 rc = 0;
1933 list_for_each_entry_safe(cqr, n, &device->ccw_queue, devlist) {
1934 /* Check status and move request to flush_queue */
1935 switch (cqr->status) {
1936 case DASD_CQR_IN_IO:
1937 rc = device->discipline->term_IO(cqr);
1938 if (rc) {
1939 /* unable to terminate requeust */
1940 dev_err(&device->cdev->dev,
1941 "Flushing the DASD request queue "
1942 "failed for request %p\n", cqr);
1943 /* stop flush processing */
1944 goto finished;
1945 }
1946 break;
1947 case DASD_CQR_QUEUED:
1948 cqr->stopclk = get_clock();
1949 cqr->status = DASD_CQR_CLEARED;
1950 break;
1951 default: /* no need to modify the others */
1952 break;
1953 }
1954 list_move_tail(&cqr->devlist, &flush_queue);
1955 }
1956 finished:
1957 spin_unlock_irq(get_ccwdev_lock(device->cdev));
1958 /*
1959 * After this point all requests must be in state CLEAR_PENDING,
1960 * CLEARED, SUCCESS or ERROR. Now wait for CLEAR_PENDING to become
1961 * one of the others.
1962 */
1963 list_for_each_entry_safe(cqr, n, &flush_queue, devlist)
1964 wait_event(dasd_flush_wq,
1965 (cqr->status != DASD_CQR_CLEAR_PENDING));
1966 /*
1967 * Now set each request back to TERMINATED, DONE or NEED_ERP
1968 * and call the callback function of flushed requests
1969 */
1970 __dasd_device_process_final_queue(device, &flush_queue);
1971 return rc;
1972 }
1973
1974 /*
1975 * Acquire the device lock and process queues for the device.
1976 */
1977 static void dasd_device_tasklet(struct dasd_device *device)
1978 {
1979 struct list_head final_queue;
1980
1981 atomic_set (&device->tasklet_scheduled, 0);
1982 INIT_LIST_HEAD(&final_queue);
1983 spin_lock_irq(get_ccwdev_lock(device->cdev));
1984 /* Check expire time of first request on the ccw queue. */
1985 __dasd_device_check_expire(device);
1986 /* find final requests on ccw queue */
1987 __dasd_device_process_ccw_queue(device, &final_queue);
1988 __dasd_device_check_path_events(device);
1989 spin_unlock_irq(get_ccwdev_lock(device->cdev));
1990 /* Now call the callback function of requests with final status */
1991 __dasd_device_process_final_queue(device, &final_queue);
1992 spin_lock_irq(get_ccwdev_lock(device->cdev));
1993 /* Now check if the head of the ccw queue needs to be started. */
1994 __dasd_device_start_head(device);
1995 spin_unlock_irq(get_ccwdev_lock(device->cdev));
1996 dasd_put_device(device);
1997 }
1998
1999 /*
2000 * Schedules a call to dasd_tasklet over the device tasklet.
2001 */
2002 void dasd_schedule_device_bh(struct dasd_device *device)
2003 {
2004 /* Protect against rescheduling. */
2005 if (atomic_cmpxchg (&device->tasklet_scheduled, 0, 1) != 0)
2006 return;
2007 dasd_get_device(device);
2008 tasklet_hi_schedule(&device->tasklet);
2009 }
2010
2011 void dasd_device_set_stop_bits(struct dasd_device *device, int bits)
2012 {
2013 device->stopped |= bits;
2014 }
2015 EXPORT_SYMBOL_GPL(dasd_device_set_stop_bits);
2016
2017 void dasd_device_remove_stop_bits(struct dasd_device *device, int bits)
2018 {
2019 device->stopped &= ~bits;
2020 if (!device->stopped)
2021 wake_up(&generic_waitq);
2022 }
2023 EXPORT_SYMBOL_GPL(dasd_device_remove_stop_bits);
2024
2025 /*
2026 * Queue a request to the head of the device ccw_queue.
2027 * Start the I/O if possible.
2028 */
2029 void dasd_add_request_head(struct dasd_ccw_req *cqr)
2030 {
2031 struct dasd_device *device;
2032 unsigned long flags;
2033
2034 device = cqr->startdev;
2035 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags);
2036 cqr->status = DASD_CQR_QUEUED;
2037 list_add(&cqr->devlist, &device->ccw_queue);
2038 /* let the bh start the request to keep them in order */
2039 dasd_schedule_device_bh(device);
2040 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags);
2041 }
2042
2043 /*
2044 * Queue a request to the tail of the device ccw_queue.
2045 * Start the I/O if possible.
2046 */
2047 void dasd_add_request_tail(struct dasd_ccw_req *cqr)
2048 {
2049 struct dasd_device *device;
2050 unsigned long flags;
2051
2052 device = cqr->startdev;
2053 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags);
2054 cqr->status = DASD_CQR_QUEUED;
2055 list_add_tail(&cqr->devlist, &device->ccw_queue);
2056 /* let the bh start the request to keep them in order */
2057 dasd_schedule_device_bh(device);
2058 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags);
2059 }
2060
2061 /*
2062 * Wakeup helper for the 'sleep_on' functions.
2063 */
2064 static void dasd_wakeup_cb(struct dasd_ccw_req *cqr, void *data)
2065 {
2066 spin_lock_irq(get_ccwdev_lock(cqr->startdev->cdev));
2067 cqr->callback_data = DASD_SLEEPON_END_TAG;
2068 spin_unlock_irq(get_ccwdev_lock(cqr->startdev->cdev));
2069 wake_up(&generic_waitq);
2070 }
2071
2072 static inline int _wait_for_wakeup(struct dasd_ccw_req *cqr)
2073 {
2074 struct dasd_device *device;
2075 int rc;
2076
2077 device = cqr->startdev;
2078 spin_lock_irq(get_ccwdev_lock(device->cdev));
2079 rc = (cqr->callback_data == DASD_SLEEPON_END_TAG);
2080 spin_unlock_irq(get_ccwdev_lock(device->cdev));
2081 return rc;
2082 }
2083
2084 /*
2085 * checks if error recovery is necessary, returns 1 if yes, 0 otherwise.
2086 */
2087 static int __dasd_sleep_on_erp(struct dasd_ccw_req *cqr)
2088 {
2089 struct dasd_device *device;
2090 dasd_erp_fn_t erp_fn;
2091
2092 if (cqr->status == DASD_CQR_FILLED)
2093 return 0;
2094 device = cqr->startdev;
2095 if (test_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags)) {
2096 if (cqr->status == DASD_CQR_TERMINATED) {
2097 device->discipline->handle_terminated_request(cqr);
2098 return 1;
2099 }
2100 if (cqr->status == DASD_CQR_NEED_ERP) {
2101 erp_fn = device->discipline->erp_action(cqr);
2102 erp_fn(cqr);
2103 return 1;
2104 }
2105 if (cqr->status == DASD_CQR_FAILED)
2106 dasd_log_sense(cqr, &cqr->irb);
2107 if (cqr->refers) {
2108 __dasd_process_erp(device, cqr);
2109 return 1;
2110 }
2111 }
2112 return 0;
2113 }
2114
2115 static int __dasd_sleep_on_loop_condition(struct dasd_ccw_req *cqr)
2116 {
2117 if (test_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags)) {
2118 if (cqr->refers) /* erp is not done yet */
2119 return 1;
2120 return ((cqr->status != DASD_CQR_DONE) &&
2121 (cqr->status != DASD_CQR_FAILED));
2122 } else
2123 return (cqr->status == DASD_CQR_FILLED);
2124 }
2125
2126 static int _dasd_sleep_on(struct dasd_ccw_req *maincqr, int interruptible)
2127 {
2128 struct dasd_device *device;
2129 int rc;
2130 struct list_head ccw_queue;
2131 struct dasd_ccw_req *cqr;
2132
2133 INIT_LIST_HEAD(&ccw_queue);
2134 maincqr->status = DASD_CQR_FILLED;
2135 device = maincqr->startdev;
2136 list_add(&maincqr->blocklist, &ccw_queue);
2137 for (cqr = maincqr; __dasd_sleep_on_loop_condition(cqr);
2138 cqr = list_first_entry(&ccw_queue,
2139 struct dasd_ccw_req, blocklist)) {
2140
2141 if (__dasd_sleep_on_erp(cqr))
2142 continue;
2143 if (cqr->status != DASD_CQR_FILLED) /* could be failed */
2144 continue;
2145 if (test_bit(DASD_FLAG_LOCK_STOLEN, &device->flags) &&
2146 !test_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags)) {
2147 cqr->status = DASD_CQR_FAILED;
2148 cqr->intrc = -EPERM;
2149 continue;
2150 }
2151 /* Non-temporary stop condition will trigger fail fast */
2152 if (device->stopped & ~DASD_STOPPED_PENDING &&
2153 test_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags) &&
2154 (!dasd_eer_enabled(device))) {
2155 cqr->status = DASD_CQR_FAILED;
2156 continue;
2157 }
2158 /* Don't try to start requests if device is stopped */
2159 if (interruptible) {
2160 rc = wait_event_interruptible(
2161 generic_waitq, !(device->stopped));
2162 if (rc == -ERESTARTSYS) {
2163 cqr->status = DASD_CQR_FAILED;
2164 maincqr->intrc = rc;
2165 continue;
2166 }
2167 } else
2168 wait_event(generic_waitq, !(device->stopped));
2169
2170 cqr->callback = dasd_wakeup_cb;
2171 cqr->callback_data = DASD_SLEEPON_START_TAG;
2172 dasd_add_request_tail(cqr);
2173 if (interruptible) {
2174 rc = wait_event_interruptible(
2175 generic_waitq, _wait_for_wakeup(cqr));
2176 if (rc == -ERESTARTSYS) {
2177 dasd_cancel_req(cqr);
2178 /* wait (non-interruptible) for final status */
2179 wait_event(generic_waitq,
2180 _wait_for_wakeup(cqr));
2181 cqr->status = DASD_CQR_FAILED;
2182 maincqr->intrc = rc;
2183 continue;
2184 }
2185 } else
2186 wait_event(generic_waitq, _wait_for_wakeup(cqr));
2187 }
2188
2189 maincqr->endclk = get_clock();
2190 if ((maincqr->status != DASD_CQR_DONE) &&
2191 (maincqr->intrc != -ERESTARTSYS))
2192 dasd_log_sense(maincqr, &maincqr->irb);
2193 if (maincqr->status == DASD_CQR_DONE)
2194 rc = 0;
2195 else if (maincqr->intrc)
2196 rc = maincqr->intrc;
2197 else
2198 rc = -EIO;
2199 return rc;
2200 }
2201
2202 /*
2203 * Queue a request to the tail of the device ccw_queue and wait for
2204 * it's completion.
2205 */
2206 int dasd_sleep_on(struct dasd_ccw_req *cqr)
2207 {
2208 return _dasd_sleep_on(cqr, 0);
2209 }
2210
2211 /*
2212 * Queue a request to the tail of the device ccw_queue and wait
2213 * interruptible for it's completion.
2214 */
2215 int dasd_sleep_on_interruptible(struct dasd_ccw_req *cqr)
2216 {
2217 return _dasd_sleep_on(cqr, 1);
2218 }
2219
2220 /*
2221 * Whoa nelly now it gets really hairy. For some functions (e.g. steal lock
2222 * for eckd devices) the currently running request has to be terminated
2223 * and be put back to status queued, before the special request is added
2224 * to the head of the queue. Then the special request is waited on normally.
2225 */
2226 static inline int _dasd_term_running_cqr(struct dasd_device *device)
2227 {
2228 struct dasd_ccw_req *cqr;
2229 int rc;
2230
2231 if (list_empty(&device->ccw_queue))
2232 return 0;
2233 cqr = list_entry(device->ccw_queue.next, struct dasd_ccw_req, devlist);
2234 rc = device->discipline->term_IO(cqr);
2235 if (!rc)
2236 /*
2237 * CQR terminated because a more important request is pending.
2238 * Undo decreasing of retry counter because this is
2239 * not an error case.
2240 */
2241 cqr->retries++;
2242 return rc;
2243 }
2244
2245 int dasd_sleep_on_immediatly(struct dasd_ccw_req *cqr)
2246 {
2247 struct dasd_device *device;
2248 int rc;
2249
2250 device = cqr->startdev;
2251 if (test_bit(DASD_FLAG_LOCK_STOLEN, &device->flags) &&
2252 !test_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags)) {
2253 cqr->status = DASD_CQR_FAILED;
2254 cqr->intrc = -EPERM;
2255 return -EIO;
2256 }
2257 spin_lock_irq(get_ccwdev_lock(device->cdev));
2258 rc = _dasd_term_running_cqr(device);
2259 if (rc) {
2260 spin_unlock_irq(get_ccwdev_lock(device->cdev));
2261 return rc;
2262 }
2263 cqr->callback = dasd_wakeup_cb;
2264 cqr->callback_data = DASD_SLEEPON_START_TAG;
2265 cqr->status = DASD_CQR_QUEUED;
2266 list_add(&cqr->devlist, &device->ccw_queue);
2267
2268 /* let the bh start the request to keep them in order */
2269 dasd_schedule_device_bh(device);
2270
2271 spin_unlock_irq(get_ccwdev_lock(device->cdev));
2272
2273 wait_event(generic_waitq, _wait_for_wakeup(cqr));
2274
2275 if (cqr->status == DASD_CQR_DONE)
2276 rc = 0;
2277 else if (cqr->intrc)
2278 rc = cqr->intrc;
2279 else
2280 rc = -EIO;
2281 return rc;
2282 }
2283
2284 /*
2285 * Cancels a request that was started with dasd_sleep_on_req.
2286 * This is useful to timeout requests. The request will be
2287 * terminated if it is currently in i/o.
2288 * Returns 1 if the request has been terminated.
2289 * 0 if there was no need to terminate the request (not started yet)
2290 * negative error code if termination failed
2291 * Cancellation of a request is an asynchronous operation! The calling
2292 * function has to wait until the request is properly returned via callback.
2293 */
2294 int dasd_cancel_req(struct dasd_ccw_req *cqr)
2295 {
2296 struct dasd_device *device = cqr->startdev;
2297 unsigned long flags;
2298 int rc;
2299
2300 rc = 0;
2301 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags);
2302 switch (cqr->status) {
2303 case DASD_CQR_QUEUED:
2304 /* request was not started - just set to cleared */
2305 cqr->status = DASD_CQR_CLEARED;
2306 break;
2307 case DASD_CQR_IN_IO:
2308 /* request in IO - terminate IO and release again */
2309 rc = device->discipline->term_IO(cqr);
2310 if (rc) {
2311 dev_err(&device->cdev->dev,
2312 "Cancelling request %p failed with rc=%d\n",
2313 cqr, rc);
2314 } else {
2315 cqr->stopclk = get_clock();
2316 }
2317 break;
2318 default: /* already finished or clear pending - do nothing */
2319 break;
2320 }
2321 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags);
2322 dasd_schedule_device_bh(device);
2323 return rc;
2324 }
2325
2326
2327 /*
2328 * SECTION: Operations of the dasd_block layer.
2329 */
2330
2331 /*
2332 * Timeout function for dasd_block. This is used when the block layer
2333 * is waiting for something that may not come reliably, (e.g. a state
2334 * change interrupt)
2335 */
2336 static void dasd_block_timeout(unsigned long ptr)
2337 {
2338 unsigned long flags;
2339 struct dasd_block *block;
2340
2341 block = (struct dasd_block *) ptr;
2342 spin_lock_irqsave(get_ccwdev_lock(block->base->cdev), flags);
2343 /* re-activate request queue */
2344 dasd_device_remove_stop_bits(block->base, DASD_STOPPED_PENDING);
2345 spin_unlock_irqrestore(get_ccwdev_lock(block->base->cdev), flags);
2346 dasd_schedule_block_bh(block);
2347 }
2348
2349 /*
2350 * Setup timeout for a dasd_block in jiffies.
2351 */
2352 void dasd_block_set_timer(struct dasd_block *block, int expires)
2353 {
2354 if (expires == 0)
2355 del_timer(&block->timer);
2356 else
2357 mod_timer(&block->timer, jiffies + expires);
2358 }
2359
2360 /*
2361 * Clear timeout for a dasd_block.
2362 */
2363 void dasd_block_clear_timer(struct dasd_block *block)
2364 {
2365 del_timer(&block->timer);
2366 }
2367
2368 /*
2369 * Process finished error recovery ccw.
2370 */
2371 static void __dasd_process_erp(struct dasd_device *device,
2372 struct dasd_ccw_req *cqr)
2373 {
2374 dasd_erp_fn_t erp_fn;
2375
2376 if (cqr->status == DASD_CQR_DONE)
2377 DBF_DEV_EVENT(DBF_NOTICE, device, "%s", "ERP successful");
2378 else
2379 dev_err(&device->cdev->dev, "ERP failed for the DASD\n");
2380 erp_fn = device->discipline->erp_postaction(cqr);
2381 erp_fn(cqr);
2382 }
2383
2384 /*
2385 * Fetch requests from the block device queue.
2386 */
2387 static void __dasd_process_request_queue(struct dasd_block *block)
2388 {
2389 struct request_queue *queue;
2390 struct request *req;
2391 struct dasd_ccw_req *cqr;
2392 struct dasd_device *basedev;
2393 unsigned long flags;
2394 queue = block->request_queue;
2395 basedev = block->base;
2396 /* No queue ? Then there is nothing to do. */
2397 if (queue == NULL)
2398 return;
2399
2400 /*
2401 * We requeue request from the block device queue to the ccw
2402 * queue only in two states. In state DASD_STATE_READY the
2403 * partition detection is done and we need to requeue requests
2404 * for that. State DASD_STATE_ONLINE is normal block device
2405 * operation.
2406 */
2407 if (basedev->state < DASD_STATE_READY) {
2408 while ((req = blk_fetch_request(block->request_queue)))
2409 __blk_end_request_all(req, -EIO);
2410 return;
2411 }
2412 /* Now we try to fetch requests from the request queue */
2413 while ((req = blk_peek_request(queue))) {
2414 if (basedev->features & DASD_FEATURE_READONLY &&
2415 rq_data_dir(req) == WRITE) {
2416 DBF_DEV_EVENT(DBF_ERR, basedev,
2417 "Rejecting write request %p",
2418 req);
2419 blk_start_request(req);
2420 __blk_end_request_all(req, -EIO);
2421 continue;
2422 }
2423 cqr = basedev->discipline->build_cp(basedev, block, req);
2424 if (IS_ERR(cqr)) {
2425 if (PTR_ERR(cqr) == -EBUSY)
2426 break; /* normal end condition */
2427 if (PTR_ERR(cqr) == -ENOMEM)
2428 break; /* terminate request queue loop */
2429 if (PTR_ERR(cqr) == -EAGAIN) {
2430 /*
2431 * The current request cannot be build right
2432 * now, we have to try later. If this request
2433 * is the head-of-queue we stop the device
2434 * for 1/2 second.
2435 */
2436 if (!list_empty(&block->ccw_queue))
2437 break;
2438 spin_lock_irqsave(
2439 get_ccwdev_lock(basedev->cdev), flags);
2440 dasd_device_set_stop_bits(basedev,
2441 DASD_STOPPED_PENDING);
2442 spin_unlock_irqrestore(
2443 get_ccwdev_lock(basedev->cdev), flags);
2444 dasd_block_set_timer(block, HZ/2);
2445 break;
2446 }
2447 DBF_DEV_EVENT(DBF_ERR, basedev,
2448 "CCW creation failed (rc=%ld) "
2449 "on request %p",
2450 PTR_ERR(cqr), req);
2451 blk_start_request(req);
2452 __blk_end_request_all(req, -EIO);
2453 continue;
2454 }
2455 /*
2456 * Note: callback is set to dasd_return_cqr_cb in
2457 * __dasd_block_start_head to cover erp requests as well
2458 */
2459 cqr->callback_data = (void *) req;
2460 cqr->status = DASD_CQR_FILLED;
2461 blk_start_request(req);
2462 list_add_tail(&cqr->blocklist, &block->ccw_queue);
2463 dasd_profile_start(block, cqr, req);
2464 }
2465 }
2466
2467 static void __dasd_cleanup_cqr(struct dasd_ccw_req *cqr)
2468 {
2469 struct request *req;
2470 int status;
2471 int error = 0;
2472
2473 req = (struct request *) cqr->callback_data;
2474 dasd_profile_end(cqr->block, cqr, req);
2475 status = cqr->block->base->discipline->free_cp(cqr, req);
2476 if (status <= 0)
2477 error = status ? status : -EIO;
2478 __blk_end_request_all(req, error);
2479 }
2480
2481 /*
2482 * Process ccw request queue.
2483 */
2484 static void __dasd_process_block_ccw_queue(struct dasd_block *block,
2485 struct list_head *final_queue)
2486 {
2487 struct list_head *l, *n;
2488 struct dasd_ccw_req *cqr;
2489 dasd_erp_fn_t erp_fn;
2490 unsigned long flags;
2491 struct dasd_device *base = block->base;
2492
2493 restart:
2494 /* Process request with final status. */
2495 list_for_each_safe(l, n, &block->ccw_queue) {
2496 cqr = list_entry(l, struct dasd_ccw_req, blocklist);
2497 if (cqr->status != DASD_CQR_DONE &&
2498 cqr->status != DASD_CQR_FAILED &&
2499 cqr->status != DASD_CQR_NEED_ERP &&
2500 cqr->status != DASD_CQR_TERMINATED)
2501 continue;
2502
2503 if (cqr->status == DASD_CQR_TERMINATED) {
2504 base->discipline->handle_terminated_request(cqr);
2505 goto restart;
2506 }
2507
2508 /* Process requests that may be recovered */
2509 if (cqr->status == DASD_CQR_NEED_ERP) {
2510 erp_fn = base->discipline->erp_action(cqr);
2511 if (IS_ERR(erp_fn(cqr)))
2512 continue;
2513 goto restart;
2514 }
2515
2516 /* log sense for fatal error */
2517 if (cqr->status == DASD_CQR_FAILED) {
2518 dasd_log_sense(cqr, &cqr->irb);
2519 }
2520
2521 /* First of all call extended error reporting. */
2522 if (dasd_eer_enabled(base) &&
2523 cqr->status == DASD_CQR_FAILED) {
2524 dasd_eer_write(base, cqr, DASD_EER_FATALERROR);
2525
2526 /* restart request */
2527 cqr->status = DASD_CQR_FILLED;
2528 cqr->retries = 255;
2529 spin_lock_irqsave(get_ccwdev_lock(base->cdev), flags);
2530 dasd_device_set_stop_bits(base, DASD_STOPPED_QUIESCE);
2531 spin_unlock_irqrestore(get_ccwdev_lock(base->cdev),
2532 flags);
2533 goto restart;
2534 }
2535
2536 /* Process finished ERP request. */
2537 if (cqr->refers) {
2538 __dasd_process_erp(base, cqr);
2539 goto restart;
2540 }
2541
2542 /* Rechain finished requests to final queue */
2543 cqr->endclk = get_clock();
2544 list_move_tail(&cqr->blocklist, final_queue);
2545 }
2546 }
2547
2548 static void dasd_return_cqr_cb(struct dasd_ccw_req *cqr, void *data)
2549 {
2550 dasd_schedule_block_bh(cqr->block);
2551 }
2552
2553 static void __dasd_block_start_head(struct dasd_block *block)
2554 {
2555 struct dasd_ccw_req *cqr;
2556
2557 if (list_empty(&block->ccw_queue))
2558 return;
2559 /* We allways begin with the first requests on the queue, as some
2560 * of previously started requests have to be enqueued on a
2561 * dasd_device again for error recovery.
2562 */
2563 list_for_each_entry(cqr, &block->ccw_queue, blocklist) {
2564 if (cqr->status != DASD_CQR_FILLED)
2565 continue;
2566 if (test_bit(DASD_FLAG_LOCK_STOLEN, &block->base->flags) &&
2567 !test_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags)) {
2568 cqr->status = DASD_CQR_FAILED;
2569 cqr->intrc = -EPERM;
2570 dasd_schedule_block_bh(block);
2571 continue;
2572 }
2573 /* Non-temporary stop condition will trigger fail fast */
2574 if (block->base->stopped & ~DASD_STOPPED_PENDING &&
2575 test_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags) &&
2576 (!dasd_eer_enabled(block->base))) {
2577 cqr->status = DASD_CQR_FAILED;
2578 dasd_schedule_block_bh(block);
2579 continue;
2580 }
2581 /* Don't try to start requests if device is stopped */
2582 if (block->base->stopped)
2583 return;
2584
2585 /* just a fail safe check, should not happen */
2586 if (!cqr->startdev)
2587 cqr->startdev = block->base;
2588
2589 /* make sure that the requests we submit find their way back */
2590 cqr->callback = dasd_return_cqr_cb;
2591
2592 dasd_add_request_tail(cqr);
2593 }
2594 }
2595
2596 /*
2597 * Central dasd_block layer routine. Takes requests from the generic
2598 * block layer request queue, creates ccw requests, enqueues them on
2599 * a dasd_device and processes ccw requests that have been returned.
2600 */
2601 static void dasd_block_tasklet(struct dasd_block *block)
2602 {
2603 struct list_head final_queue;
2604 struct list_head *l, *n;
2605 struct dasd_ccw_req *cqr;
2606
2607 atomic_set(&block->tasklet_scheduled, 0);
2608 INIT_LIST_HEAD(&final_queue);
2609 spin_lock(&block->queue_lock);
2610 /* Finish off requests on ccw queue */
2611 __dasd_process_block_ccw_queue(block, &final_queue);
2612 spin_unlock(&block->queue_lock);
2613 /* Now call the callback function of requests with final status */
2614 spin_lock_irq(&block->request_queue_lock);
2615 list_for_each_safe(l, n, &final_queue) {
2616 cqr = list_entry(l, struct dasd_ccw_req, blocklist);
2617 list_del_init(&cqr->blocklist);
2618 __dasd_cleanup_cqr(cqr);
2619 }
2620 spin_lock(&block->queue_lock);
2621 /* Get new request from the block device request queue */
2622 __dasd_process_request_queue(block);
2623 /* Now check if the head of the ccw queue needs to be started. */
2624 __dasd_block_start_head(block);
2625 spin_unlock(&block->queue_lock);
2626 spin_unlock_irq(&block->request_queue_lock);
2627 dasd_put_device(block->base);
2628 }
2629
2630 static void _dasd_wake_block_flush_cb(struct dasd_ccw_req *cqr, void *data)
2631 {
2632 wake_up(&dasd_flush_wq);
2633 }
2634
2635 /*
2636 * Go through all request on the dasd_block request queue, cancel them
2637 * on the respective dasd_device, and return them to the generic
2638 * block layer.
2639 */
2640 static int dasd_flush_block_queue(struct dasd_block *block)
2641 {
2642 struct dasd_ccw_req *cqr, *n;
2643 int rc, i;
2644 struct list_head flush_queue;
2645
2646 INIT_LIST_HEAD(&flush_queue);
2647 spin_lock_bh(&block->queue_lock);
2648 rc = 0;
2649 restart:
2650 list_for_each_entry_safe(cqr, n, &block->ccw_queue, blocklist) {
2651 /* if this request currently owned by a dasd_device cancel it */
2652 if (cqr->status >= DASD_CQR_QUEUED)
2653 rc = dasd_cancel_req(cqr);
2654 if (rc < 0)
2655 break;
2656 /* Rechain request (including erp chain) so it won't be
2657 * touched by the dasd_block_tasklet anymore.
2658 * Replace the callback so we notice when the request
2659 * is returned from the dasd_device layer.
2660 */
2661 cqr->callback = _dasd_wake_block_flush_cb;
2662 for (i = 0; cqr != NULL; cqr = cqr->refers, i++)
2663 list_move_tail(&cqr->blocklist, &flush_queue);
2664 if (i > 1)
2665 /* moved more than one request - need to restart */
2666 goto restart;
2667 }
2668 spin_unlock_bh(&block->queue_lock);
2669 /* Now call the callback function of flushed requests */
2670 restart_cb:
2671 list_for_each_entry_safe(cqr, n, &flush_queue, blocklist) {
2672 wait_event(dasd_flush_wq, (cqr->status < DASD_CQR_QUEUED));
2673 /* Process finished ERP request. */
2674 if (cqr->refers) {
2675 spin_lock_bh(&block->queue_lock);
2676 __dasd_process_erp(block->base, cqr);
2677 spin_unlock_bh(&block->queue_lock);
2678 /* restart list_for_xx loop since dasd_process_erp
2679 * might remove multiple elements */
2680 goto restart_cb;
2681 }
2682 /* call the callback function */
2683 spin_lock_irq(&block->request_queue_lock);
2684 cqr->endclk = get_clock();
2685 list_del_init(&cqr->blocklist);
2686 __dasd_cleanup_cqr(cqr);
2687 spin_unlock_irq(&block->request_queue_lock);
2688 }
2689 return rc;
2690 }
2691
2692 /*
2693 * Schedules a call to dasd_tasklet over the device tasklet.
2694 */
2695 void dasd_schedule_block_bh(struct dasd_block *block)
2696 {
2697 /* Protect against rescheduling. */
2698 if (atomic_cmpxchg(&block->tasklet_scheduled, 0, 1) != 0)
2699 return;
2700 /* life cycle of block is bound to it's base device */
2701 dasd_get_device(block->base);
2702 tasklet_hi_schedule(&block->tasklet);
2703 }
2704
2705
2706 /*
2707 * SECTION: external block device operations
2708 * (request queue handling, open, release, etc.)
2709 */
2710
2711 /*
2712 * Dasd request queue function. Called from ll_rw_blk.c
2713 */
2714 static void do_dasd_request(struct request_queue *queue)
2715 {
2716 struct dasd_block *block;
2717
2718 block = queue->queuedata;
2719 spin_lock(&block->queue_lock);
2720 /* Get new request from the block device request queue */
2721 __dasd_process_request_queue(block);
2722 /* Now check if the head of the ccw queue needs to be started. */
2723 __dasd_block_start_head(block);
2724 spin_unlock(&block->queue_lock);
2725 }
2726
2727 /*
2728 * Allocate and initialize request queue and default I/O scheduler.
2729 */
2730 static int dasd_alloc_queue(struct dasd_block *block)
2731 {
2732 int rc;
2733
2734 block->request_queue = blk_init_queue(do_dasd_request,
2735 &block->request_queue_lock);
2736 if (block->request_queue == NULL)
2737 return -ENOMEM;
2738
2739 block->request_queue->queuedata = block;
2740
2741 elevator_exit(block->request_queue->elevator);
2742 block->request_queue->elevator = NULL;
2743 rc = elevator_init(block->request_queue, "deadline");
2744 if (rc) {
2745 blk_cleanup_queue(block->request_queue);
2746 return rc;
2747 }
2748 return 0;
2749 }
2750
2751 /*
2752 * Allocate and initialize request queue.
2753 */
2754 static void dasd_setup_queue(struct dasd_block *block)
2755 {
2756 int max;
2757
2758 if (block->base->features & DASD_FEATURE_USERAW) {
2759 /*
2760 * the max_blocks value for raw_track access is 256
2761 * it is higher than the native ECKD value because we
2762 * only need one ccw per track
2763 * so the max_hw_sectors are
2764 * 2048 x 512B = 1024kB = 16 tracks
2765 */
2766 max = 2048;
2767 } else {
2768 max = block->base->discipline->max_blocks << block->s2b_shift;
2769 }
2770 blk_queue_logical_block_size(block->request_queue,
2771 block->bp_block);
2772 blk_queue_max_hw_sectors(block->request_queue, max);
2773 blk_queue_max_segments(block->request_queue, -1L);
2774 /* with page sized segments we can translate each segement into
2775 * one idaw/tidaw
2776 */
2777 blk_queue_max_segment_size(block->request_queue, PAGE_SIZE);
2778 blk_queue_segment_boundary(block->request_queue, PAGE_SIZE - 1);
2779 }
2780
2781 /*
2782 * Deactivate and free request queue.
2783 */
2784 static void dasd_free_queue(struct dasd_block *block)
2785 {
2786 if (block->request_queue) {
2787 blk_cleanup_queue(block->request_queue);
2788 block->request_queue = NULL;
2789 }
2790 }
2791
2792 /*
2793 * Flush request on the request queue.
2794 */
2795 static void dasd_flush_request_queue(struct dasd_block *block)
2796 {
2797 struct request *req;
2798
2799 if (!block->request_queue)
2800 return;
2801
2802 spin_lock_irq(&block->request_queue_lock);
2803 while ((req = blk_fetch_request(block->request_queue)))
2804 __blk_end_request_all(req, -EIO);
2805 spin_unlock_irq(&block->request_queue_lock);
2806 }
2807
2808 static int dasd_open(struct block_device *bdev, fmode_t mode)
2809 {
2810 struct dasd_device *base;
2811 int rc;
2812
2813 base = dasd_device_from_gendisk(bdev->bd_disk);
2814 if (!base)
2815 return -ENODEV;
2816
2817 atomic_inc(&base->block->open_count);
2818 if (test_bit(DASD_FLAG_OFFLINE, &base->flags)) {
2819 rc = -ENODEV;
2820 goto unlock;
2821 }
2822
2823 if (!try_module_get(base->discipline->owner)) {
2824 rc = -EINVAL;
2825 goto unlock;
2826 }
2827
2828 if (dasd_probeonly) {
2829 dev_info(&base->cdev->dev,
2830 "Accessing the DASD failed because it is in "
2831 "probeonly mode\n");
2832 rc = -EPERM;
2833 goto out;
2834 }
2835
2836 if (base->state <= DASD_STATE_BASIC) {
2837 DBF_DEV_EVENT(DBF_ERR, base, " %s",
2838 " Cannot open unrecognized device");
2839 rc = -ENODEV;
2840 goto out;
2841 }
2842
2843 if ((mode & FMODE_WRITE) &&
2844 (test_bit(DASD_FLAG_DEVICE_RO, &base->flags) ||
2845 (base->features & DASD_FEATURE_READONLY))) {
2846 rc = -EROFS;
2847 goto out;
2848 }
2849
2850 dasd_put_device(base);
2851 return 0;
2852
2853 out:
2854 module_put(base->discipline->owner);
2855 unlock:
2856 atomic_dec(&base->block->open_count);
2857 dasd_put_device(base);
2858 return rc;
2859 }
2860
2861 static int dasd_release(struct gendisk *disk, fmode_t mode)
2862 {
2863 struct dasd_device *base;
2864
2865 base = dasd_device_from_gendisk(disk);
2866 if (!base)
2867 return -ENODEV;
2868
2869 atomic_dec(&base->block->open_count);
2870 module_put(base->discipline->owner);
2871 dasd_put_device(base);
2872 return 0;
2873 }
2874
2875 /*
2876 * Return disk geometry.
2877 */
2878 static int dasd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
2879 {
2880 struct dasd_device *base;
2881
2882 base = dasd_device_from_gendisk(bdev->bd_disk);
2883 if (!base)
2884 return -ENODEV;
2885
2886 if (!base->discipline ||
2887 !base->discipline->fill_geometry) {
2888 dasd_put_device(base);
2889 return -EINVAL;
2890 }
2891 base->discipline->fill_geometry(base->block, geo);
2892 geo->start = get_start_sect(bdev) >> base->block->s2b_shift;
2893 dasd_put_device(base);
2894 return 0;
2895 }
2896
2897 const struct block_device_operations
2898 dasd_device_operations = {
2899 .owner = THIS_MODULE,
2900 .open = dasd_open,
2901 .release = dasd_release,
2902 .ioctl = dasd_ioctl,
2903 .compat_ioctl = dasd_ioctl,
2904 .getgeo = dasd_getgeo,
2905 };
2906
2907 /*******************************************************************************
2908 * end of block device operations
2909 */
2910
2911 static void
2912 dasd_exit(void)
2913 {
2914 #ifdef CONFIG_PROC_FS
2915 dasd_proc_exit();
2916 #endif
2917 dasd_eer_exit();
2918 if (dasd_page_cache != NULL) {
2919 kmem_cache_destroy(dasd_page_cache);
2920 dasd_page_cache = NULL;
2921 }
2922 dasd_gendisk_exit();
2923 dasd_devmap_exit();
2924 if (dasd_debug_area != NULL) {
2925 debug_unregister(dasd_debug_area);
2926 dasd_debug_area = NULL;
2927 }
2928 dasd_statistics_removeroot();
2929 }
2930
2931 /*
2932 * SECTION: common functions for ccw_driver use
2933 */
2934
2935 /*
2936 * Is the device read-only?
2937 * Note that this function does not report the setting of the
2938 * readonly device attribute, but how it is configured in z/VM.
2939 */
2940 int dasd_device_is_ro(struct dasd_device *device)
2941 {
2942 struct ccw_dev_id dev_id;
2943 struct diag210 diag_data;
2944 int rc;
2945
2946 if (!MACHINE_IS_VM)
2947 return 0;
2948 ccw_device_get_id(device->cdev, &dev_id);
2949 memset(&diag_data, 0, sizeof(diag_data));
2950 diag_data.vrdcdvno = dev_id.devno;
2951 diag_data.vrdclen = sizeof(diag_data);
2952 rc = diag210(&diag_data);
2953 if (rc == 0 || rc == 2) {
2954 return diag_data.vrdcvfla & 0x80;
2955 } else {
2956 DBF_EVENT(DBF_WARNING, "diag210 failed for dev=%04x with rc=%d",
2957 dev_id.devno, rc);
2958 return 0;
2959 }
2960 }
2961 EXPORT_SYMBOL_GPL(dasd_device_is_ro);
2962
2963 static void dasd_generic_auto_online(void *data, async_cookie_t cookie)
2964 {
2965 struct ccw_device *cdev = data;
2966 int ret;
2967
2968 ret = ccw_device_set_online(cdev);
2969 if (ret)
2970 pr_warning("%s: Setting the DASD online failed with rc=%d\n",
2971 dev_name(&cdev->dev), ret);
2972 }
2973
2974 /*
2975 * Initial attempt at a probe function. this can be simplified once
2976 * the other detection code is gone.
2977 */
2978 int dasd_generic_probe(struct ccw_device *cdev,
2979 struct dasd_discipline *discipline)
2980 {
2981 int ret;
2982
2983 ret = dasd_add_sysfs_files(cdev);
2984 if (ret) {
2985 DBF_EVENT_DEVID(DBF_WARNING, cdev, "%s",
2986 "dasd_generic_probe: could not add "
2987 "sysfs entries");
2988 return ret;
2989 }
2990 cdev->handler = &dasd_int_handler;
2991
2992 /*
2993 * Automatically online either all dasd devices (dasd_autodetect)
2994 * or all devices specified with dasd= parameters during
2995 * initial probe.
2996 */
2997 if ((dasd_get_feature(cdev, DASD_FEATURE_INITIAL_ONLINE) > 0 ) ||
2998 (dasd_autodetect && dasd_busid_known(dev_name(&cdev->dev)) != 0))
2999 async_schedule(dasd_generic_auto_online, cdev);
3000 return 0;
3001 }
3002
3003 /*
3004 * This will one day be called from a global not_oper handler.
3005 * It is also used by driver_unregister during module unload.
3006 */
3007 void dasd_generic_remove(struct ccw_device *cdev)
3008 {
3009 struct dasd_device *device;
3010 struct dasd_block *block;
3011
3012 cdev->handler = NULL;
3013
3014 dasd_remove_sysfs_files(cdev);
3015 device = dasd_device_from_cdev(cdev);
3016 if (IS_ERR(device))
3017 return;
3018 if (test_and_set_bit(DASD_FLAG_OFFLINE, &device->flags)) {
3019 /* Already doing offline processing */
3020 dasd_put_device(device);
3021 return;
3022 }
3023 /*
3024 * This device is removed unconditionally. Set offline
3025 * flag to prevent dasd_open from opening it while it is
3026 * no quite down yet.
3027 */
3028 dasd_set_target_state(device, DASD_STATE_NEW);
3029 /* dasd_delete_device destroys the device reference. */
3030 block = device->block;
3031 dasd_delete_device(device);
3032 /*
3033 * life cycle of block is bound to device, so delete it after
3034 * device was safely removed
3035 */
3036 if (block)
3037 dasd_free_block(block);
3038 }
3039
3040 /*
3041 * Activate a device. This is called from dasd_{eckd,fba}_probe() when either
3042 * the device is detected for the first time and is supposed to be used
3043 * or the user has started activation through sysfs.
3044 */
3045 int dasd_generic_set_online(struct ccw_device *cdev,
3046 struct dasd_discipline *base_discipline)
3047 {
3048 struct dasd_discipline *discipline;
3049 struct dasd_device *device;
3050 int rc;
3051
3052 /* first online clears initial online feature flag */
3053 dasd_set_feature(cdev, DASD_FEATURE_INITIAL_ONLINE, 0);
3054 device = dasd_create_device(cdev);
3055 if (IS_ERR(device))
3056 return PTR_ERR(device);
3057
3058 discipline = base_discipline;
3059 if (device->features & DASD_FEATURE_USEDIAG) {
3060 if (!dasd_diag_discipline_pointer) {
3061 pr_warning("%s Setting the DASD online failed because "
3062 "of missing DIAG discipline\n",
3063 dev_name(&cdev->dev));
3064 dasd_delete_device(device);
3065 return -ENODEV;
3066 }
3067 discipline = dasd_diag_discipline_pointer;
3068 }
3069 if (!try_module_get(base_discipline->owner)) {
3070 dasd_delete_device(device);
3071 return -EINVAL;
3072 }
3073 if (!try_module_get(discipline->owner)) {
3074 module_put(base_discipline->owner);
3075 dasd_delete_device(device);
3076 return -EINVAL;
3077 }
3078 device->base_discipline = base_discipline;
3079 device->discipline = discipline;
3080
3081 /* check_device will allocate block device if necessary */
3082 rc = discipline->check_device(device);
3083 if (rc) {
3084 pr_warning("%s Setting the DASD online with discipline %s "
3085 "failed with rc=%i\n",
3086 dev_name(&cdev->dev), discipline->name, rc);
3087 module_put(discipline->owner);
3088 module_put(base_discipline->owner);
3089 dasd_delete_device(device);
3090 return rc;
3091 }
3092
3093 dasd_set_target_state(device, DASD_STATE_ONLINE);
3094 if (device->state <= DASD_STATE_KNOWN) {
3095 pr_warning("%s Setting the DASD online failed because of a "
3096 "missing discipline\n", dev_name(&cdev->dev));
3097 rc = -ENODEV;
3098 dasd_set_target_state(device, DASD_STATE_NEW);
3099 if (device->block)
3100 dasd_free_block(device->block);
3101 dasd_delete_device(device);
3102 } else
3103 pr_debug("dasd_generic device %s found\n",
3104 dev_name(&cdev->dev));
3105
3106 wait_event(dasd_init_waitq, _wait_for_device(device));
3107
3108 dasd_put_device(device);
3109 return rc;
3110 }
3111
3112 int dasd_generic_set_offline(struct ccw_device *cdev)
3113 {
3114 struct dasd_device *device;
3115 struct dasd_block *block;
3116 int max_count, open_count;
3117
3118 device = dasd_device_from_cdev(cdev);
3119 if (IS_ERR(device))
3120 return PTR_ERR(device);
3121 if (test_and_set_bit(DASD_FLAG_OFFLINE, &device->flags)) {
3122 /* Already doing offline processing */
3123 dasd_put_device(device);
3124 return 0;
3125 }
3126 /*
3127 * We must make sure that this device is currently not in use.
3128 * The open_count is increased for every opener, that includes
3129 * the blkdev_get in dasd_scan_partitions. We are only interested
3130 * in the other openers.
3131 */
3132 if (device->block) {
3133 max_count = device->block->bdev ? 0 : -1;
3134 open_count = atomic_read(&device->block->open_count);
3135 if (open_count > max_count) {
3136 if (open_count > 0)
3137 pr_warning("%s: The DASD cannot be set offline "
3138 "with open count %i\n",
3139 dev_name(&cdev->dev), open_count);
3140 else
3141 pr_warning("%s: The DASD cannot be set offline "
3142 "while it is in use\n",
3143 dev_name(&cdev->dev));
3144 clear_bit(DASD_FLAG_OFFLINE, &device->flags);
3145 dasd_put_device(device);
3146 return -EBUSY;
3147 }
3148 }
3149 dasd_set_target_state(device, DASD_STATE_NEW);
3150 /* dasd_delete_device destroys the device reference. */
3151 block = device->block;
3152 dasd_delete_device(device);
3153 /*
3154 * life cycle of block is bound to device, so delete it after
3155 * device was safely removed
3156 */
3157 if (block)
3158 dasd_free_block(block);
3159 return 0;
3160 }
3161
3162 int dasd_generic_last_path_gone(struct dasd_device *device)
3163 {
3164 struct dasd_ccw_req *cqr;
3165
3166 dev_warn(&device->cdev->dev, "No operational channel path is left "
3167 "for the device\n");
3168 DBF_DEV_EVENT(DBF_WARNING, device, "%s", "last path gone");
3169 /* First of all call extended error reporting. */
3170 dasd_eer_write(device, NULL, DASD_EER_NOPATH);
3171
3172 if (device->state < DASD_STATE_BASIC)
3173 return 0;
3174 /* Device is active. We want to keep it. */
3175 list_for_each_entry(cqr, &device->ccw_queue, devlist)
3176 if ((cqr->status == DASD_CQR_IN_IO) ||
3177 (cqr->status == DASD_CQR_CLEAR_PENDING)) {
3178 cqr->status = DASD_CQR_QUEUED;
3179 cqr->retries++;
3180 }
3181 dasd_device_set_stop_bits(device, DASD_STOPPED_DC_WAIT);
3182 dasd_device_clear_timer(device);
3183 dasd_schedule_device_bh(device);
3184 return 1;
3185 }
3186 EXPORT_SYMBOL_GPL(dasd_generic_last_path_gone);
3187
3188 int dasd_generic_path_operational(struct dasd_device *device)
3189 {
3190 dev_info(&device->cdev->dev, "A channel path to the device has become "
3191 "operational\n");
3192 DBF_DEV_EVENT(DBF_WARNING, device, "%s", "path operational");
3193 dasd_device_remove_stop_bits(device, DASD_STOPPED_DC_WAIT);
3194 if (device->stopped & DASD_UNRESUMED_PM) {
3195 dasd_device_remove_stop_bits(device, DASD_UNRESUMED_PM);
3196 dasd_restore_device(device);
3197 return 1;
3198 }
3199 dasd_schedule_device_bh(device);
3200 if (device->block)
3201 dasd_schedule_block_bh(device->block);
3202 return 1;
3203 }
3204 EXPORT_SYMBOL_GPL(dasd_generic_path_operational);
3205
3206 int dasd_generic_notify(struct ccw_device *cdev, int event)
3207 {
3208 struct dasd_device *device;
3209 int ret;
3210
3211 device = dasd_device_from_cdev_locked(cdev);
3212 if (IS_ERR(device))
3213 return 0;
3214 ret = 0;
3215 switch (event) {
3216 case CIO_GONE:
3217 case CIO_BOXED:
3218 case CIO_NO_PATH:
3219 device->path_data.opm = 0;
3220 device->path_data.ppm = 0;
3221 device->path_data.npm = 0;
3222 ret = dasd_generic_last_path_gone(device);
3223 break;
3224 case CIO_OPER:
3225 ret = 1;
3226 if (device->path_data.opm)
3227 ret = dasd_generic_path_operational(device);
3228 break;
3229 }
3230 dasd_put_device(device);
3231 return ret;
3232 }
3233
3234 void dasd_generic_path_event(struct ccw_device *cdev, int *path_event)
3235 {
3236 int chp;
3237 __u8 oldopm, eventlpm;
3238 struct dasd_device *device;
3239
3240 device = dasd_device_from_cdev_locked(cdev);
3241 if (IS_ERR(device))
3242 return;
3243 for (chp = 0; chp < 8; chp++) {
3244 eventlpm = 0x80 >> chp;
3245 if (path_event[chp] & PE_PATH_GONE) {
3246 oldopm = device->path_data.opm;
3247 device->path_data.opm &= ~eventlpm;
3248 device->path_data.ppm &= ~eventlpm;
3249 device->path_data.npm &= ~eventlpm;
3250 if (oldopm && !device->path_data.opm)
3251 dasd_generic_last_path_gone(device);
3252 }
3253 if (path_event[chp] & PE_PATH_AVAILABLE) {
3254 device->path_data.opm &= ~eventlpm;
3255 device->path_data.ppm &= ~eventlpm;
3256 device->path_data.npm &= ~eventlpm;
3257 device->path_data.tbvpm |= eventlpm;
3258 dasd_schedule_device_bh(device);
3259 }
3260 }
3261 dasd_put_device(device);
3262 }
3263 EXPORT_SYMBOL_GPL(dasd_generic_path_event);
3264
3265 int dasd_generic_verify_path(struct dasd_device *device, __u8 lpm)
3266 {
3267 if (!device->path_data.opm && lpm) {
3268 device->path_data.opm = lpm;
3269 dasd_generic_path_operational(device);
3270 } else
3271 device->path_data.opm |= lpm;
3272 return 0;
3273 }
3274 EXPORT_SYMBOL_GPL(dasd_generic_verify_path);
3275
3276
3277 int dasd_generic_pm_freeze(struct ccw_device *cdev)
3278 {
3279 struct dasd_ccw_req *cqr, *n;
3280 int rc;
3281 struct list_head freeze_queue;
3282 struct dasd_device *device = dasd_device_from_cdev(cdev);
3283
3284 if (IS_ERR(device))
3285 return PTR_ERR(device);
3286
3287 if (device->discipline->freeze)
3288 rc = device->discipline->freeze(device);
3289
3290 /* disallow new I/O */
3291 dasd_device_set_stop_bits(device, DASD_STOPPED_PM);
3292 /* clear active requests */
3293 INIT_LIST_HEAD(&freeze_queue);
3294 spin_lock_irq(get_ccwdev_lock(cdev));
3295 rc = 0;
3296 list_for_each_entry_safe(cqr, n, &device->ccw_queue, devlist) {
3297 /* Check status and move request to flush_queue */
3298 if (cqr->status == DASD_CQR_IN_IO) {
3299 rc = device->discipline->term_IO(cqr);
3300 if (rc) {
3301 /* unable to terminate requeust */
3302 dev_err(&device->cdev->dev,
3303 "Unable to terminate request %p "
3304 "on suspend\n", cqr);
3305 spin_unlock_irq(get_ccwdev_lock(cdev));
3306 dasd_put_device(device);
3307 return rc;
3308 }
3309 }
3310 list_move_tail(&cqr->devlist, &freeze_queue);
3311 }
3312
3313 spin_unlock_irq(get_ccwdev_lock(cdev));
3314
3315 list_for_each_entry_safe(cqr, n, &freeze_queue, devlist) {
3316 wait_event(dasd_flush_wq,
3317 (cqr->status != DASD_CQR_CLEAR_PENDING));
3318 if (cqr->status == DASD_CQR_CLEARED)
3319 cqr->status = DASD_CQR_QUEUED;
3320 }
3321 /* move freeze_queue to start of the ccw_queue */
3322 spin_lock_irq(get_ccwdev_lock(cdev));
3323 list_splice_tail(&freeze_queue, &device->ccw_queue);
3324 spin_unlock_irq(get_ccwdev_lock(cdev));
3325
3326 dasd_put_device(device);
3327 return rc;
3328 }
3329 EXPORT_SYMBOL_GPL(dasd_generic_pm_freeze);
3330
3331 int dasd_generic_restore_device(struct ccw_device *cdev)
3332 {
3333 struct dasd_device *device = dasd_device_from_cdev(cdev);
3334 int rc = 0;
3335
3336 if (IS_ERR(device))
3337 return PTR_ERR(device);
3338
3339 /* allow new IO again */
3340 dasd_device_remove_stop_bits(device,
3341 (DASD_STOPPED_PM | DASD_UNRESUMED_PM));
3342
3343 dasd_schedule_device_bh(device);
3344
3345 /*
3346 * call discipline restore function
3347 * if device is stopped do nothing e.g. for disconnected devices
3348 */
3349 if (device->discipline->restore && !(device->stopped))
3350 rc = device->discipline->restore(device);
3351 if (rc || device->stopped)
3352 /*
3353 * if the resume failed for the DASD we put it in
3354 * an UNRESUMED stop state
3355 */
3356 device->stopped |= DASD_UNRESUMED_PM;
3357
3358 if (device->block)
3359 dasd_schedule_block_bh(device->block);
3360
3361 dasd_put_device(device);
3362 return 0;
3363 }
3364 EXPORT_SYMBOL_GPL(dasd_generic_restore_device);
3365
3366 static struct dasd_ccw_req *dasd_generic_build_rdc(struct dasd_device *device,
3367 void *rdc_buffer,
3368 int rdc_buffer_size,
3369 int magic)
3370 {
3371 struct dasd_ccw_req *cqr;
3372 struct ccw1 *ccw;
3373 unsigned long *idaw;
3374
3375 cqr = dasd_smalloc_request(magic, 1 /* RDC */, rdc_buffer_size, device);
3376
3377 if (IS_ERR(cqr)) {
3378 /* internal error 13 - Allocating the RDC request failed*/
3379 dev_err(&device->cdev->dev,
3380 "An error occurred in the DASD device driver, "
3381 "reason=%s\n", "13");
3382 return cqr;
3383 }
3384
3385 ccw = cqr->cpaddr;
3386 ccw->cmd_code = CCW_CMD_RDC;
3387 if (idal_is_needed(rdc_buffer, rdc_buffer_size)) {
3388 idaw = (unsigned long *) (cqr->data);
3389 ccw->cda = (__u32)(addr_t) idaw;
3390 ccw->flags = CCW_FLAG_IDA;
3391 idaw = idal_create_words(idaw, rdc_buffer, rdc_buffer_size);
3392 } else {
3393 ccw->cda = (__u32)(addr_t) rdc_buffer;
3394 ccw->flags = 0;
3395 }
3396
3397 ccw->count = rdc_buffer_size;
3398 cqr->startdev = device;
3399 cqr->memdev = device;
3400 cqr->expires = 10*HZ;
3401 cqr->retries = 256;
3402 cqr->buildclk = get_clock();
3403 cqr->status = DASD_CQR_FILLED;
3404 return cqr;
3405 }
3406
3407
3408 int dasd_generic_read_dev_chars(struct dasd_device *device, int magic,
3409 void *rdc_buffer, int rdc_buffer_size)
3410 {
3411 int ret;
3412 struct dasd_ccw_req *cqr;
3413
3414 cqr = dasd_generic_build_rdc(device, rdc_buffer, rdc_buffer_size,
3415 magic);
3416 if (IS_ERR(cqr))
3417 return PTR_ERR(cqr);
3418
3419 ret = dasd_sleep_on(cqr);
3420 dasd_sfree_request(cqr, cqr->memdev);
3421 return ret;
3422 }
3423 EXPORT_SYMBOL_GPL(dasd_generic_read_dev_chars);
3424
3425 /*
3426 * In command mode and transport mode we need to look for sense
3427 * data in different places. The sense data itself is allways
3428 * an array of 32 bytes, so we can unify the sense data access
3429 * for both modes.
3430 */
3431 char *dasd_get_sense(struct irb *irb)
3432 {
3433 struct tsb *tsb = NULL;
3434 char *sense = NULL;
3435
3436 if (scsw_is_tm(&irb->scsw) && (irb->scsw.tm.fcxs == 0x01)) {
3437 if (irb->scsw.tm.tcw)
3438 tsb = tcw_get_tsb((struct tcw *)(unsigned long)
3439 irb->scsw.tm.tcw);
3440 if (tsb && tsb->length == 64 && tsb->flags)
3441 switch (tsb->flags & 0x07) {
3442 case 1: /* tsa_iostat */
3443 sense = tsb->tsa.iostat.sense;
3444 break;
3445 case 2: /* tsa_ddpc */
3446 sense = tsb->tsa.ddpc.sense;
3447 break;
3448 default:
3449 /* currently we don't use interrogate data */
3450 break;
3451 }
3452 } else if (irb->esw.esw0.erw.cons) {
3453 sense = irb->ecw;
3454 }
3455 return sense;
3456 }
3457 EXPORT_SYMBOL_GPL(dasd_get_sense);
3458
3459 static int __init dasd_init(void)
3460 {
3461 int rc;
3462
3463 init_waitqueue_head(&dasd_init_waitq);
3464 init_waitqueue_head(&dasd_flush_wq);
3465 init_waitqueue_head(&generic_waitq);
3466
3467 /* register 'common' DASD debug area, used for all DBF_XXX calls */
3468 dasd_debug_area = debug_register("dasd", 1, 1, 8 * sizeof(long));
3469 if (dasd_debug_area == NULL) {
3470 rc = -ENOMEM;
3471 goto failed;
3472 }
3473 debug_register_view(dasd_debug_area, &debug_sprintf_view);
3474 debug_set_level(dasd_debug_area, DBF_WARNING);
3475
3476 DBF_EVENT(DBF_EMERG, "%s", "debug area created");
3477
3478 dasd_diag_discipline_pointer = NULL;
3479
3480 dasd_statistics_createroot();
3481
3482 rc = dasd_devmap_init();
3483 if (rc)
3484 goto failed;
3485 rc = dasd_gendisk_init();
3486 if (rc)
3487 goto failed;
3488 rc = dasd_parse();
3489 if (rc)
3490 goto failed;
3491 rc = dasd_eer_init();
3492 if (rc)
3493 goto failed;
3494 #ifdef CONFIG_PROC_FS
3495 rc = dasd_proc_init();
3496 if (rc)
3497 goto failed;
3498 #endif
3499
3500 return 0;
3501 failed:
3502 pr_info("The DASD device driver could not be initialized\n");
3503 dasd_exit();
3504 return rc;
3505 }
3506
3507 module_init(dasd_init);
3508 module_exit(dasd_exit);
3509
3510 EXPORT_SYMBOL(dasd_debug_area);
3511 EXPORT_SYMBOL(dasd_diag_discipline_pointer);
3512
3513 EXPORT_SYMBOL(dasd_add_request_head);
3514 EXPORT_SYMBOL(dasd_add_request_tail);
3515 EXPORT_SYMBOL(dasd_cancel_req);
3516 EXPORT_SYMBOL(dasd_device_clear_timer);
3517 EXPORT_SYMBOL(dasd_block_clear_timer);
3518 EXPORT_SYMBOL(dasd_enable_device);
3519 EXPORT_SYMBOL(dasd_int_handler);
3520 EXPORT_SYMBOL(dasd_kfree_request);
3521 EXPORT_SYMBOL(dasd_kick_device);
3522 EXPORT_SYMBOL(dasd_kmalloc_request);
3523 EXPORT_SYMBOL(dasd_schedule_device_bh);
3524 EXPORT_SYMBOL(dasd_schedule_block_bh);
3525 EXPORT_SYMBOL(dasd_set_target_state);
3526 EXPORT_SYMBOL(dasd_device_set_timer);
3527 EXPORT_SYMBOL(dasd_block_set_timer);
3528 EXPORT_SYMBOL(dasd_sfree_request);
3529 EXPORT_SYMBOL(dasd_sleep_on);
3530 EXPORT_SYMBOL(dasd_sleep_on_immediatly);
3531 EXPORT_SYMBOL(dasd_sleep_on_interruptible);
3532 EXPORT_SYMBOL(dasd_smalloc_request);
3533 EXPORT_SYMBOL(dasd_start_IO);
3534 EXPORT_SYMBOL(dasd_term_IO);
3535
3536 EXPORT_SYMBOL_GPL(dasd_generic_probe);
3537 EXPORT_SYMBOL_GPL(dasd_generic_remove);
3538 EXPORT_SYMBOL_GPL(dasd_generic_notify);
3539 EXPORT_SYMBOL_GPL(dasd_generic_set_online);
3540 EXPORT_SYMBOL_GPL(dasd_generic_set_offline);
3541 EXPORT_SYMBOL_GPL(dasd_generic_handle_state_change);
3542 EXPORT_SYMBOL_GPL(dasd_flush_device_queue);
3543 EXPORT_SYMBOL_GPL(dasd_alloc_block);
3544 EXPORT_SYMBOL_GPL(dasd_free_block);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree