1
2
3
4
5
6
7
8
9
10
11
12#include <linux/module.h>
13#include <linux/init.h>
14
15#include <asm/ccwdev.h>
16#include <asm/cio.h>
17
18#include "cio.h"
19#include "cio_debug.h"
20#include "css.h"
21#include "device.h"
22#include "ioasm.h"
23#include "io_sch.h"
24
25
26
27
28
29static void
30ccw_device_msg_control_check(struct ccw_device *cdev, struct irb *irb)
31{
32 char dbf_text[15];
33
34 if (!scsw_is_valid_cstat(&irb->scsw) ||
35 !(scsw_cstat(&irb->scsw) & (SCHN_STAT_CHN_DATA_CHK |
36 SCHN_STAT_CHN_CTRL_CHK | SCHN_STAT_INTF_CTRL_CHK)))
37 return;
38 CIO_MSG_EVENT(0, "Channel-Check or Interface-Control-Check "
39 "received"
40 " ... device %04x on subchannel 0.%x.%04x, dev_stat "
41 ": %02X sch_stat : %02X\n",
42 cdev->private->dev_id.devno, cdev->private->schid.ssid,
43 cdev->private->schid.sch_no,
44 scsw_dstat(&irb->scsw), scsw_cstat(&irb->scsw));
45 sprintf(dbf_text, "chk%x", cdev->private->schid.sch_no);
46 CIO_TRACE_EVENT(0, dbf_text);
47 CIO_HEX_EVENT(0, irb, sizeof(struct irb));
48}
49
50
51
52
53static void
54ccw_device_path_notoper(struct ccw_device *cdev)
55{
56 struct subchannel *sch;
57
58 sch = to_subchannel(cdev->dev.parent);
59 if (cio_update_schib(sch))
60 goto doverify;
61
62 CIO_MSG_EVENT(0, "%s(0.%x.%04x) - path(s) %02x are "
63 "not operational \n", __func__,
64 sch->schid.ssid, sch->schid.sch_no,
65 sch->schib.pmcw.pnom);
66
67 sch->lpm &= ~sch->schib.pmcw.pnom;
68doverify:
69 cdev->private->flags.doverify = 1;
70}
71
72
73
74
75static void
76ccw_device_accumulate_ecw(struct ccw_device *cdev, struct irb *irb)
77{
78
79
80
81
82
83 cdev->private->irb.scsw.cmd.ectl = 0;
84 if ((irb->scsw.cmd.stctl & SCSW_STCTL_ALERT_STATUS) &&
85 !(irb->scsw.cmd.stctl & SCSW_STCTL_INTER_STATUS))
86 cdev->private->irb.scsw.cmd.ectl = irb->scsw.cmd.ectl;
87
88 if (!cdev->private->irb.scsw.cmd.ectl)
89 return;
90
91 memcpy (&cdev->private->irb.ecw, irb->ecw, sizeof (irb->ecw));
92}
93
94
95
96
97static int
98ccw_device_accumulate_esw_valid(struct irb *irb)
99{
100 if (!irb->scsw.cmd.eswf &&
101 (irb->scsw.cmd.stctl == SCSW_STCTL_STATUS_PEND))
102 return 0;
103 if (irb->scsw.cmd.stctl ==
104 (SCSW_STCTL_INTER_STATUS|SCSW_STCTL_STATUS_PEND) &&
105 !(irb->scsw.cmd.actl & SCSW_ACTL_SUSPENDED))
106 return 0;
107 return 1;
108}
109
110
111
112
113static void
114ccw_device_accumulate_esw(struct ccw_device *cdev, struct irb *irb)
115{
116 struct irb *cdev_irb;
117 struct sublog *cdev_sublog, *sublog;
118
119 if (!ccw_device_accumulate_esw_valid(irb))
120 return;
121
122 cdev_irb = &cdev->private->irb;
123
124
125 cdev_irb->esw.esw1.lpum = irb->esw.esw1.lpum;
126
127
128 if (irb->scsw.cmd.eswf) {
129 cdev_sublog = &cdev_irb->esw.esw0.sublog;
130 sublog = &irb->esw.esw0.sublog;
131
132 cdev_sublog->esf = sublog->esf;
133
134
135
136
137 if (irb->scsw.cmd.cstat & (SCHN_STAT_CHN_DATA_CHK |
138 SCHN_STAT_CHN_CTRL_CHK |
139 SCHN_STAT_INTF_CTRL_CHK)) {
140
141 cdev_sublog->arep = sublog->arep;
142
143 cdev_sublog->fvf = sublog->fvf;
144
145 cdev_sublog->sacc = sublog->sacc;
146
147 cdev_sublog->termc = sublog->termc;
148
149 cdev_sublog->seqc = sublog->seqc;
150 }
151
152 cdev_sublog->devsc = sublog->devsc;
153
154 cdev_sublog->serr = sublog->serr;
155
156 cdev_sublog->ioerr = sublog->ioerr;
157
158 if (irb->scsw.cmd.cstat & SCHN_STAT_INTF_CTRL_CHK)
159 cdev_irb->esw.esw0.erw.cpt = irb->esw.esw0.erw.cpt;
160
161 cdev_irb->esw.esw0.erw.fsavf = irb->esw.esw0.erw.fsavf;
162 if (cdev_irb->esw.esw0.erw.fsavf) {
163
164 memcpy(cdev_irb->esw.esw0.faddr, irb->esw.esw0.faddr,
165 sizeof (irb->esw.esw0.faddr));
166
167 cdev_irb->esw.esw0.erw.fsaf = irb->esw.esw0.erw.fsaf;
168 }
169
170 cdev_irb->esw.esw0.erw.scavf = irb->esw.esw0.erw.scavf;
171 if (irb->esw.esw0.erw.scavf)
172
173 cdev_irb->esw.esw0.saddr = irb->esw.esw0.saddr;
174
175 }
176
177
178
179 cdev_irb->esw.esw0.erw.auth = irb->esw.esw0.erw.auth;
180
181 cdev_irb->esw.esw0.erw.pvrf = irb->esw.esw0.erw.pvrf;
182 if (irb->esw.esw0.erw.pvrf)
183 cdev->private->flags.doverify = 1;
184
185 cdev_irb->esw.esw0.erw.cons = irb->esw.esw0.erw.cons;
186 if (irb->esw.esw0.erw.cons)
187 cdev_irb->esw.esw0.erw.scnt = irb->esw.esw0.erw.scnt;
188}
189
190
191
192
193void
194ccw_device_accumulate_irb(struct ccw_device *cdev, struct irb *irb)
195{
196 struct irb *cdev_irb;
197
198
199
200
201
202
203 if (!(scsw_stctl(&irb->scsw) & SCSW_STCTL_STATUS_PEND))
204 return;
205
206
207 ccw_device_msg_control_check(cdev, irb);
208
209
210 if (scsw_is_valid_pno(&irb->scsw) && scsw_pno(&irb->scsw))
211 ccw_device_path_notoper(cdev);
212
213 if (scsw_is_tm(&irb->scsw)) {
214 memcpy(&cdev->private->irb, irb, sizeof(struct irb));
215 return;
216 }
217
218
219
220 if (!scsw_is_solicited(&irb->scsw))
221 return;
222
223 cdev_irb = &cdev->private->irb;
224
225
226
227
228
229
230 if (irb->scsw.cmd.fctl & SCSW_FCTL_CLEAR_FUNC)
231 memset(&cdev->private->irb, 0, sizeof(struct irb));
232
233
234 if (irb->scsw.cmd.fctl & SCSW_FCTL_START_FUNC) {
235
236 cdev_irb->scsw.cmd.key = irb->scsw.cmd.key;
237
238 cdev_irb->scsw.cmd.sctl = irb->scsw.cmd.sctl;
239
240 cdev_irb->scsw.cmd.cc |= irb->scsw.cmd.cc;
241
242 cdev_irb->scsw.cmd.fmt = irb->scsw.cmd.fmt;
243
244 cdev_irb->scsw.cmd.pfch = irb->scsw.cmd.pfch;
245
246 cdev_irb->scsw.cmd.isic = irb->scsw.cmd.isic;
247
248 cdev_irb->scsw.cmd.alcc = irb->scsw.cmd.alcc;
249
250 cdev_irb->scsw.cmd.ssi = irb->scsw.cmd.ssi;
251 }
252
253
254 ccw_device_accumulate_ecw(cdev, irb);
255
256
257 cdev_irb->scsw.cmd.fctl |= irb->scsw.cmd.fctl;
258
259 cdev_irb->scsw.cmd.actl = irb->scsw.cmd.actl;
260
261 cdev_irb->scsw.cmd.stctl |= irb->scsw.cmd.stctl;
262
263
264
265
266 if ((irb->scsw.cmd.stctl & SCSW_STCTL_PRIM_STATUS) ||
267 ((irb->scsw.cmd.stctl ==
268 (SCSW_STCTL_INTER_STATUS|SCSW_STCTL_STATUS_PEND)) &&
269 (irb->scsw.cmd.actl & SCSW_ACTL_DEVACT) &&
270 (irb->scsw.cmd.actl & SCSW_ACTL_SCHACT)) ||
271 (irb->scsw.cmd.actl & SCSW_ACTL_SUSPENDED))
272 cdev_irb->scsw.cmd.cpa = irb->scsw.cmd.cpa;
273
274 cdev_irb->scsw.cmd.dstat &= ~DEV_STAT_BUSY;
275
276 if (irb->scsw.cmd.stctl &
277 (SCSW_STCTL_PRIM_STATUS | SCSW_STCTL_SEC_STATUS
278 | SCSW_STCTL_INTER_STATUS | SCSW_STCTL_ALERT_STATUS))
279 cdev_irb->scsw.cmd.dstat |= irb->scsw.cmd.dstat;
280
281 cdev_irb->scsw.cmd.cstat |= irb->scsw.cmd.cstat;
282
283 if ((irb->scsw.cmd.stctl & SCSW_STCTL_PRIM_STATUS) &&
284 (irb->scsw.cmd.cstat & ~(SCHN_STAT_PCI | SCHN_STAT_INCORR_LEN))
285 == 0)
286 cdev_irb->scsw.cmd.count = irb->scsw.cmd.count;
287
288
289 ccw_device_accumulate_esw(cdev, irb);
290
291
292
293
294
295
296
297
298
299
300
301
302
303 if ((cdev_irb->scsw.cmd.dstat & DEV_STAT_UNIT_CHECK) &&
304 !(cdev_irb->esw.esw0.erw.cons))
305 cdev->private->flags.dosense = 1;
306}
307
308
309
310
311int
312ccw_device_do_sense(struct ccw_device *cdev, struct irb *irb)
313{
314 struct subchannel *sch;
315 struct ccw1 *sense_ccw;
316 int rc;
317
318 sch = to_subchannel(cdev->dev.parent);
319
320
321 if (scsw_actl(&irb->scsw) & (SCSW_ACTL_DEVACT | SCSW_ACTL_SCHACT))
322
323
324
325
326
327
328 return -EBUSY;
329
330
331
332
333 sense_ccw = &to_io_private(sch)->sense_ccw;
334 sense_ccw->cmd_code = CCW_CMD_BASIC_SENSE;
335 sense_ccw->cda = (__u32) __pa(cdev->private->irb.ecw);
336 sense_ccw->count = SENSE_MAX_COUNT;
337 sense_ccw->flags = CCW_FLAG_SLI;
338
339 rc = cio_start(sch, sense_ccw, 0xff);
340 if (rc == -ENODEV || rc == -EACCES)
341 dev_fsm_event(cdev, DEV_EVENT_VERIFY);
342 return rc;
343}
344
345
346
347
348void
349ccw_device_accumulate_basic_sense(struct ccw_device *cdev, struct irb *irb)
350{
351
352
353
354
355
356 if (!(scsw_stctl(&irb->scsw) & SCSW_STCTL_STATUS_PEND))
357 return;
358
359
360 ccw_device_msg_control_check(cdev, irb);
361
362
363 if (scsw_is_valid_pno(&irb->scsw) && scsw_pno(&irb->scsw))
364 ccw_device_path_notoper(cdev);
365
366 if (!(irb->scsw.cmd.dstat & DEV_STAT_UNIT_CHECK) &&
367 (irb->scsw.cmd.dstat & DEV_STAT_CHN_END)) {
368 cdev->private->irb.esw.esw0.erw.cons = 1;
369 cdev->private->flags.dosense = 0;
370 }
371
372 if (ccw_device_accumulate_esw_valid(irb) &&
373 irb->esw.esw0.erw.pvrf)
374 cdev->private->flags.doverify = 1;
375}
376
377
378
379
380
381int
382ccw_device_accumulate_and_sense(struct ccw_device *cdev, struct irb *irb)
383{
384 ccw_device_accumulate_irb(cdev, irb);
385 if ((irb->scsw.cmd.actl & (SCSW_ACTL_DEVACT | SCSW_ACTL_SCHACT)) != 0)
386 return -EBUSY;
387
388 if (cdev->private->flags.dosense &&
389 !(irb->scsw.cmd.dstat & DEV_STAT_UNIT_CHECK)) {
390 cdev->private->irb.esw.esw0.erw.cons = 1;
391 cdev->private->flags.dosense = 0;
392 return 0;
393 }
394 if (cdev->private->flags.dosense) {
395 ccw_device_do_sense(cdev, irb);
396 return -EBUSY;
397 }
398 return 0;
399}
400
401