1 /* 2 * S/390 common I/O routines -- channel subsystem call 3 * 4 * Copyright IBM Corp. 1999,2012 5 * Author(s): Ingo Adlung (adlung@de.ibm.com) 6 * Cornelia Huck (cornelia.huck@de.ibm.com) 7 * Arnd Bergmann (arndb@de.ibm.com) 8 */ 9 10 #define KMSG_COMPONENT "cio" 11 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 12 13 #include <linux/module.h> 14 #include <linux/slab.h> 15 #include <linux/init.h> 16 #include <linux/device.h> 17 #include <linux/mutex.h> 18 #include <linux/pci.h> 19 20 #include <asm/cio.h> 21 #include <asm/chpid.h> 22 #include <asm/chsc.h> 23 #include <asm/crw.h> 24 #include <asm/isc.h> 25 #include <asm/ebcdic.h> 26 27 #include "css.h" 28 #include "cio.h" 29 #include "cio_debug.h" 30 #include "ioasm.h" 31 #include "chp.h" 32 #include "chsc.h" 33 34 static void *sei_page; 35 static void *chsc_page; 36 static DEFINE_SPINLOCK(chsc_page_lock); 37 38 /** 39 * chsc_error_from_response() - convert a chsc response to an error 40 * @response: chsc response code 41 * 42 * Returns an appropriate Linux error code for @response. 43 */ 44 int chsc_error_from_response(int response) 45 { 46 switch (response) { 47 case 0x0001: 48 return 0; 49 case 0x0002: 50 case 0x0003: 51 case 0x0006: 52 case 0x0007: 53 case 0x0008: 54 case 0x000a: 55 case 0x0104: 56 return -EINVAL; 57 case 0x0004: 58 return -EOPNOTSUPP; 59 case 0x000b: 60 case 0x0107: /* "Channel busy" for the op 0x003d */ 61 return -EBUSY; 62 case 0x0100: 63 case 0x0102: 64 return -ENOMEM; 65 default: 66 return -EIO; 67 } 68 } 69 EXPORT_SYMBOL_GPL(chsc_error_from_response); 70 71 struct chsc_ssd_area { 72 struct chsc_header request; 73 u16 :10; 74 u16 ssid:2; 75 u16 :4; 76 u16 f_sch; /* first subchannel */ 77 u16 :16; 78 u16 l_sch; /* last subchannel */ 79 u32 :32; 80 struct chsc_header response; 81 u32 :32; 82 u8 sch_valid : 1; 83 u8 dev_valid : 1; 84 u8 st : 3; /* subchannel type */ 85 u8 zeroes : 3; 86 u8 unit_addr; /* unit address */ 87 u16 devno; /* device number */ 88 u8 path_mask; 89 u8 fla_valid_mask; 90 u16 sch; /* subchannel */ 91 u8 chpid[8]; /* chpids 0-7 */ 92 u16 fla[8]; /* full link addresses 0-7 */ 93 } __attribute__ ((packed)); 94 95 int chsc_get_ssd_info(struct subchannel_id schid, struct chsc_ssd_info *ssd) 96 { 97 struct chsc_ssd_area *ssd_area; 98 int ccode; 99 int ret; 100 int i; 101 int mask; 102 103 spin_lock_irq(&chsc_page_lock); 104 memset(chsc_page, 0, PAGE_SIZE); 105 ssd_area = chsc_page; 106 ssd_area->request.length = 0x0010; 107 ssd_area->request.code = 0x0004; 108 ssd_area->ssid = schid.ssid; 109 ssd_area->f_sch = schid.sch_no; 110 ssd_area->l_sch = schid.sch_no; 111 112 ccode = chsc(ssd_area); 113 /* Check response. */ 114 if (ccode > 0) { 115 ret = (ccode == 3) ? -ENODEV : -EBUSY; 116 goto out; 117 } 118 ret = chsc_error_from_response(ssd_area->response.code); 119 if (ret != 0) { 120 CIO_MSG_EVENT(2, "chsc: ssd failed for 0.%x.%04x (rc=%04x)\n", 121 schid.ssid, schid.sch_no, 122 ssd_area->response.code); 123 goto out; 124 } 125 if (!ssd_area->sch_valid) { 126 ret = -ENODEV; 127 goto out; 128 } 129 /* Copy data */ 130 ret = 0; 131 memset(ssd, 0, sizeof(struct chsc_ssd_info)); 132 if ((ssd_area->st != SUBCHANNEL_TYPE_IO) && 133 (ssd_area->st != SUBCHANNEL_TYPE_MSG)) 134 goto out; 135 ssd->path_mask = ssd_area->path_mask; 136 ssd->fla_valid_mask = ssd_area->fla_valid_mask; 137 for (i = 0; i < 8; i++) { 138 mask = 0x80 >> i; 139 if (ssd_area->path_mask & mask) { 140 chp_id_init(&ssd->chpid[i]); 141 ssd->chpid[i].id = ssd_area->chpid[i]; 142 } 143 if (ssd_area->fla_valid_mask & mask) 144 ssd->fla[i] = ssd_area->fla[i]; 145 } 146 out: 147 spin_unlock_irq(&chsc_page_lock); 148 return ret; 149 } 150 151 /** 152 * chsc_ssqd() - store subchannel QDIO data (SSQD) 153 * @schid: id of the subchannel on which SSQD is performed 154 * @ssqd: request and response block for SSQD 155 * 156 * Returns 0 on success. 157 */ 158 int chsc_ssqd(struct subchannel_id schid, struct chsc_ssqd_area *ssqd) 159 { 160 memset(ssqd, 0, sizeof(*ssqd)); 161 ssqd->request.length = 0x0010; 162 ssqd->request.code = 0x0024; 163 ssqd->first_sch = schid.sch_no; 164 ssqd->last_sch = schid.sch_no; 165 ssqd->ssid = schid.ssid; 166 167 if (chsc(ssqd)) 168 return -EIO; 169 170 return chsc_error_from_response(ssqd->response.code); 171 } 172 EXPORT_SYMBOL_GPL(chsc_ssqd); 173 174 /** 175 * chsc_sadc() - set adapter device controls (SADC) 176 * @schid: id of the subchannel on which SADC is performed 177 * @scssc: request and response block for SADC 178 * @summary_indicator_addr: summary indicator address 179 * @subchannel_indicator_addr: subchannel indicator address 180 * 181 * Returns 0 on success. 182 */ 183 int chsc_sadc(struct subchannel_id schid, struct chsc_scssc_area *scssc, 184 u64 summary_indicator_addr, u64 subchannel_indicator_addr) 185 { 186 memset(scssc, 0, sizeof(*scssc)); 187 scssc->request.length = 0x0fe0; 188 scssc->request.code = 0x0021; 189 scssc->operation_code = 0; 190 191 scssc->summary_indicator_addr = summary_indicator_addr; 192 scssc->subchannel_indicator_addr = subchannel_indicator_addr; 193 194 scssc->ks = PAGE_DEFAULT_KEY >> 4; 195 scssc->kc = PAGE_DEFAULT_KEY >> 4; 196 scssc->isc = QDIO_AIRQ_ISC; 197 scssc->schid = schid; 198 199 /* enable the time delay disablement facility */ 200 if (css_general_characteristics.aif_tdd) 201 scssc->word_with_d_bit = 0x10000000; 202 203 if (chsc(scssc)) 204 return -EIO; 205 206 return chsc_error_from_response(scssc->response.code); 207 } 208 EXPORT_SYMBOL_GPL(chsc_sadc); 209 210 static int s390_subchannel_remove_chpid(struct subchannel *sch, void *data) 211 { 212 spin_lock_irq(sch->lock); 213 if (sch->driver && sch->driver->chp_event) 214 if (sch->driver->chp_event(sch, data, CHP_OFFLINE) != 0) 215 goto out_unreg; 216 spin_unlock_irq(sch->lock); 217 return 0; 218 219 out_unreg: 220 sch->lpm = 0; 221 spin_unlock_irq(sch->lock); 222 css_schedule_eval(sch->schid); 223 return 0; 224 } 225 226 void chsc_chp_offline(struct chp_id chpid) 227 { 228 struct channel_path *chp = chpid_to_chp(chpid); 229 struct chp_link link; 230 char dbf_txt[15]; 231 232 sprintf(dbf_txt, "chpr%x.%02x", chpid.cssid, chpid.id); 233 CIO_TRACE_EVENT(2, dbf_txt); 234 235 if (chp_get_status(chpid) <= 0) 236 return; 237 memset(&link, 0, sizeof(struct chp_link)); 238 link.chpid = chpid; 239 /* Wait until previous actions have settled. */ 240 css_wait_for_slow_path(); 241 242 mutex_lock(&chp->lock); 243 chp_update_desc(chp); 244 mutex_unlock(&chp->lock); 245 246 for_each_subchannel_staged(s390_subchannel_remove_chpid, NULL, &link); 247 } 248 249 static int __s390_process_res_acc(struct subchannel *sch, void *data) 250 { 251 spin_lock_irq(sch->lock); 252 if (sch->driver && sch->driver->chp_event) 253 sch->driver->chp_event(sch, data, CHP_ONLINE); 254 spin_unlock_irq(sch->lock); 255 256 return 0; 257 } 258 259 static void s390_process_res_acc(struct chp_link *link) 260 { 261 char dbf_txt[15]; 262 263 sprintf(dbf_txt, "accpr%x.%02x", link->chpid.cssid, 264 link->chpid.id); 265 CIO_TRACE_EVENT( 2, dbf_txt); 266 if (link->fla != 0) { 267 sprintf(dbf_txt, "fla%x", link->fla); 268 CIO_TRACE_EVENT( 2, dbf_txt); 269 } 270 /* Wait until previous actions have settled. */ 271 css_wait_for_slow_path(); 272 /* 273 * I/O resources may have become accessible. 274 * Scan through all subchannels that may be concerned and 275 * do a validation on those. 276 * The more information we have (info), the less scanning 277 * will we have to do. 278 */ 279 for_each_subchannel_staged(__s390_process_res_acc, NULL, link); 280 css_schedule_reprobe(); 281 } 282 283 struct chsc_sei_nt0_area { 284 u8 flags; 285 u8 vf; /* validity flags */ 286 u8 rs; /* reporting source */ 287 u8 cc; /* content code */ 288 u16 fla; /* full link address */ 289 u16 rsid; /* reporting source id */ 290 u32 reserved1; 291 u32 reserved2; 292 /* ccdf has to be big enough for a link-incident record */ 293 u8 ccdf[PAGE_SIZE - 24 - 16]; /* content-code dependent field */ 294 } __packed; 295 296 struct chsc_sei_nt2_area { 297 u8 flags; /* p and v bit */ 298 u8 reserved1; 299 u8 reserved2; 300 u8 cc; /* content code */ 301 u32 reserved3[13]; 302 u8 ccdf[PAGE_SIZE - 24 - 56]; /* content-code dependent field */ 303 } __packed; 304 305 #define CHSC_SEI_NT0 (1ULL << 63) 306 #define CHSC_SEI_NT2 (1ULL << 61) 307 308 struct chsc_sei { 309 struct chsc_header request; 310 u32 reserved1; 311 u64 ntsm; /* notification type mask */ 312 struct chsc_header response; 313 u32 :24; 314 u8 nt; 315 union { 316 struct chsc_sei_nt0_area nt0_area; 317 struct chsc_sei_nt2_area nt2_area; 318 u8 nt_area[PAGE_SIZE - 24]; 319 } u; 320 } __packed; 321 322 /* 323 * Node Descriptor as defined in SA22-7204, "Common I/O-Device Commands" 324 */ 325 326 #define ND_VALIDITY_VALID 0 327 #define ND_VALIDITY_OUTDATED 1 328 #define ND_VALIDITY_INVALID 2 329 330 struct node_descriptor { 331 /* Flags. */ 332 union { 333 struct { 334 u32 validity:3; 335 u32 reserved:5; 336 } __packed; 337 u8 byte0; 338 } __packed; 339 340 /* Node parameters. */ 341 u32 params:24; 342 343 /* Node ID. */ 344 char type[6]; 345 char model[3]; 346 char manufacturer[3]; 347 char plant[2]; 348 char seq[12]; 349 u16 tag; 350 } __packed; 351 352 /* 353 * Link Incident Record as defined in SA22-7202, "ESCON I/O Interface" 354 */ 355 356 #define LIR_IQ_CLASS_INFO 0 357 #define LIR_IQ_CLASS_DEGRADED 1 358 #define LIR_IQ_CLASS_NOT_OPERATIONAL 2 359 360 struct lir { 361 struct { 362 u32 null:1; 363 u32 reserved:3; 364 u32 class:2; 365 u32 reserved2:2; 366 } __packed iq; 367 u32 ic:8; 368 u32 reserved:16; 369 struct node_descriptor incident_node; 370 struct node_descriptor attached_node; 371 u8 reserved2[32]; 372 } __packed; 373 374 #define PARAMS_LEN 10 /* PARAMS=xx,xxxxxx */ 375 #define NODEID_LEN 35 /* NODEID=tttttt/mdl,mmm.ppssssssssssss,xxxx */ 376 377 /* Copy EBCIDC text, convert to ASCII and optionally add delimiter. */ 378 static char *store_ebcdic(char *dest, const char *src, unsigned long len, 379 char delim) 380 { 381 memcpy(dest, src, len); 382 EBCASC(dest, len); 383 384 if (delim) 385 dest[len++] = delim; 386 387 return dest + len; 388 } 389 390 /* Format node ID and parameters for output in LIR log message. */ 391 static void format_node_data(char *params, char *id, struct node_descriptor *nd) 392 { 393 memset(params, 0, PARAMS_LEN); 394 memset(id, 0, NODEID_LEN); 395 396 if (nd->validity != ND_VALIDITY_VALID) { 397 strncpy(params, "n/a", PARAMS_LEN - 1); 398 strncpy(id, "n/a", NODEID_LEN - 1); 399 return; 400 } 401 402 /* PARAMS=xx,xxxxxx */ 403 snprintf(params, PARAMS_LEN, "%02x,%06x", nd->byte0, nd->params); 404 /* NODEID=tttttt/mdl,mmm.ppssssssssssss,xxxx */ 405 id = store_ebcdic(id, nd->type, sizeof(nd->type), '/'); 406 id = store_ebcdic(id, nd->model, sizeof(nd->model), ','); 407 id = store_ebcdic(id, nd->manufacturer, sizeof(nd->manufacturer), '.'); 408 id = store_ebcdic(id, nd->plant, sizeof(nd->plant), 0); 409 id = store_ebcdic(id, nd->seq, sizeof(nd->seq), ','); 410 sprintf(id, "%04X", nd->tag); 411 } 412 413 static void chsc_process_sei_link_incident(struct chsc_sei_nt0_area *sei_area) 414 { 415 struct lir *lir = (struct lir *) &sei_area->ccdf; 416 char iuparams[PARAMS_LEN], iunodeid[NODEID_LEN], auparams[PARAMS_LEN], 417 aunodeid[NODEID_LEN]; 418 419 CIO_CRW_EVENT(4, "chsc: link incident (rs=%02x, rs_id=%04x, iq=%02x)\n", 420 sei_area->rs, sei_area->rsid, sei_area->ccdf[0]); 421 422 /* Ignore NULL Link Incident Records. */ 423 if (lir->iq.null) 424 return; 425 426 /* Inform user that a link requires maintenance actions because it has 427 * become degraded or not operational. Note that this log message is 428 * the primary intention behind a Link Incident Record. */ 429 430 format_node_data(iuparams, iunodeid, &lir->incident_node); 431 format_node_data(auparams, aunodeid, &lir->attached_node); 432 433 switch (lir->iq.class) { 434 case LIR_IQ_CLASS_DEGRADED: 435 pr_warn("Link degraded: RS=%02x RSID=%04x IC=%02x " 436 "IUPARAMS=%s IUNODEID=%s AUPARAMS=%s AUNODEID=%s\n", 437 sei_area->rs, sei_area->rsid, lir->ic, iuparams, 438 iunodeid, auparams, aunodeid); 439 break; 440 case LIR_IQ_CLASS_NOT_OPERATIONAL: 441 pr_err("Link stopped: RS=%02x RSID=%04x IC=%02x " 442 "IUPARAMS=%s IUNODEID=%s AUPARAMS=%s AUNODEID=%s\n", 443 sei_area->rs, sei_area->rsid, lir->ic, iuparams, 444 iunodeid, auparams, aunodeid); 445 break; 446 default: 447 break; 448 } 449 } 450 451 static void chsc_process_sei_res_acc(struct chsc_sei_nt0_area *sei_area) 452 { 453 struct chp_link link; 454 struct chp_id chpid; 455 int status; 456 457 CIO_CRW_EVENT(4, "chsc: resource accessibility event (rs=%02x, " 458 "rs_id=%04x)\n", sei_area->rs, sei_area->rsid); 459 if (sei_area->rs != 4) 460 return; 461 chp_id_init(&chpid); 462 chpid.id = sei_area->rsid; 463 /* allocate a new channel path structure, if needed */ 464 status = chp_get_status(chpid); 465 if (status < 0) 466 chp_new(chpid); 467 else if (!status) 468 return; 469 memset(&link, 0, sizeof(struct chp_link)); 470 link.chpid = chpid; 471 if ((sei_area->vf & 0xc0) != 0) { 472 link.fla = sei_area->fla; 473 if ((sei_area->vf & 0xc0) == 0xc0) 474 /* full link address */ 475 link.fla_mask = 0xffff; 476 else 477 /* link address */ 478 link.fla_mask = 0xff00; 479 } 480 s390_process_res_acc(&link); 481 } 482 483 static void chsc_process_sei_chp_avail(struct chsc_sei_nt0_area *sei_area) 484 { 485 struct channel_path *chp; 486 struct chp_id chpid; 487 u8 *data; 488 int num; 489 490 CIO_CRW_EVENT(4, "chsc: channel path availability information\n"); 491 if (sei_area->rs != 0) 492 return; 493 data = sei_area->ccdf; 494 chp_id_init(&chpid); 495 for (num = 0; num <= __MAX_CHPID; num++) { 496 if (!chp_test_bit(data, num)) 497 continue; 498 chpid.id = num; 499 500 CIO_CRW_EVENT(4, "Update information for channel path " 501 "%x.%02x\n", chpid.cssid, chpid.id); 502 chp = chpid_to_chp(chpid); 503 if (!chp) { 504 chp_new(chpid); 505 continue; 506 } 507 mutex_lock(&chp->lock); 508 chp_update_desc(chp); 509 mutex_unlock(&chp->lock); 510 } 511 } 512 513 struct chp_config_data { 514 u8 map[32]; 515 u8 op; 516 u8 pc; 517 }; 518 519 static void chsc_process_sei_chp_config(struct chsc_sei_nt0_area *sei_area) 520 { 521 struct chp_config_data *data; 522 struct chp_id chpid; 523 int num; 524 char *events[3] = {"configure", "deconfigure", "cancel deconfigure"}; 525 526 CIO_CRW_EVENT(4, "chsc: channel-path-configuration notification\n"); 527 if (sei_area->rs != 0) 528 return; 529 data = (struct chp_config_data *) &(sei_area->ccdf); 530 chp_id_init(&chpid); 531 for (num = 0; num <= __MAX_CHPID; num++) { 532 if (!chp_test_bit(data->map, num)) 533 continue; 534 chpid.id = num; 535 pr_notice("Processing %s for channel path %x.%02x\n", 536 events[data->op], chpid.cssid, chpid.id); 537 switch (data->op) { 538 case 0: 539 chp_cfg_schedule(chpid, 1); 540 break; 541 case 1: 542 chp_cfg_schedule(chpid, 0); 543 break; 544 case 2: 545 chp_cfg_cancel_deconfigure(chpid); 546 break; 547 } 548 } 549 } 550 551 static void chsc_process_sei_scm_change(struct chsc_sei_nt0_area *sei_area) 552 { 553 int ret; 554 555 CIO_CRW_EVENT(4, "chsc: scm change notification\n"); 556 if (sei_area->rs != 7) 557 return; 558 559 ret = scm_update_information(); 560 if (ret) 561 CIO_CRW_EVENT(0, "chsc: updating change notification" 562 " failed (rc=%d).\n", ret); 563 } 564 565 static void chsc_process_sei_scm_avail(struct chsc_sei_nt0_area *sei_area) 566 { 567 int ret; 568 569 CIO_CRW_EVENT(4, "chsc: scm available information\n"); 570 if (sei_area->rs != 7) 571 return; 572 573 ret = scm_process_availability_information(); 574 if (ret) 575 CIO_CRW_EVENT(0, "chsc: process availability information" 576 " failed (rc=%d).\n", ret); 577 } 578 579 static void chsc_process_sei_nt2(struct chsc_sei_nt2_area *sei_area) 580 { 581 switch (sei_area->cc) { 582 case 1: 583 zpci_event_error(sei_area->ccdf); 584 break; 585 case 2: 586 zpci_event_availability(sei_area->ccdf); 587 break; 588 default: 589 CIO_CRW_EVENT(2, "chsc: sei nt2 unhandled cc=%d\n", 590 sei_area->cc); 591 break; 592 } 593 } 594 595 static void chsc_process_sei_nt0(struct chsc_sei_nt0_area *sei_area) 596 { 597 /* which kind of information was stored? */ 598 switch (sei_area->cc) { 599 case 1: /* link incident*/ 600 chsc_process_sei_link_incident(sei_area); 601 break; 602 case 2: /* i/o resource accessibility */ 603 chsc_process_sei_res_acc(sei_area); 604 break; 605 case 7: /* channel-path-availability information */ 606 chsc_process_sei_chp_avail(sei_area); 607 break; 608 case 8: /* channel-path-configuration notification */ 609 chsc_process_sei_chp_config(sei_area); 610 break; 611 case 12: /* scm change notification */ 612 chsc_process_sei_scm_change(sei_area); 613 break; 614 case 14: /* scm available notification */ 615 chsc_process_sei_scm_avail(sei_area); 616 break; 617 default: /* other stuff */ 618 CIO_CRW_EVENT(2, "chsc: sei nt0 unhandled cc=%d\n", 619 sei_area->cc); 620 break; 621 } 622 623 /* Check if we might have lost some information. */ 624 if (sei_area->flags & 0x40) { 625 CIO_CRW_EVENT(2, "chsc: event overflow\n"); 626 css_schedule_eval_all(); 627 } 628 } 629 630 static void chsc_process_event_information(struct chsc_sei *sei, u64 ntsm) 631 { 632 static int ntsm_unsupported; 633 634 while (true) { 635 memset(sei, 0, sizeof(*sei)); 636 sei->request.length = 0x0010; 637 sei->request.code = 0x000e; 638 if (!ntsm_unsupported) 639 sei->ntsm = ntsm; 640 641 if (chsc(sei)) 642 break; 643 644 if (sei->response.code != 0x0001) { 645 CIO_CRW_EVENT(2, "chsc: sei failed (rc=%04x, ntsm=%llx)\n", 646 sei->response.code, sei->ntsm); 647 648 if (sei->response.code == 3 && sei->ntsm) { 649 /* Fallback for old firmware. */ 650 ntsm_unsupported = 1; 651 continue; 652 } 653 break; 654 } 655 656 CIO_CRW_EVENT(2, "chsc: sei successful (nt=%d)\n", sei->nt); 657 switch (sei->nt) { 658 case 0: 659 chsc_process_sei_nt0(&sei->u.nt0_area); 660 break; 661 case 2: 662 chsc_process_sei_nt2(&sei->u.nt2_area); 663 break; 664 default: 665 CIO_CRW_EVENT(2, "chsc: unhandled nt: %d\n", sei->nt); 666 break; 667 } 668 669 if (!(sei->u.nt0_area.flags & 0x80)) 670 break; 671 } 672 } 673 674 /* 675 * Handle channel subsystem related CRWs. 676 * Use store event information to find out what's going on. 677 * 678 * Note: Access to sei_page is serialized through machine check handler 679 * thread, so no need for locking. 680 */ 681 static void chsc_process_crw(struct crw *crw0, struct crw *crw1, int overflow) 682 { 683 struct chsc_sei *sei = sei_page; 684 685 if (overflow) { 686 css_schedule_eval_all(); 687 return; 688 } 689 CIO_CRW_EVENT(2, "CRW reports slct=%d, oflw=%d, " 690 "chn=%d, rsc=%X, anc=%d, erc=%X, rsid=%X\n", 691 crw0->slct, crw0->oflw, crw0->chn, crw0->rsc, crw0->anc, 692 crw0->erc, crw0->rsid); 693 694 CIO_TRACE_EVENT(2, "prcss"); 695 chsc_process_event_information(sei, CHSC_SEI_NT0 | CHSC_SEI_NT2); 696 } 697 698 void chsc_chp_online(struct chp_id chpid) 699 { 700 struct channel_path *chp = chpid_to_chp(chpid); 701 struct chp_link link; 702 char dbf_txt[15]; 703 704 sprintf(dbf_txt, "cadd%x.%02x", chpid.cssid, chpid.id); 705 CIO_TRACE_EVENT(2, dbf_txt); 706 707 if (chp_get_status(chpid) != 0) { 708 memset(&link, 0, sizeof(struct chp_link)); 709 link.chpid = chpid; 710 /* Wait until previous actions have settled. */ 711 css_wait_for_slow_path(); 712 713 mutex_lock(&chp->lock); 714 chp_update_desc(chp); 715 mutex_unlock(&chp->lock); 716 717 for_each_subchannel_staged(__s390_process_res_acc, NULL, 718 &link); 719 css_schedule_reprobe(); 720 } 721 } 722 723 static void __s390_subchannel_vary_chpid(struct subchannel *sch, 724 struct chp_id chpid, int on) 725 { 726 unsigned long flags; 727 struct chp_link link; 728 729 memset(&link, 0, sizeof(struct chp_link)); 730 link.chpid = chpid; 731 spin_lock_irqsave(sch->lock, flags); 732 if (sch->driver && sch->driver->chp_event) 733 sch->driver->chp_event(sch, &link, 734 on ? CHP_VARY_ON : CHP_VARY_OFF); 735 spin_unlock_irqrestore(sch->lock, flags); 736 } 737 738 static int s390_subchannel_vary_chpid_off(struct subchannel *sch, void *data) 739 { 740 struct chp_id *chpid = data; 741 742 __s390_subchannel_vary_chpid(sch, *chpid, 0); 743 return 0; 744 } 745 746 static int s390_subchannel_vary_chpid_on(struct subchannel *sch, void *data) 747 { 748 struct chp_id *chpid = data; 749 750 __s390_subchannel_vary_chpid(sch, *chpid, 1); 751 return 0; 752 } 753 754 /** 755 * chsc_chp_vary - propagate channel-path vary operation to subchannels 756 * @chpid: channl-path ID 757 * @on: non-zero for vary online, zero for vary offline 758 */ 759 int chsc_chp_vary(struct chp_id chpid, int on) 760 { 761 struct channel_path *chp = chpid_to_chp(chpid); 762 763 /* Wait until previous actions have settled. */ 764 css_wait_for_slow_path(); 765 /* 766 * Redo PathVerification on the devices the chpid connects to 767 */ 768 if (on) { 769 /* Try to update the channel path description. */ 770 chp_update_desc(chp); 771 for_each_subchannel_staged(s390_subchannel_vary_chpid_on, 772 NULL, &chpid); 773 css_schedule_reprobe(); 774 } else 775 for_each_subchannel_staged(s390_subchannel_vary_chpid_off, 776 NULL, &chpid); 777 778 return 0; 779 } 780 781 static void 782 chsc_remove_cmg_attr(struct channel_subsystem *css) 783 { 784 int i; 785 786 for (i = 0; i <= __MAX_CHPID; i++) { 787 if (!css->chps[i]) 788 continue; 789 chp_remove_cmg_attr(css->chps[i]); 790 } 791 } 792 793 static int 794 chsc_add_cmg_attr(struct channel_subsystem *css) 795 { 796 int i, ret; 797 798 ret = 0; 799 for (i = 0; i <= __MAX_CHPID; i++) { 800 if (!css->chps[i]) 801 continue; 802 ret = chp_add_cmg_attr(css->chps[i]); 803 if (ret) 804 goto cleanup; 805 } 806 return ret; 807 cleanup: 808 for (--i; i >= 0; i--) { 809 if (!css->chps[i]) 810 continue; 811 chp_remove_cmg_attr(css->chps[i]); 812 } 813 return ret; 814 } 815 816 int __chsc_do_secm(struct channel_subsystem *css, int enable) 817 { 818 struct { 819 struct chsc_header request; 820 u32 operation_code : 2; 821 u32 : 30; 822 u32 key : 4; 823 u32 : 28; 824 u32 zeroes1; 825 u32 cub_addr1; 826 u32 zeroes2; 827 u32 cub_addr2; 828 u32 reserved[13]; 829 struct chsc_header response; 830 u32 status : 8; 831 u32 : 4; 832 u32 fmt : 4; 833 u32 : 16; 834 } __attribute__ ((packed)) *secm_area; 835 int ret, ccode; 836 837 spin_lock_irq(&chsc_page_lock); 838 memset(chsc_page, 0, PAGE_SIZE); 839 secm_area = chsc_page; 840 secm_area->request.length = 0x0050; 841 secm_area->request.code = 0x0016; 842 843 secm_area->key = PAGE_DEFAULT_KEY >> 4; 844 secm_area->cub_addr1 = (u64)(unsigned long)css->cub_addr1; 845 secm_area->cub_addr2 = (u64)(unsigned long)css->cub_addr2; 846 847 secm_area->operation_code = enable ? 0 : 1; 848 849 ccode = chsc(secm_area); 850 if (ccode > 0) { 851 ret = (ccode == 3) ? -ENODEV : -EBUSY; 852 goto out; 853 } 854 855 switch (secm_area->response.code) { 856 case 0x0102: 857 case 0x0103: 858 ret = -EINVAL; 859 break; 860 default: 861 ret = chsc_error_from_response(secm_area->response.code); 862 } 863 if (ret != 0) 864 CIO_CRW_EVENT(2, "chsc: secm failed (rc=%04x)\n", 865 secm_area->response.code); 866 out: 867 spin_unlock_irq(&chsc_page_lock); 868 return ret; 869 } 870 871 int 872 chsc_secm(struct channel_subsystem *css, int enable) 873 { 874 int ret; 875 876 if (enable && !css->cm_enabled) { 877 css->cub_addr1 = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA); 878 css->cub_addr2 = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA); 879 if (!css->cub_addr1 || !css->cub_addr2) { 880 free_page((unsigned long)css->cub_addr1); 881 free_page((unsigned long)css->cub_addr2); 882 return -ENOMEM; 883 } 884 } 885 ret = __chsc_do_secm(css, enable); 886 if (!ret) { 887 css->cm_enabled = enable; 888 if (css->cm_enabled) { 889 ret = chsc_add_cmg_attr(css); 890 if (ret) { 891 __chsc_do_secm(css, 0); 892 css->cm_enabled = 0; 893 } 894 } else 895 chsc_remove_cmg_attr(css); 896 } 897 if (!css->cm_enabled) { 898 free_page((unsigned long)css->cub_addr1); 899 free_page((unsigned long)css->cub_addr2); 900 } 901 return ret; 902 } 903 904 int chsc_determine_channel_path_desc(struct chp_id chpid, int fmt, int rfmt, 905 int c, int m, void *page) 906 { 907 struct chsc_scpd *scpd_area; 908 int ccode, ret; 909 910 if ((rfmt == 1 || rfmt == 0) && c == 1 && 911 !css_general_characteristics.fcs) 912 return -EINVAL; 913 if ((rfmt == 2) && !css_general_characteristics.cib) 914 return -EINVAL; 915 916 memset(page, 0, PAGE_SIZE); 917 scpd_area = page; 918 scpd_area->request.length = 0x0010; 919 scpd_area->request.code = 0x0002; 920 scpd_area->cssid = chpid.cssid; 921 scpd_area->first_chpid = chpid.id; 922 scpd_area->last_chpid = chpid.id; 923 scpd_area->m = m; 924 scpd_area->c = c; 925 scpd_area->fmt = fmt; 926 scpd_area->rfmt = rfmt; 927 928 ccode = chsc(scpd_area); 929 if (ccode > 0) 930 return (ccode == 3) ? -ENODEV : -EBUSY; 931 932 ret = chsc_error_from_response(scpd_area->response.code); 933 if (ret) 934 CIO_CRW_EVENT(2, "chsc: scpd failed (rc=%04x)\n", 935 scpd_area->response.code); 936 return ret; 937 } 938 EXPORT_SYMBOL_GPL(chsc_determine_channel_path_desc); 939 940 int chsc_determine_base_channel_path_desc(struct chp_id chpid, 941 struct channel_path_desc *desc) 942 { 943 struct chsc_scpd *scpd_area; 944 unsigned long flags; 945 int ret; 946 947 spin_lock_irqsave(&chsc_page_lock, flags); 948 scpd_area = chsc_page; 949 ret = chsc_determine_channel_path_desc(chpid, 0, 0, 0, 0, scpd_area); 950 if (ret) 951 goto out; 952 953 memcpy(desc, scpd_area->data, sizeof(*desc)); 954 out: 955 spin_unlock_irqrestore(&chsc_page_lock, flags); 956 return ret; 957 } 958 959 int chsc_determine_fmt1_channel_path_desc(struct chp_id chpid, 960 struct channel_path_desc_fmt1 *desc) 961 { 962 struct chsc_scpd *scpd_area; 963 unsigned long flags; 964 int ret; 965 966 spin_lock_irqsave(&chsc_page_lock, flags); 967 scpd_area = chsc_page; 968 ret = chsc_determine_channel_path_desc(chpid, 0, 1, 1, 0, scpd_area); 969 if (ret) 970 goto out; 971 972 memcpy(desc, scpd_area->data, sizeof(*desc)); 973 out: 974 spin_unlock_irqrestore(&chsc_page_lock, flags); 975 return ret; 976 } 977 978 static void 979 chsc_initialize_cmg_chars(struct channel_path *chp, u8 cmcv, 980 struct cmg_chars *chars) 981 { 982 int i, mask; 983 984 for (i = 0; i < NR_MEASUREMENT_CHARS; i++) { 985 mask = 0x80 >> (i + 3); 986 if (cmcv & mask) 987 chp->cmg_chars.values[i] = chars->values[i]; 988 else 989 chp->cmg_chars.values[i] = 0; 990 } 991 } 992 993 int chsc_get_channel_measurement_chars(struct channel_path *chp) 994 { 995 int ccode, ret; 996 997 struct { 998 struct chsc_header request; 999 u32 : 24; 1000 u32 first_chpid : 8; 1001 u32 : 24; 1002 u32 last_chpid : 8; 1003 u32 zeroes1; 1004 struct chsc_header response; 1005 u32 zeroes2; 1006 u32 not_valid : 1; 1007 u32 shared : 1; 1008 u32 : 22; 1009 u32 chpid : 8; 1010 u32 cmcv : 5; 1011 u32 : 11; 1012 u32 cmgq : 8; 1013 u32 cmg : 8; 1014 u32 zeroes3; 1015 u32 data[NR_MEASUREMENT_CHARS]; 1016 } __attribute__ ((packed)) *scmc_area; 1017 1018 chp->shared = -1; 1019 chp->cmg = -1; 1020 1021 if (!css_chsc_characteristics.scmc || !css_chsc_characteristics.secm) 1022 return -EINVAL; 1023 1024 spin_lock_irq(&chsc_page_lock); 1025 memset(chsc_page, 0, PAGE_SIZE); 1026 scmc_area = chsc_page; 1027 scmc_area->request.length = 0x0010; 1028 scmc_area->request.code = 0x0022; 1029 scmc_area->first_chpid = chp->chpid.id; 1030 scmc_area->last_chpid = chp->chpid.id; 1031 1032 ccode = chsc(scmc_area); 1033 if (ccode > 0) { 1034 ret = (ccode == 3) ? -ENODEV : -EBUSY; 1035 goto out; 1036 } 1037 1038 ret = chsc_error_from_response(scmc_area->response.code); 1039 if (ret) { 1040 CIO_CRW_EVENT(2, "chsc: scmc failed (rc=%04x)\n", 1041 scmc_area->response.code); 1042 goto out; 1043 } 1044 if (scmc_area->not_valid) 1045 goto out; 1046 1047 chp->cmg = scmc_area->cmg; 1048 chp->shared = scmc_area->shared; 1049 if (chp->cmg != 2 && chp->cmg != 3) { 1050 /* No cmg-dependent data. */ 1051 goto out; 1052 } 1053 chsc_initialize_cmg_chars(chp, scmc_area->cmcv, 1054 (struct cmg_chars *) &scmc_area->data); 1055 out: 1056 spin_unlock_irq(&chsc_page_lock); 1057 return ret; 1058 } 1059 1060 int __init chsc_init(void) 1061 { 1062 int ret; 1063 1064 sei_page = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA); 1065 chsc_page = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA); 1066 if (!sei_page || !chsc_page) { 1067 ret = -ENOMEM; 1068 goto out_err; 1069 } 1070 ret = crw_register_handler(CRW_RSC_CSS, chsc_process_crw); 1071 if (ret) 1072 goto out_err; 1073 return ret; 1074 out_err: 1075 free_page((unsigned long)chsc_page); 1076 free_page((unsigned long)sei_page); 1077 return ret; 1078 } 1079 1080 void __init chsc_init_cleanup(void) 1081 { 1082 crw_unregister_handler(CRW_RSC_CSS); 1083 free_page((unsigned long)chsc_page); 1084 free_page((unsigned long)sei_page); 1085 } 1086 1087 int __chsc_enable_facility(struct chsc_sda_area *sda_area, int operation_code) 1088 { 1089 int ret; 1090 1091 sda_area->request.length = 0x0400; 1092 sda_area->request.code = 0x0031; 1093 sda_area->operation_code = operation_code; 1094 1095 ret = chsc(sda_area); 1096 if (ret > 0) { 1097 ret = (ret == 3) ? -ENODEV : -EBUSY; 1098 goto out; 1099 } 1100 1101 switch (sda_area->response.code) { 1102 case 0x0101: 1103 ret = -EOPNOTSUPP; 1104 break; 1105 default: 1106 ret = chsc_error_from_response(sda_area->response.code); 1107 } 1108 out: 1109 return ret; 1110 } 1111 1112 int chsc_enable_facility(int operation_code) 1113 { 1114 struct chsc_sda_area *sda_area; 1115 unsigned long flags; 1116 int ret; 1117 1118 spin_lock_irqsave(&chsc_page_lock, flags); 1119 memset(chsc_page, 0, PAGE_SIZE); 1120 sda_area = chsc_page; 1121 1122 ret = __chsc_enable_facility(sda_area, operation_code); 1123 if (ret != 0) 1124 CIO_CRW_EVENT(2, "chsc: sda (oc=%x) failed (rc=%04x)\n", 1125 operation_code, sda_area->response.code); 1126 1127 spin_unlock_irqrestore(&chsc_page_lock, flags); 1128 return ret; 1129 } 1130 1131 struct css_general_char css_general_characteristics; 1132 struct css_chsc_char css_chsc_characteristics; 1133 1134 int __init 1135 chsc_determine_css_characteristics(void) 1136 { 1137 int result; 1138 struct { 1139 struct chsc_header request; 1140 u32 reserved1; 1141 u32 reserved2; 1142 u32 reserved3; 1143 struct chsc_header response; 1144 u32 reserved4; 1145 u32 general_char[510]; 1146 u32 chsc_char[508]; 1147 } __attribute__ ((packed)) *scsc_area; 1148 1149 spin_lock_irq(&chsc_page_lock); 1150 memset(chsc_page, 0, PAGE_SIZE); 1151 scsc_area = chsc_page; 1152 scsc_area->request.length = 0x0010; 1153 scsc_area->request.code = 0x0010; 1154 1155 result = chsc(scsc_area); 1156 if (result) { 1157 result = (result == 3) ? -ENODEV : -EBUSY; 1158 goto exit; 1159 } 1160 1161 result = chsc_error_from_response(scsc_area->response.code); 1162 if (result == 0) { 1163 memcpy(&css_general_characteristics, scsc_area->general_char, 1164 sizeof(css_general_characteristics)); 1165 memcpy(&css_chsc_characteristics, scsc_area->chsc_char, 1166 sizeof(css_chsc_characteristics)); 1167 } else 1168 CIO_CRW_EVENT(2, "chsc: scsc failed (rc=%04x)\n", 1169 scsc_area->response.code); 1170 exit: 1171 spin_unlock_irq(&chsc_page_lock); 1172 return result; 1173 } 1174 1175 EXPORT_SYMBOL_GPL(css_general_characteristics); 1176 EXPORT_SYMBOL_GPL(css_chsc_characteristics); 1177 1178 int chsc_sstpc(void *page, unsigned int op, u16 ctrl, u64 *clock_delta) 1179 { 1180 struct { 1181 struct chsc_header request; 1182 unsigned int rsvd0; 1183 unsigned int op : 8; 1184 unsigned int rsvd1 : 8; 1185 unsigned int ctrl : 16; 1186 unsigned int rsvd2[5]; 1187 struct chsc_header response; 1188 unsigned int rsvd3[3]; 1189 u64 clock_delta; 1190 unsigned int rsvd4[2]; 1191 } __attribute__ ((packed)) *rr; 1192 int rc; 1193 1194 memset(page, 0, PAGE_SIZE); 1195 rr = page; 1196 rr->request.length = 0x0020; 1197 rr->request.code = 0x0033; 1198 rr->op = op; 1199 rr->ctrl = ctrl; 1200 rc = chsc(rr); 1201 if (rc) 1202 return -EIO; 1203 rc = (rr->response.code == 0x0001) ? 0 : -EIO; 1204 if (clock_delta) 1205 *clock_delta = rr->clock_delta; 1206 return rc; 1207 } 1208 1209 int chsc_sstpi(void *page, void *result, size_t size) 1210 { 1211 struct { 1212 struct chsc_header request; 1213 unsigned int rsvd0[3]; 1214 struct chsc_header response; 1215 char data[size]; 1216 } __attribute__ ((packed)) *rr; 1217 int rc; 1218 1219 memset(page, 0, PAGE_SIZE); 1220 rr = page; 1221 rr->request.length = 0x0010; 1222 rr->request.code = 0x0038; 1223 rc = chsc(rr); 1224 if (rc) 1225 return -EIO; 1226 memcpy(result, &rr->data, size); 1227 return (rr->response.code == 0x0001) ? 0 : -EIO; 1228 } 1229 1230 int chsc_siosl(struct subchannel_id schid) 1231 { 1232 struct { 1233 struct chsc_header request; 1234 u32 word1; 1235 struct subchannel_id sid; 1236 u32 word3; 1237 struct chsc_header response; 1238 u32 word[11]; 1239 } __attribute__ ((packed)) *siosl_area; 1240 unsigned long flags; 1241 int ccode; 1242 int rc; 1243 1244 spin_lock_irqsave(&chsc_page_lock, flags); 1245 memset(chsc_page, 0, PAGE_SIZE); 1246 siosl_area = chsc_page; 1247 siosl_area->request.length = 0x0010; 1248 siosl_area->request.code = 0x0046; 1249 siosl_area->word1 = 0x80000000; 1250 siosl_area->sid = schid; 1251 1252 ccode = chsc(siosl_area); 1253 if (ccode > 0) { 1254 if (ccode == 3) 1255 rc = -ENODEV; 1256 else 1257 rc = -EBUSY; 1258 CIO_MSG_EVENT(2, "chsc: chsc failed for 0.%x.%04x (ccode=%d)\n", 1259 schid.ssid, schid.sch_no, ccode); 1260 goto out; 1261 } 1262 rc = chsc_error_from_response(siosl_area->response.code); 1263 if (rc) 1264 CIO_MSG_EVENT(2, "chsc: siosl failed for 0.%x.%04x (rc=%04x)\n", 1265 schid.ssid, schid.sch_no, 1266 siosl_area->response.code); 1267 else 1268 CIO_MSG_EVENT(4, "chsc: siosl succeeded for 0.%x.%04x\n", 1269 schid.ssid, schid.sch_no); 1270 out: 1271 spin_unlock_irqrestore(&chsc_page_lock, flags); 1272 return rc; 1273 } 1274 EXPORT_SYMBOL_GPL(chsc_siosl); 1275 1276 /** 1277 * chsc_scm_info() - store SCM information (SSI) 1278 * @scm_area: request and response block for SSI 1279 * @token: continuation token 1280 * 1281 * Returns 0 on success. 1282 */ 1283 int chsc_scm_info(struct chsc_scm_info *scm_area, u64 token) 1284 { 1285 int ccode, ret; 1286 1287 memset(scm_area, 0, sizeof(*scm_area)); 1288 scm_area->request.length = 0x0020; 1289 scm_area->request.code = 0x004C; 1290 scm_area->reqtok = token; 1291 1292 ccode = chsc(scm_area); 1293 if (ccode > 0) { 1294 ret = (ccode == 3) ? -ENODEV : -EBUSY; 1295 goto out; 1296 } 1297 ret = chsc_error_from_response(scm_area->response.code); 1298 if (ret != 0) 1299 CIO_MSG_EVENT(2, "chsc: scm info failed (rc=%04x)\n", 1300 scm_area->response.code); 1301 out: 1302 return ret; 1303 } 1304 EXPORT_SYMBOL_GPL(chsc_scm_info); 1305 1306 /** 1307 * chsc_pnso_brinfo() - Perform Network-Subchannel Operation, Bridge Info. 1308 * @schid: id of the subchannel on which PNSO is performed 1309 * @brinfo_area: request and response block for the operation 1310 * @resume_token: resume token for multiblock response 1311 * @cnc: Boolean change-notification control 1312 * 1313 * brinfo_area must be allocated by the caller with get_zeroed_page(GFP_KERNEL) 1314 * 1315 * Returns 0 on success. 1316 */ 1317 int chsc_pnso_brinfo(struct subchannel_id schid, 1318 struct chsc_pnso_area *brinfo_area, 1319 struct chsc_brinfo_resume_token resume_token, 1320 int cnc) 1321 { 1322 memset(brinfo_area, 0, sizeof(*brinfo_area)); 1323 brinfo_area->request.length = 0x0030; 1324 brinfo_area->request.code = 0x003d; /* network-subchannel operation */ 1325 brinfo_area->m = schid.m; 1326 brinfo_area->ssid = schid.ssid; 1327 brinfo_area->sch = schid.sch_no; 1328 brinfo_area->cssid = schid.cssid; 1329 brinfo_area->oc = 0; /* Store-network-bridging-information list */ 1330 brinfo_area->resume_token = resume_token; 1331 brinfo_area->n = (cnc != 0); 1332 if (chsc(brinfo_area)) 1333 return -EIO; 1334 return chsc_error_from_response(brinfo_area->response.code); 1335 } 1336 EXPORT_SYMBOL_GPL(chsc_pnso_brinfo); 1337