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