You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
4260 lines
118 KiB
4260 lines
118 KiB
/* |
|
* Serial port driver for the ETRAX 100LX chip |
|
* |
|
* Copyright (C) 1998-2007 Axis Communications AB |
|
* |
|
* Many, many authors. Based once upon a time on serial.c for 16x50. |
|
* |
|
*/ |
|
|
|
static char *serial_version = "$Revision: 1.25 $"; |
|
|
|
#include <linux/types.h> |
|
#include <linux/errno.h> |
|
#include <linux/signal.h> |
|
#include <linux/sched.h> |
|
#include <linux/timer.h> |
|
#include <linux/interrupt.h> |
|
#include <linux/tty.h> |
|
#include <linux/tty_flip.h> |
|
#include <linux/major.h> |
|
#include <linux/string.h> |
|
#include <linux/fcntl.h> |
|
#include <linux/mm.h> |
|
#include <linux/slab.h> |
|
#include <linux/init.h> |
|
#include <linux/kernel.h> |
|
#include <linux/mutex.h> |
|
#include <linux/bitops.h> |
|
#include <linux/seq_file.h> |
|
#include <linux/delay.h> |
|
#include <linux/module.h> |
|
#include <linux/uaccess.h> |
|
#include <linux/io.h> |
|
|
|
#include <asm/irq.h> |
|
#include <asm/dma.h> |
|
|
|
#include <arch/svinto.h> |
|
#include <arch/system.h> |
|
|
|
/* non-arch dependent serial structures are in linux/serial.h */ |
|
#include <linux/serial.h> |
|
/* while we keep our own stuff (struct e100_serial) in a local .h file */ |
|
#include "crisv10.h" |
|
#include <asm/fasttimer.h> |
|
#include <arch/io_interface_mux.h> |
|
|
|
#ifdef CONFIG_ETRAX_SERIAL_FAST_TIMER |
|
#ifndef CONFIG_ETRAX_FAST_TIMER |
|
#error "Enable FAST_TIMER to use SERIAL_FAST_TIMER" |
|
#endif |
|
#endif |
|
|
|
#if defined(CONFIG_ETRAX_SERIAL_RX_TIMEOUT_TICKS) && \ |
|
(CONFIG_ETRAX_SERIAL_RX_TIMEOUT_TICKS == 0) |
|
#error "RX_TIMEOUT_TICKS == 0 not allowed, use 1" |
|
#endif |
|
|
|
/* |
|
* All of the compatibilty code so we can compile serial.c against |
|
* older kernels is hidden in serial_compat.h |
|
*/ |
|
#if defined(LOCAL_HEADERS) |
|
#include "serial_compat.h" |
|
#endif |
|
|
|
struct tty_driver *serial_driver; |
|
|
|
/* number of characters left in xmit buffer before we ask for more */ |
|
#define WAKEUP_CHARS 256 |
|
|
|
//#define SERIAL_DEBUG_INTR |
|
//#define SERIAL_DEBUG_OPEN |
|
//#define SERIAL_DEBUG_FLOW |
|
//#define SERIAL_DEBUG_DATA |
|
//#define SERIAL_DEBUG_THROTTLE |
|
//#define SERIAL_DEBUG_IO /* Debug for Extra control and status pins */ |
|
//#define SERIAL_DEBUG_LINE 0 /* What serport we want to debug */ |
|
|
|
/* Enable this to use serial interrupts to handle when you |
|
expect the first received event on the serial port to |
|
be an error, break or similar. Used to be able to flash IRMA |
|
from eLinux */ |
|
#define SERIAL_HANDLE_EARLY_ERRORS |
|
|
|
/* Currently 16 descriptors x 128 bytes = 2048 bytes */ |
|
#define SERIAL_DESCR_BUF_SIZE 256 |
|
|
|
#define SERIAL_PRESCALE_BASE 3125000 /* 3.125MHz */ |
|
#define DEF_BAUD_BASE SERIAL_PRESCALE_BASE |
|
|
|
/* We don't want to load the system with massive fast timer interrupt |
|
* on high baudrates so limit it to 250 us (4kHz) */ |
|
#define MIN_FLUSH_TIME_USEC 250 |
|
|
|
/* Add an x here to log a lot of timer stuff */ |
|
#define TIMERD(x) |
|
/* Debug details of interrupt handling */ |
|
#define DINTR1(x) /* irq on/off, errors */ |
|
#define DINTR2(x) /* tx and rx */ |
|
/* Debug flip buffer stuff */ |
|
#define DFLIP(x) |
|
/* Debug flow control and overview of data flow */ |
|
#define DFLOW(x) |
|
#define DBAUD(x) |
|
#define DLOG_INT_TRIG(x) |
|
|
|
//#define DEBUG_LOG_INCLUDED |
|
#ifndef DEBUG_LOG_INCLUDED |
|
#define DEBUG_LOG(line, string, value) |
|
#else |
|
struct debug_log_info |
|
{ |
|
unsigned long time; |
|
unsigned long timer_data; |
|
// int line; |
|
const char *string; |
|
int value; |
|
}; |
|
#define DEBUG_LOG_SIZE 4096 |
|
|
|
struct debug_log_info debug_log[DEBUG_LOG_SIZE]; |
|
int debug_log_pos = 0; |
|
|
|
#define DEBUG_LOG(_line, _string, _value) do { \ |
|
if ((_line) == SERIAL_DEBUG_LINE) {\ |
|
debug_log_func(_line, _string, _value); \ |
|
}\ |
|
}while(0) |
|
|
|
void debug_log_func(int line, const char *string, int value) |
|
{ |
|
if (debug_log_pos < DEBUG_LOG_SIZE) { |
|
debug_log[debug_log_pos].time = jiffies; |
|
debug_log[debug_log_pos].timer_data = *R_TIMER_DATA; |
|
// debug_log[debug_log_pos].line = line; |
|
debug_log[debug_log_pos].string = string; |
|
debug_log[debug_log_pos].value = value; |
|
debug_log_pos++; |
|
} |
|
/*printk(string, value);*/ |
|
} |
|
#endif |
|
|
|
#ifndef CONFIG_ETRAX_SERIAL_RX_TIMEOUT_TICKS |
|
/* Default number of timer ticks before flushing rx fifo |
|
* When using "little data, low latency applications: use 0 |
|
* When using "much data applications (PPP)" use ~5 |
|
*/ |
|
#define CONFIG_ETRAX_SERIAL_RX_TIMEOUT_TICKS 5 |
|
#endif |
|
|
|
unsigned long timer_data_to_ns(unsigned long timer_data); |
|
|
|
static void change_speed(struct e100_serial *info); |
|
static void rs_throttle(struct tty_struct * tty); |
|
static void rs_wait_until_sent(struct tty_struct *tty, int timeout); |
|
static int rs_write(struct tty_struct *tty, |
|
const unsigned char *buf, int count); |
|
#ifdef CONFIG_ETRAX_RS485 |
|
static int e100_write_rs485(struct tty_struct *tty, |
|
const unsigned char *buf, int count); |
|
#endif |
|
static int get_lsr_info(struct e100_serial *info, unsigned int *value); |
|
|
|
|
|
#define DEF_BAUD 115200 /* 115.2 kbit/s */ |
|
#define DEF_RX 0x20 /* or SERIAL_CTRL_W >> 8 */ |
|
/* Default value of tx_ctrl register: has txd(bit 7)=1 (idle) as default */ |
|
#define DEF_TX 0x80 /* or SERIAL_CTRL_B */ |
|
|
|
/* offsets from R_SERIALx_CTRL */ |
|
|
|
#define REG_DATA 0 |
|
#define REG_DATA_STATUS32 0 /* this is the 32 bit register R_SERIALx_READ */ |
|
#define REG_TR_DATA 0 |
|
#define REG_STATUS 1 |
|
#define REG_TR_CTRL 1 |
|
#define REG_REC_CTRL 2 |
|
#define REG_BAUD 3 |
|
#define REG_XOFF 4 /* this is a 32 bit register */ |
|
|
|
/* The bitfields are the same for all serial ports */ |
|
#define SER_RXD_MASK IO_MASK(R_SERIAL0_STATUS, rxd) |
|
#define SER_DATA_AVAIL_MASK IO_MASK(R_SERIAL0_STATUS, data_avail) |
|
#define SER_FRAMING_ERR_MASK IO_MASK(R_SERIAL0_STATUS, framing_err) |
|
#define SER_PAR_ERR_MASK IO_MASK(R_SERIAL0_STATUS, par_err) |
|
#define SER_OVERRUN_MASK IO_MASK(R_SERIAL0_STATUS, overrun) |
|
|
|
#define SER_ERROR_MASK (SER_OVERRUN_MASK | SER_PAR_ERR_MASK | SER_FRAMING_ERR_MASK) |
|
|
|
/* Values for info->errorcode */ |
|
#define ERRCODE_SET_BREAK (TTY_BREAK) |
|
#define ERRCODE_INSERT 0x100 |
|
#define ERRCODE_INSERT_BREAK (ERRCODE_INSERT | TTY_BREAK) |
|
|
|
#define FORCE_EOP(info) *R_SET_EOP = 1U << info->iseteop; |
|
|
|
/* |
|
* General note regarding the use of IO_* macros in this file: |
|
* |
|
* We will use the bits defined for DMA channel 6 when using various |
|
* IO_* macros (e.g. IO_STATE, IO_MASK, IO_EXTRACT) and _assume_ they are |
|
* the same for all channels (which of course they are). |
|
* |
|
* We will also use the bits defined for serial port 0 when writing commands |
|
* to the different ports, as these bits too are the same for all ports. |
|
*/ |
|
|
|
|
|
/* Mask for the irqs possibly enabled in R_IRQ_MASK1_RD etc. */ |
|
static const unsigned long e100_ser_int_mask = 0 |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT0 |
|
| IO_MASK(R_IRQ_MASK1_RD, ser0_data) | IO_MASK(R_IRQ_MASK1_RD, ser0_ready) |
|
#endif |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT1 |
|
| IO_MASK(R_IRQ_MASK1_RD, ser1_data) | IO_MASK(R_IRQ_MASK1_RD, ser1_ready) |
|
#endif |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT2 |
|
| IO_MASK(R_IRQ_MASK1_RD, ser2_data) | IO_MASK(R_IRQ_MASK1_RD, ser2_ready) |
|
#endif |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT3 |
|
| IO_MASK(R_IRQ_MASK1_RD, ser3_data) | IO_MASK(R_IRQ_MASK1_RD, ser3_ready) |
|
#endif |
|
; |
|
unsigned long r_alt_ser_baudrate_shadow = 0; |
|
|
|
/* this is the data for the four serial ports in the etrax100 */ |
|
/* DMA2(ser2), DMA4(ser3), DMA6(ser0) or DMA8(ser1) */ |
|
/* R_DMA_CHx_CLR_INTR, R_DMA_CHx_FIRST, R_DMA_CHx_CMD */ |
|
|
|
static struct e100_serial rs_table[] = { |
|
{ .baud = DEF_BAUD, |
|
.ioport = (unsigned char *)R_SERIAL0_CTRL, |
|
.irq = 1U << 12, /* uses DMA 6 and 7 */ |
|
.oclrintradr = R_DMA_CH6_CLR_INTR, |
|
.ofirstadr = R_DMA_CH6_FIRST, |
|
.ocmdadr = R_DMA_CH6_CMD, |
|
.ostatusadr = R_DMA_CH6_STATUS, |
|
.iclrintradr = R_DMA_CH7_CLR_INTR, |
|
.ifirstadr = R_DMA_CH7_FIRST, |
|
.icmdadr = R_DMA_CH7_CMD, |
|
.idescradr = R_DMA_CH7_DESCR, |
|
.rx_ctrl = DEF_RX, |
|
.tx_ctrl = DEF_TX, |
|
.iseteop = 2, |
|
.dma_owner = dma_ser0, |
|
.io_if = if_serial_0, |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT0 |
|
.enabled = 1, |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT0_DMA6_OUT |
|
.dma_out_enabled = 1, |
|
.dma_out_nbr = SER0_TX_DMA_NBR, |
|
.dma_out_irq_nbr = SER0_DMA_TX_IRQ_NBR, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = "serial 0 dma tr", |
|
#else |
|
.dma_out_enabled = 0, |
|
.dma_out_nbr = UINT_MAX, |
|
.dma_out_irq_nbr = 0, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = NULL, |
|
#endif |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT0_DMA7_IN |
|
.dma_in_enabled = 1, |
|
.dma_in_nbr = SER0_RX_DMA_NBR, |
|
.dma_in_irq_nbr = SER0_DMA_RX_IRQ_NBR, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = "serial 0 dma rec", |
|
#else |
|
.dma_in_enabled = 0, |
|
.dma_in_nbr = UINT_MAX, |
|
.dma_in_irq_nbr = 0, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = NULL, |
|
#endif |
|
#else |
|
.enabled = 0, |
|
.io_if_description = NULL, |
|
.dma_out_enabled = 0, |
|
.dma_in_enabled = 0 |
|
#endif |
|
|
|
}, /* ttyS0 */ |
|
{ .baud = DEF_BAUD, |
|
.ioport = (unsigned char *)R_SERIAL1_CTRL, |
|
.irq = 1U << 16, /* uses DMA 8 and 9 */ |
|
.oclrintradr = R_DMA_CH8_CLR_INTR, |
|
.ofirstadr = R_DMA_CH8_FIRST, |
|
.ocmdadr = R_DMA_CH8_CMD, |
|
.ostatusadr = R_DMA_CH8_STATUS, |
|
.iclrintradr = R_DMA_CH9_CLR_INTR, |
|
.ifirstadr = R_DMA_CH9_FIRST, |
|
.icmdadr = R_DMA_CH9_CMD, |
|
.idescradr = R_DMA_CH9_DESCR, |
|
.rx_ctrl = DEF_RX, |
|
.tx_ctrl = DEF_TX, |
|
.iseteop = 3, |
|
.dma_owner = dma_ser1, |
|
.io_if = if_serial_1, |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT1 |
|
.enabled = 1, |
|
.io_if_description = "ser1", |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT1_DMA8_OUT |
|
.dma_out_enabled = 1, |
|
.dma_out_nbr = SER1_TX_DMA_NBR, |
|
.dma_out_irq_nbr = SER1_DMA_TX_IRQ_NBR, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = "serial 1 dma tr", |
|
#else |
|
.dma_out_enabled = 0, |
|
.dma_out_nbr = UINT_MAX, |
|
.dma_out_irq_nbr = 0, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = NULL, |
|
#endif |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT1_DMA9_IN |
|
.dma_in_enabled = 1, |
|
.dma_in_nbr = SER1_RX_DMA_NBR, |
|
.dma_in_irq_nbr = SER1_DMA_RX_IRQ_NBR, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = "serial 1 dma rec", |
|
#else |
|
.dma_in_enabled = 0, |
|
.dma_in_enabled = 0, |
|
.dma_in_nbr = UINT_MAX, |
|
.dma_in_irq_nbr = 0, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = NULL, |
|
#endif |
|
#else |
|
.enabled = 0, |
|
.io_if_description = NULL, |
|
.dma_in_irq_nbr = 0, |
|
.dma_out_enabled = 0, |
|
.dma_in_enabled = 0 |
|
#endif |
|
}, /* ttyS1 */ |
|
|
|
{ .baud = DEF_BAUD, |
|
.ioport = (unsigned char *)R_SERIAL2_CTRL, |
|
.irq = 1U << 4, /* uses DMA 2 and 3 */ |
|
.oclrintradr = R_DMA_CH2_CLR_INTR, |
|
.ofirstadr = R_DMA_CH2_FIRST, |
|
.ocmdadr = R_DMA_CH2_CMD, |
|
.ostatusadr = R_DMA_CH2_STATUS, |
|
.iclrintradr = R_DMA_CH3_CLR_INTR, |
|
.ifirstadr = R_DMA_CH3_FIRST, |
|
.icmdadr = R_DMA_CH3_CMD, |
|
.idescradr = R_DMA_CH3_DESCR, |
|
.rx_ctrl = DEF_RX, |
|
.tx_ctrl = DEF_TX, |
|
.iseteop = 0, |
|
.dma_owner = dma_ser2, |
|
.io_if = if_serial_2, |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT2 |
|
.enabled = 1, |
|
.io_if_description = "ser2", |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT2_DMA2_OUT |
|
.dma_out_enabled = 1, |
|
.dma_out_nbr = SER2_TX_DMA_NBR, |
|
.dma_out_irq_nbr = SER2_DMA_TX_IRQ_NBR, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = "serial 2 dma tr", |
|
#else |
|
.dma_out_enabled = 0, |
|
.dma_out_nbr = UINT_MAX, |
|
.dma_out_irq_nbr = 0, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = NULL, |
|
#endif |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT2_DMA3_IN |
|
.dma_in_enabled = 1, |
|
.dma_in_nbr = SER2_RX_DMA_NBR, |
|
.dma_in_irq_nbr = SER2_DMA_RX_IRQ_NBR, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = "serial 2 dma rec", |
|
#else |
|
.dma_in_enabled = 0, |
|
.dma_in_nbr = UINT_MAX, |
|
.dma_in_irq_nbr = 0, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = NULL, |
|
#endif |
|
#else |
|
.enabled = 0, |
|
.io_if_description = NULL, |
|
.dma_out_enabled = 0, |
|
.dma_in_enabled = 0 |
|
#endif |
|
}, /* ttyS2 */ |
|
|
|
{ .baud = DEF_BAUD, |
|
.ioport = (unsigned char *)R_SERIAL3_CTRL, |
|
.irq = 1U << 8, /* uses DMA 4 and 5 */ |
|
.oclrintradr = R_DMA_CH4_CLR_INTR, |
|
.ofirstadr = R_DMA_CH4_FIRST, |
|
.ocmdadr = R_DMA_CH4_CMD, |
|
.ostatusadr = R_DMA_CH4_STATUS, |
|
.iclrintradr = R_DMA_CH5_CLR_INTR, |
|
.ifirstadr = R_DMA_CH5_FIRST, |
|
.icmdadr = R_DMA_CH5_CMD, |
|
.idescradr = R_DMA_CH5_DESCR, |
|
.rx_ctrl = DEF_RX, |
|
.tx_ctrl = DEF_TX, |
|
.iseteop = 1, |
|
.dma_owner = dma_ser3, |
|
.io_if = if_serial_3, |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT3 |
|
.enabled = 1, |
|
.io_if_description = "ser3", |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT3_DMA4_OUT |
|
.dma_out_enabled = 1, |
|
.dma_out_nbr = SER3_TX_DMA_NBR, |
|
.dma_out_irq_nbr = SER3_DMA_TX_IRQ_NBR, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = "serial 3 dma tr", |
|
#else |
|
.dma_out_enabled = 0, |
|
.dma_out_nbr = UINT_MAX, |
|
.dma_out_irq_nbr = 0, |
|
.dma_out_irq_flags = 0, |
|
.dma_out_irq_description = NULL, |
|
#endif |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT3_DMA5_IN |
|
.dma_in_enabled = 1, |
|
.dma_in_nbr = SER3_RX_DMA_NBR, |
|
.dma_in_irq_nbr = SER3_DMA_RX_IRQ_NBR, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = "serial 3 dma rec", |
|
#else |
|
.dma_in_enabled = 0, |
|
.dma_in_nbr = UINT_MAX, |
|
.dma_in_irq_nbr = 0, |
|
.dma_in_irq_flags = 0, |
|
.dma_in_irq_description = NULL |
|
#endif |
|
#else |
|
.enabled = 0, |
|
.io_if_description = NULL, |
|
.dma_out_enabled = 0, |
|
.dma_in_enabled = 0 |
|
#endif |
|
} /* ttyS3 */ |
|
}; |
|
|
|
|
|
#define NR_PORTS (sizeof(rs_table)/sizeof(struct e100_serial)) |
|
|
|
#ifdef CONFIG_ETRAX_SERIAL_FAST_TIMER |
|
static struct fast_timer fast_timers[NR_PORTS]; |
|
#endif |
|
|
|
/* RS-485 */ |
|
#if defined(CONFIG_ETRAX_RS485) |
|
#ifdef CONFIG_ETRAX_FAST_TIMER |
|
static struct fast_timer fast_timers_rs485[NR_PORTS]; |
|
#endif |
|
#if defined(CONFIG_ETRAX_RS485_ON_PA) |
|
static int rs485_pa_bit = CONFIG_ETRAX_RS485_ON_PA_BIT; |
|
#endif |
|
#endif |
|
|
|
/* Info and macros needed for each ports extra control/status signals. */ |
|
#define E100_STRUCT_PORT(line, pinname) \ |
|
((CONFIG_ETRAX_SER##line##_##pinname##_ON_PA_BIT >= 0)? \ |
|
(R_PORT_PA_DATA): ( \ |
|
(CONFIG_ETRAX_SER##line##_##pinname##_ON_PB_BIT >= 0)? \ |
|
(R_PORT_PB_DATA):&dummy_ser[line])) |
|
|
|
#define E100_STRUCT_SHADOW(line, pinname) \ |
|
((CONFIG_ETRAX_SER##line##_##pinname##_ON_PA_BIT >= 0)? \ |
|
(&port_pa_data_shadow): ( \ |
|
(CONFIG_ETRAX_SER##line##_##pinname##_ON_PB_BIT >= 0)? \ |
|
(&port_pb_data_shadow):&dummy_ser[line])) |
|
#define E100_STRUCT_MASK(line, pinname) \ |
|
((CONFIG_ETRAX_SER##line##_##pinname##_ON_PA_BIT >= 0)? \ |
|
(1<<CONFIG_ETRAX_SER##line##_##pinname##_ON_PA_BIT): ( \ |
|
(CONFIG_ETRAX_SER##line##_##pinname##_ON_PB_BIT >= 0)? \ |
|
(1<<CONFIG_ETRAX_SER##line##_##pinname##_ON_PB_BIT):DUMMY_##pinname##_MASK)) |
|
|
|
#define DUMMY_DTR_MASK 1 |
|
#define DUMMY_RI_MASK 2 |
|
#define DUMMY_DSR_MASK 4 |
|
#define DUMMY_CD_MASK 8 |
|
static unsigned char dummy_ser[NR_PORTS] = {0xFF, 0xFF, 0xFF,0xFF}; |
|
|
|
/* If not all status pins are used or disabled, use mixed mode */ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT0 |
|
|
|
#define SER0_PA_BITSUM (CONFIG_ETRAX_SER0_DTR_ON_PA_BIT+CONFIG_ETRAX_SER0_RI_ON_PA_BIT+CONFIG_ETRAX_SER0_DSR_ON_PA_BIT+CONFIG_ETRAX_SER0_CD_ON_PA_BIT) |
|
|
|
#if SER0_PA_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER0_DTR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER0_RI_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER0_DSR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER0_CD_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#define SER0_PB_BITSUM (CONFIG_ETRAX_SER0_DTR_ON_PB_BIT+CONFIG_ETRAX_SER0_RI_ON_PB_BIT+CONFIG_ETRAX_SER0_DSR_ON_PB_BIT+CONFIG_ETRAX_SER0_CD_ON_PB_BIT) |
|
|
|
#if SER0_PB_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER0_DTR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER0_RI_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER0_DSR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER0_CD_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#endif /* PORT0 */ |
|
|
|
|
|
#ifdef CONFIG_ETRAX_SERIAL_PORT1 |
|
|
|
#define SER1_PA_BITSUM (CONFIG_ETRAX_SER1_DTR_ON_PA_BIT+CONFIG_ETRAX_SER1_RI_ON_PA_BIT+CONFIG_ETRAX_SER1_DSR_ON_PA_BIT+CONFIG_ETRAX_SER1_CD_ON_PA_BIT) |
|
|
|
#if SER1_PA_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER1_DTR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER1_RI_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER1_DSR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER1_CD_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#define SER1_PB_BITSUM (CONFIG_ETRAX_SER1_DTR_ON_PB_BIT+CONFIG_ETRAX_SER1_RI_ON_PB_BIT+CONFIG_ETRAX_SER1_DSR_ON_PB_BIT+CONFIG_ETRAX_SER1_CD_ON_PB_BIT) |
|
|
|
#if SER1_PB_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER1_DTR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER1_RI_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER1_DSR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER1_CD_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#endif /* PORT1 */ |
|
|
|
#ifdef CONFIG_ETRAX_SERIAL_PORT2 |
|
|
|
#define SER2_PA_BITSUM (CONFIG_ETRAX_SER2_DTR_ON_PA_BIT+CONFIG_ETRAX_SER2_RI_ON_PA_BIT+CONFIG_ETRAX_SER2_DSR_ON_PA_BIT+CONFIG_ETRAX_SER2_CD_ON_PA_BIT) |
|
|
|
#if SER2_PA_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER2_DTR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER2_RI_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER2_DSR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER2_CD_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#define SER2_PB_BITSUM (CONFIG_ETRAX_SER2_DTR_ON_PB_BIT+CONFIG_ETRAX_SER2_RI_ON_PB_BIT+CONFIG_ETRAX_SER2_DSR_ON_PB_BIT+CONFIG_ETRAX_SER2_CD_ON_PB_BIT) |
|
|
|
#if SER2_PB_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER2_DTR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER2_RI_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER2_DSR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER2_CD_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#endif /* PORT2 */ |
|
|
|
#ifdef CONFIG_ETRAX_SERIAL_PORT3 |
|
|
|
#define SER3_PA_BITSUM (CONFIG_ETRAX_SER3_DTR_ON_PA_BIT+CONFIG_ETRAX_SER3_RI_ON_PA_BIT+CONFIG_ETRAX_SER3_DSR_ON_PA_BIT+CONFIG_ETRAX_SER3_CD_ON_PA_BIT) |
|
|
|
#if SER3_PA_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER3_DTR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER3_RI_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER3_DSR_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER3_CD_ON_PA_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#define SER3_PB_BITSUM (CONFIG_ETRAX_SER3_DTR_ON_PB_BIT+CONFIG_ETRAX_SER3_RI_ON_PB_BIT+CONFIG_ETRAX_SER3_DSR_ON_PB_BIT+CONFIG_ETRAX_SER3_CD_ON_PB_BIT) |
|
|
|
#if SER3_PB_BITSUM != -4 |
|
# if CONFIG_ETRAX_SER3_DTR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER3_RI_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER3_DSR_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
# if CONFIG_ETRAX_SER3_CD_ON_PB_BIT == -1 |
|
# ifndef CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED |
|
# define CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED 1 |
|
# endif |
|
# endif |
|
#endif |
|
|
|
#endif /* PORT3 */ |
|
|
|
|
|
#if defined(CONFIG_ETRAX_SER0_DTR_RI_DSR_CD_MIXED) || \ |
|
defined(CONFIG_ETRAX_SER1_DTR_RI_DSR_CD_MIXED) || \ |
|
defined(CONFIG_ETRAX_SER2_DTR_RI_DSR_CD_MIXED) || \ |
|
defined(CONFIG_ETRAX_SER3_DTR_RI_DSR_CD_MIXED) |
|
#define ETRAX_SERX_DTR_RI_DSR_CD_MIXED |
|
#endif |
|
|
|
#ifdef ETRAX_SERX_DTR_RI_DSR_CD_MIXED |
|
/* The pins can be mixed on PA and PB */ |
|
#define CONTROL_PINS_PORT_NOT_USED(line) \ |
|
&dummy_ser[line], &dummy_ser[line], \ |
|
&dummy_ser[line], &dummy_ser[line], \ |
|
&dummy_ser[line], &dummy_ser[line], \ |
|
&dummy_ser[line], &dummy_ser[line], \ |
|
DUMMY_DTR_MASK, DUMMY_RI_MASK, DUMMY_DSR_MASK, DUMMY_CD_MASK |
|
|
|
|
|
struct control_pins |
|
{ |
|
volatile unsigned char *dtr_port; |
|
unsigned char *dtr_shadow; |
|
volatile unsigned char *ri_port; |
|
unsigned char *ri_shadow; |
|
volatile unsigned char *dsr_port; |
|
unsigned char *dsr_shadow; |
|
volatile unsigned char *cd_port; |
|
unsigned char *cd_shadow; |
|
|
|
unsigned char dtr_mask; |
|
unsigned char ri_mask; |
|
unsigned char dsr_mask; |
|
unsigned char cd_mask; |
|
}; |
|
|
|
static const struct control_pins e100_modem_pins[NR_PORTS] = |
|
{ |
|
/* Ser 0 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT0 |
|
E100_STRUCT_PORT(0,DTR), E100_STRUCT_SHADOW(0,DTR), |
|
E100_STRUCT_PORT(0,RI), E100_STRUCT_SHADOW(0,RI), |
|
E100_STRUCT_PORT(0,DSR), E100_STRUCT_SHADOW(0,DSR), |
|
E100_STRUCT_PORT(0,CD), E100_STRUCT_SHADOW(0,CD), |
|
E100_STRUCT_MASK(0,DTR), |
|
E100_STRUCT_MASK(0,RI), |
|
E100_STRUCT_MASK(0,DSR), |
|
E100_STRUCT_MASK(0,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(0) |
|
#endif |
|
}, |
|
|
|
/* Ser 1 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT1 |
|
E100_STRUCT_PORT(1,DTR), E100_STRUCT_SHADOW(1,DTR), |
|
E100_STRUCT_PORT(1,RI), E100_STRUCT_SHADOW(1,RI), |
|
E100_STRUCT_PORT(1,DSR), E100_STRUCT_SHADOW(1,DSR), |
|
E100_STRUCT_PORT(1,CD), E100_STRUCT_SHADOW(1,CD), |
|
E100_STRUCT_MASK(1,DTR), |
|
E100_STRUCT_MASK(1,RI), |
|
E100_STRUCT_MASK(1,DSR), |
|
E100_STRUCT_MASK(1,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(1) |
|
#endif |
|
}, |
|
|
|
/* Ser 2 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT2 |
|
E100_STRUCT_PORT(2,DTR), E100_STRUCT_SHADOW(2,DTR), |
|
E100_STRUCT_PORT(2,RI), E100_STRUCT_SHADOW(2,RI), |
|
E100_STRUCT_PORT(2,DSR), E100_STRUCT_SHADOW(2,DSR), |
|
E100_STRUCT_PORT(2,CD), E100_STRUCT_SHADOW(2,CD), |
|
E100_STRUCT_MASK(2,DTR), |
|
E100_STRUCT_MASK(2,RI), |
|
E100_STRUCT_MASK(2,DSR), |
|
E100_STRUCT_MASK(2,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(2) |
|
#endif |
|
}, |
|
|
|
/* Ser 3 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT3 |
|
E100_STRUCT_PORT(3,DTR), E100_STRUCT_SHADOW(3,DTR), |
|
E100_STRUCT_PORT(3,RI), E100_STRUCT_SHADOW(3,RI), |
|
E100_STRUCT_PORT(3,DSR), E100_STRUCT_SHADOW(3,DSR), |
|
E100_STRUCT_PORT(3,CD), E100_STRUCT_SHADOW(3,CD), |
|
E100_STRUCT_MASK(3,DTR), |
|
E100_STRUCT_MASK(3,RI), |
|
E100_STRUCT_MASK(3,DSR), |
|
E100_STRUCT_MASK(3,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(3) |
|
#endif |
|
} |
|
}; |
|
#else /* ETRAX_SERX_DTR_RI_DSR_CD_MIXED */ |
|
|
|
/* All pins are on either PA or PB for each serial port */ |
|
#define CONTROL_PINS_PORT_NOT_USED(line) \ |
|
&dummy_ser[line], &dummy_ser[line], \ |
|
DUMMY_DTR_MASK, DUMMY_RI_MASK, DUMMY_DSR_MASK, DUMMY_CD_MASK |
|
|
|
|
|
struct control_pins |
|
{ |
|
volatile unsigned char *port; |
|
unsigned char *shadow; |
|
|
|
unsigned char dtr_mask; |
|
unsigned char ri_mask; |
|
unsigned char dsr_mask; |
|
unsigned char cd_mask; |
|
}; |
|
|
|
#define dtr_port port |
|
#define dtr_shadow shadow |
|
#define ri_port port |
|
#define ri_shadow shadow |
|
#define dsr_port port |
|
#define dsr_shadow shadow |
|
#define cd_port port |
|
#define cd_shadow shadow |
|
|
|
static const struct control_pins e100_modem_pins[NR_PORTS] = |
|
{ |
|
/* Ser 0 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT0 |
|
E100_STRUCT_PORT(0,DTR), E100_STRUCT_SHADOW(0,DTR), |
|
E100_STRUCT_MASK(0,DTR), |
|
E100_STRUCT_MASK(0,RI), |
|
E100_STRUCT_MASK(0,DSR), |
|
E100_STRUCT_MASK(0,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(0) |
|
#endif |
|
}, |
|
|
|
/* Ser 1 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT1 |
|
E100_STRUCT_PORT(1,DTR), E100_STRUCT_SHADOW(1,DTR), |
|
E100_STRUCT_MASK(1,DTR), |
|
E100_STRUCT_MASK(1,RI), |
|
E100_STRUCT_MASK(1,DSR), |
|
E100_STRUCT_MASK(1,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(1) |
|
#endif |
|
}, |
|
|
|
/* Ser 2 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT2 |
|
E100_STRUCT_PORT(2,DTR), E100_STRUCT_SHADOW(2,DTR), |
|
E100_STRUCT_MASK(2,DTR), |
|
E100_STRUCT_MASK(2,RI), |
|
E100_STRUCT_MASK(2,DSR), |
|
E100_STRUCT_MASK(2,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(2) |
|
#endif |
|
}, |
|
|
|
/* Ser 3 */ |
|
{ |
|
#ifdef CONFIG_ETRAX_SERIAL_PORT3 |
|
E100_STRUCT_PORT(3,DTR), E100_STRUCT_SHADOW(3,DTR), |
|
E100_STRUCT_MASK(3,DTR), |
|
E100_STRUCT_MASK(3,RI), |
|
E100_STRUCT_MASK(3,DSR), |
|
E100_STRUCT_MASK(3,CD) |
|
#else |
|
CONTROL_PINS_PORT_NOT_USED(3) |
|
#endif |
|
} |
|
}; |
|
#endif /* !ETRAX_SERX_DTR_RI_DSR_CD_MIXED */ |
|
|
|
#define E100_RTS_MASK 0x20 |
|
#define E100_CTS_MASK 0x40 |
|
|
|
/* All serial port signals are active low: |
|
* active = 0 -> 3.3V to RS-232 driver -> -12V on RS-232 level |
|
* inactive = 1 -> 0V to RS-232 driver -> +12V on RS-232 level |
|
* |
|
* These macros returns the pin value: 0=0V, >=1 = 3.3V on ETRAX chip |
|
*/ |
|
|
|
/* Output */ |
|
#define E100_RTS_GET(info) ((info)->rx_ctrl & E100_RTS_MASK) |
|
/* Input */ |
|
#define E100_CTS_GET(info) ((info)->ioport[REG_STATUS] & E100_CTS_MASK) |
|
|
|
/* These are typically PA or PB and 0 means 0V, 1 means 3.3V */ |
|
/* Is an output */ |
|
#define E100_DTR_GET(info) ((*e100_modem_pins[(info)->line].dtr_shadow) & e100_modem_pins[(info)->line].dtr_mask) |
|
|
|
/* Normally inputs */ |
|
#define E100_RI_GET(info) ((*e100_modem_pins[(info)->line].ri_port) & e100_modem_pins[(info)->line].ri_mask) |
|
#define E100_CD_GET(info) ((*e100_modem_pins[(info)->line].cd_port) & e100_modem_pins[(info)->line].cd_mask) |
|
|
|
/* Input */ |
|
#define E100_DSR_GET(info) ((*e100_modem_pins[(info)->line].dsr_port) & e100_modem_pins[(info)->line].dsr_mask) |
|
|
|
/* Calculate the chartime depending on baudrate, numbor of bits etc. */ |
|
static void update_char_time(struct e100_serial * info) |
|
{ |
|
tcflag_t cflags = info->port.tty->termios.c_cflag; |
|
int bits; |
|
|
|
/* calc. number of bits / data byte */ |
|
/* databits + startbit and 1 stopbit */ |
|
if ((cflags & CSIZE) == CS7) |
|
bits = 9; |
|
else |
|
bits = 10; |
|
|
|
if (cflags & CSTOPB) /* 2 stopbits ? */ |
|
bits++; |
|
|
|
if (cflags & PARENB) /* parity bit ? */ |
|
bits++; |
|
|
|
/* calc timeout */ |
|
info->char_time_usec = ((bits * 1000000) / info->baud) + 1; |
|
info->flush_time_usec = 4*info->char_time_usec; |
|
if (info->flush_time_usec < MIN_FLUSH_TIME_USEC) |
|
info->flush_time_usec = MIN_FLUSH_TIME_USEC; |
|
|
|
} |
|
|
|
/* |
|
* This function maps from the Bxxxx defines in asm/termbits.h into real |
|
* baud rates. |
|
*/ |
|
|
|
static int |
|
cflag_to_baud(unsigned int cflag) |
|
{ |
|
static int baud_table[] = { |
|
0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, |
|
4800, 9600, 19200, 38400 }; |
|
|
|
static int ext_baud_table[] = { |
|
0, 57600, 115200, 230400, 460800, 921600, 1843200, 6250000, |
|
0, 0, 0, 0, 0, 0, 0, 0 }; |
|
|
|
if (cflag & CBAUDEX) |
|
return ext_baud_table[(cflag & CBAUD) & ~CBAUDEX]; |
|
else |
|
return baud_table[cflag & CBAUD]; |
|
} |
|
|
|
/* and this maps to an etrax100 hardware baud constant */ |
|
|
|
static unsigned char |
|
cflag_to_etrax_baud(unsigned int cflag) |
|
{ |
|
char retval; |
|
|
|
static char baud_table[] = { |
|
-1, -1, -1, -1, -1, -1, -1, 0, 1, 2, -1, 3, 4, 5, 6, 7 }; |
|
|
|
static char ext_baud_table[] = { |
|
-1, 8, 9, 10, 11, 12, 13, 14, -1, -1, -1, -1, -1, -1, -1, -1 }; |
|
|
|
if (cflag & CBAUDEX) |
|
retval = ext_baud_table[(cflag & CBAUD) & ~CBAUDEX]; |
|
else |
|
retval = baud_table[cflag & CBAUD]; |
|
|
|
if (retval < 0) { |
|
printk(KERN_WARNING "serdriver tried setting invalid baud rate, flags %x.\n", cflag); |
|
retval = 5; /* choose default 9600 instead */ |
|
} |
|
|
|
return retval | (retval << 4); /* choose same for both TX and RX */ |
|
} |
|
|
|
|
|
/* Various static support functions */ |
|
|
|
/* Functions to set or clear DTR/RTS on the requested line */ |
|
/* It is complicated by the fact that RTS is a serial port register, while |
|
* DTR might not be implemented in the HW at all, and if it is, it can be on |
|
* any general port. |
|
*/ |
|
|
|
|
|
static inline void |
|
e100_dtr(struct e100_serial *info, int set) |
|
{ |
|
unsigned char mask = e100_modem_pins[info->line].dtr_mask; |
|
|
|
#ifdef SERIAL_DEBUG_IO |
|
printk("ser%i dtr %i mask: 0x%02X\n", info->line, set, mask); |
|
printk("ser%i shadow before 0x%02X get: %i\n", |
|
info->line, *e100_modem_pins[info->line].dtr_shadow, |
|
E100_DTR_GET(info)); |
|
#endif |
|
/* DTR is active low */ |
|
{ |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
*e100_modem_pins[info->line].dtr_shadow &= ~mask; |
|
*e100_modem_pins[info->line].dtr_shadow |= (set ? 0 : mask); |
|
*e100_modem_pins[info->line].dtr_port = *e100_modem_pins[info->line].dtr_shadow; |
|
local_irq_restore(flags); |
|
} |
|
|
|
#ifdef SERIAL_DEBUG_IO |
|
printk("ser%i shadow after 0x%02X get: %i\n", |
|
info->line, *e100_modem_pins[info->line].dtr_shadow, |
|
E100_DTR_GET(info)); |
|
#endif |
|
} |
|
|
|
/* set = 0 means 3.3V on the pin, bitvalue: 0=active, 1=inactive |
|
* 0=0V , 1=3.3V |
|
*/ |
|
static inline void |
|
e100_rts(struct e100_serial *info, int set) |
|
{ |
|
unsigned long flags; |
|
local_irq_save(flags); |
|
info->rx_ctrl &= ~E100_RTS_MASK; |
|
info->rx_ctrl |= (set ? 0 : E100_RTS_MASK); /* RTS is active low */ |
|
info->ioport[REG_REC_CTRL] = info->rx_ctrl; |
|
local_irq_restore(flags); |
|
#ifdef SERIAL_DEBUG_IO |
|
printk("ser%i rts %i\n", info->line, set); |
|
#endif |
|
} |
|
|
|
|
|
/* If this behaves as a modem, RI and CD is an output */ |
|
static inline void |
|
e100_ri_out(struct e100_serial *info, int set) |
|
{ |
|
/* RI is active low */ |
|
{ |
|
unsigned char mask = e100_modem_pins[info->line].ri_mask; |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
*e100_modem_pins[info->line].ri_shadow &= ~mask; |
|
*e100_modem_pins[info->line].ri_shadow |= (set ? 0 : mask); |
|
*e100_modem_pins[info->line].ri_port = *e100_modem_pins[info->line].ri_shadow; |
|
local_irq_restore(flags); |
|
} |
|
} |
|
static inline void |
|
e100_cd_out(struct e100_serial *info, int set) |
|
{ |
|
/* CD is active low */ |
|
{ |
|
unsigned char mask = e100_modem_pins[info->line].cd_mask; |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
*e100_modem_pins[info->line].cd_shadow &= ~mask; |
|
*e100_modem_pins[info->line].cd_shadow |= (set ? 0 : mask); |
|
*e100_modem_pins[info->line].cd_port = *e100_modem_pins[info->line].cd_shadow; |
|
local_irq_restore(flags); |
|
} |
|
} |
|
|
|
static inline void |
|
e100_disable_rx(struct e100_serial *info) |
|
{ |
|
/* disable the receiver */ |
|
info->ioport[REG_REC_CTRL] = |
|
(info->rx_ctrl &= ~IO_MASK(R_SERIAL0_REC_CTRL, rec_enable)); |
|
} |
|
|
|
static inline void |
|
e100_enable_rx(struct e100_serial *info) |
|
{ |
|
/* enable the receiver */ |
|
info->ioport[REG_REC_CTRL] = |
|
(info->rx_ctrl |= IO_MASK(R_SERIAL0_REC_CTRL, rec_enable)); |
|
} |
|
|
|
/* the rx DMA uses both the dma_descr and the dma_eop interrupts */ |
|
|
|
static inline void |
|
e100_disable_rxdma_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("rxdma_irq(%d): 0\n",info->line); |
|
#endif |
|
DINTR1(DEBUG_LOG(info->line,"IRQ disable_rxdma_irq %i\n", info->line)); |
|
*R_IRQ_MASK2_CLR = (info->irq << 2) | (info->irq << 3); |
|
} |
|
|
|
static inline void |
|
e100_enable_rxdma_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("rxdma_irq(%d): 1\n",info->line); |
|
#endif |
|
DINTR1(DEBUG_LOG(info->line,"IRQ enable_rxdma_irq %i\n", info->line)); |
|
*R_IRQ_MASK2_SET = (info->irq << 2) | (info->irq << 3); |
|
} |
|
|
|
/* the tx DMA uses only dma_descr interrupt */ |
|
|
|
static void e100_disable_txdma_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("txdma_irq(%d): 0\n",info->line); |
|
#endif |
|
DINTR1(DEBUG_LOG(info->line,"IRQ disable_txdma_irq %i\n", info->line)); |
|
*R_IRQ_MASK2_CLR = info->irq; |
|
} |
|
|
|
static void e100_enable_txdma_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("txdma_irq(%d): 1\n",info->line); |
|
#endif |
|
DINTR1(DEBUG_LOG(info->line,"IRQ enable_txdma_irq %i\n", info->line)); |
|
*R_IRQ_MASK2_SET = info->irq; |
|
} |
|
|
|
static void e100_disable_txdma_channel(struct e100_serial *info) |
|
{ |
|
unsigned long flags; |
|
|
|
/* Disable output DMA channel for the serial port in question |
|
* ( set to something other than serialX) |
|
*/ |
|
local_irq_save(flags); |
|
DFLOW(DEBUG_LOG(info->line, "disable_txdma_channel %i\n", info->line)); |
|
if (info->line == 0) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma6)) == |
|
IO_STATE(R_GEN_CONFIG, dma6, serial0)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma6); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma6, unused); |
|
} |
|
} else if (info->line == 1) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma8)) == |
|
IO_STATE(R_GEN_CONFIG, dma8, serial1)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma8); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma8, usb); |
|
} |
|
} else if (info->line == 2) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma2)) == |
|
IO_STATE(R_GEN_CONFIG, dma2, serial2)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma2); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma2, par0); |
|
} |
|
} else if (info->line == 3) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma4)) == |
|
IO_STATE(R_GEN_CONFIG, dma4, serial3)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma4); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma4, par1); |
|
} |
|
} |
|
*R_GEN_CONFIG = genconfig_shadow; |
|
local_irq_restore(flags); |
|
} |
|
|
|
|
|
static void e100_enable_txdma_channel(struct e100_serial *info) |
|
{ |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
DFLOW(DEBUG_LOG(info->line, "enable_txdma_channel %i\n", info->line)); |
|
/* Enable output DMA channel for the serial port in question */ |
|
if (info->line == 0) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma6); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma6, serial0); |
|
} else if (info->line == 1) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma8); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma8, serial1); |
|
} else if (info->line == 2) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma2); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma2, serial2); |
|
} else if (info->line == 3) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma4); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma4, serial3); |
|
} |
|
*R_GEN_CONFIG = genconfig_shadow; |
|
local_irq_restore(flags); |
|
} |
|
|
|
static void e100_disable_rxdma_channel(struct e100_serial *info) |
|
{ |
|
unsigned long flags; |
|
|
|
/* Disable input DMA channel for the serial port in question |
|
* ( set to something other than serialX) |
|
*/ |
|
local_irq_save(flags); |
|
if (info->line == 0) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma7)) == |
|
IO_STATE(R_GEN_CONFIG, dma7, serial0)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma7); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma7, unused); |
|
} |
|
} else if (info->line == 1) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma9)) == |
|
IO_STATE(R_GEN_CONFIG, dma9, serial1)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma9); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma9, usb); |
|
} |
|
} else if (info->line == 2) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma3)) == |
|
IO_STATE(R_GEN_CONFIG, dma3, serial2)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma3); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma3, par0); |
|
} |
|
} else if (info->line == 3) { |
|
if ((genconfig_shadow & IO_MASK(R_GEN_CONFIG, dma5)) == |
|
IO_STATE(R_GEN_CONFIG, dma5, serial3)) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma5); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma5, par1); |
|
} |
|
} |
|
*R_GEN_CONFIG = genconfig_shadow; |
|
local_irq_restore(flags); |
|
} |
|
|
|
|
|
static void e100_enable_rxdma_channel(struct e100_serial *info) |
|
{ |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
/* Enable input DMA channel for the serial port in question */ |
|
if (info->line == 0) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma7); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma7, serial0); |
|
} else if (info->line == 1) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma9); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma9, serial1); |
|
} else if (info->line == 2) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma3); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma3, serial2); |
|
} else if (info->line == 3) { |
|
genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma5); |
|
genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma5, serial3); |
|
} |
|
*R_GEN_CONFIG = genconfig_shadow; |
|
local_irq_restore(flags); |
|
} |
|
|
|
#ifdef SERIAL_HANDLE_EARLY_ERRORS |
|
/* in order to detect and fix errors on the first byte |
|
we have to use the serial interrupts as well. */ |
|
|
|
static inline void |
|
e100_disable_serial_data_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("ser_irq(%d): 0\n",info->line); |
|
#endif |
|
DINTR1(DEBUG_LOG(info->line,"IRQ disable data_irq %i\n", info->line)); |
|
*R_IRQ_MASK1_CLR = (1U << (8+2*info->line)); |
|
} |
|
|
|
static inline void |
|
e100_enable_serial_data_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("ser_irq(%d): 1\n",info->line); |
|
printk("**** %d = %d\n", |
|
(8+2*info->line), |
|
(1U << (8+2*info->line))); |
|
#endif |
|
DINTR1(DEBUG_LOG(info->line,"IRQ enable data_irq %i\n", info->line)); |
|
*R_IRQ_MASK1_SET = (1U << (8+2*info->line)); |
|
} |
|
#endif |
|
|
|
static inline void |
|
e100_disable_serial_tx_ready_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("ser_tx_irq(%d): 0\n",info->line); |
|
#endif |
|
DINTR1(DEBUG_LOG(info->line,"IRQ disable ready_irq %i\n", info->line)); |
|
*R_IRQ_MASK1_CLR = (1U << (8+1+2*info->line)); |
|
} |
|
|
|
static inline void |
|
e100_enable_serial_tx_ready_irq(struct e100_serial *info) |
|
{ |
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("ser_tx_irq(%d): 1\n",info->line); |
|
printk("**** %d = %d\n", |
|
(8+1+2*info->line), |
|
(1U << (8+1+2*info->line))); |
|
#endif |
|
DINTR2(DEBUG_LOG(info->line,"IRQ enable ready_irq %i\n", info->line)); |
|
*R_IRQ_MASK1_SET = (1U << (8+1+2*info->line)); |
|
} |
|
|
|
static inline void e100_enable_rx_irq(struct e100_serial *info) |
|
{ |
|
if (info->uses_dma_in) |
|
e100_enable_rxdma_irq(info); |
|
else |
|
e100_enable_serial_data_irq(info); |
|
} |
|
static inline void e100_disable_rx_irq(struct e100_serial *info) |
|
{ |
|
if (info->uses_dma_in) |
|
e100_disable_rxdma_irq(info); |
|
else |
|
e100_disable_serial_data_irq(info); |
|
} |
|
|
|
#if defined(CONFIG_ETRAX_RS485) |
|
/* Enable RS-485 mode on selected port. This is UGLY. */ |
|
static int |
|
e100_enable_rs485(struct tty_struct *tty, struct serial_rs485 *r) |
|
{ |
|
struct e100_serial * info = (struct e100_serial *)tty->driver_data; |
|
|
|
#if defined(CONFIG_ETRAX_RS485_ON_PA) |
|
*R_PORT_PA_DATA = port_pa_data_shadow |= (1 << rs485_pa_bit); |
|
#endif |
|
|
|
info->rs485 = *r; |
|
|
|
/* Maximum delay before RTS equal to 1000 */ |
|
if (info->rs485.delay_rts_before_send >= 1000) |
|
info->rs485.delay_rts_before_send = 1000; |
|
|
|
/* printk("rts: on send = %i, after = %i, enabled = %i", |
|
info->rs485.rts_on_send, |
|
info->rs485.rts_after_sent, |
|
info->rs485.enabled |
|
); |
|
*/ |
|
return 0; |
|
} |
|
|
|
static int |
|
e100_write_rs485(struct tty_struct *tty, |
|
const unsigned char *buf, int count) |
|
{ |
|
struct e100_serial * info = (struct e100_serial *)tty->driver_data; |
|
int old_value = (info->rs485.flags) & SER_RS485_ENABLED; |
|
|
|
/* rs485 is always implicitly enabled if we're using the ioctl() |
|
* but it doesn't have to be set in the serial_rs485 |
|
* (to be backward compatible with old apps) |
|
* So we store, set and restore it. |
|
*/ |
|
info->rs485.flags |= SER_RS485_ENABLED; |
|
/* rs_write now deals with RS485 if enabled */ |
|
count = rs_write(tty, buf, count); |
|
if (!old_value) |
|
info->rs485.flags &= ~(SER_RS485_ENABLED); |
|
return count; |
|
} |
|
|
|
#ifdef CONFIG_ETRAX_FAST_TIMER |
|
/* Timer function to toggle RTS when using FAST_TIMER */ |
|
static void rs485_toggle_rts_timer_function(unsigned long data) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)data; |
|
|
|
fast_timers_rs485[info->line].function = NULL; |
|
e100_rts(info, (info->rs485.flags & SER_RS485_RTS_AFTER_SEND)); |
|
#if defined(CONFIG_ETRAX_RS485_DISABLE_RECEIVER) |
|
e100_enable_rx(info); |
|
e100_enable_rx_irq(info); |
|
#endif |
|
} |
|
#endif |
|
#endif /* CONFIG_ETRAX_RS485 */ |
|
|
|
/* |
|
* ------------------------------------------------------------ |
|
* rs_stop() and rs_start() |
|
* |
|
* This routines are called before setting or resetting tty->stopped. |
|
* They enable or disable transmitter using the XOFF registers, as necessary. |
|
* ------------------------------------------------------------ |
|
*/ |
|
|
|
static void |
|
rs_stop(struct tty_struct *tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
if (info) { |
|
unsigned long flags; |
|
unsigned long xoff; |
|
|
|
local_irq_save(flags); |
|
DFLOW(DEBUG_LOG(info->line, "XOFF rs_stop xmit %i\n", |
|
CIRC_CNT(info->xmit.head, |
|
info->xmit.tail,SERIAL_XMIT_SIZE))); |
|
|
|
xoff = IO_FIELD(R_SERIAL0_XOFF, xoff_char, |
|
STOP_CHAR(info->port.tty)); |
|
xoff |= IO_STATE(R_SERIAL0_XOFF, tx_stop, stop); |
|
if (tty->termios.c_iflag & IXON ) { |
|
xoff |= IO_STATE(R_SERIAL0_XOFF, auto_xoff, enable); |
|
} |
|
|
|
*((unsigned long *)&info->ioport[REG_XOFF]) = xoff; |
|
local_irq_restore(flags); |
|
} |
|
} |
|
|
|
static void |
|
rs_start(struct tty_struct *tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
if (info) { |
|
unsigned long flags; |
|
unsigned long xoff; |
|
|
|
local_irq_save(flags); |
|
DFLOW(DEBUG_LOG(info->line, "XOFF rs_start xmit %i\n", |
|
CIRC_CNT(info->xmit.head, |
|
info->xmit.tail,SERIAL_XMIT_SIZE))); |
|
xoff = IO_FIELD(R_SERIAL0_XOFF, xoff_char, STOP_CHAR(tty)); |
|
xoff |= IO_STATE(R_SERIAL0_XOFF, tx_stop, enable); |
|
if (tty->termios.c_iflag & IXON ) { |
|
xoff |= IO_STATE(R_SERIAL0_XOFF, auto_xoff, enable); |
|
} |
|
|
|
*((unsigned long *)&info->ioport[REG_XOFF]) = xoff; |
|
if (!info->uses_dma_out && |
|
info->xmit.head != info->xmit.tail && info->xmit.buf) |
|
e100_enable_serial_tx_ready_irq(info); |
|
|
|
local_irq_restore(flags); |
|
} |
|
} |
|
|
|
/* |
|
* ---------------------------------------------------------------------- |
|
* |
|
* Here starts the interrupt handling routines. All of the following |
|
* subroutines are declared as inline and are folded into |
|
* rs_interrupt(). They were separated out for readability's sake. |
|
* |
|
* Note: rs_interrupt() is a "fast" interrupt, which means that it |
|
* runs with interrupts turned off. People who may want to modify |
|
* rs_interrupt() should try to keep the interrupt handler as fast as |
|
* possible. After you are done making modifications, it is not a bad |
|
* idea to do: |
|
* |
|
* gcc -S -DKERNEL -Wall -Wstrict-prototypes -O6 -fomit-frame-pointer serial.c |
|
* |
|
* and look at the resulting assemble code in serial.s. |
|
* |
|
* - Ted Ts'o (tytso@mit.edu), 7-Mar-93 |
|
* ----------------------------------------------------------------------- |
|
*/ |
|
|
|
/* |
|
* This routine is used by the interrupt handler to schedule |
|
* processing in the software interrupt portion of the driver. |
|
*/ |
|
static void rs_sched_event(struct e100_serial *info, int event) |
|
{ |
|
if (info->event & (1 << event)) |
|
return; |
|
info->event |= 1 << event; |
|
schedule_work(&info->work); |
|
} |
|
|
|
/* The output DMA channel is free - use it to send as many chars as possible |
|
* NOTES: |
|
* We don't pay attention to info->x_char, which means if the TTY wants to |
|
* use XON/XOFF it will set info->x_char but we won't send any X char! |
|
* |
|
* To implement this, we'd just start a DMA send of 1 byte pointing at a |
|
* buffer containing the X char, and skip updating xmit. We'd also have to |
|
* check if the last sent char was the X char when we enter this function |
|
* the next time, to avoid updating xmit with the sent X value. |
|
*/ |
|
|
|
static void |
|
transmit_chars_dma(struct e100_serial *info) |
|
{ |
|
unsigned int c, sentl; |
|
struct etrax_dma_descr *descr; |
|
|
|
/* acknowledge both dma_descr and dma_eop irq in R_DMA_CHx_CLR_INTR */ |
|
*info->oclrintradr = |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_descr, do) | |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_eop, do); |
|
|
|
#ifdef SERIAL_DEBUG_INTR |
|
if (info->line == SERIAL_DEBUG_LINE) |
|
printk("tc\n"); |
|
#endif |
|
if (!info->tr_running) { |
|
/* weirdo... we shouldn't get here! */ |
|
printk(KERN_WARNING "Achtung: transmit_chars_dma with !tr_running\n"); |
|
return; |
|
} |
|
|
|
descr = &info->tr_descr; |
|
|
|
/* first get the amount of bytes sent during the last DMA transfer, |
|
and update xmit accordingly */ |
|
|
|
/* if the stop bit was not set, all data has been sent */ |
|
if (!(descr->status & d_stop)) { |
|
sentl = descr->sw_len; |
|
} else |
|
/* otherwise we find the amount of data sent here */ |
|
sentl = descr->hw_len; |
|
|
|
DFLOW(DEBUG_LOG(info->line, "TX %i done\n", sentl)); |
|
|
|
/* update stats */ |
|
info->icount.tx += sentl; |
|
|
|
/* update xmit buffer */ |
|
info->xmit.tail = (info->xmit.tail + sentl) & (SERIAL_XMIT_SIZE - 1); |
|
|
|
/* if there is only a few chars left in the buf, wake up the blocked |
|
write if any */ |
|
if (CIRC_CNT(info->xmit.head, |
|
info->xmit.tail, |
|
SERIAL_XMIT_SIZE) < WAKEUP_CHARS) |
|
rs_sched_event(info, RS_EVENT_WRITE_WAKEUP); |
|
|
|
/* find out the largest amount of consecutive bytes we want to send now */ |
|
|
|
c = CIRC_CNT_TO_END(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE); |
|
|
|
/* Don't send all in one DMA transfer - divide it so we wake up |
|
* application before all is sent |
|
*/ |
|
|
|
if (c >= 4*WAKEUP_CHARS) |
|
c = c/2; |
|
|
|
if (c <= 0) { |
|
/* our job here is done, don't schedule any new DMA transfer */ |
|
info->tr_running = 0; |
|
|
|
#if defined(CONFIG_ETRAX_RS485) && defined(CONFIG_ETRAX_FAST_TIMER) |
|
if (info->rs485.flags & SER_RS485_ENABLED) { |
|
/* Set a short timer to toggle RTS */ |
|
start_one_shot_timer(&fast_timers_rs485[info->line], |
|
rs485_toggle_rts_timer_function, |
|
(unsigned long)info, |
|
info->char_time_usec*2, |
|
"RS-485"); |
|
} |
|
#endif /* RS485 */ |
|
return; |
|
} |
|
|
|
/* ok we can schedule a dma send of c chars starting at info->xmit.tail */ |
|
/* set up the descriptor correctly for output */ |
|
DFLOW(DEBUG_LOG(info->line, "TX %i\n", c)); |
|
descr->ctrl = d_int | d_eol | d_wait; /* Wait needed for tty_wait_until_sent() */ |
|
descr->sw_len = c; |
|
descr->buf = virt_to_phys(info->xmit.buf + info->xmit.tail); |
|
descr->status = 0; |
|
|
|
*info->ofirstadr = virt_to_phys(descr); /* write to R_DMAx_FIRST */ |
|
*info->ocmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, start); |
|
|
|
/* DMA is now running (hopefully) */ |
|
} /* transmit_chars_dma */ |
|
|
|
static void |
|
start_transmit(struct e100_serial *info) |
|
{ |
|
#if 0 |
|
if (info->line == SERIAL_DEBUG_LINE) |
|
printk("x\n"); |
|
#endif |
|
|
|
info->tr_descr.sw_len = 0; |
|
info->tr_descr.hw_len = 0; |
|
info->tr_descr.status = 0; |
|
info->tr_running = 1; |
|
if (info->uses_dma_out) |
|
transmit_chars_dma(info); |
|
else |
|
e100_enable_serial_tx_ready_irq(info); |
|
} /* start_transmit */ |
|
|
|
#ifdef CONFIG_ETRAX_SERIAL_FAST_TIMER |
|
static int serial_fast_timer_started = 0; |
|
static int serial_fast_timer_expired = 0; |
|
static void flush_timeout_function(unsigned long data); |
|
#define START_FLUSH_FAST_TIMER_TIME(info, string, usec) {\ |
|
unsigned long timer_flags; \ |
|
local_irq_save(timer_flags); \ |
|
if (fast_timers[info->line].function == NULL) { \ |
|
serial_fast_timer_started++; \ |
|
TIMERD(DEBUG_LOG(info->line, "start_timer %i ", info->line)); \ |
|
TIMERD(DEBUG_LOG(info->line, "num started: %i\n", serial_fast_timer_started)); \ |
|
start_one_shot_timer(&fast_timers[info->line], \ |
|
flush_timeout_function, \ |
|
(unsigned long)info, \ |
|
(usec), \ |
|
string); \ |
|
} \ |
|
else { \ |
|
TIMERD(DEBUG_LOG(info->line, "timer %i already running\n", info->line)); \ |
|
} \ |
|
local_irq_restore(timer_flags); \ |
|
} |
|
#define START_FLUSH_FAST_TIMER(info, string) START_FLUSH_FAST_TIMER_TIME(info, string, info->flush_time_usec) |
|
|
|
#else |
|
#define START_FLUSH_FAST_TIMER_TIME(info, string, usec) |
|
#define START_FLUSH_FAST_TIMER(info, string) |
|
#endif |
|
|
|
static struct etrax_recv_buffer * |
|
alloc_recv_buffer(unsigned int size) |
|
{ |
|
struct etrax_recv_buffer *buffer; |
|
|
|
buffer = kmalloc(sizeof *buffer + size, GFP_ATOMIC); |
|
if (!buffer) |
|
return NULL; |
|
|
|
buffer->next = NULL; |
|
buffer->length = 0; |
|
buffer->error = TTY_NORMAL; |
|
|
|
return buffer; |
|
} |
|
|
|
static void |
|
append_recv_buffer(struct e100_serial *info, struct etrax_recv_buffer *buffer) |
|
{ |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
|
|
if (!info->first_recv_buffer) |
|
info->first_recv_buffer = buffer; |
|
else |
|
info->last_recv_buffer->next = buffer; |
|
|
|
info->last_recv_buffer = buffer; |
|
|
|
info->recv_cnt += buffer->length; |
|
if (info->recv_cnt > info->max_recv_cnt) |
|
info->max_recv_cnt = info->recv_cnt; |
|
|
|
local_irq_restore(flags); |
|
} |
|
|
|
static int |
|
add_char_and_flag(struct e100_serial *info, unsigned char data, unsigned char flag) |
|
{ |
|
struct etrax_recv_buffer *buffer; |
|
if (info->uses_dma_in) { |
|
buffer = alloc_recv_buffer(4); |
|
if (!buffer) |
|
return 0; |
|
|
|
buffer->length = 1; |
|
buffer->error = flag; |
|
buffer->buffer[0] = data; |
|
|
|
append_recv_buffer(info, buffer); |
|
|
|
info->icount.rx++; |
|
} else { |
|
tty_insert_flip_char(&info->port, data, flag); |
|
info->icount.rx++; |
|
} |
|
|
|
return 1; |
|
} |
|
|
|
static unsigned int handle_descr_data(struct e100_serial *info, |
|
struct etrax_dma_descr *descr, |
|
unsigned int recvl) |
|
{ |
|
struct etrax_recv_buffer *buffer = phys_to_virt(descr->buf) - sizeof *buffer; |
|
|
|
if (info->recv_cnt + recvl > 65536) { |
|
printk(KERN_WARNING |
|
"%s: Too much pending incoming serial data! Dropping %u bytes.\n", __func__, recvl); |
|
return 0; |
|
} |
|
|
|
buffer->length = recvl; |
|
|
|
if (info->errorcode == ERRCODE_SET_BREAK) |
|
buffer->error = TTY_BREAK; |
|
info->errorcode = 0; |
|
|
|
append_recv_buffer(info, buffer); |
|
|
|
buffer = alloc_recv_buffer(SERIAL_DESCR_BUF_SIZE); |
|
if (!buffer) |
|
panic("%s: Failed to allocate memory for receive buffer!\n", __func__); |
|
|
|
descr->buf = virt_to_phys(buffer->buffer); |
|
|
|
return recvl; |
|
} |
|
|
|
static unsigned int handle_all_descr_data(struct e100_serial *info) |
|
{ |
|
struct etrax_dma_descr *descr; |
|
unsigned int recvl; |
|
unsigned int ret = 0; |
|
|
|
while (1) |
|
{ |
|
descr = &info->rec_descr[info->cur_rec_descr]; |
|
|
|
if (descr == phys_to_virt(*info->idescradr)) |
|
break; |
|
|
|
if (++info->cur_rec_descr == SERIAL_RECV_DESCRIPTORS) |
|
info->cur_rec_descr = 0; |
|
|
|
/* find out how many bytes were read */ |
|
|
|
/* if the eop bit was not set, all data has been received */ |
|
if (!(descr->status & d_eop)) { |
|
recvl = descr->sw_len; |
|
} else { |
|
/* otherwise we find the amount of data received here */ |
|
recvl = descr->hw_len; |
|
} |
|
|
|
/* Reset the status information */ |
|
descr->status = 0; |
|
|
|
DFLOW( DEBUG_LOG(info->line, "RX %lu\n", recvl); |
|
if (info->port.tty->stopped) { |
|
unsigned char *buf = phys_to_virt(descr->buf); |
|
DEBUG_LOG(info->line, "rx 0x%02X\n", buf[0]); |
|
DEBUG_LOG(info->line, "rx 0x%02X\n", buf[1]); |
|
DEBUG_LOG(info->line, "rx 0x%02X\n", buf[2]); |
|
} |
|
); |
|
|
|
/* update stats */ |
|
info->icount.rx += recvl; |
|
|
|
ret += handle_descr_data(info, descr, recvl); |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static void receive_chars_dma(struct e100_serial *info) |
|
{ |
|
struct tty_struct *tty; |
|
unsigned char rstat; |
|
|
|
/* Acknowledge both dma_descr and dma_eop irq in R_DMA_CHx_CLR_INTR */ |
|
*info->iclrintradr = |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_descr, do) | |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_eop, do); |
|
|
|
tty = info->port.tty; |
|
if (!tty) /* Something wrong... */ |
|
return; |
|
|
|
#ifdef SERIAL_HANDLE_EARLY_ERRORS |
|
if (info->uses_dma_in) |
|
e100_enable_serial_data_irq(info); |
|
#endif |
|
|
|
if (info->errorcode == ERRCODE_INSERT_BREAK) |
|
add_char_and_flag(info, '\0', TTY_BREAK); |
|
|
|
handle_all_descr_data(info); |
|
|
|
/* Read the status register to detect errors */ |
|
rstat = info->ioport[REG_STATUS]; |
|
if (rstat & IO_MASK(R_SERIAL0_STATUS, xoff_detect) ) { |
|
DFLOW(DEBUG_LOG(info->line, "XOFF detect stat %x\n", rstat)); |
|
} |
|
|
|
if (rstat & SER_ERROR_MASK) { |
|
/* If we got an error, we must reset it by reading the |
|
* data_in field |
|
*/ |
|
unsigned char data = info->ioport[REG_DATA]; |
|
|
|
DEBUG_LOG(info->line, "#dERR: s d 0x%04X\n", |
|
((rstat & SER_ERROR_MASK) << 8) | data); |
|
|
|
if (rstat & SER_PAR_ERR_MASK) |
|
add_char_and_flag(info, data, TTY_PARITY); |
|
else if (rstat & SER_OVERRUN_MASK) |
|
add_char_and_flag(info, data, TTY_OVERRUN); |
|
else if (rstat & SER_FRAMING_ERR_MASK) |
|
add_char_and_flag(info, data, TTY_FRAME); |
|
} |
|
|
|
START_FLUSH_FAST_TIMER(info, "receive_chars"); |
|
|
|
/* Restart the receiving DMA */ |
|
*info->icmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, restart); |
|
} |
|
|
|
static int start_recv_dma(struct e100_serial *info) |
|
{ |
|
struct etrax_dma_descr *descr = info->rec_descr; |
|
struct etrax_recv_buffer *buffer; |
|
int i; |
|
|
|
/* Set up the receiving descriptors */ |
|
for (i = 0; i < SERIAL_RECV_DESCRIPTORS; i++) { |
|
buffer = alloc_recv_buffer(SERIAL_DESCR_BUF_SIZE); |
|
if (!buffer) |
|
panic("%s: Failed to allocate memory for receive buffer!\n", __func__); |
|
|
|
descr[i].ctrl = d_int; |
|
descr[i].buf = virt_to_phys(buffer->buffer); |
|
descr[i].sw_len = SERIAL_DESCR_BUF_SIZE; |
|
descr[i].hw_len = 0; |
|
descr[i].status = 0; |
|
descr[i].next = virt_to_phys(&descr[i+1]); |
|
} |
|
|
|
/* Link the last descriptor to the first */ |
|
descr[i-1].next = virt_to_phys(&descr[0]); |
|
|
|
/* Start with the first descriptor in the list */ |
|
info->cur_rec_descr = 0; |
|
|
|
/* Start the DMA */ |
|
*info->ifirstadr = virt_to_phys(&descr[info->cur_rec_descr]); |
|
*info->icmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, start); |
|
|
|
/* Input DMA should be running now */ |
|
return 1; |
|
} |
|
|
|
static void |
|
start_receive(struct e100_serial *info) |
|
{ |
|
if (info->uses_dma_in) { |
|
/* reset the input dma channel to be sure it works */ |
|
|
|
*info->icmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, reset); |
|
while (IO_EXTRACT(R_DMA_CH6_CMD, cmd, *info->icmdadr) == |
|
IO_STATE_VALUE(R_DMA_CH6_CMD, cmd, reset)); |
|
|
|
start_recv_dma(info); |
|
} |
|
} |
|
|
|
|
|
/* the bits in the MASK2 register are laid out like this: |
|
DMAI_EOP DMAI_DESCR DMAO_EOP DMAO_DESCR |
|
where I is the input channel and O is the output channel for the port. |
|
info->irq is the bit number for the DMAO_DESCR so to check the others we |
|
shift info->irq to the left. |
|
*/ |
|
|
|
/* dma output channel interrupt handler |
|
this interrupt is called from DMA2(ser2), DMA4(ser3), DMA6(ser0) or |
|
DMA8(ser1) when they have finished a descriptor with the intr flag set. |
|
*/ |
|
|
|
static irqreturn_t |
|
tr_interrupt(int irq, void *dev_id) |
|
{ |
|
struct e100_serial *info; |
|
unsigned long ireg; |
|
int i; |
|
int handled = 0; |
|
|
|
/* find out the line that caused this irq and get it from rs_table */ |
|
|
|
ireg = *R_IRQ_MASK2_RD; /* get the active irq bits for the dma channels */ |
|
|
|
for (i = 0; i < NR_PORTS; i++) { |
|
info = rs_table + i; |
|
if (!info->enabled || !info->uses_dma_out) |
|
continue; |
|
/* check for dma_descr (don't need to check for dma_eop in output dma for serial */ |
|
if (ireg & info->irq) { |
|
handled = 1; |
|
/* we can send a new dma bunch. make it so. */ |
|
DINTR2(DEBUG_LOG(info->line, "tr_interrupt %i\n", i)); |
|
/* Read jiffies_usec first, |
|
* we want this time to be as late as possible |
|
*/ |
|
info->last_tx_active_usec = GET_JIFFIES_USEC(); |
|
info->last_tx_active = jiffies; |
|
transmit_chars_dma(info); |
|
} |
|
|
|
/* FIXME: here we should really check for a change in the |
|
status lines and if so call status_handle(info) */ |
|
} |
|
return IRQ_RETVAL(handled); |
|
} /* tr_interrupt */ |
|
|
|
/* dma input channel interrupt handler */ |
|
|
|
static irqreturn_t |
|
rec_interrupt(int irq, void *dev_id) |
|
{ |
|
struct e100_serial *info; |
|
unsigned long ireg; |
|
int i; |
|
int handled = 0; |
|
|
|
/* find out the line that caused this irq and get it from rs_table */ |
|
|
|
ireg = *R_IRQ_MASK2_RD; /* get the active irq bits for the dma channels */ |
|
|
|
for (i = 0; i < NR_PORTS; i++) { |
|
info = rs_table + i; |
|
if (!info->enabled || !info->uses_dma_in) |
|
continue; |
|
/* check for both dma_eop and dma_descr for the input dma channel */ |
|
if (ireg & ((info->irq << 2) | (info->irq << 3))) { |
|
handled = 1; |
|
/* we have received something */ |
|
receive_chars_dma(info); |
|
} |
|
|
|
/* FIXME: here we should really check for a change in the |
|
status lines and if so call status_handle(info) */ |
|
} |
|
return IRQ_RETVAL(handled); |
|
} /* rec_interrupt */ |
|
|
|
static int force_eop_if_needed(struct e100_serial *info) |
|
{ |
|
/* We check data_avail bit to determine if data has |
|
* arrived since last time |
|
*/ |
|
unsigned char rstat = info->ioport[REG_STATUS]; |
|
|
|
/* error or datavail? */ |
|
if (rstat & SER_ERROR_MASK) { |
|
/* Some error has occurred. If there has been valid data, an |
|
* EOP interrupt will be made automatically. If no data, the |
|
* normal ser_interrupt should be enabled and handle it. |
|
* So do nothing! |
|
*/ |
|
DEBUG_LOG(info->line, "timeout err: rstat 0x%03X\n", |
|
rstat | (info->line << 8)); |
|
return 0; |
|
} |
|
|
|
if (rstat & SER_DATA_AVAIL_MASK) { |
|
/* Ok data, no error, count it */ |
|
TIMERD(DEBUG_LOG(info->line, "timeout: rstat 0x%03X\n", |
|
rstat | (info->line << 8))); |
|
/* Read data to clear status flags */ |
|
(void)info->ioport[REG_DATA]; |
|
|
|
info->forced_eop = 0; |
|
START_FLUSH_FAST_TIMER(info, "magic"); |
|
return 0; |
|
} |
|
|
|
/* hit the timeout, force an EOP for the input |
|
* dma channel if we haven't already |
|
*/ |
|
if (!info->forced_eop) { |
|
info->forced_eop = 1; |
|
TIMERD(DEBUG_LOG(info->line, "timeout EOP %i\n", info->line)); |
|
FORCE_EOP(info); |
|
} |
|
|
|
return 1; |
|
} |
|
|
|
static void flush_to_flip_buffer(struct e100_serial *info) |
|
{ |
|
struct etrax_recv_buffer *buffer; |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
|
|
while ((buffer = info->first_recv_buffer) != NULL) { |
|
unsigned int count = buffer->length; |
|
|
|
tty_insert_flip_string(&info->port, buffer->buffer, count); |
|
info->recv_cnt -= count; |
|
|
|
if (count == buffer->length) { |
|
info->first_recv_buffer = buffer->next; |
|
kfree(buffer); |
|
} else { |
|
buffer->length -= count; |
|
memmove(buffer->buffer, buffer->buffer + count, buffer->length); |
|
buffer->error = TTY_NORMAL; |
|
} |
|
} |
|
|
|
if (!info->first_recv_buffer) |
|
info->last_recv_buffer = NULL; |
|
|
|
local_irq_restore(flags); |
|
|
|
/* This includes a check for low-latency */ |
|
tty_flip_buffer_push(&info->port); |
|
} |
|
|
|
static void check_flush_timeout(struct e100_serial *info) |
|
{ |
|
/* Flip what we've got (if we can) */ |
|
flush_to_flip_buffer(info); |
|
|
|
/* We might need to flip later, but not to fast |
|
* since the system is busy processing input... */ |
|
if (info->first_recv_buffer) |
|
START_FLUSH_FAST_TIMER_TIME(info, "flip", 2000); |
|
|
|
/* Force eop last, since data might have come while we're processing |
|
* and if we started the slow timer above, we won't start a fast |
|
* below. |
|
*/ |
|
force_eop_if_needed(info); |
|
} |
|
|
|
#ifdef CONFIG_ETRAX_SERIAL_FAST_TIMER |
|
static void flush_timeout_function(unsigned long data) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)data; |
|
|
|
fast_timers[info->line].function = NULL; |
|
serial_fast_timer_expired++; |
|
TIMERD(DEBUG_LOG(info->line, "flush_timeout %i ", info->line)); |
|
TIMERD(DEBUG_LOG(info->line, "num expired: %i\n", serial_fast_timer_expired)); |
|
check_flush_timeout(info); |
|
} |
|
|
|
#else |
|
|
|
/* dma fifo/buffer timeout handler |
|
forces an end-of-packet for the dma input channel if no chars |
|
have been received for CONFIG_ETRAX_SERIAL_RX_TIMEOUT_TICKS/100 s. |
|
*/ |
|
|
|
static struct timer_list flush_timer; |
|
|
|
static void |
|
timed_flush_handler(unsigned long ptr) |
|
{ |
|
struct e100_serial *info; |
|
int i; |
|
|
|
for (i = 0; i < NR_PORTS; i++) { |
|
info = rs_table + i; |
|
if (info->uses_dma_in) |
|
check_flush_timeout(info); |
|
} |
|
|
|
/* restart flush timer */ |
|
mod_timer(&flush_timer, jiffies + CONFIG_ETRAX_SERIAL_RX_TIMEOUT_TICKS); |
|
} |
|
#endif |
|
|
|
#ifdef SERIAL_HANDLE_EARLY_ERRORS |
|
|
|
/* If there is an error (ie break) when the DMA is running and |
|
* there are no bytes in the fifo the DMA is stopped and we get no |
|
* eop interrupt. Thus we have to monitor the first bytes on a DMA |
|
* transfer, and if it is without error we can turn the serial |
|
* interrupts off. |
|
*/ |
|
|
|
/* |
|
BREAK handling on ETRAX 100: |
|
ETRAX will generate interrupt although there is no stop bit between the |
|
characters. |
|
|
|
Depending on how long the break sequence is, the end of the breaksequence |
|
will look differently: |
|
| indicates start/end of a character. |
|
|
|
B= Break character (0x00) with framing error. |
|
E= Error byte with parity error received after B characters. |
|
F= "Faked" valid byte received immediately after B characters. |
|
V= Valid byte |
|
|
|
1. |
|
B BL ___________________________ V |
|
.._|__________|__________| |valid data | |
|
|
|
Multiple frame errors with data == 0x00 (B), |
|
the timing matches up "perfectly" so no extra ending char is detected. |
|
The RXD pin is 1 in the last interrupt, in that case |
|
we set info->errorcode = ERRCODE_INSERT_BREAK, but we can't really |
|
know if another byte will come and this really is case 2. below |
|
(e.g F=0xFF or 0xFE) |
|
If RXD pin is 0 we can expect another character (see 2. below). |
|
|
|
|
|
2. |
|
|
|
B B E or F__________________..__ V |
|
.._|__________|__________|______ | |valid data |
|
"valid" or |
|
parity error |
|
|
|
Multiple frame errors with data == 0x00 (B), |
|
but the part of the break trigs is interpreted as a start bit (and possibly |
|
some 0 bits followed by a number of 1 bits and a stop bit). |
|
Depending on parity settings etc. this last character can be either |
|
a fake "valid" char (F) or have a parity error (E). |
|
|
|
If the character is valid it will be put in the buffer, |
|
we set info->errorcode = ERRCODE_SET_BREAK so the receive interrupt |
|
will set the flags so the tty will handle it, |
|
if it's an error byte it will not be put in the buffer |
|
and we set info->errorcode = ERRCODE_INSERT_BREAK. |
|
|
|
To distinguish a V byte in 1. from an F byte in 2. we keep a timestamp |
|
of the last faulty char (B) and compares it with the current time: |
|
If the time elapsed time is less then 2*char_time_usec we will assume |
|
it's a faked F char and not a Valid char and set |
|
info->errorcode = ERRCODE_SET_BREAK. |
|
|
|
Flaws in the above solution: |
|
~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
|
We use the timer to distinguish a F character from a V character, |
|
if a V character is to close after the break we might make the wrong decision. |
|
|
|
TODO: The break will be delayed until an F or V character is received. |
|
|
|
*/ |
|
|
|
static void handle_ser_rx_interrupt_no_dma(struct e100_serial *info) |
|
{ |
|
unsigned long data_read; |
|
|
|
/* Read data and status at the same time */ |
|
data_read = *((unsigned long *)&info->ioport[REG_DATA_STATUS32]); |
|
more_data: |
|
if (data_read & IO_MASK(R_SERIAL0_READ, xoff_detect) ) { |
|
DFLOW(DEBUG_LOG(info->line, "XOFF detect\n", 0)); |
|
} |
|
DINTR2(DEBUG_LOG(info->line, "ser_rx %c\n", IO_EXTRACT(R_SERIAL0_READ, data_in, data_read))); |
|
|
|
if (data_read & ( IO_MASK(R_SERIAL0_READ, framing_err) | |
|
IO_MASK(R_SERIAL0_READ, par_err) | |
|
IO_MASK(R_SERIAL0_READ, overrun) )) { |
|
/* An error */ |
|
info->last_rx_active_usec = GET_JIFFIES_USEC(); |
|
info->last_rx_active = jiffies; |
|
DINTR1(DEBUG_LOG(info->line, "ser_rx err stat_data %04X\n", data_read)); |
|
DLOG_INT_TRIG( |
|
if (!log_int_trig1_pos) { |
|
log_int_trig1_pos = log_int_pos; |
|
log_int(rdpc(), 0, 0); |
|
} |
|
); |
|
|
|
|
|
if ( ((data_read & IO_MASK(R_SERIAL0_READ, data_in)) == 0) && |
|
(data_read & IO_MASK(R_SERIAL0_READ, framing_err)) ) { |
|
/* Most likely a break, but we get interrupts over and |
|
* over again. |
|
*/ |
|
|
|
if (!info->break_detected_cnt) { |
|
DEBUG_LOG(info->line, "#BRK start\n", 0); |
|
} |
|
if (data_read & IO_MASK(R_SERIAL0_READ, rxd)) { |
|
/* The RX pin is high now, so the break |
|
* must be over, but.... |
|
* we can't really know if we will get another |
|
* last byte ending the break or not. |
|
* And we don't know if the byte (if any) will |
|
* have an error or look valid. |
|
*/ |
|
DEBUG_LOG(info->line, "# BL BRK\n", 0); |
|
info->errorcode = ERRCODE_INSERT_BREAK; |
|
} |
|
info->break_detected_cnt++; |
|
} else { |
|
/* The error does not look like a break, but could be |
|
* the end of one |
|
*/ |
|
if (info->break_detected_cnt) { |
|
DEBUG_LOG(info->line, "EBRK %i\n", info->break_detected_cnt); |
|
info->errorcode = ERRCODE_INSERT_BREAK; |
|
} else { |
|
unsigned char data = IO_EXTRACT(R_SERIAL0_READ, |
|
data_in, data_read); |
|
char flag = TTY_NORMAL; |
|
if (info->errorcode == ERRCODE_INSERT_BREAK) { |
|
tty_insert_flip_char(&info->port, 0, flag); |
|
info->icount.rx++; |
|
} |
|
|
|
if (data_read & IO_MASK(R_SERIAL0_READ, par_err)) { |
|
info->icount.parity++; |
|
flag = TTY_PARITY; |
|
} else if (data_read & IO_MASK(R_SERIAL0_READ, overrun)) { |
|
info->icount.overrun++; |
|
flag = TTY_OVERRUN; |
|
} else if (data_read & IO_MASK(R_SERIAL0_READ, framing_err)) { |
|
info->icount.frame++; |
|
flag = TTY_FRAME; |
|
} |
|
tty_insert_flip_char(&info->port, data, flag); |
|
info->errorcode = 0; |
|
} |
|
info->break_detected_cnt = 0; |
|
} |
|
} else if (data_read & IO_MASK(R_SERIAL0_READ, data_avail)) { |
|
/* No error */ |
|
DLOG_INT_TRIG( |
|
if (!log_int_trig1_pos) { |
|
if (log_int_pos >= log_int_size) { |
|
log_int_pos = 0; |
|
} |
|
log_int_trig0_pos = log_int_pos; |
|
log_int(rdpc(), 0, 0); |
|
} |
|
); |
|
tty_insert_flip_char(&info->port, |
|
IO_EXTRACT(R_SERIAL0_READ, data_in, data_read), |
|
TTY_NORMAL); |
|
} else { |
|
DEBUG_LOG(info->line, "ser_rx int but no data_avail %08lX\n", data_read); |
|
} |
|
|
|
|
|
info->icount.rx++; |
|
data_read = *((unsigned long *)&info->ioport[REG_DATA_STATUS32]); |
|
if (data_read & IO_MASK(R_SERIAL0_READ, data_avail)) { |
|
DEBUG_LOG(info->line, "ser_rx %c in loop\n", IO_EXTRACT(R_SERIAL0_READ, data_in, data_read)); |
|
goto more_data; |
|
} |
|
|
|
tty_flip_buffer_push(&info->port); |
|
} |
|
|
|
static void handle_ser_rx_interrupt(struct e100_serial *info) |
|
{ |
|
unsigned char rstat; |
|
|
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("Interrupt from serport %d\n", i); |
|
#endif |
|
/* DEBUG_LOG(info->line, "ser_interrupt stat %03X\n", rstat | (i << 8)); */ |
|
if (!info->uses_dma_in) { |
|
handle_ser_rx_interrupt_no_dma(info); |
|
return; |
|
} |
|
/* DMA is used */ |
|
rstat = info->ioport[REG_STATUS]; |
|
if (rstat & IO_MASK(R_SERIAL0_STATUS, xoff_detect) ) { |
|
DFLOW(DEBUG_LOG(info->line, "XOFF detect\n", 0)); |
|
} |
|
|
|
if (rstat & SER_ERROR_MASK) { |
|
unsigned char data; |
|
|
|
info->last_rx_active_usec = GET_JIFFIES_USEC(); |
|
info->last_rx_active = jiffies; |
|
/* If we got an error, we must reset it by reading the |
|
* data_in field |
|
*/ |
|
data = info->ioport[REG_DATA]; |
|
DINTR1(DEBUG_LOG(info->line, "ser_rx! %c\n", data)); |
|
DINTR1(DEBUG_LOG(info->line, "ser_rx err stat %02X\n", rstat)); |
|
if (!data && (rstat & SER_FRAMING_ERR_MASK)) { |
|
/* Most likely a break, but we get interrupts over and |
|
* over again. |
|
*/ |
|
|
|
if (!info->break_detected_cnt) { |
|
DEBUG_LOG(info->line, "#BRK start\n", 0); |
|
} |
|
if (rstat & SER_RXD_MASK) { |
|
/* The RX pin is high now, so the break |
|
* must be over, but.... |
|
* we can't really know if we will get another |
|
* last byte ending the break or not. |
|
* And we don't know if the byte (if any) will |
|
* have an error or look valid. |
|
*/ |
|
DEBUG_LOG(info->line, "# BL BRK\n", 0); |
|
info->errorcode = ERRCODE_INSERT_BREAK; |
|
} |
|
info->break_detected_cnt++; |
|
} else { |
|
/* The error does not look like a break, but could be |
|
* the end of one |
|
*/ |
|
if (info->break_detected_cnt) { |
|
DEBUG_LOG(info->line, "EBRK %i\n", info->break_detected_cnt); |
|
info->errorcode = ERRCODE_INSERT_BREAK; |
|
} else { |
|
if (info->errorcode == ERRCODE_INSERT_BREAK) { |
|
info->icount.brk++; |
|
add_char_and_flag(info, '\0', TTY_BREAK); |
|
} |
|
|
|
if (rstat & SER_PAR_ERR_MASK) { |
|
info->icount.parity++; |
|
add_char_and_flag(info, data, TTY_PARITY); |
|
} else if (rstat & SER_OVERRUN_MASK) { |
|
info->icount.overrun++; |
|
add_char_and_flag(info, data, TTY_OVERRUN); |
|
} else if (rstat & SER_FRAMING_ERR_MASK) { |
|
info->icount.frame++; |
|
add_char_and_flag(info, data, TTY_FRAME); |
|
} |
|
|
|
info->errorcode = 0; |
|
} |
|
info->break_detected_cnt = 0; |
|
DEBUG_LOG(info->line, "#iERR s d %04X\n", |
|
((rstat & SER_ERROR_MASK) << 8) | data); |
|
} |
|
} else { /* It was a valid byte, now let the DMA do the rest */ |
|
unsigned long curr_time_u = GET_JIFFIES_USEC(); |
|
unsigned long curr_time = jiffies; |
|
|
|
if (info->break_detected_cnt) { |
|
/* Detect if this character is a new valid char or the |
|
* last char in a break sequence: If LSBits are 0 and |
|
* MSBits are high AND the time is close to the |
|
* previous interrupt we should discard it. |
|
*/ |
|
long elapsed_usec = |
|
(curr_time - info->last_rx_active) * (1000000/HZ) + |
|
curr_time_u - info->last_rx_active_usec; |
|
if (elapsed_usec < 2*info->char_time_usec) { |
|
DEBUG_LOG(info->line, "FBRK %i\n", info->line); |
|
/* Report as BREAK (error) and let |
|
* receive_chars_dma() handle it |
|
*/ |
|
info->errorcode = ERRCODE_SET_BREAK; |
|
} else { |
|
DEBUG_LOG(info->line, "Not end of BRK (V)%i\n", info->line); |
|
} |
|
DEBUG_LOG(info->line, "num brk %i\n", info->break_detected_cnt); |
|
} |
|
|
|
#ifdef SERIAL_DEBUG_INTR |
|
printk("** OK, disabling ser_interrupts\n"); |
|
#endif |
|
e100_disable_serial_data_irq(info); |
|
DINTR2(DEBUG_LOG(info->line, "ser_rx OK %d\n", info->line)); |
|
info->break_detected_cnt = 0; |
|
|
|
} |
|
/* Restarting the DMA never hurts */ |
|
*info->icmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, restart); |
|
START_FLUSH_FAST_TIMER(info, "ser_int"); |
|
} /* handle_ser_rx_interrupt */ |
|
|
|
static void handle_ser_tx_interrupt(struct e100_serial *info) |
|
{ |
|
unsigned long flags; |
|
|
|
if (info->x_char) { |
|
unsigned char rstat; |
|
DFLOW(DEBUG_LOG(info->line, "tx_int: xchar 0x%02X\n", info->x_char)); |
|
local_irq_save(flags); |
|
rstat = info->ioport[REG_STATUS]; |
|
DFLOW(DEBUG_LOG(info->line, "stat %x\n", rstat)); |
|
|
|
info->ioport[REG_TR_DATA] = info->x_char; |
|
info->icount.tx++; |
|
info->x_char = 0; |
|
/* We must enable since it is disabled in ser_interrupt */ |
|
e100_enable_serial_tx_ready_irq(info); |
|
local_irq_restore(flags); |
|
return; |
|
} |
|
if (info->uses_dma_out) { |
|
unsigned char rstat; |
|
int i; |
|
/* We only use normal tx interrupt when sending x_char */ |
|
DFLOW(DEBUG_LOG(info->line, "tx_int: xchar sent\n", 0)); |
|
local_irq_save(flags); |
|
rstat = info->ioport[REG_STATUS]; |
|
DFLOW(DEBUG_LOG(info->line, "stat %x\n", rstat)); |
|
e100_disable_serial_tx_ready_irq(info); |
|
if (info->port.tty->stopped) |
|
rs_stop(info->port.tty); |
|
/* Enable the DMA channel and tell it to continue */ |
|
e100_enable_txdma_channel(info); |
|
/* Wait 12 cycles before doing the DMA command */ |
|
for(i = 6; i > 0; i--) |
|
nop(); |
|
|
|
*info->ocmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, continue); |
|
local_irq_restore(flags); |
|
return; |
|
} |
|
/* Normal char-by-char interrupt */ |
|
if (info->xmit.head == info->xmit.tail |
|
|| info->port.tty->stopped) { |
|
DFLOW(DEBUG_LOG(info->line, "tx_int: stopped %i\n", |
|
info->port.tty->stopped)); |
|
e100_disable_serial_tx_ready_irq(info); |
|
info->tr_running = 0; |
|
return; |
|
} |
|
DINTR2(DEBUG_LOG(info->line, "tx_int %c\n", info->xmit.buf[info->xmit.tail])); |
|
/* Send a byte, rs485 timing is critical so turn of ints */ |
|
local_irq_save(flags); |
|
info->ioport[REG_TR_DATA] = info->xmit.buf[info->xmit.tail]; |
|
info->xmit.tail = (info->xmit.tail + 1) & (SERIAL_XMIT_SIZE-1); |
|
info->icount.tx++; |
|
if (info->xmit.head == info->xmit.tail) { |
|
#if defined(CONFIG_ETRAX_RS485) && defined(CONFIG_ETRAX_FAST_TIMER) |
|
if (info->rs485.flags & SER_RS485_ENABLED) { |
|
/* Set a short timer to toggle RTS */ |
|
start_one_shot_timer(&fast_timers_rs485[info->line], |
|
rs485_toggle_rts_timer_function, |
|
(unsigned long)info, |
|
info->char_time_usec*2, |
|
"RS-485"); |
|
} |
|
#endif /* RS485 */ |
|
info->last_tx_active_usec = GET_JIFFIES_USEC(); |
|
info->last_tx_active = jiffies; |
|
e100_disable_serial_tx_ready_irq(info); |
|
info->tr_running = 0; |
|
DFLOW(DEBUG_LOG(info->line, "tx_int: stop2\n", 0)); |
|
} else { |
|
/* We must enable since it is disabled in ser_interrupt */ |
|
e100_enable_serial_tx_ready_irq(info); |
|
} |
|
local_irq_restore(flags); |
|
|
|
if (CIRC_CNT(info->xmit.head, |
|
info->xmit.tail, |
|
SERIAL_XMIT_SIZE) < WAKEUP_CHARS) |
|
rs_sched_event(info, RS_EVENT_WRITE_WAKEUP); |
|
|
|
} /* handle_ser_tx_interrupt */ |
|
|
|
/* result of time measurements: |
|
* RX duration 54-60 us when doing something, otherwise 6-9 us |
|
* ser_int duration: just sending: 8-15 us normally, up to 73 us |
|
*/ |
|
static irqreturn_t |
|
ser_interrupt(int irq, void *dev_id) |
|
{ |
|
static volatile int tx_started = 0; |
|
struct e100_serial *info; |
|
int i; |
|
unsigned long flags; |
|
unsigned long irq_mask1_rd; |
|
unsigned long data_mask = (1 << (8+2*0)); /* ser0 data_avail */ |
|
int handled = 0; |
|
static volatile unsigned long reentered_ready_mask = 0; |
|
|
|
local_irq_save(flags); |
|
irq_mask1_rd = *R_IRQ_MASK1_RD; |
|
/* First handle all rx interrupts with ints disabled */ |
|
info = rs_table; |
|
irq_mask1_rd &= e100_ser_int_mask; |
|
for (i = 0; i < NR_PORTS; i++) { |
|
/* Which line caused the data irq? */ |
|
if (irq_mask1_rd & data_mask) { |
|
handled = 1; |
|
handle_ser_rx_interrupt(info); |
|
} |
|
info += 1; |
|
data_mask <<= 2; |
|
} |
|
/* Handle tx interrupts with interrupts enabled so we |
|
* can take care of new data interrupts while transmitting |
|
* We protect the tx part with the tx_started flag. |
|
* We disable the tr_ready interrupts we are about to handle and |
|
* unblock the serial interrupt so new serial interrupts may come. |
|
* |
|
* If we get a new interrupt: |
|
* - it migth be due to synchronous serial ports. |
|
* - serial irq will be blocked by general irq handler. |
|
* - async data will be handled above (sync will be ignored). |
|
* - tx_started flag will prevent us from trying to send again and |
|
* we will exit fast - no need to unblock serial irq. |
|
* - Next (sync) serial interrupt handler will be runned with |
|
* disabled interrupt due to restore_flags() at end of function, |
|
* so sync handler will not be preempted or reentered. |
|
*/ |
|
if (!tx_started) { |
|
unsigned long ready_mask; |
|
unsigned long |
|
tx_started = 1; |
|
/* Only the tr_ready interrupts left */ |
|
irq_mask1_rd &= (IO_MASK(R_IRQ_MASK1_RD, ser0_ready) | |
|
IO_MASK(R_IRQ_MASK1_RD, ser1_ready) | |
|
IO_MASK(R_IRQ_MASK1_RD, ser2_ready) | |
|
IO_MASK(R_IRQ_MASK1_RD, ser3_ready)); |
|
while (irq_mask1_rd) { |
|
/* Disable those we are about to handle */ |
|
*R_IRQ_MASK1_CLR = irq_mask1_rd; |
|
/* Unblock the serial interrupt */ |
|
*R_VECT_MASK_SET = IO_STATE(R_VECT_MASK_SET, serial, set); |
|
|
|
local_irq_enable(); |
|
ready_mask = (1 << (8+1+2*0)); /* ser0 tr_ready */ |
|
info = rs_table; |
|
for (i = 0; i < NR_PORTS; i++) { |
|
/* Which line caused the ready irq? */ |
|
if (irq_mask1_rd & ready_mask) { |
|
handled = 1; |
|
handle_ser_tx_interrupt(info); |
|
} |
|
info += 1; |
|
ready_mask <<= 2; |
|
} |
|
/* handle_ser_tx_interrupt enables tr_ready interrupts */ |
|
local_irq_disable(); |
|
/* Handle reentered TX interrupt */ |
|
irq_mask1_rd = reentered_ready_mask; |
|
} |
|
local_irq_disable(); |
|
tx_started = 0; |
|
} else { |
|
unsigned long ready_mask; |
|
ready_mask = irq_mask1_rd & (IO_MASK(R_IRQ_MASK1_RD, ser0_ready) | |
|
IO_MASK(R_IRQ_MASK1_RD, ser1_ready) | |
|
IO_MASK(R_IRQ_MASK1_RD, ser2_ready) | |
|
IO_MASK(R_IRQ_MASK1_RD, ser3_ready)); |
|
if (ready_mask) { |
|
reentered_ready_mask |= ready_mask; |
|
/* Disable those we are about to handle */ |
|
*R_IRQ_MASK1_CLR = ready_mask; |
|
DFLOW(DEBUG_LOG(SERIAL_DEBUG_LINE, "ser_int reentered with TX %X\n", ready_mask)); |
|
} |
|
} |
|
|
|
local_irq_restore(flags); |
|
return IRQ_RETVAL(handled); |
|
} /* ser_interrupt */ |
|
#endif |
|
|
|
/* |
|
* ------------------------------------------------------------------- |
|
* Here ends the serial interrupt routines. |
|
* ------------------------------------------------------------------- |
|
*/ |
|
|
|
/* |
|
* This routine is used to handle the "bottom half" processing for the |
|
* serial driver, known also the "software interrupt" processing. |
|
* This processing is done at the kernel interrupt level, after the |
|
* rs_interrupt() has returned, BUT WITH INTERRUPTS TURNED ON. This |
|
* is where time-consuming activities which can not be done in the |
|
* interrupt driver proper are done; the interrupt driver schedules |
|
* them using rs_sched_event(), and they get done here. |
|
*/ |
|
static void |
|
do_softint(struct work_struct *work) |
|
{ |
|
struct e100_serial *info; |
|
struct tty_struct *tty; |
|
|
|
info = container_of(work, struct e100_serial, work); |
|
|
|
tty = info->port.tty; |
|
if (!tty) |
|
return; |
|
|
|
if (test_and_clear_bit(RS_EVENT_WRITE_WAKEUP, &info->event)) |
|
tty_wakeup(tty); |
|
} |
|
|
|
static int |
|
startup(struct e100_serial * info) |
|
{ |
|
unsigned long flags; |
|
unsigned long xmit_page; |
|
int i; |
|
|
|
xmit_page = get_zeroed_page(GFP_KERNEL); |
|
if (!xmit_page) |
|
return -ENOMEM; |
|
|
|
local_irq_save(flags); |
|
|
|
/* if it was already initialized, skip this */ |
|
|
|
if (info->port.flags & ASYNC_INITIALIZED) { |
|
local_irq_restore(flags); |
|
free_page(xmit_page); |
|
return 0; |
|
} |
|
|
|
if (info->xmit.buf) |
|
free_page(xmit_page); |
|
else |
|
info->xmit.buf = (unsigned char *) xmit_page; |
|
|
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("starting up ttyS%d (xmit_buf 0x%p)...\n", info->line, info->xmit.buf); |
|
#endif |
|
|
|
/* |
|
* Clear the FIFO buffers and disable them |
|
* (they will be reenabled in change_speed()) |
|
*/ |
|
|
|
/* |
|
* Reset the DMA channels and make sure their interrupts are cleared |
|
*/ |
|
|
|
if (info->dma_in_enabled) { |
|
info->uses_dma_in = 1; |
|
e100_enable_rxdma_channel(info); |
|
|
|
*info->icmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, reset); |
|
|
|
/* Wait until reset cycle is complete */ |
|
while (IO_EXTRACT(R_DMA_CH6_CMD, cmd, *info->icmdadr) == |
|
IO_STATE_VALUE(R_DMA_CH6_CMD, cmd, reset)); |
|
|
|
/* Make sure the irqs are cleared */ |
|
*info->iclrintradr = |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_descr, do) | |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_eop, do); |
|
} else { |
|
e100_disable_rxdma_channel(info); |
|
} |
|
|
|
if (info->dma_out_enabled) { |
|
info->uses_dma_out = 1; |
|
e100_enable_txdma_channel(info); |
|
*info->ocmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, reset); |
|
|
|
while (IO_EXTRACT(R_DMA_CH6_CMD, cmd, *info->ocmdadr) == |
|
IO_STATE_VALUE(R_DMA_CH6_CMD, cmd, reset)); |
|
|
|
/* Make sure the irqs are cleared */ |
|
*info->oclrintradr = |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_descr, do) | |
|
IO_STATE(R_DMA_CH6_CLR_INTR, clr_eop, do); |
|
} else { |
|
e100_disable_txdma_channel(info); |
|
} |
|
|
|
if (info->port.tty) |
|
clear_bit(TTY_IO_ERROR, &info->port.tty->flags); |
|
|
|
info->xmit.head = info->xmit.tail = 0; |
|
info->first_recv_buffer = info->last_recv_buffer = NULL; |
|
info->recv_cnt = info->max_recv_cnt = 0; |
|
|
|
for (i = 0; i < SERIAL_RECV_DESCRIPTORS; i++) |
|
info->rec_descr[i].buf = 0; |
|
|
|
/* |
|
* and set the speed and other flags of the serial port |
|
* this will start the rx/tx as well |
|
*/ |
|
#ifdef SERIAL_HANDLE_EARLY_ERRORS |
|
e100_enable_serial_data_irq(info); |
|
#endif |
|
change_speed(info); |
|
|
|
/* dummy read to reset any serial errors */ |
|
|
|
(void)info->ioport[REG_DATA]; |
|
|
|
/* enable the interrupts */ |
|
if (info->uses_dma_out) |
|
e100_enable_txdma_irq(info); |
|
|
|
e100_enable_rx_irq(info); |
|
|
|
info->tr_running = 0; /* to be sure we don't lock up the transmitter */ |
|
|
|
/* setup the dma input descriptor and start dma */ |
|
|
|
start_receive(info); |
|
|
|
/* for safety, make sure the descriptors last result is 0 bytes written */ |
|
|
|
info->tr_descr.sw_len = 0; |
|
info->tr_descr.hw_len = 0; |
|
info->tr_descr.status = 0; |
|
|
|
/* enable RTS/DTR last */ |
|
|
|
e100_rts(info, 1); |
|
e100_dtr(info, 1); |
|
|
|
info->port.flags |= ASYNC_INITIALIZED; |
|
|
|
local_irq_restore(flags); |
|
return 0; |
|
} |
|
|
|
/* |
|
* This routine will shutdown a serial port; interrupts are disabled, and |
|
* DTR is dropped if the hangup on close termio flag is on. |
|
*/ |
|
static void |
|
shutdown(struct e100_serial * info) |
|
{ |
|
unsigned long flags; |
|
struct etrax_dma_descr *descr = info->rec_descr; |
|
struct etrax_recv_buffer *buffer; |
|
int i; |
|
|
|
/* shut down the transmitter and receiver */ |
|
DFLOW(DEBUG_LOG(info->line, "shutdown %i\n", info->line)); |
|
e100_disable_rx(info); |
|
info->ioport[REG_TR_CTRL] = (info->tx_ctrl &= ~0x40); |
|
|
|
/* disable interrupts, reset dma channels */ |
|
if (info->uses_dma_in) { |
|
e100_disable_rxdma_irq(info); |
|
*info->icmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, reset); |
|
info->uses_dma_in = 0; |
|
} else { |
|
e100_disable_serial_data_irq(info); |
|
} |
|
|
|
if (info->uses_dma_out) { |
|
e100_disable_txdma_irq(info); |
|
info->tr_running = 0; |
|
*info->ocmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, reset); |
|
info->uses_dma_out = 0; |
|
} else { |
|
e100_disable_serial_tx_ready_irq(info); |
|
info->tr_running = 0; |
|
} |
|
|
|
if (!(info->port.flags & ASYNC_INITIALIZED)) |
|
return; |
|
|
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("Shutting down serial port %d (irq %d)....\n", info->line, |
|
info->irq); |
|
#endif |
|
|
|
local_irq_save(flags); |
|
|
|
if (info->xmit.buf) { |
|
free_page((unsigned long)info->xmit.buf); |
|
info->xmit.buf = NULL; |
|
} |
|
|
|
for (i = 0; i < SERIAL_RECV_DESCRIPTORS; i++) |
|
if (descr[i].buf) { |
|
buffer = phys_to_virt(descr[i].buf) - sizeof *buffer; |
|
kfree(buffer); |
|
descr[i].buf = 0; |
|
} |
|
|
|
if (!info->port.tty || (info->port.tty->termios.c_cflag & HUPCL)) { |
|
/* hang up DTR and RTS if HUPCL is enabled */ |
|
e100_dtr(info, 0); |
|
e100_rts(info, 0); /* could check CRTSCTS before doing this */ |
|
} |
|
|
|
if (info->port.tty) |
|
set_bit(TTY_IO_ERROR, &info->port.tty->flags); |
|
|
|
info->port.flags &= ~ASYNC_INITIALIZED; |
|
local_irq_restore(flags); |
|
} |
|
|
|
|
|
/* change baud rate and other assorted parameters */ |
|
|
|
static void |
|
change_speed(struct e100_serial *info) |
|
{ |
|
unsigned int cflag; |
|
unsigned long xoff; |
|
unsigned long flags; |
|
/* first some safety checks */ |
|
|
|
if (!info->port.tty) |
|
return; |
|
if (!info->ioport) |
|
return; |
|
|
|
cflag = info->port.tty->termios.c_cflag; |
|
|
|
/* possibly, the tx/rx should be disabled first to do this safely */ |
|
|
|
/* change baud-rate and write it to the hardware */ |
|
if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST) { |
|
/* Special baudrate */ |
|
u32 mask = 0xFF << (info->line*8); /* Each port has 8 bits */ |
|
unsigned long alt_source = |
|
IO_STATE(R_ALT_SER_BAUDRATE, ser0_rec, normal) | |
|
IO_STATE(R_ALT_SER_BAUDRATE, ser0_tr, normal); |
|
/* R_ALT_SER_BAUDRATE selects the source */ |
|
DBAUD(printk("Custom baudrate: baud_base/divisor %lu/%i\n", |
|
(unsigned long)info->baud_base, info->custom_divisor)); |
|
if (info->baud_base == SERIAL_PRESCALE_BASE) { |
|
/* 0, 2-65535 (0=65536) */ |
|
u16 divisor = info->custom_divisor; |
|
/* R_SERIAL_PRESCALE (upper 16 bits of R_CLOCK_PRESCALE) */ |
|
/* baudrate is 3.125MHz/custom_divisor */ |
|
alt_source = |
|
IO_STATE(R_ALT_SER_BAUDRATE, ser0_rec, prescale) | |
|
IO_STATE(R_ALT_SER_BAUDRATE, ser0_tr, prescale); |
|
alt_source = 0x11; |
|
DBAUD(printk("Writing SERIAL_PRESCALE: divisor %i\n", divisor)); |
|
*R_SERIAL_PRESCALE = divisor; |
|
info->baud = SERIAL_PRESCALE_BASE/divisor; |
|
} |
|
else |
|
{ |
|
/* Bad baudbase, we don't support using timer0 |
|
* for baudrate. |
|
*/ |
|
printk(KERN_WARNING "Bad baud_base/custom_divisor: %lu/%i\n", |
|
(unsigned long)info->baud_base, info->custom_divisor); |
|
} |
|
r_alt_ser_baudrate_shadow &= ~mask; |
|
r_alt_ser_baudrate_shadow |= (alt_source << (info->line*8)); |
|
*R_ALT_SER_BAUDRATE = r_alt_ser_baudrate_shadow; |
|
} else { |
|
/* Normal baudrate */ |
|
/* Make sure we use normal baudrate */ |
|
u32 mask = 0xFF << (info->line*8); /* Each port has 8 bits */ |
|
unsigned long alt_source = |
|
IO_STATE(R_ALT_SER_BAUDRATE, ser0_rec, normal) | |
|
IO_STATE(R_ALT_SER_BAUDRATE, ser0_tr, normal); |
|
r_alt_ser_baudrate_shadow &= ~mask; |
|
r_alt_ser_baudrate_shadow |= (alt_source << (info->line*8)); |
|
*R_ALT_SER_BAUDRATE = r_alt_ser_baudrate_shadow; |
|
|
|
info->baud = cflag_to_baud(cflag); |
|
info->ioport[REG_BAUD] = cflag_to_etrax_baud(cflag); |
|
} |
|
|
|
/* start with default settings and then fill in changes */ |
|
local_irq_save(flags); |
|
/* 8 bit, no/even parity */ |
|
info->rx_ctrl &= ~(IO_MASK(R_SERIAL0_REC_CTRL, rec_bitnr) | |
|
IO_MASK(R_SERIAL0_REC_CTRL, rec_par_en) | |
|
IO_MASK(R_SERIAL0_REC_CTRL, rec_par)); |
|
|
|
/* 8 bit, no/even parity, 1 stop bit, no cts */ |
|
info->tx_ctrl &= ~(IO_MASK(R_SERIAL0_TR_CTRL, tr_bitnr) | |
|
IO_MASK(R_SERIAL0_TR_CTRL, tr_par_en) | |
|
IO_MASK(R_SERIAL0_TR_CTRL, tr_par) | |
|
IO_MASK(R_SERIAL0_TR_CTRL, stop_bits) | |
|
IO_MASK(R_SERIAL0_TR_CTRL, auto_cts)); |
|
|
|
if ((cflag & CSIZE) == CS7) { |
|
/* set 7 bit mode */ |
|
info->tx_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, tr_bitnr, tr_7bit); |
|
info->rx_ctrl |= IO_STATE(R_SERIAL0_REC_CTRL, rec_bitnr, rec_7bit); |
|
} |
|
|
|
if (cflag & CSTOPB) { |
|
/* set 2 stop bit mode */ |
|
info->tx_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, stop_bits, two_bits); |
|
} |
|
|
|
if (cflag & PARENB) { |
|
/* enable parity */ |
|
info->tx_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, tr_par_en, enable); |
|
info->rx_ctrl |= IO_STATE(R_SERIAL0_REC_CTRL, rec_par_en, enable); |
|
} |
|
|
|
if (cflag & CMSPAR) { |
|
/* enable stick parity, PARODD mean Mark which matches ETRAX */ |
|
info->tx_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, tr_stick_par, stick); |
|
info->rx_ctrl |= IO_STATE(R_SERIAL0_REC_CTRL, rec_stick_par, stick); |
|
} |
|
if (cflag & PARODD) { |
|
/* set odd parity (or Mark if CMSPAR) */ |
|
info->tx_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, tr_par, odd); |
|
info->rx_ctrl |= IO_STATE(R_SERIAL0_REC_CTRL, rec_par, odd); |
|
} |
|
|
|
if (cflag & CRTSCTS) { |
|
/* enable automatic CTS handling */ |
|
DFLOW(DEBUG_LOG(info->line, "FLOW auto_cts enabled\n", 0)); |
|
info->tx_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, auto_cts, active); |
|
} |
|
|
|
/* make sure the tx and rx are enabled */ |
|
|
|
info->tx_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, tr_enable, enable); |
|
info->rx_ctrl |= IO_STATE(R_SERIAL0_REC_CTRL, rec_enable, enable); |
|
|
|
/* actually write the control regs to the hardware */ |
|
|
|
info->ioport[REG_TR_CTRL] = info->tx_ctrl; |
|
info->ioport[REG_REC_CTRL] = info->rx_ctrl; |
|
xoff = IO_FIELD(R_SERIAL0_XOFF, xoff_char, STOP_CHAR(info->port.tty)); |
|
xoff |= IO_STATE(R_SERIAL0_XOFF, tx_stop, enable); |
|
if (info->port.tty->termios.c_iflag & IXON ) { |
|
DFLOW(DEBUG_LOG(info->line, "FLOW XOFF enabled 0x%02X\n", |
|
STOP_CHAR(info->port.tty))); |
|
xoff |= IO_STATE(R_SERIAL0_XOFF, auto_xoff, enable); |
|
} |
|
|
|
*((unsigned long *)&info->ioport[REG_XOFF]) = xoff; |
|
local_irq_restore(flags); |
|
|
|
update_char_time(info); |
|
|
|
} /* change_speed */ |
|
|
|
/* start transmitting chars NOW */ |
|
|
|
static void |
|
rs_flush_chars(struct tty_struct *tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned long flags; |
|
|
|
if (info->tr_running || |
|
info->xmit.head == info->xmit.tail || |
|
tty->stopped || |
|
!info->xmit.buf) |
|
return; |
|
|
|
#ifdef SERIAL_DEBUG_FLOW |
|
printk("rs_flush_chars\n"); |
|
#endif |
|
|
|
/* this protection might not exactly be necessary here */ |
|
|
|
local_irq_save(flags); |
|
start_transmit(info); |
|
local_irq_restore(flags); |
|
} |
|
|
|
static int rs_raw_write(struct tty_struct *tty, |
|
const unsigned char *buf, int count) |
|
{ |
|
int c, ret = 0; |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned long flags; |
|
|
|
/* first some sanity checks */ |
|
|
|
if (!info->xmit.buf) |
|
return 0; |
|
|
|
#ifdef SERIAL_DEBUG_DATA |
|
if (info->line == SERIAL_DEBUG_LINE) |
|
printk("rs_raw_write (%d), status %d\n", |
|
count, info->ioport[REG_STATUS]); |
|
#endif |
|
|
|
local_save_flags(flags); |
|
DFLOW(DEBUG_LOG(info->line, "write count %i ", count)); |
|
DFLOW(DEBUG_LOG(info->line, "ldisc %i\n", tty->ldisc.chars_in_buffer(tty))); |
|
|
|
|
|
/* The local_irq_disable/restore_flags pairs below are needed |
|
* because the DMA interrupt handler moves the info->xmit values. |
|
* the memcpy needs to be in the critical region unfortunately, |
|
* because we need to read xmit values, memcpy, write xmit values |
|
* in one atomic operation... this could perhaps be avoided by |
|
* more clever design. |
|
*/ |
|
local_irq_disable(); |
|
while (count) { |
|
c = CIRC_SPACE_TO_END(info->xmit.head, |
|
info->xmit.tail, |
|
SERIAL_XMIT_SIZE); |
|
|
|
if (count < c) |
|
c = count; |
|
if (c <= 0) |
|
break; |
|
|
|
memcpy(info->xmit.buf + info->xmit.head, buf, c); |
|
info->xmit.head = (info->xmit.head + c) & |
|
(SERIAL_XMIT_SIZE-1); |
|
buf += c; |
|
count -= c; |
|
ret += c; |
|
} |
|
local_irq_restore(flags); |
|
|
|
/* enable transmitter if not running, unless the tty is stopped |
|
* this does not need IRQ protection since if tr_running == 0 |
|
* the IRQ's are not running anyway for this port. |
|
*/ |
|
DFLOW(DEBUG_LOG(info->line, "write ret %i\n", ret)); |
|
|
|
if (info->xmit.head != info->xmit.tail && |
|
!tty->stopped && |
|
!info->tr_running) { |
|
start_transmit(info); |
|
} |
|
|
|
return ret; |
|
} /* raw_raw_write() */ |
|
|
|
static int |
|
rs_write(struct tty_struct *tty, |
|
const unsigned char *buf, int count) |
|
{ |
|
#if defined(CONFIG_ETRAX_RS485) |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
|
|
if (info->rs485.flags & SER_RS485_ENABLED) |
|
{ |
|
/* If we are in RS-485 mode, we need to toggle RTS and disable |
|
* the receiver before initiating a DMA transfer |
|
*/ |
|
#ifdef CONFIG_ETRAX_FAST_TIMER |
|
/* Abort any started timer */ |
|
fast_timers_rs485[info->line].function = NULL; |
|
del_fast_timer(&fast_timers_rs485[info->line]); |
|
#endif |
|
e100_rts(info, (info->rs485.flags & SER_RS485_RTS_ON_SEND)); |
|
#if defined(CONFIG_ETRAX_RS485_DISABLE_RECEIVER) |
|
e100_disable_rx(info); |
|
e100_enable_rx_irq(info); |
|
#endif |
|
if (info->rs485.delay_rts_before_send > 0) |
|
msleep(info->rs485.delay_rts_before_send); |
|
} |
|
#endif /* CONFIG_ETRAX_RS485 */ |
|
|
|
count = rs_raw_write(tty, buf, count); |
|
|
|
#if defined(CONFIG_ETRAX_RS485) |
|
if (info->rs485.flags & SER_RS485_ENABLED) |
|
{ |
|
unsigned int val; |
|
/* If we are in RS-485 mode the following has to be done: |
|
* wait until DMA is ready |
|
* wait on transmit shift register |
|
* toggle RTS |
|
* enable the receiver |
|
*/ |
|
|
|
/* Sleep until all sent */ |
|
tty_wait_until_sent(tty, 0); |
|
#ifdef CONFIG_ETRAX_FAST_TIMER |
|
/* Now sleep a little more so that shift register is empty */ |
|
schedule_usleep(info->char_time_usec * 2); |
|
#endif |
|
/* wait on transmit shift register */ |
|
do{ |
|
get_lsr_info(info, &val); |
|
}while (!(val & TIOCSER_TEMT)); |
|
|
|
e100_rts(info, (info->rs485.flags & SER_RS485_RTS_AFTER_SEND)); |
|
|
|
#if defined(CONFIG_ETRAX_RS485_DISABLE_RECEIVER) |
|
e100_enable_rx(info); |
|
e100_enable_rxdma_irq(info); |
|
#endif |
|
} |
|
#endif /* CONFIG_ETRAX_RS485 */ |
|
|
|
return count; |
|
} /* rs_write */ |
|
|
|
|
|
/* how much space is available in the xmit buffer? */ |
|
|
|
static int |
|
rs_write_room(struct tty_struct *tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
|
|
return CIRC_SPACE(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE); |
|
} |
|
|
|
/* How many chars are in the xmit buffer? |
|
* This does not include any chars in the transmitter FIFO. |
|
* Use wait_until_sent for waiting for FIFO drain. |
|
*/ |
|
|
|
static int |
|
rs_chars_in_buffer(struct tty_struct *tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
|
|
return CIRC_CNT(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE); |
|
} |
|
|
|
/* discard everything in the xmit buffer */ |
|
|
|
static void |
|
rs_flush_buffer(struct tty_struct *tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
info->xmit.head = info->xmit.tail = 0; |
|
local_irq_restore(flags); |
|
|
|
tty_wakeup(tty); |
|
} |
|
|
|
/* |
|
* This function is used to send a high-priority XON/XOFF character to |
|
* the device |
|
* |
|
* Since we use DMA we don't check for info->x_char in transmit_chars_dma(), |
|
* but we do it in handle_ser_tx_interrupt(). |
|
* We disable DMA channel and enable tx ready interrupt and write the |
|
* character when possible. |
|
*/ |
|
static void rs_send_xchar(struct tty_struct *tty, char ch) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned long flags; |
|
local_irq_save(flags); |
|
if (info->uses_dma_out) { |
|
/* Put the DMA on hold and disable the channel */ |
|
*info->ocmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, hold); |
|
while (IO_EXTRACT(R_DMA_CH6_CMD, cmd, *info->ocmdadr) != |
|
IO_STATE_VALUE(R_DMA_CH6_CMD, cmd, hold)); |
|
e100_disable_txdma_channel(info); |
|
} |
|
|
|
/* Must make sure transmitter is not stopped before we can transmit */ |
|
if (tty->stopped) |
|
rs_start(tty); |
|
|
|
/* Enable manual transmit interrupt and send from there */ |
|
DFLOW(DEBUG_LOG(info->line, "rs_send_xchar 0x%02X\n", ch)); |
|
info->x_char = ch; |
|
e100_enable_serial_tx_ready_irq(info); |
|
local_irq_restore(flags); |
|
} |
|
|
|
/* |
|
* ------------------------------------------------------------ |
|
* rs_throttle() |
|
* |
|
* This routine is called by the upper-layer tty layer to signal that |
|
* incoming characters should be throttled. |
|
* ------------------------------------------------------------ |
|
*/ |
|
static void |
|
rs_throttle(struct tty_struct * tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
#ifdef SERIAL_DEBUG_THROTTLE |
|
printk("throttle %s: %lu....\n", tty_name(tty), |
|
(unsigned long)tty->ldisc.chars_in_buffer(tty)); |
|
#endif |
|
DFLOW(DEBUG_LOG(info->line,"rs_throttle %lu\n", tty->ldisc.chars_in_buffer(tty))); |
|
|
|
/* Do RTS before XOFF since XOFF might take some time */ |
|
if (tty->termios.c_cflag & CRTSCTS) { |
|
/* Turn off RTS line */ |
|
e100_rts(info, 0); |
|
} |
|
if (I_IXOFF(tty)) |
|
rs_send_xchar(tty, STOP_CHAR(tty)); |
|
|
|
} |
|
|
|
static void |
|
rs_unthrottle(struct tty_struct * tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
#ifdef SERIAL_DEBUG_THROTTLE |
|
printk("unthrottle %s: %lu....\n", tty_name(tty), |
|
(unsigned long)tty->ldisc.chars_in_buffer(tty)); |
|
#endif |
|
DFLOW(DEBUG_LOG(info->line,"rs_unthrottle ldisc %d\n", tty->ldisc.chars_in_buffer(tty))); |
|
DFLOW(DEBUG_LOG(info->line,"rs_unthrottle flip.count: %i\n", tty->flip.count)); |
|
/* Do RTS before XOFF since XOFF might take some time */ |
|
if (tty->termios.c_cflag & CRTSCTS) { |
|
/* Assert RTS line */ |
|
e100_rts(info, 1); |
|
} |
|
|
|
if (I_IXOFF(tty)) { |
|
if (info->x_char) |
|
info->x_char = 0; |
|
else |
|
rs_send_xchar(tty, START_CHAR(tty)); |
|
} |
|
|
|
} |
|
|
|
/* |
|
* ------------------------------------------------------------ |
|
* rs_ioctl() and friends |
|
* ------------------------------------------------------------ |
|
*/ |
|
|
|
static int |
|
get_serial_info(struct e100_serial * info, |
|
struct serial_struct * retinfo) |
|
{ |
|
struct serial_struct tmp; |
|
|
|
/* this is all probably wrong, there are a lot of fields |
|
* here that we don't have in e100_serial and maybe we |
|
* should set them to something else than 0. |
|
*/ |
|
|
|
if (!retinfo) |
|
return -EFAULT; |
|
memset(&tmp, 0, sizeof(tmp)); |
|
tmp.type = info->type; |
|
tmp.line = info->line; |
|
tmp.port = (int)info->ioport; |
|
tmp.irq = info->irq; |
|
tmp.flags = info->port.flags; |
|
tmp.baud_base = info->baud_base; |
|
tmp.close_delay = info->port.close_delay; |
|
tmp.closing_wait = info->port.closing_wait; |
|
tmp.custom_divisor = info->custom_divisor; |
|
if (copy_to_user(retinfo, &tmp, sizeof(*retinfo))) |
|
return -EFAULT; |
|
return 0; |
|
} |
|
|
|
static int |
|
set_serial_info(struct e100_serial *info, |
|
struct serial_struct *new_info) |
|
{ |
|
struct serial_struct new_serial; |
|
struct e100_serial old_info; |
|
int retval = 0; |
|
|
|
if (copy_from_user(&new_serial, new_info, sizeof(new_serial))) |
|
return -EFAULT; |
|
|
|
old_info = *info; |
|
|
|
if (!capable(CAP_SYS_ADMIN)) { |
|
if ((new_serial.type != info->type) || |
|
(new_serial.close_delay != info->port.close_delay) || |
|
((new_serial.flags & ~ASYNC_USR_MASK) != |
|
(info->port.flags & ~ASYNC_USR_MASK))) |
|
return -EPERM; |
|
info->port.flags = ((info->port.flags & ~ASYNC_USR_MASK) | |
|
(new_serial.flags & ASYNC_USR_MASK)); |
|
goto check_and_exit; |
|
} |
|
|
|
if (info->port.count > 1) |
|
return -EBUSY; |
|
|
|
/* |
|
* OK, past this point, all the error checking has been done. |
|
* At this point, we start making changes..... |
|
*/ |
|
|
|
info->baud_base = new_serial.baud_base; |
|
info->port.flags = ((info->port.flags & ~ASYNC_FLAGS) | |
|
(new_serial.flags & ASYNC_FLAGS)); |
|
info->custom_divisor = new_serial.custom_divisor; |
|
info->type = new_serial.type; |
|
info->port.close_delay = new_serial.close_delay; |
|
info->port.closing_wait = new_serial.closing_wait; |
|
info->port.low_latency = (info->port.flags & ASYNC_LOW_LATENCY) ? 1 : 0; |
|
|
|
check_and_exit: |
|
if (info->port.flags & ASYNC_INITIALIZED) { |
|
change_speed(info); |
|
} else |
|
retval = startup(info); |
|
return retval; |
|
} |
|
|
|
/* |
|
* get_lsr_info - get line status register info |
|
* |
|
* Purpose: Let user call ioctl() to get info when the UART physically |
|
* is emptied. On bus types like RS485, the transmitter must |
|
* release the bus after transmitting. This must be done when |
|
* the transmit shift register is empty, not be done when the |
|
* transmit holding register is empty. This functionality |
|
* allows an RS485 driver to be written in user space. |
|
*/ |
|
static int |
|
get_lsr_info(struct e100_serial * info, unsigned int *value) |
|
{ |
|
unsigned int result = TIOCSER_TEMT; |
|
unsigned long curr_time = jiffies; |
|
unsigned long curr_time_usec = GET_JIFFIES_USEC(); |
|
unsigned long elapsed_usec = |
|
(curr_time - info->last_tx_active) * 1000000/HZ + |
|
curr_time_usec - info->last_tx_active_usec; |
|
|
|
if (info->xmit.head != info->xmit.tail || |
|
elapsed_usec < 2*info->char_time_usec) { |
|
result = 0; |
|
} |
|
|
|
if (copy_to_user(value, &result, sizeof(int))) |
|
return -EFAULT; |
|
return 0; |
|
} |
|
|
|
#ifdef SERIAL_DEBUG_IO |
|
struct state_str |
|
{ |
|
int state; |
|
const char *str; |
|
}; |
|
|
|
const struct state_str control_state_str[] = { |
|
{TIOCM_DTR, "DTR" }, |
|
{TIOCM_RTS, "RTS"}, |
|
{TIOCM_ST, "ST?" }, |
|
{TIOCM_SR, "SR?" }, |
|
{TIOCM_CTS, "CTS" }, |
|
{TIOCM_CD, "CD" }, |
|
{TIOCM_RI, "RI" }, |
|
{TIOCM_DSR, "DSR" }, |
|
{0, NULL } |
|
}; |
|
|
|
char *get_control_state_str(int MLines, char *s) |
|
{ |
|
int i = 0; |
|
|
|
s[0]='\0'; |
|
while (control_state_str[i].str != NULL) { |
|
if (MLines & control_state_str[i].state) { |
|
if (s[0] != '\0') { |
|
strcat(s, ", "); |
|
} |
|
strcat(s, control_state_str[i].str); |
|
} |
|
i++; |
|
} |
|
return s; |
|
} |
|
#endif |
|
|
|
static int |
|
rs_break(struct tty_struct *tty, int break_state) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned long flags; |
|
|
|
if (!info->ioport) |
|
return -EIO; |
|
|
|
local_irq_save(flags); |
|
if (break_state == -1) { |
|
/* Go to manual mode and set the txd pin to 0 */ |
|
/* Clear bit 7 (txd) and 6 (tr_enable) */ |
|
info->tx_ctrl &= 0x3F; |
|
} else { |
|
/* Set bit 7 (txd) and 6 (tr_enable) */ |
|
info->tx_ctrl |= (0x80 | 0x40); |
|
} |
|
info->ioport[REG_TR_CTRL] = info->tx_ctrl; |
|
local_irq_restore(flags); |
|
return 0; |
|
} |
|
|
|
static int |
|
rs_tiocmset(struct tty_struct *tty, unsigned int set, unsigned int clear) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
|
|
if (clear & TIOCM_RTS) |
|
e100_rts(info, 0); |
|
if (clear & TIOCM_DTR) |
|
e100_dtr(info, 0); |
|
/* Handle FEMALE behaviour */ |
|
if (clear & TIOCM_RI) |
|
e100_ri_out(info, 0); |
|
if (clear & TIOCM_CD) |
|
e100_cd_out(info, 0); |
|
|
|
if (set & TIOCM_RTS) |
|
e100_rts(info, 1); |
|
if (set & TIOCM_DTR) |
|
e100_dtr(info, 1); |
|
/* Handle FEMALE behaviour */ |
|
if (set & TIOCM_RI) |
|
e100_ri_out(info, 1); |
|
if (set & TIOCM_CD) |
|
e100_cd_out(info, 1); |
|
|
|
local_irq_restore(flags); |
|
return 0; |
|
} |
|
|
|
static int |
|
rs_tiocmget(struct tty_struct *tty) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned int result; |
|
unsigned long flags; |
|
|
|
local_irq_save(flags); |
|
|
|
result = |
|
(!E100_RTS_GET(info) ? TIOCM_RTS : 0) |
|
| (!E100_DTR_GET(info) ? TIOCM_DTR : 0) |
|
| (!E100_RI_GET(info) ? TIOCM_RNG : 0) |
|
| (!E100_DSR_GET(info) ? TIOCM_DSR : 0) |
|
| (!E100_CD_GET(info) ? TIOCM_CAR : 0) |
|
| (!E100_CTS_GET(info) ? TIOCM_CTS : 0); |
|
|
|
local_irq_restore(flags); |
|
|
|
#ifdef SERIAL_DEBUG_IO |
|
printk(KERN_DEBUG "ser%i: modem state: %i 0x%08X\n", |
|
info->line, result, result); |
|
{ |
|
char s[100]; |
|
|
|
get_control_state_str(result, s); |
|
printk(KERN_DEBUG "state: %s\n", s); |
|
} |
|
#endif |
|
return result; |
|
|
|
} |
|
|
|
|
|
static int |
|
rs_ioctl(struct tty_struct *tty, |
|
unsigned int cmd, unsigned long arg) |
|
{ |
|
struct e100_serial * info = (struct e100_serial *)tty->driver_data; |
|
|
|
if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) && |
|
(cmd != TIOCSERCONFIG) && (cmd != TIOCSERGWILD) && |
|
(cmd != TIOCSERSWILD) && (cmd != TIOCSERGSTRUCT)) { |
|
if (tty->flags & (1 << TTY_IO_ERROR)) |
|
return -EIO; |
|
} |
|
|
|
switch (cmd) { |
|
case TIOCGSERIAL: |
|
return get_serial_info(info, |
|
(struct serial_struct *) arg); |
|
case TIOCSSERIAL: |
|
return set_serial_info(info, |
|
(struct serial_struct *) arg); |
|
case TIOCSERGETLSR: /* Get line status register */ |
|
return get_lsr_info(info, (unsigned int *) arg); |
|
|
|
case TIOCSERGSTRUCT: |
|
if (copy_to_user((struct e100_serial *) arg, |
|
info, sizeof(struct e100_serial))) |
|
return -EFAULT; |
|
return 0; |
|
|
|
#if defined(CONFIG_ETRAX_RS485) |
|
case TIOCSERSETRS485: |
|
{ |
|
/* In this ioctl we still use the old structure |
|
* rs485_control for backward compatibility |
|
* (if we use serial_rs485, then old user-level code |
|
* wouldn't work anymore...). |
|
* The use of this ioctl is deprecated: use TIOCSRS485 |
|
* instead.*/ |
|
struct rs485_control rs485ctrl; |
|
struct serial_rs485 rs485data; |
|
printk(KERN_DEBUG "The use of this ioctl is deprecated. Use TIOCSRS485 instead\n"); |
|
if (copy_from_user(&rs485ctrl, (struct rs485_control *)arg, |
|
sizeof(rs485ctrl))) |
|
return -EFAULT; |
|
|
|
rs485data.delay_rts_before_send = rs485ctrl.delay_rts_before_send; |
|
rs485data.flags = 0; |
|
|
|
if (rs485ctrl.enabled) |
|
rs485data.flags |= SER_RS485_ENABLED; |
|
else |
|
rs485data.flags &= ~(SER_RS485_ENABLED); |
|
|
|
if (rs485ctrl.rts_on_send) |
|
rs485data.flags |= SER_RS485_RTS_ON_SEND; |
|
else |
|
rs485data.flags &= ~(SER_RS485_RTS_ON_SEND); |
|
|
|
if (rs485ctrl.rts_after_sent) |
|
rs485data.flags |= SER_RS485_RTS_AFTER_SEND; |
|
else |
|
rs485data.flags &= ~(SER_RS485_RTS_AFTER_SEND); |
|
|
|
return e100_enable_rs485(tty, &rs485data); |
|
} |
|
|
|
case TIOCSRS485: |
|
{ |
|
/* This is the new version of TIOCSRS485, with new |
|
* data structure serial_rs485 */ |
|
struct serial_rs485 rs485data; |
|
if (copy_from_user(&rs485data, (struct rs485_control *)arg, |
|
sizeof(rs485data))) |
|
return -EFAULT; |
|
|
|
return e100_enable_rs485(tty, &rs485data); |
|
} |
|
|
|
case TIOCGRS485: |
|
{ |
|
struct serial_rs485 *rs485data = |
|
&(((struct e100_serial *)tty->driver_data)->rs485); |
|
/* This is the ioctl to get RS485 data from user-space */ |
|
if (copy_to_user((struct serial_rs485 *) arg, |
|
rs485data, |
|
sizeof(struct serial_rs485))) |
|
return -EFAULT; |
|
break; |
|
} |
|
|
|
case TIOCSERWRRS485: |
|
{ |
|
struct rs485_write rs485wr; |
|
if (copy_from_user(&rs485wr, (struct rs485_write *)arg, |
|
sizeof(rs485wr))) |
|
return -EFAULT; |
|
|
|
return e100_write_rs485(tty, rs485wr.outc, rs485wr.outc_size); |
|
} |
|
#endif |
|
|
|
default: |
|
return -ENOIOCTLCMD; |
|
} |
|
return 0; |
|
} |
|
|
|
static void |
|
rs_set_termios(struct tty_struct *tty, struct ktermios *old_termios) |
|
{ |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
|
|
change_speed(info); |
|
|
|
/* Handle turning off CRTSCTS */ |
|
if ((old_termios->c_cflag & CRTSCTS) && |
|
!(tty->termios.c_cflag & CRTSCTS)) |
|
rs_start(tty); |
|
|
|
} |
|
|
|
/* |
|
* ------------------------------------------------------------ |
|
* rs_close() |
|
* |
|
* This routine is called when the serial port gets closed. First, we |
|
* wait for the last remaining data to be sent. Then, we unlink its |
|
* S structure from the interrupt chain if necessary, and we free |
|
* that IRQ if nothing is left in the chain. |
|
* ------------------------------------------------------------ |
|
*/ |
|
static void |
|
rs_close(struct tty_struct *tty, struct file * filp) |
|
{ |
|
struct e100_serial * info = (struct e100_serial *)tty->driver_data; |
|
unsigned long flags; |
|
|
|
if (!info) |
|
return; |
|
|
|
/* interrupts are disabled for this entire function */ |
|
|
|
local_irq_save(flags); |
|
|
|
if (tty_hung_up_p(filp)) { |
|
local_irq_restore(flags); |
|
return; |
|
} |
|
|
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("[%d] rs_close ttyS%d, count = %d\n", current->pid, |
|
info->line, info->count); |
|
#endif |
|
if ((tty->count == 1) && (info->port.count != 1)) { |
|
/* |
|
* Uh, oh. tty->count is 1, which means that the tty |
|
* structure will be freed. Info->count should always |
|
* be one in these conditions. If it's greater than |
|
* one, we've got real problems, since it means the |
|
* serial port won't be shutdown. |
|
*/ |
|
printk(KERN_ERR |
|
"rs_close: bad serial port count; tty->count is 1, " |
|
"info->count is %d\n", info->port.count); |
|
info->port.count = 1; |
|
} |
|
if (--info->port.count < 0) { |
|
printk(KERN_ERR "rs_close: bad serial port count for ttyS%d: %d\n", |
|
info->line, info->port.count); |
|
info->port.count = 0; |
|
} |
|
if (info->port.count) { |
|
local_irq_restore(flags); |
|
return; |
|
} |
|
info->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; |
|
if (info->port.closing_wait != ASYNC_CLOSING_WAIT_NONE) |
|
tty_wait_until_sent(tty, info->port.closing_wait); |
|
/* |
|
* At this point we stop accepting input. To do this, we |
|
* disable the serial receiver and the DMA receive interrupt. |
|
*/ |
|
#ifdef SERIAL_HANDLE_EARLY_ERRORS |
|
e100_disable_serial_data_irq(info); |
|
#endif |
|
|
|
e100_disable_rx(info); |
|
e100_disable_rx_irq(info); |
|
|
|
if (info->port.flags & ASYNC_INITIALIZED) { |
|
/* |
|
* Before we drop DTR, make sure the UART transmitter |
|
* has completely drained; this is especially |
|
* important as we have a transmit FIFO! |
|
*/ |
|
rs_wait_until_sent(tty, HZ); |
|
} |
|
|
|
shutdown(info); |
|
rs_flush_buffer(tty); |
|
tty_ldisc_flush(tty); |
|
tty->closing = 0; |
|
info->event = 0; |
|
info->port.tty = NULL; |
|
if (info->port.blocked_open) { |
|
if (info->port.close_delay) |
|
schedule_timeout_interruptible(info->port.close_delay); |
|
wake_up_interruptible(&info->port.open_wait); |
|
} |
|
info->port.flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING); |
|
local_irq_restore(flags); |
|
|
|
/* port closed */ |
|
|
|
#if defined(CONFIG_ETRAX_RS485) |
|
if (info->rs485.flags & SER_RS485_ENABLED) { |
|
info->rs485.flags &= ~(SER_RS485_ENABLED); |
|
#if defined(CONFIG_ETRAX_RS485_ON_PA) |
|
*R_PORT_PA_DATA = port_pa_data_shadow &= ~(1 << rs485_pa_bit); |
|
#endif |
|
} |
|
#endif |
|
|
|
/* |
|
* Release any allocated DMA irq's. |
|
*/ |
|
if (info->dma_in_enabled) { |
|
free_irq(info->dma_in_irq_nbr, info); |
|
cris_free_dma(info->dma_in_nbr, info->dma_in_irq_description); |
|
info->uses_dma_in = 0; |
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk(KERN_DEBUG "DMA irq '%s' freed\n", |
|
info->dma_in_irq_description); |
|
#endif |
|
} |
|
if (info->dma_out_enabled) { |
|
free_irq(info->dma_out_irq_nbr, info); |
|
cris_free_dma(info->dma_out_nbr, info->dma_out_irq_description); |
|
info->uses_dma_out = 0; |
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk(KERN_DEBUG "DMA irq '%s' freed\n", |
|
info->dma_out_irq_description); |
|
#endif |
|
} |
|
} |
|
|
|
/* |
|
* rs_wait_until_sent() --- wait until the transmitter is empty |
|
*/ |
|
static void rs_wait_until_sent(struct tty_struct *tty, int timeout) |
|
{ |
|
unsigned long orig_jiffies; |
|
struct e100_serial *info = (struct e100_serial *)tty->driver_data; |
|
unsigned long curr_time = jiffies; |
|
unsigned long curr_time_usec = GET_JIFFIES_USEC(); |
|
long elapsed_usec = |
|
(curr_time - info->last_tx_active) * (1000000/HZ) + |
|
curr_time_usec - info->last_tx_active_usec; |
|
|
|
/* |
|
* Check R_DMA_CHx_STATUS bit 0-6=number of available bytes in FIFO |
|
* R_DMA_CHx_HWSW bit 31-16=nbr of bytes left in DMA buffer (0=64k) |
|
*/ |
|
orig_jiffies = jiffies; |
|
while (info->xmit.head != info->xmit.tail || /* More in send queue */ |
|
(*info->ostatusadr & 0x007f) || /* more in FIFO */ |
|
(elapsed_usec < 2*info->char_time_usec)) { |
|
schedule_timeout_interruptible(1); |
|
if (signal_pending(current)) |
|
break; |
|
if (timeout && time_after(jiffies, orig_jiffies + timeout)) |
|
break; |
|
curr_time = jiffies; |
|
curr_time_usec = GET_JIFFIES_USEC(); |
|
elapsed_usec = |
|
(curr_time - info->last_tx_active) * (1000000/HZ) + |
|
curr_time_usec - info->last_tx_active_usec; |
|
} |
|
set_current_state(TASK_RUNNING); |
|
} |
|
|
|
/* |
|
* rs_hangup() --- called by tty_hangup() when a hangup is signaled. |
|
*/ |
|
void |
|
rs_hangup(struct tty_struct *tty) |
|
{ |
|
struct e100_serial * info = (struct e100_serial *)tty->driver_data; |
|
|
|
rs_flush_buffer(tty); |
|
shutdown(info); |
|
info->event = 0; |
|
info->port.count = 0; |
|
info->port.flags &= ~ASYNC_NORMAL_ACTIVE; |
|
info->port.tty = NULL; |
|
wake_up_interruptible(&info->port.open_wait); |
|
} |
|
|
|
/* |
|
* ------------------------------------------------------------ |
|
* rs_open() and friends |
|
* ------------------------------------------------------------ |
|
*/ |
|
static int |
|
block_til_ready(struct tty_struct *tty, struct file * filp, |
|
struct e100_serial *info) |
|
{ |
|
DECLARE_WAITQUEUE(wait, current); |
|
unsigned long flags; |
|
int retval; |
|
int do_clocal = 0; |
|
|
|
/* |
|
* 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))) { |
|
info->port.flags |= ASYNC_NORMAL_ACTIVE; |
|
return 0; |
|
} |
|
|
|
if (tty->termios.c_cflag & CLOCAL) { |
|
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->port.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(&info->port.open_wait, &wait); |
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("block_til_ready before block: ttyS%d, count = %d\n", |
|
info->line, info->port.count); |
|
#endif |
|
local_irq_save(flags); |
|
info->port.count--; |
|
local_irq_restore(flags); |
|
info->port.blocked_open++; |
|
while (1) { |
|
local_irq_save(flags); |
|
/* assert RTS and DTR */ |
|
e100_rts(info, 1); |
|
e100_dtr(info, 1); |
|
local_irq_restore(flags); |
|
set_current_state(TASK_INTERRUPTIBLE); |
|
if (tty_hung_up_p(filp) || |
|
!(info->port.flags & ASYNC_INITIALIZED)) { |
|
#ifdef SERIAL_DO_RESTART |
|
if (info->port.flags & ASYNC_HUP_NOTIFY) |
|
retval = -EAGAIN; |
|
else |
|
retval = -ERESTARTSYS; |
|
#else |
|
retval = -EAGAIN; |
|
#endif |
|
break; |
|
} |
|
if (do_clocal) |
|
/* && (do_clocal || DCD_IS_ASSERTED) */ |
|
break; |
|
if (signal_pending(current)) { |
|
retval = -ERESTARTSYS; |
|
break; |
|
} |
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("block_til_ready blocking: ttyS%d, count = %d\n", |
|
info->line, info->port.count); |
|
#endif |
|
tty_unlock(tty); |
|
schedule(); |
|
tty_lock(tty); |
|
} |
|
set_current_state(TASK_RUNNING); |
|
remove_wait_queue(&info->port.open_wait, &wait); |
|
if (!tty_hung_up_p(filp)) |
|
info->port.count++; |
|
info->port.blocked_open--; |
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("block_til_ready after blocking: ttyS%d, count = %d\n", |
|
info->line, info->port.count); |
|
#endif |
|
if (retval) |
|
return retval; |
|
info->port.flags |= ASYNC_NORMAL_ACTIVE; |
|
return 0; |
|
} |
|
|
|
static void |
|
deinit_port(struct e100_serial *info) |
|
{ |
|
if (info->dma_out_enabled) { |
|
cris_free_dma(info->dma_out_nbr, info->dma_out_irq_description); |
|
free_irq(info->dma_out_irq_nbr, info); |
|
} |
|
if (info->dma_in_enabled) { |
|
cris_free_dma(info->dma_in_nbr, info->dma_in_irq_description); |
|
free_irq(info->dma_in_irq_nbr, info); |
|
} |
|
} |
|
|
|
/* |
|
* This routine is called whenever a serial port is opened. |
|
* It performs the serial-specific initialization for the tty structure. |
|
*/ |
|
static int |
|
rs_open(struct tty_struct *tty, struct file * filp) |
|
{ |
|
struct e100_serial *info; |
|
int retval; |
|
int allocated_resources = 0; |
|
|
|
info = rs_table + tty->index; |
|
if (!info->enabled) |
|
return -ENODEV; |
|
|
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("[%d] rs_open %s, count = %d\n", current->pid, tty->name, |
|
info->port.count); |
|
#endif |
|
|
|
info->port.count++; |
|
tty->driver_data = info; |
|
info->port.tty = tty; |
|
|
|
info->port.low_latency = !!(info->port.flags & ASYNC_LOW_LATENCY); |
|
|
|
/* |
|
* If DMA is enabled try to allocate the irq's. |
|
*/ |
|
if (info->port.count == 1) { |
|
allocated_resources = 1; |
|
if (info->dma_in_enabled) { |
|
if (request_irq(info->dma_in_irq_nbr, |
|
rec_interrupt, |
|
info->dma_in_irq_flags, |
|
info->dma_in_irq_description, |
|
info)) { |
|
printk(KERN_WARNING "DMA irq '%s' busy; " |
|
"falling back to non-DMA mode\n", |
|
info->dma_in_irq_description); |
|
/* Make sure we never try to use DMA in */ |
|
/* for the port again. */ |
|
info->dma_in_enabled = 0; |
|
} else if (cris_request_dma(info->dma_in_nbr, |
|
info->dma_in_irq_description, |
|
DMA_VERBOSE_ON_ERROR, |
|
info->dma_owner)) { |
|
free_irq(info->dma_in_irq_nbr, info); |
|
printk(KERN_WARNING "DMA '%s' busy; " |
|
"falling back to non-DMA mode\n", |
|
info->dma_in_irq_description); |
|
/* Make sure we never try to use DMA in */ |
|
/* for the port again. */ |
|
info->dma_in_enabled = 0; |
|
} |
|
#ifdef SERIAL_DEBUG_OPEN |
|
else |
|
printk(KERN_DEBUG "DMA irq '%s' allocated\n", |
|
info->dma_in_irq_description); |
|
#endif |
|
} |
|
if (info->dma_out_enabled) { |
|
if (request_irq(info->dma_out_irq_nbr, |
|
tr_interrupt, |
|
info->dma_out_irq_flags, |
|
info->dma_out_irq_description, |
|
info)) { |
|
printk(KERN_WARNING "DMA irq '%s' busy; " |
|
"falling back to non-DMA mode\n", |
|
info->dma_out_irq_description); |
|
/* Make sure we never try to use DMA out */ |
|
/* for the port again. */ |
|
info->dma_out_enabled = 0; |
|
} else if (cris_request_dma(info->dma_out_nbr, |
|
info->dma_out_irq_description, |
|
DMA_VERBOSE_ON_ERROR, |
|
info->dma_owner)) { |
|
free_irq(info->dma_out_irq_nbr, info); |
|
printk(KERN_WARNING "DMA '%s' busy; " |
|
"falling back to non-DMA mode\n", |
|
info->dma_out_irq_description); |
|
/* Make sure we never try to use DMA out */ |
|
/* for the port again. */ |
|
info->dma_out_enabled = 0; |
|
} |
|
#ifdef SERIAL_DEBUG_OPEN |
|
else |
|
printk(KERN_DEBUG "DMA irq '%s' allocated\n", |
|
info->dma_out_irq_description); |
|
#endif |
|
} |
|
} |
|
|
|
/* |
|
* Start up the serial port |
|
*/ |
|
|
|
retval = startup(info); |
|
if (retval) { |
|
if (allocated_resources) |
|
deinit_port(info); |
|
|
|
/* FIXME Decrease count info->port.count here too? */ |
|
return retval; |
|
} |
|
|
|
|
|
retval = block_til_ready(tty, filp, info); |
|
if (retval) { |
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("rs_open returning after block_til_ready with %d\n", |
|
retval); |
|
#endif |
|
if (allocated_resources) |
|
deinit_port(info); |
|
|
|
return retval; |
|
} |
|
|
|
#ifdef SERIAL_DEBUG_OPEN |
|
printk("rs_open ttyS%d successful...\n", info->line); |
|
#endif |
|
DLOG_INT_TRIG( log_int_pos = 0); |
|
|
|
DFLIP( if (info->line == SERIAL_DEBUG_LINE) { |
|
info->icount.rx = 0; |
|
} ); |
|
|
|
return 0; |
|
} |
|
|
|
#ifdef CONFIG_PROC_FS |
|
/* |
|
* /proc fs routines.... |
|
*/ |
|
|
|
static void seq_line_info(struct seq_file *m, struct e100_serial *info) |
|
{ |
|
unsigned long tmp; |
|
|
|
seq_printf(m, "%d: uart:E100 port:%lX irq:%d", |
|
info->line, (unsigned long)info->ioport, info->irq); |
|
|
|
if (!info->ioport || (info->type == PORT_UNKNOWN)) { |
|
seq_printf(m, "\n"); |
|
return; |
|
} |
|
|
|
seq_printf(m, " baud:%d", info->baud); |
|
seq_printf(m, " tx:%lu rx:%lu", |
|
(unsigned long)info->icount.tx, |
|
(unsigned long)info->icount.rx); |
|
tmp = CIRC_CNT(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE); |
|
if (tmp) |
|
seq_printf(m, " tx_pend:%lu/%lu", |
|
(unsigned long)tmp, |
|
(unsigned long)SERIAL_XMIT_SIZE); |
|
|
|
seq_printf(m, " rx_pend:%lu/%lu", |
|
(unsigned long)info->recv_cnt, |
|
(unsigned long)info->max_recv_cnt); |
|
|
|
#if 1 |
|
if (info->port.tty) { |
|
if (info->port.tty->stopped) |
|
seq_printf(m, " stopped:%i", |
|
(int)info->port.tty->stopped); |
|
} |
|
|
|
{ |
|
unsigned char rstat = info->ioport[REG_STATUS]; |
|
if (rstat & IO_MASK(R_SERIAL0_STATUS, xoff_detect)) |
|
seq_printf(m, " xoff_detect:1"); |
|
} |
|
|
|
#endif |
|
|
|
if (info->icount.frame) |
|
seq_printf(m, " fe:%lu", (unsigned long)info->icount.frame); |
|
|
|
if (info->icount.parity) |
|
seq_printf(m, " pe:%lu", (unsigned long)info->icount.parity); |
|
|
|
if (info->icount.brk) |
|
seq_printf(m, " brk:%lu", (unsigned long)info->icount.brk); |
|
|
|
if (info->icount.overrun) |
|
seq_printf(m, " oe:%lu", (unsigned long)info->icount.overrun); |
|
|
|
/* |
|
* Last thing is the RS-232 status lines |
|
*/ |
|
if (!E100_RTS_GET(info)) |
|
seq_puts(m, "|RTS"); |
|
if (!E100_CTS_GET(info)) |
|
seq_puts(m, "|CTS"); |
|
if (!E100_DTR_GET(info)) |
|
seq_puts(m, "|DTR"); |
|
if (!E100_DSR_GET(info)) |
|
seq_puts(m, "|DSR"); |
|
if (!E100_CD_GET(info)) |
|
seq_puts(m, "|CD"); |
|
if (!E100_RI_GET(info)) |
|
seq_puts(m, "|RI"); |
|
seq_puts(m, "\n"); |
|
} |
|
|
|
|
|
static int crisv10_proc_show(struct seq_file *m, void *v) |
|
{ |
|
int i; |
|
|
|
seq_printf(m, "serinfo:1.0 driver:%s\n", serial_version); |
|
|
|
for (i = 0; i < NR_PORTS; i++) { |
|
if (!rs_table[i].enabled) |
|
continue; |
|
seq_line_info(m, &rs_table[i]); |
|
} |
|
#ifdef DEBUG_LOG_INCLUDED |
|
for (i = 0; i < debug_log_pos; i++) { |
|
seq_printf(m, "%-4i %lu.%lu ", |
|
i, debug_log[i].time, |
|
timer_data_to_ns(debug_log[i].timer_data)); |
|
seq_printf(m, debug_log[i].string, debug_log[i].value); |
|
} |
|
seq_printf(m, "debug_log %i/%i\n", i, DEBUG_LOG_SIZE); |
|
debug_log_pos = 0; |
|
#endif |
|
return 0; |
|
} |
|
|
|
static int crisv10_proc_open(struct inode *inode, struct file *file) |
|
{ |
|
return single_open(file, crisv10_proc_show, NULL); |
|
} |
|
|
|
static const struct file_operations crisv10_proc_fops = { |
|
.owner = THIS_MODULE, |
|
.open = crisv10_proc_open, |
|
.read = seq_read, |
|
.llseek = seq_lseek, |
|
.release = single_release, |
|
}; |
|
#endif |
|
|
|
|
|
/* Finally, routines used to initialize the serial driver. */ |
|
|
|
static void show_serial_version(void) |
|
{ |
|
printk(KERN_INFO |
|
"ETRAX 100LX serial-driver %s, " |
|
"(c) 2000-2004 Axis Communications AB\r\n", |
|
&serial_version[11]); /* "$Revision: x.yy" */ |
|
} |
|
|
|
/* rs_init inits the driver at boot (using the module_init chain) */ |
|
|
|
static const struct tty_operations rs_ops = { |
|
.open = rs_open, |
|
.close = rs_close, |
|
.write = rs_write, |
|
.flush_chars = rs_flush_chars, |
|
.write_room = rs_write_room, |
|
.chars_in_buffer = rs_chars_in_buffer, |
|
.flush_buffer = rs_flush_buffer, |
|
.ioctl = rs_ioctl, |
|
.throttle = rs_throttle, |
|
.unthrottle = rs_unthrottle, |
|
.set_termios = rs_set_termios, |
|
.stop = rs_stop, |
|
.start = rs_start, |
|
.hangup = rs_hangup, |
|
.break_ctl = rs_break, |
|
.send_xchar = rs_send_xchar, |
|
.wait_until_sent = rs_wait_until_sent, |
|
.tiocmget = rs_tiocmget, |
|
.tiocmset = rs_tiocmset, |
|
#ifdef CONFIG_PROC_FS |
|
.proc_fops = &crisv10_proc_fops, |
|
#endif |
|
}; |
|
|
|
static int __init rs_init(void) |
|
{ |
|
int i; |
|
struct e100_serial *info; |
|
struct tty_driver *driver = alloc_tty_driver(NR_PORTS); |
|
|
|
if (!driver) |
|
return -ENOMEM; |
|
|
|
show_serial_version(); |
|
|
|
/* Setup the timed flush handler system */ |
|
|
|
#if !defined(CONFIG_ETRAX_SERIAL_FAST_TIMER) |
|
setup_timer(&flush_timer, timed_flush_handler, 0); |
|
mod_timer(&flush_timer, jiffies + 5); |
|
#endif |
|
|
|
#if defined(CONFIG_ETRAX_RS485) |
|
#if defined(CONFIG_ETRAX_RS485_ON_PA) |
|
if (cris_io_interface_allocate_pins(if_serial_0, 'a', rs485_pa_bit, |
|
rs485_pa_bit)) { |
|
printk(KERN_ERR "ETRAX100LX serial: Could not allocate " |
|
"RS485 pin\n"); |
|
put_tty_driver(driver); |
|
return -EBUSY; |
|
} |
|
#endif |
|
#endif |
|
|
|
/* Initialize the tty_driver structure */ |
|
|
|
driver->driver_name = "serial"; |
|
driver->name = "ttyS"; |
|
driver->major = TTY_MAJOR; |
|
driver->minor_start = 64; |
|
driver->type = TTY_DRIVER_TYPE_SERIAL; |
|
driver->subtype = SERIAL_TYPE_NORMAL; |
|
driver->init_termios = tty_std_termios; |
|
driver->init_termios.c_cflag = |
|
B115200 | CS8 | CREAD | HUPCL | CLOCAL; /* is normally B9600 default... */ |
|
driver->init_termios.c_ispeed = 115200; |
|
driver->init_termios.c_ospeed = 115200; |
|
driver->flags = TTY_DRIVER_REAL_RAW; |
|
|
|
tty_set_operations(driver, &rs_ops); |
|
serial_driver = driver; |
|
|
|
/* do some initializing for the separate ports */ |
|
for (i = 0, info = rs_table; i < NR_PORTS; i++,info++) { |
|
if (info->enabled) { |
|
if (cris_request_io_interface(info->io_if, |
|
info->io_if_description)) { |
|
printk(KERN_ERR "ETRAX100LX async serial: " |
|
"Could not allocate IO pins for " |
|
"%s, port %d\n", |
|
info->io_if_description, i); |
|
info->enabled = 0; |
|
} |
|
} |
|
tty_port_init(&info->port); |
|
info->uses_dma_in = 0; |
|
info->uses_dma_out = 0; |
|
info->line = i; |
|
info->port.tty = NULL; |
|
info->type = PORT_ETRAX; |
|
info->tr_running = 0; |
|
info->forced_eop = 0; |
|
info->baud_base = DEF_BAUD_BASE; |
|
info->custom_divisor = 0; |
|
info->x_char = 0; |
|
info->event = 0; |
|
info->xmit.buf = NULL; |
|
info->xmit.tail = info->xmit.head = 0; |
|
info->first_recv_buffer = info->last_recv_buffer = NULL; |
|
info->recv_cnt = info->max_recv_cnt = 0; |
|
info->last_tx_active_usec = 0; |
|
info->last_tx_active = 0; |
|
|
|
#if defined(CONFIG_ETRAX_RS485) |
|
/* Set sane defaults */ |
|
info->rs485.flags &= ~(SER_RS485_RTS_ON_SEND); |
|
info->rs485.flags |= SER_RS485_RTS_AFTER_SEND; |
|
info->rs485.delay_rts_before_send = 0; |
|
info->rs485.flags &= ~(SER_RS485_ENABLED); |
|
#endif |
|
INIT_WORK(&info->work, do_softint); |
|
|
|
if (info->enabled) { |
|
printk(KERN_INFO "%s%d at %p is a builtin UART with DMA\n", |
|
serial_driver->name, info->line, info->ioport); |
|
} |
|
tty_port_link_device(&info->port, driver, i); |
|
} |
|
|
|
if (tty_register_driver(driver)) |
|
panic("Couldn't register serial driver\n"); |
|
|
|
#ifdef CONFIG_ETRAX_FAST_TIMER |
|
#ifdef CONFIG_ETRAX_SERIAL_FAST_TIMER |
|
memset(fast_timers, 0, sizeof(fast_timers)); |
|
#endif |
|
#ifdef CONFIG_ETRAX_RS485 |
|
memset(fast_timers_rs485, 0, sizeof(fast_timers_rs485)); |
|
#endif |
|
fast_timer_init(); |
|
#endif |
|
|
|
#ifndef CONFIG_ETRAX_KGDB |
|
/* Not needed in simulator. May only complicate stuff. */ |
|
/* hook the irq's for DMA channel 6 and 7, serial output and input, and some more... */ |
|
|
|
if (request_irq(SERIAL_IRQ_NBR, ser_interrupt, |
|
IRQF_SHARED, "serial ", driver)) |
|
panic("%s: Failed to request irq8", __func__); |
|
|
|
#endif |
|
|
|
return 0; |
|
} |
|
|
|
/* this makes sure that rs_init is called during kernel boot */ |
|
|
|
module_init(rs_init);
|
|
|