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