blob: 407d0e9adfaf96a0d4362f8e56c986f0c17700fa [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * drivers/s390/cio/chsc.c
3 * S/390 common I/O routines -- channel subsystem call
Linus Torvalds1da177e2005-04-16 15:20:36 -07004 *
Cornelia Huckc820de32008-07-14 09:58:45 +02005 * Copyright IBM Corp. 1999,2008
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 * Author(s): Ingo Adlung (adlung@de.ibm.com)
Cornelia Huck4ce3b302006-01-14 13:21:04 -08007 * Cornelia Huck (cornelia.huck@de.ibm.com)
Linus Torvalds1da177e2005-04-16 15:20:36 -07008 * Arnd Bergmann (arndb@de.ibm.com)
9 */
10
Michael Ernste6d5a422008-12-25 13:39:36 +010011#define KMSG_COMPONENT "cio"
12#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
13
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/slab.h>
16#include <linux/init.h>
17#include <linux/device.h>
18
19#include <asm/cio.h>
Peter Oberparleitere5854a52007-04-27 16:01:31 +020020#include <asm/chpid.h>
Cornelia Huck9d92a7e2008-07-14 09:59:05 +020021#include <asm/chsc.h>
Heiko Carstensf5daba12009-03-26 15:24:01 +010022#include <asm/crw.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023
24#include "css.h"
25#include "cio.h"
26#include "cio_debug.h"
27#include "ioasm.h"
Peter Oberparleitere6b6e102007-04-27 16:01:28 +020028#include "chp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include "chsc.h"
30
Linus Torvalds1da177e2005-04-16 15:20:36 -070031static void *sei_page;
Sebastian Ott818c2722010-04-22 17:17:03 +020032static DEFINE_SPINLOCK(sda_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070033
Cornelia Huckdae39842008-07-17 17:16:47 +020034/**
35 * chsc_error_from_response() - convert a chsc response to an error
36 * @response: chsc response code
37 *
38 * Returns an appropriate Linux error code for @response.
39 */
40int chsc_error_from_response(int response)
Cornelia Huckb9c9a212008-02-05 16:50:34 +010041{
42 switch (response) {
43 case 0x0001:
44 return 0;
45 case 0x0002:
46 case 0x0003:
47 case 0x0006:
48 case 0x0007:
49 case 0x0008:
50 case 0x000a:
51 return -EINVAL;
52 case 0x0004:
53 return -EOPNOTSUPP;
54 default:
55 return -EIO;
56 }
57}
Cornelia Huckdae39842008-07-17 17:16:47 +020058EXPORT_SYMBOL_GPL(chsc_error_from_response);
Cornelia Huckb9c9a212008-02-05 16:50:34 +010059
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020060struct chsc_ssd_area {
61 struct chsc_header request;
62 u16 :10;
63 u16 ssid:2;
64 u16 :4;
65 u16 f_sch; /* first subchannel */
66 u16 :16;
67 u16 l_sch; /* last subchannel */
68 u32 :32;
69 struct chsc_header response;
70 u32 :32;
71 u8 sch_valid : 1;
72 u8 dev_valid : 1;
73 u8 st : 3; /* subchannel type */
74 u8 zeroes : 3;
75 u8 unit_addr; /* unit address */
76 u16 devno; /* device number */
77 u8 path_mask;
78 u8 fla_valid_mask;
79 u16 sch; /* subchannel */
80 u8 chpid[8]; /* chpids 0-7 */
81 u16 fla[8]; /* full link addresses 0-7 */
82} __attribute__ ((packed));
83
84int chsc_get_ssd_info(struct subchannel_id schid, struct chsc_ssd_info *ssd)
Linus Torvalds1da177e2005-04-16 15:20:36 -070085{
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020086 unsigned long page;
87 struct chsc_ssd_area *ssd_area;
88 int ccode;
Linus Torvalds1da177e2005-04-16 15:20:36 -070089 int ret;
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020090 int i;
91 int mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -070092
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020093 page = get_zeroed_page(GFP_KERNEL | GFP_DMA);
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 if (!page)
95 return -ENOMEM;
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020096 ssd_area = (struct chsc_ssd_area *) page;
97 ssd_area->request.length = 0x0010;
98 ssd_area->request.code = 0x0004;
99 ssd_area->ssid = schid.ssid;
100 ssd_area->f_sch = schid.sch_no;
101 ssd_area->l_sch = schid.sch_no;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200102
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200103 ccode = chsc(ssd_area);
104 /* Check response. */
105 if (ccode > 0) {
106 ret = (ccode == 3) ? -ENODEV : -EBUSY;
107 goto out_free;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100109 ret = chsc_error_from_response(ssd_area->response.code);
110 if (ret != 0) {
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200111 CIO_MSG_EVENT(2, "chsc: ssd failed for 0.%x.%04x (rc=%04x)\n",
112 schid.ssid, schid.sch_no,
113 ssd_area->response.code);
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200114 goto out_free;
115 }
116 if (!ssd_area->sch_valid) {
117 ret = -ENODEV;
118 goto out_free;
119 }
120 /* Copy data */
121 ret = 0;
122 memset(ssd, 0, sizeof(struct chsc_ssd_info));
Cornelia Huckb279a4f2008-01-26 14:10:45 +0100123 if ((ssd_area->st != SUBCHANNEL_TYPE_IO) &&
124 (ssd_area->st != SUBCHANNEL_TYPE_MSG))
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200125 goto out_free;
126 ssd->path_mask = ssd_area->path_mask;
127 ssd->fla_valid_mask = ssd_area->fla_valid_mask;
128 for (i = 0; i < 8; i++) {
129 mask = 0x80 >> i;
130 if (ssd_area->path_mask & mask) {
131 chp_id_init(&ssd->chpid[i]);
132 ssd->chpid[i].id = ssd_area->chpid[i];
133 }
134 if (ssd_area->fla_valid_mask & mask)
135 ssd->fla[i] = ssd_area->fla[i];
136 }
137out_free:
138 free_page(page);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139 return ret;
140}
141
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100142static int s390_subchannel_remove_chpid(struct subchannel *sch, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143{
Cornelia Huck2ec22982006-12-08 15:54:26 +0100144 spin_lock_irq(sch->lock);
Cornelia Huckc820de32008-07-14 09:58:45 +0200145 if (sch->driver && sch->driver->chp_event)
146 if (sch->driver->chp_event(sch, data, CHP_OFFLINE) != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147 goto out_unreg;
Cornelia Huck2ec22982006-12-08 15:54:26 +0100148 spin_unlock_irq(sch->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 return 0;
Stefan Bader387b7342007-04-27 16:01:33 +0200150
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151out_unreg:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 sch->lpm = 0;
Stefan Bader387b7342007-04-27 16:01:33 +0200153 spin_unlock_irq(sch->lock);
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200154 css_schedule_eval(sch->schid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 return 0;
156}
157
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200158void chsc_chp_offline(struct chp_id chpid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159{
160 char dbf_txt[15];
Cornelia Huck99611f82008-07-14 09:59:02 +0200161 struct chp_link link;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200163 sprintf(dbf_txt, "chpr%x.%02x", chpid.cssid, chpid.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164 CIO_TRACE_EVENT(2, dbf_txt);
165
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200166 if (chp_get_status(chpid) <= 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167 return;
Cornelia Huck99611f82008-07-14 09:59:02 +0200168 memset(&link, 0, sizeof(struct chp_link));
169 link.chpid = chpid;
Cornelia Huck22806dc2008-04-17 07:45:59 +0200170 /* Wait until previous actions have settled. */
171 css_wait_for_slow_path();
Cornelia Huck99611f82008-07-14 09:59:02 +0200172 for_each_subchannel_staged(s390_subchannel_remove_chpid, NULL, &link);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173}
174
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100175static int s390_process_res_acc_new_sch(struct subchannel_id schid, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176{
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800177 struct schib schib;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800178 /*
179 * We don't know the device yet, but since a path
180 * may be available now to the device we'll have
181 * to do recognition again.
182 * Since we don't have any idea about which chpid
183 * that beast may be on we'll have to do a stsch
184 * on all devices, grr...
185 */
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800186 if (stsch_err(schid, &schib))
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800187 /* We're through */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200188 return -ENXIO;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800189
190 /* Put it on the slow path. */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200191 css_schedule_eval(schid);
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800192 return 0;
193}
194
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100195static int __s390_process_res_acc(struct subchannel *sch, void *data)
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800196{
Cornelia Huck2ec22982006-12-08 15:54:26 +0100197 spin_lock_irq(sch->lock);
Cornelia Huckc820de32008-07-14 09:58:45 +0200198 if (sch->driver && sch->driver->chp_event)
199 sch->driver->chp_event(sch, data, CHP_ONLINE);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100200 spin_unlock_irq(sch->lock);
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100201
Peter Oberparleiterdd9963f2006-09-20 15:59:54 +0200202 return 0;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800203}
204
Cornelia Huck99611f82008-07-14 09:59:02 +0200205static void s390_process_res_acc(struct chp_link *link)
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800206{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700207 char dbf_txt[15];
208
Cornelia Huck99611f82008-07-14 09:59:02 +0200209 sprintf(dbf_txt, "accpr%x.%02x", link->chpid.cssid,
210 link->chpid.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 CIO_TRACE_EVENT( 2, dbf_txt);
Cornelia Huck99611f82008-07-14 09:59:02 +0200212 if (link->fla != 0) {
213 sprintf(dbf_txt, "fla%x", link->fla);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214 CIO_TRACE_EVENT( 2, dbf_txt);
215 }
Cornelia Huck22806dc2008-04-17 07:45:59 +0200216 /* Wait until previous actions have settled. */
217 css_wait_for_slow_path();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700218 /*
219 * I/O resources may have become accessible.
220 * Scan through all subchannels that may be concerned and
221 * do a validation on those.
222 * The more information we have (info), the less scanning
223 * will we have to do.
224 */
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100225 for_each_subchannel_staged(__s390_process_res_acc,
Cornelia Huck99611f82008-07-14 09:59:02 +0200226 s390_process_res_acc_new_sch, link);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700227}
228
229static int
230__get_chpid_from_lir(void *data)
231{
232 struct lir {
233 u8 iq;
234 u8 ic;
235 u16 sci;
236 /* incident-node descriptor */
237 u32 indesc[28];
238 /* attached-node descriptor */
239 u32 andesc[28];
240 /* incident-specific information */
241 u32 isinfo[28];
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100242 } __attribute__ ((packed)) *lir;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243
Cornelia Huck12975ae2006-10-11 15:31:47 +0200244 lir = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 if (!(lir->iq&0x80))
246 /* NULL link incident record */
247 return -EINVAL;
248 if (!(lir->indesc[0]&0xc0000000))
249 /* node descriptor not valid */
250 return -EINVAL;
251 if (!(lir->indesc[0]&0x10000000))
252 /* don't handle device-type nodes - FIXME */
253 return -EINVAL;
254 /* Byte 3 contains the chpid. Could also be CTCA, but we don't care */
255
256 return (u16) (lir->indesc[0]&0x000000ff);
257}
258
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100259struct chsc_sei_area {
260 struct chsc_header request;
261 u32 reserved1;
262 u32 reserved2;
263 u32 reserved3;
264 struct chsc_header response;
265 u32 reserved4;
266 u8 flags;
267 u8 vf; /* validity flags */
268 u8 rs; /* reporting source */
269 u8 cc; /* content code */
270 u16 fla; /* full link address */
271 u16 rsid; /* reporting source id */
272 u32 reserved5;
273 u32 reserved6;
274 u8 ccdf[4096 - 16 - 24]; /* content-code dependent field */
275 /* ccdf has to be big enough for a link-incident record */
276} __attribute__ ((packed));
277
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200278static void chsc_process_sei_link_incident(struct chsc_sei_area *sei_area)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279{
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200280 struct chp_id chpid;
281 int id;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100282
283 CIO_CRW_EVENT(4, "chsc: link incident (rs=%02x, rs_id=%04x)\n",
284 sei_area->rs, sei_area->rsid);
285 if (sei_area->rs != 4)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200286 return;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200287 id = __get_chpid_from_lir(sei_area->ccdf);
288 if (id < 0)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100289 CIO_CRW_EVENT(4, "chsc: link incident - invalid LIR\n");
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200290 else {
291 chp_id_init(&chpid);
292 chpid.id = id;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200293 chsc_chp_offline(chpid);
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200294 }
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100295}
296
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200297static void chsc_process_sei_res_acc(struct chsc_sei_area *sei_area)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100298{
Cornelia Huck99611f82008-07-14 09:59:02 +0200299 struct chp_link link;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200300 struct chp_id chpid;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100301 int status;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100302
303 CIO_CRW_EVENT(4, "chsc: resource accessibility event (rs=%02x, "
304 "rs_id=%04x)\n", sei_area->rs, sei_area->rsid);
305 if (sei_area->rs != 4)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200306 return;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200307 chp_id_init(&chpid);
308 chpid.id = sei_area->rsid;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100309 /* allocate a new channel path structure, if needed */
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200310 status = chp_get_status(chpid);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100311 if (status < 0)
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200312 chp_new(chpid);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100313 else if (!status)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200314 return;
Cornelia Huck99611f82008-07-14 09:59:02 +0200315 memset(&link, 0, sizeof(struct chp_link));
316 link.chpid = chpid;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100317 if ((sei_area->vf & 0xc0) != 0) {
Cornelia Huck99611f82008-07-14 09:59:02 +0200318 link.fla = sei_area->fla;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100319 if ((sei_area->vf & 0xc0) == 0xc0)
320 /* full link address */
Cornelia Huck99611f82008-07-14 09:59:02 +0200321 link.fla_mask = 0xffff;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100322 else
323 /* link address */
Cornelia Huck99611f82008-07-14 09:59:02 +0200324 link.fla_mask = 0xff00;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100325 }
Cornelia Huck99611f82008-07-14 09:59:02 +0200326 s390_process_res_acc(&link);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100327}
328
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200329struct chp_config_data {
330 u8 map[32];
331 u8 op;
332 u8 pc;
333};
334
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200335static void chsc_process_sei_chp_config(struct chsc_sei_area *sei_area)
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200336{
337 struct chp_config_data *data;
338 struct chp_id chpid;
339 int num;
Michael Ernste6d5a422008-12-25 13:39:36 +0100340 char *events[3] = {"configure", "deconfigure", "cancel deconfigure"};
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200341
342 CIO_CRW_EVENT(4, "chsc: channel-path-configuration notification\n");
343 if (sei_area->rs != 0)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200344 return;
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200345 data = (struct chp_config_data *) &(sei_area->ccdf);
346 chp_id_init(&chpid);
347 for (num = 0; num <= __MAX_CHPID; num++) {
348 if (!chp_test_bit(data->map, num))
349 continue;
350 chpid.id = num;
Michael Ernste6d5a422008-12-25 13:39:36 +0100351 pr_notice("Processing %s for channel path %x.%02x\n",
352 events[data->op], chpid.cssid, chpid.id);
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200353 switch (data->op) {
354 case 0:
355 chp_cfg_schedule(chpid, 1);
356 break;
357 case 1:
358 chp_cfg_schedule(chpid, 0);
359 break;
360 case 2:
361 chp_cfg_cancel_deconfigure(chpid);
362 break;
363 }
364 }
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200365}
366
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200367static void chsc_process_sei(struct chsc_sei_area *sei_area)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100368{
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100369 /* Check if we might have lost some information. */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200370 if (sei_area->flags & 0x40) {
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100371 CIO_CRW_EVENT(2, "chsc: event overflow\n");
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200372 css_schedule_eval_all();
373 }
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100374 /* which kind of information was stored? */
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100375 switch (sei_area->cc) {
376 case 1: /* link incident*/
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200377 chsc_process_sei_link_incident(sei_area);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100378 break;
379 case 2: /* i/o resource accessibiliy */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200380 chsc_process_sei_res_acc(sei_area);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100381 break;
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200382 case 8: /* channel-path-configuration notification */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200383 chsc_process_sei_chp_config(sei_area);
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200384 break;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100385 default: /* other stuff */
386 CIO_CRW_EVENT(4, "chsc: unhandled sei content code %d\n",
387 sei_area->cc);
388 break;
389 }
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100390}
391
Cornelia Huckc1156182008-07-14 09:58:46 +0200392static void chsc_process_crw(struct crw *crw0, struct crw *crw1, int overflow)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100393{
394 struct chsc_sei_area *sei_area;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395
Cornelia Huckc1156182008-07-14 09:58:46 +0200396 if (overflow) {
397 css_schedule_eval_all();
398 return;
399 }
400 CIO_CRW_EVENT(2, "CRW reports slct=%d, oflw=%d, "
401 "chn=%d, rsc=%X, anc=%d, erc=%X, rsid=%X\n",
402 crw0->slct, crw0->oflw, crw0->chn, crw0->rsc, crw0->anc,
403 crw0->erc, crw0->rsid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 if (!sei_page)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200405 return;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100406 /* Access to sei_page is serialized through machine check handler
407 * thread, so no need for locking. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 sei_area = sei_page;
409
Cornelia Huckc1156182008-07-14 09:58:46 +0200410 CIO_TRACE_EVENT(2, "prcss");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 do {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412 memset(sei_area, 0, sizeof(*sei_area));
Cornelia Huck495a5b42006-03-24 03:15:14 -0800413 sei_area->request.length = 0x0010;
414 sei_area->request.code = 0x000e;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100415 if (chsc(sei_area))
416 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100418 if (sei_area->response.code == 0x0001) {
419 CIO_CRW_EVENT(4, "chsc: sei successful\n");
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200420 chsc_process_sei(sei_area);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100421 } else {
422 CIO_CRW_EVENT(2, "chsc: sei failed (rc=%04x)\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423 sei_area->response.code);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424 break;
425 }
426 } while (sei_area->flags & 0x80);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427}
428
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200429void chsc_chp_online(struct chp_id chpid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700431 char dbf_txt[15];
Cornelia Huck99611f82008-07-14 09:59:02 +0200432 struct chp_link link;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200434 sprintf(dbf_txt, "cadd%x.%02x", chpid.cssid, chpid.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700435 CIO_TRACE_EVENT(2, dbf_txt);
436
Cornelia Huck22806dc2008-04-17 07:45:59 +0200437 if (chp_get_status(chpid) != 0) {
Cornelia Huck99611f82008-07-14 09:59:02 +0200438 memset(&link, 0, sizeof(struct chp_link));
439 link.chpid = chpid;
Cornelia Huck22806dc2008-04-17 07:45:59 +0200440 /* Wait until previous actions have settled. */
441 css_wait_for_slow_path();
Cornelia Huckc820de32008-07-14 09:58:45 +0200442 for_each_subchannel_staged(__s390_process_res_acc, NULL,
Cornelia Huck99611f82008-07-14 09:59:02 +0200443 &link);
Cornelia Huck22806dc2008-04-17 07:45:59 +0200444 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445}
446
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200447static void __s390_subchannel_vary_chpid(struct subchannel *sch,
448 struct chp_id chpid, int on)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450 unsigned long flags;
Cornelia Huck99611f82008-07-14 09:59:02 +0200451 struct chp_link link;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452
Cornelia Huck99611f82008-07-14 09:59:02 +0200453 memset(&link, 0, sizeof(struct chp_link));
454 link.chpid = chpid;
Cornelia Huck2ec22982006-12-08 15:54:26 +0100455 spin_lock_irqsave(sch->lock, flags);
Cornelia Huckc820de32008-07-14 09:58:45 +0200456 if (sch->driver && sch->driver->chp_event)
Cornelia Huck99611f82008-07-14 09:59:02 +0200457 sch->driver->chp_event(sch, &link,
Cornelia Huckc820de32008-07-14 09:58:45 +0200458 on ? CHP_VARY_ON : CHP_VARY_OFF);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100459 spin_unlock_irqrestore(sch->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460}
461
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100462static int s390_subchannel_vary_chpid_off(struct subchannel *sch, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463{
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100464 struct chp_id *chpid = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700465
466 __s390_subchannel_vary_chpid(sch, *chpid, 0);
467 return 0;
468}
469
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100470static int s390_subchannel_vary_chpid_on(struct subchannel *sch, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471{
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100472 struct chp_id *chpid = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473
474 __s390_subchannel_vary_chpid(sch, *chpid, 1);
475 return 0;
476}
477
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800478static int
479__s390_vary_chpid_on(struct subchannel_id schid, void *data)
480{
481 struct schib schib;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800482
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800483 if (stsch_err(schid, &schib))
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800484 /* We're through */
485 return -ENXIO;
486 /* Put it on the slow path. */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200487 css_schedule_eval(schid);
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800488 return 0;
489}
490
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200491/**
492 * chsc_chp_vary - propagate channel-path vary operation to subchannels
493 * @chpid: channl-path ID
494 * @on: non-zero for vary online, zero for vary offline
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495 */
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200496int chsc_chp_vary(struct chp_id chpid, int on)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497{
Cornelia Huck99611f82008-07-14 09:59:02 +0200498 struct chp_link link;
499
500 memset(&link, 0, sizeof(struct chp_link));
501 link.chpid = chpid;
Cornelia Huck22806dc2008-04-17 07:45:59 +0200502 /* Wait until previous actions have settled. */
503 css_wait_for_slow_path();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504 /*
505 * Redo PathVerification on the devices the chpid connects to
506 */
507
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800508 if (on)
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100509 for_each_subchannel_staged(s390_subchannel_vary_chpid_on,
Cornelia Huck99611f82008-07-14 09:59:02 +0200510 __s390_vary_chpid_on, &link);
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100511 else
512 for_each_subchannel_staged(s390_subchannel_vary_chpid_off,
Cornelia Huck99611f82008-07-14 09:59:02 +0200513 NULL, &link);
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100514
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515 return 0;
516}
517
Cornelia Huck495a5b42006-03-24 03:15:14 -0800518static void
519chsc_remove_cmg_attr(struct channel_subsystem *css)
520{
521 int i;
522
523 for (i = 0; i <= __MAX_CHPID; i++) {
524 if (!css->chps[i])
525 continue;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200526 chp_remove_cmg_attr(css->chps[i]);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800527 }
528}
529
530static int
531chsc_add_cmg_attr(struct channel_subsystem *css)
532{
533 int i, ret;
534
535 ret = 0;
536 for (i = 0; i <= __MAX_CHPID; i++) {
537 if (!css->chps[i])
538 continue;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200539 ret = chp_add_cmg_attr(css->chps[i]);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800540 if (ret)
541 goto cleanup;
542 }
543 return ret;
544cleanup:
545 for (--i; i >= 0; i--) {
546 if (!css->chps[i])
547 continue;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200548 chp_remove_cmg_attr(css->chps[i]);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800549 }
550 return ret;
551}
552
Sebastian Ottdcbd16d2009-06-16 10:30:22 +0200553int __chsc_do_secm(struct channel_subsystem *css, int enable, void *page)
Cornelia Huck495a5b42006-03-24 03:15:14 -0800554{
555 struct {
556 struct chsc_header request;
557 u32 operation_code : 2;
558 u32 : 30;
559 u32 key : 4;
560 u32 : 28;
561 u32 zeroes1;
562 u32 cub_addr1;
563 u32 zeroes2;
564 u32 cub_addr2;
565 u32 reserved[13];
566 struct chsc_header response;
567 u32 status : 8;
568 u32 : 4;
569 u32 fmt : 4;
570 u32 : 16;
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100571 } __attribute__ ((packed)) *secm_area;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800572 int ret, ccode;
573
574 secm_area = page;
575 secm_area->request.length = 0x0050;
576 secm_area->request.code = 0x0016;
577
Heiko Carstensd1bf8592010-02-26 22:37:30 +0100578 secm_area->key = PAGE_DEFAULT_KEY >> 4;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800579 secm_area->cub_addr1 = (u64)(unsigned long)css->cub_addr1;
580 secm_area->cub_addr2 = (u64)(unsigned long)css->cub_addr2;
581
582 secm_area->operation_code = enable ? 0 : 1;
583
584 ccode = chsc(secm_area);
585 if (ccode > 0)
586 return (ccode == 3) ? -ENODEV : -EBUSY;
587
588 switch (secm_area->response.code) {
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100589 case 0x0102:
590 case 0x0103:
Cornelia Huck495a5b42006-03-24 03:15:14 -0800591 ret = -EINVAL;
Sebastian Ott17e7d872009-03-26 15:24:17 +0100592 break;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800593 default:
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100594 ret = chsc_error_from_response(secm_area->response.code);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800595 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100596 if (ret != 0)
597 CIO_CRW_EVENT(2, "chsc: secm failed (rc=%04x)\n",
598 secm_area->response.code);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800599 return ret;
600}
601
602int
603chsc_secm(struct channel_subsystem *css, int enable)
604{
605 void *secm_area;
606 int ret;
607
608 secm_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
609 if (!secm_area)
610 return -ENOMEM;
611
Cornelia Huck495a5b42006-03-24 03:15:14 -0800612 if (enable && !css->cm_enabled) {
613 css->cub_addr1 = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
614 css->cub_addr2 = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
615 if (!css->cub_addr1 || !css->cub_addr2) {
616 free_page((unsigned long)css->cub_addr1);
617 free_page((unsigned long)css->cub_addr2);
618 free_page((unsigned long)secm_area);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800619 return -ENOMEM;
620 }
621 }
622 ret = __chsc_do_secm(css, enable, secm_area);
623 if (!ret) {
624 css->cm_enabled = enable;
625 if (css->cm_enabled) {
626 ret = chsc_add_cmg_attr(css);
627 if (ret) {
628 memset(secm_area, 0, PAGE_SIZE);
629 __chsc_do_secm(css, 0, secm_area);
630 css->cm_enabled = 0;
631 }
632 } else
633 chsc_remove_cmg_attr(css);
634 }
Cornelia Huck8c4941c2007-04-27 16:01:38 +0200635 if (!css->cm_enabled) {
Cornelia Huck495a5b42006-03-24 03:15:14 -0800636 free_page((unsigned long)css->cub_addr1);
637 free_page((unsigned long)css->cub_addr2);
638 }
Cornelia Huck495a5b42006-03-24 03:15:14 -0800639 free_page((unsigned long)secm_area);
640 return ret;
641}
642
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200643int chsc_determine_channel_path_desc(struct chp_id chpid, int fmt, int rfmt,
644 int c, int m,
645 struct chsc_response_struct *resp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646{
647 int ccode, ret;
648
649 struct {
650 struct chsc_header request;
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200651 u32 : 2;
652 u32 m : 1;
653 u32 c : 1;
654 u32 fmt : 4;
655 u32 cssid : 8;
656 u32 : 4;
657 u32 rfmt : 4;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658 u32 first_chpid : 8;
659 u32 : 24;
660 u32 last_chpid : 8;
661 u32 zeroes1;
662 struct chsc_header response;
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200663 u8 data[PAGE_SIZE - 20];
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100664 } __attribute__ ((packed)) *scpd_area;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200666 if ((rfmt == 1) && !css_general_characteristics.fcs)
667 return -EINVAL;
668 if ((rfmt == 2) && !css_general_characteristics.cib)
669 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 scpd_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
671 if (!scpd_area)
672 return -ENOMEM;
673
Cornelia Huck495a5b42006-03-24 03:15:14 -0800674 scpd_area->request.length = 0x0010;
675 scpd_area->request.code = 0x0002;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700676
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200677 scpd_area->cssid = chpid.cssid;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200678 scpd_area->first_chpid = chpid.id;
679 scpd_area->last_chpid = chpid.id;
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200680 scpd_area->m = m;
681 scpd_area->c = c;
682 scpd_area->fmt = fmt;
683 scpd_area->rfmt = rfmt;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684
685 ccode = chsc(scpd_area);
686 if (ccode > 0) {
687 ret = (ccode == 3) ? -ENODEV : -EBUSY;
688 goto out;
689 }
690
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100691 ret = chsc_error_from_response(scpd_area->response.code);
692 if (ret == 0)
693 /* Success. */
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200694 memcpy(resp, &scpd_area->response, scpd_area->response.length);
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100695 else
696 CIO_CRW_EVENT(2, "chsc: scpd failed (rc=%04x)\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697 scpd_area->response.code);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698out:
699 free_page((unsigned long)scpd_area);
700 return ret;
701}
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200702EXPORT_SYMBOL_GPL(chsc_determine_channel_path_desc);
703
704int chsc_determine_base_channel_path_desc(struct chp_id chpid,
705 struct channel_path_desc *desc)
706{
707 struct chsc_response_struct *chsc_resp;
708 int ret;
709
710 chsc_resp = kzalloc(sizeof(*chsc_resp), GFP_KERNEL);
711 if (!chsc_resp)
712 return -ENOMEM;
713 ret = chsc_determine_channel_path_desc(chpid, 0, 0, 0, 0, chsc_resp);
714 if (ret)
715 goto out_free;
Sebastian Ott878c4952010-07-19 09:22:37 +0200716 memcpy(desc, &chsc_resp->data, sizeof(*desc));
Cornelia Huck9d92a7e2008-07-14 09:59:05 +0200717out_free:
718 kfree(chsc_resp);
719 return ret;
720}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700721
Cornelia Huck495a5b42006-03-24 03:15:14 -0800722static void
723chsc_initialize_cmg_chars(struct channel_path *chp, u8 cmcv,
724 struct cmg_chars *chars)
725{
726 switch (chp->cmg) {
727 case 2:
728 case 3:
729 chp->cmg_chars = kmalloc(sizeof(struct cmg_chars),
730 GFP_KERNEL);
731 if (chp->cmg_chars) {
732 int i, mask;
733 struct cmg_chars *cmg_chars;
734
735 cmg_chars = chp->cmg_chars;
736 for (i = 0; i < NR_MEASUREMENT_CHARS; i++) {
737 mask = 0x80 >> (i + 3);
738 if (cmcv & mask)
739 cmg_chars->values[i] = chars->values[i];
740 else
741 cmg_chars->values[i] = 0;
742 }
743 }
744 break;
745 default:
746 /* No cmg-dependent data. */
747 break;
748 }
749}
750
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200751int chsc_get_channel_measurement_chars(struct channel_path *chp)
Cornelia Huck495a5b42006-03-24 03:15:14 -0800752{
753 int ccode, ret;
754
755 struct {
756 struct chsc_header request;
757 u32 : 24;
758 u32 first_chpid : 8;
759 u32 : 24;
760 u32 last_chpid : 8;
761 u32 zeroes1;
762 struct chsc_header response;
763 u32 zeroes2;
764 u32 not_valid : 1;
765 u32 shared : 1;
766 u32 : 22;
767 u32 chpid : 8;
768 u32 cmcv : 5;
769 u32 : 11;
770 u32 cmgq : 8;
771 u32 cmg : 8;
772 u32 zeroes3;
773 u32 data[NR_MEASUREMENT_CHARS];
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100774 } __attribute__ ((packed)) *scmc_area;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800775
776 scmc_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
777 if (!scmc_area)
778 return -ENOMEM;
779
780 scmc_area->request.length = 0x0010;
781 scmc_area->request.code = 0x0022;
782
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200783 scmc_area->first_chpid = chp->chpid.id;
784 scmc_area->last_chpid = chp->chpid.id;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800785
786 ccode = chsc(scmc_area);
787 if (ccode > 0) {
788 ret = (ccode == 3) ? -ENODEV : -EBUSY;
789 goto out;
790 }
791
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100792 ret = chsc_error_from_response(scmc_area->response.code);
793 if (ret == 0) {
794 /* Success. */
Cornelia Huck495a5b42006-03-24 03:15:14 -0800795 if (!scmc_area->not_valid) {
796 chp->cmg = scmc_area->cmg;
797 chp->shared = scmc_area->shared;
798 chsc_initialize_cmg_chars(chp, scmc_area->cmcv,
799 (struct cmg_chars *)
800 &scmc_area->data);
801 } else {
802 chp->cmg = -1;
803 chp->shared = -1;
804 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100805 } else {
806 CIO_CRW_EVENT(2, "chsc: scmc failed (rc=%04x)\n",
Cornelia Huck495a5b42006-03-24 03:15:14 -0800807 scmc_area->response.code);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800808 }
809out:
810 free_page((unsigned long)scmc_area);
811 return ret;
812}
813
Cornelia Huck4434a382007-07-27 12:29:21 +0200814int __init chsc_alloc_sei_area(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700815{
Cornelia Huckc1156182008-07-14 09:58:46 +0200816 int ret;
817
Linus Torvalds1da177e2005-04-16 15:20:36 -0700818 sei_page = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
Cornelia Huckc1156182008-07-14 09:58:46 +0200819 if (!sei_page) {
Cornelia Hucke556bbb2007-07-27 12:29:19 +0200820 CIO_MSG_EVENT(0, "Can't allocate page for processing of "
821 "chsc machine checks!\n");
Cornelia Huckc1156182008-07-14 09:58:46 +0200822 return -ENOMEM;
823 }
Heiko Carstensf5daba12009-03-26 15:24:01 +0100824 ret = crw_register_handler(CRW_RSC_CSS, chsc_process_crw);
Cornelia Huckc1156182008-07-14 09:58:46 +0200825 if (ret)
826 kfree(sei_page);
827 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700828}
829
Cornelia Huck4434a382007-07-27 12:29:21 +0200830void __init chsc_free_sei_area(void)
831{
Heiko Carstensf5daba12009-03-26 15:24:01 +0100832 crw_unregister_handler(CRW_RSC_CSS);
Cornelia Huck4434a382007-07-27 12:29:21 +0200833 kfree(sei_page);
834}
835
Sebastian Ott818c2722010-04-22 17:17:03 +0200836int chsc_enable_facility(int operation_code)
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800837{
838 int ret;
Sebastian Ott818c2722010-04-22 17:17:03 +0200839 static struct {
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800840 struct chsc_header request;
841 u8 reserved1:4;
842 u8 format:4;
843 u8 reserved2;
844 u16 operation_code;
845 u32 reserved3;
846 u32 reserved4;
847 u32 operation_data_area[252];
848 struct chsc_header response;
849 u32 reserved5:4;
850 u32 format2:4;
851 u32 reserved6:24;
Sebastian Ott818c2722010-04-22 17:17:03 +0200852 } __attribute__ ((packed, aligned(4096))) sda_area;
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800853
Sebastian Ott818c2722010-04-22 17:17:03 +0200854 spin_lock(&sda_lock);
855 memset(&sda_area, 0, sizeof(sda_area));
856 sda_area.request.length = 0x0400;
857 sda_area.request.code = 0x0031;
858 sda_area.operation_code = operation_code;
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800859
Sebastian Ott818c2722010-04-22 17:17:03 +0200860 ret = chsc(&sda_area);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800861 if (ret > 0) {
862 ret = (ret == 3) ? -ENODEV : -EBUSY;
863 goto out;
864 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100865
Sebastian Ott818c2722010-04-22 17:17:03 +0200866 switch (sda_area.response.code) {
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100867 case 0x0101:
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800868 ret = -EOPNOTSUPP;
869 break;
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100870 default:
Sebastian Ott818c2722010-04-22 17:17:03 +0200871 ret = chsc_error_from_response(sda_area.response.code);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800872 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100873 if (ret != 0)
874 CIO_CRW_EVENT(2, "chsc: sda (oc=%x) failed (rc=%04x)\n",
Sebastian Ott818c2722010-04-22 17:17:03 +0200875 operation_code, sda_area.response.code);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800876 out:
Sebastian Ott818c2722010-04-22 17:17:03 +0200877 spin_unlock(&sda_lock);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800878 return ret;
879}
880
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881struct css_general_char css_general_characteristics;
882struct css_chsc_char css_chsc_characteristics;
883
884int __init
885chsc_determine_css_characteristics(void)
886{
887 int result;
888 struct {
889 struct chsc_header request;
890 u32 reserved1;
891 u32 reserved2;
892 u32 reserved3;
893 struct chsc_header response;
894 u32 reserved4;
895 u32 general_char[510];
896 u32 chsc_char[518];
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100897 } __attribute__ ((packed)) *scsc_area;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700898
899 scsc_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100900 if (!scsc_area)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700902
Cornelia Huck495a5b42006-03-24 03:15:14 -0800903 scsc_area->request.length = 0x0010;
904 scsc_area->request.code = 0x0010;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700905
906 result = chsc(scsc_area);
907 if (result) {
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100908 result = (result == 3) ? -ENODEV : -EBUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700909 goto exit;
910 }
911
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100912 result = chsc_error_from_response(scsc_area->response.code);
913 if (result == 0) {
914 memcpy(&css_general_characteristics, scsc_area->general_char,
915 sizeof(css_general_characteristics));
916 memcpy(&css_chsc_characteristics, scsc_area->chsc_char,
917 sizeof(css_chsc_characteristics));
918 } else
919 CIO_CRW_EVENT(2, "chsc: scsc failed (rc=%04x)\n",
920 scsc_area->response.code);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700921exit:
922 free_page ((unsigned long) scsc_area);
923 return result;
924}
925
926EXPORT_SYMBOL_GPL(css_general_characteristics);
927EXPORT_SYMBOL_GPL(css_chsc_characteristics);
Martin Schwidefskyd2fec592008-07-14 09:58:56 +0200928
929int chsc_sstpc(void *page, unsigned int op, u16 ctrl)
930{
931 struct {
932 struct chsc_header request;
933 unsigned int rsvd0;
934 unsigned int op : 8;
935 unsigned int rsvd1 : 8;
936 unsigned int ctrl : 16;
937 unsigned int rsvd2[5];
938 struct chsc_header response;
939 unsigned int rsvd3[7];
940 } __attribute__ ((packed)) *rr;
941 int rc;
942
943 memset(page, 0, PAGE_SIZE);
944 rr = page;
945 rr->request.length = 0x0020;
946 rr->request.code = 0x0033;
947 rr->op = op;
948 rr->ctrl = ctrl;
949 rc = chsc(rr);
950 if (rc)
951 return -EIO;
952 rc = (rr->response.code == 0x0001) ? 0 : -EIO;
953 return rc;
954}
955
956int chsc_sstpi(void *page, void *result, size_t size)
957{
958 struct {
959 struct chsc_header request;
960 unsigned int rsvd0[3];
961 struct chsc_header response;
962 char data[size];
963 } __attribute__ ((packed)) *rr;
964 int rc;
965
966 memset(page, 0, PAGE_SIZE);
967 rr = page;
968 rr->request.length = 0x0010;
969 rr->request.code = 0x0038;
970 rc = chsc(rr);
971 if (rc)
972 return -EIO;
973 memcpy(result, &rr->data, size);
974 return (rr->response.code == 0x0001) ? 0 : -EIO;
975}
976