1 // SPDX-License-Identifier: GPL-2.0 2 /* 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 * EMC Symmetrix ioctl Copyright EMC Corporation, 2008 10 * Author.........: Nigel Hislop <hislop_nigel@emc.com> 11 */ 12 13 #define KMSG_COMPONENT "dasd-eckd" 14 15 #include <linux/stddef.h> 16 #include <linux/kernel.h> 17 #include <linux/slab.h> 18 #include <linux/hdreg.h> /* HDIO_GETGEO */ 19 #include <linux/bio.h> 20 #include <linux/module.h> 21 #include <linux/compat.h> 22 #include <linux/init.h> 23 #include <linux/seq_file.h> 24 25 #include <asm/css_chars.h> 26 #include <asm/debug.h> 27 #include <asm/idals.h> 28 #include <asm/ebcdic.h> 29 #include <asm/io.h> 30 #include <linux/uaccess.h> 31 #include <asm/cio.h> 32 #include <asm/ccwdev.h> 33 #include <asm/itcw.h> 34 #include <asm/schid.h> 35 #include <asm/chpid.h> 36 37 #include "dasd_int.h" 38 #include "dasd_eckd.h" 39 40 #ifdef PRINTK_HEADER 41 #undef PRINTK_HEADER 42 #endif /* PRINTK_HEADER */ 43 #define PRINTK_HEADER "dasd(eckd):" 44 45 /* 46 * raw track access always map to 64k in memory 47 * so it maps to 16 blocks of 4k per track 48 */ 49 #define DASD_RAW_BLOCK_PER_TRACK 16 50 #define DASD_RAW_BLOCKSIZE 4096 51 /* 64k are 128 x 512 byte sectors */ 52 #define DASD_RAW_SECTORS_PER_TRACK 128 53 54 MODULE_LICENSE("GPL"); 55 56 static struct dasd_discipline dasd_eckd_discipline; 57 58 /* The ccw bus type uses this table to find devices that it sends to 59 * dasd_eckd_probe */ 60 static struct ccw_device_id dasd_eckd_ids[] = { 61 { CCW_DEVICE_DEVTYPE (0x3990, 0, 0x3390, 0), .driver_info = 0x1}, 62 { CCW_DEVICE_DEVTYPE (0x2105, 0, 0x3390, 0), .driver_info = 0x2}, 63 { CCW_DEVICE_DEVTYPE (0x3880, 0, 0x3380, 0), .driver_info = 0x3}, 64 { CCW_DEVICE_DEVTYPE (0x3990, 0, 0x3380, 0), .driver_info = 0x4}, 65 { CCW_DEVICE_DEVTYPE (0x2105, 0, 0x3380, 0), .driver_info = 0x5}, 66 { CCW_DEVICE_DEVTYPE (0x9343, 0, 0x9345, 0), .driver_info = 0x6}, 67 { CCW_DEVICE_DEVTYPE (0x2107, 0, 0x3390, 0), .driver_info = 0x7}, 68 { CCW_DEVICE_DEVTYPE (0x2107, 0, 0x3380, 0), .driver_info = 0x8}, 69 { CCW_DEVICE_DEVTYPE (0x1750, 0, 0x3390, 0), .driver_info = 0x9}, 70 { CCW_DEVICE_DEVTYPE (0x1750, 0, 0x3380, 0), .driver_info = 0xa}, 71 { /* end of list */ }, 72 }; 73 74 MODULE_DEVICE_TABLE(ccw, dasd_eckd_ids); 75 76 static struct ccw_driver dasd_eckd_driver; /* see below */ 77 78 static void *rawpadpage; 79 80 #define INIT_CQR_OK 0 81 #define INIT_CQR_UNFORMATTED 1 82 #define INIT_CQR_ERROR 2 83 84 /* emergency request for reserve/release */ 85 static struct { 86 struct dasd_ccw_req cqr; 87 struct ccw1 ccw; 88 char data[32]; 89 } *dasd_reserve_req; 90 static DEFINE_MUTEX(dasd_reserve_mutex); 91 92 static struct { 93 struct dasd_ccw_req cqr; 94 struct ccw1 ccw[2]; 95 char data[40]; 96 } *dasd_vol_info_req; 97 static DEFINE_MUTEX(dasd_vol_info_mutex); 98 99 struct ext_pool_exhaust_work_data { 100 struct work_struct worker; 101 struct dasd_device *device; 102 struct dasd_device *base; 103 }; 104 105 /* definitions for the path verification worker */ 106 struct pe_handler_work_data { 107 struct work_struct worker; 108 struct dasd_device *device; 109 struct dasd_ccw_req cqr; 110 struct ccw1 ccw; 111 __u8 rcd_buffer[DASD_ECKD_RCD_DATA_SIZE]; 112 int isglobal; 113 __u8 tbvpm; 114 __u8 fcsecpm; 115 }; 116 static struct pe_handler_work_data *pe_handler_worker; 117 static DEFINE_MUTEX(dasd_pe_handler_mutex); 118 119 struct check_attention_work_data { 120 struct work_struct worker; 121 struct dasd_device *device; 122 __u8 lpum; 123 }; 124 125 static int dasd_eckd_ext_pool_id(struct dasd_device *); 126 static int prepare_itcw(struct itcw *, unsigned int, unsigned int, int, 127 struct dasd_device *, struct dasd_device *, 128 unsigned int, int, unsigned int, unsigned int, 129 unsigned int, unsigned int); 130 131 /* initial attempt at a probe function. this can be simplified once 132 * the other detection code is gone */ 133 static int 134 dasd_eckd_probe (struct ccw_device *cdev) 135 { 136 int ret; 137 138 /* set ECKD specific ccw-device options */ 139 ret = ccw_device_set_options(cdev, CCWDEV_ALLOW_FORCE | 140 CCWDEV_DO_PATHGROUP | CCWDEV_DO_MULTIPATH); 141 if (ret) { 142 DBF_EVENT_DEVID(DBF_WARNING, cdev, "%s", 143 "dasd_eckd_probe: could not set " 144 "ccw-device options"); 145 return ret; 146 } 147 ret = dasd_generic_probe(cdev); 148 return ret; 149 } 150 151 static int 152 dasd_eckd_set_online(struct ccw_device *cdev) 153 { 154 return dasd_generic_set_online(cdev, &dasd_eckd_discipline); 155 } 156 157 static const int sizes_trk0[] = { 28, 148, 84 }; 158 #define LABEL_SIZE 140 159 160 /* head and record addresses of count_area read in analysis ccw */ 161 static const int count_area_head[] = { 0, 0, 0, 0, 1 }; 162 static const int count_area_rec[] = { 1, 2, 3, 4, 1 }; 163 164 static inline unsigned int 165 ceil_quot(unsigned int d1, unsigned int d2) 166 { 167 return (d1 + (d2 - 1)) / d2; 168 } 169 170 static unsigned int 171 recs_per_track(struct dasd_eckd_characteristics * rdc, 172 unsigned int kl, unsigned int dl) 173 { 174 int dn, kn; 175 176 switch (rdc->dev_type) { 177 case 0x3380: 178 if (kl) 179 return 1499 / (15 + 7 + ceil_quot(kl + 12, 32) + 180 ceil_quot(dl + 12, 32)); 181 else 182 return 1499 / (15 + ceil_quot(dl + 12, 32)); 183 case 0x3390: 184 dn = ceil_quot(dl + 6, 232) + 1; 185 if (kl) { 186 kn = ceil_quot(kl + 6, 232) + 1; 187 return 1729 / (10 + 9 + ceil_quot(kl + 6 * kn, 34) + 188 9 + ceil_quot(dl + 6 * dn, 34)); 189 } else 190 return 1729 / (10 + 9 + ceil_quot(dl + 6 * dn, 34)); 191 case 0x9345: 192 dn = ceil_quot(dl + 6, 232) + 1; 193 if (kl) { 194 kn = ceil_quot(kl + 6, 232) + 1; 195 return 1420 / (18 + 7 + ceil_quot(kl + 6 * kn, 34) + 196 ceil_quot(dl + 6 * dn, 34)); 197 } else 198 return 1420 / (18 + 7 + ceil_quot(dl + 6 * dn, 34)); 199 } 200 return 0; 201 } 202 203 static void set_ch_t(struct ch_t *geo, __u32 cyl, __u8 head) 204 { 205 geo->cyl = (__u16) cyl; 206 geo->head = cyl >> 16; 207 geo->head <<= 4; 208 geo->head |= head; 209 } 210 211 /* 212 * calculate failing track from sense data depending if 213 * it is an EAV device or not 214 */ 215 static int dasd_eckd_track_from_irb(struct irb *irb, struct dasd_device *device, 216 sector_t *track) 217 { 218 struct dasd_eckd_private *private = device->private; 219 u8 *sense = NULL; 220 u32 cyl; 221 u8 head; 222 223 sense = dasd_get_sense(irb); 224 if (!sense) { 225 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 226 "ESE error no sense data\n"); 227 return -EINVAL; 228 } 229 if (!(sense[27] & DASD_SENSE_BIT_2)) { 230 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 231 "ESE error no valid track data\n"); 232 return -EINVAL; 233 } 234 235 if (sense[27] & DASD_SENSE_BIT_3) { 236 /* enhanced addressing */ 237 cyl = sense[30] << 20; 238 cyl |= (sense[31] & 0xF0) << 12; 239 cyl |= sense[28] << 8; 240 cyl |= sense[29]; 241 } else { 242 cyl = sense[29] << 8; 243 cyl |= sense[30]; 244 } 245 head = sense[31] & 0x0F; 246 *track = cyl * private->rdc_data.trk_per_cyl + head; 247 return 0; 248 } 249 250 static int set_timestamp(struct ccw1 *ccw, struct DE_eckd_data *data, 251 struct dasd_device *device) 252 { 253 struct dasd_eckd_private *private = device->private; 254 int rc; 255 256 rc = get_phys_clock(&data->ep_sys_time); 257 /* 258 * Ignore return code if XRC is not supported or 259 * sync clock is switched off 260 */ 261 if ((rc && !private->rdc_data.facilities.XRC_supported) || 262 rc == -EOPNOTSUPP || rc == -EACCES) 263 return 0; 264 265 /* switch on System Time Stamp - needed for XRC Support */ 266 data->ga_extended |= 0x08; /* switch on 'Time Stamp Valid' */ 267 data->ga_extended |= 0x02; /* switch on 'Extended Parameter' */ 268 269 if (ccw) { 270 ccw->count = sizeof(struct DE_eckd_data); 271 ccw->flags |= CCW_FLAG_SLI; 272 } 273 274 return rc; 275 } 276 277 static int 278 define_extent(struct ccw1 *ccw, struct DE_eckd_data *data, unsigned int trk, 279 unsigned int totrk, int cmd, struct dasd_device *device, 280 int blksize) 281 { 282 struct dasd_eckd_private *private = device->private; 283 u16 heads, beghead, endhead; 284 u32 begcyl, endcyl; 285 int rc = 0; 286 287 if (ccw) { 288 ccw->cmd_code = DASD_ECKD_CCW_DEFINE_EXTENT; 289 ccw->flags = 0; 290 ccw->count = 16; 291 ccw->cda = (__u32)__pa(data); 292 } 293 294 memset(data, 0, sizeof(struct DE_eckd_data)); 295 switch (cmd) { 296 case DASD_ECKD_CCW_READ_HOME_ADDRESS: 297 case DASD_ECKD_CCW_READ_RECORD_ZERO: 298 case DASD_ECKD_CCW_READ: 299 case DASD_ECKD_CCW_READ_MT: 300 case DASD_ECKD_CCW_READ_CKD: 301 case DASD_ECKD_CCW_READ_CKD_MT: 302 case DASD_ECKD_CCW_READ_KD: 303 case DASD_ECKD_CCW_READ_KD_MT: 304 data->mask.perm = 0x1; 305 data->attributes.operation = private->attrib.operation; 306 break; 307 case DASD_ECKD_CCW_READ_COUNT: 308 data->mask.perm = 0x1; 309 data->attributes.operation = DASD_BYPASS_CACHE; 310 break; 311 case DASD_ECKD_CCW_READ_TRACK: 312 case DASD_ECKD_CCW_READ_TRACK_DATA: 313 data->mask.perm = 0x1; 314 data->attributes.operation = private->attrib.operation; 315 data->blk_size = 0; 316 break; 317 case DASD_ECKD_CCW_WRITE: 318 case DASD_ECKD_CCW_WRITE_MT: 319 case DASD_ECKD_CCW_WRITE_KD: 320 case DASD_ECKD_CCW_WRITE_KD_MT: 321 data->mask.perm = 0x02; 322 data->attributes.operation = private->attrib.operation; 323 rc = set_timestamp(ccw, data, device); 324 break; 325 case DASD_ECKD_CCW_WRITE_CKD: 326 case DASD_ECKD_CCW_WRITE_CKD_MT: 327 data->attributes.operation = DASD_BYPASS_CACHE; 328 rc = set_timestamp(ccw, data, device); 329 break; 330 case DASD_ECKD_CCW_ERASE: 331 case DASD_ECKD_CCW_WRITE_HOME_ADDRESS: 332 case DASD_ECKD_CCW_WRITE_RECORD_ZERO: 333 data->mask.perm = 0x3; 334 data->mask.auth = 0x1; 335 data->attributes.operation = DASD_BYPASS_CACHE; 336 rc = set_timestamp(ccw, data, device); 337 break; 338 case DASD_ECKD_CCW_WRITE_FULL_TRACK: 339 data->mask.perm = 0x03; 340 data->attributes.operation = private->attrib.operation; 341 data->blk_size = 0; 342 break; 343 case DASD_ECKD_CCW_WRITE_TRACK_DATA: 344 data->mask.perm = 0x02; 345 data->attributes.operation = private->attrib.operation; 346 data->blk_size = blksize; 347 rc = set_timestamp(ccw, data, device); 348 break; 349 default: 350 dev_err(&device->cdev->dev, 351 "0x%x is not a known command\n", cmd); 352 break; 353 } 354 355 data->attributes.mode = 0x3; /* ECKD */ 356 357 if ((private->rdc_data.cu_type == 0x2105 || 358 private->rdc_data.cu_type == 0x2107 || 359 private->rdc_data.cu_type == 0x1750) 360 && !(private->uses_cdl && trk < 2)) 361 data->ga_extended |= 0x40; /* Regular Data Format Mode */ 362 363 heads = private->rdc_data.trk_per_cyl; 364 begcyl = trk / heads; 365 beghead = trk % heads; 366 endcyl = totrk / heads; 367 endhead = totrk % heads; 368 369 /* check for sequential prestage - enhance cylinder range */ 370 if (data->attributes.operation == DASD_SEQ_PRESTAGE || 371 data->attributes.operation == DASD_SEQ_ACCESS) { 372 373 if (endcyl + private->attrib.nr_cyl < private->real_cyl) 374 endcyl += private->attrib.nr_cyl; 375 else 376 endcyl = (private->real_cyl - 1); 377 } 378 379 set_ch_t(&data->beg_ext, begcyl, beghead); 380 set_ch_t(&data->end_ext, endcyl, endhead); 381 return rc; 382 } 383 384 385 static void locate_record_ext(struct ccw1 *ccw, struct LRE_eckd_data *data, 386 unsigned int trk, unsigned int rec_on_trk, 387 int count, int cmd, struct dasd_device *device, 388 unsigned int reclen, unsigned int tlf) 389 { 390 struct dasd_eckd_private *private = device->private; 391 int sector; 392 int dn, d; 393 394 if (ccw) { 395 ccw->cmd_code = DASD_ECKD_CCW_LOCATE_RECORD_EXT; 396 ccw->flags = 0; 397 if (cmd == DASD_ECKD_CCW_WRITE_FULL_TRACK) 398 ccw->count = 22; 399 else 400 ccw->count = 20; 401 ccw->cda = (__u32)__pa(data); 402 } 403 404 memset(data, 0, sizeof(*data)); 405 sector = 0; 406 if (rec_on_trk) { 407 switch (private->rdc_data.dev_type) { 408 case 0x3390: 409 dn = ceil_quot(reclen + 6, 232); 410 d = 9 + ceil_quot(reclen + 6 * (dn + 1), 34); 411 sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8; 412 break; 413 case 0x3380: 414 d = 7 + ceil_quot(reclen + 12, 32); 415 sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7; 416 break; 417 } 418 } 419 data->sector = sector; 420 /* note: meaning of count depends on the operation 421 * for record based I/O it's the number of records, but for 422 * track based I/O it's the number of tracks 423 */ 424 data->count = count; 425 switch (cmd) { 426 case DASD_ECKD_CCW_WRITE_HOME_ADDRESS: 427 data->operation.orientation = 0x3; 428 data->operation.operation = 0x03; 429 break; 430 case DASD_ECKD_CCW_READ_HOME_ADDRESS: 431 data->operation.orientation = 0x3; 432 data->operation.operation = 0x16; 433 break; 434 case DASD_ECKD_CCW_WRITE_RECORD_ZERO: 435 data->operation.orientation = 0x1; 436 data->operation.operation = 0x03; 437 data->count++; 438 break; 439 case DASD_ECKD_CCW_READ_RECORD_ZERO: 440 data->operation.orientation = 0x3; 441 data->operation.operation = 0x16; 442 data->count++; 443 break; 444 case DASD_ECKD_CCW_WRITE: 445 case DASD_ECKD_CCW_WRITE_MT: 446 case DASD_ECKD_CCW_WRITE_KD: 447 case DASD_ECKD_CCW_WRITE_KD_MT: 448 data->auxiliary.length_valid = 0x1; 449 data->length = reclen; 450 data->operation.operation = 0x01; 451 break; 452 case DASD_ECKD_CCW_WRITE_CKD: 453 case DASD_ECKD_CCW_WRITE_CKD_MT: 454 data->auxiliary.length_valid = 0x1; 455 data->length = reclen; 456 data->operation.operation = 0x03; 457 break; 458 case DASD_ECKD_CCW_WRITE_FULL_TRACK: 459 data->operation.orientation = 0x0; 460 data->operation.operation = 0x3F; 461 data->extended_operation = 0x11; 462 data->length = 0; 463 data->extended_parameter_length = 0x02; 464 if (data->count > 8) { 465 data->extended_parameter[0] = 0xFF; 466 data->extended_parameter[1] = 0xFF; 467 data->extended_parameter[1] <<= (16 - count); 468 } else { 469 data->extended_parameter[0] = 0xFF; 470 data->extended_parameter[0] <<= (8 - count); 471 data->extended_parameter[1] = 0x00; 472 } 473 data->sector = 0xFF; 474 break; 475 case DASD_ECKD_CCW_WRITE_TRACK_DATA: 476 data->auxiliary.length_valid = 0x1; 477 data->length = reclen; /* not tlf, as one might think */ 478 data->operation.operation = 0x3F; 479 data->extended_operation = 0x23; 480 break; 481 case DASD_ECKD_CCW_READ: 482 case DASD_ECKD_CCW_READ_MT: 483 case DASD_ECKD_CCW_READ_KD: 484 case DASD_ECKD_CCW_READ_KD_MT: 485 data->auxiliary.length_valid = 0x1; 486 data->length = reclen; 487 data->operation.operation = 0x06; 488 break; 489 case DASD_ECKD_CCW_READ_CKD: 490 case DASD_ECKD_CCW_READ_CKD_MT: 491 data->auxiliary.length_valid = 0x1; 492 data->length = reclen; 493 data->operation.operation = 0x16; 494 break; 495 case DASD_ECKD_CCW_READ_COUNT: 496 data->operation.operation = 0x06; 497 break; 498 case DASD_ECKD_CCW_READ_TRACK: 499 data->operation.orientation = 0x1; 500 data->operation.operation = 0x0C; 501 data->extended_parameter_length = 0; 502 data->sector = 0xFF; 503 break; 504 case DASD_ECKD_CCW_READ_TRACK_DATA: 505 data->auxiliary.length_valid = 0x1; 506 data->length = tlf; 507 data->operation.operation = 0x0C; 508 break; 509 case DASD_ECKD_CCW_ERASE: 510 data->length = reclen; 511 data->auxiliary.length_valid = 0x1; 512 data->operation.operation = 0x0b; 513 break; 514 default: 515 DBF_DEV_EVENT(DBF_ERR, device, 516 "fill LRE unknown opcode 0x%x", cmd); 517 BUG(); 518 } 519 set_ch_t(&data->seek_addr, 520 trk / private->rdc_data.trk_per_cyl, 521 trk % private->rdc_data.trk_per_cyl); 522 data->search_arg.cyl = data->seek_addr.cyl; 523 data->search_arg.head = data->seek_addr.head; 524 data->search_arg.record = rec_on_trk; 525 } 526 527 static int prefix_LRE(struct ccw1 *ccw, struct PFX_eckd_data *pfxdata, 528 unsigned int trk, unsigned int totrk, int cmd, 529 struct dasd_device *basedev, struct dasd_device *startdev, 530 unsigned int format, unsigned int rec_on_trk, int count, 531 unsigned int blksize, unsigned int tlf) 532 { 533 struct dasd_eckd_private *basepriv, *startpriv; 534 struct LRE_eckd_data *lredata; 535 struct DE_eckd_data *dedata; 536 int rc = 0; 537 538 basepriv = basedev->private; 539 startpriv = startdev->private; 540 dedata = &pfxdata->define_extent; 541 lredata = &pfxdata->locate_record; 542 543 ccw->cmd_code = DASD_ECKD_CCW_PFX; 544 ccw->flags = 0; 545 if (cmd == DASD_ECKD_CCW_WRITE_FULL_TRACK) { 546 ccw->count = sizeof(*pfxdata) + 2; 547 ccw->cda = (__u32) __pa(pfxdata); 548 memset(pfxdata, 0, sizeof(*pfxdata) + 2); 549 } else { 550 ccw->count = sizeof(*pfxdata); 551 ccw->cda = (__u32) __pa(pfxdata); 552 memset(pfxdata, 0, sizeof(*pfxdata)); 553 } 554 555 /* prefix data */ 556 if (format > 1) { 557 DBF_DEV_EVENT(DBF_ERR, basedev, 558 "PFX LRE unknown format 0x%x", format); 559 BUG(); 560 return -EINVAL; 561 } 562 pfxdata->format = format; 563 pfxdata->base_address = basepriv->ned->unit_addr; 564 pfxdata->base_lss = basepriv->ned->ID; 565 pfxdata->validity.define_extent = 1; 566 567 /* private uid is kept up to date, conf_data may be outdated */ 568 if (startpriv->uid.type == UA_BASE_PAV_ALIAS) 569 pfxdata->validity.verify_base = 1; 570 571 if (startpriv->uid.type == UA_HYPER_PAV_ALIAS) { 572 pfxdata->validity.verify_base = 1; 573 pfxdata->validity.hyper_pav = 1; 574 } 575 576 rc = define_extent(NULL, dedata, trk, totrk, cmd, basedev, blksize); 577 578 /* 579 * For some commands the System Time Stamp is set in the define extent 580 * data when XRC is supported. The validity of the time stamp must be 581 * reflected in the prefix data as well. 582 */ 583 if (dedata->ga_extended & 0x08 && dedata->ga_extended & 0x02) 584 pfxdata->validity.time_stamp = 1; /* 'Time Stamp Valid' */ 585 586 if (format == 1) { 587 locate_record_ext(NULL, lredata, trk, rec_on_trk, count, cmd, 588 basedev, blksize, tlf); 589 } 590 591 return rc; 592 } 593 594 static int prefix(struct ccw1 *ccw, struct PFX_eckd_data *pfxdata, 595 unsigned int trk, unsigned int totrk, int cmd, 596 struct dasd_device *basedev, struct dasd_device *startdev) 597 { 598 return prefix_LRE(ccw, pfxdata, trk, totrk, cmd, basedev, startdev, 599 0, 0, 0, 0, 0); 600 } 601 602 static void 603 locate_record(struct ccw1 *ccw, struct LO_eckd_data *data, unsigned int trk, 604 unsigned int rec_on_trk, int no_rec, int cmd, 605 struct dasd_device * device, int reclen) 606 { 607 struct dasd_eckd_private *private = device->private; 608 int sector; 609 int dn, d; 610 611 DBF_DEV_EVENT(DBF_INFO, device, 612 "Locate: trk %d, rec %d, no_rec %d, cmd %d, reclen %d", 613 trk, rec_on_trk, no_rec, cmd, reclen); 614 615 ccw->cmd_code = DASD_ECKD_CCW_LOCATE_RECORD; 616 ccw->flags = 0; 617 ccw->count = 16; 618 ccw->cda = (__u32) __pa(data); 619 620 memset(data, 0, sizeof(struct LO_eckd_data)); 621 sector = 0; 622 if (rec_on_trk) { 623 switch (private->rdc_data.dev_type) { 624 case 0x3390: 625 dn = ceil_quot(reclen + 6, 232); 626 d = 9 + ceil_quot(reclen + 6 * (dn + 1), 34); 627 sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8; 628 break; 629 case 0x3380: 630 d = 7 + ceil_quot(reclen + 12, 32); 631 sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7; 632 break; 633 } 634 } 635 data->sector = sector; 636 data->count = no_rec; 637 switch (cmd) { 638 case DASD_ECKD_CCW_WRITE_HOME_ADDRESS: 639 data->operation.orientation = 0x3; 640 data->operation.operation = 0x03; 641 break; 642 case DASD_ECKD_CCW_READ_HOME_ADDRESS: 643 data->operation.orientation = 0x3; 644 data->operation.operation = 0x16; 645 break; 646 case DASD_ECKD_CCW_WRITE_RECORD_ZERO: 647 data->operation.orientation = 0x1; 648 data->operation.operation = 0x03; 649 data->count++; 650 break; 651 case DASD_ECKD_CCW_READ_RECORD_ZERO: 652 data->operation.orientation = 0x3; 653 data->operation.operation = 0x16; 654 data->count++; 655 break; 656 case DASD_ECKD_CCW_WRITE: 657 case DASD_ECKD_CCW_WRITE_MT: 658 case DASD_ECKD_CCW_WRITE_KD: 659 case DASD_ECKD_CCW_WRITE_KD_MT: 660 data->auxiliary.last_bytes_used = 0x1; 661 data->length = reclen; 662 data->operation.operation = 0x01; 663 break; 664 case DASD_ECKD_CCW_WRITE_CKD: 665 case DASD_ECKD_CCW_WRITE_CKD_MT: 666 data->auxiliary.last_bytes_used = 0x1; 667 data->length = reclen; 668 data->operation.operation = 0x03; 669 break; 670 case DASD_ECKD_CCW_READ: 671 case DASD_ECKD_CCW_READ_MT: 672 case DASD_ECKD_CCW_READ_KD: 673 case DASD_ECKD_CCW_READ_KD_MT: 674 data->auxiliary.last_bytes_used = 0x1; 675 data->length = reclen; 676 data->operation.operation = 0x06; 677 break; 678 case DASD_ECKD_CCW_READ_CKD: 679 case DASD_ECKD_CCW_READ_CKD_MT: 680 data->auxiliary.last_bytes_used = 0x1; 681 data->length = reclen; 682 data->operation.operation = 0x16; 683 break; 684 case DASD_ECKD_CCW_READ_COUNT: 685 data->operation.operation = 0x06; 686 break; 687 case DASD_ECKD_CCW_ERASE: 688 data->length = reclen; 689 data->auxiliary.last_bytes_used = 0x1; 690 data->operation.operation = 0x0b; 691 break; 692 default: 693 DBF_DEV_EVENT(DBF_ERR, device, "unknown locate record " 694 "opcode 0x%x", cmd); 695 } 696 set_ch_t(&data->seek_addr, 697 trk / private->rdc_data.trk_per_cyl, 698 trk % private->rdc_data.trk_per_cyl); 699 data->search_arg.cyl = data->seek_addr.cyl; 700 data->search_arg.head = data->seek_addr.head; 701 data->search_arg.record = rec_on_trk; 702 } 703 704 /* 705 * Returns 1 if the block is one of the special blocks that needs 706 * to get read/written with the KD variant of the command. 707 * That is DASD_ECKD_READ_KD_MT instead of DASD_ECKD_READ_MT and 708 * DASD_ECKD_WRITE_KD_MT instead of DASD_ECKD_WRITE_MT. 709 * Luckily the KD variants differ only by one bit (0x08) from the 710 * normal variant. So don't wonder about code like: 711 * if (dasd_eckd_cdl_special(blk_per_trk, recid)) 712 * ccw->cmd_code |= 0x8; 713 */ 714 static inline int 715 dasd_eckd_cdl_special(int blk_per_trk, int recid) 716 { 717 if (recid < 3) 718 return 1; 719 if (recid < blk_per_trk) 720 return 0; 721 if (recid < 2 * blk_per_trk) 722 return 1; 723 return 0; 724 } 725 726 /* 727 * Returns the record size for the special blocks of the cdl format. 728 * Only returns something useful if dasd_eckd_cdl_special is true 729 * for the recid. 730 */ 731 static inline int 732 dasd_eckd_cdl_reclen(int recid) 733 { 734 if (recid < 3) 735 return sizes_trk0[recid]; 736 return LABEL_SIZE; 737 } 738 /* create unique id from private structure. */ 739 static void create_uid(struct dasd_eckd_private *private) 740 { 741 int count; 742 struct dasd_uid *uid; 743 744 uid = &private->uid; 745 memset(uid, 0, sizeof(struct dasd_uid)); 746 memcpy(uid->vendor, private->ned->HDA_manufacturer, 747 sizeof(uid->vendor) - 1); 748 EBCASC(uid->vendor, sizeof(uid->vendor) - 1); 749 memcpy(uid->serial, &private->ned->serial, 750 sizeof(uid->serial) - 1); 751 EBCASC(uid->serial, sizeof(uid->serial) - 1); 752 uid->ssid = private->gneq->subsystemID; 753 uid->real_unit_addr = private->ned->unit_addr; 754 if (private->sneq) { 755 uid->type = private->sneq->sua_flags; 756 if (uid->type == UA_BASE_PAV_ALIAS) 757 uid->base_unit_addr = private->sneq->base_unit_addr; 758 } else { 759 uid->type = UA_BASE_DEVICE; 760 } 761 if (private->vdsneq) { 762 for (count = 0; count < 16; count++) { 763 sprintf(uid->vduit+2*count, "%02x", 764 private->vdsneq->uit[count]); 765 } 766 } 767 } 768 769 /* 770 * Generate device unique id that specifies the physical device. 771 */ 772 static int dasd_eckd_generate_uid(struct dasd_device *device) 773 { 774 struct dasd_eckd_private *private = device->private; 775 unsigned long flags; 776 777 if (!private) 778 return -ENODEV; 779 if (!private->ned || !private->gneq) 780 return -ENODEV; 781 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 782 create_uid(private); 783 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 784 return 0; 785 } 786 787 static int dasd_eckd_get_uid(struct dasd_device *device, struct dasd_uid *uid) 788 { 789 struct dasd_eckd_private *private = device->private; 790 unsigned long flags; 791 792 if (private) { 793 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 794 *uid = private->uid; 795 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 796 return 0; 797 } 798 return -EINVAL; 799 } 800 801 /* 802 * compare device UID with data of a given dasd_eckd_private structure 803 * return 0 for match 804 */ 805 static int dasd_eckd_compare_path_uid(struct dasd_device *device, 806 struct dasd_eckd_private *private) 807 { 808 struct dasd_uid device_uid; 809 810 create_uid(private); 811 dasd_eckd_get_uid(device, &device_uid); 812 813 return memcmp(&device_uid, &private->uid, sizeof(struct dasd_uid)); 814 } 815 816 static void dasd_eckd_fill_rcd_cqr(struct dasd_device *device, 817 struct dasd_ccw_req *cqr, 818 __u8 *rcd_buffer, 819 __u8 lpm) 820 { 821 struct ccw1 *ccw; 822 /* 823 * buffer has to start with EBCDIC "V1.0" to show 824 * support for virtual device SNEQ 825 */ 826 rcd_buffer[0] = 0xE5; 827 rcd_buffer[1] = 0xF1; 828 rcd_buffer[2] = 0x4B; 829 rcd_buffer[3] = 0xF0; 830 831 ccw = cqr->cpaddr; 832 ccw->cmd_code = DASD_ECKD_CCW_RCD; 833 ccw->flags = 0; 834 ccw->cda = (__u32)(addr_t)rcd_buffer; 835 ccw->count = DASD_ECKD_RCD_DATA_SIZE; 836 cqr->magic = DASD_ECKD_MAGIC; 837 838 cqr->startdev = device; 839 cqr->memdev = device; 840 cqr->block = NULL; 841 cqr->expires = 10*HZ; 842 cqr->lpm = lpm; 843 cqr->retries = 256; 844 cqr->buildclk = get_tod_clock(); 845 cqr->status = DASD_CQR_FILLED; 846 set_bit(DASD_CQR_VERIFY_PATH, &cqr->flags); 847 } 848 849 /* 850 * Wakeup helper for read_conf 851 * if the cqr is not done and needs some error recovery 852 * the buffer has to be re-initialized with the EBCDIC "V1.0" 853 * to show support for virtual device SNEQ 854 */ 855 static void read_conf_cb(struct dasd_ccw_req *cqr, void *data) 856 { 857 struct ccw1 *ccw; 858 __u8 *rcd_buffer; 859 860 if (cqr->status != DASD_CQR_DONE) { 861 ccw = cqr->cpaddr; 862 rcd_buffer = (__u8 *)((addr_t) ccw->cda); 863 memset(rcd_buffer, 0, sizeof(*rcd_buffer)); 864 865 rcd_buffer[0] = 0xE5; 866 rcd_buffer[1] = 0xF1; 867 rcd_buffer[2] = 0x4B; 868 rcd_buffer[3] = 0xF0; 869 } 870 dasd_wakeup_cb(cqr, data); 871 } 872 873 static int dasd_eckd_read_conf_immediately(struct dasd_device *device, 874 struct dasd_ccw_req *cqr, 875 __u8 *rcd_buffer, 876 __u8 lpm) 877 { 878 struct ciw *ciw; 879 int rc; 880 /* 881 * sanity check: scan for RCD command in extended SenseID data 882 * some devices do not support RCD 883 */ 884 ciw = ccw_device_get_ciw(device->cdev, CIW_TYPE_RCD); 885 if (!ciw || ciw->cmd != DASD_ECKD_CCW_RCD) 886 return -EOPNOTSUPP; 887 888 dasd_eckd_fill_rcd_cqr(device, cqr, rcd_buffer, lpm); 889 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 890 set_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags); 891 cqr->retries = 5; 892 cqr->callback = read_conf_cb; 893 rc = dasd_sleep_on_immediatly(cqr); 894 return rc; 895 } 896 897 static int dasd_eckd_read_conf_lpm(struct dasd_device *device, 898 void **rcd_buffer, 899 int *rcd_buffer_size, __u8 lpm) 900 { 901 struct ciw *ciw; 902 char *rcd_buf = NULL; 903 int ret; 904 struct dasd_ccw_req *cqr; 905 906 /* 907 * sanity check: scan for RCD command in extended SenseID data 908 * some devices do not support RCD 909 */ 910 ciw = ccw_device_get_ciw(device->cdev, CIW_TYPE_RCD); 911 if (!ciw || ciw->cmd != DASD_ECKD_CCW_RCD) { 912 ret = -EOPNOTSUPP; 913 goto out_error; 914 } 915 rcd_buf = kzalloc(DASD_ECKD_RCD_DATA_SIZE, GFP_KERNEL | GFP_DMA); 916 if (!rcd_buf) { 917 ret = -ENOMEM; 918 goto out_error; 919 } 920 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* RCD */, 921 0, /* use rcd_buf as data ara */ 922 device, NULL); 923 if (IS_ERR(cqr)) { 924 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 925 "Could not allocate RCD request"); 926 ret = -ENOMEM; 927 goto out_error; 928 } 929 dasd_eckd_fill_rcd_cqr(device, cqr, rcd_buf, lpm); 930 cqr->callback = read_conf_cb; 931 ret = dasd_sleep_on(cqr); 932 /* 933 * on success we update the user input parms 934 */ 935 dasd_sfree_request(cqr, cqr->memdev); 936 if (ret) 937 goto out_error; 938 939 *rcd_buffer_size = DASD_ECKD_RCD_DATA_SIZE; 940 *rcd_buffer = rcd_buf; 941 return 0; 942 out_error: 943 kfree(rcd_buf); 944 *rcd_buffer = NULL; 945 *rcd_buffer_size = 0; 946 return ret; 947 } 948 949 static int dasd_eckd_identify_conf_parts(struct dasd_eckd_private *private) 950 { 951 952 struct dasd_sneq *sneq; 953 int i, count; 954 955 private->ned = NULL; 956 private->sneq = NULL; 957 private->vdsneq = NULL; 958 private->gneq = NULL; 959 count = private->conf_len / sizeof(struct dasd_sneq); 960 sneq = (struct dasd_sneq *)private->conf_data; 961 for (i = 0; i < count; ++i) { 962 if (sneq->flags.identifier == 1 && sneq->format == 1) 963 private->sneq = sneq; 964 else if (sneq->flags.identifier == 1 && sneq->format == 4) 965 private->vdsneq = (struct vd_sneq *)sneq; 966 else if (sneq->flags.identifier == 2) 967 private->gneq = (struct dasd_gneq *)sneq; 968 else if (sneq->flags.identifier == 3 && sneq->res1 == 1) 969 private->ned = (struct dasd_ned *)sneq; 970 sneq++; 971 } 972 if (!private->ned || !private->gneq) { 973 private->ned = NULL; 974 private->sneq = NULL; 975 private->vdsneq = NULL; 976 private->gneq = NULL; 977 return -EINVAL; 978 } 979 return 0; 980 981 }; 982 983 static unsigned char dasd_eckd_path_access(void *conf_data, int conf_len) 984 { 985 struct dasd_gneq *gneq; 986 int i, count, found; 987 988 count = conf_len / sizeof(*gneq); 989 gneq = (struct dasd_gneq *)conf_data; 990 found = 0; 991 for (i = 0; i < count; ++i) { 992 if (gneq->flags.identifier == 2) { 993 found = 1; 994 break; 995 } 996 gneq++; 997 } 998 if (found) 999 return ((char *)gneq)[18] & 0x07; 1000 else 1001 return 0; 1002 } 1003 1004 static void dasd_eckd_store_conf_data(struct dasd_device *device, 1005 struct dasd_conf_data *conf_data, int chp) 1006 { 1007 struct dasd_eckd_private *private = device->private; 1008 struct channel_path_desc_fmt0 *chp_desc; 1009 struct subchannel_id sch_id; 1010 void *cdp; 1011 1012 /* 1013 * path handling and read_conf allocate data 1014 * free it before replacing the pointer 1015 * also replace the old private->conf_data pointer 1016 * with the new one if this points to the same data 1017 */ 1018 cdp = device->path[chp].conf_data; 1019 if (private->conf_data == cdp) { 1020 private->conf_data = (void *)conf_data; 1021 dasd_eckd_identify_conf_parts(private); 1022 } 1023 ccw_device_get_schid(device->cdev, &sch_id); 1024 device->path[chp].conf_data = conf_data; 1025 device->path[chp].cssid = sch_id.cssid; 1026 device->path[chp].ssid = sch_id.ssid; 1027 chp_desc = ccw_device_get_chp_desc(device->cdev, chp); 1028 if (chp_desc) 1029 device->path[chp].chpid = chp_desc->chpid; 1030 kfree(chp_desc); 1031 kfree(cdp); 1032 } 1033 1034 static void dasd_eckd_clear_conf_data(struct dasd_device *device) 1035 { 1036 struct dasd_eckd_private *private = device->private; 1037 int i; 1038 1039 private->conf_data = NULL; 1040 private->conf_len = 0; 1041 for (i = 0; i < 8; i++) { 1042 kfree(device->path[i].conf_data); 1043 device->path[i].conf_data = NULL; 1044 device->path[i].cssid = 0; 1045 device->path[i].ssid = 0; 1046 device->path[i].chpid = 0; 1047 dasd_path_notoper(device, i); 1048 } 1049 } 1050 1051 static void dasd_eckd_read_fc_security(struct dasd_device *device) 1052 { 1053 struct dasd_eckd_private *private = device->private; 1054 u8 esm_valid; 1055 u8 esm[8]; 1056 int chp; 1057 int rc; 1058 1059 rc = chsc_scud(private->uid.ssid, (u64 *)esm, &esm_valid); 1060 if (rc) { 1061 for (chp = 0; chp < 8; chp++) 1062 device->path[chp].fc_security = 0; 1063 return; 1064 } 1065 1066 for (chp = 0; chp < 8; chp++) { 1067 if (esm_valid & (0x80 >> chp)) 1068 device->path[chp].fc_security = esm[chp]; 1069 else 1070 device->path[chp].fc_security = 0; 1071 } 1072 } 1073 1074 static void dasd_eckd_get_uid_string(struct dasd_eckd_private *private, 1075 char *print_uid) 1076 { 1077 struct dasd_uid *uid; 1078 1079 uid = &private->uid; 1080 if (strlen(uid->vduit) > 0) 1081 snprintf(print_uid, sizeof(*print_uid), 1082 "%s.%s.%04x.%02x.%s", 1083 uid->vendor, uid->serial, uid->ssid, 1084 uid->real_unit_addr, uid->vduit); 1085 else 1086 snprintf(print_uid, sizeof(*print_uid), 1087 "%s.%s.%04x.%02x", 1088 uid->vendor, uid->serial, uid->ssid, 1089 uid->real_unit_addr); 1090 } 1091 1092 static int dasd_eckd_check_cabling(struct dasd_device *device, 1093 void *conf_data, __u8 lpm) 1094 { 1095 struct dasd_eckd_private *private = device->private; 1096 char print_path_uid[60], print_device_uid[60]; 1097 struct dasd_eckd_private path_private; 1098 1099 path_private.conf_data = conf_data; 1100 path_private.conf_len = DASD_ECKD_RCD_DATA_SIZE; 1101 if (dasd_eckd_identify_conf_parts(&path_private)) 1102 return 1; 1103 1104 if (dasd_eckd_compare_path_uid(device, &path_private)) { 1105 dasd_eckd_get_uid_string(&path_private, print_path_uid); 1106 dasd_eckd_get_uid_string(private, print_device_uid); 1107 dev_err(&device->cdev->dev, 1108 "Not all channel paths lead to the same device, path %02X leads to device %s instead of %s\n", 1109 lpm, print_path_uid, print_device_uid); 1110 return 1; 1111 } 1112 1113 return 0; 1114 } 1115 1116 static int dasd_eckd_read_conf(struct dasd_device *device) 1117 { 1118 void *conf_data; 1119 int conf_len, conf_data_saved; 1120 int rc, path_err, pos; 1121 __u8 lpm, opm; 1122 struct dasd_eckd_private *private; 1123 1124 private = device->private; 1125 opm = ccw_device_get_path_mask(device->cdev); 1126 conf_data_saved = 0; 1127 path_err = 0; 1128 /* get configuration data per operational path */ 1129 for (lpm = 0x80; lpm; lpm>>= 1) { 1130 if (!(lpm & opm)) 1131 continue; 1132 rc = dasd_eckd_read_conf_lpm(device, &conf_data, 1133 &conf_len, lpm); 1134 if (rc && rc != -EOPNOTSUPP) { /* -EOPNOTSUPP is ok */ 1135 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 1136 "Read configuration data returned " 1137 "error %d", rc); 1138 return rc; 1139 } 1140 if (conf_data == NULL) { 1141 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1142 "No configuration data " 1143 "retrieved"); 1144 /* no further analysis possible */ 1145 dasd_path_add_opm(device, opm); 1146 continue; /* no error */ 1147 } 1148 /* save first valid configuration data */ 1149 if (!conf_data_saved) { 1150 /* initially clear previously stored conf_data */ 1151 dasd_eckd_clear_conf_data(device); 1152 private->conf_data = conf_data; 1153 private->conf_len = conf_len; 1154 if (dasd_eckd_identify_conf_parts(private)) { 1155 private->conf_data = NULL; 1156 private->conf_len = 0; 1157 kfree(conf_data); 1158 continue; 1159 } 1160 /* 1161 * build device UID that other path data 1162 * can be compared to it 1163 */ 1164 dasd_eckd_generate_uid(device); 1165 conf_data_saved++; 1166 } else if (dasd_eckd_check_cabling(device, conf_data, lpm)) { 1167 dasd_path_add_cablepm(device, lpm); 1168 path_err = -EINVAL; 1169 kfree(conf_data); 1170 continue; 1171 } 1172 1173 pos = pathmask_to_pos(lpm); 1174 dasd_eckd_store_conf_data(device, conf_data, pos); 1175 1176 switch (dasd_eckd_path_access(conf_data, conf_len)) { 1177 case 0x02: 1178 dasd_path_add_nppm(device, lpm); 1179 break; 1180 case 0x03: 1181 dasd_path_add_ppm(device, lpm); 1182 break; 1183 } 1184 if (!dasd_path_get_opm(device)) { 1185 dasd_path_set_opm(device, lpm); 1186 dasd_generic_path_operational(device); 1187 } else { 1188 dasd_path_add_opm(device, lpm); 1189 } 1190 } 1191 1192 dasd_eckd_read_fc_security(device); 1193 1194 return path_err; 1195 } 1196 1197 static u32 get_fcx_max_data(struct dasd_device *device) 1198 { 1199 struct dasd_eckd_private *private = device->private; 1200 int fcx_in_css, fcx_in_gneq, fcx_in_features; 1201 unsigned int mdc; 1202 int tpm; 1203 1204 if (dasd_nofcx) 1205 return 0; 1206 /* is transport mode supported? */ 1207 fcx_in_css = css_general_characteristics.fcx; 1208 fcx_in_gneq = private->gneq->reserved2[7] & 0x04; 1209 fcx_in_features = private->features.feature[40] & 0x80; 1210 tpm = fcx_in_css && fcx_in_gneq && fcx_in_features; 1211 1212 if (!tpm) 1213 return 0; 1214 1215 mdc = ccw_device_get_mdc(device->cdev, 0); 1216 if (mdc == 0) { 1217 dev_warn(&device->cdev->dev, "Detecting the maximum supported data size for zHPF requests failed\n"); 1218 return 0; 1219 } else { 1220 return (u32)mdc * FCX_MAX_DATA_FACTOR; 1221 } 1222 } 1223 1224 static int verify_fcx_max_data(struct dasd_device *device, __u8 lpm) 1225 { 1226 struct dasd_eckd_private *private = device->private; 1227 unsigned int mdc; 1228 u32 fcx_max_data; 1229 1230 if (private->fcx_max_data) { 1231 mdc = ccw_device_get_mdc(device->cdev, lpm); 1232 if (mdc == 0) { 1233 dev_warn(&device->cdev->dev, 1234 "Detecting the maximum data size for zHPF " 1235 "requests failed (rc=%d) for a new path %x\n", 1236 mdc, lpm); 1237 return mdc; 1238 } 1239 fcx_max_data = (u32)mdc * FCX_MAX_DATA_FACTOR; 1240 if (fcx_max_data < private->fcx_max_data) { 1241 dev_warn(&device->cdev->dev, 1242 "The maximum data size for zHPF requests %u " 1243 "on a new path %x is below the active maximum " 1244 "%u\n", fcx_max_data, lpm, 1245 private->fcx_max_data); 1246 return -EACCES; 1247 } 1248 } 1249 return 0; 1250 } 1251 1252 static int rebuild_device_uid(struct dasd_device *device, 1253 struct pe_handler_work_data *data) 1254 { 1255 struct dasd_eckd_private *private = device->private; 1256 __u8 lpm, opm = dasd_path_get_opm(device); 1257 int rc = -ENODEV; 1258 1259 for (lpm = 0x80; lpm; lpm >>= 1) { 1260 if (!(lpm & opm)) 1261 continue; 1262 memset(&data->rcd_buffer, 0, sizeof(data->rcd_buffer)); 1263 memset(&data->cqr, 0, sizeof(data->cqr)); 1264 data->cqr.cpaddr = &data->ccw; 1265 rc = dasd_eckd_read_conf_immediately(device, &data->cqr, 1266 data->rcd_buffer, 1267 lpm); 1268 1269 if (rc) { 1270 if (rc == -EOPNOTSUPP) /* -EOPNOTSUPP is ok */ 1271 continue; 1272 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 1273 "Read configuration data " 1274 "returned error %d", rc); 1275 break; 1276 } 1277 memcpy(private->conf_data, data->rcd_buffer, 1278 DASD_ECKD_RCD_DATA_SIZE); 1279 if (dasd_eckd_identify_conf_parts(private)) { 1280 rc = -ENODEV; 1281 } else /* first valid path is enough */ 1282 break; 1283 } 1284 1285 if (!rc) 1286 rc = dasd_eckd_generate_uid(device); 1287 1288 return rc; 1289 } 1290 1291 static void dasd_eckd_path_available_action(struct dasd_device *device, 1292 struct pe_handler_work_data *data) 1293 { 1294 struct dasd_eckd_private path_private; 1295 __u8 path_rcd_buf[DASD_ECKD_RCD_DATA_SIZE]; 1296 __u8 lpm, opm, npm, ppm, epm, hpfpm, cablepm; 1297 struct dasd_conf_data *conf_data; 1298 unsigned long flags; 1299 char print_uid[60]; 1300 int rc, pos; 1301 1302 opm = 0; 1303 npm = 0; 1304 ppm = 0; 1305 epm = 0; 1306 hpfpm = 0; 1307 cablepm = 0; 1308 1309 for (lpm = 0x80; lpm; lpm >>= 1) { 1310 if (!(lpm & data->tbvpm)) 1311 continue; 1312 memset(&data->rcd_buffer, 0, sizeof(data->rcd_buffer)); 1313 memset(&data->cqr, 0, sizeof(data->cqr)); 1314 data->cqr.cpaddr = &data->ccw; 1315 rc = dasd_eckd_read_conf_immediately(device, &data->cqr, 1316 data->rcd_buffer, 1317 lpm); 1318 if (!rc) { 1319 switch (dasd_eckd_path_access(data->rcd_buffer, 1320 DASD_ECKD_RCD_DATA_SIZE) 1321 ) { 1322 case 0x02: 1323 npm |= lpm; 1324 break; 1325 case 0x03: 1326 ppm |= lpm; 1327 break; 1328 } 1329 opm |= lpm; 1330 } else if (rc == -EOPNOTSUPP) { 1331 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1332 "path verification: No configuration " 1333 "data retrieved"); 1334 opm |= lpm; 1335 } else if (rc == -EAGAIN) { 1336 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1337 "path verification: device is stopped," 1338 " try again later"); 1339 epm |= lpm; 1340 } else { 1341 dev_warn(&device->cdev->dev, 1342 "Reading device feature codes failed " 1343 "(rc=%d) for new path %x\n", rc, lpm); 1344 continue; 1345 } 1346 if (verify_fcx_max_data(device, lpm)) { 1347 opm &= ~lpm; 1348 npm &= ~lpm; 1349 ppm &= ~lpm; 1350 hpfpm |= lpm; 1351 continue; 1352 } 1353 1354 /* 1355 * save conf_data for comparison after 1356 * rebuild_device_uid may have changed 1357 * the original data 1358 */ 1359 memcpy(&path_rcd_buf, data->rcd_buffer, 1360 DASD_ECKD_RCD_DATA_SIZE); 1361 path_private.conf_data = (void *) &path_rcd_buf; 1362 path_private.conf_len = DASD_ECKD_RCD_DATA_SIZE; 1363 if (dasd_eckd_identify_conf_parts(&path_private)) { 1364 path_private.conf_data = NULL; 1365 path_private.conf_len = 0; 1366 continue; 1367 } 1368 1369 /* 1370 * compare path UID with device UID only if at least 1371 * one valid path is left 1372 * in other case the device UID may have changed and 1373 * the first working path UID will be used as device UID 1374 */ 1375 if (dasd_path_get_opm(device) && 1376 dasd_eckd_compare_path_uid(device, &path_private)) { 1377 /* 1378 * the comparison was not successful 1379 * rebuild the device UID with at least one 1380 * known path in case a z/VM hyperswap command 1381 * has changed the device 1382 * 1383 * after this compare again 1384 * 1385 * if either the rebuild or the recompare fails 1386 * the path can not be used 1387 */ 1388 if (rebuild_device_uid(device, data) || 1389 dasd_eckd_compare_path_uid( 1390 device, &path_private)) { 1391 dasd_eckd_get_uid_string(&path_private, 1392 print_uid); 1393 dev_err(&device->cdev->dev, 1394 "The newly added channel path %02X " 1395 "will not be used because it leads " 1396 "to a different device %s\n", 1397 lpm, print_uid); 1398 opm &= ~lpm; 1399 npm &= ~lpm; 1400 ppm &= ~lpm; 1401 cablepm |= lpm; 1402 continue; 1403 } 1404 } 1405 1406 conf_data = kzalloc(DASD_ECKD_RCD_DATA_SIZE, GFP_KERNEL); 1407 if (conf_data) { 1408 memcpy(conf_data, data->rcd_buffer, 1409 DASD_ECKD_RCD_DATA_SIZE); 1410 } 1411 pos = pathmask_to_pos(lpm); 1412 dasd_eckd_store_conf_data(device, conf_data, pos); 1413 1414 /* 1415 * There is a small chance that a path is lost again between 1416 * above path verification and the following modification of 1417 * the device opm mask. We could avoid that race here by using 1418 * yet another path mask, but we rather deal with this unlikely 1419 * situation in dasd_start_IO. 1420 */ 1421 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 1422 if (!dasd_path_get_opm(device) && opm) { 1423 dasd_path_set_opm(device, opm); 1424 dasd_generic_path_operational(device); 1425 } else { 1426 dasd_path_add_opm(device, opm); 1427 } 1428 dasd_path_add_nppm(device, npm); 1429 dasd_path_add_ppm(device, ppm); 1430 dasd_path_add_tbvpm(device, epm); 1431 dasd_path_add_cablepm(device, cablepm); 1432 dasd_path_add_nohpfpm(device, hpfpm); 1433 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 1434 1435 dasd_path_create_kobj(device, pos); 1436 } 1437 } 1438 1439 static void do_pe_handler_work(struct work_struct *work) 1440 { 1441 struct pe_handler_work_data *data; 1442 struct dasd_device *device; 1443 1444 data = container_of(work, struct pe_handler_work_data, worker); 1445 device = data->device; 1446 1447 /* delay path verification until device was resumed */ 1448 if (test_bit(DASD_FLAG_SUSPENDED, &device->flags)) { 1449 schedule_work(work); 1450 return; 1451 } 1452 /* check if path verification already running and delay if so */ 1453 if (test_and_set_bit(DASD_FLAG_PATH_VERIFY, &device->flags)) { 1454 schedule_work(work); 1455 return; 1456 } 1457 1458 if (data->tbvpm) 1459 dasd_eckd_path_available_action(device, data); 1460 if (data->fcsecpm) 1461 dasd_eckd_read_fc_security(device); 1462 1463 clear_bit(DASD_FLAG_PATH_VERIFY, &device->flags); 1464 dasd_put_device(device); 1465 if (data->isglobal) 1466 mutex_unlock(&dasd_pe_handler_mutex); 1467 else 1468 kfree(data); 1469 } 1470 1471 static int dasd_eckd_pe_handler(struct dasd_device *device, 1472 __u8 tbvpm, __u8 fcsecpm) 1473 { 1474 struct pe_handler_work_data *data; 1475 1476 data = kmalloc(sizeof(*data), GFP_ATOMIC | GFP_DMA); 1477 if (!data) { 1478 if (mutex_trylock(&dasd_pe_handler_mutex)) { 1479 data = pe_handler_worker; 1480 data->isglobal = 1; 1481 } else { 1482 return -ENOMEM; 1483 } 1484 } else { 1485 memset(data, 0, sizeof(*data)); 1486 data->isglobal = 0; 1487 } 1488 INIT_WORK(&data->worker, do_pe_handler_work); 1489 dasd_get_device(device); 1490 data->device = device; 1491 data->tbvpm = tbvpm; 1492 data->fcsecpm = fcsecpm; 1493 schedule_work(&data->worker); 1494 return 0; 1495 } 1496 1497 static void dasd_eckd_reset_path(struct dasd_device *device, __u8 pm) 1498 { 1499 struct dasd_eckd_private *private = device->private; 1500 unsigned long flags; 1501 1502 if (!private->fcx_max_data) 1503 private->fcx_max_data = get_fcx_max_data(device); 1504 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 1505 dasd_path_set_tbvpm(device, pm ? : dasd_path_get_notoperpm(device)); 1506 dasd_schedule_device_bh(device); 1507 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 1508 } 1509 1510 static int dasd_eckd_read_features(struct dasd_device *device) 1511 { 1512 struct dasd_eckd_private *private = device->private; 1513 struct dasd_psf_prssd_data *prssdp; 1514 struct dasd_rssd_features *features; 1515 struct dasd_ccw_req *cqr; 1516 struct ccw1 *ccw; 1517 int rc; 1518 1519 memset(&private->features, 0, sizeof(struct dasd_rssd_features)); 1520 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ + 1 /* RSSD */, 1521 (sizeof(struct dasd_psf_prssd_data) + 1522 sizeof(struct dasd_rssd_features)), 1523 device, NULL); 1524 if (IS_ERR(cqr)) { 1525 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", "Could not " 1526 "allocate initialization request"); 1527 return PTR_ERR(cqr); 1528 } 1529 cqr->startdev = device; 1530 cqr->memdev = device; 1531 cqr->block = NULL; 1532 cqr->retries = 256; 1533 cqr->expires = 10 * HZ; 1534 1535 /* Prepare for Read Subsystem Data */ 1536 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 1537 memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data)); 1538 prssdp->order = PSF_ORDER_PRSSD; 1539 prssdp->suborder = 0x41; /* Read Feature Codes */ 1540 /* all other bytes of prssdp must be zero */ 1541 1542 ccw = cqr->cpaddr; 1543 ccw->cmd_code = DASD_ECKD_CCW_PSF; 1544 ccw->count = sizeof(struct dasd_psf_prssd_data); 1545 ccw->flags |= CCW_FLAG_CC; 1546 ccw->cda = (__u32)(addr_t) prssdp; 1547 1548 /* Read Subsystem Data - feature codes */ 1549 features = (struct dasd_rssd_features *) (prssdp + 1); 1550 memset(features, 0, sizeof(struct dasd_rssd_features)); 1551 1552 ccw++; 1553 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 1554 ccw->count = sizeof(struct dasd_rssd_features); 1555 ccw->cda = (__u32)(addr_t) features; 1556 1557 cqr->buildclk = get_tod_clock(); 1558 cqr->status = DASD_CQR_FILLED; 1559 rc = dasd_sleep_on(cqr); 1560 if (rc == 0) { 1561 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 1562 features = (struct dasd_rssd_features *) (prssdp + 1); 1563 memcpy(&private->features, features, 1564 sizeof(struct dasd_rssd_features)); 1565 } else 1566 dev_warn(&device->cdev->dev, "Reading device feature codes" 1567 " failed with rc=%d\n", rc); 1568 dasd_sfree_request(cqr, cqr->memdev); 1569 return rc; 1570 } 1571 1572 /* Read Volume Information - Volume Storage Query */ 1573 static int dasd_eckd_read_vol_info(struct dasd_device *device) 1574 { 1575 struct dasd_eckd_private *private = device->private; 1576 struct dasd_psf_prssd_data *prssdp; 1577 struct dasd_rssd_vsq *vsq; 1578 struct dasd_ccw_req *cqr; 1579 struct ccw1 *ccw; 1580 int useglobal; 1581 int rc; 1582 1583 /* This command cannot be executed on an alias device */ 1584 if (private->uid.type == UA_BASE_PAV_ALIAS || 1585 private->uid.type == UA_HYPER_PAV_ALIAS) 1586 return 0; 1587 1588 useglobal = 0; 1589 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 2 /* PSF + RSSD */, 1590 sizeof(*prssdp) + sizeof(*vsq), device, NULL); 1591 if (IS_ERR(cqr)) { 1592 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1593 "Could not allocate initialization request"); 1594 mutex_lock(&dasd_vol_info_mutex); 1595 useglobal = 1; 1596 cqr = &dasd_vol_info_req->cqr; 1597 memset(cqr, 0, sizeof(*cqr)); 1598 memset(dasd_vol_info_req, 0, sizeof(*dasd_vol_info_req)); 1599 cqr->cpaddr = &dasd_vol_info_req->ccw; 1600 cqr->data = &dasd_vol_info_req->data; 1601 cqr->magic = DASD_ECKD_MAGIC; 1602 } 1603 1604 /* Prepare for Read Subsystem Data */ 1605 prssdp = cqr->data; 1606 prssdp->order = PSF_ORDER_PRSSD; 1607 prssdp->suborder = PSF_SUBORDER_VSQ; /* Volume Storage Query */ 1608 prssdp->lss = private->ned->ID; 1609 prssdp->volume = private->ned->unit_addr; 1610 1611 ccw = cqr->cpaddr; 1612 ccw->cmd_code = DASD_ECKD_CCW_PSF; 1613 ccw->count = sizeof(*prssdp); 1614 ccw->flags |= CCW_FLAG_CC; 1615 ccw->cda = (__u32)(addr_t)prssdp; 1616 1617 /* Read Subsystem Data - Volume Storage Query */ 1618 vsq = (struct dasd_rssd_vsq *)(prssdp + 1); 1619 memset(vsq, 0, sizeof(*vsq)); 1620 1621 ccw++; 1622 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 1623 ccw->count = sizeof(*vsq); 1624 ccw->flags |= CCW_FLAG_SLI; 1625 ccw->cda = (__u32)(addr_t)vsq; 1626 1627 cqr->buildclk = get_tod_clock(); 1628 cqr->status = DASD_CQR_FILLED; 1629 cqr->startdev = device; 1630 cqr->memdev = device; 1631 cqr->block = NULL; 1632 cqr->retries = 256; 1633 cqr->expires = device->default_expires * HZ; 1634 /* The command might not be supported. Suppress the error output */ 1635 __set_bit(DASD_CQR_SUPPRESS_CR, &cqr->flags); 1636 1637 rc = dasd_sleep_on_interruptible(cqr); 1638 if (rc == 0) { 1639 memcpy(&private->vsq, vsq, sizeof(*vsq)); 1640 } else { 1641 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 1642 "Reading the volume storage information failed with rc=%d", rc); 1643 } 1644 1645 if (useglobal) 1646 mutex_unlock(&dasd_vol_info_mutex); 1647 else 1648 dasd_sfree_request(cqr, cqr->memdev); 1649 1650 return rc; 1651 } 1652 1653 static int dasd_eckd_is_ese(struct dasd_device *device) 1654 { 1655 struct dasd_eckd_private *private = device->private; 1656 1657 return private->vsq.vol_info.ese; 1658 } 1659 1660 static int dasd_eckd_ext_pool_id(struct dasd_device *device) 1661 { 1662 struct dasd_eckd_private *private = device->private; 1663 1664 return private->vsq.extent_pool_id; 1665 } 1666 1667 /* 1668 * This value represents the total amount of available space. As more space is 1669 * allocated by ESE volumes, this value will decrease. 1670 * The data for this value is therefore updated on any call. 1671 */ 1672 static int dasd_eckd_space_configured(struct dasd_device *device) 1673 { 1674 struct dasd_eckd_private *private = device->private; 1675 int rc; 1676 1677 rc = dasd_eckd_read_vol_info(device); 1678 1679 return rc ? : private->vsq.space_configured; 1680 } 1681 1682 /* 1683 * The value of space allocated by an ESE volume may have changed and is 1684 * therefore updated on any call. 1685 */ 1686 static int dasd_eckd_space_allocated(struct dasd_device *device) 1687 { 1688 struct dasd_eckd_private *private = device->private; 1689 int rc; 1690 1691 rc = dasd_eckd_read_vol_info(device); 1692 1693 return rc ? : private->vsq.space_allocated; 1694 } 1695 1696 static int dasd_eckd_logical_capacity(struct dasd_device *device) 1697 { 1698 struct dasd_eckd_private *private = device->private; 1699 1700 return private->vsq.logical_capacity; 1701 } 1702 1703 static void dasd_eckd_ext_pool_exhaust_work(struct work_struct *work) 1704 { 1705 struct ext_pool_exhaust_work_data *data; 1706 struct dasd_device *device; 1707 struct dasd_device *base; 1708 1709 data = container_of(work, struct ext_pool_exhaust_work_data, worker); 1710 device = data->device; 1711 base = data->base; 1712 1713 if (!base) 1714 base = device; 1715 if (dasd_eckd_space_configured(base) != 0) { 1716 dasd_generic_space_avail(device); 1717 } else { 1718 dev_warn(&device->cdev->dev, "No space left in the extent pool\n"); 1719 DBF_DEV_EVENT(DBF_WARNING, device, "%s", "out of space"); 1720 } 1721 1722 dasd_put_device(device); 1723 kfree(data); 1724 } 1725 1726 static int dasd_eckd_ext_pool_exhaust(struct dasd_device *device, 1727 struct dasd_ccw_req *cqr) 1728 { 1729 struct ext_pool_exhaust_work_data *data; 1730 1731 data = kzalloc(sizeof(*data), GFP_ATOMIC); 1732 if (!data) 1733 return -ENOMEM; 1734 INIT_WORK(&data->worker, dasd_eckd_ext_pool_exhaust_work); 1735 dasd_get_device(device); 1736 data->device = device; 1737 1738 if (cqr->block) 1739 data->base = cqr->block->base; 1740 else if (cqr->basedev) 1741 data->base = cqr->basedev; 1742 else 1743 data->base = NULL; 1744 1745 schedule_work(&data->worker); 1746 1747 return 0; 1748 } 1749 1750 static void dasd_eckd_cpy_ext_pool_data(struct dasd_device *device, 1751 struct dasd_rssd_lcq *lcq) 1752 { 1753 struct dasd_eckd_private *private = device->private; 1754 int pool_id = dasd_eckd_ext_pool_id(device); 1755 struct dasd_ext_pool_sum eps; 1756 int i; 1757 1758 for (i = 0; i < lcq->pool_count; i++) { 1759 eps = lcq->ext_pool_sum[i]; 1760 if (eps.pool_id == pool_id) { 1761 memcpy(&private->eps, &eps, 1762 sizeof(struct dasd_ext_pool_sum)); 1763 } 1764 } 1765 } 1766 1767 /* Read Extent Pool Information - Logical Configuration Query */ 1768 static int dasd_eckd_read_ext_pool_info(struct dasd_device *device) 1769 { 1770 struct dasd_eckd_private *private = device->private; 1771 struct dasd_psf_prssd_data *prssdp; 1772 struct dasd_rssd_lcq *lcq; 1773 struct dasd_ccw_req *cqr; 1774 struct ccw1 *ccw; 1775 int rc; 1776 1777 /* This command cannot be executed on an alias device */ 1778 if (private->uid.type == UA_BASE_PAV_ALIAS || 1779 private->uid.type == UA_HYPER_PAV_ALIAS) 1780 return 0; 1781 1782 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 2 /* PSF + RSSD */, 1783 sizeof(*prssdp) + sizeof(*lcq), device, NULL); 1784 if (IS_ERR(cqr)) { 1785 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1786 "Could not allocate initialization request"); 1787 return PTR_ERR(cqr); 1788 } 1789 1790 /* Prepare for Read Subsystem Data */ 1791 prssdp = cqr->data; 1792 memset(prssdp, 0, sizeof(*prssdp)); 1793 prssdp->order = PSF_ORDER_PRSSD; 1794 prssdp->suborder = PSF_SUBORDER_LCQ; /* Logical Configuration Query */ 1795 1796 ccw = cqr->cpaddr; 1797 ccw->cmd_code = DASD_ECKD_CCW_PSF; 1798 ccw->count = sizeof(*prssdp); 1799 ccw->flags |= CCW_FLAG_CC; 1800 ccw->cda = (__u32)(addr_t)prssdp; 1801 1802 lcq = (struct dasd_rssd_lcq *)(prssdp + 1); 1803 memset(lcq, 0, sizeof(*lcq)); 1804 1805 ccw++; 1806 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 1807 ccw->count = sizeof(*lcq); 1808 ccw->flags |= CCW_FLAG_SLI; 1809 ccw->cda = (__u32)(addr_t)lcq; 1810 1811 cqr->buildclk = get_tod_clock(); 1812 cqr->status = DASD_CQR_FILLED; 1813 cqr->startdev = device; 1814 cqr->memdev = device; 1815 cqr->block = NULL; 1816 cqr->retries = 256; 1817 cqr->expires = device->default_expires * HZ; 1818 /* The command might not be supported. Suppress the error output */ 1819 __set_bit(DASD_CQR_SUPPRESS_CR, &cqr->flags); 1820 1821 rc = dasd_sleep_on_interruptible(cqr); 1822 if (rc == 0) { 1823 dasd_eckd_cpy_ext_pool_data(device, lcq); 1824 } else { 1825 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 1826 "Reading the logical configuration failed with rc=%d", rc); 1827 } 1828 1829 dasd_sfree_request(cqr, cqr->memdev); 1830 1831 return rc; 1832 } 1833 1834 /* 1835 * Depending on the device type, the extent size is specified either as 1836 * cylinders per extent (CKD) or size per extent (FBA) 1837 * A 1GB size corresponds to 1113cyl, and 16MB to 21cyl. 1838 */ 1839 static int dasd_eckd_ext_size(struct dasd_device *device) 1840 { 1841 struct dasd_eckd_private *private = device->private; 1842 struct dasd_ext_pool_sum eps = private->eps; 1843 1844 if (!eps.flags.extent_size_valid) 1845 return 0; 1846 if (eps.extent_size.size_1G) 1847 return 1113; 1848 if (eps.extent_size.size_16M) 1849 return 21; 1850 1851 return 0; 1852 } 1853 1854 static int dasd_eckd_ext_pool_warn_thrshld(struct dasd_device *device) 1855 { 1856 struct dasd_eckd_private *private = device->private; 1857 1858 return private->eps.warn_thrshld; 1859 } 1860 1861 static int dasd_eckd_ext_pool_cap_at_warnlevel(struct dasd_device *device) 1862 { 1863 struct dasd_eckd_private *private = device->private; 1864 1865 return private->eps.flags.capacity_at_warnlevel; 1866 } 1867 1868 /* 1869 * Extent Pool out of space 1870 */ 1871 static int dasd_eckd_ext_pool_oos(struct dasd_device *device) 1872 { 1873 struct dasd_eckd_private *private = device->private; 1874 1875 return private->eps.flags.pool_oos; 1876 } 1877 1878 /* 1879 * Build CP for Perform Subsystem Function - SSC. 1880 */ 1881 static struct dasd_ccw_req *dasd_eckd_build_psf_ssc(struct dasd_device *device, 1882 int enable_pav) 1883 { 1884 struct dasd_ccw_req *cqr; 1885 struct dasd_psf_ssc_data *psf_ssc_data; 1886 struct ccw1 *ccw; 1887 1888 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ , 1889 sizeof(struct dasd_psf_ssc_data), 1890 device, NULL); 1891 1892 if (IS_ERR(cqr)) { 1893 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 1894 "Could not allocate PSF-SSC request"); 1895 return cqr; 1896 } 1897 psf_ssc_data = (struct dasd_psf_ssc_data *)cqr->data; 1898 psf_ssc_data->order = PSF_ORDER_SSC; 1899 psf_ssc_data->suborder = 0xc0; 1900 if (enable_pav) { 1901 psf_ssc_data->suborder |= 0x08; 1902 psf_ssc_data->reserved[0] = 0x88; 1903 } 1904 ccw = cqr->cpaddr; 1905 ccw->cmd_code = DASD_ECKD_CCW_PSF; 1906 ccw->cda = (__u32)(addr_t)psf_ssc_data; 1907 ccw->count = 66; 1908 1909 cqr->startdev = device; 1910 cqr->memdev = device; 1911 cqr->block = NULL; 1912 cqr->retries = 256; 1913 cqr->expires = 10*HZ; 1914 cqr->buildclk = get_tod_clock(); 1915 cqr->status = DASD_CQR_FILLED; 1916 return cqr; 1917 } 1918 1919 /* 1920 * Perform Subsystem Function. 1921 * It is necessary to trigger CIO for channel revalidation since this 1922 * call might change behaviour of DASD devices. 1923 */ 1924 static int 1925 dasd_eckd_psf_ssc(struct dasd_device *device, int enable_pav, 1926 unsigned long flags) 1927 { 1928 struct dasd_ccw_req *cqr; 1929 int rc; 1930 1931 cqr = dasd_eckd_build_psf_ssc(device, enable_pav); 1932 if (IS_ERR(cqr)) 1933 return PTR_ERR(cqr); 1934 1935 /* 1936 * set flags e.g. turn on failfast, to prevent blocking 1937 * the calling function should handle failed requests 1938 */ 1939 cqr->flags |= flags; 1940 1941 rc = dasd_sleep_on(cqr); 1942 if (!rc) 1943 /* trigger CIO to reprobe devices */ 1944 css_schedule_reprobe(); 1945 else if (cqr->intrc == -EAGAIN) 1946 rc = -EAGAIN; 1947 1948 dasd_sfree_request(cqr, cqr->memdev); 1949 return rc; 1950 } 1951 1952 /* 1953 * Valide storage server of current device. 1954 */ 1955 static int dasd_eckd_validate_server(struct dasd_device *device, 1956 unsigned long flags) 1957 { 1958 struct dasd_eckd_private *private = device->private; 1959 int enable_pav, rc; 1960 1961 if (private->uid.type == UA_BASE_PAV_ALIAS || 1962 private->uid.type == UA_HYPER_PAV_ALIAS) 1963 return 0; 1964 if (dasd_nopav || MACHINE_IS_VM) 1965 enable_pav = 0; 1966 else 1967 enable_pav = 1; 1968 rc = dasd_eckd_psf_ssc(device, enable_pav, flags); 1969 1970 /* may be requested feature is not available on server, 1971 * therefore just report error and go ahead */ 1972 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "PSF-SSC for SSID %04x " 1973 "returned rc=%d", private->uid.ssid, rc); 1974 return rc; 1975 } 1976 1977 /* 1978 * worker to do a validate server in case of a lost pathgroup 1979 */ 1980 static void dasd_eckd_do_validate_server(struct work_struct *work) 1981 { 1982 struct dasd_device *device = container_of(work, struct dasd_device, 1983 kick_validate); 1984 unsigned long flags = 0; 1985 1986 set_bit(DASD_CQR_FLAGS_FAILFAST, &flags); 1987 if (dasd_eckd_validate_server(device, flags) 1988 == -EAGAIN) { 1989 /* schedule worker again if failed */ 1990 schedule_work(&device->kick_validate); 1991 return; 1992 } 1993 1994 dasd_put_device(device); 1995 } 1996 1997 static void dasd_eckd_kick_validate_server(struct dasd_device *device) 1998 { 1999 dasd_get_device(device); 2000 /* exit if device not online or in offline processing */ 2001 if (test_bit(DASD_FLAG_OFFLINE, &device->flags) || 2002 device->state < DASD_STATE_ONLINE) { 2003 dasd_put_device(device); 2004 return; 2005 } 2006 /* queue call to do_validate_server to the kernel event daemon. */ 2007 if (!schedule_work(&device->kick_validate)) 2008 dasd_put_device(device); 2009 } 2010 2011 /* 2012 * Check device characteristics. 2013 * If the device is accessible using ECKD discipline, the device is enabled. 2014 */ 2015 static int 2016 dasd_eckd_check_characteristics(struct dasd_device *device) 2017 { 2018 struct dasd_eckd_private *private = device->private; 2019 struct dasd_block *block; 2020 struct dasd_uid temp_uid; 2021 int rc, i; 2022 int readonly; 2023 unsigned long value; 2024 2025 /* setup work queue for validate server*/ 2026 INIT_WORK(&device->kick_validate, dasd_eckd_do_validate_server); 2027 /* setup work queue for summary unit check */ 2028 INIT_WORK(&device->suc_work, dasd_alias_handle_summary_unit_check); 2029 2030 if (!ccw_device_is_pathgroup(device->cdev)) { 2031 dev_warn(&device->cdev->dev, 2032 "A channel path group could not be established\n"); 2033 return -EIO; 2034 } 2035 if (!ccw_device_is_multipath(device->cdev)) { 2036 dev_info(&device->cdev->dev, 2037 "The DASD is not operating in multipath mode\n"); 2038 } 2039 if (!private) { 2040 private = kzalloc(sizeof(*private), GFP_KERNEL | GFP_DMA); 2041 if (!private) { 2042 dev_warn(&device->cdev->dev, 2043 "Allocating memory for private DASD data " 2044 "failed\n"); 2045 return -ENOMEM; 2046 } 2047 device->private = private; 2048 } else { 2049 memset(private, 0, sizeof(*private)); 2050 } 2051 /* Invalidate status of initial analysis. */ 2052 private->init_cqr_status = -1; 2053 /* Set default cache operations. */ 2054 private->attrib.operation = DASD_NORMAL_CACHE; 2055 private->attrib.nr_cyl = 0; 2056 2057 /* Read Configuration Data */ 2058 rc = dasd_eckd_read_conf(device); 2059 if (rc) 2060 goto out_err1; 2061 2062 /* set some default values */ 2063 device->default_expires = DASD_EXPIRES; 2064 device->default_retries = DASD_RETRIES; 2065 device->path_thrhld = DASD_ECKD_PATH_THRHLD; 2066 device->path_interval = DASD_ECKD_PATH_INTERVAL; 2067 2068 if (private->gneq) { 2069 value = 1; 2070 for (i = 0; i < private->gneq->timeout.value; i++) 2071 value = 10 * value; 2072 value = value * private->gneq->timeout.number; 2073 /* do not accept useless values */ 2074 if (value != 0 && value <= DASD_EXPIRES_MAX) 2075 device->default_expires = value; 2076 } 2077 2078 dasd_eckd_get_uid(device, &temp_uid); 2079 if (temp_uid.type == UA_BASE_DEVICE) { 2080 block = dasd_alloc_block(); 2081 if (IS_ERR(block)) { 2082 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 2083 "could not allocate dasd " 2084 "block structure"); 2085 rc = PTR_ERR(block); 2086 goto out_err1; 2087 } 2088 device->block = block; 2089 block->base = device; 2090 } 2091 2092 /* register lcu with alias handling, enable PAV */ 2093 rc = dasd_alias_make_device_known_to_lcu(device); 2094 if (rc) 2095 goto out_err2; 2096 2097 dasd_eckd_validate_server(device, 0); 2098 2099 /* device may report different configuration data after LCU setup */ 2100 rc = dasd_eckd_read_conf(device); 2101 if (rc) 2102 goto out_err3; 2103 2104 dasd_path_create_kobjects(device); 2105 2106 /* Read Feature Codes */ 2107 dasd_eckd_read_features(device); 2108 2109 /* Read Volume Information */ 2110 dasd_eckd_read_vol_info(device); 2111 2112 /* Read Extent Pool Information */ 2113 dasd_eckd_read_ext_pool_info(device); 2114 2115 /* Read Device Characteristics */ 2116 rc = dasd_generic_read_dev_chars(device, DASD_ECKD_MAGIC, 2117 &private->rdc_data, 64); 2118 if (rc) { 2119 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 2120 "Read device characteristic failed, rc=%d", rc); 2121 goto out_err3; 2122 } 2123 2124 if ((device->features & DASD_FEATURE_USERAW) && 2125 !(private->rdc_data.facilities.RT_in_LR)) { 2126 dev_err(&device->cdev->dev, "The storage server does not " 2127 "support raw-track access\n"); 2128 rc = -EINVAL; 2129 goto out_err3; 2130 } 2131 2132 /* find the valid cylinder size */ 2133 if (private->rdc_data.no_cyl == LV_COMPAT_CYL && 2134 private->rdc_data.long_no_cyl) 2135 private->real_cyl = private->rdc_data.long_no_cyl; 2136 else 2137 private->real_cyl = private->rdc_data.no_cyl; 2138 2139 private->fcx_max_data = get_fcx_max_data(device); 2140 2141 readonly = dasd_device_is_ro(device); 2142 if (readonly) 2143 set_bit(DASD_FLAG_DEVICE_RO, &device->flags); 2144 2145 dev_info(&device->cdev->dev, "New DASD %04X/%02X (CU %04X/%02X) " 2146 "with %d cylinders, %d heads, %d sectors%s\n", 2147 private->rdc_data.dev_type, 2148 private->rdc_data.dev_model, 2149 private->rdc_data.cu_type, 2150 private->rdc_data.cu_model.model, 2151 private->real_cyl, 2152 private->rdc_data.trk_per_cyl, 2153 private->rdc_data.sec_per_trk, 2154 readonly ? ", read-only device" : ""); 2155 return 0; 2156 2157 out_err3: 2158 dasd_alias_disconnect_device_from_lcu(device); 2159 out_err2: 2160 dasd_free_block(device->block); 2161 device->block = NULL; 2162 out_err1: 2163 dasd_eckd_clear_conf_data(device); 2164 dasd_path_remove_kobjects(device); 2165 kfree(device->private); 2166 device->private = NULL; 2167 return rc; 2168 } 2169 2170 static void dasd_eckd_uncheck_device(struct dasd_device *device) 2171 { 2172 struct dasd_eckd_private *private = device->private; 2173 2174 if (!private) 2175 return; 2176 2177 dasd_alias_disconnect_device_from_lcu(device); 2178 private->ned = NULL; 2179 private->sneq = NULL; 2180 private->vdsneq = NULL; 2181 private->gneq = NULL; 2182 dasd_eckd_clear_conf_data(device); 2183 dasd_path_remove_kobjects(device); 2184 } 2185 2186 static struct dasd_ccw_req * 2187 dasd_eckd_analysis_ccw(struct dasd_device *device) 2188 { 2189 struct dasd_eckd_private *private = device->private; 2190 struct eckd_count *count_data; 2191 struct LO_eckd_data *LO_data; 2192 struct dasd_ccw_req *cqr; 2193 struct ccw1 *ccw; 2194 int cplength, datasize; 2195 int i; 2196 2197 cplength = 8; 2198 datasize = sizeof(struct DE_eckd_data) + 2*sizeof(struct LO_eckd_data); 2199 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, device, 2200 NULL); 2201 if (IS_ERR(cqr)) 2202 return cqr; 2203 ccw = cqr->cpaddr; 2204 /* Define extent for the first 2 tracks. */ 2205 define_extent(ccw++, cqr->data, 0, 1, 2206 DASD_ECKD_CCW_READ_COUNT, device, 0); 2207 LO_data = cqr->data + sizeof(struct DE_eckd_data); 2208 /* Locate record for the first 4 records on track 0. */ 2209 ccw[-1].flags |= CCW_FLAG_CC; 2210 locate_record(ccw++, LO_data++, 0, 0, 4, 2211 DASD_ECKD_CCW_READ_COUNT, device, 0); 2212 2213 count_data = private->count_area; 2214 for (i = 0; i < 4; i++) { 2215 ccw[-1].flags |= CCW_FLAG_CC; 2216 ccw->cmd_code = DASD_ECKD_CCW_READ_COUNT; 2217 ccw->flags = 0; 2218 ccw->count = 8; 2219 ccw->cda = (__u32)(addr_t) count_data; 2220 ccw++; 2221 count_data++; 2222 } 2223 2224 /* Locate record for the first record on track 1. */ 2225 ccw[-1].flags |= CCW_FLAG_CC; 2226 locate_record(ccw++, LO_data++, 1, 0, 1, 2227 DASD_ECKD_CCW_READ_COUNT, device, 0); 2228 /* Read count ccw. */ 2229 ccw[-1].flags |= CCW_FLAG_CC; 2230 ccw->cmd_code = DASD_ECKD_CCW_READ_COUNT; 2231 ccw->flags = 0; 2232 ccw->count = 8; 2233 ccw->cda = (__u32)(addr_t) count_data; 2234 2235 cqr->block = NULL; 2236 cqr->startdev = device; 2237 cqr->memdev = device; 2238 cqr->retries = 255; 2239 cqr->buildclk = get_tod_clock(); 2240 cqr->status = DASD_CQR_FILLED; 2241 /* Set flags to suppress output for expected errors */ 2242 set_bit(DASD_CQR_SUPPRESS_NRF, &cqr->flags); 2243 2244 return cqr; 2245 } 2246 2247 /* differentiate between 'no record found' and any other error */ 2248 static int dasd_eckd_analysis_evaluation(struct dasd_ccw_req *init_cqr) 2249 { 2250 char *sense; 2251 if (init_cqr->status == DASD_CQR_DONE) 2252 return INIT_CQR_OK; 2253 else if (init_cqr->status == DASD_CQR_NEED_ERP || 2254 init_cqr->status == DASD_CQR_FAILED) { 2255 sense = dasd_get_sense(&init_cqr->irb); 2256 if (sense && (sense[1] & SNS1_NO_REC_FOUND)) 2257 return INIT_CQR_UNFORMATTED; 2258 else 2259 return INIT_CQR_ERROR; 2260 } else 2261 return INIT_CQR_ERROR; 2262 } 2263 2264 /* 2265 * This is the callback function for the init_analysis cqr. It saves 2266 * the status of the initial analysis ccw before it frees it and kicks 2267 * the device to continue the startup sequence. This will call 2268 * dasd_eckd_do_analysis again (if the devices has not been marked 2269 * for deletion in the meantime). 2270 */ 2271 static void dasd_eckd_analysis_callback(struct dasd_ccw_req *init_cqr, 2272 void *data) 2273 { 2274 struct dasd_device *device = init_cqr->startdev; 2275 struct dasd_eckd_private *private = device->private; 2276 2277 private->init_cqr_status = dasd_eckd_analysis_evaluation(init_cqr); 2278 dasd_sfree_request(init_cqr, device); 2279 dasd_kick_device(device); 2280 } 2281 2282 static int dasd_eckd_start_analysis(struct dasd_block *block) 2283 { 2284 struct dasd_ccw_req *init_cqr; 2285 2286 init_cqr = dasd_eckd_analysis_ccw(block->base); 2287 if (IS_ERR(init_cqr)) 2288 return PTR_ERR(init_cqr); 2289 init_cqr->callback = dasd_eckd_analysis_callback; 2290 init_cqr->callback_data = NULL; 2291 init_cqr->expires = 5*HZ; 2292 /* first try without ERP, so we can later handle unformatted 2293 * devices as special case 2294 */ 2295 clear_bit(DASD_CQR_FLAGS_USE_ERP, &init_cqr->flags); 2296 init_cqr->retries = 0; 2297 dasd_add_request_head(init_cqr); 2298 return -EAGAIN; 2299 } 2300 2301 static int dasd_eckd_end_analysis(struct dasd_block *block) 2302 { 2303 struct dasd_device *device = block->base; 2304 struct dasd_eckd_private *private = device->private; 2305 struct eckd_count *count_area; 2306 unsigned int sb, blk_per_trk; 2307 int status, i; 2308 struct dasd_ccw_req *init_cqr; 2309 2310 status = private->init_cqr_status; 2311 private->init_cqr_status = -1; 2312 if (status == INIT_CQR_ERROR) { 2313 /* try again, this time with full ERP */ 2314 init_cqr = dasd_eckd_analysis_ccw(device); 2315 dasd_sleep_on(init_cqr); 2316 status = dasd_eckd_analysis_evaluation(init_cqr); 2317 dasd_sfree_request(init_cqr, device); 2318 } 2319 2320 if (device->features & DASD_FEATURE_USERAW) { 2321 block->bp_block = DASD_RAW_BLOCKSIZE; 2322 blk_per_trk = DASD_RAW_BLOCK_PER_TRACK; 2323 block->s2b_shift = 3; 2324 goto raw; 2325 } 2326 2327 if (status == INIT_CQR_UNFORMATTED) { 2328 dev_warn(&device->cdev->dev, "The DASD is not formatted\n"); 2329 return -EMEDIUMTYPE; 2330 } else if (status == INIT_CQR_ERROR) { 2331 dev_err(&device->cdev->dev, 2332 "Detecting the DASD disk layout failed because " 2333 "of an I/O error\n"); 2334 return -EIO; 2335 } 2336 2337 private->uses_cdl = 1; 2338 /* Check Track 0 for Compatible Disk Layout */ 2339 count_area = NULL; 2340 for (i = 0; i < 3; i++) { 2341 if (private->count_area[i].kl != 4 || 2342 private->count_area[i].dl != dasd_eckd_cdl_reclen(i) - 4 || 2343 private->count_area[i].cyl != 0 || 2344 private->count_area[i].head != count_area_head[i] || 2345 private->count_area[i].record != count_area_rec[i]) { 2346 private->uses_cdl = 0; 2347 break; 2348 } 2349 } 2350 if (i == 3) 2351 count_area = &private->count_area[3]; 2352 2353 if (private->uses_cdl == 0) { 2354 for (i = 0; i < 5; i++) { 2355 if ((private->count_area[i].kl != 0) || 2356 (private->count_area[i].dl != 2357 private->count_area[0].dl) || 2358 private->count_area[i].cyl != 0 || 2359 private->count_area[i].head != count_area_head[i] || 2360 private->count_area[i].record != count_area_rec[i]) 2361 break; 2362 } 2363 if (i == 5) 2364 count_area = &private->count_area[0]; 2365 } else { 2366 if (private->count_area[3].record == 1) 2367 dev_warn(&device->cdev->dev, 2368 "Track 0 has no records following the VTOC\n"); 2369 } 2370 2371 if (count_area != NULL && count_area->kl == 0) { 2372 /* we found notthing violating our disk layout */ 2373 if (dasd_check_blocksize(count_area->dl) == 0) 2374 block->bp_block = count_area->dl; 2375 } 2376 if (block->bp_block == 0) { 2377 dev_warn(&device->cdev->dev, 2378 "The disk layout of the DASD is not supported\n"); 2379 return -EMEDIUMTYPE; 2380 } 2381 block->s2b_shift = 0; /* bits to shift 512 to get a block */ 2382 for (sb = 512; sb < block->bp_block; sb = sb << 1) 2383 block->s2b_shift++; 2384 2385 blk_per_trk = recs_per_track(&private->rdc_data, 0, block->bp_block); 2386 2387 raw: 2388 block->blocks = ((unsigned long) private->real_cyl * 2389 private->rdc_data.trk_per_cyl * 2390 blk_per_trk); 2391 2392 dev_info(&device->cdev->dev, 2393 "DASD with %u KB/block, %lu KB total size, %u KB/track, " 2394 "%s\n", (block->bp_block >> 10), 2395 (((unsigned long) private->real_cyl * 2396 private->rdc_data.trk_per_cyl * 2397 blk_per_trk * (block->bp_block >> 9)) >> 1), 2398 ((blk_per_trk * block->bp_block) >> 10), 2399 private->uses_cdl ? 2400 "compatible disk layout" : "linux disk layout"); 2401 2402 return 0; 2403 } 2404 2405 static int dasd_eckd_do_analysis(struct dasd_block *block) 2406 { 2407 struct dasd_eckd_private *private = block->base->private; 2408 2409 if (private->init_cqr_status < 0) 2410 return dasd_eckd_start_analysis(block); 2411 else 2412 return dasd_eckd_end_analysis(block); 2413 } 2414 2415 static int dasd_eckd_basic_to_ready(struct dasd_device *device) 2416 { 2417 return dasd_alias_add_device(device); 2418 }; 2419 2420 static int dasd_eckd_online_to_ready(struct dasd_device *device) 2421 { 2422 if (cancel_work_sync(&device->reload_device)) 2423 dasd_put_device(device); 2424 if (cancel_work_sync(&device->kick_validate)) 2425 dasd_put_device(device); 2426 2427 return 0; 2428 }; 2429 2430 static int dasd_eckd_basic_to_known(struct dasd_device *device) 2431 { 2432 return dasd_alias_remove_device(device); 2433 }; 2434 2435 static int 2436 dasd_eckd_fill_geometry(struct dasd_block *block, struct hd_geometry *geo) 2437 { 2438 struct dasd_eckd_private *private = block->base->private; 2439 2440 if (dasd_check_blocksize(block->bp_block) == 0) { 2441 geo->sectors = recs_per_track(&private->rdc_data, 2442 0, block->bp_block); 2443 } 2444 geo->cylinders = private->rdc_data.no_cyl; 2445 geo->heads = private->rdc_data.trk_per_cyl; 2446 return 0; 2447 } 2448 2449 /* 2450 * Build the TCW request for the format check 2451 */ 2452 static struct dasd_ccw_req * 2453 dasd_eckd_build_check_tcw(struct dasd_device *base, struct format_data_t *fdata, 2454 int enable_pav, struct eckd_count *fmt_buffer, 2455 int rpt) 2456 { 2457 struct dasd_eckd_private *start_priv; 2458 struct dasd_device *startdev = NULL; 2459 struct tidaw *last_tidaw = NULL; 2460 struct dasd_ccw_req *cqr; 2461 struct itcw *itcw; 2462 int itcw_size; 2463 int count; 2464 int rc; 2465 int i; 2466 2467 if (enable_pav) 2468 startdev = dasd_alias_get_start_dev(base); 2469 2470 if (!startdev) 2471 startdev = base; 2472 2473 start_priv = startdev->private; 2474 2475 count = rpt * (fdata->stop_unit - fdata->start_unit + 1); 2476 2477 /* 2478 * we're adding 'count' amount of tidaw to the itcw. 2479 * calculate the corresponding itcw_size 2480 */ 2481 itcw_size = itcw_calc_size(0, count, 0); 2482 2483 cqr = dasd_fmalloc_request(DASD_ECKD_MAGIC, 0, itcw_size, startdev); 2484 if (IS_ERR(cqr)) 2485 return cqr; 2486 2487 start_priv->count++; 2488 2489 itcw = itcw_init(cqr->data, itcw_size, ITCW_OP_READ, 0, count, 0); 2490 if (IS_ERR(itcw)) { 2491 rc = -EINVAL; 2492 goto out_err; 2493 } 2494 2495 cqr->cpaddr = itcw_get_tcw(itcw); 2496 rc = prepare_itcw(itcw, fdata->start_unit, fdata->stop_unit, 2497 DASD_ECKD_CCW_READ_COUNT_MT, base, startdev, 0, count, 2498 sizeof(struct eckd_count), 2499 count * sizeof(struct eckd_count), 0, rpt); 2500 if (rc) 2501 goto out_err; 2502 2503 for (i = 0; i < count; i++) { 2504 last_tidaw = itcw_add_tidaw(itcw, 0, fmt_buffer++, 2505 sizeof(struct eckd_count)); 2506 if (IS_ERR(last_tidaw)) { 2507 rc = -EINVAL; 2508 goto out_err; 2509 } 2510 } 2511 2512 last_tidaw->flags |= TIDAW_FLAGS_LAST; 2513 itcw_finalize(itcw); 2514 2515 cqr->cpmode = 1; 2516 cqr->startdev = startdev; 2517 cqr->memdev = startdev; 2518 cqr->basedev = base; 2519 cqr->retries = startdev->default_retries; 2520 cqr->expires = startdev->default_expires * HZ; 2521 cqr->buildclk = get_tod_clock(); 2522 cqr->status = DASD_CQR_FILLED; 2523 /* Set flags to suppress output for expected errors */ 2524 set_bit(DASD_CQR_SUPPRESS_FP, &cqr->flags); 2525 set_bit(DASD_CQR_SUPPRESS_IL, &cqr->flags); 2526 2527 return cqr; 2528 2529 out_err: 2530 dasd_sfree_request(cqr, startdev); 2531 2532 return ERR_PTR(rc); 2533 } 2534 2535 /* 2536 * Build the CCW request for the format check 2537 */ 2538 static struct dasd_ccw_req * 2539 dasd_eckd_build_check(struct dasd_device *base, struct format_data_t *fdata, 2540 int enable_pav, struct eckd_count *fmt_buffer, int rpt) 2541 { 2542 struct dasd_eckd_private *start_priv; 2543 struct dasd_eckd_private *base_priv; 2544 struct dasd_device *startdev = NULL; 2545 struct dasd_ccw_req *cqr; 2546 struct ccw1 *ccw; 2547 void *data; 2548 int cplength, datasize; 2549 int use_prefix; 2550 int count; 2551 int i; 2552 2553 if (enable_pav) 2554 startdev = dasd_alias_get_start_dev(base); 2555 2556 if (!startdev) 2557 startdev = base; 2558 2559 start_priv = startdev->private; 2560 base_priv = base->private; 2561 2562 count = rpt * (fdata->stop_unit - fdata->start_unit + 1); 2563 2564 use_prefix = base_priv->features.feature[8] & 0x01; 2565 2566 if (use_prefix) { 2567 cplength = 1; 2568 datasize = sizeof(struct PFX_eckd_data); 2569 } else { 2570 cplength = 2; 2571 datasize = sizeof(struct DE_eckd_data) + 2572 sizeof(struct LO_eckd_data); 2573 } 2574 cplength += count; 2575 2576 cqr = dasd_fmalloc_request(DASD_ECKD_MAGIC, cplength, datasize, startdev); 2577 if (IS_ERR(cqr)) 2578 return cqr; 2579 2580 start_priv->count++; 2581 data = cqr->data; 2582 ccw = cqr->cpaddr; 2583 2584 if (use_prefix) { 2585 prefix_LRE(ccw++, data, fdata->start_unit, fdata->stop_unit, 2586 DASD_ECKD_CCW_READ_COUNT, base, startdev, 1, 0, 2587 count, 0, 0); 2588 } else { 2589 define_extent(ccw++, data, fdata->start_unit, fdata->stop_unit, 2590 DASD_ECKD_CCW_READ_COUNT, startdev, 0); 2591 2592 data += sizeof(struct DE_eckd_data); 2593 ccw[-1].flags |= CCW_FLAG_CC; 2594 2595 locate_record(ccw++, data, fdata->start_unit, 0, count, 2596 DASD_ECKD_CCW_READ_COUNT, base, 0); 2597 } 2598 2599 for (i = 0; i < count; i++) { 2600 ccw[-1].flags |= CCW_FLAG_CC; 2601 ccw->cmd_code = DASD_ECKD_CCW_READ_COUNT; 2602 ccw->flags = CCW_FLAG_SLI; 2603 ccw->count = 8; 2604 ccw->cda = (__u32)(addr_t) fmt_buffer; 2605 ccw++; 2606 fmt_buffer++; 2607 } 2608 2609 cqr->startdev = startdev; 2610 cqr->memdev = startdev; 2611 cqr->basedev = base; 2612 cqr->retries = DASD_RETRIES; 2613 cqr->expires = startdev->default_expires * HZ; 2614 cqr->buildclk = get_tod_clock(); 2615 cqr->status = DASD_CQR_FILLED; 2616 /* Set flags to suppress output for expected errors */ 2617 set_bit(DASD_CQR_SUPPRESS_NRF, &cqr->flags); 2618 2619 return cqr; 2620 } 2621 2622 static struct dasd_ccw_req * 2623 dasd_eckd_build_format(struct dasd_device *base, struct dasd_device *startdev, 2624 struct format_data_t *fdata, int enable_pav) 2625 { 2626 struct dasd_eckd_private *base_priv; 2627 struct dasd_eckd_private *start_priv; 2628 struct dasd_ccw_req *fcp; 2629 struct eckd_count *ect; 2630 struct ch_t address; 2631 struct ccw1 *ccw; 2632 void *data; 2633 int rpt; 2634 int cplength, datasize; 2635 int i, j; 2636 int intensity = 0; 2637 int r0_perm; 2638 int nr_tracks; 2639 int use_prefix; 2640 2641 if (enable_pav) 2642 startdev = dasd_alias_get_start_dev(base); 2643 2644 if (!startdev) 2645 startdev = base; 2646 2647 start_priv = startdev->private; 2648 base_priv = base->private; 2649 2650 rpt = recs_per_track(&base_priv->rdc_data, 0, fdata->blksize); 2651 2652 nr_tracks = fdata->stop_unit - fdata->start_unit + 1; 2653 2654 /* 2655 * fdata->intensity is a bit string that tells us what to do: 2656 * Bit 0: write record zero 2657 * Bit 1: write home address, currently not supported 2658 * Bit 2: invalidate tracks 2659 * Bit 3: use OS/390 compatible disk layout (cdl) 2660 * Bit 4: do not allow storage subsystem to modify record zero 2661 * Only some bit combinations do make sense. 2662 */ 2663 if (fdata->intensity & 0x10) { 2664 r0_perm = 0; 2665 intensity = fdata->intensity & ~0x10; 2666 } else { 2667 r0_perm = 1; 2668 intensity = fdata->intensity; 2669 } 2670 2671 use_prefix = base_priv->features.feature[8] & 0x01; 2672 2673 switch (intensity) { 2674 case 0x00: /* Normal format */ 2675 case 0x08: /* Normal format, use cdl. */ 2676 cplength = 2 + (rpt*nr_tracks); 2677 if (use_prefix) 2678 datasize = sizeof(struct PFX_eckd_data) + 2679 sizeof(struct LO_eckd_data) + 2680 rpt * nr_tracks * sizeof(struct eckd_count); 2681 else 2682 datasize = sizeof(struct DE_eckd_data) + 2683 sizeof(struct LO_eckd_data) + 2684 rpt * nr_tracks * sizeof(struct eckd_count); 2685 break; 2686 case 0x01: /* Write record zero and format track. */ 2687 case 0x09: /* Write record zero and format track, use cdl. */ 2688 cplength = 2 + rpt * nr_tracks; 2689 if (use_prefix) 2690 datasize = sizeof(struct PFX_eckd_data) + 2691 sizeof(struct LO_eckd_data) + 2692 sizeof(struct eckd_count) + 2693 rpt * nr_tracks * sizeof(struct eckd_count); 2694 else 2695 datasize = sizeof(struct DE_eckd_data) + 2696 sizeof(struct LO_eckd_data) + 2697 sizeof(struct eckd_count) + 2698 rpt * nr_tracks * sizeof(struct eckd_count); 2699 break; 2700 case 0x04: /* Invalidate track. */ 2701 case 0x0c: /* Invalidate track, use cdl. */ 2702 cplength = 3; 2703 if (use_prefix) 2704 datasize = sizeof(struct PFX_eckd_data) + 2705 sizeof(struct LO_eckd_data) + 2706 sizeof(struct eckd_count); 2707 else 2708 datasize = sizeof(struct DE_eckd_data) + 2709 sizeof(struct LO_eckd_data) + 2710 sizeof(struct eckd_count); 2711 break; 2712 default: 2713 dev_warn(&startdev->cdev->dev, 2714 "An I/O control call used incorrect flags 0x%x\n", 2715 fdata->intensity); 2716 return ERR_PTR(-EINVAL); 2717 } 2718 2719 fcp = dasd_fmalloc_request(DASD_ECKD_MAGIC, cplength, datasize, startdev); 2720 if (IS_ERR(fcp)) 2721 return fcp; 2722 2723 start_priv->count++; 2724 data = fcp->data; 2725 ccw = fcp->cpaddr; 2726 2727 switch (intensity & ~0x08) { 2728 case 0x00: /* Normal format. */ 2729 if (use_prefix) { 2730 prefix(ccw++, (struct PFX_eckd_data *) data, 2731 fdata->start_unit, fdata->stop_unit, 2732 DASD_ECKD_CCW_WRITE_CKD, base, startdev); 2733 /* grant subsystem permission to format R0 */ 2734 if (r0_perm) 2735 ((struct PFX_eckd_data *)data) 2736 ->define_extent.ga_extended |= 0x04; 2737 data += sizeof(struct PFX_eckd_data); 2738 } else { 2739 define_extent(ccw++, (struct DE_eckd_data *) data, 2740 fdata->start_unit, fdata->stop_unit, 2741 DASD_ECKD_CCW_WRITE_CKD, startdev, 0); 2742 /* grant subsystem permission to format R0 */ 2743 if (r0_perm) 2744 ((struct DE_eckd_data *) data) 2745 ->ga_extended |= 0x04; 2746 data += sizeof(struct DE_eckd_data); 2747 } 2748 ccw[-1].flags |= CCW_FLAG_CC; 2749 locate_record(ccw++, (struct LO_eckd_data *) data, 2750 fdata->start_unit, 0, rpt*nr_tracks, 2751 DASD_ECKD_CCW_WRITE_CKD, base, 2752 fdata->blksize); 2753 data += sizeof(struct LO_eckd_data); 2754 break; 2755 case 0x01: /* Write record zero + format track. */ 2756 if (use_prefix) { 2757 prefix(ccw++, (struct PFX_eckd_data *) data, 2758 fdata->start_unit, fdata->stop_unit, 2759 DASD_ECKD_CCW_WRITE_RECORD_ZERO, 2760 base, startdev); 2761 data += sizeof(struct PFX_eckd_data); 2762 } else { 2763 define_extent(ccw++, (struct DE_eckd_data *) data, 2764 fdata->start_unit, fdata->stop_unit, 2765 DASD_ECKD_CCW_WRITE_RECORD_ZERO, startdev, 0); 2766 data += sizeof(struct DE_eckd_data); 2767 } 2768 ccw[-1].flags |= CCW_FLAG_CC; 2769 locate_record(ccw++, (struct LO_eckd_data *) data, 2770 fdata->start_unit, 0, rpt * nr_tracks + 1, 2771 DASD_ECKD_CCW_WRITE_RECORD_ZERO, base, 2772 base->block->bp_block); 2773 data += sizeof(struct LO_eckd_data); 2774 break; 2775 case 0x04: /* Invalidate track. */ 2776 if (use_prefix) { 2777 prefix(ccw++, (struct PFX_eckd_data *) data, 2778 fdata->start_unit, fdata->stop_unit, 2779 DASD_ECKD_CCW_WRITE_CKD, base, startdev); 2780 data += sizeof(struct PFX_eckd_data); 2781 } else { 2782 define_extent(ccw++, (struct DE_eckd_data *) data, 2783 fdata->start_unit, fdata->stop_unit, 2784 DASD_ECKD_CCW_WRITE_CKD, startdev, 0); 2785 data += sizeof(struct DE_eckd_data); 2786 } 2787 ccw[-1].flags |= CCW_FLAG_CC; 2788 locate_record(ccw++, (struct LO_eckd_data *) data, 2789 fdata->start_unit, 0, 1, 2790 DASD_ECKD_CCW_WRITE_CKD, base, 8); 2791 data += sizeof(struct LO_eckd_data); 2792 break; 2793 } 2794 2795 for (j = 0; j < nr_tracks; j++) { 2796 /* calculate cylinder and head for the current track */ 2797 set_ch_t(&address, 2798 (fdata->start_unit + j) / 2799 base_priv->rdc_data.trk_per_cyl, 2800 (fdata->start_unit + j) % 2801 base_priv->rdc_data.trk_per_cyl); 2802 if (intensity & 0x01) { /* write record zero */ 2803 ect = (struct eckd_count *) data; 2804 data += sizeof(struct eckd_count); 2805 ect->cyl = address.cyl; 2806 ect->head = address.head; 2807 ect->record = 0; 2808 ect->kl = 0; 2809 ect->dl = 8; 2810 ccw[-1].flags |= CCW_FLAG_CC; 2811 ccw->cmd_code = DASD_ECKD_CCW_WRITE_RECORD_ZERO; 2812 ccw->flags = CCW_FLAG_SLI; 2813 ccw->count = 8; 2814 ccw->cda = (__u32)(addr_t) ect; 2815 ccw++; 2816 } 2817 if ((intensity & ~0x08) & 0x04) { /* erase track */ 2818 ect = (struct eckd_count *) data; 2819 data += sizeof(struct eckd_count); 2820 ect->cyl = address.cyl; 2821 ect->head = address.head; 2822 ect->record = 1; 2823 ect->kl = 0; 2824 ect->dl = 0; 2825 ccw[-1].flags |= CCW_FLAG_CC; 2826 ccw->cmd_code = DASD_ECKD_CCW_WRITE_CKD; 2827 ccw->flags = CCW_FLAG_SLI; 2828 ccw->count = 8; 2829 ccw->cda = (__u32)(addr_t) ect; 2830 } else { /* write remaining records */ 2831 for (i = 0; i < rpt; i++) { 2832 ect = (struct eckd_count *) data; 2833 data += sizeof(struct eckd_count); 2834 ect->cyl = address.cyl; 2835 ect->head = address.head; 2836 ect->record = i + 1; 2837 ect->kl = 0; 2838 ect->dl = fdata->blksize; 2839 /* 2840 * Check for special tracks 0-1 2841 * when formatting CDL 2842 */ 2843 if ((intensity & 0x08) && 2844 address.cyl == 0 && address.head == 0) { 2845 if (i < 3) { 2846 ect->kl = 4; 2847 ect->dl = sizes_trk0[i] - 4; 2848 } 2849 } 2850 if ((intensity & 0x08) && 2851 address.cyl == 0 && address.head == 1) { 2852 ect->kl = 44; 2853 ect->dl = LABEL_SIZE - 44; 2854 } 2855 ccw[-1].flags |= CCW_FLAG_CC; 2856 if (i != 0 || j == 0) 2857 ccw->cmd_code = 2858 DASD_ECKD_CCW_WRITE_CKD; 2859 else 2860 ccw->cmd_code = 2861 DASD_ECKD_CCW_WRITE_CKD_MT; 2862 ccw->flags = CCW_FLAG_SLI; 2863 ccw->count = 8; 2864 ccw->cda = (__u32)(addr_t) ect; 2865 ccw++; 2866 } 2867 } 2868 } 2869 2870 fcp->startdev = startdev; 2871 fcp->memdev = startdev; 2872 fcp->basedev = base; 2873 fcp->retries = 256; 2874 fcp->expires = startdev->default_expires * HZ; 2875 fcp->buildclk = get_tod_clock(); 2876 fcp->status = DASD_CQR_FILLED; 2877 2878 return fcp; 2879 } 2880 2881 /* 2882 * Wrapper function to build a CCW request depending on input data 2883 */ 2884 static struct dasd_ccw_req * 2885 dasd_eckd_format_build_ccw_req(struct dasd_device *base, 2886 struct format_data_t *fdata, int enable_pav, 2887 int tpm, struct eckd_count *fmt_buffer, int rpt) 2888 { 2889 struct dasd_ccw_req *ccw_req; 2890 2891 if (!fmt_buffer) { 2892 ccw_req = dasd_eckd_build_format(base, NULL, fdata, enable_pav); 2893 } else { 2894 if (tpm) 2895 ccw_req = dasd_eckd_build_check_tcw(base, fdata, 2896 enable_pav, 2897 fmt_buffer, rpt); 2898 else 2899 ccw_req = dasd_eckd_build_check(base, fdata, enable_pav, 2900 fmt_buffer, rpt); 2901 } 2902 2903 return ccw_req; 2904 } 2905 2906 /* 2907 * Sanity checks on format_data 2908 */ 2909 static int dasd_eckd_format_sanity_checks(struct dasd_device *base, 2910 struct format_data_t *fdata) 2911 { 2912 struct dasd_eckd_private *private = base->private; 2913 2914 if (fdata->start_unit >= 2915 (private->real_cyl * private->rdc_data.trk_per_cyl)) { 2916 dev_warn(&base->cdev->dev, 2917 "Start track number %u used in formatting is too big\n", 2918 fdata->start_unit); 2919 return -EINVAL; 2920 } 2921 if (fdata->stop_unit >= 2922 (private->real_cyl * private->rdc_data.trk_per_cyl)) { 2923 dev_warn(&base->cdev->dev, 2924 "Stop track number %u used in formatting is too big\n", 2925 fdata->stop_unit); 2926 return -EINVAL; 2927 } 2928 if (fdata->start_unit > fdata->stop_unit) { 2929 dev_warn(&base->cdev->dev, 2930 "Start track %u used in formatting exceeds end track\n", 2931 fdata->start_unit); 2932 return -EINVAL; 2933 } 2934 if (dasd_check_blocksize(fdata->blksize) != 0) { 2935 dev_warn(&base->cdev->dev, 2936 "The DASD cannot be formatted with block size %u\n", 2937 fdata->blksize); 2938 return -EINVAL; 2939 } 2940 return 0; 2941 } 2942 2943 /* 2944 * This function will process format_data originally coming from an IOCTL 2945 */ 2946 static int dasd_eckd_format_process_data(struct dasd_device *base, 2947 struct format_data_t *fdata, 2948 int enable_pav, int tpm, 2949 struct eckd_count *fmt_buffer, int rpt, 2950 struct irb *irb) 2951 { 2952 struct dasd_eckd_private *private = base->private; 2953 struct dasd_ccw_req *cqr, *n; 2954 struct list_head format_queue; 2955 struct dasd_device *device; 2956 char *sense = NULL; 2957 int old_start, old_stop, format_step; 2958 int step, retry; 2959 int rc; 2960 2961 rc = dasd_eckd_format_sanity_checks(base, fdata); 2962 if (rc) 2963 return rc; 2964 2965 INIT_LIST_HEAD(&format_queue); 2966 2967 old_start = fdata->start_unit; 2968 old_stop = fdata->stop_unit; 2969 2970 if (!tpm && fmt_buffer != NULL) { 2971 /* Command Mode / Format Check */ 2972 format_step = 1; 2973 } else if (tpm && fmt_buffer != NULL) { 2974 /* Transport Mode / Format Check */ 2975 format_step = DASD_CQR_MAX_CCW / rpt; 2976 } else { 2977 /* Normal Formatting */ 2978 format_step = DASD_CQR_MAX_CCW / 2979 recs_per_track(&private->rdc_data, 0, fdata->blksize); 2980 } 2981 2982 do { 2983 retry = 0; 2984 while (fdata->start_unit <= old_stop) { 2985 step = fdata->stop_unit - fdata->start_unit + 1; 2986 if (step > format_step) { 2987 fdata->stop_unit = 2988 fdata->start_unit + format_step - 1; 2989 } 2990 2991 cqr = dasd_eckd_format_build_ccw_req(base, fdata, 2992 enable_pav, tpm, 2993 fmt_buffer, rpt); 2994 if (IS_ERR(cqr)) { 2995 rc = PTR_ERR(cqr); 2996 if (rc == -ENOMEM) { 2997 if (list_empty(&format_queue)) 2998 goto out; 2999 /* 3000 * not enough memory available, start 3001 * requests retry after first requests 3002 * were finished 3003 */ 3004 retry = 1; 3005 break; 3006 } 3007 goto out_err; 3008 } 3009 list_add_tail(&cqr->blocklist, &format_queue); 3010 3011 if (fmt_buffer) { 3012 step = fdata->stop_unit - fdata->start_unit + 1; 3013 fmt_buffer += rpt * step; 3014 } 3015 fdata->start_unit = fdata->stop_unit + 1; 3016 fdata->stop_unit = old_stop; 3017 } 3018 3019 rc = dasd_sleep_on_queue(&format_queue); 3020 3021 out_err: 3022 list_for_each_entry_safe(cqr, n, &format_queue, blocklist) { 3023 device = cqr->startdev; 3024 private = device->private; 3025 3026 if (cqr->status == DASD_CQR_FAILED) { 3027 /* 3028 * Only get sense data if called by format 3029 * check 3030 */ 3031 if (fmt_buffer && irb) { 3032 sense = dasd_get_sense(&cqr->irb); 3033 memcpy(irb, &cqr->irb, sizeof(*irb)); 3034 } 3035 rc = -EIO; 3036 } 3037 list_del_init(&cqr->blocklist); 3038 dasd_ffree_request(cqr, device); 3039 private->count--; 3040 } 3041 3042 if (rc && rc != -EIO) 3043 goto out; 3044 if (rc == -EIO) { 3045 /* 3046 * In case fewer than the expected records are on the 3047 * track, we will most likely get a 'No Record Found' 3048 * error (in command mode) or a 'File Protected' error 3049 * (in transport mode). Those particular cases shouldn't 3050 * pass the -EIO to the IOCTL, therefore reset the rc 3051 * and continue. 3052 */ 3053 if (sense && 3054 (sense[1] & SNS1_NO_REC_FOUND || 3055 sense[1] & SNS1_FILE_PROTECTED)) 3056 retry = 1; 3057 else 3058 goto out; 3059 } 3060 3061 } while (retry); 3062 3063 out: 3064 fdata->start_unit = old_start; 3065 fdata->stop_unit = old_stop; 3066 3067 return rc; 3068 } 3069 3070 static int dasd_eckd_format_device(struct dasd_device *base, 3071 struct format_data_t *fdata, int enable_pav) 3072 { 3073 return dasd_eckd_format_process_data(base, fdata, enable_pav, 0, NULL, 3074 0, NULL); 3075 } 3076 3077 static bool test_and_set_format_track(struct dasd_format_entry *to_format, 3078 struct dasd_block *block) 3079 { 3080 struct dasd_format_entry *format; 3081 unsigned long flags; 3082 bool rc = false; 3083 3084 spin_lock_irqsave(&block->format_lock, flags); 3085 list_for_each_entry(format, &block->format_list, list) { 3086 if (format->track == to_format->track) { 3087 rc = true; 3088 goto out; 3089 } 3090 } 3091 list_add_tail(&to_format->list, &block->format_list); 3092 3093 out: 3094 spin_unlock_irqrestore(&block->format_lock, flags); 3095 return rc; 3096 } 3097 3098 static void clear_format_track(struct dasd_format_entry *format, 3099 struct dasd_block *block) 3100 { 3101 unsigned long flags; 3102 3103 spin_lock_irqsave(&block->format_lock, flags); 3104 list_del_init(&format->list); 3105 spin_unlock_irqrestore(&block->format_lock, flags); 3106 } 3107 3108 /* 3109 * Callback function to free ESE format requests. 3110 */ 3111 static void dasd_eckd_ese_format_cb(struct dasd_ccw_req *cqr, void *data) 3112 { 3113 struct dasd_device *device = cqr->startdev; 3114 struct dasd_eckd_private *private = device->private; 3115 struct dasd_format_entry *format = data; 3116 3117 clear_format_track(format, cqr->basedev->block); 3118 private->count--; 3119 dasd_ffree_request(cqr, device); 3120 } 3121 3122 static struct dasd_ccw_req * 3123 dasd_eckd_ese_format(struct dasd_device *startdev, struct dasd_ccw_req *cqr, 3124 struct irb *irb) 3125 { 3126 struct dasd_eckd_private *private; 3127 struct dasd_format_entry *format; 3128 struct format_data_t fdata; 3129 unsigned int recs_per_trk; 3130 struct dasd_ccw_req *fcqr; 3131 struct dasd_device *base; 3132 struct dasd_block *block; 3133 unsigned int blksize; 3134 struct request *req; 3135 sector_t first_trk; 3136 sector_t last_trk; 3137 sector_t curr_trk; 3138 int rc; 3139 3140 req = cqr->callback_data; 3141 block = cqr->block; 3142 base = block->base; 3143 private = base->private; 3144 blksize = block->bp_block; 3145 recs_per_trk = recs_per_track(&private->rdc_data, 0, blksize); 3146 format = &startdev->format_entry; 3147 3148 first_trk = blk_rq_pos(req) >> block->s2b_shift; 3149 sector_div(first_trk, recs_per_trk); 3150 last_trk = 3151 (blk_rq_pos(req) + blk_rq_sectors(req) - 1) >> block->s2b_shift; 3152 sector_div(last_trk, recs_per_trk); 3153 rc = dasd_eckd_track_from_irb(irb, base, &curr_trk); 3154 if (rc) 3155 return ERR_PTR(rc); 3156 3157 if (curr_trk < first_trk || curr_trk > last_trk) { 3158 DBF_DEV_EVENT(DBF_WARNING, startdev, 3159 "ESE error track %llu not within range %llu - %llu\n", 3160 curr_trk, first_trk, last_trk); 3161 return ERR_PTR(-EINVAL); 3162 } 3163 format->track = curr_trk; 3164 /* test if track is already in formatting by another thread */ 3165 if (test_and_set_format_track(format, block)) 3166 return ERR_PTR(-EEXIST); 3167 3168 fdata.start_unit = curr_trk; 3169 fdata.stop_unit = curr_trk; 3170 fdata.blksize = blksize; 3171 fdata.intensity = private->uses_cdl ? DASD_FMT_INT_COMPAT : 0; 3172 3173 rc = dasd_eckd_format_sanity_checks(base, &fdata); 3174 if (rc) 3175 return ERR_PTR(-EINVAL); 3176 3177 /* 3178 * We're building the request with PAV disabled as we're reusing 3179 * the former startdev. 3180 */ 3181 fcqr = dasd_eckd_build_format(base, startdev, &fdata, 0); 3182 if (IS_ERR(fcqr)) 3183 return fcqr; 3184 3185 fcqr->callback = dasd_eckd_ese_format_cb; 3186 fcqr->callback_data = (void *) format; 3187 3188 return fcqr; 3189 } 3190 3191 /* 3192 * When data is read from an unformatted area of an ESE volume, this function 3193 * returns zeroed data and thereby mimics a read of zero data. 3194 * 3195 * The first unformatted track is the one that got the NRF error, the address is 3196 * encoded in the sense data. 3197 * 3198 * All tracks before have returned valid data and should not be touched. 3199 * All tracks after the unformatted track might be formatted or not. This is 3200 * currently not known, remember the processed data and return the remainder of 3201 * the request to the blocklayer in __dasd_cleanup_cqr(). 3202 */ 3203 static int dasd_eckd_ese_read(struct dasd_ccw_req *cqr, struct irb *irb) 3204 { 3205 struct dasd_eckd_private *private; 3206 sector_t first_trk, last_trk; 3207 sector_t first_blk, last_blk; 3208 unsigned int blksize, off; 3209 unsigned int recs_per_trk; 3210 struct dasd_device *base; 3211 struct req_iterator iter; 3212 struct dasd_block *block; 3213 unsigned int skip_block; 3214 unsigned int blk_count; 3215 struct request *req; 3216 struct bio_vec bv; 3217 sector_t curr_trk; 3218 sector_t end_blk; 3219 char *dst; 3220 int rc; 3221 3222 req = (struct request *) cqr->callback_data; 3223 base = cqr->block->base; 3224 blksize = base->block->bp_block; 3225 block = cqr->block; 3226 private = base->private; 3227 skip_block = 0; 3228 blk_count = 0; 3229 3230 recs_per_trk = recs_per_track(&private->rdc_data, 0, blksize); 3231 first_trk = first_blk = blk_rq_pos(req) >> block->s2b_shift; 3232 sector_div(first_trk, recs_per_trk); 3233 last_trk = last_blk = 3234 (blk_rq_pos(req) + blk_rq_sectors(req) - 1) >> block->s2b_shift; 3235 sector_div(last_trk, recs_per_trk); 3236 rc = dasd_eckd_track_from_irb(irb, base, &curr_trk); 3237 if (rc) 3238 return rc; 3239 3240 /* sanity check if the current track from sense data is valid */ 3241 if (curr_trk < first_trk || curr_trk > last_trk) { 3242 DBF_DEV_EVENT(DBF_WARNING, base, 3243 "ESE error track %llu not within range %llu - %llu\n", 3244 curr_trk, first_trk, last_trk); 3245 return -EINVAL; 3246 } 3247 3248 /* 3249 * if not the first track got the NRF error we have to skip over valid 3250 * blocks 3251 */ 3252 if (curr_trk != first_trk) 3253 skip_block = curr_trk * recs_per_trk - first_blk; 3254 3255 /* we have no information beyond the current track */ 3256 end_blk = (curr_trk + 1) * recs_per_trk; 3257 3258 rq_for_each_segment(bv, req, iter) { 3259 dst = bvec_virt(&bv); 3260 for (off = 0; off < bv.bv_len; off += blksize) { 3261 if (first_blk + blk_count >= end_blk) { 3262 cqr->proc_bytes = blk_count * blksize; 3263 return 0; 3264 } 3265 if (dst && !skip_block) { 3266 dst += off; 3267 memset(dst, 0, blksize); 3268 } else { 3269 skip_block--; 3270 } 3271 blk_count++; 3272 } 3273 } 3274 return 0; 3275 } 3276 3277 /* 3278 * Helper function to count consecutive records of a single track. 3279 */ 3280 static int dasd_eckd_count_records(struct eckd_count *fmt_buffer, int start, 3281 int max) 3282 { 3283 int head; 3284 int i; 3285 3286 head = fmt_buffer[start].head; 3287 3288 /* 3289 * There are 3 conditions where we stop counting: 3290 * - if data reoccurs (same head and record may reoccur), which may 3291 * happen due to the way DASD_ECKD_CCW_READ_COUNT works 3292 * - when the head changes, because we're iterating over several tracks 3293 * then (DASD_ECKD_CCW_READ_COUNT_MT) 3294 * - when we've reached the end of sensible data in the buffer (the 3295 * record will be 0 then) 3296 */ 3297 for (i = start; i < max; i++) { 3298 if (i > start) { 3299 if ((fmt_buffer[i].head == head && 3300 fmt_buffer[i].record == 1) || 3301 fmt_buffer[i].head != head || 3302 fmt_buffer[i].record == 0) 3303 break; 3304 } 3305 } 3306 3307 return i - start; 3308 } 3309 3310 /* 3311 * Evaluate a given range of tracks. Data like number of records, blocksize, 3312 * record ids, and key length are compared with expected data. 3313 * 3314 * If a mismatch occurs, the corresponding error bit is set, as well as 3315 * additional information, depending on the error. 3316 */ 3317 static void dasd_eckd_format_evaluate_tracks(struct eckd_count *fmt_buffer, 3318 struct format_check_t *cdata, 3319 int rpt_max, int rpt_exp, 3320 int trk_per_cyl, int tpm) 3321 { 3322 struct ch_t geo; 3323 int max_entries; 3324 int count = 0; 3325 int trkcount; 3326 int blksize; 3327 int pos = 0; 3328 int i, j; 3329 int kl; 3330 3331 trkcount = cdata->expect.stop_unit - cdata->expect.start_unit + 1; 3332 max_entries = trkcount * rpt_max; 3333 3334 for (i = cdata->expect.start_unit; i <= cdata->expect.stop_unit; i++) { 3335 /* Calculate the correct next starting position in the buffer */ 3336 if (tpm) { 3337 while (fmt_buffer[pos].record == 0 && 3338 fmt_buffer[pos].dl == 0) { 3339 if (pos++ > max_entries) 3340 break; 3341 } 3342 } else { 3343 if (i != cdata->expect.start_unit) 3344 pos += rpt_max - count; 3345 } 3346 3347 /* Calculate the expected geo values for the current track */ 3348 set_ch_t(&geo, i / trk_per_cyl, i % trk_per_cyl); 3349 3350 /* Count and check number of records */ 3351 count = dasd_eckd_count_records(fmt_buffer, pos, pos + rpt_max); 3352 3353 if (count < rpt_exp) { 3354 cdata->result = DASD_FMT_ERR_TOO_FEW_RECORDS; 3355 break; 3356 } 3357 if (count > rpt_exp) { 3358 cdata->result = DASD_FMT_ERR_TOO_MANY_RECORDS; 3359 break; 3360 } 3361 3362 for (j = 0; j < count; j++, pos++) { 3363 blksize = cdata->expect.blksize; 3364 kl = 0; 3365 3366 /* 3367 * Set special values when checking CDL formatted 3368 * devices. 3369 */ 3370 if ((cdata->expect.intensity & 0x08) && 3371 geo.cyl == 0 && geo.head == 0) { 3372 if (j < 3) { 3373 blksize = sizes_trk0[j] - 4; 3374 kl = 4; 3375 } 3376 } 3377 if ((cdata->expect.intensity & 0x08) && 3378 geo.cyl == 0 && geo.head == 1) { 3379 blksize = LABEL_SIZE - 44; 3380 kl = 44; 3381 } 3382 3383 /* Check blocksize */ 3384 if (fmt_buffer[pos].dl != blksize) { 3385 cdata->result = DASD_FMT_ERR_BLKSIZE; 3386 goto out; 3387 } 3388 /* Check if key length is 0 */ 3389 if (fmt_buffer[pos].kl != kl) { 3390 cdata->result = DASD_FMT_ERR_KEY_LENGTH; 3391 goto out; 3392 } 3393 /* Check if record_id is correct */ 3394 if (fmt_buffer[pos].cyl != geo.cyl || 3395 fmt_buffer[pos].head != geo.head || 3396 fmt_buffer[pos].record != (j + 1)) { 3397 cdata->result = DASD_FMT_ERR_RECORD_ID; 3398 goto out; 3399 } 3400 } 3401 } 3402 3403 out: 3404 /* 3405 * In case of no errors, we need to decrease by one 3406 * to get the correct positions. 3407 */ 3408 if (!cdata->result) { 3409 i--; 3410 pos--; 3411 } 3412 3413 cdata->unit = i; 3414 cdata->num_records = count; 3415 cdata->rec = fmt_buffer[pos].record; 3416 cdata->blksize = fmt_buffer[pos].dl; 3417 cdata->key_length = fmt_buffer[pos].kl; 3418 } 3419 3420 /* 3421 * Check the format of a range of tracks of a DASD. 3422 */ 3423 static int dasd_eckd_check_device_format(struct dasd_device *base, 3424 struct format_check_t *cdata, 3425 int enable_pav) 3426 { 3427 struct dasd_eckd_private *private = base->private; 3428 struct eckd_count *fmt_buffer; 3429 struct irb irb; 3430 int rpt_max, rpt_exp; 3431 int fmt_buffer_size; 3432 int trk_per_cyl; 3433 int trkcount; 3434 int tpm = 0; 3435 int rc; 3436 3437 trk_per_cyl = private->rdc_data.trk_per_cyl; 3438 3439 /* Get maximum and expected amount of records per track */ 3440 rpt_max = recs_per_track(&private->rdc_data, 0, 512) + 1; 3441 rpt_exp = recs_per_track(&private->rdc_data, 0, cdata->expect.blksize); 3442 3443 trkcount = cdata->expect.stop_unit - cdata->expect.start_unit + 1; 3444 fmt_buffer_size = trkcount * rpt_max * sizeof(struct eckd_count); 3445 3446 fmt_buffer = kzalloc(fmt_buffer_size, GFP_KERNEL | GFP_DMA); 3447 if (!fmt_buffer) 3448 return -ENOMEM; 3449 3450 /* 3451 * A certain FICON feature subset is needed to operate in transport 3452 * mode. Additionally, the support for transport mode is implicitly 3453 * checked by comparing the buffer size with fcx_max_data. As long as 3454 * the buffer size is smaller we can operate in transport mode and 3455 * process multiple tracks. If not, only one track at once is being 3456 * processed using command mode. 3457 */ 3458 if ((private->features.feature[40] & 0x04) && 3459 fmt_buffer_size <= private->fcx_max_data) 3460 tpm = 1; 3461 3462 rc = dasd_eckd_format_process_data(base, &cdata->expect, enable_pav, 3463 tpm, fmt_buffer, rpt_max, &irb); 3464 if (rc && rc != -EIO) 3465 goto out; 3466 if (rc == -EIO) { 3467 /* 3468 * If our first attempt with transport mode enabled comes back 3469 * with an incorrect length error, we're going to retry the 3470 * check with command mode. 3471 */ 3472 if (tpm && scsw_cstat(&irb.scsw) == 0x40) { 3473 tpm = 0; 3474 rc = dasd_eckd_format_process_data(base, &cdata->expect, 3475 enable_pav, tpm, 3476 fmt_buffer, rpt_max, 3477 &irb); 3478 if (rc) 3479 goto out; 3480 } else { 3481 goto out; 3482 } 3483 } 3484 3485 dasd_eckd_format_evaluate_tracks(fmt_buffer, cdata, rpt_max, rpt_exp, 3486 trk_per_cyl, tpm); 3487 3488 out: 3489 kfree(fmt_buffer); 3490 3491 return rc; 3492 } 3493 3494 static void dasd_eckd_handle_terminated_request(struct dasd_ccw_req *cqr) 3495 { 3496 if (cqr->retries < 0) { 3497 cqr->status = DASD_CQR_FAILED; 3498 return; 3499 } 3500 cqr->status = DASD_CQR_FILLED; 3501 if (cqr->block && (cqr->startdev != cqr->block->base)) { 3502 dasd_eckd_reset_ccw_to_base_io(cqr); 3503 cqr->startdev = cqr->block->base; 3504 cqr->lpm = dasd_path_get_opm(cqr->block->base); 3505 } 3506 }; 3507 3508 static dasd_erp_fn_t 3509 dasd_eckd_erp_action(struct dasd_ccw_req * cqr) 3510 { 3511 struct dasd_device *device = (struct dasd_device *) cqr->startdev; 3512 struct ccw_device *cdev = device->cdev; 3513 3514 switch (cdev->id.cu_type) { 3515 case 0x3990: 3516 case 0x2105: 3517 case 0x2107: 3518 case 0x1750: 3519 return dasd_3990_erp_action; 3520 case 0x9343: 3521 case 0x3880: 3522 default: 3523 return dasd_default_erp_action; 3524 } 3525 } 3526 3527 static dasd_erp_fn_t 3528 dasd_eckd_erp_postaction(struct dasd_ccw_req * cqr) 3529 { 3530 return dasd_default_erp_postaction; 3531 } 3532 3533 static void dasd_eckd_check_for_device_change(struct dasd_device *device, 3534 struct dasd_ccw_req *cqr, 3535 struct irb *irb) 3536 { 3537 char mask; 3538 char *sense = NULL; 3539 struct dasd_eckd_private *private = device->private; 3540 3541 /* first of all check for state change pending interrupt */ 3542 mask = DEV_STAT_ATTENTION | DEV_STAT_DEV_END | DEV_STAT_UNIT_EXCEP; 3543 if ((scsw_dstat(&irb->scsw) & mask) == mask) { 3544 /* 3545 * for alias only, not in offline processing 3546 * and only if not suspended 3547 */ 3548 if (!device->block && private->lcu && 3549 device->state == DASD_STATE_ONLINE && 3550 !test_bit(DASD_FLAG_OFFLINE, &device->flags) && 3551 !test_bit(DASD_FLAG_SUSPENDED, &device->flags)) { 3552 /* schedule worker to reload device */ 3553 dasd_reload_device(device); 3554 } 3555 dasd_generic_handle_state_change(device); 3556 return; 3557 } 3558 3559 sense = dasd_get_sense(irb); 3560 if (!sense) 3561 return; 3562 3563 /* summary unit check */ 3564 if ((sense[27] & DASD_SENSE_BIT_0) && (sense[7] == 0x0D) && 3565 (scsw_dstat(&irb->scsw) & DEV_STAT_UNIT_CHECK)) { 3566 if (test_and_set_bit(DASD_FLAG_SUC, &device->flags)) { 3567 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 3568 "eckd suc: device already notified"); 3569 return; 3570 } 3571 sense = dasd_get_sense(irb); 3572 if (!sense) { 3573 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 3574 "eckd suc: no reason code available"); 3575 clear_bit(DASD_FLAG_SUC, &device->flags); 3576 return; 3577 3578 } 3579 private->suc_reason = sense[8]; 3580 DBF_DEV_EVENT(DBF_NOTICE, device, "%s %x", 3581 "eckd handle summary unit check: reason", 3582 private->suc_reason); 3583 dasd_get_device(device); 3584 if (!schedule_work(&device->suc_work)) 3585 dasd_put_device(device); 3586 3587 return; 3588 } 3589 3590 /* service information message SIM */ 3591 if (!cqr && !(sense[27] & DASD_SENSE_BIT_0) && 3592 ((sense[6] & DASD_SIM_SENSE) == DASD_SIM_SENSE)) { 3593 dasd_3990_erp_handle_sim(device, sense); 3594 return; 3595 } 3596 3597 /* loss of device reservation is handled via base devices only 3598 * as alias devices may be used with several bases 3599 */ 3600 if (device->block && (sense[27] & DASD_SENSE_BIT_0) && 3601 (sense[7] == 0x3F) && 3602 (scsw_dstat(&irb->scsw) & DEV_STAT_UNIT_CHECK) && 3603 test_bit(DASD_FLAG_IS_RESERVED, &device->flags)) { 3604 if (device->features & DASD_FEATURE_FAILONSLCK) 3605 set_bit(DASD_FLAG_LOCK_STOLEN, &device->flags); 3606 clear_bit(DASD_FLAG_IS_RESERVED, &device->flags); 3607 dev_err(&device->cdev->dev, 3608 "The device reservation was lost\n"); 3609 } 3610 } 3611 3612 static int dasd_eckd_ras_sanity_checks(struct dasd_device *device, 3613 unsigned int first_trk, 3614 unsigned int last_trk) 3615 { 3616 struct dasd_eckd_private *private = device->private; 3617 unsigned int trks_per_vol; 3618 int rc = 0; 3619 3620 trks_per_vol = private->real_cyl * private->rdc_data.trk_per_cyl; 3621 3622 if (first_trk >= trks_per_vol) { 3623 dev_warn(&device->cdev->dev, 3624 "Start track number %u used in the space release command is too big\n", 3625 first_trk); 3626 rc = -EINVAL; 3627 } else if (last_trk >= trks_per_vol) { 3628 dev_warn(&device->cdev->dev, 3629 "Stop track number %u used in the space release command is too big\n", 3630 last_trk); 3631 rc = -EINVAL; 3632 } else if (first_trk > last_trk) { 3633 dev_warn(&device->cdev->dev, 3634 "Start track %u used in the space release command exceeds the end track\n", 3635 first_trk); 3636 rc = -EINVAL; 3637 } 3638 return rc; 3639 } 3640 3641 /* 3642 * Helper function to count the amount of involved extents within a given range 3643 * with extent alignment in mind. 3644 */ 3645 static int count_exts(unsigned int from, unsigned int to, int trks_per_ext) 3646 { 3647 int cur_pos = 0; 3648 int count = 0; 3649 int tmp; 3650 3651 if (from == to) 3652 return 1; 3653 3654 /* Count first partial extent */ 3655 if (from % trks_per_ext != 0) { 3656 tmp = from + trks_per_ext - (from % trks_per_ext) - 1; 3657 if (tmp > to) 3658 tmp = to; 3659 cur_pos = tmp - from + 1; 3660 count++; 3661 } 3662 /* Count full extents */ 3663 if (to - (from + cur_pos) + 1 >= trks_per_ext) { 3664 tmp = to - ((to - trks_per_ext + 1) % trks_per_ext); 3665 count += (tmp - (from + cur_pos) + 1) / trks_per_ext; 3666 cur_pos = tmp; 3667 } 3668 /* Count last partial extent */ 3669 if (cur_pos < to) 3670 count++; 3671 3672 return count; 3673 } 3674 3675 /* 3676 * Release allocated space for a given range or an entire volume. 3677 */ 3678 static struct dasd_ccw_req * 3679 dasd_eckd_dso_ras(struct dasd_device *device, struct dasd_block *block, 3680 struct request *req, unsigned int first_trk, 3681 unsigned int last_trk, int by_extent) 3682 { 3683 struct dasd_eckd_private *private = device->private; 3684 struct dasd_dso_ras_ext_range *ras_range; 3685 struct dasd_rssd_features *features; 3686 struct dasd_dso_ras_data *ras_data; 3687 u16 heads, beg_head, end_head; 3688 int cur_to_trk, cur_from_trk; 3689 struct dasd_ccw_req *cqr; 3690 u32 beg_cyl, end_cyl; 3691 struct ccw1 *ccw; 3692 int trks_per_ext; 3693 size_t ras_size; 3694 size_t size; 3695 int nr_exts; 3696 void *rq; 3697 int i; 3698 3699 if (dasd_eckd_ras_sanity_checks(device, first_trk, last_trk)) 3700 return ERR_PTR(-EINVAL); 3701 3702 rq = req ? blk_mq_rq_to_pdu(req) : NULL; 3703 3704 features = &private->features; 3705 3706 trks_per_ext = dasd_eckd_ext_size(device) * private->rdc_data.trk_per_cyl; 3707 nr_exts = 0; 3708 if (by_extent) 3709 nr_exts = count_exts(first_trk, last_trk, trks_per_ext); 3710 ras_size = sizeof(*ras_data); 3711 size = ras_size + (nr_exts * sizeof(*ras_range)); 3712 3713 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, size, device, rq); 3714 if (IS_ERR(cqr)) { 3715 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 3716 "Could not allocate RAS request"); 3717 return cqr; 3718 } 3719 3720 ras_data = cqr->data; 3721 memset(ras_data, 0, size); 3722 3723 ras_data->order = DSO_ORDER_RAS; 3724 ras_data->flags.vol_type = 0; /* CKD volume */ 3725 /* Release specified extents or entire volume */ 3726 ras_data->op_flags.by_extent = by_extent; 3727 /* 3728 * This bit guarantees initialisation of tracks within an extent that is 3729 * not fully specified, but is only supported with a certain feature 3730 * subset. 3731 */ 3732 ras_data->op_flags.guarantee_init = !!(features->feature[56] & 0x01); 3733 ras_data->lss = private->ned->ID; 3734 ras_data->dev_addr = private->ned->unit_addr; 3735 ras_data->nr_exts = nr_exts; 3736 3737 if (by_extent) { 3738 heads = private->rdc_data.trk_per_cyl; 3739 cur_from_trk = first_trk; 3740 cur_to_trk = first_trk + trks_per_ext - 3741 (first_trk % trks_per_ext) - 1; 3742 if (cur_to_trk > last_trk) 3743 cur_to_trk = last_trk; 3744 ras_range = (struct dasd_dso_ras_ext_range *)(cqr->data + ras_size); 3745 3746 for (i = 0; i < nr_exts; i++) { 3747 beg_cyl = cur_from_trk / heads; 3748 beg_head = cur_from_trk % heads; 3749 end_cyl = cur_to_trk / heads; 3750 end_head = cur_to_trk % heads; 3751 3752 set_ch_t(&ras_range->beg_ext, beg_cyl, beg_head); 3753 set_ch_t(&ras_range->end_ext, end_cyl, end_head); 3754 3755 cur_from_trk = cur_to_trk + 1; 3756 cur_to_trk = cur_from_trk + trks_per_ext - 1; 3757 if (cur_to_trk > last_trk) 3758 cur_to_trk = last_trk; 3759 ras_range++; 3760 } 3761 } 3762 3763 ccw = cqr->cpaddr; 3764 ccw->cda = (__u32)(addr_t)cqr->data; 3765 ccw->cmd_code = DASD_ECKD_CCW_DSO; 3766 ccw->count = size; 3767 3768 cqr->startdev = device; 3769 cqr->memdev = device; 3770 cqr->block = block; 3771 cqr->retries = 256; 3772 cqr->expires = device->default_expires * HZ; 3773 cqr->buildclk = get_tod_clock(); 3774 cqr->status = DASD_CQR_FILLED; 3775 3776 return cqr; 3777 } 3778 3779 static int dasd_eckd_release_space_full(struct dasd_device *device) 3780 { 3781 struct dasd_ccw_req *cqr; 3782 int rc; 3783 3784 cqr = dasd_eckd_dso_ras(device, NULL, NULL, 0, 0, 0); 3785 if (IS_ERR(cqr)) 3786 return PTR_ERR(cqr); 3787 3788 rc = dasd_sleep_on_interruptible(cqr); 3789 3790 dasd_sfree_request(cqr, cqr->memdev); 3791 3792 return rc; 3793 } 3794 3795 static int dasd_eckd_release_space_trks(struct dasd_device *device, 3796 unsigned int from, unsigned int to) 3797 { 3798 struct dasd_eckd_private *private = device->private; 3799 struct dasd_block *block = device->block; 3800 struct dasd_ccw_req *cqr, *n; 3801 struct list_head ras_queue; 3802 unsigned int device_exts; 3803 int trks_per_ext; 3804 int stop, step; 3805 int cur_pos; 3806 int rc = 0; 3807 int retry; 3808 3809 INIT_LIST_HEAD(&ras_queue); 3810 3811 device_exts = private->real_cyl / dasd_eckd_ext_size(device); 3812 trks_per_ext = dasd_eckd_ext_size(device) * private->rdc_data.trk_per_cyl; 3813 3814 /* Make sure device limits are not exceeded */ 3815 step = trks_per_ext * min(device_exts, DASD_ECKD_RAS_EXTS_MAX); 3816 cur_pos = from; 3817 3818 do { 3819 retry = 0; 3820 while (cur_pos < to) { 3821 stop = cur_pos + step - 3822 ((cur_pos + step) % trks_per_ext) - 1; 3823 if (stop > to) 3824 stop = to; 3825 3826 cqr = dasd_eckd_dso_ras(device, NULL, NULL, cur_pos, stop, 1); 3827 if (IS_ERR(cqr)) { 3828 rc = PTR_ERR(cqr); 3829 if (rc == -ENOMEM) { 3830 if (list_empty(&ras_queue)) 3831 goto out; 3832 retry = 1; 3833 break; 3834 } 3835 goto err_out; 3836 } 3837 3838 spin_lock_irq(&block->queue_lock); 3839 list_add_tail(&cqr->blocklist, &ras_queue); 3840 spin_unlock_irq(&block->queue_lock); 3841 cur_pos = stop + 1; 3842 } 3843 3844 rc = dasd_sleep_on_queue_interruptible(&ras_queue); 3845 3846 err_out: 3847 list_for_each_entry_safe(cqr, n, &ras_queue, blocklist) { 3848 device = cqr->startdev; 3849 private = device->private; 3850 3851 spin_lock_irq(&block->queue_lock); 3852 list_del_init(&cqr->blocklist); 3853 spin_unlock_irq(&block->queue_lock); 3854 dasd_sfree_request(cqr, device); 3855 private->count--; 3856 } 3857 } while (retry); 3858 3859 out: 3860 return rc; 3861 } 3862 3863 static int dasd_eckd_release_space(struct dasd_device *device, 3864 struct format_data_t *rdata) 3865 { 3866 if (rdata->intensity & DASD_FMT_INT_ESE_FULL) 3867 return dasd_eckd_release_space_full(device); 3868 else if (rdata->intensity == 0) 3869 return dasd_eckd_release_space_trks(device, rdata->start_unit, 3870 rdata->stop_unit); 3871 else 3872 return -EINVAL; 3873 } 3874 3875 static struct dasd_ccw_req *dasd_eckd_build_cp_cmd_single( 3876 struct dasd_device *startdev, 3877 struct dasd_block *block, 3878 struct request *req, 3879 sector_t first_rec, 3880 sector_t last_rec, 3881 sector_t first_trk, 3882 sector_t last_trk, 3883 unsigned int first_offs, 3884 unsigned int last_offs, 3885 unsigned int blk_per_trk, 3886 unsigned int blksize) 3887 { 3888 struct dasd_eckd_private *private; 3889 unsigned long *idaws; 3890 struct LO_eckd_data *LO_data; 3891 struct dasd_ccw_req *cqr; 3892 struct ccw1 *ccw; 3893 struct req_iterator iter; 3894 struct bio_vec bv; 3895 char *dst; 3896 unsigned int off; 3897 int count, cidaw, cplength, datasize; 3898 sector_t recid; 3899 unsigned char cmd, rcmd; 3900 int use_prefix; 3901 struct dasd_device *basedev; 3902 3903 basedev = block->base; 3904 private = basedev->private; 3905 if (rq_data_dir(req) == READ) 3906 cmd = DASD_ECKD_CCW_READ_MT; 3907 else if (rq_data_dir(req) == WRITE) 3908 cmd = DASD_ECKD_CCW_WRITE_MT; 3909 else 3910 return ERR_PTR(-EINVAL); 3911 3912 /* Check struct bio and count the number of blocks for the request. */ 3913 count = 0; 3914 cidaw = 0; 3915 rq_for_each_segment(bv, req, iter) { 3916 if (bv.bv_len & (blksize - 1)) 3917 /* Eckd can only do full blocks. */ 3918 return ERR_PTR(-EINVAL); 3919 count += bv.bv_len >> (block->s2b_shift + 9); 3920 if (idal_is_needed (page_address(bv.bv_page), bv.bv_len)) 3921 cidaw += bv.bv_len >> (block->s2b_shift + 9); 3922 } 3923 /* Paranoia. */ 3924 if (count != last_rec - first_rec + 1) 3925 return ERR_PTR(-EINVAL); 3926 3927 /* use the prefix command if available */ 3928 use_prefix = private->features.feature[8] & 0x01; 3929 if (use_prefix) { 3930 /* 1x prefix + number of blocks */ 3931 cplength = 2 + count; 3932 /* 1x prefix + cidaws*sizeof(long) */ 3933 datasize = sizeof(struct PFX_eckd_data) + 3934 sizeof(struct LO_eckd_data) + 3935 cidaw * sizeof(unsigned long); 3936 } else { 3937 /* 1x define extent + 1x locate record + number of blocks */ 3938 cplength = 2 + count; 3939 /* 1x define extent + 1x locate record + cidaws*sizeof(long) */ 3940 datasize = sizeof(struct DE_eckd_data) + 3941 sizeof(struct LO_eckd_data) + 3942 cidaw * sizeof(unsigned long); 3943 } 3944 /* Find out the number of additional locate record ccws for cdl. */ 3945 if (private->uses_cdl && first_rec < 2*blk_per_trk) { 3946 if (last_rec >= 2*blk_per_trk) 3947 count = 2*blk_per_trk - first_rec; 3948 cplength += count; 3949 datasize += count*sizeof(struct LO_eckd_data); 3950 } 3951 /* Allocate the ccw request. */ 3952 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, 3953 startdev, blk_mq_rq_to_pdu(req)); 3954 if (IS_ERR(cqr)) 3955 return cqr; 3956 ccw = cqr->cpaddr; 3957 /* First ccw is define extent or prefix. */ 3958 if (use_prefix) { 3959 if (prefix(ccw++, cqr->data, first_trk, 3960 last_trk, cmd, basedev, startdev) == -EAGAIN) { 3961 /* Clock not in sync and XRC is enabled. 3962 * Try again later. 3963 */ 3964 dasd_sfree_request(cqr, startdev); 3965 return ERR_PTR(-EAGAIN); 3966 } 3967 idaws = (unsigned long *) (cqr->data + 3968 sizeof(struct PFX_eckd_data)); 3969 } else { 3970 if (define_extent(ccw++, cqr->data, first_trk, 3971 last_trk, cmd, basedev, 0) == -EAGAIN) { 3972 /* Clock not in sync and XRC is enabled. 3973 * Try again later. 3974 */ 3975 dasd_sfree_request(cqr, startdev); 3976 return ERR_PTR(-EAGAIN); 3977 } 3978 idaws = (unsigned long *) (cqr->data + 3979 sizeof(struct DE_eckd_data)); 3980 } 3981 /* Build locate_record+read/write/ccws. */ 3982 LO_data = (struct LO_eckd_data *) (idaws + cidaw); 3983 recid = first_rec; 3984 if (private->uses_cdl == 0 || recid > 2*blk_per_trk) { 3985 /* Only standard blocks so there is just one locate record. */ 3986 ccw[-1].flags |= CCW_FLAG_CC; 3987 locate_record(ccw++, LO_data++, first_trk, first_offs + 1, 3988 last_rec - recid + 1, cmd, basedev, blksize); 3989 } 3990 rq_for_each_segment(bv, req, iter) { 3991 dst = bvec_virt(&bv); 3992 if (dasd_page_cache) { 3993 char *copy = kmem_cache_alloc(dasd_page_cache, 3994 GFP_DMA | __GFP_NOWARN); 3995 if (copy && rq_data_dir(req) == WRITE) 3996 memcpy(copy + bv.bv_offset, dst, bv.bv_len); 3997 if (copy) 3998 dst = copy + bv.bv_offset; 3999 } 4000 for (off = 0; off < bv.bv_len; off += blksize) { 4001 sector_t trkid = recid; 4002 unsigned int recoffs = sector_div(trkid, blk_per_trk); 4003 rcmd = cmd; 4004 count = blksize; 4005 /* Locate record for cdl special block ? */ 4006 if (private->uses_cdl && recid < 2*blk_per_trk) { 4007 if (dasd_eckd_cdl_special(blk_per_trk, recid)){ 4008 rcmd |= 0x8; 4009 count = dasd_eckd_cdl_reclen(recid); 4010 if (count < blksize && 4011 rq_data_dir(req) == READ) 4012 memset(dst + count, 0xe5, 4013 blksize - count); 4014 } 4015 ccw[-1].flags |= CCW_FLAG_CC; 4016 locate_record(ccw++, LO_data++, 4017 trkid, recoffs + 1, 4018 1, rcmd, basedev, count); 4019 } 4020 /* Locate record for standard blocks ? */ 4021 if (private->uses_cdl && recid == 2*blk_per_trk) { 4022 ccw[-1].flags |= CCW_FLAG_CC; 4023 locate_record(ccw++, LO_data++, 4024 trkid, recoffs + 1, 4025 last_rec - recid + 1, 4026 cmd, basedev, count); 4027 } 4028 /* Read/write ccw. */ 4029 ccw[-1].flags |= CCW_FLAG_CC; 4030 ccw->cmd_code = rcmd; 4031 ccw->count = count; 4032 if (idal_is_needed(dst, blksize)) { 4033 ccw->cda = (__u32)(addr_t) idaws; 4034 ccw->flags = CCW_FLAG_IDA; 4035 idaws = idal_create_words(idaws, dst, blksize); 4036 } else { 4037 ccw->cda = (__u32)(addr_t) dst; 4038 ccw->flags = 0; 4039 } 4040 ccw++; 4041 dst += blksize; 4042 recid++; 4043 } 4044 } 4045 if (blk_noretry_request(req) || 4046 block->base->features & DASD_FEATURE_FAILFAST) 4047 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 4048 cqr->startdev = startdev; 4049 cqr->memdev = startdev; 4050 cqr->block = block; 4051 cqr->expires = startdev->default_expires * HZ; /* default 5 minutes */ 4052 cqr->lpm = dasd_path_get_ppm(startdev); 4053 cqr->retries = startdev->default_retries; 4054 cqr->buildclk = get_tod_clock(); 4055 cqr->status = DASD_CQR_FILLED; 4056 4057 /* Set flags to suppress output for expected errors */ 4058 if (dasd_eckd_is_ese(basedev)) { 4059 set_bit(DASD_CQR_SUPPRESS_FP, &cqr->flags); 4060 set_bit(DASD_CQR_SUPPRESS_IL, &cqr->flags); 4061 set_bit(DASD_CQR_SUPPRESS_NRF, &cqr->flags); 4062 } 4063 4064 return cqr; 4065 } 4066 4067 static struct dasd_ccw_req *dasd_eckd_build_cp_cmd_track( 4068 struct dasd_device *startdev, 4069 struct dasd_block *block, 4070 struct request *req, 4071 sector_t first_rec, 4072 sector_t last_rec, 4073 sector_t first_trk, 4074 sector_t last_trk, 4075 unsigned int first_offs, 4076 unsigned int last_offs, 4077 unsigned int blk_per_trk, 4078 unsigned int blksize) 4079 { 4080 unsigned long *idaws; 4081 struct dasd_ccw_req *cqr; 4082 struct ccw1 *ccw; 4083 struct req_iterator iter; 4084 struct bio_vec bv; 4085 char *dst, *idaw_dst; 4086 unsigned int cidaw, cplength, datasize; 4087 unsigned int tlf; 4088 sector_t recid; 4089 unsigned char cmd; 4090 struct dasd_device *basedev; 4091 unsigned int trkcount, count, count_to_trk_end; 4092 unsigned int idaw_len, seg_len, part_len, len_to_track_end; 4093 unsigned char new_track, end_idaw; 4094 sector_t trkid; 4095 unsigned int recoffs; 4096 4097 basedev = block->base; 4098 if (rq_data_dir(req) == READ) 4099 cmd = DASD_ECKD_CCW_READ_TRACK_DATA; 4100 else if (rq_data_dir(req) == WRITE) 4101 cmd = DASD_ECKD_CCW_WRITE_TRACK_DATA; 4102 else 4103 return ERR_PTR(-EINVAL); 4104 4105 /* Track based I/O needs IDAWs for each page, and not just for 4106 * 64 bit addresses. We need additional idals for pages 4107 * that get filled from two tracks, so we use the number 4108 * of records as upper limit. 4109 */ 4110 cidaw = last_rec - first_rec + 1; 4111 trkcount = last_trk - first_trk + 1; 4112 4113 /* 1x prefix + one read/write ccw per track */ 4114 cplength = 1 + trkcount; 4115 4116 datasize = sizeof(struct PFX_eckd_data) + cidaw * sizeof(unsigned long); 4117 4118 /* Allocate the ccw request. */ 4119 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, 4120 startdev, blk_mq_rq_to_pdu(req)); 4121 if (IS_ERR(cqr)) 4122 return cqr; 4123 ccw = cqr->cpaddr; 4124 /* transfer length factor: how many bytes to read from the last track */ 4125 if (first_trk == last_trk) 4126 tlf = last_offs - first_offs + 1; 4127 else 4128 tlf = last_offs + 1; 4129 tlf *= blksize; 4130 4131 if (prefix_LRE(ccw++, cqr->data, first_trk, 4132 last_trk, cmd, basedev, startdev, 4133 1 /* format */, first_offs + 1, 4134 trkcount, blksize, 4135 tlf) == -EAGAIN) { 4136 /* Clock not in sync and XRC is enabled. 4137 * Try again later. 4138 */ 4139 dasd_sfree_request(cqr, startdev); 4140 return ERR_PTR(-EAGAIN); 4141 } 4142 4143 /* 4144 * The translation of request into ccw programs must meet the 4145 * following conditions: 4146 * - all idaws but the first and the last must address full pages 4147 * (or 2K blocks on 31-bit) 4148 * - the scope of a ccw and it's idal ends with the track boundaries 4149 */ 4150 idaws = (unsigned long *) (cqr->data + sizeof(struct PFX_eckd_data)); 4151 recid = first_rec; 4152 new_track = 1; 4153 end_idaw = 0; 4154 len_to_track_end = 0; 4155 idaw_dst = NULL; 4156 idaw_len = 0; 4157 rq_for_each_segment(bv, req, iter) { 4158 dst = bvec_virt(&bv); 4159 seg_len = bv.bv_len; 4160 while (seg_len) { 4161 if (new_track) { 4162 trkid = recid; 4163 recoffs = sector_div(trkid, blk_per_trk); 4164 count_to_trk_end = blk_per_trk - recoffs; 4165 count = min((last_rec - recid + 1), 4166 (sector_t)count_to_trk_end); 4167 len_to_track_end = count * blksize; 4168 ccw[-1].flags |= CCW_FLAG_CC; 4169 ccw->cmd_code = cmd; 4170 ccw->count = len_to_track_end; 4171 ccw->cda = (__u32)(addr_t)idaws; 4172 ccw->flags = CCW_FLAG_IDA; 4173 ccw++; 4174 recid += count; 4175 new_track = 0; 4176 /* first idaw for a ccw may start anywhere */ 4177 if (!idaw_dst) 4178 idaw_dst = dst; 4179 } 4180 /* If we start a new idaw, we must make sure that it 4181 * starts on an IDA_BLOCK_SIZE boundary. 4182 * If we continue an idaw, we must make sure that the 4183 * current segment begins where the so far accumulated 4184 * idaw ends 4185 */ 4186 if (!idaw_dst) { 4187 if (__pa(dst) & (IDA_BLOCK_SIZE-1)) { 4188 dasd_sfree_request(cqr, startdev); 4189 return ERR_PTR(-ERANGE); 4190 } else 4191 idaw_dst = dst; 4192 } 4193 if ((idaw_dst + idaw_len) != dst) { 4194 dasd_sfree_request(cqr, startdev); 4195 return ERR_PTR(-ERANGE); 4196 } 4197 part_len = min(seg_len, len_to_track_end); 4198 seg_len -= part_len; 4199 dst += part_len; 4200 idaw_len += part_len; 4201 len_to_track_end -= part_len; 4202 /* collected memory area ends on an IDA_BLOCK border, 4203 * -> create an idaw 4204 * idal_create_words will handle cases where idaw_len 4205 * is larger then IDA_BLOCK_SIZE 4206 */ 4207 if (!(__pa(idaw_dst + idaw_len) & (IDA_BLOCK_SIZE-1))) 4208 end_idaw = 1; 4209 /* We also need to end the idaw at track end */ 4210 if (!len_to_track_end) { 4211 new_track = 1; 4212 end_idaw = 1; 4213 } 4214 if (end_idaw) { 4215 idaws = idal_create_words(idaws, idaw_dst, 4216 idaw_len); 4217 idaw_dst = NULL; 4218 idaw_len = 0; 4219 end_idaw = 0; 4220 } 4221 } 4222 } 4223 4224 if (blk_noretry_request(req) || 4225 block->base->features & DASD_FEATURE_FAILFAST) 4226 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 4227 cqr->startdev = startdev; 4228 cqr->memdev = startdev; 4229 cqr->block = block; 4230 cqr->expires = startdev->default_expires * HZ; /* default 5 minutes */ 4231 cqr->lpm = dasd_path_get_ppm(startdev); 4232 cqr->retries = startdev->default_retries; 4233 cqr->buildclk = get_tod_clock(); 4234 cqr->status = DASD_CQR_FILLED; 4235 4236 /* Set flags to suppress output for expected errors */ 4237 if (dasd_eckd_is_ese(basedev)) 4238 set_bit(DASD_CQR_SUPPRESS_NRF, &cqr->flags); 4239 4240 return cqr; 4241 } 4242 4243 static int prepare_itcw(struct itcw *itcw, 4244 unsigned int trk, unsigned int totrk, int cmd, 4245 struct dasd_device *basedev, 4246 struct dasd_device *startdev, 4247 unsigned int rec_on_trk, int count, 4248 unsigned int blksize, 4249 unsigned int total_data_size, 4250 unsigned int tlf, 4251 unsigned int blk_per_trk) 4252 { 4253 struct PFX_eckd_data pfxdata; 4254 struct dasd_eckd_private *basepriv, *startpriv; 4255 struct DE_eckd_data *dedata; 4256 struct LRE_eckd_data *lredata; 4257 struct dcw *dcw; 4258 4259 u32 begcyl, endcyl; 4260 u16 heads, beghead, endhead; 4261 u8 pfx_cmd; 4262 4263 int rc = 0; 4264 int sector = 0; 4265 int dn, d; 4266 4267 4268 /* setup prefix data */ 4269 basepriv = basedev->private; 4270 startpriv = startdev->private; 4271 dedata = &pfxdata.define_extent; 4272 lredata = &pfxdata.locate_record; 4273 4274 memset(&pfxdata, 0, sizeof(pfxdata)); 4275 pfxdata.format = 1; /* PFX with LRE */ 4276 pfxdata.base_address = basepriv->ned->unit_addr; 4277 pfxdata.base_lss = basepriv->ned->ID; 4278 pfxdata.validity.define_extent = 1; 4279 4280 /* private uid is kept up to date, conf_data may be outdated */ 4281 if (startpriv->uid.type == UA_BASE_PAV_ALIAS) 4282 pfxdata.validity.verify_base = 1; 4283 4284 if (startpriv->uid.type == UA_HYPER_PAV_ALIAS) { 4285 pfxdata.validity.verify_base = 1; 4286 pfxdata.validity.hyper_pav = 1; 4287 } 4288 4289 switch (cmd) { 4290 case DASD_ECKD_CCW_READ_TRACK_DATA: 4291 dedata->mask.perm = 0x1; 4292 dedata->attributes.operation = basepriv->attrib.operation; 4293 dedata->blk_size = blksize; 4294 dedata->ga_extended |= 0x42; 4295 lredata->operation.orientation = 0x0; 4296 lredata->operation.operation = 0x0C; 4297 lredata->auxiliary.check_bytes = 0x01; 4298 pfx_cmd = DASD_ECKD_CCW_PFX_READ; 4299 break; 4300 case DASD_ECKD_CCW_WRITE_TRACK_DATA: 4301 dedata->mask.perm = 0x02; 4302 dedata->attributes.operation = basepriv->attrib.operation; 4303 dedata->blk_size = blksize; 4304 rc = set_timestamp(NULL, dedata, basedev); 4305 dedata->ga_extended |= 0x42; 4306 lredata->operation.orientation = 0x0; 4307 lredata->operation.operation = 0x3F; 4308 lredata->extended_operation = 0x23; 4309 lredata->auxiliary.check_bytes = 0x2; 4310 /* 4311 * If XRC is supported the System Time Stamp is set. The 4312 * validity of the time stamp must be reflected in the prefix 4313 * data as well. 4314 */ 4315 if (dedata->ga_extended & 0x08 && dedata->ga_extended & 0x02) 4316 pfxdata.validity.time_stamp = 1; /* 'Time Stamp Valid' */ 4317 pfx_cmd = DASD_ECKD_CCW_PFX; 4318 break; 4319 case DASD_ECKD_CCW_READ_COUNT_MT: 4320 dedata->mask.perm = 0x1; 4321 dedata->attributes.operation = DASD_BYPASS_CACHE; 4322 dedata->ga_extended |= 0x42; 4323 dedata->blk_size = blksize; 4324 lredata->operation.orientation = 0x2; 4325 lredata->operation.operation = 0x16; 4326 lredata->auxiliary.check_bytes = 0x01; 4327 pfx_cmd = DASD_ECKD_CCW_PFX_READ; 4328 break; 4329 default: 4330 DBF_DEV_EVENT(DBF_ERR, basedev, 4331 "prepare itcw, unknown opcode 0x%x", cmd); 4332 BUG(); 4333 break; 4334 } 4335 if (rc) 4336 return rc; 4337 4338 dedata->attributes.mode = 0x3; /* ECKD */ 4339 4340 heads = basepriv->rdc_data.trk_per_cyl; 4341 begcyl = trk / heads; 4342 beghead = trk % heads; 4343 endcyl = totrk / heads; 4344 endhead = totrk % heads; 4345 4346 /* check for sequential prestage - enhance cylinder range */ 4347 if (dedata->attributes.operation == DASD_SEQ_PRESTAGE || 4348 dedata->attributes.operation == DASD_SEQ_ACCESS) { 4349 4350 if (endcyl + basepriv->attrib.nr_cyl < basepriv->real_cyl) 4351 endcyl += basepriv->attrib.nr_cyl; 4352 else 4353 endcyl = (basepriv->real_cyl - 1); 4354 } 4355 4356 set_ch_t(&dedata->beg_ext, begcyl, beghead); 4357 set_ch_t(&dedata->end_ext, endcyl, endhead); 4358 4359 dedata->ep_format = 0x20; /* records per track is valid */ 4360 dedata->ep_rec_per_track = blk_per_trk; 4361 4362 if (rec_on_trk) { 4363 switch (basepriv->rdc_data.dev_type) { 4364 case 0x3390: 4365 dn = ceil_quot(blksize + 6, 232); 4366 d = 9 + ceil_quot(blksize + 6 * (dn + 1), 34); 4367 sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8; 4368 break; 4369 case 0x3380: 4370 d = 7 + ceil_quot(blksize + 12, 32); 4371 sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7; 4372 break; 4373 } 4374 } 4375 4376 if (cmd == DASD_ECKD_CCW_READ_COUNT_MT) { 4377 lredata->auxiliary.length_valid = 0; 4378 lredata->auxiliary.length_scope = 0; 4379 lredata->sector = 0xff; 4380 } else { 4381 lredata->auxiliary.length_valid = 1; 4382 lredata->auxiliary.length_scope = 1; 4383 lredata->sector = sector; 4384 } 4385 lredata->auxiliary.imbedded_ccw_valid = 1; 4386 lredata->length = tlf; 4387 lredata->imbedded_ccw = cmd; 4388 lredata->count = count; 4389 set_ch_t(&lredata->seek_addr, begcyl, beghead); 4390 lredata->search_arg.cyl = lredata->seek_addr.cyl; 4391 lredata->search_arg.head = lredata->seek_addr.head; 4392 lredata->search_arg.record = rec_on_trk; 4393 4394 dcw = itcw_add_dcw(itcw, pfx_cmd, 0, 4395 &pfxdata, sizeof(pfxdata), total_data_size); 4396 return PTR_ERR_OR_ZERO(dcw); 4397 } 4398 4399 static struct dasd_ccw_req *dasd_eckd_build_cp_tpm_track( 4400 struct dasd_device *startdev, 4401 struct dasd_block *block, 4402 struct request *req, 4403 sector_t first_rec, 4404 sector_t last_rec, 4405 sector_t first_trk, 4406 sector_t last_trk, 4407 unsigned int first_offs, 4408 unsigned int last_offs, 4409 unsigned int blk_per_trk, 4410 unsigned int blksize) 4411 { 4412 struct dasd_ccw_req *cqr; 4413 struct req_iterator iter; 4414 struct bio_vec bv; 4415 char *dst; 4416 unsigned int trkcount, ctidaw; 4417 unsigned char cmd; 4418 struct dasd_device *basedev; 4419 unsigned int tlf; 4420 struct itcw *itcw; 4421 struct tidaw *last_tidaw = NULL; 4422 int itcw_op; 4423 size_t itcw_size; 4424 u8 tidaw_flags; 4425 unsigned int seg_len, part_len, len_to_track_end; 4426 unsigned char new_track; 4427 sector_t recid, trkid; 4428 unsigned int offs; 4429 unsigned int count, count_to_trk_end; 4430 int ret; 4431 4432 basedev = block->base; 4433 if (rq_data_dir(req) == READ) { 4434 cmd = DASD_ECKD_CCW_READ_TRACK_DATA; 4435 itcw_op = ITCW_OP_READ; 4436 } else if (rq_data_dir(req) == WRITE) { 4437 cmd = DASD_ECKD_CCW_WRITE_TRACK_DATA; 4438 itcw_op = ITCW_OP_WRITE; 4439 } else 4440 return ERR_PTR(-EINVAL); 4441 4442 /* trackbased I/O needs address all memory via TIDAWs, 4443 * not just for 64 bit addresses. This allows us to map 4444 * each segment directly to one tidaw. 4445 * In the case of write requests, additional tidaws may 4446 * be needed when a segment crosses a track boundary. 4447 */ 4448 trkcount = last_trk - first_trk + 1; 4449 ctidaw = 0; 4450 rq_for_each_segment(bv, req, iter) { 4451 ++ctidaw; 4452 } 4453 if (rq_data_dir(req) == WRITE) 4454 ctidaw += (last_trk - first_trk); 4455 4456 /* Allocate the ccw request. */ 4457 itcw_size = itcw_calc_size(0, ctidaw, 0); 4458 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 0, itcw_size, startdev, 4459 blk_mq_rq_to_pdu(req)); 4460 if (IS_ERR(cqr)) 4461 return cqr; 4462 4463 /* transfer length factor: how many bytes to read from the last track */ 4464 if (first_trk == last_trk) 4465 tlf = last_offs - first_offs + 1; 4466 else 4467 tlf = last_offs + 1; 4468 tlf *= blksize; 4469 4470 itcw = itcw_init(cqr->data, itcw_size, itcw_op, 0, ctidaw, 0); 4471 if (IS_ERR(itcw)) { 4472 ret = -EINVAL; 4473 goto out_error; 4474 } 4475 cqr->cpaddr = itcw_get_tcw(itcw); 4476 if (prepare_itcw(itcw, first_trk, last_trk, 4477 cmd, basedev, startdev, 4478 first_offs + 1, 4479 trkcount, blksize, 4480 (last_rec - first_rec + 1) * blksize, 4481 tlf, blk_per_trk) == -EAGAIN) { 4482 /* Clock not in sync and XRC is enabled. 4483 * Try again later. 4484 */ 4485 ret = -EAGAIN; 4486 goto out_error; 4487 } 4488 len_to_track_end = 0; 4489 /* 4490 * A tidaw can address 4k of memory, but must not cross page boundaries 4491 * We can let the block layer handle this by setting 4492 * blk_queue_segment_boundary to page boundaries and 4493 * blk_max_segment_size to page size when setting up the request queue. 4494 * For write requests, a TIDAW must not cross track boundaries, because 4495 * we have to set the CBC flag on the last tidaw for each track. 4496 */ 4497 if (rq_data_dir(req) == WRITE) { 4498 new_track = 1; 4499 recid = first_rec; 4500 rq_for_each_segment(bv, req, iter) { 4501 dst = bvec_virt(&bv); 4502 seg_len = bv.bv_len; 4503 while (seg_len) { 4504 if (new_track) { 4505 trkid = recid; 4506 offs = sector_div(trkid, blk_per_trk); 4507 count_to_trk_end = blk_per_trk - offs; 4508 count = min((last_rec - recid + 1), 4509 (sector_t)count_to_trk_end); 4510 len_to_track_end = count * blksize; 4511 recid += count; 4512 new_track = 0; 4513 } 4514 part_len = min(seg_len, len_to_track_end); 4515 seg_len -= part_len; 4516 len_to_track_end -= part_len; 4517 /* We need to end the tidaw at track end */ 4518 if (!len_to_track_end) { 4519 new_track = 1; 4520 tidaw_flags = TIDAW_FLAGS_INSERT_CBC; 4521 } else 4522 tidaw_flags = 0; 4523 last_tidaw = itcw_add_tidaw(itcw, tidaw_flags, 4524 dst, part_len); 4525 if (IS_ERR(last_tidaw)) { 4526 ret = -EINVAL; 4527 goto out_error; 4528 } 4529 dst += part_len; 4530 } 4531 } 4532 } else { 4533 rq_for_each_segment(bv, req, iter) { 4534 dst = bvec_virt(&bv); 4535 last_tidaw = itcw_add_tidaw(itcw, 0x00, 4536 dst, bv.bv_len); 4537 if (IS_ERR(last_tidaw)) { 4538 ret = -EINVAL; 4539 goto out_error; 4540 } 4541 } 4542 } 4543 last_tidaw->flags |= TIDAW_FLAGS_LAST; 4544 last_tidaw->flags &= ~TIDAW_FLAGS_INSERT_CBC; 4545 itcw_finalize(itcw); 4546 4547 if (blk_noretry_request(req) || 4548 block->base->features & DASD_FEATURE_FAILFAST) 4549 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 4550 cqr->cpmode = 1; 4551 cqr->startdev = startdev; 4552 cqr->memdev = startdev; 4553 cqr->block = block; 4554 cqr->expires = startdev->default_expires * HZ; /* default 5 minutes */ 4555 cqr->lpm = dasd_path_get_ppm(startdev); 4556 cqr->retries = startdev->default_retries; 4557 cqr->buildclk = get_tod_clock(); 4558 cqr->status = DASD_CQR_FILLED; 4559 4560 /* Set flags to suppress output for expected errors */ 4561 if (dasd_eckd_is_ese(basedev)) { 4562 set_bit(DASD_CQR_SUPPRESS_FP, &cqr->flags); 4563 set_bit(DASD_CQR_SUPPRESS_IL, &cqr->flags); 4564 set_bit(DASD_CQR_SUPPRESS_NRF, &cqr->flags); 4565 } 4566 4567 return cqr; 4568 out_error: 4569 dasd_sfree_request(cqr, startdev); 4570 return ERR_PTR(ret); 4571 } 4572 4573 static struct dasd_ccw_req *dasd_eckd_build_cp(struct dasd_device *startdev, 4574 struct dasd_block *block, 4575 struct request *req) 4576 { 4577 int cmdrtd, cmdwtd; 4578 int use_prefix; 4579 int fcx_multitrack; 4580 struct dasd_eckd_private *private; 4581 struct dasd_device *basedev; 4582 sector_t first_rec, last_rec; 4583 sector_t first_trk, last_trk; 4584 unsigned int first_offs, last_offs; 4585 unsigned int blk_per_trk, blksize; 4586 int cdlspecial; 4587 unsigned int data_size; 4588 struct dasd_ccw_req *cqr; 4589 4590 basedev = block->base; 4591 private = basedev->private; 4592 4593 /* Calculate number of blocks/records per track. */ 4594 blksize = block->bp_block; 4595 blk_per_trk = recs_per_track(&private->rdc_data, 0, blksize); 4596 if (blk_per_trk == 0) 4597 return ERR_PTR(-EINVAL); 4598 /* Calculate record id of first and last block. */ 4599 first_rec = first_trk = blk_rq_pos(req) >> block->s2b_shift; 4600 first_offs = sector_div(first_trk, blk_per_trk); 4601 last_rec = last_trk = 4602 (blk_rq_pos(req) + blk_rq_sectors(req) - 1) >> block->s2b_shift; 4603 last_offs = sector_div(last_trk, blk_per_trk); 4604 cdlspecial = (private->uses_cdl && first_rec < 2*blk_per_trk); 4605 4606 fcx_multitrack = private->features.feature[40] & 0x20; 4607 data_size = blk_rq_bytes(req); 4608 if (data_size % blksize) 4609 return ERR_PTR(-EINVAL); 4610 /* tpm write request add CBC data on each track boundary */ 4611 if (rq_data_dir(req) == WRITE) 4612 data_size += (last_trk - first_trk) * 4; 4613 4614 /* is read track data and write track data in command mode supported? */ 4615 cmdrtd = private->features.feature[9] & 0x20; 4616 cmdwtd = private->features.feature[12] & 0x40; 4617 use_prefix = private->features.feature[8] & 0x01; 4618 4619 cqr = NULL; 4620 if (cdlspecial || dasd_page_cache) { 4621 /* do nothing, just fall through to the cmd mode single case */ 4622 } else if ((data_size <= private->fcx_max_data) 4623 && (fcx_multitrack || (first_trk == last_trk))) { 4624 cqr = dasd_eckd_build_cp_tpm_track(startdev, block, req, 4625 first_rec, last_rec, 4626 first_trk, last_trk, 4627 first_offs, last_offs, 4628 blk_per_trk, blksize); 4629 if (IS_ERR(cqr) && (PTR_ERR(cqr) != -EAGAIN) && 4630 (PTR_ERR(cqr) != -ENOMEM)) 4631 cqr = NULL; 4632 } else if (use_prefix && 4633 (((rq_data_dir(req) == READ) && cmdrtd) || 4634 ((rq_data_dir(req) == WRITE) && cmdwtd))) { 4635 cqr = dasd_eckd_build_cp_cmd_track(startdev, block, req, 4636 first_rec, last_rec, 4637 first_trk, last_trk, 4638 first_offs, last_offs, 4639 blk_per_trk, blksize); 4640 if (IS_ERR(cqr) && (PTR_ERR(cqr) != -EAGAIN) && 4641 (PTR_ERR(cqr) != -ENOMEM)) 4642 cqr = NULL; 4643 } 4644 if (!cqr) 4645 cqr = dasd_eckd_build_cp_cmd_single(startdev, block, req, 4646 first_rec, last_rec, 4647 first_trk, last_trk, 4648 first_offs, last_offs, 4649 blk_per_trk, blksize); 4650 return cqr; 4651 } 4652 4653 static struct dasd_ccw_req *dasd_eckd_build_cp_raw(struct dasd_device *startdev, 4654 struct dasd_block *block, 4655 struct request *req) 4656 { 4657 sector_t start_padding_sectors, end_sector_offset, end_padding_sectors; 4658 unsigned int seg_len, len_to_track_end; 4659 unsigned int cidaw, cplength, datasize; 4660 sector_t first_trk, last_trk, sectors; 4661 struct dasd_eckd_private *base_priv; 4662 struct dasd_device *basedev; 4663 struct req_iterator iter; 4664 struct dasd_ccw_req *cqr; 4665 unsigned int first_offs; 4666 unsigned int trkcount; 4667 unsigned long *idaws; 4668 unsigned int size; 4669 unsigned char cmd; 4670 struct bio_vec bv; 4671 struct ccw1 *ccw; 4672 int use_prefix; 4673 void *data; 4674 char *dst; 4675 4676 /* 4677 * raw track access needs to be mutiple of 64k and on 64k boundary 4678 * For read requests we can fix an incorrect alignment by padding 4679 * the request with dummy pages. 4680 */ 4681 start_padding_sectors = blk_rq_pos(req) % DASD_RAW_SECTORS_PER_TRACK; 4682 end_sector_offset = (blk_rq_pos(req) + blk_rq_sectors(req)) % 4683 DASD_RAW_SECTORS_PER_TRACK; 4684 end_padding_sectors = (DASD_RAW_SECTORS_PER_TRACK - end_sector_offset) % 4685 DASD_RAW_SECTORS_PER_TRACK; 4686 basedev = block->base; 4687 if ((start_padding_sectors || end_padding_sectors) && 4688 (rq_data_dir(req) == WRITE)) { 4689 DBF_DEV_EVENT(DBF_ERR, basedev, 4690 "raw write not track aligned (%llu,%llu) req %p", 4691 start_padding_sectors, end_padding_sectors, req); 4692 return ERR_PTR(-EINVAL); 4693 } 4694 4695 first_trk = blk_rq_pos(req) / DASD_RAW_SECTORS_PER_TRACK; 4696 last_trk = (blk_rq_pos(req) + blk_rq_sectors(req) - 1) / 4697 DASD_RAW_SECTORS_PER_TRACK; 4698 trkcount = last_trk - first_trk + 1; 4699 first_offs = 0; 4700 4701 if (rq_data_dir(req) == READ) 4702 cmd = DASD_ECKD_CCW_READ_TRACK; 4703 else if (rq_data_dir(req) == WRITE) 4704 cmd = DASD_ECKD_CCW_WRITE_FULL_TRACK; 4705 else 4706 return ERR_PTR(-EINVAL); 4707 4708 /* 4709 * Raw track based I/O needs IDAWs for each page, 4710 * and not just for 64 bit addresses. 4711 */ 4712 cidaw = trkcount * DASD_RAW_BLOCK_PER_TRACK; 4713 4714 /* 4715 * struct PFX_eckd_data and struct LRE_eckd_data can have up to 2 bytes 4716 * of extended parameter. This is needed for write full track. 4717 */ 4718 base_priv = basedev->private; 4719 use_prefix = base_priv->features.feature[8] & 0x01; 4720 if (use_prefix) { 4721 cplength = 1 + trkcount; 4722 size = sizeof(struct PFX_eckd_data) + 2; 4723 } else { 4724 cplength = 2 + trkcount; 4725 size = sizeof(struct DE_eckd_data) + 4726 sizeof(struct LRE_eckd_data) + 2; 4727 } 4728 size = ALIGN(size, 8); 4729 4730 datasize = size + cidaw * sizeof(unsigned long); 4731 4732 /* Allocate the ccw request. */ 4733 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, 4734 datasize, startdev, blk_mq_rq_to_pdu(req)); 4735 if (IS_ERR(cqr)) 4736 return cqr; 4737 4738 ccw = cqr->cpaddr; 4739 data = cqr->data; 4740 4741 if (use_prefix) { 4742 prefix_LRE(ccw++, data, first_trk, last_trk, cmd, basedev, 4743 startdev, 1, first_offs + 1, trkcount, 0, 0); 4744 } else { 4745 define_extent(ccw++, data, first_trk, last_trk, cmd, basedev, 0); 4746 ccw[-1].flags |= CCW_FLAG_CC; 4747 4748 data += sizeof(struct DE_eckd_data); 4749 locate_record_ext(ccw++, data, first_trk, first_offs + 1, 4750 trkcount, cmd, basedev, 0, 0); 4751 } 4752 4753 idaws = (unsigned long *)(cqr->data + size); 4754 len_to_track_end = 0; 4755 if (start_padding_sectors) { 4756 ccw[-1].flags |= CCW_FLAG_CC; 4757 ccw->cmd_code = cmd; 4758 /* maximum 3390 track size */ 4759 ccw->count = 57326; 4760 /* 64k map to one track */ 4761 len_to_track_end = 65536 - start_padding_sectors * 512; 4762 ccw->cda = (__u32)(addr_t)idaws; 4763 ccw->flags |= CCW_FLAG_IDA; 4764 ccw->flags |= CCW_FLAG_SLI; 4765 ccw++; 4766 for (sectors = 0; sectors < start_padding_sectors; sectors += 8) 4767 idaws = idal_create_words(idaws, rawpadpage, PAGE_SIZE); 4768 } 4769 rq_for_each_segment(bv, req, iter) { 4770 dst = bvec_virt(&bv); 4771 seg_len = bv.bv_len; 4772 if (cmd == DASD_ECKD_CCW_READ_TRACK) 4773 memset(dst, 0, seg_len); 4774 if (!len_to_track_end) { 4775 ccw[-1].flags |= CCW_FLAG_CC; 4776 ccw->cmd_code = cmd; 4777 /* maximum 3390 track size */ 4778 ccw->count = 57326; 4779 /* 64k map to one track */ 4780 len_to_track_end = 65536; 4781 ccw->cda = (__u32)(addr_t)idaws; 4782 ccw->flags |= CCW_FLAG_IDA; 4783 ccw->flags |= CCW_FLAG_SLI; 4784 ccw++; 4785 } 4786 len_to_track_end -= seg_len; 4787 idaws = idal_create_words(idaws, dst, seg_len); 4788 } 4789 for (sectors = 0; sectors < end_padding_sectors; sectors += 8) 4790 idaws = idal_create_words(idaws, rawpadpage, PAGE_SIZE); 4791 if (blk_noretry_request(req) || 4792 block->base->features & DASD_FEATURE_FAILFAST) 4793 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 4794 cqr->startdev = startdev; 4795 cqr->memdev = startdev; 4796 cqr->block = block; 4797 cqr->expires = startdev->default_expires * HZ; 4798 cqr->lpm = dasd_path_get_ppm(startdev); 4799 cqr->retries = startdev->default_retries; 4800 cqr->buildclk = get_tod_clock(); 4801 cqr->status = DASD_CQR_FILLED; 4802 4803 return cqr; 4804 } 4805 4806 4807 static int 4808 dasd_eckd_free_cp(struct dasd_ccw_req *cqr, struct request *req) 4809 { 4810 struct dasd_eckd_private *private; 4811 struct ccw1 *ccw; 4812 struct req_iterator iter; 4813 struct bio_vec bv; 4814 char *dst, *cda; 4815 unsigned int blksize, blk_per_trk, off; 4816 sector_t recid; 4817 int status; 4818 4819 if (!dasd_page_cache) 4820 goto out; 4821 private = cqr->block->base->private; 4822 blksize = cqr->block->bp_block; 4823 blk_per_trk = recs_per_track(&private->rdc_data, 0, blksize); 4824 recid = blk_rq_pos(req) >> cqr->block->s2b_shift; 4825 ccw = cqr->cpaddr; 4826 /* Skip over define extent & locate record. */ 4827 ccw++; 4828 if (private->uses_cdl == 0 || recid > 2*blk_per_trk) 4829 ccw++; 4830 rq_for_each_segment(bv, req, iter) { 4831 dst = bvec_virt(&bv); 4832 for (off = 0; off < bv.bv_len; off += blksize) { 4833 /* Skip locate record. */ 4834 if (private->uses_cdl && recid <= 2*blk_per_trk) 4835 ccw++; 4836 if (dst) { 4837 if (ccw->flags & CCW_FLAG_IDA) 4838 cda = *((char **)((addr_t) ccw->cda)); 4839 else 4840 cda = (char *)((addr_t) ccw->cda); 4841 if (dst != cda) { 4842 if (rq_data_dir(req) == READ) 4843 memcpy(dst, cda, bv.bv_len); 4844 kmem_cache_free(dasd_page_cache, 4845 (void *)((addr_t)cda & PAGE_MASK)); 4846 } 4847 dst = NULL; 4848 } 4849 ccw++; 4850 recid++; 4851 } 4852 } 4853 out: 4854 status = cqr->status == DASD_CQR_DONE; 4855 dasd_sfree_request(cqr, cqr->memdev); 4856 return status; 4857 } 4858 4859 /* 4860 * Modify ccw/tcw in cqr so it can be started on a base device. 4861 * 4862 * Note that this is not enough to restart the cqr! 4863 * Either reset cqr->startdev as well (summary unit check handling) 4864 * or restart via separate cqr (as in ERP handling). 4865 */ 4866 void dasd_eckd_reset_ccw_to_base_io(struct dasd_ccw_req *cqr) 4867 { 4868 struct ccw1 *ccw; 4869 struct PFX_eckd_data *pfxdata; 4870 struct tcw *tcw; 4871 struct tccb *tccb; 4872 struct dcw *dcw; 4873 4874 if (cqr->cpmode == 1) { 4875 tcw = cqr->cpaddr; 4876 tccb = tcw_get_tccb(tcw); 4877 dcw = (struct dcw *)&tccb->tca[0]; 4878 pfxdata = (struct PFX_eckd_data *)&dcw->cd[0]; 4879 pfxdata->validity.verify_base = 0; 4880 pfxdata->validity.hyper_pav = 0; 4881 } else { 4882 ccw = cqr->cpaddr; 4883 pfxdata = cqr->data; 4884 if (ccw->cmd_code == DASD_ECKD_CCW_PFX) { 4885 pfxdata->validity.verify_base = 0; 4886 pfxdata->validity.hyper_pav = 0; 4887 } 4888 } 4889 } 4890 4891 #define DASD_ECKD_CHANQ_MAX_SIZE 4 4892 4893 static struct dasd_ccw_req *dasd_eckd_build_alias_cp(struct dasd_device *base, 4894 struct dasd_block *block, 4895 struct request *req) 4896 { 4897 struct dasd_eckd_private *private; 4898 struct dasd_device *startdev; 4899 unsigned long flags; 4900 struct dasd_ccw_req *cqr; 4901 4902 startdev = dasd_alias_get_start_dev(base); 4903 if (!startdev) 4904 startdev = base; 4905 private = startdev->private; 4906 if (private->count >= DASD_ECKD_CHANQ_MAX_SIZE) 4907 return ERR_PTR(-EBUSY); 4908 4909 spin_lock_irqsave(get_ccwdev_lock(startdev->cdev), flags); 4910 private->count++; 4911 if ((base->features & DASD_FEATURE_USERAW)) 4912 cqr = dasd_eckd_build_cp_raw(startdev, block, req); 4913 else 4914 cqr = dasd_eckd_build_cp(startdev, block, req); 4915 if (IS_ERR(cqr)) 4916 private->count--; 4917 spin_unlock_irqrestore(get_ccwdev_lock(startdev->cdev), flags); 4918 return cqr; 4919 } 4920 4921 static int dasd_eckd_free_alias_cp(struct dasd_ccw_req *cqr, 4922 struct request *req) 4923 { 4924 struct dasd_eckd_private *private; 4925 unsigned long flags; 4926 4927 spin_lock_irqsave(get_ccwdev_lock(cqr->memdev->cdev), flags); 4928 private = cqr->memdev->private; 4929 private->count--; 4930 spin_unlock_irqrestore(get_ccwdev_lock(cqr->memdev->cdev), flags); 4931 return dasd_eckd_free_cp(cqr, req); 4932 } 4933 4934 static int 4935 dasd_eckd_fill_info(struct dasd_device * device, 4936 struct dasd_information2_t * info) 4937 { 4938 struct dasd_eckd_private *private = device->private; 4939 4940 info->label_block = 2; 4941 info->FBA_layout = private->uses_cdl ? 0 : 1; 4942 info->format = private->uses_cdl ? DASD_FORMAT_CDL : DASD_FORMAT_LDL; 4943 info->characteristics_size = sizeof(private->rdc_data); 4944 memcpy(info->characteristics, &private->rdc_data, 4945 sizeof(private->rdc_data)); 4946 info->confdata_size = min((unsigned long)private->conf_len, 4947 sizeof(info->configuration_data)); 4948 memcpy(info->configuration_data, private->conf_data, 4949 info->confdata_size); 4950 return 0; 4951 } 4952 4953 /* 4954 * SECTION: ioctl functions for eckd devices. 4955 */ 4956 4957 /* 4958 * Release device ioctl. 4959 * Buils a channel programm to releases a prior reserved 4960 * (see dasd_eckd_reserve) device. 4961 */ 4962 static int 4963 dasd_eckd_release(struct dasd_device *device) 4964 { 4965 struct dasd_ccw_req *cqr; 4966 int rc; 4967 struct ccw1 *ccw; 4968 int useglobal; 4969 4970 if (!capable(CAP_SYS_ADMIN)) 4971 return -EACCES; 4972 4973 useglobal = 0; 4974 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device, NULL); 4975 if (IS_ERR(cqr)) { 4976 mutex_lock(&dasd_reserve_mutex); 4977 useglobal = 1; 4978 cqr = &dasd_reserve_req->cqr; 4979 memset(cqr, 0, sizeof(*cqr)); 4980 memset(&dasd_reserve_req->ccw, 0, 4981 sizeof(dasd_reserve_req->ccw)); 4982 cqr->cpaddr = &dasd_reserve_req->ccw; 4983 cqr->data = &dasd_reserve_req->data; 4984 cqr->magic = DASD_ECKD_MAGIC; 4985 } 4986 ccw = cqr->cpaddr; 4987 ccw->cmd_code = DASD_ECKD_CCW_RELEASE; 4988 ccw->flags |= CCW_FLAG_SLI; 4989 ccw->count = 32; 4990 ccw->cda = (__u32)(addr_t) cqr->data; 4991 cqr->startdev = device; 4992 cqr->memdev = device; 4993 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 4994 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 4995 cqr->retries = 2; /* set retry counter to enable basic ERP */ 4996 cqr->expires = 2 * HZ; 4997 cqr->buildclk = get_tod_clock(); 4998 cqr->status = DASD_CQR_FILLED; 4999 5000 rc = dasd_sleep_on_immediatly(cqr); 5001 if (!rc) 5002 clear_bit(DASD_FLAG_IS_RESERVED, &device->flags); 5003 5004 if (useglobal) 5005 mutex_unlock(&dasd_reserve_mutex); 5006 else 5007 dasd_sfree_request(cqr, cqr->memdev); 5008 return rc; 5009 } 5010 5011 /* 5012 * Reserve device ioctl. 5013 * Options are set to 'synchronous wait for interrupt' and 5014 * 'timeout the request'. This leads to a terminate IO if 5015 * the interrupt is outstanding for a certain time. 5016 */ 5017 static int 5018 dasd_eckd_reserve(struct dasd_device *device) 5019 { 5020 struct dasd_ccw_req *cqr; 5021 int rc; 5022 struct ccw1 *ccw; 5023 int useglobal; 5024 5025 if (!capable(CAP_SYS_ADMIN)) 5026 return -EACCES; 5027 5028 useglobal = 0; 5029 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device, NULL); 5030 if (IS_ERR(cqr)) { 5031 mutex_lock(&dasd_reserve_mutex); 5032 useglobal = 1; 5033 cqr = &dasd_reserve_req->cqr; 5034 memset(cqr, 0, sizeof(*cqr)); 5035 memset(&dasd_reserve_req->ccw, 0, 5036 sizeof(dasd_reserve_req->ccw)); 5037 cqr->cpaddr = &dasd_reserve_req->ccw; 5038 cqr->data = &dasd_reserve_req->data; 5039 cqr->magic = DASD_ECKD_MAGIC; 5040 } 5041 ccw = cqr->cpaddr; 5042 ccw->cmd_code = DASD_ECKD_CCW_RESERVE; 5043 ccw->flags |= CCW_FLAG_SLI; 5044 ccw->count = 32; 5045 ccw->cda = (__u32)(addr_t) cqr->data; 5046 cqr->startdev = device; 5047 cqr->memdev = device; 5048 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 5049 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 5050 cqr->retries = 2; /* set retry counter to enable basic ERP */ 5051 cqr->expires = 2 * HZ; 5052 cqr->buildclk = get_tod_clock(); 5053 cqr->status = DASD_CQR_FILLED; 5054 5055 rc = dasd_sleep_on_immediatly(cqr); 5056 if (!rc) 5057 set_bit(DASD_FLAG_IS_RESERVED, &device->flags); 5058 5059 if (useglobal) 5060 mutex_unlock(&dasd_reserve_mutex); 5061 else 5062 dasd_sfree_request(cqr, cqr->memdev); 5063 return rc; 5064 } 5065 5066 /* 5067 * Steal lock ioctl - unconditional reserve device. 5068 * Buils a channel programm to break a device's reservation. 5069 * (unconditional reserve) 5070 */ 5071 static int 5072 dasd_eckd_steal_lock(struct dasd_device *device) 5073 { 5074 struct dasd_ccw_req *cqr; 5075 int rc; 5076 struct ccw1 *ccw; 5077 int useglobal; 5078 5079 if (!capable(CAP_SYS_ADMIN)) 5080 return -EACCES; 5081 5082 useglobal = 0; 5083 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device, NULL); 5084 if (IS_ERR(cqr)) { 5085 mutex_lock(&dasd_reserve_mutex); 5086 useglobal = 1; 5087 cqr = &dasd_reserve_req->cqr; 5088 memset(cqr, 0, sizeof(*cqr)); 5089 memset(&dasd_reserve_req->ccw, 0, 5090 sizeof(dasd_reserve_req->ccw)); 5091 cqr->cpaddr = &dasd_reserve_req->ccw; 5092 cqr->data = &dasd_reserve_req->data; 5093 cqr->magic = DASD_ECKD_MAGIC; 5094 } 5095 ccw = cqr->cpaddr; 5096 ccw->cmd_code = DASD_ECKD_CCW_SLCK; 5097 ccw->flags |= CCW_FLAG_SLI; 5098 ccw->count = 32; 5099 ccw->cda = (__u32)(addr_t) cqr->data; 5100 cqr->startdev = device; 5101 cqr->memdev = device; 5102 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 5103 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 5104 cqr->retries = 2; /* set retry counter to enable basic ERP */ 5105 cqr->expires = 2 * HZ; 5106 cqr->buildclk = get_tod_clock(); 5107 cqr->status = DASD_CQR_FILLED; 5108 5109 rc = dasd_sleep_on_immediatly(cqr); 5110 if (!rc) 5111 set_bit(DASD_FLAG_IS_RESERVED, &device->flags); 5112 5113 if (useglobal) 5114 mutex_unlock(&dasd_reserve_mutex); 5115 else 5116 dasd_sfree_request(cqr, cqr->memdev); 5117 return rc; 5118 } 5119 5120 /* 5121 * SNID - Sense Path Group ID 5122 * This ioctl may be used in situations where I/O is stalled due to 5123 * a reserve, so if the normal dasd_smalloc_request fails, we use the 5124 * preallocated dasd_reserve_req. 5125 */ 5126 static int dasd_eckd_snid(struct dasd_device *device, 5127 void __user *argp) 5128 { 5129 struct dasd_ccw_req *cqr; 5130 int rc; 5131 struct ccw1 *ccw; 5132 int useglobal; 5133 struct dasd_snid_ioctl_data usrparm; 5134 5135 if (!capable(CAP_SYS_ADMIN)) 5136 return -EACCES; 5137 5138 if (copy_from_user(&usrparm, argp, sizeof(usrparm))) 5139 return -EFAULT; 5140 5141 useglobal = 0; 5142 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 5143 sizeof(struct dasd_snid_data), device, 5144 NULL); 5145 if (IS_ERR(cqr)) { 5146 mutex_lock(&dasd_reserve_mutex); 5147 useglobal = 1; 5148 cqr = &dasd_reserve_req->cqr; 5149 memset(cqr, 0, sizeof(*cqr)); 5150 memset(&dasd_reserve_req->ccw, 0, 5151 sizeof(dasd_reserve_req->ccw)); 5152 cqr->cpaddr = &dasd_reserve_req->ccw; 5153 cqr->data = &dasd_reserve_req->data; 5154 cqr->magic = DASD_ECKD_MAGIC; 5155 } 5156 ccw = cqr->cpaddr; 5157 ccw->cmd_code = DASD_ECKD_CCW_SNID; 5158 ccw->flags |= CCW_FLAG_SLI; 5159 ccw->count = 12; 5160 ccw->cda = (__u32)(addr_t) cqr->data; 5161 cqr->startdev = device; 5162 cqr->memdev = device; 5163 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 5164 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 5165 set_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags); 5166 cqr->retries = 5; 5167 cqr->expires = 10 * HZ; 5168 cqr->buildclk = get_tod_clock(); 5169 cqr->status = DASD_CQR_FILLED; 5170 cqr->lpm = usrparm.path_mask; 5171 5172 rc = dasd_sleep_on_immediatly(cqr); 5173 /* verify that I/O processing didn't modify the path mask */ 5174 if (!rc && usrparm.path_mask && (cqr->lpm != usrparm.path_mask)) 5175 rc = -EIO; 5176 if (!rc) { 5177 usrparm.data = *((struct dasd_snid_data *)cqr->data); 5178 if (copy_to_user(argp, &usrparm, sizeof(usrparm))) 5179 rc = -EFAULT; 5180 } 5181 5182 if (useglobal) 5183 mutex_unlock(&dasd_reserve_mutex); 5184 else 5185 dasd_sfree_request(cqr, cqr->memdev); 5186 return rc; 5187 } 5188 5189 /* 5190 * Read performance statistics 5191 */ 5192 static int 5193 dasd_eckd_performance(struct dasd_device *device, void __user *argp) 5194 { 5195 struct dasd_psf_prssd_data *prssdp; 5196 struct dasd_rssd_perf_stats_t *stats; 5197 struct dasd_ccw_req *cqr; 5198 struct ccw1 *ccw; 5199 int rc; 5200 5201 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ + 1 /* RSSD */, 5202 (sizeof(struct dasd_psf_prssd_data) + 5203 sizeof(struct dasd_rssd_perf_stats_t)), 5204 device, NULL); 5205 if (IS_ERR(cqr)) { 5206 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 5207 "Could not allocate initialization request"); 5208 return PTR_ERR(cqr); 5209 } 5210 cqr->startdev = device; 5211 cqr->memdev = device; 5212 cqr->retries = 0; 5213 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 5214 cqr->expires = 10 * HZ; 5215 5216 /* Prepare for Read Subsystem Data */ 5217 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 5218 memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data)); 5219 prssdp->order = PSF_ORDER_PRSSD; 5220 prssdp->suborder = 0x01; /* Performance Statistics */ 5221 prssdp->varies[1] = 0x01; /* Perf Statistics for the Subsystem */ 5222 5223 ccw = cqr->cpaddr; 5224 ccw->cmd_code = DASD_ECKD_CCW_PSF; 5225 ccw->count = sizeof(struct dasd_psf_prssd_data); 5226 ccw->flags |= CCW_FLAG_CC; 5227 ccw->cda = (__u32)(addr_t) prssdp; 5228 5229 /* Read Subsystem Data - Performance Statistics */ 5230 stats = (struct dasd_rssd_perf_stats_t *) (prssdp + 1); 5231 memset(stats, 0, sizeof(struct dasd_rssd_perf_stats_t)); 5232 5233 ccw++; 5234 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 5235 ccw->count = sizeof(struct dasd_rssd_perf_stats_t); 5236 ccw->cda = (__u32)(addr_t) stats; 5237 5238 cqr->buildclk = get_tod_clock(); 5239 cqr->status = DASD_CQR_FILLED; 5240 rc = dasd_sleep_on(cqr); 5241 if (rc == 0) { 5242 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 5243 stats = (struct dasd_rssd_perf_stats_t *) (prssdp + 1); 5244 if (copy_to_user(argp, stats, 5245 sizeof(struct dasd_rssd_perf_stats_t))) 5246 rc = -EFAULT; 5247 } 5248 dasd_sfree_request(cqr, cqr->memdev); 5249 return rc; 5250 } 5251 5252 /* 5253 * Get attributes (cache operations) 5254 * Returnes the cache attributes used in Define Extend (DE). 5255 */ 5256 static int 5257 dasd_eckd_get_attrib(struct dasd_device *device, void __user *argp) 5258 { 5259 struct dasd_eckd_private *private = device->private; 5260 struct attrib_data_t attrib = private->attrib; 5261 int rc; 5262 5263 if (!capable(CAP_SYS_ADMIN)) 5264 return -EACCES; 5265 if (!argp) 5266 return -EINVAL; 5267 5268 rc = 0; 5269 if (copy_to_user(argp, (long *) &attrib, 5270 sizeof(struct attrib_data_t))) 5271 rc = -EFAULT; 5272 5273 return rc; 5274 } 5275 5276 /* 5277 * Set attributes (cache operations) 5278 * Stores the attributes for cache operation to be used in Define Extend (DE). 5279 */ 5280 static int 5281 dasd_eckd_set_attrib(struct dasd_device *device, void __user *argp) 5282 { 5283 struct dasd_eckd_private *private = device->private; 5284 struct attrib_data_t attrib; 5285 5286 if (!capable(CAP_SYS_ADMIN)) 5287 return -EACCES; 5288 if (!argp) 5289 return -EINVAL; 5290 5291 if (copy_from_user(&attrib, argp, sizeof(struct attrib_data_t))) 5292 return -EFAULT; 5293 private->attrib = attrib; 5294 5295 dev_info(&device->cdev->dev, 5296 "The DASD cache mode was set to %x (%i cylinder prestage)\n", 5297 private->attrib.operation, private->attrib.nr_cyl); 5298 return 0; 5299 } 5300 5301 /* 5302 * Issue syscall I/O to EMC Symmetrix array. 5303 * CCWs are PSF and RSSD 5304 */ 5305 static int dasd_symm_io(struct dasd_device *device, void __user *argp) 5306 { 5307 struct dasd_symmio_parms usrparm; 5308 char *psf_data, *rssd_result; 5309 struct dasd_ccw_req *cqr; 5310 struct ccw1 *ccw; 5311 char psf0, psf1; 5312 int rc; 5313 5314 if (!capable(CAP_SYS_ADMIN) && !capable(CAP_SYS_RAWIO)) 5315 return -EACCES; 5316 psf0 = psf1 = 0; 5317 5318 /* Copy parms from caller */ 5319 rc = -EFAULT; 5320 if (copy_from_user(&usrparm, argp, sizeof(usrparm))) 5321 goto out; 5322 if (is_compat_task()) { 5323 /* Make sure pointers are sane even on 31 bit. */ 5324 rc = -EINVAL; 5325 if ((usrparm.psf_data >> 32) != 0) 5326 goto out; 5327 if ((usrparm.rssd_result >> 32) != 0) 5328 goto out; 5329 usrparm.psf_data &= 0x7fffffffULL; 5330 usrparm.rssd_result &= 0x7fffffffULL; 5331 } 5332 /* at least 2 bytes are accessed and should be allocated */ 5333 if (usrparm.psf_data_len < 2) { 5334 DBF_DEV_EVENT(DBF_WARNING, device, 5335 "Symmetrix ioctl invalid data length %d", 5336 usrparm.psf_data_len); 5337 rc = -EINVAL; 5338 goto out; 5339 } 5340 /* alloc I/O data area */ 5341 psf_data = kzalloc(usrparm.psf_data_len, GFP_KERNEL | GFP_DMA); 5342 rssd_result = kzalloc(usrparm.rssd_result_len, GFP_KERNEL | GFP_DMA); 5343 if (!psf_data || !rssd_result) { 5344 rc = -ENOMEM; 5345 goto out_free; 5346 } 5347 5348 /* get syscall header from user space */ 5349 rc = -EFAULT; 5350 if (copy_from_user(psf_data, 5351 (void __user *)(unsigned long) usrparm.psf_data, 5352 usrparm.psf_data_len)) 5353 goto out_free; 5354 psf0 = psf_data[0]; 5355 psf1 = psf_data[1]; 5356 5357 /* setup CCWs for PSF + RSSD */ 5358 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 2, 0, device, NULL); 5359 if (IS_ERR(cqr)) { 5360 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 5361 "Could not allocate initialization request"); 5362 rc = PTR_ERR(cqr); 5363 goto out_free; 5364 } 5365 5366 cqr->startdev = device; 5367 cqr->memdev = device; 5368 cqr->retries = 3; 5369 cqr->expires = 10 * HZ; 5370 cqr->buildclk = get_tod_clock(); 5371 cqr->status = DASD_CQR_FILLED; 5372 5373 /* Build the ccws */ 5374 ccw = cqr->cpaddr; 5375 5376 /* PSF ccw */ 5377 ccw->cmd_code = DASD_ECKD_CCW_PSF; 5378 ccw->count = usrparm.psf_data_len; 5379 ccw->flags |= CCW_FLAG_CC; 5380 ccw->cda = (__u32)(addr_t) psf_data; 5381 5382 ccw++; 5383 5384 /* RSSD ccw */ 5385 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 5386 ccw->count = usrparm.rssd_result_len; 5387 ccw->flags = CCW_FLAG_SLI ; 5388 ccw->cda = (__u32)(addr_t) rssd_result; 5389 5390 rc = dasd_sleep_on(cqr); 5391 if (rc) 5392 goto out_sfree; 5393 5394 rc = -EFAULT; 5395 if (copy_to_user((void __user *)(unsigned long) usrparm.rssd_result, 5396 rssd_result, usrparm.rssd_result_len)) 5397 goto out_sfree; 5398 rc = 0; 5399 5400 out_sfree: 5401 dasd_sfree_request(cqr, cqr->memdev); 5402 out_free: 5403 kfree(rssd_result); 5404 kfree(psf_data); 5405 out: 5406 DBF_DEV_EVENT(DBF_WARNING, device, 5407 "Symmetrix ioctl (0x%02x 0x%02x): rc=%d", 5408 (int) psf0, (int) psf1, rc); 5409 return rc; 5410 } 5411 5412 static int 5413 dasd_eckd_ioctl(struct dasd_block *block, unsigned int cmd, void __user *argp) 5414 { 5415 struct dasd_device *device = block->base; 5416 5417 switch (cmd) { 5418 case BIODASDGATTR: 5419 return dasd_eckd_get_attrib(device, argp); 5420 case BIODASDSATTR: 5421 return dasd_eckd_set_attrib(device, argp); 5422 case BIODASDPSRD: 5423 return dasd_eckd_performance(device, argp); 5424 case BIODASDRLSE: 5425 return dasd_eckd_release(device); 5426 case BIODASDRSRV: 5427 return dasd_eckd_reserve(device); 5428 case BIODASDSLCK: 5429 return dasd_eckd_steal_lock(device); 5430 case BIODASDSNID: 5431 return dasd_eckd_snid(device, argp); 5432 case BIODASDSYMMIO: 5433 return dasd_symm_io(device, argp); 5434 default: 5435 return -ENOTTY; 5436 } 5437 } 5438 5439 /* 5440 * Dump the range of CCWs into 'page' buffer 5441 * and return number of printed chars. 5442 */ 5443 static int 5444 dasd_eckd_dump_ccw_range(struct ccw1 *from, struct ccw1 *to, char *page) 5445 { 5446 int len, count; 5447 char *datap; 5448 5449 len = 0; 5450 while (from <= to) { 5451 len += sprintf(page + len, PRINTK_HEADER 5452 " CCW %p: %08X %08X DAT:", 5453 from, ((int *) from)[0], ((int *) from)[1]); 5454 5455 /* get pointer to data (consider IDALs) */ 5456 if (from->flags & CCW_FLAG_IDA) 5457 datap = (char *) *((addr_t *) (addr_t) from->cda); 5458 else 5459 datap = (char *) ((addr_t) from->cda); 5460 5461 /* dump data (max 32 bytes) */ 5462 for (count = 0; count < from->count && count < 32; count++) { 5463 if (count % 8 == 0) len += sprintf(page + len, " "); 5464 if (count % 4 == 0) len += sprintf(page + len, " "); 5465 len += sprintf(page + len, "%02x", datap[count]); 5466 } 5467 len += sprintf(page + len, "\n"); 5468 from++; 5469 } 5470 return len; 5471 } 5472 5473 static void 5474 dasd_eckd_dump_sense_dbf(struct dasd_device *device, struct irb *irb, 5475 char *reason) 5476 { 5477 u64 *sense; 5478 u64 *stat; 5479 5480 sense = (u64 *) dasd_get_sense(irb); 5481 stat = (u64 *) &irb->scsw; 5482 if (sense) { 5483 DBF_DEV_EVENT(DBF_EMERG, device, "%s: %016llx %08x : " 5484 "%016llx %016llx %016llx %016llx", 5485 reason, *stat, *((u32 *) (stat + 1)), 5486 sense[0], sense[1], sense[2], sense[3]); 5487 } else { 5488 DBF_DEV_EVENT(DBF_EMERG, device, "%s: %016llx %08x : %s", 5489 reason, *stat, *((u32 *) (stat + 1)), 5490 "NO VALID SENSE"); 5491 } 5492 } 5493 5494 /* 5495 * Print sense data and related channel program. 5496 * Parts are printed because printk buffer is only 1024 bytes. 5497 */ 5498 static void dasd_eckd_dump_sense_ccw(struct dasd_device *device, 5499 struct dasd_ccw_req *req, struct irb *irb) 5500 { 5501 char *page; 5502 struct ccw1 *first, *last, *fail, *from, *to; 5503 int len, sl, sct; 5504 5505 page = (char *) get_zeroed_page(GFP_ATOMIC); 5506 if (page == NULL) { 5507 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 5508 "No memory to dump sense data\n"); 5509 return; 5510 } 5511 /* dump the sense data */ 5512 len = sprintf(page, PRINTK_HEADER 5513 " I/O status report for device %s:\n", 5514 dev_name(&device->cdev->dev)); 5515 len += sprintf(page + len, PRINTK_HEADER 5516 " in req: %p CC:%02X FC:%02X AC:%02X SC:%02X DS:%02X " 5517 "CS:%02X RC:%d\n", 5518 req, scsw_cc(&irb->scsw), scsw_fctl(&irb->scsw), 5519 scsw_actl(&irb->scsw), scsw_stctl(&irb->scsw), 5520 scsw_dstat(&irb->scsw), scsw_cstat(&irb->scsw), 5521 req ? req->intrc : 0); 5522 len += sprintf(page + len, PRINTK_HEADER 5523 " device %s: Failing CCW: %p\n", 5524 dev_name(&device->cdev->dev), 5525 (void *) (addr_t) irb->scsw.cmd.cpa); 5526 if (irb->esw.esw0.erw.cons) { 5527 for (sl = 0; sl < 4; sl++) { 5528 len += sprintf(page + len, PRINTK_HEADER 5529 " Sense(hex) %2d-%2d:", 5530 (8 * sl), ((8 * sl) + 7)); 5531 5532 for (sct = 0; sct < 8; sct++) { 5533 len += sprintf(page + len, " %02x", 5534 irb->ecw[8 * sl + sct]); 5535 } 5536 len += sprintf(page + len, "\n"); 5537 } 5538 5539 if (irb->ecw[27] & DASD_SENSE_BIT_0) { 5540 /* 24 Byte Sense Data */ 5541 sprintf(page + len, PRINTK_HEADER 5542 " 24 Byte: %x MSG %x, " 5543 "%s MSGb to SYSOP\n", 5544 irb->ecw[7] >> 4, irb->ecw[7] & 0x0f, 5545 irb->ecw[1] & 0x10 ? "" : "no"); 5546 } else { 5547 /* 32 Byte Sense Data */ 5548 sprintf(page + len, PRINTK_HEADER 5549 " 32 Byte: Format: %x " 5550 "Exception class %x\n", 5551 irb->ecw[6] & 0x0f, irb->ecw[22] >> 4); 5552 } 5553 } else { 5554 sprintf(page + len, PRINTK_HEADER 5555 " SORRY - NO VALID SENSE AVAILABLE\n"); 5556 } 5557 printk(KERN_ERR "%s", page); 5558 5559 if (req) { 5560 /* req == NULL for unsolicited interrupts */ 5561 /* dump the Channel Program (max 140 Bytes per line) */ 5562 /* Count CCW and print first CCWs (maximum 1024 % 140 = 7) */ 5563 first = req->cpaddr; 5564 for (last = first; last->flags & (CCW_FLAG_CC | CCW_FLAG_DC); last++); 5565 to = min(first + 6, last); 5566 len = sprintf(page, PRINTK_HEADER 5567 " Related CP in req: %p\n", req); 5568 dasd_eckd_dump_ccw_range(first, to, page + len); 5569 printk(KERN_ERR "%s", page); 5570 5571 /* print failing CCW area (maximum 4) */ 5572 /* scsw->cda is either valid or zero */ 5573 len = 0; 5574 from = ++to; 5575 fail = (struct ccw1 *)(addr_t) 5576 irb->scsw.cmd.cpa; /* failing CCW */ 5577 if (from < fail - 2) { 5578 from = fail - 2; /* there is a gap - print header */ 5579 len += sprintf(page, PRINTK_HEADER "......\n"); 5580 } 5581 to = min(fail + 1, last); 5582 len += dasd_eckd_dump_ccw_range(from, to, page + len); 5583 5584 /* print last CCWs (maximum 2) */ 5585 from = max(from, ++to); 5586 if (from < last - 1) { 5587 from = last - 1; /* there is a gap - print header */ 5588 len += sprintf(page + len, PRINTK_HEADER "......\n"); 5589 } 5590 len += dasd_eckd_dump_ccw_range(from, last, page + len); 5591 if (len > 0) 5592 printk(KERN_ERR "%s", page); 5593 } 5594 free_page((unsigned long) page); 5595 } 5596 5597 5598 /* 5599 * Print sense data from a tcw. 5600 */ 5601 static void dasd_eckd_dump_sense_tcw(struct dasd_device *device, 5602 struct dasd_ccw_req *req, struct irb *irb) 5603 { 5604 char *page; 5605 int len, sl, sct, residual; 5606 struct tsb *tsb; 5607 u8 *sense, *rcq; 5608 5609 page = (char *) get_zeroed_page(GFP_ATOMIC); 5610 if (page == NULL) { 5611 DBF_DEV_EVENT(DBF_WARNING, device, " %s", 5612 "No memory to dump sense data"); 5613 return; 5614 } 5615 /* dump the sense data */ 5616 len = sprintf(page, PRINTK_HEADER 5617 " I/O status report for device %s:\n", 5618 dev_name(&device->cdev->dev)); 5619 len += sprintf(page + len, PRINTK_HEADER 5620 " in req: %p CC:%02X FC:%02X AC:%02X SC:%02X DS:%02X " 5621 "CS:%02X fcxs:%02X schxs:%02X RC:%d\n", 5622 req, scsw_cc(&irb->scsw), scsw_fctl(&irb->scsw), 5623 scsw_actl(&irb->scsw), scsw_stctl(&irb->scsw), 5624 scsw_dstat(&irb->scsw), scsw_cstat(&irb->scsw), 5625 irb->scsw.tm.fcxs, 5626 (irb->scsw.tm.ifob << 7) | irb->scsw.tm.sesq, 5627 req ? req->intrc : 0); 5628 len += sprintf(page + len, PRINTK_HEADER 5629 " device %s: Failing TCW: %p\n", 5630 dev_name(&device->cdev->dev), 5631 (void *) (addr_t) irb->scsw.tm.tcw); 5632 5633 tsb = NULL; 5634 sense = NULL; 5635 if (irb->scsw.tm.tcw && (irb->scsw.tm.fcxs & 0x01)) 5636 tsb = tcw_get_tsb( 5637 (struct tcw *)(unsigned long)irb->scsw.tm.tcw); 5638 5639 if (tsb) { 5640 len += sprintf(page + len, PRINTK_HEADER 5641 " tsb->length %d\n", tsb->length); 5642 len += sprintf(page + len, PRINTK_HEADER 5643 " tsb->flags %x\n", tsb->flags); 5644 len += sprintf(page + len, PRINTK_HEADER 5645 " tsb->dcw_offset %d\n", tsb->dcw_offset); 5646 len += sprintf(page + len, PRINTK_HEADER 5647 " tsb->count %d\n", tsb->count); 5648 residual = tsb->count - 28; 5649 len += sprintf(page + len, PRINTK_HEADER 5650 " residual %d\n", residual); 5651 5652 switch (tsb->flags & 0x07) { 5653 case 1: /* tsa_iostat */ 5654 len += sprintf(page + len, PRINTK_HEADER 5655 " tsb->tsa.iostat.dev_time %d\n", 5656 tsb->tsa.iostat.dev_time); 5657 len += sprintf(page + len, PRINTK_HEADER 5658 " tsb->tsa.iostat.def_time %d\n", 5659 tsb->tsa.iostat.def_time); 5660 len += sprintf(page + len, PRINTK_HEADER 5661 " tsb->tsa.iostat.queue_time %d\n", 5662 tsb->tsa.iostat.queue_time); 5663 len += sprintf(page + len, PRINTK_HEADER 5664 " tsb->tsa.iostat.dev_busy_time %d\n", 5665 tsb->tsa.iostat.dev_busy_time); 5666 len += sprintf(page + len, PRINTK_HEADER 5667 " tsb->tsa.iostat.dev_act_time %d\n", 5668 tsb->tsa.iostat.dev_act_time); 5669 sense = tsb->tsa.iostat.sense; 5670 break; 5671 case 2: /* ts_ddpc */ 5672 len += sprintf(page + len, PRINTK_HEADER 5673 " tsb->tsa.ddpc.rc %d\n", tsb->tsa.ddpc.rc); 5674 for (sl = 0; sl < 2; sl++) { 5675 len += sprintf(page + len, PRINTK_HEADER 5676 " tsb->tsa.ddpc.rcq %2d-%2d: ", 5677 (8 * sl), ((8 * sl) + 7)); 5678 rcq = tsb->tsa.ddpc.rcq; 5679 for (sct = 0; sct < 8; sct++) { 5680 len += sprintf(page + len, " %02x", 5681 rcq[8 * sl + sct]); 5682 } 5683 len += sprintf(page + len, "\n"); 5684 } 5685 sense = tsb->tsa.ddpc.sense; 5686 break; 5687 case 3: /* tsa_intrg */ 5688 len += sprintf(page + len, PRINTK_HEADER 5689 " tsb->tsa.intrg.: not supported yet\n"); 5690 break; 5691 } 5692 5693 if (sense) { 5694 for (sl = 0; sl < 4; sl++) { 5695 len += sprintf(page + len, PRINTK_HEADER 5696 " Sense(hex) %2d-%2d:", 5697 (8 * sl), ((8 * sl) + 7)); 5698 for (sct = 0; sct < 8; sct++) { 5699 len += sprintf(page + len, " %02x", 5700 sense[8 * sl + sct]); 5701 } 5702 len += sprintf(page + len, "\n"); 5703 } 5704 5705 if (sense[27] & DASD_SENSE_BIT_0) { 5706 /* 24 Byte Sense Data */ 5707 sprintf(page + len, PRINTK_HEADER 5708 " 24 Byte: %x MSG %x, " 5709 "%s MSGb to SYSOP\n", 5710 sense[7] >> 4, sense[7] & 0x0f, 5711 sense[1] & 0x10 ? "" : "no"); 5712 } else { 5713 /* 32 Byte Sense Data */ 5714 sprintf(page + len, PRINTK_HEADER 5715 " 32 Byte: Format: %x " 5716 "Exception class %x\n", 5717 sense[6] & 0x0f, sense[22] >> 4); 5718 } 5719 } else { 5720 sprintf(page + len, PRINTK_HEADER 5721 " SORRY - NO VALID SENSE AVAILABLE\n"); 5722 } 5723 } else { 5724 sprintf(page + len, PRINTK_HEADER 5725 " SORRY - NO TSB DATA AVAILABLE\n"); 5726 } 5727 printk(KERN_ERR "%s", page); 5728 free_page((unsigned long) page); 5729 } 5730 5731 static void dasd_eckd_dump_sense(struct dasd_device *device, 5732 struct dasd_ccw_req *req, struct irb *irb) 5733 { 5734 u8 *sense = dasd_get_sense(irb); 5735 5736 if (scsw_is_tm(&irb->scsw)) { 5737 /* 5738 * In some cases the 'File Protected' or 'Incorrect Length' 5739 * error might be expected and log messages shouldn't be written 5740 * then. Check if the according suppress bit is set. 5741 */ 5742 if (sense && (sense[1] & SNS1_FILE_PROTECTED) && 5743 test_bit(DASD_CQR_SUPPRESS_FP, &req->flags)) 5744 return; 5745 if (scsw_cstat(&irb->scsw) == 0x40 && 5746 test_bit(DASD_CQR_SUPPRESS_IL, &req->flags)) 5747 return; 5748 5749 dasd_eckd_dump_sense_tcw(device, req, irb); 5750 } else { 5751 /* 5752 * In some cases the 'Command Reject' or 'No Record Found' 5753 * error might be expected and log messages shouldn't be 5754 * written then. Check if the according suppress bit is set. 5755 */ 5756 if (sense && sense[0] & SNS0_CMD_REJECT && 5757 test_bit(DASD_CQR_SUPPRESS_CR, &req->flags)) 5758 return; 5759 5760 if (sense && sense[1] & SNS1_NO_REC_FOUND && 5761 test_bit(DASD_CQR_SUPPRESS_NRF, &req->flags)) 5762 return; 5763 5764 dasd_eckd_dump_sense_ccw(device, req, irb); 5765 } 5766 } 5767 5768 static int dasd_eckd_reload_device(struct dasd_device *device) 5769 { 5770 struct dasd_eckd_private *private = device->private; 5771 int rc, old_base; 5772 char print_uid[60]; 5773 struct dasd_uid uid; 5774 unsigned long flags; 5775 5776 /* 5777 * remove device from alias handling to prevent new requests 5778 * from being scheduled on the wrong alias device 5779 */ 5780 dasd_alias_remove_device(device); 5781 5782 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 5783 old_base = private->uid.base_unit_addr; 5784 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 5785 5786 /* Read Configuration Data */ 5787 rc = dasd_eckd_read_conf(device); 5788 if (rc) 5789 goto out_err; 5790 5791 rc = dasd_eckd_generate_uid(device); 5792 if (rc) 5793 goto out_err; 5794 /* 5795 * update unit address configuration and 5796 * add device to alias management 5797 */ 5798 dasd_alias_update_add_device(device); 5799 5800 dasd_eckd_get_uid(device, &uid); 5801 5802 if (old_base != uid.base_unit_addr) { 5803 dasd_eckd_get_uid_string(private, print_uid); 5804 dev_info(&device->cdev->dev, 5805 "An Alias device was reassigned to a new base device " 5806 "with UID: %s\n", print_uid); 5807 } 5808 return 0; 5809 5810 out_err: 5811 return -1; 5812 } 5813 5814 static int dasd_eckd_read_message_buffer(struct dasd_device *device, 5815 struct dasd_rssd_messages *messages, 5816 __u8 lpum) 5817 { 5818 struct dasd_rssd_messages *message_buf; 5819 struct dasd_psf_prssd_data *prssdp; 5820 struct dasd_ccw_req *cqr; 5821 struct ccw1 *ccw; 5822 int rc; 5823 5824 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ + 1 /* RSSD */, 5825 (sizeof(struct dasd_psf_prssd_data) + 5826 sizeof(struct dasd_rssd_messages)), 5827 device, NULL); 5828 if (IS_ERR(cqr)) { 5829 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 5830 "Could not allocate read message buffer request"); 5831 return PTR_ERR(cqr); 5832 } 5833 5834 cqr->lpm = lpum; 5835 retry: 5836 cqr->startdev = device; 5837 cqr->memdev = device; 5838 cqr->block = NULL; 5839 cqr->expires = 10 * HZ; 5840 set_bit(DASD_CQR_VERIFY_PATH, &cqr->flags); 5841 /* dasd_sleep_on_immediatly does not do complex error 5842 * recovery so clear erp flag and set retry counter to 5843 * do basic erp */ 5844 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 5845 cqr->retries = 256; 5846 5847 /* Prepare for Read Subsystem Data */ 5848 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 5849 memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data)); 5850 prssdp->order = PSF_ORDER_PRSSD; 5851 prssdp->suborder = 0x03; /* Message Buffer */ 5852 /* all other bytes of prssdp must be zero */ 5853 5854 ccw = cqr->cpaddr; 5855 ccw->cmd_code = DASD_ECKD_CCW_PSF; 5856 ccw->count = sizeof(struct dasd_psf_prssd_data); 5857 ccw->flags |= CCW_FLAG_CC; 5858 ccw->flags |= CCW_FLAG_SLI; 5859 ccw->cda = (__u32)(addr_t) prssdp; 5860 5861 /* Read Subsystem Data - message buffer */ 5862 message_buf = (struct dasd_rssd_messages *) (prssdp + 1); 5863 memset(message_buf, 0, sizeof(struct dasd_rssd_messages)); 5864 5865 ccw++; 5866 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 5867 ccw->count = sizeof(struct dasd_rssd_messages); 5868 ccw->flags |= CCW_FLAG_SLI; 5869 ccw->cda = (__u32)(addr_t) message_buf; 5870 5871 cqr->buildclk = get_tod_clock(); 5872 cqr->status = DASD_CQR_FILLED; 5873 rc = dasd_sleep_on_immediatly(cqr); 5874 if (rc == 0) { 5875 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 5876 message_buf = (struct dasd_rssd_messages *) 5877 (prssdp + 1); 5878 memcpy(messages, message_buf, 5879 sizeof(struct dasd_rssd_messages)); 5880 } else if (cqr->lpm) { 5881 /* 5882 * on z/VM we might not be able to do I/O on the requested path 5883 * but instead we get the required information on any path 5884 * so retry with open path mask 5885 */ 5886 cqr->lpm = 0; 5887 goto retry; 5888 } else 5889 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 5890 "Reading messages failed with rc=%d\n" 5891 , rc); 5892 dasd_sfree_request(cqr, cqr->memdev); 5893 return rc; 5894 } 5895 5896 static int dasd_eckd_query_host_access(struct dasd_device *device, 5897 struct dasd_psf_query_host_access *data) 5898 { 5899 struct dasd_eckd_private *private = device->private; 5900 struct dasd_psf_query_host_access *host_access; 5901 struct dasd_psf_prssd_data *prssdp; 5902 struct dasd_ccw_req *cqr; 5903 struct ccw1 *ccw; 5904 int rc; 5905 5906 /* not available for HYPER PAV alias devices */ 5907 if (!device->block && private->lcu->pav == HYPER_PAV) 5908 return -EOPNOTSUPP; 5909 5910 /* may not be supported by the storage server */ 5911 if (!(private->features.feature[14] & 0x80)) 5912 return -EOPNOTSUPP; 5913 5914 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ + 1 /* RSSD */, 5915 sizeof(struct dasd_psf_prssd_data) + 1, 5916 device, NULL); 5917 if (IS_ERR(cqr)) { 5918 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 5919 "Could not allocate read message buffer request"); 5920 return PTR_ERR(cqr); 5921 } 5922 host_access = kzalloc(sizeof(*host_access), GFP_KERNEL | GFP_DMA); 5923 if (!host_access) { 5924 dasd_sfree_request(cqr, device); 5925 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 5926 "Could not allocate host_access buffer"); 5927 return -ENOMEM; 5928 } 5929 cqr->startdev = device; 5930 cqr->memdev = device; 5931 cqr->block = NULL; 5932 cqr->retries = 256; 5933 cqr->expires = 10 * HZ; 5934 5935 /* Prepare for Read Subsystem Data */ 5936 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 5937 memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data)); 5938 prssdp->order = PSF_ORDER_PRSSD; 5939 prssdp->suborder = PSF_SUBORDER_QHA; /* query host access */ 5940 /* LSS and Volume that will be queried */ 5941 prssdp->lss = private->ned->ID; 5942 prssdp->volume = private->ned->unit_addr; 5943 /* all other bytes of prssdp must be zero */ 5944 5945 ccw = cqr->cpaddr; 5946 ccw->cmd_code = DASD_ECKD_CCW_PSF; 5947 ccw->count = sizeof(struct dasd_psf_prssd_data); 5948 ccw->flags |= CCW_FLAG_CC; 5949 ccw->flags |= CCW_FLAG_SLI; 5950 ccw->cda = (__u32)(addr_t) prssdp; 5951 5952 /* Read Subsystem Data - query host access */ 5953 ccw++; 5954 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 5955 ccw->count = sizeof(struct dasd_psf_query_host_access); 5956 ccw->flags |= CCW_FLAG_SLI; 5957 ccw->cda = (__u32)(addr_t) host_access; 5958 5959 cqr->buildclk = get_tod_clock(); 5960 cqr->status = DASD_CQR_FILLED; 5961 /* the command might not be supported, suppress error message */ 5962 __set_bit(DASD_CQR_SUPPRESS_CR, &cqr->flags); 5963 rc = dasd_sleep_on_interruptible(cqr); 5964 if (rc == 0) { 5965 *data = *host_access; 5966 } else { 5967 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 5968 "Reading host access data failed with rc=%d\n", 5969 rc); 5970 rc = -EOPNOTSUPP; 5971 } 5972 5973 dasd_sfree_request(cqr, cqr->memdev); 5974 kfree(host_access); 5975 return rc; 5976 } 5977 /* 5978 * return number of grouped devices 5979 */ 5980 static int dasd_eckd_host_access_count(struct dasd_device *device) 5981 { 5982 struct dasd_psf_query_host_access *access; 5983 struct dasd_ckd_path_group_entry *entry; 5984 struct dasd_ckd_host_information *info; 5985 int count = 0; 5986 int rc, i; 5987 5988 access = kzalloc(sizeof(*access), GFP_NOIO); 5989 if (!access) { 5990 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 5991 "Could not allocate access buffer"); 5992 return -ENOMEM; 5993 } 5994 rc = dasd_eckd_query_host_access(device, access); 5995 if (rc) { 5996 kfree(access); 5997 return rc; 5998 } 5999 6000 info = (struct dasd_ckd_host_information *) 6001 access->host_access_information; 6002 for (i = 0; i < info->entry_count; i++) { 6003 entry = (struct dasd_ckd_path_group_entry *) 6004 (info->entry + i * info->entry_size); 6005 if (entry->status_flags & DASD_ECKD_PG_GROUPED) 6006 count++; 6007 } 6008 6009 kfree(access); 6010 return count; 6011 } 6012 6013 /* 6014 * write host access information to a sequential file 6015 */ 6016 static int dasd_hosts_print(struct dasd_device *device, struct seq_file *m) 6017 { 6018 struct dasd_psf_query_host_access *access; 6019 struct dasd_ckd_path_group_entry *entry; 6020 struct dasd_ckd_host_information *info; 6021 char sysplex[9] = ""; 6022 int rc, i; 6023 6024 access = kzalloc(sizeof(*access), GFP_NOIO); 6025 if (!access) { 6026 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 6027 "Could not allocate access buffer"); 6028 return -ENOMEM; 6029 } 6030 rc = dasd_eckd_query_host_access(device, access); 6031 if (rc) { 6032 kfree(access); 6033 return rc; 6034 } 6035 6036 info = (struct dasd_ckd_host_information *) 6037 access->host_access_information; 6038 for (i = 0; i < info->entry_count; i++) { 6039 entry = (struct dasd_ckd_path_group_entry *) 6040 (info->entry + i * info->entry_size); 6041 /* PGID */ 6042 seq_printf(m, "pgid %*phN\n", 11, entry->pgid); 6043 /* FLAGS */ 6044 seq_printf(m, "status_flags %02x\n", entry->status_flags); 6045 /* SYSPLEX NAME */ 6046 memcpy(&sysplex, &entry->sysplex_name, sizeof(sysplex) - 1); 6047 EBCASC(sysplex, sizeof(sysplex)); 6048 seq_printf(m, "sysplex_name %8s\n", sysplex); 6049 /* SUPPORTED CYLINDER */ 6050 seq_printf(m, "supported_cylinder %d\n", entry->cylinder); 6051 /* TIMESTAMP */ 6052 seq_printf(m, "timestamp %lu\n", (unsigned long) 6053 entry->timestamp); 6054 } 6055 kfree(access); 6056 6057 return 0; 6058 } 6059 6060 /* 6061 * Perform Subsystem Function - CUIR response 6062 */ 6063 static int 6064 dasd_eckd_psf_cuir_response(struct dasd_device *device, int response, 6065 __u32 message_id, __u8 lpum) 6066 { 6067 struct dasd_psf_cuir_response *psf_cuir; 6068 int pos = pathmask_to_pos(lpum); 6069 struct dasd_ccw_req *cqr; 6070 struct ccw1 *ccw; 6071 int rc; 6072 6073 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ , 6074 sizeof(struct dasd_psf_cuir_response), 6075 device, NULL); 6076 6077 if (IS_ERR(cqr)) { 6078 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 6079 "Could not allocate PSF-CUIR request"); 6080 return PTR_ERR(cqr); 6081 } 6082 6083 psf_cuir = (struct dasd_psf_cuir_response *)cqr->data; 6084 psf_cuir->order = PSF_ORDER_CUIR_RESPONSE; 6085 psf_cuir->cc = response; 6086 psf_cuir->chpid = device->path[pos].chpid; 6087 psf_cuir->message_id = message_id; 6088 psf_cuir->cssid = device->path[pos].cssid; 6089 psf_cuir->ssid = device->path[pos].ssid; 6090 ccw = cqr->cpaddr; 6091 ccw->cmd_code = DASD_ECKD_CCW_PSF; 6092 ccw->cda = (__u32)(addr_t)psf_cuir; 6093 ccw->flags = CCW_FLAG_SLI; 6094 ccw->count = sizeof(struct dasd_psf_cuir_response); 6095 6096 cqr->startdev = device; 6097 cqr->memdev = device; 6098 cqr->block = NULL; 6099 cqr->retries = 256; 6100 cqr->expires = 10*HZ; 6101 cqr->buildclk = get_tod_clock(); 6102 cqr->status = DASD_CQR_FILLED; 6103 set_bit(DASD_CQR_VERIFY_PATH, &cqr->flags); 6104 6105 rc = dasd_sleep_on(cqr); 6106 6107 dasd_sfree_request(cqr, cqr->memdev); 6108 return rc; 6109 } 6110 6111 /* 6112 * return configuration data that is referenced by record selector 6113 * if a record selector is specified or per default return the 6114 * conf_data pointer for the path specified by lpum 6115 */ 6116 static struct dasd_conf_data *dasd_eckd_get_ref_conf(struct dasd_device *device, 6117 __u8 lpum, 6118 struct dasd_cuir_message *cuir) 6119 { 6120 struct dasd_conf_data *conf_data; 6121 int path, pos; 6122 6123 if (cuir->record_selector == 0) 6124 goto out; 6125 for (path = 0x80, pos = 0; path; path >>= 1, pos++) { 6126 conf_data = device->path[pos].conf_data; 6127 if (conf_data->gneq.record_selector == 6128 cuir->record_selector) 6129 return conf_data; 6130 } 6131 out: 6132 return device->path[pathmask_to_pos(lpum)].conf_data; 6133 } 6134 6135 /* 6136 * This function determines the scope of a reconfiguration request by 6137 * analysing the path and device selection data provided in the CUIR request. 6138 * Returns a path mask containing CUIR affected paths for the give device. 6139 * 6140 * If the CUIR request does not contain the required information return the 6141 * path mask of the path the attention message for the CUIR request was reveived 6142 * on. 6143 */ 6144 static int dasd_eckd_cuir_scope(struct dasd_device *device, __u8 lpum, 6145 struct dasd_cuir_message *cuir) 6146 { 6147 struct dasd_conf_data *ref_conf_data; 6148 unsigned long bitmask = 0, mask = 0; 6149 struct dasd_conf_data *conf_data; 6150 unsigned int pos, path; 6151 char *ref_gneq, *gneq; 6152 char *ref_ned, *ned; 6153 int tbcpm = 0; 6154 6155 /* if CUIR request does not specify the scope use the path 6156 the attention message was presented on */ 6157 if (!cuir->ned_map || 6158 !(cuir->neq_map[0] | cuir->neq_map[1] | cuir->neq_map[2])) 6159 return lpum; 6160 6161 /* get reference conf data */ 6162 ref_conf_data = dasd_eckd_get_ref_conf(device, lpum, cuir); 6163 /* reference ned is determined by ned_map field */ 6164 pos = 8 - ffs(cuir->ned_map); 6165 ref_ned = (char *)&ref_conf_data->neds[pos]; 6166 ref_gneq = (char *)&ref_conf_data->gneq; 6167 /* transfer 24 bit neq_map to mask */ 6168 mask = cuir->neq_map[2]; 6169 mask |= cuir->neq_map[1] << 8; 6170 mask |= cuir->neq_map[0] << 16; 6171 6172 for (path = 0; path < 8; path++) { 6173 /* initialise data per path */ 6174 bitmask = mask; 6175 conf_data = device->path[path].conf_data; 6176 pos = 8 - ffs(cuir->ned_map); 6177 ned = (char *) &conf_data->neds[pos]; 6178 /* compare reference ned and per path ned */ 6179 if (memcmp(ref_ned, ned, sizeof(*ned)) != 0) 6180 continue; 6181 gneq = (char *)&conf_data->gneq; 6182 /* compare reference gneq and per_path gneq under 6183 24 bit mask where mask bit 0 equals byte 7 of 6184 the gneq and mask bit 24 equals byte 31 */ 6185 while (bitmask) { 6186 pos = ffs(bitmask) - 1; 6187 if (memcmp(&ref_gneq[31 - pos], &gneq[31 - pos], 1) 6188 != 0) 6189 break; 6190 clear_bit(pos, &bitmask); 6191 } 6192 if (bitmask) 6193 continue; 6194 /* device and path match the reference values 6195 add path to CUIR scope */ 6196 tbcpm |= 0x80 >> path; 6197 } 6198 return tbcpm; 6199 } 6200 6201 static void dasd_eckd_cuir_notify_user(struct dasd_device *device, 6202 unsigned long paths, int action) 6203 { 6204 int pos; 6205 6206 while (paths) { 6207 /* get position of bit in mask */ 6208 pos = 8 - ffs(paths); 6209 /* get channel path descriptor from this position */ 6210 if (action == CUIR_QUIESCE) 6211 pr_warn("Service on the storage server caused path %x.%02x to go offline", 6212 device->path[pos].cssid, 6213 device->path[pos].chpid); 6214 else if (action == CUIR_RESUME) 6215 pr_info("Path %x.%02x is back online after service on the storage server", 6216 device->path[pos].cssid, 6217 device->path[pos].chpid); 6218 clear_bit(7 - pos, &paths); 6219 } 6220 } 6221 6222 static int dasd_eckd_cuir_remove_path(struct dasd_device *device, __u8 lpum, 6223 struct dasd_cuir_message *cuir) 6224 { 6225 unsigned long tbcpm; 6226 6227 tbcpm = dasd_eckd_cuir_scope(device, lpum, cuir); 6228 /* nothing to do if path is not in use */ 6229 if (!(dasd_path_get_opm(device) & tbcpm)) 6230 return 0; 6231 if (!(dasd_path_get_opm(device) & ~tbcpm)) { 6232 /* no path would be left if the CUIR action is taken 6233 return error */ 6234 return -EINVAL; 6235 } 6236 /* remove device from operational path mask */ 6237 dasd_path_remove_opm(device, tbcpm); 6238 dasd_path_add_cuirpm(device, tbcpm); 6239 return tbcpm; 6240 } 6241 6242 /* 6243 * walk through all devices and build a path mask to quiesce them 6244 * return an error if the last path to a device would be removed 6245 * 6246 * if only part of the devices are quiesced and an error 6247 * occurs no onlining necessary, the storage server will 6248 * notify the already set offline devices again 6249 */ 6250 static int dasd_eckd_cuir_quiesce(struct dasd_device *device, __u8 lpum, 6251 struct dasd_cuir_message *cuir) 6252 { 6253 struct dasd_eckd_private *private = device->private; 6254 struct alias_pav_group *pavgroup, *tempgroup; 6255 struct dasd_device *dev, *n; 6256 unsigned long paths = 0; 6257 unsigned long flags; 6258 int tbcpm; 6259 6260 /* active devices */ 6261 list_for_each_entry_safe(dev, n, &private->lcu->active_devices, 6262 alias_list) { 6263 spin_lock_irqsave(get_ccwdev_lock(dev->cdev), flags); 6264 tbcpm = dasd_eckd_cuir_remove_path(dev, lpum, cuir); 6265 spin_unlock_irqrestore(get_ccwdev_lock(dev->cdev), flags); 6266 if (tbcpm < 0) 6267 goto out_err; 6268 paths |= tbcpm; 6269 } 6270 /* inactive devices */ 6271 list_for_each_entry_safe(dev, n, &private->lcu->inactive_devices, 6272 alias_list) { 6273 spin_lock_irqsave(get_ccwdev_lock(dev->cdev), flags); 6274 tbcpm = dasd_eckd_cuir_remove_path(dev, lpum, cuir); 6275 spin_unlock_irqrestore(get_ccwdev_lock(dev->cdev), flags); 6276 if (tbcpm < 0) 6277 goto out_err; 6278 paths |= tbcpm; 6279 } 6280 /* devices in PAV groups */ 6281 list_for_each_entry_safe(pavgroup, tempgroup, 6282 &private->lcu->grouplist, group) { 6283 list_for_each_entry_safe(dev, n, &pavgroup->baselist, 6284 alias_list) { 6285 spin_lock_irqsave(get_ccwdev_lock(dev->cdev), flags); 6286 tbcpm = dasd_eckd_cuir_remove_path(dev, lpum, cuir); 6287 spin_unlock_irqrestore( 6288 get_ccwdev_lock(dev->cdev), flags); 6289 if (tbcpm < 0) 6290 goto out_err; 6291 paths |= tbcpm; 6292 } 6293 list_for_each_entry_safe(dev, n, &pavgroup->aliaslist, 6294 alias_list) { 6295 spin_lock_irqsave(get_ccwdev_lock(dev->cdev), flags); 6296 tbcpm = dasd_eckd_cuir_remove_path(dev, lpum, cuir); 6297 spin_unlock_irqrestore( 6298 get_ccwdev_lock(dev->cdev), flags); 6299 if (tbcpm < 0) 6300 goto out_err; 6301 paths |= tbcpm; 6302 } 6303 } 6304 /* notify user about all paths affected by CUIR action */ 6305 dasd_eckd_cuir_notify_user(device, paths, CUIR_QUIESCE); 6306 return 0; 6307 out_err: 6308 return tbcpm; 6309 } 6310 6311 static int dasd_eckd_cuir_resume(struct dasd_device *device, __u8 lpum, 6312 struct dasd_cuir_message *cuir) 6313 { 6314 struct dasd_eckd_private *private = device->private; 6315 struct alias_pav_group *pavgroup, *tempgroup; 6316 struct dasd_device *dev, *n; 6317 unsigned long paths = 0; 6318 int tbcpm; 6319 6320 /* 6321 * the path may have been added through a generic path event before 6322 * only trigger path verification if the path is not already in use 6323 */ 6324 list_for_each_entry_safe(dev, n, 6325 &private->lcu->active_devices, 6326 alias_list) { 6327 tbcpm = dasd_eckd_cuir_scope(dev, lpum, cuir); 6328 paths |= tbcpm; 6329 if (!(dasd_path_get_opm(dev) & tbcpm)) { 6330 dasd_path_add_tbvpm(dev, tbcpm); 6331 dasd_schedule_device_bh(dev); 6332 } 6333 } 6334 list_for_each_entry_safe(dev, n, 6335 &private->lcu->inactive_devices, 6336 alias_list) { 6337 tbcpm = dasd_eckd_cuir_scope(dev, lpum, cuir); 6338 paths |= tbcpm; 6339 if (!(dasd_path_get_opm(dev) & tbcpm)) { 6340 dasd_path_add_tbvpm(dev, tbcpm); 6341 dasd_schedule_device_bh(dev); 6342 } 6343 } 6344 /* devices in PAV groups */ 6345 list_for_each_entry_safe(pavgroup, tempgroup, 6346 &private->lcu->grouplist, 6347 group) { 6348 list_for_each_entry_safe(dev, n, 6349 &pavgroup->baselist, 6350 alias_list) { 6351 tbcpm = dasd_eckd_cuir_scope(dev, lpum, cuir); 6352 paths |= tbcpm; 6353 if (!(dasd_path_get_opm(dev) & tbcpm)) { 6354 dasd_path_add_tbvpm(dev, tbcpm); 6355 dasd_schedule_device_bh(dev); 6356 } 6357 } 6358 list_for_each_entry_safe(dev, n, 6359 &pavgroup->aliaslist, 6360 alias_list) { 6361 tbcpm = dasd_eckd_cuir_scope(dev, lpum, cuir); 6362 paths |= tbcpm; 6363 if (!(dasd_path_get_opm(dev) & tbcpm)) { 6364 dasd_path_add_tbvpm(dev, tbcpm); 6365 dasd_schedule_device_bh(dev); 6366 } 6367 } 6368 } 6369 /* notify user about all paths affected by CUIR action */ 6370 dasd_eckd_cuir_notify_user(device, paths, CUIR_RESUME); 6371 return 0; 6372 } 6373 6374 static void dasd_eckd_handle_cuir(struct dasd_device *device, void *messages, 6375 __u8 lpum) 6376 { 6377 struct dasd_cuir_message *cuir = messages; 6378 int response; 6379 6380 DBF_DEV_EVENT(DBF_WARNING, device, 6381 "CUIR request: %016llx %016llx %016llx %08x", 6382 ((u64 *)cuir)[0], ((u64 *)cuir)[1], ((u64 *)cuir)[2], 6383 ((u32 *)cuir)[3]); 6384 6385 if (cuir->code == CUIR_QUIESCE) { 6386 /* quiesce */ 6387 if (dasd_eckd_cuir_quiesce(device, lpum, cuir)) 6388 response = PSF_CUIR_LAST_PATH; 6389 else 6390 response = PSF_CUIR_COMPLETED; 6391 } else if (cuir->code == CUIR_RESUME) { 6392 /* resume */ 6393 dasd_eckd_cuir_resume(device, lpum, cuir); 6394 response = PSF_CUIR_COMPLETED; 6395 } else 6396 response = PSF_CUIR_NOT_SUPPORTED; 6397 6398 dasd_eckd_psf_cuir_response(device, response, 6399 cuir->message_id, lpum); 6400 DBF_DEV_EVENT(DBF_WARNING, device, 6401 "CUIR response: %d on message ID %08x", response, 6402 cuir->message_id); 6403 /* to make sure there is no attention left schedule work again */ 6404 device->discipline->check_attention(device, lpum); 6405 } 6406 6407 static void dasd_eckd_oos_resume(struct dasd_device *device) 6408 { 6409 struct dasd_eckd_private *private = device->private; 6410 struct alias_pav_group *pavgroup, *tempgroup; 6411 struct dasd_device *dev, *n; 6412 unsigned long flags; 6413 6414 spin_lock_irqsave(&private->lcu->lock, flags); 6415 list_for_each_entry_safe(dev, n, &private->lcu->active_devices, 6416 alias_list) { 6417 if (dev->stopped & DASD_STOPPED_NOSPC) 6418 dasd_generic_space_avail(dev); 6419 } 6420 list_for_each_entry_safe(dev, n, &private->lcu->inactive_devices, 6421 alias_list) { 6422 if (dev->stopped & DASD_STOPPED_NOSPC) 6423 dasd_generic_space_avail(dev); 6424 } 6425 /* devices in PAV groups */ 6426 list_for_each_entry_safe(pavgroup, tempgroup, 6427 &private->lcu->grouplist, 6428 group) { 6429 list_for_each_entry_safe(dev, n, &pavgroup->baselist, 6430 alias_list) { 6431 if (dev->stopped & DASD_STOPPED_NOSPC) 6432 dasd_generic_space_avail(dev); 6433 } 6434 list_for_each_entry_safe(dev, n, &pavgroup->aliaslist, 6435 alias_list) { 6436 if (dev->stopped & DASD_STOPPED_NOSPC) 6437 dasd_generic_space_avail(dev); 6438 } 6439 } 6440 spin_unlock_irqrestore(&private->lcu->lock, flags); 6441 } 6442 6443 static void dasd_eckd_handle_oos(struct dasd_device *device, void *messages, 6444 __u8 lpum) 6445 { 6446 struct dasd_oos_message *oos = messages; 6447 6448 switch (oos->code) { 6449 case REPO_WARN: 6450 case POOL_WARN: 6451 dev_warn(&device->cdev->dev, 6452 "Extent pool usage has reached a critical value\n"); 6453 dasd_eckd_oos_resume(device); 6454 break; 6455 case REPO_EXHAUST: 6456 case POOL_EXHAUST: 6457 dev_warn(&device->cdev->dev, 6458 "Extent pool is exhausted\n"); 6459 break; 6460 case REPO_RELIEVE: 6461 case POOL_RELIEVE: 6462 dev_info(&device->cdev->dev, 6463 "Extent pool physical space constraint has been relieved\n"); 6464 break; 6465 } 6466 6467 /* In any case, update related data */ 6468 dasd_eckd_read_ext_pool_info(device); 6469 6470 /* to make sure there is no attention left schedule work again */ 6471 device->discipline->check_attention(device, lpum); 6472 } 6473 6474 static void dasd_eckd_check_attention_work(struct work_struct *work) 6475 { 6476 struct check_attention_work_data *data; 6477 struct dasd_rssd_messages *messages; 6478 struct dasd_device *device; 6479 int rc; 6480 6481 data = container_of(work, struct check_attention_work_data, worker); 6482 device = data->device; 6483 messages = kzalloc(sizeof(*messages), GFP_KERNEL); 6484 if (!messages) { 6485 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 6486 "Could not allocate attention message buffer"); 6487 goto out; 6488 } 6489 rc = dasd_eckd_read_message_buffer(device, messages, data->lpum); 6490 if (rc) 6491 goto out; 6492 6493 if (messages->length == ATTENTION_LENGTH_CUIR && 6494 messages->format == ATTENTION_FORMAT_CUIR) 6495 dasd_eckd_handle_cuir(device, messages, data->lpum); 6496 if (messages->length == ATTENTION_LENGTH_OOS && 6497 messages->format == ATTENTION_FORMAT_OOS) 6498 dasd_eckd_handle_oos(device, messages, data->lpum); 6499 6500 out: 6501 dasd_put_device(device); 6502 kfree(messages); 6503 kfree(data); 6504 } 6505 6506 static int dasd_eckd_check_attention(struct dasd_device *device, __u8 lpum) 6507 { 6508 struct check_attention_work_data *data; 6509 6510 data = kzalloc(sizeof(*data), GFP_ATOMIC); 6511 if (!data) 6512 return -ENOMEM; 6513 INIT_WORK(&data->worker, dasd_eckd_check_attention_work); 6514 dasd_get_device(device); 6515 data->device = device; 6516 data->lpum = lpum; 6517 schedule_work(&data->worker); 6518 return 0; 6519 } 6520 6521 static int dasd_eckd_disable_hpf_path(struct dasd_device *device, __u8 lpum) 6522 { 6523 if (~lpum & dasd_path_get_opm(device)) { 6524 dasd_path_add_nohpfpm(device, lpum); 6525 dasd_path_remove_opm(device, lpum); 6526 dev_err(&device->cdev->dev, 6527 "Channel path %02X lost HPF functionality and is disabled\n", 6528 lpum); 6529 return 1; 6530 } 6531 return 0; 6532 } 6533 6534 static void dasd_eckd_disable_hpf_device(struct dasd_device *device) 6535 { 6536 struct dasd_eckd_private *private = device->private; 6537 6538 dev_err(&device->cdev->dev, 6539 "High Performance FICON disabled\n"); 6540 private->fcx_max_data = 0; 6541 } 6542 6543 static int dasd_eckd_hpf_enabled(struct dasd_device *device) 6544 { 6545 struct dasd_eckd_private *private = device->private; 6546 6547 return private->fcx_max_data ? 1 : 0; 6548 } 6549 6550 static void dasd_eckd_handle_hpf_error(struct dasd_device *device, 6551 struct irb *irb) 6552 { 6553 struct dasd_eckd_private *private = device->private; 6554 6555 if (!private->fcx_max_data) { 6556 /* sanity check for no HPF, the error makes no sense */ 6557 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 6558 "Trying to disable HPF for a non HPF device"); 6559 return; 6560 } 6561 if (irb->scsw.tm.sesq == SCSW_SESQ_DEV_NOFCX) { 6562 dasd_eckd_disable_hpf_device(device); 6563 } else if (irb->scsw.tm.sesq == SCSW_SESQ_PATH_NOFCX) { 6564 if (dasd_eckd_disable_hpf_path(device, irb->esw.esw1.lpum)) 6565 return; 6566 dasd_eckd_disable_hpf_device(device); 6567 dasd_path_set_tbvpm(device, 6568 dasd_path_get_hpfpm(device)); 6569 } 6570 /* 6571 * prevent that any new I/O ist started on the device and schedule a 6572 * requeue of existing requests 6573 */ 6574 dasd_device_set_stop_bits(device, DASD_STOPPED_NOT_ACC); 6575 dasd_schedule_requeue(device); 6576 } 6577 6578 /* 6579 * Initialize block layer request queue. 6580 */ 6581 static void dasd_eckd_setup_blk_queue(struct dasd_block *block) 6582 { 6583 unsigned int logical_block_size = block->bp_block; 6584 struct request_queue *q = block->request_queue; 6585 struct dasd_device *device = block->base; 6586 int max; 6587 6588 if (device->features & DASD_FEATURE_USERAW) { 6589 /* 6590 * the max_blocks value for raw_track access is 256 6591 * it is higher than the native ECKD value because we 6592 * only need one ccw per track 6593 * so the max_hw_sectors are 6594 * 2048 x 512B = 1024kB = 16 tracks 6595 */ 6596 max = DASD_ECKD_MAX_BLOCKS_RAW << block->s2b_shift; 6597 } else { 6598 max = DASD_ECKD_MAX_BLOCKS << block->s2b_shift; 6599 } 6600 blk_queue_flag_set(QUEUE_FLAG_NONROT, q); 6601 q->limits.max_dev_sectors = max; 6602 blk_queue_logical_block_size(q, logical_block_size); 6603 blk_queue_max_hw_sectors(q, max); 6604 blk_queue_max_segments(q, USHRT_MAX); 6605 /* With page sized segments each segment can be translated into one idaw/tidaw */ 6606 blk_queue_max_segment_size(q, PAGE_SIZE); 6607 blk_queue_segment_boundary(q, PAGE_SIZE - 1); 6608 } 6609 6610 static struct ccw_driver dasd_eckd_driver = { 6611 .driver = { 6612 .name = "dasd-eckd", 6613 .owner = THIS_MODULE, 6614 .dev_groups = dasd_dev_groups, 6615 }, 6616 .ids = dasd_eckd_ids, 6617 .probe = dasd_eckd_probe, 6618 .remove = dasd_generic_remove, 6619 .set_offline = dasd_generic_set_offline, 6620 .set_online = dasd_eckd_set_online, 6621 .notify = dasd_generic_notify, 6622 .path_event = dasd_generic_path_event, 6623 .shutdown = dasd_generic_shutdown, 6624 .uc_handler = dasd_generic_uc_handler, 6625 .int_class = IRQIO_DAS, 6626 }; 6627 6628 static struct dasd_discipline dasd_eckd_discipline = { 6629 .owner = THIS_MODULE, 6630 .name = "ECKD", 6631 .ebcname = "ECKD", 6632 .check_device = dasd_eckd_check_characteristics, 6633 .uncheck_device = dasd_eckd_uncheck_device, 6634 .do_analysis = dasd_eckd_do_analysis, 6635 .pe_handler = dasd_eckd_pe_handler, 6636 .basic_to_ready = dasd_eckd_basic_to_ready, 6637 .online_to_ready = dasd_eckd_online_to_ready, 6638 .basic_to_known = dasd_eckd_basic_to_known, 6639 .setup_blk_queue = dasd_eckd_setup_blk_queue, 6640 .fill_geometry = dasd_eckd_fill_geometry, 6641 .start_IO = dasd_start_IO, 6642 .term_IO = dasd_term_IO, 6643 .handle_terminated_request = dasd_eckd_handle_terminated_request, 6644 .format_device = dasd_eckd_format_device, 6645 .check_device_format = dasd_eckd_check_device_format, 6646 .erp_action = dasd_eckd_erp_action, 6647 .erp_postaction = dasd_eckd_erp_postaction, 6648 .check_for_device_change = dasd_eckd_check_for_device_change, 6649 .build_cp = dasd_eckd_build_alias_cp, 6650 .free_cp = dasd_eckd_free_alias_cp, 6651 .dump_sense = dasd_eckd_dump_sense, 6652 .dump_sense_dbf = dasd_eckd_dump_sense_dbf, 6653 .fill_info = dasd_eckd_fill_info, 6654 .ioctl = dasd_eckd_ioctl, 6655 .reload = dasd_eckd_reload_device, 6656 .get_uid = dasd_eckd_get_uid, 6657 .kick_validate = dasd_eckd_kick_validate_server, 6658 .check_attention = dasd_eckd_check_attention, 6659 .host_access_count = dasd_eckd_host_access_count, 6660 .hosts_print = dasd_hosts_print, 6661 .handle_hpf_error = dasd_eckd_handle_hpf_error, 6662 .disable_hpf = dasd_eckd_disable_hpf_device, 6663 .hpf_enabled = dasd_eckd_hpf_enabled, 6664 .reset_path = dasd_eckd_reset_path, 6665 .is_ese = dasd_eckd_is_ese, 6666 .space_allocated = dasd_eckd_space_allocated, 6667 .space_configured = dasd_eckd_space_configured, 6668 .logical_capacity = dasd_eckd_logical_capacity, 6669 .release_space = dasd_eckd_release_space, 6670 .ext_pool_id = dasd_eckd_ext_pool_id, 6671 .ext_size = dasd_eckd_ext_size, 6672 .ext_pool_cap_at_warnlevel = dasd_eckd_ext_pool_cap_at_warnlevel, 6673 .ext_pool_warn_thrshld = dasd_eckd_ext_pool_warn_thrshld, 6674 .ext_pool_oos = dasd_eckd_ext_pool_oos, 6675 .ext_pool_exhaust = dasd_eckd_ext_pool_exhaust, 6676 .ese_format = dasd_eckd_ese_format, 6677 .ese_read = dasd_eckd_ese_read, 6678 }; 6679 6680 static int __init 6681 dasd_eckd_init(void) 6682 { 6683 int ret; 6684 6685 ASCEBC(dasd_eckd_discipline.ebcname, 4); 6686 dasd_reserve_req = kmalloc(sizeof(*dasd_reserve_req), 6687 GFP_KERNEL | GFP_DMA); 6688 if (!dasd_reserve_req) 6689 return -ENOMEM; 6690 dasd_vol_info_req = kmalloc(sizeof(*dasd_vol_info_req), 6691 GFP_KERNEL | GFP_DMA); 6692 if (!dasd_vol_info_req) 6693 return -ENOMEM; 6694 pe_handler_worker = kmalloc(sizeof(*pe_handler_worker), 6695 GFP_KERNEL | GFP_DMA); 6696 if (!pe_handler_worker) { 6697 kfree(dasd_reserve_req); 6698 kfree(dasd_vol_info_req); 6699 return -ENOMEM; 6700 } 6701 rawpadpage = (void *)__get_free_page(GFP_KERNEL); 6702 if (!rawpadpage) { 6703 kfree(pe_handler_worker); 6704 kfree(dasd_reserve_req); 6705 kfree(dasd_vol_info_req); 6706 return -ENOMEM; 6707 } 6708 ret = ccw_driver_register(&dasd_eckd_driver); 6709 if (!ret) 6710 wait_for_device_probe(); 6711 else { 6712 kfree(pe_handler_worker); 6713 kfree(dasd_reserve_req); 6714 kfree(dasd_vol_info_req); 6715 free_page((unsigned long)rawpadpage); 6716 } 6717 return ret; 6718 } 6719 6720 static void __exit 6721 dasd_eckd_cleanup(void) 6722 { 6723 ccw_driver_unregister(&dasd_eckd_driver); 6724 kfree(pe_handler_worker); 6725 kfree(dasd_reserve_req); 6726 free_page((unsigned long)rawpadpage); 6727 } 6728 6729 module_init(dasd_eckd_init); 6730 module_exit(dasd_eckd_cleanup); 6731