mirror of
				git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
				synced 2025-09-04 20:19:47 +08:00 
			
		
		
		
	 174cd4b1e5
			
		
	
	
		174cd4b1e5
		
	
	
	
	
		
			
			Fix up affected files that include this signal functionality via sched.h. Acked-by: Linus Torvalds <torvalds@linux-foundation.org> Cc: Mike Galbraith <efault@gmx.de> Cc: Peter Zijlstra <peterz@infradead.org> Cc: Thomas Gleixner <tglx@linutronix.de> Cc: linux-kernel@vger.kernel.org Signed-off-by: Ingo Molnar <mingo@kernel.org>
		
			
				
	
	
		
			4248 lines
		
	
	
		
			117 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			4248 lines
		
	
	
		
			117 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * 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/signal.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/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 (I_IXON(tty))
 | |
| 			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 (I_IXON(tty))
 | |
| 			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 (tty_port_initialized(&info->port)) {
 | |
| 		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);
 | |
| 
 | |
| 	tty_port_set_initialized(&info->port, 1);
 | |
| 
 | |
| 	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 (!tty_port_initialized(&info->port))
 | |
| 		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);
 | |
| 
 | |
| 	tty_port_set_initialized(&info->port, 0);
 | |
| 	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\n"));
 | |
| 
 | |
| 
 | |
| 	/* 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 ....\n", tty_name(tty));
 | |
| #endif
 | |
| 	DFLOW(DEBUG_LOG(info->line,"rs_throttle\n"));
 | |
| 
 | |
| 	/* Do RTS before XOFF since XOFF might take some time */
 | |
| 	if (C_CRTSCTS(tty)) {
 | |
| 		/* 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 ....\n", tty_name(tty));
 | |
| #endif
 | |
| 	DFLOW(DEBUG_LOG(info->line,"rs_unthrottle ldisc\n"));
 | |
| 	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 (C_CRTSCTS(tty)) {
 | |
| 		/* 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.
 | |
| 	 */
 | |
| 
 | |
| 	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 (tty_port_initialized(&info->port))
 | |
| 		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_io_error(tty))
 | |
| 			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) && !C_CRTSCTS(tty))
 | |
| 		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;
 | |
| 	}
 | |
| 	/*
 | |
| 	 * 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 (tty_port_initialized(&info->port)) {
 | |
| 		/*
 | |
| 		 * 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);
 | |
| 	}
 | |
| 	local_irq_restore(flags);
 | |
| 	tty_port_set_active(&info->port, 0);
 | |
| 
 | |
| 	/* 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;
 | |
| 	tty_port_set_active(&info->port, 0);
 | |
| 	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_io_error(tty)) {
 | |
| 		tty_port_set_active(&info->port, 1);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	if (C_CLOCAL(tty))
 | |
| 		do_clocal = 1;
 | |
| 
 | |
| 	/*
 | |
| 	 * Block waiting for the carrier detect and the line to become
 | |
| 	 * free (i.e., not in use by the callout).  While we are in
 | |
| 	 * this loop, info->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) || !tty_port_initialized(&info->port)) {
 | |
| #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;
 | |
| 	tty_port_set_active(&info->port, 1);
 | |
| 	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 initcall 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 */
 | |
| device_initcall(rs_init);
 |