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