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