Commit | Line | Data |
---|---|---|
724117b7 | 1 | // SPDX-License-Identifier: GPL-2.0 |
1da177e4 | 2 | /* |
1da177e4 | 3 | * S/390 common I/O routines -- low level i/o calls |
1da177e4 | 4 | * |
a53c8fab | 5 | * Copyright IBM Corp. 1999, 2008 |
1da177e4 | 6 | * Author(s): Ingo Adlung (adlung@de.ibm.com) |
4ce3b30c | 7 | * Cornelia Huck (cornelia.huck@de.ibm.com) |
1da177e4 LT |
8 | * Arnd Bergmann (arndb@de.ibm.com) |
9 | * Martin Schwidefsky (schwidefsky@de.ibm.com) | |
10 | */ | |
11 | ||
e6d5a428 ME |
12 | #define KMSG_COMPONENT "cio" |
13 | #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt | |
14 | ||
88dbd203 | 15 | #include <linux/ftrace.h> |
1da177e4 | 16 | #include <linux/module.h> |
1da177e4 LT |
17 | #include <linux/init.h> |
18 | #include <linux/slab.h> | |
19 | #include <linux/device.h> | |
20 | #include <linux/kernel_stat.h> | |
21 | #include <linux/interrupt.h> | |
257ceab7 | 22 | #include <linux/irq.h> |
1da177e4 LT |
23 | #include <asm/cio.h> |
24 | #include <asm/delay.h> | |
25 | #include <asm/irq.h> | |
5a489b98 | 26 | #include <asm/irq_regs.h> |
e87bfe51 | 27 | #include <asm/setup.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> |
32ef5517 | 32 | #include <linux/sched/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" |
42248979 | 44 | #include "trace.h" |
1da177e4 LT |
45 | |
46 | debug_info_t *cio_debug_msg_id; | |
47 | debug_info_t *cio_debug_trace_id; | |
48 | debug_info_t *cio_debug_crw_id; | |
49 | ||
63aef00b MS |
50 | DEFINE_PER_CPU_ALIGNED(struct irb, cio_irb); |
51 | EXPORT_PER_CPU_SYMBOL(cio_irb); | |
52 | ||
1da177e4 LT |
53 | /* |
54 | * Function: cio_debug_init | |
bc698bcf CH |
55 | * Initializes three debug logs for common I/O: |
56 | * - cio_msg logs generic cio messages | |
1da177e4 | 57 | * - cio_trace logs the calling of different functions |
bc698bcf | 58 | * - cio_crw logs machine check related cio messages |
1da177e4 | 59 | */ |
bc698bcf | 60 | static int __init cio_debug_init(void) |
1da177e4 | 61 | { |
f7e1e65d | 62 | cio_debug_msg_id = debug_register("cio_msg", 16, 1, 11 * sizeof(long)); |
1da177e4 LT |
63 | if (!cio_debug_msg_id) |
64 | goto out_unregister; | |
bc698bcf CH |
65 | debug_register_view(cio_debug_msg_id, &debug_sprintf_view); |
66 | debug_set_level(cio_debug_msg_id, 2); | |
361f494d | 67 | cio_debug_trace_id = debug_register("cio_trace", 16, 1, 16); |
1da177e4 LT |
68 | if (!cio_debug_trace_id) |
69 | goto out_unregister; | |
bc698bcf CH |
70 | debug_register_view(cio_debug_trace_id, &debug_hex_ascii_view); |
71 | debug_set_level(cio_debug_trace_id, 2); | |
f7e1e65d | 72 | cio_debug_crw_id = debug_register("cio_crw", 8, 1, 8 * sizeof(long)); |
1da177e4 LT |
73 | if (!cio_debug_crw_id) |
74 | goto out_unregister; | |
bc698bcf CH |
75 | debug_register_view(cio_debug_crw_id, &debug_sprintf_view); |
76 | debug_set_level(cio_debug_crw_id, 4); | |
1da177e4 LT |
77 | return 0; |
78 | ||
79 | out_unregister: | |
a6e975c5 ME |
80 | debug_unregister(cio_debug_msg_id); |
81 | debug_unregister(cio_debug_trace_id); | |
82 | debug_unregister(cio_debug_crw_id); | |
1da177e4 LT |
83 | return -1; |
84 | } | |
85 | ||
86 | arch_initcall (cio_debug_init); | |
87 | ||
c513d07a | 88 | int cio_set_options(struct subchannel *sch, int flags) |
1da177e4 | 89 | { |
c513d07a | 90 | struct io_subchannel_private *priv = to_io_private(sch); |
1da177e4 | 91 | |
c513d07a SO |
92 | priv->options.suspend = (flags & DOIO_ALLOW_SUSPEND) != 0; |
93 | priv->options.prefetch = (flags & DOIO_DENY_PREFETCH) != 0; | |
94 | priv->options.inter = (flags & DOIO_SUPPRESS_INTER) != 0; | |
95 | return 0; | |
1da177e4 LT |
96 | } |
97 | ||
4d284cac | 98 | static int |
1da177e4 LT |
99 | cio_start_handle_notoper(struct subchannel *sch, __u8 lpm) |
100 | { | |
101 | char dbf_text[15]; | |
102 | ||
103 | if (lpm != 0) | |
104 | sch->lpm &= ~lpm; | |
105 | else | |
106 | sch->lpm = 0; | |
107 | ||
139b83dd | 108 | CIO_MSG_EVENT(2, "cio_start: 'not oper' status for " |
fb6958a5 CH |
109 | "subchannel 0.%x.%04x!\n", sch->schid.ssid, |
110 | sch->schid.sch_no); | |
cdb912a4 SO |
111 | |
112 | if (cio_update_schib(sch)) | |
113 | return -ENODEV; | |
114 | ||
2a0217d5 | 115 | sprintf(dbf_text, "no%s", dev_name(&sch->dev)); |
1da177e4 LT |
116 | CIO_TRACE_EVENT(0, dbf_text); |
117 | CIO_HEX_EVENT(0, &sch->schib, sizeof (struct schib)); | |
118 | ||
119 | return (sch->lpm ? -EACCES : -ENODEV); | |
120 | } | |
121 | ||
122 | int | |
123 | cio_start_key (struct subchannel *sch, /* subchannel structure */ | |
124 | struct ccw1 * cpa, /* logical channel prog addr */ | |
125 | __u8 lpm, /* logical path mask */ | |
126 | __u8 key) /* storage key */ | |
127 | { | |
c513d07a SO |
128 | struct io_subchannel_private *priv = to_io_private(sch); |
129 | union orb *orb = &priv->orb; | |
1da177e4 LT |
130 | int ccode; |
131 | ||
efd986db SO |
132 | CIO_TRACE_EVENT(5, "stIO"); |
133 | CIO_TRACE_EVENT(5, dev_name(&sch->dev)); | |
1da177e4 | 134 | |
9adb8c1d | 135 | memset(orb, 0, sizeof(union orb)); |
1da177e4 | 136 | /* sch is always under 2G. */ |
5c2e5a0c | 137 | orb->cmd.intparm = (u32)virt_to_phys(sch); |
83262d63 | 138 | orb->cmd.fmt = 1; |
1da177e4 | 139 | |
c513d07a SO |
140 | orb->cmd.pfch = priv->options.prefetch == 0; |
141 | orb->cmd.spnd = priv->options.suspend; | |
142 | orb->cmd.ssic = priv->options.suspend && priv->options.inter; | |
83262d63 | 143 | orb->cmd.lpm = (lpm != 0) ? lpm : sch->lpm; |
1da177e4 LT |
144 | /* |
145 | * for 64 bit we always support 64 bit IDAWs with 4k page size only | |
146 | */ | |
83262d63 PO |
147 | orb->cmd.c64 = 1; |
148 | orb->cmd.i2k = 0; | |
83262d63 | 149 | orb->cmd.key = key >> 4; |
1da177e4 | 150 | /* issue "Start Subchannel" */ |
9ff91a33 | 151 | orb->cmd.cpa = virt_to_dma32(cpa); |
cd6b4f27 | 152 | ccode = ssch(sch->schid, orb); |
1da177e4 LT |
153 | |
154 | /* process condition code */ | |
efd986db | 155 | CIO_HEX_EVENT(5, &ccode, sizeof(ccode)); |
1da177e4 LT |
156 | |
157 | switch (ccode) { | |
158 | case 0: | |
159 | /* | |
160 | * initialize device status information | |
161 | */ | |
23d805b6 | 162 | sch->schib.scsw.cmd.actl |= SCSW_ACTL_START_PEND; |
1da177e4 LT |
163 | return 0; |
164 | case 1: /* status pending */ | |
165 | case 2: /* busy */ | |
166 | return -EBUSY; | |
c91ebe49 | 167 | case 3: /* device/path not operational */ |
1da177e4 | 168 | return cio_start_handle_notoper(sch, lpm); |
c91ebe49 CH |
169 | default: |
170 | return ccode; | |
1da177e4 LT |
171 | } |
172 | } | |
a22217e2 | 173 | EXPORT_SYMBOL_GPL(cio_start_key); |
1da177e4 LT |
174 | |
175 | int | |
176 | cio_start (struct subchannel *sch, struct ccw1 *cpa, __u8 lpm) | |
177 | { | |
0b642ede | 178 | return cio_start_key(sch, cpa, lpm, PAGE_DEFAULT_KEY); |
1da177e4 | 179 | } |
a22217e2 | 180 | EXPORT_SYMBOL_GPL(cio_start); |
1da177e4 LT |
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 | } | |
a22217e2 | 213 | EXPORT_SYMBOL_GPL(cio_resume); |
1da177e4 LT |
214 | |
215 | /* | |
216 | * halt I/O operation | |
217 | */ | |
218 | int | |
219 | cio_halt(struct subchannel *sch) | |
220 | { | |
1da177e4 LT |
221 | int ccode; |
222 | ||
223 | if (!sch) | |
224 | return -ENODEV; | |
225 | ||
efd986db | 226 | CIO_TRACE_EVENT(2, "haltIO"); |
2a0217d5 | 227 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 LT |
228 | |
229 | /* | |
230 | * Issue "Halt subchannel" and process condition code | |
231 | */ | |
a8237fc4 | 232 | ccode = hsch (sch->schid); |
1da177e4 | 233 | |
efd986db | 234 | CIO_HEX_EVENT(2, &ccode, sizeof(ccode)); |
1da177e4 LT |
235 | |
236 | switch (ccode) { | |
237 | case 0: | |
23d805b6 | 238 | sch->schib.scsw.cmd.actl |= SCSW_ACTL_HALT_PEND; |
1da177e4 LT |
239 | return 0; |
240 | case 1: /* status pending */ | |
241 | case 2: /* busy */ | |
242 | return -EBUSY; | |
243 | default: /* device not operational */ | |
244 | return -ENODEV; | |
245 | } | |
246 | } | |
a22217e2 | 247 | EXPORT_SYMBOL_GPL(cio_halt); |
1da177e4 LT |
248 | |
249 | /* | |
250 | * Clear I/O operation | |
251 | */ | |
252 | int | |
253 | cio_clear(struct subchannel *sch) | |
254 | { | |
1da177e4 LT |
255 | int ccode; |
256 | ||
257 | if (!sch) | |
258 | return -ENODEV; | |
259 | ||
efd986db | 260 | CIO_TRACE_EVENT(2, "clearIO"); |
2a0217d5 | 261 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 LT |
262 | |
263 | /* | |
264 | * Issue "Clear subchannel" and process condition code | |
265 | */ | |
a8237fc4 | 266 | ccode = csch (sch->schid); |
1da177e4 | 267 | |
efd986db | 268 | CIO_HEX_EVENT(2, &ccode, sizeof(ccode)); |
1da177e4 LT |
269 | |
270 | switch (ccode) { | |
271 | case 0: | |
23d805b6 | 272 | sch->schib.scsw.cmd.actl |= SCSW_ACTL_CLEAR_PEND; |
1da177e4 LT |
273 | return 0; |
274 | default: /* device not operational */ | |
275 | return -ENODEV; | |
276 | } | |
277 | } | |
a22217e2 | 278 | EXPORT_SYMBOL_GPL(cio_clear); |
1da177e4 LT |
279 | |
280 | /* | |
281 | * Function: cio_cancel | |
282 | * Issues a "Cancel Subchannel" on the specified subchannel | |
283 | * Note: We don't need any fancy intparms and flags here | |
284 | * since xsch is executed synchronously. | |
285 | * Only for common I/O internal use as for now. | |
286 | */ | |
287 | int | |
288 | cio_cancel (struct subchannel *sch) | |
289 | { | |
1da177e4 LT |
290 | int ccode; |
291 | ||
292 | if (!sch) | |
293 | return -ENODEV; | |
294 | ||
efd986db | 295 | CIO_TRACE_EVENT(2, "cancelIO"); |
2a0217d5 | 296 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 | 297 | |
a8237fc4 | 298 | ccode = xsch (sch->schid); |
1da177e4 | 299 | |
efd986db | 300 | CIO_HEX_EVENT(2, &ccode, sizeof(ccode)); |
1da177e4 LT |
301 | |
302 | switch (ccode) { | |
303 | case 0: /* success */ | |
304 | /* Update information in scsw. */ | |
cdb912a4 SO |
305 | if (cio_update_schib(sch)) |
306 | return -ENODEV; | |
1da177e4 LT |
307 | return 0; |
308 | case 1: /* status pending */ | |
309 | return -EBUSY; | |
310 | case 2: /* not applicable */ | |
311 | return -EINVAL; | |
312 | default: /* not oper */ | |
313 | return -ENODEV; | |
314 | } | |
315 | } | |
a22217e2 | 316 | EXPORT_SYMBOL_GPL(cio_cancel); |
1da177e4 | 317 | |
5434da4d DJS |
318 | /** |
319 | * cio_cancel_halt_clear - Cancel running I/O by performing cancel, halt | |
320 | * and clear ordinally if subchannel is valid. | |
321 | * @sch: subchannel on which to perform the cancel_halt_clear operation | |
322 | * @iretry: the number of the times remained to retry the next operation | |
323 | * | |
324 | * This should be called repeatedly since halt/clear are asynchronous | |
325 | * operations. We do one try with cio_cancel, three tries with cio_halt, | |
326 | * 255 tries with cio_clear. The caller should initialize @iretry with | |
327 | * the value 255 for its first call to this, and keep using the same | |
328 | * @iretry in the subsequent calls until it gets a non -EBUSY return. | |
329 | * | |
330 | * Returns 0 if device now idle, -ENODEV for device not operational, | |
331 | * -EBUSY if an interrupt is expected (either from halt/clear or from a | |
332 | * status pending), and -EIO if out of retries. | |
333 | */ | |
334 | int cio_cancel_halt_clear(struct subchannel *sch, int *iretry) | |
335 | { | |
336 | int ret; | |
337 | ||
338 | if (cio_update_schib(sch)) | |
339 | return -ENODEV; | |
340 | if (!sch->schib.pmcw.ena) | |
341 | /* Not operational -> done. */ | |
342 | return 0; | |
343 | /* Stage 1: cancel io. */ | |
344 | if (!(scsw_actl(&sch->schib.scsw) & SCSW_ACTL_HALT_PEND) && | |
345 | !(scsw_actl(&sch->schib.scsw) & SCSW_ACTL_CLEAR_PEND)) { | |
346 | if (!scsw_is_tm(&sch->schib.scsw)) { | |
347 | ret = cio_cancel(sch); | |
348 | if (ret != -EINVAL) | |
349 | return ret; | |
350 | } | |
351 | /* | |
352 | * Cancel io unsuccessful or not applicable (transport mode). | |
353 | * Continue with asynchronous instructions. | |
354 | */ | |
355 | *iretry = 3; /* 3 halt retries. */ | |
356 | } | |
357 | /* Stage 2: halt io. */ | |
358 | if (!(scsw_actl(&sch->schib.scsw) & SCSW_ACTL_CLEAR_PEND)) { | |
359 | if (*iretry) { | |
360 | *iretry -= 1; | |
361 | ret = cio_halt(sch); | |
362 | if (ret != -EBUSY) | |
363 | return (ret == 0) ? -EBUSY : ret; | |
364 | } | |
365 | /* Halt io unsuccessful. */ | |
366 | *iretry = 255; /* 255 clear retries. */ | |
367 | } | |
368 | /* Stage 3: clear io. */ | |
369 | if (*iretry) { | |
370 | *iretry -= 1; | |
371 | ret = cio_clear(sch); | |
372 | return (ret == 0) ? -EBUSY : ret; | |
373 | } | |
374 | /* Function was unsuccessful */ | |
375 | return -EIO; | |
376 | } | |
a22217e2 | 377 | EXPORT_SYMBOL_GPL(cio_cancel_halt_clear); |
13952ec1 SO |
378 | |
379 | static void cio_apply_config(struct subchannel *sch, struct schib *schib) | |
380 | { | |
381 | schib->pmcw.intparm = sch->config.intparm; | |
382 | schib->pmcw.mbi = sch->config.mbi; | |
383 | schib->pmcw.isc = sch->config.isc; | |
384 | schib->pmcw.ena = sch->config.ena; | |
385 | schib->pmcw.mme = sch->config.mme; | |
386 | schib->pmcw.mp = sch->config.mp; | |
387 | schib->pmcw.csense = sch->config.csense; | |
388 | schib->pmcw.mbfc = sch->config.mbfc; | |
389 | if (sch->config.mbfc) | |
390 | schib->mba = sch->config.mba; | |
391 | } | |
392 | ||
393 | static int cio_check_config(struct subchannel *sch, struct schib *schib) | |
394 | { | |
395 | return (schib->pmcw.intparm == sch->config.intparm) && | |
396 | (schib->pmcw.mbi == sch->config.mbi) && | |
397 | (schib->pmcw.isc == sch->config.isc) && | |
398 | (schib->pmcw.ena == sch->config.ena) && | |
399 | (schib->pmcw.mme == sch->config.mme) && | |
400 | (schib->pmcw.mp == sch->config.mp) && | |
401 | (schib->pmcw.csense == sch->config.csense) && | |
402 | (schib->pmcw.mbfc == sch->config.mbfc) && | |
403 | (!sch->config.mbfc || (schib->mba == sch->config.mba)); | |
404 | } | |
405 | ||
1da177e4 | 406 | /* |
13952ec1 | 407 | * cio_commit_config - apply configuration to the subchannel |
1da177e4 | 408 | */ |
13952ec1 | 409 | int cio_commit_config(struct subchannel *sch) |
1da177e4 | 410 | { |
13952ec1 | 411 | int ccode, retry, ret = 0; |
1bc8927c SO |
412 | struct schib schib; |
413 | struct irb irb; | |
13952ec1 | 414 | |
62e65da9 | 415 | if (stsch(sch->schid, &schib) || !css_sch_is_valid(&schib)) |
13952ec1 | 416 | return -ENODEV; |
1da177e4 | 417 | |
1da177e4 | 418 | for (retry = 0; retry < 5; retry++) { |
13952ec1 SO |
419 | /* copy desired changes to local schib */ |
420 | cio_apply_config(sch, &schib); | |
62e65da9 | 421 | ccode = msch(sch->schid, &schib); |
13952ec1 | 422 | if (ccode < 0) /* -EIO if msch gets a program check. */ |
1da177e4 LT |
423 | return ccode; |
424 | switch (ccode) { | |
73ac36ea | 425 | case 0: /* successful */ |
62e65da9 | 426 | if (stsch(sch->schid, &schib) || |
13952ec1 SO |
427 | !css_sch_is_valid(&schib)) |
428 | return -ENODEV; | |
429 | if (cio_check_config(sch, &schib)) { | |
430 | /* commit changes from local schib */ | |
431 | memcpy(&sch->schib, &schib, sizeof(schib)); | |
432 | return 0; | |
433 | } | |
434 | ret = -EAGAIN; | |
435 | break; | |
436 | case 1: /* status pending */ | |
1bc8927c SO |
437 | ret = -EBUSY; |
438 | if (tsch(sch->schid, &irb)) | |
439 | return ret; | |
440 | break; | |
13952ec1 SO |
441 | case 2: /* busy */ |
442 | udelay(100); /* allow for recovery */ | |
1da177e4 LT |
443 | ret = -EBUSY; |
444 | break; | |
13952ec1 | 445 | case 3: /* not operational */ |
1da177e4 LT |
446 | return -ENODEV; |
447 | } | |
448 | } | |
449 | return ret; | |
450 | } | |
a22217e2 | 451 | EXPORT_SYMBOL_GPL(cio_commit_config); |
1da177e4 | 452 | |
cdb912a4 SO |
453 | /** |
454 | * cio_update_schib - Perform stsch and update schib if subchannel is valid. | |
455 | * @sch: subchannel on which to perform stsch | |
456 | * Return zero on success, -ENODEV otherwise. | |
457 | */ | |
458 | int cio_update_schib(struct subchannel *sch) | |
459 | { | |
460 | struct schib schib; | |
461 | ||
62e65da9 | 462 | if (stsch(sch->schid, &schib) || !css_sch_is_valid(&schib)) |
cdb912a4 SO |
463 | return -ENODEV; |
464 | ||
465 | memcpy(&sch->schib, &schib, sizeof(schib)); | |
466 | return 0; | |
467 | } | |
468 | EXPORT_SYMBOL_GPL(cio_update_schib); | |
469 | ||
44a1c19e CH |
470 | /** |
471 | * cio_enable_subchannel - enable a subchannel. | |
472 | * @sch: subchannel to be enabled | |
473 | * @intparm: interruption parameter to set | |
1da177e4 | 474 | */ |
edf22096 | 475 | int cio_enable_subchannel(struct subchannel *sch, u32 intparm) |
1da177e4 | 476 | { |
1da177e4 LT |
477 | int ret; |
478 | ||
efd986db | 479 | CIO_TRACE_EVENT(2, "ensch"); |
2a0217d5 | 480 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 | 481 | |
d7b5a4c9 CH |
482 | if (sch_is_pseudo_sch(sch)) |
483 | return -EINVAL; | |
cdb912a4 | 484 | if (cio_update_schib(sch)) |
1da177e4 LT |
485 | return -ENODEV; |
486 | ||
13952ec1 SO |
487 | sch->config.ena = 1; |
488 | sch->config.isc = sch->isc; | |
489 | sch->config.intparm = intparm; | |
490 | ||
1bc8927c SO |
491 | ret = cio_commit_config(sch); |
492 | if (ret == -EIO) { | |
493 | /* | |
494 | * Got a program check in msch. Try without | |
495 | * the concurrent sense bit the next time. | |
496 | */ | |
497 | sch->config.csense = 0; | |
13952ec1 | 498 | ret = cio_commit_config(sch); |
1da177e4 | 499 | } |
efd986db | 500 | CIO_HEX_EVENT(2, &ret, sizeof(ret)); |
1da177e4 LT |
501 | return ret; |
502 | } | |
44a1c19e | 503 | EXPORT_SYMBOL_GPL(cio_enable_subchannel); |
1da177e4 | 504 | |
44a1c19e CH |
505 | /** |
506 | * cio_disable_subchannel - disable a subchannel. | |
507 | * @sch: subchannel to disable | |
1da177e4 | 508 | */ |
44a1c19e | 509 | int cio_disable_subchannel(struct subchannel *sch) |
1da177e4 | 510 | { |
1da177e4 LT |
511 | int ret; |
512 | ||
efd986db | 513 | CIO_TRACE_EVENT(2, "dissch"); |
2a0217d5 | 514 | CIO_TRACE_EVENT(2, dev_name(&sch->dev)); |
1da177e4 | 515 | |
d7b5a4c9 CH |
516 | if (sch_is_pseudo_sch(sch)) |
517 | return 0; | |
cdb912a4 | 518 | if (cio_update_schib(sch)) |
1da177e4 LT |
519 | return -ENODEV; |
520 | ||
13952ec1 | 521 | sch->config.ena = 0; |
1bc8927c | 522 | ret = cio_commit_config(sch); |
13952ec1 | 523 | |
efd986db | 524 | CIO_HEX_EVENT(2, &ret, sizeof(ret)); |
1da177e4 LT |
525 | return ret; |
526 | } | |
44a1c19e | 527 | EXPORT_SYMBOL_GPL(cio_disable_subchannel); |
1da177e4 | 528 | |
1da177e4 | 529 | /* |
1f44a225 | 530 | * do_cio_interrupt() handles all normal I/O device IRQ's |
1da177e4 | 531 | */ |
1f44a225 | 532 | static irqreturn_t do_cio_interrupt(int irq, void *dummy) |
1da177e4 | 533 | { |
1f44a225 | 534 | struct tpi_info *tpi_info; |
1da177e4 LT |
535 | struct subchannel *sch; |
536 | struct irb *irb; | |
537 | ||
34bbeed0 | 538 | tpi_info = &get_irq_regs()->tpi_info; |
42248979 | 539 | trace_s390_cio_interrupt(tpi_info); |
0bf7fcf1 | 540 | irb = this_cpu_ptr(&cio_irb); |
5c2e5a0c | 541 | if (!tpi_info->intparm) { |
48f6b00c MS |
542 | /* Clear pending interrupt condition. */ |
543 | inc_irq_stat(IRQIO_CIO); | |
544 | tsch(tpi_info->schid, irb); | |
1f44a225 | 545 | return IRQ_HANDLED; |
48f6b00c | 546 | } |
5c2e5a0c | 547 | sch = phys_to_virt(tpi_info->intparm); |
b8fa3e90 | 548 | spin_lock(&sch->lock); |
48f6b00c MS |
549 | /* Store interrupt response block to lowcore. */ |
550 | if (tsch(tpi_info->schid, irb) == 0) { | |
551 | /* Keep subchannel information word up to date. */ | |
552 | memcpy (&sch->schib.scsw, &irb->scsw, sizeof (irb->scsw)); | |
553 | /* Call interrupt handler if there is one. */ | |
554 | if (sch->driver && sch->driver->irq) | |
555 | sch->driver->irq(sch); | |
556 | else | |
420f42ec | 557 | inc_irq_stat(IRQIO_CIO); |
48f6b00c MS |
558 | } else |
559 | inc_irq_stat(IRQIO_CIO); | |
b8fa3e90 | 560 | spin_unlock(&sch->lock); |
1f44a225 MS |
561 | |
562 | return IRQ_HANDLED; | |
563 | } | |
564 | ||
1f44a225 MS |
565 | void __init init_cio_interrupts(void) |
566 | { | |
567 | irq_set_chip_and_handler(IO_INTERRUPT, | |
568 | &dummy_irq_chip, handle_percpu_irq); | |
8719b6d2 | 569 | if (request_irq(IO_INTERRUPT, do_cio_interrupt, 0, "I/O", NULL)) |
570 | panic("Failed to register I/O interrupt\n"); | |
1da177e4 LT |
571 | } |
572 | ||
573 | #ifdef CONFIG_CCW_CONSOLE | |
863fc849 | 574 | static struct subchannel *console_sch; |
dbe33fc9 | 575 | static struct lock_class_key console_sch_key; |
1da177e4 | 576 | |
191fd44c | 577 | /* |
b603d258 | 578 | * Use cio_tsch to update the subchannel status and call the interrupt handler |
188561a4 | 579 | * if status had been pending. Called with the subchannel's lock held. |
191fd44c | 580 | */ |
188561a4 | 581 | void cio_tsch(struct subchannel *sch) |
191fd44c | 582 | { |
191fd44c HC |
583 | struct irb *irb; |
584 | int irq_context; | |
585 | ||
0bf7fcf1 | 586 | irb = this_cpu_ptr(&cio_irb); |
191fd44c | 587 | /* Store interrupt response block to lowcore. */ |
b603d258 | 588 | if (tsch(sch->schid, irb) != 0) |
191fd44c | 589 | /* Not status pending or not operational. */ |
b603d258 MS |
590 | return; |
591 | memcpy(&sch->schib.scsw, &irb->scsw, sizeof(union scsw)); | |
592 | /* Call interrupt handler with updated status. */ | |
191fd44c | 593 | irq_context = in_interrupt(); |
b603d258 | 594 | if (!irq_context) { |
191fd44c | 595 | local_bh_disable(); |
b603d258 MS |
596 | irq_enter(); |
597 | } | |
bc5dfcff | 598 | kstat_incr_irq_this_cpu(IO_INTERRUPT); |
191fd44c HC |
599 | if (sch->driver && sch->driver->irq) |
600 | sch->driver->irq(sch); | |
de400d6b | 601 | else |
420f42ec | 602 | inc_irq_stat(IRQIO_CIO); |
b603d258 MS |
603 | if (!irq_context) { |
604 | irq_exit(); | |
191fd44c | 605 | _local_bh_enable(); |
b603d258 | 606 | } |
191fd44c HC |
607 | } |
608 | ||
863fc849 | 609 | static int cio_test_for_console(struct subchannel_id schid, void *data) |
cd6b4f27 | 610 | { |
863fc849 | 611 | struct schib schib; |
cd6b4f27 | 612 | |
62e65da9 | 613 | if (stsch(schid, &schib) != 0) |
f97a56fb | 614 | return -ENXIO; |
863fc849 SO |
615 | if ((schib.pmcw.st == SUBCHANNEL_TYPE_IO) && schib.pmcw.dnv && |
616 | (schib.pmcw.dev == console_devno)) { | |
f97a56fb CH |
617 | console_irq = schid.sch_no; |
618 | return 1; /* found */ | |
619 | } | |
620 | return 0; | |
621 | } | |
622 | ||
863fc849 | 623 | static int cio_get_console_sch_no(void) |
1da177e4 | 624 | { |
a8237fc4 | 625 | struct subchannel_id schid; |
863fc849 SO |
626 | struct schib schib; |
627 | ||
a8237fc4 | 628 | init_subchannel_id(&schid); |
1da177e4 LT |
629 | if (console_irq != -1) { |
630 | /* VM provided us with the irq number of the console. */ | |
a8237fc4 | 631 | schid.sch_no = console_irq; |
62e65da9 | 632 | if (stsch(schid, &schib) != 0 || |
863fc849 | 633 | (schib.pmcw.st != SUBCHANNEL_TYPE_IO) || !schib.pmcw.dnv) |
1da177e4 | 634 | return -1; |
863fc849 | 635 | console_devno = schib.pmcw.dev; |
1da177e4 LT |
636 | } else if (console_devno != -1) { |
637 | /* At least the console device number is known. */ | |
f97a56fb | 638 | for_each_subchannel(cio_test_for_console, NULL); |
1da177e4 LT |
639 | } |
640 | return console_irq; | |
641 | } | |
642 | ||
863fc849 | 643 | struct subchannel *cio_probe_console(void) |
1da177e4 | 644 | { |
a8237fc4 | 645 | struct subchannel_id schid; |
863fc849 | 646 | struct subchannel *sch; |
d4f5d79e | 647 | struct schib schib; |
863fc849 | 648 | int sch_no, ret; |
1da177e4 | 649 | |
f97a56fb CH |
650 | sch_no = cio_get_console_sch_no(); |
651 | if (sch_no == -1) { | |
baebc70a | 652 | pr_warn("No CCW console was found\n"); |
1da177e4 LT |
653 | return ERR_PTR(-ENODEV); |
654 | } | |
a8237fc4 | 655 | init_subchannel_id(&schid); |
f97a56fb | 656 | schid.sch_no = sch_no; |
d4f5d79e SO |
657 | ret = stsch(schid, &schib); |
658 | if (ret) | |
659 | return ERR_PTR(-ENODEV); | |
660 | ||
661 | sch = css_alloc_subchannel(schid, &schib); | |
863fc849 SO |
662 | if (IS_ERR(sch)) |
663 | return sch; | |
1da177e4 | 664 | |
b8fa3e90 | 665 | lockdep_set_class(&sch->lock, &console_sch_key); |
6ef556cc | 666 | isc_register(CONSOLE_ISC); |
863fc849 | 667 | sch->config.isc = CONSOLE_ISC; |
5c2e5a0c | 668 | sch->config.intparm = (u32)virt_to_phys(sch); |
863fc849 | 669 | ret = cio_commit_config(sch); |
1da177e4 | 670 | if (ret) { |
6ef556cc | 671 | isc_unregister(CONSOLE_ISC); |
863fc849 | 672 | put_device(&sch->dev); |
1da177e4 LT |
673 | return ERR_PTR(ret); |
674 | } | |
863fc849 SO |
675 | console_sch = sch; |
676 | return sch; | |
1da177e4 LT |
677 | } |
678 | ||
863fc849 | 679 | int cio_is_console(struct subchannel_id schid) |
1da177e4 | 680 | { |
863fc849 | 681 | if (!console_sch) |
1da177e4 | 682 | return 0; |
863fc849 | 683 | return schid_equal(&schid, &console_sch->schid); |
1da177e4 LT |
684 | } |
685 | ||
14556b33 | 686 | void cio_register_early_subchannels(void) |
1da177e4 | 687 | { |
14556b33 SO |
688 | int ret; |
689 | ||
690 | if (!console_sch) | |
691 | return; | |
692 | ||
693 | ret = css_register_subchannel(console_sch); | |
694 | if (ret) | |
695 | put_device(&console_sch->dev); | |
1da177e4 | 696 | } |
863fc849 | 697 | #endif /* CONFIG_CCW_CONSOLE */ |
1da177e4 | 698 | |
83262d63 PO |
699 | /** |
700 | * cio_tm_start_key - perform start function | |
701 | * @sch: subchannel on which to perform the start function | |
702 | * @tcw: transport-command word to be started | |
703 | * @lpm: mask of paths to use | |
704 | * @key: storage key to use for storage access | |
705 | * | |
706 | * Start the tcw on the given subchannel. Return zero on success, non-zero | |
707 | * otherwise. | |
708 | */ | |
709 | int cio_tm_start_key(struct subchannel *sch, struct tcw *tcw, u8 lpm, u8 key) | |
710 | { | |
711 | int cc; | |
712 | union orb *orb = &to_io_private(sch)->orb; | |
713 | ||
714 | memset(orb, 0, sizeof(union orb)); | |
5c2e5a0c | 715 | orb->tm.intparm = (u32)virt_to_phys(sch); |
83262d63 PO |
716 | orb->tm.key = key >> 4; |
717 | orb->tm.b = 1; | |
718 | orb->tm.lpm = lpm ? lpm : sch->lpm; | |
9ff91a33 | 719 | orb->tm.tcw = virt_to_dma32(tcw); |
83262d63 PO |
720 | cc = ssch(sch->schid, orb); |
721 | switch (cc) { | |
722 | case 0: | |
723 | return 0; | |
724 | case 1: | |
725 | case 2: | |
726 | return -EBUSY; | |
727 | default: | |
728 | return cio_start_handle_notoper(sch, lpm); | |
729 | } | |
730 | } | |
a22217e2 | 731 | EXPORT_SYMBOL_GPL(cio_tm_start_key); |
83262d63 PO |
732 | |
733 | /** | |
734 | * cio_tm_intrg - perform interrogate function | |
364e3f90 | 735 | * @sch: subchannel on which to perform the interrogate function |
83262d63 PO |
736 | * |
737 | * If the specified subchannel is running in transport-mode, perform the | |
738 | * interrogate function. Return zero on success, non-zero otherwie. | |
739 | */ | |
740 | int cio_tm_intrg(struct subchannel *sch) | |
741 | { | |
742 | int cc; | |
743 | ||
744 | if (!to_io_private(sch)->orb.tm.b) | |
745 | return -EINVAL; | |
746 | cc = xsch(sch->schid); | |
747 | switch (cc) { | |
748 | case 0: | |
749 | case 2: | |
750 | return 0; | |
751 | case 1: | |
752 | return -EBUSY; | |
753 | default: | |
754 | return -ENODEV; | |
755 | } | |
756 | } | |
a22217e2 | 757 | EXPORT_SYMBOL_GPL(cio_tm_intrg); |