blob: e23c3806972a018921f94f20e85bd4017fab808e [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
11#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070012#include <linux/slab.h>
13#include <linux/init.h>
14#include <linux/device.h>
15
16#include <asm/cio.h>
Peter Oberparleitere5854a52007-04-27 16:01:31 +020017#include <asm/chpid.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070018
Cornelia Huckc1156182008-07-14 09:58:46 +020019#include "../s390mach.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070020#include "css.h"
21#include "cio.h"
22#include "cio_debug.h"
23#include "ioasm.h"
Peter Oberparleitere6b6e102007-04-27 16:01:28 +020024#include "chp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070025#include "chsc.h"
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027static void *sei_page;
28
Cornelia Huckb9c9a212008-02-05 16:50:34 +010029static int chsc_error_from_response(int response)
30{
31 switch (response) {
32 case 0x0001:
33 return 0;
34 case 0x0002:
35 case 0x0003:
36 case 0x0006:
37 case 0x0007:
38 case 0x0008:
39 case 0x000a:
40 return -EINVAL;
41 case 0x0004:
42 return -EOPNOTSUPP;
43 default:
44 return -EIO;
45 }
46}
47
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020048struct chsc_ssd_area {
49 struct chsc_header request;
50 u16 :10;
51 u16 ssid:2;
52 u16 :4;
53 u16 f_sch; /* first subchannel */
54 u16 :16;
55 u16 l_sch; /* last subchannel */
56 u32 :32;
57 struct chsc_header response;
58 u32 :32;
59 u8 sch_valid : 1;
60 u8 dev_valid : 1;
61 u8 st : 3; /* subchannel type */
62 u8 zeroes : 3;
63 u8 unit_addr; /* unit address */
64 u16 devno; /* device number */
65 u8 path_mask;
66 u8 fla_valid_mask;
67 u16 sch; /* subchannel */
68 u8 chpid[8]; /* chpids 0-7 */
69 u16 fla[8]; /* full link addresses 0-7 */
70} __attribute__ ((packed));
71
72int chsc_get_ssd_info(struct subchannel_id schid, struct chsc_ssd_info *ssd)
Linus Torvalds1da177e2005-04-16 15:20:36 -070073{
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020074 unsigned long page;
75 struct chsc_ssd_area *ssd_area;
76 int ccode;
Linus Torvalds1da177e2005-04-16 15:20:36 -070077 int ret;
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020078 int i;
79 int mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -070080
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020081 page = get_zeroed_page(GFP_KERNEL | GFP_DMA);
Linus Torvalds1da177e2005-04-16 15:20:36 -070082 if (!page)
83 return -ENOMEM;
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020084 ssd_area = (struct chsc_ssd_area *) page;
85 ssd_area->request.length = 0x0010;
86 ssd_area->request.code = 0x0004;
87 ssd_area->ssid = schid.ssid;
88 ssd_area->f_sch = schid.sch_no;
89 ssd_area->l_sch = schid.sch_no;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +020090
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020091 ccode = chsc(ssd_area);
92 /* Check response. */
93 if (ccode > 0) {
94 ret = (ccode == 3) ? -ENODEV : -EBUSY;
95 goto out_free;
Linus Torvalds1da177e2005-04-16 15:20:36 -070096 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +010097 ret = chsc_error_from_response(ssd_area->response.code);
98 if (ret != 0) {
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020099 CIO_MSG_EVENT(2, "chsc: ssd failed for 0.%x.%04x (rc=%04x)\n",
100 schid.ssid, schid.sch_no,
101 ssd_area->response.code);
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200102 goto out_free;
103 }
104 if (!ssd_area->sch_valid) {
105 ret = -ENODEV;
106 goto out_free;
107 }
108 /* Copy data */
109 ret = 0;
110 memset(ssd, 0, sizeof(struct chsc_ssd_info));
Cornelia Huckb279a4f2008-01-26 14:10:45 +0100111 if ((ssd_area->st != SUBCHANNEL_TYPE_IO) &&
112 (ssd_area->st != SUBCHANNEL_TYPE_MSG))
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200113 goto out_free;
114 ssd->path_mask = ssd_area->path_mask;
115 ssd->fla_valid_mask = ssd_area->fla_valid_mask;
116 for (i = 0; i < 8; i++) {
117 mask = 0x80 >> i;
118 if (ssd_area->path_mask & mask) {
119 chp_id_init(&ssd->chpid[i]);
120 ssd->chpid[i].id = ssd_area->chpid[i];
121 }
122 if (ssd_area->fla_valid_mask & mask)
123 ssd->fla[i] = ssd_area->fla[i];
124 }
125out_free:
126 free_page(page);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 return ret;
128}
129
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100130static int s390_subchannel_remove_chpid(struct subchannel *sch, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131{
Cornelia Huck2ec22982006-12-08 15:54:26 +0100132 spin_lock_irq(sch->lock);
Cornelia Huckc820de32008-07-14 09:58:45 +0200133 if (sch->driver && sch->driver->chp_event)
134 if (sch->driver->chp_event(sch, data, CHP_OFFLINE) != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 goto out_unreg;
Cornelia Huck2ec22982006-12-08 15:54:26 +0100136 spin_unlock_irq(sch->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 return 0;
Stefan Bader387b7342007-04-27 16:01:33 +0200138
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139out_unreg:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 sch->lpm = 0;
Stefan Bader387b7342007-04-27 16:01:33 +0200141 spin_unlock_irq(sch->lock);
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200142 css_schedule_eval(sch->schid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143 return 0;
144}
145
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200146void chsc_chp_offline(struct chp_id chpid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147{
148 char dbf_txt[15];
Cornelia Huck99611f82008-07-14 09:59:02 +0200149 struct chp_link link;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200151 sprintf(dbf_txt, "chpr%x.%02x", chpid.cssid, chpid.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 CIO_TRACE_EVENT(2, dbf_txt);
153
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200154 if (chp_get_status(chpid) <= 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 return;
Cornelia Huck99611f82008-07-14 09:59:02 +0200156 memset(&link, 0, sizeof(struct chp_link));
157 link.chpid = chpid;
Cornelia Huck22806dc2008-04-17 07:45:59 +0200158 /* Wait until previous actions have settled. */
159 css_wait_for_slow_path();
Cornelia Huck99611f82008-07-14 09:59:02 +0200160 for_each_subchannel_staged(s390_subchannel_remove_chpid, NULL, &link);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161}
162
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100163static int s390_process_res_acc_new_sch(struct subchannel_id schid, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164{
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800165 struct schib schib;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800166 /*
167 * We don't know the device yet, but since a path
168 * may be available now to the device we'll have
169 * to do recognition again.
170 * Since we don't have any idea about which chpid
171 * that beast may be on we'll have to do a stsch
172 * on all devices, grr...
173 */
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800174 if (stsch_err(schid, &schib))
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800175 /* We're through */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200176 return -ENXIO;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800177
178 /* Put it on the slow path. */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200179 css_schedule_eval(schid);
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800180 return 0;
181}
182
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100183static int __s390_process_res_acc(struct subchannel *sch, void *data)
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800184{
Cornelia Huck2ec22982006-12-08 15:54:26 +0100185 spin_lock_irq(sch->lock);
Cornelia Huckc820de32008-07-14 09:58:45 +0200186 if (sch->driver && sch->driver->chp_event)
187 sch->driver->chp_event(sch, data, CHP_ONLINE);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100188 spin_unlock_irq(sch->lock);
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100189
Peter Oberparleiterdd9963f2006-09-20 15:59:54 +0200190 return 0;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800191}
192
Cornelia Huck99611f82008-07-14 09:59:02 +0200193static void s390_process_res_acc(struct chp_link *link)
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800194{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195 char dbf_txt[15];
196
Cornelia Huck99611f82008-07-14 09:59:02 +0200197 sprintf(dbf_txt, "accpr%x.%02x", link->chpid.cssid,
198 link->chpid.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 CIO_TRACE_EVENT( 2, dbf_txt);
Cornelia Huck99611f82008-07-14 09:59:02 +0200200 if (link->fla != 0) {
201 sprintf(dbf_txt, "fla%x", link->fla);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202 CIO_TRACE_EVENT( 2, dbf_txt);
203 }
Cornelia Huck22806dc2008-04-17 07:45:59 +0200204 /* Wait until previous actions have settled. */
205 css_wait_for_slow_path();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206 /*
207 * I/O resources may have become accessible.
208 * Scan through all subchannels that may be concerned and
209 * do a validation on those.
210 * The more information we have (info), the less scanning
211 * will we have to do.
212 */
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100213 for_each_subchannel_staged(__s390_process_res_acc,
Cornelia Huck99611f82008-07-14 09:59:02 +0200214 s390_process_res_acc_new_sch, link);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215}
216
217static int
218__get_chpid_from_lir(void *data)
219{
220 struct lir {
221 u8 iq;
222 u8 ic;
223 u16 sci;
224 /* incident-node descriptor */
225 u32 indesc[28];
226 /* attached-node descriptor */
227 u32 andesc[28];
228 /* incident-specific information */
229 u32 isinfo[28];
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100230 } __attribute__ ((packed)) *lir;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231
Cornelia Huck12975ae2006-10-11 15:31:47 +0200232 lir = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700233 if (!(lir->iq&0x80))
234 /* NULL link incident record */
235 return -EINVAL;
236 if (!(lir->indesc[0]&0xc0000000))
237 /* node descriptor not valid */
238 return -EINVAL;
239 if (!(lir->indesc[0]&0x10000000))
240 /* don't handle device-type nodes - FIXME */
241 return -EINVAL;
242 /* Byte 3 contains the chpid. Could also be CTCA, but we don't care */
243
244 return (u16) (lir->indesc[0]&0x000000ff);
245}
246
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100247struct chsc_sei_area {
248 struct chsc_header request;
249 u32 reserved1;
250 u32 reserved2;
251 u32 reserved3;
252 struct chsc_header response;
253 u32 reserved4;
254 u8 flags;
255 u8 vf; /* validity flags */
256 u8 rs; /* reporting source */
257 u8 cc; /* content code */
258 u16 fla; /* full link address */
259 u16 rsid; /* reporting source id */
260 u32 reserved5;
261 u32 reserved6;
262 u8 ccdf[4096 - 16 - 24]; /* content-code dependent field */
263 /* ccdf has to be big enough for a link-incident record */
264} __attribute__ ((packed));
265
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200266static void chsc_process_sei_link_incident(struct chsc_sei_area *sei_area)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267{
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200268 struct chp_id chpid;
269 int id;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100270
271 CIO_CRW_EVENT(4, "chsc: link incident (rs=%02x, rs_id=%04x)\n",
272 sei_area->rs, sei_area->rsid);
273 if (sei_area->rs != 4)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200274 return;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200275 id = __get_chpid_from_lir(sei_area->ccdf);
276 if (id < 0)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100277 CIO_CRW_EVENT(4, "chsc: link incident - invalid LIR\n");
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200278 else {
279 chp_id_init(&chpid);
280 chpid.id = id;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200281 chsc_chp_offline(chpid);
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200282 }
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100283}
284
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200285static void chsc_process_sei_res_acc(struct chsc_sei_area *sei_area)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100286{
Cornelia Huck99611f82008-07-14 09:59:02 +0200287 struct chp_link link;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200288 struct chp_id chpid;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100289 int status;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100290
291 CIO_CRW_EVENT(4, "chsc: resource accessibility event (rs=%02x, "
292 "rs_id=%04x)\n", sei_area->rs, sei_area->rsid);
293 if (sei_area->rs != 4)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200294 return;
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200295 chp_id_init(&chpid);
296 chpid.id = sei_area->rsid;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100297 /* allocate a new channel path structure, if needed */
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200298 status = chp_get_status(chpid);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100299 if (status < 0)
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200300 chp_new(chpid);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100301 else if (!status)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200302 return;
Cornelia Huck99611f82008-07-14 09:59:02 +0200303 memset(&link, 0, sizeof(struct chp_link));
304 link.chpid = chpid;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100305 if ((sei_area->vf & 0xc0) != 0) {
Cornelia Huck99611f82008-07-14 09:59:02 +0200306 link.fla = sei_area->fla;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100307 if ((sei_area->vf & 0xc0) == 0xc0)
308 /* full link address */
Cornelia Huck99611f82008-07-14 09:59:02 +0200309 link.fla_mask = 0xffff;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100310 else
311 /* link address */
Cornelia Huck99611f82008-07-14 09:59:02 +0200312 link.fla_mask = 0xff00;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100313 }
Cornelia Huck99611f82008-07-14 09:59:02 +0200314 s390_process_res_acc(&link);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100315}
316
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200317struct chp_config_data {
318 u8 map[32];
319 u8 op;
320 u8 pc;
321};
322
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200323static void chsc_process_sei_chp_config(struct chsc_sei_area *sei_area)
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200324{
325 struct chp_config_data *data;
326 struct chp_id chpid;
327 int num;
328
329 CIO_CRW_EVENT(4, "chsc: channel-path-configuration notification\n");
330 if (sei_area->rs != 0)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200331 return;
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200332 data = (struct chp_config_data *) &(sei_area->ccdf);
333 chp_id_init(&chpid);
334 for (num = 0; num <= __MAX_CHPID; num++) {
335 if (!chp_test_bit(data->map, num))
336 continue;
337 chpid.id = num;
338 printk(KERN_WARNING "cio: processing configure event %d for "
339 "chpid %x.%02x\n", data->op, chpid.cssid, chpid.id);
340 switch (data->op) {
341 case 0:
342 chp_cfg_schedule(chpid, 1);
343 break;
344 case 1:
345 chp_cfg_schedule(chpid, 0);
346 break;
347 case 2:
348 chp_cfg_cancel_deconfigure(chpid);
349 break;
350 }
351 }
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200352}
353
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200354static void chsc_process_sei(struct chsc_sei_area *sei_area)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100355{
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100356 /* Check if we might have lost some information. */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200357 if (sei_area->flags & 0x40) {
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100358 CIO_CRW_EVENT(2, "chsc: event overflow\n");
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200359 css_schedule_eval_all();
360 }
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100361 /* which kind of information was stored? */
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100362 switch (sei_area->cc) {
363 case 1: /* link incident*/
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200364 chsc_process_sei_link_incident(sei_area);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100365 break;
366 case 2: /* i/o resource accessibiliy */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200367 chsc_process_sei_res_acc(sei_area);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100368 break;
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200369 case 8: /* channel-path-configuration notification */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200370 chsc_process_sei_chp_config(sei_area);
Peter Oberparleitere5854a52007-04-27 16:01:31 +0200371 break;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100372 default: /* other stuff */
373 CIO_CRW_EVENT(4, "chsc: unhandled sei content code %d\n",
374 sei_area->cc);
375 break;
376 }
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100377}
378
Cornelia Huckc1156182008-07-14 09:58:46 +0200379static void chsc_process_crw(struct crw *crw0, struct crw *crw1, int overflow)
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100380{
381 struct chsc_sei_area *sei_area;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382
Cornelia Huckc1156182008-07-14 09:58:46 +0200383 if (overflow) {
384 css_schedule_eval_all();
385 return;
386 }
387 CIO_CRW_EVENT(2, "CRW reports slct=%d, oflw=%d, "
388 "chn=%d, rsc=%X, anc=%d, erc=%X, rsid=%X\n",
389 crw0->slct, crw0->oflw, crw0->chn, crw0->rsc, crw0->anc,
390 crw0->erc, crw0->rsid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 if (!sei_page)
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200392 return;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100393 /* Access to sei_page is serialized through machine check handler
394 * thread, so no need for locking. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 sei_area = sei_page;
396
Cornelia Huckc1156182008-07-14 09:58:46 +0200397 CIO_TRACE_EVENT(2, "prcss");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398 do {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 memset(sei_area, 0, sizeof(*sei_area));
Cornelia Huck495a5b42006-03-24 03:15:14 -0800400 sei_area->request.length = 0x0010;
401 sei_area->request.code = 0x000e;
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100402 if (chsc(sei_area))
403 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100405 if (sei_area->response.code == 0x0001) {
406 CIO_CRW_EVENT(4, "chsc: sei successful\n");
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200407 chsc_process_sei(sei_area);
Peter Oberparleiter184357a2007-02-05 21:17:42 +0100408 } else {
409 CIO_CRW_EVENT(2, "chsc: sei failed (rc=%04x)\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410 sei_area->response.code);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 break;
412 }
413 } while (sei_area->flags & 0x80);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414}
415
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200416void chsc_chp_online(struct chp_id chpid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418 char dbf_txt[15];
Cornelia Huck99611f82008-07-14 09:59:02 +0200419 struct chp_link link;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200421 sprintf(dbf_txt, "cadd%x.%02x", chpid.cssid, chpid.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422 CIO_TRACE_EVENT(2, dbf_txt);
423
Cornelia Huck22806dc2008-04-17 07:45:59 +0200424 if (chp_get_status(chpid) != 0) {
Cornelia Huck99611f82008-07-14 09:59:02 +0200425 memset(&link, 0, sizeof(struct chp_link));
426 link.chpid = chpid;
Cornelia Huck22806dc2008-04-17 07:45:59 +0200427 /* Wait until previous actions have settled. */
428 css_wait_for_slow_path();
Cornelia Huckc820de32008-07-14 09:58:45 +0200429 for_each_subchannel_staged(__s390_process_res_acc, NULL,
Cornelia Huck99611f82008-07-14 09:59:02 +0200430 &link);
Cornelia Huck22806dc2008-04-17 07:45:59 +0200431 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432}
433
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200434static void __s390_subchannel_vary_chpid(struct subchannel *sch,
435 struct chp_id chpid, int on)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437 unsigned long flags;
Cornelia Huck99611f82008-07-14 09:59:02 +0200438 struct chp_link link;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439
Cornelia Huck99611f82008-07-14 09:59:02 +0200440 memset(&link, 0, sizeof(struct chp_link));
441 link.chpid = chpid;
Cornelia Huck2ec22982006-12-08 15:54:26 +0100442 spin_lock_irqsave(sch->lock, flags);
Cornelia Huckc820de32008-07-14 09:58:45 +0200443 if (sch->driver && sch->driver->chp_event)
Cornelia Huck99611f82008-07-14 09:59:02 +0200444 sch->driver->chp_event(sch, &link,
Cornelia Huckc820de32008-07-14 09:58:45 +0200445 on ? CHP_VARY_ON : CHP_VARY_OFF);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100446 spin_unlock_irqrestore(sch->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447}
448
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100449static int s390_subchannel_vary_chpid_off(struct subchannel *sch, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450{
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100451 struct chp_id *chpid = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452
453 __s390_subchannel_vary_chpid(sch, *chpid, 0);
454 return 0;
455}
456
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100457static int s390_subchannel_vary_chpid_on(struct subchannel *sch, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700458{
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100459 struct chp_id *chpid = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460
461 __s390_subchannel_vary_chpid(sch, *chpid, 1);
462 return 0;
463}
464
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800465static int
466__s390_vary_chpid_on(struct subchannel_id schid, void *data)
467{
468 struct schib schib;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800469
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800470 if (stsch_err(schid, &schib))
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800471 /* We're through */
472 return -ENXIO;
473 /* Put it on the slow path. */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200474 css_schedule_eval(schid);
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800475 return 0;
476}
477
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200478/**
479 * chsc_chp_vary - propagate channel-path vary operation to subchannels
480 * @chpid: channl-path ID
481 * @on: non-zero for vary online, zero for vary offline
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482 */
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200483int chsc_chp_vary(struct chp_id chpid, int on)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484{
Cornelia Huck99611f82008-07-14 09:59:02 +0200485 struct chp_link link;
486
487 memset(&link, 0, sizeof(struct chp_link));
488 link.chpid = chpid;
Cornelia Huck22806dc2008-04-17 07:45:59 +0200489 /* Wait until previous actions have settled. */
490 css_wait_for_slow_path();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491 /*
492 * Redo PathVerification on the devices the chpid connects to
493 */
494
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800495 if (on)
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100496 for_each_subchannel_staged(s390_subchannel_vary_chpid_on,
Cornelia Huck99611f82008-07-14 09:59:02 +0200497 __s390_vary_chpid_on, &link);
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100498 else
499 for_each_subchannel_staged(s390_subchannel_vary_chpid_off,
Cornelia Huck99611f82008-07-14 09:59:02 +0200500 NULL, &link);
Peter Oberparleitere82a1562008-01-26 14:10:48 +0100501
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502 return 0;
503}
504
Cornelia Huck495a5b42006-03-24 03:15:14 -0800505static void
506chsc_remove_cmg_attr(struct channel_subsystem *css)
507{
508 int i;
509
510 for (i = 0; i <= __MAX_CHPID; i++) {
511 if (!css->chps[i])
512 continue;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200513 chp_remove_cmg_attr(css->chps[i]);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800514 }
515}
516
517static int
518chsc_add_cmg_attr(struct channel_subsystem *css)
519{
520 int i, ret;
521
522 ret = 0;
523 for (i = 0; i <= __MAX_CHPID; i++) {
524 if (!css->chps[i])
525 continue;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200526 ret = chp_add_cmg_attr(css->chps[i]);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800527 if (ret)
528 goto cleanup;
529 }
530 return ret;
531cleanup:
532 for (--i; i >= 0; i--) {
533 if (!css->chps[i])
534 continue;
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200535 chp_remove_cmg_attr(css->chps[i]);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800536 }
537 return ret;
538}
539
Cornelia Huck495a5b42006-03-24 03:15:14 -0800540static int
541__chsc_do_secm(struct channel_subsystem *css, int enable, void *page)
542{
543 struct {
544 struct chsc_header request;
545 u32 operation_code : 2;
546 u32 : 30;
547 u32 key : 4;
548 u32 : 28;
549 u32 zeroes1;
550 u32 cub_addr1;
551 u32 zeroes2;
552 u32 cub_addr2;
553 u32 reserved[13];
554 struct chsc_header response;
555 u32 status : 8;
556 u32 : 4;
557 u32 fmt : 4;
558 u32 : 16;
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100559 } __attribute__ ((packed)) *secm_area;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800560 int ret, ccode;
561
562 secm_area = page;
563 secm_area->request.length = 0x0050;
564 secm_area->request.code = 0x0016;
565
566 secm_area->key = PAGE_DEFAULT_KEY;
567 secm_area->cub_addr1 = (u64)(unsigned long)css->cub_addr1;
568 secm_area->cub_addr2 = (u64)(unsigned long)css->cub_addr2;
569
570 secm_area->operation_code = enable ? 0 : 1;
571
572 ccode = chsc(secm_area);
573 if (ccode > 0)
574 return (ccode == 3) ? -ENODEV : -EBUSY;
575
576 switch (secm_area->response.code) {
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100577 case 0x0102:
578 case 0x0103:
Cornelia Huck495a5b42006-03-24 03:15:14 -0800579 ret = -EINVAL;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800580 default:
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100581 ret = chsc_error_from_response(secm_area->response.code);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800582 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100583 if (ret != 0)
584 CIO_CRW_EVENT(2, "chsc: secm failed (rc=%04x)\n",
585 secm_area->response.code);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800586 return ret;
587}
588
589int
590chsc_secm(struct channel_subsystem *css, int enable)
591{
592 void *secm_area;
593 int ret;
594
595 secm_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
596 if (!secm_area)
597 return -ENOMEM;
598
Cornelia Huck495a5b42006-03-24 03:15:14 -0800599 if (enable && !css->cm_enabled) {
600 css->cub_addr1 = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
601 css->cub_addr2 = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
602 if (!css->cub_addr1 || !css->cub_addr2) {
603 free_page((unsigned long)css->cub_addr1);
604 free_page((unsigned long)css->cub_addr2);
605 free_page((unsigned long)secm_area);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800606 return -ENOMEM;
607 }
608 }
609 ret = __chsc_do_secm(css, enable, secm_area);
610 if (!ret) {
611 css->cm_enabled = enable;
612 if (css->cm_enabled) {
613 ret = chsc_add_cmg_attr(css);
614 if (ret) {
615 memset(secm_area, 0, PAGE_SIZE);
616 __chsc_do_secm(css, 0, secm_area);
617 css->cm_enabled = 0;
618 }
619 } else
620 chsc_remove_cmg_attr(css);
621 }
Cornelia Huck8c4941c2007-04-27 16:01:38 +0200622 if (!css->cm_enabled) {
Cornelia Huck495a5b42006-03-24 03:15:14 -0800623 free_page((unsigned long)css->cub_addr1);
624 free_page((unsigned long)css->cub_addr2);
625 }
Cornelia Huck495a5b42006-03-24 03:15:14 -0800626 free_page((unsigned long)secm_area);
627 return ret;
628}
629
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200630int chsc_determine_channel_path_description(struct chp_id chpid,
631 struct channel_path_desc *desc)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632{
633 int ccode, ret;
634
635 struct {
636 struct chsc_header request;
637 u32 : 24;
638 u32 first_chpid : 8;
639 u32 : 24;
640 u32 last_chpid : 8;
641 u32 zeroes1;
642 struct chsc_header response;
643 u32 zeroes2;
644 struct channel_path_desc desc;
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100645 } __attribute__ ((packed)) *scpd_area;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646
647 scpd_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
648 if (!scpd_area)
649 return -ENOMEM;
650
Cornelia Huck495a5b42006-03-24 03:15:14 -0800651 scpd_area->request.length = 0x0010;
652 scpd_area->request.code = 0x0002;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200654 scpd_area->first_chpid = chpid.id;
655 scpd_area->last_chpid = chpid.id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656
657 ccode = chsc(scpd_area);
658 if (ccode > 0) {
659 ret = (ccode == 3) ? -ENODEV : -EBUSY;
660 goto out;
661 }
662
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100663 ret = chsc_error_from_response(scpd_area->response.code);
664 if (ret == 0)
665 /* Success. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666 memcpy(desc, &scpd_area->desc,
667 sizeof(struct channel_path_desc));
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100668 else
669 CIO_CRW_EVENT(2, "chsc: scpd failed (rc=%04x)\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 scpd_area->response.code);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700671out:
672 free_page((unsigned long)scpd_area);
673 return ret;
674}
675
Cornelia Huck495a5b42006-03-24 03:15:14 -0800676static void
677chsc_initialize_cmg_chars(struct channel_path *chp, u8 cmcv,
678 struct cmg_chars *chars)
679{
680 switch (chp->cmg) {
681 case 2:
682 case 3:
683 chp->cmg_chars = kmalloc(sizeof(struct cmg_chars),
684 GFP_KERNEL);
685 if (chp->cmg_chars) {
686 int i, mask;
687 struct cmg_chars *cmg_chars;
688
689 cmg_chars = chp->cmg_chars;
690 for (i = 0; i < NR_MEASUREMENT_CHARS; i++) {
691 mask = 0x80 >> (i + 3);
692 if (cmcv & mask)
693 cmg_chars->values[i] = chars->values[i];
694 else
695 cmg_chars->values[i] = 0;
696 }
697 }
698 break;
699 default:
700 /* No cmg-dependent data. */
701 break;
702 }
703}
704
Peter Oberparleitere6b6e102007-04-27 16:01:28 +0200705int chsc_get_channel_measurement_chars(struct channel_path *chp)
Cornelia Huck495a5b42006-03-24 03:15:14 -0800706{
707 int ccode, ret;
708
709 struct {
710 struct chsc_header request;
711 u32 : 24;
712 u32 first_chpid : 8;
713 u32 : 24;
714 u32 last_chpid : 8;
715 u32 zeroes1;
716 struct chsc_header response;
717 u32 zeroes2;
718 u32 not_valid : 1;
719 u32 shared : 1;
720 u32 : 22;
721 u32 chpid : 8;
722 u32 cmcv : 5;
723 u32 : 11;
724 u32 cmgq : 8;
725 u32 cmg : 8;
726 u32 zeroes3;
727 u32 data[NR_MEASUREMENT_CHARS];
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100728 } __attribute__ ((packed)) *scmc_area;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800729
730 scmc_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
731 if (!scmc_area)
732 return -ENOMEM;
733
734 scmc_area->request.length = 0x0010;
735 scmc_area->request.code = 0x0022;
736
Peter Oberparleiterf86635f2007-04-27 16:01:26 +0200737 scmc_area->first_chpid = chp->chpid.id;
738 scmc_area->last_chpid = chp->chpid.id;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800739
740 ccode = chsc(scmc_area);
741 if (ccode > 0) {
742 ret = (ccode == 3) ? -ENODEV : -EBUSY;
743 goto out;
744 }
745
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100746 ret = chsc_error_from_response(scmc_area->response.code);
747 if (ret == 0) {
748 /* Success. */
Cornelia Huck495a5b42006-03-24 03:15:14 -0800749 if (!scmc_area->not_valid) {
750 chp->cmg = scmc_area->cmg;
751 chp->shared = scmc_area->shared;
752 chsc_initialize_cmg_chars(chp, scmc_area->cmcv,
753 (struct cmg_chars *)
754 &scmc_area->data);
755 } else {
756 chp->cmg = -1;
757 chp->shared = -1;
758 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100759 } else {
760 CIO_CRW_EVENT(2, "chsc: scmc failed (rc=%04x)\n",
Cornelia Huck495a5b42006-03-24 03:15:14 -0800761 scmc_area->response.code);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800762 }
763out:
764 free_page((unsigned long)scmc_area);
765 return ret;
766}
767
Cornelia Huck4434a382007-07-27 12:29:21 +0200768int __init chsc_alloc_sei_area(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700769{
Cornelia Huckc1156182008-07-14 09:58:46 +0200770 int ret;
771
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772 sei_page = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
Cornelia Huckc1156182008-07-14 09:58:46 +0200773 if (!sei_page) {
Cornelia Hucke556bbb2007-07-27 12:29:19 +0200774 CIO_MSG_EVENT(0, "Can't allocate page for processing of "
775 "chsc machine checks!\n");
Cornelia Huckc1156182008-07-14 09:58:46 +0200776 return -ENOMEM;
777 }
778 ret = s390_register_crw_handler(CRW_RSC_CSS, chsc_process_crw);
779 if (ret)
780 kfree(sei_page);
781 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782}
783
Cornelia Huck4434a382007-07-27 12:29:21 +0200784void __init chsc_free_sei_area(void)
785{
Cornelia Huckc1156182008-07-14 09:58:46 +0200786 s390_unregister_crw_handler(CRW_RSC_CSS);
Cornelia Huck4434a382007-07-27 12:29:21 +0200787 kfree(sei_page);
788}
789
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800790int __init
791chsc_enable_facility(int operation_code)
792{
793 int ret;
794 struct {
795 struct chsc_header request;
796 u8 reserved1:4;
797 u8 format:4;
798 u8 reserved2;
799 u16 operation_code;
800 u32 reserved3;
801 u32 reserved4;
802 u32 operation_data_area[252];
803 struct chsc_header response;
804 u32 reserved5:4;
805 u32 format2:4;
806 u32 reserved6:24;
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100807 } __attribute__ ((packed)) *sda_area;
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800808
809 sda_area = (void *)get_zeroed_page(GFP_KERNEL|GFP_DMA);
810 if (!sda_area)
811 return -ENOMEM;
Cornelia Huck495a5b42006-03-24 03:15:14 -0800812 sda_area->request.length = 0x0400;
813 sda_area->request.code = 0x0031;
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800814 sda_area->operation_code = operation_code;
815
816 ret = chsc(sda_area);
817 if (ret > 0) {
818 ret = (ret == 3) ? -ENODEV : -EBUSY;
819 goto out;
820 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100821
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800822 switch (sda_area->response.code) {
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100823 case 0x0101:
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800824 ret = -EOPNOTSUPP;
825 break;
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100826 default:
827 ret = chsc_error_from_response(sda_area->response.code);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800828 }
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100829 if (ret != 0)
830 CIO_CRW_EVENT(2, "chsc: sda (oc=%x) failed (rc=%04x)\n",
831 operation_code, sda_area->response.code);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800832 out:
833 free_page((unsigned long)sda_area);
834 return ret;
835}
836
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837struct css_general_char css_general_characteristics;
838struct css_chsc_char css_chsc_characteristics;
839
840int __init
841chsc_determine_css_characteristics(void)
842{
843 int result;
844 struct {
845 struct chsc_header request;
846 u32 reserved1;
847 u32 reserved2;
848 u32 reserved3;
849 struct chsc_header response;
850 u32 reserved4;
851 u32 general_char[510];
852 u32 chsc_char[518];
Peter Oberparleiter0f008aa2007-02-05 21:17:40 +0100853 } __attribute__ ((packed)) *scsc_area;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700854
855 scsc_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100856 if (!scsc_area)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700858
Cornelia Huck495a5b42006-03-24 03:15:14 -0800859 scsc_area->request.length = 0x0010;
860 scsc_area->request.code = 0x0010;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700861
862 result = chsc(scsc_area);
863 if (result) {
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100864 result = (result == 3) ? -ENODEV : -EBUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700865 goto exit;
866 }
867
Cornelia Huckb9c9a212008-02-05 16:50:34 +0100868 result = chsc_error_from_response(scsc_area->response.code);
869 if (result == 0) {
870 memcpy(&css_general_characteristics, scsc_area->general_char,
871 sizeof(css_general_characteristics));
872 memcpy(&css_chsc_characteristics, scsc_area->chsc_char,
873 sizeof(css_chsc_characteristics));
874 } else
875 CIO_CRW_EVENT(2, "chsc: scsc failed (rc=%04x)\n",
876 scsc_area->response.code);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700877exit:
878 free_page ((unsigned long) scsc_area);
879 return result;
880}
881
882EXPORT_SYMBOL_GPL(css_general_characteristics);
883EXPORT_SYMBOL_GPL(css_chsc_characteristics);
Martin Schwidefskyd2fec592008-07-14 09:58:56 +0200884
885int chsc_sstpc(void *page, unsigned int op, u16 ctrl)
886{
887 struct {
888 struct chsc_header request;
889 unsigned int rsvd0;
890 unsigned int op : 8;
891 unsigned int rsvd1 : 8;
892 unsigned int ctrl : 16;
893 unsigned int rsvd2[5];
894 struct chsc_header response;
895 unsigned int rsvd3[7];
896 } __attribute__ ((packed)) *rr;
897 int rc;
898
899 memset(page, 0, PAGE_SIZE);
900 rr = page;
901 rr->request.length = 0x0020;
902 rr->request.code = 0x0033;
903 rr->op = op;
904 rr->ctrl = ctrl;
905 rc = chsc(rr);
906 if (rc)
907 return -EIO;
908 rc = (rr->response.code == 0x0001) ? 0 : -EIO;
909 return rc;
910}
911
912int chsc_sstpi(void *page, void *result, size_t size)
913{
914 struct {
915 struct chsc_header request;
916 unsigned int rsvd0[3];
917 struct chsc_header response;
918 char data[size];
919 } __attribute__ ((packed)) *rr;
920 int rc;
921
922 memset(page, 0, PAGE_SIZE);
923 rr = page;
924 rr->request.length = 0x0010;
925 rr->request.code = 0x0038;
926 rc = chsc(rr);
927 if (rc)
928 return -EIO;
929 memcpy(result, &rr->data, size);
930 return (rr->response.code == 0x0001) ? 0 : -EIO;
931}
932