Linux Audio

Check our new training course

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