1 /*****************************************************************************/
4 * stallion.c -- stallion multiport serial driver.
6 * Copyright (C) 1996-1999 Stallion Technologies
7 * Copyright (C) 1994-1996 Greg Ungerer.
9 * This code is loosely based on the Linux serial driver, written by
10 * Linus Torvalds, Theodore T'so and others.
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or
15 * (at your option) any later version.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
27 /*****************************************************************************/
29 #include <linux/module.h>
30 #include <linux/slab.h>
31 #include <linux/interrupt.h>
32 #include <linux/tty.h>
33 #include <linux/tty_flip.h>
34 #include <linux/serial.h>
35 #include <linux/cd1400.h>
36 #include <linux/sc26198.h>
37 #include <linux/comstats.h>
38 #include <linux/stallion.h>
39 #include <linux/ioport.h>
40 #include <linux/init.h>
41 #include <linux/smp_lock.h>
42 #include <linux/device.h>
43 #include <linux/delay.h>
46 #include <asm/uaccess.h>
49 #include <linux/pci.h>
52 /*****************************************************************************/
55 * Define different board types. Use the standard Stallion "assigned"
56 * board numbers. Boards supported in this driver are abbreviated as
57 * EIO = EasyIO and ECH = EasyConnection 8/32.
63 #define BRD_ECH64PCI 27
64 #define BRD_EASYIOPCI 28
67 * Define a configuration structure to hold the board configuration.
68 * Need to set this up in the code (for now) with the boards that are
69 * to be configured into the system. This is what needs to be modified
70 * when adding/removing/modifying boards. Each line entry in the
71 * stl_brdconf[] array is a board. Each line contains io/irq/memory
72 * ranges for that board (as well as what type of board it is).
74 * { BRD_EASYIO, 0x2a0, 0, 0, 10, 0 },
75 * This line would configure an EasyIO board (4 or 8, no difference),
76 * at io address 2a0 and irq 10.
78 * { BRD_ECH, 0x2a8, 0x280, 0, 12, 0 },
79 * This line will configure an EasyConnection 8/32 board at primary io
80 * address 2a8, secondary io address 280 and irq 12.
81 * Enter as many lines into this array as you want (only the first 4
82 * will actually be used!). Any combination of EasyIO and EasyConnection
83 * boards can be specified. EasyConnection 8/32 boards can share their
84 * secondary io addresses between each other.
86 * NOTE: there is no need to put any entries in this table for PCI
87 * boards. They will be found automatically by the driver - provided
88 * PCI BIOS32 support is compiled into the kernel.
95 unsigned long memaddr
;
100 static stlconf_t stl_brdconf
[] = {
101 /*{ BRD_EASYIO, 0x2a0, 0, 0, 10, 0 },*/
104 static int stl_nrbrds
= ARRAY_SIZE(stl_brdconf
);
106 /*****************************************************************************/
109 * Define some important driver characteristics. Device major numbers
110 * allocated as per Linux Device Registry.
112 #ifndef STL_SIOMEMMAJOR
113 #define STL_SIOMEMMAJOR 28
115 #ifndef STL_SERIALMAJOR
116 #define STL_SERIALMAJOR 24
118 #ifndef STL_CALLOUTMAJOR
119 #define STL_CALLOUTMAJOR 25
123 * Set the TX buffer size. Bigger is better, but we don't want
124 * to chew too much memory with buffers!
126 #define STL_TXBUFLOW 512
127 #define STL_TXBUFSIZE 4096
129 /*****************************************************************************/
132 * Define our local driver identity first. Set up stuff to deal with
133 * all the local structures required by a serial tty driver.
135 static char *stl_drvtitle
= "Stallion Multiport Serial Driver";
136 static char *stl_drvname
= "stallion";
137 static char *stl_drvversion
= "5.6.0";
139 static struct tty_driver
*stl_serial
;
142 * Define a local default termios struct. All ports will be created
143 * with this termios initially. Basically all it defines is a raw port
144 * at 9600, 8 data bits, 1 stop bit.
146 static struct termios stl_deftermios
= {
147 .c_cflag
= (B9600
| CS8
| CREAD
| HUPCL
| CLOCAL
),
152 * Define global stats structures. Not used often, and can be
153 * re-used for each stats call.
155 static comstats_t stl_comstats
;
156 static combrd_t stl_brdstats
;
157 static stlbrd_t stl_dummybrd
;
158 static stlport_t stl_dummyport
;
161 * Define global place to put buffer overflow characters.
163 static char stl_unwanted
[SC26198_RXFIFOSIZE
];
165 /*****************************************************************************/
167 static stlbrd_t
*stl_brds
[STL_MAXBRDS
];
170 * Per board state flags. Used with the state field of the board struct.
171 * Not really much here!
173 #define BRD_FOUND 0x1
176 * Define the port structure istate flags. These set of flags are
177 * modified at interrupt time - so setting and reseting them needs
178 * to be atomic. Use the bit clear/setting routines for this.
180 #define ASYI_TXBUSY 1
182 #define ASYI_DCDCHANGE 3
183 #define ASYI_TXFLOWED 4
186 * Define an array of board names as printable strings. Handy for
187 * referencing boards when printing trace and stuff.
189 static char *stl_brdnames
[] = {
221 /*****************************************************************************/
224 * Define some string labels for arguments passed from the module
225 * load line. These allow for easy board definitions, and easy
226 * modification of the io, memory and irq resoucres.
228 static int stl_nargs
= 0;
229 static char *board0
[4];
230 static char *board1
[4];
231 static char *board2
[4];
232 static char *board3
[4];
234 static char **stl_brdsp
[] = {
242 * Define a set of common board names, and types. This is used to
243 * parse any module arguments.
246 typedef struct stlbrdtype
{
251 static stlbrdtype_t stl_brdstr
[] = {
252 { "easyio", BRD_EASYIO
},
253 { "eio", BRD_EASYIO
},
254 { "20", BRD_EASYIO
},
255 { "ec8/32", BRD_ECH
},
256 { "ec8/32-at", BRD_ECH
},
257 { "ec8/32-isa", BRD_ECH
},
259 { "echat", BRD_ECH
},
261 { "ec8/32-mc", BRD_ECHMC
},
262 { "ec8/32-mca", BRD_ECHMC
},
263 { "echmc", BRD_ECHMC
},
264 { "echmca", BRD_ECHMC
},
266 { "ec8/32-pc", BRD_ECHPCI
},
267 { "ec8/32-pci", BRD_ECHPCI
},
268 { "26", BRD_ECHPCI
},
269 { "ec8/64-pc", BRD_ECH64PCI
},
270 { "ec8/64-pci", BRD_ECH64PCI
},
271 { "ech-pci", BRD_ECH64PCI
},
272 { "echpci", BRD_ECH64PCI
},
273 { "echpc", BRD_ECH64PCI
},
274 { "27", BRD_ECH64PCI
},
275 { "easyio-pc", BRD_EASYIOPCI
},
276 { "easyio-pci", BRD_EASYIOPCI
},
277 { "eio-pci", BRD_EASYIOPCI
},
278 { "eiopci", BRD_EASYIOPCI
},
279 { "28", BRD_EASYIOPCI
},
283 * Define the module agruments.
285 MODULE_AUTHOR("Greg Ungerer");
286 MODULE_DESCRIPTION("Stallion Multiport Serial Driver");
287 MODULE_LICENSE("GPL");
289 module_param_array(board0
, charp
, &stl_nargs
, 0);
290 MODULE_PARM_DESC(board0
, "Board 0 config -> name[,ioaddr[,ioaddr2][,irq]]");
291 module_param_array(board1
, charp
, &stl_nargs
, 0);
292 MODULE_PARM_DESC(board1
, "Board 1 config -> name[,ioaddr[,ioaddr2][,irq]]");
293 module_param_array(board2
, charp
, &stl_nargs
, 0);
294 MODULE_PARM_DESC(board2
, "Board 2 config -> name[,ioaddr[,ioaddr2][,irq]]");
295 module_param_array(board3
, charp
, &stl_nargs
, 0);
296 MODULE_PARM_DESC(board3
, "Board 3 config -> name[,ioaddr[,ioaddr2][,irq]]");
298 /*****************************************************************************/
301 * Hardware ID bits for the EasyIO and ECH boards. These defines apply
302 * to the directly accessible io ports of these boards (not the uarts -
303 * they are in cd1400.h and sc26198.h).
305 #define EIO_8PORTRS 0x04
306 #define EIO_4PORTRS 0x05
307 #define EIO_8PORTDI 0x00
308 #define EIO_8PORTM 0x06
310 #define EIO_IDBITMASK 0x07
312 #define EIO_BRDMASK 0xf0
315 #define ID_BRD16 0x30
317 #define EIO_INTRPEND 0x08
318 #define EIO_INTEDGE 0x00
319 #define EIO_INTLEVEL 0x08
323 #define ECH_IDBITMASK 0xe0
324 #define ECH_BRDENABLE 0x08
325 #define ECH_BRDDISABLE 0x00
326 #define ECH_INTENABLE 0x01
327 #define ECH_INTDISABLE 0x00
328 #define ECH_INTLEVEL 0x02
329 #define ECH_INTEDGE 0x00
330 #define ECH_INTRPEND 0x01
331 #define ECH_BRDRESET 0x01
333 #define ECHMC_INTENABLE 0x01
334 #define ECHMC_BRDRESET 0x02
336 #define ECH_PNLSTATUS 2
337 #define ECH_PNL16PORT 0x20
338 #define ECH_PNLIDMASK 0x07
339 #define ECH_PNLXPID 0x40
340 #define ECH_PNLINTRPEND 0x80
342 #define ECH_ADDR2MASK 0x1e0
345 * Define the vector mapping bits for the programmable interrupt board
346 * hardware. These bits encode the interrupt for the board to use - it
347 * is software selectable (except the EIO-8M).
349 static unsigned char stl_vecmap
[] = {
350 0xff, 0xff, 0xff, 0x04, 0x06, 0x05, 0xff, 0x07,
351 0xff, 0xff, 0x00, 0x02, 0x01, 0xff, 0xff, 0x03
355 * Lock ordering is that you may not take stallion_lock holding
359 static spinlock_t brd_lock
; /* Guard the board mapping */
360 static spinlock_t stallion_lock
; /* Guard the tty driver */
363 * Set up enable and disable macros for the ECH boards. They require
364 * the secondary io address space to be activated and deactivated.
365 * This way all ECH boards can share their secondary io region.
366 * If this is an ECH-PCI board then also need to set the page pointer
367 * to point to the correct page.
369 #define BRDENABLE(brdnr,pagenr) \
370 if (stl_brds[(brdnr)]->brdtype == BRD_ECH) \
371 outb((stl_brds[(brdnr)]->ioctrlval | ECH_BRDENABLE), \
372 stl_brds[(brdnr)]->ioctrl); \
373 else if (stl_brds[(brdnr)]->brdtype == BRD_ECHPCI) \
374 outb((pagenr), stl_brds[(brdnr)]->ioctrl);
376 #define BRDDISABLE(brdnr) \
377 if (stl_brds[(brdnr)]->brdtype == BRD_ECH) \
378 outb((stl_brds[(brdnr)]->ioctrlval | ECH_BRDDISABLE), \
379 stl_brds[(brdnr)]->ioctrl);
381 #define STL_CD1400MAXBAUD 230400
382 #define STL_SC26198MAXBAUD 460800
384 #define STL_BAUDBASE 115200
385 #define STL_CLOSEDELAY (5 * HZ / 10)
387 /*****************************************************************************/
392 * Define the Stallion PCI vendor and device IDs.
394 #ifndef PCI_VENDOR_ID_STALLION
395 #define PCI_VENDOR_ID_STALLION 0x124d
397 #ifndef PCI_DEVICE_ID_ECHPCI832
398 #define PCI_DEVICE_ID_ECHPCI832 0x0000
400 #ifndef PCI_DEVICE_ID_ECHPCI864
401 #define PCI_DEVICE_ID_ECHPCI864 0x0002
403 #ifndef PCI_DEVICE_ID_EIOPCI
404 #define PCI_DEVICE_ID_EIOPCI 0x0003
408 * Define structure to hold all Stallion PCI boards.
410 typedef struct stlpcibrd
{
411 unsigned short vendid
;
412 unsigned short devid
;
416 static stlpcibrd_t stl_pcibrds
[] = {
417 { PCI_VENDOR_ID_STALLION
, PCI_DEVICE_ID_ECHPCI864
, BRD_ECH64PCI
},
418 { PCI_VENDOR_ID_STALLION
, PCI_DEVICE_ID_EIOPCI
, BRD_EASYIOPCI
},
419 { PCI_VENDOR_ID_STALLION
, PCI_DEVICE_ID_ECHPCI832
, BRD_ECHPCI
},
420 { PCI_VENDOR_ID_NS
, PCI_DEVICE_ID_NS_87410
, BRD_ECHPCI
},
423 static int stl_nrpcibrds
= ARRAY_SIZE(stl_pcibrds
);
427 /*****************************************************************************/
430 * Define macros to extract a brd/port number from a minor number.
432 #define MINOR2BRD(min) (((min) & 0xc0) >> 6)
433 #define MINOR2PORT(min) ((min) & 0x3f)
436 * Define a baud rate table that converts termios baud rate selector
437 * into the actual baud rate value. All baud rate calculations are
438 * based on the actual baud rate required.
440 static unsigned int stl_baudrates
[] = {
441 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
442 9600, 19200, 38400, 57600, 115200, 230400, 460800, 921600
446 * Define some handy local macros...
449 #define MIN(a,b) (((a) <= (b)) ? (a) : (b))
452 #define TOLOWER(x) ((((x) >= 'A') && ((x) <= 'Z')) ? ((x) + 0x20) : (x))
454 /*****************************************************************************/
457 * Declare all those functions in this driver!
460 static void stl_argbrds(void);
461 static int stl_parsebrd(stlconf_t
*confp
, char **argp
);
463 static unsigned long stl_atol(char *str
);
465 static int stl_init(void);
466 static int stl_open(struct tty_struct
*tty
, struct file
*filp
);
467 static void stl_close(struct tty_struct
*tty
, struct file
*filp
);
468 static int stl_write(struct tty_struct
*tty
, const unsigned char *buf
, int count
);
469 static void stl_putchar(struct tty_struct
*tty
, unsigned char ch
);
470 static void stl_flushchars(struct tty_struct
*tty
);
471 static int stl_writeroom(struct tty_struct
*tty
);
472 static int stl_charsinbuffer(struct tty_struct
*tty
);
473 static int stl_ioctl(struct tty_struct
*tty
, struct file
*file
, unsigned int cmd
, unsigned long arg
);
474 static void stl_settermios(struct tty_struct
*tty
, struct termios
*old
);
475 static void stl_throttle(struct tty_struct
*tty
);
476 static void stl_unthrottle(struct tty_struct
*tty
);
477 static void stl_stop(struct tty_struct
*tty
);
478 static void stl_start(struct tty_struct
*tty
);
479 static void stl_flushbuffer(struct tty_struct
*tty
);
480 static void stl_breakctl(struct tty_struct
*tty
, int state
);
481 static void stl_waituntilsent(struct tty_struct
*tty
, int timeout
);
482 static void stl_sendxchar(struct tty_struct
*tty
, char ch
);
483 static void stl_hangup(struct tty_struct
*tty
);
484 static int stl_memioctl(struct inode
*ip
, struct file
*fp
, unsigned int cmd
, unsigned long arg
);
485 static int stl_portinfo(stlport_t
*portp
, int portnr
, char *pos
);
486 static int stl_readproc(char *page
, char **start
, off_t off
, int count
, int *eof
, void *data
);
488 static int stl_brdinit(stlbrd_t
*brdp
);
489 static int stl_initports(stlbrd_t
*brdp
, stlpanel_t
*panelp
);
490 static int stl_getserial(stlport_t
*portp
, struct serial_struct __user
*sp
);
491 static int stl_setserial(stlport_t
*portp
, struct serial_struct __user
*sp
);
492 static int stl_getbrdstats(combrd_t __user
*bp
);
493 static int stl_getportstats(stlport_t
*portp
, comstats_t __user
*cp
);
494 static int stl_clrportstats(stlport_t
*portp
, comstats_t __user
*cp
);
495 static int stl_getportstruct(stlport_t __user
*arg
);
496 static int stl_getbrdstruct(stlbrd_t __user
*arg
);
497 static int stl_waitcarrier(stlport_t
*portp
, struct file
*filp
);
498 static int stl_eiointr(stlbrd_t
*brdp
);
499 static int stl_echatintr(stlbrd_t
*brdp
);
500 static int stl_echmcaintr(stlbrd_t
*brdp
);
501 static int stl_echpciintr(stlbrd_t
*brdp
);
502 static int stl_echpci64intr(stlbrd_t
*brdp
);
503 static void stl_offintr(struct work_struct
*);
504 static stlbrd_t
*stl_allocbrd(void);
505 static stlport_t
*stl_getport(int brdnr
, int panelnr
, int portnr
);
507 static inline int stl_initbrds(void);
508 static inline int stl_initeio(stlbrd_t
*brdp
);
509 static inline int stl_initech(stlbrd_t
*brdp
);
510 static inline int stl_getbrdnr(void);
513 static inline int stl_findpcibrds(void);
514 static inline int stl_initpcibrd(int brdtype
, struct pci_dev
*devp
);
518 * CD1400 uart specific handling functions.
520 static void stl_cd1400setreg(stlport_t
*portp
, int regnr
, int value
);
521 static int stl_cd1400getreg(stlport_t
*portp
, int regnr
);
522 static int stl_cd1400updatereg(stlport_t
*portp
, int regnr
, int value
);
523 static int stl_cd1400panelinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
);
524 static void stl_cd1400portinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
, stlport_t
*portp
);
525 static void stl_cd1400setport(stlport_t
*portp
, struct termios
*tiosp
);
526 static int stl_cd1400getsignals(stlport_t
*portp
);
527 static void stl_cd1400setsignals(stlport_t
*portp
, int dtr
, int rts
);
528 static void stl_cd1400ccrwait(stlport_t
*portp
);
529 static void stl_cd1400enablerxtx(stlport_t
*portp
, int rx
, int tx
);
530 static void stl_cd1400startrxtx(stlport_t
*portp
, int rx
, int tx
);
531 static void stl_cd1400disableintrs(stlport_t
*portp
);
532 static void stl_cd1400sendbreak(stlport_t
*portp
, int len
);
533 static void stl_cd1400flowctrl(stlport_t
*portp
, int state
);
534 static void stl_cd1400sendflow(stlport_t
*portp
, int state
);
535 static void stl_cd1400flush(stlport_t
*portp
);
536 static int stl_cd1400datastate(stlport_t
*portp
);
537 static void stl_cd1400eiointr(stlpanel_t
*panelp
, unsigned int iobase
);
538 static void stl_cd1400echintr(stlpanel_t
*panelp
, unsigned int iobase
);
539 static void stl_cd1400txisr(stlpanel_t
*panelp
, int ioaddr
);
540 static void stl_cd1400rxisr(stlpanel_t
*panelp
, int ioaddr
);
541 static void stl_cd1400mdmisr(stlpanel_t
*panelp
, int ioaddr
);
543 static inline int stl_cd1400breakisr(stlport_t
*portp
, int ioaddr
);
546 * SC26198 uart specific handling functions.
548 static void stl_sc26198setreg(stlport_t
*portp
, int regnr
, int value
);
549 static int stl_sc26198getreg(stlport_t
*portp
, int regnr
);
550 static int stl_sc26198updatereg(stlport_t
*portp
, int regnr
, int value
);
551 static int stl_sc26198getglobreg(stlport_t
*portp
, int regnr
);
552 static int stl_sc26198panelinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
);
553 static void stl_sc26198portinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
, stlport_t
*portp
);
554 static void stl_sc26198setport(stlport_t
*portp
, struct termios
*tiosp
);
555 static int stl_sc26198getsignals(stlport_t
*portp
);
556 static void stl_sc26198setsignals(stlport_t
*portp
, int dtr
, int rts
);
557 static void stl_sc26198enablerxtx(stlport_t
*portp
, int rx
, int tx
);
558 static void stl_sc26198startrxtx(stlport_t
*portp
, int rx
, int tx
);
559 static void stl_sc26198disableintrs(stlport_t
*portp
);
560 static void stl_sc26198sendbreak(stlport_t
*portp
, int len
);
561 static void stl_sc26198flowctrl(stlport_t
*portp
, int state
);
562 static void stl_sc26198sendflow(stlport_t
*portp
, int state
);
563 static void stl_sc26198flush(stlport_t
*portp
);
564 static int stl_sc26198datastate(stlport_t
*portp
);
565 static void stl_sc26198wait(stlport_t
*portp
);
566 static void stl_sc26198txunflow(stlport_t
*portp
, struct tty_struct
*tty
);
567 static void stl_sc26198intr(stlpanel_t
*panelp
, unsigned int iobase
);
568 static void stl_sc26198txisr(stlport_t
*port
);
569 static void stl_sc26198rxisr(stlport_t
*port
, unsigned int iack
);
570 static void stl_sc26198rxbadch(stlport_t
*portp
, unsigned char status
, char ch
);
571 static void stl_sc26198rxbadchars(stlport_t
*portp
);
572 static void stl_sc26198otherisr(stlport_t
*port
, unsigned int iack
);
574 /*****************************************************************************/
577 * Generic UART support structure.
579 typedef struct uart
{
580 int (*panelinit
)(stlbrd_t
*brdp
, stlpanel_t
*panelp
);
581 void (*portinit
)(stlbrd_t
*brdp
, stlpanel_t
*panelp
, stlport_t
*portp
);
582 void (*setport
)(stlport_t
*portp
, struct termios
*tiosp
);
583 int (*getsignals
)(stlport_t
*portp
);
584 void (*setsignals
)(stlport_t
*portp
, int dtr
, int rts
);
585 void (*enablerxtx
)(stlport_t
*portp
, int rx
, int tx
);
586 void (*startrxtx
)(stlport_t
*portp
, int rx
, int tx
);
587 void (*disableintrs
)(stlport_t
*portp
);
588 void (*sendbreak
)(stlport_t
*portp
, int len
);
589 void (*flowctrl
)(stlport_t
*portp
, int state
);
590 void (*sendflow
)(stlport_t
*portp
, int state
);
591 void (*flush
)(stlport_t
*portp
);
592 int (*datastate
)(stlport_t
*portp
);
593 void (*intr
)(stlpanel_t
*panelp
, unsigned int iobase
);
597 * Define some macros to make calling these functions nice and clean.
599 #define stl_panelinit (* ((uart_t *) panelp->uartp)->panelinit)
600 #define stl_portinit (* ((uart_t *) portp->uartp)->portinit)
601 #define stl_setport (* ((uart_t *) portp->uartp)->setport)
602 #define stl_getsignals (* ((uart_t *) portp->uartp)->getsignals)
603 #define stl_setsignals (* ((uart_t *) portp->uartp)->setsignals)
604 #define stl_enablerxtx (* ((uart_t *) portp->uartp)->enablerxtx)
605 #define stl_startrxtx (* ((uart_t *) portp->uartp)->startrxtx)
606 #define stl_disableintrs (* ((uart_t *) portp->uartp)->disableintrs)
607 #define stl_sendbreak (* ((uart_t *) portp->uartp)->sendbreak)
608 #define stl_flowctrl (* ((uart_t *) portp->uartp)->flowctrl)
609 #define stl_sendflow (* ((uart_t *) portp->uartp)->sendflow)
610 #define stl_flush (* ((uart_t *) portp->uartp)->flush)
611 #define stl_datastate (* ((uart_t *) portp->uartp)->datastate)
613 /*****************************************************************************/
616 * CD1400 UART specific data initialization.
618 static uart_t stl_cd1400uart
= {
622 stl_cd1400getsignals
,
623 stl_cd1400setsignals
,
624 stl_cd1400enablerxtx
,
626 stl_cd1400disableintrs
,
636 * Define the offsets within the register bank of a cd1400 based panel.
637 * These io address offsets are common to the EasyIO board as well.
645 #define EREG_BANKSIZE 8
647 #define CD1400_CLK 25000000
648 #define CD1400_CLK8M 20000000
651 * Define the cd1400 baud rate clocks. These are used when calculating
652 * what clock and divisor to use for the required baud rate. Also
653 * define the maximum baud rate allowed, and the default base baud.
655 static int stl_cd1400clkdivs
[] = {
656 CD1400_CLK0
, CD1400_CLK1
, CD1400_CLK2
, CD1400_CLK3
, CD1400_CLK4
659 /*****************************************************************************/
662 * SC26198 UART specific data initization.
664 static uart_t stl_sc26198uart
= {
665 stl_sc26198panelinit
,
668 stl_sc26198getsignals
,
669 stl_sc26198setsignals
,
670 stl_sc26198enablerxtx
,
671 stl_sc26198startrxtx
,
672 stl_sc26198disableintrs
,
673 stl_sc26198sendbreak
,
677 stl_sc26198datastate
,
682 * Define the offsets within the register bank of a sc26198 based panel.
690 #define XP_BANKSIZE 4
693 * Define the sc26198 baud rate table. Offsets within the table
694 * represent the actual baud rate selector of sc26198 registers.
696 static unsigned int sc26198_baudtable
[] = {
697 50, 75, 150, 200, 300, 450, 600, 900, 1200, 1800, 2400, 3600,
698 4800, 7200, 9600, 14400, 19200, 28800, 38400, 57600, 115200,
699 230400, 460800, 921600
702 #define SC26198_NRBAUDS ARRAY_SIZE(sc26198_baudtable)
704 /*****************************************************************************/
707 * Define the driver info for a user level control device. Used mainly
708 * to get at port stats - only not using the port device itself.
710 static const struct file_operations stl_fsiomem
= {
711 .owner
= THIS_MODULE
,
712 .ioctl
= stl_memioctl
,
715 /*****************************************************************************/
717 static struct class *stallion_class
;
720 * Loadable module initialization stuff.
723 static int __init
stallion_module_init(void)
729 /*****************************************************************************/
731 static void __exit
stallion_module_exit(void)
738 pr_debug("cleanup_module()\n");
740 printk(KERN_INFO
"Unloading %s: version %s\n", stl_drvtitle
,
744 * Free up all allocated resources used by the ports. This includes
745 * memory and interrupts. As part of this process we will also do
746 * a hangup on every open port - to try to flush out any processes
747 * hanging onto ports.
749 i
= tty_unregister_driver(stl_serial
);
750 put_tty_driver(stl_serial
);
752 printk("STALLION: failed to un-register tty driver, "
756 for (i
= 0; i
< 4; i
++)
757 class_device_destroy(stallion_class
, MKDEV(STL_SIOMEMMAJOR
, i
));
758 if ((i
= unregister_chrdev(STL_SIOMEMMAJOR
, "staliomem")))
759 printk("STALLION: failed to un-register serial memory device, "
761 class_destroy(stallion_class
);
763 for (i
= 0; (i
< stl_nrbrds
); i
++) {
764 if ((brdp
= stl_brds
[i
]) == (stlbrd_t
*) NULL
)
767 free_irq(brdp
->irq
, brdp
);
769 for (j
= 0; (j
< STL_MAXPANELS
); j
++) {
770 panelp
= brdp
->panels
[j
];
771 if (panelp
== (stlpanel_t
*) NULL
)
773 for (k
= 0; (k
< STL_PORTSPERPANEL
); k
++) {
774 portp
= panelp
->ports
[k
];
775 if (portp
== (stlport_t
*) NULL
)
777 if (portp
->tty
!= (struct tty_struct
*) NULL
)
778 stl_hangup(portp
->tty
);
779 kfree(portp
->tx
.buf
);
785 release_region(brdp
->ioaddr1
, brdp
->iosize1
);
786 if (brdp
->iosize2
> 0)
787 release_region(brdp
->ioaddr2
, brdp
->iosize2
);
790 stl_brds
[i
] = (stlbrd_t
*) NULL
;
794 module_init(stallion_module_init
);
795 module_exit(stallion_module_exit
);
797 /*****************************************************************************/
800 * Check for any arguments passed in on the module load command line.
803 static void stl_argbrds(void)
809 pr_debug("stl_argbrds()\n");
811 for (i
= stl_nrbrds
; (i
< stl_nargs
); i
++) {
812 memset(&conf
, 0, sizeof(conf
));
813 if (stl_parsebrd(&conf
, stl_brdsp
[i
]) == 0)
815 if ((brdp
= stl_allocbrd()) == (stlbrd_t
*) NULL
)
819 brdp
->brdtype
= conf
.brdtype
;
820 brdp
->ioaddr1
= conf
.ioaddr1
;
821 brdp
->ioaddr2
= conf
.ioaddr2
;
822 brdp
->irq
= conf
.irq
;
823 brdp
->irqtype
= conf
.irqtype
;
828 /*****************************************************************************/
831 * Convert an ascii string number into an unsigned long.
834 static unsigned long stl_atol(char *str
)
842 if ((*sp
== '0') && (*(sp
+1) == 'x')) {
845 } else if (*sp
== '0') {
852 for (; (*sp
!= 0); sp
++) {
853 c
= (*sp
> '9') ? (TOLOWER(*sp
) - 'a' + 10) : (*sp
- '0');
854 if ((c
< 0) || (c
>= base
)) {
855 printk("STALLION: invalid argument %s\n", str
);
859 val
= (val
* base
) + c
;
864 /*****************************************************************************/
867 * Parse the supplied argument string, into the board conf struct.
870 static int stl_parsebrd(stlconf_t
*confp
, char **argp
)
875 pr_debug("stl_parsebrd(confp=%p,argp=%p)\n", confp
, argp
);
877 if ((argp
[0] == (char *) NULL
) || (*argp
[0] == 0))
880 for (sp
= argp
[0], i
= 0; ((*sp
!= 0) && (i
< 25)); sp
++, i
++)
883 for (i
= 0; i
< ARRAY_SIZE(stl_brdstr
); i
++) {
884 if (strcmp(stl_brdstr
[i
].name
, argp
[0]) == 0)
887 if (i
== ARRAY_SIZE(stl_brdstr
)) {
888 printk("STALLION: unknown board name, %s?\n", argp
[0]);
892 confp
->brdtype
= stl_brdstr
[i
].type
;
895 if ((argp
[i
] != (char *) NULL
) && (*argp
[i
] != 0))
896 confp
->ioaddr1
= stl_atol(argp
[i
]);
898 if (confp
->brdtype
== BRD_ECH
) {
899 if ((argp
[i
] != (char *) NULL
) && (*argp
[i
] != 0))
900 confp
->ioaddr2
= stl_atol(argp
[i
]);
903 if ((argp
[i
] != (char *) NULL
) && (*argp
[i
] != 0))
904 confp
->irq
= stl_atol(argp
[i
]);
908 /*****************************************************************************/
911 * Allocate a new board structure. Fill out the basic info in it.
914 static stlbrd_t
*stl_allocbrd(void)
918 brdp
= kzalloc(sizeof(stlbrd_t
), GFP_KERNEL
);
920 printk("STALLION: failed to allocate memory (size=%Zd)\n",
925 brdp
->magic
= STL_BOARDMAGIC
;
929 /*****************************************************************************/
931 static int stl_open(struct tty_struct
*tty
, struct file
*filp
)
935 unsigned int minordev
;
936 int brdnr
, panelnr
, portnr
, rc
;
938 pr_debug("stl_open(tty=%p,filp=%p): device=%s\n", tty
, filp
, tty
->name
);
940 minordev
= tty
->index
;
941 brdnr
= MINOR2BRD(minordev
);
942 if (brdnr
>= stl_nrbrds
)
944 brdp
= stl_brds
[brdnr
];
945 if (brdp
== (stlbrd_t
*) NULL
)
947 minordev
= MINOR2PORT(minordev
);
948 for (portnr
= -1, panelnr
= 0; (panelnr
< STL_MAXPANELS
); panelnr
++) {
949 if (brdp
->panels
[panelnr
] == (stlpanel_t
*) NULL
)
951 if (minordev
< brdp
->panels
[panelnr
]->nrports
) {
955 minordev
-= brdp
->panels
[panelnr
]->nrports
;
960 portp
= brdp
->panels
[panelnr
]->ports
[portnr
];
961 if (portp
== (stlport_t
*) NULL
)
965 * On the first open of the device setup the port hardware, and
966 * initialize the per port data structure.
969 tty
->driver_data
= portp
;
972 if ((portp
->flags
& ASYNC_INITIALIZED
) == 0) {
973 if (!portp
->tx
.buf
) {
974 portp
->tx
.buf
= kmalloc(STL_TXBUFSIZE
, GFP_KERNEL
);
977 portp
->tx
.head
= portp
->tx
.buf
;
978 portp
->tx
.tail
= portp
->tx
.buf
;
980 stl_setport(portp
, tty
->termios
);
981 portp
->sigs
= stl_getsignals(portp
);
982 stl_setsignals(portp
, 1, 1);
983 stl_enablerxtx(portp
, 1, 1);
984 stl_startrxtx(portp
, 1, 0);
985 clear_bit(TTY_IO_ERROR
, &tty
->flags
);
986 portp
->flags
|= ASYNC_INITIALIZED
;
990 * Check if this port is in the middle of closing. If so then wait
991 * until it is closed then return error status, based on flag settings.
992 * The sleep here does not need interrupt protection since the wakeup
993 * for it is done with the same context.
995 if (portp
->flags
& ASYNC_CLOSING
) {
996 interruptible_sleep_on(&portp
->close_wait
);
997 if (portp
->flags
& ASYNC_HUP_NOTIFY
)
1003 * Based on type of open being done check if it can overlap with any
1004 * previous opens still in effect. If we are a normal serial device
1005 * then also we might have to wait for carrier.
1007 if (!(filp
->f_flags
& O_NONBLOCK
)) {
1008 if ((rc
= stl_waitcarrier(portp
, filp
)) != 0)
1011 portp
->flags
|= ASYNC_NORMAL_ACTIVE
;
1016 /*****************************************************************************/
1019 * Possibly need to wait for carrier (DCD signal) to come high. Say
1020 * maybe because if we are clocal then we don't need to wait...
1023 static int stl_waitcarrier(stlport_t
*portp
, struct file
*filp
)
1025 unsigned long flags
;
1028 pr_debug("stl_waitcarrier(portp=%p,filp=%p)\n", portp
, filp
);
1033 spin_lock_irqsave(&stallion_lock
, flags
);
1035 if (portp
->tty
->termios
->c_cflag
& CLOCAL
)
1038 portp
->openwaitcnt
++;
1039 if (! tty_hung_up_p(filp
))
1043 /* Takes brd_lock internally */
1044 stl_setsignals(portp
, 1, 1);
1045 if (tty_hung_up_p(filp
) ||
1046 ((portp
->flags
& ASYNC_INITIALIZED
) == 0)) {
1047 if (portp
->flags
& ASYNC_HUP_NOTIFY
)
1053 if (((portp
->flags
& ASYNC_CLOSING
) == 0) &&
1054 (doclocal
|| (portp
->sigs
& TIOCM_CD
))) {
1057 if (signal_pending(current
)) {
1062 interruptible_sleep_on(&portp
->open_wait
);
1065 if (! tty_hung_up_p(filp
))
1067 portp
->openwaitcnt
--;
1068 spin_unlock_irqrestore(&stallion_lock
, flags
);
1073 /*****************************************************************************/
1075 static void stl_close(struct tty_struct
*tty
, struct file
*filp
)
1078 unsigned long flags
;
1080 pr_debug("stl_close(tty=%p,filp=%p)\n", tty
, filp
);
1082 portp
= tty
->driver_data
;
1083 if (portp
== (stlport_t
*) NULL
)
1086 spin_lock_irqsave(&stallion_lock
, flags
);
1087 if (tty_hung_up_p(filp
)) {
1088 spin_unlock_irqrestore(&stallion_lock
, flags
);
1091 if ((tty
->count
== 1) && (portp
->refcount
!= 1))
1092 portp
->refcount
= 1;
1093 if (portp
->refcount
-- > 1) {
1094 spin_unlock_irqrestore(&stallion_lock
, flags
);
1098 portp
->refcount
= 0;
1099 portp
->flags
|= ASYNC_CLOSING
;
1102 * May want to wait for any data to drain before closing. The BUSY
1103 * flag keeps track of whether we are still sending or not - it is
1104 * very accurate for the cd1400, not quite so for the sc26198.
1105 * (The sc26198 has no "end-of-data" interrupt only empty FIFO)
1109 spin_unlock_irqrestore(&stallion_lock
, flags
);
1111 if (portp
->closing_wait
!= ASYNC_CLOSING_WAIT_NONE
)
1112 tty_wait_until_sent(tty
, portp
->closing_wait
);
1113 stl_waituntilsent(tty
, (HZ
/ 2));
1116 spin_lock_irqsave(&stallion_lock
, flags
);
1117 portp
->flags
&= ~ASYNC_INITIALIZED
;
1118 spin_unlock_irqrestore(&stallion_lock
, flags
);
1120 stl_disableintrs(portp
);
1121 if (tty
->termios
->c_cflag
& HUPCL
)
1122 stl_setsignals(portp
, 0, 0);
1123 stl_enablerxtx(portp
, 0, 0);
1124 stl_flushbuffer(tty
);
1126 if (portp
->tx
.buf
!= (char *) NULL
) {
1127 kfree(portp
->tx
.buf
);
1128 portp
->tx
.buf
= (char *) NULL
;
1129 portp
->tx
.head
= (char *) NULL
;
1130 portp
->tx
.tail
= (char *) NULL
;
1132 set_bit(TTY_IO_ERROR
, &tty
->flags
);
1133 tty_ldisc_flush(tty
);
1136 portp
->tty
= (struct tty_struct
*) NULL
;
1138 if (portp
->openwaitcnt
) {
1139 if (portp
->close_delay
)
1140 msleep_interruptible(jiffies_to_msecs(portp
->close_delay
));
1141 wake_up_interruptible(&portp
->open_wait
);
1144 portp
->flags
&= ~(ASYNC_NORMAL_ACTIVE
|ASYNC_CLOSING
);
1145 wake_up_interruptible(&portp
->close_wait
);
1148 /*****************************************************************************/
1151 * Write routine. Take data and stuff it in to the TX ring queue.
1152 * If transmit interrupts are not running then start them.
1155 static int stl_write(struct tty_struct
*tty
, const unsigned char *buf
, int count
)
1158 unsigned int len
, stlen
;
1159 unsigned char *chbuf
;
1162 pr_debug("stl_write(tty=%p,buf=%p,count=%d)\n", tty
, buf
, count
);
1164 portp
= tty
->driver_data
;
1165 if (portp
== (stlport_t
*) NULL
)
1167 if (portp
->tx
.buf
== (char *) NULL
)
1171 * If copying direct from user space we must cater for page faults,
1172 * causing us to "sleep" here for a while. To handle this copy in all
1173 * the data we need now, into a local buffer. Then when we got it all
1174 * copy it into the TX buffer.
1176 chbuf
= (unsigned char *) buf
;
1178 head
= portp
->tx
.head
;
1179 tail
= portp
->tx
.tail
;
1181 len
= STL_TXBUFSIZE
- (head
- tail
) - 1;
1182 stlen
= STL_TXBUFSIZE
- (head
- portp
->tx
.buf
);
1184 len
= tail
- head
- 1;
1188 len
= MIN(len
, count
);
1191 stlen
= MIN(len
, stlen
);
1192 memcpy(head
, chbuf
, stlen
);
1197 if (head
>= (portp
->tx
.buf
+ STL_TXBUFSIZE
)) {
1198 head
= portp
->tx
.buf
;
1199 stlen
= tail
- head
;
1202 portp
->tx
.head
= head
;
1204 clear_bit(ASYI_TXLOW
, &portp
->istate
);
1205 stl_startrxtx(portp
, -1, 1);
1210 /*****************************************************************************/
1212 static void stl_putchar(struct tty_struct
*tty
, unsigned char ch
)
1218 pr_debug("stl_putchar(tty=%p,ch=%x)\n", tty
, ch
);
1220 if (tty
== (struct tty_struct
*) NULL
)
1222 portp
= tty
->driver_data
;
1223 if (portp
== (stlport_t
*) NULL
)
1225 if (portp
->tx
.buf
== (char *) NULL
)
1228 head
= portp
->tx
.head
;
1229 tail
= portp
->tx
.tail
;
1231 len
= (head
>= tail
) ? (STL_TXBUFSIZE
- (head
- tail
)) : (tail
- head
);
1236 if (head
>= (portp
->tx
.buf
+ STL_TXBUFSIZE
))
1237 head
= portp
->tx
.buf
;
1239 portp
->tx
.head
= head
;
1242 /*****************************************************************************/
1245 * If there are any characters in the buffer then make sure that TX
1246 * interrupts are on and get'em out. Normally used after the putchar
1247 * routine has been called.
1250 static void stl_flushchars(struct tty_struct
*tty
)
1254 pr_debug("stl_flushchars(tty=%p)\n", tty
);
1256 if (tty
== (struct tty_struct
*) NULL
)
1258 portp
= tty
->driver_data
;
1259 if (portp
== (stlport_t
*) NULL
)
1261 if (portp
->tx
.buf
== (char *) NULL
)
1264 stl_startrxtx(portp
, -1, 1);
1267 /*****************************************************************************/
1269 static int stl_writeroom(struct tty_struct
*tty
)
1274 pr_debug("stl_writeroom(tty=%p)\n", tty
);
1276 if (tty
== (struct tty_struct
*) NULL
)
1278 portp
= tty
->driver_data
;
1279 if (portp
== (stlport_t
*) NULL
)
1281 if (portp
->tx
.buf
== (char *) NULL
)
1284 head
= portp
->tx
.head
;
1285 tail
= portp
->tx
.tail
;
1286 return ((head
>= tail
) ? (STL_TXBUFSIZE
- (head
- tail
) - 1) : (tail
- head
- 1));
1289 /*****************************************************************************/
1292 * Return number of chars in the TX buffer. Normally we would just
1293 * calculate the number of chars in the buffer and return that, but if
1294 * the buffer is empty and TX interrupts are still on then we return
1295 * that the buffer still has 1 char in it. This way whoever called us
1296 * will not think that ALL chars have drained - since the UART still
1297 * must have some chars in it (we are busy after all).
1300 static int stl_charsinbuffer(struct tty_struct
*tty
)
1306 pr_debug("stl_charsinbuffer(tty=%p)\n", tty
);
1308 if (tty
== (struct tty_struct
*) NULL
)
1310 portp
= tty
->driver_data
;
1311 if (portp
== (stlport_t
*) NULL
)
1313 if (portp
->tx
.buf
== (char *) NULL
)
1316 head
= portp
->tx
.head
;
1317 tail
= portp
->tx
.tail
;
1318 size
= (head
>= tail
) ? (head
- tail
) : (STL_TXBUFSIZE
- (tail
- head
));
1319 if ((size
== 0) && test_bit(ASYI_TXBUSY
, &portp
->istate
))
1324 /*****************************************************************************/
1327 * Generate the serial struct info.
1330 static int stl_getserial(stlport_t
*portp
, struct serial_struct __user
*sp
)
1332 struct serial_struct sio
;
1335 pr_debug("stl_getserial(portp=%p,sp=%p)\n", portp
, sp
);
1337 memset(&sio
, 0, sizeof(struct serial_struct
));
1338 sio
.line
= portp
->portnr
;
1339 sio
.port
= portp
->ioaddr
;
1340 sio
.flags
= portp
->flags
;
1341 sio
.baud_base
= portp
->baud_base
;
1342 sio
.close_delay
= portp
->close_delay
;
1343 sio
.closing_wait
= portp
->closing_wait
;
1344 sio
.custom_divisor
= portp
->custom_divisor
;
1346 if (portp
->uartp
== &stl_cd1400uart
) {
1347 sio
.type
= PORT_CIRRUS
;
1348 sio
.xmit_fifo_size
= CD1400_TXFIFOSIZE
;
1350 sio
.type
= PORT_UNKNOWN
;
1351 sio
.xmit_fifo_size
= SC26198_TXFIFOSIZE
;
1354 brdp
= stl_brds
[portp
->brdnr
];
1355 if (brdp
!= (stlbrd_t
*) NULL
)
1356 sio
.irq
= brdp
->irq
;
1358 return copy_to_user(sp
, &sio
, sizeof(struct serial_struct
)) ? -EFAULT
: 0;
1361 /*****************************************************************************/
1364 * Set port according to the serial struct info.
1365 * At this point we do not do any auto-configure stuff, so we will
1366 * just quietly ignore any requests to change irq, etc.
1369 static int stl_setserial(stlport_t
*portp
, struct serial_struct __user
*sp
)
1371 struct serial_struct sio
;
1373 pr_debug("stl_setserial(portp=%p,sp=%p)\n", portp
, sp
);
1375 if (copy_from_user(&sio
, sp
, sizeof(struct serial_struct
)))
1377 if (!capable(CAP_SYS_ADMIN
)) {
1378 if ((sio
.baud_base
!= portp
->baud_base
) ||
1379 (sio
.close_delay
!= portp
->close_delay
) ||
1380 ((sio
.flags
& ~ASYNC_USR_MASK
) !=
1381 (portp
->flags
& ~ASYNC_USR_MASK
)))
1385 portp
->flags
= (portp
->flags
& ~ASYNC_USR_MASK
) |
1386 (sio
.flags
& ASYNC_USR_MASK
);
1387 portp
->baud_base
= sio
.baud_base
;
1388 portp
->close_delay
= sio
.close_delay
;
1389 portp
->closing_wait
= sio
.closing_wait
;
1390 portp
->custom_divisor
= sio
.custom_divisor
;
1391 stl_setport(portp
, portp
->tty
->termios
);
1395 /*****************************************************************************/
1397 static int stl_tiocmget(struct tty_struct
*tty
, struct file
*file
)
1401 if (tty
== (struct tty_struct
*) NULL
)
1403 portp
= tty
->driver_data
;
1404 if (portp
== (stlport_t
*) NULL
)
1406 if (tty
->flags
& (1 << TTY_IO_ERROR
))
1409 return stl_getsignals(portp
);
1412 static int stl_tiocmset(struct tty_struct
*tty
, struct file
*file
,
1413 unsigned int set
, unsigned int clear
)
1416 int rts
= -1, dtr
= -1;
1418 if (tty
== (struct tty_struct
*) NULL
)
1420 portp
= tty
->driver_data
;
1421 if (portp
== (stlport_t
*) NULL
)
1423 if (tty
->flags
& (1 << TTY_IO_ERROR
))
1426 if (set
& TIOCM_RTS
)
1428 if (set
& TIOCM_DTR
)
1430 if (clear
& TIOCM_RTS
)
1432 if (clear
& TIOCM_DTR
)
1435 stl_setsignals(portp
, dtr
, rts
);
1439 static int stl_ioctl(struct tty_struct
*tty
, struct file
*file
, unsigned int cmd
, unsigned long arg
)
1444 void __user
*argp
= (void __user
*)arg
;
1446 pr_debug("stl_ioctl(tty=%p,file=%p,cmd=%x,arg=%lx)\n", tty
, file
, cmd
,
1449 if (tty
== (struct tty_struct
*) NULL
)
1451 portp
= tty
->driver_data
;
1452 if (portp
== (stlport_t
*) NULL
)
1455 if ((cmd
!= TIOCGSERIAL
) && (cmd
!= TIOCSSERIAL
) &&
1456 (cmd
!= COM_GETPORTSTATS
) && (cmd
!= COM_CLRPORTSTATS
)) {
1457 if (tty
->flags
& (1 << TTY_IO_ERROR
))
1465 rc
= put_user(((tty
->termios
->c_cflag
& CLOCAL
) ? 1 : 0),
1466 (unsigned __user
*) argp
);
1469 if (get_user(ival
, (unsigned int __user
*) arg
))
1471 tty
->termios
->c_cflag
=
1472 (tty
->termios
->c_cflag
& ~CLOCAL
) |
1473 (ival
? CLOCAL
: 0);
1476 rc
= stl_getserial(portp
, argp
);
1479 rc
= stl_setserial(portp
, argp
);
1481 case COM_GETPORTSTATS
:
1482 rc
= stl_getportstats(portp
, argp
);
1484 case COM_CLRPORTSTATS
:
1485 rc
= stl_clrportstats(portp
, argp
);
1491 case TIOCSERGSTRUCT
:
1492 case TIOCSERGETMULTI
:
1493 case TIOCSERSETMULTI
:
1502 /*****************************************************************************/
1504 static void stl_settermios(struct tty_struct
*tty
, struct termios
*old
)
1507 struct termios
*tiosp
;
1509 pr_debug("stl_settermios(tty=%p,old=%p)\n", tty
, old
);
1511 if (tty
== (struct tty_struct
*) NULL
)
1513 portp
= tty
->driver_data
;
1514 if (portp
== (stlport_t
*) NULL
)
1517 tiosp
= tty
->termios
;
1518 if ((tiosp
->c_cflag
== old
->c_cflag
) &&
1519 (tiosp
->c_iflag
== old
->c_iflag
))
1522 stl_setport(portp
, tiosp
);
1523 stl_setsignals(portp
, ((tiosp
->c_cflag
& (CBAUD
& ~CBAUDEX
)) ? 1 : 0),
1525 if ((old
->c_cflag
& CRTSCTS
) && ((tiosp
->c_cflag
& CRTSCTS
) == 0)) {
1526 tty
->hw_stopped
= 0;
1529 if (((old
->c_cflag
& CLOCAL
) == 0) && (tiosp
->c_cflag
& CLOCAL
))
1530 wake_up_interruptible(&portp
->open_wait
);
1533 /*****************************************************************************/
1536 * Attempt to flow control who ever is sending us data. Based on termios
1537 * settings use software or/and hardware flow control.
1540 static void stl_throttle(struct tty_struct
*tty
)
1544 pr_debug("stl_throttle(tty=%p)\n", tty
);
1546 if (tty
== (struct tty_struct
*) NULL
)
1548 portp
= tty
->driver_data
;
1549 if (portp
== (stlport_t
*) NULL
)
1551 stl_flowctrl(portp
, 0);
1554 /*****************************************************************************/
1557 * Unflow control the device sending us data...
1560 static void stl_unthrottle(struct tty_struct
*tty
)
1564 pr_debug("stl_unthrottle(tty=%p)\n", tty
);
1566 if (tty
== (struct tty_struct
*) NULL
)
1568 portp
= tty
->driver_data
;
1569 if (portp
== (stlport_t
*) NULL
)
1571 stl_flowctrl(portp
, 1);
1574 /*****************************************************************************/
1577 * Stop the transmitter. Basically to do this we will just turn TX
1581 static void stl_stop(struct tty_struct
*tty
)
1585 pr_debug("stl_stop(tty=%p)\n", tty
);
1587 if (tty
== (struct tty_struct
*) NULL
)
1589 portp
= tty
->driver_data
;
1590 if (portp
== (stlport_t
*) NULL
)
1592 stl_startrxtx(portp
, -1, 0);
1595 /*****************************************************************************/
1598 * Start the transmitter again. Just turn TX interrupts back on.
1601 static void stl_start(struct tty_struct
*tty
)
1605 pr_debug("stl_start(tty=%p)\n", tty
);
1607 if (tty
== (struct tty_struct
*) NULL
)
1609 portp
= tty
->driver_data
;
1610 if (portp
== (stlport_t
*) NULL
)
1612 stl_startrxtx(portp
, -1, 1);
1615 /*****************************************************************************/
1618 * Hangup this port. This is pretty much like closing the port, only
1619 * a little more brutal. No waiting for data to drain. Shutdown the
1620 * port and maybe drop signals.
1623 static void stl_hangup(struct tty_struct
*tty
)
1627 pr_debug("stl_hangup(tty=%p)\n", tty
);
1629 if (tty
== (struct tty_struct
*) NULL
)
1631 portp
= tty
->driver_data
;
1632 if (portp
== (stlport_t
*) NULL
)
1635 portp
->flags
&= ~ASYNC_INITIALIZED
;
1636 stl_disableintrs(portp
);
1637 if (tty
->termios
->c_cflag
& HUPCL
)
1638 stl_setsignals(portp
, 0, 0);
1639 stl_enablerxtx(portp
, 0, 0);
1640 stl_flushbuffer(tty
);
1642 set_bit(TTY_IO_ERROR
, &tty
->flags
);
1643 if (portp
->tx
.buf
!= (char *) NULL
) {
1644 kfree(portp
->tx
.buf
);
1645 portp
->tx
.buf
= (char *) NULL
;
1646 portp
->tx
.head
= (char *) NULL
;
1647 portp
->tx
.tail
= (char *) NULL
;
1649 portp
->tty
= (struct tty_struct
*) NULL
;
1650 portp
->flags
&= ~ASYNC_NORMAL_ACTIVE
;
1651 portp
->refcount
= 0;
1652 wake_up_interruptible(&portp
->open_wait
);
1655 /*****************************************************************************/
1657 static void stl_flushbuffer(struct tty_struct
*tty
)
1661 pr_debug("stl_flushbuffer(tty=%p)\n", tty
);
1663 if (tty
== (struct tty_struct
*) NULL
)
1665 portp
= tty
->driver_data
;
1666 if (portp
== (stlport_t
*) NULL
)
1673 /*****************************************************************************/
1675 static void stl_breakctl(struct tty_struct
*tty
, int state
)
1679 pr_debug("stl_breakctl(tty=%p,state=%d)\n", tty
, state
);
1681 if (tty
== (struct tty_struct
*) NULL
)
1683 portp
= tty
->driver_data
;
1684 if (portp
== (stlport_t
*) NULL
)
1687 stl_sendbreak(portp
, ((state
== -1) ? 1 : 2));
1690 /*****************************************************************************/
1692 static void stl_waituntilsent(struct tty_struct
*tty
, int timeout
)
1697 pr_debug("stl_waituntilsent(tty=%p,timeout=%d)\n", tty
, timeout
);
1699 if (tty
== (struct tty_struct
*) NULL
)
1701 portp
= tty
->driver_data
;
1702 if (portp
== (stlport_t
*) NULL
)
1707 tend
= jiffies
+ timeout
;
1709 while (stl_datastate(portp
)) {
1710 if (signal_pending(current
))
1712 msleep_interruptible(20);
1713 if (time_after_eq(jiffies
, tend
))
1718 /*****************************************************************************/
1720 static void stl_sendxchar(struct tty_struct
*tty
, char ch
)
1724 pr_debug("stl_sendxchar(tty=%p,ch=%x)\n", tty
, ch
);
1726 if (tty
== (struct tty_struct
*) NULL
)
1728 portp
= tty
->driver_data
;
1729 if (portp
== (stlport_t
*) NULL
)
1732 if (ch
== STOP_CHAR(tty
))
1733 stl_sendflow(portp
, 0);
1734 else if (ch
== START_CHAR(tty
))
1735 stl_sendflow(portp
, 1);
1737 stl_putchar(tty
, ch
);
1740 /*****************************************************************************/
1745 * Format info for a specified port. The line is deliberately limited
1746 * to 80 characters. (If it is too long it will be truncated, if too
1747 * short then padded with spaces).
1750 static int stl_portinfo(stlport_t
*portp
, int portnr
, char *pos
)
1756 sp
+= sprintf(sp
, "%d: uart:%s tx:%d rx:%d",
1757 portnr
, (portp
->hwid
== 1) ? "SC26198" : "CD1400",
1758 (int) portp
->stats
.txtotal
, (int) portp
->stats
.rxtotal
);
1760 if (portp
->stats
.rxframing
)
1761 sp
+= sprintf(sp
, " fe:%d", (int) portp
->stats
.rxframing
);
1762 if (portp
->stats
.rxparity
)
1763 sp
+= sprintf(sp
, " pe:%d", (int) portp
->stats
.rxparity
);
1764 if (portp
->stats
.rxbreaks
)
1765 sp
+= sprintf(sp
, " brk:%d", (int) portp
->stats
.rxbreaks
);
1766 if (portp
->stats
.rxoverrun
)
1767 sp
+= sprintf(sp
, " oe:%d", (int) portp
->stats
.rxoverrun
);
1769 sigs
= stl_getsignals(portp
);
1770 cnt
= sprintf(sp
, "%s%s%s%s%s ",
1771 (sigs
& TIOCM_RTS
) ? "|RTS" : "",
1772 (sigs
& TIOCM_CTS
) ? "|CTS" : "",
1773 (sigs
& TIOCM_DTR
) ? "|DTR" : "",
1774 (sigs
& TIOCM_CD
) ? "|DCD" : "",
1775 (sigs
& TIOCM_DSR
) ? "|DSR" : "");
1779 for (cnt
= (sp
- pos
); (cnt
< (MAXLINE
- 1)); cnt
++)
1782 pos
[(MAXLINE
- 2)] = '+';
1783 pos
[(MAXLINE
- 1)] = '\n';
1788 /*****************************************************************************/
1791 * Port info, read from the /proc file system.
1794 static int stl_readproc(char *page
, char **start
, off_t off
, int count
, int *eof
, void *data
)
1799 int brdnr
, panelnr
, portnr
, totalport
;
1803 pr_debug("stl_readproc(page=%p,start=%p,off=%lx,count=%d,eof=%p,"
1804 "data=%p\n", page
, start
, off
, count
, eof
, data
);
1811 pos
+= sprintf(pos
, "%s: version %s", stl_drvtitle
,
1813 while (pos
< (page
+ MAXLINE
- 1))
1820 * We scan through for each board, panel and port. The offset is
1821 * calculated on the fly, and irrelevant ports are skipped.
1823 for (brdnr
= 0; (brdnr
< stl_nrbrds
); brdnr
++) {
1824 brdp
= stl_brds
[brdnr
];
1825 if (brdp
== (stlbrd_t
*) NULL
)
1827 if (brdp
->state
== 0)
1830 maxoff
= curoff
+ (brdp
->nrports
* MAXLINE
);
1831 if (off
>= maxoff
) {
1836 totalport
= brdnr
* STL_MAXPORTS
;
1837 for (panelnr
= 0; (panelnr
< brdp
->nrpanels
); panelnr
++) {
1838 panelp
= brdp
->panels
[panelnr
];
1839 if (panelp
== (stlpanel_t
*) NULL
)
1842 maxoff
= curoff
+ (panelp
->nrports
* MAXLINE
);
1843 if (off
>= maxoff
) {
1845 totalport
+= panelp
->nrports
;
1849 for (portnr
= 0; (portnr
< panelp
->nrports
); portnr
++,
1851 portp
= panelp
->ports
[portnr
];
1852 if (portp
== (stlport_t
*) NULL
)
1854 if (off
>= (curoff
+= MAXLINE
))
1856 if ((pos
- page
+ MAXLINE
) > count
)
1858 pos
+= stl_portinfo(portp
, totalport
, pos
);
1867 return (pos
- page
);
1870 /*****************************************************************************/
1873 * All board interrupts are vectored through here first. This code then
1874 * calls off to the approrpriate board interrupt handlers.
1877 static irqreturn_t
stl_intr(int irq
, void *dev_id
)
1879 stlbrd_t
*brdp
= (stlbrd_t
*) dev_id
;
1881 pr_debug("stl_intr(brdp=%p,irq=%d)\n", brdp
, irq
);
1883 return IRQ_RETVAL((* brdp
->isr
)(brdp
));
1886 /*****************************************************************************/
1889 * Interrupt service routine for EasyIO board types.
1892 static int stl_eiointr(stlbrd_t
*brdp
)
1895 unsigned int iobase
;
1898 spin_lock(&brd_lock
);
1899 panelp
= brdp
->panels
[0];
1900 iobase
= panelp
->iobase
;
1901 while (inb(brdp
->iostatus
) & EIO_INTRPEND
) {
1903 (* panelp
->isr
)(panelp
, iobase
);
1905 spin_unlock(&brd_lock
);
1909 /*****************************************************************************/
1912 * Interrupt service routine for ECH-AT board types.
1915 static int stl_echatintr(stlbrd_t
*brdp
)
1918 unsigned int ioaddr
;
1922 outb((brdp
->ioctrlval
| ECH_BRDENABLE
), brdp
->ioctrl
);
1924 while (inb(brdp
->iostatus
) & ECH_INTRPEND
) {
1926 for (bnknr
= 0; (bnknr
< brdp
->nrbnks
); bnknr
++) {
1927 ioaddr
= brdp
->bnkstataddr
[bnknr
];
1928 if (inb(ioaddr
) & ECH_PNLINTRPEND
) {
1929 panelp
= brdp
->bnk2panel
[bnknr
];
1930 (* panelp
->isr
)(panelp
, (ioaddr
& 0xfffc));
1935 outb((brdp
->ioctrlval
| ECH_BRDDISABLE
), brdp
->ioctrl
);
1940 /*****************************************************************************/
1943 * Interrupt service routine for ECH-MCA board types.
1946 static int stl_echmcaintr(stlbrd_t
*brdp
)
1949 unsigned int ioaddr
;
1953 while (inb(brdp
->iostatus
) & ECH_INTRPEND
) {
1955 for (bnknr
= 0; (bnknr
< brdp
->nrbnks
); bnknr
++) {
1956 ioaddr
= brdp
->bnkstataddr
[bnknr
];
1957 if (inb(ioaddr
) & ECH_PNLINTRPEND
) {
1958 panelp
= brdp
->bnk2panel
[bnknr
];
1959 (* panelp
->isr
)(panelp
, (ioaddr
& 0xfffc));
1966 /*****************************************************************************/
1969 * Interrupt service routine for ECH-PCI board types.
1972 static int stl_echpciintr(stlbrd_t
*brdp
)
1975 unsigned int ioaddr
;
1981 for (bnknr
= 0; (bnknr
< brdp
->nrbnks
); bnknr
++) {
1982 outb(brdp
->bnkpageaddr
[bnknr
], brdp
->ioctrl
);
1983 ioaddr
= brdp
->bnkstataddr
[bnknr
];
1984 if (inb(ioaddr
) & ECH_PNLINTRPEND
) {
1985 panelp
= brdp
->bnk2panel
[bnknr
];
1986 (* panelp
->isr
)(panelp
, (ioaddr
& 0xfffc));
1997 /*****************************************************************************/
2000 * Interrupt service routine for ECH-8/64-PCI board types.
2003 static int stl_echpci64intr(stlbrd_t
*brdp
)
2006 unsigned int ioaddr
;
2010 while (inb(brdp
->ioctrl
) & 0x1) {
2012 for (bnknr
= 0; (bnknr
< brdp
->nrbnks
); bnknr
++) {
2013 ioaddr
= brdp
->bnkstataddr
[bnknr
];
2014 if (inb(ioaddr
) & ECH_PNLINTRPEND
) {
2015 panelp
= brdp
->bnk2panel
[bnknr
];
2016 (* panelp
->isr
)(panelp
, (ioaddr
& 0xfffc));
2024 /*****************************************************************************/
2027 * Service an off-level request for some channel.
2029 static void stl_offintr(struct work_struct
*work
)
2031 stlport_t
*portp
= container_of(work
, stlport_t
, tqueue
);
2032 struct tty_struct
*tty
;
2033 unsigned int oldsigs
;
2035 pr_debug("stl_offintr(portp=%p)\n", portp
);
2037 if (portp
== (stlport_t
*) NULL
)
2041 if (tty
== (struct tty_struct
*) NULL
)
2045 if (test_bit(ASYI_TXLOW
, &portp
->istate
)) {
2048 if (test_bit(ASYI_DCDCHANGE
, &portp
->istate
)) {
2049 clear_bit(ASYI_DCDCHANGE
, &portp
->istate
);
2050 oldsigs
= portp
->sigs
;
2051 portp
->sigs
= stl_getsignals(portp
);
2052 if ((portp
->sigs
& TIOCM_CD
) && ((oldsigs
& TIOCM_CD
) == 0))
2053 wake_up_interruptible(&portp
->open_wait
);
2054 if ((oldsigs
& TIOCM_CD
) && ((portp
->sigs
& TIOCM_CD
) == 0)) {
2055 if (portp
->flags
& ASYNC_CHECK_CD
)
2056 tty_hangup(tty
); /* FIXME: module removal race here - AKPM */
2062 /*****************************************************************************/
2065 * Initialize all the ports on a panel.
2068 static int __init
stl_initports(stlbrd_t
*brdp
, stlpanel_t
*panelp
)
2073 pr_debug("stl_initports(brdp=%p,panelp=%p)\n", brdp
, panelp
);
2075 chipmask
= stl_panelinit(brdp
, panelp
);
2078 * All UART's are initialized (if found!). Now go through and setup
2079 * each ports data structures.
2081 for (i
= 0; (i
< panelp
->nrports
); i
++) {
2082 portp
= kzalloc(sizeof(stlport_t
), GFP_KERNEL
);
2084 printk("STALLION: failed to allocate memory "
2085 "(size=%Zd)\n", sizeof(stlport_t
));
2089 portp
->magic
= STL_PORTMAGIC
;
2091 portp
->brdnr
= panelp
->brdnr
;
2092 portp
->panelnr
= panelp
->panelnr
;
2093 portp
->uartp
= panelp
->uartp
;
2094 portp
->clk
= brdp
->clk
;
2095 portp
->baud_base
= STL_BAUDBASE
;
2096 portp
->close_delay
= STL_CLOSEDELAY
;
2097 portp
->closing_wait
= 30 * HZ
;
2098 INIT_WORK(&portp
->tqueue
, stl_offintr
);
2099 init_waitqueue_head(&portp
->open_wait
);
2100 init_waitqueue_head(&portp
->close_wait
);
2101 portp
->stats
.brd
= portp
->brdnr
;
2102 portp
->stats
.panel
= portp
->panelnr
;
2103 portp
->stats
.port
= portp
->portnr
;
2104 panelp
->ports
[i
] = portp
;
2105 stl_portinit(brdp
, panelp
, portp
);
2111 /*****************************************************************************/
2114 * Try to find and initialize an EasyIO board.
2117 static inline int stl_initeio(stlbrd_t
*brdp
)
2120 unsigned int status
;
2124 pr_debug("stl_initeio(brdp=%p)\n", brdp
);
2126 brdp
->ioctrl
= brdp
->ioaddr1
+ 1;
2127 brdp
->iostatus
= brdp
->ioaddr1
+ 2;
2129 status
= inb(brdp
->iostatus
);
2130 if ((status
& EIO_IDBITMASK
) == EIO_MK3
)
2134 * Handle board specific stuff now. The real difference is PCI
2137 if (brdp
->brdtype
== BRD_EASYIOPCI
) {
2138 brdp
->iosize1
= 0x80;
2139 brdp
->iosize2
= 0x80;
2140 name
= "serial(EIO-PCI)";
2141 outb(0x41, (brdp
->ioaddr2
+ 0x4c));
2144 name
= "serial(EIO)";
2145 if ((brdp
->irq
< 0) || (brdp
->irq
> 15) ||
2146 (stl_vecmap
[brdp
->irq
] == (unsigned char) 0xff)) {
2147 printk("STALLION: invalid irq=%d for brd=%d\n",
2148 brdp
->irq
, brdp
->brdnr
);
2151 outb((stl_vecmap
[brdp
->irq
] | EIO_0WS
|
2152 ((brdp
->irqtype
) ? EIO_INTLEVEL
: EIO_INTEDGE
)),
2156 if (!request_region(brdp
->ioaddr1
, brdp
->iosize1
, name
)) {
2157 printk(KERN_WARNING
"STALLION: Warning, board %d I/O address "
2158 "%x conflicts with another device\n", brdp
->brdnr
,
2163 if (brdp
->iosize2
> 0)
2164 if (!request_region(brdp
->ioaddr2
, brdp
->iosize2
, name
)) {
2165 printk(KERN_WARNING
"STALLION: Warning, board %d I/O "
2166 "address %x conflicts with another device\n",
2167 brdp
->brdnr
, brdp
->ioaddr2
);
2168 printk(KERN_WARNING
"STALLION: Warning, also "
2169 "releasing board %d I/O address %x \n",
2170 brdp
->brdnr
, brdp
->ioaddr1
);
2171 release_region(brdp
->ioaddr1
, brdp
->iosize1
);
2176 * Everything looks OK, so let's go ahead and probe for the hardware.
2178 brdp
->clk
= CD1400_CLK
;
2179 brdp
->isr
= stl_eiointr
;
2181 switch (status
& EIO_IDBITMASK
) {
2183 brdp
->clk
= CD1400_CLK8M
;
2193 switch (status
& EIO_BRDMASK
) {
2212 * We have verified that the board is actually present, so now we
2213 * can complete the setup.
2216 panelp
= kzalloc(sizeof(stlpanel_t
), GFP_KERNEL
);
2218 printk(KERN_WARNING
"STALLION: failed to allocate memory "
2219 "(size=%Zd)\n", sizeof(stlpanel_t
));
2223 panelp
->magic
= STL_PANELMAGIC
;
2224 panelp
->brdnr
= brdp
->brdnr
;
2225 panelp
->panelnr
= 0;
2226 panelp
->nrports
= brdp
->nrports
;
2227 panelp
->iobase
= brdp
->ioaddr1
;
2228 panelp
->hwid
= status
;
2229 if ((status
& EIO_IDBITMASK
) == EIO_MK3
) {
2230 panelp
->uartp
= (void *) &stl_sc26198uart
;
2231 panelp
->isr
= stl_sc26198intr
;
2233 panelp
->uartp
= (void *) &stl_cd1400uart
;
2234 panelp
->isr
= stl_cd1400eiointr
;
2237 brdp
->panels
[0] = panelp
;
2239 brdp
->state
|= BRD_FOUND
;
2240 brdp
->hwid
= status
;
2241 if (request_irq(brdp
->irq
, stl_intr
, IRQF_SHARED
, name
, brdp
) != 0) {
2242 printk("STALLION: failed to register interrupt "
2243 "routine for %s irq=%d\n", name
, brdp
->irq
);
2251 /*****************************************************************************/
2254 * Try to find an ECH board and initialize it. This code is capable of
2255 * dealing with all types of ECH board.
2258 static inline int stl_initech(stlbrd_t
*brdp
)
2261 unsigned int status
, nxtid
, ioaddr
, conflict
;
2262 int panelnr
, banknr
, i
;
2265 pr_debug("stl_initech(brdp=%p)\n", brdp
);
2271 * Set up the initial board register contents for boards. This varies a
2272 * bit between the different board types. So we need to handle each
2273 * separately. Also do a check that the supplied IRQ is good.
2275 switch (brdp
->brdtype
) {
2278 brdp
->isr
= stl_echatintr
;
2279 brdp
->ioctrl
= brdp
->ioaddr1
+ 1;
2280 brdp
->iostatus
= brdp
->ioaddr1
+ 1;
2281 status
= inb(brdp
->iostatus
);
2282 if ((status
& ECH_IDBITMASK
) != ECH_ID
)
2284 if ((brdp
->irq
< 0) || (brdp
->irq
> 15) ||
2285 (stl_vecmap
[brdp
->irq
] == (unsigned char) 0xff)) {
2286 printk("STALLION: invalid irq=%d for brd=%d\n",
2287 brdp
->irq
, brdp
->brdnr
);
2290 status
= ((brdp
->ioaddr2
& ECH_ADDR2MASK
) >> 1);
2291 status
|= (stl_vecmap
[brdp
->irq
] << 1);
2292 outb((status
| ECH_BRDRESET
), brdp
->ioaddr1
);
2293 brdp
->ioctrlval
= ECH_INTENABLE
|
2294 ((brdp
->irqtype
) ? ECH_INTLEVEL
: ECH_INTEDGE
);
2295 for (i
= 0; (i
< 10); i
++)
2296 outb((brdp
->ioctrlval
| ECH_BRDENABLE
), brdp
->ioctrl
);
2299 name
= "serial(EC8/32)";
2300 outb(status
, brdp
->ioaddr1
);
2304 brdp
->isr
= stl_echmcaintr
;
2305 brdp
->ioctrl
= brdp
->ioaddr1
+ 0x20;
2306 brdp
->iostatus
= brdp
->ioctrl
;
2307 status
= inb(brdp
->iostatus
);
2308 if ((status
& ECH_IDBITMASK
) != ECH_ID
)
2310 if ((brdp
->irq
< 0) || (brdp
->irq
> 15) ||
2311 (stl_vecmap
[brdp
->irq
] == (unsigned char) 0xff)) {
2312 printk("STALLION: invalid irq=%d for brd=%d\n",
2313 brdp
->irq
, brdp
->brdnr
);
2316 outb(ECHMC_BRDRESET
, brdp
->ioctrl
);
2317 outb(ECHMC_INTENABLE
, brdp
->ioctrl
);
2319 name
= "serial(EC8/32-MC)";
2323 brdp
->isr
= stl_echpciintr
;
2324 brdp
->ioctrl
= brdp
->ioaddr1
+ 2;
2327 name
= "serial(EC8/32-PCI)";
2331 brdp
->isr
= stl_echpci64intr
;
2332 brdp
->ioctrl
= brdp
->ioaddr2
+ 0x40;
2333 outb(0x43, (brdp
->ioaddr1
+ 0x4c));
2334 brdp
->iosize1
= 0x80;
2335 brdp
->iosize2
= 0x80;
2336 name
= "serial(EC8/64-PCI)";
2340 printk("STALLION: unknown board type=%d\n", brdp
->brdtype
);
2346 * Check boards for possible IO address conflicts and return fail status
2347 * if an IO conflict found.
2349 if (!request_region(brdp
->ioaddr1
, brdp
->iosize1
, name
)) {
2350 printk(KERN_WARNING
"STALLION: Warning, board %d I/O address "
2351 "%x conflicts with another device\n", brdp
->brdnr
,
2356 if (brdp
->iosize2
> 0)
2357 if (!request_region(brdp
->ioaddr2
, brdp
->iosize2
, name
)) {
2358 printk(KERN_WARNING
"STALLION: Warning, board %d I/O "
2359 "address %x conflicts with another device\n",
2360 brdp
->brdnr
, brdp
->ioaddr2
);
2361 printk(KERN_WARNING
"STALLION: Warning, also "
2362 "releasing board %d I/O address %x \n",
2363 brdp
->brdnr
, brdp
->ioaddr1
);
2364 release_region(brdp
->ioaddr1
, brdp
->iosize1
);
2369 * Scan through the secondary io address space looking for panels.
2370 * As we find'em allocate and initialize panel structures for each.
2372 brdp
->clk
= CD1400_CLK
;
2373 brdp
->hwid
= status
;
2375 ioaddr
= brdp
->ioaddr2
;
2380 for (i
= 0; (i
< STL_MAXPANELS
); i
++) {
2381 if (brdp
->brdtype
== BRD_ECHPCI
) {
2382 outb(nxtid
, brdp
->ioctrl
);
2383 ioaddr
= brdp
->ioaddr2
;
2385 status
= inb(ioaddr
+ ECH_PNLSTATUS
);
2386 if ((status
& ECH_PNLIDMASK
) != nxtid
)
2388 panelp
= kzalloc(sizeof(stlpanel_t
), GFP_KERNEL
);
2390 printk("STALLION: failed to allocate memory "
2391 "(size=%Zd)\n", sizeof(stlpanel_t
));
2394 panelp
->magic
= STL_PANELMAGIC
;
2395 panelp
->brdnr
= brdp
->brdnr
;
2396 panelp
->panelnr
= panelnr
;
2397 panelp
->iobase
= ioaddr
;
2398 panelp
->pagenr
= nxtid
;
2399 panelp
->hwid
= status
;
2400 brdp
->bnk2panel
[banknr
] = panelp
;
2401 brdp
->bnkpageaddr
[banknr
] = nxtid
;
2402 brdp
->bnkstataddr
[banknr
++] = ioaddr
+ ECH_PNLSTATUS
;
2404 if (status
& ECH_PNLXPID
) {
2405 panelp
->uartp
= (void *) &stl_sc26198uart
;
2406 panelp
->isr
= stl_sc26198intr
;
2407 if (status
& ECH_PNL16PORT
) {
2408 panelp
->nrports
= 16;
2409 brdp
->bnk2panel
[banknr
] = panelp
;
2410 brdp
->bnkpageaddr
[banknr
] = nxtid
;
2411 brdp
->bnkstataddr
[banknr
++] = ioaddr
+ 4 +
2414 panelp
->nrports
= 8;
2417 panelp
->uartp
= (void *) &stl_cd1400uart
;
2418 panelp
->isr
= stl_cd1400echintr
;
2419 if (status
& ECH_PNL16PORT
) {
2420 panelp
->nrports
= 16;
2421 panelp
->ackmask
= 0x80;
2422 if (brdp
->brdtype
!= BRD_ECHPCI
)
2423 ioaddr
+= EREG_BANKSIZE
;
2424 brdp
->bnk2panel
[banknr
] = panelp
;
2425 brdp
->bnkpageaddr
[banknr
] = ++nxtid
;
2426 brdp
->bnkstataddr
[banknr
++] = ioaddr
+
2429 panelp
->nrports
= 8;
2430 panelp
->ackmask
= 0xc0;
2435 ioaddr
+= EREG_BANKSIZE
;
2436 brdp
->nrports
+= panelp
->nrports
;
2437 brdp
->panels
[panelnr
++] = panelp
;
2438 if ((brdp
->brdtype
!= BRD_ECHPCI
) &&
2439 (ioaddr
>= (brdp
->ioaddr2
+ brdp
->iosize2
)))
2443 brdp
->nrpanels
= panelnr
;
2444 brdp
->nrbnks
= banknr
;
2445 if (brdp
->brdtype
== BRD_ECH
)
2446 outb((brdp
->ioctrlval
| ECH_BRDDISABLE
), brdp
->ioctrl
);
2448 brdp
->state
|= BRD_FOUND
;
2449 if (request_irq(brdp
->irq
, stl_intr
, IRQF_SHARED
, name
, brdp
) != 0) {
2450 printk("STALLION: failed to register interrupt "
2451 "routine for %s irq=%d\n", name
, brdp
->irq
);
2460 /*****************************************************************************/
2463 * Initialize and configure the specified board.
2464 * Scan through all the boards in the configuration and see what we
2465 * can find. Handle EIO and the ECH boards a little differently here
2466 * since the initial search and setup is very different.
2469 static int __init
stl_brdinit(stlbrd_t
*brdp
)
2473 pr_debug("stl_brdinit(brdp=%p)\n", brdp
);
2475 switch (brdp
->brdtype
) {
2487 printk("STALLION: board=%d is unknown board type=%d\n",
2488 brdp
->brdnr
, brdp
->brdtype
);
2492 stl_brds
[brdp
->brdnr
] = brdp
;
2493 if ((brdp
->state
& BRD_FOUND
) == 0) {
2494 printk("STALLION: %s board not found, board=%d io=%x irq=%d\n",
2495 stl_brdnames
[brdp
->brdtype
], brdp
->brdnr
,
2496 brdp
->ioaddr1
, brdp
->irq
);
2500 for (i
= 0; (i
< STL_MAXPANELS
); i
++)
2501 if (brdp
->panels
[i
] != (stlpanel_t
*) NULL
)
2502 stl_initports(brdp
, brdp
->panels
[i
]);
2504 printk("STALLION: %s found, board=%d io=%x irq=%d "
2505 "nrpanels=%d nrports=%d\n", stl_brdnames
[brdp
->brdtype
],
2506 brdp
->brdnr
, brdp
->ioaddr1
, brdp
->irq
, brdp
->nrpanels
,
2511 /*****************************************************************************/
2514 * Find the next available board number that is free.
2517 static inline int stl_getbrdnr(void)
2521 for (i
= 0; (i
< STL_MAXBRDS
); i
++) {
2522 if (stl_brds
[i
] == (stlbrd_t
*) NULL
) {
2523 if (i
>= stl_nrbrds
)
2531 /*****************************************************************************/
2536 * We have a Stallion board. Allocate a board structure and
2537 * initialize it. Read its IO and IRQ resources from PCI
2538 * configuration space.
2541 static inline int stl_initpcibrd(int brdtype
, struct pci_dev
*devp
)
2545 pr_debug("stl_initpcibrd(brdtype=%d,busnr=%x,devnr=%x)\n", brdtype
,
2546 devp
->bus
->number
, devp
->devfn
);
2548 if (pci_enable_device(devp
))
2550 if ((brdp
= stl_allocbrd()) == (stlbrd_t
*) NULL
)
2552 if ((brdp
->brdnr
= stl_getbrdnr()) < 0) {
2553 printk("STALLION: too many boards found, "
2554 "maximum supported %d\n", STL_MAXBRDS
);
2557 brdp
->brdtype
= brdtype
;
2560 * Different Stallion boards use the BAR registers in different ways,
2561 * so set up io addresses based on board type.
2563 pr_debug("%s(%d): BAR[]=%Lx,%Lx,%Lx,%Lx IRQ=%x\n", __FILE__
, __LINE__
,
2564 pci_resource_start(devp
, 0), pci_resource_start(devp
, 1),
2565 pci_resource_start(devp
, 2), pci_resource_start(devp
, 3), devp
->irq
);
2568 * We have all resources from the board, so let's setup the actual
2569 * board structure now.
2573 brdp
->ioaddr2
= pci_resource_start(devp
, 0);
2574 brdp
->ioaddr1
= pci_resource_start(devp
, 1);
2577 brdp
->ioaddr2
= pci_resource_start(devp
, 2);
2578 brdp
->ioaddr1
= pci_resource_start(devp
, 1);
2581 brdp
->ioaddr1
= pci_resource_start(devp
, 2);
2582 brdp
->ioaddr2
= pci_resource_start(devp
, 1);
2585 printk("STALLION: unknown PCI board type=%d\n", brdtype
);
2589 brdp
->irq
= devp
->irq
;
2595 /*****************************************************************************/
2598 * Find all Stallion PCI boards that might be installed. Initialize each
2599 * one as it is found.
2603 static inline int stl_findpcibrds(void)
2605 struct pci_dev
*dev
= NULL
;
2608 pr_debug("stl_findpcibrds()\n");
2610 for (i
= 0; (i
< stl_nrpcibrds
); i
++)
2611 while ((dev
= pci_find_device(stl_pcibrds
[i
].vendid
,
2612 stl_pcibrds
[i
].devid
, dev
))) {
2615 * Found a device on the PCI bus that has our vendor and
2616 * device ID. Need to check now that it is really us.
2618 if ((dev
->class >> 8) == PCI_CLASS_STORAGE_IDE
)
2621 rc
= stl_initpcibrd(stl_pcibrds
[i
].brdtype
, dev
);
2631 /*****************************************************************************/
2634 * Scan through all the boards in the configuration and see what we
2635 * can find. Handle EIO and the ECH boards a little differently here
2636 * since the initial search and setup is too different.
2639 static inline int stl_initbrds(void)
2645 pr_debug("stl_initbrds()\n");
2647 if (stl_nrbrds
> STL_MAXBRDS
) {
2648 printk("STALLION: too many boards in configuration table, "
2649 "truncating to %d\n", STL_MAXBRDS
);
2650 stl_nrbrds
= STL_MAXBRDS
;
2654 * Firstly scan the list of static boards configured. Allocate
2655 * resources and initialize the boards as found.
2657 for (i
= 0; (i
< stl_nrbrds
); i
++) {
2658 confp
= &stl_brdconf
[i
];
2659 stl_parsebrd(confp
, stl_brdsp
[i
]);
2660 if ((brdp
= stl_allocbrd()) == (stlbrd_t
*) NULL
)
2663 brdp
->brdtype
= confp
->brdtype
;
2664 brdp
->ioaddr1
= confp
->ioaddr1
;
2665 brdp
->ioaddr2
= confp
->ioaddr2
;
2666 brdp
->irq
= confp
->irq
;
2667 brdp
->irqtype
= confp
->irqtype
;
2672 * Find any dynamically supported boards. That is via module load
2673 * line options or auto-detected on the PCI bus.
2683 /*****************************************************************************/
2686 * Return the board stats structure to user app.
2689 static int stl_getbrdstats(combrd_t __user
*bp
)
2695 if (copy_from_user(&stl_brdstats
, bp
, sizeof(combrd_t
)))
2697 if (stl_brdstats
.brd
>= STL_MAXBRDS
)
2699 brdp
= stl_brds
[stl_brdstats
.brd
];
2700 if (brdp
== (stlbrd_t
*) NULL
)
2703 memset(&stl_brdstats
, 0, sizeof(combrd_t
));
2704 stl_brdstats
.brd
= brdp
->brdnr
;
2705 stl_brdstats
.type
= brdp
->brdtype
;
2706 stl_brdstats
.hwid
= brdp
->hwid
;
2707 stl_brdstats
.state
= brdp
->state
;
2708 stl_brdstats
.ioaddr
= brdp
->ioaddr1
;
2709 stl_brdstats
.ioaddr2
= brdp
->ioaddr2
;
2710 stl_brdstats
.irq
= brdp
->irq
;
2711 stl_brdstats
.nrpanels
= brdp
->nrpanels
;
2712 stl_brdstats
.nrports
= brdp
->nrports
;
2713 for (i
= 0; (i
< brdp
->nrpanels
); i
++) {
2714 panelp
= brdp
->panels
[i
];
2715 stl_brdstats
.panels
[i
].panel
= i
;
2716 stl_brdstats
.panels
[i
].hwid
= panelp
->hwid
;
2717 stl_brdstats
.panels
[i
].nrports
= panelp
->nrports
;
2720 return copy_to_user(bp
, &stl_brdstats
, sizeof(combrd_t
)) ? -EFAULT
: 0;
2723 /*****************************************************************************/
2726 * Resolve the referenced port number into a port struct pointer.
2729 static stlport_t
*stl_getport(int brdnr
, int panelnr
, int portnr
)
2734 if ((brdnr
< 0) || (brdnr
>= STL_MAXBRDS
))
2735 return((stlport_t
*) NULL
);
2736 brdp
= stl_brds
[brdnr
];
2737 if (brdp
== (stlbrd_t
*) NULL
)
2738 return((stlport_t
*) NULL
);
2739 if ((panelnr
< 0) || (panelnr
>= brdp
->nrpanels
))
2740 return((stlport_t
*) NULL
);
2741 panelp
= brdp
->panels
[panelnr
];
2742 if (panelp
== (stlpanel_t
*) NULL
)
2743 return((stlport_t
*) NULL
);
2744 if ((portnr
< 0) || (portnr
>= panelp
->nrports
))
2745 return((stlport_t
*) NULL
);
2746 return(panelp
->ports
[portnr
]);
2749 /*****************************************************************************/
2752 * Return the port stats structure to user app. A NULL port struct
2753 * pointer passed in means that we need to find out from the app
2754 * what port to get stats for (used through board control device).
2757 static int stl_getportstats(stlport_t
*portp
, comstats_t __user
*cp
)
2759 unsigned char *head
, *tail
;
2760 unsigned long flags
;
2763 if (copy_from_user(&stl_comstats
, cp
, sizeof(comstats_t
)))
2765 portp
= stl_getport(stl_comstats
.brd
, stl_comstats
.panel
,
2767 if (portp
== (stlport_t
*) NULL
)
2771 portp
->stats
.state
= portp
->istate
;
2772 portp
->stats
.flags
= portp
->flags
;
2773 portp
->stats
.hwid
= portp
->hwid
;
2775 portp
->stats
.ttystate
= 0;
2776 portp
->stats
.cflags
= 0;
2777 portp
->stats
.iflags
= 0;
2778 portp
->stats
.oflags
= 0;
2779 portp
->stats
.lflags
= 0;
2780 portp
->stats
.rxbuffered
= 0;
2782 spin_lock_irqsave(&stallion_lock
, flags
);
2783 if (portp
->tty
!= (struct tty_struct
*) NULL
) {
2784 if (portp
->tty
->driver_data
== portp
) {
2785 portp
->stats
.ttystate
= portp
->tty
->flags
;
2786 /* No longer available as a statistic */
2787 portp
->stats
.rxbuffered
= 1; /*portp->tty->flip.count; */
2788 if (portp
->tty
->termios
!= (struct termios
*) NULL
) {
2789 portp
->stats
.cflags
= portp
->tty
->termios
->c_cflag
;
2790 portp
->stats
.iflags
= portp
->tty
->termios
->c_iflag
;
2791 portp
->stats
.oflags
= portp
->tty
->termios
->c_oflag
;
2792 portp
->stats
.lflags
= portp
->tty
->termios
->c_lflag
;
2796 spin_unlock_irqrestore(&stallion_lock
, flags
);
2798 head
= portp
->tx
.head
;
2799 tail
= portp
->tx
.tail
;
2800 portp
->stats
.txbuffered
= ((head
>= tail
) ? (head
- tail
) :
2801 (STL_TXBUFSIZE
- (tail
- head
)));
2803 portp
->stats
.signals
= (unsigned long) stl_getsignals(portp
);
2805 return copy_to_user(cp
, &portp
->stats
,
2806 sizeof(comstats_t
)) ? -EFAULT
: 0;
2809 /*****************************************************************************/
2812 * Clear the port stats structure. We also return it zeroed out...
2815 static int stl_clrportstats(stlport_t
*portp
, comstats_t __user
*cp
)
2818 if (copy_from_user(&stl_comstats
, cp
, sizeof(comstats_t
)))
2820 portp
= stl_getport(stl_comstats
.brd
, stl_comstats
.panel
,
2822 if (portp
== (stlport_t
*) NULL
)
2826 memset(&portp
->stats
, 0, sizeof(comstats_t
));
2827 portp
->stats
.brd
= portp
->brdnr
;
2828 portp
->stats
.panel
= portp
->panelnr
;
2829 portp
->stats
.port
= portp
->portnr
;
2830 return copy_to_user(cp
, &portp
->stats
,
2831 sizeof(comstats_t
)) ? -EFAULT
: 0;
2834 /*****************************************************************************/
2837 * Return the entire driver ports structure to a user app.
2840 static int stl_getportstruct(stlport_t __user
*arg
)
2844 if (copy_from_user(&stl_dummyport
, arg
, sizeof(stlport_t
)))
2846 portp
= stl_getport(stl_dummyport
.brdnr
, stl_dummyport
.panelnr
,
2847 stl_dummyport
.portnr
);
2850 return copy_to_user(arg
, portp
, sizeof(stlport_t
)) ? -EFAULT
: 0;
2853 /*****************************************************************************/
2856 * Return the entire driver board structure to a user app.
2859 static int stl_getbrdstruct(stlbrd_t __user
*arg
)
2863 if (copy_from_user(&stl_dummybrd
, arg
, sizeof(stlbrd_t
)))
2865 if ((stl_dummybrd
.brdnr
< 0) || (stl_dummybrd
.brdnr
>= STL_MAXBRDS
))
2867 brdp
= stl_brds
[stl_dummybrd
.brdnr
];
2870 return copy_to_user(arg
, brdp
, sizeof(stlbrd_t
)) ? -EFAULT
: 0;
2873 /*****************************************************************************/
2876 * The "staliomem" device is also required to do some special operations
2877 * on the board and/or ports. In this driver it is mostly used for stats
2881 static int stl_memioctl(struct inode
*ip
, struct file
*fp
, unsigned int cmd
, unsigned long arg
)
2884 void __user
*argp
= (void __user
*)arg
;
2886 pr_debug("stl_memioctl(ip=%p,fp=%p,cmd=%x,arg=%lx)\n", ip
, fp
, cmd
,arg
);
2889 if (brdnr
>= STL_MAXBRDS
)
2894 case COM_GETPORTSTATS
:
2895 rc
= stl_getportstats(NULL
, argp
);
2897 case COM_CLRPORTSTATS
:
2898 rc
= stl_clrportstats(NULL
, argp
);
2900 case COM_GETBRDSTATS
:
2901 rc
= stl_getbrdstats(argp
);
2904 rc
= stl_getportstruct(argp
);
2907 rc
= stl_getbrdstruct(argp
);
2917 static const struct tty_operations stl_ops
= {
2921 .put_char
= stl_putchar
,
2922 .flush_chars
= stl_flushchars
,
2923 .write_room
= stl_writeroom
,
2924 .chars_in_buffer
= stl_charsinbuffer
,
2926 .set_termios
= stl_settermios
,
2927 .throttle
= stl_throttle
,
2928 .unthrottle
= stl_unthrottle
,
2931 .hangup
= stl_hangup
,
2932 .flush_buffer
= stl_flushbuffer
,
2933 .break_ctl
= stl_breakctl
,
2934 .wait_until_sent
= stl_waituntilsent
,
2935 .send_xchar
= stl_sendxchar
,
2936 .read_proc
= stl_readproc
,
2937 .tiocmget
= stl_tiocmget
,
2938 .tiocmset
= stl_tiocmset
,
2941 /*****************************************************************************/
2943 static int __init
stl_init(void)
2946 printk(KERN_INFO
"%s: version %s\n", stl_drvtitle
, stl_drvversion
);
2948 spin_lock_init(&stallion_lock
);
2949 spin_lock_init(&brd_lock
);
2953 stl_serial
= alloc_tty_driver(STL_MAXBRDS
* STL_MAXPORTS
);
2958 * Set up a character driver for per board stuff. This is mainly used
2959 * to do stats ioctls on the ports.
2961 if (register_chrdev(STL_SIOMEMMAJOR
, "staliomem", &stl_fsiomem
))
2962 printk("STALLION: failed to register serial board device\n");
2964 stallion_class
= class_create(THIS_MODULE
, "staliomem");
2965 for (i
= 0; i
< 4; i
++)
2966 class_device_create(stallion_class
, NULL
,
2967 MKDEV(STL_SIOMEMMAJOR
, i
), NULL
,
2970 stl_serial
->owner
= THIS_MODULE
;
2971 stl_serial
->driver_name
= stl_drvname
;
2972 stl_serial
->name
= "ttyE";
2973 stl_serial
->major
= STL_SERIALMAJOR
;
2974 stl_serial
->minor_start
= 0;
2975 stl_serial
->type
= TTY_DRIVER_TYPE_SERIAL
;
2976 stl_serial
->subtype
= SERIAL_TYPE_NORMAL
;
2977 stl_serial
->init_termios
= stl_deftermios
;
2978 stl_serial
->flags
= TTY_DRIVER_REAL_RAW
;
2979 tty_set_operations(stl_serial
, &stl_ops
);
2981 if (tty_register_driver(stl_serial
)) {
2982 put_tty_driver(stl_serial
);
2983 printk("STALLION: failed to register serial driver\n");
2990 /*****************************************************************************/
2991 /* CD1400 HARDWARE FUNCTIONS */
2992 /*****************************************************************************/
2995 * These functions get/set/update the registers of the cd1400 UARTs.
2996 * Access to the cd1400 registers is via an address/data io port pair.
2997 * (Maybe should make this inline...)
3000 static int stl_cd1400getreg(stlport_t
*portp
, int regnr
)
3002 outb((regnr
+ portp
->uartaddr
), portp
->ioaddr
);
3003 return inb(portp
->ioaddr
+ EREG_DATA
);
3006 static void stl_cd1400setreg(stlport_t
*portp
, int regnr
, int value
)
3008 outb((regnr
+ portp
->uartaddr
), portp
->ioaddr
);
3009 outb(value
, portp
->ioaddr
+ EREG_DATA
);
3012 static int stl_cd1400updatereg(stlport_t
*portp
, int regnr
, int value
)
3014 outb((regnr
+ portp
->uartaddr
), portp
->ioaddr
);
3015 if (inb(portp
->ioaddr
+ EREG_DATA
) != value
) {
3016 outb(value
, portp
->ioaddr
+ EREG_DATA
);
3022 /*****************************************************************************/
3025 * Inbitialize the UARTs in a panel. We don't care what sort of board
3026 * these ports are on - since the port io registers are almost
3027 * identical when dealing with ports.
3030 static int stl_cd1400panelinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
)
3034 int nrchips
, uartaddr
, ioaddr
;
3035 unsigned long flags
;
3037 pr_debug("stl_panelinit(brdp=%p,panelp=%p)\n", brdp
, panelp
);
3039 spin_lock_irqsave(&brd_lock
, flags
);
3040 BRDENABLE(panelp
->brdnr
, panelp
->pagenr
);
3043 * Check that each chip is present and started up OK.
3046 nrchips
= panelp
->nrports
/ CD1400_PORTS
;
3047 for (i
= 0; (i
< nrchips
); i
++) {
3048 if (brdp
->brdtype
== BRD_ECHPCI
) {
3049 outb((panelp
->pagenr
+ (i
>> 1)), brdp
->ioctrl
);
3050 ioaddr
= panelp
->iobase
;
3052 ioaddr
= panelp
->iobase
+ (EREG_BANKSIZE
* (i
>> 1));
3054 uartaddr
= (i
& 0x01) ? 0x080 : 0;
3055 outb((GFRCR
+ uartaddr
), ioaddr
);
3056 outb(0, (ioaddr
+ EREG_DATA
));
3057 outb((CCR
+ uartaddr
), ioaddr
);
3058 outb(CCR_RESETFULL
, (ioaddr
+ EREG_DATA
));
3059 outb(CCR_RESETFULL
, (ioaddr
+ EREG_DATA
));
3060 outb((GFRCR
+ uartaddr
), ioaddr
);
3061 for (j
= 0; (j
< CCR_MAXWAIT
); j
++) {
3062 if ((gfrcr
= inb(ioaddr
+ EREG_DATA
)) != 0)
3065 if ((j
>= CCR_MAXWAIT
) || (gfrcr
< 0x40) || (gfrcr
> 0x60)) {
3066 printk("STALLION: cd1400 not responding, "
3067 "brd=%d panel=%d chip=%d\n",
3068 panelp
->brdnr
, panelp
->panelnr
, i
);
3071 chipmask
|= (0x1 << i
);
3072 outb((PPR
+ uartaddr
), ioaddr
);
3073 outb(PPR_SCALAR
, (ioaddr
+ EREG_DATA
));
3076 BRDDISABLE(panelp
->brdnr
);
3077 spin_unlock_irqrestore(&brd_lock
, flags
);
3081 /*****************************************************************************/
3084 * Initialize hardware specific port registers.
3087 static void stl_cd1400portinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
, stlport_t
*portp
)
3089 unsigned long flags
;
3090 pr_debug("stl_cd1400portinit(brdp=%p,panelp=%p,portp=%p)\n", brdp
,
3093 if ((brdp
== (stlbrd_t
*) NULL
) || (panelp
== (stlpanel_t
*) NULL
) ||
3094 (portp
== (stlport_t
*) NULL
))
3097 spin_lock_irqsave(&brd_lock
, flags
);
3098 portp
->ioaddr
= panelp
->iobase
+ (((brdp
->brdtype
== BRD_ECHPCI
) ||
3099 (portp
->portnr
< 8)) ? 0 : EREG_BANKSIZE
);
3100 portp
->uartaddr
= (portp
->portnr
& 0x04) << 5;
3101 portp
->pagenr
= panelp
->pagenr
+ (portp
->portnr
>> 3);
3103 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3104 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3105 stl_cd1400setreg(portp
, LIVR
, (portp
->portnr
<< 3));
3106 portp
->hwid
= stl_cd1400getreg(portp
, GFRCR
);
3107 BRDDISABLE(portp
->brdnr
);
3108 spin_unlock_irqrestore(&brd_lock
, flags
);
3111 /*****************************************************************************/
3114 * Wait for the command register to be ready. We will poll this,
3115 * since it won't usually take too long to be ready.
3118 static void stl_cd1400ccrwait(stlport_t
*portp
)
3122 for (i
= 0; (i
< CCR_MAXWAIT
); i
++) {
3123 if (stl_cd1400getreg(portp
, CCR
) == 0) {
3128 printk("STALLION: cd1400 not responding, port=%d panel=%d brd=%d\n",
3129 portp
->portnr
, portp
->panelnr
, portp
->brdnr
);
3132 /*****************************************************************************/
3135 * Set up the cd1400 registers for a port based on the termios port
3139 static void stl_cd1400setport(stlport_t
*portp
, struct termios
*tiosp
)
3142 unsigned long flags
;
3143 unsigned int clkdiv
, baudrate
;
3144 unsigned char cor1
, cor2
, cor3
;
3145 unsigned char cor4
, cor5
, ccr
;
3146 unsigned char srer
, sreron
, sreroff
;
3147 unsigned char mcor1
, mcor2
, rtpr
;
3148 unsigned char clk
, div
;
3164 brdp
= stl_brds
[portp
->brdnr
];
3165 if (brdp
== (stlbrd_t
*) NULL
)
3169 * Set up the RX char ignore mask with those RX error types we
3170 * can ignore. We can get the cd1400 to help us out a little here,
3171 * it will ignore parity errors and breaks for us.
3173 portp
->rxignoremsk
= 0;
3174 if (tiosp
->c_iflag
& IGNPAR
) {
3175 portp
->rxignoremsk
|= (ST_PARITY
| ST_FRAMING
| ST_OVERRUN
);
3176 cor1
|= COR1_PARIGNORE
;
3178 if (tiosp
->c_iflag
& IGNBRK
) {
3179 portp
->rxignoremsk
|= ST_BREAK
;
3180 cor4
|= COR4_IGNBRK
;
3183 portp
->rxmarkmsk
= ST_OVERRUN
;
3184 if (tiosp
->c_iflag
& (INPCK
| PARMRK
))
3185 portp
->rxmarkmsk
|= (ST_PARITY
| ST_FRAMING
);
3186 if (tiosp
->c_iflag
& BRKINT
)
3187 portp
->rxmarkmsk
|= ST_BREAK
;
3190 * Go through the char size, parity and stop bits and set all the
3191 * option register appropriately.
3193 switch (tiosp
->c_cflag
& CSIZE
) {
3208 if (tiosp
->c_cflag
& CSTOPB
)
3213 if (tiosp
->c_cflag
& PARENB
) {
3214 if (tiosp
->c_cflag
& PARODD
)
3215 cor1
|= (COR1_PARENB
| COR1_PARODD
);
3217 cor1
|= (COR1_PARENB
| COR1_PAREVEN
);
3219 cor1
|= COR1_PARNONE
;
3223 * Set the RX FIFO threshold at 6 chars. This gives a bit of breathing
3224 * space for hardware flow control and the like. This should be set to
3225 * VMIN. Also here we will set the RX data timeout to 10ms - this should
3226 * really be based on VTIME.
3228 cor3
|= FIFO_RXTHRESHOLD
;
3232 * Calculate the baud rate timers. For now we will just assume that
3233 * the input and output baud are the same. Could have used a baud
3234 * table here, but this way we can generate virtually any baud rate
3237 baudrate
= tiosp
->c_cflag
& CBAUD
;
3238 if (baudrate
& CBAUDEX
) {
3239 baudrate
&= ~CBAUDEX
;
3240 if ((baudrate
< 1) || (baudrate
> 4))
3241 tiosp
->c_cflag
&= ~CBAUDEX
;
3245 baudrate
= stl_baudrates
[baudrate
];
3246 if ((tiosp
->c_cflag
& CBAUD
) == B38400
) {
3247 if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_HI
)
3249 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_VHI
)
3251 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_SHI
)
3253 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_WARP
)
3255 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_CUST
)
3256 baudrate
= (portp
->baud_base
/ portp
->custom_divisor
);
3258 if (baudrate
> STL_CD1400MAXBAUD
)
3259 baudrate
= STL_CD1400MAXBAUD
;
3262 for (clk
= 0; (clk
< CD1400_NUMCLKS
); clk
++) {
3263 clkdiv
= ((portp
->clk
/ stl_cd1400clkdivs
[clk
]) / baudrate
);
3267 div
= (unsigned char) clkdiv
;
3271 * Check what form of modem signaling is required and set it up.
3273 if ((tiosp
->c_cflag
& CLOCAL
) == 0) {
3276 sreron
|= SRER_MODEM
;
3277 portp
->flags
|= ASYNC_CHECK_CD
;
3279 portp
->flags
&= ~ASYNC_CHECK_CD
;
3283 * Setup cd1400 enhanced modes if we can. In particular we want to
3284 * handle as much of the flow control as possible automatically. As
3285 * well as saving a few CPU cycles it will also greatly improve flow
3286 * control reliability.
3288 if (tiosp
->c_iflag
& IXON
) {
3291 if (tiosp
->c_iflag
& IXANY
)
3295 if (tiosp
->c_cflag
& CRTSCTS
) {
3297 mcor1
|= FIFO_RTSTHRESHOLD
;
3301 * All cd1400 register values calculated so go through and set
3305 pr_debug("SETPORT: portnr=%d panelnr=%d brdnr=%d\n",
3306 portp
->portnr
, portp
->panelnr
, portp
->brdnr
);
3307 pr_debug(" cor1=%x cor2=%x cor3=%x cor4=%x cor5=%x\n",
3308 cor1
, cor2
, cor3
, cor4
, cor5
);
3309 pr_debug(" mcor1=%x mcor2=%x rtpr=%x sreron=%x sreroff=%x\n",
3310 mcor1
, mcor2
, rtpr
, sreron
, sreroff
);
3311 pr_debug(" tcor=%x tbpr=%x rcor=%x rbpr=%x\n", clk
, div
, clk
, div
);
3312 pr_debug(" schr1=%x schr2=%x schr3=%x schr4=%x\n",
3313 tiosp
->c_cc
[VSTART
], tiosp
->c_cc
[VSTOP
],
3314 tiosp
->c_cc
[VSTART
], tiosp
->c_cc
[VSTOP
]);
3316 spin_lock_irqsave(&brd_lock
, flags
);
3317 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3318 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x3));
3319 srer
= stl_cd1400getreg(portp
, SRER
);
3320 stl_cd1400setreg(portp
, SRER
, 0);
3321 if (stl_cd1400updatereg(portp
, COR1
, cor1
))
3323 if (stl_cd1400updatereg(portp
, COR2
, cor2
))
3325 if (stl_cd1400updatereg(portp
, COR3
, cor3
))
3328 stl_cd1400ccrwait(portp
);
3329 stl_cd1400setreg(portp
, CCR
, CCR_CORCHANGE
);
3331 stl_cd1400setreg(portp
, COR4
, cor4
);
3332 stl_cd1400setreg(portp
, COR5
, cor5
);
3333 stl_cd1400setreg(portp
, MCOR1
, mcor1
);
3334 stl_cd1400setreg(portp
, MCOR2
, mcor2
);
3336 stl_cd1400setreg(portp
, TCOR
, clk
);
3337 stl_cd1400setreg(portp
, TBPR
, div
);
3338 stl_cd1400setreg(portp
, RCOR
, clk
);
3339 stl_cd1400setreg(portp
, RBPR
, div
);
3341 stl_cd1400setreg(portp
, SCHR1
, tiosp
->c_cc
[VSTART
]);
3342 stl_cd1400setreg(portp
, SCHR2
, tiosp
->c_cc
[VSTOP
]);
3343 stl_cd1400setreg(portp
, SCHR3
, tiosp
->c_cc
[VSTART
]);
3344 stl_cd1400setreg(portp
, SCHR4
, tiosp
->c_cc
[VSTOP
]);
3345 stl_cd1400setreg(portp
, RTPR
, rtpr
);
3346 mcor1
= stl_cd1400getreg(portp
, MSVR1
);
3347 if (mcor1
& MSVR1_DCD
)
3348 portp
->sigs
|= TIOCM_CD
;
3350 portp
->sigs
&= ~TIOCM_CD
;
3351 stl_cd1400setreg(portp
, SRER
, ((srer
& ~sreroff
) | sreron
));
3352 BRDDISABLE(portp
->brdnr
);
3353 spin_unlock_irqrestore(&brd_lock
, flags
);
3356 /*****************************************************************************/
3359 * Set the state of the DTR and RTS signals.
3362 static void stl_cd1400setsignals(stlport_t
*portp
, int dtr
, int rts
)
3364 unsigned char msvr1
, msvr2
;
3365 unsigned long flags
;
3367 pr_debug("stl_cd1400setsignals(portp=%p,dtr=%d,rts=%d)\n",
3377 spin_lock_irqsave(&brd_lock
, flags
);
3378 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3379 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3381 stl_cd1400setreg(portp
, MSVR2
, msvr2
);
3383 stl_cd1400setreg(portp
, MSVR1
, msvr1
);
3384 BRDDISABLE(portp
->brdnr
);
3385 spin_unlock_irqrestore(&brd_lock
, flags
);
3388 /*****************************************************************************/
3391 * Return the state of the signals.
3394 static int stl_cd1400getsignals(stlport_t
*portp
)
3396 unsigned char msvr1
, msvr2
;
3397 unsigned long flags
;
3400 pr_debug("stl_cd1400getsignals(portp=%p)\n", portp
);
3402 spin_lock_irqsave(&brd_lock
, flags
);
3403 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3404 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3405 msvr1
= stl_cd1400getreg(portp
, MSVR1
);
3406 msvr2
= stl_cd1400getreg(portp
, MSVR2
);
3407 BRDDISABLE(portp
->brdnr
);
3408 spin_unlock_irqrestore(&brd_lock
, flags
);
3411 sigs
|= (msvr1
& MSVR1_DCD
) ? TIOCM_CD
: 0;
3412 sigs
|= (msvr1
& MSVR1_CTS
) ? TIOCM_CTS
: 0;
3413 sigs
|= (msvr1
& MSVR1_DTR
) ? TIOCM_DTR
: 0;
3414 sigs
|= (msvr2
& MSVR2_RTS
) ? TIOCM_RTS
: 0;
3416 sigs
|= (msvr1
& MSVR1_RI
) ? TIOCM_RI
: 0;
3417 sigs
|= (msvr1
& MSVR1_DSR
) ? TIOCM_DSR
: 0;
3424 /*****************************************************************************/
3427 * Enable/Disable the Transmitter and/or Receiver.
3430 static void stl_cd1400enablerxtx(stlport_t
*portp
, int rx
, int tx
)
3433 unsigned long flags
;
3435 pr_debug("stl_cd1400enablerxtx(portp=%p,rx=%d,tx=%d)\n", portp
, rx
, tx
);
3440 ccr
|= CCR_TXDISABLE
;
3442 ccr
|= CCR_TXENABLE
;
3444 ccr
|= CCR_RXDISABLE
;
3446 ccr
|= CCR_RXENABLE
;
3448 spin_lock_irqsave(&brd_lock
, flags
);
3449 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3450 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3451 stl_cd1400ccrwait(portp
);
3452 stl_cd1400setreg(portp
, CCR
, ccr
);
3453 stl_cd1400ccrwait(portp
);
3454 BRDDISABLE(portp
->brdnr
);
3455 spin_unlock_irqrestore(&brd_lock
, flags
);
3458 /*****************************************************************************/
3461 * Start/stop the Transmitter and/or Receiver.
3464 static void stl_cd1400startrxtx(stlport_t
*portp
, int rx
, int tx
)
3466 unsigned char sreron
, sreroff
;
3467 unsigned long flags
;
3469 pr_debug("stl_cd1400startrxtx(portp=%p,rx=%d,tx=%d)\n", portp
, rx
, tx
);
3474 sreroff
|= (SRER_TXDATA
| SRER_TXEMPTY
);
3476 sreron
|= SRER_TXDATA
;
3478 sreron
|= SRER_TXEMPTY
;
3480 sreroff
|= SRER_RXDATA
;
3482 sreron
|= SRER_RXDATA
;
3484 spin_lock_irqsave(&brd_lock
, flags
);
3485 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3486 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3487 stl_cd1400setreg(portp
, SRER
,
3488 ((stl_cd1400getreg(portp
, SRER
) & ~sreroff
) | sreron
));
3489 BRDDISABLE(portp
->brdnr
);
3491 set_bit(ASYI_TXBUSY
, &portp
->istate
);
3492 spin_unlock_irqrestore(&brd_lock
, flags
);
3495 /*****************************************************************************/
3498 * Disable all interrupts from this port.
3501 static void stl_cd1400disableintrs(stlport_t
*portp
)
3503 unsigned long flags
;
3505 pr_debug("stl_cd1400disableintrs(portp=%p)\n", portp
);
3507 spin_lock_irqsave(&brd_lock
, flags
);
3508 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3509 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3510 stl_cd1400setreg(portp
, SRER
, 0);
3511 BRDDISABLE(portp
->brdnr
);
3512 spin_unlock_irqrestore(&brd_lock
, flags
);
3515 /*****************************************************************************/
3517 static void stl_cd1400sendbreak(stlport_t
*portp
, int len
)
3519 unsigned long flags
;
3521 pr_debug("stl_cd1400sendbreak(portp=%p,len=%d)\n", portp
, len
);
3523 spin_lock_irqsave(&brd_lock
, flags
);
3524 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3525 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3526 stl_cd1400setreg(portp
, SRER
,
3527 ((stl_cd1400getreg(portp
, SRER
) & ~SRER_TXDATA
) |
3529 BRDDISABLE(portp
->brdnr
);
3530 portp
->brklen
= len
;
3532 portp
->stats
.txbreaks
++;
3533 spin_unlock_irqrestore(&brd_lock
, flags
);
3536 /*****************************************************************************/
3539 * Take flow control actions...
3542 static void stl_cd1400flowctrl(stlport_t
*portp
, int state
)
3544 struct tty_struct
*tty
;
3545 unsigned long flags
;
3547 pr_debug("stl_cd1400flowctrl(portp=%p,state=%x)\n", portp
, state
);
3549 if (portp
== (stlport_t
*) NULL
)
3552 if (tty
== (struct tty_struct
*) NULL
)
3555 spin_lock_irqsave(&brd_lock
, flags
);
3556 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3557 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3560 if (tty
->termios
->c_iflag
& IXOFF
) {
3561 stl_cd1400ccrwait(portp
);
3562 stl_cd1400setreg(portp
, CCR
, CCR_SENDSCHR1
);
3563 portp
->stats
.rxxon
++;
3564 stl_cd1400ccrwait(portp
);
3567 * Question: should we return RTS to what it was before? It may
3568 * have been set by an ioctl... Suppose not, since if you have
3569 * hardware flow control set then it is pretty silly to go and
3570 * set the RTS line by hand.
3572 if (tty
->termios
->c_cflag
& CRTSCTS
) {
3573 stl_cd1400setreg(portp
, MCOR1
,
3574 (stl_cd1400getreg(portp
, MCOR1
) |
3575 FIFO_RTSTHRESHOLD
));
3576 stl_cd1400setreg(portp
, MSVR2
, MSVR2_RTS
);
3577 portp
->stats
.rxrtson
++;
3580 if (tty
->termios
->c_iflag
& IXOFF
) {
3581 stl_cd1400ccrwait(portp
);
3582 stl_cd1400setreg(portp
, CCR
, CCR_SENDSCHR2
);
3583 portp
->stats
.rxxoff
++;
3584 stl_cd1400ccrwait(portp
);
3586 if (tty
->termios
->c_cflag
& CRTSCTS
) {
3587 stl_cd1400setreg(portp
, MCOR1
,
3588 (stl_cd1400getreg(portp
, MCOR1
) & 0xf0));
3589 stl_cd1400setreg(portp
, MSVR2
, 0);
3590 portp
->stats
.rxrtsoff
++;
3594 BRDDISABLE(portp
->brdnr
);
3595 spin_unlock_irqrestore(&brd_lock
, flags
);
3598 /*****************************************************************************/
3601 * Send a flow control character...
3604 static void stl_cd1400sendflow(stlport_t
*portp
, int state
)
3606 struct tty_struct
*tty
;
3607 unsigned long flags
;
3609 pr_debug("stl_cd1400sendflow(portp=%p,state=%x)\n", portp
, state
);
3611 if (portp
== (stlport_t
*) NULL
)
3614 if (tty
== (struct tty_struct
*) NULL
)
3617 spin_lock_irqsave(&brd_lock
, flags
);
3618 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3619 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3621 stl_cd1400ccrwait(portp
);
3622 stl_cd1400setreg(portp
, CCR
, CCR_SENDSCHR1
);
3623 portp
->stats
.rxxon
++;
3624 stl_cd1400ccrwait(portp
);
3626 stl_cd1400ccrwait(portp
);
3627 stl_cd1400setreg(portp
, CCR
, CCR_SENDSCHR2
);
3628 portp
->stats
.rxxoff
++;
3629 stl_cd1400ccrwait(portp
);
3631 BRDDISABLE(portp
->brdnr
);
3632 spin_unlock_irqrestore(&brd_lock
, flags
);
3635 /*****************************************************************************/
3637 static void stl_cd1400flush(stlport_t
*portp
)
3639 unsigned long flags
;
3641 pr_debug("stl_cd1400flush(portp=%p)\n", portp
);
3643 if (portp
== (stlport_t
*) NULL
)
3646 spin_lock_irqsave(&brd_lock
, flags
);
3647 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3648 stl_cd1400setreg(portp
, CAR
, (portp
->portnr
& 0x03));
3649 stl_cd1400ccrwait(portp
);
3650 stl_cd1400setreg(portp
, CCR
, CCR_TXFLUSHFIFO
);
3651 stl_cd1400ccrwait(portp
);
3652 portp
->tx
.tail
= portp
->tx
.head
;
3653 BRDDISABLE(portp
->brdnr
);
3654 spin_unlock_irqrestore(&brd_lock
, flags
);
3657 /*****************************************************************************/
3660 * Return the current state of data flow on this port. This is only
3661 * really interresting when determining if data has fully completed
3662 * transmission or not... This is easy for the cd1400, it accurately
3663 * maintains the busy port flag.
3666 static int stl_cd1400datastate(stlport_t
*portp
)
3668 pr_debug("stl_cd1400datastate(portp=%p)\n", portp
);
3670 if (portp
== (stlport_t
*) NULL
)
3673 return test_bit(ASYI_TXBUSY
, &portp
->istate
) ? 1 : 0;
3676 /*****************************************************************************/
3679 * Interrupt service routine for cd1400 EasyIO boards.
3682 static void stl_cd1400eiointr(stlpanel_t
*panelp
, unsigned int iobase
)
3684 unsigned char svrtype
;
3686 pr_debug("stl_cd1400eiointr(panelp=%p,iobase=%x)\n", panelp
, iobase
);
3688 spin_lock(&brd_lock
);
3690 svrtype
= inb(iobase
+ EREG_DATA
);
3691 if (panelp
->nrports
> 4) {
3692 outb((SVRR
+ 0x80), iobase
);
3693 svrtype
|= inb(iobase
+ EREG_DATA
);
3696 if (svrtype
& SVRR_RX
)
3697 stl_cd1400rxisr(panelp
, iobase
);
3698 else if (svrtype
& SVRR_TX
)
3699 stl_cd1400txisr(panelp
, iobase
);
3700 else if (svrtype
& SVRR_MDM
)
3701 stl_cd1400mdmisr(panelp
, iobase
);
3703 spin_unlock(&brd_lock
);
3706 /*****************************************************************************/
3709 * Interrupt service routine for cd1400 panels.
3712 static void stl_cd1400echintr(stlpanel_t
*panelp
, unsigned int iobase
)
3714 unsigned char svrtype
;
3716 pr_debug("stl_cd1400echintr(panelp=%p,iobase=%x)\n", panelp
, iobase
);
3719 svrtype
= inb(iobase
+ EREG_DATA
);
3720 outb((SVRR
+ 0x80), iobase
);
3721 svrtype
|= inb(iobase
+ EREG_DATA
);
3722 if (svrtype
& SVRR_RX
)
3723 stl_cd1400rxisr(panelp
, iobase
);
3724 else if (svrtype
& SVRR_TX
)
3725 stl_cd1400txisr(panelp
, iobase
);
3726 else if (svrtype
& SVRR_MDM
)
3727 stl_cd1400mdmisr(panelp
, iobase
);
3731 /*****************************************************************************/
3734 * Unfortunately we need to handle breaks in the TX data stream, since
3735 * this is the only way to generate them on the cd1400.
3738 static inline int stl_cd1400breakisr(stlport_t
*portp
, int ioaddr
)
3740 if (portp
->brklen
== 1) {
3741 outb((COR2
+ portp
->uartaddr
), ioaddr
);
3742 outb((inb(ioaddr
+ EREG_DATA
) | COR2_ETC
),
3743 (ioaddr
+ EREG_DATA
));
3744 outb((TDR
+ portp
->uartaddr
), ioaddr
);
3745 outb(ETC_CMD
, (ioaddr
+ EREG_DATA
));
3746 outb(ETC_STARTBREAK
, (ioaddr
+ EREG_DATA
));
3747 outb((SRER
+ portp
->uartaddr
), ioaddr
);
3748 outb((inb(ioaddr
+ EREG_DATA
) & ~(SRER_TXDATA
| SRER_TXEMPTY
)),
3749 (ioaddr
+ EREG_DATA
));
3751 } else if (portp
->brklen
> 1) {
3752 outb((TDR
+ portp
->uartaddr
), ioaddr
);
3753 outb(ETC_CMD
, (ioaddr
+ EREG_DATA
));
3754 outb(ETC_STOPBREAK
, (ioaddr
+ EREG_DATA
));
3758 outb((COR2
+ portp
->uartaddr
), ioaddr
);
3759 outb((inb(ioaddr
+ EREG_DATA
) & ~COR2_ETC
),
3760 (ioaddr
+ EREG_DATA
));
3766 /*****************************************************************************/
3769 * Transmit interrupt handler. This has gotta be fast! Handling TX
3770 * chars is pretty simple, stuff as many as possible from the TX buffer
3771 * into the cd1400 FIFO. Must also handle TX breaks here, since they
3772 * are embedded as commands in the data stream. Oh no, had to use a goto!
3773 * This could be optimized more, will do when I get time...
3774 * In practice it is possible that interrupts are enabled but that the
3775 * port has been hung up. Need to handle not having any TX buffer here,
3776 * this is done by using the side effect that head and tail will also
3777 * be NULL if the buffer has been freed.
3780 static void stl_cd1400txisr(stlpanel_t
*panelp
, int ioaddr
)
3785 unsigned char ioack
, srer
;
3787 pr_debug("stl_cd1400txisr(panelp=%p,ioaddr=%x)\n", panelp
, ioaddr
);
3789 ioack
= inb(ioaddr
+ EREG_TXACK
);
3790 if (((ioack
& panelp
->ackmask
) != 0) ||
3791 ((ioack
& ACK_TYPMASK
) != ACK_TYPTX
)) {
3792 printk("STALLION: bad TX interrupt ack value=%x\n", ioack
);
3795 portp
= panelp
->ports
[(ioack
>> 3)];
3798 * Unfortunately we need to handle breaks in the data stream, since
3799 * this is the only way to generate them on the cd1400. Do it now if
3800 * a break is to be sent.
3802 if (portp
->brklen
!= 0)
3803 if (stl_cd1400breakisr(portp
, ioaddr
))
3806 head
= portp
->tx
.head
;
3807 tail
= portp
->tx
.tail
;
3808 len
= (head
>= tail
) ? (head
- tail
) : (STL_TXBUFSIZE
- (tail
- head
));
3809 if ((len
== 0) || ((len
< STL_TXBUFLOW
) &&
3810 (test_bit(ASYI_TXLOW
, &portp
->istate
) == 0))) {
3811 set_bit(ASYI_TXLOW
, &portp
->istate
);
3812 schedule_work(&portp
->tqueue
);
3816 outb((SRER
+ portp
->uartaddr
), ioaddr
);
3817 srer
= inb(ioaddr
+ EREG_DATA
);
3818 if (srer
& SRER_TXDATA
) {
3819 srer
= (srer
& ~SRER_TXDATA
) | SRER_TXEMPTY
;
3821 srer
&= ~(SRER_TXDATA
| SRER_TXEMPTY
);
3822 clear_bit(ASYI_TXBUSY
, &portp
->istate
);
3824 outb(srer
, (ioaddr
+ EREG_DATA
));
3826 len
= MIN(len
, CD1400_TXFIFOSIZE
);
3827 portp
->stats
.txtotal
+= len
;
3828 stlen
= MIN(len
, ((portp
->tx
.buf
+ STL_TXBUFSIZE
) - tail
));
3829 outb((TDR
+ portp
->uartaddr
), ioaddr
);
3830 outsb((ioaddr
+ EREG_DATA
), tail
, stlen
);
3833 if (tail
>= (portp
->tx
.buf
+ STL_TXBUFSIZE
))
3834 tail
= portp
->tx
.buf
;
3836 outsb((ioaddr
+ EREG_DATA
), tail
, len
);
3839 portp
->tx
.tail
= tail
;
3843 outb((EOSRR
+ portp
->uartaddr
), ioaddr
);
3844 outb(0, (ioaddr
+ EREG_DATA
));
3847 /*****************************************************************************/
3850 * Receive character interrupt handler. Determine if we have good chars
3851 * or bad chars and then process appropriately. Good chars are easy
3852 * just shove the lot into the RX buffer and set all status byte to 0.
3853 * If a bad RX char then process as required. This routine needs to be
3854 * fast! In practice it is possible that we get an interrupt on a port
3855 * that is closed. This can happen on hangups - since they completely
3856 * shutdown a port not in user context. Need to handle this case.
3859 static void stl_cd1400rxisr(stlpanel_t
*panelp
, int ioaddr
)
3862 struct tty_struct
*tty
;
3863 unsigned int ioack
, len
, buflen
;
3864 unsigned char status
;
3867 pr_debug("stl_cd1400rxisr(panelp=%p,ioaddr=%x)\n", panelp
, ioaddr
);
3869 ioack
= inb(ioaddr
+ EREG_RXACK
);
3870 if ((ioack
& panelp
->ackmask
) != 0) {
3871 printk("STALLION: bad RX interrupt ack value=%x\n", ioack
);
3874 portp
= panelp
->ports
[(ioack
>> 3)];
3877 if ((ioack
& ACK_TYPMASK
) == ACK_TYPRXGOOD
) {
3878 outb((RDCR
+ portp
->uartaddr
), ioaddr
);
3879 len
= inb(ioaddr
+ EREG_DATA
);
3880 if (tty
== NULL
|| (buflen
= tty_buffer_request_room(tty
, len
)) == 0) {
3881 len
= MIN(len
, sizeof(stl_unwanted
));
3882 outb((RDSR
+ portp
->uartaddr
), ioaddr
);
3883 insb((ioaddr
+ EREG_DATA
), &stl_unwanted
[0], len
);
3884 portp
->stats
.rxlost
+= len
;
3885 portp
->stats
.rxtotal
+= len
;
3887 len
= MIN(len
, buflen
);
3890 outb((RDSR
+ portp
->uartaddr
), ioaddr
);
3891 tty_prepare_flip_string(tty
, &ptr
, len
);
3892 insb((ioaddr
+ EREG_DATA
), ptr
, len
);
3893 tty_schedule_flip(tty
);
3894 portp
->stats
.rxtotal
+= len
;
3897 } else if ((ioack
& ACK_TYPMASK
) == ACK_TYPRXBAD
) {
3898 outb((RDSR
+ portp
->uartaddr
), ioaddr
);
3899 status
= inb(ioaddr
+ EREG_DATA
);
3900 ch
= inb(ioaddr
+ EREG_DATA
);
3901 if (status
& ST_PARITY
)
3902 portp
->stats
.rxparity
++;
3903 if (status
& ST_FRAMING
)
3904 portp
->stats
.rxframing
++;
3905 if (status
& ST_OVERRUN
)
3906 portp
->stats
.rxoverrun
++;
3907 if (status
& ST_BREAK
)
3908 portp
->stats
.rxbreaks
++;
3909 if (status
& ST_SCHARMASK
) {
3910 if ((status
& ST_SCHARMASK
) == ST_SCHAR1
)
3911 portp
->stats
.txxon
++;
3912 if ((status
& ST_SCHARMASK
) == ST_SCHAR2
)
3913 portp
->stats
.txxoff
++;
3916 if (tty
!= NULL
&& (portp
->rxignoremsk
& status
) == 0) {
3917 if (portp
->rxmarkmsk
& status
) {
3918 if (status
& ST_BREAK
) {
3920 if (portp
->flags
& ASYNC_SAK
) {
3922 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
3924 } else if (status
& ST_PARITY
) {
3925 status
= TTY_PARITY
;
3926 } else if (status
& ST_FRAMING
) {
3928 } else if(status
& ST_OVERRUN
) {
3929 status
= TTY_OVERRUN
;
3936 tty_insert_flip_char(tty
, ch
, status
);
3937 tty_schedule_flip(tty
);
3940 printk("STALLION: bad RX interrupt ack value=%x\n", ioack
);
3945 outb((EOSRR
+ portp
->uartaddr
), ioaddr
);
3946 outb(0, (ioaddr
+ EREG_DATA
));
3949 /*****************************************************************************/
3952 * Modem interrupt handler. The is called when the modem signal line
3953 * (DCD) has changed state. Leave most of the work to the off-level
3954 * processing routine.
3957 static void stl_cd1400mdmisr(stlpanel_t
*panelp
, int ioaddr
)
3963 pr_debug("stl_cd1400mdmisr(panelp=%p)\n", panelp
);
3965 ioack
= inb(ioaddr
+ EREG_MDACK
);
3966 if (((ioack
& panelp
->ackmask
) != 0) ||
3967 ((ioack
& ACK_TYPMASK
) != ACK_TYPMDM
)) {
3968 printk("STALLION: bad MODEM interrupt ack value=%x\n", ioack
);
3971 portp
= panelp
->ports
[(ioack
>> 3)];
3973 outb((MISR
+ portp
->uartaddr
), ioaddr
);
3974 misr
= inb(ioaddr
+ EREG_DATA
);
3975 if (misr
& MISR_DCD
) {
3976 set_bit(ASYI_DCDCHANGE
, &portp
->istate
);
3977 schedule_work(&portp
->tqueue
);
3978 portp
->stats
.modem
++;
3981 outb((EOSRR
+ portp
->uartaddr
), ioaddr
);
3982 outb(0, (ioaddr
+ EREG_DATA
));
3985 /*****************************************************************************/
3986 /* SC26198 HARDWARE FUNCTIONS */
3987 /*****************************************************************************/
3990 * These functions get/set/update the registers of the sc26198 UARTs.
3991 * Access to the sc26198 registers is via an address/data io port pair.
3992 * (Maybe should make this inline...)
3995 static int stl_sc26198getreg(stlport_t
*portp
, int regnr
)
3997 outb((regnr
| portp
->uartaddr
), (portp
->ioaddr
+ XP_ADDR
));
3998 return inb(portp
->ioaddr
+ XP_DATA
);
4001 static void stl_sc26198setreg(stlport_t
*portp
, int regnr
, int value
)
4003 outb((regnr
| portp
->uartaddr
), (portp
->ioaddr
+ XP_ADDR
));
4004 outb(value
, (portp
->ioaddr
+ XP_DATA
));
4007 static int stl_sc26198updatereg(stlport_t
*portp
, int regnr
, int value
)
4009 outb((regnr
| portp
->uartaddr
), (portp
->ioaddr
+ XP_ADDR
));
4010 if (inb(portp
->ioaddr
+ XP_DATA
) != value
) {
4011 outb(value
, (portp
->ioaddr
+ XP_DATA
));
4017 /*****************************************************************************/
4020 * Functions to get and set the sc26198 global registers.
4023 static int stl_sc26198getglobreg(stlport_t
*portp
, int regnr
)
4025 outb(regnr
, (portp
->ioaddr
+ XP_ADDR
));
4026 return inb(portp
->ioaddr
+ XP_DATA
);
4030 static void stl_sc26198setglobreg(stlport_t
*portp
, int regnr
, int value
)
4032 outb(regnr
, (portp
->ioaddr
+ XP_ADDR
));
4033 outb(value
, (portp
->ioaddr
+ XP_DATA
));
4037 /*****************************************************************************/
4040 * Inbitialize the UARTs in a panel. We don't care what sort of board
4041 * these ports are on - since the port io registers are almost
4042 * identical when dealing with ports.
4045 static int stl_sc26198panelinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
)
4048 int nrchips
, ioaddr
;
4050 pr_debug("stl_sc26198panelinit(brdp=%p,panelp=%p)\n", brdp
, panelp
);
4052 BRDENABLE(panelp
->brdnr
, panelp
->pagenr
);
4055 * Check that each chip is present and started up OK.
4058 nrchips
= (panelp
->nrports
+ 4) / SC26198_PORTS
;
4059 if (brdp
->brdtype
== BRD_ECHPCI
)
4060 outb(panelp
->pagenr
, brdp
->ioctrl
);
4062 for (i
= 0; (i
< nrchips
); i
++) {
4063 ioaddr
= panelp
->iobase
+ (i
* 4);
4064 outb(SCCR
, (ioaddr
+ XP_ADDR
));
4065 outb(CR_RESETALL
, (ioaddr
+ XP_DATA
));
4066 outb(TSTR
, (ioaddr
+ XP_ADDR
));
4067 if (inb(ioaddr
+ XP_DATA
) != 0) {
4068 printk("STALLION: sc26198 not responding, "
4069 "brd=%d panel=%d chip=%d\n",
4070 panelp
->brdnr
, panelp
->panelnr
, i
);
4073 chipmask
|= (0x1 << i
);
4074 outb(GCCR
, (ioaddr
+ XP_ADDR
));
4075 outb(GCCR_IVRTYPCHANACK
, (ioaddr
+ XP_DATA
));
4076 outb(WDTRCR
, (ioaddr
+ XP_ADDR
));
4077 outb(0xff, (ioaddr
+ XP_DATA
));
4080 BRDDISABLE(panelp
->brdnr
);
4084 /*****************************************************************************/
4087 * Initialize hardware specific port registers.
4090 static void stl_sc26198portinit(stlbrd_t
*brdp
, stlpanel_t
*panelp
, stlport_t
*portp
)
4092 pr_debug("stl_sc26198portinit(brdp=%p,panelp=%p,portp=%p)\n", brdp
,
4095 if ((brdp
== (stlbrd_t
*) NULL
) || (panelp
== (stlpanel_t
*) NULL
) ||
4096 (portp
== (stlport_t
*) NULL
))
4099 portp
->ioaddr
= panelp
->iobase
+ ((portp
->portnr
< 8) ? 0 : 4);
4100 portp
->uartaddr
= (portp
->portnr
& 0x07) << 4;
4101 portp
->pagenr
= panelp
->pagenr
;
4104 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4105 stl_sc26198setreg(portp
, IOPCR
, IOPCR_SETSIGS
);
4106 BRDDISABLE(portp
->brdnr
);
4109 /*****************************************************************************/
4112 * Set up the sc26198 registers for a port based on the termios port
4116 static void stl_sc26198setport(stlport_t
*portp
, struct termios
*tiosp
)
4119 unsigned long flags
;
4120 unsigned int baudrate
;
4121 unsigned char mr0
, mr1
, mr2
, clk
;
4122 unsigned char imron
, imroff
, iopr
, ipr
;
4132 brdp
= stl_brds
[portp
->brdnr
];
4133 if (brdp
== (stlbrd_t
*) NULL
)
4137 * Set up the RX char ignore mask with those RX error types we
4140 portp
->rxignoremsk
= 0;
4141 if (tiosp
->c_iflag
& IGNPAR
)
4142 portp
->rxignoremsk
|= (SR_RXPARITY
| SR_RXFRAMING
|
4144 if (tiosp
->c_iflag
& IGNBRK
)
4145 portp
->rxignoremsk
|= SR_RXBREAK
;
4147 portp
->rxmarkmsk
= SR_RXOVERRUN
;
4148 if (tiosp
->c_iflag
& (INPCK
| PARMRK
))
4149 portp
->rxmarkmsk
|= (SR_RXPARITY
| SR_RXFRAMING
);
4150 if (tiosp
->c_iflag
& BRKINT
)
4151 portp
->rxmarkmsk
|= SR_RXBREAK
;
4154 * Go through the char size, parity and stop bits and set all the
4155 * option register appropriately.
4157 switch (tiosp
->c_cflag
& CSIZE
) {
4172 if (tiosp
->c_cflag
& CSTOPB
)
4177 if (tiosp
->c_cflag
& PARENB
) {
4178 if (tiosp
->c_cflag
& PARODD
)
4179 mr1
|= (MR1_PARENB
| MR1_PARODD
);
4181 mr1
|= (MR1_PARENB
| MR1_PAREVEN
);
4186 mr1
|= MR1_ERRBLOCK
;
4189 * Set the RX FIFO threshold at 8 chars. This gives a bit of breathing
4190 * space for hardware flow control and the like. This should be set to
4193 mr2
|= MR2_RXFIFOHALF
;
4196 * Calculate the baud rate timers. For now we will just assume that
4197 * the input and output baud are the same. The sc26198 has a fixed
4198 * baud rate table, so only discrete baud rates possible.
4200 baudrate
= tiosp
->c_cflag
& CBAUD
;
4201 if (baudrate
& CBAUDEX
) {
4202 baudrate
&= ~CBAUDEX
;
4203 if ((baudrate
< 1) || (baudrate
> 4))
4204 tiosp
->c_cflag
&= ~CBAUDEX
;
4208 baudrate
= stl_baudrates
[baudrate
];
4209 if ((tiosp
->c_cflag
& CBAUD
) == B38400
) {
4210 if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_HI
)
4212 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_VHI
)
4214 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_SHI
)
4216 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_WARP
)
4218 else if ((portp
->flags
& ASYNC_SPD_MASK
) == ASYNC_SPD_CUST
)
4219 baudrate
= (portp
->baud_base
/ portp
->custom_divisor
);
4221 if (baudrate
> STL_SC26198MAXBAUD
)
4222 baudrate
= STL_SC26198MAXBAUD
;
4225 for (clk
= 0; (clk
< SC26198_NRBAUDS
); clk
++) {
4226 if (baudrate
<= sc26198_baudtable
[clk
])
4232 * Check what form of modem signaling is required and set it up.
4234 if (tiosp
->c_cflag
& CLOCAL
) {
4235 portp
->flags
&= ~ASYNC_CHECK_CD
;
4237 iopr
|= IOPR_DCDCOS
;
4239 portp
->flags
|= ASYNC_CHECK_CD
;
4243 * Setup sc26198 enhanced modes if we can. In particular we want to
4244 * handle as much of the flow control as possible automatically. As
4245 * well as saving a few CPU cycles it will also greatly improve flow
4246 * control reliability.
4248 if (tiosp
->c_iflag
& IXON
) {
4249 mr0
|= MR0_SWFTX
| MR0_SWFT
;
4250 imron
|= IR_XONXOFF
;
4252 imroff
|= IR_XONXOFF
;
4254 if (tiosp
->c_iflag
& IXOFF
)
4257 if (tiosp
->c_cflag
& CRTSCTS
) {
4263 * All sc26198 register values calculated so go through and set
4267 pr_debug("SETPORT: portnr=%d panelnr=%d brdnr=%d\n",
4268 portp
->portnr
, portp
->panelnr
, portp
->brdnr
);
4269 pr_debug(" mr0=%x mr1=%x mr2=%x clk=%x\n", mr0
, mr1
, mr2
, clk
);
4270 pr_debug(" iopr=%x imron=%x imroff=%x\n", iopr
, imron
, imroff
);
4271 pr_debug(" schr1=%x schr2=%x schr3=%x schr4=%x\n",
4272 tiosp
->c_cc
[VSTART
], tiosp
->c_cc
[VSTOP
],
4273 tiosp
->c_cc
[VSTART
], tiosp
->c_cc
[VSTOP
]);
4275 spin_lock_irqsave(&brd_lock
, flags
);
4276 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4277 stl_sc26198setreg(portp
, IMR
, 0);
4278 stl_sc26198updatereg(portp
, MR0
, mr0
);
4279 stl_sc26198updatereg(portp
, MR1
, mr1
);
4280 stl_sc26198setreg(portp
, SCCR
, CR_RXERRBLOCK
);
4281 stl_sc26198updatereg(portp
, MR2
, mr2
);
4282 stl_sc26198updatereg(portp
, IOPIOR
,
4283 ((stl_sc26198getreg(portp
, IOPIOR
) & ~IPR_CHANGEMASK
) | iopr
));
4286 stl_sc26198setreg(portp
, TXCSR
, clk
);
4287 stl_sc26198setreg(portp
, RXCSR
, clk
);
4290 stl_sc26198setreg(portp
, XONCR
, tiosp
->c_cc
[VSTART
]);
4291 stl_sc26198setreg(portp
, XOFFCR
, tiosp
->c_cc
[VSTOP
]);
4293 ipr
= stl_sc26198getreg(portp
, IPR
);
4295 portp
->sigs
&= ~TIOCM_CD
;
4297 portp
->sigs
|= TIOCM_CD
;
4299 portp
->imr
= (portp
->imr
& ~imroff
) | imron
;
4300 stl_sc26198setreg(portp
, IMR
, portp
->imr
);
4301 BRDDISABLE(portp
->brdnr
);
4302 spin_unlock_irqrestore(&brd_lock
, flags
);
4305 /*****************************************************************************/
4308 * Set the state of the DTR and RTS signals.
4311 static void stl_sc26198setsignals(stlport_t
*portp
, int dtr
, int rts
)
4313 unsigned char iopioron
, iopioroff
;
4314 unsigned long flags
;
4316 pr_debug("stl_sc26198setsignals(portp=%p,dtr=%d,rts=%d)\n", portp
,
4322 iopioroff
|= IPR_DTR
;
4324 iopioron
|= IPR_DTR
;
4326 iopioroff
|= IPR_RTS
;
4328 iopioron
|= IPR_RTS
;
4330 spin_lock_irqsave(&brd_lock
, flags
);
4331 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4332 stl_sc26198setreg(portp
, IOPIOR
,
4333 ((stl_sc26198getreg(portp
, IOPIOR
) & ~iopioroff
) | iopioron
));
4334 BRDDISABLE(portp
->brdnr
);
4335 spin_unlock_irqrestore(&brd_lock
, flags
);
4338 /*****************************************************************************/
4341 * Return the state of the signals.
4344 static int stl_sc26198getsignals(stlport_t
*portp
)
4347 unsigned long flags
;
4350 pr_debug("stl_sc26198getsignals(portp=%p)\n", portp
);
4352 spin_lock_irqsave(&brd_lock
, flags
);
4353 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4354 ipr
= stl_sc26198getreg(portp
, IPR
);
4355 BRDDISABLE(portp
->brdnr
);
4356 spin_unlock_irqrestore(&brd_lock
, flags
);
4359 sigs
|= (ipr
& IPR_DCD
) ? 0 : TIOCM_CD
;
4360 sigs
|= (ipr
& IPR_CTS
) ? 0 : TIOCM_CTS
;
4361 sigs
|= (ipr
& IPR_DTR
) ? 0: TIOCM_DTR
;
4362 sigs
|= (ipr
& IPR_RTS
) ? 0: TIOCM_RTS
;
4367 /*****************************************************************************/
4370 * Enable/Disable the Transmitter and/or Receiver.
4373 static void stl_sc26198enablerxtx(stlport_t
*portp
, int rx
, int tx
)
4376 unsigned long flags
;
4378 pr_debug("stl_sc26198enablerxtx(portp=%p,rx=%d,tx=%d)\n", portp
, rx
,tx
);
4380 ccr
= portp
->crenable
;
4382 ccr
&= ~CR_TXENABLE
;
4386 ccr
&= ~CR_RXENABLE
;
4390 spin_lock_irqsave(&brd_lock
, flags
);
4391 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4392 stl_sc26198setreg(portp
, SCCR
, ccr
);
4393 BRDDISABLE(portp
->brdnr
);
4394 portp
->crenable
= ccr
;
4395 spin_unlock_irqrestore(&brd_lock
, flags
);
4398 /*****************************************************************************/
4401 * Start/stop the Transmitter and/or Receiver.
4404 static void stl_sc26198startrxtx(stlport_t
*portp
, int rx
, int tx
)
4407 unsigned long flags
;
4409 pr_debug("stl_sc26198startrxtx(portp=%p,rx=%d,tx=%d)\n", portp
, rx
, tx
);
4417 imr
&= ~(IR_RXRDY
| IR_RXBREAK
| IR_RXWATCHDOG
);
4419 imr
|= IR_RXRDY
| IR_RXBREAK
| IR_RXWATCHDOG
;
4421 spin_lock_irqsave(&brd_lock
, flags
);
4422 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4423 stl_sc26198setreg(portp
, IMR
, imr
);
4424 BRDDISABLE(portp
->brdnr
);
4427 set_bit(ASYI_TXBUSY
, &portp
->istate
);
4428 spin_unlock_irqrestore(&brd_lock
, flags
);
4431 /*****************************************************************************/
4434 * Disable all interrupts from this port.
4437 static void stl_sc26198disableintrs(stlport_t
*portp
)
4439 unsigned long flags
;
4441 pr_debug("stl_sc26198disableintrs(portp=%p)\n", portp
);
4443 spin_lock_irqsave(&brd_lock
, flags
);
4444 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4446 stl_sc26198setreg(portp
, IMR
, 0);
4447 BRDDISABLE(portp
->brdnr
);
4448 spin_unlock_irqrestore(&brd_lock
, flags
);
4451 /*****************************************************************************/
4453 static void stl_sc26198sendbreak(stlport_t
*portp
, int len
)
4455 unsigned long flags
;
4457 pr_debug("stl_sc26198sendbreak(portp=%p,len=%d)\n", portp
, len
);
4459 spin_lock_irqsave(&brd_lock
, flags
);
4460 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4462 stl_sc26198setreg(portp
, SCCR
, CR_TXSTARTBREAK
);
4463 portp
->stats
.txbreaks
++;
4465 stl_sc26198setreg(portp
, SCCR
, CR_TXSTOPBREAK
);
4467 BRDDISABLE(portp
->brdnr
);
4468 spin_unlock_irqrestore(&brd_lock
, flags
);
4471 /*****************************************************************************/
4474 * Take flow control actions...
4477 static void stl_sc26198flowctrl(stlport_t
*portp
, int state
)
4479 struct tty_struct
*tty
;
4480 unsigned long flags
;
4483 pr_debug("stl_sc26198flowctrl(portp=%p,state=%x)\n", portp
, state
);
4485 if (portp
== (stlport_t
*) NULL
)
4488 if (tty
== (struct tty_struct
*) NULL
)
4491 spin_lock_irqsave(&brd_lock
, flags
);
4492 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4495 if (tty
->termios
->c_iflag
& IXOFF
) {
4496 mr0
= stl_sc26198getreg(portp
, MR0
);
4497 stl_sc26198setreg(portp
, MR0
, (mr0
& ~MR0_SWFRXTX
));
4498 stl_sc26198setreg(portp
, SCCR
, CR_TXSENDXON
);
4500 portp
->stats
.rxxon
++;
4501 stl_sc26198wait(portp
);
4502 stl_sc26198setreg(portp
, MR0
, mr0
);
4505 * Question: should we return RTS to what it was before? It may
4506 * have been set by an ioctl... Suppose not, since if you have
4507 * hardware flow control set then it is pretty silly to go and
4508 * set the RTS line by hand.
4510 if (tty
->termios
->c_cflag
& CRTSCTS
) {
4511 stl_sc26198setreg(portp
, MR1
,
4512 (stl_sc26198getreg(portp
, MR1
) | MR1_AUTORTS
));
4513 stl_sc26198setreg(portp
, IOPIOR
,
4514 (stl_sc26198getreg(portp
, IOPIOR
) | IOPR_RTS
));
4515 portp
->stats
.rxrtson
++;
4518 if (tty
->termios
->c_iflag
& IXOFF
) {
4519 mr0
= stl_sc26198getreg(portp
, MR0
);
4520 stl_sc26198setreg(portp
, MR0
, (mr0
& ~MR0_SWFRXTX
));
4521 stl_sc26198setreg(portp
, SCCR
, CR_TXSENDXOFF
);
4523 portp
->stats
.rxxoff
++;
4524 stl_sc26198wait(portp
);
4525 stl_sc26198setreg(portp
, MR0
, mr0
);
4527 if (tty
->termios
->c_cflag
& CRTSCTS
) {
4528 stl_sc26198setreg(portp
, MR1
,
4529 (stl_sc26198getreg(portp
, MR1
) & ~MR1_AUTORTS
));
4530 stl_sc26198setreg(portp
, IOPIOR
,
4531 (stl_sc26198getreg(portp
, IOPIOR
) & ~IOPR_RTS
));
4532 portp
->stats
.rxrtsoff
++;
4536 BRDDISABLE(portp
->brdnr
);
4537 spin_unlock_irqrestore(&brd_lock
, flags
);
4540 /*****************************************************************************/
4543 * Send a flow control character.
4546 static void stl_sc26198sendflow(stlport_t
*portp
, int state
)
4548 struct tty_struct
*tty
;
4549 unsigned long flags
;
4552 pr_debug("stl_sc26198sendflow(portp=%p,state=%x)\n", portp
, state
);
4554 if (portp
== (stlport_t
*) NULL
)
4557 if (tty
== (struct tty_struct
*) NULL
)
4560 spin_lock_irqsave(&brd_lock
, flags
);
4561 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4563 mr0
= stl_sc26198getreg(portp
, MR0
);
4564 stl_sc26198setreg(portp
, MR0
, (mr0
& ~MR0_SWFRXTX
));
4565 stl_sc26198setreg(portp
, SCCR
, CR_TXSENDXON
);
4567 portp
->stats
.rxxon
++;
4568 stl_sc26198wait(portp
);
4569 stl_sc26198setreg(portp
, MR0
, mr0
);
4571 mr0
= stl_sc26198getreg(portp
, MR0
);
4572 stl_sc26198setreg(portp
, MR0
, (mr0
& ~MR0_SWFRXTX
));
4573 stl_sc26198setreg(portp
, SCCR
, CR_TXSENDXOFF
);
4575 portp
->stats
.rxxoff
++;
4576 stl_sc26198wait(portp
);
4577 stl_sc26198setreg(portp
, MR0
, mr0
);
4579 BRDDISABLE(portp
->brdnr
);
4580 spin_unlock_irqrestore(&brd_lock
, flags
);
4583 /*****************************************************************************/
4585 static void stl_sc26198flush(stlport_t
*portp
)
4587 unsigned long flags
;
4589 pr_debug("stl_sc26198flush(portp=%p)\n", portp
);
4591 if (portp
== (stlport_t
*) NULL
)
4594 spin_lock_irqsave(&brd_lock
, flags
);
4595 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4596 stl_sc26198setreg(portp
, SCCR
, CR_TXRESET
);
4597 stl_sc26198setreg(portp
, SCCR
, portp
->crenable
);
4598 BRDDISABLE(portp
->brdnr
);
4599 portp
->tx
.tail
= portp
->tx
.head
;
4600 spin_unlock_irqrestore(&brd_lock
, flags
);
4603 /*****************************************************************************/
4606 * Return the current state of data flow on this port. This is only
4607 * really interresting when determining if data has fully completed
4608 * transmission or not... The sc26198 interrupt scheme cannot
4609 * determine when all data has actually drained, so we need to
4610 * check the port statusy register to be sure.
4613 static int stl_sc26198datastate(stlport_t
*portp
)
4615 unsigned long flags
;
4618 pr_debug("stl_sc26198datastate(portp=%p)\n", portp
);
4620 if (portp
== (stlport_t
*) NULL
)
4622 if (test_bit(ASYI_TXBUSY
, &portp
->istate
))
4625 spin_lock_irqsave(&brd_lock
, flags
);
4626 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4627 sr
= stl_sc26198getreg(portp
, SR
);
4628 BRDDISABLE(portp
->brdnr
);
4629 spin_unlock_irqrestore(&brd_lock
, flags
);
4631 return (sr
& SR_TXEMPTY
) ? 0 : 1;
4634 /*****************************************************************************/
4637 * Delay for a small amount of time, to give the sc26198 a chance
4638 * to process a command...
4641 static void stl_sc26198wait(stlport_t
*portp
)
4645 pr_debug("stl_sc26198wait(portp=%p)\n", portp
);
4647 if (portp
== (stlport_t
*) NULL
)
4650 for (i
= 0; (i
< 20); i
++)
4651 stl_sc26198getglobreg(portp
, TSTR
);
4654 /*****************************************************************************/
4657 * If we are TX flow controlled and in IXANY mode then we may
4658 * need to unflow control here. We gotta do this because of the
4659 * automatic flow control modes of the sc26198.
4662 static inline void stl_sc26198txunflow(stlport_t
*portp
, struct tty_struct
*tty
)
4666 mr0
= stl_sc26198getreg(portp
, MR0
);
4667 stl_sc26198setreg(portp
, MR0
, (mr0
& ~MR0_SWFRXTX
));
4668 stl_sc26198setreg(portp
, SCCR
, CR_HOSTXON
);
4669 stl_sc26198wait(portp
);
4670 stl_sc26198setreg(portp
, MR0
, mr0
);
4671 clear_bit(ASYI_TXFLOWED
, &portp
->istate
);
4674 /*****************************************************************************/
4677 * Interrupt service routine for sc26198 panels.
4680 static void stl_sc26198intr(stlpanel_t
*panelp
, unsigned int iobase
)
4685 spin_lock(&brd_lock
);
4688 * Work around bug in sc26198 chip... Cannot have A6 address
4689 * line of UART high, else iack will be returned as 0.
4691 outb(0, (iobase
+ 1));
4693 iack
= inb(iobase
+ XP_IACK
);
4694 portp
= panelp
->ports
[(iack
& IVR_CHANMASK
) + ((iobase
& 0x4) << 1)];
4696 if (iack
& IVR_RXDATA
)
4697 stl_sc26198rxisr(portp
, iack
);
4698 else if (iack
& IVR_TXDATA
)
4699 stl_sc26198txisr(portp
);
4701 stl_sc26198otherisr(portp
, iack
);
4703 spin_unlock(&brd_lock
);
4706 /*****************************************************************************/
4709 * Transmit interrupt handler. This has gotta be fast! Handling TX
4710 * chars is pretty simple, stuff as many as possible from the TX buffer
4711 * into the sc26198 FIFO.
4712 * In practice it is possible that interrupts are enabled but that the
4713 * port has been hung up. Need to handle not having any TX buffer here,
4714 * this is done by using the side effect that head and tail will also
4715 * be NULL if the buffer has been freed.
4718 static void stl_sc26198txisr(stlport_t
*portp
)
4720 unsigned int ioaddr
;
4725 pr_debug("stl_sc26198txisr(portp=%p)\n", portp
);
4727 ioaddr
= portp
->ioaddr
;
4728 head
= portp
->tx
.head
;
4729 tail
= portp
->tx
.tail
;
4730 len
= (head
>= tail
) ? (head
- tail
) : (STL_TXBUFSIZE
- (tail
- head
));
4731 if ((len
== 0) || ((len
< STL_TXBUFLOW
) &&
4732 (test_bit(ASYI_TXLOW
, &portp
->istate
) == 0))) {
4733 set_bit(ASYI_TXLOW
, &portp
->istate
);
4734 schedule_work(&portp
->tqueue
);
4738 outb((MR0
| portp
->uartaddr
), (ioaddr
+ XP_ADDR
));
4739 mr0
= inb(ioaddr
+ XP_DATA
);
4740 if ((mr0
& MR0_TXMASK
) == MR0_TXEMPTY
) {
4741 portp
->imr
&= ~IR_TXRDY
;
4742 outb((IMR
| portp
->uartaddr
), (ioaddr
+ XP_ADDR
));
4743 outb(portp
->imr
, (ioaddr
+ XP_DATA
));
4744 clear_bit(ASYI_TXBUSY
, &portp
->istate
);
4746 mr0
|= ((mr0
& ~MR0_TXMASK
) | MR0_TXEMPTY
);
4747 outb(mr0
, (ioaddr
+ XP_DATA
));
4750 len
= MIN(len
, SC26198_TXFIFOSIZE
);
4751 portp
->stats
.txtotal
+= len
;
4752 stlen
= MIN(len
, ((portp
->tx
.buf
+ STL_TXBUFSIZE
) - tail
));
4753 outb(GTXFIFO
, (ioaddr
+ XP_ADDR
));
4754 outsb((ioaddr
+ XP_DATA
), tail
, stlen
);
4757 if (tail
>= (portp
->tx
.buf
+ STL_TXBUFSIZE
))
4758 tail
= portp
->tx
.buf
;
4760 outsb((ioaddr
+ XP_DATA
), tail
, len
);
4763 portp
->tx
.tail
= tail
;
4767 /*****************************************************************************/
4770 * Receive character interrupt handler. Determine if we have good chars
4771 * or bad chars and then process appropriately. Good chars are easy
4772 * just shove the lot into the RX buffer and set all status byte to 0.
4773 * If a bad RX char then process as required. This routine needs to be
4774 * fast! In practice it is possible that we get an interrupt on a port
4775 * that is closed. This can happen on hangups - since they completely
4776 * shutdown a port not in user context. Need to handle this case.
4779 static void stl_sc26198rxisr(stlport_t
*portp
, unsigned int iack
)
4781 struct tty_struct
*tty
;
4782 unsigned int len
, buflen
, ioaddr
;
4784 pr_debug("stl_sc26198rxisr(portp=%p,iack=%x)\n", portp
, iack
);
4787 ioaddr
= portp
->ioaddr
;
4788 outb(GIBCR
, (ioaddr
+ XP_ADDR
));
4789 len
= inb(ioaddr
+ XP_DATA
) + 1;
4791 if ((iack
& IVR_TYPEMASK
) == IVR_RXDATA
) {
4792 if (tty
== NULL
|| (buflen
= tty_buffer_request_room(tty
, len
)) == 0) {
4793 len
= MIN(len
, sizeof(stl_unwanted
));
4794 outb(GRXFIFO
, (ioaddr
+ XP_ADDR
));
4795 insb((ioaddr
+ XP_DATA
), &stl_unwanted
[0], len
);
4796 portp
->stats
.rxlost
+= len
;
4797 portp
->stats
.rxtotal
+= len
;
4799 len
= MIN(len
, buflen
);
4802 outb(GRXFIFO
, (ioaddr
+ XP_ADDR
));
4803 tty_prepare_flip_string(tty
, &ptr
, len
);
4804 insb((ioaddr
+ XP_DATA
), ptr
, len
);
4805 tty_schedule_flip(tty
);
4806 portp
->stats
.rxtotal
+= len
;
4810 stl_sc26198rxbadchars(portp
);
4814 * If we are TX flow controlled and in IXANY mode then we may need
4815 * to unflow control here. We gotta do this because of the automatic
4816 * flow control modes of the sc26198.
4818 if (test_bit(ASYI_TXFLOWED
, &portp
->istate
)) {
4819 if ((tty
!= (struct tty_struct
*) NULL
) &&
4820 (tty
->termios
!= (struct termios
*) NULL
) &&
4821 (tty
->termios
->c_iflag
& IXANY
)) {
4822 stl_sc26198txunflow(portp
, tty
);
4827 /*****************************************************************************/
4830 * Process an RX bad character.
4833 static inline void stl_sc26198rxbadch(stlport_t
*portp
, unsigned char status
, char ch
)
4835 struct tty_struct
*tty
;
4836 unsigned int ioaddr
;
4839 ioaddr
= portp
->ioaddr
;
4841 if (status
& SR_RXPARITY
)
4842 portp
->stats
.rxparity
++;
4843 if (status
& SR_RXFRAMING
)
4844 portp
->stats
.rxframing
++;
4845 if (status
& SR_RXOVERRUN
)
4846 portp
->stats
.rxoverrun
++;
4847 if (status
& SR_RXBREAK
)
4848 portp
->stats
.rxbreaks
++;
4850 if ((tty
!= (struct tty_struct
*) NULL
) &&
4851 ((portp
->rxignoremsk
& status
) == 0)) {
4852 if (portp
->rxmarkmsk
& status
) {
4853 if (status
& SR_RXBREAK
) {
4855 if (portp
->flags
& ASYNC_SAK
) {
4857 BRDENABLE(portp
->brdnr
, portp
->pagenr
);
4859 } else if (status
& SR_RXPARITY
) {
4860 status
= TTY_PARITY
;
4861 } else if (status
& SR_RXFRAMING
) {
4863 } else if(status
& SR_RXOVERRUN
) {
4864 status
= TTY_OVERRUN
;
4872 tty_insert_flip_char(tty
, ch
, status
);
4873 tty_schedule_flip(tty
);
4876 portp
->stats
.rxtotal
++;
4880 /*****************************************************************************/
4883 * Process all characters in the RX FIFO of the UART. Check all char
4884 * status bytes as well, and process as required. We need to check
4885 * all bytes in the FIFO, in case some more enter the FIFO while we
4886 * are here. To get the exact character error type we need to switch
4887 * into CHAR error mode (that is why we need to make sure we empty
4891 static void stl_sc26198rxbadchars(stlport_t
*portp
)
4893 unsigned char status
, mr1
;
4897 * To get the precise error type for each character we must switch
4898 * back into CHAR error mode.
4900 mr1
= stl_sc26198getreg(portp
, MR1
);
4901 stl_sc26198setreg(portp
, MR1
, (mr1
& ~MR1_ERRBLOCK
));
4903 while ((status
= stl_sc26198getreg(portp
, SR
)) & SR_RXRDY
) {
4904 stl_sc26198setreg(portp
, SCCR
, CR_CLEARRXERR
);
4905 ch
= stl_sc26198getreg(portp
, RXFIFO
);
4906 stl_sc26198rxbadch(portp
, status
, ch
);
4910 * To get correct interrupt class we must switch back into BLOCK
4913 stl_sc26198setreg(portp
, MR1
, mr1
);
4916 /*****************************************************************************/
4919 * Other interrupt handler. This includes modem signals, flow
4920 * control actions, etc. Most stuff is left to off-level interrupt
4924 static void stl_sc26198otherisr(stlport_t
*portp
, unsigned int iack
)
4926 unsigned char cir
, ipr
, xisr
;
4928 pr_debug("stl_sc26198otherisr(portp=%p,iack=%x)\n", portp
, iack
);
4930 cir
= stl_sc26198getglobreg(portp
, CIR
);
4932 switch (cir
& CIR_SUBTYPEMASK
) {
4934 ipr
= stl_sc26198getreg(portp
, IPR
);
4935 if (ipr
& IPR_DCDCHANGE
) {
4936 set_bit(ASYI_DCDCHANGE
, &portp
->istate
);
4937 schedule_work(&portp
->tqueue
);
4938 portp
->stats
.modem
++;
4941 case CIR_SUBXONXOFF
:
4942 xisr
= stl_sc26198getreg(portp
, XISR
);
4943 if (xisr
& XISR_RXXONGOT
) {
4944 set_bit(ASYI_TXFLOWED
, &portp
->istate
);
4945 portp
->stats
.txxoff
++;
4947 if (xisr
& XISR_RXXOFFGOT
) {
4948 clear_bit(ASYI_TXFLOWED
, &portp
->istate
);
4949 portp
->stats
.txxon
++;
4953 stl_sc26198setreg(portp
, SCCR
, CR_BREAKRESET
);
4954 stl_sc26198rxbadchars(portp
);
4961 /*****************************************************************************/