mirror of
https://git.FreeBSD.org/src.git
synced 2024-12-29 12:03:03 +00:00
512824f8f7
thread being waken up. The thread waken up can run at a priority as high as after tsleep(). - Replace selwakeup()s with selwakeuppri()s and pass appropriate priorities. - Add cv_broadcastpri() which raises the priority of the broadcast threads. Used by selwakeuppri() if collision occurs. Not objected in: -arch, -current
3078 lines
78 KiB
C
3078 lines
78 KiB
C
/*****************************************************************************/
|
|
|
|
/*
|
|
* stallion.c -- stallion multiport serial driver.
|
|
*
|
|
* Copyright (c) 1995-1996 Greg Ungerer (gerg@stallion.oz.au).
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by Greg Ungerer.
|
|
* 4. Neither the name of the author nor the names of any co-contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
/*****************************************************************************/
|
|
|
|
#define TTYDEFCHARS 1
|
|
|
|
#include "opt_compat.h"
|
|
#include "opt_tty.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/tty.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/fcntl.h>
|
|
#include <sys/bus.h>
|
|
#include <i386/isa/isa_device.h>
|
|
#include <i386/isa/ic/scd1400.h>
|
|
#include <machine/comstats.h>
|
|
|
|
#warning "The stallion pci attachment is broken and not compiled"
|
|
#define NPCI 0
|
|
#if NPCI > 0
|
|
#ifndef COMPAT_OLDPCI
|
|
#error "The stallion pci driver requires the old pci compatibility shims"
|
|
#endif
|
|
#include <dev/pci/pcivar.h>
|
|
#include <dev/pci/pcireg.h>
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Define the version level of the kernel - so we can compile in the
|
|
* appropriate bits of code. By default this will compile for a 2.1
|
|
* level kernel.
|
|
*/
|
|
#define VFREEBSD 220
|
|
|
|
#if VFREEBSD >= 220
|
|
#define STATIC static
|
|
#else
|
|
#define STATIC
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Define different board types. At the moment I have only declared
|
|
* those boards that this driver supports. But I will use the standard
|
|
* "assigned" board numbers. In the future this driver will support
|
|
* some of the other Stallion boards. Currently supported boards are
|
|
* abbreviated as EIO = EasyIO and ECH = EasyConnection 8/32.
|
|
*/
|
|
#define BRD_EASYIO 20
|
|
#define BRD_ECH 21
|
|
#define BRD_ECHMC 22
|
|
#define BRD_ECHPCI 26
|
|
|
|
/*
|
|
* When using the BSD "config" stuff there is no easy way to specifiy
|
|
* a secondary IO address region. So it is hard wired here. Also the
|
|
* shared interrupt information is hard wired here...
|
|
*/
|
|
static unsigned int stl_ioshared = 0x280;
|
|
static unsigned int stl_irqshared = 0;
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Define important driver limitations.
|
|
*/
|
|
#define STL_MAXBRDS 8
|
|
#define STL_MAXPANELS 4
|
|
#define STL_PORTSPERPANEL 16
|
|
#define STL_PORTSPERBRD 64
|
|
|
|
/*
|
|
* Define the important minor number break down bits. These have been
|
|
* chosen to be "compatible" with the standard sio driver minor numbers.
|
|
* Extra high bits are used to distinguish between boards.
|
|
*/
|
|
#define STL_CALLOUTDEV 0x80
|
|
#define STL_CTRLLOCK 0x40
|
|
#define STL_CTRLINIT 0x20
|
|
#define STL_CTRLDEV (STL_CTRLLOCK | STL_CTRLINIT)
|
|
|
|
#define STL_MEMDEV 0x07000000
|
|
|
|
#define STL_DEFSPEED TTYDEF_SPEED
|
|
#define STL_DEFCFLAG (CS8 | CREAD | HUPCL)
|
|
|
|
/*
|
|
* I haven't really decided (or measured) what buffer sizes give
|
|
* a good balance between performance and memory usage. These seem
|
|
* to work pretty well...
|
|
*/
|
|
#define STL_RXBUFSIZE 2048
|
|
#define STL_TXBUFSIZE 2048
|
|
|
|
#define STL_TXBUFLOW (STL_TXBUFSIZE / 4)
|
|
#define STL_RXBUFHIGH (3 * STL_RXBUFSIZE / 4)
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Define our local driver identity first. Set up stuff to deal with
|
|
* all the local structures required by a serial tty driver.
|
|
*/
|
|
static const char stl_drvname[] = "stl";
|
|
static const char stl_longdrvname[] = "Stallion Multiport Serial Driver";
|
|
static const char stl_drvversion[] = "1.0.0";
|
|
static int stl_brdprobed[STL_MAXBRDS];
|
|
|
|
static int stl_nrbrds = 0;
|
|
static int stl_doingtimeout = 0;
|
|
|
|
static const char __file__[] = /*__FILE__*/ "stallion.c";
|
|
|
|
/*
|
|
* Define global stats structures. Not used often, and can be
|
|
* re-used for each stats call.
|
|
*/
|
|
static combrd_t stl_brdstats;
|
|
static comstats_t stl_comstats;
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Define a set of structures to hold all the board/panel/port info
|
|
* for our ports. These will be dynamically allocated as required.
|
|
*/
|
|
|
|
/*
|
|
* Define a ring queue structure for each port. This will hold the
|
|
* TX data waiting to be output. Characters are fed into this buffer
|
|
* from the line discipline (or even direct from user space!) and
|
|
* then fed into the UARTs during interrupts. Will use a clasic ring
|
|
* queue here for this. The good thing about this type of ring queue
|
|
* is that the head and tail pointers can be updated without interrupt
|
|
* protection - since "write" code only needs to change the head, and
|
|
* interrupt code only needs to change the tail.
|
|
*/
|
|
typedef struct {
|
|
char *buf;
|
|
char *endbuf;
|
|
char *head;
|
|
char *tail;
|
|
} stlrq_t;
|
|
|
|
/*
|
|
* Port, panel and board structures to hold status info about each.
|
|
* The board structure contains pointers to structures for each panel
|
|
* connected to it, and in turn each panel structure contains pointers
|
|
* for each port structure for each port on that panel. Note that
|
|
* the port structure also contains the board and panel number that it
|
|
* is associated with, this makes it (fairly) easy to get back to the
|
|
* board/panel info for a port. Also note that the tty struct is at
|
|
* the top of the structure, this is important, since the code uses
|
|
* this fact to get the port struct pointer from the tty struct
|
|
* pointer!
|
|
*/
|
|
typedef struct {
|
|
struct tty tty;
|
|
int portnr;
|
|
int panelnr;
|
|
int brdnr;
|
|
int ioaddr;
|
|
int uartaddr;
|
|
int pagenr;
|
|
int callout;
|
|
int brklen;
|
|
int dtrwait;
|
|
int dotimestamp;
|
|
int waitopens;
|
|
int hotchar;
|
|
unsigned int state;
|
|
unsigned int hwid;
|
|
unsigned int sigs;
|
|
unsigned int rxignoremsk;
|
|
unsigned int rxmarkmsk;
|
|
unsigned long clk;
|
|
struct termios initintios;
|
|
struct termios initouttios;
|
|
struct termios lockintios;
|
|
struct termios lockouttios;
|
|
struct timeval timestamp;
|
|
comstats_t stats;
|
|
stlrq_t tx;
|
|
stlrq_t rx;
|
|
stlrq_t rxstatus;
|
|
} stlport_t;
|
|
|
|
typedef struct {
|
|
int panelnr;
|
|
int brdnr;
|
|
int pagenr;
|
|
int nrports;
|
|
int iobase;
|
|
unsigned int hwid;
|
|
unsigned int ackmask;
|
|
stlport_t *ports[STL_PORTSPERPANEL];
|
|
} stlpanel_t;
|
|
|
|
typedef struct {
|
|
int brdnr;
|
|
int brdtype;
|
|
int unitid;
|
|
int state;
|
|
int nrpanels;
|
|
int nrports;
|
|
int irq;
|
|
int irqtype;
|
|
unsigned int ioaddr1;
|
|
unsigned int ioaddr2;
|
|
unsigned int iostatus;
|
|
unsigned int ioctrl;
|
|
unsigned int ioctrlval;
|
|
unsigned int hwid;
|
|
unsigned long clk;
|
|
stlpanel_t *panels[STL_MAXPANELS];
|
|
stlport_t *ports[STL_PORTSPERBRD];
|
|
} stlbrd_t;
|
|
|
|
static stlbrd_t *stl_brds[STL_MAXBRDS];
|
|
|
|
/*
|
|
* Per board state flags. Used with the state field of the board struct.
|
|
* Not really much here yet!
|
|
*/
|
|
#define BRD_FOUND 0x1
|
|
|
|
/*
|
|
* Define the port structure state flags. These set of flags are
|
|
* modified at interrupt time - so setting and reseting them needs
|
|
* to be atomic.
|
|
*/
|
|
#define ASY_TXLOW 0x1
|
|
#define ASY_RXDATA 0x2
|
|
#define ASY_DCDCHANGE 0x4
|
|
#define ASY_DTRWAIT 0x8
|
|
#define ASY_RTSFLOW 0x10
|
|
#define ASY_RTSFLOWMODE 0x20
|
|
#define ASY_CTSFLOWMODE 0x40
|
|
|
|
#define ASY_ACTIVE (ASY_TXLOW | ASY_RXDATA | ASY_DCDCHANGE)
|
|
|
|
/*
|
|
* Define an array of board names as printable strings. Handy for
|
|
* referencing boards when printing trace and stuff.
|
|
*/
|
|
static char *stl_brdnames[] = {
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
"EasyIO",
|
|
"EC8/32-AT",
|
|
"EC8/32-MC",
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
(char *) NULL,
|
|
"EC8/32-PCI",
|
|
};
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Hardware ID bits for the EasyIO and ECH boards. These defines apply
|
|
* to the directly accessible io ports of these boards (not the cd1400
|
|
* uarts - they are in scd1400.h).
|
|
*/
|
|
#define EIO_8PORTRS 0x04
|
|
#define EIO_4PORTRS 0x05
|
|
#define EIO_8PORTDI 0x00
|
|
#define EIO_8PORTM 0x06
|
|
#define EIO_IDBITMASK 0x07
|
|
#define EIO_INTRPEND 0x08
|
|
#define EIO_INTEDGE 0x00
|
|
#define EIO_INTLEVEL 0x08
|
|
|
|
#define ECH_ID 0xa0
|
|
#define ECH_IDBITMASK 0xe0
|
|
#define ECH_BRDENABLE 0x08
|
|
#define ECH_BRDDISABLE 0x00
|
|
#define ECH_INTENABLE 0x01
|
|
#define ECH_INTDISABLE 0x00
|
|
#define ECH_INTLEVEL 0x02
|
|
#define ECH_INTEDGE 0x00
|
|
#define ECH_INTRPEND 0x01
|
|
#define ECH_BRDRESET 0x01
|
|
|
|
#define ECHMC_INTENABLE 0x01
|
|
#define ECHMC_BRDRESET 0x02
|
|
|
|
#define ECH_PNLSTATUS 2
|
|
#define ECH_PNL16PORT 0x20
|
|
#define ECH_PNLIDMASK 0x07
|
|
#define ECH_PNLINTRPEND 0x80
|
|
#define ECH_ADDR2MASK 0x1e0
|
|
|
|
#define EIO_CLK 25000000
|
|
#define EIO_CLK8M 20000000
|
|
#define ECH_CLK EIO_CLK
|
|
|
|
/*
|
|
* Define the offsets within the register bank for all io registers.
|
|
* These io address offsets are common to both the EIO and ECH.
|
|
*/
|
|
#define EREG_ADDR 0
|
|
#define EREG_DATA 4
|
|
#define EREG_RXACK 5
|
|
#define EREG_TXACK 6
|
|
#define EREG_MDACK 7
|
|
|
|
#define EREG_BANKSIZE 8
|
|
|
|
/*
|
|
* Define the PCI vendor and device id for ECH8/32-PCI.
|
|
*/
|
|
#define STL_PCIDEVID 0xd001100b
|
|
|
|
/*
|
|
* Define the vector mapping bits for the programmable interrupt board
|
|
* hardware. These bits encode the interrupt for the board to use - it
|
|
* is software selectable (except the EIO-8M).
|
|
*/
|
|
static unsigned char stl_vecmap[] = {
|
|
0xff, 0xff, 0xff, 0x04, 0x06, 0x05, 0xff, 0x07,
|
|
0xff, 0xff, 0x00, 0x02, 0x01, 0xff, 0xff, 0x03
|
|
};
|
|
|
|
/*
|
|
* Set up enable and disable macros for the ECH boards. They require
|
|
* the secondary io address space to be activated and deactivated.
|
|
* This way all ECH boards can share their secondary io region.
|
|
* If this is an ECH-PCI board then also need to set the page pointer
|
|
* to point to the correct page.
|
|
*/
|
|
#define BRDENABLE(brdnr,pagenr) \
|
|
if (stl_brds[(brdnr)]->brdtype == BRD_ECH) \
|
|
outb(stl_brds[(brdnr)]->ioctrl, \
|
|
(stl_brds[(brdnr)]->ioctrlval | ECH_BRDENABLE));\
|
|
else if (stl_brds[(brdnr)]->brdtype == BRD_ECHPCI) \
|
|
outb(stl_brds[(brdnr)]->ioctrl, (pagenr));
|
|
|
|
#define BRDDISABLE(brdnr) \
|
|
if (stl_brds[(brdnr)]->brdtype == BRD_ECH) \
|
|
outb(stl_brds[(brdnr)]->ioctrl, \
|
|
(stl_brds[(brdnr)]->ioctrlval | ECH_BRDDISABLE));
|
|
|
|
/*
|
|
* Define the cd1400 baud rate clocks. These are used when calculating
|
|
* what clock and divisor to use for the required baud rate. Also
|
|
* define the maximum baud rate allowed, and the default base baud.
|
|
*/
|
|
static int stl_cd1400clkdivs[] = {
|
|
CD1400_CLK0, CD1400_CLK1, CD1400_CLK2, CD1400_CLK3, CD1400_CLK4
|
|
};
|
|
|
|
#define STL_MAXBAUD 230400
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Define macros to extract a brd and port number from a minor number.
|
|
* This uses the extended minor number range in the upper 2 bytes of
|
|
* the device number. This gives us plenty of minor numbers to play
|
|
* with...
|
|
*/
|
|
#define MKDEV2BRD(m) ((minor(m) & 0x00700000) >> 20)
|
|
#define MKDEV2PORT(m) ((minor(m) & 0x1f) | ((minor(m) & 0x00010000) >> 11))
|
|
|
|
/*
|
|
* Define some handy local macros...
|
|
*/
|
|
#ifndef MIN
|
|
#define MIN(a,b) (((a) <= (b)) ? (a) : (b))
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Declare all those functions in this driver! First up is the set of
|
|
* externally visible functions.
|
|
*/
|
|
|
|
static int stlprobe(struct isa_device *idp);
|
|
static int stlattach(struct isa_device *idp);
|
|
|
|
STATIC d_open_t stlopen;
|
|
STATIC d_close_t stlclose;
|
|
STATIC d_ioctl_t stlioctl;
|
|
|
|
/*
|
|
* Internal function prototypes.
|
|
*/
|
|
static stlport_t *stl_dev2port(dev_t dev);
|
|
static int stl_findfreeunit(void);
|
|
static int stl_rawopen(stlport_t *portp);
|
|
static int stl_rawclose(stlport_t *portp);
|
|
static int stl_param(struct tty *tp, struct termios *tiosp);
|
|
static void stl_start(struct tty *tp);
|
|
static void stl_stop(struct tty *tp, int);
|
|
static void stl_ttyoptim(stlport_t *portp, struct termios *tiosp);
|
|
static void stl_dotimeout(void);
|
|
static void stl_poll(void *arg);
|
|
static void stl_rxprocess(stlport_t *portp);
|
|
static void stl_dtrwakeup(void *arg);
|
|
static int stl_brdinit(stlbrd_t *brdp);
|
|
static int stl_initeio(stlbrd_t *brdp);
|
|
static int stl_initech(stlbrd_t *brdp);
|
|
static int stl_initports(stlbrd_t *brdp, stlpanel_t *panelp);
|
|
static ointhand2_t stlintr;
|
|
static __inline void stl_txisr(stlpanel_t *panelp, int ioaddr);
|
|
static __inline void stl_rxisr(stlpanel_t *panelp, int ioaddr);
|
|
static __inline void stl_mdmisr(stlpanel_t *panelp, int ioaddr);
|
|
static void stl_setreg(stlport_t *portp, int regnr, int value);
|
|
static int stl_getreg(stlport_t *portp, int regnr);
|
|
static int stl_updatereg(stlport_t *portp, int regnr, int value);
|
|
static int stl_getsignals(stlport_t *portp);
|
|
static void stl_setsignals(stlport_t *portp, int dtr, int rts);
|
|
static void stl_flowcontrol(stlport_t *portp, int hw, int sw);
|
|
static void stl_ccrwait(stlport_t *portp);
|
|
static void stl_enablerxtx(stlport_t *portp, int rx, int tx);
|
|
static void stl_startrxtx(stlport_t *portp, int rx, int tx);
|
|
static void stl_disableintrs(stlport_t *portp);
|
|
static void stl_sendbreak(stlport_t *portp, long len);
|
|
static void stl_flush(stlport_t *portp, int flag);
|
|
static int stl_memioctl(dev_t dev, unsigned long cmd, caddr_t data,
|
|
int flag, struct thread *td);
|
|
static int stl_getbrdstats(caddr_t data);
|
|
static int stl_getportstats(stlport_t *portp, caddr_t data);
|
|
static int stl_clrportstats(stlport_t *portp, caddr_t data);
|
|
static stlport_t *stl_getport(int brdnr, int panelnr, int portnr);
|
|
|
|
#if NPCI > 0
|
|
static const char *stlpciprobe(pcici_t tag, pcidi_t type);
|
|
static void stlpciattach(pcici_t tag, int unit);
|
|
static void stlpciintr(void * arg);
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Declare the driver isa structure.
|
|
*/
|
|
struct isa_driver stldriver = {
|
|
INTR_TYPE_TTY,
|
|
stlprobe,
|
|
stlattach,
|
|
"stl"
|
|
};
|
|
COMPAT_ISA_DRIVER(stl, stldriver);
|
|
|
|
/*****************************************************************************/
|
|
|
|
#if NPCI > 0
|
|
|
|
/*
|
|
* Declare the driver pci structure.
|
|
*/
|
|
static unsigned long stl_count;
|
|
|
|
static struct pci_device stlpcidriver = {
|
|
"stl",
|
|
stlpciprobe,
|
|
stlpciattach,
|
|
&stl_count,
|
|
NULL,
|
|
};
|
|
|
|
COMPAT_PCI_DRIVER (stlpci, stlpcidriver);
|
|
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
#if VFREEBSD >= 220
|
|
|
|
/*
|
|
* FreeBSD-2.2+ kernel linkage.
|
|
*/
|
|
|
|
#define CDEV_MAJOR 72
|
|
static struct cdevsw stl_cdevsw = {
|
|
.d_open = stlopen,
|
|
.d_close = stlclose,
|
|
.d_read = ttyread,
|
|
.d_write = ttywrite,
|
|
.d_ioctl = stlioctl,
|
|
.d_poll = ttypoll,
|
|
.d_name = "stl",
|
|
.d_maj = CDEV_MAJOR,
|
|
.d_flags = D_TTY,
|
|
.d_kqfilter = ttykqfilter,
|
|
};
|
|
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Probe for some type of EasyIO or EasyConnection 8/32 board at
|
|
* the supplied address. All we do is check if we can find the
|
|
* board ID for the board... (Note, PCI boards not checked here,
|
|
* they are done in the stlpciprobe() routine).
|
|
*/
|
|
|
|
static int stlprobe(struct isa_device *idp)
|
|
{
|
|
unsigned int status;
|
|
|
|
#if DEBUG
|
|
printf("stlprobe(idp=%x): unit=%d iobase=%x\n", (int) idp,
|
|
idp->id_unit, idp->id_iobase);
|
|
#endif
|
|
|
|
if (idp->id_unit > STL_MAXBRDS)
|
|
return(0);
|
|
|
|
status = inb(idp->id_iobase + 1);
|
|
if ((status & ECH_IDBITMASK) == ECH_ID) {
|
|
stl_brdprobed[idp->id_unit] = BRD_ECH;
|
|
return(1);
|
|
}
|
|
|
|
status = inb(idp->id_iobase + 2);
|
|
switch (status & EIO_IDBITMASK) {
|
|
case EIO_8PORTRS:
|
|
case EIO_8PORTM:
|
|
case EIO_8PORTDI:
|
|
case EIO_4PORTRS:
|
|
stl_brdprobed[idp->id_unit] = BRD_EASYIO;
|
|
return(1);
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Find an available internal board number (unit number). The problem
|
|
* is that the same unit numbers can be assigned to different boards
|
|
* detected during the ISA and PCI initialization phases.
|
|
*/
|
|
|
|
static int stl_findfreeunit()
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; (i < STL_MAXBRDS); i++)
|
|
if (stl_brds[i] == (stlbrd_t *) NULL)
|
|
break;
|
|
return((i >= STL_MAXBRDS) ? -1 : i);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Allocate resources for and initialize the specified board.
|
|
*/
|
|
|
|
static int stlattach(struct isa_device *idp)
|
|
{
|
|
stlbrd_t *brdp;
|
|
|
|
#if DEBUG
|
|
printf("stlattach(idp=%p): unit=%d iobase=%x\n", (void *) idp,
|
|
idp->id_unit, idp->id_iobase);
|
|
#endif
|
|
|
|
idp->id_ointr = stlintr;
|
|
|
|
brdp = (stlbrd_t *) malloc(sizeof(stlbrd_t), M_TTYS, M_NOWAIT | M_ZERO);
|
|
if (brdp == (stlbrd_t *) NULL) {
|
|
printf("STALLION: failed to allocate memory (size=%d)\n",
|
|
sizeof(stlbrd_t));
|
|
return(0);
|
|
}
|
|
|
|
if ((brdp->brdnr = stl_findfreeunit()) < 0) {
|
|
printf("STALLION: too many boards found, max=%d\n",
|
|
STL_MAXBRDS);
|
|
return(0);
|
|
}
|
|
if (brdp->brdnr >= stl_nrbrds)
|
|
stl_nrbrds = brdp->brdnr + 1;
|
|
|
|
brdp->unitid = idp->id_unit;
|
|
brdp->brdtype = stl_brdprobed[idp->id_unit];
|
|
brdp->ioaddr1 = idp->id_iobase;
|
|
brdp->ioaddr2 = stl_ioshared;
|
|
brdp->irq = ffs(idp->id_irq) - 1;
|
|
brdp->irqtype = stl_irqshared;
|
|
stl_brdinit(brdp);
|
|
|
|
if (0) {
|
|
make_dev(&stl_cdevsw, 0, 0, 0, 0, "stallion_is_broken");
|
|
}
|
|
return(1);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
#if NPCI > 0
|
|
|
|
/*
|
|
* Probe specifically for the PCI boards. We need to be a little
|
|
* carefull here, since it looks sort like a Nat Semi IDE chip...
|
|
*/
|
|
|
|
static const char *stlpciprobe(pcici_t tag, pcidi_t type)
|
|
{
|
|
unsigned long class;
|
|
|
|
#if DEBUG
|
|
printf("stlpciprobe(tag=%x,type=%x)\n", (int) &tag, (int) type);
|
|
#endif
|
|
|
|
switch (type) {
|
|
case STL_PCIDEVID:
|
|
break;
|
|
default:
|
|
return((char *) NULL);
|
|
}
|
|
|
|
class = pci_conf_read(tag, PCI_CLASS_REG);
|
|
if ((class & PCI_CLASS_MASK) == PCI_CLASS_MASS_STORAGE)
|
|
return((char *) NULL);
|
|
|
|
return("Stallion EasyConnection 8/32-PCI");
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Allocate resources for and initialize the specified PCI board.
|
|
*/
|
|
|
|
void stlpciattach(pcici_t tag, int unit)
|
|
{
|
|
stlbrd_t *brdp;
|
|
|
|
#if DEBUG
|
|
printf("stlpciattach(tag=%x,unit=%x)\n", (int) &tag, unit);
|
|
#endif
|
|
|
|
brdp = (stlbrd_t *) malloc(sizeof(stlbrd_t), M_TTYS, M_NOWAIT | M_ZERO);
|
|
if (brdp == (stlbrd_t *) NULL) {
|
|
printf("STALLION: failed to allocate memory (size=%d)\n",
|
|
sizeof(stlbrd_t));
|
|
return;
|
|
}
|
|
|
|
if ((unit < 0) || (unit > STL_MAXBRDS)) {
|
|
printf("STALLION: bad PCI board unit number=%d\n", unit);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Allocate us a new driver unique unit number.
|
|
*/
|
|
if ((brdp->brdnr = stl_findfreeunit()) < 0) {
|
|
printf("STALLION: too many boards found, max=%d\n",
|
|
STL_MAXBRDS);
|
|
return;
|
|
}
|
|
if (brdp->brdnr >= stl_nrbrds)
|
|
stl_nrbrds = brdp->brdnr + 1;
|
|
|
|
brdp->unitid = 0;
|
|
brdp->brdtype = BRD_ECHPCI;
|
|
brdp->ioaddr1 = ((unsigned int) pci_conf_read(tag, 0x14)) & 0xfffc;
|
|
brdp->ioaddr2 = ((unsigned int) pci_conf_read(tag, 0x10)) & 0xfffc;
|
|
brdp->irq = ((int) pci_conf_read(tag, 0x3c)) & 0xff;
|
|
brdp->irqtype = 0;
|
|
if (pci_map_int(tag, stlpciintr, (void *) NULL, &tty_imask) == 0) {
|
|
printf("STALLION: failed to map interrupt irq=%d for unit=%d\n",
|
|
brdp->irq, brdp->brdnr);
|
|
return;
|
|
}
|
|
|
|
#if 0
|
|
printf("%s(%d): ECH-PCI iobase=%x iopage=%x irq=%d\n", __file__, __LINE__, brdp->ioaddr2, brdp->ioaddr1, brdp->irq);
|
|
#endif
|
|
stl_brdinit(brdp);
|
|
}
|
|
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
STATIC int stlopen(dev_t dev, int flag, int mode, struct thread *td)
|
|
{
|
|
struct tty *tp;
|
|
stlport_t *portp;
|
|
int error, callout, x;
|
|
|
|
#if DEBUG
|
|
printf("stlopen(dev=%x,flag=%x,mode=%x,p=%x)\n", (int) dev, flag,
|
|
mode, (int) td);
|
|
#endif
|
|
|
|
/*
|
|
* Firstly check if the supplied device number is a valid device.
|
|
*/
|
|
if (minor(dev) & STL_MEMDEV)
|
|
return(0);
|
|
|
|
portp = stl_dev2port(dev);
|
|
if (portp == (stlport_t *) NULL)
|
|
return(ENXIO);
|
|
tp = &portp->tty;
|
|
dev->si_tty = tp;
|
|
callout = minor(dev) & STL_CALLOUTDEV;
|
|
error = 0;
|
|
|
|
x = spltty();
|
|
|
|
stlopen_restart:
|
|
/*
|
|
* Wait here for the DTR drop timeout period to expire.
|
|
*/
|
|
while (portp->state & ASY_DTRWAIT) {
|
|
error = tsleep(&portp->dtrwait, (TTIPRI | PCATCH),
|
|
"stldtr", 0);
|
|
if (error)
|
|
goto stlopen_end;
|
|
}
|
|
|
|
/*
|
|
* We have a valid device, so now we check if it is already open.
|
|
* If not then initialize the port hardware and set up the tty
|
|
* struct as required.
|
|
*/
|
|
if ((tp->t_state & TS_ISOPEN) == 0) {
|
|
tp->t_oproc = stl_start;
|
|
tp->t_stop = stl_stop;
|
|
tp->t_param = stl_param;
|
|
tp->t_dev = dev;
|
|
tp->t_termios = callout ? portp->initouttios :
|
|
portp->initintios;
|
|
stl_rawopen(portp);
|
|
if ((portp->sigs & TIOCM_CD) || callout)
|
|
(*linesw[tp->t_line].l_modem)(tp, 1);
|
|
} else {
|
|
if (callout) {
|
|
if (portp->callout == 0) {
|
|
error = EBUSY;
|
|
goto stlopen_end;
|
|
}
|
|
} else {
|
|
if (portp->callout != 0) {
|
|
if (flag & O_NONBLOCK) {
|
|
error = EBUSY;
|
|
goto stlopen_end;
|
|
}
|
|
error = tsleep(&portp->callout,
|
|
(TTIPRI | PCATCH), "stlcall", 0);
|
|
if (error)
|
|
goto stlopen_end;
|
|
goto stlopen_restart;
|
|
}
|
|
}
|
|
if ((tp->t_state & TS_XCLUDE) &&
|
|
suser(td)) {
|
|
error = EBUSY;
|
|
goto stlopen_end;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If this port is not the callout device and we do not have carrier
|
|
* then we need to sleep, waiting for it to be asserted.
|
|
*/
|
|
if (((tp->t_state & TS_CARR_ON) == 0) && !callout &&
|
|
((tp->t_cflag & CLOCAL) == 0) &&
|
|
((flag & O_NONBLOCK) == 0)) {
|
|
portp->waitopens++;
|
|
error = tsleep(TSA_CARR_ON(tp), (TTIPRI | PCATCH), "stldcd", 0);
|
|
portp->waitopens--;
|
|
if (error)
|
|
goto stlopen_end;
|
|
goto stlopen_restart;
|
|
}
|
|
|
|
/*
|
|
* Open the line discipline.
|
|
*/
|
|
error = (*linesw[tp->t_line].l_open)(dev, tp);
|
|
stl_ttyoptim(portp, &tp->t_termios);
|
|
if ((tp->t_state & TS_ISOPEN) && callout)
|
|
portp->callout = 1;
|
|
|
|
/*
|
|
* If for any reason we get to here and the port is not actually
|
|
* open then close of the physical hardware - no point leaving it
|
|
* active when the open failed...
|
|
*/
|
|
stlopen_end:
|
|
splx(x);
|
|
if (((tp->t_state & TS_ISOPEN) == 0) && (portp->waitopens == 0))
|
|
stl_rawclose(portp);
|
|
|
|
return(error);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
STATIC int stlclose(dev_t dev, int flag, int mode, struct thread *td)
|
|
{
|
|
struct tty *tp;
|
|
stlport_t *portp;
|
|
int x;
|
|
|
|
#if DEBUG
|
|
printf("stlclose(dev=%s,flag=%x,mode=%x,p=%p)\n", devtoname(dev),
|
|
flag, mode, (void *) td);
|
|
#endif
|
|
|
|
if (minor(dev) & STL_MEMDEV)
|
|
return(0);
|
|
|
|
portp = stl_dev2port(dev);
|
|
if (portp == (stlport_t *) NULL)
|
|
return(ENXIO);
|
|
tp = &portp->tty;
|
|
|
|
x = spltty();
|
|
(*linesw[tp->t_line].l_close)(tp, flag);
|
|
stl_ttyoptim(portp, &tp->t_termios);
|
|
stl_rawclose(portp);
|
|
ttyclose(tp);
|
|
splx(x);
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
#if VFREEBSD >= 220
|
|
|
|
STATIC void stl_stop(struct tty *tp, int rw)
|
|
{
|
|
#if DEBUG
|
|
printf("stl_stop(tp=%x,rw=%x)\n", (int) tp, rw);
|
|
#endif
|
|
|
|
stl_flush((stlport_t *) tp, rw);
|
|
}
|
|
|
|
#else
|
|
|
|
STATIC int stlstop(struct tty *tp, int rw)
|
|
{
|
|
#if DEBUG
|
|
printf("stlstop(tp=%x,rw=%x)\n", (int) tp, rw);
|
|
#endif
|
|
|
|
stl_flush((stlport_t *) tp, rw);
|
|
return(0);
|
|
}
|
|
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
STATIC int stlioctl(dev_t dev, unsigned long cmd, caddr_t data, int flag,
|
|
struct thread *td)
|
|
{
|
|
struct termios *newtios, *localtios;
|
|
struct tty *tp;
|
|
stlport_t *portp;
|
|
int error, i, x;
|
|
|
|
#if DEBUG
|
|
printf("stlioctl(dev=%s,cmd=%lx,data=%p,flag=%x,p=%p)\n",
|
|
devtoname(dev), cmd, (void *) data, flag, (void *) td);
|
|
#endif
|
|
|
|
if (minor(dev) & STL_MEMDEV)
|
|
return(stl_memioctl(dev, cmd, data, flag, td));
|
|
|
|
portp = stl_dev2port(dev);
|
|
if (portp == (stlport_t *) NULL)
|
|
return(ENODEV);
|
|
tp = &portp->tty;
|
|
error = 0;
|
|
|
|
/*
|
|
* First up handle ioctls on the control devices.
|
|
*/
|
|
if (minor(dev) & STL_CTRLDEV) {
|
|
if ((minor(dev) & STL_CTRLDEV) == STL_CTRLINIT)
|
|
localtios = (minor(dev) & STL_CALLOUTDEV) ?
|
|
&portp->initouttios : &portp->initintios;
|
|
else if ((minor(dev) & STL_CTRLDEV) == STL_CTRLLOCK)
|
|
localtios = (minor(dev) & STL_CALLOUTDEV) ?
|
|
&portp->lockouttios : &portp->lockintios;
|
|
else
|
|
return(ENODEV);
|
|
|
|
switch (cmd) {
|
|
case TIOCSETA:
|
|
if ((error = suser(td)) == 0)
|
|
*localtios = *((struct termios *) data);
|
|
break;
|
|
case TIOCGETA:
|
|
*((struct termios *) data) = *localtios;
|
|
break;
|
|
case TIOCGETD:
|
|
*((int *) data) = TTYDISC;
|
|
break;
|
|
case TIOCGWINSZ:
|
|
bzero(data, sizeof(struct winsize));
|
|
break;
|
|
default:
|
|
error = ENOTTY;
|
|
break;
|
|
}
|
|
return(error);
|
|
}
|
|
|
|
/*
|
|
* Deal with 4.3 compatibility issues if we have too...
|
|
*/
|
|
#if defined(COMPAT_43) || defined(COMPAT_SUNOS)
|
|
if (1) {
|
|
struct termios tios;
|
|
unsigned long oldcmd;
|
|
|
|
tios = tp->t_termios;
|
|
oldcmd = cmd;
|
|
if ((error = ttsetcompat(tp, &cmd, data, &tios)))
|
|
return(error);
|
|
if (cmd != oldcmd)
|
|
data = (caddr_t) &tios;
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Carry out some pre-cmd processing work first...
|
|
* Hmmm, not so sure we want this, disable for now...
|
|
*/
|
|
if ((cmd == TIOCSETA) || (cmd == TIOCSETAW) || (cmd == TIOCSETAF)) {
|
|
newtios = (struct termios *) data;
|
|
localtios = (minor(dev) & STL_CALLOUTDEV) ?
|
|
&portp->lockouttios : &portp->lockintios;
|
|
|
|
newtios->c_iflag = (tp->t_iflag & localtios->c_iflag) |
|
|
(newtios->c_iflag & ~localtios->c_iflag);
|
|
newtios->c_oflag = (tp->t_oflag & localtios->c_oflag) |
|
|
(newtios->c_oflag & ~localtios->c_oflag);
|
|
newtios->c_cflag = (tp->t_cflag & localtios->c_cflag) |
|
|
(newtios->c_cflag & ~localtios->c_cflag);
|
|
newtios->c_lflag = (tp->t_lflag & localtios->c_lflag) |
|
|
(newtios->c_lflag & ~localtios->c_lflag);
|
|
for (i = 0; (i < NCCS); i++) {
|
|
if (localtios->c_cc[i] != 0)
|
|
newtios->c_cc[i] = tp->t_cc[i];
|
|
}
|
|
if (localtios->c_ispeed != 0)
|
|
newtios->c_ispeed = tp->t_ispeed;
|
|
if (localtios->c_ospeed != 0)
|
|
newtios->c_ospeed = tp->t_ospeed;
|
|
}
|
|
|
|
/*
|
|
* Call the line discipline and the common command processing to
|
|
* process this command (if they can).
|
|
*/
|
|
error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, td);
|
|
if (error != ENOIOCTL)
|
|
return(error);
|
|
|
|
x = spltty();
|
|
error = ttioctl(tp, cmd, data, flag);
|
|
stl_ttyoptim(portp, &tp->t_termios);
|
|
if (error != ENOIOCTL) {
|
|
splx(x);
|
|
return(error);
|
|
}
|
|
|
|
error = 0;
|
|
|
|
/*
|
|
* Process local commands here. These are all commands that only we
|
|
* can take care of (they all rely on actually doing something special
|
|
* to the actual hardware).
|
|
*/
|
|
switch (cmd) {
|
|
case TIOCSBRK:
|
|
stl_sendbreak(portp, -1);
|
|
break;
|
|
case TIOCCBRK:
|
|
stl_sendbreak(portp, -2);
|
|
break;
|
|
case TIOCSDTR:
|
|
stl_setsignals(portp, 1, -1);
|
|
break;
|
|
case TIOCCDTR:
|
|
stl_setsignals(portp, 0, -1);
|
|
break;
|
|
case TIOCMSET:
|
|
i = *((int *) data);
|
|
stl_setsignals(portp, ((i & TIOCM_DTR) ? 1 : 0),
|
|
((i & TIOCM_RTS) ? 1 : 0));
|
|
break;
|
|
case TIOCMBIS:
|
|
i = *((int *) data);
|
|
stl_setsignals(portp, ((i & TIOCM_DTR) ? 1 : -1),
|
|
((i & TIOCM_RTS) ? 1 : -1));
|
|
break;
|
|
case TIOCMBIC:
|
|
i = *((int *) data);
|
|
stl_setsignals(portp, ((i & TIOCM_DTR) ? 0 : -1),
|
|
((i & TIOCM_RTS) ? 0 : -1));
|
|
break;
|
|
case TIOCMGET:
|
|
*((int *) data) = (stl_getsignals(portp) | TIOCM_LE);
|
|
break;
|
|
case TIOCMSDTRWAIT:
|
|
if ((error = suser(td)) == 0)
|
|
portp->dtrwait = *((int *) data) * hz / 100;
|
|
break;
|
|
case TIOCMGDTRWAIT:
|
|
*((int *) data) = portp->dtrwait * 100 / hz;
|
|
break;
|
|
case TIOCTIMESTAMP:
|
|
portp->dotimestamp = 1;
|
|
*((struct timeval *) data) = portp->timestamp;
|
|
break;
|
|
default:
|
|
error = ENOTTY;
|
|
break;
|
|
}
|
|
splx(x);
|
|
|
|
return(error);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Convert the specified minor device number into a port struct
|
|
* pointer. Return NULL if the device number is not a valid port.
|
|
*/
|
|
|
|
STATIC stlport_t *stl_dev2port(dev_t dev)
|
|
{
|
|
stlbrd_t *brdp;
|
|
|
|
brdp = stl_brds[MKDEV2BRD(dev)];
|
|
if (brdp == (stlbrd_t *) NULL)
|
|
return((stlport_t *) NULL);
|
|
return(brdp->ports[MKDEV2PORT(dev)]);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Initialize the port hardware. This involves enabling the transmitter
|
|
* and receiver, setting the port configuration, and setting the initial
|
|
* signal state.
|
|
*/
|
|
|
|
static int stl_rawopen(stlport_t *portp)
|
|
{
|
|
#if DEBUG
|
|
printf("stl_rawopen(portp=%p): brdnr=%d panelnr=%d portnr=%d\n",
|
|
(void *) portp, portp->brdnr, portp->panelnr, portp->portnr);
|
|
#endif
|
|
stl_param(&portp->tty, &portp->tty.t_termios);
|
|
portp->sigs = stl_getsignals(portp);
|
|
stl_setsignals(portp, 1, 1);
|
|
stl_enablerxtx(portp, 1, 1);
|
|
stl_startrxtx(portp, 1, 0);
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Shutdown the hardware of a port. Disable its transmitter and
|
|
* receiver, and maybe drop signals if appropriate.
|
|
*/
|
|
|
|
static int stl_rawclose(stlport_t *portp)
|
|
{
|
|
struct tty *tp;
|
|
|
|
#if DEBUG
|
|
printf("stl_rawclose(portp=%p): brdnr=%d panelnr=%d portnr=%d\n",
|
|
(void *) portp, portp->brdnr, portp->panelnr, portp->portnr);
|
|
#endif
|
|
|
|
tp = &portp->tty;
|
|
stl_disableintrs(portp);
|
|
stl_enablerxtx(portp, 0, 0);
|
|
stl_flush(portp, (FWRITE | FREAD));
|
|
if (tp->t_cflag & HUPCL) {
|
|
stl_setsignals(portp, 0, 0);
|
|
if (portp->dtrwait != 0) {
|
|
portp->state |= ASY_DTRWAIT;
|
|
timeout(stl_dtrwakeup, portp, portp->dtrwait);
|
|
}
|
|
}
|
|
portp->callout = 0;
|
|
portp->brklen = 0;
|
|
portp->state &= ~(ASY_ACTIVE | ASY_RTSFLOW);
|
|
wakeup(&portp->callout);
|
|
wakeup(TSA_CARR_ON(tp));
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Clear the DTR waiting flag, and wake up any sleepers waiting for
|
|
* DTR wait period to finish.
|
|
*/
|
|
|
|
static void stl_dtrwakeup(void *arg)
|
|
{
|
|
stlport_t *portp;
|
|
|
|
portp = (stlport_t *) arg;
|
|
portp->state &= ~ASY_DTRWAIT;
|
|
wakeup(&portp->dtrwait);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Start (or continue) the transfer of TX data on this port. If the
|
|
* port is not currently busy then load up the interrupt ring queue
|
|
* buffer and kick of the transmitter. If the port is running low on
|
|
* TX data then refill the ring queue. This routine is also used to
|
|
* activate input flow control!
|
|
*/
|
|
|
|
static void stl_start(struct tty *tp)
|
|
{
|
|
stlport_t *portp;
|
|
unsigned int len, stlen;
|
|
char *head, *tail;
|
|
int count, x;
|
|
|
|
portp = (stlport_t *) tp;
|
|
|
|
#if DEBUG
|
|
printf("stl_start(tp=%x): brdnr=%d portnr=%d\n", (int) tp,
|
|
portp->brdnr, portp->portnr);
|
|
#endif
|
|
|
|
x = spltty();
|
|
|
|
/*
|
|
* Check if the ports input has been blocked, and take appropriate action.
|
|
* Not very often do we really need to do anything, so make it quick.
|
|
*/
|
|
if (tp->t_state & TS_TBLOCK) {
|
|
if ((portp->state & ASY_RTSFLOW) == 0)
|
|
stl_flowcontrol(portp, 0, -1);
|
|
} else {
|
|
if (portp->state & ASY_RTSFLOW)
|
|
stl_flowcontrol(portp, 1, -1);
|
|
}
|
|
|
|
#if VFREEBSD == 205
|
|
/*
|
|
* Check if the output cooked clist buffers are near empty, wake up
|
|
* the line discipline to fill it up.
|
|
*/
|
|
if (tp->t_outq.c_cc <= tp->t_lowat) {
|
|
if (tp->t_state & TS_ASLEEP) {
|
|
tp->t_state &= ~TS_ASLEEP;
|
|
wakeup(&tp->t_outq);
|
|
}
|
|
selwakeuppri(&tp->t_wsel, TTOPRI);
|
|
}
|
|
#endif
|
|
|
|
if (tp->t_state & (TS_TIMEOUT | TS_TTSTOP)) {
|
|
splx(x);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Copy data from the clists into the interrupt ring queue. This will
|
|
* require at most 2 copys... What we do is calculate how many chars
|
|
* can fit into the ring queue, and how many can fit in 1 copy. If after
|
|
* the first copy there is still more room then do the second copy.
|
|
* The beauty of this type of ring queue is that we do not need to
|
|
* spl protect our-selves, since we only ever update the head pointer,
|
|
* and the interrupt routine only ever updates the tail pointer.
|
|
*/
|
|
if (tp->t_outq.c_cc != 0) {
|
|
head = portp->tx.head;
|
|
tail = portp->tx.tail;
|
|
if (head >= tail) {
|
|
len = STL_TXBUFSIZE - (head - tail) - 1;
|
|
stlen = portp->tx.endbuf - head;
|
|
} else {
|
|
len = tail - head - 1;
|
|
stlen = len;
|
|
}
|
|
|
|
if (len > 0) {
|
|
stlen = MIN(len, stlen);
|
|
count = q_to_b(&tp->t_outq, head, stlen);
|
|
len -= count;
|
|
head += count;
|
|
if (head >= portp->tx.endbuf) {
|
|
head = portp->tx.buf;
|
|
if (len > 0) {
|
|
stlen = q_to_b(&tp->t_outq, head, len);
|
|
head += stlen;
|
|
count += stlen;
|
|
}
|
|
}
|
|
portp->tx.head = head;
|
|
if (count > 0)
|
|
stl_startrxtx(portp, -1, 1);
|
|
}
|
|
|
|
/*
|
|
* If we sent something, make sure we are called again.
|
|
*/
|
|
tp->t_state |= TS_BUSY;
|
|
}
|
|
|
|
#if VFREEBSD != 205
|
|
/*
|
|
* Do any writer wakeups.
|
|
*/
|
|
ttwwakeup(tp);
|
|
#endif
|
|
|
|
splx(x);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static void stl_flush(stlport_t *portp, int flag)
|
|
{
|
|
char *head, *tail;
|
|
int len, x;
|
|
|
|
#if DEBUG
|
|
printf("stl_flush(portp=%x,flag=%x)\n", (int) portp, flag);
|
|
#endif
|
|
|
|
if (portp == (stlport_t *) NULL)
|
|
return;
|
|
|
|
x = spltty();
|
|
|
|
if (flag & FWRITE) {
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x03));
|
|
stl_ccrwait(portp);
|
|
stl_setreg(portp, CCR, CCR_TXFLUSHFIFO);
|
|
stl_ccrwait(portp);
|
|
portp->tx.tail = portp->tx.head;
|
|
BRDDISABLE(portp->brdnr);
|
|
}
|
|
|
|
/*
|
|
* The only thing to watch out for when flushing the read side is
|
|
* the RX status buffer. The interrupt code relys on the status
|
|
* bytes as being zeroed all the time (it does not bother setting
|
|
* a good char status to 0, it expects that it already will be).
|
|
* We also need to un-flow the RX channel if flow control was
|
|
* active.
|
|
*/
|
|
if (flag & FREAD) {
|
|
head = portp->rx.head;
|
|
tail = portp->rx.tail;
|
|
if (head != tail) {
|
|
if (head >= tail) {
|
|
len = head - tail;
|
|
} else {
|
|
len = portp->rx.endbuf - tail;
|
|
bzero(portp->rxstatus.buf,
|
|
(head - portp->rx.buf));
|
|
}
|
|
bzero((tail + STL_RXBUFSIZE), len);
|
|
portp->rx.tail = head;
|
|
}
|
|
|
|
if ((portp->state & ASY_RTSFLOW) &&
|
|
((portp->tty.t_state & TS_TBLOCK) == 0))
|
|
stl_flowcontrol(portp, 1, -1);
|
|
}
|
|
|
|
splx(x);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* These functions get/set/update the registers of the cd1400 UARTs.
|
|
* Access to the cd1400 registers is via an address/data io port pair.
|
|
* (Maybe should make this inline...)
|
|
*/
|
|
|
|
static int stl_getreg(stlport_t *portp, int regnr)
|
|
{
|
|
outb(portp->ioaddr, (regnr + portp->uartaddr));
|
|
return(inb(portp->ioaddr + EREG_DATA));
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static void stl_setreg(stlport_t *portp, int regnr, int value)
|
|
{
|
|
outb(portp->ioaddr, (regnr + portp->uartaddr));
|
|
outb((portp->ioaddr + EREG_DATA), value);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static int stl_updatereg(stlport_t *portp, int regnr, int value)
|
|
{
|
|
outb(portp->ioaddr, (regnr + portp->uartaddr));
|
|
if (inb(portp->ioaddr + EREG_DATA) != value) {
|
|
outb((portp->ioaddr + EREG_DATA), value);
|
|
return(1);
|
|
}
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Wait for the command register to be ready. We will poll this, since
|
|
* it won't usually take too long to be ready, and it is only really
|
|
* used for non-critical actions.
|
|
*/
|
|
|
|
static void stl_ccrwait(stlport_t *portp)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; (i < CCR_MAXWAIT); i++) {
|
|
if (stl_getreg(portp, CCR) == 0) {
|
|
return;
|
|
}
|
|
}
|
|
|
|
printf("STALLION: cd1400 device not responding, brd=%d panel=%d"
|
|
"port=%d\n", portp->brdnr, portp->panelnr, portp->portnr);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Transmit interrupt handler. This has gotta be fast! Handling TX
|
|
* chars is pretty simple, stuff as many as possible from the TX buffer
|
|
* into the cd1400 FIFO. Must also handle TX breaks here, since they
|
|
* are embedded as commands in the data stream. Oh no, had to use a goto!
|
|
* This could be optimized more, will do when I get time...
|
|
* In practice it is possible that interrupts are enabled but that the
|
|
* port has been hung up. Need to handle not having any TX buffer here,
|
|
* this is done by using the side effect that head and tail will also
|
|
* be NULL if the buffer has been freed.
|
|
*/
|
|
|
|
static __inline void stl_txisr(stlpanel_t *panelp, int ioaddr)
|
|
{
|
|
stlport_t *portp;
|
|
int len, stlen;
|
|
char *head, *tail;
|
|
unsigned char ioack, srer;
|
|
|
|
#if DEBUG
|
|
printf("stl_txisr(panelp=%x,ioaddr=%x)\n", (int) panelp, ioaddr);
|
|
#endif
|
|
|
|
ioack = inb(ioaddr + EREG_TXACK);
|
|
if (((ioack & panelp->ackmask) != 0) ||
|
|
((ioack & ACK_TYPMASK) != ACK_TYPTX)) {
|
|
printf("STALLION: bad TX interrupt ack value=%x\n", ioack);
|
|
return;
|
|
}
|
|
portp = panelp->ports[(ioack >> 3)];
|
|
|
|
/*
|
|
* Unfortunately we need to handle breaks in the data stream, since
|
|
* this is the only way to generate them on the cd1400. Do it now if
|
|
* a break is to be sent. Some special cases here: brklen is -1 then
|
|
* start sending an un-timed break, if brklen is -2 then stop sending
|
|
* an un-timed break, if brklen is -3 then we have just sent an
|
|
* un-timed break and do not want any data to go out, if brklen is -4
|
|
* then a break has just completed so clean up the port settings.
|
|
*/
|
|
if (portp->brklen != 0) {
|
|
if (portp->brklen >= -1) {
|
|
outb(ioaddr, (TDR + portp->uartaddr));
|
|
outb((ioaddr + EREG_DATA), ETC_CMD);
|
|
outb((ioaddr + EREG_DATA), ETC_STARTBREAK);
|
|
if (portp->brklen > 0) {
|
|
outb((ioaddr + EREG_DATA), ETC_CMD);
|
|
outb((ioaddr + EREG_DATA), ETC_DELAY);
|
|
outb((ioaddr + EREG_DATA), portp->brklen);
|
|
outb((ioaddr + EREG_DATA), ETC_CMD);
|
|
outb((ioaddr + EREG_DATA), ETC_STOPBREAK);
|
|
portp->brklen = -4;
|
|
} else {
|
|
portp->brklen = -3;
|
|
}
|
|
} else if (portp->brklen == -2) {
|
|
outb(ioaddr, (TDR + portp->uartaddr));
|
|
outb((ioaddr + EREG_DATA), ETC_CMD);
|
|
outb((ioaddr + EREG_DATA), ETC_STOPBREAK);
|
|
portp->brklen = -4;
|
|
} else if (portp->brklen == -3) {
|
|
outb(ioaddr, (SRER + portp->uartaddr));
|
|
srer = inb(ioaddr + EREG_DATA);
|
|
srer &= ~(SRER_TXDATA | SRER_TXEMPTY);
|
|
outb((ioaddr + EREG_DATA), srer);
|
|
} else {
|
|
outb(ioaddr, (COR2 + portp->uartaddr));
|
|
outb((ioaddr + EREG_DATA),
|
|
(inb(ioaddr + EREG_DATA) & ~COR2_ETC));
|
|
portp->brklen = 0;
|
|
}
|
|
goto stl_txalldone;
|
|
}
|
|
|
|
head = portp->tx.head;
|
|
tail = portp->tx.tail;
|
|
len = (head >= tail) ? (head - tail) : (STL_TXBUFSIZE - (tail - head));
|
|
if ((len == 0) || ((len < STL_TXBUFLOW) &&
|
|
((portp->state & ASY_TXLOW) == 0))) {
|
|
portp->state |= ASY_TXLOW;
|
|
stl_dotimeout();
|
|
}
|
|
|
|
if (len == 0) {
|
|
outb(ioaddr, (SRER + portp->uartaddr));
|
|
srer = inb(ioaddr + EREG_DATA);
|
|
if (srer & SRER_TXDATA) {
|
|
srer = (srer & ~SRER_TXDATA) | SRER_TXEMPTY;
|
|
} else {
|
|
srer &= ~(SRER_TXDATA | SRER_TXEMPTY);
|
|
portp->tty.t_state &= ~TS_BUSY;
|
|
}
|
|
outb((ioaddr + EREG_DATA), srer);
|
|
} else {
|
|
len = MIN(len, CD1400_TXFIFOSIZE);
|
|
portp->stats.txtotal += len;
|
|
stlen = MIN(len, (portp->tx.endbuf - tail));
|
|
outb(ioaddr, (TDR + portp->uartaddr));
|
|
outsb((ioaddr + EREG_DATA), tail, stlen);
|
|
len -= stlen;
|
|
tail += stlen;
|
|
if (tail >= portp->tx.endbuf)
|
|
tail = portp->tx.buf;
|
|
if (len > 0) {
|
|
outsb((ioaddr + EREG_DATA), tail, len);
|
|
tail += len;
|
|
}
|
|
portp->tx.tail = tail;
|
|
}
|
|
|
|
stl_txalldone:
|
|
outb(ioaddr, (EOSRR + portp->uartaddr));
|
|
outb((ioaddr + EREG_DATA), 0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Receive character interrupt handler. Determine if we have good chars
|
|
* or bad chars and then process appropriately. Good chars are easy
|
|
* just shove the lot into the RX buffer and set all status bytes to 0.
|
|
* If a bad RX char then process as required. This routine needs to be
|
|
* fast!
|
|
*/
|
|
|
|
static __inline void stl_rxisr(stlpanel_t *panelp, int ioaddr)
|
|
{
|
|
stlport_t *portp;
|
|
struct tty *tp;
|
|
unsigned int ioack, len, buflen, stlen;
|
|
unsigned char status;
|
|
char ch;
|
|
char *head, *tail;
|
|
static char unwanted[CD1400_RXFIFOSIZE];
|
|
|
|
#if DEBUG
|
|
printf("stl_rxisr(panelp=%x,ioaddr=%x)\n", (int) panelp, ioaddr);
|
|
#endif
|
|
|
|
ioack = inb(ioaddr + EREG_RXACK);
|
|
if ((ioack & panelp->ackmask) != 0) {
|
|
printf("STALLION: bad RX interrupt ack value=%x\n", ioack);
|
|
return;
|
|
}
|
|
portp = panelp->ports[(ioack >> 3)];
|
|
tp = &portp->tty;
|
|
|
|
/*
|
|
* First up, caluclate how much room there is in the RX ring queue.
|
|
* We also want to keep track of the longest possible copy length,
|
|
* this has to allow for the wrapping of the ring queue.
|
|
*/
|
|
head = portp->rx.head;
|
|
tail = portp->rx.tail;
|
|
if (head >= tail) {
|
|
buflen = STL_RXBUFSIZE - (head - tail) - 1;
|
|
stlen = portp->rx.endbuf - head;
|
|
} else {
|
|
buflen = tail - head - 1;
|
|
stlen = buflen;
|
|
}
|
|
|
|
/*
|
|
* Check if the input buffer is near full. If so then we should take
|
|
* some flow control action... It is very easy to do hardware and
|
|
* software flow control from here since we have the port selected on
|
|
* the UART.
|
|
*/
|
|
if (buflen <= (STL_RXBUFSIZE - STL_RXBUFHIGH)) {
|
|
if (((portp->state & ASY_RTSFLOW) == 0) &&
|
|
(portp->state & ASY_RTSFLOWMODE)) {
|
|
portp->state |= ASY_RTSFLOW;
|
|
stl_setreg(portp, MCOR1,
|
|
(stl_getreg(portp, MCOR1) & 0xf0));
|
|
stl_setreg(portp, MSVR2, 0);
|
|
portp->stats.rxrtsoff++;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* OK we are set, process good data... If the RX ring queue is full
|
|
* just chuck the chars - don't leave them in the UART.
|
|
*/
|
|
if ((ioack & ACK_TYPMASK) == ACK_TYPRXGOOD) {
|
|
outb(ioaddr, (RDCR + portp->uartaddr));
|
|
len = inb(ioaddr + EREG_DATA);
|
|
if (buflen == 0) {
|
|
outb(ioaddr, (RDSR + portp->uartaddr));
|
|
insb((ioaddr + EREG_DATA), &unwanted[0], len);
|
|
portp->stats.rxlost += len;
|
|
portp->stats.rxtotal += len;
|
|
} else {
|
|
len = MIN(len, buflen);
|
|
portp->stats.rxtotal += len;
|
|
stlen = MIN(len, stlen);
|
|
if (len > 0) {
|
|
outb(ioaddr, (RDSR + portp->uartaddr));
|
|
insb((ioaddr + EREG_DATA), head, stlen);
|
|
head += stlen;
|
|
if (head >= portp->rx.endbuf) {
|
|
head = portp->rx.buf;
|
|
len -= stlen;
|
|
insb((ioaddr + EREG_DATA), head, len);
|
|
head += len;
|
|
}
|
|
}
|
|
}
|
|
} else if ((ioack & ACK_TYPMASK) == ACK_TYPRXBAD) {
|
|
outb(ioaddr, (RDSR + portp->uartaddr));
|
|
status = inb(ioaddr + EREG_DATA);
|
|
ch = inb(ioaddr + EREG_DATA);
|
|
if (status & ST_BREAK)
|
|
portp->stats.rxbreaks++;
|
|
if (status & ST_FRAMING)
|
|
portp->stats.rxframing++;
|
|
if (status & ST_PARITY)
|
|
portp->stats.rxparity++;
|
|
if (status & ST_OVERRUN)
|
|
portp->stats.rxoverrun++;
|
|
if (status & ST_SCHARMASK) {
|
|
if ((status & ST_SCHARMASK) == ST_SCHAR1)
|
|
portp->stats.txxon++;
|
|
if ((status & ST_SCHARMASK) == ST_SCHAR2)
|
|
portp->stats.txxoff++;
|
|
goto stl_rxalldone;
|
|
}
|
|
if ((portp->rxignoremsk & status) == 0) {
|
|
if ((tp->t_state & TS_CAN_BYPASS_L_RINT) &&
|
|
((status & ST_FRAMING) ||
|
|
((status & ST_PARITY) && (tp->t_iflag & INPCK))))
|
|
ch = 0;
|
|
if ((portp->rxmarkmsk & status) == 0)
|
|
status = 0;
|
|
*(head + STL_RXBUFSIZE) = status;
|
|
*head++ = ch;
|
|
if (head >= portp->rx.endbuf)
|
|
head = portp->rx.buf;
|
|
}
|
|
} else {
|
|
printf("STALLION: bad RX interrupt ack value=%x\n", ioack);
|
|
return;
|
|
}
|
|
|
|
portp->rx.head = head;
|
|
portp->state |= ASY_RXDATA;
|
|
stl_dotimeout();
|
|
|
|
stl_rxalldone:
|
|
outb(ioaddr, (EOSRR + portp->uartaddr));
|
|
outb((ioaddr + EREG_DATA), 0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Modem interrupt handler. The is called when the modem signal line
|
|
* (DCD) has changed state. Leave most of the work to the off-level
|
|
* processing routine.
|
|
*/
|
|
|
|
static __inline void stl_mdmisr(stlpanel_t *panelp, int ioaddr)
|
|
{
|
|
stlport_t *portp;
|
|
unsigned int ioack;
|
|
unsigned char misr;
|
|
|
|
#if DEBUG
|
|
printf("stl_mdmisr(panelp=%x,ioaddr=%x)\n", (int) panelp, ioaddr);
|
|
#endif
|
|
|
|
ioack = inb(ioaddr + EREG_MDACK);
|
|
if (((ioack & panelp->ackmask) != 0) ||
|
|
((ioack & ACK_TYPMASK) != ACK_TYPMDM)) {
|
|
printf("STALLION: bad MODEM interrupt ack value=%x\n", ioack);
|
|
return;
|
|
}
|
|
portp = panelp->ports[(ioack >> 3)];
|
|
|
|
outb(ioaddr, (MISR + portp->uartaddr));
|
|
misr = inb(ioaddr + EREG_DATA);
|
|
if (misr & MISR_DCD) {
|
|
portp->state |= ASY_DCDCHANGE;
|
|
portp->stats.modem++;
|
|
stl_dotimeout();
|
|
}
|
|
|
|
outb(ioaddr, (EOSRR + portp->uartaddr));
|
|
outb((ioaddr + EREG_DATA), 0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Interrupt handler for EIO and ECH boards. This code ain't all that
|
|
* pretty, but the idea is to make it as fast as possible. This code is
|
|
* well suited to be assemblerized :-) We don't use the general purpose
|
|
* register access functions here, for speed we will go strait to the
|
|
* io register.
|
|
*/
|
|
|
|
static void stlintr(int unit)
|
|
{
|
|
stlbrd_t *brdp;
|
|
stlpanel_t *panelp;
|
|
unsigned char svrtype;
|
|
int i, panelnr, iobase;
|
|
int cnt;
|
|
|
|
#if DEBUG
|
|
printf("stlintr(unit=%d)\n", unit);
|
|
#endif
|
|
|
|
cnt = 0;
|
|
panelp = (stlpanel_t *) NULL;
|
|
for (i = 0; (i < stl_nrbrds); ) {
|
|
if ((brdp = stl_brds[i]) == (stlbrd_t *) NULL) {
|
|
i++;
|
|
continue;
|
|
}
|
|
if (brdp->state == 0) {
|
|
i++;
|
|
continue;
|
|
}
|
|
/*
|
|
* The following section of code handles the subtle differences
|
|
* between board types. It is sort of similar, but different
|
|
* enough to handle each separately.
|
|
*/
|
|
if (brdp->brdtype == BRD_EASYIO) {
|
|
if ((inb(brdp->iostatus) & EIO_INTRPEND) == 0) {
|
|
i++;
|
|
continue;
|
|
}
|
|
panelp = brdp->panels[0];
|
|
iobase = panelp->iobase;
|
|
outb(iobase, SVRR);
|
|
svrtype = inb(iobase + EREG_DATA);
|
|
if (brdp->nrports > 4) {
|
|
outb(iobase, (SVRR + 0x80));
|
|
svrtype |= inb(iobase + EREG_DATA);
|
|
}
|
|
} else if (brdp->brdtype == BRD_ECH) {
|
|
if ((inb(brdp->iostatus) & ECH_INTRPEND) == 0) {
|
|
i++;
|
|
continue;
|
|
}
|
|
outb(brdp->ioctrl, (brdp->ioctrlval | ECH_BRDENABLE));
|
|
for (panelnr = 0; (panelnr < brdp->nrpanels); panelnr++) {
|
|
panelp = brdp->panels[panelnr];
|
|
iobase = panelp->iobase;
|
|
if (inb(iobase + ECH_PNLSTATUS) & ECH_PNLINTRPEND)
|
|
break;
|
|
if (panelp->nrports > 8) {
|
|
iobase += 0x8;
|
|
if (inb(iobase + ECH_PNLSTATUS) & ECH_PNLINTRPEND)
|
|
break;
|
|
}
|
|
}
|
|
if (panelnr >= brdp->nrpanels) {
|
|
i++;
|
|
continue;
|
|
}
|
|
outb(iobase, SVRR);
|
|
svrtype = inb(iobase + EREG_DATA);
|
|
outb(iobase, (SVRR + 0x80));
|
|
svrtype |= inb(iobase + EREG_DATA);
|
|
} else if (brdp->brdtype == BRD_ECHPCI) {
|
|
iobase = brdp->ioaddr2;
|
|
for (panelnr = 0; (panelnr < brdp->nrpanels); panelnr++) {
|
|
panelp = brdp->panels[panelnr];
|
|
outb(brdp->ioctrl, panelp->pagenr);
|
|
if (inb(iobase + ECH_PNLSTATUS) & ECH_PNLINTRPEND)
|
|
break;
|
|
if (panelp->nrports > 8) {
|
|
outb(brdp->ioctrl, (panelp->pagenr + 1));
|
|
if (inb(iobase + ECH_PNLSTATUS) & ECH_PNLINTRPEND)
|
|
break;
|
|
}
|
|
}
|
|
if (panelnr >= brdp->nrpanels) {
|
|
i++;
|
|
continue;
|
|
}
|
|
outb(iobase, SVRR);
|
|
svrtype = inb(iobase + EREG_DATA);
|
|
outb(iobase, (SVRR + 0x80));
|
|
svrtype |= inb(iobase + EREG_DATA);
|
|
} else if (brdp->brdtype == BRD_ECHMC) {
|
|
if ((inb(brdp->iostatus) & ECH_INTRPEND) == 0) {
|
|
i++;
|
|
continue;
|
|
}
|
|
for (panelnr = 0; (panelnr < brdp->nrpanels); panelnr++) {
|
|
panelp = brdp->panels[panelnr];
|
|
iobase = panelp->iobase;
|
|
if (inb(iobase + ECH_PNLSTATUS) & ECH_PNLINTRPEND)
|
|
break;
|
|
if (panelp->nrports > 8) {
|
|
iobase += 0x8;
|
|
if (inb(iobase + ECH_PNLSTATUS) & ECH_PNLINTRPEND)
|
|
break;
|
|
}
|
|
}
|
|
if (panelnr >= brdp->nrpanels) {
|
|
i++;
|
|
continue;
|
|
}
|
|
outb(iobase, SVRR);
|
|
svrtype = inb(iobase + EREG_DATA);
|
|
outb(iobase, (SVRR + 0x80));
|
|
svrtype |= inb(iobase + EREG_DATA);
|
|
} else {
|
|
printf("STALLION: unknown board type=%x\n", brdp->brdtype);
|
|
i++;
|
|
continue;
|
|
}
|
|
|
|
/*
|
|
* We have determined what type of service is required for a
|
|
* port. From here on in the service of a port is the same no
|
|
* matter what the board type...
|
|
*/
|
|
if (svrtype & SVRR_RX)
|
|
stl_rxisr(panelp, iobase);
|
|
if (svrtype & SVRR_TX)
|
|
stl_txisr(panelp, iobase);
|
|
if (svrtype & SVRR_MDM)
|
|
stl_mdmisr(panelp, iobase);
|
|
|
|
if (brdp->brdtype == BRD_ECH)
|
|
outb(brdp->ioctrl, (brdp->ioctrlval | ECH_BRDDISABLE));
|
|
}
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
#if NPCI > 0
|
|
|
|
static void stlpciintr(void *arg)
|
|
{
|
|
stlintr(0);
|
|
}
|
|
|
|
#endif
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* If we haven't scheduled a timeout then do it, some port needs high
|
|
* level processing.
|
|
*/
|
|
|
|
static void stl_dotimeout()
|
|
{
|
|
#if DEBUG
|
|
printf("stl_dotimeout()\n");
|
|
#endif
|
|
|
|
if (stl_doingtimeout == 0) {
|
|
timeout(stl_poll, 0, 1);
|
|
stl_doingtimeout++;
|
|
}
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Service "software" level processing. Too slow or painfull to be done
|
|
* at real hardware interrupt time. This way we might also be able to
|
|
* do some service on other waiting ports as well...
|
|
*/
|
|
|
|
static void stl_poll(void *arg)
|
|
{
|
|
stlbrd_t *brdp;
|
|
stlport_t *portp;
|
|
struct tty *tp;
|
|
int brdnr, portnr, rearm, x;
|
|
|
|
#if DEBUG
|
|
printf("stl_poll()\n");
|
|
#endif
|
|
|
|
stl_doingtimeout = 0;
|
|
rearm = 0;
|
|
|
|
x = spltty();
|
|
for (brdnr = 0; (brdnr < stl_nrbrds); brdnr++) {
|
|
if ((brdp = stl_brds[brdnr]) == (stlbrd_t *) NULL)
|
|
continue;
|
|
for (portnr = 0; (portnr < brdp->nrports); portnr++) {
|
|
if ((portp = brdp->ports[portnr]) == (stlport_t *) NULL)
|
|
continue;
|
|
if ((portp->state & ASY_ACTIVE) == 0)
|
|
continue;
|
|
tp = &portp->tty;
|
|
|
|
if (portp->state & ASY_RXDATA)
|
|
stl_rxprocess(portp);
|
|
if (portp->state & ASY_DCDCHANGE) {
|
|
portp->state &= ~ASY_DCDCHANGE;
|
|
portp->sigs = stl_getsignals(portp);
|
|
(*linesw[tp->t_line].l_modem)(tp,
|
|
(portp->sigs & TIOCM_CD));
|
|
}
|
|
if (portp->state & ASY_TXLOW) {
|
|
portp->state &= ~ASY_TXLOW;
|
|
(*linesw[tp->t_line].l_start)(tp);
|
|
}
|
|
|
|
if (portp->state & ASY_ACTIVE)
|
|
rearm++;
|
|
}
|
|
}
|
|
splx(x);
|
|
|
|
if (rearm)
|
|
stl_dotimeout();
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Process the RX data that has been buffered up in the RX ring queue.
|
|
*/
|
|
|
|
static void stl_rxprocess(stlport_t *portp)
|
|
{
|
|
struct tty *tp;
|
|
unsigned int len, stlen, lostlen;
|
|
char *head, *tail;
|
|
char status;
|
|
int ch;
|
|
|
|
#if DEBUG
|
|
printf("stl_rxprocess(portp=%x): brdnr=%d portnr=%d\n", (int) portp,
|
|
portp->brdnr, portp->portnr);
|
|
#endif
|
|
|
|
tp = &portp->tty;
|
|
portp->state &= ~ASY_RXDATA;
|
|
|
|
if ((tp->t_state & TS_ISOPEN) == 0) {
|
|
stl_flush(portp, FREAD);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Calculate the amount of data in the RX ring queue. Also calculate
|
|
* the largest single copy size...
|
|
*/
|
|
head = portp->rx.head;
|
|
tail = portp->rx.tail;
|
|
if (head >= tail) {
|
|
len = head - tail;
|
|
stlen = len;
|
|
} else {
|
|
len = STL_RXBUFSIZE - (tail - head);
|
|
stlen = portp->rx.endbuf - tail;
|
|
}
|
|
|
|
if (tp->t_state & TS_CAN_BYPASS_L_RINT) {
|
|
if (len > 0) {
|
|
if (((tp->t_rawq.c_cc + len) >= TTYHOG) &&
|
|
((portp->state & ASY_RTSFLOWMODE) ||
|
|
(tp->t_iflag & IXOFF)) &&
|
|
((tp->t_state & TS_TBLOCK) == 0)) {
|
|
ch = TTYHOG - tp->t_rawq.c_cc - 1;
|
|
len = (ch > 0) ? ch : 0;
|
|
stlen = MIN(stlen, len);
|
|
ttyblock(tp);
|
|
}
|
|
lostlen = b_to_q(tail, stlen, &tp->t_rawq);
|
|
tail += stlen;
|
|
len -= stlen;
|
|
if (tail >= portp->rx.endbuf) {
|
|
tail = portp->rx.buf;
|
|
lostlen += b_to_q(tail, len, &tp->t_rawq);
|
|
tail += len;
|
|
}
|
|
portp->stats.rxlost += lostlen;
|
|
ttwakeup(tp);
|
|
portp->rx.tail = tail;
|
|
}
|
|
} else {
|
|
while (portp->rx.tail != head) {
|
|
ch = (unsigned char) *(portp->rx.tail);
|
|
status = *(portp->rx.tail + STL_RXBUFSIZE);
|
|
if (status) {
|
|
*(portp->rx.tail + STL_RXBUFSIZE) = 0;
|
|
if (status & ST_BREAK)
|
|
ch |= TTY_BI;
|
|
if (status & ST_FRAMING)
|
|
ch |= TTY_FE;
|
|
if (status & ST_PARITY)
|
|
ch |= TTY_PE;
|
|
if (status & ST_OVERRUN)
|
|
ch |= TTY_OE;
|
|
}
|
|
(*linesw[tp->t_line].l_rint)(ch, tp);
|
|
if (portp->rx.tail == head)
|
|
break;
|
|
|
|
if (++(portp->rx.tail) >= portp->rx.endbuf)
|
|
portp->rx.tail = portp->rx.buf;
|
|
}
|
|
}
|
|
|
|
if (head != portp->rx.tail)
|
|
portp->state |= ASY_RXDATA;
|
|
|
|
/*
|
|
* If we where flow controled then maybe the buffer is low enough that
|
|
* we can re-activate it.
|
|
*/
|
|
if ((portp->state & ASY_RTSFLOW) && ((tp->t_state & TS_TBLOCK) == 0))
|
|
stl_flowcontrol(portp, 1, -1);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Set up the cd1400 registers for a port based on the termios port
|
|
* settings.
|
|
*/
|
|
|
|
static int stl_param(struct tty *tp, struct termios *tiosp)
|
|
{
|
|
stlport_t *portp;
|
|
unsigned int clkdiv;
|
|
unsigned char cor1, cor2, cor3;
|
|
unsigned char cor4, cor5, ccr;
|
|
unsigned char srer, sreron, sreroff;
|
|
unsigned char mcor1, mcor2, rtpr;
|
|
unsigned char clk, div;
|
|
int x;
|
|
|
|
portp = (stlport_t *) tp;
|
|
|
|
#if DEBUG
|
|
printf("stl_param(tp=%x,tiosp=%x): brdnr=%d portnr=%d\n", (int) tp,
|
|
(int) tiosp, portp->brdnr, portp->portnr);
|
|
#endif
|
|
|
|
cor1 = 0;
|
|
cor2 = 0;
|
|
cor3 = 0;
|
|
cor4 = 0;
|
|
cor5 = 0;
|
|
ccr = 0;
|
|
rtpr = 0;
|
|
clk = 0;
|
|
div = 0;
|
|
mcor1 = 0;
|
|
mcor2 = 0;
|
|
sreron = 0;
|
|
sreroff = 0;
|
|
|
|
/*
|
|
* Set up the RX char ignore mask with those RX error types we
|
|
* can ignore. We could have used some special modes of the cd1400
|
|
* UART to help, but it is better this way because we can keep stats
|
|
* on the number of each type of RX exception event.
|
|
*/
|
|
portp->rxignoremsk = 0;
|
|
if (tiosp->c_iflag & IGNPAR)
|
|
portp->rxignoremsk |= (ST_PARITY | ST_FRAMING | ST_OVERRUN);
|
|
if (tiosp->c_iflag & IGNBRK)
|
|
portp->rxignoremsk |= ST_BREAK;
|
|
|
|
portp->rxmarkmsk = ST_OVERRUN;
|
|
if (tiosp->c_iflag & (INPCK | PARMRK))
|
|
portp->rxmarkmsk |= (ST_PARITY | ST_FRAMING);
|
|
if (tiosp->c_iflag & BRKINT)
|
|
portp->rxmarkmsk |= ST_BREAK;
|
|
|
|
/*
|
|
* Go through the char size, parity and stop bits and set all the
|
|
* option registers appropriately.
|
|
*/
|
|
switch (tiosp->c_cflag & CSIZE) {
|
|
case CS5:
|
|
cor1 |= COR1_CHL5;
|
|
break;
|
|
case CS6:
|
|
cor1 |= COR1_CHL6;
|
|
break;
|
|
case CS7:
|
|
cor1 |= COR1_CHL7;
|
|
break;
|
|
default:
|
|
cor1 |= COR1_CHL8;
|
|
break;
|
|
}
|
|
|
|
if (tiosp->c_cflag & CSTOPB)
|
|
cor1 |= COR1_STOP2;
|
|
else
|
|
cor1 |= COR1_STOP1;
|
|
|
|
if (tiosp->c_cflag & PARENB) {
|
|
if (tiosp->c_cflag & PARODD)
|
|
cor1 |= (COR1_PARENB | COR1_PARODD);
|
|
else
|
|
cor1 |= (COR1_PARENB | COR1_PAREVEN);
|
|
} else {
|
|
cor1 |= COR1_PARNONE;
|
|
}
|
|
|
|
if (tiosp->c_iflag & ISTRIP)
|
|
cor5 |= COR5_ISTRIP;
|
|
|
|
/*
|
|
* Set the RX FIFO threshold at 6 chars. This gives a bit of breathing
|
|
* space for hardware flow control and the like. This should be set to
|
|
* VMIN. Also here we will set the RX data timeout to 10ms - this should
|
|
* really be based on VTIME...
|
|
*/
|
|
cor3 |= FIFO_RXTHRESHOLD;
|
|
rtpr = 2;
|
|
|
|
/*
|
|
* Calculate the baud rate timers. For now we will just assume that
|
|
* the input and output baud are the same. Could have used a baud
|
|
* table here, but this way we can generate virtually any baud rate
|
|
* we like!
|
|
*/
|
|
if (tiosp->c_ispeed == 0)
|
|
tiosp->c_ispeed = tiosp->c_ospeed;
|
|
if ((tiosp->c_ospeed < 0) || (tiosp->c_ospeed > STL_MAXBAUD))
|
|
return(EINVAL);
|
|
|
|
if (tiosp->c_ospeed > 0) {
|
|
for (clk = 0; (clk < CD1400_NUMCLKS); clk++) {
|
|
clkdiv = ((portp->clk / stl_cd1400clkdivs[clk]) /
|
|
tiosp->c_ospeed);
|
|
if (clkdiv < 0x100)
|
|
break;
|
|
}
|
|
div = (unsigned char) clkdiv;
|
|
}
|
|
|
|
/*
|
|
* Check what form of modem signaling is required and set it up.
|
|
*/
|
|
if ((tiosp->c_cflag & CLOCAL) == 0) {
|
|
mcor1 |= MCOR1_DCD;
|
|
mcor2 |= MCOR2_DCD;
|
|
sreron |= SRER_MODEM;
|
|
}
|
|
|
|
/*
|
|
* Setup cd1400 enhanced modes if we can. In particular we want to
|
|
* handle as much of the flow control as possbile automatically. As
|
|
* well as saving a few CPU cycles it will also greatly improve flow
|
|
* control reliablilty.
|
|
*/
|
|
if (tiosp->c_iflag & IXON) {
|
|
cor2 |= COR2_TXIBE;
|
|
cor3 |= COR3_SCD12;
|
|
if (tiosp->c_iflag & IXANY)
|
|
cor2 |= COR2_IXM;
|
|
}
|
|
|
|
if (tiosp->c_cflag & CCTS_OFLOW)
|
|
cor2 |= COR2_CTSAE;
|
|
if (tiosp->c_cflag & CRTS_IFLOW)
|
|
mcor1 |= FIFO_RTSTHRESHOLD;
|
|
|
|
/*
|
|
* All cd1400 register values calculated so go through and set them
|
|
* all up.
|
|
*/
|
|
#if DEBUG
|
|
printf("SETPORT: portnr=%d panelnr=%d brdnr=%d\n", portp->portnr,
|
|
portp->panelnr, portp->brdnr);
|
|
printf(" cor1=%x cor2=%x cor3=%x cor4=%x cor5=%x\n", cor1, cor2,
|
|
cor3, cor4, cor5);
|
|
printf(" mcor1=%x mcor2=%x rtpr=%x sreron=%x sreroff=%x\n",
|
|
mcor1, mcor2, rtpr, sreron, sreroff);
|
|
printf(" tcor=%x tbpr=%x rcor=%x rbpr=%x\n", clk, div, clk, div);
|
|
printf(" schr1=%x schr2=%x schr3=%x schr4=%x\n",
|
|
tiosp->c_cc[VSTART], tiosp->c_cc[VSTOP], tiosp->c_cc[VSTART],
|
|
tiosp->c_cc[VSTOP]);
|
|
#endif
|
|
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x3));
|
|
srer = stl_getreg(portp, SRER);
|
|
stl_setreg(portp, SRER, 0);
|
|
ccr += stl_updatereg(portp, COR1, cor1);
|
|
ccr += stl_updatereg(portp, COR2, cor2);
|
|
ccr += stl_updatereg(portp, COR3, cor3);
|
|
if (ccr) {
|
|
stl_ccrwait(portp);
|
|
stl_setreg(portp, CCR, CCR_CORCHANGE);
|
|
}
|
|
stl_setreg(portp, COR4, cor4);
|
|
stl_setreg(portp, COR5, cor5);
|
|
stl_setreg(portp, MCOR1, mcor1);
|
|
stl_setreg(portp, MCOR2, mcor2);
|
|
if (tiosp->c_ospeed == 0) {
|
|
stl_setreg(portp, MSVR1, 0);
|
|
} else {
|
|
stl_setreg(portp, MSVR1, MSVR1_DTR);
|
|
stl_setreg(portp, TCOR, clk);
|
|
stl_setreg(portp, TBPR, div);
|
|
stl_setreg(portp, RCOR, clk);
|
|
stl_setreg(portp, RBPR, div);
|
|
}
|
|
stl_setreg(portp, SCHR1, tiosp->c_cc[VSTART]);
|
|
stl_setreg(portp, SCHR2, tiosp->c_cc[VSTOP]);
|
|
stl_setreg(portp, SCHR3, tiosp->c_cc[VSTART]);
|
|
stl_setreg(portp, SCHR4, tiosp->c_cc[VSTOP]);
|
|
stl_setreg(portp, RTPR, rtpr);
|
|
mcor1 = stl_getreg(portp, MSVR1);
|
|
if (mcor1 & MSVR1_DCD)
|
|
portp->sigs |= TIOCM_CD;
|
|
else
|
|
portp->sigs &= ~TIOCM_CD;
|
|
stl_setreg(portp, SRER, ((srer & ~sreroff) | sreron));
|
|
BRDDISABLE(portp->brdnr);
|
|
portp->state &= ~(ASY_RTSFLOWMODE | ASY_CTSFLOWMODE);
|
|
portp->state |= ((tiosp->c_cflag & CRTS_IFLOW) ? ASY_RTSFLOWMODE : 0);
|
|
portp->state |= ((tiosp->c_cflag & CCTS_OFLOW) ? ASY_CTSFLOWMODE : 0);
|
|
stl_ttyoptim(portp, tiosp);
|
|
splx(x);
|
|
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Action the flow control as required. The hw and sw args inform the
|
|
* routine what flow control methods it should try.
|
|
*/
|
|
|
|
static void stl_flowcontrol(stlport_t *portp, int hw, int sw)
|
|
{
|
|
unsigned char *head, *tail;
|
|
int len, hwflow, x;
|
|
|
|
#if DEBUG
|
|
printf("stl_flowcontrol(portp=%x,hw=%d,sw=%d)\n", (int) portp, hw, sw);
|
|
#endif
|
|
|
|
hwflow = -1;
|
|
|
|
if (portp->state & ASY_RTSFLOWMODE) {
|
|
if (hw == 0) {
|
|
if ((portp->state & ASY_RTSFLOW) == 0)
|
|
hwflow = 0;
|
|
} else if (hw > 0) {
|
|
if (portp->state & ASY_RTSFLOW) {
|
|
head = portp->rx.head;
|
|
tail = portp->rx.tail;
|
|
len = (head >= tail) ? (head - tail) :
|
|
(STL_RXBUFSIZE - (tail - head));
|
|
if (len < STL_RXBUFHIGH)
|
|
hwflow = 1;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* We have worked out what to do, if anything. So now apply it to the
|
|
* UART port.
|
|
*/
|
|
if (hwflow >= 0) {
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x03));
|
|
if (hwflow == 0) {
|
|
portp->state |= ASY_RTSFLOW;
|
|
stl_setreg(portp, MCOR1,
|
|
(stl_getreg(portp, MCOR1) & 0xf0));
|
|
stl_setreg(portp, MSVR2, 0);
|
|
portp->stats.rxrtsoff++;
|
|
} else if (hwflow > 0) {
|
|
portp->state &= ~ASY_RTSFLOW;
|
|
stl_setreg(portp, MSVR2, MSVR2_RTS);
|
|
stl_setreg(portp, MCOR1,
|
|
(stl_getreg(portp, MCOR1) | FIFO_RTSTHRESHOLD));
|
|
portp->stats.rxrtson++;
|
|
}
|
|
BRDDISABLE(portp->brdnr);
|
|
splx(x);
|
|
}
|
|
}
|
|
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Set the state of the DTR and RTS signals.
|
|
*/
|
|
|
|
static void stl_setsignals(stlport_t *portp, int dtr, int rts)
|
|
{
|
|
unsigned char msvr1, msvr2;
|
|
int x;
|
|
|
|
#if DEBUG
|
|
printf("stl_setsignals(portp=%x,dtr=%d,rts=%d)\n", (int) portp,
|
|
dtr, rts);
|
|
#endif
|
|
|
|
msvr1 = 0;
|
|
msvr2 = 0;
|
|
if (dtr > 0)
|
|
msvr1 = MSVR1_DTR;
|
|
if (rts > 0)
|
|
msvr2 = MSVR2_RTS;
|
|
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x03));
|
|
if (rts >= 0)
|
|
stl_setreg(portp, MSVR2, msvr2);
|
|
if (dtr >= 0)
|
|
stl_setreg(portp, MSVR1, msvr1);
|
|
BRDDISABLE(portp->brdnr);
|
|
splx(x);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Get the state of the signals.
|
|
*/
|
|
|
|
static int stl_getsignals(stlport_t *portp)
|
|
{
|
|
unsigned char msvr1, msvr2;
|
|
int sigs, x;
|
|
|
|
#if DEBUG
|
|
printf("stl_getsignals(portp=%x)\n", (int) portp);
|
|
#endif
|
|
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x3));
|
|
msvr1 = stl_getreg(portp, MSVR1);
|
|
msvr2 = stl_getreg(portp, MSVR2);
|
|
BRDDISABLE(portp->brdnr);
|
|
splx(x);
|
|
|
|
sigs = 0;
|
|
sigs |= (msvr1 & MSVR1_DCD) ? TIOCM_CD : 0;
|
|
sigs |= (msvr1 & MSVR1_CTS) ? TIOCM_CTS : 0;
|
|
sigs |= (msvr1 & MSVR1_RI) ? TIOCM_RI : 0;
|
|
sigs |= (msvr1 & MSVR1_DSR) ? TIOCM_DSR : 0;
|
|
sigs |= (msvr1 & MSVR1_DTR) ? TIOCM_DTR : 0;
|
|
sigs |= (msvr2 & MSVR2_RTS) ? TIOCM_RTS : 0;
|
|
return(sigs);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Enable or disable the Transmitter and/or Receiver.
|
|
*/
|
|
|
|
static void stl_enablerxtx(stlport_t *portp, int rx, int tx)
|
|
{
|
|
unsigned char ccr;
|
|
int x;
|
|
|
|
#if DEBUG
|
|
printf("stl_enablerxtx(portp=%x,rx=%d,tx=%d)\n", (int) portp, rx, tx);
|
|
#endif
|
|
|
|
ccr = 0;
|
|
if (tx == 0)
|
|
ccr |= CCR_TXDISABLE;
|
|
else if (tx > 0)
|
|
ccr |= CCR_TXENABLE;
|
|
if (rx == 0)
|
|
ccr |= CCR_RXDISABLE;
|
|
else if (rx > 0)
|
|
ccr |= CCR_RXENABLE;
|
|
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x03));
|
|
stl_ccrwait(portp);
|
|
stl_setreg(portp, CCR, ccr);
|
|
stl_ccrwait(portp);
|
|
BRDDISABLE(portp->brdnr);
|
|
splx(x);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Start or stop the Transmitter and/or Receiver.
|
|
*/
|
|
|
|
static void stl_startrxtx(stlport_t *portp, int rx, int tx)
|
|
{
|
|
unsigned char sreron, sreroff;
|
|
int x;
|
|
|
|
#if DEBUG
|
|
printf("stl_startrxtx(portp=%x,rx=%d,tx=%d)\n", (int) portp, rx, tx);
|
|
#endif
|
|
|
|
sreron = 0;
|
|
sreroff = 0;
|
|
if (tx == 0)
|
|
sreroff |= (SRER_TXDATA | SRER_TXEMPTY);
|
|
else if (tx == 1)
|
|
sreron |= SRER_TXDATA;
|
|
else if (tx >= 2)
|
|
sreron |= SRER_TXEMPTY;
|
|
if (rx == 0)
|
|
sreroff |= SRER_RXDATA;
|
|
else if (rx > 0)
|
|
sreron |= SRER_RXDATA;
|
|
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x3));
|
|
stl_setreg(portp, SRER,
|
|
((stl_getreg(portp, SRER) & ~sreroff) | sreron));
|
|
BRDDISABLE(portp->brdnr);
|
|
if (tx > 0)
|
|
portp->tty.t_state |= TS_BUSY;
|
|
splx(x);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Disable all interrupts from this port.
|
|
*/
|
|
|
|
static void stl_disableintrs(stlport_t *portp)
|
|
{
|
|
int x;
|
|
|
|
#if DEBUG
|
|
printf("stl_disableintrs(portp=%x)\n", (int) portp);
|
|
#endif
|
|
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x3));
|
|
stl_setreg(portp, SRER, 0);
|
|
BRDDISABLE(portp->brdnr);
|
|
splx(x);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static void stl_sendbreak(stlport_t *portp, long len)
|
|
{
|
|
int x;
|
|
|
|
#if DEBUG
|
|
printf("stl_sendbreak(portp=%x,len=%d)\n", (int) portp, (int) len);
|
|
#endif
|
|
|
|
x = spltty();
|
|
BRDENABLE(portp->brdnr, portp->pagenr);
|
|
stl_setreg(portp, CAR, (portp->portnr & 0x3));
|
|
stl_setreg(portp, COR2, (stl_getreg(portp, COR2) | COR2_ETC));
|
|
stl_setreg(portp, SRER,
|
|
((stl_getreg(portp, SRER) & ~SRER_TXDATA) | SRER_TXEMPTY));
|
|
BRDDISABLE(portp->brdnr);
|
|
if (len > 0) {
|
|
len = len / 5;
|
|
portp->brklen = (len > 255) ? 255 : len;
|
|
} else {
|
|
portp->brklen = len;
|
|
}
|
|
splx(x);
|
|
portp->stats.txbreaks++;
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Enable l_rint processing bypass mode if tty modes allow it.
|
|
*/
|
|
|
|
static void stl_ttyoptim(stlport_t *portp, struct termios *tiosp)
|
|
{
|
|
struct tty *tp;
|
|
|
|
tp = &portp->tty;
|
|
if (((tiosp->c_iflag & (ICRNL | IGNCR | IMAXBEL | INLCR)) == 0) &&
|
|
(((tiosp->c_iflag & BRKINT) == 0) || (tiosp->c_iflag & IGNBRK)) &&
|
|
(((tiosp->c_iflag & PARMRK) == 0) ||
|
|
((tiosp->c_iflag & (IGNPAR | IGNBRK)) == (IGNPAR | IGNBRK))) &&
|
|
((tiosp->c_lflag & (ECHO | ICANON | IEXTEN | ISIG | PENDIN)) ==0) &&
|
|
(linesw[tp->t_line].l_rint == ttyinput))
|
|
tp->t_state |= TS_CAN_BYPASS_L_RINT;
|
|
else
|
|
tp->t_state &= ~TS_CAN_BYPASS_L_RINT;
|
|
portp->hotchar = linesw[tp->t_line].l_hotchar;
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Try and find and initialize all the ports on a panel. We don't care
|
|
* what sort of board these ports are on - since the port io registers
|
|
* are almost identical when dealing with ports.
|
|
*/
|
|
|
|
static int stl_initports(stlbrd_t *brdp, stlpanel_t *panelp)
|
|
{
|
|
stlport_t *portp;
|
|
unsigned int chipmask;
|
|
unsigned int gfrcr;
|
|
int nrchips, uartaddr, ioaddr;
|
|
int i, j;
|
|
|
|
#if DEBUG
|
|
printf("stl_initports(panelp=%x)\n", (int) panelp);
|
|
#endif
|
|
|
|
BRDENABLE(panelp->brdnr, panelp->pagenr);
|
|
|
|
/*
|
|
* Check that each chip is present and started up OK.
|
|
*/
|
|
chipmask = 0;
|
|
nrchips = panelp->nrports / CD1400_PORTS;
|
|
for (i = 0; (i < nrchips); i++) {
|
|
if (brdp->brdtype == BRD_ECHPCI) {
|
|
outb(brdp->ioctrl, (panelp->pagenr + (i >> 1)));
|
|
ioaddr = panelp->iobase;
|
|
} else {
|
|
ioaddr = panelp->iobase + (EREG_BANKSIZE * (i >> 1));
|
|
}
|
|
uartaddr = (i & 0x01) ? 0x080 : 0;
|
|
outb(ioaddr, (GFRCR + uartaddr));
|
|
outb((ioaddr + EREG_DATA), 0);
|
|
outb(ioaddr, (CCR + uartaddr));
|
|
outb((ioaddr + EREG_DATA), CCR_RESETFULL);
|
|
outb((ioaddr + EREG_DATA), CCR_RESETFULL);
|
|
outb(ioaddr, (GFRCR + uartaddr));
|
|
for (j = 0; (j < CCR_MAXWAIT); j++) {
|
|
gfrcr = inb(ioaddr + EREG_DATA);
|
|
if ((gfrcr > 0x40) && (gfrcr < 0x60))
|
|
break;
|
|
}
|
|
if (j >= CCR_MAXWAIT) {
|
|
printf("STALLION: cd1400 not responding, brd=%d "
|
|
"panel=%d chip=%d\n", panelp->brdnr,
|
|
panelp->panelnr, i);
|
|
continue;
|
|
}
|
|
chipmask |= (0x1 << i);
|
|
outb(ioaddr, (PPR + uartaddr));
|
|
outb((ioaddr + EREG_DATA), PPR_SCALAR);
|
|
}
|
|
|
|
/*
|
|
* All cd1400's are initialized (if found!). Now go through and setup
|
|
* each ports data structures. Also init the LIVR register of cd1400
|
|
* for each port.
|
|
*/
|
|
ioaddr = panelp->iobase;
|
|
for (i = 0; (i < panelp->nrports); i++) {
|
|
if (brdp->brdtype == BRD_ECHPCI) {
|
|
outb(brdp->ioctrl, (panelp->pagenr + (i >> 3)));
|
|
ioaddr = panelp->iobase;
|
|
} else {
|
|
ioaddr = panelp->iobase + (EREG_BANKSIZE * (i >> 3));
|
|
}
|
|
if ((chipmask & (0x1 << (i / 4))) == 0)
|
|
continue;
|
|
portp = (stlport_t *) malloc(sizeof(stlport_t), M_TTYS,
|
|
M_NOWAIT | M_ZERO);
|
|
if (portp == (stlport_t *) NULL) {
|
|
printf("STALLION: failed to allocate port memory "
|
|
"(size=%d)\n", sizeof(stlport_t));
|
|
break;
|
|
}
|
|
|
|
portp->portnr = i;
|
|
portp->brdnr = panelp->brdnr;
|
|
portp->panelnr = panelp->panelnr;
|
|
portp->clk = brdp->clk;
|
|
portp->ioaddr = ioaddr;
|
|
portp->uartaddr = (i & 0x4) << 5;
|
|
portp->pagenr = panelp->pagenr + (i >> 3);
|
|
portp->hwid = stl_getreg(portp, GFRCR);
|
|
stl_setreg(portp, CAR, (i & 0x3));
|
|
stl_setreg(portp, LIVR, (i << 3));
|
|
panelp->ports[i] = portp;
|
|
|
|
j = STL_TXBUFSIZE + (2 * STL_RXBUFSIZE);
|
|
portp->tx.buf = (char *) malloc(j, M_TTYS, M_NOWAIT);
|
|
if (portp->tx.buf == (char *) NULL) {
|
|
printf("STALLION: failed to allocate buffer memory "
|
|
"(size=%d)\n", j);
|
|
break;
|
|
}
|
|
portp->tx.endbuf = portp->tx.buf + STL_TXBUFSIZE;
|
|
portp->tx.head = portp->tx.buf;
|
|
portp->tx.tail = portp->tx.buf;
|
|
portp->rx.buf = portp->tx.buf + STL_TXBUFSIZE;
|
|
portp->rx.endbuf = portp->rx.buf + STL_RXBUFSIZE;
|
|
portp->rx.head = portp->rx.buf;
|
|
portp->rx.tail = portp->rx.buf;
|
|
portp->rxstatus.buf = portp->rx.buf + STL_RXBUFSIZE;
|
|
portp->rxstatus.endbuf = portp->rxstatus.buf + STL_RXBUFSIZE;
|
|
portp->rxstatus.head = portp->rxstatus.buf;
|
|
portp->rxstatus.tail = portp->rxstatus.buf;
|
|
bzero(portp->rxstatus.head, STL_RXBUFSIZE);
|
|
|
|
portp->initintios.c_ispeed = STL_DEFSPEED;
|
|
portp->initintios.c_ospeed = STL_DEFSPEED;
|
|
portp->initintios.c_cflag = STL_DEFCFLAG;
|
|
portp->initintios.c_iflag = 0;
|
|
portp->initintios.c_oflag = 0;
|
|
portp->initintios.c_lflag = 0;
|
|
bcopy(&ttydefchars[0], &portp->initintios.c_cc[0],
|
|
sizeof(portp->initintios.c_cc));
|
|
portp->initouttios = portp->initintios;
|
|
portp->dtrwait = 3 * hz;
|
|
}
|
|
|
|
BRDDISABLE(panelp->brdnr);
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Try to find and initialize an EasyIO board.
|
|
*/
|
|
|
|
static int stl_initeio(stlbrd_t *brdp)
|
|
{
|
|
stlpanel_t *panelp;
|
|
unsigned int status;
|
|
|
|
#if DEBUG
|
|
printf("stl_initeio(brdp=%x)\n", (int) brdp);
|
|
#endif
|
|
|
|
brdp->ioctrl = brdp->ioaddr1 + 1;
|
|
brdp->iostatus = brdp->ioaddr1 + 2;
|
|
brdp->clk = EIO_CLK;
|
|
|
|
status = inb(brdp->iostatus);
|
|
switch (status & EIO_IDBITMASK) {
|
|
case EIO_8PORTM:
|
|
brdp->clk = EIO_CLK8M;
|
|
/* FALLTHROUGH */
|
|
case EIO_8PORTRS:
|
|
case EIO_8PORTDI:
|
|
brdp->nrports = 8;
|
|
break;
|
|
case EIO_4PORTRS:
|
|
brdp->nrports = 4;
|
|
break;
|
|
default:
|
|
return(ENODEV);
|
|
}
|
|
|
|
/*
|
|
* Check that the supplied IRQ is good and then use it to setup the
|
|
* programmable interrupt bits on EIO board. Also set the edge/level
|
|
* triggered interrupt bit.
|
|
*/
|
|
if ((brdp->irq < 0) || (brdp->irq > 15) ||
|
|
(stl_vecmap[brdp->irq] == (unsigned char) 0xff)) {
|
|
printf("STALLION: invalid irq=%d for brd=%d\n", brdp->irq,
|
|
brdp->brdnr);
|
|
return(EINVAL);
|
|
}
|
|
outb(brdp->ioctrl, (stl_vecmap[brdp->irq] |
|
|
((brdp->irqtype) ? EIO_INTLEVEL : EIO_INTEDGE)));
|
|
|
|
panelp = (stlpanel_t *) malloc(sizeof(stlpanel_t), M_TTYS,
|
|
M_NOWAIT | M_ZERO);
|
|
if (panelp == (stlpanel_t *) NULL) {
|
|
printf("STALLION: failed to allocate memory (size=%d)\n",
|
|
sizeof(stlpanel_t));
|
|
return(ENOMEM);
|
|
}
|
|
|
|
panelp->brdnr = brdp->brdnr;
|
|
panelp->panelnr = 0;
|
|
panelp->nrports = brdp->nrports;
|
|
panelp->iobase = brdp->ioaddr1;
|
|
panelp->hwid = status;
|
|
brdp->panels[0] = panelp;
|
|
brdp->nrpanels = 1;
|
|
brdp->hwid = status;
|
|
brdp->state |= BRD_FOUND;
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Try to find an ECH board and initialize it. This code is capable of
|
|
* dealing with all types of ECH board.
|
|
*/
|
|
|
|
static int stl_initech(stlbrd_t *brdp)
|
|
{
|
|
stlpanel_t *panelp;
|
|
unsigned int status, nxtid;
|
|
int panelnr, ioaddr, i;
|
|
|
|
#if DEBUG
|
|
printf("stl_initech(brdp=%x)\n", (int) brdp);
|
|
#endif
|
|
|
|
/*
|
|
* Set up the initial board register contents for boards. This varys a
|
|
* bit between the different board types. So we need to handle each
|
|
* separately. Also do a check that the supplied IRQ is good.
|
|
*/
|
|
if (brdp->brdtype == BRD_ECH) {
|
|
brdp->ioctrl = brdp->ioaddr1 + 1;
|
|
brdp->iostatus = brdp->ioaddr1 + 1;
|
|
status = inb(brdp->iostatus);
|
|
if ((status & ECH_IDBITMASK) != ECH_ID)
|
|
return(ENODEV);
|
|
brdp->hwid = status;
|
|
|
|
if ((brdp->irq < 0) || (brdp->irq > 15) ||
|
|
(stl_vecmap[brdp->irq] == (unsigned char) 0xff)) {
|
|
printf("STALLION: invalid irq=%d for brd=%d\n",
|
|
brdp->irq, brdp->brdnr);
|
|
return(EINVAL);
|
|
}
|
|
status = ((brdp->ioaddr2 & ECH_ADDR2MASK) >> 1);
|
|
status |= (stl_vecmap[brdp->irq] << 1);
|
|
outb(brdp->ioaddr1, (status | ECH_BRDRESET));
|
|
brdp->ioctrlval = ECH_INTENABLE |
|
|
((brdp->irqtype) ? ECH_INTLEVEL : ECH_INTEDGE);
|
|
outb(brdp->ioctrl, (brdp->ioctrlval | ECH_BRDENABLE));
|
|
outb(brdp->ioaddr1, status);
|
|
} else if (brdp->brdtype == BRD_ECHMC) {
|
|
brdp->ioctrl = brdp->ioaddr1 + 0x20;
|
|
brdp->iostatus = brdp->ioctrl;
|
|
status = inb(brdp->iostatus);
|
|
if ((status & ECH_IDBITMASK) != ECH_ID)
|
|
return(ENODEV);
|
|
brdp->hwid = status;
|
|
|
|
if ((brdp->irq < 0) || (brdp->irq > 15) ||
|
|
(stl_vecmap[brdp->irq] == (unsigned char) 0xff)) {
|
|
printf("STALLION: invalid irq=%d for brd=%d\n",
|
|
brdp->irq, brdp->brdnr);
|
|
return(EINVAL);
|
|
}
|
|
outb(brdp->ioctrl, ECHMC_BRDRESET);
|
|
outb(brdp->ioctrl, ECHMC_INTENABLE);
|
|
} else if (brdp->brdtype == BRD_ECHPCI) {
|
|
brdp->ioctrl = brdp->ioaddr1 + 2;
|
|
}
|
|
|
|
brdp->clk = ECH_CLK;
|
|
|
|
/*
|
|
* Scan through the secondary io address space looking for panels.
|
|
* As we find'em allocate and initialize panel structures for each.
|
|
*/
|
|
ioaddr = brdp->ioaddr2;
|
|
panelnr = 0;
|
|
nxtid = 0;
|
|
|
|
for (i = 0; (i < STL_MAXPANELS); i++) {
|
|
if (brdp->brdtype == BRD_ECHPCI) {
|
|
outb(brdp->ioctrl, nxtid);
|
|
ioaddr = brdp->ioaddr2;
|
|
}
|
|
status = inb(ioaddr + ECH_PNLSTATUS);
|
|
if ((status & ECH_PNLIDMASK) != nxtid)
|
|
break;
|
|
panelp = (stlpanel_t *) malloc(sizeof(stlpanel_t), M_TTYS,
|
|
M_NOWAIT | M_ZERO);
|
|
if (panelp == (stlpanel_t *) NULL) {
|
|
printf("STALLION: failed to allocate memory"
|
|
"(size=%d)\n", sizeof(stlpanel_t));
|
|
break;
|
|
}
|
|
panelp->brdnr = brdp->brdnr;
|
|
panelp->panelnr = panelnr;
|
|
panelp->iobase = ioaddr;
|
|
panelp->pagenr = nxtid;
|
|
panelp->hwid = status;
|
|
if (status & ECH_PNL16PORT) {
|
|
if ((brdp->nrports + 16) > 32)
|
|
break;
|
|
panelp->nrports = 16;
|
|
panelp->ackmask = 0x80;
|
|
brdp->nrports += 16;
|
|
ioaddr += (EREG_BANKSIZE * 2);
|
|
nxtid += 2;
|
|
} else {
|
|
panelp->nrports = 8;
|
|
panelp->ackmask = 0xc0;
|
|
brdp->nrports += 8;
|
|
ioaddr += EREG_BANKSIZE;
|
|
nxtid++;
|
|
}
|
|
brdp->panels[panelnr++] = panelp;
|
|
brdp->nrpanels++;
|
|
if (ioaddr >= (brdp->ioaddr2 + 0x20))
|
|
break;
|
|
}
|
|
|
|
if (brdp->brdtype == BRD_ECH)
|
|
outb(brdp->ioctrl, (brdp->ioctrlval | ECH_BRDDISABLE));
|
|
|
|
brdp->state |= BRD_FOUND;
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Initialize and configure the specified board. This firstly probes
|
|
* for the board, if it is found then the board is initialized and
|
|
* then all its ports are initialized as well.
|
|
*/
|
|
|
|
static int stl_brdinit(stlbrd_t *brdp)
|
|
{
|
|
stlpanel_t *panelp;
|
|
int i, j, k;
|
|
|
|
#if DEBUG
|
|
printf("stl_brdinit(brdp=%x): unit=%d type=%d io1=%x io2=%x irq=%d\n",
|
|
(int) brdp, brdp->brdnr, brdp->brdtype, brdp->ioaddr1,
|
|
brdp->ioaddr2, brdp->irq);
|
|
#endif
|
|
|
|
switch (brdp->brdtype) {
|
|
case BRD_EASYIO:
|
|
stl_initeio(brdp);
|
|
break;
|
|
case BRD_ECH:
|
|
case BRD_ECHMC:
|
|
case BRD_ECHPCI:
|
|
stl_initech(brdp);
|
|
break;
|
|
default:
|
|
printf("STALLION: unit=%d is unknown board type=%d\n",
|
|
brdp->brdnr, brdp->brdtype);
|
|
return(ENODEV);
|
|
}
|
|
|
|
stl_brds[brdp->brdnr] = brdp;
|
|
if ((brdp->state & BRD_FOUND) == 0) {
|
|
#if 0
|
|
printf("STALLION: %s board not found, unit=%d io=%x irq=%d\n",
|
|
stl_brdnames[brdp->brdtype], brdp->brdnr,
|
|
brdp->ioaddr1, brdp->irq);
|
|
#endif
|
|
return(ENODEV);
|
|
}
|
|
|
|
for (i = 0, k = 0; (i < STL_MAXPANELS); i++) {
|
|
panelp = brdp->panels[i];
|
|
if (panelp != (stlpanel_t *) NULL) {
|
|
stl_initports(brdp, panelp);
|
|
for (j = 0; (j < panelp->nrports); j++)
|
|
brdp->ports[k++] = panelp->ports[j];
|
|
}
|
|
}
|
|
|
|
printf("stl%d: %s (driver version %s) unit=%d nrpanels=%d nrports=%d\n",
|
|
brdp->unitid, stl_brdnames[brdp->brdtype], stl_drvversion,
|
|
brdp->brdnr, brdp->nrpanels, brdp->nrports);
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Return the board stats structure to user app.
|
|
*/
|
|
|
|
static int stl_getbrdstats(caddr_t data)
|
|
{
|
|
stlbrd_t *brdp;
|
|
stlpanel_t *panelp;
|
|
int i;
|
|
|
|
stl_brdstats = *((combrd_t *) data);
|
|
if (stl_brdstats.brd >= STL_MAXBRDS)
|
|
return(-ENODEV);
|
|
brdp = stl_brds[stl_brdstats.brd];
|
|
if (brdp == (stlbrd_t *) NULL)
|
|
return(-ENODEV);
|
|
|
|
bzero(&stl_brdstats, sizeof(combrd_t));
|
|
stl_brdstats.brd = brdp->brdnr;
|
|
stl_brdstats.type = brdp->brdtype;
|
|
stl_brdstats.hwid = brdp->hwid;
|
|
stl_brdstats.state = brdp->state;
|
|
stl_brdstats.ioaddr = brdp->ioaddr1;
|
|
stl_brdstats.ioaddr2 = brdp->ioaddr2;
|
|
stl_brdstats.irq = brdp->irq;
|
|
stl_brdstats.nrpanels = brdp->nrpanels;
|
|
stl_brdstats.nrports = brdp->nrports;
|
|
for (i = 0; (i < brdp->nrpanels); i++) {
|
|
panelp = brdp->panels[i];
|
|
stl_brdstats.panels[i].panel = i;
|
|
stl_brdstats.panels[i].hwid = panelp->hwid;
|
|
stl_brdstats.panels[i].nrports = panelp->nrports;
|
|
}
|
|
|
|
*((combrd_t *) data) = stl_brdstats;;
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Resolve the referenced port number into a port struct pointer.
|
|
*/
|
|
|
|
static stlport_t *stl_getport(int brdnr, int panelnr, int portnr)
|
|
{
|
|
stlbrd_t *brdp;
|
|
stlpanel_t *panelp;
|
|
|
|
if ((brdnr < 0) || (brdnr >= STL_MAXBRDS))
|
|
return((stlport_t *) NULL);
|
|
brdp = stl_brds[brdnr];
|
|
if (brdp == (stlbrd_t *) NULL)
|
|
return((stlport_t *) NULL);
|
|
if ((panelnr < 0) || (panelnr >= brdp->nrpanels))
|
|
return((stlport_t *) NULL);
|
|
panelp = brdp->panels[panelnr];
|
|
if (panelp == (stlpanel_t *) NULL)
|
|
return((stlport_t *) NULL);
|
|
if ((portnr < 0) || (portnr >= panelp->nrports))
|
|
return((stlport_t *) NULL);
|
|
return(panelp->ports[portnr]);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Return the port stats structure to user app. A NULL port struct
|
|
* pointer passed in means that we need to find out from the app
|
|
* what port to get stats for (used through board control device).
|
|
*/
|
|
|
|
static int stl_getportstats(stlport_t *portp, caddr_t data)
|
|
{
|
|
unsigned char *head, *tail;
|
|
|
|
if (portp == (stlport_t *) NULL) {
|
|
stl_comstats = *((comstats_t *) data);
|
|
portp = stl_getport(stl_comstats.brd, stl_comstats.panel,
|
|
stl_comstats.port);
|
|
if (portp == (stlport_t *) NULL)
|
|
return(-ENODEV);
|
|
}
|
|
|
|
portp->stats.state = portp->state;
|
|
/*portp->stats.flags = portp->flags;*/
|
|
portp->stats.hwid = portp->hwid;
|
|
portp->stats.ttystate = portp->tty.t_state;
|
|
portp->stats.cflags = portp->tty.t_cflag;
|
|
portp->stats.iflags = portp->tty.t_iflag;
|
|
portp->stats.oflags = portp->tty.t_oflag;
|
|
portp->stats.lflags = portp->tty.t_lflag;
|
|
|
|
head = portp->tx.head;
|
|
tail = portp->tx.tail;
|
|
portp->stats.txbuffered = ((head >= tail) ? (head - tail) :
|
|
(STL_TXBUFSIZE - (tail - head)));
|
|
|
|
head = portp->rx.head;
|
|
tail = portp->rx.tail;
|
|
portp->stats.rxbuffered = (head >= tail) ? (head - tail) :
|
|
(STL_RXBUFSIZE - (tail - head));
|
|
|
|
portp->stats.signals = (unsigned long) stl_getsignals(portp);
|
|
|
|
*((comstats_t *) data) = portp->stats;
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* Clear the port stats structure. We also return it zeroed out...
|
|
*/
|
|
|
|
static int stl_clrportstats(stlport_t *portp, caddr_t data)
|
|
{
|
|
if (portp == (stlport_t *) NULL) {
|
|
stl_comstats = *((comstats_t *) data);
|
|
portp = stl_getport(stl_comstats.brd, stl_comstats.panel,
|
|
stl_comstats.port);
|
|
if (portp == (stlport_t *) NULL)
|
|
return(-ENODEV);
|
|
}
|
|
|
|
bzero(&portp->stats, sizeof(comstats_t));
|
|
portp->stats.brd = portp->brdnr;
|
|
portp->stats.panel = portp->panelnr;
|
|
portp->stats.port = portp->portnr;
|
|
*((comstats_t *) data) = stl_comstats;
|
|
return(0);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
/*
|
|
* The "staliomem" device is used for stats collection in this driver.
|
|
*/
|
|
|
|
static int stl_memioctl(dev_t dev, unsigned long cmd, caddr_t data, int flag,
|
|
struct thread *td)
|
|
{
|
|
stlbrd_t *brdp;
|
|
int brdnr, rc;
|
|
|
|
#if DEBUG
|
|
printf("stl_memioctl(dev=%s,cmd=%lx,data=%p,flag=%x)\n",
|
|
devtoname(dev), cmd, (void *) data, flag);
|
|
#endif
|
|
|
|
brdnr = minor(dev) & 0x7;
|
|
brdp = stl_brds[brdnr];
|
|
if (brdp == (stlbrd_t *) NULL)
|
|
return(ENODEV);
|
|
if (brdp->state == 0)
|
|
return(ENODEV);
|
|
|
|
rc = 0;
|
|
|
|
switch (cmd) {
|
|
case COM_GETPORTSTATS:
|
|
rc = stl_getportstats((stlport_t *) NULL, data);
|
|
break;
|
|
case COM_CLRPORTSTATS:
|
|
rc = stl_clrportstats((stlport_t *) NULL, data);
|
|
break;
|
|
case COM_GETBRDSTATS:
|
|
rc = stl_getbrdstats(data);
|
|
break;
|
|
default:
|
|
rc = ENOTTY;
|
|
break;
|
|
}
|
|
|
|
return(rc);
|
|
}
|
|
|
|
/*****************************************************************************/
|