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