1 /* 2 * Author(s)......: Holger Smolinski <Holger.Smolinski@de.ibm.com> 3 * Horst Hummel <Horst.Hummel@de.ibm.com> 4 * Carsten Otte <Cotte@de.ibm.com> 5 * Martin Schwidefsky <schwidefsky@de.ibm.com> 6 * Bugreports.to..: <Linux390@de.ibm.com> 7 * Copyright IBM Corp. 1999, 2009 8 * EMC Symmetrix ioctl Copyright EMC Corporation, 2008 9 * Author.........: Nigel Hislop <hislop_nigel@emc.com> 10 */ 11 12 #define KMSG_COMPONENT "dasd-eckd" 13 14 #include <linux/stddef.h> 15 #include <linux/kernel.h> 16 #include <linux/slab.h> 17 #include <linux/hdreg.h> /* HDIO_GETGEO */ 18 #include <linux/bio.h> 19 #include <linux/module.h> 20 #include <linux/compat.h> 21 #include <linux/init.h> 22 23 #include <asm/css_chars.h> 24 #include <asm/debug.h> 25 #include <asm/idals.h> 26 #include <asm/ebcdic.h> 27 #include <asm/io.h> 28 #include <asm/uaccess.h> 29 #include <asm/cio.h> 30 #include <asm/ccwdev.h> 31 #include <asm/itcw.h> 32 33 #include "dasd_int.h" 34 #include "dasd_eckd.h" 35 36 #ifdef PRINTK_HEADER 37 #undef PRINTK_HEADER 38 #endif /* PRINTK_HEADER */ 39 #define PRINTK_HEADER "dasd(eckd):" 40 41 #define ECKD_C0(i) (i->home_bytes) 42 #define ECKD_F(i) (i->formula) 43 #define ECKD_F1(i) (ECKD_F(i)==0x01?(i->factors.f_0x01.f1):\ 44 (i->factors.f_0x02.f1)) 45 #define ECKD_F2(i) (ECKD_F(i)==0x01?(i->factors.f_0x01.f2):\ 46 (i->factors.f_0x02.f2)) 47 #define ECKD_F3(i) (ECKD_F(i)==0x01?(i->factors.f_0x01.f3):\ 48 (i->factors.f_0x02.f3)) 49 #define ECKD_F4(i) (ECKD_F(i)==0x02?(i->factors.f_0x02.f4):0) 50 #define ECKD_F5(i) (ECKD_F(i)==0x02?(i->factors.f_0x02.f5):0) 51 #define ECKD_F6(i) (i->factor6) 52 #define ECKD_F7(i) (i->factor7) 53 #define ECKD_F8(i) (i->factor8) 54 55 /* 56 * raw track access always map to 64k in memory 57 * so it maps to 16 blocks of 4k per track 58 */ 59 #define DASD_RAW_BLOCK_PER_TRACK 16 60 #define DASD_RAW_BLOCKSIZE 4096 61 /* 64k are 128 x 512 byte sectors */ 62 #define DASD_RAW_SECTORS_PER_TRACK 128 63 64 MODULE_LICENSE("GPL"); 65 66 static struct dasd_discipline dasd_eckd_discipline; 67 68 /* The ccw bus type uses this table to find devices that it sends to 69 * dasd_eckd_probe */ 70 static struct ccw_device_id dasd_eckd_ids[] = { 71 { CCW_DEVICE_DEVTYPE (0x3990, 0, 0x3390, 0), .driver_info = 0x1}, 72 { CCW_DEVICE_DEVTYPE (0x2105, 0, 0x3390, 0), .driver_info = 0x2}, 73 { CCW_DEVICE_DEVTYPE (0x3880, 0, 0x3380, 0), .driver_info = 0x3}, 74 { CCW_DEVICE_DEVTYPE (0x3990, 0, 0x3380, 0), .driver_info = 0x4}, 75 { CCW_DEVICE_DEVTYPE (0x2105, 0, 0x3380, 0), .driver_info = 0x5}, 76 { CCW_DEVICE_DEVTYPE (0x9343, 0, 0x9345, 0), .driver_info = 0x6}, 77 { CCW_DEVICE_DEVTYPE (0x2107, 0, 0x3390, 0), .driver_info = 0x7}, 78 { CCW_DEVICE_DEVTYPE (0x2107, 0, 0x3380, 0), .driver_info = 0x8}, 79 { CCW_DEVICE_DEVTYPE (0x1750, 0, 0x3390, 0), .driver_info = 0x9}, 80 { CCW_DEVICE_DEVTYPE (0x1750, 0, 0x3380, 0), .driver_info = 0xa}, 81 { /* end of list */ }, 82 }; 83 84 MODULE_DEVICE_TABLE(ccw, dasd_eckd_ids); 85 86 static struct ccw_driver dasd_eckd_driver; /* see below */ 87 88 static void *rawpadpage; 89 90 #define INIT_CQR_OK 0 91 #define INIT_CQR_UNFORMATTED 1 92 #define INIT_CQR_ERROR 2 93 94 /* emergency request for reserve/release */ 95 static struct { 96 struct dasd_ccw_req cqr; 97 struct ccw1 ccw; 98 char data[32]; 99 } *dasd_reserve_req; 100 static DEFINE_MUTEX(dasd_reserve_mutex); 101 102 /* definitions for the path verification worker */ 103 struct path_verification_work_data { 104 struct work_struct worker; 105 struct dasd_device *device; 106 struct dasd_ccw_req cqr; 107 struct ccw1 ccw; 108 __u8 rcd_buffer[DASD_ECKD_RCD_DATA_SIZE]; 109 int isglobal; 110 __u8 tbvpm; 111 }; 112 static struct path_verification_work_data *path_verification_worker; 113 static DEFINE_MUTEX(dasd_path_verification_mutex); 114 115 /* initial attempt at a probe function. this can be simplified once 116 * the other detection code is gone */ 117 static int 118 dasd_eckd_probe (struct ccw_device *cdev) 119 { 120 int ret; 121 122 /* set ECKD specific ccw-device options */ 123 ret = ccw_device_set_options(cdev, CCWDEV_ALLOW_FORCE | 124 CCWDEV_DO_PATHGROUP | CCWDEV_DO_MULTIPATH); 125 if (ret) { 126 DBF_EVENT_DEVID(DBF_WARNING, cdev, "%s", 127 "dasd_eckd_probe: could not set " 128 "ccw-device options"); 129 return ret; 130 } 131 ret = dasd_generic_probe(cdev, &dasd_eckd_discipline); 132 return ret; 133 } 134 135 static int 136 dasd_eckd_set_online(struct ccw_device *cdev) 137 { 138 return dasd_generic_set_online(cdev, &dasd_eckd_discipline); 139 } 140 141 static const int sizes_trk0[] = { 28, 148, 84 }; 142 #define LABEL_SIZE 140 143 144 /* head and record addresses of count_area read in analysis ccw */ 145 static const int count_area_head[] = { 0, 0, 0, 0, 2 }; 146 static const int count_area_rec[] = { 1, 2, 3, 4, 1 }; 147 148 static inline unsigned int 149 round_up_multiple(unsigned int no, unsigned int mult) 150 { 151 int rem = no % mult; 152 return (rem ? no - rem + mult : no); 153 } 154 155 static inline unsigned int 156 ceil_quot(unsigned int d1, unsigned int d2) 157 { 158 return (d1 + (d2 - 1)) / d2; 159 } 160 161 static unsigned int 162 recs_per_track(struct dasd_eckd_characteristics * rdc, 163 unsigned int kl, unsigned int dl) 164 { 165 int dn, kn; 166 167 switch (rdc->dev_type) { 168 case 0x3380: 169 if (kl) 170 return 1499 / (15 + 7 + ceil_quot(kl + 12, 32) + 171 ceil_quot(dl + 12, 32)); 172 else 173 return 1499 / (15 + ceil_quot(dl + 12, 32)); 174 case 0x3390: 175 dn = ceil_quot(dl + 6, 232) + 1; 176 if (kl) { 177 kn = ceil_quot(kl + 6, 232) + 1; 178 return 1729 / (10 + 9 + ceil_quot(kl + 6 * kn, 34) + 179 9 + ceil_quot(dl + 6 * dn, 34)); 180 } else 181 return 1729 / (10 + 9 + ceil_quot(dl + 6 * dn, 34)); 182 case 0x9345: 183 dn = ceil_quot(dl + 6, 232) + 1; 184 if (kl) { 185 kn = ceil_quot(kl + 6, 232) + 1; 186 return 1420 / (18 + 7 + ceil_quot(kl + 6 * kn, 34) + 187 ceil_quot(dl + 6 * dn, 34)); 188 } else 189 return 1420 / (18 + 7 + ceil_quot(dl + 6 * dn, 34)); 190 } 191 return 0; 192 } 193 194 static void set_ch_t(struct ch_t *geo, __u32 cyl, __u8 head) 195 { 196 geo->cyl = (__u16) cyl; 197 geo->head = cyl >> 16; 198 geo->head <<= 4; 199 geo->head |= head; 200 } 201 202 static int 203 check_XRC (struct ccw1 *de_ccw, 204 struct DE_eckd_data *data, 205 struct dasd_device *device) 206 { 207 struct dasd_eckd_private *private; 208 int rc; 209 210 private = (struct dasd_eckd_private *) device->private; 211 if (!private->rdc_data.facilities.XRC_supported) 212 return 0; 213 214 /* switch on System Time Stamp - needed for XRC Support */ 215 data->ga_extended |= 0x08; /* switch on 'Time Stamp Valid' */ 216 data->ga_extended |= 0x02; /* switch on 'Extended Parameter' */ 217 218 rc = get_sync_clock(&data->ep_sys_time); 219 /* Ignore return code if sync clock is switched off. */ 220 if (rc == -EOPNOTSUPP || rc == -EACCES) 221 rc = 0; 222 223 de_ccw->count = sizeof(struct DE_eckd_data); 224 de_ccw->flags |= CCW_FLAG_SLI; 225 return rc; 226 } 227 228 static int 229 define_extent(struct ccw1 *ccw, struct DE_eckd_data *data, unsigned int trk, 230 unsigned int totrk, int cmd, struct dasd_device *device) 231 { 232 struct dasd_eckd_private *private; 233 u32 begcyl, endcyl; 234 u16 heads, beghead, endhead; 235 int rc = 0; 236 237 private = (struct dasd_eckd_private *) device->private; 238 239 ccw->cmd_code = DASD_ECKD_CCW_DEFINE_EXTENT; 240 ccw->flags = 0; 241 ccw->count = 16; 242 ccw->cda = (__u32) __pa(data); 243 244 memset(data, 0, sizeof(struct DE_eckd_data)); 245 switch (cmd) { 246 case DASD_ECKD_CCW_READ_HOME_ADDRESS: 247 case DASD_ECKD_CCW_READ_RECORD_ZERO: 248 case DASD_ECKD_CCW_READ: 249 case DASD_ECKD_CCW_READ_MT: 250 case DASD_ECKD_CCW_READ_CKD: 251 case DASD_ECKD_CCW_READ_CKD_MT: 252 case DASD_ECKD_CCW_READ_KD: 253 case DASD_ECKD_CCW_READ_KD_MT: 254 case DASD_ECKD_CCW_READ_COUNT: 255 data->mask.perm = 0x1; 256 data->attributes.operation = private->attrib.operation; 257 break; 258 case DASD_ECKD_CCW_WRITE: 259 case DASD_ECKD_CCW_WRITE_MT: 260 case DASD_ECKD_CCW_WRITE_KD: 261 case DASD_ECKD_CCW_WRITE_KD_MT: 262 data->mask.perm = 0x02; 263 data->attributes.operation = private->attrib.operation; 264 rc = check_XRC (ccw, data, device); 265 break; 266 case DASD_ECKD_CCW_WRITE_CKD: 267 case DASD_ECKD_CCW_WRITE_CKD_MT: 268 data->attributes.operation = DASD_BYPASS_CACHE; 269 rc = check_XRC (ccw, data, device); 270 break; 271 case DASD_ECKD_CCW_ERASE: 272 case DASD_ECKD_CCW_WRITE_HOME_ADDRESS: 273 case DASD_ECKD_CCW_WRITE_RECORD_ZERO: 274 data->mask.perm = 0x3; 275 data->mask.auth = 0x1; 276 data->attributes.operation = DASD_BYPASS_CACHE; 277 rc = check_XRC (ccw, data, device); 278 break; 279 default: 280 dev_err(&device->cdev->dev, 281 "0x%x is not a known command\n", cmd); 282 break; 283 } 284 285 data->attributes.mode = 0x3; /* ECKD */ 286 287 if ((private->rdc_data.cu_type == 0x2105 || 288 private->rdc_data.cu_type == 0x2107 || 289 private->rdc_data.cu_type == 0x1750) 290 && !(private->uses_cdl && trk < 2)) 291 data->ga_extended |= 0x40; /* Regular Data Format Mode */ 292 293 heads = private->rdc_data.trk_per_cyl; 294 begcyl = trk / heads; 295 beghead = trk % heads; 296 endcyl = totrk / heads; 297 endhead = totrk % heads; 298 299 /* check for sequential prestage - enhance cylinder range */ 300 if (data->attributes.operation == DASD_SEQ_PRESTAGE || 301 data->attributes.operation == DASD_SEQ_ACCESS) { 302 303 if (endcyl + private->attrib.nr_cyl < private->real_cyl) 304 endcyl += private->attrib.nr_cyl; 305 else 306 endcyl = (private->real_cyl - 1); 307 } 308 309 set_ch_t(&data->beg_ext, begcyl, beghead); 310 set_ch_t(&data->end_ext, endcyl, endhead); 311 return rc; 312 } 313 314 static int check_XRC_on_prefix(struct PFX_eckd_data *pfxdata, 315 struct dasd_device *device) 316 { 317 struct dasd_eckd_private *private; 318 int rc; 319 320 private = (struct dasd_eckd_private *) device->private; 321 if (!private->rdc_data.facilities.XRC_supported) 322 return 0; 323 324 /* switch on System Time Stamp - needed for XRC Support */ 325 pfxdata->define_extent.ga_extended |= 0x08; /* 'Time Stamp Valid' */ 326 pfxdata->define_extent.ga_extended |= 0x02; /* 'Extended Parameter' */ 327 pfxdata->validity.time_stamp = 1; /* 'Time Stamp Valid' */ 328 329 rc = get_sync_clock(&pfxdata->define_extent.ep_sys_time); 330 /* Ignore return code if sync clock is switched off. */ 331 if (rc == -EOPNOTSUPP || rc == -EACCES) 332 rc = 0; 333 return rc; 334 } 335 336 static void fill_LRE_data(struct LRE_eckd_data *data, unsigned int trk, 337 unsigned int rec_on_trk, int count, int cmd, 338 struct dasd_device *device, unsigned int reclen, 339 unsigned int tlf) 340 { 341 struct dasd_eckd_private *private; 342 int sector; 343 int dn, d; 344 345 private = (struct dasd_eckd_private *) device->private; 346 347 memset(data, 0, sizeof(*data)); 348 sector = 0; 349 if (rec_on_trk) { 350 switch (private->rdc_data.dev_type) { 351 case 0x3390: 352 dn = ceil_quot(reclen + 6, 232); 353 d = 9 + ceil_quot(reclen + 6 * (dn + 1), 34); 354 sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8; 355 break; 356 case 0x3380: 357 d = 7 + ceil_quot(reclen + 12, 32); 358 sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7; 359 break; 360 } 361 } 362 data->sector = sector; 363 /* note: meaning of count depends on the operation 364 * for record based I/O it's the number of records, but for 365 * track based I/O it's the number of tracks 366 */ 367 data->count = count; 368 switch (cmd) { 369 case DASD_ECKD_CCW_WRITE_HOME_ADDRESS: 370 data->operation.orientation = 0x3; 371 data->operation.operation = 0x03; 372 break; 373 case DASD_ECKD_CCW_READ_HOME_ADDRESS: 374 data->operation.orientation = 0x3; 375 data->operation.operation = 0x16; 376 break; 377 case DASD_ECKD_CCW_WRITE_RECORD_ZERO: 378 data->operation.orientation = 0x1; 379 data->operation.operation = 0x03; 380 data->count++; 381 break; 382 case DASD_ECKD_CCW_READ_RECORD_ZERO: 383 data->operation.orientation = 0x3; 384 data->operation.operation = 0x16; 385 data->count++; 386 break; 387 case DASD_ECKD_CCW_WRITE: 388 case DASD_ECKD_CCW_WRITE_MT: 389 case DASD_ECKD_CCW_WRITE_KD: 390 case DASD_ECKD_CCW_WRITE_KD_MT: 391 data->auxiliary.length_valid = 0x1; 392 data->length = reclen; 393 data->operation.operation = 0x01; 394 break; 395 case DASD_ECKD_CCW_WRITE_CKD: 396 case DASD_ECKD_CCW_WRITE_CKD_MT: 397 data->auxiliary.length_valid = 0x1; 398 data->length = reclen; 399 data->operation.operation = 0x03; 400 break; 401 case DASD_ECKD_CCW_WRITE_FULL_TRACK: 402 data->operation.orientation = 0x0; 403 data->operation.operation = 0x3F; 404 data->extended_operation = 0x11; 405 data->length = 0; 406 data->extended_parameter_length = 0x02; 407 if (data->count > 8) { 408 data->extended_parameter[0] = 0xFF; 409 data->extended_parameter[1] = 0xFF; 410 data->extended_parameter[1] <<= (16 - count); 411 } else { 412 data->extended_parameter[0] = 0xFF; 413 data->extended_parameter[0] <<= (8 - count); 414 data->extended_parameter[1] = 0x00; 415 } 416 data->sector = 0xFF; 417 break; 418 case DASD_ECKD_CCW_WRITE_TRACK_DATA: 419 data->auxiliary.length_valid = 0x1; 420 data->length = reclen; /* not tlf, as one might think */ 421 data->operation.operation = 0x3F; 422 data->extended_operation = 0x23; 423 break; 424 case DASD_ECKD_CCW_READ: 425 case DASD_ECKD_CCW_READ_MT: 426 case DASD_ECKD_CCW_READ_KD: 427 case DASD_ECKD_CCW_READ_KD_MT: 428 data->auxiliary.length_valid = 0x1; 429 data->length = reclen; 430 data->operation.operation = 0x06; 431 break; 432 case DASD_ECKD_CCW_READ_CKD: 433 case DASD_ECKD_CCW_READ_CKD_MT: 434 data->auxiliary.length_valid = 0x1; 435 data->length = reclen; 436 data->operation.operation = 0x16; 437 break; 438 case DASD_ECKD_CCW_READ_COUNT: 439 data->operation.operation = 0x06; 440 break; 441 case DASD_ECKD_CCW_READ_TRACK: 442 data->operation.orientation = 0x1; 443 data->operation.operation = 0x0C; 444 data->extended_parameter_length = 0; 445 data->sector = 0xFF; 446 break; 447 case DASD_ECKD_CCW_READ_TRACK_DATA: 448 data->auxiliary.length_valid = 0x1; 449 data->length = tlf; 450 data->operation.operation = 0x0C; 451 break; 452 case DASD_ECKD_CCW_ERASE: 453 data->length = reclen; 454 data->auxiliary.length_valid = 0x1; 455 data->operation.operation = 0x0b; 456 break; 457 default: 458 DBF_DEV_EVENT(DBF_ERR, device, 459 "fill LRE unknown opcode 0x%x", cmd); 460 BUG(); 461 } 462 set_ch_t(&data->seek_addr, 463 trk / private->rdc_data.trk_per_cyl, 464 trk % private->rdc_data.trk_per_cyl); 465 data->search_arg.cyl = data->seek_addr.cyl; 466 data->search_arg.head = data->seek_addr.head; 467 data->search_arg.record = rec_on_trk; 468 } 469 470 static int prefix_LRE(struct ccw1 *ccw, struct PFX_eckd_data *pfxdata, 471 unsigned int trk, unsigned int totrk, int cmd, 472 struct dasd_device *basedev, struct dasd_device *startdev, 473 unsigned char format, unsigned int rec_on_trk, int count, 474 unsigned int blksize, unsigned int tlf) 475 { 476 struct dasd_eckd_private *basepriv, *startpriv; 477 struct DE_eckd_data *dedata; 478 struct LRE_eckd_data *lredata; 479 u32 begcyl, endcyl; 480 u16 heads, beghead, endhead; 481 int rc = 0; 482 483 basepriv = (struct dasd_eckd_private *) basedev->private; 484 startpriv = (struct dasd_eckd_private *) startdev->private; 485 dedata = &pfxdata->define_extent; 486 lredata = &pfxdata->locate_record; 487 488 ccw->cmd_code = DASD_ECKD_CCW_PFX; 489 ccw->flags = 0; 490 if (cmd == DASD_ECKD_CCW_WRITE_FULL_TRACK) { 491 ccw->count = sizeof(*pfxdata) + 2; 492 ccw->cda = (__u32) __pa(pfxdata); 493 memset(pfxdata, 0, sizeof(*pfxdata) + 2); 494 } else { 495 ccw->count = sizeof(*pfxdata); 496 ccw->cda = (__u32) __pa(pfxdata); 497 memset(pfxdata, 0, sizeof(*pfxdata)); 498 } 499 500 /* prefix data */ 501 if (format > 1) { 502 DBF_DEV_EVENT(DBF_ERR, basedev, 503 "PFX LRE unknown format 0x%x", format); 504 BUG(); 505 return -EINVAL; 506 } 507 pfxdata->format = format; 508 pfxdata->base_address = basepriv->ned->unit_addr; 509 pfxdata->base_lss = basepriv->ned->ID; 510 pfxdata->validity.define_extent = 1; 511 512 /* private uid is kept up to date, conf_data may be outdated */ 513 if (startpriv->uid.type != UA_BASE_DEVICE) { 514 pfxdata->validity.verify_base = 1; 515 if (startpriv->uid.type == UA_HYPER_PAV_ALIAS) 516 pfxdata->validity.hyper_pav = 1; 517 } 518 519 /* define extend data (mostly)*/ 520 switch (cmd) { 521 case DASD_ECKD_CCW_READ_HOME_ADDRESS: 522 case DASD_ECKD_CCW_READ_RECORD_ZERO: 523 case DASD_ECKD_CCW_READ: 524 case DASD_ECKD_CCW_READ_MT: 525 case DASD_ECKD_CCW_READ_CKD: 526 case DASD_ECKD_CCW_READ_CKD_MT: 527 case DASD_ECKD_CCW_READ_KD: 528 case DASD_ECKD_CCW_READ_KD_MT: 529 case DASD_ECKD_CCW_READ_COUNT: 530 dedata->mask.perm = 0x1; 531 dedata->attributes.operation = basepriv->attrib.operation; 532 break; 533 case DASD_ECKD_CCW_READ_TRACK: 534 case DASD_ECKD_CCW_READ_TRACK_DATA: 535 dedata->mask.perm = 0x1; 536 dedata->attributes.operation = basepriv->attrib.operation; 537 dedata->blk_size = 0; 538 break; 539 case DASD_ECKD_CCW_WRITE: 540 case DASD_ECKD_CCW_WRITE_MT: 541 case DASD_ECKD_CCW_WRITE_KD: 542 case DASD_ECKD_CCW_WRITE_KD_MT: 543 dedata->mask.perm = 0x02; 544 dedata->attributes.operation = basepriv->attrib.operation; 545 rc = check_XRC_on_prefix(pfxdata, basedev); 546 break; 547 case DASD_ECKD_CCW_WRITE_CKD: 548 case DASD_ECKD_CCW_WRITE_CKD_MT: 549 dedata->attributes.operation = DASD_BYPASS_CACHE; 550 rc = check_XRC_on_prefix(pfxdata, basedev); 551 break; 552 case DASD_ECKD_CCW_ERASE: 553 case DASD_ECKD_CCW_WRITE_HOME_ADDRESS: 554 case DASD_ECKD_CCW_WRITE_RECORD_ZERO: 555 dedata->mask.perm = 0x3; 556 dedata->mask.auth = 0x1; 557 dedata->attributes.operation = DASD_BYPASS_CACHE; 558 rc = check_XRC_on_prefix(pfxdata, basedev); 559 break; 560 case DASD_ECKD_CCW_WRITE_FULL_TRACK: 561 dedata->mask.perm = 0x03; 562 dedata->attributes.operation = basepriv->attrib.operation; 563 dedata->blk_size = 0; 564 break; 565 case DASD_ECKD_CCW_WRITE_TRACK_DATA: 566 dedata->mask.perm = 0x02; 567 dedata->attributes.operation = basepriv->attrib.operation; 568 dedata->blk_size = blksize; 569 rc = check_XRC_on_prefix(pfxdata, basedev); 570 break; 571 default: 572 DBF_DEV_EVENT(DBF_ERR, basedev, 573 "PFX LRE unknown opcode 0x%x", cmd); 574 BUG(); 575 return -EINVAL; 576 } 577 578 dedata->attributes.mode = 0x3; /* ECKD */ 579 580 if ((basepriv->rdc_data.cu_type == 0x2105 || 581 basepriv->rdc_data.cu_type == 0x2107 || 582 basepriv->rdc_data.cu_type == 0x1750) 583 && !(basepriv->uses_cdl && trk < 2)) 584 dedata->ga_extended |= 0x40; /* Regular Data Format Mode */ 585 586 heads = basepriv->rdc_data.trk_per_cyl; 587 begcyl = trk / heads; 588 beghead = trk % heads; 589 endcyl = totrk / heads; 590 endhead = totrk % heads; 591 592 /* check for sequential prestage - enhance cylinder range */ 593 if (dedata->attributes.operation == DASD_SEQ_PRESTAGE || 594 dedata->attributes.operation == DASD_SEQ_ACCESS) { 595 596 if (endcyl + basepriv->attrib.nr_cyl < basepriv->real_cyl) 597 endcyl += basepriv->attrib.nr_cyl; 598 else 599 endcyl = (basepriv->real_cyl - 1); 600 } 601 602 set_ch_t(&dedata->beg_ext, begcyl, beghead); 603 set_ch_t(&dedata->end_ext, endcyl, endhead); 604 605 if (format == 1) { 606 fill_LRE_data(lredata, trk, rec_on_trk, count, cmd, 607 basedev, blksize, tlf); 608 } 609 610 return rc; 611 } 612 613 static int prefix(struct ccw1 *ccw, struct PFX_eckd_data *pfxdata, 614 unsigned int trk, unsigned int totrk, int cmd, 615 struct dasd_device *basedev, struct dasd_device *startdev) 616 { 617 return prefix_LRE(ccw, pfxdata, trk, totrk, cmd, basedev, startdev, 618 0, 0, 0, 0, 0); 619 } 620 621 static void 622 locate_record(struct ccw1 *ccw, struct LO_eckd_data *data, unsigned int trk, 623 unsigned int rec_on_trk, int no_rec, int cmd, 624 struct dasd_device * device, int reclen) 625 { 626 struct dasd_eckd_private *private; 627 int sector; 628 int dn, d; 629 630 private = (struct dasd_eckd_private *) device->private; 631 632 DBF_DEV_EVENT(DBF_INFO, device, 633 "Locate: trk %d, rec %d, no_rec %d, cmd %d, reclen %d", 634 trk, rec_on_trk, no_rec, cmd, reclen); 635 636 ccw->cmd_code = DASD_ECKD_CCW_LOCATE_RECORD; 637 ccw->flags = 0; 638 ccw->count = 16; 639 ccw->cda = (__u32) __pa(data); 640 641 memset(data, 0, sizeof(struct LO_eckd_data)); 642 sector = 0; 643 if (rec_on_trk) { 644 switch (private->rdc_data.dev_type) { 645 case 0x3390: 646 dn = ceil_quot(reclen + 6, 232); 647 d = 9 + ceil_quot(reclen + 6 * (dn + 1), 34); 648 sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8; 649 break; 650 case 0x3380: 651 d = 7 + ceil_quot(reclen + 12, 32); 652 sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7; 653 break; 654 } 655 } 656 data->sector = sector; 657 data->count = no_rec; 658 switch (cmd) { 659 case DASD_ECKD_CCW_WRITE_HOME_ADDRESS: 660 data->operation.orientation = 0x3; 661 data->operation.operation = 0x03; 662 break; 663 case DASD_ECKD_CCW_READ_HOME_ADDRESS: 664 data->operation.orientation = 0x3; 665 data->operation.operation = 0x16; 666 break; 667 case DASD_ECKD_CCW_WRITE_RECORD_ZERO: 668 data->operation.orientation = 0x1; 669 data->operation.operation = 0x03; 670 data->count++; 671 break; 672 case DASD_ECKD_CCW_READ_RECORD_ZERO: 673 data->operation.orientation = 0x3; 674 data->operation.operation = 0x16; 675 data->count++; 676 break; 677 case DASD_ECKD_CCW_WRITE: 678 case DASD_ECKD_CCW_WRITE_MT: 679 case DASD_ECKD_CCW_WRITE_KD: 680 case DASD_ECKD_CCW_WRITE_KD_MT: 681 data->auxiliary.last_bytes_used = 0x1; 682 data->length = reclen; 683 data->operation.operation = 0x01; 684 break; 685 case DASD_ECKD_CCW_WRITE_CKD: 686 case DASD_ECKD_CCW_WRITE_CKD_MT: 687 data->auxiliary.last_bytes_used = 0x1; 688 data->length = reclen; 689 data->operation.operation = 0x03; 690 break; 691 case DASD_ECKD_CCW_READ: 692 case DASD_ECKD_CCW_READ_MT: 693 case DASD_ECKD_CCW_READ_KD: 694 case DASD_ECKD_CCW_READ_KD_MT: 695 data->auxiliary.last_bytes_used = 0x1; 696 data->length = reclen; 697 data->operation.operation = 0x06; 698 break; 699 case DASD_ECKD_CCW_READ_CKD: 700 case DASD_ECKD_CCW_READ_CKD_MT: 701 data->auxiliary.last_bytes_used = 0x1; 702 data->length = reclen; 703 data->operation.operation = 0x16; 704 break; 705 case DASD_ECKD_CCW_READ_COUNT: 706 data->operation.operation = 0x06; 707 break; 708 case DASD_ECKD_CCW_ERASE: 709 data->length = reclen; 710 data->auxiliary.last_bytes_used = 0x1; 711 data->operation.operation = 0x0b; 712 break; 713 default: 714 DBF_DEV_EVENT(DBF_ERR, device, "unknown locate record " 715 "opcode 0x%x", cmd); 716 } 717 set_ch_t(&data->seek_addr, 718 trk / private->rdc_data.trk_per_cyl, 719 trk % private->rdc_data.trk_per_cyl); 720 data->search_arg.cyl = data->seek_addr.cyl; 721 data->search_arg.head = data->seek_addr.head; 722 data->search_arg.record = rec_on_trk; 723 } 724 725 /* 726 * Returns 1 if the block is one of the special blocks that needs 727 * to get read/written with the KD variant of the command. 728 * That is DASD_ECKD_READ_KD_MT instead of DASD_ECKD_READ_MT and 729 * DASD_ECKD_WRITE_KD_MT instead of DASD_ECKD_WRITE_MT. 730 * Luckily the KD variants differ only by one bit (0x08) from the 731 * normal variant. So don't wonder about code like: 732 * if (dasd_eckd_cdl_special(blk_per_trk, recid)) 733 * ccw->cmd_code |= 0x8; 734 */ 735 static inline int 736 dasd_eckd_cdl_special(int blk_per_trk, int recid) 737 { 738 if (recid < 3) 739 return 1; 740 if (recid < blk_per_trk) 741 return 0; 742 if (recid < 2 * blk_per_trk) 743 return 1; 744 return 0; 745 } 746 747 /* 748 * Returns the record size for the special blocks of the cdl format. 749 * Only returns something useful if dasd_eckd_cdl_special is true 750 * for the recid. 751 */ 752 static inline int 753 dasd_eckd_cdl_reclen(int recid) 754 { 755 if (recid < 3) 756 return sizes_trk0[recid]; 757 return LABEL_SIZE; 758 } 759 /* create unique id from private structure. */ 760 static void create_uid(struct dasd_eckd_private *private) 761 { 762 int count; 763 struct dasd_uid *uid; 764 765 uid = &private->uid; 766 memset(uid, 0, sizeof(struct dasd_uid)); 767 memcpy(uid->vendor, private->ned->HDA_manufacturer, 768 sizeof(uid->vendor) - 1); 769 EBCASC(uid->vendor, sizeof(uid->vendor) - 1); 770 memcpy(uid->serial, private->ned->HDA_location, 771 sizeof(uid->serial) - 1); 772 EBCASC(uid->serial, sizeof(uid->serial) - 1); 773 uid->ssid = private->gneq->subsystemID; 774 uid->real_unit_addr = private->ned->unit_addr; 775 if (private->sneq) { 776 uid->type = private->sneq->sua_flags; 777 if (uid->type == UA_BASE_PAV_ALIAS) 778 uid->base_unit_addr = private->sneq->base_unit_addr; 779 } else { 780 uid->type = UA_BASE_DEVICE; 781 } 782 if (private->vdsneq) { 783 for (count = 0; count < 16; count++) { 784 sprintf(uid->vduit+2*count, "%02x", 785 private->vdsneq->uit[count]); 786 } 787 } 788 } 789 790 /* 791 * Generate device unique id that specifies the physical device. 792 */ 793 static int dasd_eckd_generate_uid(struct dasd_device *device) 794 { 795 struct dasd_eckd_private *private; 796 unsigned long flags; 797 798 private = (struct dasd_eckd_private *) device->private; 799 if (!private) 800 return -ENODEV; 801 if (!private->ned || !private->gneq) 802 return -ENODEV; 803 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 804 create_uid(private); 805 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 806 return 0; 807 } 808 809 static int dasd_eckd_get_uid(struct dasd_device *device, struct dasd_uid *uid) 810 { 811 struct dasd_eckd_private *private; 812 unsigned long flags; 813 814 if (device->private) { 815 private = (struct dasd_eckd_private *)device->private; 816 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 817 *uid = private->uid; 818 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 819 return 0; 820 } 821 return -EINVAL; 822 } 823 824 /* 825 * compare device UID with data of a given dasd_eckd_private structure 826 * return 0 for match 827 */ 828 static int dasd_eckd_compare_path_uid(struct dasd_device *device, 829 struct dasd_eckd_private *private) 830 { 831 struct dasd_uid device_uid; 832 833 create_uid(private); 834 dasd_eckd_get_uid(device, &device_uid); 835 836 return memcmp(&device_uid, &private->uid, sizeof(struct dasd_uid)); 837 } 838 839 static void dasd_eckd_fill_rcd_cqr(struct dasd_device *device, 840 struct dasd_ccw_req *cqr, 841 __u8 *rcd_buffer, 842 __u8 lpm) 843 { 844 struct ccw1 *ccw; 845 /* 846 * buffer has to start with EBCDIC "V1.0" to show 847 * support for virtual device SNEQ 848 */ 849 rcd_buffer[0] = 0xE5; 850 rcd_buffer[1] = 0xF1; 851 rcd_buffer[2] = 0x4B; 852 rcd_buffer[3] = 0xF0; 853 854 ccw = cqr->cpaddr; 855 ccw->cmd_code = DASD_ECKD_CCW_RCD; 856 ccw->flags = 0; 857 ccw->cda = (__u32)(addr_t)rcd_buffer; 858 ccw->count = DASD_ECKD_RCD_DATA_SIZE; 859 cqr->magic = DASD_ECKD_MAGIC; 860 861 cqr->startdev = device; 862 cqr->memdev = device; 863 cqr->block = NULL; 864 cqr->expires = 10*HZ; 865 cqr->lpm = lpm; 866 cqr->retries = 256; 867 cqr->buildclk = get_tod_clock(); 868 cqr->status = DASD_CQR_FILLED; 869 set_bit(DASD_CQR_VERIFY_PATH, &cqr->flags); 870 } 871 872 /* 873 * Wakeup helper for read_conf 874 * if the cqr is not done and needs some error recovery 875 * the buffer has to be re-initialized with the EBCDIC "V1.0" 876 * to show support for virtual device SNEQ 877 */ 878 static void read_conf_cb(struct dasd_ccw_req *cqr, void *data) 879 { 880 struct ccw1 *ccw; 881 __u8 *rcd_buffer; 882 883 if (cqr->status != DASD_CQR_DONE) { 884 ccw = cqr->cpaddr; 885 rcd_buffer = (__u8 *)((addr_t) ccw->cda); 886 memset(rcd_buffer, 0, sizeof(*rcd_buffer)); 887 888 rcd_buffer[0] = 0xE5; 889 rcd_buffer[1] = 0xF1; 890 rcd_buffer[2] = 0x4B; 891 rcd_buffer[3] = 0xF0; 892 } 893 dasd_wakeup_cb(cqr, data); 894 } 895 896 static int dasd_eckd_read_conf_immediately(struct dasd_device *device, 897 struct dasd_ccw_req *cqr, 898 __u8 *rcd_buffer, 899 __u8 lpm) 900 { 901 struct ciw *ciw; 902 int rc; 903 /* 904 * sanity check: scan for RCD command in extended SenseID data 905 * some devices do not support RCD 906 */ 907 ciw = ccw_device_get_ciw(device->cdev, CIW_TYPE_RCD); 908 if (!ciw || ciw->cmd != DASD_ECKD_CCW_RCD) 909 return -EOPNOTSUPP; 910 911 dasd_eckd_fill_rcd_cqr(device, cqr, rcd_buffer, lpm); 912 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 913 set_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags); 914 cqr->retries = 5; 915 cqr->callback = read_conf_cb; 916 rc = dasd_sleep_on_immediatly(cqr); 917 return rc; 918 } 919 920 static int dasd_eckd_read_conf_lpm(struct dasd_device *device, 921 void **rcd_buffer, 922 int *rcd_buffer_size, __u8 lpm) 923 { 924 struct ciw *ciw; 925 char *rcd_buf = NULL; 926 int ret; 927 struct dasd_ccw_req *cqr; 928 929 /* 930 * sanity check: scan for RCD command in extended SenseID data 931 * some devices do not support RCD 932 */ 933 ciw = ccw_device_get_ciw(device->cdev, CIW_TYPE_RCD); 934 if (!ciw || ciw->cmd != DASD_ECKD_CCW_RCD) { 935 ret = -EOPNOTSUPP; 936 goto out_error; 937 } 938 rcd_buf = kzalloc(DASD_ECKD_RCD_DATA_SIZE, GFP_KERNEL | GFP_DMA); 939 if (!rcd_buf) { 940 ret = -ENOMEM; 941 goto out_error; 942 } 943 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* RCD */, 944 0, /* use rcd_buf as data ara */ 945 device); 946 if (IS_ERR(cqr)) { 947 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 948 "Could not allocate RCD request"); 949 ret = -ENOMEM; 950 goto out_error; 951 } 952 dasd_eckd_fill_rcd_cqr(device, cqr, rcd_buf, lpm); 953 cqr->callback = read_conf_cb; 954 ret = dasd_sleep_on(cqr); 955 /* 956 * on success we update the user input parms 957 */ 958 dasd_sfree_request(cqr, cqr->memdev); 959 if (ret) 960 goto out_error; 961 962 *rcd_buffer_size = DASD_ECKD_RCD_DATA_SIZE; 963 *rcd_buffer = rcd_buf; 964 return 0; 965 out_error: 966 kfree(rcd_buf); 967 *rcd_buffer = NULL; 968 *rcd_buffer_size = 0; 969 return ret; 970 } 971 972 static int dasd_eckd_identify_conf_parts(struct dasd_eckd_private *private) 973 { 974 975 struct dasd_sneq *sneq; 976 int i, count; 977 978 private->ned = NULL; 979 private->sneq = NULL; 980 private->vdsneq = NULL; 981 private->gneq = NULL; 982 count = private->conf_len / sizeof(struct dasd_sneq); 983 sneq = (struct dasd_sneq *)private->conf_data; 984 for (i = 0; i < count; ++i) { 985 if (sneq->flags.identifier == 1 && sneq->format == 1) 986 private->sneq = sneq; 987 else if (sneq->flags.identifier == 1 && sneq->format == 4) 988 private->vdsneq = (struct vd_sneq *)sneq; 989 else if (sneq->flags.identifier == 2) 990 private->gneq = (struct dasd_gneq *)sneq; 991 else if (sneq->flags.identifier == 3 && sneq->res1 == 1) 992 private->ned = (struct dasd_ned *)sneq; 993 sneq++; 994 } 995 if (!private->ned || !private->gneq) { 996 private->ned = NULL; 997 private->sneq = NULL; 998 private->vdsneq = NULL; 999 private->gneq = NULL; 1000 return -EINVAL; 1001 } 1002 return 0; 1003 1004 }; 1005 1006 static unsigned char dasd_eckd_path_access(void *conf_data, int conf_len) 1007 { 1008 struct dasd_gneq *gneq; 1009 int i, count, found; 1010 1011 count = conf_len / sizeof(*gneq); 1012 gneq = (struct dasd_gneq *)conf_data; 1013 found = 0; 1014 for (i = 0; i < count; ++i) { 1015 if (gneq->flags.identifier == 2) { 1016 found = 1; 1017 break; 1018 } 1019 gneq++; 1020 } 1021 if (found) 1022 return ((char *)gneq)[18] & 0x07; 1023 else 1024 return 0; 1025 } 1026 1027 static int dasd_eckd_read_conf(struct dasd_device *device) 1028 { 1029 void *conf_data; 1030 int conf_len, conf_data_saved; 1031 int rc, path_err; 1032 __u8 lpm, opm; 1033 struct dasd_eckd_private *private, path_private; 1034 struct dasd_path *path_data; 1035 struct dasd_uid *uid; 1036 char print_path_uid[60], print_device_uid[60]; 1037 1038 private = (struct dasd_eckd_private *) device->private; 1039 path_data = &device->path_data; 1040 opm = ccw_device_get_path_mask(device->cdev); 1041 conf_data_saved = 0; 1042 path_err = 0; 1043 /* get configuration data per operational path */ 1044 for (lpm = 0x80; lpm; lpm>>= 1) { 1045 if (!(lpm & opm)) 1046 continue; 1047 rc = dasd_eckd_read_conf_lpm(device, &conf_data, 1048 &conf_len, lpm); 1049 if (rc && rc != -EOPNOTSUPP) { /* -EOPNOTSUPP is ok */ 1050 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 1051 "Read configuration data returned " 1052 "error %d", rc); 1053 return rc; 1054 } 1055 if (conf_data == NULL) { 1056 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1057 "No configuration data " 1058 "retrieved"); 1059 /* no further analysis possible */ 1060 path_data->opm |= lpm; 1061 continue; /* no error */ 1062 } 1063 /* save first valid configuration data */ 1064 if (!conf_data_saved) { 1065 kfree(private->conf_data); 1066 private->conf_data = conf_data; 1067 private->conf_len = conf_len; 1068 if (dasd_eckd_identify_conf_parts(private)) { 1069 private->conf_data = NULL; 1070 private->conf_len = 0; 1071 kfree(conf_data); 1072 continue; 1073 } 1074 /* 1075 * build device UID that other path data 1076 * can be compared to it 1077 */ 1078 dasd_eckd_generate_uid(device); 1079 conf_data_saved++; 1080 } else { 1081 path_private.conf_data = conf_data; 1082 path_private.conf_len = DASD_ECKD_RCD_DATA_SIZE; 1083 if (dasd_eckd_identify_conf_parts( 1084 &path_private)) { 1085 path_private.conf_data = NULL; 1086 path_private.conf_len = 0; 1087 kfree(conf_data); 1088 continue; 1089 } 1090 1091 if (dasd_eckd_compare_path_uid( 1092 device, &path_private)) { 1093 uid = &path_private.uid; 1094 if (strlen(uid->vduit) > 0) 1095 snprintf(print_path_uid, 1096 sizeof(print_path_uid), 1097 "%s.%s.%04x.%02x.%s", 1098 uid->vendor, uid->serial, 1099 uid->ssid, uid->real_unit_addr, 1100 uid->vduit); 1101 else 1102 snprintf(print_path_uid, 1103 sizeof(print_path_uid), 1104 "%s.%s.%04x.%02x", 1105 uid->vendor, uid->serial, 1106 uid->ssid, 1107 uid->real_unit_addr); 1108 uid = &private->uid; 1109 if (strlen(uid->vduit) > 0) 1110 snprintf(print_device_uid, 1111 sizeof(print_device_uid), 1112 "%s.%s.%04x.%02x.%s", 1113 uid->vendor, uid->serial, 1114 uid->ssid, uid->real_unit_addr, 1115 uid->vduit); 1116 else 1117 snprintf(print_device_uid, 1118 sizeof(print_device_uid), 1119 "%s.%s.%04x.%02x", 1120 uid->vendor, uid->serial, 1121 uid->ssid, 1122 uid->real_unit_addr); 1123 dev_err(&device->cdev->dev, 1124 "Not all channel paths lead to " 1125 "the same device, path %02X leads to " 1126 "device %s instead of %s\n", lpm, 1127 print_path_uid, print_device_uid); 1128 path_err = -EINVAL; 1129 continue; 1130 } 1131 1132 path_private.conf_data = NULL; 1133 path_private.conf_len = 0; 1134 } 1135 switch (dasd_eckd_path_access(conf_data, conf_len)) { 1136 case 0x02: 1137 path_data->npm |= lpm; 1138 break; 1139 case 0x03: 1140 path_data->ppm |= lpm; 1141 break; 1142 } 1143 path_data->opm |= lpm; 1144 1145 if (conf_data != private->conf_data) 1146 kfree(conf_data); 1147 } 1148 1149 return path_err; 1150 } 1151 1152 static int verify_fcx_max_data(struct dasd_device *device, __u8 lpm) 1153 { 1154 struct dasd_eckd_private *private; 1155 int mdc; 1156 u32 fcx_max_data; 1157 1158 private = (struct dasd_eckd_private *) device->private; 1159 if (private->fcx_max_data) { 1160 mdc = ccw_device_get_mdc(device->cdev, lpm); 1161 if ((mdc < 0)) { 1162 dev_warn(&device->cdev->dev, 1163 "Detecting the maximum data size for zHPF " 1164 "requests failed (rc=%d) for a new path %x\n", 1165 mdc, lpm); 1166 return mdc; 1167 } 1168 fcx_max_data = mdc * FCX_MAX_DATA_FACTOR; 1169 if (fcx_max_data < private->fcx_max_data) { 1170 dev_warn(&device->cdev->dev, 1171 "The maximum data size for zHPF requests %u " 1172 "on a new path %x is below the active maximum " 1173 "%u\n", fcx_max_data, lpm, 1174 private->fcx_max_data); 1175 return -EACCES; 1176 } 1177 } 1178 return 0; 1179 } 1180 1181 static int rebuild_device_uid(struct dasd_device *device, 1182 struct path_verification_work_data *data) 1183 { 1184 struct dasd_eckd_private *private; 1185 struct dasd_path *path_data; 1186 __u8 lpm, opm; 1187 int rc; 1188 1189 rc = -ENODEV; 1190 private = (struct dasd_eckd_private *) device->private; 1191 path_data = &device->path_data; 1192 opm = device->path_data.opm; 1193 1194 for (lpm = 0x80; lpm; lpm >>= 1) { 1195 if (!(lpm & opm)) 1196 continue; 1197 memset(&data->rcd_buffer, 0, sizeof(data->rcd_buffer)); 1198 memset(&data->cqr, 0, sizeof(data->cqr)); 1199 data->cqr.cpaddr = &data->ccw; 1200 rc = dasd_eckd_read_conf_immediately(device, &data->cqr, 1201 data->rcd_buffer, 1202 lpm); 1203 1204 if (rc) { 1205 if (rc == -EOPNOTSUPP) /* -EOPNOTSUPP is ok */ 1206 continue; 1207 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 1208 "Read configuration data " 1209 "returned error %d", rc); 1210 break; 1211 } 1212 memcpy(private->conf_data, data->rcd_buffer, 1213 DASD_ECKD_RCD_DATA_SIZE); 1214 if (dasd_eckd_identify_conf_parts(private)) { 1215 rc = -ENODEV; 1216 } else /* first valid path is enough */ 1217 break; 1218 } 1219 1220 if (!rc) 1221 rc = dasd_eckd_generate_uid(device); 1222 1223 return rc; 1224 } 1225 1226 static void do_path_verification_work(struct work_struct *work) 1227 { 1228 struct path_verification_work_data *data; 1229 struct dasd_device *device; 1230 struct dasd_eckd_private path_private; 1231 struct dasd_uid *uid; 1232 __u8 path_rcd_buf[DASD_ECKD_RCD_DATA_SIZE]; 1233 __u8 lpm, opm, npm, ppm, epm; 1234 unsigned long flags; 1235 char print_uid[60]; 1236 int rc; 1237 1238 data = container_of(work, struct path_verification_work_data, worker); 1239 device = data->device; 1240 1241 /* delay path verification until device was resumed */ 1242 if (test_bit(DASD_FLAG_SUSPENDED, &device->flags)) { 1243 schedule_work(work); 1244 return; 1245 } 1246 1247 opm = 0; 1248 npm = 0; 1249 ppm = 0; 1250 epm = 0; 1251 for (lpm = 0x80; lpm; lpm >>= 1) { 1252 if (!(lpm & data->tbvpm)) 1253 continue; 1254 memset(&data->rcd_buffer, 0, sizeof(data->rcd_buffer)); 1255 memset(&data->cqr, 0, sizeof(data->cqr)); 1256 data->cqr.cpaddr = &data->ccw; 1257 rc = dasd_eckd_read_conf_immediately(device, &data->cqr, 1258 data->rcd_buffer, 1259 lpm); 1260 if (!rc) { 1261 switch (dasd_eckd_path_access(data->rcd_buffer, 1262 DASD_ECKD_RCD_DATA_SIZE) 1263 ) { 1264 case 0x02: 1265 npm |= lpm; 1266 break; 1267 case 0x03: 1268 ppm |= lpm; 1269 break; 1270 } 1271 opm |= lpm; 1272 } else if (rc == -EOPNOTSUPP) { 1273 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1274 "path verification: No configuration " 1275 "data retrieved"); 1276 opm |= lpm; 1277 } else if (rc == -EAGAIN) { 1278 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1279 "path verification: device is stopped," 1280 " try again later"); 1281 epm |= lpm; 1282 } else { 1283 dev_warn(&device->cdev->dev, 1284 "Reading device feature codes failed " 1285 "(rc=%d) for new path %x\n", rc, lpm); 1286 continue; 1287 } 1288 if (verify_fcx_max_data(device, lpm)) { 1289 opm &= ~lpm; 1290 npm &= ~lpm; 1291 ppm &= ~lpm; 1292 continue; 1293 } 1294 1295 /* 1296 * save conf_data for comparison after 1297 * rebuild_device_uid may have changed 1298 * the original data 1299 */ 1300 memcpy(&path_rcd_buf, data->rcd_buffer, 1301 DASD_ECKD_RCD_DATA_SIZE); 1302 path_private.conf_data = (void *) &path_rcd_buf; 1303 path_private.conf_len = DASD_ECKD_RCD_DATA_SIZE; 1304 if (dasd_eckd_identify_conf_parts(&path_private)) { 1305 path_private.conf_data = NULL; 1306 path_private.conf_len = 0; 1307 continue; 1308 } 1309 1310 /* 1311 * compare path UID with device UID only if at least 1312 * one valid path is left 1313 * in other case the device UID may have changed and 1314 * the first working path UID will be used as device UID 1315 */ 1316 if (device->path_data.opm && 1317 dasd_eckd_compare_path_uid(device, &path_private)) { 1318 /* 1319 * the comparison was not successful 1320 * rebuild the device UID with at least one 1321 * known path in case a z/VM hyperswap command 1322 * has changed the device 1323 * 1324 * after this compare again 1325 * 1326 * if either the rebuild or the recompare fails 1327 * the path can not be used 1328 */ 1329 if (rebuild_device_uid(device, data) || 1330 dasd_eckd_compare_path_uid( 1331 device, &path_private)) { 1332 uid = &path_private.uid; 1333 if (strlen(uid->vduit) > 0) 1334 snprintf(print_uid, sizeof(print_uid), 1335 "%s.%s.%04x.%02x.%s", 1336 uid->vendor, uid->serial, 1337 uid->ssid, uid->real_unit_addr, 1338 uid->vduit); 1339 else 1340 snprintf(print_uid, sizeof(print_uid), 1341 "%s.%s.%04x.%02x", 1342 uid->vendor, uid->serial, 1343 uid->ssid, 1344 uid->real_unit_addr); 1345 dev_err(&device->cdev->dev, 1346 "The newly added channel path %02X " 1347 "will not be used because it leads " 1348 "to a different device %s\n", 1349 lpm, print_uid); 1350 opm &= ~lpm; 1351 npm &= ~lpm; 1352 ppm &= ~lpm; 1353 continue; 1354 } 1355 } 1356 1357 /* 1358 * There is a small chance that a path is lost again between 1359 * above path verification and the following modification of 1360 * the device opm mask. We could avoid that race here by using 1361 * yet another path mask, but we rather deal with this unlikely 1362 * situation in dasd_start_IO. 1363 */ 1364 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 1365 if (!device->path_data.opm && opm) { 1366 device->path_data.opm = opm; 1367 dasd_generic_path_operational(device); 1368 } else 1369 device->path_data.opm |= opm; 1370 device->path_data.npm |= npm; 1371 device->path_data.ppm |= ppm; 1372 device->path_data.tbvpm |= epm; 1373 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 1374 } 1375 1376 dasd_put_device(device); 1377 if (data->isglobal) 1378 mutex_unlock(&dasd_path_verification_mutex); 1379 else 1380 kfree(data); 1381 } 1382 1383 static int dasd_eckd_verify_path(struct dasd_device *device, __u8 lpm) 1384 { 1385 struct path_verification_work_data *data; 1386 1387 data = kmalloc(sizeof(*data), GFP_ATOMIC | GFP_DMA); 1388 if (!data) { 1389 if (mutex_trylock(&dasd_path_verification_mutex)) { 1390 data = path_verification_worker; 1391 data->isglobal = 1; 1392 } else 1393 return -ENOMEM; 1394 } else { 1395 memset(data, 0, sizeof(*data)); 1396 data->isglobal = 0; 1397 } 1398 INIT_WORK(&data->worker, do_path_verification_work); 1399 dasd_get_device(device); 1400 data->device = device; 1401 data->tbvpm = lpm; 1402 schedule_work(&data->worker); 1403 return 0; 1404 } 1405 1406 static int dasd_eckd_read_features(struct dasd_device *device) 1407 { 1408 struct dasd_psf_prssd_data *prssdp; 1409 struct dasd_rssd_features *features; 1410 struct dasd_ccw_req *cqr; 1411 struct ccw1 *ccw; 1412 int rc; 1413 struct dasd_eckd_private *private; 1414 1415 private = (struct dasd_eckd_private *) device->private; 1416 memset(&private->features, 0, sizeof(struct dasd_rssd_features)); 1417 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ + 1 /* RSSD */, 1418 (sizeof(struct dasd_psf_prssd_data) + 1419 sizeof(struct dasd_rssd_features)), 1420 device); 1421 if (IS_ERR(cqr)) { 1422 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", "Could not " 1423 "allocate initialization request"); 1424 return PTR_ERR(cqr); 1425 } 1426 cqr->startdev = device; 1427 cqr->memdev = device; 1428 cqr->block = NULL; 1429 cqr->retries = 256; 1430 cqr->expires = 10 * HZ; 1431 1432 /* Prepare for Read Subsystem Data */ 1433 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 1434 memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data)); 1435 prssdp->order = PSF_ORDER_PRSSD; 1436 prssdp->suborder = 0x41; /* Read Feature Codes */ 1437 /* all other bytes of prssdp must be zero */ 1438 1439 ccw = cqr->cpaddr; 1440 ccw->cmd_code = DASD_ECKD_CCW_PSF; 1441 ccw->count = sizeof(struct dasd_psf_prssd_data); 1442 ccw->flags |= CCW_FLAG_CC; 1443 ccw->cda = (__u32)(addr_t) prssdp; 1444 1445 /* Read Subsystem Data - feature codes */ 1446 features = (struct dasd_rssd_features *) (prssdp + 1); 1447 memset(features, 0, sizeof(struct dasd_rssd_features)); 1448 1449 ccw++; 1450 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 1451 ccw->count = sizeof(struct dasd_rssd_features); 1452 ccw->cda = (__u32)(addr_t) features; 1453 1454 cqr->buildclk = get_tod_clock(); 1455 cqr->status = DASD_CQR_FILLED; 1456 rc = dasd_sleep_on(cqr); 1457 if (rc == 0) { 1458 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 1459 features = (struct dasd_rssd_features *) (prssdp + 1); 1460 memcpy(&private->features, features, 1461 sizeof(struct dasd_rssd_features)); 1462 } else 1463 dev_warn(&device->cdev->dev, "Reading device feature codes" 1464 " failed with rc=%d\n", rc); 1465 dasd_sfree_request(cqr, cqr->memdev); 1466 return rc; 1467 } 1468 1469 1470 /* 1471 * Build CP for Perform Subsystem Function - SSC. 1472 */ 1473 static struct dasd_ccw_req *dasd_eckd_build_psf_ssc(struct dasd_device *device, 1474 int enable_pav) 1475 { 1476 struct dasd_ccw_req *cqr; 1477 struct dasd_psf_ssc_data *psf_ssc_data; 1478 struct ccw1 *ccw; 1479 1480 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ , 1481 sizeof(struct dasd_psf_ssc_data), 1482 device); 1483 1484 if (IS_ERR(cqr)) { 1485 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 1486 "Could not allocate PSF-SSC request"); 1487 return cqr; 1488 } 1489 psf_ssc_data = (struct dasd_psf_ssc_data *)cqr->data; 1490 psf_ssc_data->order = PSF_ORDER_SSC; 1491 psf_ssc_data->suborder = 0xc0; 1492 if (enable_pav) { 1493 psf_ssc_data->suborder |= 0x08; 1494 psf_ssc_data->reserved[0] = 0x88; 1495 } 1496 ccw = cqr->cpaddr; 1497 ccw->cmd_code = DASD_ECKD_CCW_PSF; 1498 ccw->cda = (__u32)(addr_t)psf_ssc_data; 1499 ccw->count = 66; 1500 1501 cqr->startdev = device; 1502 cqr->memdev = device; 1503 cqr->block = NULL; 1504 cqr->retries = 256; 1505 cqr->expires = 10*HZ; 1506 cqr->buildclk = get_tod_clock(); 1507 cqr->status = DASD_CQR_FILLED; 1508 return cqr; 1509 } 1510 1511 /* 1512 * Perform Subsystem Function. 1513 * It is necessary to trigger CIO for channel revalidation since this 1514 * call might change behaviour of DASD devices. 1515 */ 1516 static int 1517 dasd_eckd_psf_ssc(struct dasd_device *device, int enable_pav, 1518 unsigned long flags) 1519 { 1520 struct dasd_ccw_req *cqr; 1521 int rc; 1522 1523 cqr = dasd_eckd_build_psf_ssc(device, enable_pav); 1524 if (IS_ERR(cqr)) 1525 return PTR_ERR(cqr); 1526 1527 /* 1528 * set flags e.g. turn on failfast, to prevent blocking 1529 * the calling function should handle failed requests 1530 */ 1531 cqr->flags |= flags; 1532 1533 rc = dasd_sleep_on(cqr); 1534 if (!rc) 1535 /* trigger CIO to reprobe devices */ 1536 css_schedule_reprobe(); 1537 else if (cqr->intrc == -EAGAIN) 1538 rc = -EAGAIN; 1539 1540 dasd_sfree_request(cqr, cqr->memdev); 1541 return rc; 1542 } 1543 1544 /* 1545 * Valide storage server of current device. 1546 */ 1547 static int dasd_eckd_validate_server(struct dasd_device *device, 1548 unsigned long flags) 1549 { 1550 int rc; 1551 struct dasd_eckd_private *private; 1552 int enable_pav; 1553 1554 private = (struct dasd_eckd_private *) device->private; 1555 if (private->uid.type == UA_BASE_PAV_ALIAS || 1556 private->uid.type == UA_HYPER_PAV_ALIAS) 1557 return 0; 1558 if (dasd_nopav || MACHINE_IS_VM) 1559 enable_pav = 0; 1560 else 1561 enable_pav = 1; 1562 rc = dasd_eckd_psf_ssc(device, enable_pav, flags); 1563 1564 /* may be requested feature is not available on server, 1565 * therefore just report error and go ahead */ 1566 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "PSF-SSC for SSID %04x " 1567 "returned rc=%d", private->uid.ssid, rc); 1568 return rc; 1569 } 1570 1571 /* 1572 * worker to do a validate server in case of a lost pathgroup 1573 */ 1574 static void dasd_eckd_do_validate_server(struct work_struct *work) 1575 { 1576 struct dasd_device *device = container_of(work, struct dasd_device, 1577 kick_validate); 1578 unsigned long flags = 0; 1579 1580 set_bit(DASD_CQR_FLAGS_FAILFAST, &flags); 1581 if (dasd_eckd_validate_server(device, flags) 1582 == -EAGAIN) { 1583 /* schedule worker again if failed */ 1584 schedule_work(&device->kick_validate); 1585 return; 1586 } 1587 1588 dasd_put_device(device); 1589 } 1590 1591 static void dasd_eckd_kick_validate_server(struct dasd_device *device) 1592 { 1593 dasd_get_device(device); 1594 /* exit if device not online or in offline processing */ 1595 if (test_bit(DASD_FLAG_OFFLINE, &device->flags) || 1596 device->state < DASD_STATE_ONLINE) { 1597 dasd_put_device(device); 1598 return; 1599 } 1600 /* queue call to do_validate_server to the kernel event daemon. */ 1601 schedule_work(&device->kick_validate); 1602 } 1603 1604 static u32 get_fcx_max_data(struct dasd_device *device) 1605 { 1606 #if defined(CONFIG_64BIT) 1607 int tpm, mdc; 1608 int fcx_in_css, fcx_in_gneq, fcx_in_features; 1609 struct dasd_eckd_private *private; 1610 1611 if (dasd_nofcx) 1612 return 0; 1613 /* is transport mode supported? */ 1614 private = (struct dasd_eckd_private *) device->private; 1615 fcx_in_css = css_general_characteristics.fcx; 1616 fcx_in_gneq = private->gneq->reserved2[7] & 0x04; 1617 fcx_in_features = private->features.feature[40] & 0x80; 1618 tpm = fcx_in_css && fcx_in_gneq && fcx_in_features; 1619 1620 if (!tpm) 1621 return 0; 1622 1623 mdc = ccw_device_get_mdc(device->cdev, 0); 1624 if (mdc < 0) { 1625 dev_warn(&device->cdev->dev, "Detecting the maximum supported" 1626 " data size for zHPF requests failed\n"); 1627 return 0; 1628 } else 1629 return mdc * FCX_MAX_DATA_FACTOR; 1630 #else 1631 return 0; 1632 #endif 1633 } 1634 1635 /* 1636 * Check device characteristics. 1637 * If the device is accessible using ECKD discipline, the device is enabled. 1638 */ 1639 static int 1640 dasd_eckd_check_characteristics(struct dasd_device *device) 1641 { 1642 struct dasd_eckd_private *private; 1643 struct dasd_block *block; 1644 struct dasd_uid temp_uid; 1645 int rc, i; 1646 int readonly; 1647 unsigned long value; 1648 1649 /* setup work queue for validate server*/ 1650 INIT_WORK(&device->kick_validate, dasd_eckd_do_validate_server); 1651 1652 if (!ccw_device_is_pathgroup(device->cdev)) { 1653 dev_warn(&device->cdev->dev, 1654 "A channel path group could not be established\n"); 1655 return -EIO; 1656 } 1657 if (!ccw_device_is_multipath(device->cdev)) { 1658 dev_info(&device->cdev->dev, 1659 "The DASD is not operating in multipath mode\n"); 1660 } 1661 private = (struct dasd_eckd_private *) device->private; 1662 if (!private) { 1663 private = kzalloc(sizeof(*private), GFP_KERNEL | GFP_DMA); 1664 if (!private) { 1665 dev_warn(&device->cdev->dev, 1666 "Allocating memory for private DASD data " 1667 "failed\n"); 1668 return -ENOMEM; 1669 } 1670 device->private = (void *) private; 1671 } else { 1672 memset(private, 0, sizeof(*private)); 1673 } 1674 /* Invalidate status of initial analysis. */ 1675 private->init_cqr_status = -1; 1676 /* Set default cache operations. */ 1677 private->attrib.operation = DASD_NORMAL_CACHE; 1678 private->attrib.nr_cyl = 0; 1679 1680 /* Read Configuration Data */ 1681 rc = dasd_eckd_read_conf(device); 1682 if (rc) 1683 goto out_err1; 1684 1685 /* set default timeout */ 1686 device->default_expires = DASD_EXPIRES; 1687 /* set default retry count */ 1688 device->default_retries = DASD_RETRIES; 1689 1690 if (private->gneq) { 1691 value = 1; 1692 for (i = 0; i < private->gneq->timeout.value; i++) 1693 value = 10 * value; 1694 value = value * private->gneq->timeout.number; 1695 /* do not accept useless values */ 1696 if (value != 0 && value <= DASD_EXPIRES_MAX) 1697 device->default_expires = value; 1698 } 1699 1700 dasd_eckd_get_uid(device, &temp_uid); 1701 if (temp_uid.type == UA_BASE_DEVICE) { 1702 block = dasd_alloc_block(); 1703 if (IS_ERR(block)) { 1704 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, "%s", 1705 "could not allocate dasd " 1706 "block structure"); 1707 rc = PTR_ERR(block); 1708 goto out_err1; 1709 } 1710 device->block = block; 1711 block->base = device; 1712 } 1713 1714 /* register lcu with alias handling, enable PAV */ 1715 rc = dasd_alias_make_device_known_to_lcu(device); 1716 if (rc) 1717 goto out_err2; 1718 1719 dasd_eckd_validate_server(device, 0); 1720 1721 /* device may report different configuration data after LCU setup */ 1722 rc = dasd_eckd_read_conf(device); 1723 if (rc) 1724 goto out_err3; 1725 1726 /* Read Feature Codes */ 1727 dasd_eckd_read_features(device); 1728 1729 /* Read Device Characteristics */ 1730 rc = dasd_generic_read_dev_chars(device, DASD_ECKD_MAGIC, 1731 &private->rdc_data, 64); 1732 if (rc) { 1733 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 1734 "Read device characteristic failed, rc=%d", rc); 1735 goto out_err3; 1736 } 1737 1738 if ((device->features & DASD_FEATURE_USERAW) && 1739 !(private->rdc_data.facilities.RT_in_LR)) { 1740 dev_err(&device->cdev->dev, "The storage server does not " 1741 "support raw-track access\n"); 1742 rc = -EINVAL; 1743 goto out_err3; 1744 } 1745 1746 /* find the valid cylinder size */ 1747 if (private->rdc_data.no_cyl == LV_COMPAT_CYL && 1748 private->rdc_data.long_no_cyl) 1749 private->real_cyl = private->rdc_data.long_no_cyl; 1750 else 1751 private->real_cyl = private->rdc_data.no_cyl; 1752 1753 private->fcx_max_data = get_fcx_max_data(device); 1754 1755 readonly = dasd_device_is_ro(device); 1756 if (readonly) 1757 set_bit(DASD_FLAG_DEVICE_RO, &device->flags); 1758 1759 dev_info(&device->cdev->dev, "New DASD %04X/%02X (CU %04X/%02X) " 1760 "with %d cylinders, %d heads, %d sectors%s\n", 1761 private->rdc_data.dev_type, 1762 private->rdc_data.dev_model, 1763 private->rdc_data.cu_type, 1764 private->rdc_data.cu_model.model, 1765 private->real_cyl, 1766 private->rdc_data.trk_per_cyl, 1767 private->rdc_data.sec_per_trk, 1768 readonly ? ", read-only device" : ""); 1769 return 0; 1770 1771 out_err3: 1772 dasd_alias_disconnect_device_from_lcu(device); 1773 out_err2: 1774 dasd_free_block(device->block); 1775 device->block = NULL; 1776 out_err1: 1777 kfree(private->conf_data); 1778 kfree(device->private); 1779 device->private = NULL; 1780 return rc; 1781 } 1782 1783 static void dasd_eckd_uncheck_device(struct dasd_device *device) 1784 { 1785 struct dasd_eckd_private *private; 1786 1787 private = (struct dasd_eckd_private *) device->private; 1788 dasd_alias_disconnect_device_from_lcu(device); 1789 private->ned = NULL; 1790 private->sneq = NULL; 1791 private->vdsneq = NULL; 1792 private->gneq = NULL; 1793 private->conf_len = 0; 1794 kfree(private->conf_data); 1795 private->conf_data = NULL; 1796 } 1797 1798 static struct dasd_ccw_req * 1799 dasd_eckd_analysis_ccw(struct dasd_device *device) 1800 { 1801 struct dasd_eckd_private *private; 1802 struct eckd_count *count_data; 1803 struct LO_eckd_data *LO_data; 1804 struct dasd_ccw_req *cqr; 1805 struct ccw1 *ccw; 1806 int cplength, datasize; 1807 int i; 1808 1809 private = (struct dasd_eckd_private *) device->private; 1810 1811 cplength = 8; 1812 datasize = sizeof(struct DE_eckd_data) + 2*sizeof(struct LO_eckd_data); 1813 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, device); 1814 if (IS_ERR(cqr)) 1815 return cqr; 1816 ccw = cqr->cpaddr; 1817 /* Define extent for the first 3 tracks. */ 1818 define_extent(ccw++, cqr->data, 0, 2, 1819 DASD_ECKD_CCW_READ_COUNT, device); 1820 LO_data = cqr->data + sizeof(struct DE_eckd_data); 1821 /* Locate record for the first 4 records on track 0. */ 1822 ccw[-1].flags |= CCW_FLAG_CC; 1823 locate_record(ccw++, LO_data++, 0, 0, 4, 1824 DASD_ECKD_CCW_READ_COUNT, device, 0); 1825 1826 count_data = private->count_area; 1827 for (i = 0; i < 4; i++) { 1828 ccw[-1].flags |= CCW_FLAG_CC; 1829 ccw->cmd_code = DASD_ECKD_CCW_READ_COUNT; 1830 ccw->flags = 0; 1831 ccw->count = 8; 1832 ccw->cda = (__u32)(addr_t) count_data; 1833 ccw++; 1834 count_data++; 1835 } 1836 1837 /* Locate record for the first record on track 2. */ 1838 ccw[-1].flags |= CCW_FLAG_CC; 1839 locate_record(ccw++, LO_data++, 2, 0, 1, 1840 DASD_ECKD_CCW_READ_COUNT, device, 0); 1841 /* Read count ccw. */ 1842 ccw[-1].flags |= CCW_FLAG_CC; 1843 ccw->cmd_code = DASD_ECKD_CCW_READ_COUNT; 1844 ccw->flags = 0; 1845 ccw->count = 8; 1846 ccw->cda = (__u32)(addr_t) count_data; 1847 1848 cqr->block = NULL; 1849 cqr->startdev = device; 1850 cqr->memdev = device; 1851 cqr->retries = 255; 1852 cqr->buildclk = get_tod_clock(); 1853 cqr->status = DASD_CQR_FILLED; 1854 return cqr; 1855 } 1856 1857 /* differentiate between 'no record found' and any other error */ 1858 static int dasd_eckd_analysis_evaluation(struct dasd_ccw_req *init_cqr) 1859 { 1860 char *sense; 1861 if (init_cqr->status == DASD_CQR_DONE) 1862 return INIT_CQR_OK; 1863 else if (init_cqr->status == DASD_CQR_NEED_ERP || 1864 init_cqr->status == DASD_CQR_FAILED) { 1865 sense = dasd_get_sense(&init_cqr->irb); 1866 if (sense && (sense[1] & SNS1_NO_REC_FOUND)) 1867 return INIT_CQR_UNFORMATTED; 1868 else 1869 return INIT_CQR_ERROR; 1870 } else 1871 return INIT_CQR_ERROR; 1872 } 1873 1874 /* 1875 * This is the callback function for the init_analysis cqr. It saves 1876 * the status of the initial analysis ccw before it frees it and kicks 1877 * the device to continue the startup sequence. This will call 1878 * dasd_eckd_do_analysis again (if the devices has not been marked 1879 * for deletion in the meantime). 1880 */ 1881 static void dasd_eckd_analysis_callback(struct dasd_ccw_req *init_cqr, 1882 void *data) 1883 { 1884 struct dasd_eckd_private *private; 1885 struct dasd_device *device; 1886 1887 device = init_cqr->startdev; 1888 private = (struct dasd_eckd_private *) device->private; 1889 private->init_cqr_status = dasd_eckd_analysis_evaluation(init_cqr); 1890 dasd_sfree_request(init_cqr, device); 1891 dasd_kick_device(device); 1892 } 1893 1894 static int dasd_eckd_start_analysis(struct dasd_block *block) 1895 { 1896 struct dasd_ccw_req *init_cqr; 1897 1898 init_cqr = dasd_eckd_analysis_ccw(block->base); 1899 if (IS_ERR(init_cqr)) 1900 return PTR_ERR(init_cqr); 1901 init_cqr->callback = dasd_eckd_analysis_callback; 1902 init_cqr->callback_data = NULL; 1903 init_cqr->expires = 5*HZ; 1904 /* first try without ERP, so we can later handle unformatted 1905 * devices as special case 1906 */ 1907 clear_bit(DASD_CQR_FLAGS_USE_ERP, &init_cqr->flags); 1908 init_cqr->retries = 0; 1909 dasd_add_request_head(init_cqr); 1910 return -EAGAIN; 1911 } 1912 1913 static int dasd_eckd_end_analysis(struct dasd_block *block) 1914 { 1915 struct dasd_device *device; 1916 struct dasd_eckd_private *private; 1917 struct eckd_count *count_area; 1918 unsigned int sb, blk_per_trk; 1919 int status, i; 1920 struct dasd_ccw_req *init_cqr; 1921 1922 device = block->base; 1923 private = (struct dasd_eckd_private *) device->private; 1924 status = private->init_cqr_status; 1925 private->init_cqr_status = -1; 1926 if (status == INIT_CQR_ERROR) { 1927 /* try again, this time with full ERP */ 1928 init_cqr = dasd_eckd_analysis_ccw(device); 1929 dasd_sleep_on(init_cqr); 1930 status = dasd_eckd_analysis_evaluation(init_cqr); 1931 dasd_sfree_request(init_cqr, device); 1932 } 1933 1934 if (device->features & DASD_FEATURE_USERAW) { 1935 block->bp_block = DASD_RAW_BLOCKSIZE; 1936 blk_per_trk = DASD_RAW_BLOCK_PER_TRACK; 1937 block->s2b_shift = 3; 1938 goto raw; 1939 } 1940 1941 if (status == INIT_CQR_UNFORMATTED) { 1942 dev_warn(&device->cdev->dev, "The DASD is not formatted\n"); 1943 return -EMEDIUMTYPE; 1944 } else if (status == INIT_CQR_ERROR) { 1945 dev_err(&device->cdev->dev, 1946 "Detecting the DASD disk layout failed because " 1947 "of an I/O error\n"); 1948 return -EIO; 1949 } 1950 1951 private->uses_cdl = 1; 1952 /* Check Track 0 for Compatible Disk Layout */ 1953 count_area = NULL; 1954 for (i = 0; i < 3; i++) { 1955 if (private->count_area[i].kl != 4 || 1956 private->count_area[i].dl != dasd_eckd_cdl_reclen(i) - 4 || 1957 private->count_area[i].cyl != 0 || 1958 private->count_area[i].head != count_area_head[i] || 1959 private->count_area[i].record != count_area_rec[i]) { 1960 private->uses_cdl = 0; 1961 break; 1962 } 1963 } 1964 if (i == 3) 1965 count_area = &private->count_area[4]; 1966 1967 if (private->uses_cdl == 0) { 1968 for (i = 0; i < 5; i++) { 1969 if ((private->count_area[i].kl != 0) || 1970 (private->count_area[i].dl != 1971 private->count_area[0].dl) || 1972 private->count_area[i].cyl != 0 || 1973 private->count_area[i].head != count_area_head[i] || 1974 private->count_area[i].record != count_area_rec[i]) 1975 break; 1976 } 1977 if (i == 5) 1978 count_area = &private->count_area[0]; 1979 } else { 1980 if (private->count_area[3].record == 1) 1981 dev_warn(&device->cdev->dev, 1982 "Track 0 has no records following the VTOC\n"); 1983 } 1984 1985 if (count_area != NULL && count_area->kl == 0) { 1986 /* we found notthing violating our disk layout */ 1987 if (dasd_check_blocksize(count_area->dl) == 0) 1988 block->bp_block = count_area->dl; 1989 } 1990 if (block->bp_block == 0) { 1991 dev_warn(&device->cdev->dev, 1992 "The disk layout of the DASD is not supported\n"); 1993 return -EMEDIUMTYPE; 1994 } 1995 block->s2b_shift = 0; /* bits to shift 512 to get a block */ 1996 for (sb = 512; sb < block->bp_block; sb = sb << 1) 1997 block->s2b_shift++; 1998 1999 blk_per_trk = recs_per_track(&private->rdc_data, 0, block->bp_block); 2000 2001 raw: 2002 block->blocks = (private->real_cyl * 2003 private->rdc_data.trk_per_cyl * 2004 blk_per_trk); 2005 2006 dev_info(&device->cdev->dev, 2007 "DASD with %d KB/block, %d KB total size, %d KB/track, " 2008 "%s\n", (block->bp_block >> 10), 2009 ((private->real_cyl * 2010 private->rdc_data.trk_per_cyl * 2011 blk_per_trk * (block->bp_block >> 9)) >> 1), 2012 ((blk_per_trk * block->bp_block) >> 10), 2013 private->uses_cdl ? 2014 "compatible disk layout" : "linux disk layout"); 2015 2016 return 0; 2017 } 2018 2019 static int dasd_eckd_do_analysis(struct dasd_block *block) 2020 { 2021 struct dasd_eckd_private *private; 2022 2023 private = (struct dasd_eckd_private *) block->base->private; 2024 if (private->init_cqr_status < 0) 2025 return dasd_eckd_start_analysis(block); 2026 else 2027 return dasd_eckd_end_analysis(block); 2028 } 2029 2030 static int dasd_eckd_basic_to_ready(struct dasd_device *device) 2031 { 2032 return dasd_alias_add_device(device); 2033 }; 2034 2035 static int dasd_eckd_online_to_ready(struct dasd_device *device) 2036 { 2037 cancel_work_sync(&device->reload_device); 2038 cancel_work_sync(&device->kick_validate); 2039 return 0; 2040 }; 2041 2042 static int dasd_eckd_basic_to_known(struct dasd_device *device) 2043 { 2044 return dasd_alias_remove_device(device); 2045 }; 2046 2047 static int 2048 dasd_eckd_fill_geometry(struct dasd_block *block, struct hd_geometry *geo) 2049 { 2050 struct dasd_eckd_private *private; 2051 2052 private = (struct dasd_eckd_private *) block->base->private; 2053 if (dasd_check_blocksize(block->bp_block) == 0) { 2054 geo->sectors = recs_per_track(&private->rdc_data, 2055 0, block->bp_block); 2056 } 2057 geo->cylinders = private->rdc_data.no_cyl; 2058 geo->heads = private->rdc_data.trk_per_cyl; 2059 return 0; 2060 } 2061 2062 static struct dasd_ccw_req * 2063 dasd_eckd_build_format(struct dasd_device *base, 2064 struct format_data_t *fdata, 2065 int enable_pav) 2066 { 2067 struct dasd_eckd_private *base_priv; 2068 struct dasd_eckd_private *start_priv; 2069 struct dasd_device *startdev = NULL; 2070 struct dasd_ccw_req *fcp; 2071 struct eckd_count *ect; 2072 struct ch_t address; 2073 struct ccw1 *ccw; 2074 void *data; 2075 int rpt; 2076 int cplength, datasize; 2077 int i, j; 2078 int intensity = 0; 2079 int r0_perm; 2080 int nr_tracks; 2081 int use_prefix; 2082 2083 if (enable_pav) 2084 startdev = dasd_alias_get_start_dev(base); 2085 2086 if (!startdev) 2087 startdev = base; 2088 2089 start_priv = (struct dasd_eckd_private *) startdev->private; 2090 base_priv = (struct dasd_eckd_private *) base->private; 2091 2092 rpt = recs_per_track(&base_priv->rdc_data, 0, fdata->blksize); 2093 2094 nr_tracks = fdata->stop_unit - fdata->start_unit + 1; 2095 2096 /* 2097 * fdata->intensity is a bit string that tells us what to do: 2098 * Bit 0: write record zero 2099 * Bit 1: write home address, currently not supported 2100 * Bit 2: invalidate tracks 2101 * Bit 3: use OS/390 compatible disk layout (cdl) 2102 * Bit 4: do not allow storage subsystem to modify record zero 2103 * Only some bit combinations do make sense. 2104 */ 2105 if (fdata->intensity & 0x10) { 2106 r0_perm = 0; 2107 intensity = fdata->intensity & ~0x10; 2108 } else { 2109 r0_perm = 1; 2110 intensity = fdata->intensity; 2111 } 2112 2113 use_prefix = base_priv->features.feature[8] & 0x01; 2114 2115 switch (intensity) { 2116 case 0x00: /* Normal format */ 2117 case 0x08: /* Normal format, use cdl. */ 2118 cplength = 2 + (rpt*nr_tracks); 2119 if (use_prefix) 2120 datasize = sizeof(struct PFX_eckd_data) + 2121 sizeof(struct LO_eckd_data) + 2122 rpt * nr_tracks * sizeof(struct eckd_count); 2123 else 2124 datasize = sizeof(struct DE_eckd_data) + 2125 sizeof(struct LO_eckd_data) + 2126 rpt * nr_tracks * sizeof(struct eckd_count); 2127 break; 2128 case 0x01: /* Write record zero and format track. */ 2129 case 0x09: /* Write record zero and format track, use cdl. */ 2130 cplength = 2 + rpt * nr_tracks; 2131 if (use_prefix) 2132 datasize = sizeof(struct PFX_eckd_data) + 2133 sizeof(struct LO_eckd_data) + 2134 sizeof(struct eckd_count) + 2135 rpt * nr_tracks * sizeof(struct eckd_count); 2136 else 2137 datasize = sizeof(struct DE_eckd_data) + 2138 sizeof(struct LO_eckd_data) + 2139 sizeof(struct eckd_count) + 2140 rpt * nr_tracks * sizeof(struct eckd_count); 2141 break; 2142 case 0x04: /* Invalidate track. */ 2143 case 0x0c: /* Invalidate track, use cdl. */ 2144 cplength = 3; 2145 if (use_prefix) 2146 datasize = sizeof(struct PFX_eckd_data) + 2147 sizeof(struct LO_eckd_data) + 2148 sizeof(struct eckd_count); 2149 else 2150 datasize = sizeof(struct DE_eckd_data) + 2151 sizeof(struct LO_eckd_data) + 2152 sizeof(struct eckd_count); 2153 break; 2154 default: 2155 dev_warn(&startdev->cdev->dev, 2156 "An I/O control call used incorrect flags 0x%x\n", 2157 fdata->intensity); 2158 return ERR_PTR(-EINVAL); 2159 } 2160 /* Allocate the format ccw request. */ 2161 fcp = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, 2162 datasize, startdev); 2163 if (IS_ERR(fcp)) 2164 return fcp; 2165 2166 start_priv->count++; 2167 data = fcp->data; 2168 ccw = fcp->cpaddr; 2169 2170 switch (intensity & ~0x08) { 2171 case 0x00: /* Normal format. */ 2172 if (use_prefix) { 2173 prefix(ccw++, (struct PFX_eckd_data *) data, 2174 fdata->start_unit, fdata->stop_unit, 2175 DASD_ECKD_CCW_WRITE_CKD, base, startdev); 2176 /* grant subsystem permission to format R0 */ 2177 if (r0_perm) 2178 ((struct PFX_eckd_data *)data) 2179 ->define_extent.ga_extended |= 0x04; 2180 data += sizeof(struct PFX_eckd_data); 2181 } else { 2182 define_extent(ccw++, (struct DE_eckd_data *) data, 2183 fdata->start_unit, fdata->stop_unit, 2184 DASD_ECKD_CCW_WRITE_CKD, startdev); 2185 /* grant subsystem permission to format R0 */ 2186 if (r0_perm) 2187 ((struct DE_eckd_data *) data) 2188 ->ga_extended |= 0x04; 2189 data += sizeof(struct DE_eckd_data); 2190 } 2191 ccw[-1].flags |= CCW_FLAG_CC; 2192 locate_record(ccw++, (struct LO_eckd_data *) data, 2193 fdata->start_unit, 0, rpt*nr_tracks, 2194 DASD_ECKD_CCW_WRITE_CKD, base, 2195 fdata->blksize); 2196 data += sizeof(struct LO_eckd_data); 2197 break; 2198 case 0x01: /* Write record zero + format track. */ 2199 if (use_prefix) { 2200 prefix(ccw++, (struct PFX_eckd_data *) data, 2201 fdata->start_unit, fdata->stop_unit, 2202 DASD_ECKD_CCW_WRITE_RECORD_ZERO, 2203 base, startdev); 2204 data += sizeof(struct PFX_eckd_data); 2205 } else { 2206 define_extent(ccw++, (struct DE_eckd_data *) data, 2207 fdata->start_unit, fdata->stop_unit, 2208 DASD_ECKD_CCW_WRITE_RECORD_ZERO, startdev); 2209 data += sizeof(struct DE_eckd_data); 2210 } 2211 ccw[-1].flags |= CCW_FLAG_CC; 2212 locate_record(ccw++, (struct LO_eckd_data *) data, 2213 fdata->start_unit, 0, rpt * nr_tracks + 1, 2214 DASD_ECKD_CCW_WRITE_RECORD_ZERO, base, 2215 base->block->bp_block); 2216 data += sizeof(struct LO_eckd_data); 2217 break; 2218 case 0x04: /* Invalidate track. */ 2219 if (use_prefix) { 2220 prefix(ccw++, (struct PFX_eckd_data *) data, 2221 fdata->start_unit, fdata->stop_unit, 2222 DASD_ECKD_CCW_WRITE_CKD, base, startdev); 2223 data += sizeof(struct PFX_eckd_data); 2224 } else { 2225 define_extent(ccw++, (struct DE_eckd_data *) data, 2226 fdata->start_unit, fdata->stop_unit, 2227 DASD_ECKD_CCW_WRITE_CKD, startdev); 2228 data += sizeof(struct DE_eckd_data); 2229 } 2230 ccw[-1].flags |= CCW_FLAG_CC; 2231 locate_record(ccw++, (struct LO_eckd_data *) data, 2232 fdata->start_unit, 0, 1, 2233 DASD_ECKD_CCW_WRITE_CKD, base, 8); 2234 data += sizeof(struct LO_eckd_data); 2235 break; 2236 } 2237 2238 for (j = 0; j < nr_tracks; j++) { 2239 /* calculate cylinder and head for the current track */ 2240 set_ch_t(&address, 2241 (fdata->start_unit + j) / 2242 base_priv->rdc_data.trk_per_cyl, 2243 (fdata->start_unit + j) % 2244 base_priv->rdc_data.trk_per_cyl); 2245 if (intensity & 0x01) { /* write record zero */ 2246 ect = (struct eckd_count *) data; 2247 data += sizeof(struct eckd_count); 2248 ect->cyl = address.cyl; 2249 ect->head = address.head; 2250 ect->record = 0; 2251 ect->kl = 0; 2252 ect->dl = 8; 2253 ccw[-1].flags |= CCW_FLAG_CC; 2254 ccw->cmd_code = DASD_ECKD_CCW_WRITE_RECORD_ZERO; 2255 ccw->flags = CCW_FLAG_SLI; 2256 ccw->count = 8; 2257 ccw->cda = (__u32)(addr_t) ect; 2258 ccw++; 2259 } 2260 if ((intensity & ~0x08) & 0x04) { /* erase track */ 2261 ect = (struct eckd_count *) data; 2262 data += sizeof(struct eckd_count); 2263 ect->cyl = address.cyl; 2264 ect->head = address.head; 2265 ect->record = 1; 2266 ect->kl = 0; 2267 ect->dl = 0; 2268 ccw[-1].flags |= CCW_FLAG_CC; 2269 ccw->cmd_code = DASD_ECKD_CCW_WRITE_CKD; 2270 ccw->flags = CCW_FLAG_SLI; 2271 ccw->count = 8; 2272 ccw->cda = (__u32)(addr_t) ect; 2273 } else { /* write remaining records */ 2274 for (i = 0; i < rpt; i++) { 2275 ect = (struct eckd_count *) data; 2276 data += sizeof(struct eckd_count); 2277 ect->cyl = address.cyl; 2278 ect->head = address.head; 2279 ect->record = i + 1; 2280 ect->kl = 0; 2281 ect->dl = fdata->blksize; 2282 /* 2283 * Check for special tracks 0-1 2284 * when formatting CDL 2285 */ 2286 if ((intensity & 0x08) && 2287 fdata->start_unit == 0) { 2288 if (i < 3) { 2289 ect->kl = 4; 2290 ect->dl = sizes_trk0[i] - 4; 2291 } 2292 } 2293 if ((intensity & 0x08) && 2294 fdata->start_unit == 1) { 2295 ect->kl = 44; 2296 ect->dl = LABEL_SIZE - 44; 2297 } 2298 ccw[-1].flags |= CCW_FLAG_CC; 2299 if (i != 0 || j == 0) 2300 ccw->cmd_code = 2301 DASD_ECKD_CCW_WRITE_CKD; 2302 else 2303 ccw->cmd_code = 2304 DASD_ECKD_CCW_WRITE_CKD_MT; 2305 ccw->flags = CCW_FLAG_SLI; 2306 ccw->count = 8; 2307 ccw->cda = (__u32)(addr_t) ect; 2308 ccw++; 2309 } 2310 } 2311 } 2312 2313 fcp->startdev = startdev; 2314 fcp->memdev = startdev; 2315 fcp->basedev = base; 2316 fcp->retries = 256; 2317 fcp->expires = startdev->default_expires * HZ; 2318 fcp->buildclk = get_tod_clock(); 2319 fcp->status = DASD_CQR_FILLED; 2320 2321 return fcp; 2322 } 2323 2324 static int 2325 dasd_eckd_format_device(struct dasd_device *base, 2326 struct format_data_t *fdata, 2327 int enable_pav) 2328 { 2329 struct dasd_ccw_req *cqr, *n; 2330 struct dasd_block *block; 2331 struct dasd_eckd_private *private; 2332 struct list_head format_queue; 2333 struct dasd_device *device; 2334 int old_stop, format_step; 2335 int step, rc = 0, sleep_rc; 2336 2337 block = base->block; 2338 private = (struct dasd_eckd_private *) base->private; 2339 2340 /* Sanity checks. */ 2341 if (fdata->start_unit >= 2342 (private->real_cyl * private->rdc_data.trk_per_cyl)) { 2343 dev_warn(&base->cdev->dev, 2344 "Start track number %u used in formatting is too big\n", 2345 fdata->start_unit); 2346 return -EINVAL; 2347 } 2348 if (fdata->stop_unit >= 2349 (private->real_cyl * private->rdc_data.trk_per_cyl)) { 2350 dev_warn(&base->cdev->dev, 2351 "Stop track number %u used in formatting is too big\n", 2352 fdata->stop_unit); 2353 return -EINVAL; 2354 } 2355 if (fdata->start_unit > fdata->stop_unit) { 2356 dev_warn(&base->cdev->dev, 2357 "Start track %u used in formatting exceeds end track\n", 2358 fdata->start_unit); 2359 return -EINVAL; 2360 } 2361 if (dasd_check_blocksize(fdata->blksize) != 0) { 2362 dev_warn(&base->cdev->dev, 2363 "The DASD cannot be formatted with block size %u\n", 2364 fdata->blksize); 2365 return -EINVAL; 2366 } 2367 2368 INIT_LIST_HEAD(&format_queue); 2369 2370 old_stop = fdata->stop_unit; 2371 while (fdata->start_unit <= 1) { 2372 fdata->stop_unit = fdata->start_unit; 2373 cqr = dasd_eckd_build_format(base, fdata, enable_pav); 2374 list_add(&cqr->blocklist, &format_queue); 2375 2376 fdata->stop_unit = old_stop; 2377 fdata->start_unit++; 2378 2379 if (fdata->start_unit > fdata->stop_unit) 2380 goto sleep; 2381 } 2382 2383 retry: 2384 format_step = 255 / recs_per_track(&private->rdc_data, 0, 2385 fdata->blksize); 2386 while (fdata->start_unit <= old_stop) { 2387 step = fdata->stop_unit - fdata->start_unit + 1; 2388 if (step > format_step) 2389 fdata->stop_unit = fdata->start_unit + format_step - 1; 2390 2391 cqr = dasd_eckd_build_format(base, fdata, enable_pav); 2392 if (IS_ERR(cqr)) { 2393 if (PTR_ERR(cqr) == -ENOMEM) { 2394 /* 2395 * not enough memory available 2396 * go to out and start requests 2397 * retry after first requests were finished 2398 */ 2399 fdata->stop_unit = old_stop; 2400 goto sleep; 2401 } else 2402 return PTR_ERR(cqr); 2403 } 2404 list_add(&cqr->blocklist, &format_queue); 2405 2406 fdata->start_unit = fdata->stop_unit + 1; 2407 fdata->stop_unit = old_stop; 2408 } 2409 2410 sleep: 2411 sleep_rc = dasd_sleep_on_queue(&format_queue); 2412 2413 list_for_each_entry_safe(cqr, n, &format_queue, blocklist) { 2414 device = cqr->startdev; 2415 private = (struct dasd_eckd_private *) device->private; 2416 if (cqr->status == DASD_CQR_FAILED) 2417 rc = -EIO; 2418 list_del_init(&cqr->blocklist); 2419 dasd_sfree_request(cqr, device); 2420 private->count--; 2421 } 2422 2423 if (sleep_rc) 2424 return sleep_rc; 2425 2426 /* 2427 * in case of ENOMEM we need to retry after 2428 * first requests are finished 2429 */ 2430 if (fdata->start_unit <= fdata->stop_unit) 2431 goto retry; 2432 2433 return rc; 2434 } 2435 2436 static void dasd_eckd_handle_terminated_request(struct dasd_ccw_req *cqr) 2437 { 2438 if (cqr->retries < 0) { 2439 cqr->status = DASD_CQR_FAILED; 2440 return; 2441 } 2442 cqr->status = DASD_CQR_FILLED; 2443 if (cqr->block && (cqr->startdev != cqr->block->base)) { 2444 dasd_eckd_reset_ccw_to_base_io(cqr); 2445 cqr->startdev = cqr->block->base; 2446 cqr->lpm = cqr->block->base->path_data.opm; 2447 } 2448 }; 2449 2450 static dasd_erp_fn_t 2451 dasd_eckd_erp_action(struct dasd_ccw_req * cqr) 2452 { 2453 struct dasd_device *device = (struct dasd_device *) cqr->startdev; 2454 struct ccw_device *cdev = device->cdev; 2455 2456 switch (cdev->id.cu_type) { 2457 case 0x3990: 2458 case 0x2105: 2459 case 0x2107: 2460 case 0x1750: 2461 return dasd_3990_erp_action; 2462 case 0x9343: 2463 case 0x3880: 2464 default: 2465 return dasd_default_erp_action; 2466 } 2467 } 2468 2469 static dasd_erp_fn_t 2470 dasd_eckd_erp_postaction(struct dasd_ccw_req * cqr) 2471 { 2472 return dasd_default_erp_postaction; 2473 } 2474 2475 static void dasd_eckd_check_for_device_change(struct dasd_device *device, 2476 struct dasd_ccw_req *cqr, 2477 struct irb *irb) 2478 { 2479 char mask; 2480 char *sense = NULL; 2481 struct dasd_eckd_private *private; 2482 2483 private = (struct dasd_eckd_private *) device->private; 2484 /* first of all check for state change pending interrupt */ 2485 mask = DEV_STAT_ATTENTION | DEV_STAT_DEV_END | DEV_STAT_UNIT_EXCEP; 2486 if ((scsw_dstat(&irb->scsw) & mask) == mask) { 2487 /* 2488 * for alias only, not in offline processing 2489 * and only if not suspended 2490 */ 2491 if (!device->block && private->lcu && 2492 device->state == DASD_STATE_ONLINE && 2493 !test_bit(DASD_FLAG_OFFLINE, &device->flags) && 2494 !test_bit(DASD_FLAG_SUSPENDED, &device->flags)) { 2495 /* 2496 * the state change could be caused by an alias 2497 * reassignment remove device from alias handling 2498 * to prevent new requests from being scheduled on 2499 * the wrong alias device 2500 */ 2501 dasd_alias_remove_device(device); 2502 2503 /* schedule worker to reload device */ 2504 dasd_reload_device(device); 2505 } 2506 dasd_generic_handle_state_change(device); 2507 return; 2508 } 2509 2510 sense = dasd_get_sense(irb); 2511 if (!sense) 2512 return; 2513 2514 /* summary unit check */ 2515 if ((sense[27] & DASD_SENSE_BIT_0) && (sense[7] == 0x0D) && 2516 (scsw_dstat(&irb->scsw) & DEV_STAT_UNIT_CHECK)) { 2517 dasd_alias_handle_summary_unit_check(device, irb); 2518 return; 2519 } 2520 2521 /* service information message SIM */ 2522 if (!cqr && !(sense[27] & DASD_SENSE_BIT_0) && 2523 ((sense[6] & DASD_SIM_SENSE) == DASD_SIM_SENSE)) { 2524 dasd_3990_erp_handle_sim(device, sense); 2525 return; 2526 } 2527 2528 /* loss of device reservation is handled via base devices only 2529 * as alias devices may be used with several bases 2530 */ 2531 if (device->block && (sense[27] & DASD_SENSE_BIT_0) && 2532 (sense[7] == 0x3F) && 2533 (scsw_dstat(&irb->scsw) & DEV_STAT_UNIT_CHECK) && 2534 test_bit(DASD_FLAG_IS_RESERVED, &device->flags)) { 2535 if (device->features & DASD_FEATURE_FAILONSLCK) 2536 set_bit(DASD_FLAG_LOCK_STOLEN, &device->flags); 2537 clear_bit(DASD_FLAG_IS_RESERVED, &device->flags); 2538 dev_err(&device->cdev->dev, 2539 "The device reservation was lost\n"); 2540 } 2541 } 2542 2543 static struct dasd_ccw_req *dasd_eckd_build_cp_cmd_single( 2544 struct dasd_device *startdev, 2545 struct dasd_block *block, 2546 struct request *req, 2547 sector_t first_rec, 2548 sector_t last_rec, 2549 sector_t first_trk, 2550 sector_t last_trk, 2551 unsigned int first_offs, 2552 unsigned int last_offs, 2553 unsigned int blk_per_trk, 2554 unsigned int blksize) 2555 { 2556 struct dasd_eckd_private *private; 2557 unsigned long *idaws; 2558 struct LO_eckd_data *LO_data; 2559 struct dasd_ccw_req *cqr; 2560 struct ccw1 *ccw; 2561 struct req_iterator iter; 2562 struct bio_vec bv; 2563 char *dst; 2564 unsigned int off; 2565 int count, cidaw, cplength, datasize; 2566 sector_t recid; 2567 unsigned char cmd, rcmd; 2568 int use_prefix; 2569 struct dasd_device *basedev; 2570 2571 basedev = block->base; 2572 private = (struct dasd_eckd_private *) basedev->private; 2573 if (rq_data_dir(req) == READ) 2574 cmd = DASD_ECKD_CCW_READ_MT; 2575 else if (rq_data_dir(req) == WRITE) 2576 cmd = DASD_ECKD_CCW_WRITE_MT; 2577 else 2578 return ERR_PTR(-EINVAL); 2579 2580 /* Check struct bio and count the number of blocks for the request. */ 2581 count = 0; 2582 cidaw = 0; 2583 rq_for_each_segment(bv, req, iter) { 2584 if (bv.bv_len & (blksize - 1)) 2585 /* Eckd can only do full blocks. */ 2586 return ERR_PTR(-EINVAL); 2587 count += bv.bv_len >> (block->s2b_shift + 9); 2588 #if defined(CONFIG_64BIT) 2589 if (idal_is_needed (page_address(bv.bv_page), bv.bv_len)) 2590 cidaw += bv.bv_len >> (block->s2b_shift + 9); 2591 #endif 2592 } 2593 /* Paranoia. */ 2594 if (count != last_rec - first_rec + 1) 2595 return ERR_PTR(-EINVAL); 2596 2597 /* use the prefix command if available */ 2598 use_prefix = private->features.feature[8] & 0x01; 2599 if (use_prefix) { 2600 /* 1x prefix + number of blocks */ 2601 cplength = 2 + count; 2602 /* 1x prefix + cidaws*sizeof(long) */ 2603 datasize = sizeof(struct PFX_eckd_data) + 2604 sizeof(struct LO_eckd_data) + 2605 cidaw * sizeof(unsigned long); 2606 } else { 2607 /* 1x define extent + 1x locate record + number of blocks */ 2608 cplength = 2 + count; 2609 /* 1x define extent + 1x locate record + cidaws*sizeof(long) */ 2610 datasize = sizeof(struct DE_eckd_data) + 2611 sizeof(struct LO_eckd_data) + 2612 cidaw * sizeof(unsigned long); 2613 } 2614 /* Find out the number of additional locate record ccws for cdl. */ 2615 if (private->uses_cdl && first_rec < 2*blk_per_trk) { 2616 if (last_rec >= 2*blk_per_trk) 2617 count = 2*blk_per_trk - first_rec; 2618 cplength += count; 2619 datasize += count*sizeof(struct LO_eckd_data); 2620 } 2621 /* Allocate the ccw request. */ 2622 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, 2623 startdev); 2624 if (IS_ERR(cqr)) 2625 return cqr; 2626 ccw = cqr->cpaddr; 2627 /* First ccw is define extent or prefix. */ 2628 if (use_prefix) { 2629 if (prefix(ccw++, cqr->data, first_trk, 2630 last_trk, cmd, basedev, startdev) == -EAGAIN) { 2631 /* Clock not in sync and XRC is enabled. 2632 * Try again later. 2633 */ 2634 dasd_sfree_request(cqr, startdev); 2635 return ERR_PTR(-EAGAIN); 2636 } 2637 idaws = (unsigned long *) (cqr->data + 2638 sizeof(struct PFX_eckd_data)); 2639 } else { 2640 if (define_extent(ccw++, cqr->data, first_trk, 2641 last_trk, cmd, basedev) == -EAGAIN) { 2642 /* Clock not in sync and XRC is enabled. 2643 * Try again later. 2644 */ 2645 dasd_sfree_request(cqr, startdev); 2646 return ERR_PTR(-EAGAIN); 2647 } 2648 idaws = (unsigned long *) (cqr->data + 2649 sizeof(struct DE_eckd_data)); 2650 } 2651 /* Build locate_record+read/write/ccws. */ 2652 LO_data = (struct LO_eckd_data *) (idaws + cidaw); 2653 recid = first_rec; 2654 if (private->uses_cdl == 0 || recid > 2*blk_per_trk) { 2655 /* Only standard blocks so there is just one locate record. */ 2656 ccw[-1].flags |= CCW_FLAG_CC; 2657 locate_record(ccw++, LO_data++, first_trk, first_offs + 1, 2658 last_rec - recid + 1, cmd, basedev, blksize); 2659 } 2660 rq_for_each_segment(bv, req, iter) { 2661 dst = page_address(bv.bv_page) + bv.bv_offset; 2662 if (dasd_page_cache) { 2663 char *copy = kmem_cache_alloc(dasd_page_cache, 2664 GFP_DMA | __GFP_NOWARN); 2665 if (copy && rq_data_dir(req) == WRITE) 2666 memcpy(copy + bv.bv_offset, dst, bv.bv_len); 2667 if (copy) 2668 dst = copy + bv.bv_offset; 2669 } 2670 for (off = 0; off < bv.bv_len; off += blksize) { 2671 sector_t trkid = recid; 2672 unsigned int recoffs = sector_div(trkid, blk_per_trk); 2673 rcmd = cmd; 2674 count = blksize; 2675 /* Locate record for cdl special block ? */ 2676 if (private->uses_cdl && recid < 2*blk_per_trk) { 2677 if (dasd_eckd_cdl_special(blk_per_trk, recid)){ 2678 rcmd |= 0x8; 2679 count = dasd_eckd_cdl_reclen(recid); 2680 if (count < blksize && 2681 rq_data_dir(req) == READ) 2682 memset(dst + count, 0xe5, 2683 blksize - count); 2684 } 2685 ccw[-1].flags |= CCW_FLAG_CC; 2686 locate_record(ccw++, LO_data++, 2687 trkid, recoffs + 1, 2688 1, rcmd, basedev, count); 2689 } 2690 /* Locate record for standard blocks ? */ 2691 if (private->uses_cdl && recid == 2*blk_per_trk) { 2692 ccw[-1].flags |= CCW_FLAG_CC; 2693 locate_record(ccw++, LO_data++, 2694 trkid, recoffs + 1, 2695 last_rec - recid + 1, 2696 cmd, basedev, count); 2697 } 2698 /* Read/write ccw. */ 2699 ccw[-1].flags |= CCW_FLAG_CC; 2700 ccw->cmd_code = rcmd; 2701 ccw->count = count; 2702 if (idal_is_needed(dst, blksize)) { 2703 ccw->cda = (__u32)(addr_t) idaws; 2704 ccw->flags = CCW_FLAG_IDA; 2705 idaws = idal_create_words(idaws, dst, blksize); 2706 } else { 2707 ccw->cda = (__u32)(addr_t) dst; 2708 ccw->flags = 0; 2709 } 2710 ccw++; 2711 dst += blksize; 2712 recid++; 2713 } 2714 } 2715 if (blk_noretry_request(req) || 2716 block->base->features & DASD_FEATURE_FAILFAST) 2717 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 2718 cqr->startdev = startdev; 2719 cqr->memdev = startdev; 2720 cqr->block = block; 2721 cqr->expires = startdev->default_expires * HZ; /* default 5 minutes */ 2722 cqr->lpm = startdev->path_data.ppm; 2723 cqr->retries = startdev->default_retries; 2724 cqr->buildclk = get_tod_clock(); 2725 cqr->status = DASD_CQR_FILLED; 2726 return cqr; 2727 } 2728 2729 static struct dasd_ccw_req *dasd_eckd_build_cp_cmd_track( 2730 struct dasd_device *startdev, 2731 struct dasd_block *block, 2732 struct request *req, 2733 sector_t first_rec, 2734 sector_t last_rec, 2735 sector_t first_trk, 2736 sector_t last_trk, 2737 unsigned int first_offs, 2738 unsigned int last_offs, 2739 unsigned int blk_per_trk, 2740 unsigned int blksize) 2741 { 2742 unsigned long *idaws; 2743 struct dasd_ccw_req *cqr; 2744 struct ccw1 *ccw; 2745 struct req_iterator iter; 2746 struct bio_vec bv; 2747 char *dst, *idaw_dst; 2748 unsigned int cidaw, cplength, datasize; 2749 unsigned int tlf; 2750 sector_t recid; 2751 unsigned char cmd; 2752 struct dasd_device *basedev; 2753 unsigned int trkcount, count, count_to_trk_end; 2754 unsigned int idaw_len, seg_len, part_len, len_to_track_end; 2755 unsigned char new_track, end_idaw; 2756 sector_t trkid; 2757 unsigned int recoffs; 2758 2759 basedev = block->base; 2760 if (rq_data_dir(req) == READ) 2761 cmd = DASD_ECKD_CCW_READ_TRACK_DATA; 2762 else if (rq_data_dir(req) == WRITE) 2763 cmd = DASD_ECKD_CCW_WRITE_TRACK_DATA; 2764 else 2765 return ERR_PTR(-EINVAL); 2766 2767 /* Track based I/O needs IDAWs for each page, and not just for 2768 * 64 bit addresses. We need additional idals for pages 2769 * that get filled from two tracks, so we use the number 2770 * of records as upper limit. 2771 */ 2772 cidaw = last_rec - first_rec + 1; 2773 trkcount = last_trk - first_trk + 1; 2774 2775 /* 1x prefix + one read/write ccw per track */ 2776 cplength = 1 + trkcount; 2777 2778 /* on 31-bit we need space for two 32 bit addresses per page 2779 * on 64-bit one 64 bit address 2780 */ 2781 datasize = sizeof(struct PFX_eckd_data) + 2782 cidaw * sizeof(unsigned long long); 2783 2784 /* Allocate the ccw request. */ 2785 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, datasize, 2786 startdev); 2787 if (IS_ERR(cqr)) 2788 return cqr; 2789 ccw = cqr->cpaddr; 2790 /* transfer length factor: how many bytes to read from the last track */ 2791 if (first_trk == last_trk) 2792 tlf = last_offs - first_offs + 1; 2793 else 2794 tlf = last_offs + 1; 2795 tlf *= blksize; 2796 2797 if (prefix_LRE(ccw++, cqr->data, first_trk, 2798 last_trk, cmd, basedev, startdev, 2799 1 /* format */, first_offs + 1, 2800 trkcount, blksize, 2801 tlf) == -EAGAIN) { 2802 /* Clock not in sync and XRC is enabled. 2803 * Try again later. 2804 */ 2805 dasd_sfree_request(cqr, startdev); 2806 return ERR_PTR(-EAGAIN); 2807 } 2808 2809 /* 2810 * The translation of request into ccw programs must meet the 2811 * following conditions: 2812 * - all idaws but the first and the last must address full pages 2813 * (or 2K blocks on 31-bit) 2814 * - the scope of a ccw and it's idal ends with the track boundaries 2815 */ 2816 idaws = (unsigned long *) (cqr->data + sizeof(struct PFX_eckd_data)); 2817 recid = first_rec; 2818 new_track = 1; 2819 end_idaw = 0; 2820 len_to_track_end = 0; 2821 idaw_dst = NULL; 2822 idaw_len = 0; 2823 rq_for_each_segment(bv, req, iter) { 2824 dst = page_address(bv.bv_page) + bv.bv_offset; 2825 seg_len = bv.bv_len; 2826 while (seg_len) { 2827 if (new_track) { 2828 trkid = recid; 2829 recoffs = sector_div(trkid, blk_per_trk); 2830 count_to_trk_end = blk_per_trk - recoffs; 2831 count = min((last_rec - recid + 1), 2832 (sector_t)count_to_trk_end); 2833 len_to_track_end = count * blksize; 2834 ccw[-1].flags |= CCW_FLAG_CC; 2835 ccw->cmd_code = cmd; 2836 ccw->count = len_to_track_end; 2837 ccw->cda = (__u32)(addr_t)idaws; 2838 ccw->flags = CCW_FLAG_IDA; 2839 ccw++; 2840 recid += count; 2841 new_track = 0; 2842 /* first idaw for a ccw may start anywhere */ 2843 if (!idaw_dst) 2844 idaw_dst = dst; 2845 } 2846 /* If we start a new idaw, we must make sure that it 2847 * starts on an IDA_BLOCK_SIZE boundary. 2848 * If we continue an idaw, we must make sure that the 2849 * current segment begins where the so far accumulated 2850 * idaw ends 2851 */ 2852 if (!idaw_dst) { 2853 if (__pa(dst) & (IDA_BLOCK_SIZE-1)) { 2854 dasd_sfree_request(cqr, startdev); 2855 return ERR_PTR(-ERANGE); 2856 } else 2857 idaw_dst = dst; 2858 } 2859 if ((idaw_dst + idaw_len) != dst) { 2860 dasd_sfree_request(cqr, startdev); 2861 return ERR_PTR(-ERANGE); 2862 } 2863 part_len = min(seg_len, len_to_track_end); 2864 seg_len -= part_len; 2865 dst += part_len; 2866 idaw_len += part_len; 2867 len_to_track_end -= part_len; 2868 /* collected memory area ends on an IDA_BLOCK border, 2869 * -> create an idaw 2870 * idal_create_words will handle cases where idaw_len 2871 * is larger then IDA_BLOCK_SIZE 2872 */ 2873 if (!(__pa(idaw_dst + idaw_len) & (IDA_BLOCK_SIZE-1))) 2874 end_idaw = 1; 2875 /* We also need to end the idaw at track end */ 2876 if (!len_to_track_end) { 2877 new_track = 1; 2878 end_idaw = 1; 2879 } 2880 if (end_idaw) { 2881 idaws = idal_create_words(idaws, idaw_dst, 2882 idaw_len); 2883 idaw_dst = NULL; 2884 idaw_len = 0; 2885 end_idaw = 0; 2886 } 2887 } 2888 } 2889 2890 if (blk_noretry_request(req) || 2891 block->base->features & DASD_FEATURE_FAILFAST) 2892 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 2893 cqr->startdev = startdev; 2894 cqr->memdev = startdev; 2895 cqr->block = block; 2896 cqr->expires = startdev->default_expires * HZ; /* default 5 minutes */ 2897 cqr->lpm = startdev->path_data.ppm; 2898 cqr->retries = startdev->default_retries; 2899 cqr->buildclk = get_tod_clock(); 2900 cqr->status = DASD_CQR_FILLED; 2901 return cqr; 2902 } 2903 2904 static int prepare_itcw(struct itcw *itcw, 2905 unsigned int trk, unsigned int totrk, int cmd, 2906 struct dasd_device *basedev, 2907 struct dasd_device *startdev, 2908 unsigned int rec_on_trk, int count, 2909 unsigned int blksize, 2910 unsigned int total_data_size, 2911 unsigned int tlf, 2912 unsigned int blk_per_trk) 2913 { 2914 struct PFX_eckd_data pfxdata; 2915 struct dasd_eckd_private *basepriv, *startpriv; 2916 struct DE_eckd_data *dedata; 2917 struct LRE_eckd_data *lredata; 2918 struct dcw *dcw; 2919 2920 u32 begcyl, endcyl; 2921 u16 heads, beghead, endhead; 2922 u8 pfx_cmd; 2923 2924 int rc = 0; 2925 int sector = 0; 2926 int dn, d; 2927 2928 2929 /* setup prefix data */ 2930 basepriv = (struct dasd_eckd_private *) basedev->private; 2931 startpriv = (struct dasd_eckd_private *) startdev->private; 2932 dedata = &pfxdata.define_extent; 2933 lredata = &pfxdata.locate_record; 2934 2935 memset(&pfxdata, 0, sizeof(pfxdata)); 2936 pfxdata.format = 1; /* PFX with LRE */ 2937 pfxdata.base_address = basepriv->ned->unit_addr; 2938 pfxdata.base_lss = basepriv->ned->ID; 2939 pfxdata.validity.define_extent = 1; 2940 2941 /* private uid is kept up to date, conf_data may be outdated */ 2942 if (startpriv->uid.type != UA_BASE_DEVICE) { 2943 pfxdata.validity.verify_base = 1; 2944 if (startpriv->uid.type == UA_HYPER_PAV_ALIAS) 2945 pfxdata.validity.hyper_pav = 1; 2946 } 2947 2948 switch (cmd) { 2949 case DASD_ECKD_CCW_READ_TRACK_DATA: 2950 dedata->mask.perm = 0x1; 2951 dedata->attributes.operation = basepriv->attrib.operation; 2952 dedata->blk_size = blksize; 2953 dedata->ga_extended |= 0x42; 2954 lredata->operation.orientation = 0x0; 2955 lredata->operation.operation = 0x0C; 2956 lredata->auxiliary.check_bytes = 0x01; 2957 pfx_cmd = DASD_ECKD_CCW_PFX_READ; 2958 break; 2959 case DASD_ECKD_CCW_WRITE_TRACK_DATA: 2960 dedata->mask.perm = 0x02; 2961 dedata->attributes.operation = basepriv->attrib.operation; 2962 dedata->blk_size = blksize; 2963 rc = check_XRC_on_prefix(&pfxdata, basedev); 2964 dedata->ga_extended |= 0x42; 2965 lredata->operation.orientation = 0x0; 2966 lredata->operation.operation = 0x3F; 2967 lredata->extended_operation = 0x23; 2968 lredata->auxiliary.check_bytes = 0x2; 2969 pfx_cmd = DASD_ECKD_CCW_PFX; 2970 break; 2971 default: 2972 DBF_DEV_EVENT(DBF_ERR, basedev, 2973 "prepare itcw, unknown opcode 0x%x", cmd); 2974 BUG(); 2975 break; 2976 } 2977 if (rc) 2978 return rc; 2979 2980 dedata->attributes.mode = 0x3; /* ECKD */ 2981 2982 heads = basepriv->rdc_data.trk_per_cyl; 2983 begcyl = trk / heads; 2984 beghead = trk % heads; 2985 endcyl = totrk / heads; 2986 endhead = totrk % heads; 2987 2988 /* check for sequential prestage - enhance cylinder range */ 2989 if (dedata->attributes.operation == DASD_SEQ_PRESTAGE || 2990 dedata->attributes.operation == DASD_SEQ_ACCESS) { 2991 2992 if (endcyl + basepriv->attrib.nr_cyl < basepriv->real_cyl) 2993 endcyl += basepriv->attrib.nr_cyl; 2994 else 2995 endcyl = (basepriv->real_cyl - 1); 2996 } 2997 2998 set_ch_t(&dedata->beg_ext, begcyl, beghead); 2999 set_ch_t(&dedata->end_ext, endcyl, endhead); 3000 3001 dedata->ep_format = 0x20; /* records per track is valid */ 3002 dedata->ep_rec_per_track = blk_per_trk; 3003 3004 if (rec_on_trk) { 3005 switch (basepriv->rdc_data.dev_type) { 3006 case 0x3390: 3007 dn = ceil_quot(blksize + 6, 232); 3008 d = 9 + ceil_quot(blksize + 6 * (dn + 1), 34); 3009 sector = (49 + (rec_on_trk - 1) * (10 + d)) / 8; 3010 break; 3011 case 0x3380: 3012 d = 7 + ceil_quot(blksize + 12, 32); 3013 sector = (39 + (rec_on_trk - 1) * (8 + d)) / 7; 3014 break; 3015 } 3016 } 3017 3018 lredata->auxiliary.length_valid = 1; 3019 lredata->auxiliary.length_scope = 1; 3020 lredata->auxiliary.imbedded_ccw_valid = 1; 3021 lredata->length = tlf; 3022 lredata->imbedded_ccw = cmd; 3023 lredata->count = count; 3024 lredata->sector = sector; 3025 set_ch_t(&lredata->seek_addr, begcyl, beghead); 3026 lredata->search_arg.cyl = lredata->seek_addr.cyl; 3027 lredata->search_arg.head = lredata->seek_addr.head; 3028 lredata->search_arg.record = rec_on_trk; 3029 3030 dcw = itcw_add_dcw(itcw, pfx_cmd, 0, 3031 &pfxdata, sizeof(pfxdata), total_data_size); 3032 return PTR_RET(dcw); 3033 } 3034 3035 static struct dasd_ccw_req *dasd_eckd_build_cp_tpm_track( 3036 struct dasd_device *startdev, 3037 struct dasd_block *block, 3038 struct request *req, 3039 sector_t first_rec, 3040 sector_t last_rec, 3041 sector_t first_trk, 3042 sector_t last_trk, 3043 unsigned int first_offs, 3044 unsigned int last_offs, 3045 unsigned int blk_per_trk, 3046 unsigned int blksize) 3047 { 3048 struct dasd_ccw_req *cqr; 3049 struct req_iterator iter; 3050 struct bio_vec bv; 3051 char *dst; 3052 unsigned int trkcount, ctidaw; 3053 unsigned char cmd; 3054 struct dasd_device *basedev; 3055 unsigned int tlf; 3056 struct itcw *itcw; 3057 struct tidaw *last_tidaw = NULL; 3058 int itcw_op; 3059 size_t itcw_size; 3060 u8 tidaw_flags; 3061 unsigned int seg_len, part_len, len_to_track_end; 3062 unsigned char new_track; 3063 sector_t recid, trkid; 3064 unsigned int offs; 3065 unsigned int count, count_to_trk_end; 3066 int ret; 3067 3068 basedev = block->base; 3069 if (rq_data_dir(req) == READ) { 3070 cmd = DASD_ECKD_CCW_READ_TRACK_DATA; 3071 itcw_op = ITCW_OP_READ; 3072 } else if (rq_data_dir(req) == WRITE) { 3073 cmd = DASD_ECKD_CCW_WRITE_TRACK_DATA; 3074 itcw_op = ITCW_OP_WRITE; 3075 } else 3076 return ERR_PTR(-EINVAL); 3077 3078 /* trackbased I/O needs address all memory via TIDAWs, 3079 * not just for 64 bit addresses. This allows us to map 3080 * each segment directly to one tidaw. 3081 * In the case of write requests, additional tidaws may 3082 * be needed when a segment crosses a track boundary. 3083 */ 3084 trkcount = last_trk - first_trk + 1; 3085 ctidaw = 0; 3086 rq_for_each_segment(bv, req, iter) { 3087 ++ctidaw; 3088 } 3089 if (rq_data_dir(req) == WRITE) 3090 ctidaw += (last_trk - first_trk); 3091 3092 /* Allocate the ccw request. */ 3093 itcw_size = itcw_calc_size(0, ctidaw, 0); 3094 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 0, itcw_size, startdev); 3095 if (IS_ERR(cqr)) 3096 return cqr; 3097 3098 /* transfer length factor: how many bytes to read from the last track */ 3099 if (first_trk == last_trk) 3100 tlf = last_offs - first_offs + 1; 3101 else 3102 tlf = last_offs + 1; 3103 tlf *= blksize; 3104 3105 itcw = itcw_init(cqr->data, itcw_size, itcw_op, 0, ctidaw, 0); 3106 if (IS_ERR(itcw)) { 3107 ret = -EINVAL; 3108 goto out_error; 3109 } 3110 cqr->cpaddr = itcw_get_tcw(itcw); 3111 if (prepare_itcw(itcw, first_trk, last_trk, 3112 cmd, basedev, startdev, 3113 first_offs + 1, 3114 trkcount, blksize, 3115 (last_rec - first_rec + 1) * blksize, 3116 tlf, blk_per_trk) == -EAGAIN) { 3117 /* Clock not in sync and XRC is enabled. 3118 * Try again later. 3119 */ 3120 ret = -EAGAIN; 3121 goto out_error; 3122 } 3123 len_to_track_end = 0; 3124 /* 3125 * A tidaw can address 4k of memory, but must not cross page boundaries 3126 * We can let the block layer handle this by setting 3127 * blk_queue_segment_boundary to page boundaries and 3128 * blk_max_segment_size to page size when setting up the request queue. 3129 * For write requests, a TIDAW must not cross track boundaries, because 3130 * we have to set the CBC flag on the last tidaw for each track. 3131 */ 3132 if (rq_data_dir(req) == WRITE) { 3133 new_track = 1; 3134 recid = first_rec; 3135 rq_for_each_segment(bv, req, iter) { 3136 dst = page_address(bv.bv_page) + bv.bv_offset; 3137 seg_len = bv.bv_len; 3138 while (seg_len) { 3139 if (new_track) { 3140 trkid = recid; 3141 offs = sector_div(trkid, blk_per_trk); 3142 count_to_trk_end = blk_per_trk - offs; 3143 count = min((last_rec - recid + 1), 3144 (sector_t)count_to_trk_end); 3145 len_to_track_end = count * blksize; 3146 recid += count; 3147 new_track = 0; 3148 } 3149 part_len = min(seg_len, len_to_track_end); 3150 seg_len -= part_len; 3151 len_to_track_end -= part_len; 3152 /* We need to end the tidaw at track end */ 3153 if (!len_to_track_end) { 3154 new_track = 1; 3155 tidaw_flags = TIDAW_FLAGS_INSERT_CBC; 3156 } else 3157 tidaw_flags = 0; 3158 last_tidaw = itcw_add_tidaw(itcw, tidaw_flags, 3159 dst, part_len); 3160 if (IS_ERR(last_tidaw)) { 3161 ret = -EINVAL; 3162 goto out_error; 3163 } 3164 dst += part_len; 3165 } 3166 } 3167 } else { 3168 rq_for_each_segment(bv, req, iter) { 3169 dst = page_address(bv.bv_page) + bv.bv_offset; 3170 last_tidaw = itcw_add_tidaw(itcw, 0x00, 3171 dst, bv.bv_len); 3172 if (IS_ERR(last_tidaw)) { 3173 ret = -EINVAL; 3174 goto out_error; 3175 } 3176 } 3177 } 3178 last_tidaw->flags |= TIDAW_FLAGS_LAST; 3179 last_tidaw->flags &= ~TIDAW_FLAGS_INSERT_CBC; 3180 itcw_finalize(itcw); 3181 3182 if (blk_noretry_request(req) || 3183 block->base->features & DASD_FEATURE_FAILFAST) 3184 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 3185 cqr->cpmode = 1; 3186 cqr->startdev = startdev; 3187 cqr->memdev = startdev; 3188 cqr->block = block; 3189 cqr->expires = startdev->default_expires * HZ; /* default 5 minutes */ 3190 cqr->lpm = startdev->path_data.ppm; 3191 cqr->retries = startdev->default_retries; 3192 cqr->buildclk = get_tod_clock(); 3193 cqr->status = DASD_CQR_FILLED; 3194 return cqr; 3195 out_error: 3196 dasd_sfree_request(cqr, startdev); 3197 return ERR_PTR(ret); 3198 } 3199 3200 static struct dasd_ccw_req *dasd_eckd_build_cp(struct dasd_device *startdev, 3201 struct dasd_block *block, 3202 struct request *req) 3203 { 3204 int cmdrtd, cmdwtd; 3205 int use_prefix; 3206 int fcx_multitrack; 3207 struct dasd_eckd_private *private; 3208 struct dasd_device *basedev; 3209 sector_t first_rec, last_rec; 3210 sector_t first_trk, last_trk; 3211 unsigned int first_offs, last_offs; 3212 unsigned int blk_per_trk, blksize; 3213 int cdlspecial; 3214 unsigned int data_size; 3215 struct dasd_ccw_req *cqr; 3216 3217 basedev = block->base; 3218 private = (struct dasd_eckd_private *) basedev->private; 3219 3220 /* Calculate number of blocks/records per track. */ 3221 blksize = block->bp_block; 3222 blk_per_trk = recs_per_track(&private->rdc_data, 0, blksize); 3223 if (blk_per_trk == 0) 3224 return ERR_PTR(-EINVAL); 3225 /* Calculate record id of first and last block. */ 3226 first_rec = first_trk = blk_rq_pos(req) >> block->s2b_shift; 3227 first_offs = sector_div(first_trk, blk_per_trk); 3228 last_rec = last_trk = 3229 (blk_rq_pos(req) + blk_rq_sectors(req) - 1) >> block->s2b_shift; 3230 last_offs = sector_div(last_trk, blk_per_trk); 3231 cdlspecial = (private->uses_cdl && first_rec < 2*blk_per_trk); 3232 3233 fcx_multitrack = private->features.feature[40] & 0x20; 3234 data_size = blk_rq_bytes(req); 3235 if (data_size % blksize) 3236 return ERR_PTR(-EINVAL); 3237 /* tpm write request add CBC data on each track boundary */ 3238 if (rq_data_dir(req) == WRITE) 3239 data_size += (last_trk - first_trk) * 4; 3240 3241 /* is read track data and write track data in command mode supported? */ 3242 cmdrtd = private->features.feature[9] & 0x20; 3243 cmdwtd = private->features.feature[12] & 0x40; 3244 use_prefix = private->features.feature[8] & 0x01; 3245 3246 cqr = NULL; 3247 if (cdlspecial || dasd_page_cache) { 3248 /* do nothing, just fall through to the cmd mode single case */ 3249 } else if ((data_size <= private->fcx_max_data) 3250 && (fcx_multitrack || (first_trk == last_trk))) { 3251 cqr = dasd_eckd_build_cp_tpm_track(startdev, block, req, 3252 first_rec, last_rec, 3253 first_trk, last_trk, 3254 first_offs, last_offs, 3255 blk_per_trk, blksize); 3256 if (IS_ERR(cqr) && (PTR_ERR(cqr) != -EAGAIN) && 3257 (PTR_ERR(cqr) != -ENOMEM)) 3258 cqr = NULL; 3259 } else if (use_prefix && 3260 (((rq_data_dir(req) == READ) && cmdrtd) || 3261 ((rq_data_dir(req) == WRITE) && cmdwtd))) { 3262 cqr = dasd_eckd_build_cp_cmd_track(startdev, block, req, 3263 first_rec, last_rec, 3264 first_trk, last_trk, 3265 first_offs, last_offs, 3266 blk_per_trk, blksize); 3267 if (IS_ERR(cqr) && (PTR_ERR(cqr) != -EAGAIN) && 3268 (PTR_ERR(cqr) != -ENOMEM)) 3269 cqr = NULL; 3270 } 3271 if (!cqr) 3272 cqr = dasd_eckd_build_cp_cmd_single(startdev, block, req, 3273 first_rec, last_rec, 3274 first_trk, last_trk, 3275 first_offs, last_offs, 3276 blk_per_trk, blksize); 3277 return cqr; 3278 } 3279 3280 static struct dasd_ccw_req *dasd_raw_build_cp(struct dasd_device *startdev, 3281 struct dasd_block *block, 3282 struct request *req) 3283 { 3284 unsigned long *idaws; 3285 struct dasd_device *basedev; 3286 struct dasd_ccw_req *cqr; 3287 struct ccw1 *ccw; 3288 struct req_iterator iter; 3289 struct bio_vec bv; 3290 char *dst; 3291 unsigned char cmd; 3292 unsigned int trkcount; 3293 unsigned int seg_len, len_to_track_end; 3294 unsigned int first_offs; 3295 unsigned int cidaw, cplength, datasize; 3296 sector_t first_trk, last_trk, sectors; 3297 sector_t start_padding_sectors, end_sector_offset, end_padding_sectors; 3298 unsigned int pfx_datasize; 3299 3300 /* 3301 * raw track access needs to be mutiple of 64k and on 64k boundary 3302 * For read requests we can fix an incorrect alignment by padding 3303 * the request with dummy pages. 3304 */ 3305 start_padding_sectors = blk_rq_pos(req) % DASD_RAW_SECTORS_PER_TRACK; 3306 end_sector_offset = (blk_rq_pos(req) + blk_rq_sectors(req)) % 3307 DASD_RAW_SECTORS_PER_TRACK; 3308 end_padding_sectors = (DASD_RAW_SECTORS_PER_TRACK - end_sector_offset) % 3309 DASD_RAW_SECTORS_PER_TRACK; 3310 basedev = block->base; 3311 if ((start_padding_sectors || end_padding_sectors) && 3312 (rq_data_dir(req) == WRITE)) { 3313 DBF_DEV_EVENT(DBF_ERR, basedev, 3314 "raw write not track aligned (%lu,%lu) req %p", 3315 start_padding_sectors, end_padding_sectors, req); 3316 cqr = ERR_PTR(-EINVAL); 3317 goto out; 3318 } 3319 3320 first_trk = blk_rq_pos(req) / DASD_RAW_SECTORS_PER_TRACK; 3321 last_trk = (blk_rq_pos(req) + blk_rq_sectors(req) - 1) / 3322 DASD_RAW_SECTORS_PER_TRACK; 3323 trkcount = last_trk - first_trk + 1; 3324 first_offs = 0; 3325 3326 if (rq_data_dir(req) == READ) 3327 cmd = DASD_ECKD_CCW_READ_TRACK; 3328 else if (rq_data_dir(req) == WRITE) 3329 cmd = DASD_ECKD_CCW_WRITE_FULL_TRACK; 3330 else { 3331 cqr = ERR_PTR(-EINVAL); 3332 goto out; 3333 } 3334 3335 /* 3336 * Raw track based I/O needs IDAWs for each page, 3337 * and not just for 64 bit addresses. 3338 */ 3339 cidaw = trkcount * DASD_RAW_BLOCK_PER_TRACK; 3340 3341 /* 1x prefix + one read/write ccw per track */ 3342 cplength = 1 + trkcount; 3343 3344 /* 3345 * struct PFX_eckd_data has up to 2 byte as extended parameter 3346 * this is needed for write full track and has to be mentioned 3347 * separately 3348 * add 8 instead of 2 to keep 8 byte boundary 3349 */ 3350 pfx_datasize = sizeof(struct PFX_eckd_data) + 8; 3351 3352 datasize = pfx_datasize + cidaw * sizeof(unsigned long long); 3353 3354 /* Allocate the ccw request. */ 3355 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, cplength, 3356 datasize, startdev); 3357 if (IS_ERR(cqr)) 3358 goto out; 3359 ccw = cqr->cpaddr; 3360 3361 if (prefix_LRE(ccw++, cqr->data, first_trk, last_trk, cmd, 3362 basedev, startdev, 1 /* format */, first_offs + 1, 3363 trkcount, 0, 0) == -EAGAIN) { 3364 /* Clock not in sync and XRC is enabled. 3365 * Try again later. 3366 */ 3367 dasd_sfree_request(cqr, startdev); 3368 cqr = ERR_PTR(-EAGAIN); 3369 goto out; 3370 } 3371 3372 idaws = (unsigned long *)(cqr->data + pfx_datasize); 3373 len_to_track_end = 0; 3374 if (start_padding_sectors) { 3375 ccw[-1].flags |= CCW_FLAG_CC; 3376 ccw->cmd_code = cmd; 3377 /* maximum 3390 track size */ 3378 ccw->count = 57326; 3379 /* 64k map to one track */ 3380 len_to_track_end = 65536 - start_padding_sectors * 512; 3381 ccw->cda = (__u32)(addr_t)idaws; 3382 ccw->flags |= CCW_FLAG_IDA; 3383 ccw->flags |= CCW_FLAG_SLI; 3384 ccw++; 3385 for (sectors = 0; sectors < start_padding_sectors; sectors += 8) 3386 idaws = idal_create_words(idaws, rawpadpage, PAGE_SIZE); 3387 } 3388 rq_for_each_segment(bv, req, iter) { 3389 dst = page_address(bv.bv_page) + bv.bv_offset; 3390 seg_len = bv.bv_len; 3391 if (cmd == DASD_ECKD_CCW_READ_TRACK) 3392 memset(dst, 0, seg_len); 3393 if (!len_to_track_end) { 3394 ccw[-1].flags |= CCW_FLAG_CC; 3395 ccw->cmd_code = cmd; 3396 /* maximum 3390 track size */ 3397 ccw->count = 57326; 3398 /* 64k map to one track */ 3399 len_to_track_end = 65536; 3400 ccw->cda = (__u32)(addr_t)idaws; 3401 ccw->flags |= CCW_FLAG_IDA; 3402 ccw->flags |= CCW_FLAG_SLI; 3403 ccw++; 3404 } 3405 len_to_track_end -= seg_len; 3406 idaws = idal_create_words(idaws, dst, seg_len); 3407 } 3408 for (sectors = 0; sectors < end_padding_sectors; sectors += 8) 3409 idaws = idal_create_words(idaws, rawpadpage, PAGE_SIZE); 3410 if (blk_noretry_request(req) || 3411 block->base->features & DASD_FEATURE_FAILFAST) 3412 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 3413 cqr->startdev = startdev; 3414 cqr->memdev = startdev; 3415 cqr->block = block; 3416 cqr->expires = startdev->default_expires * HZ; 3417 cqr->lpm = startdev->path_data.ppm; 3418 cqr->retries = startdev->default_retries; 3419 cqr->buildclk = get_tod_clock(); 3420 cqr->status = DASD_CQR_FILLED; 3421 3422 if (IS_ERR(cqr) && PTR_ERR(cqr) != -EAGAIN) 3423 cqr = NULL; 3424 out: 3425 return cqr; 3426 } 3427 3428 3429 static int 3430 dasd_eckd_free_cp(struct dasd_ccw_req *cqr, struct request *req) 3431 { 3432 struct dasd_eckd_private *private; 3433 struct ccw1 *ccw; 3434 struct req_iterator iter; 3435 struct bio_vec bv; 3436 char *dst, *cda; 3437 unsigned int blksize, blk_per_trk, off; 3438 sector_t recid; 3439 int status; 3440 3441 if (!dasd_page_cache) 3442 goto out; 3443 private = (struct dasd_eckd_private *) cqr->block->base->private; 3444 blksize = cqr->block->bp_block; 3445 blk_per_trk = recs_per_track(&private->rdc_data, 0, blksize); 3446 recid = blk_rq_pos(req) >> cqr->block->s2b_shift; 3447 ccw = cqr->cpaddr; 3448 /* Skip over define extent & locate record. */ 3449 ccw++; 3450 if (private->uses_cdl == 0 || recid > 2*blk_per_trk) 3451 ccw++; 3452 rq_for_each_segment(bv, req, iter) { 3453 dst = page_address(bv.bv_page) + bv.bv_offset; 3454 for (off = 0; off < bv.bv_len; off += blksize) { 3455 /* Skip locate record. */ 3456 if (private->uses_cdl && recid <= 2*blk_per_trk) 3457 ccw++; 3458 if (dst) { 3459 if (ccw->flags & CCW_FLAG_IDA) 3460 cda = *((char **)((addr_t) ccw->cda)); 3461 else 3462 cda = (char *)((addr_t) ccw->cda); 3463 if (dst != cda) { 3464 if (rq_data_dir(req) == READ) 3465 memcpy(dst, cda, bv.bv_len); 3466 kmem_cache_free(dasd_page_cache, 3467 (void *)((addr_t)cda & PAGE_MASK)); 3468 } 3469 dst = NULL; 3470 } 3471 ccw++; 3472 recid++; 3473 } 3474 } 3475 out: 3476 status = cqr->status == DASD_CQR_DONE; 3477 dasd_sfree_request(cqr, cqr->memdev); 3478 return status; 3479 } 3480 3481 /* 3482 * Modify ccw/tcw in cqr so it can be started on a base device. 3483 * 3484 * Note that this is not enough to restart the cqr! 3485 * Either reset cqr->startdev as well (summary unit check handling) 3486 * or restart via separate cqr (as in ERP handling). 3487 */ 3488 void dasd_eckd_reset_ccw_to_base_io(struct dasd_ccw_req *cqr) 3489 { 3490 struct ccw1 *ccw; 3491 struct PFX_eckd_data *pfxdata; 3492 struct tcw *tcw; 3493 struct tccb *tccb; 3494 struct dcw *dcw; 3495 3496 if (cqr->cpmode == 1) { 3497 tcw = cqr->cpaddr; 3498 tccb = tcw_get_tccb(tcw); 3499 dcw = (struct dcw *)&tccb->tca[0]; 3500 pfxdata = (struct PFX_eckd_data *)&dcw->cd[0]; 3501 pfxdata->validity.verify_base = 0; 3502 pfxdata->validity.hyper_pav = 0; 3503 } else { 3504 ccw = cqr->cpaddr; 3505 pfxdata = cqr->data; 3506 if (ccw->cmd_code == DASD_ECKD_CCW_PFX) { 3507 pfxdata->validity.verify_base = 0; 3508 pfxdata->validity.hyper_pav = 0; 3509 } 3510 } 3511 } 3512 3513 #define DASD_ECKD_CHANQ_MAX_SIZE 4 3514 3515 static struct dasd_ccw_req *dasd_eckd_build_alias_cp(struct dasd_device *base, 3516 struct dasd_block *block, 3517 struct request *req) 3518 { 3519 struct dasd_eckd_private *private; 3520 struct dasd_device *startdev; 3521 unsigned long flags; 3522 struct dasd_ccw_req *cqr; 3523 3524 startdev = dasd_alias_get_start_dev(base); 3525 if (!startdev) 3526 startdev = base; 3527 private = (struct dasd_eckd_private *) startdev->private; 3528 if (private->count >= DASD_ECKD_CHANQ_MAX_SIZE) 3529 return ERR_PTR(-EBUSY); 3530 3531 spin_lock_irqsave(get_ccwdev_lock(startdev->cdev), flags); 3532 private->count++; 3533 if ((base->features & DASD_FEATURE_USERAW)) 3534 cqr = dasd_raw_build_cp(startdev, block, req); 3535 else 3536 cqr = dasd_eckd_build_cp(startdev, block, req); 3537 if (IS_ERR(cqr)) 3538 private->count--; 3539 spin_unlock_irqrestore(get_ccwdev_lock(startdev->cdev), flags); 3540 return cqr; 3541 } 3542 3543 static int dasd_eckd_free_alias_cp(struct dasd_ccw_req *cqr, 3544 struct request *req) 3545 { 3546 struct dasd_eckd_private *private; 3547 unsigned long flags; 3548 3549 spin_lock_irqsave(get_ccwdev_lock(cqr->memdev->cdev), flags); 3550 private = (struct dasd_eckd_private *) cqr->memdev->private; 3551 private->count--; 3552 spin_unlock_irqrestore(get_ccwdev_lock(cqr->memdev->cdev), flags); 3553 return dasd_eckd_free_cp(cqr, req); 3554 } 3555 3556 static int 3557 dasd_eckd_fill_info(struct dasd_device * device, 3558 struct dasd_information2_t * info) 3559 { 3560 struct dasd_eckd_private *private; 3561 3562 private = (struct dasd_eckd_private *) device->private; 3563 info->label_block = 2; 3564 info->FBA_layout = private->uses_cdl ? 0 : 1; 3565 info->format = private->uses_cdl ? DASD_FORMAT_CDL : DASD_FORMAT_LDL; 3566 info->characteristics_size = sizeof(struct dasd_eckd_characteristics); 3567 memcpy(info->characteristics, &private->rdc_data, 3568 sizeof(struct dasd_eckd_characteristics)); 3569 info->confdata_size = min((unsigned long)private->conf_len, 3570 sizeof(info->configuration_data)); 3571 memcpy(info->configuration_data, private->conf_data, 3572 info->confdata_size); 3573 return 0; 3574 } 3575 3576 /* 3577 * SECTION: ioctl functions for eckd devices. 3578 */ 3579 3580 /* 3581 * Release device ioctl. 3582 * Buils a channel programm to releases a prior reserved 3583 * (see dasd_eckd_reserve) device. 3584 */ 3585 static int 3586 dasd_eckd_release(struct dasd_device *device) 3587 { 3588 struct dasd_ccw_req *cqr; 3589 int rc; 3590 struct ccw1 *ccw; 3591 int useglobal; 3592 3593 if (!capable(CAP_SYS_ADMIN)) 3594 return -EACCES; 3595 3596 useglobal = 0; 3597 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device); 3598 if (IS_ERR(cqr)) { 3599 mutex_lock(&dasd_reserve_mutex); 3600 useglobal = 1; 3601 cqr = &dasd_reserve_req->cqr; 3602 memset(cqr, 0, sizeof(*cqr)); 3603 memset(&dasd_reserve_req->ccw, 0, 3604 sizeof(dasd_reserve_req->ccw)); 3605 cqr->cpaddr = &dasd_reserve_req->ccw; 3606 cqr->data = &dasd_reserve_req->data; 3607 cqr->magic = DASD_ECKD_MAGIC; 3608 } 3609 ccw = cqr->cpaddr; 3610 ccw->cmd_code = DASD_ECKD_CCW_RELEASE; 3611 ccw->flags |= CCW_FLAG_SLI; 3612 ccw->count = 32; 3613 ccw->cda = (__u32)(addr_t) cqr->data; 3614 cqr->startdev = device; 3615 cqr->memdev = device; 3616 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 3617 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 3618 cqr->retries = 2; /* set retry counter to enable basic ERP */ 3619 cqr->expires = 2 * HZ; 3620 cqr->buildclk = get_tod_clock(); 3621 cqr->status = DASD_CQR_FILLED; 3622 3623 rc = dasd_sleep_on_immediatly(cqr); 3624 if (!rc) 3625 clear_bit(DASD_FLAG_IS_RESERVED, &device->flags); 3626 3627 if (useglobal) 3628 mutex_unlock(&dasd_reserve_mutex); 3629 else 3630 dasd_sfree_request(cqr, cqr->memdev); 3631 return rc; 3632 } 3633 3634 /* 3635 * Reserve device ioctl. 3636 * Options are set to 'synchronous wait for interrupt' and 3637 * 'timeout the request'. This leads to a terminate IO if 3638 * the interrupt is outstanding for a certain time. 3639 */ 3640 static int 3641 dasd_eckd_reserve(struct dasd_device *device) 3642 { 3643 struct dasd_ccw_req *cqr; 3644 int rc; 3645 struct ccw1 *ccw; 3646 int useglobal; 3647 3648 if (!capable(CAP_SYS_ADMIN)) 3649 return -EACCES; 3650 3651 useglobal = 0; 3652 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device); 3653 if (IS_ERR(cqr)) { 3654 mutex_lock(&dasd_reserve_mutex); 3655 useglobal = 1; 3656 cqr = &dasd_reserve_req->cqr; 3657 memset(cqr, 0, sizeof(*cqr)); 3658 memset(&dasd_reserve_req->ccw, 0, 3659 sizeof(dasd_reserve_req->ccw)); 3660 cqr->cpaddr = &dasd_reserve_req->ccw; 3661 cqr->data = &dasd_reserve_req->data; 3662 cqr->magic = DASD_ECKD_MAGIC; 3663 } 3664 ccw = cqr->cpaddr; 3665 ccw->cmd_code = DASD_ECKD_CCW_RESERVE; 3666 ccw->flags |= CCW_FLAG_SLI; 3667 ccw->count = 32; 3668 ccw->cda = (__u32)(addr_t) cqr->data; 3669 cqr->startdev = device; 3670 cqr->memdev = device; 3671 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 3672 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 3673 cqr->retries = 2; /* set retry counter to enable basic ERP */ 3674 cqr->expires = 2 * HZ; 3675 cqr->buildclk = get_tod_clock(); 3676 cqr->status = DASD_CQR_FILLED; 3677 3678 rc = dasd_sleep_on_immediatly(cqr); 3679 if (!rc) 3680 set_bit(DASD_FLAG_IS_RESERVED, &device->flags); 3681 3682 if (useglobal) 3683 mutex_unlock(&dasd_reserve_mutex); 3684 else 3685 dasd_sfree_request(cqr, cqr->memdev); 3686 return rc; 3687 } 3688 3689 /* 3690 * Steal lock ioctl - unconditional reserve device. 3691 * Buils a channel programm to break a device's reservation. 3692 * (unconditional reserve) 3693 */ 3694 static int 3695 dasd_eckd_steal_lock(struct dasd_device *device) 3696 { 3697 struct dasd_ccw_req *cqr; 3698 int rc; 3699 struct ccw1 *ccw; 3700 int useglobal; 3701 3702 if (!capable(CAP_SYS_ADMIN)) 3703 return -EACCES; 3704 3705 useglobal = 0; 3706 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 32, device); 3707 if (IS_ERR(cqr)) { 3708 mutex_lock(&dasd_reserve_mutex); 3709 useglobal = 1; 3710 cqr = &dasd_reserve_req->cqr; 3711 memset(cqr, 0, sizeof(*cqr)); 3712 memset(&dasd_reserve_req->ccw, 0, 3713 sizeof(dasd_reserve_req->ccw)); 3714 cqr->cpaddr = &dasd_reserve_req->ccw; 3715 cqr->data = &dasd_reserve_req->data; 3716 cqr->magic = DASD_ECKD_MAGIC; 3717 } 3718 ccw = cqr->cpaddr; 3719 ccw->cmd_code = DASD_ECKD_CCW_SLCK; 3720 ccw->flags |= CCW_FLAG_SLI; 3721 ccw->count = 32; 3722 ccw->cda = (__u32)(addr_t) cqr->data; 3723 cqr->startdev = device; 3724 cqr->memdev = device; 3725 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 3726 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 3727 cqr->retries = 2; /* set retry counter to enable basic ERP */ 3728 cqr->expires = 2 * HZ; 3729 cqr->buildclk = get_tod_clock(); 3730 cqr->status = DASD_CQR_FILLED; 3731 3732 rc = dasd_sleep_on_immediatly(cqr); 3733 if (!rc) 3734 set_bit(DASD_FLAG_IS_RESERVED, &device->flags); 3735 3736 if (useglobal) 3737 mutex_unlock(&dasd_reserve_mutex); 3738 else 3739 dasd_sfree_request(cqr, cqr->memdev); 3740 return rc; 3741 } 3742 3743 /* 3744 * SNID - Sense Path Group ID 3745 * This ioctl may be used in situations where I/O is stalled due to 3746 * a reserve, so if the normal dasd_smalloc_request fails, we use the 3747 * preallocated dasd_reserve_req. 3748 */ 3749 static int dasd_eckd_snid(struct dasd_device *device, 3750 void __user *argp) 3751 { 3752 struct dasd_ccw_req *cqr; 3753 int rc; 3754 struct ccw1 *ccw; 3755 int useglobal; 3756 struct dasd_snid_ioctl_data usrparm; 3757 3758 if (!capable(CAP_SYS_ADMIN)) 3759 return -EACCES; 3760 3761 if (copy_from_user(&usrparm, argp, sizeof(usrparm))) 3762 return -EFAULT; 3763 3764 useglobal = 0; 3765 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1, 3766 sizeof(struct dasd_snid_data), device); 3767 if (IS_ERR(cqr)) { 3768 mutex_lock(&dasd_reserve_mutex); 3769 useglobal = 1; 3770 cqr = &dasd_reserve_req->cqr; 3771 memset(cqr, 0, sizeof(*cqr)); 3772 memset(&dasd_reserve_req->ccw, 0, 3773 sizeof(dasd_reserve_req->ccw)); 3774 cqr->cpaddr = &dasd_reserve_req->ccw; 3775 cqr->data = &dasd_reserve_req->data; 3776 cqr->magic = DASD_ECKD_MAGIC; 3777 } 3778 ccw = cqr->cpaddr; 3779 ccw->cmd_code = DASD_ECKD_CCW_SNID; 3780 ccw->flags |= CCW_FLAG_SLI; 3781 ccw->count = 12; 3782 ccw->cda = (__u32)(addr_t) cqr->data; 3783 cqr->startdev = device; 3784 cqr->memdev = device; 3785 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 3786 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr->flags); 3787 set_bit(DASD_CQR_ALLOW_SLOCK, &cqr->flags); 3788 cqr->retries = 5; 3789 cqr->expires = 10 * HZ; 3790 cqr->buildclk = get_tod_clock(); 3791 cqr->status = DASD_CQR_FILLED; 3792 cqr->lpm = usrparm.path_mask; 3793 3794 rc = dasd_sleep_on_immediatly(cqr); 3795 /* verify that I/O processing didn't modify the path mask */ 3796 if (!rc && usrparm.path_mask && (cqr->lpm != usrparm.path_mask)) 3797 rc = -EIO; 3798 if (!rc) { 3799 usrparm.data = *((struct dasd_snid_data *)cqr->data); 3800 if (copy_to_user(argp, &usrparm, sizeof(usrparm))) 3801 rc = -EFAULT; 3802 } 3803 3804 if (useglobal) 3805 mutex_unlock(&dasd_reserve_mutex); 3806 else 3807 dasd_sfree_request(cqr, cqr->memdev); 3808 return rc; 3809 } 3810 3811 /* 3812 * Read performance statistics 3813 */ 3814 static int 3815 dasd_eckd_performance(struct dasd_device *device, void __user *argp) 3816 { 3817 struct dasd_psf_prssd_data *prssdp; 3818 struct dasd_rssd_perf_stats_t *stats; 3819 struct dasd_ccw_req *cqr; 3820 struct ccw1 *ccw; 3821 int rc; 3822 3823 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 1 /* PSF */ + 1 /* RSSD */, 3824 (sizeof(struct dasd_psf_prssd_data) + 3825 sizeof(struct dasd_rssd_perf_stats_t)), 3826 device); 3827 if (IS_ERR(cqr)) { 3828 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 3829 "Could not allocate initialization request"); 3830 return PTR_ERR(cqr); 3831 } 3832 cqr->startdev = device; 3833 cqr->memdev = device; 3834 cqr->retries = 0; 3835 clear_bit(DASD_CQR_FLAGS_USE_ERP, &cqr->flags); 3836 cqr->expires = 10 * HZ; 3837 3838 /* Prepare for Read Subsystem Data */ 3839 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 3840 memset(prssdp, 0, sizeof(struct dasd_psf_prssd_data)); 3841 prssdp->order = PSF_ORDER_PRSSD; 3842 prssdp->suborder = 0x01; /* Performance Statistics */ 3843 prssdp->varies[1] = 0x01; /* Perf Statistics for the Subsystem */ 3844 3845 ccw = cqr->cpaddr; 3846 ccw->cmd_code = DASD_ECKD_CCW_PSF; 3847 ccw->count = sizeof(struct dasd_psf_prssd_data); 3848 ccw->flags |= CCW_FLAG_CC; 3849 ccw->cda = (__u32)(addr_t) prssdp; 3850 3851 /* Read Subsystem Data - Performance Statistics */ 3852 stats = (struct dasd_rssd_perf_stats_t *) (prssdp + 1); 3853 memset(stats, 0, sizeof(struct dasd_rssd_perf_stats_t)); 3854 3855 ccw++; 3856 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 3857 ccw->count = sizeof(struct dasd_rssd_perf_stats_t); 3858 ccw->cda = (__u32)(addr_t) stats; 3859 3860 cqr->buildclk = get_tod_clock(); 3861 cqr->status = DASD_CQR_FILLED; 3862 rc = dasd_sleep_on(cqr); 3863 if (rc == 0) { 3864 prssdp = (struct dasd_psf_prssd_data *) cqr->data; 3865 stats = (struct dasd_rssd_perf_stats_t *) (prssdp + 1); 3866 if (copy_to_user(argp, stats, 3867 sizeof(struct dasd_rssd_perf_stats_t))) 3868 rc = -EFAULT; 3869 } 3870 dasd_sfree_request(cqr, cqr->memdev); 3871 return rc; 3872 } 3873 3874 /* 3875 * Get attributes (cache operations) 3876 * Returnes the cache attributes used in Define Extend (DE). 3877 */ 3878 static int 3879 dasd_eckd_get_attrib(struct dasd_device *device, void __user *argp) 3880 { 3881 struct dasd_eckd_private *private = 3882 (struct dasd_eckd_private *)device->private; 3883 struct attrib_data_t attrib = private->attrib; 3884 int rc; 3885 3886 if (!capable(CAP_SYS_ADMIN)) 3887 return -EACCES; 3888 if (!argp) 3889 return -EINVAL; 3890 3891 rc = 0; 3892 if (copy_to_user(argp, (long *) &attrib, 3893 sizeof(struct attrib_data_t))) 3894 rc = -EFAULT; 3895 3896 return rc; 3897 } 3898 3899 /* 3900 * Set attributes (cache operations) 3901 * Stores the attributes for cache operation to be used in Define Extend (DE). 3902 */ 3903 static int 3904 dasd_eckd_set_attrib(struct dasd_device *device, void __user *argp) 3905 { 3906 struct dasd_eckd_private *private = 3907 (struct dasd_eckd_private *)device->private; 3908 struct attrib_data_t attrib; 3909 3910 if (!capable(CAP_SYS_ADMIN)) 3911 return -EACCES; 3912 if (!argp) 3913 return -EINVAL; 3914 3915 if (copy_from_user(&attrib, argp, sizeof(struct attrib_data_t))) 3916 return -EFAULT; 3917 private->attrib = attrib; 3918 3919 dev_info(&device->cdev->dev, 3920 "The DASD cache mode was set to %x (%i cylinder prestage)\n", 3921 private->attrib.operation, private->attrib.nr_cyl); 3922 return 0; 3923 } 3924 3925 /* 3926 * Issue syscall I/O to EMC Symmetrix array. 3927 * CCWs are PSF and RSSD 3928 */ 3929 static int dasd_symm_io(struct dasd_device *device, void __user *argp) 3930 { 3931 struct dasd_symmio_parms usrparm; 3932 char *psf_data, *rssd_result; 3933 struct dasd_ccw_req *cqr; 3934 struct ccw1 *ccw; 3935 char psf0, psf1; 3936 int rc; 3937 3938 if (!capable(CAP_SYS_ADMIN) && !capable(CAP_SYS_RAWIO)) 3939 return -EACCES; 3940 psf0 = psf1 = 0; 3941 3942 /* Copy parms from caller */ 3943 rc = -EFAULT; 3944 if (copy_from_user(&usrparm, argp, sizeof(usrparm))) 3945 goto out; 3946 if (is_compat_task() || sizeof(long) == 4) { 3947 /* Make sure pointers are sane even on 31 bit. */ 3948 rc = -EINVAL; 3949 if ((usrparm.psf_data >> 32) != 0) 3950 goto out; 3951 if ((usrparm.rssd_result >> 32) != 0) 3952 goto out; 3953 usrparm.psf_data &= 0x7fffffffULL; 3954 usrparm.rssd_result &= 0x7fffffffULL; 3955 } 3956 /* alloc I/O data area */ 3957 psf_data = kzalloc(usrparm.psf_data_len, GFP_KERNEL | GFP_DMA); 3958 rssd_result = kzalloc(usrparm.rssd_result_len, GFP_KERNEL | GFP_DMA); 3959 if (!psf_data || !rssd_result) { 3960 rc = -ENOMEM; 3961 goto out_free; 3962 } 3963 3964 /* get syscall header from user space */ 3965 rc = -EFAULT; 3966 if (copy_from_user(psf_data, 3967 (void __user *)(unsigned long) usrparm.psf_data, 3968 usrparm.psf_data_len)) 3969 goto out_free; 3970 psf0 = psf_data[0]; 3971 psf1 = psf_data[1]; 3972 3973 /* setup CCWs for PSF + RSSD */ 3974 cqr = dasd_smalloc_request(DASD_ECKD_MAGIC, 2 , 0, device); 3975 if (IS_ERR(cqr)) { 3976 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 3977 "Could not allocate initialization request"); 3978 rc = PTR_ERR(cqr); 3979 goto out_free; 3980 } 3981 3982 cqr->startdev = device; 3983 cqr->memdev = device; 3984 cqr->retries = 3; 3985 cqr->expires = 10 * HZ; 3986 cqr->buildclk = get_tod_clock(); 3987 cqr->status = DASD_CQR_FILLED; 3988 3989 /* Build the ccws */ 3990 ccw = cqr->cpaddr; 3991 3992 /* PSF ccw */ 3993 ccw->cmd_code = DASD_ECKD_CCW_PSF; 3994 ccw->count = usrparm.psf_data_len; 3995 ccw->flags |= CCW_FLAG_CC; 3996 ccw->cda = (__u32)(addr_t) psf_data; 3997 3998 ccw++; 3999 4000 /* RSSD ccw */ 4001 ccw->cmd_code = DASD_ECKD_CCW_RSSD; 4002 ccw->count = usrparm.rssd_result_len; 4003 ccw->flags = CCW_FLAG_SLI ; 4004 ccw->cda = (__u32)(addr_t) rssd_result; 4005 4006 rc = dasd_sleep_on(cqr); 4007 if (rc) 4008 goto out_sfree; 4009 4010 rc = -EFAULT; 4011 if (copy_to_user((void __user *)(unsigned long) usrparm.rssd_result, 4012 rssd_result, usrparm.rssd_result_len)) 4013 goto out_sfree; 4014 rc = 0; 4015 4016 out_sfree: 4017 dasd_sfree_request(cqr, cqr->memdev); 4018 out_free: 4019 kfree(rssd_result); 4020 kfree(psf_data); 4021 out: 4022 DBF_DEV_EVENT(DBF_WARNING, device, 4023 "Symmetrix ioctl (0x%02x 0x%02x): rc=%d", 4024 (int) psf0, (int) psf1, rc); 4025 return rc; 4026 } 4027 4028 static int 4029 dasd_eckd_ioctl(struct dasd_block *block, unsigned int cmd, void __user *argp) 4030 { 4031 struct dasd_device *device = block->base; 4032 4033 switch (cmd) { 4034 case BIODASDGATTR: 4035 return dasd_eckd_get_attrib(device, argp); 4036 case BIODASDSATTR: 4037 return dasd_eckd_set_attrib(device, argp); 4038 case BIODASDPSRD: 4039 return dasd_eckd_performance(device, argp); 4040 case BIODASDRLSE: 4041 return dasd_eckd_release(device); 4042 case BIODASDRSRV: 4043 return dasd_eckd_reserve(device); 4044 case BIODASDSLCK: 4045 return dasd_eckd_steal_lock(device); 4046 case BIODASDSNID: 4047 return dasd_eckd_snid(device, argp); 4048 case BIODASDSYMMIO: 4049 return dasd_symm_io(device, argp); 4050 default: 4051 return -ENOTTY; 4052 } 4053 } 4054 4055 /* 4056 * Dump the range of CCWs into 'page' buffer 4057 * and return number of printed chars. 4058 */ 4059 static int 4060 dasd_eckd_dump_ccw_range(struct ccw1 *from, struct ccw1 *to, char *page) 4061 { 4062 int len, count; 4063 char *datap; 4064 4065 len = 0; 4066 while (from <= to) { 4067 len += sprintf(page + len, PRINTK_HEADER 4068 " CCW %p: %08X %08X DAT:", 4069 from, ((int *) from)[0], ((int *) from)[1]); 4070 4071 /* get pointer to data (consider IDALs) */ 4072 if (from->flags & CCW_FLAG_IDA) 4073 datap = (char *) *((addr_t *) (addr_t) from->cda); 4074 else 4075 datap = (char *) ((addr_t) from->cda); 4076 4077 /* dump data (max 32 bytes) */ 4078 for (count = 0; count < from->count && count < 32; count++) { 4079 if (count % 8 == 0) len += sprintf(page + len, " "); 4080 if (count % 4 == 0) len += sprintf(page + len, " "); 4081 len += sprintf(page + len, "%02x", datap[count]); 4082 } 4083 len += sprintf(page + len, "\n"); 4084 from++; 4085 } 4086 return len; 4087 } 4088 4089 static void 4090 dasd_eckd_dump_sense_dbf(struct dasd_device *device, struct irb *irb, 4091 char *reason) 4092 { 4093 u64 *sense; 4094 u64 *stat; 4095 4096 sense = (u64 *) dasd_get_sense(irb); 4097 stat = (u64 *) &irb->scsw; 4098 if (sense) { 4099 DBF_DEV_EVENT(DBF_EMERG, device, "%s: %016llx %08x : " 4100 "%016llx %016llx %016llx %016llx", 4101 reason, *stat, *((u32 *) (stat + 1)), 4102 sense[0], sense[1], sense[2], sense[3]); 4103 } else { 4104 DBF_DEV_EVENT(DBF_EMERG, device, "%s: %016llx %08x : %s", 4105 reason, *stat, *((u32 *) (stat + 1)), 4106 "NO VALID SENSE"); 4107 } 4108 } 4109 4110 /* 4111 * Print sense data and related channel program. 4112 * Parts are printed because printk buffer is only 1024 bytes. 4113 */ 4114 static void dasd_eckd_dump_sense_ccw(struct dasd_device *device, 4115 struct dasd_ccw_req *req, struct irb *irb) 4116 { 4117 char *page; 4118 struct ccw1 *first, *last, *fail, *from, *to; 4119 int len, sl, sct; 4120 4121 page = (char *) get_zeroed_page(GFP_ATOMIC); 4122 if (page == NULL) { 4123 DBF_DEV_EVENT(DBF_WARNING, device, "%s", 4124 "No memory to dump sense data\n"); 4125 return; 4126 } 4127 /* dump the sense data */ 4128 len = sprintf(page, PRINTK_HEADER 4129 " I/O status report for device %s:\n", 4130 dev_name(&device->cdev->dev)); 4131 len += sprintf(page + len, PRINTK_HEADER 4132 " in req: %p CC:%02X FC:%02X AC:%02X SC:%02X DS:%02X " 4133 "CS:%02X RC:%d\n", 4134 req, scsw_cc(&irb->scsw), scsw_fctl(&irb->scsw), 4135 scsw_actl(&irb->scsw), scsw_stctl(&irb->scsw), 4136 scsw_dstat(&irb->scsw), scsw_cstat(&irb->scsw), 4137 req ? req->intrc : 0); 4138 len += sprintf(page + len, PRINTK_HEADER 4139 " device %s: Failing CCW: %p\n", 4140 dev_name(&device->cdev->dev), 4141 (void *) (addr_t) irb->scsw.cmd.cpa); 4142 if (irb->esw.esw0.erw.cons) { 4143 for (sl = 0; sl < 4; sl++) { 4144 len += sprintf(page + len, PRINTK_HEADER 4145 " Sense(hex) %2d-%2d:", 4146 (8 * sl), ((8 * sl) + 7)); 4147 4148 for (sct = 0; sct < 8; sct++) { 4149 len += sprintf(page + len, " %02x", 4150 irb->ecw[8 * sl + sct]); 4151 } 4152 len += sprintf(page + len, "\n"); 4153 } 4154 4155 if (irb->ecw[27] & DASD_SENSE_BIT_0) { 4156 /* 24 Byte Sense Data */ 4157 sprintf(page + len, PRINTK_HEADER 4158 " 24 Byte: %x MSG %x, " 4159 "%s MSGb to SYSOP\n", 4160 irb->ecw[7] >> 4, irb->ecw[7] & 0x0f, 4161 irb->ecw[1] & 0x10 ? "" : "no"); 4162 } else { 4163 /* 32 Byte Sense Data */ 4164 sprintf(page + len, PRINTK_HEADER 4165 " 32 Byte: Format: %x " 4166 "Exception class %x\n", 4167 irb->ecw[6] & 0x0f, irb->ecw[22] >> 4); 4168 } 4169 } else { 4170 sprintf(page + len, PRINTK_HEADER 4171 " SORRY - NO VALID SENSE AVAILABLE\n"); 4172 } 4173 printk(KERN_ERR "%s", page); 4174 4175 if (req) { 4176 /* req == NULL for unsolicited interrupts */ 4177 /* dump the Channel Program (max 140 Bytes per line) */ 4178 /* Count CCW and print first CCWs (maximum 1024 % 140 = 7) */ 4179 first = req->cpaddr; 4180 for (last = first; last->flags & (CCW_FLAG_CC | CCW_FLAG_DC); last++); 4181 to = min(first + 6, last); 4182 len = sprintf(page, PRINTK_HEADER 4183 " Related CP in req: %p\n", req); 4184 dasd_eckd_dump_ccw_range(first, to, page + len); 4185 printk(KERN_ERR "%s", page); 4186 4187 /* print failing CCW area (maximum 4) */ 4188 /* scsw->cda is either valid or zero */ 4189 len = 0; 4190 from = ++to; 4191 fail = (struct ccw1 *)(addr_t) 4192 irb->scsw.cmd.cpa; /* failing CCW */ 4193 if (from < fail - 2) { 4194 from = fail - 2; /* there is a gap - print header */ 4195 len += sprintf(page, PRINTK_HEADER "......\n"); 4196 } 4197 to = min(fail + 1, last); 4198 len += dasd_eckd_dump_ccw_range(from, to, page + len); 4199 4200 /* print last CCWs (maximum 2) */ 4201 from = max(from, ++to); 4202 if (from < last - 1) { 4203 from = last - 1; /* there is a gap - print header */ 4204 len += sprintf(page + len, PRINTK_HEADER "......\n"); 4205 } 4206 len += dasd_eckd_dump_ccw_range(from, last, page + len); 4207 if (len > 0) 4208 printk(KERN_ERR "%s", page); 4209 } 4210 free_page((unsigned long) page); 4211 } 4212 4213 4214 /* 4215 * Print sense data from a tcw. 4216 */ 4217 static void dasd_eckd_dump_sense_tcw(struct dasd_device *device, 4218 struct dasd_ccw_req *req, struct irb *irb) 4219 { 4220 char *page; 4221 int len, sl, sct, residual; 4222 struct tsb *tsb; 4223 u8 *sense, *rcq; 4224 4225 page = (char *) get_zeroed_page(GFP_ATOMIC); 4226 if (page == NULL) { 4227 DBF_DEV_EVENT(DBF_WARNING, device, " %s", 4228 "No memory to dump sense data"); 4229 return; 4230 } 4231 /* dump the sense data */ 4232 len = sprintf(page, PRINTK_HEADER 4233 " I/O status report for device %s:\n", 4234 dev_name(&device->cdev->dev)); 4235 len += sprintf(page + len, PRINTK_HEADER 4236 " in req: %p CC:%02X FC:%02X AC:%02X SC:%02X DS:%02X " 4237 "CS:%02X fcxs:%02X schxs:%02X RC:%d\n", 4238 req, scsw_cc(&irb->scsw), scsw_fctl(&irb->scsw), 4239 scsw_actl(&irb->scsw), scsw_stctl(&irb->scsw), 4240 scsw_dstat(&irb->scsw), scsw_cstat(&irb->scsw), 4241 irb->scsw.tm.fcxs, irb->scsw.tm.schxs, 4242 req ? req->intrc : 0); 4243 len += sprintf(page + len, PRINTK_HEADER 4244 " device %s: Failing TCW: %p\n", 4245 dev_name(&device->cdev->dev), 4246 (void *) (addr_t) irb->scsw.tm.tcw); 4247 4248 tsb = NULL; 4249 sense = NULL; 4250 if (irb->scsw.tm.tcw && (irb->scsw.tm.fcxs & 0x01)) 4251 tsb = tcw_get_tsb( 4252 (struct tcw *)(unsigned long)irb->scsw.tm.tcw); 4253 4254 if (tsb) { 4255 len += sprintf(page + len, PRINTK_HEADER 4256 " tsb->length %d\n", tsb->length); 4257 len += sprintf(page + len, PRINTK_HEADER 4258 " tsb->flags %x\n", tsb->flags); 4259 len += sprintf(page + len, PRINTK_HEADER 4260 " tsb->dcw_offset %d\n", tsb->dcw_offset); 4261 len += sprintf(page + len, PRINTK_HEADER 4262 " tsb->count %d\n", tsb->count); 4263 residual = tsb->count - 28; 4264 len += sprintf(page + len, PRINTK_HEADER 4265 " residual %d\n", residual); 4266 4267 switch (tsb->flags & 0x07) { 4268 case 1: /* tsa_iostat */ 4269 len += sprintf(page + len, PRINTK_HEADER 4270 " tsb->tsa.iostat.dev_time %d\n", 4271 tsb->tsa.iostat.dev_time); 4272 len += sprintf(page + len, PRINTK_HEADER 4273 " tsb->tsa.iostat.def_time %d\n", 4274 tsb->tsa.iostat.def_time); 4275 len += sprintf(page + len, PRINTK_HEADER 4276 " tsb->tsa.iostat.queue_time %d\n", 4277 tsb->tsa.iostat.queue_time); 4278 len += sprintf(page + len, PRINTK_HEADER 4279 " tsb->tsa.iostat.dev_busy_time %d\n", 4280 tsb->tsa.iostat.dev_busy_time); 4281 len += sprintf(page + len, PRINTK_HEADER 4282 " tsb->tsa.iostat.dev_act_time %d\n", 4283 tsb->tsa.iostat.dev_act_time); 4284 sense = tsb->tsa.iostat.sense; 4285 break; 4286 case 2: /* ts_ddpc */ 4287 len += sprintf(page + len, PRINTK_HEADER 4288 " tsb->tsa.ddpc.rc %d\n", tsb->tsa.ddpc.rc); 4289 for (sl = 0; sl < 2; sl++) { 4290 len += sprintf(page + len, PRINTK_HEADER 4291 " tsb->tsa.ddpc.rcq %2d-%2d: ", 4292 (8 * sl), ((8 * sl) + 7)); 4293 rcq = tsb->tsa.ddpc.rcq; 4294 for (sct = 0; sct < 8; sct++) { 4295 len += sprintf(page + len, " %02x", 4296 rcq[8 * sl + sct]); 4297 } 4298 len += sprintf(page + len, "\n"); 4299 } 4300 sense = tsb->tsa.ddpc.sense; 4301 break; 4302 case 3: /* tsa_intrg */ 4303 len += sprintf(page + len, PRINTK_HEADER 4304 " tsb->tsa.intrg.: not supportet yet\n"); 4305 break; 4306 } 4307 4308 if (sense) { 4309 for (sl = 0; sl < 4; sl++) { 4310 len += sprintf(page + len, PRINTK_HEADER 4311 " Sense(hex) %2d-%2d:", 4312 (8 * sl), ((8 * sl) + 7)); 4313 for (sct = 0; sct < 8; sct++) { 4314 len += sprintf(page + len, " %02x", 4315 sense[8 * sl + sct]); 4316 } 4317 len += sprintf(page + len, "\n"); 4318 } 4319 4320 if (sense[27] & DASD_SENSE_BIT_0) { 4321 /* 24 Byte Sense Data */ 4322 sprintf(page + len, PRINTK_HEADER 4323 " 24 Byte: %x MSG %x, " 4324 "%s MSGb to SYSOP\n", 4325 sense[7] >> 4, sense[7] & 0x0f, 4326 sense[1] & 0x10 ? "" : "no"); 4327 } else { 4328 /* 32 Byte Sense Data */ 4329 sprintf(page + len, PRINTK_HEADER 4330 " 32 Byte: Format: %x " 4331 "Exception class %x\n", 4332 sense[6] & 0x0f, sense[22] >> 4); 4333 } 4334 } else { 4335 sprintf(page + len, PRINTK_HEADER 4336 " SORRY - NO VALID SENSE AVAILABLE\n"); 4337 } 4338 } else { 4339 sprintf(page + len, PRINTK_HEADER 4340 " SORRY - NO TSB DATA AVAILABLE\n"); 4341 } 4342 printk(KERN_ERR "%s", page); 4343 free_page((unsigned long) page); 4344 } 4345 4346 static void dasd_eckd_dump_sense(struct dasd_device *device, 4347 struct dasd_ccw_req *req, struct irb *irb) 4348 { 4349 if (scsw_is_tm(&irb->scsw)) 4350 dasd_eckd_dump_sense_tcw(device, req, irb); 4351 else 4352 dasd_eckd_dump_sense_ccw(device, req, irb); 4353 } 4354 4355 static int dasd_eckd_pm_freeze(struct dasd_device *device) 4356 { 4357 /* 4358 * the device should be disconnected from our LCU structure 4359 * on restore we will reconnect it and reread LCU specific 4360 * information like PAV support that might have changed 4361 */ 4362 dasd_alias_remove_device(device); 4363 dasd_alias_disconnect_device_from_lcu(device); 4364 4365 return 0; 4366 } 4367 4368 static int dasd_eckd_restore_device(struct dasd_device *device) 4369 { 4370 struct dasd_eckd_private *private; 4371 struct dasd_eckd_characteristics temp_rdc_data; 4372 int rc; 4373 struct dasd_uid temp_uid; 4374 unsigned long flags; 4375 unsigned long cqr_flags = 0; 4376 4377 private = (struct dasd_eckd_private *) device->private; 4378 4379 /* Read Configuration Data */ 4380 dasd_eckd_read_conf(device); 4381 4382 dasd_eckd_get_uid(device, &temp_uid); 4383 /* Generate device unique id */ 4384 rc = dasd_eckd_generate_uid(device); 4385 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 4386 if (memcmp(&private->uid, &temp_uid, sizeof(struct dasd_uid)) != 0) 4387 dev_err(&device->cdev->dev, "The UID of the DASD has " 4388 "changed\n"); 4389 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 4390 if (rc) 4391 goto out_err; 4392 4393 /* register lcu with alias handling, enable PAV if this is a new lcu */ 4394 rc = dasd_alias_make_device_known_to_lcu(device); 4395 if (rc) 4396 return rc; 4397 4398 set_bit(DASD_CQR_FLAGS_FAILFAST, &cqr_flags); 4399 dasd_eckd_validate_server(device, cqr_flags); 4400 4401 /* RE-Read Configuration Data */ 4402 dasd_eckd_read_conf(device); 4403 4404 /* Read Feature Codes */ 4405 dasd_eckd_read_features(device); 4406 4407 /* Read Device Characteristics */ 4408 rc = dasd_generic_read_dev_chars(device, DASD_ECKD_MAGIC, 4409 &temp_rdc_data, 64); 4410 if (rc) { 4411 DBF_EVENT_DEVID(DBF_WARNING, device->cdev, 4412 "Read device characteristic failed, rc=%d", rc); 4413 goto out_err; 4414 } 4415 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 4416 memcpy(&private->rdc_data, &temp_rdc_data, sizeof(temp_rdc_data)); 4417 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 4418 4419 /* add device to alias management */ 4420 dasd_alias_add_device(device); 4421 4422 return 0; 4423 4424 out_err: 4425 return -1; 4426 } 4427 4428 static int dasd_eckd_reload_device(struct dasd_device *device) 4429 { 4430 struct dasd_eckd_private *private; 4431 int rc, old_base; 4432 char print_uid[60]; 4433 struct dasd_uid uid; 4434 unsigned long flags; 4435 4436 private = (struct dasd_eckd_private *) device->private; 4437 4438 spin_lock_irqsave(get_ccwdev_lock(device->cdev), flags); 4439 old_base = private->uid.base_unit_addr; 4440 spin_unlock_irqrestore(get_ccwdev_lock(device->cdev), flags); 4441 4442 /* Read Configuration Data */ 4443 rc = dasd_eckd_read_conf(device); 4444 if (rc) 4445 goto out_err; 4446 4447 rc = dasd_eckd_generate_uid(device); 4448 if (rc) 4449 goto out_err; 4450 /* 4451 * update unit address configuration and 4452 * add device to alias management 4453 */ 4454 dasd_alias_update_add_device(device); 4455 4456 dasd_eckd_get_uid(device, &uid); 4457 4458 if (old_base != uid.base_unit_addr) { 4459 if (strlen(uid.vduit) > 0) 4460 snprintf(print_uid, sizeof(print_uid), 4461 "%s.%s.%04x.%02x.%s", uid.vendor, uid.serial, 4462 uid.ssid, uid.base_unit_addr, uid.vduit); 4463 else 4464 snprintf(print_uid, sizeof(print_uid), 4465 "%s.%s.%04x.%02x", uid.vendor, uid.serial, 4466 uid.ssid, uid.base_unit_addr); 4467 4468 dev_info(&device->cdev->dev, 4469 "An Alias device was reassigned to a new base device " 4470 "with UID: %s\n", print_uid); 4471 } 4472 return 0; 4473 4474 out_err: 4475 return -1; 4476 } 4477 4478 static struct ccw_driver dasd_eckd_driver = { 4479 .driver = { 4480 .name = "dasd-eckd", 4481 .owner = THIS_MODULE, 4482 }, 4483 .ids = dasd_eckd_ids, 4484 .probe = dasd_eckd_probe, 4485 .remove = dasd_generic_remove, 4486 .set_offline = dasd_generic_set_offline, 4487 .set_online = dasd_eckd_set_online, 4488 .notify = dasd_generic_notify, 4489 .path_event = dasd_generic_path_event, 4490 .shutdown = dasd_generic_shutdown, 4491 .freeze = dasd_generic_pm_freeze, 4492 .thaw = dasd_generic_restore_device, 4493 .restore = dasd_generic_restore_device, 4494 .uc_handler = dasd_generic_uc_handler, 4495 .int_class = IRQIO_DAS, 4496 }; 4497 4498 /* 4499 * max_blocks is dependent on the amount of storage that is available 4500 * in the static io buffer for each device. Currently each device has 4501 * 8192 bytes (=2 pages). For 64 bit one dasd_mchunkt_t structure has 4502 * 24 bytes, the struct dasd_ccw_req has 136 bytes and each block can use 4503 * up to 16 bytes (8 for the ccw and 8 for the idal pointer). In 4504 * addition we have one define extent ccw + 16 bytes of data and one 4505 * locate record ccw + 16 bytes of data. That makes: 4506 * (8192 - 24 - 136 - 8 - 16 - 8 - 16) / 16 = 499 blocks at maximum. 4507 * We want to fit two into the available memory so that we can immediately 4508 * start the next request if one finishes off. That makes 249.5 blocks 4509 * for one request. Give a little safety and the result is 240. 4510 */ 4511 static struct dasd_discipline dasd_eckd_discipline = { 4512 .owner = THIS_MODULE, 4513 .name = "ECKD", 4514 .ebcname = "ECKD", 4515 .max_blocks = 190, 4516 .check_device = dasd_eckd_check_characteristics, 4517 .uncheck_device = dasd_eckd_uncheck_device, 4518 .do_analysis = dasd_eckd_do_analysis, 4519 .verify_path = dasd_eckd_verify_path, 4520 .basic_to_ready = dasd_eckd_basic_to_ready, 4521 .online_to_ready = dasd_eckd_online_to_ready, 4522 .basic_to_known = dasd_eckd_basic_to_known, 4523 .fill_geometry = dasd_eckd_fill_geometry, 4524 .start_IO = dasd_start_IO, 4525 .term_IO = dasd_term_IO, 4526 .handle_terminated_request = dasd_eckd_handle_terminated_request, 4527 .format_device = dasd_eckd_format_device, 4528 .erp_action = dasd_eckd_erp_action, 4529 .erp_postaction = dasd_eckd_erp_postaction, 4530 .check_for_device_change = dasd_eckd_check_for_device_change, 4531 .build_cp = dasd_eckd_build_alias_cp, 4532 .free_cp = dasd_eckd_free_alias_cp, 4533 .dump_sense = dasd_eckd_dump_sense, 4534 .dump_sense_dbf = dasd_eckd_dump_sense_dbf, 4535 .fill_info = dasd_eckd_fill_info, 4536 .ioctl = dasd_eckd_ioctl, 4537 .freeze = dasd_eckd_pm_freeze, 4538 .restore = dasd_eckd_restore_device, 4539 .reload = dasd_eckd_reload_device, 4540 .get_uid = dasd_eckd_get_uid, 4541 .kick_validate = dasd_eckd_kick_validate_server, 4542 }; 4543 4544 static int __init 4545 dasd_eckd_init(void) 4546 { 4547 int ret; 4548 4549 ASCEBC(dasd_eckd_discipline.ebcname, 4); 4550 dasd_reserve_req = kmalloc(sizeof(*dasd_reserve_req), 4551 GFP_KERNEL | GFP_DMA); 4552 if (!dasd_reserve_req) 4553 return -ENOMEM; 4554 path_verification_worker = kmalloc(sizeof(*path_verification_worker), 4555 GFP_KERNEL | GFP_DMA); 4556 if (!path_verification_worker) { 4557 kfree(dasd_reserve_req); 4558 return -ENOMEM; 4559 } 4560 rawpadpage = (void *)__get_free_page(GFP_KERNEL); 4561 if (!rawpadpage) { 4562 kfree(path_verification_worker); 4563 kfree(dasd_reserve_req); 4564 return -ENOMEM; 4565 } 4566 ret = ccw_driver_register(&dasd_eckd_driver); 4567 if (!ret) 4568 wait_for_device_probe(); 4569 else { 4570 kfree(path_verification_worker); 4571 kfree(dasd_reserve_req); 4572 free_page((unsigned long)rawpadpage); 4573 } 4574 return ret; 4575 } 4576 4577 static void __exit 4578 dasd_eckd_cleanup(void) 4579 { 4580 ccw_driver_unregister(&dasd_eckd_driver); 4581 kfree(path_verification_worker); 4582 kfree(dasd_reserve_req); 4583 free_page((unsigned long)rawpadpage); 4584 } 4585 4586 module_init(dasd_eckd_init); 4587 module_exit(dasd_eckd_cleanup); 4588