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