summaryrefslogtreecommitdiff
path: root/target
diff options
context:
space:
mode:
authorWaldemar Brodkorb <wbx@openadk.org>2010-01-10 16:47:55 +0100
committerWaldemar Brodkorb <wbx@openadk.org>2010-01-10 16:47:55 +0100
commitb3b32918faf1d63a84c68b24c866d8a849adfdae (patch)
tree934797e131208c68abd66d64eefe63ebb087ccec /target
parent940a3a2497867e7fb2044a437175619b65f04334 (diff)
parentcfc200714ddfa6d76feb836c258b1135d91a8348 (diff)
Merge branch 'master' of git+ssh://openadk.org/git/openadk
Diffstat (limited to 'target')
-rw-r--r--target/foxboard/Makefile11
-rw-r--r--target/foxboard/patches/cris.patch6556
2 files changed, 6498 insertions, 69 deletions
diff --git a/target/foxboard/Makefile b/target/foxboard/Makefile
index a21647355..dd6e167c2 100644
--- a/target/foxboard/Makefile
+++ b/target/foxboard/Makefile
@@ -24,10 +24,13 @@ ifeq ($(FS),squashfs)
imageinstall: $(BIN_DIR)/$(ROOTFSSQUASHFS)
dd if=${BUILD_DIR}/${ROOTFSSQUASHFS} of=${BIN_DIR}/${ROOTFSSQUASHFS} \
bs=4063232 conv=sync $(MAKE_TRACE)
- @echo
- @echo Use sudo ./boot_linux -F -i $(ROOTFSSQUASHFS) to flash
- @echo Do not forget to set network boot jumper, before you start the foxboard
- @echo 'Login as user root with password linux123 via ssh or console'
+ @if [ $$(stat --format=%s ${BIN_DIR}/${ROOTFSSQUASHFS}) -gt 4063232 ];then \
+ echo 'Image is too big!'; \
+ else \
+ echo 'Use sudo ./boot_linux -F -i $(ROOTFSSQUASHFS) to flash'; \
+ echo 'Do not forget to set the network boot jumper, before you start the foxboard'; \
+ echo 'Login as user root with password linux123 via ssh or console'; \
+ fi
endif
ifeq ($(FS),nfsroot)
imageinstall: ${BIN_DIR}/${ROOTFSTARBALL}
diff --git a/target/foxboard/patches/cris.patch b/target/foxboard/patches/cris.patch
index 277e1757d..3c6bca534 100644
--- a/target/foxboard/patches/cris.patch
+++ b/target/foxboard/patches/cris.patch
@@ -1,7 +1,16 @@
-diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/axisflashmap.c linux-2.6.31.5/arch/cris/arch-v10/drivers/axisflashmap.c
---- linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/axisflashmap.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/arch-v10/drivers/axisflashmap.c 2009-11-09 21:10:52.565914436 +0100
-@@ -122,19 +122,19 @@
+diff -Nur linux-2.6.32.orig/arch/cris/arch-v10/drivers/axisflashmap.c linux-2.6.32/arch/cris/arch-v10/drivers/axisflashmap.c
+--- linux-2.6.32.orig/arch/cris/arch-v10/drivers/axisflashmap.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/arch-v10/drivers/axisflashmap.c 2010-01-10 14:34:37.376309632 +0100
+@@ -113,7 +113,7 @@
+
+ /* If no partition-table was found, we use this default-set. */
+ #define MAX_PARTITIONS 7
+-#define NUM_DEFAULT_PARTITIONS 3
++#define NUM_DEFAULT_PARTITIONS 4
+
+ /*
+ * Default flash size is 2MB. CONFIG_ETRAX_PTABLE_SECTOR is most likely the
+@@ -122,19 +122,24 @@
*/
static struct mtd_partition axis_default_partitions[NUM_DEFAULT_PARTITIONS] = {
{
@@ -26,10 +35,15 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/axisflashmap.c linux-2.
+ .name = "cfgfs",
+ .size = 0x20000 ,
+ .offset = CONFIG_ETRAX_MTD_SIZE - 0x20000
++ },
++ {
++ .name = "linux",
++ .size = CONFIG_ETRAX_MTD_SIZE - 0x20000,
++ .offset = 0
}
};
-@@ -281,6 +281,11 @@
+@@ -281,6 +286,11 @@
struct partitiontable_entry *ptable;
int use_default_ptable = 1; /* Until proven otherwise. */
const char pmsg[] = " /dev/flash%d at 0x%08x, size 0x%08x\n";
@@ -41,7 +55,7 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/axisflashmap.c linux-2.
if (!(mymtd = flash_probe())) {
/* There's no reason to use this module if no flash chip can
-@@ -292,6 +297,31 @@
+@@ -292,6 +302,31 @@
mymtd->name, mymtd->size);
axisflash_mtd = mymtd;
}
@@ -73,7 +87,7 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/axisflashmap.c linux-2.
if (mymtd) {
mymtd->owner = THIS_MODULE;
-@@ -360,21 +390,6 @@
+@@ -360,21 +395,6 @@
use_default_ptable = !ptable_ok;
}
@@ -95,7 +109,7 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/axisflashmap.c linux-2.
#ifdef CONFIG_ETRAX_AXISFLASHMAP_MTD0WHOLE
if (mymtd) {
main_partition.size = mymtd->size;
-@@ -397,36 +412,6 @@
+@@ -397,36 +417,6 @@
if (err)
panic("axisflashmap could not add MTD partitions!\n");
}
@@ -132,9 +146,9 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/axisflashmap.c linux-2.
return err;
}
-diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/ds1302.c linux-2.6.31.5/arch/cris/arch-v10/drivers/ds1302.c
---- linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/ds1302.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/arch-v10/drivers/ds1302.c 2009-11-09 21:10:52.569915505 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/arch-v10/drivers/ds1302.c linux-2.6.32/arch/cris/arch-v10/drivers/ds1302.c
+--- linux-2.6.32.orig/arch/cris/arch-v10/drivers/ds1302.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/arch-v10/drivers/ds1302.c 2010-01-10 13:41:59.256309588 +0100
@@ -21,6 +21,7 @@
#include <linux/delay.h>
#include <linux/bcd.h>
@@ -167,9 +181,9 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/ds1302.c linux-2.6.31.5
return 0;
}
-diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/gpio.c linux-2.6.31.5/arch/cris/arch-v10/drivers/gpio.c
---- linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/gpio.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/arch-v10/drivers/gpio.c 2009-11-09 21:10:52.569915505 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/arch-v10/drivers/gpio.c linux-2.6.32/arch/cris/arch-v10/drivers/gpio.c
+--- linux-2.6.32.orig/arch/cris/arch-v10/drivers/gpio.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/arch-v10/drivers/gpio.c 2010-01-10 13:41:59.256309588 +0100
@@ -21,6 +21,7 @@
#include <linux/poll.h>
#include <linux/init.h>
@@ -203,18 +217,18 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/drivers/gpio.c linux-2.6.31.5/a
/* Clear all leds */
#if defined (CONFIG_ETRAX_CSP0_LEDS) || defined (CONFIG_ETRAX_PA_LEDS) || defined (CONFIG_ETRAX_PB_LEDS)
CRIS_LED_NETWORK_SET(0);
-diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/lib/hw_settings.S linux-2.6.31.5/arch/cris/arch-v10/lib/hw_settings.S
---- linux-2.6.31.5.orig/arch/cris/arch-v10/lib/hw_settings.S 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/arch-v10/lib/hw_settings.S 2009-11-09 21:10:52.622221897 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/arch-v10/lib/hw_settings.S linux-2.6.32/arch/cris/arch-v10/lib/hw_settings.S
+--- linux-2.6.32.orig/arch/cris/arch-v10/lib/hw_settings.S 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/arch-v10/lib/hw_settings.S 2010-01-10 13:41:59.256309588 +0100
@@ -60,3 +60,5 @@
.dword R_PORT_PB_SET
.dword PB_SET_VALUE
.dword 0 ; No more register values
+ .ascii "ACME_PART_MAGIC"
+ .dword 0xdeadc0de
-diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/mm/init.c linux-2.6.31.5/arch/cris/arch-v10/mm/init.c
---- linux-2.6.31.5.orig/arch/cris/arch-v10/mm/init.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/arch-v10/mm/init.c 2009-11-09 21:10:52.669914289 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/arch-v10/mm/init.c linux-2.6.32/arch/cris/arch-v10/mm/init.c
+--- linux-2.6.32.orig/arch/cris/arch-v10/mm/init.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/arch-v10/mm/init.c 2010-01-10 13:41:59.256309588 +0100
@@ -184,6 +184,9 @@
free_area_init_node(0, zones_size, PAGE_OFFSET >> PAGE_SHIFT, 0);
@@ -225,9 +239,9 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/arch-v10/mm/init.c linux-2.6.31.5/arch/c
/* Initialize remaps of some I/O-ports. It is important that this
* is called before any driver is initialized.
-diff -Nur linux-2.6.31.5.orig/arch/cris/boot/compressed/Makefile linux-2.6.31.5/arch/cris/boot/compressed/Makefile
---- linux-2.6.31.5.orig/arch/cris/boot/compressed/Makefile 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/boot/compressed/Makefile 2009-11-09 21:10:52.673930723 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/boot/compressed/Makefile linux-2.6.32/arch/cris/boot/compressed/Makefile
+--- linux-2.6.32.orig/arch/cris/boot/compressed/Makefile 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/boot/compressed/Makefile 2010-01-10 13:41:59.256309588 +0100
@@ -18,7 +18,7 @@
OBJECTS-$(CONFIG_ETRAX_ARCH_V32) = $(obj)/head_v32.o
OBJECTS-$(CONFIG_ETRAX_ARCH_V10) = $(obj)/head_v10.o
@@ -237,9 +251,9 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/boot/compressed/Makefile linux-2.6.31.5/
quiet_cmd_image = BUILD $@
cmd_image = cat $(obj)/decompress.bin $(obj)/piggy.gz > $@
-diff -Nur linux-2.6.31.5.orig/arch/cris/boot/compressed/misc.c linux-2.6.31.5/arch/cris/boot/compressed/misc.c
---- linux-2.6.31.5.orig/arch/cris/boot/compressed/misc.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/boot/compressed/misc.c 2009-11-09 21:10:52.677915030 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/boot/compressed/misc.c linux-2.6.32/arch/cris/boot/compressed/misc.c
+--- linux-2.6.32.orig/arch/cris/boot/compressed/misc.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/boot/compressed/misc.c 2010-01-10 13:41:59.256309588 +0100
@@ -106,7 +106,7 @@
static void flush_window(void);
@@ -290,9 +304,9 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/boot/compressed/misc.c linux-2.6.31.5/ar
- puts("Done. Now booting the kernel\n");
+ putstr("Done. Now booting the kernel\n");
}
-diff -Nur linux-2.6.31.5.orig/arch/cris/boot/Makefile linux-2.6.31.5/arch/cris/boot/Makefile
---- linux-2.6.31.5.orig/arch/cris/boot/Makefile 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/boot/Makefile 2009-11-09 21:10:52.729928085 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/boot/Makefile linux-2.6.32/arch/cris/boot/Makefile
+--- linux-2.6.32.orig/arch/cris/boot/Makefile 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/boot/Makefile 2010-01-10 13:41:59.256309588 +0100
@@ -5,7 +5,7 @@
objcopyflags-$(CONFIG_ETRAX_ARCH_V10) += -R .note -R .comment
objcopyflags-$(CONFIG_ETRAX_ARCH_V32) += --remove-section=.bss
@@ -310,9 +324,9 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/boot/Makefile linux-2.6.31.5/arch/cris/b
$(obj)/zImage: $(obj)/compressed/vmlinux
@cp $< $@
-diff -Nur linux-2.6.31.5.orig/arch/cris/Kconfig linux-2.6.31.5/arch/cris/Kconfig
---- linux-2.6.31.5.orig/arch/cris/Kconfig 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/Kconfig 2009-11-09 21:10:52.761915122 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/Kconfig linux-2.6.32/arch/cris/Kconfig
+--- linux-2.6.32.orig/arch/cris/Kconfig 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/Kconfig 2010-01-10 13:41:59.256309588 +0100
@@ -168,6 +168,12 @@
help
Size of DRAM (decimal in MB) typically 2, 8 or 16.
@@ -347,9 +361,9 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/Kconfig linux-2.6.31.5/arch/cris/Kconfig
source "drivers/net/Kconfig"
source "drivers/i2c/Kconfig"
-diff -Nur linux-2.6.31.5.orig/arch/cris/Makefile linux-2.6.31.5/arch/cris/Makefile
---- linux-2.6.31.5.orig/arch/cris/Makefile 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/arch/cris/Makefile 2009-11-09 21:12:38.534695929 +0100
+diff -Nur linux-2.6.32.orig/arch/cris/Makefile linux-2.6.32/arch/cris/Makefile
+--- linux-2.6.32.orig/arch/cris/Makefile 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/arch/cris/Makefile 2010-01-10 13:41:59.256309588 +0100
@@ -40,10 +40,10 @@
LD = $(CROSS_COMPILE)ld -mcrislinux
@@ -363,10 +377,10 @@ diff -Nur linux-2.6.31.5.orig/arch/cris/Makefile linux-2.6.31.5/arch/cris/Makefi
KBUILD_CPPFLAGS += $(inc)
ifdef CONFIG_FRAME_POINTER
-diff -Nur linux-2.6.31.5.orig/drivers/net/cris/eth_v10.c linux-2.6.31.5/drivers/net/cris/eth_v10.c
---- linux-2.6.31.5.orig/drivers/net/cris/eth_v10.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/drivers/net/cris/eth_v10.c 2009-11-09 21:10:52.857914224 +0100
-@@ -1711,7 +1711,7 @@
+diff -Nur linux-2.6.32.orig/drivers/net/cris/eth_v10.c linux-2.6.32/drivers/net/cris/eth_v10.c
+--- linux-2.6.32.orig/drivers/net/cris/eth_v10.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/drivers/net/cris/eth_v10.c 2010-01-10 13:41:59.256309588 +0100
+@@ -1725,7 +1725,7 @@
static void
e100_netpoll(struct net_device* netdev)
{
@@ -375,9 +389,1773 @@ diff -Nur linux-2.6.31.5.orig/drivers/net/cris/eth_v10.c linux-2.6.31.5/drivers/
}
#endif
-diff -Nur linux-2.6.31.5.orig/drivers/serial/crisv10.c linux-2.6.31.5/drivers/serial/crisv10.c
---- linux-2.6.31.5.orig/drivers/serial/crisv10.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/drivers/serial/crisv10.c 2009-11-10 07:59:31.341915786 +0100
+diff -Nur linux-2.6.32.orig/drivers/net/cris/eth_v10.c.orig linux-2.6.32/drivers/net/cris/eth_v10.c.orig
+--- linux-2.6.32.orig/drivers/net/cris/eth_v10.c.orig 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.32/drivers/net/cris/eth_v10.c.orig 2009-12-03 04:51:21.000000000 +0100
+@@ -0,0 +1,1760 @@
++/*
++ * e100net.c: A network driver for the ETRAX 100LX network controller.
++ *
++ * Copyright (c) 1998-2002 Axis Communications AB.
++ *
++ * The outline of this driver comes from skeleton.c.
++ *
++ */
++
++
++#include <linux/module.h>
++
++#include <linux/kernel.h>
++#include <linux/delay.h>
++#include <linux/types.h>
++#include <linux/fcntl.h>
++#include <linux/interrupt.h>
++#include <linux/ptrace.h>
++#include <linux/ioport.h>
++#include <linux/in.h>
++#include <linux/slab.h>
++#include <linux/string.h>
++#include <linux/spinlock.h>
++#include <linux/errno.h>
++#include <linux/init.h>
++#include <linux/bitops.h>
++
++#include <linux/if.h>
++#include <linux/mii.h>
++#include <linux/netdevice.h>
++#include <linux/etherdevice.h>
++#include <linux/skbuff.h>
++#include <linux/ethtool.h>
++
++#include <arch/svinto.h>/* DMA and register descriptions */
++#include <asm/io.h> /* CRIS_LED_* I/O functions */
++#include <asm/irq.h>
++#include <asm/dma.h>
++#include <asm/system.h>
++#include <asm/ethernet.h>
++#include <asm/cache.h>
++#include <arch/io_interface_mux.h>
++
++//#define ETHDEBUG
++#define D(x)
++
++/*
++ * The name of the card. Is used for messages and in the requests for
++ * io regions, irqs and dma channels
++ */
++
++static const char* cardname = "ETRAX 100LX built-in ethernet controller";
++
++/* A default ethernet address. Highlevel SW will set the real one later */
++
++static struct sockaddr default_mac = {
++ 0,
++ { 0x00, 0x40, 0x8C, 0xCD, 0x00, 0x00 }
++};
++
++/* Information that need to be kept for each board. */
++struct net_local {
++ struct net_device_stats stats;
++ struct mii_if_info mii_if;
++
++ /* Tx control lock. This protects the transmit buffer ring
++ * state along with the "tx full" state of the driver. This
++ * means all netif_queue flow control actions are protected
++ * by this lock as well.
++ */
++ spinlock_t lock;
++
++ spinlock_t led_lock; /* Protect LED state */
++ spinlock_t transceiver_lock; /* Protect transceiver state. */
++};
++
++typedef struct etrax_eth_descr
++{
++ etrax_dma_descr descr;
++ struct sk_buff* skb;
++} etrax_eth_descr;
++
++/* Some transceivers requires special handling */
++struct transceiver_ops
++{
++ unsigned int oui;
++ void (*check_speed)(struct net_device* dev);
++ void (*check_duplex)(struct net_device* dev);
++};
++
++/* Duplex settings */
++enum duplex
++{
++ half,
++ full,
++ autoneg
++};
++
++/* Dma descriptors etc. */
++
++#define MAX_MEDIA_DATA_SIZE 1522
++
++#define MIN_PACKET_LEN 46
++#define ETHER_HEAD_LEN 14
++
++/*
++** MDIO constants.
++*/
++#define MDIO_START 0x1
++#define MDIO_READ 0x2
++#define MDIO_WRITE 0x1
++#define MDIO_PREAMBLE 0xfffffffful
++
++/* Broadcom specific */
++#define MDIO_AUX_CTRL_STATUS_REG 0x18
++#define MDIO_BC_FULL_DUPLEX_IND 0x1
++#define MDIO_BC_SPEED 0x2
++
++/* TDK specific */
++#define MDIO_TDK_DIAGNOSTIC_REG 18
++#define MDIO_TDK_DIAGNOSTIC_RATE 0x400
++#define MDIO_TDK_DIAGNOSTIC_DPLX 0x800
++
++/*Intel LXT972A specific*/
++#define MDIO_INT_STATUS_REG_2 0x0011
++#define MDIO_INT_FULL_DUPLEX_IND (1 << 9)
++#define MDIO_INT_SPEED (1 << 14)
++
++/* Network flash constants */
++#define NET_FLASH_TIME (HZ/50) /* 20 ms */
++#define NET_FLASH_PAUSE (HZ/100) /* 10 ms */
++#define NET_LINK_UP_CHECK_INTERVAL (2*HZ) /* 2 s */
++#define NET_DUPLEX_CHECK_INTERVAL (2*HZ) /* 2 s */
++
++#define NO_NETWORK_ACTIVITY 0
++#define NETWORK_ACTIVITY 1
++
++#define NBR_OF_RX_DESC 32
++#define NBR_OF_TX_DESC 16
++
++/* Large packets are sent directly to upper layers while small packets are */
++/* copied (to reduce memory waste). The following constant decides the breakpoint */
++#define RX_COPYBREAK 256
++
++/* Due to a chip bug we need to flush the cache when descriptors are returned */
++/* to the DMA. To decrease performance impact we return descriptors in chunks. */
++/* The following constant determines the number of descriptors to return. */
++#define RX_QUEUE_THRESHOLD NBR_OF_RX_DESC/2
++
++#define GET_BIT(bit,val) (((val) >> (bit)) & 0x01)
++
++/* Define some macros to access ETRAX 100 registers */
++#define SETF(var, reg, field, val) var = (var & ~IO_MASK_(reg##_, field##_)) | \
++ IO_FIELD_(reg##_, field##_, val)
++#define SETS(var, reg, field, val) var = (var & ~IO_MASK_(reg##_, field##_)) | \
++ IO_STATE_(reg##_, field##_, _##val)
++
++static etrax_eth_descr *myNextRxDesc; /* Points to the next descriptor to
++ to be processed */
++static etrax_eth_descr *myLastRxDesc; /* The last processed descriptor */
++
++static etrax_eth_descr RxDescList[NBR_OF_RX_DESC] __attribute__ ((aligned(32)));
++
++static etrax_eth_descr* myFirstTxDesc; /* First packet not yet sent */
++static etrax_eth_descr* myLastTxDesc; /* End of send queue */
++static etrax_eth_descr* myNextTxDesc; /* Next descriptor to use */
++static etrax_eth_descr TxDescList[NBR_OF_TX_DESC] __attribute__ ((aligned(32)));
++
++static unsigned int network_rec_config_shadow = 0;
++
++static unsigned int network_tr_ctrl_shadow = 0;
++
++/* Network speed indication. */
++static DEFINE_TIMER(speed_timer, NULL, 0, 0);
++static DEFINE_TIMER(clear_led_timer, NULL, 0, 0);
++static int current_speed; /* Speed read from transceiver */
++static int current_speed_selection; /* Speed selected by user */
++static unsigned long led_next_time;
++static int led_active;
++static int rx_queue_len;
++
++/* Duplex */
++static DEFINE_TIMER(duplex_timer, NULL, 0, 0);
++static int full_duplex;
++static enum duplex current_duplex;
++
++/* Index to functions, as function prototypes. */
++
++static int etrax_ethernet_init(void);
++
++static int e100_open(struct net_device *dev);
++static int e100_set_mac_address(struct net_device *dev, void *addr);
++static int e100_send_packet(struct sk_buff *skb, struct net_device *dev);
++static irqreturn_t e100rxtx_interrupt(int irq, void *dev_id);
++static irqreturn_t e100nw_interrupt(int irq, void *dev_id);
++static void e100_rx(struct net_device *dev);
++static int e100_close(struct net_device *dev);
++static int e100_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd);
++static int e100_set_config(struct net_device* dev, struct ifmap* map);
++static void e100_tx_timeout(struct net_device *dev);
++static struct net_device_stats *e100_get_stats(struct net_device *dev);
++static void set_multicast_list(struct net_device *dev);
++static void e100_hardware_send_packet(struct net_local* np, char *buf, int length);
++static void update_rx_stats(struct net_device_stats *);
++static void update_tx_stats(struct net_device_stats *);
++static int e100_probe_transceiver(struct net_device* dev);
++
++static void e100_check_speed(unsigned long priv);
++static void e100_set_speed(struct net_device* dev, unsigned long speed);
++static void e100_check_duplex(unsigned long priv);
++static void e100_set_duplex(struct net_device* dev, enum duplex);
++static void e100_negotiate(struct net_device* dev);
++
++static int e100_get_mdio_reg(struct net_device *dev, int phy_id, int location);
++static void e100_set_mdio_reg(struct net_device *dev, int phy_id, int location, int value);
++
++static void e100_send_mdio_cmd(unsigned short cmd, int write_cmd);
++static void e100_send_mdio_bit(unsigned char bit);
++static unsigned char e100_receive_mdio_bit(void);
++static void e100_reset_transceiver(struct net_device* net);
++
++static void e100_clear_network_leds(unsigned long dummy);
++static void e100_set_network_leds(int active);
++
++static const struct ethtool_ops e100_ethtool_ops;
++#if defined(CONFIG_ETRAX_NO_PHY)
++static void dummy_check_speed(struct net_device* dev);
++static void dummy_check_duplex(struct net_device* dev);
++#else
++static void broadcom_check_speed(struct net_device* dev);
++static void broadcom_check_duplex(struct net_device* dev);
++static void tdk_check_speed(struct net_device* dev);
++static void tdk_check_duplex(struct net_device* dev);
++static void intel_check_speed(struct net_device* dev);
++static void intel_check_duplex(struct net_device* dev);
++static void generic_check_speed(struct net_device* dev);
++static void generic_check_duplex(struct net_device* dev);
++#endif
++#ifdef CONFIG_NET_POLL_CONTROLLER
++static void e100_netpoll(struct net_device* dev);
++#endif
++
++static int autoneg_normal = 1;
++
++struct transceiver_ops transceivers[] =
++{
++#if defined(CONFIG_ETRAX_NO_PHY)
++ {0x0000, dummy_check_speed, dummy_check_duplex} /* Dummy */
++#else
++ {0x1018, broadcom_check_speed, broadcom_check_duplex}, /* Broadcom */
++ {0xC039, tdk_check_speed, tdk_check_duplex}, /* TDK 2120 */
++ {0x039C, tdk_check_speed, tdk_check_duplex}, /* TDK 2120C */
++ {0x04de, intel_check_speed, intel_check_duplex}, /* Intel LXT972A*/
++ {0x0000, generic_check_speed, generic_check_duplex} /* Generic, must be last */
++#endif
++};
++
++struct transceiver_ops* transceiver = &transceivers[0];
++
++static const struct net_device_ops e100_netdev_ops = {
++ .ndo_open = e100_open,
++ .ndo_stop = e100_close,
++ .ndo_start_xmit = e100_send_packet,
++ .ndo_tx_timeout = e100_tx_timeout,
++ .ndo_get_stats = e100_get_stats,
++ .ndo_set_multicast_list = set_multicast_list,
++ .ndo_do_ioctl = e100_ioctl,
++ .ndo_set_mac_address = e100_set_mac_address,
++ .ndo_validate_addr = eth_validate_addr,
++ .ndo_change_mtu = eth_change_mtu,
++ .ndo_set_config = e100_set_config,
++#ifdef CONFIG_NET_POLL_CONTROLLER
++ .ndo_poll_controller = e100_netpoll,
++#endif
++};
++
++#define tx_done(dev) (*R_DMA_CH0_CMD == 0)
++
++/*
++ * Check for a network adaptor of this type, and return '0' if one exists.
++ * If dev->base_addr == 0, probe all likely locations.
++ * If dev->base_addr == 1, always return failure.
++ * If dev->base_addr == 2, allocate space for the device and return success
++ * (detachable devices only).
++ */
++
++static int __init
++etrax_ethernet_init(void)
++{
++ struct net_device *dev;
++ struct net_local* np;
++ int i, err;
++
++ printk(KERN_INFO
++ "ETRAX 100LX 10/100MBit ethernet v2.0 (c) 1998-2007 Axis Communications AB\n");
++
++ if (cris_request_io_interface(if_eth, cardname)) {
++ printk(KERN_CRIT "etrax_ethernet_init failed to get IO interface\n");
++ return -EBUSY;
++ }
++
++ dev = alloc_etherdev(sizeof(struct net_local));
++ if (!dev)
++ return -ENOMEM;
++
++ np = netdev_priv(dev);
++
++ /* we do our own locking */
++ dev->features |= NETIF_F_LLTX;
++
++ dev->base_addr = (unsigned int)R_NETWORK_SA_0; /* just to have something to show */
++
++ /* now setup our etrax specific stuff */
++
++ dev->irq = NETWORK_DMA_RX_IRQ_NBR; /* we really use DMATX as well... */
++ dev->dma = NETWORK_RX_DMA_NBR;
++
++ /* fill in our handlers so the network layer can talk to us in the future */
++
++ dev->ethtool_ops = &e100_ethtool_ops;
++ dev->netdev_ops = &e100_netdev_ops;
++
++ spin_lock_init(&np->lock);
++ spin_lock_init(&np->led_lock);
++ spin_lock_init(&np->transceiver_lock);
++
++ /* Initialise the list of Etrax DMA-descriptors */
++
++ /* Initialise receive descriptors */
++
++ for (i = 0; i < NBR_OF_RX_DESC; i++) {
++ /* Allocate two extra cachelines to make sure that buffer used
++ * by DMA does not share cacheline with any other data (to
++ * avoid cache bug)
++ */
++ RxDescList[i].skb = dev_alloc_skb(MAX_MEDIA_DATA_SIZE + 2 * L1_CACHE_BYTES);
++ if (!RxDescList[i].skb)
++ return -ENOMEM;
++ RxDescList[i].descr.ctrl = 0;
++ RxDescList[i].descr.sw_len = MAX_MEDIA_DATA_SIZE;
++ RxDescList[i].descr.next = virt_to_phys(&RxDescList[i + 1]);
++ RxDescList[i].descr.buf = L1_CACHE_ALIGN(virt_to_phys(RxDescList[i].skb->data));
++ RxDescList[i].descr.status = 0;
++ RxDescList[i].descr.hw_len = 0;
++ prepare_rx_descriptor(&RxDescList[i].descr);
++ }
++
++ RxDescList[NBR_OF_RX_DESC - 1].descr.ctrl = d_eol;
++ RxDescList[NBR_OF_RX_DESC - 1].descr.next = virt_to_phys(&RxDescList[0]);
++ rx_queue_len = 0;
++
++ /* Initialize transmit descriptors */
++ for (i = 0; i < NBR_OF_TX_DESC; i++) {
++ TxDescList[i].descr.ctrl = 0;
++ TxDescList[i].descr.sw_len = 0;
++ TxDescList[i].descr.next = virt_to_phys(&TxDescList[i + 1].descr);
++ TxDescList[i].descr.buf = 0;
++ TxDescList[i].descr.status = 0;
++ TxDescList[i].descr.hw_len = 0;
++ TxDescList[i].skb = 0;
++ }
++
++ TxDescList[NBR_OF_TX_DESC - 1].descr.ctrl = d_eol;
++ TxDescList[NBR_OF_TX_DESC - 1].descr.next = virt_to_phys(&TxDescList[0].descr);
++
++ /* Initialise initial pointers */
++
++ myNextRxDesc = &RxDescList[0];
++ myLastRxDesc = &RxDescList[NBR_OF_RX_DESC - 1];
++ myFirstTxDesc = &TxDescList[0];
++ myNextTxDesc = &TxDescList[0];
++ myLastTxDesc = &TxDescList[NBR_OF_TX_DESC - 1];
++
++ /* Register device */
++ err = register_netdev(dev);
++ if (err) {
++ free_netdev(dev);
++ return err;
++ }
++
++ /* set the default MAC address */
++
++ e100_set_mac_address(dev, &default_mac);
++
++ /* Initialize speed indicator stuff. */
++
++ current_speed = 10;
++ current_speed_selection = 0; /* Auto */
++ speed_timer.expires = jiffies + NET_LINK_UP_CHECK_INTERVAL;
++ speed_timer.data = (unsigned long)dev;
++ speed_timer.function = e100_check_speed;
++
++ clear_led_timer.function = e100_clear_network_leds;
++ clear_led_timer.data = (unsigned long)dev;
++
++ full_duplex = 0;
++ current_duplex = autoneg;
++ duplex_timer.expires = jiffies + NET_DUPLEX_CHECK_INTERVAL;
++ duplex_timer.data = (unsigned long)dev;
++ duplex_timer.function = e100_check_duplex;
++
++ /* Initialize mii interface */
++ np->mii_if.phy_id_mask = 0x1f;
++ np->mii_if.reg_num_mask = 0x1f;
++ np->mii_if.dev = dev;
++ np->mii_if.mdio_read = e100_get_mdio_reg;
++ np->mii_if.mdio_write = e100_set_mdio_reg;
++
++ /* Initialize group address registers to make sure that no */
++ /* unwanted addresses are matched */
++ *R_NETWORK_GA_0 = 0x00000000;
++ *R_NETWORK_GA_1 = 0x00000000;
++
++ /* Initialize next time the led can flash */
++ led_next_time = jiffies;
++ return 0;
++}
++
++/* set MAC address of the interface. called from the core after a
++ * SIOCSIFADDR ioctl, and from the bootup above.
++ */
++
++static int
++e100_set_mac_address(struct net_device *dev, void *p)
++{
++ struct net_local *np = netdev_priv(dev);
++ struct sockaddr *addr = p;
++
++ spin_lock(&np->lock); /* preemption protection */
++
++ /* remember it */
++
++ memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
++
++ /* Write it to the hardware.
++ * Note the way the address is wrapped:
++ * *R_NETWORK_SA_0 = a0_0 | (a0_1 << 8) | (a0_2 << 16) | (a0_3 << 24);
++ * *R_NETWORK_SA_1 = a0_4 | (a0_5 << 8);
++ */
++
++ *R_NETWORK_SA_0 = dev->dev_addr[0] | (dev->dev_addr[1] << 8) |
++ (dev->dev_addr[2] << 16) | (dev->dev_addr[3] << 24);
++ *R_NETWORK_SA_1 = dev->dev_addr[4] | (dev->dev_addr[5] << 8);
++ *R_NETWORK_SA_2 = 0;
++
++ /* show it in the log as well */
++
++ printk(KERN_INFO "%s: changed MAC to %pM\n", dev->name, dev->dev_addr);
++
++ spin_unlock(&np->lock);
++
++ return 0;
++}
++
++/*
++ * Open/initialize the board. This is called (in the current kernel)
++ * sometime after booting when the 'ifconfig' program is run.
++ *
++ * This routine should set everything up anew at each open, even
++ * registers that "should" only need to be set once at boot, so that
++ * there is non-reboot way to recover if something goes wrong.
++ */
++
++static int
++e100_open(struct net_device *dev)
++{
++ unsigned long flags;
++
++ /* enable the MDIO output pin */
++
++ *R_NETWORK_MGM_CTRL = IO_STATE(R_NETWORK_MGM_CTRL, mdoe, enable);
++
++ *R_IRQ_MASK0_CLR =
++ IO_STATE(R_IRQ_MASK0_CLR, overrun, clr) |
++ IO_STATE(R_IRQ_MASK0_CLR, underrun, clr) |
++ IO_STATE(R_IRQ_MASK0_CLR, excessive_col, clr);
++
++ /* clear dma0 and 1 eop and descr irq masks */
++ *R_IRQ_MASK2_CLR =
++ IO_STATE(R_IRQ_MASK2_CLR, dma0_descr, clr) |
++ IO_STATE(R_IRQ_MASK2_CLR, dma0_eop, clr) |
++ IO_STATE(R_IRQ_MASK2_CLR, dma1_descr, clr) |
++ IO_STATE(R_IRQ_MASK2_CLR, dma1_eop, clr);
++
++ /* Reset and wait for the DMA channels */
++
++ RESET_DMA(NETWORK_TX_DMA_NBR);
++ RESET_DMA(NETWORK_RX_DMA_NBR);
++ WAIT_DMA(NETWORK_TX_DMA_NBR);
++ WAIT_DMA(NETWORK_RX_DMA_NBR);
++
++ /* Initialise the etrax network controller */
++
++ /* allocate the irq corresponding to the receiving DMA */
++
++ if (request_irq(NETWORK_DMA_RX_IRQ_NBR, e100rxtx_interrupt,
++ IRQF_SAMPLE_RANDOM, cardname, (void *)dev)) {
++ goto grace_exit0;
++ }
++
++ /* allocate the irq corresponding to the transmitting DMA */
++
++ if (request_irq(NETWORK_DMA_TX_IRQ_NBR, e100rxtx_interrupt, 0,
++ cardname, (void *)dev)) {
++ goto grace_exit1;
++ }
++
++ /* allocate the irq corresponding to the network errors etc */
++
++ if (request_irq(NETWORK_STATUS_IRQ_NBR, e100nw_interrupt, 0,
++ cardname, (void *)dev)) {
++ goto grace_exit2;
++ }
++
++ /*
++ * Always allocate the DMA channels after the IRQ,
++ * and clean up on failure.
++ */
++
++ if (cris_request_dma(NETWORK_TX_DMA_NBR,
++ cardname,
++ DMA_VERBOSE_ON_ERROR,
++ dma_eth)) {
++ goto grace_exit3;
++ }
++
++ if (cris_request_dma(NETWORK_RX_DMA_NBR,
++ cardname,
++ DMA_VERBOSE_ON_ERROR,
++ dma_eth)) {
++ goto grace_exit4;
++ }
++
++ /* give the HW an idea of what MAC address we want */
++
++ *R_NETWORK_SA_0 = dev->dev_addr[0] | (dev->dev_addr[1] << 8) |
++ (dev->dev_addr[2] << 16) | (dev->dev_addr[3] << 24);
++ *R_NETWORK_SA_1 = dev->dev_addr[4] | (dev->dev_addr[5] << 8);
++ *R_NETWORK_SA_2 = 0;
++
++#if 0
++ /* use promiscuous mode for testing */
++ *R_NETWORK_GA_0 = 0xffffffff;
++ *R_NETWORK_GA_1 = 0xffffffff;
++
++ *R_NETWORK_REC_CONFIG = 0xd; /* broadcast rec, individ. rec, ma0 enabled */
++#else
++ SETS(network_rec_config_shadow, R_NETWORK_REC_CONFIG, max_size, size1522);
++ SETS(network_rec_config_shadow, R_NETWORK_REC_CONFIG, broadcast, receive);
++ SETS(network_rec_config_shadow, R_NETWORK_REC_CONFIG, ma0, enable);
++ SETF(network_rec_config_shadow, R_NETWORK_REC_CONFIG, duplex, full_duplex);
++ *R_NETWORK_REC_CONFIG = network_rec_config_shadow;
++#endif
++
++ *R_NETWORK_GEN_CONFIG =
++ IO_STATE(R_NETWORK_GEN_CONFIG, phy, mii_clk) |
++ IO_STATE(R_NETWORK_GEN_CONFIG, enable, on);
++
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, clr_error, clr);
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, delay, none);
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, cancel, dont);
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, cd, enable);
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, retry, enable);
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, pad, enable);
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, crc, enable);
++ *R_NETWORK_TR_CTRL = network_tr_ctrl_shadow;
++
++ local_irq_save(flags);
++
++ /* enable the irq's for ethernet DMA */
++
++ *R_IRQ_MASK2_SET =
++ IO_STATE(R_IRQ_MASK2_SET, dma0_eop, set) |
++ IO_STATE(R_IRQ_MASK2_SET, dma1_eop, set);
++
++ *R_IRQ_MASK0_SET =
++ IO_STATE(R_IRQ_MASK0_SET, overrun, set) |
++ IO_STATE(R_IRQ_MASK0_SET, underrun, set) |
++ IO_STATE(R_IRQ_MASK0_SET, excessive_col, set);
++
++ /* make sure the irqs are cleared */
++
++ *R_DMA_CH0_CLR_INTR = IO_STATE(R_DMA_CH0_CLR_INTR, clr_eop, do);
++ *R_DMA_CH1_CLR_INTR = IO_STATE(R_DMA_CH1_CLR_INTR, clr_eop, do);
++
++ /* make sure the rec and transmit error counters are cleared */
++
++ (void)*R_REC_COUNTERS; /* dummy read */
++ (void)*R_TR_COUNTERS; /* dummy read */
++
++ /* start the receiving DMA channel so we can receive packets from now on */
++
++ *R_DMA_CH1_FIRST = virt_to_phys(myNextRxDesc);
++ *R_DMA_CH1_CMD = IO_STATE(R_DMA_CH1_CMD, cmd, start);
++
++ /* Set up transmit DMA channel so it can be restarted later */
++
++ *R_DMA_CH0_FIRST = 0;
++ *R_DMA_CH0_DESCR = virt_to_phys(myLastTxDesc);
++ netif_start_queue(dev);
++
++ local_irq_restore(flags);
++
++ /* Probe for transceiver */
++ if (e100_probe_transceiver(dev))
++ goto grace_exit5;
++
++ /* Start duplex/speed timers */
++ add_timer(&speed_timer);
++ add_timer(&duplex_timer);
++
++ /* We are now ready to accept transmit requeusts from
++ * the queueing layer of the networking.
++ */
++ netif_carrier_on(dev);
++
++ return 0;
++
++grace_exit5:
++ cris_free_dma(NETWORK_RX_DMA_NBR, cardname);
++grace_exit4:
++ cris_free_dma(NETWORK_TX_DMA_NBR, cardname);
++grace_exit3:
++ free_irq(NETWORK_STATUS_IRQ_NBR, (void *)dev);
++grace_exit2:
++ free_irq(NETWORK_DMA_TX_IRQ_NBR, (void *)dev);
++grace_exit1:
++ free_irq(NETWORK_DMA_RX_IRQ_NBR, (void *)dev);
++grace_exit0:
++ return -EAGAIN;
++}
++
++#if defined(CONFIG_ETRAX_NO_PHY)
++static void
++dummy_check_speed(struct net_device* dev)
++{
++ current_speed = 100;
++}
++#else
++static void
++generic_check_speed(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id, MII_ADVERTISE);
++ if ((data & ADVERTISE_100FULL) ||
++ (data & ADVERTISE_100HALF))
++ current_speed = 100;
++ else
++ current_speed = 10;
++}
++
++static void
++tdk_check_speed(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id,
++ MDIO_TDK_DIAGNOSTIC_REG);
++ current_speed = (data & MDIO_TDK_DIAGNOSTIC_RATE ? 100 : 10);
++}
++
++static void
++broadcom_check_speed(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id,
++ MDIO_AUX_CTRL_STATUS_REG);
++ current_speed = (data & MDIO_BC_SPEED ? 100 : 10);
++}
++
++static void
++intel_check_speed(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id,
++ MDIO_INT_STATUS_REG_2);
++ current_speed = (data & MDIO_INT_SPEED ? 100 : 10);
++}
++#endif
++static void
++e100_check_speed(unsigned long priv)
++{
++ struct net_device* dev = (struct net_device*)priv;
++ struct net_local *np = netdev_priv(dev);
++ static int led_initiated = 0;
++ unsigned long data;
++ int old_speed = current_speed;
++
++ spin_lock(&np->transceiver_lock);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id, MII_BMSR);
++ if (!(data & BMSR_LSTATUS)) {
++ current_speed = 0;
++ } else {
++ transceiver->check_speed(dev);
++ }
++
++ spin_lock(&np->led_lock);
++ if ((old_speed != current_speed) || !led_initiated) {
++ led_initiated = 1;
++ e100_set_network_leds(NO_NETWORK_ACTIVITY);
++ if (current_speed)
++ netif_carrier_on(dev);
++ else
++ netif_carrier_off(dev);
++ }
++ spin_unlock(&np->led_lock);
++
++ /* Reinitialize the timer. */
++ speed_timer.expires = jiffies + NET_LINK_UP_CHECK_INTERVAL;
++ add_timer(&speed_timer);
++
++ spin_unlock(&np->transceiver_lock);
++}
++
++static void
++e100_negotiate(struct net_device* dev)
++{
++ struct net_local *np = netdev_priv(dev);
++ unsigned short data = e100_get_mdio_reg(dev, np->mii_if.phy_id,
++ MII_ADVERTISE);
++
++ /* Discard old speed and duplex settings */
++ data &= ~(ADVERTISE_100HALF | ADVERTISE_100FULL |
++ ADVERTISE_10HALF | ADVERTISE_10FULL);
++
++ switch (current_speed_selection) {
++ case 10:
++ if (current_duplex == full)
++ data |= ADVERTISE_10FULL;
++ else if (current_duplex == half)
++ data |= ADVERTISE_10HALF;
++ else
++ data |= ADVERTISE_10HALF | ADVERTISE_10FULL;
++ break;
++
++ case 100:
++ if (current_duplex == full)
++ data |= ADVERTISE_100FULL;
++ else if (current_duplex == half)
++ data |= ADVERTISE_100HALF;
++ else
++ data |= ADVERTISE_100HALF | ADVERTISE_100FULL;
++ break;
++
++ case 0: /* Auto */
++ if (current_duplex == full)
++ data |= ADVERTISE_100FULL | ADVERTISE_10FULL;
++ else if (current_duplex == half)
++ data |= ADVERTISE_100HALF | ADVERTISE_10HALF;
++ else
++ data |= ADVERTISE_10HALF | ADVERTISE_10FULL |
++ ADVERTISE_100HALF | ADVERTISE_100FULL;
++ break;
++
++ default: /* assume autoneg speed and duplex */
++ data |= ADVERTISE_10HALF | ADVERTISE_10FULL |
++ ADVERTISE_100HALF | ADVERTISE_100FULL;
++ break;
++ }
++
++ e100_set_mdio_reg(dev, np->mii_if.phy_id, MII_ADVERTISE, data);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id, MII_BMCR);
++ if (autoneg_normal) {
++ /* Renegotiate with link partner */
++ data |= BMCR_ANENABLE | BMCR_ANRESTART;
++ } else {
++ /* Don't negotiate speed or duplex */
++ data &= ~(BMCR_ANENABLE | BMCR_ANRESTART);
++
++ /* Set speed and duplex static */
++ if (current_speed_selection == 10)
++ data &= ~BMCR_SPEED100;
++ else
++ data |= BMCR_SPEED100;
++
++ if (current_duplex != full)
++ data &= ~BMCR_FULLDPLX;
++ else
++ data |= BMCR_FULLDPLX;
++ }
++ e100_set_mdio_reg(dev, np->mii_if.phy_id, MII_BMCR, data);
++}
++
++static void
++e100_set_speed(struct net_device* dev, unsigned long speed)
++{
++ struct net_local *np = netdev_priv(dev);
++
++ spin_lock(&np->transceiver_lock);
++ if (speed != current_speed_selection) {
++ current_speed_selection = speed;
++ e100_negotiate(dev);
++ }
++ spin_unlock(&np->transceiver_lock);
++}
++
++static void
++e100_check_duplex(unsigned long priv)
++{
++ struct net_device *dev = (struct net_device *)priv;
++ struct net_local *np = netdev_priv(dev);
++ int old_duplex;
++
++ spin_lock(&np->transceiver_lock);
++ old_duplex = full_duplex;
++ transceiver->check_duplex(dev);
++ if (old_duplex != full_duplex) {
++ /* Duplex changed */
++ SETF(network_rec_config_shadow, R_NETWORK_REC_CONFIG, duplex, full_duplex);
++ *R_NETWORK_REC_CONFIG = network_rec_config_shadow;
++ }
++
++ /* Reinitialize the timer. */
++ duplex_timer.expires = jiffies + NET_DUPLEX_CHECK_INTERVAL;
++ add_timer(&duplex_timer);
++ np->mii_if.full_duplex = full_duplex;
++ spin_unlock(&np->transceiver_lock);
++}
++#if defined(CONFIG_ETRAX_NO_PHY)
++static void
++dummy_check_duplex(struct net_device* dev)
++{
++ full_duplex = 1;
++}
++#else
++static void
++generic_check_duplex(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id, MII_ADVERTISE);
++ if ((data & ADVERTISE_10FULL) ||
++ (data & ADVERTISE_100FULL))
++ full_duplex = 1;
++ else
++ full_duplex = 0;
++}
++
++static void
++tdk_check_duplex(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id,
++ MDIO_TDK_DIAGNOSTIC_REG);
++ full_duplex = (data & MDIO_TDK_DIAGNOSTIC_DPLX) ? 1 : 0;
++}
++
++static void
++broadcom_check_duplex(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id,
++ MDIO_AUX_CTRL_STATUS_REG);
++ full_duplex = (data & MDIO_BC_FULL_DUPLEX_IND) ? 1 : 0;
++}
++
++static void
++intel_check_duplex(struct net_device* dev)
++{
++ unsigned long data;
++ struct net_local *np = netdev_priv(dev);
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id,
++ MDIO_INT_STATUS_REG_2);
++ full_duplex = (data & MDIO_INT_FULL_DUPLEX_IND) ? 1 : 0;
++}
++#endif
++static void
++e100_set_duplex(struct net_device* dev, enum duplex new_duplex)
++{
++ struct net_local *np = netdev_priv(dev);
++
++ spin_lock(&np->transceiver_lock);
++ if (new_duplex != current_duplex) {
++ current_duplex = new_duplex;
++ e100_negotiate(dev);
++ }
++ spin_unlock(&np->transceiver_lock);
++}
++
++static int
++e100_probe_transceiver(struct net_device* dev)
++{
++ int ret = 0;
++
++#if !defined(CONFIG_ETRAX_NO_PHY)
++ unsigned int phyid_high;
++ unsigned int phyid_low;
++ unsigned int oui;
++ struct transceiver_ops* ops = NULL;
++ struct net_local *np = netdev_priv(dev);
++
++ spin_lock(&np->transceiver_lock);
++
++ /* Probe MDIO physical address */
++ for (np->mii_if.phy_id = 0; np->mii_if.phy_id <= 31;
++ np->mii_if.phy_id++) {
++ if (e100_get_mdio_reg(dev,
++ np->mii_if.phy_id, MII_BMSR) != 0xffff)
++ break;
++ }
++ if (np->mii_if.phy_id == 32) {
++ ret = -ENODEV;
++ goto out;
++ }
++
++ /* Get manufacturer */
++ phyid_high = e100_get_mdio_reg(dev, np->mii_if.phy_id, MII_PHYSID1);
++ phyid_low = e100_get_mdio_reg(dev, np->mii_if.phy_id, MII_PHYSID2);
++ oui = (phyid_high << 6) | (phyid_low >> 10);
++
++ for (ops = &transceivers[0]; ops->oui; ops++) {
++ if (ops->oui == oui)
++ break;
++ }
++ transceiver = ops;
++out:
++ spin_unlock(&np->transceiver_lock);
++#endif
++ return ret;
++}
++
++static int
++e100_get_mdio_reg(struct net_device *dev, int phy_id, int location)
++{
++ unsigned short cmd; /* Data to be sent on MDIO port */
++ int data; /* Data read from MDIO */
++ int bitCounter;
++
++ /* Start of frame, OP Code, Physical Address, Register Address */
++ cmd = (MDIO_START << 14) | (MDIO_READ << 12) | (phy_id << 7) |
++ (location << 2);
++
++ e100_send_mdio_cmd(cmd, 0);
++
++ data = 0;
++
++ /* Data... */
++ for (bitCounter=15; bitCounter>=0 ; bitCounter--) {
++ data |= (e100_receive_mdio_bit() << bitCounter);
++ }
++
++ return data;
++}
++
++static void
++e100_set_mdio_reg(struct net_device *dev, int phy_id, int location, int value)
++{
++ int bitCounter;
++ unsigned short cmd;
++
++ cmd = (MDIO_START << 14) | (MDIO_WRITE << 12) | (phy_id << 7) |
++ (location << 2);
++
++ e100_send_mdio_cmd(cmd, 1);
++
++ /* Data... */
++ for (bitCounter=15; bitCounter>=0 ; bitCounter--) {
++ e100_send_mdio_bit(GET_BIT(bitCounter, value));
++ }
++
++}
++
++static void
++e100_send_mdio_cmd(unsigned short cmd, int write_cmd)
++{
++ int bitCounter;
++ unsigned char data = 0x2;
++
++ /* Preamble */
++ for (bitCounter = 31; bitCounter>= 0; bitCounter--)
++ e100_send_mdio_bit(GET_BIT(bitCounter, MDIO_PREAMBLE));
++
++ for (bitCounter = 15; bitCounter >= 2; bitCounter--)
++ e100_send_mdio_bit(GET_BIT(bitCounter, cmd));
++
++ /* Turnaround */
++ for (bitCounter = 1; bitCounter >= 0 ; bitCounter--)
++ if (write_cmd)
++ e100_send_mdio_bit(GET_BIT(bitCounter, data));
++ else
++ e100_receive_mdio_bit();
++}
++
++static void
++e100_send_mdio_bit(unsigned char bit)
++{
++ *R_NETWORK_MGM_CTRL =
++ IO_STATE(R_NETWORK_MGM_CTRL, mdoe, enable) |
++ IO_FIELD(R_NETWORK_MGM_CTRL, mdio, bit);
++ udelay(1);
++ *R_NETWORK_MGM_CTRL =
++ IO_STATE(R_NETWORK_MGM_CTRL, mdoe, enable) |
++ IO_MASK(R_NETWORK_MGM_CTRL, mdck) |
++ IO_FIELD(R_NETWORK_MGM_CTRL, mdio, bit);
++ udelay(1);
++}
++
++static unsigned char
++e100_receive_mdio_bit()
++{
++ unsigned char bit;
++ *R_NETWORK_MGM_CTRL = 0;
++ bit = IO_EXTRACT(R_NETWORK_STAT, mdio, *R_NETWORK_STAT);
++ udelay(1);
++ *R_NETWORK_MGM_CTRL = IO_MASK(R_NETWORK_MGM_CTRL, mdck);
++ udelay(1);
++ return bit;
++}
++
++static void
++e100_reset_transceiver(struct net_device* dev)
++{
++ struct net_local *np = netdev_priv(dev);
++ unsigned short cmd;
++ unsigned short data;
++ int bitCounter;
++
++ data = e100_get_mdio_reg(dev, np->mii_if.phy_id, MII_BMCR);
++
++ cmd = (MDIO_START << 14) | (MDIO_WRITE << 12) | (np->mii_if.phy_id << 7) | (MII_BMCR << 2);
++
++ e100_send_mdio_cmd(cmd, 1);
++
++ data |= 0x8000;
++
++ for (bitCounter = 15; bitCounter >= 0 ; bitCounter--) {
++ e100_send_mdio_bit(GET_BIT(bitCounter, data));
++ }
++}
++
++/* Called by upper layers if they decide it took too long to complete
++ * sending a packet - we need to reset and stuff.
++ */
++
++static void
++e100_tx_timeout(struct net_device *dev)
++{
++ struct net_local *np = netdev_priv(dev);
++ unsigned long flags;
++
++ spin_lock_irqsave(&np->lock, flags);
++
++ printk(KERN_WARNING "%s: transmit timed out, %s?\n", dev->name,
++ tx_done(dev) ? "IRQ problem" : "network cable problem");
++
++ /* remember we got an error */
++
++ np->stats.tx_errors++;
++
++ /* reset the TX DMA in case it has hung on something */
++
++ RESET_DMA(NETWORK_TX_DMA_NBR);
++ WAIT_DMA(NETWORK_TX_DMA_NBR);
++
++ /* Reset the transceiver. */
++
++ e100_reset_transceiver(dev);
++
++ /* and get rid of the packets that never got an interrupt */
++ while (myFirstTxDesc != myNextTxDesc) {
++ dev_kfree_skb(myFirstTxDesc->skb);
++ myFirstTxDesc->skb = 0;
++ myFirstTxDesc = phys_to_virt(myFirstTxDesc->descr.next);
++ }
++
++ /* Set up transmit DMA channel so it can be restarted later */
++ *R_DMA_CH0_FIRST = 0;
++ *R_DMA_CH0_DESCR = virt_to_phys(myLastTxDesc);
++
++ /* tell the upper layers we're ok again */
++
++ netif_wake_queue(dev);
++ spin_unlock_irqrestore(&np->lock, flags);
++}
++
++
++/* This will only be invoked if the driver is _not_ in XOFF state.
++ * What this means is that we need not check it, and that this
++ * invariant will hold if we make sure that the netif_*_queue()
++ * calls are done at the proper times.
++ */
++
++static int
++e100_send_packet(struct sk_buff *skb, struct net_device *dev)
++{
++ struct net_local *np = netdev_priv(dev);
++ unsigned char *buf = skb->data;
++ unsigned long flags;
++
++#ifdef ETHDEBUG
++ printk("send packet len %d\n", length);
++#endif
++ spin_lock_irqsave(&np->lock, flags); /* protect from tx_interrupt and ourself */
++
++ myNextTxDesc->skb = skb;
++
++ dev->trans_start = jiffies;
++
++ e100_hardware_send_packet(np, buf, skb->len);
++
++ myNextTxDesc = phys_to_virt(myNextTxDesc->descr.next);
++
++ /* Stop queue if full */
++ if (myNextTxDesc == myFirstTxDesc) {
++ netif_stop_queue(dev);
++ }
++
++ spin_unlock_irqrestore(&np->lock, flags);
++
++ return NETDEV_TX_OK;
++}
++
++/*
++ * The typical workload of the driver:
++ * Handle the network interface interrupts.
++ */
++
++static irqreturn_t
++e100rxtx_interrupt(int irq, void *dev_id)
++{
++ struct net_device *dev = (struct net_device *)dev_id;
++ struct net_local *np = netdev_priv(dev);
++ unsigned long irqbits;
++
++ /*
++ * Note that both rx and tx interrupts are blocked at this point,
++ * regardless of which got us here.
++ */
++
++ irqbits = *R_IRQ_MASK2_RD;
++
++ /* Handle received packets */
++ if (irqbits & IO_STATE(R_IRQ_MASK2_RD, dma1_eop, active)) {
++ /* acknowledge the eop interrupt */
++
++ *R_DMA_CH1_CLR_INTR = IO_STATE(R_DMA_CH1_CLR_INTR, clr_eop, do);
++
++ /* check if one or more complete packets were indeed received */
++
++ while ((*R_DMA_CH1_FIRST != virt_to_phys(myNextRxDesc)) &&
++ (myNextRxDesc != myLastRxDesc)) {
++ /* Take out the buffer and give it to the OS, then
++ * allocate a new buffer to put a packet in.
++ */
++ e100_rx(dev);
++ np->stats.rx_packets++;
++ /* restart/continue on the channel, for safety */
++ *R_DMA_CH1_CMD = IO_STATE(R_DMA_CH1_CMD, cmd, restart);
++ /* clear dma channel 1 eop/descr irq bits */
++ *R_DMA_CH1_CLR_INTR =
++ IO_STATE(R_DMA_CH1_CLR_INTR, clr_eop, do) |
++ IO_STATE(R_DMA_CH1_CLR_INTR, clr_descr, do);
++
++ /* now, we might have gotten another packet
++ so we have to loop back and check if so */
++ }
++ }
++
++ /* Report any packets that have been sent */
++ while (virt_to_phys(myFirstTxDesc) != *R_DMA_CH0_FIRST &&
++ (netif_queue_stopped(dev) || myFirstTxDesc != myNextTxDesc)) {
++ np->stats.tx_bytes += myFirstTxDesc->skb->len;
++ np->stats.tx_packets++;
++
++ /* dma is ready with the transmission of the data in tx_skb, so now
++ we can release the skb memory */
++ dev_kfree_skb_irq(myFirstTxDesc->skb);
++ myFirstTxDesc->skb = 0;
++ myFirstTxDesc = phys_to_virt(myFirstTxDesc->descr.next);
++ /* Wake up queue. */
++ netif_wake_queue(dev);
++ }
++
++ if (irqbits & IO_STATE(R_IRQ_MASK2_RD, dma0_eop, active)) {
++ /* acknowledge the eop interrupt. */
++ *R_DMA_CH0_CLR_INTR = IO_STATE(R_DMA_CH0_CLR_INTR, clr_eop, do);
++ }
++
++ return IRQ_HANDLED;
++}
++
++static irqreturn_t
++e100nw_interrupt(int irq, void *dev_id)
++{
++ struct net_device *dev = (struct net_device *)dev_id;
++ struct net_local *np = netdev_priv(dev);
++ unsigned long irqbits = *R_IRQ_MASK0_RD;
++
++ /* check for underrun irq */
++ if (irqbits & IO_STATE(R_IRQ_MASK0_RD, underrun, active)) {
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, clr_error, clr);
++ *R_NETWORK_TR_CTRL = network_tr_ctrl_shadow;
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, clr_error, nop);
++ np->stats.tx_errors++;
++ D(printk("ethernet receiver underrun!\n"));
++ }
++
++ /* check for overrun irq */
++ if (irqbits & IO_STATE(R_IRQ_MASK0_RD, overrun, active)) {
++ update_rx_stats(&np->stats); /* this will ack the irq */
++ D(printk("ethernet receiver overrun!\n"));
++ }
++ /* check for excessive collision irq */
++ if (irqbits & IO_STATE(R_IRQ_MASK0_RD, excessive_col, active)) {
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, clr_error, clr);
++ *R_NETWORK_TR_CTRL = network_tr_ctrl_shadow;
++ SETS(network_tr_ctrl_shadow, R_NETWORK_TR_CTRL, clr_error, nop);
++ np->stats.tx_errors++;
++ D(printk("ethernet excessive collisions!\n"));
++ }
++ return IRQ_HANDLED;
++}
++
++/* We have a good packet(s), get it/them out of the buffers. */
++static void
++e100_rx(struct net_device *dev)
++{
++ struct sk_buff *skb;
++ int length = 0;
++ struct net_local *np = netdev_priv(dev);
++ unsigned char *skb_data_ptr;
++#ifdef ETHDEBUG
++ int i;
++#endif
++ etrax_eth_descr *prevRxDesc; /* The descriptor right before myNextRxDesc */
++ spin_lock(&np->led_lock);
++ if (!led_active && time_after(jiffies, led_next_time)) {
++ /* light the network leds depending on the current speed. */
++ e100_set_network_leds(NETWORK_ACTIVITY);
++
++ /* Set the earliest time we may clear the LED */
++ led_next_time = jiffies + NET_FLASH_TIME;
++ led_active = 1;
++ mod_timer(&clear_led_timer, jiffies + HZ/10);
++ }
++ spin_unlock(&np->led_lock);
++
++ length = myNextRxDesc->descr.hw_len - 4;
++ np->stats.rx_bytes += length;
++
++#ifdef ETHDEBUG
++ printk("Got a packet of length %d:\n", length);
++ /* dump the first bytes in the packet */
++ skb_data_ptr = (unsigned char *)phys_to_virt(myNextRxDesc->descr.buf);
++ for (i = 0; i < 8; i++) {
++ printk("%d: %.2x %.2x %.2x %.2x %.2x %.2x %.2x %.2x\n", i * 8,
++ skb_data_ptr[0],skb_data_ptr[1],skb_data_ptr[2],skb_data_ptr[3],
++ skb_data_ptr[4],skb_data_ptr[5],skb_data_ptr[6],skb_data_ptr[7]);
++ skb_data_ptr += 8;
++ }
++#endif
++
++ if (length < RX_COPYBREAK) {
++ /* Small packet, copy data */
++ skb = dev_alloc_skb(length - ETHER_HEAD_LEN);
++ if (!skb) {
++ np->stats.rx_errors++;
++ printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n", dev->name);
++ goto update_nextrxdesc;
++ }
++
++ skb_put(skb, length - ETHER_HEAD_LEN); /* allocate room for the packet body */
++ skb_data_ptr = skb_push(skb, ETHER_HEAD_LEN); /* allocate room for the header */
++
++#ifdef ETHDEBUG
++ printk("head = 0x%x, data = 0x%x, tail = 0x%x, end = 0x%x\n",
++ skb->head, skb->data, skb_tail_pointer(skb),
++ skb_end_pointer(skb));
++ printk("copying packet to 0x%x.\n", skb_data_ptr);
++#endif
++
++ memcpy(skb_data_ptr, phys_to_virt(myNextRxDesc->descr.buf), length);
++ }
++ else {
++ /* Large packet, send directly to upper layers and allocate new
++ * memory (aligned to cache line boundary to avoid bug).
++ * Before sending the skb to upper layers we must make sure
++ * that skb->data points to the aligned start of the packet.
++ */
++ int align;
++ struct sk_buff *new_skb = dev_alloc_skb(MAX_MEDIA_DATA_SIZE + 2 * L1_CACHE_BYTES);
++ if (!new_skb) {
++ np->stats.rx_errors++;
++ printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n", dev->name);
++ goto update_nextrxdesc;
++ }
++ skb = myNextRxDesc->skb;
++ align = (int)phys_to_virt(myNextRxDesc->descr.buf) - (int)skb->data;
++ skb_put(skb, length + align);
++ skb_pull(skb, align); /* Remove alignment bytes */
++ myNextRxDesc->skb = new_skb;
++ myNextRxDesc->descr.buf = L1_CACHE_ALIGN(virt_to_phys(myNextRxDesc->skb->data));
++ }
++
++ skb->protocol = eth_type_trans(skb, dev);
++
++ /* Send the packet to the upper layers */
++ netif_rx(skb);
++
++ update_nextrxdesc:
++ /* Prepare for next packet */
++ myNextRxDesc->descr.status = 0;
++ prevRxDesc = myNextRxDesc;
++ myNextRxDesc = phys_to_virt(myNextRxDesc->descr.next);
++
++ rx_queue_len++;
++
++ /* Check if descriptors should be returned */
++ if (rx_queue_len == RX_QUEUE_THRESHOLD) {
++ flush_etrax_cache();
++ prevRxDesc->descr.ctrl |= d_eol;
++ myLastRxDesc->descr.ctrl &= ~d_eol;
++ myLastRxDesc = prevRxDesc;
++ rx_queue_len = 0;
++ }
++}
++
++/* The inverse routine to net_open(). */
++static int
++e100_close(struct net_device *dev)
++{
++ struct net_local *np = netdev_priv(dev);
++
++ printk(KERN_INFO "Closing %s.\n", dev->name);
++
++ netif_stop_queue(dev);
++
++ *R_IRQ_MASK0_CLR =
++ IO_STATE(R_IRQ_MASK0_CLR, overrun, clr) |
++ IO_STATE(R_IRQ_MASK0_CLR, underrun, clr) |
++ IO_STATE(R_IRQ_MASK0_CLR, excessive_col, clr);
++
++ *R_IRQ_MASK2_CLR =
++ IO_STATE(R_IRQ_MASK2_CLR, dma0_descr, clr) |
++ IO_STATE(R_IRQ_MASK2_CLR, dma0_eop, clr) |
++ IO_STATE(R_IRQ_MASK2_CLR, dma1_descr, clr) |
++ IO_STATE(R_IRQ_MASK2_CLR, dma1_eop, clr);
++
++ /* Stop the receiver and the transmitter */
++
++ RESET_DMA(NETWORK_TX_DMA_NBR);
++ RESET_DMA(NETWORK_RX_DMA_NBR);
++
++ /* Flush the Tx and disable Rx here. */
++
++ free_irq(NETWORK_DMA_RX_IRQ_NBR, (void *)dev);
++ free_irq(NETWORK_DMA_TX_IRQ_NBR, (void *)dev);
++ free_irq(NETWORK_STATUS_IRQ_NBR, (void *)dev);
++
++ cris_free_dma(NETWORK_TX_DMA_NBR, cardname);
++ cris_free_dma(NETWORK_RX_DMA_NBR, cardname);
++
++ /* Update the statistics here. */
++
++ update_rx_stats(&np->stats);
++ update_tx_stats(&np->stats);
++
++ /* Stop speed/duplex timers */
++ del_timer(&speed_timer);
++ del_timer(&duplex_timer);
++
++ return 0;
++}
++
++static int
++e100_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
++{
++ struct mii_ioctl_data *data = if_mii(ifr);
++ struct net_local *np = netdev_priv(dev);
++ int rc = 0;
++ int old_autoneg;
++
++ spin_lock(&np->lock); /* Preempt protection */
++ switch (cmd) {
++ /* The ioctls below should be considered obsolete but are */
++ /* still present for compatability with old scripts/apps */
++ case SET_ETH_SPEED_10: /* 10 Mbps */
++ e100_set_speed(dev, 10);
++ break;
++ case SET_ETH_SPEED_100: /* 100 Mbps */
++ e100_set_speed(dev, 100);
++ break;
++ case SET_ETH_SPEED_AUTO: /* Auto-negotiate speed */
++ e100_set_speed(dev, 0);
++ break;
++ case SET_ETH_DUPLEX_HALF: /* Half duplex */
++ e100_set_duplex(dev, half);
++ break;
++ case SET_ETH_DUPLEX_FULL: /* Full duplex */
++ e100_set_duplex(dev, full);
++ break;
++ case SET_ETH_DUPLEX_AUTO: /* Auto-negotiate duplex */
++ e100_set_duplex(dev, autoneg);
++ break;
++ case SET_ETH_AUTONEG:
++ old_autoneg = autoneg_normal;
++ autoneg_normal = *(int*)data;
++ if (autoneg_normal != old_autoneg)
++ e100_negotiate(dev);
++ break;
++ default:
++ rc = generic_mii_ioctl(&np->mii_if, if_mii(ifr),
++ cmd, NULL);
++ break;
++ }
++ spin_unlock(&np->lock);
++ return rc;
++}
++
++static int e100_get_settings(struct net_device *dev,
++ struct ethtool_cmd *cmd)
++{
++ struct net_local *np = netdev_priv(dev);
++ int err;
++
++ spin_lock_irq(&np->lock);
++ err = mii_ethtool_gset(&np->mii_if, cmd);
++ spin_unlock_irq(&np->lock);
++
++ /* The PHY may support 1000baseT, but the Etrax100 does not. */
++ cmd->supported &= ~(SUPPORTED_1000baseT_Half
++ | SUPPORTED_1000baseT_Full);
++ return err;
++}
++
++static int e100_set_settings(struct net_device *dev,
++ struct ethtool_cmd *ecmd)
++{
++ if (ecmd->autoneg == AUTONEG_ENABLE) {
++ e100_set_duplex(dev, autoneg);
++ e100_set_speed(dev, 0);
++ } else {
++ e100_set_duplex(dev, ecmd->duplex == DUPLEX_HALF ? half : full);
++ e100_set_speed(dev, ecmd->speed == SPEED_10 ? 10: 100);
++ }
++
++ return 0;
++}
++
++static void e100_get_drvinfo(struct net_device *dev,
++ struct ethtool_drvinfo *info)
++{
++ strncpy(info->driver, "ETRAX 100LX", sizeof(info->driver) - 1);
++ strncpy(info->version, "$Revision: 1.31 $", sizeof(info->version) - 1);
++ strncpy(info->fw_version, "N/A", sizeof(info->fw_version) - 1);
++ strncpy(info->bus_info, "N/A", sizeof(info->bus_info) - 1);
++}
++
++static int e100_nway_reset(struct net_device *dev)
++{
++ if (current_duplex == autoneg && current_speed_selection == 0)
++ e100_negotiate(dev);
++ return 0;
++}
++
++static const struct ethtool_ops e100_ethtool_ops = {
++ .get_settings = e100_get_settings,
++ .set_settings = e100_set_settings,
++ .get_drvinfo = e100_get_drvinfo,
++ .nway_reset = e100_nway_reset,
++ .get_link = ethtool_op_get_link,
++};
++
++static int
++e100_set_config(struct net_device *dev, struct ifmap *map)
++{
++ struct net_local *np = netdev_priv(dev);
++
++ spin_lock(&np->lock); /* Preempt protection */
++
++ switch(map->port) {
++ case IF_PORT_UNKNOWN:
++ /* Use autoneg */
++ e100_set_speed(dev, 0);
++ e100_set_duplex(dev, autoneg);
++ break;
++ case IF_PORT_10BASET:
++ e100_set_speed(dev, 10);
++ e100_set_duplex(dev, autoneg);
++ break;
++ case IF_PORT_100BASET:
++ case IF_PORT_100BASETX:
++ e100_set_speed(dev, 100);
++ e100_set_duplex(dev, autoneg);
++ break;
++ case IF_PORT_100BASEFX:
++ case IF_PORT_10BASE2:
++ case IF_PORT_AUI:
++ spin_unlock(&np->lock);
++ return -EOPNOTSUPP;
++ break;
++ default:
++ printk(KERN_ERR "%s: Invalid media selected", dev->name);
++ spin_unlock(&np->lock);
++ return -EINVAL;
++ }
++ spin_unlock(&np->lock);
++ return 0;
++}
++
++static void
++update_rx_stats(struct net_device_stats *es)
++{
++ unsigned long r = *R_REC_COUNTERS;
++ /* update stats relevant to reception errors */
++ es->rx_fifo_errors += IO_EXTRACT(R_REC_COUNTERS, congestion, r);
++ es->rx_crc_errors += IO_EXTRACT(R_REC_COUNTERS, crc_error, r);
++ es->rx_frame_errors += IO_EXTRACT(R_REC_COUNTERS, alignment_error, r);
++ es->rx_length_errors += IO_EXTRACT(R_REC_COUNTERS, oversize, r);
++}
++
++static void
++update_tx_stats(struct net_device_stats *es)
++{
++ unsigned long r = *R_TR_COUNTERS;
++ /* update stats relevant to transmission errors */
++ es->collisions +=
++ IO_EXTRACT(R_TR_COUNTERS, single_col, r) +
++ IO_EXTRACT(R_TR_COUNTERS, multiple_col, r);
++}
++
++/*
++ * Get the current statistics.
++ * This may be called with the card open or closed.
++ */
++static struct net_device_stats *
++e100_get_stats(struct net_device *dev)
++{
++ struct net_local *lp = netdev_priv(dev);
++ unsigned long flags;
++
++ spin_lock_irqsave(&lp->lock, flags);
++
++ update_rx_stats(&lp->stats);
++ update_tx_stats(&lp->stats);
++
++ spin_unlock_irqrestore(&lp->lock, flags);
++ return &lp->stats;
++}
++
++/*
++ * Set or clear the multicast filter for this adaptor.
++ * num_addrs == -1 Promiscuous mode, receive all packets
++ * num_addrs == 0 Normal mode, clear multicast list
++ * num_addrs > 0 Multicast mode, receive normal and MC packets,
++ * and do best-effort filtering.
++ */
++static void
++set_multicast_list(struct net_device *dev)
++{
++ struct net_local *lp = netdev_priv(dev);
++ int num_addr = dev->mc_count;
++ unsigned long int lo_bits;
++ unsigned long int hi_bits;
++
++ spin_lock(&lp->lock);
++ if (dev->flags & IFF_PROMISC) {
++ /* promiscuous mode */
++ lo_bits = 0xfffffffful;
++ hi_bits = 0xfffffffful;
++
++ /* Enable individual receive */
++ SETS(network_rec_config_shadow, R_NETWORK_REC_CONFIG, individual, receive);
++ *R_NETWORK_REC_CONFIG = network_rec_config_shadow;
++ } else if (dev->flags & IFF_ALLMULTI) {
++ /* enable all multicasts */
++ lo_bits = 0xfffffffful;
++ hi_bits = 0xfffffffful;
++
++ /* Disable individual receive */
++ SETS(network_rec_config_shadow, R_NETWORK_REC_CONFIG, individual, discard);
++ *R_NETWORK_REC_CONFIG = network_rec_config_shadow;
++ } else if (num_addr == 0) {
++ /* Normal, clear the mc list */
++ lo_bits = 0x00000000ul;
++ hi_bits = 0x00000000ul;
++
++ /* Disable individual receive */
++ SETS(network_rec_config_shadow, R_NETWORK_REC_CONFIG, individual, discard);
++ *R_NETWORK_REC_CONFIG = network_rec_config_shadow;
++ } else {
++ /* MC mode, receive normal and MC packets */
++ char hash_ix;
++ struct dev_mc_list *dmi = dev->mc_list;
++ int i;
++ char *baddr;
++
++ lo_bits = 0x00000000ul;
++ hi_bits = 0x00000000ul;
++ for (i = 0; i < num_addr; i++) {
++ /* Calculate the hash index for the GA registers */
++
++ hash_ix = 0;
++ baddr = dmi->dmi_addr;
++ hash_ix ^= (*baddr) & 0x3f;
++ hash_ix ^= ((*baddr) >> 6) & 0x03;
++ ++baddr;
++ hash_ix ^= ((*baddr) << 2) & 0x03c;
++ hash_ix ^= ((*baddr) >> 4) & 0xf;
++ ++baddr;
++ hash_ix ^= ((*baddr) << 4) & 0x30;
++ hash_ix ^= ((*baddr) >> 2) & 0x3f;
++ ++baddr;
++ hash_ix ^= (*baddr) & 0x3f;
++ hash_ix ^= ((*baddr) >> 6) & 0x03;
++ ++baddr;
++ hash_ix ^= ((*baddr) << 2) & 0x03c;
++ hash_ix ^= ((*baddr) >> 4) & 0xf;
++ ++baddr;
++ hash_ix ^= ((*baddr) << 4) & 0x30;
++ hash_ix ^= ((*baddr) >> 2) & 0x3f;
++
++ hash_ix &= 0x3f;
++
++ if (hash_ix >= 32) {
++ hi_bits |= (1 << (hash_ix-32));
++ } else {
++ lo_bits |= (1 << hash_ix);
++ }
++ dmi = dmi->next;
++ }
++ /* Disable individual receive */
++ SETS(network_rec_config_shadow, R_NETWORK_REC_CONFIG, individual, discard);
++ *R_NETWORK_REC_CONFIG = network_rec_config_shadow;
++ }
++ *R_NETWORK_GA_0 = lo_bits;
++ *R_NETWORK_GA_1 = hi_bits;
++ spin_unlock(&lp->lock);
++}
++
++void
++e100_hardware_send_packet(struct net_local *np, char *buf, int length)
++{
++ D(printk("e100 send pack, buf 0x%x len %d\n", buf, length));
++
++ spin_lock(&np->led_lock);
++ if (!led_active && time_after(jiffies, led_next_time)) {
++ /* light the network leds depending on the current speed. */
++ e100_set_network_leds(NETWORK_ACTIVITY);
++
++ /* Set the earliest time we may clear the LED */
++ led_next_time = jiffies + NET_FLASH_TIME;
++ led_active = 1;
++ mod_timer(&clear_led_timer, jiffies + HZ/10);
++ }
++ spin_unlock(&np->led_lock);
++
++ /* configure the tx dma descriptor */
++ myNextTxDesc->descr.sw_len = length;
++ myNextTxDesc->descr.ctrl = d_eop | d_eol | d_wait;
++ myNextTxDesc->descr.buf = virt_to_phys(buf);
++
++ /* Move end of list */
++ myLastTxDesc->descr.ctrl &= ~d_eol;
++ myLastTxDesc = myNextTxDesc;
++
++ /* Restart DMA channel */
++ *R_DMA_CH0_CMD = IO_STATE(R_DMA_CH0_CMD, cmd, restart);
++}
++
++static void
++e100_clear_network_leds(unsigned long dummy)
++{
++ struct net_device *dev = (struct net_device *)dummy;
++ struct net_local *np = netdev_priv(dev);
++
++ spin_lock(&np->led_lock);
++
++ if (led_active && time_after(jiffies, led_next_time)) {
++ e100_set_network_leds(NO_NETWORK_ACTIVITY);
++
++ /* Set the earliest time we may set the LED */
++ led_next_time = jiffies + NET_FLASH_PAUSE;
++ led_active = 0;
++ }
++
++ spin_unlock(&np->led_lock);
++}
++
++static void
++e100_set_network_leds(int active)
++{
++#if defined(CONFIG_ETRAX_NETWORK_LED_ON_WHEN_LINK)
++ int light_leds = (active == NO_NETWORK_ACTIVITY);
++#elif defined(CONFIG_ETRAX_NETWORK_LED_ON_WHEN_ACTIVITY)
++ int light_leds = (active == NETWORK_ACTIVITY);
++#else
++#error "Define either CONFIG_ETRAX_NETWORK_LED_ON_WHEN_LINK or CONFIG_ETRAX_NETWORK_LED_ON_WHEN_ACTIVITY"
++#endif
++
++ if (!current_speed) {
++ /* Make LED red, link is down */
++#if defined(CONFIG_ETRAX_NETWORK_RED_ON_NO_CONNECTION)
++ CRIS_LED_NETWORK_SET(CRIS_LED_RED);
++#else
++ CRIS_LED_NETWORK_SET(CRIS_LED_OFF);
++#endif
++ } else if (light_leds) {
++ if (current_speed == 10) {
++ CRIS_LED_NETWORK_SET(CRIS_LED_ORANGE);
++ } else {
++ CRIS_LED_NETWORK_SET(CRIS_LED_GREEN);
++ }
++ } else {
++ CRIS_LED_NETWORK_SET(CRIS_LED_OFF);
++ }
++}
++
++#ifdef CONFIG_NET_POLL_CONTROLLER
++static void
++e100_netpoll(struct net_device* netdev)
++{
++ e100rxtx_interrupt(NETWORK_DMA_TX_IRQ_NBR, netdev, NULL);
++}
++#endif
++
++static int
++etrax_init_module(void)
++{
++ return etrax_ethernet_init();
++}
++
++static int __init
++e100_boot_setup(char* str)
++{
++ struct sockaddr sa = {0};
++ int i;
++
++ /* Parse the colon separated Ethernet station address */
++ for (i = 0; i < ETH_ALEN; i++) {
++ unsigned int tmp;
++ if (sscanf(str + 3*i, "%2x", &tmp) != 1) {
++ printk(KERN_WARNING "Malformed station address");
++ return 0;
++ }
++ sa.sa_data[i] = (char)tmp;
++ }
++
++ default_mac = sa;
++ return 1;
++}
++
++__setup("etrax100_eth=", e100_boot_setup);
++
++module_init(etrax_init_module);
+diff -Nur linux-2.6.32.orig/drivers/serial/crisv10.c linux-2.6.32/drivers/serial/crisv10.c
+--- linux-2.6.32.orig/drivers/serial/crisv10.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/drivers/serial/crisv10.c 2010-01-10 13:41:59.276309474 +0100
@@ -13,6 +13,7 @@
#include <linux/errno.h>
#include <linux/signal.h>
@@ -386,7 +2164,7 @@ diff -Nur linux-2.6.31.5.orig/drivers/serial/crisv10.c linux-2.6.31.5/drivers/se
#include <linux/timer.h>
#include <linux/interrupt.h>
#include <linux/tty.h>
-@@ -26,6 +27,7 @@
+@@ -27,6 +28,7 @@
#include <linux/kernel.h>
#include <linux/mutex.h>
#include <linux/bitops.h>
@@ -394,7 +2172,7 @@ diff -Nur linux-2.6.31.5.orig/drivers/serial/crisv10.c linux-2.6.31.5/drivers/se
#include <linux/seq_file.h>
#include <linux/delay.h>
#include <linux/module.h>
-@@ -4414,6 +4416,7 @@
+@@ -4415,6 +4417,7 @@
#endif
};
@@ -402,7 +2180,7 @@ diff -Nur linux-2.6.31.5.orig/drivers/serial/crisv10.c linux-2.6.31.5/drivers/se
static int __init rs_init(void)
{
int i;
-@@ -4547,6 +4550,24 @@
+@@ -4548,6 +4551,24 @@
#endif
#endif /* CONFIG_SVINTO_SIM */
@@ -427,9 +2205,4569 @@ diff -Nur linux-2.6.31.5.orig/drivers/serial/crisv10.c linux-2.6.31.5/drivers/se
return 0;
}
-diff -Nur linux-2.6.31.5.orig/drivers/usb/host/hc-cris-dbg.h linux-2.6.31.5/drivers/usb/host/hc-cris-dbg.h
---- linux-2.6.31.5.orig/drivers/usb/host/hc-cris-dbg.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-2.6.31.5/drivers/usb/host/hc-cris-dbg.h 2009-11-09 21:10:52.977927276 +0100
+diff -Nur linux-2.6.32.orig/drivers/serial/crisv10.c.orig linux-2.6.32/drivers/serial/crisv10.c.orig
+--- linux-2.6.32.orig/drivers/serial/crisv10.c.orig 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.32/drivers/serial/crisv10.c.orig 2009-12-03 04:51:21.000000000 +0100
+@@ -0,0 +1,4556 @@
++/*
++ * Serial port driver for the ETRAX 100LX chip
++ *
++ * Copyright (C) 1998-2007 Axis Communications AB
++ *
++ * Many, many authors. Based once upon a time on serial.c for 16x50.
++ *
++ */
++
++static char *serial_version = "$Revision: 1.25 $";
++
++#include <linux/types.h>
++#include <linux/errno.h>
++#include <linux/signal.h>
++#include <linux/sched.h>
++#include <linux/timer.h>
++#include <linux/interrupt.h>
++#include <linux/tty.h>
++#include <linux/tty_flip.h>
++#include <linux/major.h>
++#include <linux/smp_lock.h>
++#include <linux/string.h>
++#include <linux/fcntl.h>
++#include <linux/mm.h>
++#include <linux/slab.h>
++#include <linux/init.h>
++#include <linux/kernel.h>
++#include <linux/mutex.h>
++#include <linux/bitops.h>
++#include <linux/seq_file.h>
++#include <linux/delay.h>
++#include <linux/module.h>
++#include <linux/uaccess.h>
++#include <linux/io.h>
++
++#include <asm/irq.h>
++#include <asm/dma.h>
++#include <asm/system.h>
++
++#include <arch/svinto.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
++
++#if defined(CONFIG_ETRAX_RS485_ON_PA) && defined(CONFIG_ETRAX_RS485_ON_PORT_G)
++#error "Disable either CONFIG_ETRAX_RS485_ON_PA or CONFIG_ETRAX_RS485_ON_PORT_G"
++#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 STD_FLAGS (ASYNC_BOOT_AUTOCONF | ASYNC_SKIP_TEST)
++#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,
++ .flags = STD_FLAGS,
++ .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 = IRQF_DISABLED,
++ .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 = IRQF_DISABLED,
++ .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 */
++#ifndef CONFIG_SVINTO_SIM
++ { .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,
++ .flags = STD_FLAGS,
++ .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 = IRQF_DISABLED,
++ .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 = IRQF_DISABLED,
++ .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,
++ .flags = STD_FLAGS,
++ .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 = IRQF_DISABLED,
++ .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 = IRQF_DISABLED,
++ .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,
++ .flags = STD_FLAGS,
++ .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 = IRQF_DISABLED,
++ .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 = IRQF_DISABLED,
++ .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 */
++#endif
++};
++
++
++#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
++
++#ifdef CONFIG_ETRAX_SERIAL_PROC_ENTRY
++#define PROCSTAT(x) x
++struct ser_statistics_type {
++ int overrun_cnt;
++ int early_errors_cnt;
++ int ser_ints_ok_cnt;
++ int errors_cnt;
++ unsigned long int processing_flip;
++ unsigned long processing_flip_still_room;
++ unsigned long int timeout_flush_cnt;
++ int rx_dma_ints;
++ int tx_dma_ints;
++ int rx_tot;
++ int tx_tot;
++};
++
++static struct ser_statistics_type ser_stat[NR_PORTS];
++
++#else
++
++#define PROCSTAT(x)
++
++#endif /* CONFIG_ETRAX_SERIAL_PROC_ENTRY */
++
++/* 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
++#if defined(CONFIG_ETRAX_RS485_ON_PORT_G)
++static int rs485_port_g_bit = CONFIG_ETRAX_RS485_ON_PORT_G_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 CONFIG_ETRAX_SERX_DTR_RI_DSR_CD_MIXED
++#endif
++
++#ifdef CONFIG_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 /* CONFIG_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 /* !CONFIG_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)
++
++
++/*
++ * tmp_buf is used as a temporary buffer by serial_write. We need to
++ * lock it in case the memcpy_fromfs blocks while swapping in a page,
++ * and some other program tries to do a serial write at the same time.
++ * Since the lock will only come under contention when the system is
++ * swapping and available memory is low, it makes sense to share one
++ * buffer across all the serial ports, since it significantly saves
++ * memory if large numbers of serial ports are open.
++ */
++static unsigned char *tmp_buf;
++static DEFINE_MUTEX(tmp_buf_mutex);
++
++/* 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)
++{
++#ifndef CONFIG_SVINTO_SIM
++ 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
++#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)
++{
++#ifndef CONFIG_SVINTO_SIM
++ 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
++#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)
++{
++#ifndef CONFIG_SVINTO_SIM
++ /* 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);
++ }
++#endif
++}
++static inline void
++e100_cd_out(struct e100_serial *info, int set)
++{
++#ifndef CONFIG_SVINTO_SIM
++ /* 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);
++ }
++#endif
++}
++
++static inline void
++e100_disable_rx(struct e100_serial *info)
++{
++#ifndef CONFIG_SVINTO_SIM
++ /* disable the receiver */
++ info->ioport[REG_REC_CTRL] =
++ (info->rx_ctrl &= ~IO_MASK(R_SERIAL0_REC_CTRL, rec_enable));
++#endif
++}
++
++static inline void
++e100_enable_rx(struct e100_serial *info)
++{
++#ifndef CONFIG_SVINTO_SIM
++ /* enable the receiver */
++ info->ioport[REG_REC_CTRL] =
++ (info->rx_ctrl |= IO_MASK(R_SERIAL0_REC_CTRL, rec_enable));
++#endif
++}
++
++/* 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
++#if defined(CONFIG_ETRAX_RS485_ON_PORT_G)
++ REG_SHADOW_SET(R_PORT_G_DATA, port_g_data_shadow,
++ rs485_port_g_bit, 1);
++#endif
++#if defined(CONFIG_ETRAX_RS485_LTC1387)
++ REG_SHADOW_SET(R_PORT_G_DATA, port_g_data_shadow,
++ CONFIG_ETRAX_RS485_LTC1387_DXEN_PORT_G_BIT, 1);
++ REG_SHADOW_SET(R_PORT_G_DATA, port_g_data_shadow,
++ CONFIG_ETRAX_RS485_LTC1387_RXEN_PORT_G_BIT, 1);
++#endif
++
++ info->rs485.flags = r->flags;
++ if (r->delay_rts_before_send >= 1000)
++ info->rs485.delay_rts_before_send = 1000;
++ else
++ info->rs485.delay_rts_before_send = r->delay_rts_before_send;
++/* printk("rts: on send = %i, after = %i, enabled = %i",
++ info->rs485.rts_on_send,
++ info->rs485.rts_after_sent,
++ info->rs485.enabled
++ );
++*/
++ return 0;
++}
++
++static int
++e100_write_rs485(struct tty_struct *tty,
++ const unsigned char *buf, int count)
++{
++ struct e100_serial * info = (struct e100_serial *)tty->driver_data;
++ int old_value = (info->rs485.flags) & SER_RS485_ENABLED;
++
++ /* rs485 is always implicitly enabled if we're using the ioctl()
++ * but it doesn't have to be set in the serial_rs485
++ * (to be backward compatible with old apps)
++ * So we store, set and restore it.
++ */
++ info->rs485.flags |= SER_RS485_ENABLED;
++ /* rs_write now deals with RS485 if enabled */
++ count = rs_write(tty, buf, count);
++ if (!old_value)
++ info->rs485.flags &= ~(SER_RS485_ENABLED);
++ return count;
++}
++
++#ifdef CONFIG_ETRAX_FAST_TIMER
++/* Timer function to toggle RTS when using FAST_TIMER */
++static void rs485_toggle_rts_timer_function(unsigned long data)
++{
++ struct e100_serial *info = (struct e100_serial *)data;
++
++ fast_timers_rs485[info->line].function = NULL;
++ e100_rts(info, (info->rs485.flags & SER_RS485_RTS_AFTER_SEND));
++#if defined(CONFIG_ETRAX_RS485_DISABLE_RECEIVER)
++ e100_enable_rx(info);
++ e100_enable_rx_irq(info);
++#endif
++}
++#endif
++#endif /* CONFIG_ETRAX_RS485 */
++
++/*
++ * ------------------------------------------------------------
++ * rs_stop() and rs_start()
++ *
++ * This routines are called before setting or resetting tty->stopped.
++ * They enable or disable transmitter using the XOFF registers, as necessary.
++ * ------------------------------------------------------------
++ */
++
++static void
++rs_stop(struct tty_struct *tty)
++{
++ struct e100_serial *info = (struct e100_serial *)tty->driver_data;
++ if (info) {
++ unsigned long flags;
++ unsigned long xoff;
++
++ local_irq_save(flags);
++ DFLOW(DEBUG_LOG(info->line, "XOFF rs_stop xmit %i\n",
++ CIRC_CNT(info->xmit.head,
++ info->xmit.tail,SERIAL_XMIT_SIZE)));
++
++ xoff = IO_FIELD(R_SERIAL0_XOFF, xoff_char,
++ STOP_CHAR(info->port.tty));
++ xoff |= IO_STATE(R_SERIAL0_XOFF, tx_stop, stop);
++ if (tty->termios->c_iflag & IXON ) {
++ xoff |= IO_STATE(R_SERIAL0_XOFF, auto_xoff, enable);
++ }
++
++ *((unsigned long *)&info->ioport[REG_XOFF]) = xoff;
++ local_irq_restore(flags);
++ }
++}
++
++static void
++rs_start(struct tty_struct *tty)
++{
++ struct e100_serial *info = (struct e100_serial *)tty->driver_data;
++ if (info) {
++ unsigned long flags;
++ unsigned long xoff;
++
++ local_irq_save(flags);
++ DFLOW(DEBUG_LOG(info->line, "XOFF rs_start xmit %i\n",
++ CIRC_CNT(info->xmit.head,
++ info->xmit.tail,SERIAL_XMIT_SIZE)));
++ xoff = IO_FIELD(R_SERIAL0_XOFF, xoff_char, STOP_CHAR(tty));
++ xoff |= IO_STATE(R_SERIAL0_XOFF, tx_stop, enable);
++ if (tty->termios->c_iflag & IXON ) {
++ xoff |= IO_STATE(R_SERIAL0_XOFF, auto_xoff, enable);
++ }
++
++ *((unsigned long *)&info->ioport[REG_XOFF]) = xoff;
++ if (!info->uses_dma_out &&
++ info->xmit.head != info->xmit.tail && info->xmit.buf)
++ e100_enable_serial_tx_ready_irq(info);
++
++ local_irq_restore(flags);
++ }
++}
++
++/*
++ * ----------------------------------------------------------------------
++ *
++ * Here starts the interrupt handling routines. All of the following
++ * subroutines are declared as inline and are folded into
++ * rs_interrupt(). They were separated out for readability's sake.
++ *
++ * Note: rs_interrupt() is a "fast" interrupt, which means that it
++ * runs with interrupts turned off. People who may want to modify
++ * rs_interrupt() should try to keep the interrupt handler as fast as
++ * possible. After you are done making modifications, it is not a bad
++ * idea to do:
++ *
++ * gcc -S -DKERNEL -Wall -Wstrict-prototypes -O6 -fomit-frame-pointer serial.c
++ *
++ * and look at the resulting assemble code in serial.s.
++ *
++ * - Ted Ts'o (tytso@mit.edu), 7-Mar-93
++ * -----------------------------------------------------------------------
++ */
++
++/*
++ * This routine is used by the interrupt handler to schedule
++ * processing in the software interrupt portion of the driver.
++ */
++static void rs_sched_event(struct e100_serial *info, int event)
++{
++ if (info->event & (1 << event))
++ return;
++ info->event |= 1 << event;
++ schedule_work(&info->work);
++}
++
++/* The output DMA channel is free - use it to send as many chars as possible
++ * NOTES:
++ * We don't pay attention to info->x_char, which means if the TTY wants to
++ * use XON/XOFF it will set info->x_char but we won't send any X char!
++ *
++ * To implement this, we'd just start a DMA send of 1 byte pointing at a
++ * buffer containing the X char, and skip updating xmit. We'd also have to
++ * check if the last sent char was the X char when we enter this function
++ * the next time, to avoid updating xmit with the sent X value.
++ */
++
++static void
++transmit_chars_dma(struct e100_serial *info)
++{
++ unsigned int c, sentl;
++ struct etrax_dma_descr *descr;
++
++#ifdef CONFIG_SVINTO_SIM
++ /* This will output too little if tail is not 0 always since
++ * we don't reloop to send the other part. Anyway this SHOULD be a
++ * no-op - transmit_chars_dma would never really be called during sim
++ * since rs_write does not write into the xmit buffer then.
++ */
++ if (info->xmit.tail)
++ printk("Error in serial.c:transmit_chars-dma(), tail!=0\n");
++ if (info->xmit.head != info->xmit.tail) {
++ SIMCOUT(info->xmit.buf + info->xmit.tail,
++ CIRC_CNT(info->xmit.head,
++ info->xmit.tail,
++ SERIAL_XMIT_SIZE));
++ info->xmit.head = info->xmit.tail; /* move back head */
++ info->tr_running = 0;
++ }
++ return;
++#endif
++ /* 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;
++
++ if (!(buffer = kmalloc(sizeof *buffer + size, GFP_ATOMIC)))
++ 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) {
++ if (!(buffer = alloc_recv_buffer(4)))
++ return 0;
++
++ buffer->length = 1;
++ buffer->error = flag;
++ buffer->buffer[0] = data;
++
++ append_recv_buffer(info, buffer);
++
++ info->icount.rx++;
++ } else {
++ struct tty_struct *tty = info->port.tty;
++ tty_insert_flip_char(tty, 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_CRIT
++ "%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);
++
++ if (!(buffer = alloc_recv_buffer(SERIAL_DESCR_BUF_SIZE)))
++ 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;
++
++#ifdef CONFIG_SVINTO_SIM
++ /* No receive in the simulator. Will probably be when the rest of
++ * the serial interface works, and this piece will just be removed.
++ */
++ return;
++#endif
++
++ /* 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];
++
++ PROCSTAT(ser_stat[info->line].errors_cnt++);
++ 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++) {
++ if (!(buffer = alloc_recv_buffer(SERIAL_DESCR_BUF_SIZE)))
++ 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)
++{
++#ifdef CONFIG_SVINTO_SIM
++ /* No receive in the simulator. Will probably be when the rest of
++ * the serial interface works, and this piece will just be removed.
++ */
++ return;
++#endif
++ 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;
++
++#ifdef CONFIG_SVINTO_SIM
++ /* No receive in the simulator. Will probably be when the rest of
++ * the serial interface works, and this piece will just be removed.
++ */
++ {
++ const char *s = "What? tr_interrupt in simulator??\n";
++ SIMCOUT(s,strlen(s));
++ }
++ return IRQ_HANDLED;
++#endif
++
++ /* 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
++ */
++ PROCSTAT(ser_stat[info->line].tx_dma_ints++);
++ 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;
++
++#ifdef CONFIG_SVINTO_SIM
++ /* No receive in the simulator. Will probably be when the rest of
++ * the serial interface works, and this piece will just be removed.
++ */
++ {
++ const char *s = "What? rec_interrupt in simulator??\n";
++ SIMCOUT(s,strlen(s));
++ }
++ return IRQ_HANDLED;
++#endif
++
++ /* 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;
++ PROCSTAT(ser_stat[info->line].timeout_flush_cnt++);
++ 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 tty_struct *tty;
++ struct etrax_recv_buffer *buffer;
++ unsigned long flags;
++
++ local_irq_save(flags);
++ tty = info->port.tty;
++
++ if (!tty) {
++ local_irq_restore(flags);
++ return;
++ }
++
++ while ((buffer = info->first_recv_buffer) != NULL) {
++ unsigned int count = buffer->length;
++
++ tty_insert_flip_string(tty, 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(tty);
++}
++
++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_timout %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;
++
++#ifdef CONFIG_SVINTO_SIM
++ return;
++#endif
++
++ 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
++struct e100_serial * handle_ser_rx_interrupt_no_dma(struct e100_serial *info)
++{
++ unsigned long data_read;
++ struct tty_struct *tty = info->port.tty;
++
++ if (!tty) {
++ printk("!NO TTY!\n");
++ return info;
++ }
++
++ /* 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) {
++ struct tty_struct *tty = info->port.tty;
++ tty_insert_flip_char(tty, 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(tty, 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(tty,
++ 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.tty);
++ return info;
++}
++
++static struct e100_serial* 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) {
++ return handle_ser_rx_interrupt_no_dma(info);
++ }
++ /* 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);
++ }
++ PROCSTAT(ser_stat[info->line].early_errors_cnt++);
++ } 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;
++
++ PROCSTAT(ser_stat[info->line].ser_ints_ok_cnt++);
++ }
++ /* Restarting the DMA never hurts */
++ *info->icmdadr = IO_STATE(R_DMA_CH6_CMD, cmd, restart);
++ START_FLUSH_FAST_TIMER(info, "ser_int");
++ return info;
++} /* 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
++ || info->port.tty->hw_stopped) {
++ DFLOW(DEBUG_LOG(info->line, "tx_int: stopped %i\n",
++ info->port.tty->stopped));
++ e100_disable_serial_tx_ready_irq(info);
++ info->tr_running = 0;
++ return;
++ }
++ DINTR2(DEBUG_LOG(info->line, "tx_int %c\n", info->xmit.buf[info->xmit.tail]));
++ /* Send a byte, rs485 timing is critical so turn of ints */
++ local_irq_save(flags);
++ info->ioport[REG_TR_DATA] = info->xmit.buf[info->xmit.tail];
++ info->xmit.tail = (info->xmit.tail + 1) & (SERIAL_XMIT_SIZE-1);
++ info->icount.tx++;
++ if (info->xmit.head == info->xmit.tail) {
++#if defined(CONFIG_ETRAX_RS485) && defined(CONFIG_ETRAX_FAST_TIMER)
++ if (info->rs485.flags & SER_RS485_ENABLED) {
++ /* Set a short timer to toggle RTS */
++ start_one_shot_timer(&fast_timers_rs485[info->line],
++ rs485_toggle_rts_timer_function,
++ (unsigned long)info,
++ info->char_time_usec*2,
++ "RS-485");
++ }
++#endif /* RS485 */
++ info->last_tx_active_usec = GET_JIFFIES_USEC();
++ info->last_tx_active = jiffies;
++ e100_disable_serial_tx_ready_irq(info);
++ info->tr_running = 0;
++ DFLOW(DEBUG_LOG(info->line, "tx_int: stop2\n", 0));
++ } else {
++ /* We must enable since it is disabled in ser_interrupt */
++ e100_enable_serial_tx_ready_irq(info);
++ }
++ local_irq_restore(flags);
++
++ if (CIRC_CNT(info->xmit.head,
++ info->xmit.tail,
++ SERIAL_XMIT_SIZE) < WAKEUP_CHARS)
++ rs_sched_event(info, RS_EVENT_WRITE_WAKEUP);
++
++} /* handle_ser_tx_interrupt */
++
++/* result of time measurements:
++ * RX duration 54-60 us when doing something, otherwise 6-9 us
++ * ser_int duration: just sending: 8-15 us normally, up to 73 us
++ */
++static irqreturn_t
++ser_interrupt(int irq, void *dev_id)
++{
++ static volatile int tx_started = 0;
++ struct e100_serial *info;
++ int i;
++ unsigned long flags;
++ unsigned long irq_mask1_rd;
++ unsigned long data_mask = (1 << (8+2*0)); /* ser0 data_avail */
++ int handled = 0;
++ static volatile unsigned long reentered_ready_mask = 0;
++
++ local_irq_save(flags);
++ irq_mask1_rd = *R_IRQ_MASK1_RD;
++ /* First handle all rx interrupts with ints disabled */
++ info = rs_table;
++ irq_mask1_rd &= e100_ser_int_mask;
++ for (i = 0; i < NR_PORTS; i++) {
++ /* Which line caused the data irq? */
++ if (irq_mask1_rd & data_mask) {
++ handled = 1;
++ handle_ser_rx_interrupt(info);
++ }
++ info += 1;
++ data_mask <<= 2;
++ }
++ /* Handle tx interrupts with interrupts enabled so we
++ * can take care of new data interrupts while transmitting
++ * We protect the tx part with the tx_started flag.
++ * We disable the tr_ready interrupts we are about to handle and
++ * unblock the serial interrupt so new serial interrupts may come.
++ *
++ * If we get a new interrupt:
++ * - it migth be due to synchronous serial ports.
++ * - serial irq will be blocked by general irq handler.
++ * - async data will be handled above (sync will be ignored).
++ * - tx_started flag will prevent us from trying to send again and
++ * we will exit fast - no need to unblock serial irq.
++ * - Next (sync) serial interrupt handler will be runned with
++ * disabled interrupt due to restore_flags() at end of function,
++ * so sync handler will not be preempted or reentered.
++ */
++ if (!tx_started) {
++ unsigned long ready_mask;
++ unsigned long
++ tx_started = 1;
++ /* Only the tr_ready interrupts left */
++ irq_mask1_rd &= (IO_MASK(R_IRQ_MASK1_RD, ser0_ready) |
++ IO_MASK(R_IRQ_MASK1_RD, ser1_ready) |
++ IO_MASK(R_IRQ_MASK1_RD, ser2_ready) |
++ IO_MASK(R_IRQ_MASK1_RD, ser3_ready));
++ while (irq_mask1_rd) {
++ /* Disable those we are about to handle */
++ *R_IRQ_MASK1_CLR = irq_mask1_rd;
++ /* Unblock the serial interrupt */
++ *R_VECT_MASK_SET = IO_STATE(R_VECT_MASK_SET, serial, set);
++
++ local_irq_enable();
++ ready_mask = (1 << (8+1+2*0)); /* ser0 tr_ready */
++ info = rs_table;
++ for (i = 0; i < NR_PORTS; i++) {
++ /* Which line caused the ready irq? */
++ if (irq_mask1_rd & ready_mask) {
++ handled = 1;
++ handle_ser_tx_interrupt(info);
++ }
++ info += 1;
++ ready_mask <<= 2;
++ }
++ /* handle_ser_tx_interrupt enables tr_ready interrupts */
++ local_irq_disable();
++ /* Handle reentered TX interrupt */
++ irq_mask1_rd = reentered_ready_mask;
++ }
++ local_irq_disable();
++ tx_started = 0;
++ } else {
++ unsigned long ready_mask;
++ ready_mask = irq_mask1_rd & (IO_MASK(R_IRQ_MASK1_RD, ser0_ready) |
++ IO_MASK(R_IRQ_MASK1_RD, ser1_ready) |
++ IO_MASK(R_IRQ_MASK1_RD, ser2_ready) |
++ IO_MASK(R_IRQ_MASK1_RD, ser3_ready));
++ if (ready_mask) {
++ reentered_ready_mask |= ready_mask;
++ /* Disable those we are about to handle */
++ *R_IRQ_MASK1_CLR = ready_mask;
++ DFLOW(DEBUG_LOG(SERIAL_DEBUG_LINE, "ser_int reentered with TX %X\n", ready_mask));
++ }
++ }
++
++ local_irq_restore(flags);
++ return IRQ_RETVAL(handled);
++} /* ser_interrupt */
++#endif
++
++/*
++ * -------------------------------------------------------------------
++ * Here ends the serial interrupt routines.
++ * -------------------------------------------------------------------
++ */
++
++/*
++ * This routine is used to handle the "bottom half" processing for the
++ * serial driver, known also the "software interrupt" processing.
++ * This processing is done at the kernel interrupt level, after the
++ * rs_interrupt() has returned, BUT WITH INTERRUPTS TURNED ON. This
++ * is where time-consuming activities which can not be done in the
++ * interrupt driver proper are done; the interrupt driver schedules
++ * them using rs_sched_event(), and they get done here.
++ */
++static void
++do_softint(struct work_struct *work)
++{
++ struct e100_serial *info;
++ struct tty_struct *tty;
++
++ info = container_of(work, struct e100_serial, work);
++
++ tty = info->port.tty;
++ if (!tty)
++ return;
++
++ if (test_and_clear_bit(RS_EVENT_WRITE_WAKEUP, &info->event))
++ tty_wakeup(tty);
++}
++
++static int
++startup(struct e100_serial * info)
++{
++ unsigned long flags;
++ unsigned long xmit_page;
++ int i;
++
++ xmit_page = get_zeroed_page(GFP_KERNEL);
++ if (!xmit_page)
++ return -ENOMEM;
++
++ local_irq_save(flags);
++
++ /* if it was already initialized, skip this */
++
++ if (info->flags & ASYNC_INITIALIZED) {
++ local_irq_restore(flags);
++ free_page(xmit_page);
++ return 0;
++ }
++
++ if (info->xmit.buf)
++ free_page(xmit_page);
++ else
++ info->xmit.buf = (unsigned char *) xmit_page;
++
++#ifdef SERIAL_DEBUG_OPEN
++ printk("starting up ttyS%d (xmit_buf 0x%p)...\n", info->line, info->xmit.buf);
++#endif
++
++#ifdef CONFIG_SVINTO_SIM
++ /* Bits and pieces collected from below. Better to have them
++ in one ifdef:ed clause than to mix in a lot of ifdefs,
++ right? */
++ 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 = NULL;
++
++ /* No real action in the simulator, but may set info important
++ to ioctl. */
++ change_speed(info);
++#else
++
++ /*
++ * 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);
++
++#endif /* CONFIG_SVINTO_SIM */
++
++ info->flags |= ASYNC_INITIALIZED;
++
++ local_irq_restore(flags);
++ return 0;
++}
++
++/*
++ * This routine will shutdown a serial port; interrupts are disabled, and
++ * DTR is dropped if the hangup on close termio flag is on.
++ */
++static void
++shutdown(struct e100_serial * info)
++{
++ unsigned long flags;
++ struct etrax_dma_descr *descr = info->rec_descr;
++ struct etrax_recv_buffer *buffer;
++ int i;
++
++#ifndef CONFIG_SVINTO_SIM
++ /* 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;
++ }
++
++#endif /* CONFIG_SVINTO_SIM */
++
++ if (!(info->flags & ASYNC_INITIALIZED))
++ return;
++
++#ifdef SERIAL_DEBUG_OPEN
++ printk("Shutting down serial port %d (irq %d)....\n", info->line,
++ info->irq);
++#endif
++
++ local_irq_save(flags);
++
++ if (info->xmit.buf) {
++ free_page((unsigned long)info->xmit.buf);
++ info->xmit.buf = NULL;
++ }
++
++ for (i = 0; i < SERIAL_RECV_DESCRIPTORS; i++)
++ if (descr[i].buf) {
++ buffer = phys_to_virt(descr[i].buf) - sizeof *buffer;
++ kfree(buffer);
++ descr[i].buf = 0;
++ }
++
++ if (!info->port.tty || (info->port.tty->termios->c_cflag & HUPCL)) {
++ /* hang up DTR and RTS if HUPCL is enabled */
++ e100_dtr(info, 0);
++ e100_rts(info, 0); /* could check CRTSCTS before doing this */
++ }
++
++ if (info->port.tty)
++ set_bit(TTY_IO_ERROR, &info->port.tty->flags);
++
++ info->flags &= ~ASYNC_INITIALIZED;
++ local_irq_restore(flags);
++}
++
++
++/* change baud rate and other assorted parameters */
++
++static void
++change_speed(struct e100_serial *info)
++{
++ unsigned int cflag;
++ unsigned long xoff;
++ unsigned long flags;
++ /* first some safety checks */
++
++ if (!info->port.tty || !info->port.tty->termios)
++ 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->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;
++ }
++#ifdef CONFIG_ETRAX_EXTERN_PB6CLK_ENABLED
++ else if ((info->baud_base==CONFIG_ETRAX_EXTERN_PB6CLK_FREQ/8 &&
++ info->custom_divisor == 1) ||
++ (info->baud_base==CONFIG_ETRAX_EXTERN_PB6CLK_FREQ &&
++ info->custom_divisor == 8)) {
++ /* ext_clk selected */
++ alt_source =
++ IO_STATE(R_ALT_SER_BAUDRATE, ser0_rec, extern) |
++ IO_STATE(R_ALT_SER_BAUDRATE, ser0_tr, extern);
++ DBAUD(printk("using external baudrate: %lu\n", CONFIG_ETRAX_EXTERN_PB6CLK_FREQ/8));
++ info->baud = CONFIG_ETRAX_EXTERN_PB6CLK_FREQ/8;
++ }
++#endif
++ 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));
++#ifndef CONFIG_SVINTO_SIM
++ *R_ALT_SER_BAUDRATE = r_alt_ser_baudrate_shadow;
++#endif /* CONFIG_SVINTO_SIM */
++
++ info->baud = cflag_to_baud(cflag);
++#ifndef CONFIG_SVINTO_SIM
++ info->ioport[REG_BAUD] = cflag_to_etrax_baud(cflag);
++#endif /* CONFIG_SVINTO_SIM */
++ }
++
++#ifndef CONFIG_SVINTO_SIM
++ /* 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);
++#endif /* !CONFIG_SVINTO_SIM */
++
++ 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 ||
++ tty->hw_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 (!tty || !info->xmit.buf || !tmp_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
++
++#ifdef CONFIG_SVINTO_SIM
++ /* Really simple. The output is here and now. */
++ SIMCOUT(buf, count);
++ return count;
++#endif
++ local_save_flags(flags);
++ DFLOW(DEBUG_LOG(info->line, "write count %i ", count));
++ DFLOW(DEBUG_LOG(info->line, "ldisc %i\n", tty->ldisc.chars_in_buffer(tty)));
++
++
++ /* The local_irq_disable/restore_flags pairs below are needed
++ * because the DMA interrupt handler moves the info->xmit values.
++ * the memcpy needs to be in the critical region unfortunately,
++ * because we need to read xmit values, memcpy, write xmit values
++ * in one atomic operation... this could perhaps be avoided by
++ * more clever design.
++ */
++ local_irq_disable();
++ while (count) {
++ c = CIRC_SPACE_TO_END(info->xmit.head,
++ info->xmit.tail,
++ SERIAL_XMIT_SIZE);
++
++ if (count < c)
++ c = count;
++ if (c <= 0)
++ break;
++
++ memcpy(info->xmit.buf + info->xmit.head, buf, c);
++ info->xmit.head = (info->xmit.head + c) &
++ (SERIAL_XMIT_SIZE-1);
++ buf += c;
++ count -= c;
++ ret += c;
++ }
++ local_irq_restore(flags);
++
++ /* enable transmitter if not running, unless the tty is stopped
++ * this does not need IRQ protection since if tr_running == 0
++ * the IRQ's are not running anyway for this port.
++ */
++ DFLOW(DEBUG_LOG(info->line, "write ret %i\n", ret));
++
++ if (info->xmit.head != info->xmit.tail &&
++ !tty->stopped &&
++ !tty->hw_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
++ char buf[64];
++
++ printk("throttle %s: %lu....\n", tty_name(tty, buf),
++ (unsigned long)tty->ldisc.chars_in_buffer(tty));
++#endif
++ DFLOW(DEBUG_LOG(info->line,"rs_throttle %lu\n", tty->ldisc.chars_in_buffer(tty)));
++
++ /* Do RTS before XOFF since XOFF might take some time */
++ if (tty->termios->c_cflag & CRTSCTS) {
++ /* Turn off RTS line */
++ e100_rts(info, 0);
++ }
++ if (I_IXOFF(tty))
++ rs_send_xchar(tty, STOP_CHAR(tty));
++
++}
++
++static void
++rs_unthrottle(struct tty_struct * tty)
++{
++ struct e100_serial *info = (struct e100_serial *)tty->driver_data;
++#ifdef SERIAL_DEBUG_THROTTLE
++ char buf[64];
++
++ printk("unthrottle %s: %lu....\n", tty_name(tty, buf),
++ (unsigned long)tty->ldisc.chars_in_buffer(tty));
++#endif
++ DFLOW(DEBUG_LOG(info->line,"rs_unthrottle ldisc %d\n", tty->ldisc.chars_in_buffer(tty)));
++ DFLOW(DEBUG_LOG(info->line,"rs_unthrottle flip.count: %i\n", tty->flip.count));
++ /* Do RTS before XOFF since XOFF might take some time */
++ if (tty->termios->c_cflag & CRTSCTS) {
++ /* Assert RTS line */
++ e100_rts(info, 1);
++ }
++
++ if (I_IXOFF(tty)) {
++ if (info->x_char)
++ info->x_char = 0;
++ else
++ rs_send_xchar(tty, START_CHAR(tty));
++ }
++
++}
++
++/*
++ * ------------------------------------------------------------
++ * rs_ioctl() and friends
++ * ------------------------------------------------------------
++ */
++
++static int
++get_serial_info(struct e100_serial * info,
++ struct serial_struct * retinfo)
++{
++ struct serial_struct tmp;
++
++ /* this is all probably wrong, there are a lot of fields
++ * here that we don't have in e100_serial and maybe we
++ * should set them to something else than 0.
++ */
++
++ if (!retinfo)
++ return -EFAULT;
++ memset(&tmp, 0, sizeof(tmp));
++ tmp.type = info->type;
++ tmp.line = info->line;
++ tmp.port = (int)info->ioport;
++ tmp.irq = info->irq;
++ tmp.flags = info->flags;
++ tmp.baud_base = info->baud_base;
++ tmp.close_delay = info->close_delay;
++ tmp.closing_wait = info->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->close_delay) ||
++ ((new_serial.flags & ~ASYNC_USR_MASK) !=
++ (info->flags & ~ASYNC_USR_MASK)))
++ return -EPERM;
++ info->flags = ((info->flags & ~ASYNC_USR_MASK) |
++ (new_serial.flags & ASYNC_USR_MASK));
++ goto check_and_exit;
++ }
++
++ if (info->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->flags = ((info->flags & ~ASYNC_FLAGS) |
++ (new_serial.flags & ASYNC_FLAGS));
++ info->custom_divisor = new_serial.custom_divisor;
++ info->type = new_serial.type;
++ info->close_delay = new_serial.close_delay;
++ info->closing_wait = new_serial.closing_wait;
++ info->port.tty->low_latency = (info->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
++
++ check_and_exit:
++ if (info->flags & ASYNC_INITIALIZED) {
++ change_speed(info);
++ } else
++ retval = startup(info);
++ return retval;
++}
++
++/*
++ * get_lsr_info - get line status register info
++ *
++ * Purpose: Let user call ioctl() to get info when the UART physically
++ * is emptied. On bus types like RS485, the transmitter must
++ * release the bus after transmitting. This must be done when
++ * the transmit shift register is empty, not be done when the
++ * transmit holding register is empty. This functionality
++ * allows an RS485 driver to be written in user space.
++ */
++static int
++get_lsr_info(struct e100_serial * info, unsigned int *value)
++{
++ unsigned int result = TIOCSER_TEMT;
++#ifndef CONFIG_SVINTO_SIM
++ 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;
++ }
++#endif
++
++ 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, struct file *file,
++ 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 file *file)
++{
++ 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, struct file * file,
++ unsigned int cmd, unsigned long arg)
++{
++ struct e100_serial * info = (struct e100_serial *)tty->driver_data;
++
++ if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
++ (cmd != TIOCSERCONFIG) && (cmd != TIOCSERGWILD) &&
++ (cmd != TIOCSERSWILD) && (cmd != TIOCSERGSTRUCT)) {
++ if (tty->flags & (1 << TTY_IO_ERROR))
++ return -EIO;
++ }
++
++ switch (cmd) {
++ case TIOCGSERIAL:
++ return get_serial_info(info,
++ (struct serial_struct *) arg);
++ case TIOCSSERIAL:
++ return set_serial_info(info,
++ (struct serial_struct *) arg);
++ case TIOCSERGETLSR: /* Get line status register */
++ return get_lsr_info(info, (unsigned int *) arg);
++
++ case TIOCSERGSTRUCT:
++ if (copy_to_user((struct e100_serial *) arg,
++ info, sizeof(struct e100_serial)))
++ return -EFAULT;
++ return 0;
++
++#if defined(CONFIG_ETRAX_RS485)
++ case TIOCSERSETRS485:
++ {
++ /* In this ioctl we still use the old structure
++ * rs485_control for backward compatibility
++ * (if we use serial_rs485, then old user-level code
++ * wouldn't work anymore...).
++ * The use of this ioctl is deprecated: use TIOCSRS485
++ * instead.*/
++ struct rs485_control rs485ctrl;
++ struct serial_rs485 rs485data;
++ printk(KERN_DEBUG "The use of this ioctl is deprecated. Use TIOCSRS485 instead\n");
++ if (copy_from_user(&rs485ctrl, (struct rs485_control *)arg,
++ sizeof(rs485ctrl)))
++ return -EFAULT;
++
++ rs485data.delay_rts_before_send = rs485ctrl.delay_rts_before_send;
++ rs485data.flags = 0;
++ if (rs485ctrl.enabled)
++ rs485data.flags |= SER_RS485_ENABLED;
++ else
++ rs485data.flags &= ~(SER_RS485_ENABLED);
++
++ if (rs485ctrl.rts_on_send)
++ rs485data.flags |= SER_RS485_RTS_ON_SEND;
++ else
++ rs485data.flags &= ~(SER_RS485_RTS_ON_SEND);
++
++ if (rs485ctrl.rts_after_sent)
++ rs485data.flags |= SER_RS485_RTS_AFTER_SEND;
++ else
++ rs485data.flags &= ~(SER_RS485_RTS_AFTER_SEND);
++
++ return e100_enable_rs485(tty, &rs485data);
++ }
++
++ case TIOCSRS485:
++ {
++ /* This is the new version of TIOCSRS485, with new
++ * data structure serial_rs485 */
++ struct serial_rs485 rs485data;
++ if (copy_from_user(&rs485data, (struct rs485_control *)arg,
++ sizeof(rs485data)))
++ return -EFAULT;
++
++ return e100_enable_rs485(tty, &rs485data);
++ }
++
++
++ case TIOCSERWRRS485:
++ {
++ struct rs485_write rs485wr;
++ if (copy_from_user(&rs485wr, (struct rs485_write *)arg,
++ sizeof(rs485wr)))
++ return -EFAULT;
++
++ return e100_write_rs485(tty, rs485wr.outc, rs485wr.outc_size);
++ }
++#endif
++
++ default:
++ return -ENOIOCTLCMD;
++ }
++ return 0;
++}
++
++static void
++rs_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
++{
++ struct e100_serial *info = (struct e100_serial *)tty->driver_data;
++
++ change_speed(info);
++
++ /* Handle turning off CRTSCTS */
++ if ((old_termios->c_cflag & CRTSCTS) &&
++ !(tty->termios->c_cflag & CRTSCTS)) {
++ tty->hw_stopped = 0;
++ 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->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_CRIT
++ "rs_close: bad serial port count; tty->count is 1, "
++ "info->count is %d\n", info->count);
++ info->count = 1;
++ }
++ if (--info->count < 0) {
++ printk(KERN_CRIT "rs_close: bad serial port count for ttyS%d: %d\n",
++ info->line, info->count);
++ info->count = 0;
++ }
++ if (info->count) {
++ local_irq_restore(flags);
++ return;
++ }
++ info->flags |= ASYNC_CLOSING;
++ /*
++ * Save the termios structure, since this port may have
++ * separate termios for callout and dialin.
++ */
++ if (info->flags & ASYNC_NORMAL_ACTIVE)
++ info->normal_termios = *tty->termios;
++ /*
++ * 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->closing_wait != ASYNC_CLOSING_WAIT_NONE)
++ tty_wait_until_sent(tty, info->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
++
++#ifndef CONFIG_SVINTO_SIM
++ e100_disable_rx(info);
++ e100_disable_rx_irq(info);
++
++ if (info->flags & ASYNC_INITIALIZED) {
++ /*
++ * Before we drop DTR, make sure the UART transmitter
++ * has completely drained; this is especially
++ * important as we have a transmit FIFO!
++ */
++ rs_wait_until_sent(tty, HZ);
++ }
++#endif
++
++ shutdown(info);
++ rs_flush_buffer(tty);
++ tty_ldisc_flush(tty);
++ tty->closing = 0;
++ info->event = 0;
++ info->port.tty = NULL;
++ if (info->blocked_open) {
++ if (info->close_delay)
++ schedule_timeout_interruptible(info->close_delay);
++ wake_up_interruptible(&info->open_wait);
++ }
++ info->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
++ wake_up_interruptible(&info->close_wait);
++ local_irq_restore(flags);
++
++ /* port closed */
++
++#if defined(CONFIG_ETRAX_RS485)
++ if (info->rs485.flags & SER_RS485_ENABLED) {
++ info->rs485.flags &= ~(SER_RS485_ENABLED);
++#if defined(CONFIG_ETRAX_RS485_ON_PA)
++ *R_PORT_PA_DATA = port_pa_data_shadow &= ~(1 << rs485_pa_bit);
++#endif
++#if defined(CONFIG_ETRAX_RS485_ON_PORT_G)
++ REG_SHADOW_SET(R_PORT_G_DATA, port_g_data_shadow,
++ rs485_port_g_bit, 0);
++#endif
++#if defined(CONFIG_ETRAX_RS485_LTC1387)
++ REG_SHADOW_SET(R_PORT_G_DATA, port_g_data_shadow,
++ CONFIG_ETRAX_RS485_LTC1387_DXEN_PORT_G_BIT, 0);
++ REG_SHADOW_SET(R_PORT_G_DATA, port_g_data_shadow,
++ CONFIG_ETRAX_RS485_LTC1387_RXEN_PORT_G_BIT, 0);
++#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)
++ */
++ lock_kernel();
++ 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);
++ unlock_kernel();
++}
++
++/*
++ * 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->count = 0;
++ info->flags &= ~ASYNC_NORMAL_ACTIVE;
++ info->port.tty = NULL;
++ wake_up_interruptible(&info->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, extra_count = 0;
++
++ /*
++ * If the device is in the middle of being closed, then block
++ * until it's done, and then try again.
++ */
++ if (tty_hung_up_p(filp) ||
++ (info->flags & ASYNC_CLOSING)) {
++ wait_event_interruptible(info->close_wait,
++ !(info->flags & ASYNC_CLOSING));
++#ifdef SERIAL_DO_RESTART
++ if (info->flags & ASYNC_HUP_NOTIFY)
++ return -EAGAIN;
++ else
++ return -ERESTARTSYS;
++#else
++ return -EAGAIN;
++#endif
++ }
++
++ /*
++ * If non-blocking mode is set, or the port is not enabled,
++ * then make the check up front and then exit.
++ */
++ if ((filp->f_flags & O_NONBLOCK) ||
++ (tty->flags & (1 << TTY_IO_ERROR))) {
++ info->flags |= ASYNC_NORMAL_ACTIVE;
++ return 0;
++ }
++
++ if (tty->termios->c_cflag & CLOCAL) {
++ do_clocal = 1;
++ }
++
++ /*
++ * Block waiting for the carrier detect and the line to become
++ * free (i.e., not in use by the callout). While we are in
++ * this loop, info->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->open_wait, &wait);
++#ifdef SERIAL_DEBUG_OPEN
++ printk("block_til_ready before block: ttyS%d, count = %d\n",
++ info->line, info->count);
++#endif
++ local_irq_save(flags);
++ if (!tty_hung_up_p(filp)) {
++ extra_count++;
++ info->count--;
++ }
++ local_irq_restore(flags);
++ info->blocked_open++;
++ while (1) {
++ local_irq_save(flags);
++ /* assert RTS and DTR */
++ e100_rts(info, 1);
++ e100_dtr(info, 1);
++ local_irq_restore(flags);
++ set_current_state(TASK_INTERRUPTIBLE);
++ if (tty_hung_up_p(filp) ||
++ !(info->flags & ASYNC_INITIALIZED)) {
++#ifdef SERIAL_DO_RESTART
++ if (info->flags & ASYNC_HUP_NOTIFY)
++ retval = -EAGAIN;
++ else
++ retval = -ERESTARTSYS;
++#else
++ retval = -EAGAIN;
++#endif
++ break;
++ }
++ if (!(info->flags & ASYNC_CLOSING) && 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->count);
++#endif
++ schedule();
++ }
++ set_current_state(TASK_RUNNING);
++ remove_wait_queue(&info->open_wait, &wait);
++ if (extra_count)
++ info->count++;
++ info->blocked_open--;
++#ifdef SERIAL_DEBUG_OPEN
++ printk("block_til_ready after blocking: ttyS%d, count = %d\n",
++ info->line, info->count);
++#endif
++ if (retval)
++ return retval;
++ info->flags |= ASYNC_NORMAL_ACTIVE;
++ return 0;
++}
++
++static void
++deinit_port(struct e100_serial *info)
++{
++ if (info->dma_out_enabled) {
++ cris_free_dma(info->dma_out_nbr, info->dma_out_irq_description);
++ free_irq(info->dma_out_irq_nbr, info);
++ }
++ if (info->dma_in_enabled) {
++ cris_free_dma(info->dma_in_nbr, info->dma_in_irq_description);
++ free_irq(info->dma_in_irq_nbr, info);
++ }
++}
++
++/*
++ * This routine is called whenever a serial port is opened.
++ * It performs the serial-specific initialization for the tty structure.
++ */
++static int
++rs_open(struct tty_struct *tty, struct file * filp)
++{
++ struct e100_serial *info;
++ int retval, line;
++ unsigned long page;
++ int allocated_resources = 0;
++
++ /* find which port we want to open */
++ line = tty->index;
++
++ if (line < 0 || line >= NR_PORTS)
++ return -ENODEV;
++
++ /* find the corresponding e100_serial struct in the table */
++ info = rs_table + line;
++
++ /* don't allow the opening of ports that are not enabled in the HW config */
++ if (!info->enabled)
++ return -ENODEV;
++
++#ifdef SERIAL_DEBUG_OPEN
++ printk("[%d] rs_open %s, count = %d\n", current->pid, tty->name,
++ info->count);
++#endif
++
++ info->count++;
++ tty->driver_data = info;
++ info->port.tty = tty;
++
++ info->port.tty->low_latency = (info->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
++
++ if (!tmp_buf) {
++ page = get_zeroed_page(GFP_KERNEL);
++ if (!page) {
++ return -ENOMEM;
++ }
++ if (tmp_buf)
++ free_page(page);
++ else
++ tmp_buf = (unsigned char *) page;
++ }
++
++ /*
++ * If the port is in the middle of closing, bail out now
++ */
++ if (tty_hung_up_p(filp) ||
++ (info->flags & ASYNC_CLOSING)) {
++ wait_event_interruptible(info->close_wait,
++ !(info->flags & ASYNC_CLOSING));
++#ifdef SERIAL_DO_RESTART
++ return ((info->flags & ASYNC_HUP_NOTIFY) ?
++ -EAGAIN : -ERESTARTSYS);
++#else
++ return -EAGAIN;
++#endif
++ }
++
++ /*
++ * If DMA is enabled try to allocate the irq's.
++ */
++ if (info->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->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;
++ }
++
++ if ((info->count == 1) && (info->flags & ASYNC_SPLIT_TERMIOS)) {
++ *tty->termios = info->normal_termios;
++ change_speed(info);
++ }
++
++#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);
++ if (info->port.tty->hw_stopped)
++ seq_printf(m, " hw_stopped:%i",
++ (int)info->port.tty->hw_stopped);
++ }
++
++ {
++ unsigned char rstat = info->ioport[REG_STATUS];
++ if (rstat & IO_MASK(R_SERIAL0_STATUS, xoff_detect))
++ seq_printf(m, " xoff_detect:1");
++ }
++
++#endif
++
++ if (info->icount.frame)
++ seq_printf(m, " fe:%lu", (unsigned long)info->icount.frame);
++
++ if (info->icount.parity)
++ seq_printf(m, " pe:%lu", (unsigned long)info->icount.parity);
++
++ if (info->icount.brk)
++ seq_printf(m, " brk:%lu", (unsigned long)info->icount.brk);
++
++ if (info->icount.overrun)
++ seq_printf(m, " oe:%lu", (unsigned long)info->icount.overrun);
++
++ /*
++ * Last thing is the RS-232 status lines
++ */
++ if (!E100_RTS_GET(info))
++ seq_puts(m, "|RTS");
++ if (!E100_CTS_GET(info))
++ seq_puts(m, "|CTS");
++ if (!E100_DTR_GET(info))
++ seq_puts(m, "|DTR");
++ if (!E100_DSR_GET(info))
++ seq_puts(m, "|DSR");
++ if (!E100_CD_GET(info))
++ seq_puts(m, "|CD");
++ if (!E100_RI_GET(info))
++ seq_puts(m, "|RI");
++ seq_puts(m, "\n");
++}
++
++
++static int crisv10_proc_show(struct seq_file *m, void *v)
++{
++ int i;
++
++ seq_printf(m, "serinfo:1.0 driver:%s\n", serial_version);
++
++ for (i = 0; i < NR_PORTS; i++) {
++ if (!rs_table[i].enabled)
++ continue;
++ seq_line_info(m, &rs_table[i]);
++ }
++#ifdef DEBUG_LOG_INCLUDED
++ for (i = 0; i < debug_log_pos; i++) {
++ seq_printf(m, "%-4i %lu.%lu ",
++ i, debug_log[i].time,
++ timer_data_to_ns(debug_log[i].timer_data));
++ seq_printf(m, debug_log[i].string, debug_log[i].value);
++ }
++ seq_printf(m, "debug_log %i/%i\n", i, DEBUG_LOG_SIZE);
++ debug_log_pos = 0;
++#endif
++ return 0;
++}
++
++static int crisv10_proc_open(struct inode *inode, struct file *file)
++{
++ return single_open(file, crisv10_proc_show, NULL);
++}
++
++static const struct file_operations crisv10_proc_fops = {
++ .owner = THIS_MODULE,
++ .open = crisv10_proc_open,
++ .read = seq_read,
++ .llseek = seq_lseek,
++ .release = single_release,
++};
++#endif
++
++
++/* Finally, routines used to initialize the serial driver. */
++
++static void show_serial_version(void)
++{
++ printk(KERN_INFO
++ "ETRAX 100LX serial-driver %s, "
++ "(c) 2000-2004 Axis Communications AB\r\n",
++ &serial_version[11]); /* "$Revision: x.yy" */
++}
++
++/* rs_init inits the driver at boot (using the module_init chain) */
++
++static const struct tty_operations rs_ops = {
++ .open = rs_open,
++ .close = rs_close,
++ .write = rs_write,
++ .flush_chars = rs_flush_chars,
++ .write_room = rs_write_room,
++ .chars_in_buffer = rs_chars_in_buffer,
++ .flush_buffer = rs_flush_buffer,
++ .ioctl = rs_ioctl,
++ .throttle = rs_throttle,
++ .unthrottle = rs_unthrottle,
++ .set_termios = rs_set_termios,
++ .stop = rs_stop,
++ .start = rs_start,
++ .hangup = rs_hangup,
++ .break_ctl = rs_break,
++ .send_xchar = rs_send_xchar,
++ .wait_until_sent = rs_wait_until_sent,
++ .tiocmget = rs_tiocmget,
++ .tiocmset = rs_tiocmset,
++#ifdef CONFIG_PROC_FS
++ .proc_fops = &crisv10_proc_fops,
++#endif
++};
++
++static int __init rs_init(void)
++{
++ int i;
++ struct e100_serial *info;
++ struct tty_driver *driver = alloc_tty_driver(NR_PORTS);
++
++ if (!driver)
++ return -ENOMEM;
++
++ show_serial_version();
++
++ /* Setup the timed flush handler system */
++
++#if !defined(CONFIG_ETRAX_SERIAL_FAST_TIMER)
++ setup_timer(&flush_timer, timed_flush_handler, 0);
++ mod_timer(&flush_timer, jiffies + 5);
++#endif
++
++#if defined(CONFIG_ETRAX_RS485)
++#if defined(CONFIG_ETRAX_RS485_ON_PA)
++ if (cris_io_interface_allocate_pins(if_ser0, 'a', rs485_pa_bit,
++ rs485_pa_bit)) {
++ printk(KERN_CRIT "ETRAX100LX serial: Could not allocate "
++ "RS485 pin\n");
++ put_tty_driver(driver);
++ return -EBUSY;
++ }
++#endif
++#if defined(CONFIG_ETRAX_RS485_ON_PORT_G)
++ if (cris_io_interface_allocate_pins(if_ser0, 'g', rs485_pa_bit,
++ rs485_port_g_bit)) {
++ printk(KERN_CRIT "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_DRIVER_DYNAMIC_DEV;
++
++ tty_set_operations(driver, &rs_ops);
++ serial_driver = driver;
++ if (tty_register_driver(driver))
++ panic("Couldn't register serial driver\n");
++ /* 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_CRIT "ETRAX100LX async serial: "
++ "Could not allocate IO pins for "
++ "%s, port %d\n",
++ info->io_if_description, i);
++ info->enabled = 0;
++ }
++ }
++ 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->flags = 0;
++ info->close_delay = 5*HZ/10;
++ info->closing_wait = 30*HZ;
++ info->x_char = 0;
++ info->event = 0;
++ info->count = 0;
++ info->blocked_open = 0;
++ info->normal_termios = driver->init_termios;
++ init_waitqueue_head(&info->open_wait);
++ init_waitqueue_head(&info->close_wait);
++ 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 0x%x is a builtin UART with DMA\n",
++ serial_driver->name, info->line, (unsigned int)info->ioport);
++ }
++ }
++#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_SVINTO_SIM
++#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 | IRQF_DISABLED, "serial ", driver))
++ panic("%s: Failed to request irq8", __func__);
++
++#endif
++#endif /* CONFIG_SVINTO_SIM */
++
++ return 0;
++}
++
++/* this makes sure that rs_init is called during kernel boot */
++
++module_init(rs_init);
+diff -Nur linux-2.6.32.orig/drivers/usb/host/hc-cris-dbg.h linux-2.6.32/drivers/usb/host/hc-cris-dbg.h
+--- linux-2.6.32.orig/drivers/usb/host/hc-cris-dbg.h 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.32/drivers/usb/host/hc-cris-dbg.h 2010-01-10 13:41:59.276309474 +0100
@@ -0,0 +1,146 @@
+
+/* macros for debug output */
@@ -577,9 +6915,9 @@ diff -Nur linux-2.6.31.5.orig/drivers/usb/host/hc-cris-dbg.h linux-2.6.31.5/driv
+ }; \
+ s; \
+ })
-diff -Nur linux-2.6.31.5.orig/drivers/usb/host/hc-crisv10.c linux-2.6.31.5/drivers/usb/host/hc-crisv10.c
---- linux-2.6.31.5.orig/drivers/usb/host/hc-crisv10.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-2.6.31.5/drivers/usb/host/hc-crisv10.c 2009-11-09 21:10:53.049913537 +0100
+diff -Nur linux-2.6.32.orig/drivers/usb/host/hc-crisv10.c linux-2.6.32/drivers/usb/host/hc-crisv10.c
+--- linux-2.6.32.orig/drivers/usb/host/hc-crisv10.c 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.32/drivers/usb/host/hc-crisv10.c 2010-01-10 13:41:59.326309689 +0100
@@ -0,0 +1,4801 @@
+/*
+ *
@@ -5382,9 +11720,9 @@ diff -Nur linux-2.6.31.5.orig/drivers/usb/host/hc-crisv10.c linux-2.6.31.5/drive
+/* Module hooks */
+module_init(module_hcd_init);
+module_exit(module_hcd_exit);
-diff -Nur linux-2.6.31.5.orig/drivers/usb/host/hc-crisv10.h linux-2.6.31.5/drivers/usb/host/hc-crisv10.h
---- linux-2.6.31.5.orig/drivers/usb/host/hc-crisv10.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-2.6.31.5/drivers/usb/host/hc-crisv10.h 2009-11-09 21:10:53.061914787 +0100
+diff -Nur linux-2.6.32.orig/drivers/usb/host/hc-crisv10.h linux-2.6.32/drivers/usb/host/hc-crisv10.h
+--- linux-2.6.32.orig/drivers/usb/host/hc-crisv10.h 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.32/drivers/usb/host/hc-crisv10.h 2010-01-10 13:41:59.326309689 +0100
@@ -0,0 +1,331 @@
+#ifndef __LINUX_ETRAX_USB_H
+#define __LINUX_ETRAX_USB_H
@@ -5717,18 +12055,56 @@ diff -Nur linux-2.6.31.5.orig/drivers/usb/host/hc-crisv10.h linux-2.6.31.5/drive
+#define USB_SB_command__full__yes 1
+
+#endif
-diff -Nur linux-2.6.31.5.orig/drivers/usb/host/Makefile linux-2.6.31.5/drivers/usb/host/Makefile
---- linux-2.6.31.5.orig/drivers/usb/host/Makefile 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/drivers/usb/host/Makefile 2009-11-09 21:10:53.090776289 +0100
-@@ -31,3 +31,4 @@
+diff -Nur linux-2.6.32.orig/drivers/usb/host/Makefile linux-2.6.32/drivers/usb/host/Makefile
+--- linux-2.6.32.orig/drivers/usb/host/Makefile 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/drivers/usb/host/Makefile 2010-01-10 13:41:59.326309689 +0100
+@@ -32,3 +32,4 @@
obj-$(CONFIG_USB_R8A66597_HCD) += r8a66597-hcd.o
obj-$(CONFIG_USB_ISP1760_HCD) += isp1760.o
obj-$(CONFIG_USB_HWA_HCD) += hwa-hc.o
+obj-$(CONFIG_ETRAX_USB_HOST) += hc-crisv10.o
-diff -Nur linux-2.6.31.5.orig/drivers/usb/Makefile linux-2.6.31.5/drivers/usb/Makefile
---- linux-2.6.31.5.orig/drivers/usb/Makefile 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/drivers/usb/Makefile 2009-11-09 21:10:53.111922280 +0100
-@@ -20,6 +20,7 @@
+diff -Nur linux-2.6.32.orig/drivers/usb/host/Makefile.orig linux-2.6.32/drivers/usb/host/Makefile.orig
+--- linux-2.6.32.orig/drivers/usb/host/Makefile.orig 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.32/drivers/usb/host/Makefile.orig 2009-12-03 04:51:21.000000000 +0100
+@@ -0,0 +1,34 @@
++#
++# Makefile for USB Host Controller Drivers
++#
++
++ifeq ($(CONFIG_USB_DEBUG),y)
++ EXTRA_CFLAGS += -DDEBUG
++endif
++
++isp1760-objs := isp1760-hcd.o isp1760-if.o
++fhci-objs := fhci-hcd.o fhci-hub.o fhci-q.o fhci-mem.o \
++ fhci-tds.o fhci-sched.o
++ifeq ($(CONFIG_FHCI_DEBUG),y)
++fhci-objs += fhci-dbg.o
++endif
++xhci-objs := xhci-hcd.o xhci-mem.o xhci-pci.o xhci-ring.o xhci-hub.o xhci-dbg.o
++
++obj-$(CONFIG_USB_WHCI_HCD) += whci/
++
++obj-$(CONFIG_PCI) += pci-quirks.o
++
++obj-$(CONFIG_USB_EHCI_HCD) += ehci-hcd.o
++obj-$(CONFIG_USB_OXU210HP_HCD) += oxu210hp-hcd.o
++obj-$(CONFIG_USB_ISP116X_HCD) += isp116x-hcd.o
++obj-$(CONFIG_USB_ISP1362_HCD) += isp1362-hcd.o
++obj-$(CONFIG_USB_OHCI_HCD) += ohci-hcd.o
++obj-$(CONFIG_USB_UHCI_HCD) += uhci-hcd.o
++obj-$(CONFIG_USB_FHCI_HCD) += fhci.o
++obj-$(CONFIG_USB_XHCI_HCD) += xhci.o
++obj-$(CONFIG_USB_SL811_HCD) += sl811-hcd.o
++obj-$(CONFIG_USB_SL811_CS) += sl811_cs.o
++obj-$(CONFIG_USB_U132_HCD) += u132-hcd.o
++obj-$(CONFIG_USB_R8A66597_HCD) += r8a66597-hcd.o
++obj-$(CONFIG_USB_ISP1760_HCD) += isp1760.o
++obj-$(CONFIG_USB_HWA_HCD) += hwa-hc.o
+diff -Nur linux-2.6.32.orig/drivers/usb/Makefile linux-2.6.32/drivers/usb/Makefile
+--- linux-2.6.32.orig/drivers/usb/Makefile 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/drivers/usb/Makefile 2010-01-10 13:41:59.326309689 +0100
+@@ -21,6 +21,7 @@
obj-$(CONFIG_USB_R8A66597_HCD) += host/
obj-$(CONFIG_USB_HWA_HCD) += host/
obj-$(CONFIG_USB_ISP1760_HCD) += host/
@@ -5736,9 +12112,59 @@ diff -Nur linux-2.6.31.5.orig/drivers/usb/Makefile linux-2.6.31.5/drivers/usb/Ma
obj-$(CONFIG_USB_C67X00_HCD) += c67x00/
-diff -Nur linux-2.6.31.5.orig/lib/klist.c linux-2.6.31.5/lib/klist.c
---- linux-2.6.31.5.orig/lib/klist.c 2009-10-23 00:57:56.000000000 +0200
-+++ linux-2.6.31.5/lib/klist.c 2009-11-09 21:10:53.142378957 +0100
+diff -Nur linux-2.6.32.orig/drivers/usb/Makefile.orig linux-2.6.32/drivers/usb/Makefile.orig
+--- linux-2.6.32.orig/drivers/usb/Makefile.orig 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.32/drivers/usb/Makefile.orig 2009-12-03 04:51:21.000000000 +0100
+@@ -0,0 +1,46 @@
++#
++# Makefile for the kernel USB device drivers.
++#
++
++# Object files in subdirectories
++
++obj-$(CONFIG_USB) += core/
++
++obj-$(CONFIG_USB_MON) += mon/
++
++obj-$(CONFIG_PCI) += host/
++obj-$(CONFIG_USB_EHCI_HCD) += host/
++obj-$(CONFIG_USB_ISP116X_HCD) += host/
++obj-$(CONFIG_USB_OHCI_HCD) += host/
++obj-$(CONFIG_USB_UHCI_HCD) += host/
++obj-$(CONFIG_USB_FHCI_HCD) += host/
++obj-$(CONFIG_USB_XHCI_HCD) += host/
++obj-$(CONFIG_USB_SL811_HCD) += host/
++obj-$(CONFIG_USB_ISP1362_HCD) += host/
++obj-$(CONFIG_USB_U132_HCD) += host/
++obj-$(CONFIG_USB_R8A66597_HCD) += host/
++obj-$(CONFIG_USB_HWA_HCD) += host/
++obj-$(CONFIG_USB_ISP1760_HCD) += host/
++
++obj-$(CONFIG_USB_C67X00_HCD) += c67x00/
++
++obj-$(CONFIG_USB_WUSB) += wusbcore/
++
++obj-$(CONFIG_USB_ACM) += class/
++obj-$(CONFIG_USB_PRINTER) += class/
++obj-$(CONFIG_USB_WDM) += class/
++obj-$(CONFIG_USB_TMC) += class/
++
++obj-$(CONFIG_USB_STORAGE) += storage/
++obj-$(CONFIG_USB) += storage/
++
++obj-$(CONFIG_USB_MDC800) += image/
++obj-$(CONFIG_USB_MICROTEK) += image/
++
++obj-$(CONFIG_USB_SERIAL) += serial/
++
++obj-$(CONFIG_USB) += misc/
++obj-y += early/
++
++obj-$(CONFIG_USB_ATM) += atm/
++obj-$(CONFIG_USB_SPEEDTOUCH) += atm/
+diff -Nur linux-2.6.32.orig/lib/klist.c linux-2.6.32/lib/klist.c
+--- linux-2.6.32.orig/lib/klist.c 2009-12-03 04:51:21.000000000 +0100
++++ linux-2.6.32/lib/klist.c 2010-01-10 13:41:59.326309689 +0100
@@ -60,7 +60,7 @@
{
knode->n_klist = klist;