?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
RT-AC66 3.0.0.4.374.130 core
[tomato.git] / release / src-rt-6.x / linux / linux-2.6 / drivers / net / wan / pc300_tty.c
blobe24a7b095dd6921208c3dab48a59d9a327eed0d3
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 == 0){
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) != 0) {
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 == 0) {
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 == 0) {
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) == 0) {
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) == 0) {
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 }
Tomato firmware and modifications.