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