err.no Git - linux-2.6/blob - drivers/net/wan/pc300_tty.c

   1 /*
   2  * pc300_tty.c  Cyclades-PC300(tm) TTY Driver.
   3  *
   4  * Author:      Regina Kodato <reginak@cyclades.com>
   5  *
   6  * Copyright:   (c) 1999-2002 Cyclades Corp.
   7  *
   8  *      This program is free software; you can redistribute it and/or
   9  *  modify it under the terms of the GNU General Public License
  10  *  as published by the Free Software Foundation; either version
  11  *  2 of the License, or (at your option) any later version.
  12  *
  13  *  $Log: pc300_tty.c,v $
  14  *  Revision 3.7  2002/03/07 14:17:09  henrique
  15  *  License data fixed
  16  *
  17  *  Revision 3.6  2001/12/10 12:29:42  regina
  18  *  Fix the MLPPP bug
  19  *
  20  *  Revision 3.5  2001/10/31 11:20:05  regina
  21  *  automatic pppd starts
  22  *
  23  *  Revision 3.4  2001/08/06 12:01:51  regina
  24  *  problem in DSR_DE bit
  25  *
  26  *  Revision 3.3  2001/07/26 22:58:41  regina
  27  *  update EDA value
  28  *
  29  *  Revision 3.2  2001/07/12 13:11:20  regina
  30  *  bug fix - DCD-OFF in pc300 tty driver
  31  *
  32  *      DMA transmission bug fix
  33  *
  34  *  Revision 3.1  2001/06/22 13:13:02  regina
  35  *  MLPPP implementation
  36  *
  37  */
  38
  39 #include <linux/module.h>
  40 #include <linux/kernel.h>
  41 #include <linux/pci.h>
  42 #include <linux/errno.h>
  43 #include <linux/string.h>
  44 #include <linux/init.h>
  45 #include <linux/netdevice.h>
  46 #include <linux/spinlock.h>
  47 #include <linux/slab.h>
  48 #include <linux/if.h>
  49 #include <linux/skbuff.h>
  50 /* TTY includes */
  51 #include <linux/tty.h>
  52 #include <linux/tty_flip.h>
  53 #include <linux/serial.h>
  54
  55 #include <asm/io.h>
  56 #include <asm/uaccess.h>
  57
  58 #include "pc300.h"
  59
  60 /* defines and macros */
  61 /* TTY Global definitions */
  62 #define CPC_TTY_NPORTS  8       /* maximum number of the sync tty connections */
  63 #define CPC_TTY_MAJOR   CYCLADES_MAJOR
  64 #define CPC_TTY_MINOR_START     240     /* minor of the first PC300 interface */
  65
  66 #define CPC_TTY_MAX_MTU 2000
  67
  68 /* tty interface state */
  69 #define CPC_TTY_ST_IDLE 0
  70 #define CPC_TTY_ST_INIT 1       /* configured with MLPPP and up */
  71 #define CPC_TTY_ST_OPEN 2       /* opened by application */
  72
  73 #define CPC_TTY_LOCK(card,flags)\
  74         do {\
  75                 spin_lock_irqsave(&card->card_lock, flags);     \
  76         } while (0)
  77
  78 #define CPC_TTY_UNLOCK(card,flags)      \
  79         do {\
  80                 spin_unlock_irqrestore(&card->card_lock, flags);        \
  81         } while (0)
  82
  83 //#define       CPC_TTY_DBG(format,a...)        printk(format,##a)
  84 #define CPC_TTY_DBG(format,a...)
  85
  86 /* data structures */
  87 typedef struct _st_cpc_rx_buf {
  88         struct _st_cpc_rx_buf   *next;
  89         int             size;
  90         unsigned char   data[1];
  91 } st_cpc_rx_buf;
  92
  93 struct st_cpc_rx_list {
  94         st_cpc_rx_buf   *first;
  95         st_cpc_rx_buf   *last;
  96 };
  97
  98 typedef struct _st_cpc_tty_area {
  99         int             state;          /* state of the TTY interface */
 100         int             num_open;
 101         unsigned int    tty_minor;      /* minor this interface */
 102         volatile struct st_cpc_rx_list buf_rx;  /* ptr. to reception buffer */
 103         unsigned char*  buf_tx;         /* ptr. to transmission buffer */
 104         pc300dev_t*     pc300dev;       /* ptr. to info struct in PC300 driver */
 105         unsigned char   name[20];       /* interf. name + "-tty" */
 106         struct tty_struct *tty;
 107         struct work_struct tty_tx_work; /* tx work - tx interrupt */
 108         struct work_struct tty_rx_work; /* rx work - rx interrupt */
 109         } st_cpc_tty_area;
 110
 111 /* TTY data structures */
 112 static struct tty_driver serial_drv;
 113
 114 /* local variables */
 115 static st_cpc_tty_area  cpc_tty_area[CPC_TTY_NPORTS];
 116
 117 static int cpc_tty_cnt = 0;     /* number of intrfaces configured with MLPPP */
 118 static int cpc_tty_unreg_flag = 0;
 119
 120 /* TTY functions prototype */
 121 static int cpc_tty_open(struct tty_struct *tty, struct file *flip);
 122 static void cpc_tty_close(struct tty_struct *tty, struct file *flip);
 123 static int cpc_tty_write(struct tty_struct *tty, const unsigned char *buf, int count);
 124 static int cpc_tty_write_room(struct tty_struct *tty);
 125 static int cpc_tty_chars_in_buffer(struct tty_struct *tty);
 126 static void cpc_tty_flush_buffer(struct tty_struct *tty);
 127 static void cpc_tty_hangup(struct tty_struct *tty);
 128 static void cpc_tty_rx_work(struct work_struct *work);
 129 static void cpc_tty_tx_work(struct work_struct *work);
 130 static int cpc_tty_send_to_card(pc300dev_t *dev,void *buf, int len);
 131 static void cpc_tty_trace(pc300dev_t *dev, char* buf, int len, char rxtx);
 132 static void cpc_tty_signal_off(pc300dev_t *pc300dev, unsigned char);
 133 static void cpc_tty_signal_on(pc300dev_t *pc300dev, unsigned char);
 134
 135 static int pc300_tiocmset(struct tty_struct *, struct file *,
 136                           unsigned int, unsigned int);
 137 static int pc300_tiocmget(struct tty_struct *, struct file *);
 138
 139 /* functions called by PC300 driver */
 140 void cpc_tty_init(pc300dev_t *dev);
 141 void cpc_tty_unregister_service(pc300dev_t *pc300dev);
 142 void cpc_tty_receive(pc300dev_t *pc300dev);
 143 void cpc_tty_trigger_poll(pc300dev_t *pc300dev);
 144 void cpc_tty_reset_var(void);
 145
 146 /*
 147  * PC300 TTY clear "signal"
 148  */
 149 static void cpc_tty_signal_off(pc300dev_t *pc300dev, unsigned char signal)
 150 {
 151         pc300ch_t *pc300chan = (pc300ch_t *)pc300dev->chan;
 152         pc300_t *card = (pc300_t *) pc300chan->card;
 153         int ch = pc300chan->channel;
 154         unsigned long flags;
 155
 156         CPC_TTY_DBG("%s-tty: Clear signal %x\n",
 157                 pc300dev->dev->name, signal);
 158         CPC_TTY_LOCK(card, flags);
 159         cpc_writeb(card->hw.scabase + M_REG(CTL,ch),
 160                 cpc_readb(card->hw.scabase+M_REG(CTL,ch))& signal);
 161         CPC_TTY_UNLOCK(card,flags);
 162 }
 163
 164 /*
 165  * PC300 TTY set "signal" to ON
 166  */
 167 static void cpc_tty_signal_on(pc300dev_t *pc300dev, unsigned char signal)
 168 {
 169         pc300ch_t *pc300chan = (pc300ch_t *)pc300dev->chan;
 170         pc300_t *card = (pc300_t *) pc300chan->card;
 171         int ch = pc300chan->channel;
 172         unsigned long flags;
 173
 174         CPC_TTY_DBG("%s-tty: Set signal %x\n",
 175                 pc300dev->dev->name, signal);
 176         CPC_TTY_LOCK(card, flags);
 177         cpc_writeb(card->hw.scabase + M_REG(CTL,ch),
 178                 cpc_readb(card->hw.scabase+M_REG(CTL,ch))& ~signal);
 179         CPC_TTY_UNLOCK(card,flags);
 180 }
 181
 182 /*
 183  * PC300 TTY initialization routine
 184  *
 185  * This routine is called by the PC300 driver during board configuration
 186  * (ioctl=SIOCSP300CONF). At this point the adapter is completely
 187  * initialized.
 188  * o verify kernel version (only 2.4.x)
 189  * o register TTY driver
 190  * o init cpc_tty_area struct
 191  */
 192 void cpc_tty_init(pc300dev_t *pc300dev)
 193 {
 194         unsigned long port;
 195         int aux;
 196         st_cpc_tty_area * cpc_tty;
 197
 198         /* hdlcX - X=interface number */
 199         port = pc300dev->dev->name[4] - '0';
 200         if (port >= CPC_TTY_NPORTS) {
 201                 printk("%s-tty: invalid interface selected (0-%i): %li",
 202                         pc300dev->dev->name,
 203                         CPC_TTY_NPORTS-1,port);
 204                 return;
 205         }
 206
 207         if (cpc_tty_cnt == 0) { /* first TTY connection -> register driver */
 208                 CPC_TTY_DBG("%s-tty: driver init, major:%i, minor range:%i=%i\n",
 209                         pc300dev->dev->name,
 210                         CPC_TTY_MAJOR, CPC_TTY_MINOR_START,
 211                         CPC_TTY_MINOR_START+CPC_TTY_NPORTS);
 212                 /* initialize tty driver struct */
 213                 memset(&serial_drv,0,sizeof(struct tty_driver));
 214                 serial_drv.magic = TTY_DRIVER_MAGIC;
 215                 serial_drv.owner = THIS_MODULE;
 216                 serial_drv.driver_name = "pc300_tty";
 217                 serial_drv.name = "ttyCP";
 218                 serial_drv.major = CPC_TTY_MAJOR;
 219                 serial_drv.minor_start = CPC_TTY_MINOR_START;
 220                 serial_drv.num = CPC_TTY_NPORTS;
 221                 serial_drv.type = TTY_DRIVER_TYPE_SERIAL;
 222                 serial_drv.subtype = SERIAL_TYPE_NORMAL;
 223
 224                 serial_drv.init_termios = tty_std_termios;
 225                 serial_drv.init_termios.c_cflag = B9600|CS8|CREAD|HUPCL|CLOCAL;
 226                 serial_drv.flags = TTY_DRIVER_REAL_RAW;
 227
 228                 /* interface routines from the upper tty layer to the tty driver */
 229                 serial_drv.open = cpc_tty_open;
 230                 serial_drv.close = cpc_tty_close;
 231                 serial_drv.write = cpc_tty_write;
 232                 serial_drv.write_room = cpc_tty_write_room;
 233                 serial_drv.chars_in_buffer = cpc_tty_chars_in_buffer;
 234                 serial_drv.tiocmset = pc300_tiocmset;
 235                 serial_drv.tiocmget = pc300_tiocmget;
 236                 serial_drv.flush_buffer = cpc_tty_flush_buffer;
 237                 serial_drv.hangup = cpc_tty_hangup;
 238
 239                 /* register the TTY driver */
 240                 if (tty_register_driver(&serial_drv)) {
 241                         printk("%s-tty: Failed to register serial driver! ",
 242                                 pc300dev->dev->name);
 243                         return;
 244                 }
 245
 246                 memset((void *)cpc_tty_area, 0,
 247                                                                 sizeof(st_cpc_tty_area) * CPC_TTY_NPORTS);
 248         }
 249
 250         cpc_tty = &cpc_tty_area[port];
 251
 252         if (cpc_tty->state != CPC_TTY_ST_IDLE) {
 253                 CPC_TTY_DBG("%s-tty: TTY port %i, already in use.\n",
 254                                 pc300dev->dev->name, port);
 255                 return;
 256         }
 257
 258         cpc_tty_cnt++;
 259         cpc_tty->state = CPC_TTY_ST_INIT;
 260         cpc_tty->num_open= 0;
 261         cpc_tty->tty_minor = port + CPC_TTY_MINOR_START;
 262         cpc_tty->pc300dev = pc300dev;
 263
 264         INIT_WORK(&cpc_tty->tty_tx_work, cpc_tty_tx_work);
 265         INIT_WORK(&cpc_tty->tty_rx_work, cpc_tty_rx_work);
 266
 267         cpc_tty->buf_rx.first = cpc_tty->buf_rx.last = NULL;
 268
 269         pc300dev->cpc_tty = (void *)cpc_tty;
 270
 271         aux = strlen(pc300dev->dev->name);
 272         memcpy(cpc_tty->name, pc300dev->dev->name, aux);
 273         memcpy(&cpc_tty->name[aux], "-tty", 5);
 274
 275         cpc_open(pc300dev->dev);
 276         cpc_tty_signal_off(pc300dev, CTL_DTR);
 277
 278         CPC_TTY_DBG("%s: Initializing TTY Sync Driver, tty major#%d minor#%i\n",
 279                         cpc_tty->name,CPC_TTY_MAJOR,cpc_tty->tty_minor);
 280         return;
 281 }
 282
 283 /*
 284  * PC300 TTY OPEN routine
 285  *
 286  * This routine is called by the tty driver to open the interface
 287  * o verify minor
 288  * o allocate buffer to Rx and Tx
 289  */
 290 static int cpc_tty_open(struct tty_struct *tty, struct file *flip)
 291 {
 292         int port ;
 293         st_cpc_tty_area *cpc_tty;
 294
 295         if (!tty) {
 296                 return -ENODEV;
 297         }
 298
 299         port = tty->index;
 300
 301         if ((port < 0) || (port >= CPC_TTY_NPORTS)){
 302                 CPC_TTY_DBG("pc300_tty: open invalid port %d\n", port);
 303                 return -ENODEV;
 304         }
 305
 306         cpc_tty = &cpc_tty_area[port];
 307
 308         if (cpc_tty->state == CPC_TTY_ST_IDLE){
 309                 CPC_TTY_DBG("%s: open - invalid interface, port=%d\n",
 310                                         cpc_tty->name, tty->index);
 311                 return -ENODEV;
 312         }
 313
 314         if (cpc_tty->num_open == 0) { /* first open of this tty */
 315                 if (!cpc_tty_area[port].buf_tx){
 316                         cpc_tty_area[port].buf_tx = kmalloc(CPC_TTY_MAX_MTU,GFP_KERNEL);
 317                         if (cpc_tty_area[port].buf_tx == 0){
 318                                 CPC_TTY_DBG("%s: error in memory allocation\n",cpc_tty->name);
 319                                 return -ENOMEM;
 320                         }
 321                 }
 322
 323                 if (cpc_tty_area[port].buf_rx.first) {
 324                         unsigned char * aux;
 325                         while (cpc_tty_area[port].buf_rx.first) {
 326                                 aux = (unsigned char *)cpc_tty_area[port].buf_rx.first;
 327                                 cpc_tty_area[port].buf_rx.first = cpc_tty_area[port].buf_rx.first->next;
 328                                 kfree(aux);
 329                         }
 330                         cpc_tty_area[port].buf_rx.first = NULL;
 331                         cpc_tty_area[port].buf_rx.last = NULL;
 332                 }
 333
 334                 cpc_tty_area[port].state = CPC_TTY_ST_OPEN;
 335                 cpc_tty_area[port].tty = tty;
 336                 tty->driver_data = &cpc_tty_area[port];
 337
 338                 cpc_tty_signal_on(cpc_tty->pc300dev, CTL_DTR);
 339         }
 340
 341         cpc_tty->num_open++;
 342
 343         CPC_TTY_DBG("%s: opening TTY driver\n", cpc_tty->name);
 344
 345         /* avisar driver PC300 */
 346         return 0;
 347 }
 348
 349 /*
 350  * PC300 TTY CLOSE routine
 351  *
 352  * This routine is called by the tty driver to close the interface
 353  * o call close channel in PC300 driver (cpc_closech)
 354  * o free Rx and Tx buffers
 355  */
 356
 357 static void cpc_tty_close(struct tty_struct *tty, struct file *flip)
 358 {
 359         st_cpc_tty_area    *cpc_tty;
 360         unsigned long flags;
 361         int res;
 362
 363         if (!tty || !tty->driver_data ) {
 364                 CPC_TTY_DBG("hdlx-tty: no TTY in close \n");
 365                 return;
 366         }
 367
 368         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 369
 370         if ((cpc_tty->tty != tty)|| (cpc_tty->state != CPC_TTY_ST_OPEN)) {
 371                 CPC_TTY_DBG("%s: TTY is not opened\n",cpc_tty->name);
 372                 return;
 373         }
 374
 375         if (!cpc_tty->num_open) {
 376                 CPC_TTY_DBG("%s: TTY is closed\n",cpc_tty->name);
 377                 return;
 378         }
 379
 380         if (--cpc_tty->num_open > 0) {
 381                 CPC_TTY_DBG("%s: TTY closed\n",cpc_tty->name);
 382                 return;
 383         }
 384
 385         cpc_tty_signal_off(cpc_tty->pc300dev, CTL_DTR);
 386
 387         CPC_TTY_LOCK(cpc_tty->pc300dev->chan->card, flags);  /* lock irq */
 388         cpc_tty->tty = NULL;
 389         cpc_tty->state = CPC_TTY_ST_INIT;
 390         CPC_TTY_UNLOCK(cpc_tty->pc300dev->chan->card, flags); /* unlock irq */
 391
 392         if (cpc_tty->buf_rx.first) {
 393                 unsigned char * aux;
 394                 while (cpc_tty->buf_rx.first) {
 395                         aux = (unsigned char *)cpc_tty->buf_rx.first;
 396                         cpc_tty->buf_rx.first = cpc_tty->buf_rx.first->next;
 397                         kfree(aux);
 398                 }
 399                 cpc_tty->buf_rx.first = NULL;
 400                 cpc_tty->buf_rx.last = NULL;
 401         }
 402
 403         kfree(cpc_tty->buf_tx);
 404         cpc_tty->buf_tx = NULL;
 405
 406         CPC_TTY_DBG("%s: TTY closed\n",cpc_tty->name);
 407
 408         if (!serial_drv.refcount && cpc_tty_unreg_flag) {
 409                 cpc_tty_unreg_flag = 0;
 410                 CPC_TTY_DBG("%s: unregister the tty driver\n", cpc_tty->name);
 411                 if ((res=tty_unregister_driver(&serial_drv))) {
 412                         CPC_TTY_DBG("%s: ERROR ->unregister the tty driver error=%d\n",
 413                                                         cpc_tty->name,res);
 414                 }
 415         }
 416         return;
 417 }
 418
 419 /*
 420  * PC300 TTY WRITE routine
 421  *
 422  * This routine is called by the tty driver to write a series of characters
 423  * to the tty device. The characters may come from user or kernel space.
 424  * o verify the DCD signal
 425  * o send characters to board and start the transmission
 426  */
 427 static int cpc_tty_write(struct tty_struct *tty, const unsigned char *buf, int count)
 428 {
 429         st_cpc_tty_area    *cpc_tty;
 430         pc300ch_t *pc300chan;
 431         pc300_t *card;
 432         int ch;
 433         unsigned long flags;
 434         struct net_device_stats *stats;
 435
 436         if (!tty || !tty->driver_data ) {
 437                 CPC_TTY_DBG("hdlcX-tty: no TTY in write\n");
 438                 return -ENODEV;
 439         }
 440
 441         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 442
 443         if ((cpc_tty->tty != tty) ||  (cpc_tty->state != CPC_TTY_ST_OPEN)) {
 444                 CPC_TTY_DBG("%s: TTY is not opened\n", cpc_tty->name);
 445                 return -ENODEV;
 446         }
 447
 448         if (count > CPC_TTY_MAX_MTU) {
 449                 CPC_TTY_DBG("%s: count is invalid\n",cpc_tty->name);
 450                 return -EINVAL;        /* frame too big */
 451         }
 452
 453         CPC_TTY_DBG("%s: cpc_tty_write data len=%i\n",cpc_tty->name,count);
 454
 455         pc300chan = (pc300ch_t *)((pc300dev_t*)cpc_tty->pc300dev)->chan;
 456         stats = hdlc_stats(((pc300dev_t*)cpc_tty->pc300dev)->dev);
 457         card = (pc300_t *) pc300chan->card;
 458         ch = pc300chan->channel;
 459
 460         /* verify DCD signal*/
 461         if (cpc_readb(card->hw.scabase + M_REG(ST3,ch)) & ST3_DCD) {
 462                 /* DCD is OFF */
 463                 CPC_TTY_DBG("%s : DCD is OFF\n", cpc_tty->name);
 464                 stats->tx_errors++;
 465                 stats->tx_carrier_errors++;
 466                 CPC_TTY_LOCK(card, flags);
 467                 cpc_writeb(card->hw.scabase + M_REG(CMD, ch), CMD_TX_BUF_CLR);
 468
 469                 if (card->hw.type == PC300_TE) {
 470                         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
 471                                 cpc_readb(card->hw.falcbase + card->hw.cpld_reg2) &
 472                                 ~(CPLD_REG2_FALC_LED1 << (2 *ch)));
 473                 }
 474
 475                 CPC_TTY_UNLOCK(card, flags);
 476
 477                 return -EINVAL;
 478         }
 479
 480         if (cpc_tty_send_to_card(cpc_tty->pc300dev, (void*)buf, count)) {
 481            /* failed to send */
 482            CPC_TTY_DBG("%s: trasmition error\n", cpc_tty->name);
 483            return 0;
 484         }
 485         return count;
 486 }
 487
 488 /*
 489  * PC300 TTY Write Room routine
 490  *
 491  * This routine returns the numbers of characteres the tty driver will accept
 492  * for queuing to be written.
 493  * o return MTU
 494  */
 495 static int cpc_tty_write_room(struct tty_struct *tty)
 496 {
 497         st_cpc_tty_area    *cpc_tty;
 498
 499         if (!tty || !tty->driver_data ) {
 500                 CPC_TTY_DBG("hdlcX-tty: no TTY to write room\n");
 501                 return -ENODEV;
 502         }
 503
 504         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 505
 506         if ((cpc_tty->tty != tty) ||  (cpc_tty->state != CPC_TTY_ST_OPEN)) {
 507                 CPC_TTY_DBG("%s: TTY is not opened\n",cpc_tty->name);
 508                 return -ENODEV;
 509         }
 510
 511         CPC_TTY_DBG("%s: write room\n",cpc_tty->name);
 512
 513         return CPC_TTY_MAX_MTU;
 514 }
 515
 516 /*
 517  * PC300 TTY chars in buffer routine
 518  *
 519  * This routine returns the chars number in the transmission buffer
 520  * o returns 0
 521  */
 522 static int cpc_tty_chars_in_buffer(struct tty_struct *tty)
 523 {
 524         st_cpc_tty_area    *cpc_tty;
 525
 526         if (!tty || !tty->driver_data ) {
 527                 CPC_TTY_DBG("hdlcX-tty: no TTY to chars in buffer\n");
 528                 return -ENODEV;
 529         }
 530
 531         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 532
 533         if ((cpc_tty->tty != tty) || (cpc_tty->state != CPC_TTY_ST_OPEN)) {
 534                 CPC_TTY_DBG("%s: TTY is not opened\n",cpc_tty->name);
 535                 return -ENODEV;
 536         }
 537
 538         return(0);
 539 }
 540
 541 static int pc300_tiocmset(struct tty_struct *tty, struct file *file,
 542                           unsigned int set, unsigned int clear)
 543 {
 544         st_cpc_tty_area    *cpc_tty;
 545
 546         CPC_TTY_DBG("%s: set:%x clear:%x\n", __FUNCTION__, set, clear);
 547
 548         if (!tty || !tty->driver_data ) {
 549                 CPC_TTY_DBG("hdlcX-tty: no TTY to chars in buffer\n");
 550                 return -ENODEV;
 551         }
 552
 553         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 554
 555         if (set & TIOCM_RTS)
 556                 cpc_tty_signal_on(cpc_tty->pc300dev, CTL_RTS);
 557         if (set & TIOCM_DTR)
 558                 cpc_tty_signal_on(cpc_tty->pc300dev, CTL_DTR);
 559
 560         if (clear & TIOCM_RTS)
 561                 cpc_tty_signal_off(cpc_tty->pc300dev, CTL_RTS);
 562         if (clear & TIOCM_DTR)
 563                 cpc_tty_signal_off(cpc_tty->pc300dev, CTL_DTR);
 564
 565         return 0;
 566 }
 567
 568 static int pc300_tiocmget(struct tty_struct *tty, struct file *file)
 569 {
 570         unsigned int result;
 571         unsigned char status;
 572         unsigned long flags;
 573         st_cpc_tty_area  *cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 574         pc300dev_t *pc300dev = cpc_tty->pc300dev;
 575         pc300ch_t *pc300chan = (pc300ch_t *)pc300dev->chan;
 576         pc300_t *card = (pc300_t *) pc300chan->card;
 577         int ch = pc300chan->channel;
 578
 579         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 580
 581         CPC_TTY_DBG("%s-tty: tiocmget\n",
 582                 ((struct net_device*)(pc300dev->hdlc))->name);
 583
 584         CPC_TTY_LOCK(card, flags);
 585         status = cpc_readb(card->hw.scabase+M_REG(CTL,ch));
 586         CPC_TTY_UNLOCK(card,flags);
 587
 588         result = ((status & CTL_DTR) ? TIOCM_DTR : 0) |
 589                  ((status & CTL_RTS) ? TIOCM_RTS : 0);
 590
 591         return result;
 592 }
 593
 594 /*
 595  * PC300 TTY Flush Buffer routine
 596  *
 597  * This routine resets the transmission buffer
 598  */
 599 static void cpc_tty_flush_buffer(struct tty_struct *tty)
 600 {
 601         st_cpc_tty_area    *cpc_tty;
 602
 603         if (!tty || !tty->driver_data ) {
 604                 CPC_TTY_DBG("hdlcX-tty: no TTY to flush buffer\n");
 605                 return;
 606         }
 607
 608         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 609
 610         if ((cpc_tty->tty != tty) ||  (cpc_tty->state != CPC_TTY_ST_OPEN)) {
 611                 CPC_TTY_DBG("%s: TTY is not opened\n",cpc_tty->name);
 612                 return;
 613         }
 614
 615         CPC_TTY_DBG("%s: call wake_up_interruptible\n",cpc_tty->name);
 616
 617         tty_wakeup(tty);
 618         return;
 619 }
 620
 621 /*
 622  * PC300 TTY Hangup routine
 623  *
 624  * This routine is called by the tty driver to hangup the interface
 625  * o clear DTR signal
 626  */
 627
 628 static void cpc_tty_hangup(struct tty_struct *tty)
 629 {
 630         st_cpc_tty_area    *cpc_tty;
 631         int res;
 632
 633         if (!tty || !tty->driver_data ) {
 634                 CPC_TTY_DBG("hdlcX-tty: no TTY to hangup\n");
 635                 return ;
 636         }
 637
 638         cpc_tty = (st_cpc_tty_area *) tty->driver_data;
 639
 640         if ((cpc_tty->tty != tty) || (cpc_tty->state != CPC_TTY_ST_OPEN)) {
 641                 CPC_TTY_DBG("%s: TTY is not opened\n",cpc_tty->name);
 642                 return ;
 643         }
 644         if (!serial_drv.refcount && cpc_tty_unreg_flag) {
 645                 cpc_tty_unreg_flag = 0;
 646                 CPC_TTY_DBG("%s: unregister the tty driver\n", cpc_tty->name);
 647                 if ((res=tty_unregister_driver(&serial_drv))) {
 648                         CPC_TTY_DBG("%s: ERROR ->unregister the tty driver error=%d\n",
 649                                                         cpc_tty->name,res);
 650                 }
 651         }
 652         cpc_tty_signal_off(cpc_tty->pc300dev, CTL_DTR);
 653 }
 654
 655 /*
 656  * PC300 TTY RX work routine
 657  * This routine treats RX work
 658  * o verify read buffer
 659  * o call the line disc. read
 660  * o free memory
 661  */
 662 static void cpc_tty_rx_work(struct work_struct *work)
 663 {
 664         st_cpc_tty_area *cpc_tty;
 665         unsigned long port;
 666         int i, j;
 667         volatile st_cpc_rx_buf *buf;
 668         char flags=0,flg_rx=1;
 669         struct tty_ldisc *ld;
 670
 671         if (cpc_tty_cnt == 0) return;
 672
 673         for (i=0; (i < 4) && flg_rx ; i++) {
 674                 flg_rx = 0;
 675
 676                 cpc_tty = container_of(work, st_cpc_tty_area, tty_rx_work);
 677                 port = cpc_tty - cpc_tty_area;
 678
 679                 for (j=0; j < CPC_TTY_NPORTS; j++) {
 680                         cpc_tty = &cpc_tty_area[port];
 681
 682                         if ((buf=cpc_tty->buf_rx.first) != 0) {
 683                                 if (cpc_tty->tty) {
 684                                         ld = tty_ldisc_ref(cpc_tty->tty);
 685                                         if (ld) {
 686                                                 if (ld->receive_buf) {
 687                                                         CPC_TTY_DBG("%s: call line disc. receive_buf\n",cpc_tty->name);
 688                                                         ld->receive_buf(cpc_tty->tty, (char *)(buf->data), &flags, buf->size);
 689                                                 }
 690                                                 tty_ldisc_deref(ld);
 691                                         }
 692                                 }
 693                                 cpc_tty->buf_rx.first = cpc_tty->buf_rx.first->next;
 694                                 kfree((void *)buf);
 695                                 buf = cpc_tty->buf_rx.first;
 696                                 flg_rx = 1;
 697                         }
 698                         if (++port == CPC_TTY_NPORTS) port = 0;
 699                 }
 700         }
 701 }
 702
 703 /*
 704  * PC300 TTY RX work routine
 705  *
 706  * This routine treats RX interrupt.
 707  * o read all frames in card
 708  * o verify the frame size
 709  * o read the frame in rx buffer
 710  */
 711 static void cpc_tty_rx_disc_frame(pc300ch_t *pc300chan)
 712 {
 713         volatile pcsca_bd_t __iomem * ptdescr;
 714         volatile unsigned char status;
 715         pc300_t *card = (pc300_t *)pc300chan->card;
 716         int ch = pc300chan->channel;
 717
 718         /* dma buf read */
 719         ptdescr = (pcsca_bd_t __iomem *)(card->hw.rambase +
 720                                 RX_BD_ADDR(ch, pc300chan->rx_first_bd));
 721         while (pc300chan->rx_first_bd != pc300chan->rx_last_bd) {
 722                 status = cpc_readb(&ptdescr->status);
 723                 cpc_writeb(&ptdescr->status, 0);
 724                 cpc_writeb(&ptdescr->len, 0);
 725                 pc300chan->rx_first_bd = (pc300chan->rx_first_bd + 1) &
 726                                         (N_DMA_RX_BUF - 1);
 727                 if (status & DST_EOM) {
 728                         break; /* end of message */
 729                 }
 730                 ptdescr = (pcsca_bd_t __iomem *)(card->hw.rambase + cpc_readl(&ptdescr->next));
 731         }
 732 }
 733
 734 void cpc_tty_receive(pc300dev_t *pc300dev)
 735 {
 736         st_cpc_tty_area *cpc_tty;
 737         pc300ch_t *pc300chan = (pc300ch_t *)pc300dev->chan;
 738         pc300_t *card = (pc300_t *)pc300chan->card;
 739         int ch = pc300chan->channel;
 740         volatile pcsca_bd_t  __iomem * ptdescr;
 741         struct net_device_stats *stats = hdlc_stats(pc300dev->dev);
 742         int rx_len, rx_aux;
 743         volatile unsigned char status;
 744         unsigned short first_bd = pc300chan->rx_first_bd;
 745         st_cpc_rx_buf *new = NULL;
 746         unsigned char dsr_rx;
 747
 748         if (pc300dev->cpc_tty == NULL) {
 749                 return;
 750         }
 751
 752         dsr_rx = cpc_readb(card->hw.scabase + DSR_RX(ch));
 753
 754         cpc_tty = (st_cpc_tty_area *)pc300dev->cpc_tty;
 755
 756         while (1) {
 757                 rx_len = 0;
 758                 ptdescr = (pcsca_bd_t  __iomem *)(card->hw.rambase + RX_BD_ADDR(ch, first_bd));
 759                 while ((status = cpc_readb(&ptdescr->status)) & DST_OSB) {
 760                         rx_len += cpc_readw(&ptdescr->len);
 761                         first_bd = (first_bd + 1) & (N_DMA_RX_BUF - 1);
 762                         if (status & DST_EOM) {
 763                                 break;
 764                         }
 765                         ptdescr = (pcsca_bd_t __iomem *)(card->hw.rambase+cpc_readl(&ptdescr->next));
 766                 }
 767
 768                 if (!rx_len) {
 769                         if (dsr_rx & DSR_BOF) {
 770                                 /* update EDA */
 771                                 cpc_writel(card->hw.scabase + DRX_REG(EDAL, ch),
 772                                                 RX_BD_ADDR(ch, pc300chan->rx_last_bd));
 773                         }
 774                         kfree(new);
 775                         return;
 776                 }
 777
 778                 if (rx_len > CPC_TTY_MAX_MTU) {
 779                         /* Free RX descriptors */
 780                         CPC_TTY_DBG("%s: frame size is invalid.\n",cpc_tty->name);
 781                         stats->rx_errors++;
 782                         stats->rx_frame_errors++;
 783                         cpc_tty_rx_disc_frame(pc300chan);
 784                         continue;
 785                 }
 786
 787                 new = kmalloc(rx_len + sizeof(st_cpc_rx_buf), GFP_ATOMIC);
 788                 if (new == 0) {
 789                         cpc_tty_rx_disc_frame(pc300chan);
 790                         continue;
 791                 }
 792
 793                 /* dma buf read */
 794                 ptdescr = (pcsca_bd_t __iomem *)(card->hw.rambase +
 795                                 RX_BD_ADDR(ch, pc300chan->rx_first_bd));
 796
 797                 rx_len = 0;     /* counter frame size */
 798
 799                 while ((status = cpc_readb(&ptdescr->status)) & DST_OSB) {
 800                         rx_aux = cpc_readw(&ptdescr->len);
 801                         if ((status & (DST_OVR | DST_CRC | DST_RBIT |  DST_SHRT | DST_ABT))
 802                                 || (rx_aux > BD_DEF_LEN)) {
 803                                 CPC_TTY_DBG("%s: reception error\n", cpc_tty->name);
 804                                 stats->rx_errors++;
 805                                 if (status & DST_OVR) {
 806                                         stats->rx_fifo_errors++;
 807                                 }
 808                                 if (status & DST_CRC) {
 809                                         stats->rx_crc_errors++;
 810                                 }
 811                                 if ((status & (DST_RBIT | DST_SHRT | DST_ABT)) ||
 812                                         (rx_aux > BD_DEF_LEN))  {
 813                                         stats->rx_frame_errors++;
 814                                 }
 815                                 /* discard remainig descriptors used by the bad frame */
 816                                 CPC_TTY_DBG("%s: reception error - discard descriptors",
 817                                                 cpc_tty->name);
 818                                 cpc_tty_rx_disc_frame(pc300chan);
 819                                 rx_len = 0;
 820                                 kfree(new);
 821                                 new = NULL;
 822                                 break; /* read next frame - while(1) */
 823                         }
 824
 825                         if (cpc_tty->state != CPC_TTY_ST_OPEN) {
 826                                 /* Free RX descriptors */
 827                                 cpc_tty_rx_disc_frame(pc300chan);
 828                                 stats->rx_dropped++;
 829                                 rx_len = 0;
 830                                 kfree(new);
 831                                 new = NULL;
 832                                 break; /* read next frame - while(1) */
 833                         }
 834
 835                         /* read the segment of the frame */
 836                         if (rx_aux != 0) {
 837                                 memcpy_fromio((new->data + rx_len),
 838                                         (void __iomem *)(card->hw.rambase +
 839                                          cpc_readl(&ptdescr->ptbuf)), rx_aux);
 840                                 rx_len += rx_aux;
 841                         }
 842                         cpc_writeb(&ptdescr->status,0);
 843                         cpc_writeb(&ptdescr->len, 0);
 844                         pc300chan->rx_first_bd = (pc300chan->rx_first_bd + 1) &
 845                                         (N_DMA_RX_BUF -1);
 846                         if (status & DST_EOM)break;
 847
 848                         ptdescr = (pcsca_bd_t __iomem *) (card->hw.rambase +
 849                                         cpc_readl(&ptdescr->next));
 850                 }
 851                 /* update pointer */
 852                 pc300chan->rx_last_bd = (pc300chan->rx_first_bd - 1) &
 853                                         (N_DMA_RX_BUF - 1) ;
 854                 if (!(dsr_rx & DSR_BOF)) {
 855                         /* update EDA */
 856                         cpc_writel(card->hw.scabase + DRX_REG(EDAL, ch),
 857                                         RX_BD_ADDR(ch, pc300chan->rx_last_bd));
 858                 }
 859                 if (rx_len != 0) {
 860                         stats->rx_bytes += rx_len;
 861
 862                         if (pc300dev->trace_on) {
 863                                 cpc_tty_trace(pc300dev, new->data,rx_len, 'R');
 864                         }
 865                         new->size = rx_len;
 866                         new->next = NULL;
 867                         if (cpc_tty->buf_rx.first == 0) {
 868                                 cpc_tty->buf_rx.first = new;
 869                                 cpc_tty->buf_rx.last = new;
 870                         } else {
 871                                 cpc_tty->buf_rx.last->next = new;
 872                                 cpc_tty->buf_rx.last = new;
 873                         }
 874                         schedule_work(&(cpc_tty->tty_rx_work));
 875                         stats->rx_packets++;
 876                 }
 877         }
 878 }
 879
 880 /*
 881  * PC300 TTY TX work routine
 882  *
 883  * This routine treats TX interrupt.
 884  * o if need call line discipline wakeup
 885  * o call wake_up_interruptible
 886  */
 887 static void cpc_tty_tx_work(struct work_struct *work)
 888 {
 889         st_cpc_tty_area *cpc_tty =
 890                 container_of(work, st_cpc_tty_area, tty_tx_work);
 891         struct tty_struct *tty;
 892
 893         CPC_TTY_DBG("%s: cpc_tty_tx_work init\n",cpc_tty->name);
 894
 895         if ((tty = cpc_tty->tty) == 0) {
 896                 CPC_TTY_DBG("%s: the interface is not opened\n",cpc_tty->name);
 897                 return;
 898         }
 899         tty_wakeup(tty);
 900 }
 901
 902 /*
 903  * PC300 TTY send to card routine
 904  *
 905  * This routine send data to card.
 906  * o clear descriptors
 907  * o write data to DMA buffers
 908  * o start the transmission
 909  */
 910 static int cpc_tty_send_to_card(pc300dev_t *dev,void* buf, int len)
 911 {
 912         pc300ch_t *chan = (pc300ch_t *)dev->chan;
 913         pc300_t *card = (pc300_t *)chan->card;
 914         int ch = chan->channel;
 915         struct net_device_stats *stats = hdlc_stats(dev->dev);
 916         unsigned long flags;
 917         volatile pcsca_bd_t __iomem *ptdescr;
 918         int i, nchar;
 919         int tosend = len;
 920         int nbuf = ((len - 1)/BD_DEF_LEN) + 1;
 921         unsigned char *pdata=buf;
 922
 923         CPC_TTY_DBG("%s:cpc_tty_send_to_cars len=%i",
 924                         (st_cpc_tty_area *)dev->cpc_tty->name,len);
 925
 926         if (nbuf >= card->chan[ch].nfree_tx_bd) {
 927                 return 1;
 928         }
 929
 930         /* write buffer to DMA buffers */
 931         CPC_TTY_DBG("%s: call dma_buf_write\n",
 932                         (st_cpc_tty_area *)dev->cpc_tty->name);
 933         for (i = 0 ; i < nbuf ; i++) {
 934                 ptdescr = (pcsca_bd_t __iomem *)(card->hw.rambase +
 935                         TX_BD_ADDR(ch, card->chan[ch].tx_next_bd));
 936                 nchar = (BD_DEF_LEN > tosend) ? tosend : BD_DEF_LEN;
 937                 if (cpc_readb(&ptdescr->status) & DST_OSB) {
 938                         memcpy_toio((void __iomem *)(card->hw.rambase +
 939                                 cpc_readl(&ptdescr->ptbuf)),
 940                                 &pdata[len - tosend],
 941                                 nchar);
 942                         card->chan[ch].nfree_tx_bd--;
 943                         if ((i + 1) == nbuf) {
 944                                 /* This must be the last BD to be used */
 945                                 cpc_writeb(&ptdescr->status, DST_EOM);
 946                         } else {
 947                                 cpc_writeb(&ptdescr->status, 0);
 948                         }
 949                         cpc_writew(&ptdescr->len, nchar);
 950                 } else {
 951                         CPC_TTY_DBG("%s: error in dma_buf_write\n",
 952                                         (st_cpc_tty_area *)dev->cpc_tty->name);
 953                         stats->tx_dropped++;
 954                         return 1;
 955                 }
 956                 tosend -= nchar;
 957                 card->chan[ch].tx_next_bd =
 958                         (card->chan[ch].tx_next_bd + 1) & (N_DMA_TX_BUF - 1);
 959         }
 960
 961         if (dev->trace_on) {
 962                 cpc_tty_trace(dev, buf, len,'T');
 963         }
 964
 965         /* start transmission */
 966         CPC_TTY_DBG("%s: start transmission\n",
 967                 (st_cpc_tty_area *)dev->cpc_tty->name);
 968
 969         CPC_TTY_LOCK(card, flags);
 970         cpc_writeb(card->hw.scabase + DTX_REG(EDAL, ch),
 971                         TX_BD_ADDR(ch, chan->tx_next_bd));
 972         cpc_writeb(card->hw.scabase + M_REG(CMD, ch), CMD_TX_ENA);
 973         cpc_writeb(card->hw.scabase + DSR_TX(ch), DSR_DE);
 974
 975         if (card->hw.type == PC300_TE) {
 976                 cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
 977                         cpc_readb(card->hw.falcbase + card->hw.cpld_reg2) |
 978                         (CPLD_REG2_FALC_LED1 << (2 * ch)));
 979         }
 980         CPC_TTY_UNLOCK(card, flags);
 981         return 0;
 982 }
 983
 984 /*
 985  *      PC300 TTY trace routine
 986  *
 987  *  This routine send trace of connection to application.
 988  *  o clear descriptors
 989  *  o write data to DMA buffers
 990  *  o start the transmission
 991  */
 992
 993 static void cpc_tty_trace(pc300dev_t *dev, char* buf, int len, char rxtx)
 994 {
 995         struct sk_buff *skb;
 996
 997         if ((skb = dev_alloc_skb(10 + len)) == NULL) {
 998                 /* out of memory */
 999                 CPC_TTY_DBG("%s: tty_trace - out of memory\n", dev->dev->name);
1000                 return;
1001         }
1002
1003         skb_put (skb, 10 + len);
1004         skb->dev = dev->dev;
1005         skb->protocol = htons(ETH_P_CUST);
1006         skb_reset_mac_header(skb);
1007         skb->pkt_type = PACKET_HOST;
1008         skb->len = 10 + len;
1009
1010         skb_copy_to_linear_data(skb, dev->dev->name, 5);
1011         skb->data[5] = '[';
1012         skb->data[6] = rxtx;
1013         skb->data[7] = ']';
1014         skb->data[8] = ':';
1015         skb->data[9] = ' ';
1016         skb_copy_to_linear_data_offset(skb, 10, buf, len);
1017         netif_rx(skb);
1018 }
1019
1020 /*
1021  *      PC300 TTY unregister service routine
1022  *
1023  *      This routine unregister one interface.
1024  */
1025 void cpc_tty_unregister_service(pc300dev_t *pc300dev)
1026 {
1027         st_cpc_tty_area *cpc_tty;
1028         ulong flags;
1029         int res;
1030
1031         if ((cpc_tty= (st_cpc_tty_area *) pc300dev->cpc_tty) == 0) {
1032                 CPC_TTY_DBG("%s: interface is not TTY\n", pc300dev->dev->name);
1033                 return;
1034         }
1035         CPC_TTY_DBG("%s: cpc_tty_unregister_service", cpc_tty->name);
1036
1037         if (cpc_tty->pc300dev != pc300dev) {
1038                 CPC_TTY_DBG("%s: invalid tty ptr=%s\n",
1039                 pc300dev->dev->name, cpc_tty->name);
1040                 return;
1041         }
1042
1043         if (--cpc_tty_cnt == 0) {
1044                 if (serial_drv.refcount) {
1045                         CPC_TTY_DBG("%s: unregister is not possible, refcount=%d",
1046                                                         cpc_tty->name, serial_drv.refcount);
1047                         cpc_tty_cnt++;
1048                         cpc_tty_unreg_flag = 1;
1049                         return;
1050                 } else {
1051                         CPC_TTY_DBG("%s: unregister the tty driver\n", cpc_tty->name);
1052                         if ((res=tty_unregister_driver(&serial_drv))) {
1053                                 CPC_TTY_DBG("%s: ERROR ->unregister the tty driver error=%d\n",
1054                                                                 cpc_tty->name,res);
1055                         }
1056                 }
1057         }
1058         CPC_TTY_LOCK(pc300dev->chan->card,flags);
1059         cpc_tty->tty = NULL;
1060         CPC_TTY_UNLOCK(pc300dev->chan->card, flags);
1061         cpc_tty->tty_minor = 0;
1062         cpc_tty->state = CPC_TTY_ST_IDLE;
1063 }
1064
1065 /*
1066  * PC300 TTY trigger poll routine
1067  * This routine is called by pc300driver to treats Tx interrupt.
1068  */
1069 void cpc_tty_trigger_poll(pc300dev_t *pc300dev)
1070 {
1071         st_cpc_tty_area *cpc_tty = (st_cpc_tty_area *)pc300dev->cpc_tty;
1072         if (!cpc_tty) {
1073                 return;
1074         }
1075         schedule_work(&(cpc_tty->tty_tx_work));
1076 }
1077
1078 /*
1079  * PC300 TTY reset var routine
1080  * This routine is called by pc300driver to init the TTY area.
1081  */
1082
1083 void cpc_tty_reset_var(void)
1084 {
1085         int i ;
1086
1087         CPC_TTY_DBG("hdlcX-tty: reset variables\n");
1088         /* reset  the tty_driver structure - serial_drv */
1089         memset(&serial_drv, 0, sizeof(struct tty_driver));
1090         for (i=0; i < CPC_TTY_NPORTS; i++){
1091                 memset(&cpc_tty_area[i],0, sizeof(st_cpc_tty_area));
1092         }
1093 }