]>
Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 | 2 | * S/390 common I/O routines -- low level i/o calls |
1da177e4 | 3 | * |
a53c8fab | 4 | * Copyright IBM Corp. 1999, 2008 |
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 | * Martin Schwidefsky (schwidefsky@de.ibm.com) | |
9 | */ | |
10 | ||
e6d5a428 ME |
11 | #define KMSG_COMPONENT "cio" |
12 | #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt | |
13 | ||
88dbd203 | 14 | #include <linux/ftrace.h> |
1da177e4 | 15 | #include <linux/module.h> |
1da177e4 LT |
16 | #include <linux/init.h> |
17 | #include <linux/slab.h> | |
18 | #include <linux/device.h> | |
19 | #include <linux/kernel_stat.h> | |
20 | #include <linux/interrupt.h> | |
257ceab7 | 21 | #include <linux/irq.h> |
1da177e4 LT |
22 | #include <asm/cio.h> |
23 | #include <asm/delay.h> | |
24 | #include <asm/irq.h> | |
5a489b98 | 25 | #include <asm/irq_regs.h> |
e87bfe51 | 26 | #include <asm/setup.h> |
15e9b586 | 27 | #include <asm/reset.h> |
46b05d26 | 28 | #include <asm/ipl.h> |
e5854a58 | 29 | #include <asm/chpid.h> |
4e8e56c6 | 30 | #include <asm/airq.h> |
3a3fc29a | 31 | #include <asm/isc.h> |
bfc3f028 | 32 | #include <linux/cputime.h> |
83262d63 | 33 | #include <asm/fcx.h> |
f5daba1d HC |
34 | #include <asm/nmi.h> |
35 | #include <asm/crw.h> | |
1da177e4 LT |
36 | #include "cio.h" |
37 | #include "css.h" | |
38 | #include "chsc.h" | |
39 | #include "ioasm.h" | |
cd6b4f27 | 40 | #include "io_sch.h" |
1da177e4 LT |
41 | #include "blacklist.h" |
42 | #include "cio_debug.h" | |
e6b6e10a | 43 | #include "chp.h" |
1da177e4 LT |
44 | |
45 | debug_info_t *cio_debug_msg_id; | |
46 | debug_info_t *cio_debug_trace_id; | |
47 | debug_info_t *cio_debug_crw_id; | |
48 | ||
63aef00b MS |
49 | DEFINE_PER_CPU_ALIGNED(struct irb, cio_irb); |
50 | EXPORT_PER_CPU_SYMBOL(cio_irb); | |
51 | ||
1da177e4 LT |
52 | /* |
53 | * Function: cio_debug_init | |
bc698bcf CH |
54 | * Initializes three debug logs for common I/O: |
55 | * - cio_msg logs generic cio messages | |
1da177e4 | 56 | * - cio_trace logs the calling of different functions |
bc698bcf | 57 | * - cio_crw logs machine check related cio messages |
1da177e4 | 58 | */ |
bc698bcf | 59 | static int __init cio_debug_init(void) |
1da177e4 | 60 | { |
f7e1e65d | 61 | cio_debug_msg_id = debug_register("cio_msg", 16, 1, 11 * sizeof(long)); |
1da177e4 LT |
62 | if (!cio_debug_msg_id) |
63 | goto out_unregister; | |
bc698bcf CH |
64 | debug_register_view(cio_debug_msg_id, &debug_sprintf_view); |
65 | debug_set_level(cio_debug_msg_id, 2); | |
361f494d | 66 | cio_debug_trace_id = debug_register("cio_trace", 16, 1, 16); |
1da177e4 LT |
67 | if (!cio_debug_trace_id) |
68 | goto out_unregister; | |
bc698bcf CH |
69 | debug_register_view(cio_debug_trace_id, &debug_hex_ascii_view); |
70 | debug_set_level(cio_debug_trace_id, 2); | |
f7e1e65d | 71 | cio_debug_crw_id = debug_register("cio_crw", 8, 1, 8 * sizeof(long)); |
1da177e4 LT |
72 | if (!cio_debug_crw_id) |
73 | goto out_unregister; | |
bc698bcf CH |
74 | debug_register_view(cio_debug_crw_id, &debug_sprintf_view); |
75 | debug_set_level(cio_debug_crw_id, 4); | |
1da177e4 LT |
76 | return 0; |
77 | ||
78 | out_unregister: | |
79 | if (cio_debug_msg_id) | |
bc698bcf | 80 | debug_unregister(cio_debug_msg_id); |
1da177e4 | 81 | if (cio_debug_trace_id) |
bc698bcf | 82 | debug_unregister(cio_debug_trace_id); |
1da177e4 | 83 | if (cio_debug_crw_id) |
bc698bcf | 84 | debug_unregister(cio_debug_crw_id); |
1da177e4 LT |
85 | return -1; |
86 | } | |
87 | ||
88 | arch_initcall (cio_debug_init); | |
89 | ||
c513d07a | 90 | int cio_set_options(struct subchannel *sch, int flags) |
1da177e4 | 91 | { |
c513d07a | 92 | struct io_subchannel_private *priv = to_io_private(sch); |
1da177e4 | 93 | |
c513d07a SO |
94 | priv->options.suspend = (flags & DOIO_ALLOW_SUSPEND) != 0; |
95 | priv->options.prefetch = (flags & DOIO_DENY_PREFETCH) != 0; | |
96 | priv->options.inter = (flags & DOIO_SUPPRESS_INTER) != 0; | |
97 | return 0; | |
1da177e4 LT |
98 | } |
99 | ||
4d284cac | 100 | static int |
1da177e4 LT |
101 | cio_start_handle_notoper(struct subchannel *sch, __u8 lpm) |
102 | { | |
103 | char dbf_text[15]; | |
104 | ||
105 | if (lpm != 0) | |
106 | sch->lpm &= ~lpm; | |
107 | else | |
108 | sch->lpm = 0; | |
109 | ||
139b83dd | 110 | CIO_MSG_EVENT(2, "cio_start: 'not oper' status for " |
fb6958a5 CH |
111 | "subchannel 0.%x.%04x!\n", sch->schid.ssid, |
112 | sch->schid.sch_no); | |
cdb912a4 SO |
113 | |
114 | if (cio_update_schib(sch)) | |
115 | return -ENODEV; | |
116 | ||
2a0217d5 | 117 | sprintf(dbf_text, "no%s", dev_name(&sch->dev)); |
1da177e4 LT |
118 | CIO_TRACE_EVENT(0, dbf_text); |
119 | CIO_HEX_EVENT(0, &sch->schib, sizeof (struct schib)); | |
120 | ||
121 | return (sch->lpm ? -EACCES : -ENODEV); | |
122 | } | |
123 | ||
124 | int | |
125 | cio_start_key (struct subchannel *sch, /* subchannel structure */ | |
126 | struct ccw1 * cpa, /* logical channel prog addr */ | |
127 | __u8 lpm, /* logical path mask */ | |
128 | __u8 key) /* storage key */ | |
129 | { | |
c513d07a SO |
130 | struct io_subchannel_private *priv = to_io_private(sch); |
131 | union orb *orb = &priv->orb; | |
1da177e4 LT |
132 | int ccode; |
133 | ||
efd986db SO |
134 | CIO_TRACE_EVENT(5, "stIO"); |
135 | CIO_TRACE_EVENT(5, dev_name(&sch->dev)); | |
1da177e4 | 136 | |
9adb8c1d | 137 | memset(orb, 0, sizeof(union orb)); |
1da177e4 | 138 | /* sch is always under 2G. */ |
83262d63 PO |
139 | orb->cmd.intparm = (u32)(addr_t)sch; |
140 | orb->cmd.fmt = 1; | |
1da177e4 | 141 | |
c513d07a SO |
142 | orb->cmd.pfch = priv->options.prefetch == 0; |
143 | orb->cmd.spnd = priv->options.suspend; | |
144 | orb->cmd.ssic = priv->options.suspend && priv->options.inter; | |
83262d63 | 145 | orb->cmd.lpm = (lpm != 0) ? lpm : sch->lpm; |
1da177e4 LT |
146 | /* |
147 | * for 64 bit we always support 64 bit IDAWs with 4k page size only | |
148 | */ | |
83262d63 PO |
149 | orb->cmd.c64 = 1; |
150 | orb->cmd.i2k = 0; | |
83262d63 | 151 | orb->cmd.key = key >> 4; |
1da177e4 | 152 | /* issue "Start Subchannel" */ |
83262d63 | 153 | orb->cmd.cpa = (__u32) __pa(cpa); |
cd6b4f27 | 154 | ccode = ssch(sch->schid, orb); |
1da177e4 LT |
155 | |
156 | /* process condition code */ | |
efd986db | 157 | CIO_HEX_EVENT(5, &ccode, sizeof(ccode)); |
1da177e4 LT |
158 | |
159 | switch (ccode) { | |
160 | case 0: | |
161 | /* | |
162 | * initialize device status information | |
163 | */ | |
23d805b6 | 164 | sch->schib.scsw.cmd.actl |= SCSW_ACTL_START_PEND; |
1da177e4 LT |
165 | return 0; |
166 | case 1: /* status pending */ | |
167 | case 2: /* busy */ | |
168 | return -EBUSY; | |
c91ebe49 | 169 | case 3: /* device/path not operational */ |
1da177e4 | 170 | return cio_start_handle_notoper(sch, lpm); |
c91ebe49 CH |
171 | default: |
172 | return ccode; | |
1da177e4 LT |
173 | } |
174 | } | |
175 | ||
176 | int | |
177 | cio_start (struct subchannel *sch, struct ccw1 *cpa, __u8 lpm) | |
178 | { | |
0b642ede | 179 | return cio_start_key(sch, cpa, lpm, PAGE_DEFAULT_KEY); |
1da177e4 LT |
180 | } |
181 | ||
182 | /* | |
183 | * resume suspended I/O operation | |
184 | */ | |
185 | int | |
186 | cio_resume (struct subchannel *sch) | |
187 | { | |
1da177e4 LT |
188 | int ccode; |
189 | ||
efd986db | 190 | CIO_TRACE_EVENT(4, "resIO"); |
2a0217d5 | 191 | CIO_TRACE_EVENT(4, dev_name(&sch->dev)); |
1da177e4 | 192 | |
a8237fc4 | 193 | ccode = rsch (sch->schid); |
1da177e4 | 194 | |
efd986db | 195 | CIO_HEX_EVENT(4, &ccode, sizeof(ccode)); |
1da177e4 LT |
196 | |
197 | switch (ccode) { | |
198 | case 0: | |
23d805b6 | 199 | sch->schib.scsw.cmd.actl |= SCSW_ACTL_RESUME_PEND; |
1da177e4 LT |
200 | return 0; |
201 | case 1: | |
202 | return -EBUSY; | |
203 | case 2: | |
204 | return -EINVAL; | |
205 | default: | |
206 | /* | |
207 | * useless to wait for request completion | |
208 | * as device is no longer operational ! | |
209 | */ | |
210 | return -ENODEV; | |
211 | } | |
212 | } | |
213 | ||
214 | /* | |
215 | * halt I/O operation | |
216 | */ | |
217 | int | |
218 | cio_halt(struct subchannel *sch) | |
219 | { | |
1da177e4 LT |
220 | int ccode; |
221 | ||
222 | if (!sch) | |
223 | return -ENODEV; | |
224 | ||
efd986db | 225 | CIO_TRACE_EVENT(2, "haltIO"); |
2a0217d5 | 226 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 LT |
227 | |
228 | /* | |
229 | * Issue "Halt subchannel" and process condition code | |
230 | */ | |
a8237fc4 | 231 | ccode = hsch (sch->schid); |
1da177e4 | 232 | |
efd986db | 233 | CIO_HEX_EVENT(2, &ccode, sizeof(ccode)); |
1da177e4 LT |
234 | |
235 | switch (ccode) { | |
236 | case 0: | |
23d805b6 | 237 | sch->schib.scsw.cmd.actl |= SCSW_ACTL_HALT_PEND; |
1da177e4 LT |
238 | return 0; |
239 | case 1: /* status pending */ | |
240 | case 2: /* busy */ | |
241 | return -EBUSY; | |
242 | default: /* device not operational */ | |
243 | return -ENODEV; | |
244 | } | |
245 | } | |
246 | ||
247 | /* | |
248 | * Clear I/O operation | |
249 | */ | |
250 | int | |
251 | cio_clear(struct subchannel *sch) | |
252 | { | |
1da177e4 LT |
253 | int ccode; |
254 | ||
255 | if (!sch) | |
256 | return -ENODEV; | |
257 | ||
efd986db | 258 | CIO_TRACE_EVENT(2, "clearIO"); |
2a0217d5 | 259 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 LT |
260 | |
261 | /* | |
262 | * Issue "Clear subchannel" and process condition code | |
263 | */ | |
a8237fc4 | 264 | ccode = csch (sch->schid); |
1da177e4 | 265 | |
efd986db | 266 | CIO_HEX_EVENT(2, &ccode, sizeof(ccode)); |
1da177e4 LT |
267 | |
268 | switch (ccode) { | |
269 | case 0: | |
23d805b6 | 270 | sch->schib.scsw.cmd.actl |= SCSW_ACTL_CLEAR_PEND; |
1da177e4 LT |
271 | return 0; |
272 | default: /* device not operational */ | |
273 | return -ENODEV; | |
274 | } | |
275 | } | |
276 | ||
277 | /* | |
278 | * Function: cio_cancel | |
279 | * Issues a "Cancel Subchannel" on the specified subchannel | |
280 | * Note: We don't need any fancy intparms and flags here | |
281 | * since xsch is executed synchronously. | |
282 | * Only for common I/O internal use as for now. | |
283 | */ | |
284 | int | |
285 | cio_cancel (struct subchannel *sch) | |
286 | { | |
1da177e4 LT |
287 | int ccode; |
288 | ||
289 | if (!sch) | |
290 | return -ENODEV; | |
291 | ||
efd986db | 292 | CIO_TRACE_EVENT(2, "cancelIO"); |
2a0217d5 | 293 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 | 294 | |
a8237fc4 | 295 | ccode = xsch (sch->schid); |
1da177e4 | 296 | |
efd986db | 297 | CIO_HEX_EVENT(2, &ccode, sizeof(ccode)); |
1da177e4 LT |
298 | |
299 | switch (ccode) { | |
300 | case 0: /* success */ | |
301 | /* Update information in scsw. */ | |
cdb912a4 SO |
302 | if (cio_update_schib(sch)) |
303 | return -ENODEV; | |
1da177e4 LT |
304 | return 0; |
305 | case 1: /* status pending */ | |
306 | return -EBUSY; | |
307 | case 2: /* not applicable */ | |
308 | return -EINVAL; | |
309 | default: /* not oper */ | |
310 | return -ENODEV; | |
311 | } | |
312 | } | |
313 | ||
13952ec1 SO |
314 | |
315 | static void cio_apply_config(struct subchannel *sch, struct schib *schib) | |
316 | { | |
317 | schib->pmcw.intparm = sch->config.intparm; | |
318 | schib->pmcw.mbi = sch->config.mbi; | |
319 | schib->pmcw.isc = sch->config.isc; | |
320 | schib->pmcw.ena = sch->config.ena; | |
321 | schib->pmcw.mme = sch->config.mme; | |
322 | schib->pmcw.mp = sch->config.mp; | |
323 | schib->pmcw.csense = sch->config.csense; | |
324 | schib->pmcw.mbfc = sch->config.mbfc; | |
325 | if (sch->config.mbfc) | |
326 | schib->mba = sch->config.mba; | |
327 | } | |
328 | ||
329 | static int cio_check_config(struct subchannel *sch, struct schib *schib) | |
330 | { | |
331 | return (schib->pmcw.intparm == sch->config.intparm) && | |
332 | (schib->pmcw.mbi == sch->config.mbi) && | |
333 | (schib->pmcw.isc == sch->config.isc) && | |
334 | (schib->pmcw.ena == sch->config.ena) && | |
335 | (schib->pmcw.mme == sch->config.mme) && | |
336 | (schib->pmcw.mp == sch->config.mp) && | |
337 | (schib->pmcw.csense == sch->config.csense) && | |
338 | (schib->pmcw.mbfc == sch->config.mbfc) && | |
339 | (!sch->config.mbfc || (schib->mba == sch->config.mba)); | |
340 | } | |
341 | ||
1da177e4 | 342 | /* |
13952ec1 | 343 | * cio_commit_config - apply configuration to the subchannel |
1da177e4 | 344 | */ |
13952ec1 | 345 | int cio_commit_config(struct subchannel *sch) |
1da177e4 | 346 | { |
13952ec1 | 347 | int ccode, retry, ret = 0; |
1bc8927c SO |
348 | struct schib schib; |
349 | struct irb irb; | |
13952ec1 | 350 | |
8821d24c | 351 | if (stsch_err(sch->schid, &schib) || !css_sch_is_valid(&schib)) |
13952ec1 | 352 | return -ENODEV; |
1da177e4 | 353 | |
1da177e4 | 354 | for (retry = 0; retry < 5; retry++) { |
13952ec1 SO |
355 | /* copy desired changes to local schib */ |
356 | cio_apply_config(sch, &schib); | |
357 | ccode = msch_err(sch->schid, &schib); | |
358 | if (ccode < 0) /* -EIO if msch gets a program check. */ | |
1da177e4 LT |
359 | return ccode; |
360 | switch (ccode) { | |
73ac36ea | 361 | case 0: /* successful */ |
8821d24c | 362 | if (stsch_err(sch->schid, &schib) || |
13952ec1 SO |
363 | !css_sch_is_valid(&schib)) |
364 | return -ENODEV; | |
365 | if (cio_check_config(sch, &schib)) { | |
366 | /* commit changes from local schib */ | |
367 | memcpy(&sch->schib, &schib, sizeof(schib)); | |
368 | return 0; | |
369 | } | |
370 | ret = -EAGAIN; | |
371 | break; | |
372 | case 1: /* status pending */ | |
1bc8927c SO |
373 | ret = -EBUSY; |
374 | if (tsch(sch->schid, &irb)) | |
375 | return ret; | |
376 | break; | |
13952ec1 SO |
377 | case 2: /* busy */ |
378 | udelay(100); /* allow for recovery */ | |
1da177e4 LT |
379 | ret = -EBUSY; |
380 | break; | |
13952ec1 | 381 | case 3: /* not operational */ |
1da177e4 LT |
382 | return -ENODEV; |
383 | } | |
384 | } | |
385 | return ret; | |
386 | } | |
387 | ||
cdb912a4 SO |
388 | /** |
389 | * cio_update_schib - Perform stsch and update schib if subchannel is valid. | |
390 | * @sch: subchannel on which to perform stsch | |
391 | * Return zero on success, -ENODEV otherwise. | |
392 | */ | |
393 | int cio_update_schib(struct subchannel *sch) | |
394 | { | |
395 | struct schib schib; | |
396 | ||
8821d24c | 397 | if (stsch_err(sch->schid, &schib) || !css_sch_is_valid(&schib)) |
cdb912a4 SO |
398 | return -ENODEV; |
399 | ||
400 | memcpy(&sch->schib, &schib, sizeof(schib)); | |
401 | return 0; | |
402 | } | |
403 | EXPORT_SYMBOL_GPL(cio_update_schib); | |
404 | ||
44a1c19e CH |
405 | /** |
406 | * cio_enable_subchannel - enable a subchannel. | |
407 | * @sch: subchannel to be enabled | |
408 | * @intparm: interruption parameter to set | |
1da177e4 | 409 | */ |
edf22096 | 410 | int cio_enable_subchannel(struct subchannel *sch, u32 intparm) |
1da177e4 | 411 | { |
1da177e4 LT |
412 | int ret; |
413 | ||
efd986db | 414 | CIO_TRACE_EVENT(2, "ensch"); |
2a0217d5 | 415 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 | 416 | |
d7b5a4c9 CH |
417 | if (sch_is_pseudo_sch(sch)) |
418 | return -EINVAL; | |
cdb912a4 | 419 | if (cio_update_schib(sch)) |
1da177e4 LT |
420 | return -ENODEV; |
421 | ||
13952ec1 SO |
422 | sch->config.ena = 1; |
423 | sch->config.isc = sch->isc; | |
424 | sch->config.intparm = intparm; | |
425 | ||
1bc8927c SO |
426 | ret = cio_commit_config(sch); |
427 | if (ret == -EIO) { | |
428 | /* | |
429 | * Got a program check in msch. Try without | |
430 | * the concurrent sense bit the next time. | |
431 | */ | |
432 | sch->config.csense = 0; | |
13952ec1 | 433 | ret = cio_commit_config(sch); |
1da177e4 | 434 | } |
efd986db | 435 | CIO_HEX_EVENT(2, &ret, sizeof(ret)); |
1da177e4 LT |
436 | return ret; |
437 | } | |
44a1c19e | 438 | EXPORT_SYMBOL_GPL(cio_enable_subchannel); |
1da177e4 | 439 | |
44a1c19e CH |
440 | /** |
441 | * cio_disable_subchannel - disable a subchannel. | |
442 | * @sch: subchannel to disable | |
1da177e4 | 443 | */ |
44a1c19e | 444 | int cio_disable_subchannel(struct subchannel *sch) |
1da177e4 | 445 | { |
1da177e4 LT |
446 | int ret; |
447 | ||
efd986db | 448 | CIO_TRACE_EVENT(2, "dissch"); |
2a0217d5 | 449 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 | 450 | |
d7b5a4c9 CH |
451 | if (sch_is_pseudo_sch(sch)) |
452 | return 0; | |
cdb912a4 | 453 | if (cio_update_schib(sch)) |
1da177e4 LT |
454 | return -ENODEV; |
455 | ||
13952ec1 | 456 | sch->config.ena = 0; |
1bc8927c | 457 | ret = cio_commit_config(sch); |
13952ec1 | 458 | |
efd986db | 459 | CIO_HEX_EVENT(2, &ret, sizeof(ret)); |
1da177e4 LT |
460 | return ret; |
461 | } | |
44a1c19e | 462 | EXPORT_SYMBOL_GPL(cio_disable_subchannel); |
1da177e4 | 463 | |
b3a686f4 | 464 | static int cio_check_devno_blacklisted(struct subchannel *sch) |
0ae7a7b2 | 465 | { |
0ae7a7b2 CH |
466 | if (is_blacklisted(sch->schid.ssid, sch->schib.pmcw.dev)) { |
467 | /* | |
468 | * This device must not be known to Linux. So we simply | |
469 | * say that there is no device and return ENODEV. | |
470 | */ | |
471 | CIO_MSG_EVENT(6, "Blacklisted device detected " | |
472 | "at devno %04X, subchannel set %x\n", | |
473 | sch->schib.pmcw.dev, sch->schid.ssid); | |
474 | return -ENODEV; | |
475 | } | |
476 | return 0; | |
477 | } | |
478 | ||
479 | /** | |
480 | * cio_validate_subchannel - basic validation of subchannel | |
481 | * @sch: subchannel structure to be filled out | |
482 | * @schid: subchannel id | |
1da177e4 LT |
483 | * |
484 | * Find out subchannel type and initialize struct subchannel. | |
485 | * Return codes: | |
0ae7a7b2 | 486 | * 0 on success |
1da177e4 | 487 | * -ENXIO for non-defined subchannels |
0ae7a7b2 CH |
488 | * -ENODEV for invalid subchannels or blacklisted devices |
489 | * -EIO for subchannels in an invalid subchannel set | |
1da177e4 | 490 | */ |
0ae7a7b2 | 491 | int cio_validate_subchannel(struct subchannel *sch, struct subchannel_id schid) |
1da177e4 LT |
492 | { |
493 | char dbf_txt[15]; | |
494 | int ccode; | |
2ec22984 | 495 | int err; |
1da177e4 | 496 | |
0ae7a7b2 CH |
497 | sprintf(dbf_txt, "valsch%x", schid.sch_no); |
498 | CIO_TRACE_EVENT(4, dbf_txt); | |
1da177e4 | 499 | |
1da177e4 LT |
500 | /* |
501 | * The first subchannel that is not-operational (ccode==3) | |
e5dcf002 | 502 | * indicates that there aren't any more devices available. |
fb6958a5 | 503 | * If stsch gets an exception, it means the current subchannel set |
e5dcf002 | 504 | * is not valid. |
1da177e4 | 505 | */ |
e5dcf002 | 506 | ccode = stsch_err(schid, &sch->schib); |
2ec22984 CH |
507 | if (ccode) { |
508 | err = (ccode == 3) ? -ENXIO : ccode; | |
509 | goto out; | |
510 | } | |
1da177e4 | 511 | sch->st = sch->schib.pmcw.st; |
e5dcf002 | 512 | sch->schid = schid; |
c820de39 | 513 | |
0ae7a7b2 CH |
514 | switch (sch->st) { |
515 | case SUBCHANNEL_TYPE_IO: | |
b3a686f4 | 516 | case SUBCHANNEL_TYPE_MSG: |
e510f681 PM |
517 | if (!css_sch_is_valid(&sch->schib)) |
518 | err = -ENODEV; | |
519 | else | |
520 | err = cio_check_devno_blacklisted(sch); | |
b3a686f4 | 521 | break; |
0ae7a7b2 CH |
522 | default: |
523 | err = 0; | |
1da177e4 | 524 | } |
0ae7a7b2 | 525 | if (err) |
808e4888 | 526 | goto out; |
808e4888 | 527 | |
0ae7a7b2 CH |
528 | CIO_MSG_EVENT(4, "Subchannel 0.%x.%04x reports subchannel type %04X\n", |
529 | sch->schid.ssid, sch->schid.sch_no, sch->st); | |
2ec22984 | 530 | out: |
2ec22984 | 531 | return err; |
1da177e4 LT |
532 | } |
533 | ||
534 | /* | |
1f44a225 | 535 | * do_cio_interrupt() handles all normal I/O device IRQ's |
1da177e4 | 536 | */ |
1f44a225 | 537 | static irqreturn_t do_cio_interrupt(int irq, void *dummy) |
1da177e4 | 538 | { |
1f44a225 | 539 | struct tpi_info *tpi_info; |
1da177e4 LT |
540 | struct subchannel *sch; |
541 | struct irb *irb; | |
542 | ||
fe0f4976 | 543 | set_cpu_flag(CIF_NOHZ_DELAY); |
1f44a225 | 544 | tpi_info = (struct tpi_info *) &get_irq_regs()->int_code; |
0bf7fcf1 | 545 | irb = this_cpu_ptr(&cio_irb); |
48f6b00c MS |
546 | sch = (struct subchannel *)(unsigned long) tpi_info->intparm; |
547 | if (!sch) { | |
548 | /* Clear pending interrupt condition. */ | |
549 | inc_irq_stat(IRQIO_CIO); | |
550 | tsch(tpi_info->schid, irb); | |
1f44a225 | 551 | return IRQ_HANDLED; |
48f6b00c MS |
552 | } |
553 | spin_lock(sch->lock); | |
554 | /* Store interrupt response block to lowcore. */ | |
555 | if (tsch(tpi_info->schid, irb) == 0) { | |
556 | /* Keep subchannel information word up to date. */ | |
557 | memcpy (&sch->schib.scsw, &irb->scsw, sizeof (irb->scsw)); | |
558 | /* Call interrupt handler if there is one. */ | |
559 | if (sch->driver && sch->driver->irq) | |
560 | sch->driver->irq(sch); | |
561 | else | |
420f42ec | 562 | inc_irq_stat(IRQIO_CIO); |
48f6b00c MS |
563 | } else |
564 | inc_irq_stat(IRQIO_CIO); | |
565 | spin_unlock(sch->lock); | |
1f44a225 MS |
566 | |
567 | return IRQ_HANDLED; | |
568 | } | |
569 | ||
1f44a225 MS |
570 | static struct irqaction io_interrupt = { |
571 | .name = "IO", | |
572 | .handler = do_cio_interrupt, | |
573 | }; | |
574 | ||
575 | void __init init_cio_interrupts(void) | |
576 | { | |
577 | irq_set_chip_and_handler(IO_INTERRUPT, | |
578 | &dummy_irq_chip, handle_percpu_irq); | |
579 | setup_irq(IO_INTERRUPT, &io_interrupt); | |
1da177e4 LT |
580 | } |
581 | ||
582 | #ifdef CONFIG_CCW_CONSOLE | |
863fc849 | 583 | static struct subchannel *console_sch; |
dbe33fc9 | 584 | static struct lock_class_key console_sch_key; |
1da177e4 | 585 | |
191fd44c | 586 | /* |
b603d258 | 587 | * Use cio_tsch to update the subchannel status and call the interrupt handler |
188561a4 | 588 | * if status had been pending. Called with the subchannel's lock held. |
191fd44c | 589 | */ |
188561a4 | 590 | void cio_tsch(struct subchannel *sch) |
191fd44c | 591 | { |
191fd44c HC |
592 | struct irb *irb; |
593 | int irq_context; | |
594 | ||
0bf7fcf1 | 595 | irb = this_cpu_ptr(&cio_irb); |
191fd44c | 596 | /* Store interrupt response block to lowcore. */ |
b603d258 | 597 | if (tsch(sch->schid, irb) != 0) |
191fd44c | 598 | /* Not status pending or not operational. */ |
b603d258 MS |
599 | return; |
600 | memcpy(&sch->schib.scsw, &irb->scsw, sizeof(union scsw)); | |
601 | /* Call interrupt handler with updated status. */ | |
191fd44c | 602 | irq_context = in_interrupt(); |
b603d258 | 603 | if (!irq_context) { |
191fd44c | 604 | local_bh_disable(); |
b603d258 MS |
605 | irq_enter(); |
606 | } | |
bc5dfcff | 607 | kstat_incr_irq_this_cpu(IO_INTERRUPT); |
191fd44c HC |
608 | if (sch->driver && sch->driver->irq) |
609 | sch->driver->irq(sch); | |
de400d6b | 610 | else |
420f42ec | 611 | inc_irq_stat(IRQIO_CIO); |
b603d258 MS |
612 | if (!irq_context) { |
613 | irq_exit(); | |
191fd44c | 614 | _local_bh_enable(); |
b603d258 | 615 | } |
191fd44c HC |
616 | } |
617 | ||
863fc849 | 618 | static int cio_test_for_console(struct subchannel_id schid, void *data) |
cd6b4f27 | 619 | { |
863fc849 | 620 | struct schib schib; |
cd6b4f27 | 621 | |
863fc849 | 622 | if (stsch_err(schid, &schib) != 0) |
f97a56fb | 623 | return -ENXIO; |
863fc849 SO |
624 | if ((schib.pmcw.st == SUBCHANNEL_TYPE_IO) && schib.pmcw.dnv && |
625 | (schib.pmcw.dev == console_devno)) { | |
f97a56fb CH |
626 | console_irq = schid.sch_no; |
627 | return 1; /* found */ | |
628 | } | |
629 | return 0; | |
630 | } | |
631 | ||
863fc849 | 632 | static int cio_get_console_sch_no(void) |
1da177e4 | 633 | { |
a8237fc4 | 634 | struct subchannel_id schid; |
863fc849 SO |
635 | struct schib schib; |
636 | ||
a8237fc4 | 637 | init_subchannel_id(&schid); |
1da177e4 LT |
638 | if (console_irq != -1) { |
639 | /* VM provided us with the irq number of the console. */ | |
a8237fc4 | 640 | schid.sch_no = console_irq; |
863fc849 SO |
641 | if (stsch_err(schid, &schib) != 0 || |
642 | (schib.pmcw.st != SUBCHANNEL_TYPE_IO) || !schib.pmcw.dnv) | |
1da177e4 | 643 | return -1; |
863fc849 | 644 | console_devno = schib.pmcw.dev; |
1da177e4 LT |
645 | } else if (console_devno != -1) { |
646 | /* At least the console device number is known. */ | |
f97a56fb | 647 | for_each_subchannel(cio_test_for_console, NULL); |
1da177e4 LT |
648 | } |
649 | return console_irq; | |
650 | } | |
651 | ||
863fc849 | 652 | struct subchannel *cio_probe_console(void) |
1da177e4 | 653 | { |
a8237fc4 | 654 | struct subchannel_id schid; |
863fc849 SO |
655 | struct subchannel *sch; |
656 | int sch_no, ret; | |
1da177e4 | 657 | |
f97a56fb CH |
658 | sch_no = cio_get_console_sch_no(); |
659 | if (sch_no == -1) { | |
e6d5a428 | 660 | pr_warning("No CCW console was found\n"); |
1da177e4 LT |
661 | return ERR_PTR(-ENODEV); |
662 | } | |
a8237fc4 | 663 | init_subchannel_id(&schid); |
f97a56fb | 664 | schid.sch_no = sch_no; |
863fc849 SO |
665 | sch = css_alloc_subchannel(schid); |
666 | if (IS_ERR(sch)) | |
667 | return sch; | |
1da177e4 | 668 | |
dbe33fc9 | 669 | lockdep_set_class(sch->lock, &console_sch_key); |
6ef556cc | 670 | isc_register(CONSOLE_ISC); |
863fc849 SO |
671 | sch->config.isc = CONSOLE_ISC; |
672 | sch->config.intparm = (u32)(addr_t)sch; | |
673 | ret = cio_commit_config(sch); | |
1da177e4 | 674 | if (ret) { |
6ef556cc | 675 | isc_unregister(CONSOLE_ISC); |
863fc849 | 676 | put_device(&sch->dev); |
1da177e4 LT |
677 | return ERR_PTR(ret); |
678 | } | |
863fc849 SO |
679 | console_sch = sch; |
680 | return sch; | |
1da177e4 LT |
681 | } |
682 | ||
863fc849 | 683 | int cio_is_console(struct subchannel_id schid) |
1da177e4 | 684 | { |
863fc849 | 685 | if (!console_sch) |
1da177e4 | 686 | return 0; |
863fc849 | 687 | return schid_equal(&schid, &console_sch->schid); |
1da177e4 LT |
688 | } |
689 | ||
14556b33 | 690 | void cio_register_early_subchannels(void) |
1da177e4 | 691 | { |
14556b33 SO |
692 | int ret; |
693 | ||
694 | if (!console_sch) | |
695 | return; | |
696 | ||
697 | ret = css_register_subchannel(console_sch); | |
698 | if (ret) | |
699 | put_device(&console_sch->dev); | |
1da177e4 | 700 | } |
863fc849 | 701 | #endif /* CONFIG_CCW_CONSOLE */ |
1da177e4 | 702 | |
4d284cac | 703 | static int |
a8237fc4 | 704 | __disable_subchannel_easy(struct subchannel_id schid, struct schib *schib) |
1da177e4 LT |
705 | { |
706 | int retry, cc; | |
707 | ||
708 | cc = 0; | |
709 | for (retry=0;retry<3;retry++) { | |
710 | schib->pmcw.ena = 0; | |
8821d24c | 711 | cc = msch_err(schid, schib); |
1da177e4 LT |
712 | if (cc) |
713 | return (cc==3?-ENODEV:-EBUSY); | |
8821d24c | 714 | if (stsch_err(schid, schib) || !css_sch_is_valid(schib)) |
cdb912a4 | 715 | return -ENODEV; |
1da177e4 LT |
716 | if (!schib->pmcw.ena) |
717 | return 0; | |
718 | } | |
719 | return -EBUSY; /* uhm... */ | |
720 | } | |
721 | ||
4d284cac | 722 | static int |
0ae7a7b2 | 723 | __clear_io_subchannel_easy(struct subchannel_id schid) |
1da177e4 LT |
724 | { |
725 | int retry; | |
726 | ||
727 | if (csch(schid)) | |
728 | return -ENODEV; | |
729 | for (retry=0;retry<20;retry++) { | |
730 | struct tpi_info ti; | |
731 | ||
732 | if (tpi(&ti)) { | |
0bf7fcf1 | 733 | tsch(ti.schid, this_cpu_ptr(&cio_irb)); |
a8237fc4 | 734 | if (schid_equal(&ti.schid, &schid)) |
4c24da79 | 735 | return 0; |
1da177e4 | 736 | } |
5a0d0e65 | 737 | udelay_simple(100); |
1da177e4 LT |
738 | } |
739 | return -EBUSY; | |
740 | } | |
741 | ||
9d92a7e1 CH |
742 | static void __clear_chsc_subchannel_easy(void) |
743 | { | |
744 | /* It seems we can only wait for a bit here :/ */ | |
5a0d0e65 | 745 | udelay_simple(100); |
9d92a7e1 CH |
746 | } |
747 | ||
a45e1414 MH |
748 | static int pgm_check_occured; |
749 | ||
750 | static void cio_reset_pgm_check_handler(void) | |
751 | { | |
752 | pgm_check_occured = 1; | |
753 | } | |
754 | ||
f9c9fe3e | 755 | static int stsch_reset(struct subchannel_id schid, struct schib *addr) |
a45e1414 MH |
756 | { |
757 | int rc; | |
758 | ||
759 | pgm_check_occured = 0; | |
ab14de6c | 760 | s390_base_pgm_handler_fn = cio_reset_pgm_check_handler; |
8821d24c | 761 | rc = stsch_err(schid, addr); |
ab14de6c | 762 | s390_base_pgm_handler_fn = NULL; |
aa77015c | 763 | |
ab14de6c | 764 | /* The program check handler could have changed pgm_check_occured. */ |
6faf4444 | 765 | barrier(); |
aa77015c | 766 | |
a45e1414 MH |
767 | if (pgm_check_occured) |
768 | return -EIO; | |
769 | else | |
770 | return rc; | |
771 | } | |
772 | ||
15e9b586 | 773 | static int __shutdown_subchannel_easy(struct subchannel_id schid, void *data) |
f97a56fb CH |
774 | { |
775 | struct schib schib; | |
776 | ||
a45e1414 | 777 | if (stsch_reset(schid, &schib)) |
f97a56fb CH |
778 | return -ENXIO; |
779 | if (!schib.pmcw.ena) | |
780 | return 0; | |
781 | switch(__disable_subchannel_easy(schid, &schib)) { | |
782 | case 0: | |
783 | case -ENODEV: | |
784 | break; | |
785 | default: /* -EBUSY */ | |
0ae7a7b2 CH |
786 | switch (schib.pmcw.st) { |
787 | case SUBCHANNEL_TYPE_IO: | |
788 | if (__clear_io_subchannel_easy(schid)) | |
789 | goto out; /* give up... */ | |
790 | break; | |
9d92a7e1 CH |
791 | case SUBCHANNEL_TYPE_CHSC: |
792 | __clear_chsc_subchannel_easy(); | |
793 | break; | |
0ae7a7b2 CH |
794 | default: |
795 | /* No default clear strategy */ | |
796 | break; | |
797 | } | |
8821d24c | 798 | stsch_err(schid, &schib); |
f97a56fb CH |
799 | __disable_subchannel_easy(schid, &schib); |
800 | } | |
0ae7a7b2 | 801 | out: |
f97a56fb CH |
802 | return 0; |
803 | } | |
1da177e4 | 804 | |
15e9b586 HC |
805 | static atomic_t chpid_reset_count; |
806 | ||
807 | static void s390_reset_chpids_mcck_handler(void) | |
808 | { | |
809 | struct crw crw; | |
dc6e1555 | 810 | union mci mci; |
15e9b586 HC |
811 | |
812 | /* Check for pending channel report word. */ | |
dc6e1555 HC |
813 | mci.val = S390_lowcore.mcck_interruption_code; |
814 | if (!mci.cp) | |
15e9b586 HC |
815 | return; |
816 | /* Process channel report words. */ | |
817 | while (stcrw(&crw) == 0) { | |
818 | /* Check for responses to RCHP. */ | |
819 | if (crw.slct && crw.rsc == CRW_RSC_CPATH) | |
820 | atomic_dec(&chpid_reset_count); | |
821 | } | |
822 | } | |
823 | ||
824 | #define RCHP_TIMEOUT (30 * USEC_PER_SEC) | |
825 | static void css_reset(void) | |
826 | { | |
827 | int i, ret; | |
828 | unsigned long long timeout; | |
f86635fa | 829 | struct chp_id chpid; |
15e9b586 HC |
830 | |
831 | /* Reset subchannels. */ | |
832 | for_each_subchannel(__shutdown_subchannel_easy, NULL); | |
833 | /* Reset channel paths. */ | |
ab14de6c | 834 | s390_base_mcck_handler_fn = s390_reset_chpids_mcck_handler; |
15e9b586 HC |
835 | /* Enable channel report machine checks. */ |
836 | __ctl_set_bit(14, 28); | |
837 | /* Temporarily reenable machine checks. */ | |
838 | local_mcck_enable(); | |
f86635fa | 839 | chp_id_init(&chpid); |
15e9b586 | 840 | for (i = 0; i <= __MAX_CHPID; i++) { |
f86635fa PO |
841 | chpid.id = i; |
842 | ret = rchp(chpid); | |
15e9b586 HC |
843 | if ((ret == 0) || (ret == 2)) |
844 | /* | |
845 | * rchp either succeeded, or another rchp is already | |
846 | * in progress. In either case, we'll get a crw. | |
847 | */ | |
848 | atomic_inc(&chpid_reset_count); | |
849 | } | |
850 | /* Wait for machine check for all channel paths. */ | |
8c071b0f | 851 | timeout = get_tod_clock_fast() + (RCHP_TIMEOUT << 12); |
15e9b586 | 852 | while (atomic_read(&chpid_reset_count) != 0) { |
8c071b0f | 853 | if (get_tod_clock_fast() > timeout) |
15e9b586 HC |
854 | break; |
855 | cpu_relax(); | |
856 | } | |
857 | /* Disable machine checks again. */ | |
858 | local_mcck_disable(); | |
859 | /* Disable channel report machine checks. */ | |
860 | __ctl_clear_bit(14, 28); | |
ab14de6c | 861 | s390_base_mcck_handler_fn = NULL; |
15e9b586 HC |
862 | } |
863 | ||
864 | static struct reset_call css_reset_call = { | |
865 | .fn = css_reset, | |
866 | }; | |
867 | ||
868 | static int __init init_css_reset_call(void) | |
869 | { | |
870 | atomic_set(&chpid_reset_count, 0); | |
871 | register_reset_call(&css_reset_call); | |
872 | return 0; | |
873 | } | |
874 | ||
875 | arch_initcall(init_css_reset_call); | |
876 | ||
877 | struct sch_match_id { | |
878 | struct subchannel_id schid; | |
879 | struct ccw_dev_id devid; | |
880 | int rc; | |
881 | }; | |
882 | ||
883 | static int __reipl_subchannel_match(struct subchannel_id schid, void *data) | |
884 | { | |
885 | struct schib schib; | |
886 | struct sch_match_id *match_id = data; | |
887 | ||
a45e1414 | 888 | if (stsch_reset(schid, &schib)) |
15e9b586 | 889 | return -ENXIO; |
b279a4f5 | 890 | if ((schib.pmcw.st == SUBCHANNEL_TYPE_IO) && schib.pmcw.dnv && |
15e9b586 HC |
891 | (schib.pmcw.dev == match_id->devid.devno) && |
892 | (schid.ssid == match_id->devid.ssid)) { | |
893 | match_id->schid = schid; | |
894 | match_id->rc = 0; | |
895 | return 1; | |
896 | } | |
897 | return 0; | |
898 | } | |
899 | ||
900 | static int reipl_find_schid(struct ccw_dev_id *devid, | |
901 | struct subchannel_id *schid) | |
1da177e4 | 902 | { |
ff6b8ea6 MH |
903 | struct sch_match_id match_id; |
904 | ||
905 | match_id.devid = *devid; | |
906 | match_id.rc = -ENODEV; | |
15e9b586 | 907 | for_each_subchannel(__reipl_subchannel_match, &match_id); |
ff6b8ea6 MH |
908 | if (match_id.rc == 0) |
909 | *schid = match_id.schid; | |
910 | return match_id.rc; | |
1da177e4 LT |
911 | } |
912 | ||
ff6b8ea6 MH |
913 | extern void do_reipl_asm(__u32 schid); |
914 | ||
1da177e4 | 915 | /* Make sure all subchannels are quiet before we re-ipl an lpar. */ |
ff6b8ea6 | 916 | void reipl_ccw_dev(struct ccw_dev_id *devid) |
1da177e4 | 917 | { |
41459d36 | 918 | struct subchannel_id uninitialized_var(schid); |
ff6b8ea6 | 919 | |
10ad34bc | 920 | s390_reset_system(NULL, NULL, NULL); |
15e9b586 | 921 | if (reipl_find_schid(devid, &schid) != 0) |
ff6b8ea6 | 922 | panic("IPL Device not found\n"); |
ff6b8ea6 | 923 | do_reipl_asm(*((__u32*)&schid)); |
1da177e4 | 924 | } |
e87bfe51 | 925 | |
6fc321fd | 926 | int __init cio_get_iplinfo(struct cio_iplinfo *iplinfo) |
e87bfe51 HC |
927 | { |
928 | struct subchannel_id schid; | |
6fc321fd | 929 | struct schib schib; |
e87bfe51 | 930 | |
cbb870c8 | 931 | schid = *(struct subchannel_id *)&S390_lowcore.subchannel_id; |
e87bfe51 | 932 | if (!schid.one) |
6fc321fd | 933 | return -ENODEV; |
8821d24c | 934 | if (stsch_err(schid, &schib)) |
6fc321fd | 935 | return -ENODEV; |
b279a4f5 CH |
936 | if (schib.pmcw.st != SUBCHANNEL_TYPE_IO) |
937 | return -ENODEV; | |
6fc321fd HC |
938 | if (!schib.pmcw.dnv) |
939 | return -ENODEV; | |
940 | iplinfo->devno = schib.pmcw.dev; | |
941 | iplinfo->is_qdio = schib.pmcw.qf; | |
942 | return 0; | |
e87bfe51 | 943 | } |
83262d63 PO |
944 | |
945 | /** | |
946 | * cio_tm_start_key - perform start function | |
947 | * @sch: subchannel on which to perform the start function | |
948 | * @tcw: transport-command word to be started | |
949 | * @lpm: mask of paths to use | |
950 | * @key: storage key to use for storage access | |
951 | * | |
952 | * Start the tcw on the given subchannel. Return zero on success, non-zero | |
953 | * otherwise. | |
954 | */ | |
955 | int cio_tm_start_key(struct subchannel *sch, struct tcw *tcw, u8 lpm, u8 key) | |
956 | { | |
957 | int cc; | |
958 | union orb *orb = &to_io_private(sch)->orb; | |
959 | ||
960 | memset(orb, 0, sizeof(union orb)); | |
961 | orb->tm.intparm = (u32) (addr_t) sch; | |
962 | orb->tm.key = key >> 4; | |
963 | orb->tm.b = 1; | |
964 | orb->tm.lpm = lpm ? lpm : sch->lpm; | |
965 | orb->tm.tcw = (u32) (addr_t) tcw; | |
966 | cc = ssch(sch->schid, orb); | |
967 | switch (cc) { | |
968 | case 0: | |
969 | return 0; | |
970 | case 1: | |
971 | case 2: | |
972 | return -EBUSY; | |
973 | default: | |
974 | return cio_start_handle_notoper(sch, lpm); | |
975 | } | |
976 | } | |
977 | ||
978 | /** | |
979 | * cio_tm_intrg - perform interrogate function | |
980 | * @sch - subchannel on which to perform the interrogate function | |
981 | * | |
982 | * If the specified subchannel is running in transport-mode, perform the | |
983 | * interrogate function. Return zero on success, non-zero otherwie. | |
984 | */ | |
985 | int cio_tm_intrg(struct subchannel *sch) | |
986 | { | |
987 | int cc; | |
988 | ||
989 | if (!to_io_private(sch)->orb.tm.b) | |
990 | return -EINVAL; | |
991 | cc = xsch(sch->schid); | |
992 | switch (cc) { | |
993 | case 0: | |
994 | case 2: | |
995 | return 0; | |
996 | case 1: | |
997 | return -EBUSY; | |
998 | default: | |
999 | return -ENODEV; | |
1000 | } | |
1001 | } |