mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-05 12:06:42 +07:00
5350d3ba3d
The specialix module is missing the char-major-75-* alias that would cause it to be auto-loaded when a device of that type is opened. This patch adds the alias. Signed-off-by: Scott James Remnant <scott@canonical.com> Signed-off-by: Tim Gardner <tim.gardner@canonical.com> Signed-off-by: Alan Cox <alan@lxorguk.ukuu.org.uk> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2369 lines
56 KiB
C
2369 lines
56 KiB
C
/*
|
|
* specialix.c -- specialix IO8+ multiport serial driver.
|
|
*
|
|
* Copyright (C) 1997 Roger Wolff (R.E.Wolff@BitWizard.nl)
|
|
* Copyright (C) 1994-1996 Dmitry Gorodchanin (pgmdsg@ibi.com)
|
|
*
|
|
* Specialix pays for the development and support of this driver.
|
|
* Please DO contact io8-linux@specialix.co.uk if you require
|
|
* support. But please read the documentation (specialix.txt)
|
|
* first.
|
|
*
|
|
* This driver was developped in the BitWizard linux device
|
|
* driver service. If you require a linux device driver for your
|
|
* product, please contact devices@BitWizard.nl for a quote.
|
|
*
|
|
* This code is firmly based on the riscom/8 serial driver,
|
|
* written by Dmitry Gorodchanin. The specialix IO8+ card
|
|
* programming information was obtained from the CL-CD1865 Data
|
|
* Book, and Specialix document number 6200059: IO8+ Hardware
|
|
* Functional Specification.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of
|
|
* the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be
|
|
* useful, but WITHOUT ANY WARRANTY; without even the implied
|
|
* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
|
|
* PURPOSE. See the GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public
|
|
* License along with this program; if not, write to the Free
|
|
* Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139,
|
|
* USA.
|
|
*
|
|
* Revision history:
|
|
*
|
|
* Revision 1.0: April 1st 1997.
|
|
* Initial release for alpha testing.
|
|
* Revision 1.1: April 14th 1997.
|
|
* Incorporated Richard Hudsons suggestions,
|
|
* removed some debugging printk's.
|
|
* Revision 1.2: April 15th 1997.
|
|
* Ported to 2.1.x kernels.
|
|
* Revision 1.3: April 17th 1997
|
|
* Backported to 2.0. (Compatibility macros).
|
|
* Revision 1.4: April 18th 1997
|
|
* Fixed DTR/RTS bug that caused the card to indicate
|
|
* "don't send data" to a modem after the password prompt.
|
|
* Fixed bug for premature (fake) interrupts.
|
|
* Revision 1.5: April 19th 1997
|
|
* fixed a minor typo in the header file, cleanup a little.
|
|
* performance warnings are now MAXed at once per minute.
|
|
* Revision 1.6: May 23 1997
|
|
* Changed the specialix=... format to include interrupt.
|
|
* Revision 1.7: May 27 1997
|
|
* Made many more debug printk's a compile time option.
|
|
* Revision 1.8: Jul 1 1997
|
|
* port to linux-2.1.43 kernel.
|
|
* Revision 1.9: Oct 9 1998
|
|
* Added stuff for the IO8+/PCI version.
|
|
* Revision 1.10: Oct 22 1999 / Jan 21 2000.
|
|
* Added stuff for setserial.
|
|
* Nicolas Mailhot (Nicolas.Mailhot@email.enst.fr)
|
|
*
|
|
*/
|
|
|
|
#define VERSION "1.11"
|
|
|
|
|
|
/*
|
|
* There is a bunch of documentation about the card, jumpers, config
|
|
* settings, restrictions, cables, device names and numbers in
|
|
* Documentation/serial/specialix.txt
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/io.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/tty_flip.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/serial.h>
|
|
#include <linux/fcntl.h>
|
|
#include <linux/major.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/init.h>
|
|
#include <linux/uaccess.h>
|
|
|
|
#include "specialix_io8.h"
|
|
#include "cd1865.h"
|
|
|
|
|
|
/*
|
|
This driver can spew a whole lot of debugging output at you. If you
|
|
need maximum performance, you should disable the DEBUG define. To
|
|
aid in debugging in the field, I'm leaving the compile-time debug
|
|
features enabled, and disable them "runtime". That allows me to
|
|
instruct people with problems to enable debugging without requiring
|
|
them to recompile...
|
|
*/
|
|
#define DEBUG
|
|
|
|
static int sx_debug;
|
|
static int sx_rxfifo = SPECIALIX_RXFIFO;
|
|
static int sx_rtscts;
|
|
|
|
#ifdef DEBUG
|
|
#define dprintk(f, str...) if (sx_debug & f) printk(str)
|
|
#else
|
|
#define dprintk(f, str...) /* nothing */
|
|
#endif
|
|
|
|
#define SX_DEBUG_FLOW 0x0001
|
|
#define SX_DEBUG_DATA 0x0002
|
|
#define SX_DEBUG_PROBE 0x0004
|
|
#define SX_DEBUG_CHAN 0x0008
|
|
#define SX_DEBUG_INIT 0x0010
|
|
#define SX_DEBUG_RX 0x0020
|
|
#define SX_DEBUG_TX 0x0040
|
|
#define SX_DEBUG_IRQ 0x0080
|
|
#define SX_DEBUG_OPEN 0x0100
|
|
#define SX_DEBUG_TERMIOS 0x0200
|
|
#define SX_DEBUG_SIGNALS 0x0400
|
|
#define SX_DEBUG_FIFO 0x0800
|
|
|
|
|
|
#define func_enter() dprintk(SX_DEBUG_FLOW, "io8: enter %s\n", __func__)
|
|
#define func_exit() dprintk(SX_DEBUG_FLOW, "io8: exit %s\n", __func__)
|
|
|
|
|
|
/* Configurable options: */
|
|
|
|
/* Am I paranoid or not ? ;-) */
|
|
#define SPECIALIX_PARANOIA_CHECK
|
|
|
|
/*
|
|
* The following defines are mostly for testing purposes. But if you need
|
|
* some nice reporting in your syslog, you can define them also.
|
|
*/
|
|
#undef SX_REPORT_FIFO
|
|
#undef SX_REPORT_OVERRUN
|
|
|
|
|
|
|
|
|
|
#define SPECIALIX_LEGAL_FLAGS \
|
|
(ASYNC_HUP_NOTIFY | ASYNC_SAK | ASYNC_SPLIT_TERMIOS | \
|
|
ASYNC_SPD_HI | ASYNC_SPEED_VHI | ASYNC_SESSION_LOCKOUT | \
|
|
ASYNC_PGRP_LOCKOUT | ASYNC_CALLOUT_NOHUP)
|
|
|
|
static struct tty_driver *specialix_driver;
|
|
|
|
static struct specialix_board sx_board[SX_NBOARD] = {
|
|
{ 0, SX_IOBASE1, 9, },
|
|
{ 0, SX_IOBASE2, 11, },
|
|
{ 0, SX_IOBASE3, 12, },
|
|
{ 0, SX_IOBASE4, 15, },
|
|
};
|
|
|
|
static struct specialix_port sx_port[SX_NBOARD * SX_NPORT];
|
|
|
|
|
|
static int sx_paranoia_check(struct specialix_port const *port,
|
|
char *name, const char *routine)
|
|
{
|
|
#ifdef SPECIALIX_PARANOIA_CHECK
|
|
static const char *badmagic = KERN_ERR
|
|
"sx: Warning: bad specialix port magic number for device %s in %s\n";
|
|
static const char *badinfo = KERN_ERR
|
|
"sx: Warning: null specialix port for device %s in %s\n";
|
|
|
|
if (!port) {
|
|
printk(badinfo, name, routine);
|
|
return 1;
|
|
}
|
|
if (port->magic != SPECIALIX_MAGIC) {
|
|
printk(badmagic, name, routine);
|
|
return 1;
|
|
}
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
*
|
|
* Service functions for specialix IO8+ driver.
|
|
*
|
|
*/
|
|
|
|
/* Get board number from pointer */
|
|
static inline int board_No(struct specialix_board *bp)
|
|
{
|
|
return bp - sx_board;
|
|
}
|
|
|
|
|
|
/* Get port number from pointer */
|
|
static inline int port_No(struct specialix_port const *port)
|
|
{
|
|
return SX_PORT(port - sx_port);
|
|
}
|
|
|
|
|
|
/* Get pointer to board from pointer to port */
|
|
static inline struct specialix_board *port_Board(
|
|
struct specialix_port const *port)
|
|
{
|
|
return &sx_board[SX_BOARD(port - sx_port)];
|
|
}
|
|
|
|
|
|
/* Input Byte from CL CD186x register */
|
|
static inline unsigned char sx_in(struct specialix_board *bp,
|
|
unsigned short reg)
|
|
{
|
|
bp->reg = reg | 0x80;
|
|
outb(reg | 0x80, bp->base + SX_ADDR_REG);
|
|
return inb(bp->base + SX_DATA_REG);
|
|
}
|
|
|
|
|
|
/* Output Byte to CL CD186x register */
|
|
static inline void sx_out(struct specialix_board *bp, unsigned short reg,
|
|
unsigned char val)
|
|
{
|
|
bp->reg = reg | 0x80;
|
|
outb(reg | 0x80, bp->base + SX_ADDR_REG);
|
|
outb(val, bp->base + SX_DATA_REG);
|
|
}
|
|
|
|
|
|
/* Input Byte from CL CD186x register */
|
|
static inline unsigned char sx_in_off(struct specialix_board *bp,
|
|
unsigned short reg)
|
|
{
|
|
bp->reg = reg;
|
|
outb(reg, bp->base + SX_ADDR_REG);
|
|
return inb(bp->base + SX_DATA_REG);
|
|
}
|
|
|
|
|
|
/* Output Byte to CL CD186x register */
|
|
static inline void sx_out_off(struct specialix_board *bp,
|
|
unsigned short reg, unsigned char val)
|
|
{
|
|
bp->reg = reg;
|
|
outb(reg, bp->base + SX_ADDR_REG);
|
|
outb(val, bp->base + SX_DATA_REG);
|
|
}
|
|
|
|
|
|
/* Wait for Channel Command Register ready */
|
|
static void sx_wait_CCR(struct specialix_board *bp)
|
|
{
|
|
unsigned long delay, flags;
|
|
unsigned char ccr;
|
|
|
|
for (delay = SX_CCR_TIMEOUT; delay; delay--) {
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
ccr = sx_in(bp, CD186x_CCR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
if (!ccr)
|
|
return;
|
|
udelay(1);
|
|
}
|
|
|
|
printk(KERN_ERR "sx%d: Timeout waiting for CCR.\n", board_No(bp));
|
|
}
|
|
|
|
|
|
/* Wait for Channel Command Register ready */
|
|
static void sx_wait_CCR_off(struct specialix_board *bp)
|
|
{
|
|
unsigned long delay;
|
|
unsigned char crr;
|
|
unsigned long flags;
|
|
|
|
for (delay = SX_CCR_TIMEOUT; delay; delay--) {
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
crr = sx_in_off(bp, CD186x_CCR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
if (!crr)
|
|
return;
|
|
udelay(1);
|
|
}
|
|
|
|
printk(KERN_ERR "sx%d: Timeout waiting for CCR.\n", board_No(bp));
|
|
}
|
|
|
|
|
|
/*
|
|
* specialix IO8+ IO range functions.
|
|
*/
|
|
|
|
static int sx_request_io_range(struct specialix_board *bp)
|
|
{
|
|
return request_region(bp->base,
|
|
bp->flags & SX_BOARD_IS_PCI ? SX_PCI_IO_SPACE : SX_IO_SPACE,
|
|
"specialix IO8+") == NULL;
|
|
}
|
|
|
|
|
|
static void sx_release_io_range(struct specialix_board *bp)
|
|
{
|
|
release_region(bp->base, bp->flags & SX_BOARD_IS_PCI ?
|
|
SX_PCI_IO_SPACE : SX_IO_SPACE);
|
|
}
|
|
|
|
|
|
/* Set the IRQ using the RTS lines that run to the PAL on the board.... */
|
|
static int sx_set_irq(struct specialix_board *bp)
|
|
{
|
|
int virq;
|
|
int i;
|
|
unsigned long flags;
|
|
|
|
if (bp->flags & SX_BOARD_IS_PCI)
|
|
return 1;
|
|
switch (bp->irq) {
|
|
/* In the same order as in the docs... */
|
|
case 15:
|
|
virq = 0;
|
|
break;
|
|
case 12:
|
|
virq = 1;
|
|
break;
|
|
case 11:
|
|
virq = 2;
|
|
break;
|
|
case 9:
|
|
virq = 3;
|
|
break;
|
|
default:printk(KERN_ERR
|
|
"Speclialix: cannot set irq to %d.\n", bp->irq);
|
|
return 0;
|
|
}
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
for (i = 0; i < 2; i++) {
|
|
sx_out(bp, CD186x_CAR, i);
|
|
sx_out(bp, CD186x_MSVRTS, ((virq >> i) & 0x1)? MSVR_RTS:0);
|
|
}
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
return 1;
|
|
}
|
|
|
|
|
|
/* Reset and setup CD186x chip */
|
|
static int sx_init_CD186x(struct specialix_board *bp)
|
|
{
|
|
unsigned long flags;
|
|
int scaler;
|
|
int rv = 1;
|
|
|
|
func_enter();
|
|
sx_wait_CCR_off(bp); /* Wait for CCR ready */
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out_off(bp, CD186x_CCR, CCR_HARDRESET); /* Reset CD186x chip */
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
msleep(50); /* Delay 0.05 sec */
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out_off(bp, CD186x_GIVR, SX_ID); /* Set ID for this chip */
|
|
sx_out_off(bp, CD186x_GICR, 0); /* Clear all bits */
|
|
sx_out_off(bp, CD186x_PILR1, SX_ACK_MINT); /* Prio for modem intr */
|
|
sx_out_off(bp, CD186x_PILR2, SX_ACK_TINT); /* Prio for transmitter intr */
|
|
sx_out_off(bp, CD186x_PILR3, SX_ACK_RINT); /* Prio for receiver intr */
|
|
/* Set RegAckEn */
|
|
sx_out_off(bp, CD186x_SRCR, sx_in(bp, CD186x_SRCR) | SRCR_REGACKEN);
|
|
|
|
/* Setting up prescaler. We need 4 ticks per 1 ms */
|
|
scaler = SX_OSCFREQ/SPECIALIX_TPS;
|
|
|
|
sx_out_off(bp, CD186x_PPRH, scaler >> 8);
|
|
sx_out_off(bp, CD186x_PPRL, scaler & 0xff);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
if (!sx_set_irq(bp)) {
|
|
/* Figure out how to pass this along... */
|
|
printk(KERN_ERR "Cannot set irq to %d.\n", bp->irq);
|
|
rv = 0;
|
|
}
|
|
|
|
func_exit();
|
|
return rv;
|
|
}
|
|
|
|
|
|
static int read_cross_byte(struct specialix_board *bp, int reg, int bit)
|
|
{
|
|
int i;
|
|
int t;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
for (i = 0, t = 0; i < 8; i++) {
|
|
sx_out_off(bp, CD186x_CAR, i);
|
|
if (sx_in_off(bp, reg) & bit)
|
|
t |= 1 << i;
|
|
}
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
return t;
|
|
}
|
|
|
|
|
|
/* Main probing routine, also sets irq. */
|
|
static int sx_probe(struct specialix_board *bp)
|
|
{
|
|
unsigned char val1, val2;
|
|
int rev;
|
|
int chip;
|
|
|
|
func_enter();
|
|
|
|
if (sx_request_io_range(bp)) {
|
|
func_exit();
|
|
return 1;
|
|
}
|
|
|
|
/* Are the I/O ports here ? */
|
|
sx_out_off(bp, CD186x_PPRL, 0x5a);
|
|
udelay(1);
|
|
val1 = sx_in_off(bp, CD186x_PPRL);
|
|
|
|
sx_out_off(bp, CD186x_PPRL, 0xa5);
|
|
udelay(1);
|
|
val2 = sx_in_off(bp, CD186x_PPRL);
|
|
|
|
|
|
if (val1 != 0x5a || val2 != 0xa5) {
|
|
printk(KERN_INFO
|
|
"sx%d: specialix IO8+ Board at 0x%03x not found.\n",
|
|
board_No(bp), bp->base);
|
|
sx_release_io_range(bp);
|
|
func_exit();
|
|
return 1;
|
|
}
|
|
|
|
/* Check the DSR lines that Specialix uses as board
|
|
identification */
|
|
val1 = read_cross_byte(bp, CD186x_MSVR, MSVR_DSR);
|
|
val2 = read_cross_byte(bp, CD186x_MSVR, MSVR_RTS);
|
|
dprintk(SX_DEBUG_INIT,
|
|
"sx%d: DSR lines are: %02x, rts lines are: %02x\n",
|
|
board_No(bp), val1, val2);
|
|
|
|
/* They managed to switch the bit order between the docs and
|
|
the IO8+ card. The new PCI card now conforms to old docs.
|
|
They changed the PCI docs to reflect the situation on the
|
|
old card. */
|
|
val2 = (bp->flags & SX_BOARD_IS_PCI)?0x4d : 0xb2;
|
|
if (val1 != val2) {
|
|
printk(KERN_INFO
|
|
"sx%d: specialix IO8+ ID %02x at 0x%03x not found (%02x).\n",
|
|
board_No(bp), val2, bp->base, val1);
|
|
sx_release_io_range(bp);
|
|
func_exit();
|
|
return 1;
|
|
}
|
|
|
|
|
|
/* Reset CD186x again */
|
|
if (!sx_init_CD186x(bp)) {
|
|
sx_release_io_range(bp);
|
|
func_exit();
|
|
return 1;
|
|
}
|
|
|
|
sx_request_io_range(bp);
|
|
bp->flags |= SX_BOARD_PRESENT;
|
|
|
|
/* Chip revcode pkgtype
|
|
GFRCR SRCR bit 7
|
|
CD180 rev B 0x81 0
|
|
CD180 rev C 0x82 0
|
|
CD1864 rev A 0x82 1
|
|
CD1865 rev A 0x83 1 -- Do not use!!! Does not work.
|
|
CD1865 rev B 0x84 1
|
|
-- Thanks to Gwen Wang, Cirrus Logic.
|
|
*/
|
|
|
|
switch (sx_in_off(bp, CD186x_GFRCR)) {
|
|
case 0x82:
|
|
chip = 1864;
|
|
rev = 'A';
|
|
break;
|
|
case 0x83:
|
|
chip = 1865;
|
|
rev = 'A';
|
|
break;
|
|
case 0x84:
|
|
chip = 1865;
|
|
rev = 'B';
|
|
break;
|
|
case 0x85:
|
|
chip = 1865;
|
|
rev = 'C';
|
|
break; /* Does not exist at this time */
|
|
default:
|
|
chip = -1;
|
|
rev = 'x';
|
|
}
|
|
|
|
dprintk(SX_DEBUG_INIT, " GFCR = 0x%02x\n", sx_in_off(bp, CD186x_GFRCR));
|
|
|
|
printk(KERN_INFO
|
|
"sx%d: specialix IO8+ board detected at 0x%03x, IRQ %d, CD%d Rev. %c.\n",
|
|
board_No(bp), bp->base, bp->irq, chip, rev);
|
|
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
*
|
|
* Interrupt processing routines.
|
|
* */
|
|
|
|
static struct specialix_port *sx_get_port(struct specialix_board *bp,
|
|
unsigned char const *what)
|
|
{
|
|
unsigned char channel;
|
|
struct specialix_port *port = NULL;
|
|
|
|
channel = sx_in(bp, CD186x_GICR) >> GICR_CHAN_OFF;
|
|
dprintk(SX_DEBUG_CHAN, "channel: %d\n", channel);
|
|
if (channel < CD186x_NCH) {
|
|
port = &sx_port[board_No(bp) * SX_NPORT + channel];
|
|
dprintk(SX_DEBUG_CHAN, "port: %d %p flags: 0x%lx\n",
|
|
board_No(bp) * SX_NPORT + channel, port,
|
|
port->port.flags & ASYNC_INITIALIZED);
|
|
|
|
if (port->port.flags & ASYNC_INITIALIZED) {
|
|
dprintk(SX_DEBUG_CHAN, "port: %d %p\n", channel, port);
|
|
func_exit();
|
|
return port;
|
|
}
|
|
}
|
|
printk(KERN_INFO "sx%d: %s interrupt from invalid port %d\n",
|
|
board_No(bp), what, channel);
|
|
return NULL;
|
|
}
|
|
|
|
|
|
static void sx_receive_exc(struct specialix_board *bp)
|
|
{
|
|
struct specialix_port *port;
|
|
struct tty_struct *tty;
|
|
unsigned char status;
|
|
unsigned char ch, flag;
|
|
|
|
func_enter();
|
|
|
|
port = sx_get_port(bp, "Receive");
|
|
if (!port) {
|
|
dprintk(SX_DEBUG_RX, "Hmm, couldn't find port.\n");
|
|
func_exit();
|
|
return;
|
|
}
|
|
tty = port->port.tty;
|
|
|
|
status = sx_in(bp, CD186x_RCSR);
|
|
|
|
dprintk(SX_DEBUG_RX, "status: 0x%x\n", status);
|
|
if (status & RCSR_OE) {
|
|
port->overrun++;
|
|
dprintk(SX_DEBUG_FIFO,
|
|
"sx%d: port %d: Overrun. Total %ld overruns.\n",
|
|
board_No(bp), port_No(port), port->overrun);
|
|
}
|
|
status &= port->mark_mask;
|
|
|
|
/* This flip buffer check needs to be below the reading of the
|
|
status register to reset the chip's IRQ.... */
|
|
if (tty_buffer_request_room(tty, 1) == 0) {
|
|
dprintk(SX_DEBUG_FIFO,
|
|
"sx%d: port %d: Working around flip buffer overflow.\n",
|
|
board_No(bp), port_No(port));
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
ch = sx_in(bp, CD186x_RDR);
|
|
if (!status) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
if (status & RCSR_TOUT) {
|
|
printk(KERN_INFO
|
|
"sx%d: port %d: Receiver timeout. Hardware problems ?\n",
|
|
board_No(bp), port_No(port));
|
|
func_exit();
|
|
return;
|
|
|
|
} else if (status & RCSR_BREAK) {
|
|
dprintk(SX_DEBUG_RX, "sx%d: port %d: Handling break...\n",
|
|
board_No(bp), port_No(port));
|
|
flag = TTY_BREAK;
|
|
if (port->port.flags & ASYNC_SAK)
|
|
do_SAK(tty);
|
|
|
|
} else if (status & RCSR_PE)
|
|
flag = TTY_PARITY;
|
|
|
|
else if (status & RCSR_FE)
|
|
flag = TTY_FRAME;
|
|
|
|
else if (status & RCSR_OE)
|
|
flag = TTY_OVERRUN;
|
|
|
|
else
|
|
flag = TTY_NORMAL;
|
|
|
|
if (tty_insert_flip_char(tty, ch, flag))
|
|
tty_flip_buffer_push(tty);
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static void sx_receive(struct specialix_board *bp)
|
|
{
|
|
struct specialix_port *port;
|
|
struct tty_struct *tty;
|
|
unsigned char count;
|
|
|
|
func_enter();
|
|
|
|
port = sx_get_port(bp, "Receive");
|
|
if (port == NULL) {
|
|
dprintk(SX_DEBUG_RX, "Hmm, couldn't find port.\n");
|
|
func_exit();
|
|
return;
|
|
}
|
|
tty = port->port.tty;
|
|
|
|
count = sx_in(bp, CD186x_RDCR);
|
|
dprintk(SX_DEBUG_RX, "port: %p: count: %d\n", port, count);
|
|
port->hits[count > 8 ? 9 : count]++;
|
|
|
|
tty_buffer_request_room(tty, count);
|
|
|
|
while (count--)
|
|
tty_insert_flip_char(tty, sx_in(bp, CD186x_RDR), TTY_NORMAL);
|
|
tty_flip_buffer_push(tty);
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static void sx_transmit(struct specialix_board *bp)
|
|
{
|
|
struct specialix_port *port;
|
|
struct tty_struct *tty;
|
|
unsigned char count;
|
|
|
|
func_enter();
|
|
port = sx_get_port(bp, "Transmit");
|
|
if (port == NULL) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
dprintk(SX_DEBUG_TX, "port: %p\n", port);
|
|
tty = port->port.tty;
|
|
|
|
if (port->IER & IER_TXEMPTY) {
|
|
/* FIFO drained */
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
port->IER &= ~IER_TXEMPTY;
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
if ((port->xmit_cnt <= 0 && !port->break_length)
|
|
|| tty->stopped || tty->hw_stopped) {
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
port->IER &= ~IER_TXRDY;
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
if (port->break_length) {
|
|
if (port->break_length > 0) {
|
|
if (port->COR2 & COR2_ETC) {
|
|
sx_out(bp, CD186x_TDR, CD186x_C_ESC);
|
|
sx_out(bp, CD186x_TDR, CD186x_C_SBRK);
|
|
port->COR2 &= ~COR2_ETC;
|
|
}
|
|
count = min_t(int, port->break_length, 0xff);
|
|
sx_out(bp, CD186x_TDR, CD186x_C_ESC);
|
|
sx_out(bp, CD186x_TDR, CD186x_C_DELAY);
|
|
sx_out(bp, CD186x_TDR, count);
|
|
port->break_length -= count;
|
|
if (port->break_length == 0)
|
|
port->break_length--;
|
|
} else {
|
|
sx_out(bp, CD186x_TDR, CD186x_C_ESC);
|
|
sx_out(bp, CD186x_TDR, CD186x_C_EBRK);
|
|
sx_out(bp, CD186x_COR2, port->COR2);
|
|
sx_wait_CCR(bp);
|
|
sx_out(bp, CD186x_CCR, CCR_CORCHG2);
|
|
port->break_length = 0;
|
|
}
|
|
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
count = CD186x_NFIFO;
|
|
do {
|
|
sx_out(bp, CD186x_TDR, port->xmit_buf[port->xmit_tail++]);
|
|
port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE-1);
|
|
if (--port->xmit_cnt <= 0)
|
|
break;
|
|
} while (--count > 0);
|
|
|
|
if (port->xmit_cnt <= 0) {
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
port->IER &= ~IER_TXRDY;
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
}
|
|
if (port->xmit_cnt <= port->wakeup_chars)
|
|
tty_wakeup(tty);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static void sx_check_modem(struct specialix_board *bp)
|
|
{
|
|
struct specialix_port *port;
|
|
struct tty_struct *tty;
|
|
unsigned char mcr;
|
|
int msvr_cd;
|
|
|
|
dprintk(SX_DEBUG_SIGNALS, "Modem intr. ");
|
|
port = sx_get_port(bp, "Modem");
|
|
if (port == NULL)
|
|
return;
|
|
|
|
tty = port->port.tty;
|
|
|
|
mcr = sx_in(bp, CD186x_MCR);
|
|
|
|
if ((mcr & MCR_CDCHG)) {
|
|
dprintk(SX_DEBUG_SIGNALS, "CD just changed... ");
|
|
msvr_cd = sx_in(bp, CD186x_MSVR) & MSVR_CD;
|
|
if (msvr_cd) {
|
|
dprintk(SX_DEBUG_SIGNALS, "Waking up guys in open.\n");
|
|
wake_up_interruptible(&port->port.open_wait);
|
|
} else {
|
|
dprintk(SX_DEBUG_SIGNALS, "Sending HUP.\n");
|
|
tty_hangup(tty);
|
|
}
|
|
}
|
|
|
|
#ifdef SPECIALIX_BRAIN_DAMAGED_CTS
|
|
if (mcr & MCR_CTSCHG) {
|
|
if (sx_in(bp, CD186x_MSVR) & MSVR_CTS) {
|
|
tty->hw_stopped = 0;
|
|
port->IER |= IER_TXRDY;
|
|
if (port->xmit_cnt <= port->wakeup_chars)
|
|
tty_wakeup(tty);
|
|
} else {
|
|
tty->hw_stopped = 1;
|
|
port->IER &= ~IER_TXRDY;
|
|
}
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
}
|
|
if (mcr & MCR_DSSXHG) {
|
|
if (sx_in(bp, CD186x_MSVR) & MSVR_DSR) {
|
|
tty->hw_stopped = 0;
|
|
port->IER |= IER_TXRDY;
|
|
if (port->xmit_cnt <= port->wakeup_chars)
|
|
tty_wakeup(tty);
|
|
} else {
|
|
tty->hw_stopped = 1;
|
|
port->IER &= ~IER_TXRDY;
|
|
}
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
}
|
|
#endif /* SPECIALIX_BRAIN_DAMAGED_CTS */
|
|
|
|
/* Clear change bits */
|
|
sx_out(bp, CD186x_MCR, 0);
|
|
}
|
|
|
|
|
|
/* The main interrupt processing routine */
|
|
static irqreturn_t sx_interrupt(int dummy, void *dev_id)
|
|
{
|
|
unsigned char status;
|
|
unsigned char ack;
|
|
struct specialix_board *bp = dev_id;
|
|
unsigned long loop = 0;
|
|
int saved_reg;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
|
|
dprintk(SX_DEBUG_FLOW, "enter %s port %d room: %ld\n", __func__,
|
|
port_No(sx_get_port(bp, "INT")),
|
|
SERIAL_XMIT_SIZE - sx_get_port(bp, "ITN")->xmit_cnt - 1);
|
|
if (!(bp->flags & SX_BOARD_ACTIVE)) {
|
|
dprintk(SX_DEBUG_IRQ, "sx: False interrupt. irq %d.\n",
|
|
bp->irq);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
func_exit();
|
|
return IRQ_NONE;
|
|
}
|
|
|
|
saved_reg = bp->reg;
|
|
|
|
while (++loop < 16) {
|
|
status = sx_in(bp, CD186x_SRSR) &
|
|
(SRSR_RREQint | SRSR_TREQint | SRSR_MREQint);
|
|
if (status == 0)
|
|
break;
|
|
if (status & SRSR_RREQint) {
|
|
ack = sx_in(bp, CD186x_RRAR);
|
|
|
|
if (ack == (SX_ID | GIVR_IT_RCV))
|
|
sx_receive(bp);
|
|
else if (ack == (SX_ID | GIVR_IT_REXC))
|
|
sx_receive_exc(bp);
|
|
else
|
|
printk(KERN_ERR
|
|
"sx%d: status: 0x%x Bad receive ack 0x%02x.\n",
|
|
board_No(bp), status, ack);
|
|
|
|
} else if (status & SRSR_TREQint) {
|
|
ack = sx_in(bp, CD186x_TRAR);
|
|
|
|
if (ack == (SX_ID | GIVR_IT_TX))
|
|
sx_transmit(bp);
|
|
else
|
|
printk(KERN_ERR "sx%d: status: 0x%x Bad transmit ack 0x%02x. port: %d\n",
|
|
board_No(bp), status, ack,
|
|
port_No(sx_get_port(bp, "Int")));
|
|
} else if (status & SRSR_MREQint) {
|
|
ack = sx_in(bp, CD186x_MRAR);
|
|
|
|
if (ack == (SX_ID | GIVR_IT_MODEM))
|
|
sx_check_modem(bp);
|
|
else
|
|
printk(KERN_ERR
|
|
"sx%d: status: 0x%x Bad modem ack 0x%02x.\n",
|
|
board_No(bp), status, ack);
|
|
|
|
}
|
|
|
|
sx_out(bp, CD186x_EOIR, 0); /* Mark end of interrupt */
|
|
}
|
|
bp->reg = saved_reg;
|
|
outb(bp->reg, bp->base + SX_ADDR_REG);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
func_exit();
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
|
|
/*
|
|
* Routines for open & close processing.
|
|
*/
|
|
|
|
static void turn_ints_off(struct specialix_board *bp)
|
|
{
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
(void) sx_in_off(bp, 0); /* Turn off interrupts. */
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
static void turn_ints_on(struct specialix_board *bp)
|
|
{
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
(void) sx_in(bp, 0); /* Turn ON interrupts. */
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
/* Called with disabled interrupts */
|
|
static int sx_setup_board(struct specialix_board *bp)
|
|
{
|
|
int error;
|
|
|
|
if (bp->flags & SX_BOARD_ACTIVE)
|
|
return 0;
|
|
|
|
if (bp->flags & SX_BOARD_IS_PCI)
|
|
error = request_irq(bp->irq, sx_interrupt,
|
|
IRQF_DISABLED | IRQF_SHARED, "specialix IO8+", bp);
|
|
else
|
|
error = request_irq(bp->irq, sx_interrupt,
|
|
IRQF_DISABLED, "specialix IO8+", bp);
|
|
|
|
if (error)
|
|
return error;
|
|
|
|
turn_ints_on(bp);
|
|
bp->flags |= SX_BOARD_ACTIVE;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/* Called with disabled interrupts */
|
|
static void sx_shutdown_board(struct specialix_board *bp)
|
|
{
|
|
func_enter();
|
|
|
|
if (!(bp->flags & SX_BOARD_ACTIVE)) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp->flags &= ~SX_BOARD_ACTIVE;
|
|
|
|
dprintk(SX_DEBUG_IRQ, "Freeing IRQ%d for board %d.\n",
|
|
bp->irq, board_No(bp));
|
|
free_irq(bp->irq, bp);
|
|
turn_ints_off(bp);
|
|
func_exit();
|
|
}
|
|
|
|
static unsigned int sx_crtscts(struct tty_struct *tty)
|
|
{
|
|
if (sx_rtscts)
|
|
return C_CRTSCTS(tty);
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
* Setting up port characteristics.
|
|
* Must be called with disabled interrupts
|
|
*/
|
|
static void sx_change_speed(struct specialix_board *bp,
|
|
struct specialix_port *port)
|
|
{
|
|
struct tty_struct *tty;
|
|
unsigned long baud;
|
|
long tmp;
|
|
unsigned char cor1 = 0, cor3 = 0;
|
|
unsigned char mcor1 = 0, mcor2 = 0;
|
|
static unsigned long again;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
tty = port->port.tty;
|
|
if (!tty || !tty->termios) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
port->IER = 0;
|
|
port->COR2 = 0;
|
|
/* Select port on the board */
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
|
|
/* The Specialix board doens't implement the RTS lines.
|
|
They are used to set the IRQ level. Don't touch them. */
|
|
if (sx_crtscts(tty))
|
|
port->MSVR = MSVR_DTR | (sx_in(bp, CD186x_MSVR) & MSVR_RTS);
|
|
else
|
|
port->MSVR = (sx_in(bp, CD186x_MSVR) & MSVR_RTS);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
dprintk(SX_DEBUG_TERMIOS, "sx: got MSVR=%02x.\n", port->MSVR);
|
|
baud = tty_get_baud_rate(tty);
|
|
|
|
if (baud == 38400) {
|
|
if ((port->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
|
|
baud = 57600;
|
|
if ((port->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
|
|
baud = 115200;
|
|
}
|
|
|
|
if (!baud) {
|
|
/* Drop DTR & exit */
|
|
dprintk(SX_DEBUG_TERMIOS, "Dropping DTR... Hmm....\n");
|
|
if (!sx_crtscts(tty)) {
|
|
port->MSVR &= ~MSVR_DTR;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_MSVR, port->MSVR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
} else
|
|
dprintk(SX_DEBUG_TERMIOS, "Can't drop DTR: no DTR.\n");
|
|
return;
|
|
} else {
|
|
/* Set DTR on */
|
|
if (!sx_crtscts(tty))
|
|
port->MSVR |= MSVR_DTR;
|
|
}
|
|
|
|
/*
|
|
* Now we must calculate some speed depended things
|
|
*/
|
|
|
|
/* Set baud rate for port */
|
|
tmp = port->custom_divisor ;
|
|
if (tmp)
|
|
printk(KERN_INFO
|
|
"sx%d: Using custom baud rate divisor %ld. \n"
|
|
"This is an untested option, please be careful.\n",
|
|
port_No(port), tmp);
|
|
else
|
|
tmp = (((SX_OSCFREQ + baud/2) / baud + CD186x_TPC/2) /
|
|
CD186x_TPC);
|
|
|
|
if (tmp < 0x10 && time_before(again, jiffies)) {
|
|
again = jiffies + HZ * 60;
|
|
/* Page 48 of version 2.0 of the CL-CD1865 databook */
|
|
if (tmp >= 12) {
|
|
printk(KERN_INFO "sx%d: Baud rate divisor is %ld. \n"
|
|
"Performance degradation is possible.\n"
|
|
"Read specialix.txt for more info.\n",
|
|
port_No(port), tmp);
|
|
} else {
|
|
printk(KERN_INFO "sx%d: Baud rate divisor is %ld. \n"
|
|
"Warning: overstressing Cirrus chip. This might not work.\n"
|
|
"Read specialix.txt for more info.\n", port_No(port), tmp);
|
|
}
|
|
}
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_RBPRH, (tmp >> 8) & 0xff);
|
|
sx_out(bp, CD186x_TBPRH, (tmp >> 8) & 0xff);
|
|
sx_out(bp, CD186x_RBPRL, tmp & 0xff);
|
|
sx_out(bp, CD186x_TBPRL, tmp & 0xff);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
if (port->custom_divisor)
|
|
baud = (SX_OSCFREQ + port->custom_divisor/2) /
|
|
port->custom_divisor;
|
|
baud = (baud + 5) / 10; /* Estimated CPS */
|
|
|
|
/* Two timer ticks seems enough to wakeup something like SLIP driver */
|
|
tmp = ((baud + HZ/2) / HZ) * 2 - CD186x_NFIFO;
|
|
port->wakeup_chars = (tmp < 0) ? 0 : ((tmp >= SERIAL_XMIT_SIZE) ?
|
|
SERIAL_XMIT_SIZE - 1 : tmp);
|
|
|
|
/* Receiver timeout will be transmission time for 1.5 chars */
|
|
tmp = (SPECIALIX_TPS + SPECIALIX_TPS/2 + baud/2) / baud;
|
|
tmp = (tmp > 0xff) ? 0xff : tmp;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_RTPR, tmp);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
switch (C_CSIZE(tty)) {
|
|
case CS5:
|
|
cor1 |= COR1_5BITS;
|
|
break;
|
|
case CS6:
|
|
cor1 |= COR1_6BITS;
|
|
break;
|
|
case CS7:
|
|
cor1 |= COR1_7BITS;
|
|
break;
|
|
case CS8:
|
|
cor1 |= COR1_8BITS;
|
|
break;
|
|
}
|
|
|
|
if (C_CSTOPB(tty))
|
|
cor1 |= COR1_2SB;
|
|
|
|
cor1 |= COR1_IGNORE;
|
|
if (C_PARENB(tty)) {
|
|
cor1 |= COR1_NORMPAR;
|
|
if (C_PARODD(tty))
|
|
cor1 |= COR1_ODDP;
|
|
if (I_INPCK(tty))
|
|
cor1 &= ~COR1_IGNORE;
|
|
}
|
|
/* Set marking of some errors */
|
|
port->mark_mask = RCSR_OE | RCSR_TOUT;
|
|
if (I_INPCK(tty))
|
|
port->mark_mask |= RCSR_FE | RCSR_PE;
|
|
if (I_BRKINT(tty) || I_PARMRK(tty))
|
|
port->mark_mask |= RCSR_BREAK;
|
|
if (I_IGNPAR(tty))
|
|
port->mark_mask &= ~(RCSR_FE | RCSR_PE);
|
|
if (I_IGNBRK(tty)) {
|
|
port->mark_mask &= ~RCSR_BREAK;
|
|
if (I_IGNPAR(tty))
|
|
/* Real raw mode. Ignore all */
|
|
port->mark_mask &= ~RCSR_OE;
|
|
}
|
|
/* Enable Hardware Flow Control */
|
|
if (C_CRTSCTS(tty)) {
|
|
#ifdef SPECIALIX_BRAIN_DAMAGED_CTS
|
|
port->IER |= IER_DSR | IER_CTS;
|
|
mcor1 |= MCOR1_DSRZD | MCOR1_CTSZD;
|
|
mcor2 |= MCOR2_DSROD | MCOR2_CTSOD;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
tty->hw_stopped = !(sx_in(bp, CD186x_MSVR) &
|
|
(MSVR_CTS|MSVR_DSR));
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
#else
|
|
port->COR2 |= COR2_CTSAE;
|
|
#endif
|
|
}
|
|
/* Enable Software Flow Control. FIXME: I'm not sure about this */
|
|
/* Some people reported that it works, but I still doubt it */
|
|
if (I_IXON(tty)) {
|
|
port->COR2 |= COR2_TXIBE;
|
|
cor3 |= (COR3_FCT | COR3_SCDE);
|
|
if (I_IXANY(tty))
|
|
port->COR2 |= COR2_IXM;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_SCHR1, START_CHAR(tty));
|
|
sx_out(bp, CD186x_SCHR2, STOP_CHAR(tty));
|
|
sx_out(bp, CD186x_SCHR3, START_CHAR(tty));
|
|
sx_out(bp, CD186x_SCHR4, STOP_CHAR(tty));
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
}
|
|
if (!C_CLOCAL(tty)) {
|
|
/* Enable CD check */
|
|
port->IER |= IER_CD;
|
|
mcor1 |= MCOR1_CDZD;
|
|
mcor2 |= MCOR2_CDOD;
|
|
}
|
|
|
|
if (C_CREAD(tty))
|
|
/* Enable receiver */
|
|
port->IER |= IER_RXD;
|
|
|
|
/* Set input FIFO size (1-8 bytes) */
|
|
cor3 |= sx_rxfifo;
|
|
/* Setting up CD186x channel registers */
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_COR1, cor1);
|
|
sx_out(bp, CD186x_COR2, port->COR2);
|
|
sx_out(bp, CD186x_COR3, cor3);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
/* Make CD186x know about registers change */
|
|
sx_wait_CCR(bp);
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CCR, CCR_CORCHG1 | CCR_CORCHG2 | CCR_CORCHG3);
|
|
/* Setting up modem option registers */
|
|
dprintk(SX_DEBUG_TERMIOS, "Mcor1 = %02x, mcor2 = %02x.\n",
|
|
mcor1, mcor2);
|
|
sx_out(bp, CD186x_MCOR1, mcor1);
|
|
sx_out(bp, CD186x_MCOR2, mcor2);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
/* Enable CD186x transmitter & receiver */
|
|
sx_wait_CCR(bp);
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CCR, CCR_TXEN | CCR_RXEN);
|
|
/* Enable interrupts */
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
/* And finally set the modem lines... */
|
|
sx_out(bp, CD186x_MSVR, port->MSVR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
/* Must be called with interrupts enabled */
|
|
static int sx_setup_port(struct specialix_board *bp,
|
|
struct specialix_port *port)
|
|
{
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (port->port.flags & ASYNC_INITIALIZED) {
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
if (!port->xmit_buf) {
|
|
/* We may sleep in get_zeroed_page() */
|
|
unsigned long tmp;
|
|
|
|
tmp = get_zeroed_page(GFP_KERNEL);
|
|
if (tmp == 0L) {
|
|
func_exit();
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (port->xmit_buf) {
|
|
free_page(tmp);
|
|
func_exit();
|
|
return -ERESTARTSYS;
|
|
}
|
|
port->xmit_buf = (unsigned char *) tmp;
|
|
}
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
|
|
if (port->port.tty)
|
|
clear_bit(TTY_IO_ERROR, &port->port.tty->flags);
|
|
|
|
port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
|
|
sx_change_speed(bp, port);
|
|
port->port.flags |= ASYNC_INITIALIZED;
|
|
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
|
|
/* Must be called with interrupts disabled */
|
|
static void sx_shutdown_port(struct specialix_board *bp,
|
|
struct specialix_port *port)
|
|
{
|
|
struct tty_struct *tty;
|
|
int i;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (!(port->port.flags & ASYNC_INITIALIZED)) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
if (sx_debug & SX_DEBUG_FIFO) {
|
|
dprintk(SX_DEBUG_FIFO,
|
|
"sx%d: port %d: %ld overruns, FIFO hits [ ",
|
|
board_No(bp), port_No(port), port->overrun);
|
|
for (i = 0; i < 10; i++)
|
|
dprintk(SX_DEBUG_FIFO, "%ld ", port->hits[i]);
|
|
dprintk(SX_DEBUG_FIFO, "].\n");
|
|
}
|
|
|
|
if (port->xmit_buf) {
|
|
free_page((unsigned long) port->xmit_buf);
|
|
port->xmit_buf = NULL;
|
|
}
|
|
|
|
/* Select port */
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
|
|
tty = port->port.tty;
|
|
if (tty == NULL || C_HUPCL(tty)) {
|
|
/* Drop DTR */
|
|
sx_out(bp, CD186x_MSVDTR, 0);
|
|
}
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
/* Reset port */
|
|
sx_wait_CCR(bp);
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CCR, CCR_SOFTRESET);
|
|
/* Disable all interrupts from this port */
|
|
port->IER = 0;
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
if (tty)
|
|
set_bit(TTY_IO_ERROR, &tty->flags);
|
|
port->port.flags &= ~ASYNC_INITIALIZED;
|
|
|
|
if (!bp->count)
|
|
sx_shutdown_board(bp);
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static int block_til_ready(struct tty_struct *tty, struct file *filp,
|
|
struct specialix_port *port)
|
|
{
|
|
DECLARE_WAITQUEUE(wait, current);
|
|
struct specialix_board *bp = port_Board(port);
|
|
int retval;
|
|
int do_clocal = 0;
|
|
int CD;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
/*
|
|
* If the device is in the middle of being closed, then block
|
|
* until it's done, and then try again.
|
|
*/
|
|
if (tty_hung_up_p(filp) || port->port.flags & ASYNC_CLOSING) {
|
|
interruptible_sleep_on(&port->port.close_wait);
|
|
if (port->port.flags & ASYNC_HUP_NOTIFY) {
|
|
func_exit();
|
|
return -EAGAIN;
|
|
} else {
|
|
func_exit();
|
|
return -ERESTARTSYS;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If non-blocking mode is set, or the port is not enabled,
|
|
* then make the check up front and then exit.
|
|
*/
|
|
if ((filp->f_flags & O_NONBLOCK) ||
|
|
(tty->flags & (1 << TTY_IO_ERROR))) {
|
|
port->port.flags |= ASYNC_NORMAL_ACTIVE;
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
if (C_CLOCAL(tty))
|
|
do_clocal = 1;
|
|
|
|
/*
|
|
* Block waiting for the carrier detect and the line to become
|
|
* free (i.e., not in use by the callout). While we are in
|
|
* this loop, info->count is dropped by one, so that
|
|
* rs_close() knows when to free things. We restore it upon
|
|
* exit, either normal or abnormal.
|
|
*/
|
|
retval = 0;
|
|
add_wait_queue(&port->port.open_wait, &wait);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (!tty_hung_up_p(filp))
|
|
port->port.count--;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
port->port.blocked_open++;
|
|
while (1) {
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
CD = sx_in(bp, CD186x_MSVR) & MSVR_CD;
|
|
if (sx_crtscts(tty)) {
|
|
/* Activate RTS */
|
|
port->MSVR |= MSVR_DTR; /* WTF? */
|
|
sx_out(bp, CD186x_MSVR, port->MSVR);
|
|
} else {
|
|
/* Activate DTR */
|
|
port->MSVR |= MSVR_DTR;
|
|
sx_out(bp, CD186x_MSVR, port->MSVR);
|
|
}
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
set_current_state(TASK_INTERRUPTIBLE);
|
|
if (tty_hung_up_p(filp) ||
|
|
!(port->port.flags & ASYNC_INITIALIZED)) {
|
|
if (port->port.flags & ASYNC_HUP_NOTIFY)
|
|
retval = -EAGAIN;
|
|
else
|
|
retval = -ERESTARTSYS;
|
|
break;
|
|
}
|
|
if (!(port->port.flags & ASYNC_CLOSING) &&
|
|
(do_clocal || CD))
|
|
break;
|
|
if (signal_pending(current)) {
|
|
retval = -ERESTARTSYS;
|
|
break;
|
|
}
|
|
schedule();
|
|
}
|
|
|
|
set_current_state(TASK_RUNNING);
|
|
remove_wait_queue(&port->port.open_wait, &wait);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (!tty_hung_up_p(filp))
|
|
port->port.count++;
|
|
port->port.blocked_open--;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
if (retval) {
|
|
func_exit();
|
|
return retval;
|
|
}
|
|
|
|
port->port.flags |= ASYNC_NORMAL_ACTIVE;
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int sx_open(struct tty_struct *tty, struct file *filp)
|
|
{
|
|
int board;
|
|
int error;
|
|
struct specialix_port *port;
|
|
struct specialix_board *bp;
|
|
int i;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
board = SX_BOARD(tty->index);
|
|
|
|
if (board >= SX_NBOARD || !(sx_board[board].flags & SX_BOARD_PRESENT)) {
|
|
func_exit();
|
|
return -ENODEV;
|
|
}
|
|
|
|
bp = &sx_board[board];
|
|
port = sx_port + board * SX_NPORT + SX_PORT(tty->index);
|
|
port->overrun = 0;
|
|
for (i = 0; i < 10; i++)
|
|
port->hits[i] = 0;
|
|
|
|
dprintk(SX_DEBUG_OPEN,
|
|
"Board = %d, bp = %p, port = %p, portno = %d.\n",
|
|
board, bp, port, SX_PORT(tty->index));
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_open")) {
|
|
func_enter();
|
|
return -ENODEV;
|
|
}
|
|
|
|
error = sx_setup_board(bp);
|
|
if (error) {
|
|
func_exit();
|
|
return error;
|
|
}
|
|
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
port->port.count++;
|
|
bp->count++;
|
|
tty->driver_data = port;
|
|
port->port.tty = tty;
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
error = sx_setup_port(bp, port);
|
|
if (error) {
|
|
func_enter();
|
|
return error;
|
|
}
|
|
|
|
error = block_til_ready(tty, filp, port);
|
|
if (error) {
|
|
func_enter();
|
|
return error;
|
|
}
|
|
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
static void sx_flush_buffer(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
unsigned long flags;
|
|
struct specialix_board *bp;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_flush_buffer")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
tty_wakeup(tty);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
static void sx_close(struct tty_struct *tty, struct file *filp)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
unsigned long flags;
|
|
unsigned long timeout;
|
|
|
|
func_enter();
|
|
if (!port || sx_paranoia_check(port, tty->name, "close")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
|
|
if (tty_hung_up_p(filp)) {
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
if (tty->count == 1 && port->port.count != 1) {
|
|
printk(KERN_ERR "sx%d: sx_close: bad port count;"
|
|
" tty->count is 1, port count is %d\n",
|
|
board_No(bp), port->port.count);
|
|
port->port.count = 1;
|
|
}
|
|
|
|
if (port->port.count > 1) {
|
|
port->port.count--;
|
|
bp->count--;
|
|
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
func_exit();
|
|
return;
|
|
}
|
|
port->port.flags |= ASYNC_CLOSING;
|
|
/*
|
|
* Now we wait for the transmit buffer to clear; and we notify
|
|
* the line discipline to only process XON/XOFF characters.
|
|
*/
|
|
tty->closing = 1;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
dprintk(SX_DEBUG_OPEN, "Closing\n");
|
|
if (port->port.closing_wait != ASYNC_CLOSING_WAIT_NONE)
|
|
tty_wait_until_sent(tty, port->port.closing_wait);
|
|
/*
|
|
* At this point we stop accepting input. To do this, we
|
|
* disable the receive line status interrupts, and tell the
|
|
* interrupt driver to stop checking the data ready bit in the
|
|
* line status register.
|
|
*/
|
|
dprintk(SX_DEBUG_OPEN, "Closed\n");
|
|
port->IER &= ~IER_RXD;
|
|
if (port->port.flags & ASYNC_INITIALIZED) {
|
|
port->IER &= ~IER_TXRDY;
|
|
port->IER |= IER_TXEMPTY;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
/*
|
|
* Before we drop DTR, make sure the UART transmitter
|
|
* has completely drained; this is especially
|
|
* important if there is a transmit FIFO!
|
|
*/
|
|
timeout = jiffies+HZ;
|
|
while (port->IER & IER_TXEMPTY) {
|
|
set_current_state(TASK_INTERRUPTIBLE);
|
|
msleep_interruptible(jiffies_to_msecs(port->timeout));
|
|
if (time_after(jiffies, timeout)) {
|
|
printk(KERN_INFO "Timeout waiting for close\n");
|
|
break;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
if (--bp->count < 0) {
|
|
printk(KERN_ERR
|
|
"sx%d: sx_shutdown_port: bad board count: %d port: %d\n",
|
|
board_No(bp), bp->count, tty->index);
|
|
bp->count = 0;
|
|
}
|
|
if (--port->port.count < 0) {
|
|
printk(KERN_ERR
|
|
"sx%d: sx_close: bad port count for tty%d: %d\n",
|
|
board_No(bp), port_No(port), port->port.count);
|
|
port->port.count = 0;
|
|
}
|
|
|
|
sx_shutdown_port(bp, port);
|
|
sx_flush_buffer(tty);
|
|
tty_ldisc_flush(tty);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
tty->closing = 0;
|
|
port->port.tty = NULL;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
if (port->port.blocked_open) {
|
|
if (port->port.close_delay)
|
|
msleep_interruptible(
|
|
jiffies_to_msecs(port->port.close_delay));
|
|
wake_up_interruptible(&port->port.open_wait);
|
|
}
|
|
port->port.flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
|
|
wake_up_interruptible(&port->port.close_wait);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static int sx_write(struct tty_struct *tty,
|
|
const unsigned char *buf, int count)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
int c, total = 0;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
if (sx_paranoia_check(port, tty->name, "sx_write")) {
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
|
|
if (!port->xmit_buf) {
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
while (1) {
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
c = min_t(int, count, min(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
|
|
SERIAL_XMIT_SIZE - port->xmit_head));
|
|
if (c <= 0) {
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
break;
|
|
}
|
|
memcpy(port->xmit_buf + port->xmit_head, buf, c);
|
|
port->xmit_head = (port->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
|
|
port->xmit_cnt += c;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
buf += c;
|
|
count -= c;
|
|
total += c;
|
|
}
|
|
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
if (port->xmit_cnt && !tty->stopped && !tty->hw_stopped &&
|
|
!(port->IER & IER_TXRDY)) {
|
|
port->IER |= IER_TXRDY;
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
}
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
func_exit();
|
|
|
|
return total;
|
|
}
|
|
|
|
|
|
static int sx_put_char(struct tty_struct *tty, unsigned char ch)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
unsigned long flags;
|
|
struct specialix_board *bp;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_put_char")) {
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
dprintk(SX_DEBUG_TX, "check tty: %p %p\n", tty, port->xmit_buf);
|
|
if (!port->xmit_buf) {
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
bp = port_Board(port);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
|
|
dprintk(SX_DEBUG_TX, "xmit_cnt: %d xmit_buf: %p\n",
|
|
port->xmit_cnt, port->xmit_buf);
|
|
if (port->xmit_cnt >= SERIAL_XMIT_SIZE - 1 || !port->xmit_buf) {
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
dprintk(SX_DEBUG_TX, "Exit size\n");
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
dprintk(SX_DEBUG_TX, "Handle xmit: %p %p\n", port, port->xmit_buf);
|
|
port->xmit_buf[port->xmit_head++] = ch;
|
|
port->xmit_head &= SERIAL_XMIT_SIZE - 1;
|
|
port->xmit_cnt++;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
func_exit();
|
|
return 1;
|
|
}
|
|
|
|
|
|
static void sx_flush_chars(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
unsigned long flags;
|
|
struct specialix_board *bp = port_Board(port);
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_flush_chars")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
if (port->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
|
|
!port->xmit_buf) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
port->IER |= IER_TXRDY;
|
|
sx_out(port_Board(port), CD186x_CAR, port_No(port));
|
|
sx_out(port_Board(port), CD186x_IER, port->IER);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static int sx_write_room(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
int ret;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_write_room")) {
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
ret = SERIAL_XMIT_SIZE - port->xmit_cnt - 1;
|
|
if (ret < 0)
|
|
ret = 0;
|
|
|
|
func_exit();
|
|
return ret;
|
|
}
|
|
|
|
|
|
static int sx_chars_in_buffer(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_chars_in_buffer")) {
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
func_exit();
|
|
return port->xmit_cnt;
|
|
}
|
|
|
|
static int sx_tiocmget(struct tty_struct *tty, struct file *file)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
unsigned char status;
|
|
unsigned int result;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, __func__)) {
|
|
func_exit();
|
|
return -ENODEV;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
status = sx_in(bp, CD186x_MSVR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
dprintk(SX_DEBUG_INIT, "Got msvr[%d] = %02x, car = %d.\n",
|
|
port_No(port), status, sx_in(bp, CD186x_CAR));
|
|
dprintk(SX_DEBUG_INIT, "sx_port = %p, port = %p\n", sx_port, port);
|
|
if (sx_crtscts(port->port.tty)) {
|
|
result = TIOCM_DTR | TIOCM_DSR
|
|
| ((status & MSVR_DTR) ? TIOCM_RTS : 0)
|
|
| ((status & MSVR_CD) ? TIOCM_CAR : 0)
|
|
| ((status & MSVR_CTS) ? TIOCM_CTS : 0);
|
|
} else {
|
|
result = TIOCM_RTS | TIOCM_DSR
|
|
| ((status & MSVR_DTR) ? TIOCM_DTR : 0)
|
|
| ((status & MSVR_CD) ? TIOCM_CAR : 0)
|
|
| ((status & MSVR_CTS) ? TIOCM_CTS : 0);
|
|
}
|
|
|
|
func_exit();
|
|
|
|
return result;
|
|
}
|
|
|
|
|
|
static int sx_tiocmset(struct tty_struct *tty, struct file *file,
|
|
unsigned int set, unsigned int clear)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
unsigned long flags;
|
|
struct specialix_board *bp;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, __func__)) {
|
|
func_exit();
|
|
return -ENODEV;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (sx_crtscts(port->port.tty)) {
|
|
if (set & TIOCM_RTS)
|
|
port->MSVR |= MSVR_DTR;
|
|
} else {
|
|
if (set & TIOCM_DTR)
|
|
port->MSVR |= MSVR_DTR;
|
|
}
|
|
if (sx_crtscts(port->port.tty)) {
|
|
if (clear & TIOCM_RTS)
|
|
port->MSVR &= ~MSVR_DTR;
|
|
} else {
|
|
if (clear & TIOCM_DTR)
|
|
port->MSVR &= ~MSVR_DTR;
|
|
}
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
sx_out(bp, CD186x_MSVR, port->MSVR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int sx_send_break(struct tty_struct *tty, int length)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp = port_Board(port);
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
if (length == 0 || length == -1)
|
|
return -EOPNOTSUPP;
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
port->break_length = SPECIALIX_TPS / HZ * length;
|
|
port->COR2 |= COR2_ETC;
|
|
port->IER |= IER_TXRDY;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
sx_out(bp, CD186x_COR2, port->COR2);
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
sx_wait_CCR(bp);
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CCR, CCR_CORCHG2);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
sx_wait_CCR(bp);
|
|
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int sx_set_serial_info(struct specialix_port *port,
|
|
struct serial_struct __user *newinfo)
|
|
{
|
|
struct serial_struct tmp;
|
|
struct specialix_board *bp = port_Board(port);
|
|
int change_speed;
|
|
|
|
func_enter();
|
|
|
|
if (copy_from_user(&tmp, newinfo, sizeof(tmp))) {
|
|
func_enter();
|
|
return -EFAULT;
|
|
}
|
|
|
|
lock_kernel();
|
|
|
|
change_speed = ((port->port.flags & ASYNC_SPD_MASK) !=
|
|
(tmp.flags & ASYNC_SPD_MASK));
|
|
change_speed |= (tmp.custom_divisor != port->custom_divisor);
|
|
|
|
if (!capable(CAP_SYS_ADMIN)) {
|
|
if ((tmp.close_delay != port->port.close_delay) ||
|
|
(tmp.closing_wait != port->port.closing_wait) ||
|
|
((tmp.flags & ~ASYNC_USR_MASK) !=
|
|
(port->port.flags & ~ASYNC_USR_MASK))) {
|
|
func_exit();
|
|
unlock_kernel();
|
|
return -EPERM;
|
|
}
|
|
port->port.flags = ((port->port.flags & ~ASYNC_USR_MASK) |
|
|
(tmp.flags & ASYNC_USR_MASK));
|
|
port->custom_divisor = tmp.custom_divisor;
|
|
} else {
|
|
port->port.flags = ((port->port.flags & ~ASYNC_FLAGS) |
|
|
(tmp.flags & ASYNC_FLAGS));
|
|
port->port.close_delay = tmp.close_delay;
|
|
port->port.closing_wait = tmp.closing_wait;
|
|
port->custom_divisor = tmp.custom_divisor;
|
|
}
|
|
if (change_speed)
|
|
sx_change_speed(bp, port);
|
|
|
|
func_exit();
|
|
unlock_kernel();
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int sx_get_serial_info(struct specialix_port *port,
|
|
struct serial_struct __user *retinfo)
|
|
{
|
|
struct serial_struct tmp;
|
|
struct specialix_board *bp = port_Board(port);
|
|
|
|
func_enter();
|
|
|
|
memset(&tmp, 0, sizeof(tmp));
|
|
lock_kernel();
|
|
tmp.type = PORT_CIRRUS;
|
|
tmp.line = port - sx_port;
|
|
tmp.port = bp->base;
|
|
tmp.irq = bp->irq;
|
|
tmp.flags = port->port.flags;
|
|
tmp.baud_base = (SX_OSCFREQ + CD186x_TPC/2) / CD186x_TPC;
|
|
tmp.close_delay = port->port.close_delay * HZ/100;
|
|
tmp.closing_wait = port->port.closing_wait * HZ/100;
|
|
tmp.custom_divisor = port->custom_divisor;
|
|
tmp.xmit_fifo_size = CD186x_NFIFO;
|
|
unlock_kernel();
|
|
if (copy_to_user(retinfo, &tmp, sizeof(tmp))) {
|
|
func_exit();
|
|
return -EFAULT;
|
|
}
|
|
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int sx_ioctl(struct tty_struct *tty, struct file *filp,
|
|
unsigned int cmd, unsigned long arg)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
void __user *argp = (void __user *)arg;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_ioctl")) {
|
|
func_exit();
|
|
return -ENODEV;
|
|
}
|
|
|
|
switch (cmd) {
|
|
case TIOCGSERIAL:
|
|
func_exit();
|
|
return sx_get_serial_info(port, argp);
|
|
case TIOCSSERIAL:
|
|
func_exit();
|
|
return sx_set_serial_info(port, argp);
|
|
default:
|
|
func_exit();
|
|
return -ENOIOCTLCMD;
|
|
}
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
|
|
static void sx_throttle(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_throttle")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
|
|
/* Use DTR instead of RTS ! */
|
|
if (sx_crtscts(tty))
|
|
port->MSVR &= ~MSVR_DTR;
|
|
else {
|
|
/* Auch!!! I think the system shouldn't call this then. */
|
|
/* Or maybe we're supposed (allowed?) to do our side of hw
|
|
handshake anyway, even when hardware handshake is off.
|
|
When you see this in your logs, please report.... */
|
|
printk(KERN_ERR
|
|
"sx%d: Need to throttle, but can't (hardware hs is off)\n",
|
|
port_No(port));
|
|
}
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
if (I_IXOFF(tty)) {
|
|
sx_wait_CCR(bp);
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CCR, CCR_SSCH2);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
sx_wait_CCR(bp);
|
|
}
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_MSVR, port->MSVR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static void sx_unthrottle(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_unthrottle")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
/* XXXX Use DTR INSTEAD???? */
|
|
if (sx_crtscts(tty))
|
|
port->MSVR |= MSVR_DTR;
|
|
/* Else clause: see remark in "sx_throttle"... */
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
if (I_IXOFF(tty)) {
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
sx_wait_CCR(bp);
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CCR, CCR_SSCH1);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
sx_wait_CCR(bp);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
}
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_MSVR, port->MSVR);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static void sx_stop(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_stop")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
port->IER &= ~IER_TXRDY;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static void sx_start(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_start")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (port->xmit_cnt && port->xmit_buf && !(port->IER & IER_TXRDY)) {
|
|
port->IER |= IER_TXRDY;
|
|
spin_lock_irqsave(&bp->lock, flags);
|
|
sx_out(bp, CD186x_CAR, port_No(port));
|
|
sx_out(bp, CD186x_IER, port->IER);
|
|
spin_unlock_irqrestore(&bp->lock, flags);
|
|
}
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
static void sx_hangup(struct tty_struct *tty)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
struct specialix_board *bp;
|
|
unsigned long flags;
|
|
|
|
func_enter();
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_hangup")) {
|
|
func_exit();
|
|
return;
|
|
}
|
|
|
|
bp = port_Board(port);
|
|
|
|
sx_shutdown_port(bp, port);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
bp->count -= port->port.count;
|
|
if (bp->count < 0) {
|
|
printk(KERN_ERR
|
|
"sx%d: sx_hangup: bad board count: %d port: %d\n",
|
|
board_No(bp), bp->count, tty->index);
|
|
bp->count = 0;
|
|
}
|
|
port->port.count = 0;
|
|
port->port.flags &= ~ASYNC_NORMAL_ACTIVE;
|
|
port->port.tty = NULL;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
wake_up_interruptible(&port->port.open_wait);
|
|
|
|
func_exit();
|
|
}
|
|
|
|
|
|
static void sx_set_termios(struct tty_struct *tty,
|
|
struct ktermios *old_termios)
|
|
{
|
|
struct specialix_port *port = tty->driver_data;
|
|
unsigned long flags;
|
|
struct specialix_board *bp;
|
|
|
|
if (sx_paranoia_check(port, tty->name, "sx_set_termios"))
|
|
return;
|
|
|
|
bp = port_Board(port);
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
sx_change_speed(port_Board(port), port);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
if ((old_termios->c_cflag & CRTSCTS) &&
|
|
!(tty->termios->c_cflag & CRTSCTS)) {
|
|
tty->hw_stopped = 0;
|
|
sx_start(tty);
|
|
}
|
|
}
|
|
|
|
static const struct tty_operations sx_ops = {
|
|
.open = sx_open,
|
|
.close = sx_close,
|
|
.write = sx_write,
|
|
.put_char = sx_put_char,
|
|
.flush_chars = sx_flush_chars,
|
|
.write_room = sx_write_room,
|
|
.chars_in_buffer = sx_chars_in_buffer,
|
|
.flush_buffer = sx_flush_buffer,
|
|
.ioctl = sx_ioctl,
|
|
.throttle = sx_throttle,
|
|
.unthrottle = sx_unthrottle,
|
|
.set_termios = sx_set_termios,
|
|
.stop = sx_stop,
|
|
.start = sx_start,
|
|
.hangup = sx_hangup,
|
|
.tiocmget = sx_tiocmget,
|
|
.tiocmset = sx_tiocmset,
|
|
.break_ctl = sx_send_break,
|
|
};
|
|
|
|
static int sx_init_drivers(void)
|
|
{
|
|
int error;
|
|
int i;
|
|
|
|
func_enter();
|
|
|
|
specialix_driver = alloc_tty_driver(SX_NBOARD * SX_NPORT);
|
|
if (!specialix_driver) {
|
|
printk(KERN_ERR "sx: Couldn't allocate tty_driver.\n");
|
|
func_exit();
|
|
return 1;
|
|
}
|
|
|
|
specialix_driver->owner = THIS_MODULE;
|
|
specialix_driver->name = "ttyW";
|
|
specialix_driver->major = SPECIALIX_NORMAL_MAJOR;
|
|
specialix_driver->type = TTY_DRIVER_TYPE_SERIAL;
|
|
specialix_driver->subtype = SERIAL_TYPE_NORMAL;
|
|
specialix_driver->init_termios = tty_std_termios;
|
|
specialix_driver->init_termios.c_cflag =
|
|
B9600 | CS8 | CREAD | HUPCL | CLOCAL;
|
|
specialix_driver->init_termios.c_ispeed = 9600;
|
|
specialix_driver->init_termios.c_ospeed = 9600;
|
|
specialix_driver->flags = TTY_DRIVER_REAL_RAW |
|
|
TTY_DRIVER_HARDWARE_BREAK;
|
|
tty_set_operations(specialix_driver, &sx_ops);
|
|
|
|
error = tty_register_driver(specialix_driver);
|
|
if (error) {
|
|
put_tty_driver(specialix_driver);
|
|
printk(KERN_ERR
|
|
"sx: Couldn't register specialix IO8+ driver, error = %d\n",
|
|
error);
|
|
func_exit();
|
|
return 1;
|
|
}
|
|
memset(sx_port, 0, sizeof(sx_port));
|
|
for (i = 0; i < SX_NPORT * SX_NBOARD; i++) {
|
|
sx_port[i].magic = SPECIALIX_MAGIC;
|
|
tty_port_init(&sx_port[i].port);
|
|
spin_lock_init(&sx_port[i].lock);
|
|
}
|
|
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
static void sx_release_drivers(void)
|
|
{
|
|
func_enter();
|
|
|
|
tty_unregister_driver(specialix_driver);
|
|
put_tty_driver(specialix_driver);
|
|
func_exit();
|
|
}
|
|
|
|
/*
|
|
* This routine must be called by kernel at boot time
|
|
*/
|
|
static int __init specialix_init(void)
|
|
{
|
|
int i;
|
|
int found = 0;
|
|
|
|
func_enter();
|
|
|
|
printk(KERN_INFO "sx: Specialix IO8+ driver v" VERSION ", (c) R.E.Wolff 1997/1998.\n");
|
|
printk(KERN_INFO "sx: derived from work (c) D.Gorodchanin 1994-1996.\n");
|
|
if (sx_rtscts)
|
|
printk(KERN_INFO
|
|
"sx: DTR/RTS pin is RTS when CRTSCTS is on.\n");
|
|
else
|
|
printk(KERN_INFO "sx: DTR/RTS pin is always RTS.\n");
|
|
|
|
for (i = 0; i < SX_NBOARD; i++)
|
|
spin_lock_init(&sx_board[i].lock);
|
|
|
|
if (sx_init_drivers()) {
|
|
func_exit();
|
|
return -EIO;
|
|
}
|
|
|
|
for (i = 0; i < SX_NBOARD; i++)
|
|
if (sx_board[i].base && !sx_probe(&sx_board[i]))
|
|
found++;
|
|
|
|
#ifdef CONFIG_PCI
|
|
{
|
|
struct pci_dev *pdev = NULL;
|
|
|
|
i = 0;
|
|
while (i < SX_NBOARD) {
|
|
if (sx_board[i].flags & SX_BOARD_PRESENT) {
|
|
i++;
|
|
continue;
|
|
}
|
|
pdev = pci_get_device(PCI_VENDOR_ID_SPECIALIX,
|
|
PCI_DEVICE_ID_SPECIALIX_IO8, pdev);
|
|
if (!pdev)
|
|
break;
|
|
|
|
if (pci_enable_device(pdev))
|
|
continue;
|
|
|
|
sx_board[i].irq = pdev->irq;
|
|
|
|
sx_board[i].base = pci_resource_start(pdev, 2);
|
|
|
|
sx_board[i].flags |= SX_BOARD_IS_PCI;
|
|
if (!sx_probe(&sx_board[i]))
|
|
found++;
|
|
}
|
|
/* May exit pci_get sequence early with lots of boards */
|
|
if (pdev != NULL)
|
|
pci_dev_put(pdev);
|
|
}
|
|
#endif
|
|
|
|
if (!found) {
|
|
sx_release_drivers();
|
|
printk(KERN_INFO "sx: No specialix IO8+ boards detected.\n");
|
|
func_exit();
|
|
return -EIO;
|
|
}
|
|
|
|
func_exit();
|
|
return 0;
|
|
}
|
|
|
|
static int iobase[SX_NBOARD] = {0,};
|
|
static int irq[SX_NBOARD] = {0,};
|
|
|
|
module_param_array(iobase, int, NULL, 0);
|
|
module_param_array(irq, int, NULL, 0);
|
|
module_param(sx_debug, int, 0);
|
|
module_param(sx_rtscts, int, 0);
|
|
module_param(sx_rxfifo, int, 0);
|
|
|
|
/*
|
|
* You can setup up to 4 boards.
|
|
* by specifying "iobase=0xXXX,0xXXX ..." as insmod parameter.
|
|
* You should specify the IRQs too in that case "irq=....,...".
|
|
*
|
|
* More than 4 boards in one computer is not possible, as the card can
|
|
* only use 4 different interrupts.
|
|
*
|
|
*/
|
|
static int __init specialix_init_module(void)
|
|
{
|
|
int i;
|
|
|
|
func_enter();
|
|
|
|
if (iobase[0] || iobase[1] || iobase[2] || iobase[3]) {
|
|
for (i = 0; i < SX_NBOARD; i++) {
|
|
sx_board[i].base = iobase[i];
|
|
sx_board[i].irq = irq[i];
|
|
sx_board[i].count = 0;
|
|
}
|
|
}
|
|
|
|
func_exit();
|
|
|
|
return specialix_init();
|
|
}
|
|
|
|
static void __exit specialix_exit_module(void)
|
|
{
|
|
int i;
|
|
|
|
func_enter();
|
|
|
|
sx_release_drivers();
|
|
for (i = 0; i < SX_NBOARD; i++)
|
|
if (sx_board[i].flags & SX_BOARD_PRESENT)
|
|
sx_release_io_range(&sx_board[i]);
|
|
func_exit();
|
|
}
|
|
|
|
static struct pci_device_id specialx_pci_tbl[] __devinitdata = {
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_SPECIALIX, PCI_DEVICE_ID_SPECIALIX_IO8) },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, specialx_pci_tbl);
|
|
|
|
module_init(specialix_init_module);
|
|
module_exit(specialix_exit_module);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS_CHARDEV_MAJOR(SPECIALIX_NORMAL_MAJOR);
|