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