drivers/s390/char/raw3270.c

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