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