projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
s390/cio: wait_cons_dev don't use static variable
[deliverable/linux.git] / drivers / s390 / char / raw3270.c
1 /*
2 * IBM/3270 Driver - core functions.
3 *
4 * Author(s):
5 * Original 3270 Code for 2.4 written by Richard Hitt (UTS Global)
6 * Rewritten for 2.5 by Martin Schwidefsky <schwidefsky@de.ibm.com>
7 * Copyright IBM Corp. 2003, 2009
8 */
9
10 #include <linux/module.h>
11 #include <linux/err.h>
12 #include <linux/init.h>
13 #include <linux/interrupt.h>
14 #include <linux/list.h>
15 #include <linux/slab.h>
16 #include <linux/types.h>
17 #include <linux/wait.h>
18
19 #include <asm/ccwdev.h>
20 #include <asm/cio.h>
21 #include <asm/ebcdic.h>
22 #include <asm/diag.h>
23
24 #include "raw3270.h"
25
26 #include <linux/major.h>
27 #include <linux/kdev_t.h>
28 #include <linux/device.h>
29 #include <linux/mutex.h>
30
31 struct class *class3270;
32
33 /* The main 3270 data structure. */
34 struct raw3270 {
35 struct list_head list;
36 struct ccw_device *cdev;
37 int minor;
38
39 short model, rows, cols;
40 unsigned int state;
41 unsigned long flags;
42
43 struct list_head req_queue; /* Request queue. */
44 struct list_head view_list; /* List of available views. */
45 struct raw3270_view *view; /* Active view. */
46
47 struct timer_list timer; /* Device timer. */
48
49 unsigned char *ascebc; /* ascii -> ebcdic table */
50
51 struct raw3270_view init_view;
52 struct raw3270_request init_reset;
53 struct raw3270_request init_readpart;
54 struct raw3270_request init_readmod;
55 unsigned char init_data[256];
56 };
57
58 /* raw3270->state */
59 #define RAW3270_STATE_INIT 0 /* Initial state */
60 #define RAW3270_STATE_RESET 1 /* Reset command is pending */
61 #define RAW3270_STATE_W4ATTN 2 /* Wait for attention interrupt */
62 #define RAW3270_STATE_READMOD 3 /* Read partition is pending */
63 #define RAW3270_STATE_READY 4 /* Device is usable by views */
64
65 /* raw3270->flags */
66 #define RAW3270_FLAGS_14BITADDR 0 /* 14-bit buffer addresses */
67 #define RAW3270_FLAGS_BUSY 1 /* Device busy, leave it alone */
68 #define RAW3270_FLAGS_CONSOLE 2 /* Device is the console. */
69 #define RAW3270_FLAGS_FROZEN 3 /* set if 3270 is frozen for suspend */
70
71 /* Semaphore to protect global data of raw3270 (devices, views, etc). */
72 static DEFINE_MUTEX(raw3270_mutex);
73
74 /* List of 3270 devices. */
75 static LIST_HEAD(raw3270_devices);
76
77 /*
78 * Flag to indicate if the driver has been registered. Some operations
79 * like waiting for the end of i/o need to be done differently as long
80 * as the kernel is still starting up (console support).
81 */
82 static int raw3270_registered;
83
84 /* Module parameters */
85 static bool tubxcorrect = 0;
86 module_param(tubxcorrect, bool, 0);
87
88 /*
89 * Wait queue for device init/delete, view delete.
90 */
91 DECLARE_WAIT_QUEUE_HEAD(raw3270_wait_queue);
92
93 /*
94 * Encode array for 12 bit 3270 addresses.
95 */
96 static unsigned char raw3270_ebcgraf[64] = {
97 0x40, 0xc1, 0xc2, 0xc3, 0xc4, 0xc5, 0xc6, 0xc7,
98 0xc8, 0xc9, 0x4a, 0x4b, 0x4c, 0x4d, 0x4e, 0x4f,
99 0x50, 0xd1, 0xd2, 0xd3, 0xd4, 0xd5, 0xd6, 0xd7,
100 0xd8, 0xd9, 0x5a, 0x5b, 0x5c, 0x5d, 0x5e, 0x5f,
101 0x60, 0x61, 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7,
102 0xe8, 0xe9, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
103 0xf0, 0xf1, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7,
104 0xf8, 0xf9, 0x7a, 0x7b, 0x7c, 0x7d, 0x7e, 0x7f
105 };
106
107 static inline int raw3270_state_ready(struct raw3270 *rp)
108 {
109 return rp->state == RAW3270_STATE_READY;
110 }
111
112 static inline int raw3270_state_final(struct raw3270 *rp)
113 {
114 return rp->state == RAW3270_STATE_INIT ||
115 rp->state == RAW3270_STATE_READY;
116 }
117
118 void
119 raw3270_buffer_address(struct raw3270 *rp, char *cp, unsigned short addr)
120 {
121 if (test_bit(RAW3270_FLAGS_14BITADDR, &rp->flags)) {
122 cp[0] = (addr >> 8) & 0x3f;
123 cp[1] = addr & 0xff;
124 } else {
125 cp[0] = raw3270_ebcgraf[(addr >> 6) & 0x3f];
126 cp[1] = raw3270_ebcgraf[addr & 0x3f];
127 }
128 }
129
130 /*
131 * Allocate a new 3270 ccw request
132 */
133 struct raw3270_request *
134 raw3270_request_alloc(size_t size)
135 {
136 struct raw3270_request *rq;
137
138 /* Allocate request structure */
139 rq = kzalloc(sizeof(struct raw3270_request), GFP_KERNEL | GFP_DMA);
140 if (!rq)
141 return ERR_PTR(-ENOMEM);
142
143 /* alloc output buffer. */
144 if (size > 0) {
145 rq->buffer = kmalloc(size, GFP_KERNEL | GFP_DMA);
146 if (!rq->buffer) {
147 kfree(rq);
148 return ERR_PTR(-ENOMEM);
149 }
150 }
151 rq->size = size;
152 INIT_LIST_HEAD(&rq->list);
153
154 /*
155 * Setup ccw.
156 */
157 rq->ccw.cda = __pa(rq->buffer);
158 rq->ccw.flags = CCW_FLAG_SLI;
159
160 return rq;
161 }
162
163 /*
164 * Free 3270 ccw request
165 */
166 void
167 raw3270_request_free (struct raw3270_request *rq)
168 {
169 kfree(rq->buffer);
170 kfree(rq);
171 }
172
173 /*
174 * Reset request to initial state.
175 */
176 void
177 raw3270_request_reset(struct raw3270_request *rq)
178 {
179 BUG_ON(!list_empty(&rq->list));
180 rq->ccw.cmd_code = 0;
181 rq->ccw.count = 0;
182 rq->ccw.cda = __pa(rq->buffer);
183 rq->ccw.flags = CCW_FLAG_SLI;
184 rq->rescnt = 0;
185 rq->rc = 0;
186 }
187
188 /*
189 * Set command code to ccw of a request.
190 */
191 void
192 raw3270_request_set_cmd(struct raw3270_request *rq, u8 cmd)
193 {
194 rq->ccw.cmd_code = cmd;
195 }
196
197 /*
198 * Add data fragment to output buffer.
199 */
200 int
201 raw3270_request_add_data(struct raw3270_request *rq, void *data, size_t size)
202 {
203 if (size + rq->ccw.count > rq->size)
204 return -E2BIG;
205 memcpy(rq->buffer + rq->ccw.count, data, size);
206 rq->ccw.count += size;
207 return 0;
208 }
209
210 /*
211 * Set address/length pair to ccw of a request.
212 */
213 void
214 raw3270_request_set_data(struct raw3270_request *rq, void *data, size_t size)
215 {
216 rq->ccw.cda = __pa(data);
217 rq->ccw.count = size;
218 }
219
220 /*
221 * Set idal buffer to ccw of a request.
222 */
223 void
224 raw3270_request_set_idal(struct raw3270_request *rq, struct idal_buffer *ib)
225 {
226 rq->ccw.cda = __pa(ib->data);
227 rq->ccw.count = ib->size;
228 rq->ccw.flags |= CCW_FLAG_IDA;
229 }
230
231 /*
232 * Stop running ccw.
233 */
234 static int
235 __raw3270_halt_io(struct raw3270 *rp, struct raw3270_request *rq)
236 {
237 int retries;
238 int rc;
239
240 if (raw3270_request_final(rq))
241 return 0;
242 /* Check if interrupt has already been processed */
243 for (retries = 0; retries < 5; retries++) {
244 if (retries < 2)
245 rc = ccw_device_halt(rp->cdev, (long) rq);
246 else
247 rc = ccw_device_clear(rp->cdev, (long) rq);
248 if (rc == 0)
249 break; /* termination successful */
250 }
251 return rc;
252 }
253
254 /*
255 * Add the request to the request queue, try to start it if the
256 * 3270 device is idle. Return without waiting for end of i/o.
257 */
258 static int
259 __raw3270_start(struct raw3270 *rp, struct raw3270_view *view,
260 struct raw3270_request *rq)
261 {
262 rq->view = view;
263 raw3270_get_view(view);
264 if (list_empty(&rp->req_queue) &&
265 !test_bit(RAW3270_FLAGS_BUSY, &rp->flags)) {
266 /* No other requests are on the queue. Start this one. */
267 rq->rc = ccw_device_start(rp->cdev, &rq->ccw,
268 (unsigned long) rq, 0, 0);
269 if (rq->rc) {
270 raw3270_put_view(view);
271 return rq->rc;
272 }
273 }
274 list_add_tail(&rq->list, &rp->req_queue);
275 return 0;
276 }
277
278 int
279 raw3270_start(struct raw3270_view *view, struct raw3270_request *rq)
280 {
281 unsigned long flags;
282 struct raw3270 *rp;
283 int rc;
284
285 spin_lock_irqsave(get_ccwdev_lock(view->dev->cdev), flags);
286 rp = view->dev;
287 if (!rp || rp->view != view ||
288 test_bit(RAW3270_FLAGS_FROZEN, &rp->flags))
289 rc = -EACCES;
290 else if (!raw3270_state_ready(rp))
291 rc = -EBUSY;
292 else
293 rc = __raw3270_start(rp, view, rq);
294 spin_unlock_irqrestore(get_ccwdev_lock(view->dev->cdev), flags);
295 return rc;
296 }
297
298 int
299 raw3270_start_locked(struct raw3270_view *view, struct raw3270_request *rq)
300 {
301 struct raw3270 *rp;
302 int rc;
303
304 rp = view->dev;
305 if (!rp || rp->view != view ||
306 test_bit(RAW3270_FLAGS_FROZEN, &rp->flags))
307 rc = -EACCES;
308 else if (!raw3270_state_ready(rp))
309 rc = -EBUSY;
310 else
311 rc = __raw3270_start(rp, view, rq);
312 return rc;
313 }
314
315 int
316 raw3270_start_irq(struct raw3270_view *view, struct raw3270_request *rq)
317 {
318 struct raw3270 *rp;
319
320 rp = view->dev;
321 rq->view = view;
322 raw3270_get_view(view);
323 list_add_tail(&rq->list, &rp->req_queue);
324 return 0;
325 }
326
327 /*
328 * 3270 interrupt routine, called from the ccw_device layer
329 */
330 static void
331 raw3270_irq (struct ccw_device *cdev, unsigned long intparm, struct irb *irb)
332 {
333 struct raw3270 *rp;
334 struct raw3270_view *view;
335 struct raw3270_request *rq;
336 int rc;
337
338 rp = dev_get_drvdata(&cdev->dev);
339 if (!rp)
340 return;
341 rq = (struct raw3270_request *) intparm;
342 view = rq ? rq->view : rp->view;
343
344 if (IS_ERR(irb))
345 rc = RAW3270_IO_RETRY;
346 else if (irb->scsw.cmd.fctl & SCSW_FCTL_HALT_FUNC) {
347 rq->rc = -EIO;
348 rc = RAW3270_IO_DONE;
349 } else if (irb->scsw.cmd.dstat == (DEV_STAT_CHN_END | DEV_STAT_DEV_END |
350 DEV_STAT_UNIT_EXCEP)) {
351 /* Handle CE-DE-UE and subsequent UDE */
352 set_bit(RAW3270_FLAGS_BUSY, &rp->flags);
353 rc = RAW3270_IO_BUSY;
354 } else if (test_bit(RAW3270_FLAGS_BUSY, &rp->flags)) {
355 /* Wait for UDE if busy flag is set. */
356 if (irb->scsw.cmd.dstat & DEV_STAT_DEV_END) {
357 clear_bit(RAW3270_FLAGS_BUSY, &rp->flags);
358 /* Got it, now retry. */
359 rc = RAW3270_IO_RETRY;
360 } else
361 rc = RAW3270_IO_BUSY;
362 } else if (view)
363 rc = view->fn->intv(view, rq, irb);
364 else
365 rc = RAW3270_IO_DONE;
366
367 switch (rc) {
368 case RAW3270_IO_DONE:
369 break;
370 case RAW3270_IO_BUSY:
371 /*
372 * Intervention required by the operator. We have to wait
373 * for unsolicited device end.
374 */
375 return;
376 case RAW3270_IO_RETRY:
377 if (!rq)
378 break;
379 rq->rc = ccw_device_start(rp->cdev, &rq->ccw,
380 (unsigned long) rq, 0, 0);
381 if (rq->rc == 0)
382 return; /* Successfully restarted. */
383 break;
384 case RAW3270_IO_STOP:
385 if (!rq)
386 break;
387 __raw3270_halt_io(rp, rq);
388 rq->rc = -EIO;
389 break;
390 default:
391 BUG();
392 }
393 if (rq) {
394 BUG_ON(list_empty(&rq->list));
395 /* The request completed, remove from queue and do callback. */
396 list_del_init(&rq->list);
397 if (rq->callback)
398 rq->callback(rq, rq->callback_data);
399 /* Do put_device for get_device in raw3270_start. */
400 raw3270_put_view(view);
401 }
402 /*
403 * Try to start each request on request queue until one is
404 * started successful.
405 */
406 while (!list_empty(&rp->req_queue)) {
407 rq = list_entry(rp->req_queue.next,struct raw3270_request,list);
408 rq->rc = ccw_device_start(rp->cdev, &rq->ccw,
409 (unsigned long) rq, 0, 0);
410 if (rq->rc == 0)
411 break;
412 /* Start failed. Remove request and do callback. */
413 list_del_init(&rq->list);
414 if (rq->callback)
415 rq->callback(rq, rq->callback_data);
416 /* Do put_device for get_device in raw3270_start. */
417 raw3270_put_view(view);
418 }
419 }
420
421 /*
422 * To determine the size of the 3270 device we need to do:
423 * 1) send a 'read partition' data stream to the device
424 * 2) wait for the attn interrupt that precedes the query reply
425 * 3) do a read modified to get the query reply
426 * To make things worse we have to cope with intervention
427 * required (3270 device switched to 'stand-by') and command
428 * rejects (old devices that can't do 'read partition').
429 */
430 struct raw3270_ua { /* Query Reply structure for Usable Area */
431 struct { /* Usable Area Query Reply Base */
432 short l; /* Length of this structured field */
433 char sfid; /* 0x81 if Query Reply */
434 char qcode; /* 0x81 if Usable Area */
435 char flags0;
436 char flags1;
437 short w; /* Width of usable area */
438 short h; /* Heigth of usavle area */
439 char units; /* 0x00:in; 0x01:mm */
440 int xr;
441 int yr;
442 char aw;
443 char ah;
444 short buffsz; /* Character buffer size, bytes */
445 char xmin;
446 char ymin;
447 char xmax;
448 char ymax;
449 } __attribute__ ((packed)) uab;
450 struct { /* Alternate Usable Area Self-Defining Parameter */
451 char l; /* Length of this Self-Defining Parm */
452 char sdpid; /* 0x02 if Alternate Usable Area */
453 char res;
454 char auaid; /* 0x01 is Id for the A U A */
455 short wauai; /* Width of AUAi */
456 short hauai; /* Height of AUAi */
457 char auaunits; /* 0x00:in, 0x01:mm */
458 int auaxr;
459 int auayr;
460 char awauai;
461 char ahauai;
462 } __attribute__ ((packed)) aua;
463 } __attribute__ ((packed));
464
465 static void
466 raw3270_size_device_vm(struct raw3270 *rp)
467 {
468 int rc, model;
469 struct ccw_dev_id dev_id;
470 struct diag210 diag_data;
471
472 ccw_device_get_id(rp->cdev, &dev_id);
473 diag_data.vrdcdvno = dev_id.devno;
474 diag_data.vrdclen = sizeof(struct diag210);
475 rc = diag210(&diag_data);
476 model = diag_data.vrdccrmd;
477 /* Use default model 2 if the size could not be detected */
478 if (rc || model < 2 || model > 5)
479 model = 2;
480 switch (model) {
481 case 2:
482 rp->model = model;
483 rp->rows = 24;
484 rp->cols = 80;
485 break;
486 case 3:
487 rp->model = model;
488 rp->rows = 32;
489 rp->cols = 80;
490 break;
491 case 4:
492 rp->model = model;
493 rp->rows = 43;
494 rp->cols = 80;
495 break;
496 case 5:
497 rp->model = model;
498 rp->rows = 27;
499 rp->cols = 132;
500 break;
501 }
502 }
503
504 static void
505 raw3270_size_device(struct raw3270 *rp)
506 {
507 struct raw3270_ua *uap;
508
509 /* Got a Query Reply */
510 uap = (struct raw3270_ua *) (rp->init_data + 1);
511 /* Paranoia check. */
512 if (rp->init_readmod.rc || rp->init_data[0] != 0x88 ||
513 uap->uab.qcode != 0x81) {
514 /* Couldn't detect size. Use default model 2. */
515 rp->model = 2;
516 rp->rows = 24;
517 rp->cols = 80;
518 return;
519 }
520 /* Copy rows/columns of default Usable Area */
521 rp->rows = uap->uab.h;
522 rp->cols = uap->uab.w;
523 /* Check for 14 bit addressing */
524 if ((uap->uab.flags0 & 0x0d) == 0x01)
525 set_bit(RAW3270_FLAGS_14BITADDR, &rp->flags);
526 /* Check for Alternate Usable Area */
527 if (uap->uab.l == sizeof(struct raw3270_ua) &&
528 uap->aua.sdpid == 0x02) {
529 rp->rows = uap->aua.hauai;
530 rp->cols = uap->aua.wauai;
531 }
532 /* Try to find a model. */
533 rp->model = 0;
534 if (rp->rows == 24 && rp->cols == 80)
535 rp->model = 2;
536 if (rp->rows == 32 && rp->cols == 80)
537 rp->model = 3;
538 if (rp->rows == 43 && rp->cols == 80)
539 rp->model = 4;
540 if (rp->rows == 27 && rp->cols == 132)
541 rp->model = 5;
542 }
543
544 static void
545 raw3270_size_device_done(struct raw3270 *rp)
546 {
547 struct raw3270_view *view;
548
549 rp->view = NULL;
550 rp->state = RAW3270_STATE_READY;
551 /* Notify views about new size */
552 list_for_each_entry(view, &rp->view_list, list)
553 if (view->fn->resize)
554 view->fn->resize(view, rp->model, rp->rows, rp->cols);
555 /* Setup processing done, now activate a view */
556 list_for_each_entry(view, &rp->view_list, list) {
557 rp->view = view;
558 if (view->fn->activate(view) == 0)
559 break;
560 rp->view = NULL;
561 }
562 }
563
564 static void
565 raw3270_read_modified_cb(struct raw3270_request *rq, void *data)
566 {
567 struct raw3270 *rp = rq->view->dev;
568
569 raw3270_size_device(rp);
570 raw3270_size_device_done(rp);
571 }
572
573 static void
574 raw3270_read_modified(struct raw3270 *rp)
575 {
576 if (rp->state != RAW3270_STATE_W4ATTN)
577 return;
578 /* Use 'read modified' to get the result of a read partition. */
579 memset(&rp->init_readmod, 0, sizeof(rp->init_readmod));
580 memset(&rp->init_data, 0, sizeof(rp->init_data));
581 rp->init_readmod.ccw.cmd_code = TC_READMOD;
582 rp->init_readmod.ccw.flags = CCW_FLAG_SLI;
583 rp->init_readmod.ccw.count = sizeof(rp->init_data);
584 rp->init_readmod.ccw.cda = (__u32) __pa(rp->init_data);
585 rp->init_readmod.callback = raw3270_read_modified_cb;
586 rp->state = RAW3270_STATE_READMOD;
587 raw3270_start_irq(&rp->init_view, &rp->init_readmod);
588 }
589
590 static void
591 raw3270_writesf_readpart(struct raw3270 *rp)
592 {
593 static const unsigned char wbuf[] =
594 { 0x00, 0x07, 0x01, 0xff, 0x03, 0x00, 0x81 };
595
596 /* Store 'read partition' data stream to init_data */
597 memset(&rp->init_readpart, 0, sizeof(rp->init_readpart));
598 memset(&rp->init_data, 0, sizeof(rp->init_data));
599 memcpy(&rp->init_data, wbuf, sizeof(wbuf));
600 rp->init_readpart.ccw.cmd_code = TC_WRITESF;
601 rp->init_readpart.ccw.flags = CCW_FLAG_SLI;
602 rp->init_readpart.ccw.count = sizeof(wbuf);
603 rp->init_readpart.ccw.cda = (__u32) __pa(&rp->init_data);
604 rp->state = RAW3270_STATE_W4ATTN;
605 raw3270_start_irq(&rp->init_view, &rp->init_readpart);
606 }
607
608 /*
609 * Device reset
610 */
611 static void
612 raw3270_reset_device_cb(struct raw3270_request *rq, void *data)
613 {
614 struct raw3270 *rp = rq->view->dev;
615
616 if (rp->state != RAW3270_STATE_RESET)
617 return;
618 if (rq && rq->rc) {
619 /* Reset command failed. */
620 rp->state = RAW3270_STATE_INIT;
621 } else if (0 && MACHINE_IS_VM) {
622 raw3270_size_device_vm(rp);
623 raw3270_size_device_done(rp);
624 } else
625 raw3270_writesf_readpart(rp);
626 }
627
628 static int
629 __raw3270_reset_device(struct raw3270 *rp)
630 {
631 int rc;
632
633 /* Store reset data stream to init_data/init_reset */
634 memset(&rp->init_reset, 0, sizeof(rp->init_reset));
635 memset(&rp->init_data, 0, sizeof(rp->init_data));
636 rp->init_data[0] = TW_KR;
637 rp->init_reset.ccw.cmd_code = TC_EWRITEA;
638 rp->init_reset.ccw.flags = CCW_FLAG_SLI;
639 rp->init_reset.ccw.count = 1;
640 rp->init_reset.ccw.cda = (__u32) __pa(rp->init_data);
641 rp->init_reset.callback = raw3270_reset_device_cb;
642 rc = __raw3270_start(rp, &rp->init_view, &rp->init_reset);
643 if (rc == 0 && rp->state == RAW3270_STATE_INIT)
644 rp->state = RAW3270_STATE_RESET;
645 return rc;
646 }
647
648 static int
649 raw3270_reset_device(struct raw3270 *rp)
650 {
651 unsigned long flags;
652 int rc;
653
654 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
655 rc = __raw3270_reset_device(rp);
656 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
657 return rc;
658 }
659
660 int
661 raw3270_reset(struct raw3270_view *view)
662 {
663 struct raw3270 *rp;
664 int rc;
665
666 rp = view->dev;
667 if (!rp || rp->view != view ||
668 test_bit(RAW3270_FLAGS_FROZEN, &rp->flags))
669 rc = -EACCES;
670 else if (!raw3270_state_ready(rp))
671 rc = -EBUSY;
672 else
673 rc = raw3270_reset_device(view->dev);
674 return rc;
675 }
676
677 static int
678 raw3270_init_irq(struct raw3270_view *view, struct raw3270_request *rq,
679 struct irb *irb)
680 {
681 struct raw3270 *rp;
682
683 /*
684 * Unit-Check Processing:
685 * Expect Command Reject or Intervention Required.
686 */
687 if (irb->scsw.cmd.dstat & DEV_STAT_UNIT_CHECK) {
688 /* Request finished abnormally. */
689 if (irb->ecw[0] & SNS0_INTERVENTION_REQ) {
690 set_bit(RAW3270_FLAGS_BUSY, &view->dev->flags);
691 return RAW3270_IO_BUSY;
692 }
693 }
694 if (rq) {
695 if (irb->scsw.cmd.dstat & DEV_STAT_UNIT_CHECK) {
696 if (irb->ecw[0] & SNS0_CMD_REJECT)
697 rq->rc = -EOPNOTSUPP;
698 else
699 rq->rc = -EIO;
700 }
701 }
702 if (irb->scsw.cmd.dstat & DEV_STAT_ATTENTION) {
703 /* Queue read modified after attention interrupt */
704 rp = view->dev;
705 raw3270_read_modified(rp);
706 }
707 return RAW3270_IO_DONE;
708 }
709
710 static struct raw3270_fn raw3270_init_fn = {
711 .intv = raw3270_init_irq
712 };
713
714 /*
715 * Setup new 3270 device.
716 */
717 static int
718 raw3270_setup_device(struct ccw_device *cdev, struct raw3270 *rp, char *ascebc)
719 {
720 struct list_head *l;
721 struct raw3270 *tmp;
722 int minor;
723
724 memset(rp, 0, sizeof(struct raw3270));
725 /* Copy ebcdic -> ascii translation table. */
726 memcpy(ascebc, _ascebc, 256);
727 if (tubxcorrect) {
728 /* correct brackets and circumflex */
729 ascebc['['] = 0xad;
730 ascebc[']'] = 0xbd;
731 ascebc['^'] = 0xb0;
732 }
733 rp->ascebc = ascebc;
734
735 /* Set defaults. */
736 rp->rows = 24;
737 rp->cols = 80;
738
739 INIT_LIST_HEAD(&rp->req_queue);
740 INIT_LIST_HEAD(&rp->view_list);
741
742 rp->init_view.dev = rp;
743 rp->init_view.fn = &raw3270_init_fn;
744 rp->view = &rp->init_view;
745
746 /*
747 * Add device to list and find the smallest unused minor
748 * number for it. Note: there is no device with minor 0,
749 * see special case for fs3270.c:fs3270_open().
750 */
751 mutex_lock(&raw3270_mutex);
752 /* Keep the list sorted. */
753 minor = RAW3270_FIRSTMINOR;
754 rp->minor = -1;
755 list_for_each(l, &raw3270_devices) {
756 tmp = list_entry(l, struct raw3270, list);
757 if (tmp->minor > minor) {
758 rp->minor = minor;
759 __list_add(&rp->list, l->prev, l);
760 break;
761 }
762 minor++;
763 }
764 if (rp->minor == -1 && minor < RAW3270_MAXDEVS + RAW3270_FIRSTMINOR) {
765 rp->minor = minor;
766 list_add_tail(&rp->list, &raw3270_devices);
767 }
768 mutex_unlock(&raw3270_mutex);
769 /* No free minor number? Then give up. */
770 if (rp->minor == -1)
771 return -EUSERS;
772 rp->cdev = cdev;
773 dev_set_drvdata(&cdev->dev, rp);
774 cdev->handler = raw3270_irq;
775 return 0;
776 }
777
778 #ifdef CONFIG_TN3270_CONSOLE
779 /*
780 * Setup 3270 device configured as console.
781 */
782 struct raw3270 __init *raw3270_setup_console(struct ccw_device *cdev)
783 {
784 unsigned long flags;
785 struct raw3270 *rp;
786 char *ascebc;
787 int rc;
788
789 rp = kzalloc(sizeof(struct raw3270), GFP_KERNEL | GFP_DMA);
790 ascebc = kzalloc(256, GFP_KERNEL);
791 rc = raw3270_setup_device(cdev, rp, ascebc);
792 if (rc)
793 return ERR_PTR(rc);
794 set_bit(RAW3270_FLAGS_CONSOLE, &rp->flags);
795 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
796 do {
797 __raw3270_reset_device(rp);
798 while (!raw3270_state_final(rp)) {
799 ccw_device_wait_idle(rp->cdev);
800 barrier();
801 }
802 } while (rp->state != RAW3270_STATE_READY);
803 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
804 return rp;
805 }
806
807 void
808 raw3270_wait_cons_dev(struct raw3270 *rp)
809 {
810 unsigned long flags;
811
812 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
813 ccw_device_wait_idle(rp->cdev);
814 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
815 }
816
817 #endif
818
819 /*
820 * Create a 3270 device structure.
821 */
822 static struct raw3270 *
823 raw3270_create_device(struct ccw_device *cdev)
824 {
825 struct raw3270 *rp;
826 char *ascebc;
827 int rc;
828
829 rp = kmalloc(sizeof(struct raw3270), GFP_KERNEL | GFP_DMA);
830 if (!rp)
831 return ERR_PTR(-ENOMEM);
832 ascebc = kmalloc(256, GFP_KERNEL);
833 if (!ascebc) {
834 kfree(rp);
835 return ERR_PTR(-ENOMEM);
836 }
837 rc = raw3270_setup_device(cdev, rp, ascebc);
838 if (rc) {
839 kfree(rp->ascebc);
840 kfree(rp);
841 rp = ERR_PTR(rc);
842 }
843 /* Get reference to ccw_device structure. */
844 get_device(&cdev->dev);
845 return rp;
846 }
847
848 /*
849 * Activate a view.
850 */
851 int
852 raw3270_activate_view(struct raw3270_view *view)
853 {
854 struct raw3270 *rp;
855 struct raw3270_view *oldview, *nv;
856 unsigned long flags;
857 int rc;
858
859 rp = view->dev;
860 if (!rp)
861 return -ENODEV;
862 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
863 if (rp->view == view)
864 rc = 0;
865 else if (!raw3270_state_ready(rp))
866 rc = -EBUSY;
867 else if (test_bit(RAW3270_FLAGS_FROZEN, &rp->flags))
868 rc = -EACCES;
869 else {
870 oldview = NULL;
871 if (rp->view && rp->view->fn->deactivate) {
872 oldview = rp->view;
873 oldview->fn->deactivate(oldview);
874 }
875 rp->view = view;
876 rc = view->fn->activate(view);
877 if (rc) {
878 /* Didn't work. Try to reactivate the old view. */
879 rp->view = oldview;
880 if (!oldview || oldview->fn->activate(oldview) != 0) {
881 /* Didn't work as well. Try any other view. */
882 list_for_each_entry(nv, &rp->view_list, list)
883 if (nv != view && nv != oldview) {
884 rp->view = nv;
885 if (nv->fn->activate(nv) == 0)
886 break;
887 rp->view = NULL;
888 }
889 }
890 }
891 }
892 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
893 return rc;
894 }
895
896 /*
897 * Deactivate current view.
898 */
899 void
900 raw3270_deactivate_view(struct raw3270_view *view)
901 {
902 unsigned long flags;
903 struct raw3270 *rp;
904
905 rp = view->dev;
906 if (!rp)
907 return;
908 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
909 if (rp->view == view) {
910 view->fn->deactivate(view);
911 rp->view = NULL;
912 /* Move deactivated view to end of list. */
913 list_del_init(&view->list);
914 list_add_tail(&view->list, &rp->view_list);
915 /* Try to activate another view. */
916 if (raw3270_state_ready(rp) &&
917 !test_bit(RAW3270_FLAGS_FROZEN, &rp->flags)) {
918 list_for_each_entry(view, &rp->view_list, list) {
919 rp->view = view;
920 if (view->fn->activate(view) == 0)
921 break;
922 rp->view = NULL;
923 }
924 }
925 }
926 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
927 }
928
929 /*
930 * Add view to device with minor "minor".
931 */
932 int
933 raw3270_add_view(struct raw3270_view *view, struct raw3270_fn *fn, int minor)
934 {
935 unsigned long flags;
936 struct raw3270 *rp;
937 int rc;
938
939 if (minor <= 0)
940 return -ENODEV;
941 mutex_lock(&raw3270_mutex);
942 rc = -ENODEV;
943 list_for_each_entry(rp, &raw3270_devices, list) {
944 if (rp->minor != minor)
945 continue;
946 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
947 atomic_set(&view->ref_count, 2);
948 view->dev = rp;
949 view->fn = fn;
950 view->model = rp->model;
951 view->rows = rp->rows;
952 view->cols = rp->cols;
953 view->ascebc = rp->ascebc;
954 spin_lock_init(&view->lock);
955 list_add(&view->list, &rp->view_list);
956 rc = 0;
957 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
958 break;
959 }
960 mutex_unlock(&raw3270_mutex);
961 return rc;
962 }
963
964 /*
965 * Find specific view of device with minor "minor".
966 */
967 struct raw3270_view *
968 raw3270_find_view(struct raw3270_fn *fn, int minor)
969 {
970 struct raw3270 *rp;
971 struct raw3270_view *view, *tmp;
972 unsigned long flags;
973
974 mutex_lock(&raw3270_mutex);
975 view = ERR_PTR(-ENODEV);
976 list_for_each_entry(rp, &raw3270_devices, list) {
977 if (rp->minor != minor)
978 continue;
979 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
980 list_for_each_entry(tmp, &rp->view_list, list) {
981 if (tmp->fn == fn) {
982 raw3270_get_view(tmp);
983 view = tmp;
984 break;
985 }
986 }
987 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
988 break;
989 }
990 mutex_unlock(&raw3270_mutex);
991 return view;
992 }
993
994 /*
995 * Remove view from device and free view structure via call to view->fn->free.
996 */
997 void
998 raw3270_del_view(struct raw3270_view *view)
999 {
1000 unsigned long flags;
1001 struct raw3270 *rp;
1002 struct raw3270_view *nv;
1003
1004 rp = view->dev;
1005 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
1006 if (rp->view == view) {
1007 view->fn->deactivate(view);
1008 rp->view = NULL;
1009 }
1010 list_del_init(&view->list);
1011 if (!rp->view && raw3270_state_ready(rp) &&
1012 !test_bit(RAW3270_FLAGS_FROZEN, &rp->flags)) {
1013 /* Try to activate another view. */
1014 list_for_each_entry(nv, &rp->view_list, list) {
1015 if (nv->fn->activate(nv) == 0) {
1016 rp->view = nv;
1017 break;
1018 }
1019 }
1020 }
1021 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
1022 /* Wait for reference counter to drop to zero. */
1023 atomic_dec(&view->ref_count);
1024 wait_event(raw3270_wait_queue, atomic_read(&view->ref_count) == 0);
1025 if (view->fn->free)
1026 view->fn->free(view);
1027 }
1028
1029 /*
1030 * Remove a 3270 device structure.
1031 */
1032 static void
1033 raw3270_delete_device(struct raw3270 *rp)
1034 {
1035 struct ccw_device *cdev;
1036
1037 /* Remove from device chain. */
1038 mutex_lock(&raw3270_mutex);
1039 list_del_init(&rp->list);
1040 mutex_unlock(&raw3270_mutex);
1041
1042 /* Disconnect from ccw_device. */
1043 cdev = rp->cdev;
1044 rp->cdev = NULL;
1045 dev_set_drvdata(&cdev->dev, NULL);
1046 cdev->handler = NULL;
1047
1048 /* Put ccw_device structure. */
1049 put_device(&cdev->dev);
1050
1051 /* Now free raw3270 structure. */
1052 kfree(rp->ascebc);
1053 kfree(rp);
1054 }
1055
1056 static int
1057 raw3270_probe (struct ccw_device *cdev)
1058 {
1059 return 0;
1060 }
1061
1062 /*
1063 * Additional attributes for a 3270 device
1064 */
1065 static ssize_t
1066 raw3270_model_show(struct device *dev, struct device_attribute *attr, char *buf)
1067 {
1068 return snprintf(buf, PAGE_SIZE, "%i\n",
1069 ((struct raw3270 *) dev_get_drvdata(dev))->model);
1070 }
1071 static DEVICE_ATTR(model, 0444, raw3270_model_show, NULL);
1072
1073 static ssize_t
1074 raw3270_rows_show(struct device *dev, struct device_attribute *attr, char *buf)
1075 {
1076 return snprintf(buf, PAGE_SIZE, "%i\n",
1077 ((struct raw3270 *) dev_get_drvdata(dev))->rows);
1078 }
1079 static DEVICE_ATTR(rows, 0444, raw3270_rows_show, NULL);
1080
1081 static ssize_t
1082 raw3270_columns_show(struct device *dev, struct device_attribute *attr, char *buf)
1083 {
1084 return snprintf(buf, PAGE_SIZE, "%i\n",
1085 ((struct raw3270 *) dev_get_drvdata(dev))->cols);
1086 }
1087 static DEVICE_ATTR(columns, 0444, raw3270_columns_show, NULL);
1088
1089 static struct attribute * raw3270_attrs[] = {
1090 &dev_attr_model.attr,
1091 &dev_attr_rows.attr,
1092 &dev_attr_columns.attr,
1093 NULL,
1094 };
1095
1096 static struct attribute_group raw3270_attr_group = {
1097 .attrs = raw3270_attrs,
1098 };
1099
1100 static int raw3270_create_attributes(struct raw3270 *rp)
1101 {
1102 return sysfs_create_group(&rp->cdev->dev.kobj, &raw3270_attr_group);
1103 }
1104
1105 /*
1106 * Notifier for device addition/removal
1107 */
1108 static LIST_HEAD(raw3270_notifier);
1109
1110 int raw3270_register_notifier(struct raw3270_notifier *notifier)
1111 {
1112 struct raw3270 *rp;
1113
1114 mutex_lock(&raw3270_mutex);
1115 list_add_tail(&notifier->list, &raw3270_notifier);
1116 list_for_each_entry(rp, &raw3270_devices, list)
1117 notifier->create(rp->minor);
1118 mutex_unlock(&raw3270_mutex);
1119 return 0;
1120 }
1121
1122 void raw3270_unregister_notifier(struct raw3270_notifier *notifier)
1123 {
1124 struct raw3270 *rp;
1125
1126 mutex_lock(&raw3270_mutex);
1127 list_for_each_entry(rp, &raw3270_devices, list)
1128 notifier->destroy(rp->minor);
1129 list_del(&notifier->list);
1130 mutex_unlock(&raw3270_mutex);
1131 }
1132
1133 /*
1134 * Set 3270 device online.
1135 */
1136 static int
1137 raw3270_set_online (struct ccw_device *cdev)
1138 {
1139 struct raw3270_notifier *np;
1140 struct raw3270 *rp;
1141 int rc;
1142
1143 rp = raw3270_create_device(cdev);
1144 if (IS_ERR(rp))
1145 return PTR_ERR(rp);
1146 rc = raw3270_create_attributes(rp);
1147 if (rc)
1148 goto failure;
1149 raw3270_reset_device(rp);
1150 mutex_lock(&raw3270_mutex);
1151 list_for_each_entry(np, &raw3270_notifier, list)
1152 np->create(rp->minor);
1153 mutex_unlock(&raw3270_mutex);
1154 return 0;
1155
1156 failure:
1157 raw3270_delete_device(rp);
1158 return rc;
1159 }
1160
1161 /*
1162 * Remove 3270 device structure.
1163 */
1164 static void
1165 raw3270_remove (struct ccw_device *cdev)
1166 {
1167 unsigned long flags;
1168 struct raw3270 *rp;
1169 struct raw3270_view *v;
1170 struct raw3270_notifier *np;
1171
1172 rp = dev_get_drvdata(&cdev->dev);
1173 /*
1174 * _remove is the opposite of _probe; it's probe that
1175 * should set up rp. raw3270_remove gets entered for
1176 * devices even if they haven't been varied online.
1177 * Thus, rp may validly be NULL here.
1178 */
1179 if (rp == NULL)
1180 return;
1181
1182 sysfs_remove_group(&cdev->dev.kobj, &raw3270_attr_group);
1183
1184 /* Deactivate current view and remove all views. */
1185 spin_lock_irqsave(get_ccwdev_lock(cdev), flags);
1186 if (rp->view) {
1187 if (rp->view->fn->deactivate)
1188 rp->view->fn->deactivate(rp->view);
1189 rp->view = NULL;
1190 }
1191 while (!list_empty(&rp->view_list)) {
1192 v = list_entry(rp->view_list.next, struct raw3270_view, list);
1193 if (v->fn->release)
1194 v->fn->release(v);
1195 spin_unlock_irqrestore(get_ccwdev_lock(cdev), flags);
1196 raw3270_del_view(v);
1197 spin_lock_irqsave(get_ccwdev_lock(cdev), flags);
1198 }
1199 spin_unlock_irqrestore(get_ccwdev_lock(cdev), flags);
1200
1201 mutex_lock(&raw3270_mutex);
1202 list_for_each_entry(np, &raw3270_notifier, list)
1203 np->destroy(rp->minor);
1204 mutex_unlock(&raw3270_mutex);
1205
1206 /* Reset 3270 device. */
1207 raw3270_reset_device(rp);
1208 /* And finally remove it. */
1209 raw3270_delete_device(rp);
1210 }
1211
1212 /*
1213 * Set 3270 device offline.
1214 */
1215 static int
1216 raw3270_set_offline (struct ccw_device *cdev)
1217 {
1218 struct raw3270 *rp;
1219
1220 rp = dev_get_drvdata(&cdev->dev);
1221 if (test_bit(RAW3270_FLAGS_CONSOLE, &rp->flags))
1222 return -EBUSY;
1223 raw3270_remove(cdev);
1224 return 0;
1225 }
1226
1227 static int raw3270_pm_stop(struct ccw_device *cdev)
1228 {
1229 struct raw3270 *rp;
1230 struct raw3270_view *view;
1231 unsigned long flags;
1232
1233 rp = dev_get_drvdata(&cdev->dev);
1234 if (!rp)
1235 return 0;
1236 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
1237 if (rp->view && rp->view->fn->deactivate)
1238 rp->view->fn->deactivate(rp->view);
1239 if (!test_bit(RAW3270_FLAGS_CONSOLE, &rp->flags)) {
1240 /*
1241 * Release tty and fullscreen for all non-console
1242 * devices.
1243 */
1244 list_for_each_entry(view, &rp->view_list, list) {
1245 if (view->fn->release)
1246 view->fn->release(view);
1247 }
1248 }
1249 set_bit(RAW3270_FLAGS_FROZEN, &rp->flags);
1250 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
1251 return 0;
1252 }
1253
1254 static int raw3270_pm_start(struct ccw_device *cdev)
1255 {
1256 struct raw3270 *rp;
1257 unsigned long flags;
1258
1259 rp = dev_get_drvdata(&cdev->dev);
1260 if (!rp)
1261 return 0;
1262 spin_lock_irqsave(get_ccwdev_lock(rp->cdev), flags);
1263 clear_bit(RAW3270_FLAGS_FROZEN, &rp->flags);
1264 if (rp->view && rp->view->fn->activate)
1265 rp->view->fn->activate(rp->view);
1266 spin_unlock_irqrestore(get_ccwdev_lock(rp->cdev), flags);
1267 return 0;
1268 }
1269
1270 void raw3270_pm_unfreeze(struct raw3270_view *view)
1271 {
1272 #ifdef CONFIG_TN3270_CONSOLE
1273 struct raw3270 *rp;
1274
1275 rp = view->dev;
1276 if (rp && test_bit(RAW3270_FLAGS_FROZEN, &rp->flags))
1277 ccw_device_force_console();
1278 #endif
1279 }
1280
1281 static struct ccw_device_id raw3270_id[] = {
1282 { CCW_DEVICE(0x3270, 0) },
1283 { CCW_DEVICE(0x3271, 0) },
1284 { CCW_DEVICE(0x3272, 0) },
1285 { CCW_DEVICE(0x3273, 0) },
1286 { CCW_DEVICE(0x3274, 0) },
1287 { CCW_DEVICE(0x3275, 0) },
1288 { CCW_DEVICE(0x3276, 0) },
1289 { CCW_DEVICE(0x3277, 0) },
1290 { CCW_DEVICE(0x3278, 0) },
1291 { CCW_DEVICE(0x3279, 0) },
1292 { CCW_DEVICE(0x3174, 0) },
1293 { /* end of list */ },
1294 };
1295
1296 static struct ccw_driver raw3270_ccw_driver = {
1297 .driver = {
1298 .name = "3270",
1299 .owner = THIS_MODULE,
1300 },
1301 .ids = raw3270_id,
1302 .probe = &raw3270_probe,
1303 .remove = &raw3270_remove,
1304 .set_online = &raw3270_set_online,
1305 .set_offline = &raw3270_set_offline,
1306 .freeze = &raw3270_pm_stop,
1307 .thaw = &raw3270_pm_start,
1308 .restore = &raw3270_pm_start,
1309 .int_class = IRQIO_C70,
1310 };
1311
1312 static int
1313 raw3270_init(void)
1314 {
1315 struct raw3270 *rp;
1316 int rc;
1317
1318 if (raw3270_registered)
1319 return 0;
1320 raw3270_registered = 1;
1321 rc = ccw_driver_register(&raw3270_ccw_driver);
1322 if (rc == 0) {
1323 /* Create attributes for early (= console) device. */
1324 mutex_lock(&raw3270_mutex);
1325 class3270 = class_create(THIS_MODULE, "3270");
1326 list_for_each_entry(rp, &raw3270_devices, list) {
1327 get_device(&rp->cdev->dev);
1328 raw3270_create_attributes(rp);
1329 }
1330 mutex_unlock(&raw3270_mutex);
1331 }
1332 return rc;
1333 }
1334
1335 static void
1336 raw3270_exit(void)
1337 {
1338 ccw_driver_unregister(&raw3270_ccw_driver);
1339 class_destroy(class3270);
1340 }
1341
1342 MODULE_LICENSE("GPL");
1343
1344 module_init(raw3270_init);
1345 module_exit(raw3270_exit);
1346
1347 EXPORT_SYMBOL(class3270);
1348 EXPORT_SYMBOL(raw3270_request_alloc);
1349 EXPORT_SYMBOL(raw3270_request_free);
1350 EXPORT_SYMBOL(raw3270_request_reset);
1351 EXPORT_SYMBOL(raw3270_request_set_cmd);
1352 EXPORT_SYMBOL(raw3270_request_add_data);
1353 EXPORT_SYMBOL(raw3270_request_set_data);
1354 EXPORT_SYMBOL(raw3270_request_set_idal);
1355 EXPORT_SYMBOL(raw3270_buffer_address);
1356 EXPORT_SYMBOL(raw3270_add_view);
1357 EXPORT_SYMBOL(raw3270_del_view);
1358 EXPORT_SYMBOL(raw3270_find_view);
1359 EXPORT_SYMBOL(raw3270_activate_view);
1360 EXPORT_SYMBOL(raw3270_deactivate_view);
1361 EXPORT_SYMBOL(raw3270_start);
1362 EXPORT_SYMBOL(raw3270_start_locked);
1363 EXPORT_SYMBOL(raw3270_start_irq);
1364 EXPORT_SYMBOL(raw3270_reset);
1365 EXPORT_SYMBOL(raw3270_register_notifier);
1366 EXPORT_SYMBOL(raw3270_unregister_notifier);
1367 EXPORT_SYMBOL(raw3270_wait_queue);
Linux kernel - Deliverables
This page took 0.079518 seconds and 5 git commands to generate.