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