Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
pc300_tty.c
Go to the documentation of this file.
1 /*
2  * pc300_tty.c Cyclades-PC300(tm) TTY Driver.
3  *
4  * Author: Regina Kodato <[email protected]>
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 {
88  int size;
89  unsigned char data[1];
91 
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 */
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,
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 
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  */
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  */
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 }