Merge master.kernel.org:/pub/scm/linux/kernel/git/davej/cpufreq
[pandora-kernel.git] / drivers / s390 / cio / device_status.c
1 /*
2  * drivers/s390/cio/device_status.c
3  *
4  *    Copyright (C) 2002 IBM Deutschland Entwicklung GmbH,
5  *                       IBM Corporation
6  *    Author(s): Cornelia Huck(cohuck@de.ibm.com)
7  *               Martin Schwidefsky (schwidefsky@de.ibm.com)
8  *
9  * Status accumulation and basic sense functions.
10  */
11
12 #include <linux/config.h>
13 #include <linux/module.h>
14 #include <linux/init.h>
15
16 #include <asm/ccwdev.h>
17 #include <asm/cio.h>
18
19 #include "cio.h"
20 #include "cio_debug.h"
21 #include "css.h"
22 #include "device.h"
23 #include "ioasm.h"
24
25 /*
26  * Check for any kind of channel or interface control check but don't
27  * issue the message for the console device
28  */
29 static inline void
30 ccw_device_msg_control_check(struct ccw_device *cdev, struct irb *irb)
31 {
32         if (!(irb->scsw.cstat & (SCHN_STAT_CHN_DATA_CHK |
33                                  SCHN_STAT_CHN_CTRL_CHK |
34                                  SCHN_STAT_INTF_CTRL_CHK)))
35                 return;
36                 
37         CIO_MSG_EVENT(0, "Channel-Check or Interface-Control-Check "
38                       "received"
39                       " ... device %04X on subchannel %04X, dev_stat "
40                       ": %02X sch_stat : %02X\n",
41                       cdev->private->devno, cdev->private->irq,
42                       irb->scsw.dstat, irb->scsw.cstat);
43
44         if (irb->scsw.cc != 3) {
45                 char dbf_text[15];
46
47                 sprintf(dbf_text, "chk%x", cdev->private->irq);
48                 CIO_TRACE_EVENT(0, dbf_text);
49                 CIO_HEX_EVENT(0, irb, sizeof (struct irb));
50         }
51 }
52
53 /*
54  * Some paths became not operational (pno bit in scsw is set).
55  */
56 static void
57 ccw_device_path_notoper(struct ccw_device *cdev)
58 {
59         struct subchannel *sch;
60
61         sch = to_subchannel(cdev->dev.parent);
62         stsch (sch->irq, &sch->schib);
63
64         CIO_MSG_EVENT(0, "%s(%04x) - path(s) %02x are "
65                       "not operational \n", __FUNCTION__, sch->irq,
66                       sch->schib.pmcw.pnom);
67
68         sch->lpm &= ~sch->schib.pmcw.pnom;
69         if (cdev->private->options.pgroup)
70                 cdev->private->flags.doverify = 1;
71 }
72
73 /*
74  * Copy valid bits from the extended control word to device irb.
75  */
76 static inline void
77 ccw_device_accumulate_ecw(struct ccw_device *cdev, struct irb *irb)
78 {
79         /*
80          * Copy extended control bit if it is valid... yes there
81          * are condition that have to be met for the extended control
82          * bit to have meaning. Sick.
83          */
84         cdev->private->irb.scsw.ectl = 0;
85         if ((irb->scsw.stctl & SCSW_STCTL_ALERT_STATUS) &&
86             !(irb->scsw.stctl & SCSW_STCTL_INTER_STATUS))
87                 cdev->private->irb.scsw.ectl = irb->scsw.ectl;
88         /* Check if extended control word is valid. */
89         if (!cdev->private->irb.scsw.ectl)
90                 return;
91         /* Copy concurrent sense / model dependent information. */
92         memcpy (&cdev->private->irb.ecw, irb->ecw, sizeof (irb->ecw));
93 }
94
95 /*
96  * Check if extended status word is valid.
97  */
98 static inline int
99 ccw_device_accumulate_esw_valid(struct irb *irb)
100 {
101         if (!irb->scsw.eswf && irb->scsw.stctl == SCSW_STCTL_STATUS_PEND)
102                 return 0;
103         if (irb->scsw.stctl == 
104                         (SCSW_STCTL_INTER_STATUS|SCSW_STCTL_STATUS_PEND) &&
105             !(irb->scsw.actl & SCSW_ACTL_SUSPENDED))
106                 return 0;
107         return 1;
108 }
109
110 /*
111  * Copy valid bits from the extended status word to device irb.
112  */
113 static inline void
114 ccw_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         /* Copy last path used mask. */
125         cdev_irb->esw.esw1.lpum = irb->esw.esw1.lpum;
126
127         /* Copy subchannel logout information if esw is of format 0. */
128         if (irb->scsw.eswf) {
129                 cdev_sublog = &cdev_irb->esw.esw0.sublog;
130                 sublog = &irb->esw.esw0.sublog;
131                 /* Copy extended status flags. */
132                 cdev_sublog->esf = sublog->esf;
133                 /*
134                  * Copy fields that have a meaning for channel data check
135                  * channel control check and interface control check.
136                  */
137                 if (irb->scsw.cstat & (SCHN_STAT_CHN_DATA_CHK |
138                                        SCHN_STAT_CHN_CTRL_CHK |
139                                        SCHN_STAT_INTF_CTRL_CHK)) {
140                         /* Copy ancillary report bit. */
141                         cdev_sublog->arep = sublog->arep;
142                         /* Copy field-validity-flags. */
143                         cdev_sublog->fvf = sublog->fvf;
144                         /* Copy storage access code. */
145                         cdev_sublog->sacc = sublog->sacc;
146                         /* Copy termination code. */
147                         cdev_sublog->termc = sublog->termc;
148                         /* Copy sequence code. */
149                         cdev_sublog->seqc = sublog->seqc;
150                 }
151                 /* Copy device status check. */
152                 cdev_sublog->devsc = sublog->devsc;
153                 /* Copy secondary error. */
154                 cdev_sublog->serr = sublog->serr;
155                 /* Copy i/o-error alert. */
156                 cdev_sublog->ioerr = sublog->ioerr;
157                 /* Copy channel path timeout bit. */
158                 if (irb->scsw.cstat & SCHN_STAT_INTF_CTRL_CHK)
159                         cdev_irb->esw.esw0.erw.cpt = irb->esw.esw0.erw.cpt;
160                 /* Copy failing storage address validity flag. */
161                 cdev_irb->esw.esw0.erw.fsavf = irb->esw.esw0.erw.fsavf;
162                 if (cdev_irb->esw.esw0.erw.fsavf) {
163                         /* ... and copy the failing storage address. */
164                         memcpy(cdev_irb->esw.esw0.faddr, irb->esw.esw0.faddr,
165                                sizeof (irb->esw.esw0.faddr));
166                         /* ... and copy the failing storage address format. */
167                         cdev_irb->esw.esw0.erw.fsaf = irb->esw.esw0.erw.fsaf;
168                 }
169                 /* Copy secondary ccw address validity bit. */
170                 cdev_irb->esw.esw0.erw.scavf = irb->esw.esw0.erw.scavf;
171                 if (irb->esw.esw0.erw.scavf)
172                         /* ... and copy the secondary ccw address. */
173                         cdev_irb->esw.esw0.saddr = irb->esw.esw0.saddr;
174                 
175         }
176         /* FIXME: DCTI for format 2? */
177
178         /* Copy authorization bit. */
179         cdev_irb->esw.esw0.erw.auth = irb->esw.esw0.erw.auth;
180         /* Copy path verification required flag. */
181         cdev_irb->esw.esw0.erw.pvrf = irb->esw.esw0.erw.pvrf;
182         if (irb->esw.esw0.erw.pvrf && cdev->private->options.pgroup)
183                 cdev->private->flags.doverify = 1;
184         /* Copy concurrent sense bit. */
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  * Accumulate status from irb to devstat.
192  */
193 void
194 ccw_device_accumulate_irb(struct ccw_device *cdev, struct irb *irb)
195 {
196         struct irb *cdev_irb;
197
198         /*
199          * Check if the status pending bit is set in stctl.
200          * If not, the remaining bit have no meaning and we must ignore them.
201          * The esw is not meaningful as well...
202          */
203         if (!(irb->scsw.stctl & SCSW_STCTL_STATUS_PEND))
204                 return;
205
206         /* Check for channel checks and interface control checks. */
207         ccw_device_msg_control_check(cdev, irb);
208
209         /* Check for path not operational. */
210         if (irb->scsw.pno && irb->scsw.fctl != 0 &&
211             (!(irb->scsw.stctl & SCSW_STCTL_INTER_STATUS) ||
212              (irb->scsw.actl & SCSW_ACTL_SUSPENDED)))
213                 ccw_device_path_notoper(cdev);
214
215         /*
216          * Don't accumulate unsolicited interrupts.
217          */
218         if ((irb->scsw.stctl ==
219              (SCSW_STCTL_STATUS_PEND | SCSW_STCTL_ALERT_STATUS)) &&
220             (!irb->scsw.cc))
221                 return;
222
223         cdev_irb = &cdev->private->irb;
224
225         /* Copy bits which are valid only for the start function. */
226         if (irb->scsw.fctl & SCSW_FCTL_START_FUNC) {
227                 /* Copy key. */
228                 cdev_irb->scsw.key = irb->scsw.key;
229                 /* Copy suspend control bit. */
230                 cdev_irb->scsw.sctl = irb->scsw.sctl;
231                 /* Accumulate deferred condition code. */
232                 cdev_irb->scsw.cc |= irb->scsw.cc;
233                 /* Copy ccw format bit. */
234                 cdev_irb->scsw.fmt = irb->scsw.fmt;
235                 /* Copy prefetch bit. */
236                 cdev_irb->scsw.pfch = irb->scsw.pfch;
237                 /* Copy initial-status-interruption-control. */
238                 cdev_irb->scsw.isic = irb->scsw.isic;
239                 /* Copy address limit checking control. */
240                 cdev_irb->scsw.alcc = irb->scsw.alcc;
241                 /* Copy suppress suspend bit. */
242                 cdev_irb->scsw.ssi = irb->scsw.ssi;
243         }
244
245         /* Take care of the extended control bit and extended control word. */
246         ccw_device_accumulate_ecw(cdev, irb);
247             
248         /* Accumulate function control. */
249         cdev_irb->scsw.fctl |= irb->scsw.fctl;
250         /* Copy activity control. */
251         cdev_irb->scsw.actl= irb->scsw.actl;
252         /* Accumulate status control. */
253         cdev_irb->scsw.stctl |= irb->scsw.stctl;
254         /*
255          * Copy ccw address if it is valid. This is a bit simplified
256          * but should be close enough for all practical purposes.
257          */
258         if ((irb->scsw.stctl & SCSW_STCTL_PRIM_STATUS) ||
259             ((irb->scsw.stctl == 
260               (SCSW_STCTL_INTER_STATUS|SCSW_STCTL_STATUS_PEND)) &&
261              (irb->scsw.actl & SCSW_ACTL_DEVACT) &&
262              (irb->scsw.actl & SCSW_ACTL_SCHACT)) ||
263             (irb->scsw.actl & SCSW_ACTL_SUSPENDED))
264                 cdev_irb->scsw.cpa = irb->scsw.cpa;
265         /* Accumulate device status, but not the device busy flag. */
266         cdev_irb->scsw.dstat &= ~DEV_STAT_BUSY;
267         cdev_irb->scsw.dstat |= irb->scsw.dstat;
268         /* Accumulate subchannel status. */
269         cdev_irb->scsw.cstat |= irb->scsw.cstat;
270         /* Copy residual count if it is valid. */
271         if ((irb->scsw.stctl & SCSW_STCTL_PRIM_STATUS) &&
272             (irb->scsw.cstat & ~(SCHN_STAT_PCI | SCHN_STAT_INCORR_LEN)) == 0)
273                 cdev_irb->scsw.count = irb->scsw.count;
274
275         /* Take care of bits in the extended status word. */
276         ccw_device_accumulate_esw(cdev, irb);
277
278         /*
279          * Check whether we must issue a SENSE CCW ourselves if there is no
280          * concurrent sense facility installed for the subchannel.
281          * No sense is required if no delayed sense is pending
282          * and we did not get a unit check without sense information.
283          *
284          * Note: We should check for ioinfo[irq]->flags.consns but VM
285          *       violates the ESA/390 architecture and doesn't present an
286          *       operand exception for virtual devices without concurrent
287          *       sense facility available/supported when enabling the
288          *       concurrent sense facility.
289          */
290         if ((cdev_irb->scsw.dstat & DEV_STAT_UNIT_CHECK) &&
291             !(cdev_irb->esw.esw0.erw.cons))
292                 cdev->private->flags.dosense = 1;
293 }
294
295 /*
296  * Do a basic sense.
297  */
298 int
299 ccw_device_do_sense(struct ccw_device *cdev, struct irb *irb)
300 {
301         struct subchannel *sch;
302
303         sch = to_subchannel(cdev->dev.parent);
304
305         /* A sense is required, can we do it now ? */
306         if ((irb->scsw.actl  & (SCSW_ACTL_DEVACT | SCSW_ACTL_SCHACT)) != 0)
307                 /*
308                  * we received an Unit Check but we have no final
309                  *  status yet, therefore we must delay the SENSE
310                  *  processing. We must not report this intermediate
311                  *  status to the device interrupt handler.
312                  */
313                 return -EBUSY;
314
315         /*
316          * We have ending status but no sense information. Do a basic sense.
317          */
318         sch = to_subchannel(cdev->dev.parent);
319         sch->sense_ccw.cmd_code = CCW_CMD_BASIC_SENSE;
320         sch->sense_ccw.cda = (__u32) __pa(cdev->private->irb.ecw);
321         sch->sense_ccw.count = SENSE_MAX_COUNT;
322         sch->sense_ccw.flags = CCW_FLAG_SLI;
323
324         return cio_start (sch, &sch->sense_ccw, 0xff);
325 }
326
327 /*
328  * Add information from basic sense to devstat.
329  */
330 void
331 ccw_device_accumulate_basic_sense(struct ccw_device *cdev, struct irb *irb)
332 {
333         /*
334          * Check if the status pending bit is set in stctl.
335          * If not, the remaining bit have no meaning and we must ignore them.
336          * The esw is not meaningful as well...
337          */
338         if (!(irb->scsw.stctl & SCSW_STCTL_STATUS_PEND))
339                 return;
340
341         /* Check for channel checks and interface control checks. */
342         ccw_device_msg_control_check(cdev, irb);
343
344         /* Check for path not operational. */
345         if (irb->scsw.pno && irb->scsw.fctl != 0 &&
346             (!(irb->scsw.stctl & SCSW_STCTL_INTER_STATUS) ||
347              (irb->scsw.actl & SCSW_ACTL_SUSPENDED)))
348                 ccw_device_path_notoper(cdev);
349
350         if (!(irb->scsw.dstat & DEV_STAT_UNIT_CHECK) &&
351             (irb->scsw.dstat & DEV_STAT_CHN_END)) {
352                 cdev->private->irb.esw.esw0.erw.cons = 1;
353                 cdev->private->flags.dosense = 0;
354         }
355         /* Check if path verification is required. */
356         if (ccw_device_accumulate_esw_valid(irb) &&
357             irb->esw.esw0.erw.pvrf && cdev->private->options.pgroup) 
358                 cdev->private->flags.doverify = 1;
359 }
360
361 /*
362  * This function accumulates the status into the private devstat and
363  * starts a basic sense if one is needed.
364  */
365 int
366 ccw_device_accumulate_and_sense(struct ccw_device *cdev, struct irb *irb)
367 {
368         ccw_device_accumulate_irb(cdev, irb);
369         if ((irb->scsw.actl  & (SCSW_ACTL_DEVACT | SCSW_ACTL_SCHACT)) != 0)
370                 return -EBUSY;
371         /* Check for basic sense. */
372         if (cdev->private->flags.dosense &&
373             !(irb->scsw.dstat & DEV_STAT_UNIT_CHECK)) {
374                 cdev->private->irb.esw.esw0.erw.cons = 1;
375                 cdev->private->flags.dosense = 0;
376                 return 0;
377         }
378         if (cdev->private->flags.dosense) {
379                 ccw_device_do_sense(cdev, irb);
380                 return -EBUSY;
381         }
382         return 0;
383 }
384