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