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