]>
Commit | Line | Data |
---|---|---|
c05ffc4f ME |
1 | /* |
2 | * drivers/s390/char/sclp_cpi_sys.c | |
3 | * SCLP control program identification sysfs interface | |
4 | * | |
5 | * Copyright IBM Corp. 2001, 2007 | |
6 | * Author(s): Martin Peschke <mpeschke@de.ibm.com> | |
7 | * Michael Ernst <mernst@de.ibm.com> | |
8 | */ | |
9 | ||
10 | #include <linux/kernel.h> | |
11 | #include <linux/init.h> | |
12 | #include <linux/stat.h> | |
13 | #include <linux/device.h> | |
14 | #include <linux/string.h> | |
15 | #include <linux/ctype.h> | |
16 | #include <linux/kmod.h> | |
17 | #include <linux/timer.h> | |
18 | #include <linux/err.h> | |
19 | #include <linux/slab.h> | |
20 | #include <linux/completion.h> | |
21 | #include <asm/ebcdic.h> | |
22 | #include <asm/sclp.h> | |
23 | #include "sclp.h" | |
24 | #include "sclp_rw.h" | |
25 | #include "sclp_cpi_sys.h" | |
26 | ||
27 | #define CPI_LENGTH_NAME 8 | |
28 | #define CPI_LENGTH_LEVEL 16 | |
29 | ||
30 | struct cpi_evbuf { | |
31 | struct evbuf_header header; | |
32 | u8 id_format; | |
33 | u8 reserved0; | |
34 | u8 system_type[CPI_LENGTH_NAME]; | |
35 | u64 reserved1; | |
36 | u8 system_name[CPI_LENGTH_NAME]; | |
37 | u64 reserved2; | |
38 | u64 system_level; | |
39 | u64 reserved3; | |
40 | u8 sysplex_name[CPI_LENGTH_NAME]; | |
41 | u8 reserved4[16]; | |
42 | } __attribute__((packed)); | |
43 | ||
44 | struct cpi_sccb { | |
45 | struct sccb_header header; | |
46 | struct cpi_evbuf cpi_evbuf; | |
47 | } __attribute__((packed)); | |
48 | ||
49 | static struct sclp_register sclp_cpi_event = { | |
50 | .send_mask = EVTYP_CTLPROGIDENT_MASK, | |
51 | }; | |
52 | ||
53 | static char system_name[CPI_LENGTH_NAME + 1]; | |
54 | static char sysplex_name[CPI_LENGTH_NAME + 1]; | |
55 | static char system_type[CPI_LENGTH_NAME + 1]; | |
56 | static u64 system_level; | |
57 | ||
58 | static void set_data(char *field, char *data) | |
59 | { | |
60 | memset(field, ' ', CPI_LENGTH_NAME); | |
61 | memcpy(field, data, strlen(data)); | |
62 | sclp_ascebc_str(field, CPI_LENGTH_NAME); | |
63 | } | |
64 | ||
65 | static void cpi_callback(struct sclp_req *req, void *data) | |
66 | { | |
67 | struct completion *completion = data; | |
68 | ||
69 | complete(completion); | |
70 | } | |
71 | ||
72 | static struct sclp_req *cpi_prepare_req(void) | |
73 | { | |
74 | struct sclp_req *req; | |
75 | struct cpi_sccb *sccb; | |
76 | struct cpi_evbuf *evb; | |
77 | ||
78 | req = kzalloc(sizeof(struct sclp_req), GFP_KERNEL); | |
79 | if (!req) | |
80 | return ERR_PTR(-ENOMEM); | |
81 | sccb = (struct cpi_sccb *) get_zeroed_page(GFP_KERNEL | GFP_DMA); | |
82 | if (!sccb) { | |
83 | kfree(req); | |
84 | return ERR_PTR(-ENOMEM); | |
85 | } | |
86 | ||
87 | /* setup SCCB for Control-Program Identification */ | |
88 | sccb->header.length = sizeof(struct cpi_sccb); | |
89 | sccb->cpi_evbuf.header.length = sizeof(struct cpi_evbuf); | |
90 | sccb->cpi_evbuf.header.type = 0x0b; | |
91 | evb = &sccb->cpi_evbuf; | |
92 | ||
93 | /* set system type */ | |
94 | set_data(evb->system_type, system_type); | |
95 | ||
96 | /* set system name */ | |
97 | set_data(evb->system_name, system_name); | |
98 | ||
99 | /* set sytem level */ | |
100 | evb->system_level = system_level; | |
101 | ||
102 | /* set sysplex name */ | |
103 | set_data(evb->sysplex_name, sysplex_name); | |
104 | ||
105 | /* prepare request data structure presented to SCLP driver */ | |
106 | req->command = SCLP_CMDW_WRITE_EVENT_DATA; | |
107 | req->sccb = sccb; | |
108 | req->status = SCLP_REQ_FILLED; | |
109 | req->callback = cpi_callback; | |
110 | return req; | |
111 | } | |
112 | ||
113 | static void cpi_free_req(struct sclp_req *req) | |
114 | { | |
115 | free_page((unsigned long) req->sccb); | |
116 | kfree(req); | |
117 | } | |
118 | ||
119 | static int cpi_req(void) | |
120 | { | |
121 | struct completion completion; | |
122 | struct sclp_req *req; | |
123 | int rc; | |
124 | int response; | |
125 | ||
126 | rc = sclp_register(&sclp_cpi_event); | |
127 | if (rc) { | |
128 | printk(KERN_WARNING "cpi: could not register " | |
129 | "to hardware console.\n"); | |
130 | goto out; | |
131 | } | |
132 | if (!(sclp_cpi_event.sclp_send_mask & EVTYP_CTLPROGIDENT_MASK)) { | |
133 | printk(KERN_WARNING "cpi: no control program " | |
134 | "identification support\n"); | |
135 | rc = -EOPNOTSUPP; | |
136 | goto out_unregister; | |
137 | } | |
138 | ||
139 | req = cpi_prepare_req(); | |
140 | if (IS_ERR(req)) { | |
141 | printk(KERN_WARNING "cpi: could not allocate request\n"); | |
142 | rc = PTR_ERR(req); | |
143 | goto out_unregister; | |
144 | } | |
145 | ||
146 | init_completion(&completion); | |
147 | req->callback_data = &completion; | |
148 | ||
149 | /* Add request to sclp queue */ | |
150 | rc = sclp_add_request(req); | |
151 | if (rc) { | |
152 | printk(KERN_WARNING "cpi: could not start request\n"); | |
153 | goto out_free_req; | |
154 | } | |
155 | ||
156 | wait_for_completion(&completion); | |
157 | ||
158 | if (req->status != SCLP_REQ_DONE) { | |
159 | printk(KERN_WARNING "cpi: request failed (status=0x%02x)\n", | |
160 | req->status); | |
161 | rc = -EIO; | |
162 | goto out_free_req; | |
163 | } | |
164 | ||
165 | response = ((struct cpi_sccb *) req->sccb)->header.response_code; | |
166 | if (response != 0x0020) { | |
167 | printk(KERN_WARNING "cpi: failed with " | |
168 | "response code 0x%x\n", response); | |
169 | rc = -EIO; | |
170 | } | |
171 | ||
172 | out_free_req: | |
173 | cpi_free_req(req); | |
174 | ||
175 | out_unregister: | |
176 | sclp_unregister(&sclp_cpi_event); | |
177 | ||
178 | out: | |
179 | return rc; | |
180 | } | |
181 | ||
182 | static int check_string(const char *attr, const char *str) | |
183 | { | |
184 | size_t len; | |
185 | size_t i; | |
186 | ||
187 | len = strlen(str); | |
188 | ||
189 | if ((len > 0) && (str[len - 1] == '\n')) | |
190 | len--; | |
191 | ||
192 | if (len > CPI_LENGTH_NAME) | |
193 | return -EINVAL; | |
194 | ||
195 | for (i = 0; i < len ; i++) { | |
196 | if (isalpha(str[i]) || isdigit(str[i]) || | |
197 | strchr("$@# ", str[i])) | |
198 | continue; | |
199 | return -EINVAL; | |
200 | } | |
201 | ||
202 | return 0; | |
203 | } | |
204 | ||
205 | static void set_string(char *attr, const char *value) | |
206 | { | |
207 | size_t len; | |
208 | size_t i; | |
209 | ||
210 | len = strlen(value); | |
211 | ||
212 | if ((len > 0) && (value[len - 1] == '\n')) | |
213 | len--; | |
214 | ||
215 | for (i = 0; i < CPI_LENGTH_NAME; i++) { | |
216 | if (i < len) | |
217 | attr[i] = toupper(value[i]); | |
218 | else | |
219 | attr[i] = ' '; | |
220 | } | |
221 | } | |
222 | ||
223 | static ssize_t system_name_show(struct kobject *kobj, | |
224 | struct kobj_attribute *attr, char *page) | |
225 | { | |
226 | return snprintf(page, PAGE_SIZE, "%s\n", system_name); | |
227 | } | |
228 | ||
229 | static ssize_t system_name_store(struct kobject *kobj, | |
230 | struct kobj_attribute *attr, | |
231 | const char *buf, | |
232 | size_t len) | |
233 | { | |
234 | int rc; | |
235 | ||
236 | rc = check_string("system_name", buf); | |
237 | if (rc) | |
238 | return rc; | |
239 | ||
240 | set_string(system_name, buf); | |
241 | ||
242 | return len; | |
243 | } | |
244 | ||
245 | static struct kobj_attribute system_name_attr = | |
246 | __ATTR(system_name, 0644, system_name_show, system_name_store); | |
247 | ||
248 | static ssize_t sysplex_name_show(struct kobject *kobj, | |
249 | struct kobj_attribute *attr, char *page) | |
250 | { | |
251 | return snprintf(page, PAGE_SIZE, "%s\n", sysplex_name); | |
252 | } | |
253 | ||
254 | static ssize_t sysplex_name_store(struct kobject *kobj, | |
255 | struct kobj_attribute *attr, | |
256 | const char *buf, | |
257 | size_t len) | |
258 | { | |
259 | int rc; | |
260 | ||
261 | rc = check_string("sysplex_name", buf); | |
262 | if (rc) | |
263 | return rc; | |
264 | ||
265 | set_string(sysplex_name, buf); | |
266 | ||
267 | return len; | |
268 | } | |
269 | ||
270 | static struct kobj_attribute sysplex_name_attr = | |
271 | __ATTR(sysplex_name, 0644, sysplex_name_show, sysplex_name_store); | |
272 | ||
273 | static ssize_t system_type_show(struct kobject *kobj, | |
274 | struct kobj_attribute *attr, char *page) | |
275 | { | |
276 | return snprintf(page, PAGE_SIZE, "%s\n", system_type); | |
277 | } | |
278 | ||
279 | static ssize_t system_type_store(struct kobject *kobj, | |
280 | struct kobj_attribute *attr, | |
281 | const char *buf, | |
282 | size_t len) | |
283 | { | |
284 | int rc; | |
285 | ||
286 | rc = check_string("system_type", buf); | |
287 | if (rc) | |
288 | return rc; | |
289 | ||
290 | set_string(system_type, buf); | |
291 | ||
292 | return len; | |
293 | } | |
294 | ||
295 | static struct kobj_attribute system_type_attr = | |
296 | __ATTR(system_type, 0644, system_type_show, system_type_store); | |
297 | ||
298 | static ssize_t system_level_show(struct kobject *kobj, | |
299 | struct kobj_attribute *attr, char *page) | |
300 | { | |
301 | unsigned long long level = system_level; | |
302 | ||
303 | return snprintf(page, PAGE_SIZE, "%#018llx\n", level); | |
304 | } | |
305 | ||
306 | static ssize_t system_level_store(struct kobject *kobj, | |
307 | struct kobj_attribute *attr, | |
308 | const char *buf, | |
309 | size_t len) | |
310 | { | |
311 | unsigned long long level; | |
312 | char *endp; | |
313 | ||
314 | level = simple_strtoull(buf, &endp, 16); | |
315 | ||
316 | if (endp == buf) | |
317 | return -EINVAL; | |
318 | if (*endp == '\n') | |
319 | endp++; | |
320 | if (*endp) | |
321 | return -EINVAL; | |
322 | ||
323 | system_level = level; | |
324 | ||
325 | return len; | |
326 | } | |
327 | ||
328 | static struct kobj_attribute system_level_attr = | |
329 | __ATTR(system_level, 0644, system_level_show, system_level_store); | |
330 | ||
331 | static ssize_t set_store(struct kobject *kobj, | |
332 | struct kobj_attribute *attr, | |
333 | const char *buf, size_t len) | |
334 | { | |
335 | int rc; | |
336 | ||
337 | rc = cpi_req(); | |
338 | if (rc) | |
339 | return rc; | |
340 | ||
341 | return len; | |
342 | } | |
343 | ||
344 | static struct kobj_attribute set_attr = __ATTR(set, 0200, NULL, set_store); | |
345 | ||
346 | static struct attribute *cpi_attrs[] = { | |
347 | &system_name_attr.attr, | |
348 | &sysplex_name_attr.attr, | |
349 | &system_type_attr.attr, | |
350 | &system_level_attr.attr, | |
351 | &set_attr.attr, | |
352 | NULL, | |
353 | }; | |
354 | ||
355 | static struct attribute_group cpi_attr_group = { | |
356 | .attrs = cpi_attrs, | |
357 | }; | |
358 | ||
359 | static struct kset *cpi_kset; | |
360 | ||
361 | int sclp_cpi_set_data(const char *system, const char *sysplex, const char *type, | |
362 | const u64 level) | |
363 | { | |
364 | int rc; | |
365 | ||
366 | rc = check_string("system_name", system); | |
367 | if (rc) | |
368 | return rc; | |
369 | rc = check_string("sysplex_name", sysplex); | |
370 | if (rc) | |
371 | return rc; | |
372 | rc = check_string("system_type", type); | |
373 | if (rc) | |
374 | return rc; | |
375 | ||
376 | set_string(system_name, system); | |
377 | set_string(sysplex_name, sysplex); | |
378 | set_string(system_type, type); | |
379 | system_level = level; | |
380 | ||
381 | return cpi_req(); | |
382 | } | |
383 | EXPORT_SYMBOL(sclp_cpi_set_data); | |
384 | ||
385 | static int __init cpi_init(void) | |
386 | { | |
387 | int rc; | |
388 | ||
389 | cpi_kset = kset_create_and_add("cpi", NULL, firmware_kobj); | |
390 | if (!cpi_kset) | |
391 | return -ENOMEM; | |
392 | ||
393 | rc = sysfs_create_group(&cpi_kset->kobj, &cpi_attr_group); | |
394 | if (rc) | |
395 | kset_unregister(cpi_kset); | |
396 | ||
397 | return rc; | |
398 | } | |
399 | ||
400 | __initcall(cpi_init); |