summaryrefslogtreecommitdiff
path: root/target/linux/patches
diff options
context:
space:
mode:
authorWaldemar Brodkorb <wbx@openadk.org>2017-01-22 10:08:01 +0100
committerWaldemar Brodkorb <wbx@openadk.org>2017-01-22 10:08:16 +0100
commitb5b344787ba362d146651967691da117a12ff61d (patch)
treecc7fc0aeecd15b0008fe87207c659926a5d72b40 /target/linux/patches
parent818c883f272c1860f76232006e492283ac7ee80e (diff)
nds32: use the kernel source from Andes
Diffstat (limited to 'target/linux/patches')
-rw-r--r--target/linux/patches/3.4.113/nds32.patch72144
1 files changed, 0 insertions, 72144 deletions
diff --git a/target/linux/patches/3.4.113/nds32.patch b/target/linux/patches/3.4.113/nds32.patch
deleted file mode 100644
index b71178b57..000000000
--- a/target/linux/patches/3.4.113/nds32.patch
+++ /dev/null
@@ -1,72144 +0,0 @@
-diff -Nur linux-3.4.113.orig/arch/nds32/boot/install.sh linux-3.4.113/arch/nds32/boot/install.sh
---- linux-3.4.113.orig/arch/nds32/boot/install.sh 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/boot/install.sh 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,47 @@
-+#!/bin/sh
-+#
-+# arch/nds32/boot/install.sh
-+#
-+# This file is subject to the terms and conditions of the GNU General Public
-+# License. See the file "COPYING" in the main directory of this archive
-+# for more details.
-+#
-+# Copyright (C) 1995 by Linus Torvalds
-+# Copyright (C) 2009 Andes Technology Corporation
-+#
-+# Adapted from code in arch/i386/boot/Makefile by H. Peter Anvin
-+# Adapted from code in arch/i386/boot/install.sh by Russell King
-+#
-+# "make install" script for arm architecture
-+#
-+# Arguments:
-+# $1 - kernel version
-+# $2 - kernel image file
-+# $3 - kernel map file
-+# $4 - default install path (blank if root directory)
-+#
-+
-+# User may have a custom install script
-+if [ -x ~/bin/installkernel ]; then exec ~/bin/installkernel "$@"; fi
-+if [ -x /sbin/installkernel ]; then exec /sbin/installkernel "$@"; fi
-+
-+# Normal install
-+echo "Installing normal kernel"
-+base=vmlinux
-+
-+if [ -f $4/$base-$1 ]; then
-+ mv $4/$base-$1 $4/$base-$1.old
-+fi
-+cat $2 > $4/$base-$1
-+
-+# Install system map file
-+if [ -f $4/System.map-$1 ]; then
-+ mv $4/System.map-$1 $4/System.map-$1.old
-+fi
-+cp $3 $4/System.map-$1
-+
-+if [ -x /sbin/loadmap ]; then
-+ /sbin/loadmap
-+else
-+ echo "You have to install it yourself"
-+fi
-diff -Nur linux-3.4.113.orig/arch/nds32/boot/Makefile linux-3.4.113/arch/nds32/boot/Makefile
---- linux-3.4.113.orig/arch/nds32/boot/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/boot/Makefile 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,22 @@
-+#
-+# arch/nds32/boot/Makefile
-+#
-+# This file is subject to the terms and conditions of the GNU General Public
-+# License. See the file "COPYING" in the main directory of this archive
-+# for more details.
-+#
-+# Copyright (C) 1995-2002 Russell King
-+# Copyright (C) 2009 Andes Technology Corporation
-+#
-+
-+targets := Image
-+
-+$(obj)/Image: vmlinux FORCE
-+ $(call if_changed,objcopy)
-+ @echo ' Kernel: $@ is ready'
-+
-+.PHONY: FORCE
-+install: $(obj)/Image
-+ $(CONFIG_SHELL) $(srctree)/$(src)/install.sh $(KERNELRELEASE) \
-+ $(obj)/Image System.map "$(INSTALL_PATH)"
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/common/dmabounce.c linux-3.4.113/arch/nds32/common/dmabounce.c
---- linux-3.4.113.orig/arch/nds32/common/dmabounce.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/common/dmabounce.c 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,672 @@
-+/*
-+ * arch/nds32/common/dmabounce.c
-+ *
-+ * Special dma_{map/unmap/dma_sync}_* routines for systems that have
-+ * limited DMA windows. These functions utilize bounce buffers to
-+ * copy data to/from buffers located outside the DMA region. This
-+ * only works for systems in which DMA memory is at the bottom of
-+ * RAM and the remainder of memory is at the top an the DMA memory
-+ * can be marked as ZONE_DMA. Anything beyond that such as discontigous
-+ * DMA windows will require custom implementations that reserve memory
-+ * areas at early bootup.
-+ *
-+ * Original version by Brad Parker (brad@heeltoe.com)
-+ * Re-written by Christopher Hoover <ch@murgatroid.com>
-+ * Made generic by Deepak Saxena <dsaxena@plexity.net>
-+ *
-+ * Copyright (C) 2002 Hewlett Packard Company.
-+ * Copyright (C) 2004 MontaVista Software, Inc.
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or
-+ * modify it under the terms of the GNU General Public License
-+ * version 2 as published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/init.h>
-+#include <linux/slab.h>
-+#include <linux/device.h>
-+#include <linux/dma-mapping.h>
-+#include <linux/dmapool.h>
-+#include <linux/list.h>
-+
-+#undef DEBUG
-+
-+#undef STATS
-+#ifdef STATS
-+#define DO_STATS(X) do { X ; } while (0)
-+#else
-+#define DO_STATS(X) do { } while (0)
-+#endif
-+
-+/* ************************************************** */
-+
-+struct safe_buffer {
-+ struct list_head node;
-+
-+ /* original request */
-+ void *ptr;
-+ size_t size;
-+ int direction;
-+
-+ /* safe buffer info */
-+ struct dma_pool *pool;
-+ void *safe;
-+ dma_addr_t safe_dma_addr;
-+};
-+
-+struct dmabounce_device_info {
-+ struct list_head node;
-+
-+ struct device *dev;
-+ struct dma_pool *small_buffer_pool;
-+ struct dma_pool *large_buffer_pool;
-+ struct list_head safe_buffers;
-+ unsigned long small_buffer_size, large_buffer_size;
-+#ifdef STATS
-+ unsigned long sbp_allocs;
-+ unsigned long lbp_allocs;
-+ unsigned long total_allocs;
-+ unsigned long map_op_count;
-+ unsigned long bounce_count;
-+#endif
-+};
-+
-+static LIST_HEAD(dmabounce_devs);
-+
-+#ifdef STATS
-+static void print_alloc_stats(struct dmabounce_device_info *device_info)
-+{
-+ printk(KERN_INFO
-+ "%s: dmabounce: sbp: %lu, lbp: %lu, other: %lu, total: %lu\n",
-+ device_info->dev->bus_id,
-+ device_info->sbp_allocs, device_info->lbp_allocs,
-+ device_info->total_allocs - device_info->sbp_allocs -
-+ device_info->lbp_allocs, device_info->total_allocs);
-+}
-+#endif
-+
-+/* find the given device in the dmabounce device list */
-+static inline struct dmabounce_device_info *find_dmabounce_dev(struct device
-+ *dev)
-+{
-+ struct list_head *entry;
-+
-+ list_for_each(entry, &dmabounce_devs) {
-+ struct dmabounce_device_info *d =
-+ list_entry(entry, struct dmabounce_device_info, node);
-+
-+ if (d->dev == dev)
-+ return d;
-+ }
-+ return NULL;
-+}
-+
-+/* allocate a 'safe' buffer and keep track of it */
-+static inline struct safe_buffer *alloc_safe_buffer(struct dmabounce_device_info
-+ *device_info, void *ptr,
-+ size_t size,
-+ enum dma_data_direction dir)
-+{
-+ struct safe_buffer *buf;
-+ struct dma_pool *pool;
-+ struct device *dev = device_info->dev;
-+ void *safe;
-+ dma_addr_t safe_dma_addr;
-+
-+ dev_dbg(dev, "%s(ptr=%p, size=%d, dir=%d)\n", __func__, ptr, size, dir);
-+
-+ DO_STATS(device_info->total_allocs++);
-+
-+ buf = kmalloc(sizeof(struct safe_buffer), GFP_ATOMIC);
-+ if (buf == NULL) {
-+ dev_warn(dev, "%s: kmalloc failed\n", __func__);
-+ return NULL;
-+ }
-+
-+ if (size <= device_info->small_buffer_size) {
-+ pool = device_info->small_buffer_pool;
-+ safe = dma_pool_alloc(pool, GFP_ATOMIC, &safe_dma_addr);
-+
-+ DO_STATS(device_info->sbp_allocs++);
-+ } else if (size <= device_info->large_buffer_size) {
-+ pool = device_info->large_buffer_pool;
-+ safe = dma_pool_alloc(pool, GFP_ATOMIC, &safe_dma_addr);
-+
-+ DO_STATS(device_info->lbp_allocs++);
-+ } else {
-+ pool = NULL;
-+ safe =
-+ dma_alloc_coherent(dev, size, &safe_dma_addr, GFP_ATOMIC);
-+ }
-+
-+ if (safe == NULL) {
-+ dev_warn(device_info->dev,
-+ "%s: could not alloc dma memory (size=%d)\n",
-+ __func__, size);
-+ kfree(buf);
-+ return NULL;
-+ }
-+#ifdef STATS
-+ if (device_info->total_allocs % 1000 == 0)
-+ print_alloc_stats(device_info);
-+#endif
-+
-+ buf->ptr = ptr;
-+ buf->size = size;
-+ buf->direction = dir;
-+ buf->pool = pool;
-+ buf->safe = safe;
-+ buf->safe_dma_addr = safe_dma_addr;
-+
-+ list_add(&buf->node, &device_info->safe_buffers);
-+
-+ return buf;
-+}
-+
-+/* determine if a buffer is from our "safe" pool */
-+static inline struct safe_buffer *find_safe_buffer(struct dmabounce_device_info
-+ *device_info,
-+ dma_addr_t safe_dma_addr)
-+{
-+ struct list_head *entry;
-+
-+ list_for_each(entry, &device_info->safe_buffers) {
-+ struct safe_buffer *b =
-+ list_entry(entry, struct safe_buffer, node);
-+
-+ if (b->safe_dma_addr == safe_dma_addr)
-+ return b;
-+ }
-+
-+ return NULL;
-+}
-+
-+static inline void
-+free_safe_buffer(struct dmabounce_device_info *device_info,
-+ struct safe_buffer *buf)
-+{
-+ dev_dbg(device_info->dev, "%s(buf=%p)\n", __func__, buf);
-+
-+ list_del(&buf->node);
-+
-+ if (buf->pool)
-+ dma_pool_free(buf->pool, buf->safe, buf->safe_dma_addr);
-+ else
-+ dma_free_coherent(device_info->dev, buf->size, buf->safe,
-+ buf->safe_dma_addr);
-+
-+ kfree(buf);
-+}
-+
-+/* ************************************************** */
-+
-+#ifdef STATS
-+
-+static void print_map_stats(struct dmabounce_device_info *device_info)
-+{
-+ printk(KERN_INFO
-+ "%s: dmabounce: map_op_count=%lu, bounce_count=%lu\n",
-+ device_info->dev->bus_id,
-+ device_info->map_op_count, device_info->bounce_count);
-+}
-+#endif
-+
-+static inline dma_addr_t
-+map_single(struct device *dev, void *ptr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ struct dmabounce_device_info *device_info = find_dmabounce_dev(dev);
-+ dma_addr_t dma_addr;
-+ int needs_bounce = 0;
-+
-+ if (device_info)
-+ DO_STATS(device_info->map_op_count++);
-+
-+ dma_addr = virt_to_dma(dev, ptr);
-+
-+ if (dev->dma_mask) {
-+ unsigned long mask = *dev->dma_mask;
-+ unsigned long limit;
-+
-+ limit = (mask + 1) & ~mask;
-+ if (limit && size > limit) {
-+ dev_err(dev, "DMA mapping too big (requested %#x "
-+ "mask %#Lx)\n", size, *dev->dma_mask);
-+ return ~0;
-+ }
-+
-+ /*
-+ * Figure out if we need to bounce from the DMA mask.
-+ */
-+ needs_bounce = (dma_addr | (dma_addr + size - 1)) & ~mask;
-+ }
-+
-+ if (device_info
-+ && (needs_bounce || dma_needs_bounce(dev, dma_addr, size))) {
-+ struct safe_buffer *buf;
-+
-+ buf = alloc_safe_buffer(device_info, ptr, size, dir);
-+ if (buf == 0) {
-+ dev_err(dev, "%s: unable to map unsafe buffer %p!\n",
-+ __func__, ptr);
-+ return 0;
-+ }
-+
-+ dev_dbg(dev,
-+ "%s: unsafe buffer %p (phy=%p) mapped to %p (phy=%p)\n",
-+ __func__, buf->ptr, (void *)virt_to_dma(dev, buf->ptr),
-+ buf->safe, (void *)buf->safe_dma_addr);
-+
-+ if ((dir == DMA_TO_DEVICE) || (dir == DMA_BIDIRECTIONAL)) {
-+ dev_dbg(dev, "%s: copy unsafe %p to safe %p, size %d\n",
-+ __func__, ptr, buf->safe, size);
-+ memcpy(buf->safe, ptr, size);
-+ }
-+ consistent_sync(buf->safe, size, dir);
-+
-+ dma_addr = buf->safe_dma_addr;
-+ } else {
-+ consistent_sync(ptr, size, dir);
-+ }
-+
-+ return dma_addr;
-+}
-+
-+static inline void
-+unmap_single(struct device *dev, dma_addr_t dma_addr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ struct dmabounce_device_info *device_info = find_dmabounce_dev(dev);
-+ struct safe_buffer *buf = NULL;
-+
-+ /*
-+ * Trying to unmap an invalid mapping
-+ */
-+ if (dma_addr == ~0) {
-+ dev_err(dev, "Trying to unmap invalid mapping\n");
-+ return;
-+ }
-+
-+ if (device_info)
-+ buf = find_safe_buffer(device_info, dma_addr);
-+
-+ if (buf) {
-+ BUG_ON(buf->size != size);
-+
-+ dev_dbg(dev,
-+ "%s: unsafe buffer %p (phy=%p) mapped to %p (phy=%p)\n",
-+ __func__, buf->ptr, (void *)virt_to_dma(dev, buf->ptr),
-+ buf->safe, (void *)buf->safe_dma_addr);
-+
-+ DO_STATS(device_info->bounce_count++);
-+
-+ if ((dir == DMA_FROM_DEVICE) || (dir == DMA_BIDIRECTIONAL)) {
-+ dev_dbg(dev,
-+ "%s: copy back safe %p to unsafe %p size %d\n",
-+ __func__, buf->safe, buf->ptr, size);
-+ memcpy(buf->ptr, buf->safe, size);
-+ }
-+ free_safe_buffer(device_info, buf);
-+ }
-+}
-+
-+static inline void
-+sync_single(struct device *dev, dma_addr_t dma_addr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ struct dmabounce_device_info *device_info = find_dmabounce_dev(dev);
-+ struct safe_buffer *buf = NULL;
-+
-+ if (device_info)
-+ buf = find_safe_buffer(device_info, dma_addr);
-+
-+ if (buf) {
-+ /*
-+ * Both of these checks from original code need to be
-+ * commented out b/c some drivers rely on the following:
-+ *
-+ * 1) Drivers may map a large chunk of memory into DMA space
-+ * but only sync a small portion of it. Good example is
-+ * allocating a large buffer, mapping it, and then
-+ * breaking it up into small descriptors. No point
-+ * in syncing the whole buffer if you only have to
-+ * touch one descriptor.
-+ *
-+ * 2) Buffers that are mapped as DMA_BIDIRECTIONAL are
-+ * usually only synced in one dir at a time.
-+ *
-+ * See drivers/net/eepro100.c for examples of both cases.
-+ *
-+ * -ds
-+ *
-+ * BUG_ON(buf->size != size);
-+ * BUG_ON(buf->direction != dir);
-+ */
-+
-+ dev_dbg(dev,
-+ "%s: unsafe buffer %p (phy=%p) mapped to %p (phy=%p)\n",
-+ __func__, buf->ptr, (void *)virt_to_dma(dev, buf->ptr),
-+ buf->safe, (void *)buf->safe_dma_addr);
-+
-+ DO_STATS(device_info->bounce_count++);
-+
-+ switch (dir) {
-+ case DMA_FROM_DEVICE:
-+ dev_dbg(dev,
-+ "%s: copy back safe %p to unsafe %p size %d\n",
-+ __func__, buf->safe, buf->ptr, size);
-+ memcpy(buf->ptr, buf->safe, size);
-+ break;
-+ case DMA_TO_DEVICE:
-+ dev_dbg(dev,
-+ "%s: copy out unsafe %p to safe %p, size %d\n",
-+ __func__, buf->ptr, buf->safe, size);
-+ memcpy(buf->safe, buf->ptr, size);
-+ break;
-+ case DMA_BIDIRECTIONAL:
-+ BUG(); /* is this allowed? what does it mean? */
-+ default:
-+ BUG();
-+ }
-+ consistent_sync(buf->safe, size, dir);
-+ } else {
-+ consistent_sync(dma_to_virt(dev, dma_addr), size, dir);
-+ }
-+}
-+
-+/* ************************************************** */
-+
-+/*
-+ * see if a buffer address is in an 'unsafe' range. if it is
-+ * allocate a 'safe' buffer and copy the unsafe buffer into it.
-+ * substitute the safe buffer for the unsafe one.
-+ * (basically move the buffer from an unsafe area to a safe one)
-+ */
-+dma_addr_t
-+dma_map_single(struct device *dev, void *ptr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+ dma_addr_t dma_addr;
-+
-+ dev_dbg(dev, "%s(ptr=%p,size=%d,dir=%x)\n", __func__, ptr, size, dir);
-+
-+ BUG_ON(dir == DMA_NONE);
-+
-+ local_irq_save(flags);
-+
-+ dma_addr = map_single(dev, ptr, size, dir);
-+
-+ local_irq_restore(flags);
-+
-+ return dma_addr;
-+}
-+
-+/*
-+ * see if a mapped address was really a "safe" buffer and if so, copy
-+ * the data from the safe buffer back to the unsafe buffer and free up
-+ * the safe buffer. (basically return things back to the way they
-+ * should be)
-+ */
-+
-+void
-+dma_unmap_single(struct device *dev, dma_addr_t dma_addr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+
-+ dev_dbg(dev, "%s(ptr=%p,size=%d,dir=%x)\n",
-+ __func__, (void *)dma_addr, size, dir);
-+
-+ BUG_ON(dir == DMA_NONE);
-+
-+ local_irq_save(flags);
-+
-+ unmap_single(dev, dma_addr, size, dir);
-+
-+ local_irq_restore(flags);
-+}
-+
-+int
-+dma_map_sg(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+ int i;
-+
-+ dev_dbg(dev, "%s(sg=%p,nents=%d,dir=%x)\n", __func__, sg, nents, dir);
-+
-+ BUG_ON(dir == DMA_NONE);
-+
-+ local_irq_save(flags);
-+
-+ for (i = 0; i < nents; i++, sg++) {
-+ struct page *page = sg->page;
-+ unsigned int offset = sg->offset;
-+ unsigned int length = sg->length;
-+ void *ptr = page_address(page) + offset;
-+
-+ sg->dma_address = map_single(dev, ptr, length, dir);
-+ }
-+
-+ local_irq_restore(flags);
-+
-+ return nents;
-+}
-+
-+void
-+dma_unmap_sg(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+ int i;
-+
-+ dev_dbg(dev, "%s(sg=%p,nents=%d,dir=%x)\n", __func__, sg, nents, dir);
-+
-+ BUG_ON(dir == DMA_NONE);
-+
-+ local_irq_save(flags);
-+
-+ for (i = 0; i < nents; i++, sg++) {
-+ dma_addr_t dma_addr = sg->dma_address;
-+ unsigned int length = sg->length;
-+
-+ unmap_single(dev, dma_addr, length, dir);
-+ }
-+
-+ local_irq_restore(flags);
-+}
-+
-+void
-+dma_sync_single_for_cpu(struct device *dev, dma_addr_t dma_addr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+
-+ dev_dbg(dev, "%s(ptr=%p,size=%d,dir=%x)\n",
-+ __func__, (void *)dma_addr, size, dir);
-+
-+ local_irq_save(flags);
-+
-+ sync_single(dev, dma_addr, size, dir);
-+
-+ local_irq_restore(flags);
-+}
-+
-+void
-+dma_sync_single_for_device(struct device *dev, dma_addr_t dma_addr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+
-+ dev_dbg(dev, "%s(ptr=%p,size=%d,dir=%x)\n",
-+ __func__, (void *)dma_addr, size, dir);
-+
-+ local_irq_save(flags);
-+
-+ sync_single(dev, dma_addr, size, dir);
-+
-+ local_irq_restore(flags);
-+}
-+
-+void
-+dma_sync_sg_for_cpu(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+ int i;
-+
-+ dev_dbg(dev, "%s(sg=%p,nents=%d,dir=%x)\n", __func__, sg, nents, dir);
-+
-+ BUG_ON(dir == DMA_NONE);
-+
-+ local_irq_save(flags);
-+
-+ for (i = 0; i < nents; i++, sg++) {
-+ dma_addr_t dma_addr = sg->dma_address;
-+ unsigned int length = sg->length;
-+
-+ sync_single(dev, dma_addr, length, dir);
-+ }
-+
-+ local_irq_restore(flags);
-+}
-+
-+void
-+dma_sync_sg_for_device(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+ unsigned long flags;
-+ int i;
-+
-+ dev_dbg(dev, "%s(sg=%p,nents=%d,dir=%x)\n", __func__, sg, nents, dir);
-+
-+ BUG_ON(dir == DMA_NONE);
-+
-+ local_irq_save(flags);
-+
-+ for (i = 0; i < nents; i++, sg++) {
-+ dma_addr_t dma_addr = sg->dma_address;
-+ unsigned int length = sg->length;
-+
-+ sync_single(dev, dma_addr, length, dir);
-+ }
-+
-+ local_irq_restore(flags);
-+}
-+
-+int
-+dmabounce_register_dev(struct device *dev, unsigned long small_buffer_size,
-+ unsigned long large_buffer_size)
-+{
-+ struct dmabounce_device_info *device_info;
-+
-+ device_info = kmalloc(sizeof(struct dmabounce_device_info), GFP_ATOMIC);
-+ if (!device_info) {
-+ printk(KERN_ERR
-+ "Could not allocated dmabounce_device_info for %s",
-+ dev->bus_id);
-+ return -ENOMEM;
-+ }
-+
-+ device_info->small_buffer_pool =
-+ dma_pool_create("small_dmabounce_pool",
-+ dev, small_buffer_size, 0 /* byte alignment */ ,
-+ 0 /* no page-crossing issues */ );
-+ if (!device_info->small_buffer_pool) {
-+ printk(KERN_ERR
-+ "dmabounce: could not allocate small DMA pool for %s\n",
-+ dev->bus_id);
-+ kfree(device_info);
-+ return -ENOMEM;
-+ }
-+
-+ if (large_buffer_size) {
-+ device_info->large_buffer_pool =
-+ dma_pool_create("large_dmabounce_pool",
-+ dev,
-+ large_buffer_size, 0 /* byte alignment */ ,
-+ 0 /* no page-crossing issues */ );
-+ if (!device_info->large_buffer_pool) {
-+ printk(KERN_ERR
-+ "dmabounce: could not allocate large DMA pool for %s\n",
-+ dev->bus_id);
-+ dma_pool_destroy(device_info->small_buffer_pool);
-+
-+ return -ENOMEM;
-+ }
-+ }
-+
-+ device_info->dev = dev;
-+ device_info->small_buffer_size = small_buffer_size;
-+ device_info->large_buffer_size = large_buffer_size;
-+ INIT_LIST_HEAD(&device_info->safe_buffers);
-+
-+#ifdef STATS
-+ device_info->sbp_allocs = 0;
-+ device_info->lbp_allocs = 0;
-+ device_info->total_allocs = 0;
-+ device_info->map_op_count = 0;
-+ device_info->bounce_count = 0;
-+#endif
-+
-+ list_add(&device_info->node, &dmabounce_devs);
-+
-+ printk(KERN_INFO "dmabounce: registered device %s on %s bus\n",
-+ dev->bus_id, dev->bus->name);
-+
-+ return 0;
-+}
-+
-+void dmabounce_unregister_dev(struct device *dev)
-+{
-+ struct dmabounce_device_info *device_info = find_dmabounce_dev(dev);
-+
-+ if (!device_info) {
-+ printk(KERN_WARNING
-+ "%s: Never registered with dmabounce but attempting"
-+ "to unregister!\n", dev->bus_id);
-+ return;
-+ }
-+
-+ if (!list_empty(&device_info->safe_buffers)) {
-+ printk(KERN_ERR
-+ "%s: Removing from dmabounce with pending buffers!\n",
-+ dev->bus_id);
-+ BUG();
-+ }
-+
-+ if (device_info->small_buffer_pool)
-+ dma_pool_destroy(device_info->small_buffer_pool);
-+ if (device_info->large_buffer_pool)
-+ dma_pool_destroy(device_info->large_buffer_pool);
-+
-+#ifdef STATS
-+ print_alloc_stats(device_info);
-+ print_map_stats(device_info);
-+#endif
-+
-+ list_del(&device_info->node);
-+
-+ kfree(device_info);
-+
-+ printk(KERN_INFO "dmabounce: device %s on %s bus unregistered\n",
-+ dev->bus_id, dev->bus->name);
-+}
-+
-+EXPORT_SYMBOL(dma_map_single);
-+EXPORT_SYMBOL(dma_unmap_single);
-+EXPORT_SYMBOL(dma_map_sg);
-+EXPORT_SYMBOL(dma_unmap_sg);
-+EXPORT_SYMBOL(dma_sync_single);
-+EXPORT_SYMBOL(dma_sync_sg);
-+EXPORT_SYMBOL(dmabounce_register_dev);
-+EXPORT_SYMBOL(dmabounce_unregister_dev);
-+
-+MODULE_AUTHOR
-+ ("Christopher Hoover <ch@hpl.hp.com>, Deepak Saxena <dsaxena@plexity.net>");
-+MODULE_DESCRIPTION
-+ ("Special dma_{map/unmap/dma_sync}_* routines for systems with limited DMA windows");
-+MODULE_LICENSE("GPL");
-diff -Nur linux-3.4.113.orig/arch/nds32/common/Makefile linux-3.4.113/arch/nds32/common/Makefile
---- linux-3.4.113.orig/arch/nds32/common/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/common/Makefile 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,6 @@
-+#
-+# Makefile for the linux kernel.
-+#
-+
-+obj-y += rtctime.o
-+obj-$(CONFIG_DMABOUNCE) += dmabounce.o
-diff -Nur linux-3.4.113.orig/arch/nds32/common/rtctime.c linux-3.4.113/arch/nds32/common/rtctime.c
---- linux-3.4.113.orig/arch/nds32/common/rtctime.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/common/rtctime.c 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,441 @@
-+/*
-+ * linux/arch/nds32/common/rtctime.c
-+ *
-+ * Copyright (C) 2003 Deep Blue Solutions Ltd.
-+ * Based on sa1100-rtc.c, Nils Faerber, CIH, Nicolas Pitre.
-+ * Based on rtc.c by Paul Gortmaker
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/module.h>
-+#include <linux/kernel.h>
-+#include <linux/time.h>
-+#include <linux/rtc.h>
-+#include <linux/poll.h>
-+#include <linux/proc_fs.h>
-+#include <linux/miscdevice.h>
-+#include <linux/spinlock.h>
-+#include <linux/capability.h>
-+#include <linux/device.h>
-+#include <linux/mutex.h>
-+#include <linux/rtc.h>
-+
-+#include <asm/rtc.h>
-+#include <asm/semaphore.h>
-+
-+static DECLARE_WAIT_QUEUE_HEAD(rtc_wait);
-+static struct fasync_struct *rtc_async_queue;
-+
-+/*
-+ * rtc_lock protects rtc_irq_data
-+ */
-+static DEFINE_SPINLOCK(rtc_lock);
-+static unsigned long rtc_irq_data;
-+
-+/*
-+ * rtc_sem protects rtc_inuse and rtc_ops
-+ */
-+static DEFINE_MUTEX(rtc_mutex);
-+static unsigned long rtc_inuse;
-+static struct rtc_ops *rtc_ops;
-+
-+#define rtc_epoch 1900UL
-+
-+/*
-+ * Calculate the next alarm time given the requested alarm time mask
-+ * and the current time.
-+ */
-+void rtc_next_alarm_time(struct rtc_time *next, struct rtc_time *now,
-+ struct rtc_time *alrm)
-+{
-+ unsigned long next_time;
-+ unsigned long now_time;
-+
-+ next->tm_year = now->tm_year;
-+ next->tm_mon = now->tm_mon;
-+ next->tm_mday = now->tm_mday;
-+ next->tm_hour = alrm->tm_hour;
-+ next->tm_min = alrm->tm_min;
-+ next->tm_sec = alrm->tm_sec;
-+
-+ rtc_tm_to_time(now, &now_time);
-+ rtc_tm_to_time(next, &next_time);
-+
-+ if (next_time < now_time) {
-+ /* Advance one day */
-+ next_time += 60 * 60 * 24;
-+ rtc_time_to_tm(next_time, next);
-+ }
-+}
-+
-+static inline int rtc_arm_read_time(struct rtc_ops *ops, struct rtc_time *tm)
-+{
-+ memset(tm, 0, sizeof(struct rtc_time));
-+ return ops->read_time(tm);
-+}
-+
-+static inline int rtc_arm_set_time(struct rtc_ops *ops, struct rtc_time *tm)
-+{
-+ int ret;
-+
-+ ret = rtc_valid_tm(tm);
-+ if (ret == 0)
-+ ret = ops->set_time(tm);
-+
-+ return ret;
-+}
-+
-+static inline int rtc_arm_read_alarm(struct rtc_ops *ops,
-+ struct rtc_wkalrm *alrm)
-+{
-+ int ret = -EINVAL;
-+ if (ops->read_alarm) {
-+ memset(alrm, 0, sizeof(struct rtc_wkalrm));
-+ ret = ops->read_alarm(alrm);
-+ }
-+ return ret;
-+}
-+
-+static inline int rtc_arm_set_alarm(struct rtc_ops *ops,
-+ struct rtc_wkalrm *alrm)
-+{
-+ int ret = -EINVAL;
-+ if (ops->set_alarm)
-+ ret = ops->set_alarm(alrm);
-+ return ret;
-+}
-+
-+void rtc_update(unsigned long num, unsigned long events)
-+{
-+ spin_lock(&rtc_lock);
-+ rtc_irq_data = (rtc_irq_data + (num << 8)) | events;
-+ spin_unlock(&rtc_lock);
-+
-+ wake_up_interruptible(&rtc_wait);
-+ kill_fasync(&rtc_async_queue, SIGIO, POLL_IN);
-+}
-+
-+EXPORT_SYMBOL(rtc_update);
-+
-+static ssize_t
-+rtc_read(struct file *file, char __user * buf, size_t count, loff_t * ppos)
-+{
-+ DECLARE_WAITQUEUE(wait, current);
-+ unsigned long data;
-+ ssize_t ret;
-+
-+ if (count < sizeof(unsigned long))
-+ return -EINVAL;
-+
-+ add_wait_queue(&rtc_wait, &wait);
-+ do {
-+ __set_current_state(TASK_INTERRUPTIBLE);
-+
-+ spin_lock_irq(&rtc_lock);
-+ data = rtc_irq_data;
-+ rtc_irq_data = 0;
-+ spin_unlock_irq(&rtc_lock);
-+
-+ if (data != 0) {
-+ ret = 0;
-+ break;
-+ }
-+ if (file->f_flags & O_NONBLOCK) {
-+ ret = -EAGAIN;
-+ break;
-+ }
-+ if (signal_pending(current)) {
-+ ret = -ERESTARTSYS;
-+ break;
-+ }
-+ schedule();
-+ } while (1);
-+ set_current_state(TASK_RUNNING);
-+ remove_wait_queue(&rtc_wait, &wait);
-+
-+ if (ret == 0) {
-+ ret = put_user(data, (unsigned long __user *)buf);
-+ if (ret == 0)
-+ ret = sizeof(unsigned long);
-+ }
-+ return ret;
-+}
-+
-+static unsigned int rtc_poll(struct file *file, poll_table * wait)
-+{
-+ unsigned long data;
-+
-+ poll_wait(file, &rtc_wait, wait);
-+
-+ spin_lock_irq(&rtc_lock);
-+ data = rtc_irq_data;
-+ spin_unlock_irq(&rtc_lock);
-+
-+ return data != 0 ? POLLIN | POLLRDNORM : 0;
-+}
-+
-+static int rtc_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
-+ unsigned long arg)
-+{
-+ struct rtc_ops *ops = file->private_data;
-+ struct rtc_time tm;
-+ struct rtc_wkalrm alrm;
-+ void __user *uarg = (void __user *)arg;
-+ int ret = -EINVAL;
-+
-+ switch (cmd) {
-+ case RTC_ALM_READ:
-+ ret = rtc_arm_read_alarm(ops, &alrm);
-+ if (ret)
-+ break;
-+ ret = copy_to_user(uarg, &alrm.time, sizeof(tm));
-+ if (ret)
-+ ret = -EFAULT;
-+ break;
-+
-+ case RTC_ALM_SET:
-+ ret = copy_from_user(&alrm.time, uarg, sizeof(tm));
-+ if (ret) {
-+ ret = -EFAULT;
-+ break;
-+ }
-+ alrm.enabled = 0;
-+ alrm.pending = 0;
-+ alrm.time.tm_mday = -1;
-+ alrm.time.tm_mon = -1;
-+ alrm.time.tm_year = -1;
-+ alrm.time.tm_wday = -1;
-+ alrm.time.tm_yday = -1;
-+ alrm.time.tm_isdst = -1;
-+ ret = rtc_arm_set_alarm(ops, &alrm);
-+ break;
-+
-+ case RTC_RD_TIME:
-+ ret = rtc_arm_read_time(ops, &tm);
-+ if (ret)
-+ break;
-+ ret = copy_to_user(uarg, &tm, sizeof(tm));
-+ if (ret)
-+ ret = -EFAULT;
-+ break;
-+
-+ case RTC_SET_TIME:
-+ if (!capable(CAP_SYS_TIME)) {
-+ ret = -EACCES;
-+ break;
-+ }
-+ ret = copy_from_user(&tm, uarg, sizeof(tm));
-+ if (ret) {
-+ ret = -EFAULT;
-+ break;
-+ }
-+ ret = rtc_arm_set_time(ops, &tm);
-+ break;
-+
-+ case RTC_EPOCH_SET:
-+#ifndef rtc_epoch
-+ /*
-+ * There were no RTC clocks before 1900.
-+ */
-+ if (arg < 1900) {
-+ ret = -EINVAL;
-+ break;
-+ }
-+ if (!capable(CAP_SYS_TIME)) {
-+ ret = -EACCES;
-+ break;
-+ }
-+ rtc_epoch = arg;
-+ ret = 0;
-+#endif
-+ break;
-+
-+ case RTC_EPOCH_READ:
-+ ret = put_user(rtc_epoch, (unsigned long __user *)uarg);
-+ break;
-+
-+ case RTC_WKALM_SET:
-+ ret = copy_from_user(&alrm, uarg, sizeof(alrm));
-+ if (ret) {
-+ ret = -EFAULT;
-+ break;
-+ }
-+ ret = rtc_arm_set_alarm(ops, &alrm);
-+ break;
-+
-+ case RTC_WKALM_RD:
-+ ret = rtc_arm_read_alarm(ops, &alrm);
-+ if (ret)
-+ break;
-+ ret = copy_to_user(uarg, &alrm, sizeof(alrm));
-+ if (ret)
-+ ret = -EFAULT;
-+ break;
-+
-+ default:
-+ if (ops->ioctl)
-+ ret = ops->ioctl(cmd, arg);
-+ break;
-+ }
-+ return ret;
-+}
-+
-+static int rtc_open(struct inode *inode, struct file *file)
-+{
-+ int ret;
-+
-+ mutex_lock(&rtc_mutex);
-+
-+ if (rtc_inuse) {
-+ ret = -EBUSY;
-+ } else if (!rtc_ops || !try_module_get(rtc_ops->owner)) {
-+ ret = -ENODEV;
-+ } else {
-+ file->private_data = rtc_ops;
-+
-+ ret = rtc_ops->open ? rtc_ops->open() : 0;
-+ if (ret == 0) {
-+ spin_lock_irq(&rtc_lock);
-+ rtc_irq_data = 0;
-+ spin_unlock_irq(&rtc_lock);
-+
-+ rtc_inuse = 1;
-+ }
-+ }
-+ mutex_unlock(&rtc_mutex);
-+
-+ return ret;
-+}
-+
-+static int rtc_release(struct inode *inode, struct file *file)
-+{
-+ struct rtc_ops *ops = file->private_data;
-+
-+ if (ops->release)
-+ ops->release();
-+
-+ spin_lock_irq(&rtc_lock);
-+ rtc_irq_data = 0;
-+ spin_unlock_irq(&rtc_lock);
-+
-+ module_put(rtc_ops->owner);
-+ rtc_inuse = 0;
-+
-+ return 0;
-+}
-+
-+static int rtc_fasync(int fd, struct file *file, int on)
-+{
-+ return fasync_helper(fd, file, on, &rtc_async_queue);
-+}
-+
-+static struct file_operations rtc_fops = {
-+ .owner = THIS_MODULE,
-+ .llseek = no_llseek,
-+ .read = rtc_read,
-+ .poll = rtc_poll,
-+ .ioctl = rtc_ioctl,
-+ .open = rtc_open,
-+ .release = rtc_release,
-+ .fasync = rtc_fasync,
-+};
-+
-+static struct miscdevice rtc_miscdev = {
-+ .minor = RTC_MINOR,
-+ .name = "rtc",
-+ .fops = &rtc_fops,
-+};
-+
-+static int rtc_read_proc(char *page, char **start, off_t off, int count,
-+ int *eof, void *data)
-+{
-+ struct rtc_ops *ops = data;
-+ struct rtc_wkalrm alrm;
-+ struct rtc_time tm;
-+ char *p = page;
-+
-+ if (rtc_arm_read_time(ops, &tm) == 0) {
-+ p += sprintf(p,
-+ "rtc_time\t: %02d:%02d:%02d\n"
-+ "rtc_date\t: %04d-%02d-%02d\n"
-+ "rtc_epoch\t: %04lu\n",
-+ tm.tm_hour, tm.tm_min, tm.tm_sec,
-+ tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday,
-+ rtc_epoch);
-+ }
-+
-+ if (rtc_arm_read_alarm(ops, &alrm) == 0) {
-+ p += sprintf(p, "alrm_time\t: ");
-+ if ((unsigned int)alrm.time.tm_hour <= 24)
-+ p += sprintf(p, "%02d:", alrm.time.tm_hour);
-+ else
-+ p += sprintf(p, "**:");
-+ if ((unsigned int)alrm.time.tm_min <= 59)
-+ p += sprintf(p, "%02d:", alrm.time.tm_min);
-+ else
-+ p += sprintf(p, "**:");
-+ if ((unsigned int)alrm.time.tm_sec <= 59)
-+ p += sprintf(p, "%02d\n", alrm.time.tm_sec);
-+ else
-+ p += sprintf(p, "**\n");
-+
-+ p += sprintf(p, "alrm_date\t: ");
-+ if ((unsigned int)alrm.time.tm_year <= 200)
-+ p += sprintf(p, "%04d-", alrm.time.tm_year + 1900);
-+ else
-+ p += sprintf(p, "****-");
-+ if ((unsigned int)alrm.time.tm_mon <= 11)
-+ p += sprintf(p, "%02d-", alrm.time.tm_mon + 1);
-+ else
-+ p += sprintf(p, "**-");
-+ if ((unsigned int)alrm.time.tm_mday <= 31)
-+ p += sprintf(p, "%02d\n", alrm.time.tm_mday);
-+ else
-+ p += sprintf(p, "**\n");
-+ p += sprintf(p, "alrm_wakeup\t: %s\n",
-+ alrm.enabled ? "yes" : "no");
-+ p += sprintf(p, "alrm_pending\t: %s\n",
-+ alrm.pending ? "yes" : "no");
-+ }
-+
-+ if (ops->proc)
-+ p += ops->proc(p);
-+
-+ return p - page;
-+}
-+
-+int register_rtc(struct rtc_ops *ops)
-+{
-+ int ret = -EBUSY;
-+
-+ mutex_lock(&rtc_mutex);
-+ if (rtc_ops == NULL) {
-+ rtc_ops = ops;
-+
-+ ret = misc_register(&rtc_miscdev);
-+ if (ret == 0)
-+ create_proc_read_entry("driver/rtc", 0, NULL,
-+ rtc_read_proc, ops);
-+ }
-+ mutex_unlock(&rtc_mutex);
-+
-+ return ret;
-+}
-+
-+EXPORT_SYMBOL(register_rtc);
-+
-+void unregister_rtc(struct rtc_ops *rtc)
-+{
-+ mutex_lock(&rtc_mutex);
-+ if (rtc == rtc_ops) {
-+ remove_proc_entry("driver/rtc", NULL);
-+ misc_deregister(&rtc_miscdev);
-+ rtc_ops = NULL;
-+ }
-+ mutex_unlock(&rtc_mutex);
-+}
-+
-+EXPORT_SYMBOL(unregister_rtc);
-diff -Nur linux-3.4.113.orig/arch/nds32/configs/orca_8k_defconfig linux-3.4.113/arch/nds32/configs/orca_8k_defconfig
---- linux-3.4.113.orig/arch/nds32/configs/orca_8k_defconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/configs/orca_8k_defconfig 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,132 @@
-+CONFIG_EXPERIMENTAL=y
-+CONFIG_CROSS_COMPILE="nds32le-linux-"
-+# CONFIG_LOCALVERSION_AUTO is not set
-+CONFIG_SYSVIPC=y
-+CONFIG_POSIX_MQUEUE=y
-+CONFIG_BSD_PROCESS_ACCT=y
-+CONFIG_BSD_PROCESS_ACCT_V3=y
-+CONFIG_IKCONFIG=y
-+CONFIG_IKCONFIG_PROC=y
-+CONFIG_LOG_BUF_SHIFT=14
-+CONFIG_BLK_DEV_INITRD=y
-+CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-+CONFIG_SYSCTL_SYSCALL=y
-+# CONFIG_HOTPLUG is not set
-+# CONFIG_SIGNALFD is not set
-+CONFIG_EMBEDDED=y
-+# CONFIG_VM_EVENT_COUNTERS is not set
-+CONFIG_PROFILING=y
-+CONFIG_OPROFILE=y
-+CONFIG_MODULES=y
-+CONFIG_MODULE_UNLOAD=y
-+# CONFIG_BLK_DEV_BSG is not set
-+CONFIG_PLATFORM_AHBDMA=y
-+CONFIG_PLATFORM_APBDMA=y
-+CONFIG_SYS_CLK=30000000
-+CONFIG_UART_CLK=14745600
-+CONFIG_SDRAM_SIZE=0x40000000
-+CONFIG_CPU_CACHE_NONALIASING=y
-+CONFIG_ANDES_PAGE_SIZE_8KB=y
-+CONFIG_HIGHMEM=y
-+CONFIG_HZ_100=y
-+CONFIG_CMDLINE="root=/dev/ram0 rw mem=1024M@0x0 initrd=0x1000000,8M earlyprintk=uart8250-32bit,0x99600000 console=ttyS0,38400n8 loglevel=7 rootfstype=ext2 init=/bin/busybox init -s user_debug=-1"
-+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set
-+CONFIG_NET=y
-+CONFIG_PACKET=y
-+CONFIG_UNIX=y
-+CONFIG_NET_KEY=y
-+CONFIG_INET=y
-+CONFIG_IP_MULTICAST=y
-+# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-+# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_BEET is not set
-+# CONFIG_INET_LRO is not set
-+# CONFIG_INET_DIAG is not set
-+# CONFIG_IPV6 is not set
-+CONFIG_BRIDGE=y
-+CONFIG_MTD=y
-+CONFIG_MTD_CMDLINE_PARTS=y
-+CONFIG_MTD_CHAR=y
-+CONFIG_MTD_BLOCK=y
-+CONFIG_MTD_CFI=y
-+CONFIG_MTD_CFI_INTELEXT=y
-+CONFIG_MTD_PHYSMAP=y
-+CONFIG_MTD_PHYSMAP_COMPAT=y
-+CONFIG_MTD_PHYSMAP_START=0x80400000
-+CONFIG_MTD_PHYSMAP_LEN=0x2000000
-+CONFIG_MTD_PHYSMAP_BANKWIDTH=4
-+CONFIG_BLK_DEV_LOOP=y
-+CONFIG_BLK_DEV_RAM=y
-+CONFIG_BLK_DEV_RAM_SIZE=8192
-+CONFIG_NETDEVICES=y
-+CONFIG_TUN=y
-+CONFIG_FTMAC100=y
-+# CONFIG_INPUT_MOUSEDEV is not set
-+CONFIG_INPUT_EVDEV=y
-+# CONFIG_INPUT_KEYBOARD is not set
-+# CONFIG_INPUT_MOUSE is not set
-+CONFIG_INPUT_TOUCHSCREEN=y
-+CONFIG_TOUCHSCREEN_CPE_TS=y
-+# CONFIG_SERIO is not set
-+CONFIG_SERIAL_8250=y
-+CONFIG_SERIAL_8250_CONSOLE=y
-+CONFIG_SERIAL_8250_NR_UARTS=3
-+CONFIG_SERIAL_8250_RUNTIME_UARTS=3
-+# CONFIG_HW_RANDOM is not set
-+CONFIG_GPIOLIB=y
-+CONFIG_GPIO_SYSFS=y
-+CONFIG_GPIO_FTGPIO010=y
-+# CONFIG_HWMON is not set
-+CONFIG_WATCHDOG=y
-+CONFIG_FTWDT010_WATCHDOG=y
-+CONFIG_FB=y
-+CONFIG_FB_FTLCDC100=y
-+# CONFIG_VGA_CONSOLE is not set
-+CONFIG_FRAMEBUFFER_CONSOLE=y
-+CONFIG_LOGO=y
-+CONFIG_SOUND=y
-+CONFIG_SND=y
-+CONFIG_SND_PCM_OSS=y
-+# CONFIG_SND_SUPPORT_OLD_API is not set
-+# CONFIG_SND_VERBOSE_PROCFS is not set
-+CONFIG_SND_FTSSP010=y
-+# CONFIG_HID_SUPPORT is not set
-+# CONFIG_USB_SUPPORT is not set
-+CONFIG_MMC=y
-+CONFIG_MMC_FTSDC010=y
-+CONFIG_RTC_CLASS=y
-+# CONFIG_RTC_HCTOSYS is not set
-+CONFIG_RTC_DRV_FTRTC010=y
-+CONFIG_EXT2_FS=y
-+CONFIG_FUSE_FS=y
-+CONFIG_MSDOS_FS=y
-+CONFIG_VFAT_FS=y
-+# CONFIG_PROC_PAGE_MONITOR is not set
-+CONFIG_TMPFS=y
-+CONFIG_JFFS2_FS=y
-+CONFIG_NFS_FS=y
-+CONFIG_NFS_V3=y
-+CONFIG_NFS_V3_ACL=y
-+CONFIG_NFS_V4=y
-+CONFIG_NFS_V4_1=y
-+CONFIG_NFS_USE_LEGACY_DNS=y
-+CONFIG_NLS_CODEPAGE_437=y
-+CONFIG_NLS_ISO8859_1=y
-+CONFIG_MAGIC_SYSRQ=y
-+CONFIG_DEBUG_FS=y
-+CONFIG_DEBUG_SHIRQ=y
-+CONFIG_SCHEDSTATS=y
-+CONFIG_TIMER_STATS=y
-+CONFIG_SLUB_DEBUG_ON=y
-+CONFIG_DEBUG_RT_MUTEXES=y
-+CONFIG_DEBUG_SPINLOCK=y
-+CONFIG_DEBUG_MUTEXES=y
-+CONFIG_DEBUG_INFO=y
-+CONFIG_DEBUG_MEMORY_INIT=y
-+CONFIG_DEBUG_LIST=y
-+CONFIG_DEBUG_SG=y
-+# CONFIG_FTRACE is not set
-+CONFIG_DEBUG_USER=y
-+CONFIG_DEBUG_ERRORS=y
-+# CONFIG_CRYPTO_ANSI_CPRNG is not set
-+# CONFIG_CRYPTO_HW is not set
-diff -Nur linux-3.4.113.orig/arch/nds32/configs/orca_defconfig linux-3.4.113/arch/nds32/configs/orca_defconfig
---- linux-3.4.113.orig/arch/nds32/configs/orca_defconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/configs/orca_defconfig 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,125 @@
-+CONFIG_EXPERIMENTAL=y
-+CONFIG_CROSS_COMPILE="nds32le-linux-"
-+CONFIG_SYSVIPC=y
-+CONFIG_POSIX_MQUEUE=y
-+CONFIG_BSD_PROCESS_ACCT=y
-+CONFIG_BSD_PROCESS_ACCT_V3=y
-+CONFIG_IKCONFIG=y
-+CONFIG_IKCONFIG_PROC=y
-+CONFIG_LOG_BUF_SHIFT=14
-+CONFIG_NAMESPACES=y
-+CONFIG_SYSCTL_SYSCALL=y
-+CONFIG_KALLSYMS_ALL=y
-+# CONFIG_HOTPLUG is not set
-+CONFIG_EMBEDDED=y
-+# CONFIG_VM_EVENT_COUNTERS is not set
-+CONFIG_PROFILING=y
-+CONFIG_OPROFILE=y
-+CONFIG_MODULES=y
-+CONFIG_MODULE_UNLOAD=y
-+# CONFIG_BLK_DEV_BSG is not set
-+CONFIG_MEASURE_INTERRUPT_LATENCY=y
-+CONFIG_PLATFORM_AHBDMA=y
-+CONFIG_PLATFORM_APBDMA=y
-+CONFIG_SYS_CLK=30000000
-+CONFIG_UART_CLK=14745600
-+CONFIG_SDRAM_SIZE=0x40000000
-+CONFIG_MEMORY_START=0x0
-+# CONFIG_HWZOL is not set
-+CONFIG_IVIC=y
-+CONFIG_HIGH_RES_TIMERS=y
-+CONFIG_PREEMPT=y
-+CONFIG_HZ_100=y
-+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set
-+CONFIG_NET=y
-+CONFIG_PACKET=y
-+CONFIG_UNIX=y
-+CONFIG_NET_KEY=y
-+CONFIG_INET=y
-+CONFIG_IP_MULTICAST=y
-+# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-+# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_BEET is not set
-+# CONFIG_INET_LRO is not set
-+# CONFIG_INET_DIAG is not set
-+# CONFIG_IPV6 is not set
-+CONFIG_BRIDGE=y
-+CONFIG_MTD=y
-+CONFIG_MTD_CMDLINE_PARTS=y
-+CONFIG_MTD_CHAR=y
-+CONFIG_MTD_BLOCK=y
-+CONFIG_MTD_CFI=y
-+CONFIG_MTD_CFI_INTELEXT=y
-+CONFIG_MTD_PHYSMAP=y
-+CONFIG_MTD_PHYSMAP_COMPAT=y
-+CONFIG_MTD_PHYSMAP_START=0x80400000
-+CONFIG_MTD_PHYSMAP_LEN=0x2000000
-+CONFIG_MTD_PHYSMAP_BANKWIDTH=4
-+CONFIG_BLK_DEV_LOOP=y
-+CONFIG_BLK_DEV_RAM=y
-+CONFIG_BLK_DEV_RAM_SIZE=8192
-+CONFIG_NETDEVICES=y
-+CONFIG_TUN=y
-+CONFIG_FTMAC100=y
-+# CONFIG_INPUT_MOUSEDEV is not set
-+CONFIG_INPUT_EVDEV=y
-+# CONFIG_INPUT_KEYBOARD is not set
-+# CONFIG_INPUT_MOUSE is not set
-+CONFIG_INPUT_TOUCHSCREEN=y
-+CONFIG_TOUCHSCREEN_CPE_TS=m
-+# CONFIG_SERIO is not set
-+CONFIG_SERIAL_8250=y
-+CONFIG_SERIAL_8250_CONSOLE=y
-+CONFIG_SERIAL_8250_NR_UARTS=3
-+CONFIG_SERIAL_8250_RUNTIME_UARTS=3
-+# CONFIG_HW_RANDOM is not set
-+CONFIG_GPIOLIB=y
-+CONFIG_GPIO_SYSFS=y
-+CONFIG_GPIO_FTGPIO010=m
-+# CONFIG_HWMON is not set
-+CONFIG_WATCHDOG=y
-+CONFIG_FTWDT010_WATCHDOG=m
-+CONFIG_FB=y
-+CONFIG_FB_FTLCDC100=y
-+# CONFIG_VGA_CONSOLE is not set
-+CONFIG_FRAMEBUFFER_CONSOLE=y
-+CONFIG_LOGO=y
-+CONFIG_SOUND=y
-+CONFIG_SND=y
-+CONFIG_SND_PCM_OSS=y
-+# CONFIG_SND_SUPPORT_OLD_API is not set
-+# CONFIG_SND_VERBOSE_PROCFS is not set
-+CONFIG_SND_FTSSP010=m
-+# CONFIG_HID_SUPPORT is not set
-+# CONFIG_USB_SUPPORT is not set
-+CONFIG_MMC=y
-+CONFIG_MMC_FTSDC010=y
-+CONFIG_RTC_CLASS=y
-+# CONFIG_RTC_HCTOSYS is not set
-+CONFIG_RTC_DRV_FTRTC010=y
-+CONFIG_EXT2_FS=y
-+CONFIG_FUSE_FS=y
-+CONFIG_MSDOS_FS=y
-+CONFIG_VFAT_FS=y
-+CONFIG_TMPFS=y
-+CONFIG_TMPFS_POSIX_ACL=y
-+CONFIG_CONFIGFS_FS=y
-+CONFIG_JFFS2_FS=y
-+CONFIG_NFS_FS=y
-+CONFIG_NFS_V3=y
-+CONFIG_NFS_V3_ACL=y
-+CONFIG_NFS_V4=y
-+CONFIG_NFS_V4_1=y
-+CONFIG_NFS_USE_LEGACY_DNS=y
-+CONFIG_NLS_CODEPAGE_437=y
-+CONFIG_NLS_ISO8859_1=y
-+CONFIG_MAGIC_SYSRQ=y
-+CONFIG_HEADERS_CHECK=y
-+CONFIG_DEBUG_SECTION_MISMATCH=y
-+# CONFIG_SCHED_DEBUG is not set
-+CONFIG_DEBUG_INFO=y
-+# CONFIG_FTRACE is not set
-+CONFIG_DEBUG_USER=y
-+CONFIG_DEBUG_ERRORS=y
-+# CONFIG_CRYPTO_ANSI_CPRNG is not set
-+# CONFIG_CRYPTO_HW is not set
-diff -Nur linux-3.4.113.orig/arch/nds32/configs/qemu_defconfig linux-3.4.113/arch/nds32/configs/qemu_defconfig
---- linux-3.4.113.orig/arch/nds32/configs/qemu_defconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/configs/qemu_defconfig 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,98 @@
-+CONFIG_EXPERIMENTAL=y
-+# CONFIG_LOCALVERSION_AUTO is not set
-+CONFIG_SYSVIPC=y
-+CONFIG_BSD_PROCESS_ACCT=y
-+CONFIG_BSD_PROCESS_ACCT_V3=y
-+CONFIG_LOG_BUF_SHIFT=14
-+CONFIG_BLK_DEV_INITRD=y
-+CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-+CONFIG_SYSCTL_SYSCALL=y
-+# CONFIG_HOTPLUG is not set
-+# CONFIG_SIGNALFD is not set
-+CONFIG_EMBEDDED=y
-+# CONFIG_VM_EVENT_COUNTERS is not set
-+CONFIG_PROFILING=y
-+CONFIG_OPROFILE=y
-+CONFIG_MODULES=y
-+CONFIG_MODULE_UNLOAD=y
-+# CONFIG_BLK_DEV_BSG is not set
-+CONFIG_PLAT_QEMU=y
-+CONFIG_SYS_CLK=40000000
-+CONFIG_UART_CLK=14745600
-+CONFIG_SDRAM_SIZE=0x10000000
-+CONFIG_HZ_100=y
-+CONFIG_CMDLINE="root=/dev/ram0 rw mem=1024M@0x0 initrd=0x1000000,8M earlyprintk=uart8250-32bit,0x99600000 console=ttyS0,38400n8 loglevel=7 rootfstype=ext2 init=/bin/busybox init -s user_debug=-1"
-+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set
-+CONFIG_NET=y
-+CONFIG_PACKET=y
-+CONFIG_UNIX=y
-+CONFIG_NET_KEY=y
-+CONFIG_INET=y
-+CONFIG_IP_MULTICAST=y
-+# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-+# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_BEET is not set
-+# CONFIG_INET_LRO is not set
-+# CONFIG_INET_DIAG is not set
-+# CONFIG_IPV6 is not set
-+CONFIG_BLK_DEV_LOOP=y
-+CONFIG_BLK_DEV_RAM=y
-+CONFIG_BLK_DEV_RAM_SIZE=8192
-+CONFIG_FTSDC010=y
-+CONFIG_NETDEVICES=y
-+CONFIG_FTMAC100=y
-+# CONFIG_INPUT_MOUSEDEV is not set
-+CONFIG_INPUT_EVDEV=y
-+# CONFIG_INPUT_KEYBOARD is not set
-+# CONFIG_INPUT_MOUSE is not set
-+CONFIG_INPUT_TOUCHSCREEN=y
-+# CONFIG_SERIO is not set
-+CONFIG_SERIAL_8250=y
-+CONFIG_SERIAL_8250_CONSOLE=y
-+CONFIG_SERIAL_8250_NR_UARTS=3
-+CONFIG_SERIAL_8250_RUNTIME_UARTS=3
-+# CONFIG_HW_RANDOM is not set
-+# CONFIG_HWMON is not set
-+CONFIG_FB=y
-+# CONFIG_VGA_CONSOLE is not set
-+CONFIG_FRAMEBUFFER_CONSOLE=y
-+CONFIG_LOGO=y
-+# CONFIG_HID_SUPPORT is not set
-+# CONFIG_USB_SUPPORT is not set
-+CONFIG_EXT2_FS=y
-+CONFIG_EXT2_FS_XATTR=y
-+CONFIG_EXT2_FS_POSIX_ACL=y
-+CONFIG_EXT2_FS_SECURITY=y
-+CONFIG_EXT2_FS_XIP=y
-+CONFIG_EXT3_FS=y
-+CONFIG_EXT3_FS_POSIX_ACL=y
-+CONFIG_EXT3_FS_SECURITY=y
-+CONFIG_EXT4_FS=y
-+CONFIG_EXT4_FS_POSIX_ACL=y
-+CONFIG_EXT4_FS_SECURITY=y
-+CONFIG_EXT4_DEBUG=y
-+CONFIG_FUSE_FS=y
-+CONFIG_MSDOS_FS=y
-+CONFIG_VFAT_FS=y
-+# CONFIG_PROC_PAGE_MONITOR is not set
-+CONFIG_TMPFS=y
-+CONFIG_NFS_FS=y
-+CONFIG_NFS_V3=y
-+CONFIG_NLS_CODEPAGE_437=y
-+CONFIG_NLS_ISO8859_1=y
-+CONFIG_MAGIC_SYSRQ=y
-+CONFIG_DEBUG_FS=y
-+CONFIG_DEBUG_SHIRQ=y
-+CONFIG_DETECT_HUNG_TASK=y
-+CONFIG_SCHEDSTATS=y
-+CONFIG_TIMER_STATS=y
-+CONFIG_SLUB_DEBUG_ON=y
-+CONFIG_DEBUG_RT_MUTEXES=y
-+CONFIG_DEBUG_MUTEXES=y
-+CONFIG_DEBUG_INFO=y
-+CONFIG_DEBUG_LIST=y
-+CONFIG_DEBUG_SG=y
-+CONFIG_DEBUG_USER=y
-+CONFIG_DEBUG_ERRORS=y
-+# CONFIG_CRYPTO_ANSI_CPRNG is not set
-+# CONFIG_CRYPTO_HW is not set
-diff -Nur linux-3.4.113.orig/arch/nds32/configs/vep-be_defconfig linux-3.4.113/arch/nds32/configs/vep-be_defconfig
---- linux-3.4.113.orig/arch/nds32/configs/vep-be_defconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/configs/vep-be_defconfig 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,777 @@
-+#
-+# Automatically generated make config: don't edit
-+# Linux kernel version: 2.6.29
-+# Mon Jul 13 11:42:57 2009
-+#
-+CONFIG_NDS32=y
-+CONFIG_NO_IOPORT=y
-+CONFIG_GENERIC_IOMAP=y
-+CONFIG_RWSEM_GENERIC_SPINLOCK=y
-+CONFIG_GENERIC_HWEIGHT=y
-+CONFIG_GENERIC_FIND_NEXT_BIT=y
-+CONFIG_GENERIC_CALIBRATE_DELAY=y
-+CONFIG_GENERIC_HARDIRQS=y
-+CONFIG_LOCKDEP_SUPPORT=y
-+CONFIG_STACKTRACE_SUPPORT=y
-+CONFIG_HAVE_LATENCYTOP_SUPPORT=y
-+CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config"
-+
-+#
-+# General setup
-+#
-+CONFIG_EXPERIMENTAL=y
-+CONFIG_BROKEN_ON_SMP=y
-+CONFIG_INIT_ENV_ARG_LIMIT=32
-+CONFIG_LOCALVERSION=""
-+# CONFIG_LOCALVERSION_AUTO is not set
-+CONFIG_SWAP=y
-+CONFIG_SYSVIPC=y
-+CONFIG_SYSVIPC_SYSCTL=y
-+# CONFIG_POSIX_MQUEUE is not set
-+CONFIG_BSD_PROCESS_ACCT=y
-+CONFIG_BSD_PROCESS_ACCT_V3=y
-+# CONFIG_TASKSTATS is not set
-+# CONFIG_AUDIT is not set
-+
-+#
-+# RCU Subsystem
-+#
-+CONFIG_CLASSIC_RCU=y
-+# CONFIG_TREE_RCU is not set
-+# CONFIG_PREEMPT_RCU is not set
-+# CONFIG_TREE_RCU_TRACE is not set
-+# CONFIG_PREEMPT_RCU_TRACE is not set
-+# CONFIG_IKCONFIG is not set
-+CONFIG_LOG_BUF_SHIFT=14
-+# CONFIG_GROUP_SCHED is not set
-+# CONFIG_CGROUPS is not set
-+# CONFIG_SYSFS_DEPRECATED_V2 is not set
-+# CONFIG_RELAY is not set
-+# CONFIG_NAMESPACES is not set
-+CONFIG_BLK_DEV_INITRD=y
-+CONFIG_INITRAMFS_SOURCE=""
-+CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-+CONFIG_SYSCTL=y
-+CONFIG_ANON_INODES=y
-+CONFIG_EMBEDDED=y
-+CONFIG_UID16=y
-+CONFIG_SYSCTL_SYSCALL=y
-+# CONFIG_KALLSYMS is not set
-+# CONFIG_HOTPLUG is not set
-+CONFIG_PRINTK=y
-+CONFIG_BUG=y
-+# CONFIG_ELF_CORE is not set
-+CONFIG_BASE_FULL=y
-+CONFIG_FUTEX=y
-+CONFIG_EPOLL=y
-+# CONFIG_SIGNALFD is not set
-+CONFIG_TIMERFD=y
-+CONFIG_EVENTFD=y
-+CONFIG_SHMEM=y
-+CONFIG_AIO=y
-+# CONFIG_VM_EVENT_COUNTERS is not set
-+CONFIG_SLUB_DEBUG=y
-+CONFIG_COMPAT_BRK=y
-+# CONFIG_SLAB is not set
-+CONFIG_SLUB=y
-+# CONFIG_SLOB is not set
-+CONFIG_PROFILING=y
-+CONFIG_TRACEPOINTS=y
-+# CONFIG_MARKERS is not set
-+CONFIG_OPROFILE=y
-+CONFIG_HAVE_OPROFILE=y
-+CONFIG_HAVE_KPROBES=y
-+CONFIG_HAVE_KRETPROBES=y
-+# CONFIG_HAVE_GENERIC_DMA_COHERENT is not set
-+CONFIG_SLABINFO=y
-+CONFIG_RT_MUTEXES=y
-+CONFIG_BASE_SMALL=0
-+CONFIG_MODULES=y
-+# CONFIG_MODULE_FORCE_LOAD is not set
-+CONFIG_MODULE_UNLOAD=y
-+# CONFIG_MODULE_FORCE_UNLOAD is not set
-+# CONFIG_MODVERSIONS is not set
-+# CONFIG_MODULE_SRCVERSION_ALL is not set
-+CONFIG_BLOCK=y
-+# CONFIG_LBD is not set
-+# CONFIG_BLK_DEV_IO_TRACE is not set
-+# CONFIG_BLK_DEV_BSG is not set
-+# CONFIG_BLK_DEV_INTEGRITY is not set
-+
-+#
-+# IO Schedulers
-+#
-+CONFIG_IOSCHED_NOOP=y
-+# CONFIG_IOSCHED_AS is not set
-+# CONFIG_IOSCHED_DEADLINE is not set
-+# CONFIG_IOSCHED_CFQ is not set
-+# CONFIG_DEFAULT_AS is not set
-+# CONFIG_DEFAULT_DEADLINE is not set
-+# CONFIG_DEFAULT_CFQ is not set
-+CONFIG_DEFAULT_NOOP=y
-+CONFIG_DEFAULT_IOSCHED="noop"
-+# CONFIG_FREEZER is not set
-+
-+#
-+# System Type
-+#
-+# CONFIG_PLAT_FARADAY is not set
-+CONFIG_PLAT_VEP=y
-+# CONFIG_PLAT_AG101 is not set
-+# CONFIG_PLAT_AG102 is not set
-+# CONFIG_PLAT_AG101P is not set
-+# CONFIG_PLAT_QEMU is not set
-+CONFIG_PLATFORM_INTC=y
-+
-+#
-+# VEP Platform Options
-+#
-+# CONFIG_CACHE_L2 is not set
-+
-+#
-+# Common Platform Options
-+#
-+# CONFIG_PLATFORM_AHBDMA is not set
-+# CONFIG_PLATFORM_APBDMA is not set
-+CONFIG_SYS_CLK=67737600
-+CONFIG_UART_CLK=36864000
-+CONFIG_SDRAM_SIZE=0x10000000
-+
-+#
-+# Processor Features
-+#
-+CONFIG_CPU_CUSTOM=y
-+# CONFIG_FPU is not set
-+# CONFIG_AUDIO is not set
-+# CONFIG_EVIC is not set
-+CONFIG_CPU_CONTEXT_ID=y
-+CONFIG_ANDES_PAGE_SIZE_4KB=y
-+# CONFIG_ANDES_PAGE_SIZE_8KB is not set
-+# CONFIG_KERNEL_SPACE_LARGE_PAGE is not set
-+# CONFIG_CPU_ICACHE_DISABLE is not set
-+# CONFIG_CPU_DCACHE_DISABLE is not set
-+# CONFIG_CPU_DCACHE_WRITETHROUGH is not set
-+# CONFIG_ALIGNMENT_TRAP is not set
-+CONFIG_MMU=y
-+
-+#
-+# Kernel Features
-+#
-+CONFIG_PREEMPT_NONE=y
-+# CONFIG_PREEMPT_VOLUNTARY is not set
-+# CONFIG_PREEMPT is not set
-+CONFIG_SELECT_MEMORY_MODEL=y
-+CONFIG_FLATMEM_MANUAL=y
-+# CONFIG_DISCONTIGMEM_MANUAL is not set
-+# CONFIG_SPARSEMEM_MANUAL is not set
-+CONFIG_FLATMEM=y
-+CONFIG_FLAT_NODE_MEM_MAP=y
-+CONFIG_PAGEFLAGS_EXTENDED=y
-+CONFIG_SPLIT_PTLOCK_CPUS=4
-+# CONFIG_PHYS_ADDR_T_64BIT is not set
-+CONFIG_ZONE_DMA_FLAG=0
-+CONFIG_VIRT_TO_BUS=y
-+CONFIG_UNEVICTABLE_LRU=y
-+CONFIG_FORCE_MAX_ZONEORDER=11
-+CONFIG_HZ_100=y
-+# CONFIG_HZ_250 is not set
-+# CONFIG_HZ_300 is not set
-+# CONFIG_HZ_1000 is not set
-+CONFIG_HZ=100
-+# CONFIG_SCHED_HRTICK is not set
-+CONFIG_CMDLINE="root=/dev/ram0 rw mem=64M@0x0 initrd=0x1000000,8M console=ttyS0,38400n8 rootfstype=ext2 init=/bin/busybox init -s user_debug=-1"
-+
-+#
-+# Power management options
-+#
-+CONFIG_SYS_SUPPORTS_APM_EMULATION=y
-+CONFIG_ARCH_SUSPEND_POSSIBLE=y
-+# CONFIG_PM is not set
-+
-+#
-+# Bus options
-+#
-+# CONFIG_PCI is not set
-+# CONFIG_ARCH_SUPPORTS_MSI is not set
-+
-+#
-+# Executable file formats
-+#
-+CONFIG_BINFMT_ELF=y
-+# CONFIG_HAVE_AOUT is not set
-+# CONFIG_BINFMT_MISC is not set
-+CONFIG_NET=y
-+
-+#
-+# Networking options
-+#
-+CONFIG_COMPAT_NET_DEV_OPS=y
-+CONFIG_PACKET=y
-+# CONFIG_PACKET_MMAP is not set
-+CONFIG_UNIX=y
-+CONFIG_XFRM=y
-+# CONFIG_XFRM_USER is not set
-+# CONFIG_XFRM_SUB_POLICY is not set
-+# CONFIG_XFRM_MIGRATE is not set
-+# CONFIG_XFRM_STATISTICS is not set
-+CONFIG_NET_KEY=y
-+# CONFIG_NET_KEY_MIGRATE is not set
-+CONFIG_INET=y
-+CONFIG_IP_MULTICAST=y
-+# CONFIG_IP_ADVANCED_ROUTER is not set
-+CONFIG_IP_FIB_HASH=y
-+# CONFIG_IP_PNP is not set
-+# CONFIG_NET_IPIP is not set
-+# CONFIG_NET_IPGRE is not set
-+# CONFIG_IP_MROUTE is not set
-+# CONFIG_ARPD is not set
-+# CONFIG_SYN_COOKIES is not set
-+# CONFIG_INET_AH is not set
-+# CONFIG_INET_ESP is not set
-+# CONFIG_INET_IPCOMP is not set
-+# CONFIG_INET_XFRM_TUNNEL is not set
-+# CONFIG_INET_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-+# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_BEET is not set
-+# CONFIG_INET_LRO is not set
-+# CONFIG_INET_DIAG is not set
-+# CONFIG_TCP_CONG_ADVANCED is not set
-+CONFIG_TCP_CONG_CUBIC=y
-+CONFIG_DEFAULT_TCP_CONG="cubic"
-+# CONFIG_TCP_MD5SIG is not set
-+# CONFIG_IPV6 is not set
-+# CONFIG_NETWORK_SECMARK is not set
-+# CONFIG_NETFILTER is not set
-+# CONFIG_IP_DCCP is not set
-+# CONFIG_IP_SCTP is not set
-+# CONFIG_TIPC is not set
-+# CONFIG_ATM is not set
-+# CONFIG_BRIDGE is not set
-+# CONFIG_NET_DSA is not set
-+# CONFIG_VLAN_8021Q is not set
-+# CONFIG_DECNET is not set
-+# CONFIG_LLC2 is not set
-+# CONFIG_IPX is not set
-+# CONFIG_ATALK is not set
-+# CONFIG_X25 is not set
-+# CONFIG_LAPB is not set
-+# CONFIG_ECONET is not set
-+# CONFIG_WAN_ROUTER is not set
-+# CONFIG_NET_SCHED is not set
-+# CONFIG_DCB is not set
-+
-+#
-+# Network testing
-+#
-+# CONFIG_NET_PKTGEN is not set
-+# CONFIG_HAMRADIO is not set
-+# CONFIG_CAN is not set
-+# CONFIG_IRDA is not set
-+# CONFIG_BT is not set
-+# CONFIG_AF_RXRPC is not set
-+# CONFIG_PHONET is not set
-+CONFIG_WIRELESS=y
-+# CONFIG_CFG80211 is not set
-+CONFIG_WIRELESS_OLD_REGULATORY=y
-+# CONFIG_WIRELESS_EXT is not set
-+# CONFIG_LIB80211 is not set
-+# CONFIG_MAC80211 is not set
-+# CONFIG_WIMAX is not set
-+# CONFIG_RFKILL is not set
-+# CONFIG_NET_9P is not set
-+
-+#
-+# Device Drivers
-+#
-+
-+#
-+# Generic Driver Options
-+#
-+CONFIG_STANDALONE=y
-+CONFIG_PREVENT_FIRMWARE_BUILD=y
-+# CONFIG_SYS_HYPERVISOR is not set
-+# CONFIG_CONNECTOR is not set
-+# CONFIG_MTD is not set
-+# CONFIG_PARPORT is not set
-+CONFIG_BLK_DEV=y
-+# CONFIG_BLK_DEV_COW_COMMON is not set
-+CONFIG_BLK_DEV_LOOP=y
-+# CONFIG_BLK_DEV_CRYPTOLOOP is not set
-+# CONFIG_BLK_DEV_NBD is not set
-+CONFIG_BLK_DEV_RAM=y
-+CONFIG_BLK_DEV_RAM_COUNT=16
-+CONFIG_BLK_DEV_RAM_SIZE=8192
-+# CONFIG_BLK_DEV_XIP is not set
-+# CONFIG_CDROM_PKTCDVD is not set
-+# CONFIG_ATA_OVER_ETH is not set
-+# CONFIG_FTSDC010 is not set
-+# CONFIG_FTCFC010 is not set
-+# CONFIG_BLK_DEV_HD is not set
-+# CONFIG_MISC_DEVICES is not set
-+CONFIG_HAVE_IDE=y
-+# CONFIG_IDE is not set
-+
-+#
-+# SCSI device support
-+#
-+# CONFIG_RAID_ATTRS is not set
-+# CONFIG_SCSI is not set
-+# CONFIG_SCSI_DMA is not set
-+# CONFIG_SCSI_NETLINK is not set
-+# CONFIG_ATA is not set
-+# CONFIG_MD is not set
-+CONFIG_NETDEVICES=y
-+# CONFIG_DUMMY is not set
-+# CONFIG_BONDING is not set
-+# CONFIG_MACVLAN is not set
-+# CONFIG_EQUALIZER is not set
-+# CONFIG_TUN is not set
-+# CONFIG_VETH is not set
-+# CONFIG_PHYLIB is not set
-+CONFIG_NET_ETHERNET=y
-+# CONFIG_MII is not set
-+# CONFIG_SMC91X is not set
-+# CONFIG_DNET is not set
-+# CONFIG_IBM_NEW_EMAC_ZMII is not set
-+# CONFIG_IBM_NEW_EMAC_RGMII is not set
-+# CONFIG_IBM_NEW_EMAC_TAH is not set
-+# CONFIG_IBM_NEW_EMAC_EMAC4 is not set
-+# CONFIG_IBM_NEW_EMAC_NO_FLOW_CTRL is not set
-+# CONFIG_IBM_NEW_EMAC_MAL_CLR_ICINTSTAT is not set
-+# CONFIG_IBM_NEW_EMAC_MAL_COMMON_ERR is not set
-+# CONFIG_B44 is not set
-+CONFIG_FTMAC100=y
-+# CONFIG_NETDEV_1000 is not set
-+# CONFIG_NETDEV_10000 is not set
-+
-+#
-+# Wireless LAN
-+#
-+# CONFIG_WLAN_PRE80211 is not set
-+# CONFIG_WLAN_80211 is not set
-+# CONFIG_IWLWIFI_LEDS is not set
-+
-+#
-+# Enable WiMAX (Networking options) to see the WiMAX drivers
-+#
-+# CONFIG_WAN is not set
-+# CONFIG_PPP is not set
-+# CONFIG_SLIP is not set
-+# CONFIG_NETCONSOLE is not set
-+# CONFIG_NETPOLL is not set
-+# CONFIG_NET_POLL_CONTROLLER is not set
-+# CONFIG_ISDN is not set
-+# CONFIG_PHONE is not set
-+
-+#
-+# Input device support
-+#
-+CONFIG_INPUT=y
-+# CONFIG_INPUT_FF_MEMLESS is not set
-+# CONFIG_INPUT_POLLDEV is not set
-+
-+#
-+# Userland interfaces
-+#
-+# CONFIG_INPUT_MOUSEDEV is not set
-+# CONFIG_INPUT_JOYDEV is not set
-+# CONFIG_INPUT_EVDEV is not set
-+# CONFIG_INPUT_EVBUG is not set
-+
-+#
-+# Input Device Drivers
-+#
-+# CONFIG_INPUT_KEYBOARD is not set
-+# CONFIG_INPUT_MOUSE is not set
-+# CONFIG_INPUT_JOYSTICK is not set
-+# CONFIG_INPUT_TABLET is not set
-+# CONFIG_INPUT_TOUCHSCREEN is not set
-+# CONFIG_INPUT_MISC is not set
-+
-+#
-+# Hardware I/O ports
-+#
-+# CONFIG_SERIO is not set
-+# CONFIG_GAMEPORT is not set
-+
-+#
-+# Character devices
-+#
-+CONFIG_VT=y
-+CONFIG_CONSOLE_TRANSLATIONS=y
-+CONFIG_VT_CONSOLE=y
-+CONFIG_HW_CONSOLE=y
-+# CONFIG_VT_HW_CONSOLE_BINDING is not set
-+CONFIG_DEVKMEM=y
-+# CONFIG_SERIAL_NONSTANDARD is not set
-+
-+#
-+# Serial drivers
-+#
-+CONFIG_SERIAL_8250=y
-+CONFIG_SERIAL_8250_CONSOLE=y
-+CONFIG_SERIAL_8250_NR_UARTS=3
-+CONFIG_SERIAL_8250_RUNTIME_UARTS=3
-+# CONFIG_SERIAL_8250_EXTENDED is not set
-+
-+#
-+# Non-8250 serial port support
-+#
-+CONFIG_SERIAL_CORE=y
-+CONFIG_SERIAL_CORE_CONSOLE=y
-+CONFIG_UNIX98_PTYS=y
-+# CONFIG_DEVPTS_MULTIPLE_INSTANCES is not set
-+CONFIG_LEGACY_PTYS=y
-+CONFIG_LEGACY_PTY_COUNT=256
-+# CONFIG_IPMI_HANDLER is not set
-+# CONFIG_HW_RANDOM is not set
-+# CONFIG_R3964 is not set
-+# CONFIG_GPIO_FTGPIO010 is not set
-+# CONFIG_RAW_DRIVER is not set
-+# CONFIG_TCG_TPM is not set
-+# CONFIG_I2C is not set
-+# CONFIG_SPI is not set
-+# CONFIG_W1 is not set
-+# CONFIG_POWER_SUPPLY is not set
-+# CONFIG_HWMON is not set
-+# CONFIG_THERMAL is not set
-+# CONFIG_THERMAL_HWMON is not set
-+# CONFIG_WATCHDOG is not set
-+CONFIG_SSB_POSSIBLE=y
-+
-+#
-+# Sonics Silicon Backplane
-+#
-+# CONFIG_SSB is not set
-+
-+#
-+# Multifunction device drivers
-+#
-+# CONFIG_MFD_CORE is not set
-+# CONFIG_MFD_SM501 is not set
-+# CONFIG_HTC_PASIC3 is not set
-+# CONFIG_MFD_TMIO is not set
-+# CONFIG_REGULATOR is not set
-+
-+#
-+# Multimedia devices
-+#
-+
-+#
-+# Multimedia core support
-+#
-+# CONFIG_VIDEO_DEV is not set
-+# CONFIG_DVB_CORE is not set
-+# CONFIG_VIDEO_MEDIA is not set
-+
-+#
-+# Multimedia drivers
-+#
-+# CONFIG_DAB is not set
-+
-+#
-+# Graphics support
-+#
-+# CONFIG_VGASTATE is not set
-+# CONFIG_VIDEO_OUTPUT_CONTROL is not set
-+# CONFIG_FB is not set
-+# CONFIG_BACKLIGHT_LCD_SUPPORT is not set
-+
-+#
-+# Display device support
-+#
-+# CONFIG_DISPLAY_SUPPORT is not set
-+
-+#
-+# Console display driver support
-+#
-+# CONFIG_VGA_CONSOLE is not set
-+CONFIG_DUMMY_CONSOLE=y
-+# CONFIG_SOUND is not set
-+# CONFIG_HID_SUPPORT is not set
-+# CONFIG_USB_SUPPORT is not set
-+# CONFIG_MMC is not set
-+# CONFIG_MEMSTICK is not set
-+# CONFIG_NEW_LEDS is not set
-+# CONFIG_ACCESSIBILITY is not set
-+CONFIG_RTC_LIB=y
-+# CONFIG_RTC_CLASS is not set
-+# CONFIG_DMADEVICES is not set
-+# CONFIG_UIO is not set
-+# CONFIG_STAGING is not set
-+
-+#
-+# File systems
-+#
-+CONFIG_EXT2_FS=y
-+# CONFIG_EXT2_FS_XATTR is not set
-+# CONFIG_EXT2_FS_XIP is not set
-+# CONFIG_EXT3_FS is not set
-+# CONFIG_EXT4_FS is not set
-+# CONFIG_REISERFS_FS is not set
-+# CONFIG_JFS_FS is not set
-+# CONFIG_FS_POSIX_ACL is not set
-+CONFIG_FILE_LOCKING=y
-+# CONFIG_XFS_FS is not set
-+# CONFIG_OCFS2_FS is not set
-+# CONFIG_BTRFS_FS is not set
-+CONFIG_DNOTIFY=y
-+CONFIG_INOTIFY=y
-+CONFIG_INOTIFY_USER=y
-+# CONFIG_QUOTA is not set
-+# CONFIG_AUTOFS_FS is not set
-+# CONFIG_AUTOFS4_FS is not set
-+CONFIG_FUSE_FS=y
-+
-+#
-+# CD-ROM/DVD Filesystems
-+#
-+# CONFIG_ISO9660_FS is not set
-+# CONFIG_UDF_FS is not set
-+
-+#
-+# DOS/FAT/NT Filesystems
-+#
-+# CONFIG_MSDOS_FS is not set
-+# CONFIG_VFAT_FS is not set
-+# CONFIG_NTFS_FS is not set
-+
-+#
-+# Pseudo filesystems
-+#
-+CONFIG_PROC_FS=y
-+# CONFIG_PROC_KCORE is not set
-+CONFIG_PROC_SYSCTL=y
-+# CONFIG_PROC_PAGE_MONITOR is not set
-+CONFIG_SYSFS=y
-+CONFIG_TMPFS=y
-+# CONFIG_TMPFS_POSIX_ACL is not set
-+# CONFIG_HUGETLB_PAGE is not set
-+# CONFIG_CONFIGFS_FS is not set
-+CONFIG_MISC_FILESYSTEMS=y
-+# CONFIG_ADFS_FS is not set
-+# CONFIG_AFFS_FS is not set
-+# CONFIG_HFS_FS is not set
-+# CONFIG_HFSPLUS_FS is not set
-+# CONFIG_BEFS_FS is not set
-+# CONFIG_BFS_FS is not set
-+# CONFIG_EFS_FS is not set
-+# CONFIG_CRAMFS is not set
-+# CONFIG_SQUASHFS is not set
-+# CONFIG_VXFS_FS is not set
-+# CONFIG_MINIX_FS is not set
-+# CONFIG_OMFS_FS is not set
-+# CONFIG_HPFS_FS is not set
-+# CONFIG_QNX4FS_FS is not set
-+# CONFIG_ROMFS_FS is not set
-+# CONFIG_SYSV_FS is not set
-+# CONFIG_UFS_FS is not set
-+CONFIG_NETWORK_FILESYSTEMS=y
-+CONFIG_NFS_FS=y
-+CONFIG_NFS_V3=y
-+# CONFIG_NFS_V3_ACL is not set
-+# CONFIG_NFS_V4 is not set
-+# CONFIG_NFSD is not set
-+CONFIG_LOCKD=y
-+CONFIG_LOCKD_V4=y
-+CONFIG_NFS_COMMON=y
-+CONFIG_SUNRPC=y
-+# CONFIG_SUNRPC_REGISTER_V4 is not set
-+# CONFIG_RPCSEC_GSS_KRB5 is not set
-+# CONFIG_RPCSEC_GSS_SPKM3 is not set
-+# CONFIG_SMB_FS is not set
-+# CONFIG_CIFS is not set
-+# CONFIG_NCP_FS is not set
-+# CONFIG_CODA_FS is not set
-+# CONFIG_AFS_FS is not set
-+
-+#
-+# Partition Types
-+#
-+# CONFIG_PARTITION_ADVANCED is not set
-+CONFIG_MSDOS_PARTITION=y
-+CONFIG_NLS=y
-+CONFIG_NLS_DEFAULT="iso8859-1"
-+CONFIG_NLS_CODEPAGE_437=y
-+# CONFIG_NLS_CODEPAGE_737 is not set
-+# CONFIG_NLS_CODEPAGE_775 is not set
-+# CONFIG_NLS_CODEPAGE_850 is not set
-+# CONFIG_NLS_CODEPAGE_852 is not set
-+# CONFIG_NLS_CODEPAGE_855 is not set
-+# CONFIG_NLS_CODEPAGE_857 is not set
-+# CONFIG_NLS_CODEPAGE_860 is not set
-+# CONFIG_NLS_CODEPAGE_861 is not set
-+# CONFIG_NLS_CODEPAGE_862 is not set
-+# CONFIG_NLS_CODEPAGE_863 is not set
-+# CONFIG_NLS_CODEPAGE_864 is not set
-+# CONFIG_NLS_CODEPAGE_865 is not set
-+# CONFIG_NLS_CODEPAGE_866 is not set
-+# CONFIG_NLS_CODEPAGE_869 is not set
-+# CONFIG_NLS_CODEPAGE_936 is not set
-+# CONFIG_NLS_CODEPAGE_950 is not set
-+# CONFIG_NLS_CODEPAGE_932 is not set
-+# CONFIG_NLS_CODEPAGE_949 is not set
-+# CONFIG_NLS_CODEPAGE_874 is not set
-+# CONFIG_NLS_ISO8859_8 is not set
-+# CONFIG_NLS_CODEPAGE_1250 is not set
-+# CONFIG_NLS_CODEPAGE_1251 is not set
-+# CONFIG_NLS_ASCII is not set
-+CONFIG_NLS_ISO8859_1=y
-+# CONFIG_NLS_ISO8859_2 is not set
-+# CONFIG_NLS_ISO8859_3 is not set
-+# CONFIG_NLS_ISO8859_4 is not set
-+# CONFIG_NLS_ISO8859_5 is not set
-+# CONFIG_NLS_ISO8859_6 is not set
-+# CONFIG_NLS_ISO8859_7 is not set
-+# CONFIG_NLS_ISO8859_9 is not set
-+# CONFIG_NLS_ISO8859_13 is not set
-+# CONFIG_NLS_ISO8859_14 is not set
-+# CONFIG_NLS_ISO8859_15 is not set
-+# CONFIG_NLS_KOI8_R is not set
-+# CONFIG_NLS_KOI8_U is not set
-+# CONFIG_NLS_UTF8 is not set
-+# CONFIG_DLM is not set
-+
-+#
-+# Kernel hacking
-+#
-+CONFIG_TRACE_IRQFLAGS_SUPPORT=y
-+# CONFIG_PRINTK_TIME is not set
-+CONFIG_ENABLE_WARN_DEPRECATED=y
-+CONFIG_ENABLE_MUST_CHECK=y
-+CONFIG_FRAME_WARN=1024
-+# CONFIG_MAGIC_SYSRQ is not set
-+# CONFIG_UNUSED_SYMBOLS is not set
-+CONFIG_DEBUG_FS=y
-+# CONFIG_HEADERS_CHECK is not set
-+# CONFIG_DEBUG_KERNEL is not set
-+# CONFIG_SLUB_DEBUG_ON is not set
-+# CONFIG_SLUB_STATS is not set
-+CONFIG_STACKTRACE=y
-+# CONFIG_DEBUG_MEMORY_INIT is not set
-+CONFIG_FRAME_POINTER=y
-+# CONFIG_RCU_CPU_STALL_DETECTOR is not set
-+# CONFIG_LATENCYTOP is not set
-+CONFIG_SYSCTL_SYSCALL_CHECK=y
-+CONFIG_NOP_TRACER=y
-+CONFIG_RING_BUFFER=y
-+CONFIG_TRACING=y
-+
-+#
-+# Tracers
-+#
-+# CONFIG_DYNAMIC_PRINTK_DEBUG is not set
-+# CONFIG_SAMPLES is not set
-+CONFIG_HAVE_ARCH_KGDB=y
-+CONFIG_DEBUG_USER=y
-+# CONFIG_CCTL is not set
-+CONFIG_ELFCHK_DEFAULT_ENABLE=y
-+
-+#
-+# Security options
-+#
-+# CONFIG_KEYS is not set
-+# CONFIG_SECURITY is not set
-+# CONFIG_SECURITYFS is not set
-+# CONFIG_SECURITY_FILE_CAPABILITIES is not set
-+CONFIG_CRYPTO=y
-+
-+#
-+# Crypto core or helper
-+#
-+# CONFIG_CRYPTO_FIPS is not set
-+# CONFIG_CRYPTO_MANAGER is not set
-+# CONFIG_CRYPTO_MANAGER2 is not set
-+# CONFIG_CRYPTO_GF128MUL is not set
-+# CONFIG_CRYPTO_NULL is not set
-+# CONFIG_CRYPTO_CRYPTD is not set
-+# CONFIG_CRYPTO_AUTHENC is not set
-+# CONFIG_CRYPTO_TEST is not set
-+
-+#
-+# Authenticated Encryption with Associated Data
-+#
-+# CONFIG_CRYPTO_CCM is not set
-+# CONFIG_CRYPTO_GCM is not set
-+# CONFIG_CRYPTO_SEQIV is not set
-+
-+#
-+# Block modes
-+#
-+# CONFIG_CRYPTO_CBC is not set
-+# CONFIG_CRYPTO_CTR is not set
-+# CONFIG_CRYPTO_CTS is not set
-+# CONFIG_CRYPTO_ECB is not set
-+# CONFIG_CRYPTO_LRW is not set
-+# CONFIG_CRYPTO_PCBC is not set
-+# CONFIG_CRYPTO_XTS is not set
-+
-+#
-+# Hash modes
-+#
-+# CONFIG_CRYPTO_HMAC is not set
-+# CONFIG_CRYPTO_XCBC is not set
-+
-+#
-+# Digest
-+#
-+# CONFIG_CRYPTO_CRC32C is not set
-+# CONFIG_CRYPTO_MD4 is not set
-+# CONFIG_CRYPTO_MD5 is not set
-+# CONFIG_CRYPTO_MICHAEL_MIC is not set
-+# CONFIG_CRYPTO_RMD128 is not set
-+# CONFIG_CRYPTO_RMD160 is not set
-+# CONFIG_CRYPTO_RMD256 is not set
-+# CONFIG_CRYPTO_RMD320 is not set
-+# CONFIG_CRYPTO_SHA1 is not set
-+# CONFIG_CRYPTO_SHA256 is not set
-+# CONFIG_CRYPTO_SHA512 is not set
-+# CONFIG_CRYPTO_TGR192 is not set
-+# CONFIG_CRYPTO_WP512 is not set
-+
-+#
-+# Ciphers
-+#
-+# CONFIG_CRYPTO_AES is not set
-+# CONFIG_CRYPTO_ANUBIS is not set
-+# CONFIG_CRYPTO_ARC4 is not set
-+# CONFIG_CRYPTO_BLOWFISH is not set
-+# CONFIG_CRYPTO_CAMELLIA is not set
-+# CONFIG_CRYPTO_CAST5 is not set
-+# CONFIG_CRYPTO_CAST6 is not set
-+# CONFIG_CRYPTO_DES is not set
-+# CONFIG_CRYPTO_FCRYPT is not set
-+# CONFIG_CRYPTO_KHAZAD is not set
-+# CONFIG_CRYPTO_SALSA20 is not set
-+# CONFIG_CRYPTO_SEED is not set
-+# CONFIG_CRYPTO_SERPENT is not set
-+# CONFIG_CRYPTO_TEA is not set
-+# CONFIG_CRYPTO_TWOFISH is not set
-+
-+#
-+# Compression
-+#
-+# CONFIG_CRYPTO_DEFLATE is not set
-+# CONFIG_CRYPTO_LZO is not set
-+
-+#
-+# Random Number Generation
-+#
-+# CONFIG_CRYPTO_ANSI_CPRNG is not set
-+# CONFIG_CRYPTO_HW is not set
-+
-+#
-+# Library routines
-+#
-+CONFIG_GENERIC_FIND_LAST_BIT=y
-+# CONFIG_CRC_CCITT is not set
-+# CONFIG_CRC16 is not set
-+# CONFIG_CRC_T10DIF is not set
-+# CONFIG_CRC_ITU_T is not set
-+# CONFIG_CRC32 is not set
-+# CONFIG_CRC7 is not set
-+# CONFIG_LIBCRC32C is not set
-+CONFIG_PLIST=y
-+CONFIG_HAS_IOMEM=y
-+CONFIG_HAS_DMA=y
-diff -Nur linux-3.4.113.orig/arch/nds32/configs/vep-le_defconfig linux-3.4.113/arch/nds32/configs/vep-le_defconfig
---- linux-3.4.113.orig/arch/nds32/configs/vep-le_defconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/configs/vep-le_defconfig 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,777 @@
-+#
-+# Automatically generated make config: don't edit
-+# Linux kernel version: 2.6.29
-+# Mon Jul 13 11:41:30 2009
-+#
-+CONFIG_NDS32=y
-+CONFIG_NO_IOPORT=y
-+CONFIG_GENERIC_IOMAP=y
-+CONFIG_RWSEM_GENERIC_SPINLOCK=y
-+CONFIG_GENERIC_HWEIGHT=y
-+CONFIG_GENERIC_FIND_NEXT_BIT=y
-+CONFIG_GENERIC_CALIBRATE_DELAY=y
-+CONFIG_GENERIC_HARDIRQS=y
-+CONFIG_LOCKDEP_SUPPORT=y
-+CONFIG_STACKTRACE_SUPPORT=y
-+CONFIG_HAVE_LATENCYTOP_SUPPORT=y
-+CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config"
-+
-+#
-+# General setup
-+#
-+CONFIG_EXPERIMENTAL=y
-+CONFIG_BROKEN_ON_SMP=y
-+CONFIG_INIT_ENV_ARG_LIMIT=32
-+CONFIG_LOCALVERSION=""
-+# CONFIG_LOCALVERSION_AUTO is not set
-+CONFIG_SWAP=y
-+CONFIG_SYSVIPC=y
-+CONFIG_SYSVIPC_SYSCTL=y
-+# CONFIG_POSIX_MQUEUE is not set
-+CONFIG_BSD_PROCESS_ACCT=y
-+CONFIG_BSD_PROCESS_ACCT_V3=y
-+# CONFIG_TASKSTATS is not set
-+# CONFIG_AUDIT is not set
-+
-+#
-+# RCU Subsystem
-+#
-+CONFIG_CLASSIC_RCU=y
-+# CONFIG_TREE_RCU is not set
-+# CONFIG_PREEMPT_RCU is not set
-+# CONFIG_TREE_RCU_TRACE is not set
-+# CONFIG_PREEMPT_RCU_TRACE is not set
-+# CONFIG_IKCONFIG is not set
-+CONFIG_LOG_BUF_SHIFT=14
-+# CONFIG_GROUP_SCHED is not set
-+# CONFIG_CGROUPS is not set
-+# CONFIG_SYSFS_DEPRECATED_V2 is not set
-+# CONFIG_RELAY is not set
-+# CONFIG_NAMESPACES is not set
-+CONFIG_BLK_DEV_INITRD=y
-+CONFIG_INITRAMFS_SOURCE=""
-+CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-+CONFIG_SYSCTL=y
-+CONFIG_ANON_INODES=y
-+CONFIG_EMBEDDED=y
-+CONFIG_UID16=y
-+CONFIG_SYSCTL_SYSCALL=y
-+# CONFIG_KALLSYMS is not set
-+# CONFIG_HOTPLUG is not set
-+CONFIG_PRINTK=y
-+CONFIG_BUG=y
-+# CONFIG_ELF_CORE is not set
-+CONFIG_BASE_FULL=y
-+CONFIG_FUTEX=y
-+CONFIG_EPOLL=y
-+# CONFIG_SIGNALFD is not set
-+CONFIG_TIMERFD=y
-+CONFIG_EVENTFD=y
-+CONFIG_SHMEM=y
-+CONFIG_AIO=y
-+# CONFIG_VM_EVENT_COUNTERS is not set
-+CONFIG_SLUB_DEBUG=y
-+CONFIG_COMPAT_BRK=y
-+# CONFIG_SLAB is not set
-+CONFIG_SLUB=y
-+# CONFIG_SLOB is not set
-+CONFIG_PROFILING=y
-+CONFIG_TRACEPOINTS=y
-+# CONFIG_MARKERS is not set
-+CONFIG_OPROFILE=y
-+CONFIG_HAVE_OPROFILE=y
-+CONFIG_HAVE_KPROBES=y
-+CONFIG_HAVE_KRETPROBES=y
-+# CONFIG_HAVE_GENERIC_DMA_COHERENT is not set
-+CONFIG_SLABINFO=y
-+CONFIG_RT_MUTEXES=y
-+CONFIG_BASE_SMALL=0
-+CONFIG_MODULES=y
-+# CONFIG_MODULE_FORCE_LOAD is not set
-+CONFIG_MODULE_UNLOAD=y
-+# CONFIG_MODULE_FORCE_UNLOAD is not set
-+# CONFIG_MODVERSIONS is not set
-+# CONFIG_MODULE_SRCVERSION_ALL is not set
-+CONFIG_BLOCK=y
-+# CONFIG_LBD is not set
-+# CONFIG_BLK_DEV_IO_TRACE is not set
-+# CONFIG_BLK_DEV_BSG is not set
-+# CONFIG_BLK_DEV_INTEGRITY is not set
-+
-+#
-+# IO Schedulers
-+#
-+CONFIG_IOSCHED_NOOP=y
-+# CONFIG_IOSCHED_AS is not set
-+# CONFIG_IOSCHED_DEADLINE is not set
-+# CONFIG_IOSCHED_CFQ is not set
-+# CONFIG_DEFAULT_AS is not set
-+# CONFIG_DEFAULT_DEADLINE is not set
-+# CONFIG_DEFAULT_CFQ is not set
-+CONFIG_DEFAULT_NOOP=y
-+CONFIG_DEFAULT_IOSCHED="noop"
-+# CONFIG_FREEZER is not set
-+
-+#
-+# System Type
-+#
-+# CONFIG_PLAT_FARADAY is not set
-+CONFIG_PLAT_VEP=y
-+# CONFIG_PLAT_AG101 is not set
-+# CONFIG_PLAT_AG102 is not set
-+# CONFIG_PLAT_AG101P is not set
-+# CONFIG_PLAT_QEMU is not set
-+CONFIG_PLATFORM_INTC=y
-+
-+#
-+# VEP Platform Options
-+#
-+# CONFIG_CACHE_L2 is not set
-+
-+#
-+# Common Platform Options
-+#
-+# CONFIG_PLATFORM_AHBDMA is not set
-+# CONFIG_PLATFORM_APBDMA is not set
-+CONFIG_SYS_CLK=67737600
-+CONFIG_UART_CLK=36864000
-+CONFIG_SDRAM_SIZE=0x10000000
-+
-+#
-+# Processor Features
-+#
-+CONFIG_CPU_CUSTOM=y
-+# CONFIG_FPU is not set
-+# CONFIG_AUDIO is not set
-+# CONFIG_EVIC is not set
-+CONFIG_CPU_CONTEXT_ID=y
-+CONFIG_ANDES_PAGE_SIZE_4KB=y
-+# CONFIG_ANDES_PAGE_SIZE_8KB is not set
-+# CONFIG_KERNEL_SPACE_LARGE_PAGE is not set
-+# CONFIG_CPU_ICACHE_DISABLE is not set
-+# CONFIG_CPU_DCACHE_DISABLE is not set
-+# CONFIG_CPU_DCACHE_WRITETHROUGH is not set
-+# CONFIG_ALIGNMENT_TRAP is not set
-+CONFIG_MMU=y
-+
-+#
-+# Kernel Features
-+#
-+CONFIG_PREEMPT_NONE=y
-+# CONFIG_PREEMPT_VOLUNTARY is not set
-+# CONFIG_PREEMPT is not set
-+CONFIG_SELECT_MEMORY_MODEL=y
-+CONFIG_FLATMEM_MANUAL=y
-+# CONFIG_DISCONTIGMEM_MANUAL is not set
-+# CONFIG_SPARSEMEM_MANUAL is not set
-+CONFIG_FLATMEM=y
-+CONFIG_FLAT_NODE_MEM_MAP=y
-+CONFIG_PAGEFLAGS_EXTENDED=y
-+CONFIG_SPLIT_PTLOCK_CPUS=4
-+# CONFIG_PHYS_ADDR_T_64BIT is not set
-+CONFIG_ZONE_DMA_FLAG=0
-+CONFIG_VIRT_TO_BUS=y
-+CONFIG_UNEVICTABLE_LRU=y
-+CONFIG_FORCE_MAX_ZONEORDER=11
-+CONFIG_HZ_100=y
-+# CONFIG_HZ_250 is not set
-+# CONFIG_HZ_300 is not set
-+# CONFIG_HZ_1000 is not set
-+CONFIG_HZ=100
-+# CONFIG_SCHED_HRTICK is not set
-+CONFIG_CMDLINE="root=/dev/ram0 rw mem=64M@0x0 initrd=0x1000000,8M console=ttyS0,38400n8 rootfstype=ext2 init=/bin/busybox init -s user_debug=-1"
-+
-+#
-+# Power management options
-+#
-+CONFIG_SYS_SUPPORTS_APM_EMULATION=y
-+CONFIG_ARCH_SUSPEND_POSSIBLE=y
-+# CONFIG_PM is not set
-+
-+#
-+# Bus options
-+#
-+# CONFIG_PCI is not set
-+# CONFIG_ARCH_SUPPORTS_MSI is not set
-+
-+#
-+# Executable file formats
-+#
-+CONFIG_BINFMT_ELF=y
-+# CONFIG_HAVE_AOUT is not set
-+# CONFIG_BINFMT_MISC is not set
-+CONFIG_NET=y
-+
-+#
-+# Networking options
-+#
-+CONFIG_COMPAT_NET_DEV_OPS=y
-+CONFIG_PACKET=y
-+# CONFIG_PACKET_MMAP is not set
-+CONFIG_UNIX=y
-+CONFIG_XFRM=y
-+# CONFIG_XFRM_USER is not set
-+# CONFIG_XFRM_SUB_POLICY is not set
-+# CONFIG_XFRM_MIGRATE is not set
-+# CONFIG_XFRM_STATISTICS is not set
-+CONFIG_NET_KEY=y
-+# CONFIG_NET_KEY_MIGRATE is not set
-+CONFIG_INET=y
-+CONFIG_IP_MULTICAST=y
-+# CONFIG_IP_ADVANCED_ROUTER is not set
-+CONFIG_IP_FIB_HASH=y
-+# CONFIG_IP_PNP is not set
-+# CONFIG_NET_IPIP is not set
-+# CONFIG_NET_IPGRE is not set
-+# CONFIG_IP_MROUTE is not set
-+# CONFIG_ARPD is not set
-+# CONFIG_SYN_COOKIES is not set
-+# CONFIG_INET_AH is not set
-+# CONFIG_INET_ESP is not set
-+# CONFIG_INET_IPCOMP is not set
-+# CONFIG_INET_XFRM_TUNNEL is not set
-+# CONFIG_INET_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-+# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_BEET is not set
-+# CONFIG_INET_LRO is not set
-+# CONFIG_INET_DIAG is not set
-+# CONFIG_TCP_CONG_ADVANCED is not set
-+CONFIG_TCP_CONG_CUBIC=y
-+CONFIG_DEFAULT_TCP_CONG="cubic"
-+# CONFIG_TCP_MD5SIG is not set
-+# CONFIG_IPV6 is not set
-+# CONFIG_NETWORK_SECMARK is not set
-+# CONFIG_NETFILTER is not set
-+# CONFIG_IP_DCCP is not set
-+# CONFIG_IP_SCTP is not set
-+# CONFIG_TIPC is not set
-+# CONFIG_ATM is not set
-+# CONFIG_BRIDGE is not set
-+# CONFIG_NET_DSA is not set
-+# CONFIG_VLAN_8021Q is not set
-+# CONFIG_DECNET is not set
-+# CONFIG_LLC2 is not set
-+# CONFIG_IPX is not set
-+# CONFIG_ATALK is not set
-+# CONFIG_X25 is not set
-+# CONFIG_LAPB is not set
-+# CONFIG_ECONET is not set
-+# CONFIG_WAN_ROUTER is not set
-+# CONFIG_NET_SCHED is not set
-+# CONFIG_DCB is not set
-+
-+#
-+# Network testing
-+#
-+# CONFIG_NET_PKTGEN is not set
-+# CONFIG_HAMRADIO is not set
-+# CONFIG_CAN is not set
-+# CONFIG_IRDA is not set
-+# CONFIG_BT is not set
-+# CONFIG_AF_RXRPC is not set
-+# CONFIG_PHONET is not set
-+CONFIG_WIRELESS=y
-+# CONFIG_CFG80211 is not set
-+CONFIG_WIRELESS_OLD_REGULATORY=y
-+# CONFIG_WIRELESS_EXT is not set
-+# CONFIG_LIB80211 is not set
-+# CONFIG_MAC80211 is not set
-+# CONFIG_WIMAX is not set
-+# CONFIG_RFKILL is not set
-+# CONFIG_NET_9P is not set
-+
-+#
-+# Device Drivers
-+#
-+
-+#
-+# Generic Driver Options
-+#
-+CONFIG_STANDALONE=y
-+CONFIG_PREVENT_FIRMWARE_BUILD=y
-+# CONFIG_SYS_HYPERVISOR is not set
-+# CONFIG_CONNECTOR is not set
-+# CONFIG_MTD is not set
-+# CONFIG_PARPORT is not set
-+CONFIG_BLK_DEV=y
-+# CONFIG_BLK_DEV_COW_COMMON is not set
-+CONFIG_BLK_DEV_LOOP=y
-+# CONFIG_BLK_DEV_CRYPTOLOOP is not set
-+# CONFIG_BLK_DEV_NBD is not set
-+CONFIG_BLK_DEV_RAM=y
-+CONFIG_BLK_DEV_RAM_COUNT=16
-+CONFIG_BLK_DEV_RAM_SIZE=8192
-+# CONFIG_BLK_DEV_XIP is not set
-+# CONFIG_CDROM_PKTCDVD is not set
-+# CONFIG_ATA_OVER_ETH is not set
-+# CONFIG_FTSDC010 is not set
-+# CONFIG_FTCFC010 is not set
-+# CONFIG_BLK_DEV_HD is not set
-+# CONFIG_MISC_DEVICES is not set
-+CONFIG_HAVE_IDE=y
-+# CONFIG_IDE is not set
-+
-+#
-+# SCSI device support
-+#
-+# CONFIG_RAID_ATTRS is not set
-+# CONFIG_SCSI is not set
-+# CONFIG_SCSI_DMA is not set
-+# CONFIG_SCSI_NETLINK is not set
-+# CONFIG_ATA is not set
-+# CONFIG_MD is not set
-+CONFIG_NETDEVICES=y
-+# CONFIG_DUMMY is not set
-+# CONFIG_BONDING is not set
-+# CONFIG_MACVLAN is not set
-+# CONFIG_EQUALIZER is not set
-+# CONFIG_TUN is not set
-+# CONFIG_VETH is not set
-+# CONFIG_PHYLIB is not set
-+CONFIG_NET_ETHERNET=y
-+# CONFIG_MII is not set
-+# CONFIG_SMC91X is not set
-+# CONFIG_DNET is not set
-+# CONFIG_IBM_NEW_EMAC_ZMII is not set
-+# CONFIG_IBM_NEW_EMAC_RGMII is not set
-+# CONFIG_IBM_NEW_EMAC_TAH is not set
-+# CONFIG_IBM_NEW_EMAC_EMAC4 is not set
-+# CONFIG_IBM_NEW_EMAC_NO_FLOW_CTRL is not set
-+# CONFIG_IBM_NEW_EMAC_MAL_CLR_ICINTSTAT is not set
-+# CONFIG_IBM_NEW_EMAC_MAL_COMMON_ERR is not set
-+# CONFIG_B44 is not set
-+CONFIG_FTMAC100=y
-+# CONFIG_NETDEV_1000 is not set
-+# CONFIG_NETDEV_10000 is not set
-+
-+#
-+# Wireless LAN
-+#
-+# CONFIG_WLAN_PRE80211 is not set
-+# CONFIG_WLAN_80211 is not set
-+# CONFIG_IWLWIFI_LEDS is not set
-+
-+#
-+# Enable WiMAX (Networking options) to see the WiMAX drivers
-+#
-+# CONFIG_WAN is not set
-+# CONFIG_PPP is not set
-+# CONFIG_SLIP is not set
-+# CONFIG_NETCONSOLE is not set
-+# CONFIG_NETPOLL is not set
-+# CONFIG_NET_POLL_CONTROLLER is not set
-+# CONFIG_ISDN is not set
-+# CONFIG_PHONE is not set
-+
-+#
-+# Input device support
-+#
-+CONFIG_INPUT=y
-+# CONFIG_INPUT_FF_MEMLESS is not set
-+# CONFIG_INPUT_POLLDEV is not set
-+
-+#
-+# Userland interfaces
-+#
-+# CONFIG_INPUT_MOUSEDEV is not set
-+# CONFIG_INPUT_JOYDEV is not set
-+# CONFIG_INPUT_EVDEV is not set
-+# CONFIG_INPUT_EVBUG is not set
-+
-+#
-+# Input Device Drivers
-+#
-+# CONFIG_INPUT_KEYBOARD is not set
-+# CONFIG_INPUT_MOUSE is not set
-+# CONFIG_INPUT_JOYSTICK is not set
-+# CONFIG_INPUT_TABLET is not set
-+# CONFIG_INPUT_TOUCHSCREEN is not set
-+# CONFIG_INPUT_MISC is not set
-+
-+#
-+# Hardware I/O ports
-+#
-+# CONFIG_SERIO is not set
-+# CONFIG_GAMEPORT is not set
-+
-+#
-+# Character devices
-+#
-+CONFIG_VT=y
-+CONFIG_CONSOLE_TRANSLATIONS=y
-+CONFIG_VT_CONSOLE=y
-+CONFIG_HW_CONSOLE=y
-+# CONFIG_VT_HW_CONSOLE_BINDING is not set
-+CONFIG_DEVKMEM=y
-+# CONFIG_SERIAL_NONSTANDARD is not set
-+
-+#
-+# Serial drivers
-+#
-+CONFIG_SERIAL_8250=y
-+CONFIG_SERIAL_8250_CONSOLE=y
-+CONFIG_SERIAL_8250_NR_UARTS=3
-+CONFIG_SERIAL_8250_RUNTIME_UARTS=3
-+# CONFIG_SERIAL_8250_EXTENDED is not set
-+
-+#
-+# Non-8250 serial port support
-+#
-+CONFIG_SERIAL_CORE=y
-+CONFIG_SERIAL_CORE_CONSOLE=y
-+CONFIG_UNIX98_PTYS=y
-+# CONFIG_DEVPTS_MULTIPLE_INSTANCES is not set
-+CONFIG_LEGACY_PTYS=y
-+CONFIG_LEGACY_PTY_COUNT=256
-+# CONFIG_IPMI_HANDLER is not set
-+# CONFIG_HW_RANDOM is not set
-+# CONFIG_R3964 is not set
-+# CONFIG_GPIO_FTGPIO010 is not set
-+# CONFIG_RAW_DRIVER is not set
-+# CONFIG_TCG_TPM is not set
-+# CONFIG_I2C is not set
-+# CONFIG_SPI is not set
-+# CONFIG_W1 is not set
-+# CONFIG_POWER_SUPPLY is not set
-+# CONFIG_HWMON is not set
-+# CONFIG_THERMAL is not set
-+# CONFIG_THERMAL_HWMON is not set
-+# CONFIG_WATCHDOG is not set
-+CONFIG_SSB_POSSIBLE=y
-+
-+#
-+# Sonics Silicon Backplane
-+#
-+# CONFIG_SSB is not set
-+
-+#
-+# Multifunction device drivers
-+#
-+# CONFIG_MFD_CORE is not set
-+# CONFIG_MFD_SM501 is not set
-+# CONFIG_HTC_PASIC3 is not set
-+# CONFIG_MFD_TMIO is not set
-+# CONFIG_REGULATOR is not set
-+
-+#
-+# Multimedia devices
-+#
-+
-+#
-+# Multimedia core support
-+#
-+# CONFIG_VIDEO_DEV is not set
-+# CONFIG_DVB_CORE is not set
-+# CONFIG_VIDEO_MEDIA is not set
-+
-+#
-+# Multimedia drivers
-+#
-+# CONFIG_DAB is not set
-+
-+#
-+# Graphics support
-+#
-+# CONFIG_VGASTATE is not set
-+# CONFIG_VIDEO_OUTPUT_CONTROL is not set
-+# CONFIG_FB is not set
-+# CONFIG_BACKLIGHT_LCD_SUPPORT is not set
-+
-+#
-+# Display device support
-+#
-+# CONFIG_DISPLAY_SUPPORT is not set
-+
-+#
-+# Console display driver support
-+#
-+# CONFIG_VGA_CONSOLE is not set
-+CONFIG_DUMMY_CONSOLE=y
-+# CONFIG_SOUND is not set
-+# CONFIG_HID_SUPPORT is not set
-+# CONFIG_USB_SUPPORT is not set
-+# CONFIG_MMC is not set
-+# CONFIG_MEMSTICK is not set
-+# CONFIG_NEW_LEDS is not set
-+# CONFIG_ACCESSIBILITY is not set
-+CONFIG_RTC_LIB=y
-+# CONFIG_RTC_CLASS is not set
-+# CONFIG_DMADEVICES is not set
-+# CONFIG_UIO is not set
-+# CONFIG_STAGING is not set
-+
-+#
-+# File systems
-+#
-+CONFIG_EXT2_FS=y
-+# CONFIG_EXT2_FS_XATTR is not set
-+# CONFIG_EXT2_FS_XIP is not set
-+# CONFIG_EXT3_FS is not set
-+# CONFIG_EXT4_FS is not set
-+# CONFIG_REISERFS_FS is not set
-+# CONFIG_JFS_FS is not set
-+# CONFIG_FS_POSIX_ACL is not set
-+CONFIG_FILE_LOCKING=y
-+# CONFIG_XFS_FS is not set
-+# CONFIG_OCFS2_FS is not set
-+# CONFIG_BTRFS_FS is not set
-+CONFIG_DNOTIFY=y
-+CONFIG_INOTIFY=y
-+CONFIG_INOTIFY_USER=y
-+# CONFIG_QUOTA is not set
-+# CONFIG_AUTOFS_FS is not set
-+# CONFIG_AUTOFS4_FS is not set
-+CONFIG_FUSE_FS=y
-+
-+#
-+# CD-ROM/DVD Filesystems
-+#
-+# CONFIG_ISO9660_FS is not set
-+# CONFIG_UDF_FS is not set
-+
-+#
-+# DOS/FAT/NT Filesystems
-+#
-+# CONFIG_MSDOS_FS is not set
-+# CONFIG_VFAT_FS is not set
-+# CONFIG_NTFS_FS is not set
-+
-+#
-+# Pseudo filesystems
-+#
-+CONFIG_PROC_FS=y
-+# CONFIG_PROC_KCORE is not set
-+CONFIG_PROC_SYSCTL=y
-+# CONFIG_PROC_PAGE_MONITOR is not set
-+CONFIG_SYSFS=y
-+CONFIG_TMPFS=y
-+# CONFIG_TMPFS_POSIX_ACL is not set
-+# CONFIG_HUGETLB_PAGE is not set
-+# CONFIG_CONFIGFS_FS is not set
-+CONFIG_MISC_FILESYSTEMS=y
-+# CONFIG_ADFS_FS is not set
-+# CONFIG_AFFS_FS is not set
-+# CONFIG_HFS_FS is not set
-+# CONFIG_HFSPLUS_FS is not set
-+# CONFIG_BEFS_FS is not set
-+# CONFIG_BFS_FS is not set
-+# CONFIG_EFS_FS is not set
-+# CONFIG_CRAMFS is not set
-+# CONFIG_SQUASHFS is not set
-+# CONFIG_VXFS_FS is not set
-+# CONFIG_MINIX_FS is not set
-+# CONFIG_OMFS_FS is not set
-+# CONFIG_HPFS_FS is not set
-+# CONFIG_QNX4FS_FS is not set
-+# CONFIG_ROMFS_FS is not set
-+# CONFIG_SYSV_FS is not set
-+# CONFIG_UFS_FS is not set
-+CONFIG_NETWORK_FILESYSTEMS=y
-+CONFIG_NFS_FS=y
-+CONFIG_NFS_V3=y
-+# CONFIG_NFS_V3_ACL is not set
-+# CONFIG_NFS_V4 is not set
-+# CONFIG_NFSD is not set
-+CONFIG_LOCKD=y
-+CONFIG_LOCKD_V4=y
-+CONFIG_NFS_COMMON=y
-+CONFIG_SUNRPC=y
-+# CONFIG_SUNRPC_REGISTER_V4 is not set
-+# CONFIG_RPCSEC_GSS_KRB5 is not set
-+# CONFIG_RPCSEC_GSS_SPKM3 is not set
-+# CONFIG_SMB_FS is not set
-+# CONFIG_CIFS is not set
-+# CONFIG_NCP_FS is not set
-+# CONFIG_CODA_FS is not set
-+# CONFIG_AFS_FS is not set
-+
-+#
-+# Partition Types
-+#
-+# CONFIG_PARTITION_ADVANCED is not set
-+CONFIG_MSDOS_PARTITION=y
-+CONFIG_NLS=y
-+CONFIG_NLS_DEFAULT="iso8859-1"
-+CONFIG_NLS_CODEPAGE_437=y
-+# CONFIG_NLS_CODEPAGE_737 is not set
-+# CONFIG_NLS_CODEPAGE_775 is not set
-+# CONFIG_NLS_CODEPAGE_850 is not set
-+# CONFIG_NLS_CODEPAGE_852 is not set
-+# CONFIG_NLS_CODEPAGE_855 is not set
-+# CONFIG_NLS_CODEPAGE_857 is not set
-+# CONFIG_NLS_CODEPAGE_860 is not set
-+# CONFIG_NLS_CODEPAGE_861 is not set
-+# CONFIG_NLS_CODEPAGE_862 is not set
-+# CONFIG_NLS_CODEPAGE_863 is not set
-+# CONFIG_NLS_CODEPAGE_864 is not set
-+# CONFIG_NLS_CODEPAGE_865 is not set
-+# CONFIG_NLS_CODEPAGE_866 is not set
-+# CONFIG_NLS_CODEPAGE_869 is not set
-+# CONFIG_NLS_CODEPAGE_936 is not set
-+# CONFIG_NLS_CODEPAGE_950 is not set
-+# CONFIG_NLS_CODEPAGE_932 is not set
-+# CONFIG_NLS_CODEPAGE_949 is not set
-+# CONFIG_NLS_CODEPAGE_874 is not set
-+# CONFIG_NLS_ISO8859_8 is not set
-+# CONFIG_NLS_CODEPAGE_1250 is not set
-+# CONFIG_NLS_CODEPAGE_1251 is not set
-+# CONFIG_NLS_ASCII is not set
-+CONFIG_NLS_ISO8859_1=y
-+# CONFIG_NLS_ISO8859_2 is not set
-+# CONFIG_NLS_ISO8859_3 is not set
-+# CONFIG_NLS_ISO8859_4 is not set
-+# CONFIG_NLS_ISO8859_5 is not set
-+# CONFIG_NLS_ISO8859_6 is not set
-+# CONFIG_NLS_ISO8859_7 is not set
-+# CONFIG_NLS_ISO8859_9 is not set
-+# CONFIG_NLS_ISO8859_13 is not set
-+# CONFIG_NLS_ISO8859_14 is not set
-+# CONFIG_NLS_ISO8859_15 is not set
-+# CONFIG_NLS_KOI8_R is not set
-+# CONFIG_NLS_KOI8_U is not set
-+# CONFIG_NLS_UTF8 is not set
-+# CONFIG_DLM is not set
-+
-+#
-+# Kernel hacking
-+#
-+CONFIG_TRACE_IRQFLAGS_SUPPORT=y
-+# CONFIG_PRINTK_TIME is not set
-+CONFIG_ENABLE_WARN_DEPRECATED=y
-+CONFIG_ENABLE_MUST_CHECK=y
-+CONFIG_FRAME_WARN=1024
-+# CONFIG_MAGIC_SYSRQ is not set
-+# CONFIG_UNUSED_SYMBOLS is not set
-+CONFIG_DEBUG_FS=y
-+# CONFIG_HEADERS_CHECK is not set
-+# CONFIG_DEBUG_KERNEL is not set
-+# CONFIG_SLUB_DEBUG_ON is not set
-+# CONFIG_SLUB_STATS is not set
-+CONFIG_STACKTRACE=y
-+# CONFIG_DEBUG_MEMORY_INIT is not set
-+CONFIG_FRAME_POINTER=y
-+# CONFIG_RCU_CPU_STALL_DETECTOR is not set
-+# CONFIG_LATENCYTOP is not set
-+CONFIG_SYSCTL_SYSCALL_CHECK=y
-+CONFIG_NOP_TRACER=y
-+CONFIG_RING_BUFFER=y
-+CONFIG_TRACING=y
-+
-+#
-+# Tracers
-+#
-+# CONFIG_DYNAMIC_PRINTK_DEBUG is not set
-+# CONFIG_SAMPLES is not set
-+CONFIG_HAVE_ARCH_KGDB=y
-+CONFIG_DEBUG_USER=y
-+# CONFIG_CCTL is not set
-+CONFIG_ELFCHK_DEFAULT_ENABLE=y
-+
-+#
-+# Security options
-+#
-+# CONFIG_KEYS is not set
-+# CONFIG_SECURITY is not set
-+# CONFIG_SECURITYFS is not set
-+# CONFIG_SECURITY_FILE_CAPABILITIES is not set
-+CONFIG_CRYPTO=y
-+
-+#
-+# Crypto core or helper
-+#
-+# CONFIG_CRYPTO_FIPS is not set
-+# CONFIG_CRYPTO_MANAGER is not set
-+# CONFIG_CRYPTO_MANAGER2 is not set
-+# CONFIG_CRYPTO_GF128MUL is not set
-+# CONFIG_CRYPTO_NULL is not set
-+# CONFIG_CRYPTO_CRYPTD is not set
-+# CONFIG_CRYPTO_AUTHENC is not set
-+# CONFIG_CRYPTO_TEST is not set
-+
-+#
-+# Authenticated Encryption with Associated Data
-+#
-+# CONFIG_CRYPTO_CCM is not set
-+# CONFIG_CRYPTO_GCM is not set
-+# CONFIG_CRYPTO_SEQIV is not set
-+
-+#
-+# Block modes
-+#
-+# CONFIG_CRYPTO_CBC is not set
-+# CONFIG_CRYPTO_CTR is not set
-+# CONFIG_CRYPTO_CTS is not set
-+# CONFIG_CRYPTO_ECB is not set
-+# CONFIG_CRYPTO_LRW is not set
-+# CONFIG_CRYPTO_PCBC is not set
-+# CONFIG_CRYPTO_XTS is not set
-+
-+#
-+# Hash modes
-+#
-+# CONFIG_CRYPTO_HMAC is not set
-+# CONFIG_CRYPTO_XCBC is not set
-+
-+#
-+# Digest
-+#
-+# CONFIG_CRYPTO_CRC32C is not set
-+# CONFIG_CRYPTO_MD4 is not set
-+# CONFIG_CRYPTO_MD5 is not set
-+# CONFIG_CRYPTO_MICHAEL_MIC is not set
-+# CONFIG_CRYPTO_RMD128 is not set
-+# CONFIG_CRYPTO_RMD160 is not set
-+# CONFIG_CRYPTO_RMD256 is not set
-+# CONFIG_CRYPTO_RMD320 is not set
-+# CONFIG_CRYPTO_SHA1 is not set
-+# CONFIG_CRYPTO_SHA256 is not set
-+# CONFIG_CRYPTO_SHA512 is not set
-+# CONFIG_CRYPTO_TGR192 is not set
-+# CONFIG_CRYPTO_WP512 is not set
-+
-+#
-+# Ciphers
-+#
-+# CONFIG_CRYPTO_AES is not set
-+# CONFIG_CRYPTO_ANUBIS is not set
-+# CONFIG_CRYPTO_ARC4 is not set
-+# CONFIG_CRYPTO_BLOWFISH is not set
-+# CONFIG_CRYPTO_CAMELLIA is not set
-+# CONFIG_CRYPTO_CAST5 is not set
-+# CONFIG_CRYPTO_CAST6 is not set
-+# CONFIG_CRYPTO_DES is not set
-+# CONFIG_CRYPTO_FCRYPT is not set
-+# CONFIG_CRYPTO_KHAZAD is not set
-+# CONFIG_CRYPTO_SALSA20 is not set
-+# CONFIG_CRYPTO_SEED is not set
-+# CONFIG_CRYPTO_SERPENT is not set
-+# CONFIG_CRYPTO_TEA is not set
-+# CONFIG_CRYPTO_TWOFISH is not set
-+
-+#
-+# Compression
-+#
-+# CONFIG_CRYPTO_DEFLATE is not set
-+# CONFIG_CRYPTO_LZO is not set
-+
-+#
-+# Random Number Generation
-+#
-+# CONFIG_CRYPTO_ANSI_CPRNG is not set
-+# CONFIG_CRYPTO_HW is not set
-+
-+#
-+# Library routines
-+#
-+CONFIG_GENERIC_FIND_LAST_BIT=y
-+# CONFIG_CRC_CCITT is not set
-+# CONFIG_CRC16 is not set
-+# CONFIG_CRC_T10DIF is not set
-+# CONFIG_CRC_ITU_T is not set
-+# CONFIG_CRC32 is not set
-+# CONFIG_CRC7 is not set
-+# CONFIG_LIBCRC32C is not set
-+CONFIG_PLIST=y
-+CONFIG_HAS_IOMEM=y
-+CONFIG_HAS_DMA=y
-diff -Nur linux-3.4.113.orig/arch/nds32/configs/xc5_8k_defconfig linux-3.4.113/arch/nds32/configs/xc5_8k_defconfig
---- linux-3.4.113.orig/arch/nds32/configs/xc5_8k_defconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/configs/xc5_8k_defconfig 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,1051 @@
-+#
-+# Automatically generated make config: don't edit
-+# Linux kernel version: 2.6.29
-+# Fri Oct 2 14:21:05 2009
-+#
-+CONFIG_NDS32=y
-+# CONFIG_GENERIC_GPIO is not set
-+CONFIG_NO_IOPORT=y
-+CONFIG_GENERIC_IOMAP=y
-+CONFIG_RWSEM_GENERIC_SPINLOCK=y
-+CONFIG_GENERIC_HWEIGHT=y
-+CONFIG_GENERIC_FIND_NEXT_BIT=y
-+CONFIG_GENERIC_CALIBRATE_DELAY=y
-+CONFIG_GENERIC_HARDIRQS=y
-+CONFIG_LOCKDEP_SUPPORT=y
-+CONFIG_STACKTRACE_SUPPORT=y
-+CONFIG_HAVE_LATENCYTOP_SUPPORT=y
-+CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config"
-+
-+#
-+# General setup
-+#
-+CONFIG_EXPERIMENTAL=y
-+CONFIG_BROKEN_ON_SMP=y
-+CONFIG_INIT_ENV_ARG_LIMIT=32
-+CONFIG_LOCALVERSION=""
-+# CONFIG_LOCALVERSION_AUTO is not set
-+CONFIG_SWAP=y
-+CONFIG_SYSVIPC=y
-+CONFIG_SYSVIPC_SYSCTL=y
-+# CONFIG_POSIX_MQUEUE is not set
-+CONFIG_BSD_PROCESS_ACCT=y
-+CONFIG_BSD_PROCESS_ACCT_V3=y
-+# CONFIG_TASKSTATS is not set
-+# CONFIG_AUDIT is not set
-+
-+#
-+# RCU Subsystem
-+#
-+CONFIG_CLASSIC_RCU=y
-+# CONFIG_TREE_RCU is not set
-+# CONFIG_PREEMPT_RCU is not set
-+# CONFIG_TREE_RCU_TRACE is not set
-+# CONFIG_PREEMPT_RCU_TRACE is not set
-+# CONFIG_IKCONFIG is not set
-+CONFIG_LOG_BUF_SHIFT=14
-+# CONFIG_GROUP_SCHED is not set
-+# CONFIG_CGROUPS is not set
-+# CONFIG_SYSFS_DEPRECATED_V2 is not set
-+# CONFIG_RELAY is not set
-+# CONFIG_NAMESPACES is not set
-+CONFIG_BLK_DEV_INITRD=y
-+CONFIG_INITRAMFS_SOURCE=""
-+CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-+CONFIG_SYSCTL=y
-+CONFIG_ANON_INODES=y
-+CONFIG_EMBEDDED=y
-+CONFIG_UID16=y
-+CONFIG_SYSCTL_SYSCALL=y
-+CONFIG_KALLSYMS=y
-+# CONFIG_KALLSYMS_ALL is not set
-+CONFIG_KALLSYMS_EXTRA_PASS=y
-+# CONFIG_HOTPLUG is not set
-+CONFIG_PRINTK=y
-+CONFIG_BUG=y
-+CONFIG_ELF_CORE=y
-+CONFIG_BASE_FULL=y
-+CONFIG_FUTEX=y
-+CONFIG_EPOLL=y
-+# CONFIG_SIGNALFD is not set
-+CONFIG_TIMERFD=y
-+CONFIG_EVENTFD=y
-+CONFIG_SHMEM=y
-+CONFIG_AIO=y
-+# CONFIG_VM_EVENT_COUNTERS is not set
-+CONFIG_SLUB_DEBUG=y
-+CONFIG_COMPAT_BRK=y
-+# CONFIG_SLAB is not set
-+CONFIG_SLUB=y
-+# CONFIG_SLOB is not set
-+CONFIG_PROFILING=y
-+CONFIG_TRACEPOINTS=y
-+# CONFIG_MARKERS is not set
-+CONFIG_OPROFILE=y
-+CONFIG_HAVE_OPROFILE=y
-+# CONFIG_KPROBES is not set
-+CONFIG_HAVE_KPROBES=y
-+CONFIG_HAVE_KRETPROBES=y
-+# CONFIG_HAVE_GENERIC_DMA_COHERENT is not set
-+CONFIG_SLABINFO=y
-+CONFIG_RT_MUTEXES=y
-+CONFIG_BASE_SMALL=0
-+CONFIG_MODULES=y
-+# CONFIG_MODULE_FORCE_LOAD is not set
-+CONFIG_MODULE_UNLOAD=y
-+# CONFIG_MODULE_FORCE_UNLOAD is not set
-+# CONFIG_MODVERSIONS is not set
-+# CONFIG_MODULE_SRCVERSION_ALL is not set
-+CONFIG_BLOCK=y
-+# CONFIG_LBD is not set
-+# CONFIG_BLK_DEV_IO_TRACE is not set
-+# CONFIG_BLK_DEV_BSG is not set
-+# CONFIG_BLK_DEV_INTEGRITY is not set
-+
-+#
-+# IO Schedulers
-+#
-+CONFIG_IOSCHED_NOOP=y
-+CONFIG_IOSCHED_AS=y
-+CONFIG_IOSCHED_DEADLINE=y
-+CONFIG_IOSCHED_CFQ=y
-+# CONFIG_DEFAULT_AS is not set
-+# CONFIG_DEFAULT_DEADLINE is not set
-+CONFIG_DEFAULT_CFQ=y
-+# CONFIG_DEFAULT_NOOP is not set
-+CONFIG_DEFAULT_IOSCHED="cfq"
-+# CONFIG_FREEZER is not set
-+
-+#
-+# System Type
-+#
-+# CONFIG_PLAT_VEP is not set
-+# CONFIG_PLAT_AG101 is not set
-+# CONFIG_PLAT_AG102 is not set
-+CONFIG_PLAT_AG101P=y
-+# CONFIG_PLAT_QEMU is not set
-+CONFIG_PLATFORM_INTC=y
-+CONFIG_ARCH_WANT_OPTIONAL_GPIOLIB=y
-+
-+#
-+# AG101P Platform Options
-+#
-+
-+#
-+# Common Platform Options
-+#
-+CONFIG_PLATFORM_AHBDMA=y
-+CONFIG_PLATFORM_APBDMA=y
-+CONFIG_SYS_CLK=40000000
-+CONFIG_UART_CLK=14745600
-+CONFIG_SDRAM_SIZE=0x10000000
-+
-+#
-+# Processor Features
-+#
-+CONFIG_CPU_CUSTOM=y
-+# CONFIG_FPU is not set
-+# CONFIG_AUDIO is not set
-+# CONFIG_EVIC is not set
-+CONFIG_CPU_CONTEXT_ID=y
-+# CONFIG_CPU_CACHE_NONALIASING is not set
-+# CONFIG_ANDES_PAGE_SIZE_4KB is not set
-+CONFIG_ANDES_PAGE_SIZE_8KB=y
-+CONFIG_KERNEL_SPACE_LARGE_PAGE=y
-+# CONFIG_CPU_ICACHE_DISABLE is not set
-+# CONFIG_CPU_DCACHE_DISABLE is not set
-+# CONFIG_CPU_DCACHE_WRITETHROUGH is not set
-+# CONFIG_ABI1 is not set
-+CONFIG_ALIGNMENT_TRAP=y
-+CONFIG_GENERIC_TIME=y
-+CONFIG_GENERIC_CLOCKEVENTS=y
-+CONFIG_MMU=y
-+
-+#
-+# Kernel Features
-+#
-+# CONFIG_NO_HZ is not set
-+# CONFIG_HIGH_RES_TIMERS is not set
-+CONFIG_GENERIC_CLOCKEVENTS_BUILD=y
-+CONFIG_PREEMPT_NONE=y
-+# CONFIG_PREEMPT_VOLUNTARY is not set
-+# CONFIG_PREEMPT is not set
-+CONFIG_SELECT_MEMORY_MODEL=y
-+CONFIG_FLATMEM_MANUAL=y
-+# CONFIG_DISCONTIGMEM_MANUAL is not set
-+# CONFIG_SPARSEMEM_MANUAL is not set
-+CONFIG_FLATMEM=y
-+CONFIG_FLAT_NODE_MEM_MAP=y
-+CONFIG_PAGEFLAGS_EXTENDED=y
-+CONFIG_SPLIT_PTLOCK_CPUS=4
-+# CONFIG_PHYS_ADDR_T_64BIT is not set
-+CONFIG_ZONE_DMA_FLAG=0
-+CONFIG_VIRT_TO_BUS=y
-+CONFIG_UNEVICTABLE_LRU=y
-+CONFIG_FORCE_MAX_ZONEORDER=11
-+CONFIG_HZ_100=y
-+# CONFIG_HZ_250 is not set
-+# CONFIG_HZ_300 is not set
-+# CONFIG_HZ_1000 is not set
-+CONFIG_HZ=100
-+# CONFIG_SCHED_HRTICK is not set
-+CONFIG_CMDLINE="root=/dev/ram0 rw mem=128M@0x0 initrd=0x1000000,8M console=ttyS0,38400n8 rootfstype=ext2 init=/bin/busybox init -s user_debug=-1"
-+
-+#
-+# Power management options
-+#
-+CONFIG_SYS_SUPPORTS_APM_EMULATION=y
-+CONFIG_ARCH_SUSPEND_POSSIBLE=y
-+# CONFIG_PM is not set
-+
-+#
-+# Bus options
-+#
-+# CONFIG_PCI is not set
-+# CONFIG_ARCH_SUPPORTS_MSI is not set
-+
-+#
-+# Executable file formats
-+#
-+CONFIG_BINFMT_ELF=y
-+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set
-+# CONFIG_HAVE_AOUT is not set
-+# CONFIG_BINFMT_MISC is not set
-+CONFIG_NET=y
-+
-+#
-+# Networking options
-+#
-+CONFIG_COMPAT_NET_DEV_OPS=y
-+CONFIG_PACKET=y
-+# CONFIG_PACKET_MMAP is not set
-+CONFIG_UNIX=y
-+CONFIG_XFRM=y
-+# CONFIG_XFRM_USER is not set
-+# CONFIG_XFRM_SUB_POLICY is not set
-+# CONFIG_XFRM_MIGRATE is not set
-+# CONFIG_XFRM_STATISTICS is not set
-+CONFIG_NET_KEY=y
-+# CONFIG_NET_KEY_MIGRATE is not set
-+CONFIG_INET=y
-+CONFIG_IP_MULTICAST=y
-+# CONFIG_IP_ADVANCED_ROUTER is not set
-+CONFIG_IP_FIB_HASH=y
-+# CONFIG_IP_PNP is not set
-+# CONFIG_NET_IPIP is not set
-+# CONFIG_NET_IPGRE is not set
-+# CONFIG_IP_MROUTE is not set
-+# CONFIG_ARPD is not set
-+# CONFIG_SYN_COOKIES is not set
-+# CONFIG_INET_AH is not set
-+# CONFIG_INET_ESP is not set
-+# CONFIG_INET_IPCOMP is not set
-+# CONFIG_INET_XFRM_TUNNEL is not set
-+# CONFIG_INET_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-+# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_BEET is not set
-+# CONFIG_INET_LRO is not set
-+# CONFIG_INET_DIAG is not set
-+# CONFIG_TCP_CONG_ADVANCED is not set
-+CONFIG_TCP_CONG_CUBIC=y
-+CONFIG_DEFAULT_TCP_CONG="cubic"
-+# CONFIG_TCP_MD5SIG is not set
-+# CONFIG_IPV6 is not set
-+# CONFIG_NETWORK_SECMARK is not set
-+# CONFIG_NETFILTER is not set
-+# CONFIG_IP_DCCP is not set
-+# CONFIG_IP_SCTP is not set
-+# CONFIG_TIPC is not set
-+# CONFIG_ATM is not set
-+# CONFIG_BRIDGE is not set
-+# CONFIG_NET_DSA is not set
-+# CONFIG_VLAN_8021Q is not set
-+# CONFIG_DECNET is not set
-+# CONFIG_LLC2 is not set
-+# CONFIG_IPX is not set
-+# CONFIG_ATALK is not set
-+# CONFIG_X25 is not set
-+# CONFIG_LAPB is not set
-+# CONFIG_ECONET is not set
-+# CONFIG_WAN_ROUTER is not set
-+# CONFIG_NET_SCHED is not set
-+# CONFIG_DCB is not set
-+
-+#
-+# Network testing
-+#
-+# CONFIG_NET_PKTGEN is not set
-+# CONFIG_HAMRADIO is not set
-+# CONFIG_CAN is not set
-+# CONFIG_IRDA is not set
-+# CONFIG_BT is not set
-+# CONFIG_AF_RXRPC is not set
-+# CONFIG_PHONET is not set
-+CONFIG_WIRELESS=y
-+# CONFIG_CFG80211 is not set
-+CONFIG_WIRELESS_OLD_REGULATORY=y
-+# CONFIG_WIRELESS_EXT is not set
-+# CONFIG_LIB80211 is not set
-+# CONFIG_MAC80211 is not set
-+# CONFIG_WIMAX is not set
-+# CONFIG_RFKILL is not set
-+# CONFIG_NET_9P is not set
-+
-+#
-+# Device Drivers
-+#
-+
-+#
-+# Generic Driver Options
-+#
-+CONFIG_STANDALONE=y
-+CONFIG_PREVENT_FIRMWARE_BUILD=y
-+# CONFIG_DEBUG_DRIVER is not set
-+# CONFIG_DEBUG_DEVRES is not set
-+# CONFIG_SYS_HYPERVISOR is not set
-+# CONFIG_CONNECTOR is not set
-+CONFIG_MTD=y
-+# CONFIG_MTD_DEBUG is not set
-+# CONFIG_MTD_CONCAT is not set
-+CONFIG_MTD_PARTITIONS=y
-+# CONFIG_MTD_TESTS is not set
-+# CONFIG_MTD_REDBOOT_PARTS is not set
-+CONFIG_MTD_CMDLINE_PARTS=y
-+# CONFIG_MTD_AR7_PARTS is not set
-+
-+#
-+# User Modules And Translation Layers
-+#
-+CONFIG_MTD_CHAR=y
-+CONFIG_MTD_BLKDEVS=y
-+CONFIG_MTD_BLOCK=y
-+# CONFIG_FTL is not set
-+# CONFIG_NFTL is not set
-+# CONFIG_INFTL is not set
-+# CONFIG_RFD_FTL is not set
-+# CONFIG_SSFDC is not set
-+# CONFIG_MTD_OOPS is not set
-+
-+#
-+# RAM/ROM/Flash chip drivers
-+#
-+CONFIG_MTD_CFI=y
-+# CONFIG_MTD_JEDECPROBE is not set
-+CONFIG_MTD_GEN_PROBE=y
-+# CONFIG_MTD_CFI_ADV_OPTIONS is not set
-+CONFIG_MTD_MAP_BANK_WIDTH_1=y
-+CONFIG_MTD_MAP_BANK_WIDTH_2=y
-+CONFIG_MTD_MAP_BANK_WIDTH_4=y
-+# CONFIG_MTD_MAP_BANK_WIDTH_8 is not set
-+# CONFIG_MTD_MAP_BANK_WIDTH_16 is not set
-+# CONFIG_MTD_MAP_BANK_WIDTH_32 is not set
-+CONFIG_MTD_CFI_I1=y
-+CONFIG_MTD_CFI_I2=y
-+# CONFIG_MTD_CFI_I4 is not set
-+# CONFIG_MTD_CFI_I8 is not set
-+CONFIG_MTD_CFI_INTELEXT=y
-+# CONFIG_MTD_CFI_AMDSTD is not set
-+# CONFIG_MTD_CFI_STAA is not set
-+CONFIG_MTD_CFI_UTIL=y
-+# CONFIG_MTD_RAM is not set
-+# CONFIG_MTD_ROM is not set
-+# CONFIG_MTD_ABSENT is not set
-+
-+#
-+# Mapping drivers for chip access
-+#
-+# CONFIG_MTD_COMPLEX_MAPPINGS is not set
-+CONFIG_MTD_PHYSMAP=y
-+CONFIG_MTD_PHYSMAP_COMPAT=y
-+CONFIG_MTD_PHYSMAP_START=0x80400000
-+CONFIG_MTD_PHYSMAP_LEN=0x2000000
-+CONFIG_MTD_PHYSMAP_BANKWIDTH=4
-+# CONFIG_MTD_PLATRAM is not set
-+
-+#
-+# Self-contained MTD device drivers
-+#
-+# CONFIG_MTD_SLRAM is not set
-+# CONFIG_MTD_PHRAM is not set
-+# CONFIG_MTD_MTDRAM is not set
-+# CONFIG_MTD_BLOCK2MTD is not set
-+
-+#
-+# Disk-On-Chip Device Drivers
-+#
-+# CONFIG_MTD_DOC2000 is not set
-+# CONFIG_MTD_DOC2001 is not set
-+# CONFIG_MTD_DOC2001PLUS is not set
-+# CONFIG_MTD_NAND is not set
-+# CONFIG_MTD_ONENAND is not set
-+
-+#
-+# LPDDR flash memory drivers
-+#
-+# CONFIG_MTD_LPDDR is not set
-+
-+#
-+# UBI - Unsorted block images
-+#
-+# CONFIG_MTD_UBI is not set
-+# CONFIG_PARPORT is not set
-+CONFIG_BLK_DEV=y
-+# CONFIG_BLK_DEV_COW_COMMON is not set
-+CONFIG_BLK_DEV_LOOP=y
-+# CONFIG_BLK_DEV_CRYPTOLOOP is not set
-+# CONFIG_BLK_DEV_NBD is not set
-+CONFIG_BLK_DEV_RAM=y
-+CONFIG_BLK_DEV_RAM_COUNT=16
-+CONFIG_BLK_DEV_RAM_SIZE=8192
-+# CONFIG_BLK_DEV_XIP is not set
-+# CONFIG_CDROM_PKTCDVD is not set
-+# CONFIG_ATA_OVER_ETH is not set
-+CONFIG_FTSDC010=y
-+# CONFIG_FTCFC010 is not set
-+# CONFIG_BLK_DEV_HD is not set
-+# CONFIG_MISC_DEVICES is not set
-+CONFIG_HAVE_IDE=y
-+# CONFIG_IDE is not set
-+
-+#
-+# SCSI device support
-+#
-+# CONFIG_RAID_ATTRS is not set
-+# CONFIG_SCSI is not set
-+# CONFIG_SCSI_DMA is not set
-+# CONFIG_SCSI_NETLINK is not set
-+# CONFIG_ATA is not set
-+# CONFIG_MD is not set
-+CONFIG_NETDEVICES=y
-+# CONFIG_DUMMY is not set
-+# CONFIG_BONDING is not set
-+# CONFIG_MACVLAN is not set
-+# CONFIG_EQUALIZER is not set
-+# CONFIG_TUN is not set
-+# CONFIG_VETH is not set
-+# CONFIG_PHYLIB is not set
-+CONFIG_NET_ETHERNET=y
-+# CONFIG_MII is not set
-+# CONFIG_SMC91X is not set
-+# CONFIG_DNET is not set
-+# CONFIG_IBM_NEW_EMAC_ZMII is not set
-+# CONFIG_IBM_NEW_EMAC_RGMII is not set
-+# CONFIG_IBM_NEW_EMAC_TAH is not set
-+# CONFIG_IBM_NEW_EMAC_EMAC4 is not set
-+# CONFIG_IBM_NEW_EMAC_NO_FLOW_CTRL is not set
-+# CONFIG_IBM_NEW_EMAC_MAL_CLR_ICINTSTAT is not set
-+# CONFIG_IBM_NEW_EMAC_MAL_COMMON_ERR is not set
-+# CONFIG_B44 is not set
-+CONFIG_FTMAC100=y
-+# CONFIG_NETDEV_1000 is not set
-+# CONFIG_NETDEV_10000 is not set
-+
-+#
-+# Wireless LAN
-+#
-+# CONFIG_WLAN_PRE80211 is not set
-+# CONFIG_WLAN_80211 is not set
-+# CONFIG_IWLWIFI_LEDS is not set
-+
-+#
-+# Enable WiMAX (Networking options) to see the WiMAX drivers
-+#
-+# CONFIG_WAN is not set
-+# CONFIG_PPP is not set
-+# CONFIG_SLIP is not set
-+# CONFIG_NETCONSOLE is not set
-+# CONFIG_NETPOLL is not set
-+# CONFIG_NET_POLL_CONTROLLER is not set
-+# CONFIG_ISDN is not set
-+# CONFIG_PHONE is not set
-+
-+#
-+# Input device support
-+#
-+CONFIG_INPUT=y
-+# CONFIG_INPUT_FF_MEMLESS is not set
-+# CONFIG_INPUT_POLLDEV is not set
-+
-+#
-+# Userland interfaces
-+#
-+# CONFIG_INPUT_MOUSEDEV is not set
-+# CONFIG_INPUT_JOYDEV is not set
-+CONFIG_INPUT_EVDEV=y
-+# CONFIG_INPUT_EVBUG is not set
-+
-+#
-+# Input Device Drivers
-+#
-+# CONFIG_INPUT_KEYBOARD is not set
-+# CONFIG_INPUT_MOUSE is not set
-+# CONFIG_INPUT_JOYSTICK is not set
-+# CONFIG_INPUT_TABLET is not set
-+CONFIG_INPUT_TOUCHSCREEN=y
-+CONFIG_TOUCHSCREEN_CPE_TS=y
-+CONFIG_TOUCHSCREEN_CPE_TS_DEJITTER=y
-+# CONFIG_TOUCHSCREEN_FUJITSU is not set
-+# CONFIG_TOUCHSCREEN_GUNZE is not set
-+# CONFIG_TOUCHSCREEN_ELO is not set
-+# CONFIG_TOUCHSCREEN_WACOM_W8001 is not set
-+# CONFIG_TOUCHSCREEN_MTOUCH is not set
-+# CONFIG_TOUCHSCREEN_INEXIO is not set
-+# CONFIG_TOUCHSCREEN_MK712 is not set
-+# CONFIG_TOUCHSCREEN_PENMOUNT is not set
-+# CONFIG_TOUCHSCREEN_TOUCHRIGHT is not set
-+# CONFIG_TOUCHSCREEN_TOUCHWIN is not set
-+# CONFIG_TOUCHSCREEN_TOUCHIT213 is not set
-+# CONFIG_INPUT_MISC is not set
-+
-+#
-+# Hardware I/O ports
-+#
-+# CONFIG_SERIO is not set
-+# CONFIG_GAMEPORT is not set
-+
-+#
-+# Character devices
-+#
-+CONFIG_VT=y
-+CONFIG_CONSOLE_TRANSLATIONS=y
-+CONFIG_VT_CONSOLE=y
-+CONFIG_HW_CONSOLE=y
-+# CONFIG_VT_HW_CONSOLE_BINDING is not set
-+CONFIG_DEVKMEM=y
-+# CONFIG_SERIAL_NONSTANDARD is not set
-+
-+#
-+# Serial drivers
-+#
-+CONFIG_SERIAL_8250=y
-+CONFIG_SERIAL_8250_CONSOLE=y
-+CONFIG_SERIAL_8250_NR_UARTS=3
-+CONFIG_SERIAL_8250_RUNTIME_UARTS=3
-+# CONFIG_SERIAL_8250_EXTENDED is not set
-+
-+#
-+# Non-8250 serial port support
-+#
-+CONFIG_SERIAL_CORE=y
-+CONFIG_SERIAL_CORE_CONSOLE=y
-+CONFIG_UNIX98_PTYS=y
-+# CONFIG_DEVPTS_MULTIPLE_INSTANCES is not set
-+CONFIG_LEGACY_PTYS=y
-+CONFIG_LEGACY_PTY_COUNT=256
-+# CONFIG_IPMI_HANDLER is not set
-+# CONFIG_HW_RANDOM is not set
-+# CONFIG_R3964 is not set
-+# CONFIG_GPIO_FTGPIO010_OLD is not set
-+# CONFIG_RAW_DRIVER is not set
-+# CONFIG_TCG_TPM is not set
-+# CONFIG_I2C is not set
-+# CONFIG_SPI is not set
-+# CONFIG_GPIOLIB is not set
-+# CONFIG_W1 is not set
-+# CONFIG_POWER_SUPPLY is not set
-+# CONFIG_HWMON is not set
-+# CONFIG_THERMAL is not set
-+# CONFIG_THERMAL_HWMON is not set
-+# CONFIG_WATCHDOG is not set
-+CONFIG_SSB_POSSIBLE=y
-+
-+#
-+# Sonics Silicon Backplane
-+#
-+# CONFIG_SSB is not set
-+
-+#
-+# Multifunction device drivers
-+#
-+# CONFIG_MFD_CORE is not set
-+# CONFIG_MFD_SM501 is not set
-+# CONFIG_HTC_PASIC3 is not set
-+# CONFIG_MFD_TMIO is not set
-+# CONFIG_REGULATOR is not set
-+
-+#
-+# Multimedia devices
-+#
-+
-+#
-+# Multimedia core support
-+#
-+# CONFIG_VIDEO_DEV is not set
-+# CONFIG_DVB_CORE is not set
-+# CONFIG_VIDEO_MEDIA is not set
-+
-+#
-+# Multimedia drivers
-+#
-+# CONFIG_DAB is not set
-+
-+#
-+# Graphics support
-+#
-+# CONFIG_VGASTATE is not set
-+# CONFIG_VIDEO_OUTPUT_CONTROL is not set
-+CONFIG_FB=y
-+# CONFIG_FIRMWARE_EDID is not set
-+# CONFIG_FB_DDC is not set
-+# CONFIG_FB_BOOT_VESA_SUPPORT is not set
-+CONFIG_FB_CFB_FILLRECT=y
-+CONFIG_FB_CFB_COPYAREA=y
-+CONFIG_FB_CFB_IMAGEBLIT=y
-+# CONFIG_FB_CFB_REV_PIXELS_IN_BYTE is not set
-+# CONFIG_FB_SYS_FILLRECT is not set
-+# CONFIG_FB_SYS_COPYAREA is not set
-+# CONFIG_FB_SYS_IMAGEBLIT is not set
-+# CONFIG_FB_FOREIGN_ENDIAN is not set
-+# CONFIG_FB_SYS_FOPS is not set
-+# CONFIG_FB_SVGALIB is not set
-+# CONFIG_FB_MACMODES is not set
-+# CONFIG_FB_BACKLIGHT is not set
-+# CONFIG_FB_MODE_HELPERS is not set
-+# CONFIG_FB_TILEBLITTING is not set
-+
-+#
-+# Frame buffer hardware drivers
-+#
-+# CONFIG_FB_S1D13XXX is not set
-+CONFIG_FB_FTLCDC100=y
-+CONFIG_PANEL_AUA036QN01=y
-+# CONFIG_PANEL_CH7013A is not set
-+# CONFIG_PANEL_AUA070VW04 is not set
-+# CONFIG_PANEL_LW500AC9601 is not set
-+CONFIG_FFB_MODE_RGB=y
-+# CONFIG_FFB_MODE_YUV422 is not set
-+# CONFIG_FFB_MODE_YUV420 is not set
-+# CONFIG_FFB_MODE_8BPP is not set
-+CONFIG_FFB_MODE_16BPP=y
-+# CONFIG_FFB_MODE_24BPP is not set
-+# CONFIG_FB_VIRTUAL is not set
-+# CONFIG_FB_METRONOME is not set
-+# CONFIG_FB_MB862XX is not set
-+# CONFIG_BACKLIGHT_LCD_SUPPORT is not set
-+
-+#
-+# Display device support
-+#
-+# CONFIG_DISPLAY_SUPPORT is not set
-+
-+#
-+# Console display driver support
-+#
-+# CONFIG_VGA_CONSOLE is not set
-+CONFIG_DUMMY_CONSOLE=y
-+CONFIG_FRAMEBUFFER_CONSOLE=y
-+# CONFIG_FRAMEBUFFER_CONSOLE_DETECT_PRIMARY is not set
-+# CONFIG_FRAMEBUFFER_CONSOLE_ROTATION is not set
-+# CONFIG_FONTS is not set
-+CONFIG_FONT_8x8=y
-+CONFIG_FONT_8x16=y
-+CONFIG_LOGO=y
-+CONFIG_LOGO_LINUX_MONO=y
-+CONFIG_LOGO_LINUX_VGA16=y
-+CONFIG_LOGO_LINUX_CLUT224=y
-+CONFIG_SOUND=y
-+CONFIG_SOUND_OSS_CORE=y
-+CONFIG_SND=y
-+CONFIG_SND_TIMER=y
-+CONFIG_SND_PCM=y
-+# CONFIG_SND_SEQUENCER is not set
-+CONFIG_SND_OSSEMUL=y
-+# CONFIG_SND_MIXER_OSS is not set
-+CONFIG_SND_PCM_OSS=y
-+CONFIG_SND_PCM_OSS_PLUGINS=y
-+# CONFIG_SND_DYNAMIC_MINORS is not set
-+# CONFIG_SND_SUPPORT_OLD_API is not set
-+# CONFIG_SND_VERBOSE_PROCFS is not set
-+# CONFIG_SND_VERBOSE_PRINTK is not set
-+# CONFIG_SND_DEBUG is not set
-+CONFIG_SND_DRIVERS=y
-+# CONFIG_SND_DUMMY is not set
-+# CONFIG_SND_MTPAV is not set
-+# CONFIG_SND_SERIAL_U16550 is not set
-+# CONFIG_SND_MPU401 is not set
-+
-+#
-+# ALSA NDS32 devices
-+#
-+CONFIG_SND_FTSSP010=y
-+CONFIG_SND_FTSSP010_AC97=y
-+# CONFIG_SND_FTSSP010_I2S is not set
-+# CONFIG_SND_SOC is not set
-+# CONFIG_SOUND_PRIME is not set
-+# CONFIG_HID_SUPPORT is not set
-+# CONFIG_USB_SUPPORT is not set
-+# CONFIG_MMC is not set
-+# CONFIG_MEMSTICK is not set
-+# CONFIG_NEW_LEDS is not set
-+# CONFIG_ACCESSIBILITY is not set
-+CONFIG_RTC_LIB=y
-+CONFIG_RTC_CLASS=y
-+# CONFIG_RTC_HCTOSYS is not set
-+# CONFIG_RTC_DEBUG is not set
-+
-+#
-+# RTC interfaces
-+#
-+CONFIG_RTC_INTF_SYSFS=y
-+CONFIG_RTC_INTF_PROC=y
-+CONFIG_RTC_INTF_DEV=y
-+# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set
-+# CONFIG_RTC_DRV_TEST is not set
-+
-+#
-+# SPI RTC drivers
-+#
-+
-+#
-+# Platform RTC drivers
-+#
-+# CONFIG_RTC_DRV_DS1286 is not set
-+# CONFIG_RTC_DRV_DS1511 is not set
-+# CONFIG_RTC_DRV_DS1553 is not set
-+# CONFIG_RTC_DRV_DS1742 is not set
-+# CONFIG_RTC_DRV_STK17TA8 is not set
-+# CONFIG_RTC_DRV_M48T86 is not set
-+# CONFIG_RTC_DRV_M48T35 is not set
-+# CONFIG_RTC_DRV_M48T59 is not set
-+# CONFIG_RTC_DRV_BQ4802 is not set
-+# CONFIG_RTC_DRV_V3020 is not set
-+
-+#
-+# on-CPU RTC drivers
-+#
-+CONFIG_RTC_DRV_FTRTC010=y
-+# CONFIG_DMADEVICES is not set
-+# CONFIG_UIO is not set
-+# CONFIG_STAGING is not set
-+
-+#
-+# File systems
-+#
-+CONFIG_EXT2_FS=y
-+# CONFIG_EXT2_FS_XATTR is not set
-+# CONFIG_EXT2_FS_XIP is not set
-+# CONFIG_EXT3_FS is not set
-+# CONFIG_EXT4_FS is not set
-+# CONFIG_REISERFS_FS is not set
-+# CONFIG_JFS_FS is not set
-+# CONFIG_FS_POSIX_ACL is not set
-+CONFIG_FILE_LOCKING=y
-+# CONFIG_XFS_FS is not set
-+# CONFIG_OCFS2_FS is not set
-+# CONFIG_BTRFS_FS is not set
-+CONFIG_DNOTIFY=y
-+CONFIG_INOTIFY=y
-+CONFIG_INOTIFY_USER=y
-+# CONFIG_QUOTA is not set
-+# CONFIG_AUTOFS_FS is not set
-+# CONFIG_AUTOFS4_FS is not set
-+CONFIG_FUSE_FS=y
-+
-+#
-+# CD-ROM/DVD Filesystems
-+#
-+# CONFIG_ISO9660_FS is not set
-+# CONFIG_UDF_FS is not set
-+
-+#
-+# DOS/FAT/NT Filesystems
-+#
-+CONFIG_FAT_FS=y
-+CONFIG_MSDOS_FS=y
-+CONFIG_VFAT_FS=y
-+CONFIG_FAT_DEFAULT_CODEPAGE=437
-+CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1"
-+# CONFIG_NTFS_FS is not set
-+
-+#
-+# Pseudo filesystems
-+#
-+CONFIG_PROC_FS=y
-+# CONFIG_PROC_KCORE is not set
-+CONFIG_PROC_SYSCTL=y
-+# CONFIG_PROC_PAGE_MONITOR is not set
-+CONFIG_SYSFS=y
-+CONFIG_TMPFS=y
-+# CONFIG_TMPFS_POSIX_ACL is not set
-+# CONFIG_HUGETLB_PAGE is not set
-+# CONFIG_CONFIGFS_FS is not set
-+CONFIG_MISC_FILESYSTEMS=y
-+# CONFIG_ADFS_FS is not set
-+# CONFIG_AFFS_FS is not set
-+# CONFIG_HFS_FS is not set
-+# CONFIG_HFSPLUS_FS is not set
-+# CONFIG_BEFS_FS is not set
-+# CONFIG_BFS_FS is not set
-+# CONFIG_EFS_FS is not set
-+CONFIG_JFFS2_FS=y
-+CONFIG_JFFS2_FS_DEBUG=0
-+CONFIG_JFFS2_FS_WRITEBUFFER=y
-+# CONFIG_JFFS2_FS_WBUF_VERIFY is not set
-+# CONFIG_JFFS2_SUMMARY is not set
-+# CONFIG_JFFS2_FS_XATTR is not set
-+# CONFIG_JFFS2_COMPRESSION_OPTIONS is not set
-+CONFIG_JFFS2_ZLIB=y
-+# CONFIG_JFFS2_LZO is not set
-+CONFIG_JFFS2_RTIME=y
-+# CONFIG_JFFS2_RUBIN is not set
-+# CONFIG_CRAMFS is not set
-+# CONFIG_SQUASHFS is not set
-+# CONFIG_VXFS_FS is not set
-+# CONFIG_MINIX_FS is not set
-+# CONFIG_OMFS_FS is not set
-+# CONFIG_HPFS_FS is not set
-+# CONFIG_QNX4FS_FS is not set
-+# CONFIG_ROMFS_FS is not set
-+# CONFIG_SYSV_FS is not set
-+# CONFIG_UFS_FS is not set
-+CONFIG_NETWORK_FILESYSTEMS=y
-+CONFIG_NFS_FS=y
-+CONFIG_NFS_V3=y
-+# CONFIG_NFS_V3_ACL is not set
-+# CONFIG_NFS_V4 is not set
-+# CONFIG_NFSD is not set
-+CONFIG_LOCKD=y
-+CONFIG_LOCKD_V4=y
-+CONFIG_NFS_COMMON=y
-+CONFIG_SUNRPC=y
-+# CONFIG_SUNRPC_REGISTER_V4 is not set
-+# CONFIG_RPCSEC_GSS_KRB5 is not set
-+# CONFIG_RPCSEC_GSS_SPKM3 is not set
-+# CONFIG_SMB_FS is not set
-+# CONFIG_CIFS is not set
-+# CONFIG_NCP_FS is not set
-+# CONFIG_CODA_FS is not set
-+# CONFIG_AFS_FS is not set
-+
-+#
-+# Partition Types
-+#
-+# CONFIG_PARTITION_ADVANCED is not set
-+CONFIG_MSDOS_PARTITION=y
-+CONFIG_NLS=y
-+CONFIG_NLS_DEFAULT="iso8859-1"
-+CONFIG_NLS_CODEPAGE_437=y
-+# CONFIG_NLS_CODEPAGE_737 is not set
-+# CONFIG_NLS_CODEPAGE_775 is not set
-+# CONFIG_NLS_CODEPAGE_850 is not set
-+# CONFIG_NLS_CODEPAGE_852 is not set
-+# CONFIG_NLS_CODEPAGE_855 is not set
-+# CONFIG_NLS_CODEPAGE_857 is not set
-+# CONFIG_NLS_CODEPAGE_860 is not set
-+# CONFIG_NLS_CODEPAGE_861 is not set
-+# CONFIG_NLS_CODEPAGE_862 is not set
-+# CONFIG_NLS_CODEPAGE_863 is not set
-+# CONFIG_NLS_CODEPAGE_864 is not set
-+# CONFIG_NLS_CODEPAGE_865 is not set
-+# CONFIG_NLS_CODEPAGE_866 is not set
-+# CONFIG_NLS_CODEPAGE_869 is not set
-+# CONFIG_NLS_CODEPAGE_936 is not set
-+# CONFIG_NLS_CODEPAGE_950 is not set
-+# CONFIG_NLS_CODEPAGE_932 is not set
-+# CONFIG_NLS_CODEPAGE_949 is not set
-+# CONFIG_NLS_CODEPAGE_874 is not set
-+# CONFIG_NLS_ISO8859_8 is not set
-+# CONFIG_NLS_CODEPAGE_1250 is not set
-+# CONFIG_NLS_CODEPAGE_1251 is not set
-+# CONFIG_NLS_ASCII is not set
-+CONFIG_NLS_ISO8859_1=y
-+# CONFIG_NLS_ISO8859_2 is not set
-+# CONFIG_NLS_ISO8859_3 is not set
-+# CONFIG_NLS_ISO8859_4 is not set
-+# CONFIG_NLS_ISO8859_5 is not set
-+# CONFIG_NLS_ISO8859_6 is not set
-+# CONFIG_NLS_ISO8859_7 is not set
-+# CONFIG_NLS_ISO8859_9 is not set
-+# CONFIG_NLS_ISO8859_13 is not set
-+# CONFIG_NLS_ISO8859_14 is not set
-+# CONFIG_NLS_ISO8859_15 is not set
-+# CONFIG_NLS_KOI8_R is not set
-+# CONFIG_NLS_KOI8_U is not set
-+# CONFIG_NLS_UTF8 is not set
-+# CONFIG_DLM is not set
-+
-+#
-+# Kernel hacking
-+#
-+CONFIG_TRACE_IRQFLAGS_SUPPORT=y
-+# CONFIG_PRINTK_TIME is not set
-+CONFIG_ENABLE_WARN_DEPRECATED=y
-+CONFIG_ENABLE_MUST_CHECK=y
-+CONFIG_FRAME_WARN=1024
-+CONFIG_MAGIC_SYSRQ=y
-+# CONFIG_UNUSED_SYMBOLS is not set
-+CONFIG_DEBUG_FS=y
-+# CONFIG_HEADERS_CHECK is not set
-+CONFIG_DEBUG_KERNEL=y
-+CONFIG_DEBUG_SHIRQ=y
-+CONFIG_DETECT_SOFTLOCKUP=y
-+# CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC is not set
-+CONFIG_BOOTPARAM_SOFTLOCKUP_PANIC_VALUE=0
-+CONFIG_SCHED_DEBUG=y
-+CONFIG_SCHEDSTATS=y
-+CONFIG_TIMER_STATS=y
-+# CONFIG_DEBUG_OBJECTS is not set
-+# CONFIG_SLUB_DEBUG_ON is not set
-+# CONFIG_SLUB_STATS is not set
-+CONFIG_DEBUG_RT_MUTEXES=y
-+CONFIG_DEBUG_PI_LIST=y
-+# CONFIG_RT_MUTEX_TESTER is not set
-+CONFIG_DEBUG_SPINLOCK=y
-+CONFIG_DEBUG_MUTEXES=y
-+# CONFIG_DEBUG_LOCK_ALLOC is not set
-+# CONFIG_PROVE_LOCKING is not set
-+# CONFIG_LOCK_STAT is not set
-+CONFIG_DEBUG_SPINLOCK_SLEEP=y
-+# CONFIG_DEBUG_LOCKING_API_SELFTESTS is not set
-+CONFIG_STACKTRACE=y
-+# CONFIG_DEBUG_KOBJECT is not set
-+CONFIG_DEBUG_INFO=y
-+# CONFIG_DEBUG_VM is not set
-+# CONFIG_DEBUG_WRITECOUNT is not set
-+# CONFIG_DEBUG_MEMORY_INIT is not set
-+CONFIG_DEBUG_LIST=y
-+CONFIG_DEBUG_SG=y
-+# CONFIG_DEBUG_NOTIFIERS is not set
-+CONFIG_FRAME_POINTER=y
-+# CONFIG_BOOT_PRINTK_DELAY is not set
-+# CONFIG_RCU_TORTURE_TEST is not set
-+# CONFIG_RCU_CPU_STALL_DETECTOR is not set
-+# CONFIG_BACKTRACE_SELF_TEST is not set
-+# CONFIG_DEBUG_BLOCK_EXT_DEVT is not set
-+# CONFIG_FAULT_INJECTION is not set
-+# CONFIG_LATENCYTOP is not set
-+CONFIG_SYSCTL_SYSCALL_CHECK=y
-+CONFIG_NOP_TRACER=y
-+CONFIG_RING_BUFFER=y
-+CONFIG_TRACING=y
-+
-+#
-+# Tracers
-+#
-+# CONFIG_IRQSOFF_TRACER is not set
-+# CONFIG_SCHED_TRACER is not set
-+# CONFIG_CONTEXT_SWITCH_TRACER is not set
-+# CONFIG_BOOT_TRACER is not set
-+# CONFIG_TRACE_BRANCH_PROFILING is not set
-+# CONFIG_FTRACE_STARTUP_TEST is not set
-+# CONFIG_DYNAMIC_PRINTK_DEBUG is not set
-+# CONFIG_SAMPLES is not set
-+CONFIG_HAVE_ARCH_KGDB=y
-+# CONFIG_KGDB is not set
-+CONFIG_DEBUG_USER=y
-+CONFIG_DEBUG_ERRORS=y
-+# CONFIG_DEBUG_LL is not set
-+# CONFIG_CCTL is not set
-+# CONFIG_ELFCHK_DEFAULT_ENABLE is not set
-+
-+#
-+# Security options
-+#
-+# CONFIG_KEYS is not set
-+# CONFIG_SECURITY is not set
-+# CONFIG_SECURITYFS is not set
-+# CONFIG_SECURITY_FILE_CAPABILITIES is not set
-+CONFIG_CRYPTO=y
-+
-+#
-+# Crypto core or helper
-+#
-+# CONFIG_CRYPTO_FIPS is not set
-+# CONFIG_CRYPTO_MANAGER is not set
-+# CONFIG_CRYPTO_MANAGER2 is not set
-+# CONFIG_CRYPTO_GF128MUL is not set
-+# CONFIG_CRYPTO_NULL is not set
-+# CONFIG_CRYPTO_CRYPTD is not set
-+# CONFIG_CRYPTO_AUTHENC is not set
-+# CONFIG_CRYPTO_TEST is not set
-+
-+#
-+# Authenticated Encryption with Associated Data
-+#
-+# CONFIG_CRYPTO_CCM is not set
-+# CONFIG_CRYPTO_GCM is not set
-+# CONFIG_CRYPTO_SEQIV is not set
-+
-+#
-+# Block modes
-+#
-+# CONFIG_CRYPTO_CBC is not set
-+# CONFIG_CRYPTO_CTR is not set
-+# CONFIG_CRYPTO_CTS is not set
-+# CONFIG_CRYPTO_ECB is not set
-+# CONFIG_CRYPTO_LRW is not set
-+# CONFIG_CRYPTO_PCBC is not set
-+# CONFIG_CRYPTO_XTS is not set
-+
-+#
-+# Hash modes
-+#
-+# CONFIG_CRYPTO_HMAC is not set
-+# CONFIG_CRYPTO_XCBC is not set
-+
-+#
-+# Digest
-+#
-+# CONFIG_CRYPTO_CRC32C is not set
-+# CONFIG_CRYPTO_MD4 is not set
-+# CONFIG_CRYPTO_MD5 is not set
-+# CONFIG_CRYPTO_MICHAEL_MIC is not set
-+# CONFIG_CRYPTO_RMD128 is not set
-+# CONFIG_CRYPTO_RMD160 is not set
-+# CONFIG_CRYPTO_RMD256 is not set
-+# CONFIG_CRYPTO_RMD320 is not set
-+# CONFIG_CRYPTO_SHA1 is not set
-+# CONFIG_CRYPTO_SHA256 is not set
-+# CONFIG_CRYPTO_SHA512 is not set
-+# CONFIG_CRYPTO_TGR192 is not set
-+# CONFIG_CRYPTO_WP512 is not set
-+
-+#
-+# Ciphers
-+#
-+# CONFIG_CRYPTO_AES is not set
-+# CONFIG_CRYPTO_ANUBIS is not set
-+# CONFIG_CRYPTO_ARC4 is not set
-+# CONFIG_CRYPTO_BLOWFISH is not set
-+# CONFIG_CRYPTO_CAMELLIA is not set
-+# CONFIG_CRYPTO_CAST5 is not set
-+# CONFIG_CRYPTO_CAST6 is not set
-+# CONFIG_CRYPTO_DES is not set
-+# CONFIG_CRYPTO_FCRYPT is not set
-+# CONFIG_CRYPTO_KHAZAD is not set
-+# CONFIG_CRYPTO_SALSA20 is not set
-+# CONFIG_CRYPTO_SEED is not set
-+# CONFIG_CRYPTO_SERPENT is not set
-+# CONFIG_CRYPTO_TEA is not set
-+# CONFIG_CRYPTO_TWOFISH is not set
-+
-+#
-+# Compression
-+#
-+# CONFIG_CRYPTO_DEFLATE is not set
-+# CONFIG_CRYPTO_LZO is not set
-+
-+#
-+# Random Number Generation
-+#
-+# CONFIG_CRYPTO_ANSI_CPRNG is not set
-+# CONFIG_CRYPTO_HW is not set
-+
-+#
-+# Library routines
-+#
-+CONFIG_BITREVERSE=y
-+CONFIG_GENERIC_FIND_LAST_BIT=y
-+# CONFIG_CRC_CCITT is not set
-+# CONFIG_CRC16 is not set
-+# CONFIG_CRC_T10DIF is not set
-+# CONFIG_CRC_ITU_T is not set
-+CONFIG_CRC32=y
-+# CONFIG_CRC7 is not set
-+# CONFIG_LIBCRC32C is not set
-+CONFIG_ZLIB_INFLATE=y
-+CONFIG_ZLIB_DEFLATE=y
-+CONFIG_PLIST=y
-+CONFIG_HAS_IOMEM=y
-+CONFIG_HAS_DMA=y
-diff -Nur linux-3.4.113.orig/arch/nds32/configs/xc5_defconfig linux-3.4.113/arch/nds32/configs/xc5_defconfig
---- linux-3.4.113.orig/arch/nds32/configs/xc5_defconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/configs/xc5_defconfig 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,117 @@
-+CONFIG_EXPERIMENTAL=y
-+CONFIG_CROSS_COMPILE="nds32le-linux-"
-+# CONFIG_LOCALVERSION_AUTO is not set
-+CONFIG_SYSVIPC=y
-+CONFIG_BSD_PROCESS_ACCT=y
-+CONFIG_BSD_PROCESS_ACCT_V3=y
-+CONFIG_IKCONFIG=y
-+CONFIG_IKCONFIG_PROC=y
-+CONFIG_LOG_BUF_SHIFT=14
-+CONFIG_BLK_DEV_INITRD=y
-+CONFIG_INITRAMFS_SOURCE="/home/users/greentime/os/ramdisk/disk-nds32le-linux-glibc-v3 /home/users/greentime/os/ramdisk/disk-nds32le-linux-glibc-v3/dev/initramfs.devnodes"
-+CONFIG_CC_OPTIMIZE_FOR_SIZE=y
-+CONFIG_SYSCTL_SYSCALL=y
-+# CONFIG_HOTPLUG is not set
-+# CONFIG_SIGNALFD is not set
-+CONFIG_EMBEDDED=y
-+# CONFIG_VM_EVENT_COUNTERS is not set
-+CONFIG_PROFILING=y
-+CONFIG_OPROFILE=y
-+CONFIG_MODULES=y
-+CONFIG_MODULE_UNLOAD=y
-+# CONFIG_BLK_DEV_BSG is not set
-+CONFIG_PLATFORM_AHBDMA=y
-+CONFIG_PLATFORM_APBDMA=y
-+CONFIG_SYS_CLK=30000000
-+CONFIG_UART_CLK=14745600
-+CONFIG_SDRAM_SIZE=0x8000000
-+CONFIG_HZ_100=y
-+CONFIG_CMDLINE="root=/dev/ram0 rw mem=128M@0x0 initrd=0x1000000,8M console=ttyS0,38400n8 earlyprintk=uart8250-32bit,0x99600000 rootfstype=ext2 init=/bin/busybox init -s user_debug=-1"
-+# CONFIG_CORE_DUMP_DEFAULT_ELF_HEADERS is not set
-+CONFIG_NET=y
-+CONFIG_PACKET=y
-+CONFIG_UNIX=y
-+CONFIG_NET_KEY=y
-+CONFIG_INET=y
-+CONFIG_IP_MULTICAST=y
-+# CONFIG_INET_XFRM_MODE_TRANSPORT is not set
-+# CONFIG_INET_XFRM_MODE_TUNNEL is not set
-+# CONFIG_INET_XFRM_MODE_BEET is not set
-+# CONFIG_INET_LRO is not set
-+# CONFIG_INET_DIAG is not set
-+# CONFIG_IPV6 is not set
-+CONFIG_BRIDGE=y
-+CONFIG_MTD=y
-+CONFIG_MTD_CMDLINE_PARTS=y
-+CONFIG_MTD_CHAR=y
-+CONFIG_MTD_BLOCK=y
-+CONFIG_MTD_CFI=y
-+CONFIG_MTD_CFI_INTELEXT=y
-+CONFIG_MTD_PHYSMAP=y
-+CONFIG_MTD_PHYSMAP_COMPAT=y
-+CONFIG_MTD_PHYSMAP_START=0x80400000
-+CONFIG_MTD_PHYSMAP_LEN=0x2000000
-+CONFIG_MTD_PHYSMAP_BANKWIDTH=4
-+CONFIG_BLK_DEV_LOOP=y
-+CONFIG_BLK_DEV_RAM=y
-+CONFIG_BLK_DEV_RAM_SIZE=8192
-+CONFIG_NETDEVICES=y
-+CONFIG_TUN=y
-+CONFIG_FTMAC100=y
-+# CONFIG_INPUT_MOUSEDEV is not set
-+CONFIG_INPUT_EVDEV=y
-+# CONFIG_INPUT_KEYBOARD is not set
-+# CONFIG_INPUT_MOUSE is not set
-+CONFIG_INPUT_TOUCHSCREEN=y
-+# CONFIG_SERIO is not set
-+CONFIG_SERIAL_8250=y
-+CONFIG_SERIAL_8250_CONSOLE=y
-+CONFIG_SERIAL_8250_NR_UARTS=3
-+CONFIG_SERIAL_8250_RUNTIME_UARTS=3
-+# CONFIG_HW_RANDOM is not set
-+# CONFIG_HWMON is not set
-+CONFIG_FB=y
-+# CONFIG_VGA_CONSOLE is not set
-+CONFIG_FRAMEBUFFER_CONSOLE=y
-+CONFIG_LOGO=y
-+CONFIG_SOUND=y
-+CONFIG_SND=y
-+CONFIG_SND_PCM_OSS=y
-+# CONFIG_SND_SUPPORT_OLD_API is not set
-+# CONFIG_SND_VERBOSE_PROCFS is not set
-+# CONFIG_HID_SUPPORT is not set
-+# CONFIG_USB_SUPPORT is not set
-+CONFIG_MMC=y
-+CONFIG_MMC_FTSDC010=y
-+# CONFIG_MEMSTICK is not set
-+# CONFIG_NEW_LEDS is not set
-+# CONFIG_ACCESSIBILITY is not set
-+CONFIG_RTC_LIB=y
-+CONFIG_RTC_CLASS=y
-+# CONFIG_RTC_HCTOSYS is not set
-+CONFIG_EXT2_FS=y
-+CONFIG_FUSE_FS=y
-+CONFIG_MSDOS_FS=y
-+CONFIG_VFAT_FS=y
-+# CONFIG_PROC_PAGE_MONITOR is not set
-+CONFIG_TMPFS=y
-+CONFIG_JFFS2_FS=y
-+CONFIG_NFS_FS=y
-+CONFIG_NFS_V3=y
-+CONFIG_NLS_CODEPAGE_437=y
-+CONFIG_NLS_ISO8859_1=y
-+CONFIG_MAGIC_SYSRQ=y
-+CONFIG_DEBUG_FS=y
-+CONFIG_DEBUG_SHIRQ=y
-+CONFIG_SCHEDSTATS=y
-+CONFIG_TIMER_STATS=y
-+CONFIG_DEBUG_RT_MUTEXES=y
-+CONFIG_DEBUG_SPINLOCK=y
-+CONFIG_DEBUG_MUTEXES=y
-+CONFIG_DEBUG_INFO=y
-+CONFIG_DEBUG_LIST=y
-+CONFIG_DEBUG_SG=y
-+CONFIG_DEBUG_USER=y
-+CONFIG_DEBUG_ERRORS=y
-+# CONFIG_CRYPTO_ANSI_CPRNG is not set
-+# CONFIG_CRYPTO_HW is not set
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/amic.h linux-3.4.113/arch/nds32/include/asm/amic.h
---- linux-3.4.113.orig/arch/nds32/include/asm/amic.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/amic.h 2016-12-01 20:59:24.328611826 +0100
-@@ -0,0 +1,60 @@
-+/*
-+ * linux/arch/nds32/include/asm/amic.h
-+ *
-+ * Andes Multi-core Interrupt Controller Device Driver Interface
-+ *
-+ * Copyright (C) 2010 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * ChangeLog
-+ *
-+ * Shawn Lin 09/02/2010 Created for Andes AG102 platform code.
-+ */
-+
-+#ifndef __NDS32_AMIC_HEADER__
-+#define __NDS32_AMIC_HEADER__
-+
-+#define IRQ_BASE 0x0
-+#define IRQ_TOTAL 0x20
-+#define DEFAULT_MODE 0x000ecc00
-+#define DEFAULT_LEVEL 0xffffffff
-+#define AMIC_BASE AMIC_VA_BASE
-+#define CONFIG 0x00
-+#define CPUDC 0x04
-+#define CPUID0 0x08
-+#define CPUID1 0x0c
-+#define INTTRG 0x20
-+#define INTLVL 0x24
-+#define INTSRC 0x28
-+#define IPITRG 0x40
-+#define IPISTA 0x44
-+#define IPIPTR 0x48
-+#define IPIGST 0x4c
-+#define IPIGPT 0x50
-+#define INTEN 0x80
-+#define INTSTA 0x84
-+#define HW0STA 0x88
-+#define HW1STA 0x8c
-+#define HW2STA 0x90
-+#define HW3STA 0x94
-+#define HW4STA 0x98
-+#define HW5STA 0x9c
-+#define PRITY0 0xa0
-+#define PRITY1 0xa4
-+#define PRITY2 0xa8
-+#define PRITY3 0xac
-+
-+#endif /* __NDS32_AMIC_HEADER__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/asm-offsets.h linux-3.4.113/arch/nds32/include/asm/asm-offsets.h
---- linux-3.4.113.orig/arch/nds32/include/asm/asm-offsets.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/asm-offsets.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1 @@
-+#include <generated/asm-offsets.h>
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/assembler.h linux-3.4.113/arch/nds32/include/asm/assembler.h
---- linux-3.4.113.orig/arch/nds32/include/asm/assembler.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/assembler.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,141 @@
-+/*
-+ * linux/arch/nds32/include/asm/assembler.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_ASSEMBLER_H__
-+#define __NDS32_ASSEMBLER_H__
-+
-+/*
-+ * Stack format
-+ */
-+
-+#define S_PAD 0xac /* Padding for stack pointer 8-byte alignment. */
-+#define S_FUCOP_CTL 0xa8
-+#define S_LP 0xa4
-+#define S_GP 0xa0
-+#define S_FP 0x9c
-+#define S_R25 0x98
-+#define S_R24 0x94
-+#define S_R23 0x90
-+#define S_R22 0x8c
-+#define S_R21 0x88
-+#define S_R20 0x84
-+#define S_R19 0x80
-+#define S_R18 0x7c
-+#define S_R17 0x78
-+#define S_R16 0x74
-+#define S_R15 0x70
-+#define S_R14 0x6c
-+#define S_R13 0x68
-+#define S_R12 0x64
-+#define S_R11 0x60
-+#define S_R10 0x5c
-+#define S_R9 0x58
-+#define S_R8 0x54
-+#define S_R7 0x50
-+#define S_R6 0x4c
-+#define S_R5 0x48
-+#define S_R4 0x44
-+#define S_R3 0x40
-+#define S_R2 0x3c
-+#define S_R1 0x38
-+#define S_R0 0x34
-+#define S_D1LO 0x30
-+#define S_D1HI 0x2c
-+#define S_D0LO 0x28
-+#define S_D0HI 0x24
-+#define S_PP1 0x20
-+#define S_PP0 0x1c
-+#define S_PIPC 0x18
-+#define S_PIPSW 0x14
-+#define S_ORIG_R0 0x10
-+#define S_SP 0xc
-+#define S_IPC 0x8
-+#define S_IPSW 0x4
-+#define S_IR0 0x0
-+
-+#if !defined(CONFIG_ABI1)
-+#define S_OFF 0
-+#else
-+#define S_OFF 24
-+#endif
-+
-+#ifdef __ASSEMBLY__
-+.macro get_thread_info, rd
-+ srli \rd, $sp, #13
-+ slli \rd, \rd, #13
-+.endm
-+
-+.macro gie_disable
-+ setgie.d
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ isb
-+#else
-+ dsb
-+#endif
-+.endm
-+
-+.macro gie_enable
-+ setgie.e
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ isb
-+#else
-+ dsb
-+#endif
-+.endm
-+
-+.macro gie_save oldpsw
-+ mfsr \oldpsw, $ir0
-+ setgie.d
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ isb
-+#else
-+ dsb
-+#endif
-+.endm
-+
-+.macro gie_restore oldpsw
-+ andi \oldpsw, \oldpsw, #0x1
-+ beqz \oldpsw, 7001f
-+ setgie.e
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ isb
-+#else
-+ dsb
-+#endif
-+7001:
-+.endm
-+
-+
-+#define USER(insn, reg, addr, opr) \
-+9999: insn reg, addr, opr; \
-+ .section __ex_table,"a"; \
-+ .align 3; \
-+ .long 9999b, 9001f; \
-+ .previous
-+
-+#else /* __ASSEMBLY__ */
-+
-+__asm__ (".macro gie_disable\n\t"
-+ "setgie.d\n\t"
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ "isb\n\t"
-+#else
-+ "dsb\n\t"
-+#endif
-+ ".endm\n\t"
-+ );
-+
-+__asm__ (".macro gie_enable\n\t"
-+ "setgie.e\n\t"
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ "isb\n\t"
-+#else
-+ "dsb\n\t"
-+#endif
-+ ".endm\n\t"
-+ );
-+
-+#endif /* !__ASSEMBLY__ */
-+#endif /* __NDS32_ASSEMBLER_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/atomic.h linux-3.4.113/arch/nds32/include/asm/atomic.h
---- linux-3.4.113.orig/arch/nds32/include/asm/atomic.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/atomic.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,267 @@
-+/*
-+ * linux/arch/nds32/include/asm/atomic.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_ATOMIC_H__
-+#define __NDS32_ATOMIC_H__
-+
-+#include <linux/types.h>
-+#include <asm/barrier.h>
-+#include <asm/cmpxchg.h>
-+
-+#if defined(CONFIG_SMP) || !defined(CONFIG_CPU_DCACHE_WRITETHROUGH)
-+
-+#define ATOMIC_INIT(i) { (i) }
-+#define atomic_set(v,i) (((v)->counter) = (i))
-+#define atomic_read(v) (*(volatile int *)&(v)->counter)
-+
-+static inline void atomic_add(int i, atomic_t *v)
-+{
-+ int temp;
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\tadd\t%0, %0, %2\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (temp) : "r" (&v->counter), "r" (i));
-+}
-+
-+static inline void atomic_sub(int i, atomic_t *v)
-+{
-+ int temp;
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\tsub\t%0, %0, %2\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (temp) : "r" (&v->counter), "r" (i));
-+}
-+
-+#define atomic_inc(v) atomic_add(1, v)
-+#define atomic_dec(v) atomic_sub(1, v)
-+
-+static inline int atomic_inc_return(atomic_t *v)
-+{
-+ int temp1, temp2;
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%1, [%2+$r15]\n"
-+ "\taddi\t%1, %1, #1\n"
-+ "\tori\t%0, %1, #0\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter));
-+ return temp2;
-+}
-+
-+static inline int atomic_dec_return(atomic_t *v)
-+{
-+ int temp1, temp2;
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%1, [%2+$r15]\n"
-+ "\taddi\t%1, %1, #-1\n"
-+ "\tori\t%0, %1, #0\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter));
-+ return temp2;
-+}
-+
-+static inline int atomic_add_return(int i, atomic_t *v)
-+{
-+ int temp1, temp2;
-+
-+ smp_mb();
-+
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%1, [%2+$r15]\n"
-+ "\tadd\t%1, %1, %3\n"
-+ "\tori\t%0, %1, #0\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter), "r" (i));
-+
-+ smp_mb();
-+
-+ return temp2;
-+}
-+
-+static inline int atomic_sub_return(int i, atomic_t *v)
-+{
-+ int temp1, temp2;
-+
-+ smp_mb();
-+
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%1, [%2+$r15]\n"
-+ "\tsub\t%1, %1, %3\n"
-+ "\tori\t%0, %1, #0\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter), "r" (i));
-+
-+ smp_mb();
-+
-+ return temp2;
-+}
-+
-+/*
-+ * atomic_dec_if_positive - conditionally subtract one from atomic variable
-+ * @v: pointer of type atomic_t
-+ *
-+ * Atomically test @v and subtract one if @v is greater or equal than one.
-+ * The function returns the old value of @v minus one.
-+ */
-+static inline int atomic_dec_if_positive(atomic_t * v)
-+{
-+ int temp1, temp2, temp3;
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%2, [%3+$r15]\n"
-+ "\taddi\t%0, %2, #-1\n"
-+ "\tslts\t%1, $r15, %2\n"
-+ "\tsub\t%2, %2, %1\n"
-+ "\tscw\t%2, [%3+$r15]\n"
-+ "\tbeqz\t%2, 1b\n"
-+ : "=&r" (temp3), "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter));
-+ return temp3;
-+}
-+
-+
-+#define atomic_inc_and_test(v) (atomic_add_return(1, v) == 0)
-+#define atomic_dec_and_test(v) (atomic_sub_return(1, v) == 0)
-+#define atomic_sub_and_test(i,v) (atomic_sub_return((i),(v)) == 0)
-+#define atomic_add_negative(i,v) (atomic_add_return((i),(v)) < 0)
-+
-+
-+static inline int atomic_cmpxchg(atomic_t *v, int old, int new)
-+{
-+ int temp1, temp2, temp3;
-+
-+ smp_mb();
-+
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%0, [%3+$r15]\n"
-+ "\tsub\t%2, %0, %5\n"
-+ "\tcmovz\t%1, %4, %2\n"
-+ "\tcmovn\t%1, %0, %2\n"
-+ "\tscw\t%1, [%3+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (temp3), "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter), "r" (new), "r" (old));
-+
-+ smp_mb();
-+
-+ return temp3;
-+}
-+
-+static inline int atomic_xchg(atomic_t *v, int new)
-+{
-+ int temp1, temp2;
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%0, [%2+$r15]\n"
-+ "\tori\t%1, %3, #0\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter), "r" (new));
-+ return temp2;
-+}
-+
-+static inline int __atomic_add_unless(atomic_t *v, int a, int u)
-+{
-+ int c, old;
-+
-+ c = atomic_read(v);
-+ while (c != u && (old = atomic_cmpxchg((v), c, c + a)) != c)
-+ c = old;
-+ return c;
-+}
-+
-+static inline int atomic_inc_not_zero(atomic_t *v)
-+{
-+ int temp1, temp2;
-+ __asm__ __volatile__(
-+ "movi\t$r15, #0\n"
-+ "1:\n"
-+ "\tllw\t%1, [%2+$r15]\n"
-+ "\tslt\t%0, $r15, %1\n"
-+ "\tadd\t%1, %1, %0\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (temp2), "=&r" (temp1)
-+ : "r" (&v->counter));
-+ return temp2;
-+}
-+
-+#define smp_mb__before_atomic_dec() barrier()
-+#define smp_mb__after_atomic_dec() barrier()
-+#define smp_mb__before_atomic_inc() barrier()
-+#define smp_mb__after_atomic_inc() barrier()
-+
-+//#include <asm-generic/atomic-long.h>
-+#else /* CONFIG_SMP*/
-+
-+
-+
-+#define ATOMIC_INIT(i) { (i) }
-+
-+#ifdef __KERNEL__
-+
-+#include <asm-generic/atomic.h>
-+
-+static inline int atomic_dec_if_positive(atomic_t * v)
-+{
-+ unsigned long flags;
-+ int result;
-+
-+ local_irq_save(flags);
-+ result = v->counter;
-+ result -= 1;
-+ if (result >= 0)
-+ v->counter = result;
-+ local_irq_restore(flags);
-+ return result;
-+}
-+
-+/* Atomic operations are already serializing on ARM */
-+#define smp_mb__before_atomic_dec() barrier()
-+#define smp_mb__after_atomic_dec() barrier()
-+#define smp_mb__before_atomic_inc() barrier()
-+#define smp_mb__after_atomic_inc() barrier()
-+
-+#endif
-+
-+#endif /* CONFIG_SMP */
-+
-+#ifndef CONFIG_GENERIC_ATOMIC64
-+typedef struct {
-+ u64 __aligned(8) counter;
-+} atomic64_t;
-+#define ATOMIC64_INIT(i) { (i) }
-+static inline u64 atomic64_add_return(u64 i, atomic64_t *v){ return 0; }
-+#endif /* CONFIG_GENERIC_ATOMIC64 */
-+
-+#endif /* __NDS32_ATOMIC_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/audio.h linux-3.4.113/arch/nds32/include/asm/audio.h
---- linux-3.4.113.orig/arch/nds32/include/asm/audio.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/audio.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,65 @@
-+/*
-+ * linux/arch/nds32/include/asm/audio.h
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_AUDIO_H
-+#define __ASM_NDS32_AUDIO_H
-+
-+#ifndef __ASSEMBLY__
-+#include <linux/preempt.h>
-+#include <asm/ptrace.h>
-+
-+extern void save_audio(struct task_struct *tsk);
-+extern void audioload(struct audio_struct *audioregs);
-+extern void save_audio(struct task_struct *__tsk);
-+extern void do_audio_context_switch(unsigned long error_code, struct pt_regs *regs);
-+
-+#ifdef CONFIG_AUDIO
-+
-+#define test_tsk_audio(regs) (regs->NDS32_FUCOP_CTL & FUCOP_CTL_mskAUEN)
-+
-+struct task_struct;
-+
-+static inline void enable_audio(void)
-+{
-+ SET_FUCOP_CTL(GET_FUCOP_CTL() | FUCOP_CTL_mskAUEN);
-+}
-+
-+static inline void disable_audio(void)
-+{
-+ SET_FUCOP_CTL(GET_FUCOP_CTL() & ~FUCOP_CTL_mskAUEN);
-+}
-+
-+static inline void release_audio(struct pt_regs *regs)
-+{
-+ regs->NDS32_FUCOP_CTL &= ~FUCOP_CTL_mskAUEN;
-+ regs->NDS32_ipsw &= ~PSW_mskAEN;
-+}
-+
-+static inline void grab_audio(struct pt_regs *regs)
-+{
-+ regs->NDS32_FUCOP_CTL |= FUCOP_CTL_mskAUEN;
-+ regs->NDS32_ipsw |= PSW_mskAEN;
-+}
-+#ifdef CONFIG_UNLAZY_AUDIO
-+static inline void unlazy_audio(struct task_struct *tsk)
-+{
-+ preempt_disable();
-+ if (test_tsk_audio(task_pt_regs(tsk)))
-+ save_audio(tsk);
-+ preempt_enable();
-+}
-+#endif
-+static inline void clear_audio(struct pt_regs *regs)
-+{
-+ preempt_disable();
-+ if (test_tsk_audio(regs)) {
-+ release_audio(regs);
-+ }
-+ preempt_enable();
-+}
-+#endif /* CONFIG_AUDIO */
-+#endif /* __ASSEMBLY__ */
-+
-+#endif /* __ASM_NDS32_AUDIO_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/auxvec.h linux-3.4.113/arch/nds32/include/asm/auxvec.h
---- linux-3.4.113.orig/arch/nds32/include/asm/auxvec.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/auxvec.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,9 @@
-+/*
-+ * linux/arch/nds32/include/asm/auxvec.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_AUXVEC_H__
-+#define __NDS32_AUXVEC_H__
-+
-+#endif /*__NDS32_AUXVEC_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/barrier.h linux-3.4.113/arch/nds32/include/asm/barrier.h
---- linux-3.4.113.orig/arch/nds32/include/asm/barrier.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/barrier.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,85 @@
-+/* ============================================================================
-+ *
-+ * linux/arch/nds32/include/asm/system.h
-+ *
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for NDS32 architecture.
-+ *
-+ * Revision History:
-+ *
-+ * Nov.26.2007 Initial ported by Tom, Shawn, and Steven,
-+ * patched for KGDB and refined code by Harry.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#ifndef __ASM_NDS32_BARRIER_H
-+#define __ASM_NDS32_BARRIER_H
-+
-+#ifdef __KERNEL__
-+
-+/*
-+ * This is used to ensure the compiler did actually allocate the register we
-+ * asked it for some inline assembly sequences. Apparently we can't trust
-+ * the compiler from one version to another so a bit of paranoia won't hurt.
-+ * This string is meant to be concatenated with the inline asm string and
-+ * will cause compilation to stop on mismatch.
-+ * (for details, see gcc PR 15089)
-+ */
-+#define __asmeq(x, y) ".ifnc " x "," y " ; .err ; .endif\n\t"
-+
-+#ifndef __ASSEMBLY__
-+
-+#include <linux/linkage.h>
-+#include <linux/irqflags.h>
-+
-+struct thread_info;
-+struct task_struct;
-+
-+struct pt_regs;
-+
-+void die(const char *msg, struct pt_regs *regs, int err)
-+ __attribute__((noreturn));
-+
-+void die_if_kernel(const char *str, struct pt_regs *regs, int err);
-+
-+#include <asm/proc-fns.h>
-+
-+#define UDBG_UNDEFINED (1 << 0)
-+#define UDBG_SYSCALL (1 << 1)
-+#define UDBG_BADABORT (1 << 2)
-+#define UDBG_SEGV (1 << 3)
-+#define UDBG_BUS (1 << 4)
-+
-+extern unsigned int user_debug;
-+
-+#define mb() __asm__ __volatile__ ("" : : : "memory")
-+#define rmb() mb()
-+#define wmb() mb()
-+#define read_barrier_depends() do { } while(0)
-+#define set_mb(var, value) do { var = value; mb(); } while (0)
-+#define set_wmb(var, value) do { var = value; wmb(); } while (0)
-+
-+#ifdef CONFIG_SMP
-+#define smp_mb() mb()
-+#define smp_rmb() rmb()
-+#define smp_wmb() wmb()
-+#define smp_read_barrier_depends() read_barrier_depends()
-+#else
-+#define smp_mb() barrier()
-+#define smp_rmb() barrier()
-+#define smp_wmb() barrier()
-+#define smp_read_barrier_depends() do { } while(0)
-+#endif
-+
-+#endif /* __ASSEMBLY__ */
-+
-+#endif /* __KERNEL__ */
-+
-+#endif //__ASM_NDS32_SYSTEM_H
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/bitfield.h linux-3.4.113/arch/nds32/include/asm/bitfield.h
---- linux-3.4.113.orig/arch/nds32/include/asm/bitfield.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/bitfield.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,895 @@
-+/*
-+ * linux/arch/nds32/include/asm/bitfield.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_BITFIELD_H__
-+#define __NDS32_BITFIELD_H__
-+/******************************************************************************
-+ * cr0: CPU_VER (CPU Version Register)
-+ *****************************************************************************/
-+#define CPU_VER_offCFGID 0 /* Minor configuration */
-+#define CPU_VER_offREV 16 /* Revision of the CPU version */
-+#define CPU_VER_offCPUID 24 /* Major CPU versions */
-+
-+#define CPU_VER_mskCFGID ( 0xFFFF << CPU_VER_offCFGID )
-+#define CPU_VER_mskREV ( 0xFF << CPU_VER_offREV )
-+#define CPU_VER_mskCPUID ( 0xFF << CPU_VER_offCPUID )
-+
-+/******************************************************************************
-+ * cr1: ICM_CFG (Instruction Cache/Memory Configuration Register)
-+ *****************************************************************************/
-+#define ICM_CFG_offISET 0 /* I-cache sets (# of cache lines) per way */
-+#define ICM_CFG_offIWAY 3 /* I-cache ways */
-+#define ICM_CFG_offISZ 6 /* I-cache line size */
-+#define ICM_CFG_offILCK 9 /* I-cache locking support */
-+#define ICM_CFG_offILMB 10 /* On-chip ILM banks */
-+#define ICM_CFG_offBSAV 13 /* ILM base register alignment version */
-+/* bit 15:31 reserved */
-+
-+#define ICM_CFG_mskISET ( 0x7 << ICM_CFG_offISET )
-+#define ICM_CFG_mskIWAY ( 0x7 << ICM_CFG_offIWAY )
-+#define ICM_CFG_mskISZ ( 0x7 << ICM_CFG_offISZ )
-+#define ICM_CFG_mskILCK ( 0x1 << ICM_CFG_offILCK )
-+#define ICM_CFG_mskILMB ( 0x7 << ICM_CFG_offILMB )
-+#define ICM_CFG_mskBSAV ( 0x3 << ICM_CFG_offBSAV )
-+
-+/******************************************************************************
-+ * cr2: DCM_CFG (Data Cache/Memory Configuration Register)
-+ *****************************************************************************/
-+#define DCM_CFG_offDSET 0 /* D-cache sets (# of cache lines) per way */
-+#define DCM_CFG_offDWAY 3 /* D-cache ways */
-+#define DCM_CFG_offDSZ 6 /* D-cache line size */
-+#define DCM_CFG_offDLCK 9 /* D-cache locking support */
-+#define DCM_CFG_offDLMB 10 /* On-chip DLM banks */
-+#define DCM_CFG_offBSAV 13 /* DLM base register alignment version */
-+/* bit 15:31 reserved */
-+
-+#define DCM_CFG_mskDSET ( 0x7 << DCM_CFG_offDSET )
-+#define DCM_CFG_mskDWAY ( 0x7 << DCM_CFG_offDWAY )
-+#define DCM_CFG_mskDSZ ( 0x7 << DCM_CFG_offDSZ )
-+#define DCM_CFG_mskDLCK ( 0x1 << DCM_CFG_offDLCK )
-+#define DCM_CFG_mskDLMB ( 0x7 << DCM_CFG_offDLMB )
-+#define DCM_CFG_mskBSAV ( 0x3 << DCM_CFG_offBSAV )
-+
-+/******************************************************************************
-+ * cr3: MMU_CFG (MMU Configuration Register)
-+ *****************************************************************************/
-+#define MMU_CFG_offMMPS 0 /* Memory management protection scheme */
-+#define MMU_CFG_offMMPV 2 /* Memory management protection version number */
-+#define MMU_CFG_offFATB 7 /* Fully-associative or non-fully-associative TLB */
-+
-+#ifdef CONFIG_FULL_ASSOC
-+#define MMU_CFG_offFATBSZ 8 /* TLB entries while using full-associative TLB */
-+#else
-+#define MMU_CFG_offTBW 8 /* TLB ways(non-associative) TBS */
-+#define MMU_CFG_offTBS 11 /* TLB sets per way(non-associative) TBS */
-+/* bit 14:14 reserved */
-+#endif
-+
-+#define MMU_CFG_offEP8MIN4 15 /* 8KB page supported while minimum page is 4KB */
-+#define MMU_CFG_offfEPSZ 16 /* Extra page size supported */
-+#define MMU_CFG_offTLBLCK 24 /* TLB locking support */
-+#define MMU_CFG_offHPTWK 25 /* Hardware Page Table Walker implemented */
-+#define MMU_CFG_offDE 26 /* Default endian */
-+#define MMU_CFG_offNTPT 27 /* Partitions for non-translated attributes */
-+#define MMU_CFG_offIVTB 28 /* Invisible TLB */
-+#define MMU_CFG_offVLPT 29 /* VLPT for fast TLB fill handling implemented */
-+#define MMU_CFG_offNTME 30 /* Non-translated VA to PA mapping */
-+/* bit 31 reserved */
-+
-+#define MMU_CFG_mskMMPS ( 0x3 << MMU_CFG_offMMPS )
-+#define MMU_CFG_mskMMPV ( 0x1F << MMU_CFG_offMMPV )
-+#define MMU_CFG_mskFATB ( 0x1 << MMU_CFG_offFATB )
-+#ifdef CONFIG_FULL_ASSOC
-+#define MMU_CFG_mskFATBSZ ( 0x7f << MMU_CFG_offFATBSZ )
-+#else
-+#define MMU_CFG_mskTBW ( 0x7 << MMU_CFG_offTBW )
-+#define MMU_CFG_mskTBS ( 0x7 << MMU_CFG_offTBS )
-+#endif
-+#define MMU_CFG_mskEP8MIN4 ( 0x1 << MMU_CFG_offEP8MIN4 )
-+#define MMU_CFG_mskfEPSZ ( 0xFF << MMU_CFG_offfEPSZ )
-+#define MMU_CFG_mskTLBLCK ( 0x1 << MMU_CFG_offTLBLCK )
-+#define MMU_CFG_mskHPTWK ( 0x1 << MMU_CFG_offHPTWK )
-+#define MMU_CFG_mskDE ( 0x1 << MMU_CFG_offDE )
-+#define MMU_CFG_mskNTPT ( 0x1 << MMU_CFG_offNTPT )
-+#define MMU_CFG_mskIVTB ( 0x1 << MMU_CFG_offIVTB )
-+#define MMU_CFG_mskVLPT ( 0x1 << MMU_CFG_offVLPT )
-+#define MMU_CFG_mskNTME ( 0x1 << MMU_CFG_offNTME )
-+
-+/******************************************************************************
-+ * cr4: MSC_CFG (Misc Configuration Register)
-+ *****************************************************************************/
-+#define MSC_CFG_offEDM 0
-+#define MSC_CFG_offLMDMA 1
-+#define MSC_CFG_offPFM 2
-+#define MSC_CFG_offHSMP 3
-+#define MSC_CFG_offTRACE 4
-+#define MSC_CFG_offDIV 5
-+#define MSC_CFG_offMAC 6
-+#define MSC_CFG_offAUDIO 7
-+#define MSC_CFG_offL2C 9
-+#define MSC_CFG_offRDREG 10
-+#define MSC_CFG_offADR24 11
-+#define MSC_CFG_offINTLC 12
-+#define MSC_CFG_offBASEV 13
-+#define MSC_CFG_offNOD 16
-+/* bit 13:31 reserved */
-+
-+#define MSC_CFG_mskEDM ( 0x1 << MSC_CFG_offEDM )
-+#define MSC_CFG_mskLMDMA ( 0x1 << MSC_CFG_offLMDMA )
-+#define MSC_CFG_mskPFM ( 0x1 << MSC_CFG_offPFM )
-+#define MSC_CFG_mskHSMP ( 0x1 << MSC_CFG_offHSMP )
-+#define MSC_CFG_mskTRACE ( 0x1 << MSC_CFG_offTRACE )
-+#define MSC_CFG_mskDIV ( 0x1 << MSC_CFG_offDIV )
-+#define MSC_CFG_mskMAC ( 0x1 << MSC_CFG_offMAC )
-+#define MSC_CFG_mskAUDIO ( 0x3 << MSC_CFG_offAUDIO )
-+#define MSC_CFG_mskL2C ( 0x1 << MSC_CFG_offL2C )
-+#define MSC_CFG_mskRDREG ( 0x1 << MSC_CFG_offRDREG )
-+#define MSC_CFG_mskADR24 ( 0x1 << MSC_CFG_offADR24 )
-+#define MSC_CFG_mskINTLC ( 0x1 << MSC_CFG_offINTLC )
-+#define MSC_CFG_mskBASEV ( 0x7 << MSC_CFG_offBASEV )
-+#define MSC_CFG_mskNOD ( 0x1 << MSC_CFG_offNOD )
-+
-+/******************************************************************************
-+ * cr5: CORE_CFG (Core Identification Register)
-+ *****************************************************************************/
-+#define CORE_ID_offCOREID 0
-+/* bit 4:31 reserved */
-+
-+#define CORE_ID_mskCOREID ( 0xF << CORE_ID_offCOREID )
-+
-+/******************************************************************************
-+ * cr6: FUCOP_EXIST (FPU and Coprocessor Existence Configuration Register)
-+ *****************************************************************************/
-+#define FUCOP_EXIST_offCP0EX 0
-+#define FUCOP_EXIST_offCP1EX 1
-+#define FUCOP_EXIST_offCP2EX 2
-+#define FUCOP_EXIST_offCP3EX 3
-+#define FUCOP_EXIST_offCP0ISFPU 31
-+
-+#define FUCOP_EXIST_mskCP0EX ( 0x1 << FUCOP_EXIST_offCP0EX )
-+#define FUCOP_EXIST_mskCP1EX ( 0x1 << FUCOP_EXIST_offCP1EX )
-+#define FUCOP_EXIST_mskCP2EX ( 0x1 << FUCOP_EXIST_offCP2EX )
-+#define FUCOP_EXIST_mskCP3EX ( 0x1 << FUCOP_EXIST_offCP3EX )
-+#define FUCOP_EXIST_mskCP0ISFPU ( 0x1 << FUCOP_EXIST_offCP0ISFPU )
-+
-+/******************************************************************************
-+ * ir0: PSW (Processor Status Word Register)
-+ * ir1: IPSW (Interruption PSW Register)
-+ * ir2: P_IPSW (Previous IPSW Register)
-+ *****************************************************************************/
-+#define PSW_offGIE 0 /* Global Interrupt Enable */
-+#define PSW_offINTL 1 /* Interruption Stack Level */
-+#define PSW_offPOM 3 /* Processor Operation Mode, User/Superuser */
-+#define PSW_offBE 5 /* Endianness for data memory access, 1:MSB, 0:LSB */
-+#define PSW_offIT 6 /* Enable instruction address translation */
-+#define PSW_offDT 7 /* Enable data address translation */
-+#define PSW_offIME 8 /* Instruction Machine Error flag */
-+#define PSW_offDME 9 /* Data Machine Error flag */
-+#define PSW_offDEX 10 /* Debug Exception */
-+#define PSW_offHSS 11 /* Hardware Single Stepping */
-+#define PSW_offDRBE 12 /* Device Register Endian Mode */
-+#define PSW_offAEN 13 /* Audio ISA special feature */
-+#define PSW_offWBNA 14 /* Write Back Non-Allocate */
-+#define PSW_offIFCON 15 /* IFC On */
-+#define PSW_offCPL 16 /* Current Priority Level */
-+/* bit 19:31 reserved */
-+
-+#define PSW_mskGIE ( 0x1 << PSW_offGIE )
-+#define PSW_mskINTL ( 0x3 << PSW_offINTL )
-+#define PSW_mskPOM ( 0x3 << PSW_offPOM )
-+#define PSW_mskBE ( 0x1 << PSW_offBE )
-+#define PSW_mskIT ( 0x1 << PSW_offIT )
-+#define PSW_mskDT ( 0x1 << PSW_offDT )
-+#define PSW_mskIME ( 0x1 << PSW_offIME )
-+#define PSW_mskDME ( 0x1 << PSW_offDME )
-+#define PSW_mskDEX ( 0x1 << PSW_offDEX )
-+#define PSW_mskHSS ( 0x1 << PSW_offHSS )
-+#define PSW_mskDRBE ( 0x1 << PSW_offDRBE )
-+#define PSW_mskAEN ( 0x1 << PSW_offAEN )
-+#define PSW_mskWBNA ( 0x1 << PSW_offWBNA )
-+#define PSW_mskIFCON ( 0x1 << PSW_offIFCON )
-+#define PSW_mskCPL ( 0x7 << PSW_offCPL )
-+
-+#define PSW_SYSTEM ( 1 << PSW_offPOM )
-+#define PSW_INTL_1 ( 1 << PSW_offINTL )
-+#define PSW_CPL_NO ( 0 << PSW_offCPL )
-+#define PSW_CPL_ANY ( 7 << PSW_offCPL )
-+/******************************************************************************
-+ * ir3: IVB (Interruption Vector Base Register)
-+ *****************************************************************************/
-+/* bit 0:12 reserved */
-+#define IVB_offNIVIC 1 /* Number of input for IVIC Controller */
-+#define IVB_offIVIC_VER 11 /* IVIC Version */
-+#define IVB_offEVIC 13 /* External Vector Interrupt Controller mode */
-+#define IVB_offESZ 14 /* Size of each vector entry */
-+#define IVB_offIVBASE 16 /* BasePA of interrupt vector table */
-+
-+#define IVB_mskNIVIC ( 0x7 << IVB_offNIVIC )
-+#define IVB_mskIVIC_VER ( 0x3 << IVB_offIVIC_VER )
-+#define IVB_mskEVIC ( 0x1 << IVB_offEVIC )
-+#define IVB_mskESZ ( 0x3 << IVB_offESZ )
-+#define IVB_mskIVBASE ( 0xFFFF << IVB_offIVBASE )
-+
-+/******************************************************************************
-+ * ir4: EVA (Exception Virtual Address Register)
-+ * ir5: P_EVA (Previous EVA Register)
-+ *****************************************************************************/
-+
-+ /* This register contains the VA that causes the exception */
-+
-+/******************************************************************************
-+ * ir6: ITYPE (Interruption Type Register)
-+ * ir7: P_ITYPE (Previous ITYPE Register)
-+ *****************************************************************************/
-+#define ITYPE_offETYPE 0 /* Exception Type */
-+#define ITYPE_offINST 4 /* Exception caused by insn fetch or data access */
-+/* bit 5:15 reserved */
-+#define ITYPE_offSWID 16 /* SWID of debugging exception */
-+/* bit 31:31 reserved */
-+
-+#define ITYPE_mskETYPE ( 0xF << ITYPE_offETYPE )
-+#define ITYPE_mskINST ( 0x1 << ITYPE_offINST )
-+#define ITYPE_mskSWID ( 0x7FFF << ITYPE_offSWID )
-+
-+/* Additional definitions for ITYPE register */
-+#define ITYPE_offSTYPE 16 /* Arithmetic Sub Type */
-+#define ITYPE_offCPID 20 /* Co-Processor ID which generate the exception */
-+
-+#define ITYPE_mskSTYPE ( 0xF << ITYPE_offSTYPE )
-+#define ITYPE_mskCPID ( 0x3 << ITYPE_offCPID )
-+
-+/******************************************************************************
-+ * ir8: MERR (Machine Error Log Register)
-+ *****************************************************************************/
-+/* bit 0:30 reserved */
-+#define MERR_offBUSERR 31 /* Bus error caused by a load insn */
-+
-+#define MERR_mskBUSERR ( 0x1 << MERR_offBUSERR )
-+
-+/******************************************************************************
-+ * ir9: IPC (Interruption Program Counter Register)
-+ * ir10: P_IPC (Previous IPC Register)
-+ * ir11: OIPC (Overflow Interruption Program Counter Register)
-+ *****************************************************************************/
-+
-+ /* This is the shadow stack register of the Program Counter */
-+
-+/******************************************************************************
-+ * ir12: P_P0 (Previous P0 Register)
-+ * ir13: P_P1 (Previous P1 Register)
-+ *****************************************************************************/
-+
-+ /* These are shadow registers of $p0 and $p1 */
-+
-+/******************************************************************************
-+ * ir14: INT_MASK (Interruption Masking Register)
-+ *****************************************************************************/
-+#define INT_MASK_offH0IM 0 /* Hardware Interrupt 0 Mask bit */
-+#define INT_MASK_offH1IM 1 /* Hardware Interrupt 1 Mask bit */
-+#define INT_MASK_offH2IM 2 /* Hardware Interrupt 2 Mask bit */
-+#define INT_MASK_offH3IM 3 /* Hardware Interrupt 3 Mask bit */
-+#define INT_MASK_offH4IM 4 /* Hardware Interrupt 4 Mask bit */
-+#define INT_MASK_offH5IM 5 /* Hardware Interrupt 5 Mask bit */
-+/* bit 6:15 reserved */
-+#define INT_MASK_offSIM 16 /* Software Interrupt Mask bit */
-+/* bit 17:29 reserved */
-+#define INT_MASK_offIDIVZE 30 /* Enable detection for Divide-By-Zero */
-+#define INT_MASK_offDSSIM 31 /* Default Single Stepping Interruption Mask */
-+
-+#define INT_MASK_mskH0IM ( 0x1 << INT_MASK_offH0IM )
-+#define INT_MASK_mskH1IM ( 0x1 << INT_MASK_offH1IM )
-+#define INT_MASK_mskH2IM ( 0x1 << INT_MASK_offH2IM )
-+#define INT_MASK_mskH3IM ( 0x1 << INT_MASK_offH3IM )
-+#define INT_MASK_mskH4IM ( 0x1 << INT_MASK_offH4IM )
-+#define INT_MASK_mskH5IM ( 0x1 << INT_MASK_offH5IM )
-+#define INT_MASK_mskSIM ( 0x1 << INT_MASK_offSIM )
-+#define INT_MASK_mskIDIVZE ( 0x1 << INT_MASK_offIDIVZE )
-+#define INT_MASK_mskDSSIM ( 0x1 << INT_MASK_offDSSIM )
-+
-+/******************************************************************************
-+ * ir15: INT_PEND (Interrupt Pending Register)
-+ *****************************************************************************/
-+#define INT_PEND_offH0I 0 /* Hardware Interrupt 0 pending bit */
-+#define INT_PEND_offH1I 1 /* Hardware Interrupt 1 pending bit */
-+#define INT_PEND_offH2I 2 /* Hardware Interrupt 2 pending bit */
-+#define INT_PEND_offH3I 3 /* Hardware Interrupt 3 pending bit */
-+#define INT_PEND_offH4I 4 /* Hardware Interrupt 4 pending bit */
-+#define INT_PEND_offH5I 5 /* Hardware Interrupt 5 pending bit */
-+
-+#define INT_PEND_offCIPL 0 /* Current Interrupt Priority Level */
-+
-+/* bit 6:15 reserved */
-+#define INT_PEND_offSWI 16 /* Software Interrupt pending bit */
-+/* bit 17:31 reserved */
-+
-+#define INT_PEND_mskH0I ( 0x1 << INT_PEND_offH0I )
-+#define INT_PEND_mskH1I ( 0x1 << INT_PEND_offH1I )
-+#define INT_PEND_mskH2I ( 0x1 << INT_PEND_offH2I )
-+#define INT_PEND_mskH3I ( 0x1 << INT_PEND_offH3I )
-+#define INT_PEND_mskH4I ( 0x1 << INT_PEND_offH4I )
-+#define INT_PEND_mskH5I ( 0x1 << INT_PEND_offH5I )
-+#define INT_PEND_mskCIPL ( 0x1 << INT_PEND_offCIPL )
-+#define INT_PEND_mskSWI ( 0x1 << INT_PEND_offSWI )
-+
-+/******************************************************************************
-+ * mr0: MMU_CTL (MMU Control Register)
-+ *****************************************************************************/
-+#define MMU_CTL_offD 0 /* Default minimum page size */
-+#define MMU_CTL_offNTC0 1 /* Non-Translated Cachebility of partition 0 */
-+#define MMU_CTL_offNTC1 3 /* Non-Translated Cachebility of partition 1 */
-+#define MMU_CTL_offNTC2 5 /* Non-Translated Cachebility of partition 2 */
-+#define MMU_CTL_offNTC3 7 /* Non-Translated Cachebility of partition 3 */
-+#define MMU_CTL_offTBALCK 9 /* TLB all-lock resolution scheme */
-+#define MMU_CTL_offMPZIU 10 /* Multiple Page Size In Use bit */
-+#define MMU_CTL_offNTM0 11 /* Non-Translated VA to PA of partition 0 */
-+#define MMU_CTL_offNTM1 13 /* Non-Translated VA to PA of partition 1 */
-+#define MMU_CTL_offNTM2 15 /* Non-Translated VA to PA of partition 2 */
-+#define MMU_CTL_offNTM3 17 /* Non-Translated VA to PA of partition 3 */
-+/* bit 19:31 reserved */
-+
-+#define MMU_CTL_mskD ( 0x1 << MMU_CTL_offD )
-+#define MMU_CTL_mskNTC0 ( 0x3 << MMU_CTL_offNTC0 )
-+#define MMU_CTL_mskNTC1 ( 0x3 << MMU_CTL_offNTC1 )
-+#define MMU_CTL_mskNTC2 ( 0x3 << MMU_CTL_offNTC2 )
-+#define MMU_CTL_mskNTC3 ( 0x3 << MMU_CTL_offNTC3 )
-+#define MMU_CTL_mskTBALCK ( 0x1 << MMU_CTL_offTBALCK )
-+#define MMU_CTL_mskMPZIU ( 0x1 << MMU_CTL_offMPZIU )
-+#define MMU_CTL_mskNTM0 ( 0x3 << MMU_CTL_offNTM0 )
-+#define MMU_CTL_mskNTM1 ( 0x3 << MMU_CTL_offNTM1 )
-+#define MMU_CTL_mskNTM2 ( 0x3 << MMU_CTL_offNTM2 )
-+#define MMU_CTL_mskNTM3 ( 0x3 << MMU_CTL_offNTM3 )
-+
-+/******************************************************************************
-+ * mr1: L1_PPTB (L1 Physical Page Table Base Register)
-+ *****************************************************************************/
-+#define L1_PPTB_offNV 0 /* Enable Hardware Page Table Walker (HPTWK) */
-+/* bit 1:11 reserved */
-+#define L1_PPTB_offBASE 12 /* First level physical page table base address */
-+
-+#define L1_PPTB_mskNV ( 0x1 << L1_PPTB_offNV )
-+#define L1_PPTB_mskBASE ( 0xFFFFF << L1_PPTB_offBASE )
-+
-+/******************************************************************************
-+ * mr2: TLB_VPN (TLB Access VPN Register)
-+ *****************************************************************************/
-+/* bit 0:11 reserved */
-+#define TLB_VPN_offVPN 12 /* Virtual Page Number */
-+
-+#define TLB_VPN_mskVPN ( 0xFFFFF << TLB_VPN_offVPN )
-+
-+/******************************************************************************
-+ * mr3: TLB_DATA (TLB Access Data Register)
-+ *****************************************************************************/
-+#define TLB_DATA_offV 0 /* PTE is valid and present */
-+#define TLB_DATA_offM 1 /* Page read/write access privilege */
-+#define TLB_DATA_offD 4 /* Dirty bit */
-+#define TLB_DATA_offX 5 /* Executable bit */
-+#define TLB_DATA_offA 6 /* Access bit */
-+#define TLB_DATA_offG 7 /* Global page (shared across contexts) */
-+#define TLB_DATA_offC 8 /* Cacheability atribute */
-+/* bit 11:11 reserved */
-+#define TLB_DATA_offPPN 12 /* Phisical Page Number */
-+
-+#define TLB_DATA_mskV ( 0x1 << TLB_DATA_offV )
-+#define TLB_DATA_mskM ( 0x7 << TLB_DATA_offM )
-+#define TLB_DATA_mskD ( 0x1 << TLB_DATA_offD )
-+#define TLB_DATA_mskX ( 0x1 << TLB_DATA_offX )
-+#define TLB_DATA_mskA ( 0x1 << TLB_DATA_offA )
-+#define TLB_DATA_mskG ( 0x1 << TLB_DATA_offG )
-+#define TLB_DATA_mskC ( 0x7 << TLB_DATA_offC )
-+#define TLB_DATA_mskPPN ( 0xFFFFF << TLB_DATA_offPPN )
-+
-+/******************************************************************************
-+ * mr4: TLB_MISC (TLB Access Misc Register)
-+ *****************************************************************************/
-+#define TLB_MISC_offACC_PSZ 0 /* Page size of a PTE entry */
-+#define TLB_MISC_offCID 4 /* Context id */
-+/* bit 13:31 reserved */
-+
-+#define TLB_MISC_mskACC_PSZ ( 0xF << TLB_MISC_offACC_PSZ )
-+#define TLB_MISC_mskCID ( 0x1FF << TLB_MISC_offCID )
-+
-+/******************************************************************************
-+ * mr5: VLPT_IDX (Virtual Linear Page Table Index Register)
-+ *****************************************************************************/
-+#define VLPT_IDX_offZERO 0 /* Always 0 */
-+#define VLPT_IDX_offEVPN 2 /* Exception Virtual Page Number */
-+#define VLPT_IDX_offVLPTB 22 /* Base VA of VLPT */
-+
-+#define VLPT_IDX_mskZERO ( 0x3 << VLPT_IDX_offZERO )
-+#define VLPT_IDX_mskEVPN ( 0xFFFFF << VLPT_IDX_offEVPN )
-+#define VLPT_IDX_mskVLPTB ( 0x3FF << VLPT_IDX_offVLPTB )
-+
-+/******************************************************************************
-+ * mr6: ILMB (Instruction Local Memory Base Register)
-+ *****************************************************************************/
-+#define ILMB_offIEN 0 /* Enable ILM */
-+#define ILMB_offILMSZ 1 /* Size of ILM */
-+/* bit 5:19 reserved */
-+#define ILMB_offIBPA 20 /* Base PA of ILM */
-+
-+#define ILMB_mskIEN ( 0x1 << ILMB_offIEN )
-+#define ILMB_mskILMSZ ( 0xF << ILMB_offILMSZ )
-+#define ILMB_mskIBPA ( 0xFFF << ILMB_offIBPA )
-+
-+/******************************************************************************
-+ * mr7: DLMB (Data Local Memory Base Register)
-+ *****************************************************************************/
-+#define DLMB_offDEN 0 /* Enable DLM */
-+#define DLMB_offDLMSZ 1 /* Size of DLM */
-+#define DLMB_offDBM 5 /* Enable Double-Buffer Mode for DLM */
-+#define DLMB_offDBB 6 /* Double-buffer bank which can be accessed by the processor */
-+/* bit 7:19 reserved */
-+#define DLMB_offDBPA 20 /* Base PA of DLM */
-+
-+#define DLMB_mskDEN ( 0x1 << DLMB_offDEN )
-+#define DLMB_mskDLMSZ ( 0xF << DLMB_offDLMSZ )
-+#define DLMB_mskDBM ( 0x1 << DLMB_offDBM )
-+#define DLMB_mskDBB ( 0x1 << DLMB_offDBB )
-+#define DLMB_mskDBPA ( 0xFFF << DLMB_offDBPA )
-+
-+/******************************************************************************
-+ * mr8: CACHE_CTL (Cache Control Register)
-+ *****************************************************************************/
-+#define CACHE_CTL_offIC_EN 0 /* Enable I-cache */
-+#define CACHE_CTL_offDC_EN 1 /* Enable D-cache */
-+#define CACHE_CTL_offICALCK 2 /* I-cache all-lock resolution scheme */
-+#define CACHE_CTL_offDCALCK 3 /* D-cache all-lock resolution scheme */
-+#define CACHE_CTL_offDCCWF 4 /* Enable D-cache Critical Word Forwarding */
-+#define CACHE_CTL_offDCPMW 5 /* Enable D-cache concurrent miss and write-back processing */
-+/* bit 6:31 reserved */
-+
-+#define CACHE_CTL_mskIC_EN ( 0x1 << CACHE_CTL_offIC_EN )
-+#define CACHE_CTL_mskDC_EN ( 0x1 << CACHE_CTL_offDC_EN )
-+#define CACHE_CTL_mskICALCK ( 0x1 << CACHE_CTL_offICALCK )
-+#define CACHE_CTL_mskDCALCK ( 0x1 << CACHE_CTL_offDCALCK )
-+#define CACHE_CTL_mskDCCWF ( 0x1 << CACHE_CTL_offDCCWF )
-+#define CACHE_CTL_mskDCPMW ( 0x1 << CACHE_CTL_offDCPMW )
-+
-+/******************************************************************************
-+ * mr9: HSMP_SADDR (High Speed Memory Port Starting Address)
-+ *****************************************************************************/
-+#define HSMP_SADDR_offEN 0 /* Enable control bit for the High Speed Memory port */
-+/* bit 1:19 reserved */
-+
-+#define HSMP_SADDR_offRANGE 1 /* Denote the address range (only defined in HSMP v2 ) */
-+#define HSMP_SADDR_offSADDR 20 /* Starting base PA of the High Speed Memory Port region */
-+
-+#define HSMP_SADDR_mskEN ( 0x1 << HSMP_SADDR_offEN )
-+#define HSMP_SADDR_mskRANGE ( 0xFFF << HSMP_SADDR_offRANGE )
-+#define HSMP_SADDR_mskSADDR ( 0xFFF << HSMP_SADDR_offSADDR )
-+
-+/******************************************************************************
-+ * mr10: HSMP_EADDR (High Speed Memory Port Ending Address)
-+ *****************************************************************************/
-+/* bit 0:19 reserved */
-+#define HSMP_EADDR_offEADDR 20
-+
-+#define HSMP_EADDR_mskEADDR ( 0xFFF << HSMP_EADDR_offEADDR )
-+
-+/******************************************************************************
-+ * dr0+(n*5): BPCn (n=0-7) (Breakpoint Control Register)
-+ *****************************************************************************/
-+#define BPC_offWP 0 /* Configuration of BPAn */
-+#define BPC_offEL 1 /* Enable BPAn */
-+#define BPC_offS 2 /* Data address comparison for a store instruction */
-+#define BPC_offP 3 /* Compared data address is PA */
-+#define BPC_offC 4 /* CID value is compared with the BPCIDn register */
-+#define BPC_offBE0 5 /* Enable byte mask for the comparison with register */
-+#define BPC_offBE1 6 /* Enable byte mask for the comparison with register */
-+#define BPC_offBE2 7 /* Enable byte mask for the comparison with register */
-+#define BPC_offBE3 8 /* Enable byte mask for the comparison with register */
-+#define BPC_offT 9 /* Enable breakpoint Embedded Tracer triggering operation */
-+
-+#define BPC_mskWP ( 0x1 << BPC_offWP )
-+#define BPC_mskEL ( 0x1 << BPC_offEL )
-+#define BPC_mskS ( 0x1 << BPC_offS )
-+#define BPC_mskP ( 0x1 << BPC_offP )
-+#define BPC_mskC ( 0x1 << BPC_offC )
-+#define BPC_mskBE0 ( 0x1 << BPC_offBE0 )
-+#define BPC_mskBE1 ( 0x1 << BPC_offBE1 )
-+#define BPC_mskBE2 ( 0x1 << BPC_offBE2 )
-+#define BPC_mskBE3 ( 0x1 << BPC_offBE3 )
-+#define BPC_mskT ( 0x1 << BPC_offT )
-+
-+/******************************************************************************
-+ * dr1+(n*5): BPAn (n=0-7) (Breakpoint Address Register)
-+ *****************************************************************************/
-+
-+ /* These registers contain break point address */
-+
-+/******************************************************************************
-+ * dr2+(n*5): BPAMn (n=0-7) (Breakpoint Address Mask Register)
-+ *****************************************************************************/
-+
-+ /* These registerd contain the address comparison mask for the BPAn register */
-+
-+/******************************************************************************
-+ * dr3+(n*5): BPVn (n=0-7) Breakpoint Data Value Register
-+ *****************************************************************************/
-+
-+ /* The BPVn register contains the data value that will be compared with the
-+ * incoming load/store data value */
-+
-+/******************************************************************************
-+ * dr4+(n*5): BPCIDn (n=0-7) (Breakpoint Context ID Register)
-+ *****************************************************************************/
-+#define BPCID_offCID 0 /* CID that will be compared with a process's CID */
-+/* bit 9:31 reserved */
-+
-+#define BPCID_mskCID ( 0x1FF << BPCID_offCID )
-+
-+/******************************************************************************
-+ * dr40: EDM_CFG (EDM Configuration Register)
-+ *****************************************************************************/
-+#define EDM_CFG_offBC 0 /* Number of hardware breakpoint sets implemented */
-+#define EDM_CFG_offDIMU 3 /* Debug Instruction Memory Unit exists */
-+/* bit 4:15 reserved */
-+#define EDM_CFG_offVER 16 /* EDM version */
-+
-+#define EDM_CFG_mskBC ( 0x7 << EDM_CFG_offBC )
-+#define EDM_CFG_mskDIMU ( 0x1 << EDM_CFG_offDIMU )
-+#define EDM_CFG_mskVER ( 0xFFFF << EDM_CFG_offVER )
-+
-+/******************************************************************************
-+ * dr41: EDMSW (EDM Status Word)
-+ *****************************************************************************/
-+#define EDMSW_offWV 0 /* Write Valid */
-+#define EDMSW_offRV 1 /* Read Valid */
-+#define EDMSW_offDE 2 /* Debug exception has occurred for this core */
-+/* bit 3:31 reserved */
-+
-+#define EDMSW_mskWV ( 0x1 << EDMSW_offWV )
-+#define EDMSW_mskRV ( 0x1 << EDMSW_offRV )
-+#define EDMSW_mskDE ( 0x1 << EDMSW_offDE )
-+
-+/******************************************************************************
-+ * dr42: EDM_CTL (EDM Control Register)
-+ *****************************************************************************/
-+/* bit 0:30 reserved */
-+#define EDM_CTL_offV3_EDM_MODE 6 /* EDM compatibility control bit */
-+#define EDM_CTL_offDEH_SEL 31 /* Controls where debug exception is directed to */
-+
-+#define EDM_CTL_mskV3_EDM_MODE ( 0x1 << EDM_CTL_offV3_EDM_MODE )
-+#define EDM_CTL_mskDEH_SEL ( 0x1 << EDM_CTL_offDEH_SEL )
-+
-+/******************************************************************************
-+ * dr43: EDM_DTR (EDM Data Transfer Register)
-+ *****************************************************************************/
-+
-+ /* This is used to exchange data between the embedded EDM logic
-+ * and the processor core */
-+
-+/******************************************************************************
-+ * dr44: BPMTC (Breakpoint Match Trigger Counter Register)
-+ *****************************************************************************/
-+#define BPMTC_offBPMTC 0 /* Breakpoint match trigger counter value */
-+/* bit 16:31 reserved */
-+
-+#define BPMTC_mskBPMTC ( 0xFFFF << BPMTC_offBPMTC )
-+
-+/******************************************************************************
-+ * dr45: DIMBR (Debug Instruction Memory Base Register)
-+ *****************************************************************************/
-+/* bit 0:11 reserved */
-+#define DIMBR_offDIMB 12 /* Base address of the Debug Instruction Memory (DIM) */
-+#define DIMBR_mskDIMB ( 0xFFFFF << DIMBR_offDIMB )
-+
-+/******************************************************************************
-+ * dr46: TECR0(Trigger Event Control register 0)
-+ * dr47: TECR1 (Trigger Event Control register 1)
-+ *****************************************************************************/
-+#define TECR_offBP 0 /* Controld which BP is used as a trigger source */
-+#define TECR_offNMI 8 /* Use NMI as a trigger source */
-+#define TECR_offHWINT 9 /* Corresponding interrupt is used as a trigger source */
-+#define TECR_offEVIC 15 /* Enable HWINT as a trigger source in EVIC mode */
-+#define TECR_offSYS 16 /* Enable SYSCALL instruction as a trigger source */
-+#define TECR_offDBG 17 /* Enable debug exception as a trigger source */
-+#define TECR_offMRE 18 /* Enable MMU related exception as a trigger source */
-+#define TECR_offE 19 /* An exception is used as a trigger source */
-+/* bit 20:30 reserved */
-+#define TECR_offL 31 /* Link/Cascade TECR0 trigger event to TECR1 trigger event */
-+
-+#define TECR_mskBP ( 0xFF << TECR_offBP )
-+#define TECR_mskNMI ( 0x1 << TECR_offBNMI )
-+#define TECR_mskHWINT ( 0x3F << TECR_offBHWINT )
-+#define TECR_mskEVIC ( 0x1 << TECR_offBEVIC )
-+#define TECR_mskSYS ( 0x1 << TECR_offBSYS )
-+#define TECR_mskDBG ( 0x1 << TECR_offBDBG )
-+#define TECR_mskMRE ( 0x1 << TECR_offBMRE )
-+#define TECR_mskE ( 0x1 << TECR_offE )
-+#define TECR_mskL ( 0x1 << TECR_offL )
-+
-+/******************************************************************************
-+ * pfr0-2: PFMC0-2 (Performance Counter Register 0-2)
-+ *****************************************************************************/
-+
-+ /* These registers contains performance event count */
-+
-+/******************************************************************************
-+ * pfr3: PFM_CTL (Performance Counter Control Register)
-+ *****************************************************************************/
-+#define PFM_CTL_offEN0 0 /* Enable PFMC0 */
-+#define PFM_CTL_offEN1 1 /* Enable PFMC1 */
-+#define PFM_CTL_offEN2 2 /* Enable PFMC2 */
-+#define PFM_CTL_offIE0 3 /* Enable interrupt for PFMC0 */
-+#define PFM_CTL_offIE1 4 /* Enable interrupt for PFMC1 */
-+#define PFM_CTL_offIE2 5 /* Enable interrupt for PFMC2 */
-+#define PFM_CTL_offOVF0 6 /* Overflow bit of PFMC0 */
-+#define PFM_CTL_offOVF1 7 /* Overflow bit of PFMC1 */
-+#define PFM_CTL_offOVF2 8 /* Overflow bit of PFMC2 */
-+#define PFM_CTL_offKS0 9 /* Enable superuser mode event counting for PFMC0 */
-+#define PFM_CTL_offKS1 10 /* Enable superuser mode event counting for PFMC1 */
-+#define PFM_CTL_offKS2 11 /* Enable superuser mode event counting for PFMC2 */
-+#define PFM_CTL_offKU0 12 /* Enable user mode event counting for PFMC0 */
-+#define PFM_CTL_offKU1 13 /* Enable user mode event counting for PFMC1 */
-+#define PFM_CTL_offKU2 14 /* Enable user mode event counting for PFMC2 */
-+#define PFM_CTL_offSEL0 15 /* The event selection for PFMC0 */
-+#define PFM_CTL_offSEL1 21 /* The event selection for PFMC1 */
-+#define PFM_CTL_offSEL2 27 /* The event selection for PFMC2 */
-+/* bit 28:31 reserved */
-+
-+#define PFM_CTL_mskEN0 ( 0x01 << PFM_CTL_offEN0 )
-+#define PFM_CTL_mskEN1 ( 0x01 << PFM_CTL_offEN1 )
-+#define PFM_CTL_mskEN2 ( 0x01 << PFM_CTL_offEN2 )
-+#define PFM_CTL_mskIE0 ( 0x01 << PFM_CTL_offIE0 )
-+#define PFM_CTL_mskIE1 ( 0x01 << PFM_CTL_offIE1 )
-+#define PFM_CTL_mskIE2 ( 0x01 << PFM_CTL_offIE2 )
-+#define PFM_CTL_mskOVF0 ( 0x01 << PFM_CTL_offOVF0 )
-+#define PFM_CTL_mskOVF1 ( 0x01 << PFM_CTL_offOVF1 )
-+#define PFM_CTL_mskOVF2 ( 0x01 << PFM_CTL_offOVF2 )
-+#define PFM_CTL_mskKS0 ( 0x01 << PFM_CTL_offKS0 )
-+#define PFM_CTL_mskKS1 ( 0x01 << PFM_CTL_offKS1 )
-+#define PFM_CTL_mskKS2 ( 0x01 << PFM_CTL_offKS2 )
-+#define PFM_CTL_mskKU0 ( 0x01 << PFM_CTL_offKU0 )
-+#define PFM_CTL_mskKU1 ( 0x01 << PFM_CTL_offKU1 )
-+#define PFM_CTL_mskKU2 ( 0x01 << PFM_CTL_offKU2 )
-+#define PFM_CTL_mskSEL0 ( 0x01 << PFM_CTL_offSEL0 )
-+#define PFM_CTL_mskSEL1 ( 0x3F << PFM_CTL_offSEL1 )
-+#define PFM_CTL_mskSEL2 ( 0x3F << PFM_CTL_offSEL2 )
-+
-+/******************************************************************************
-+ * SDZ_CTL (Structure Downsizing Control Register)
-+ *****************************************************************************/
-+#define SDZ_CTL_offICDZ 0 /* I-cache downsizing control */
-+#define SDZ_CTL_offDCDZ 3 /* D-cache downsizing control */
-+#define SDZ_CTL_offMTBDZ 6 /* MTLB downsizing control */
-+#define SDZ_CTL_offBTBDZ 9 /* Branch Target Table downsizing control */
-+/* bit 12:31 reserved */
-+#define SDZ_CTL_mskICDZ ( 0x07 << SDZ_CTL_offICDZ )
-+#define SDZ_CTL_mskDCDZ ( 0x07 << SDZ_CTL_offDCDZ )
-+#define SDZ_CTL_mskMTBDZ ( 0x07 << SDZ_CTL_offMTBDZ )
-+#define SDZ_CTL_mskBTBDZ ( 0x07 << SDZ_CTL_offBTBDZ )
-+
-+/******************************************************************************
-+ * N12MISC_CTL (N12 Miscellaneous Control Register)
-+ *****************************************************************************/
-+#define N12MISC_CTL_offBTB 0 /* Disable Branch Target Buffer */
-+#define N12MISC_CTL_offRTP 1 /* Disable Return Target Predictor */
-+#define N12MISC_CTL_offPTEPF 2 /* Disable HPTWK L2 PTE pefetch */
-+/* bit 3:31 reserved */
-+
-+#define N12MISC_CTL_makBTB ( 0x1 << N12MISC_CTL_offBTB )
-+#define N12MISC_CTL_makRTP ( 0x1 << N12MISC_CTL_offRTP )
-+#define N12MISC_CTL_makPTEPF ( 0x1 << N12MISC_CTL_offPTEPF )
-+
-+/******************************************************************************
-+ * PRUSR_ACC_CTL (Privileged Resource User Access Control Registers)
-+ *****************************************************************************/
-+#define PRUSR_ACC_CTL_offDMA_EN 0 /* Allow user mode access of DMA registers */
-+#define PRUSR_ACC_CTL_offPFM_EN 1 /* Allow user mode access of PFM registers */
-+
-+#define PRUSR_ACC_CTL_mskDMA_EN ( 0x1 << PRUSR_ACC_CTL_offDMA_EN )
-+#define PRUSR_ACC_CTL_mskPFM_EN ( 0x1 << PRUSR_ACC_CTL_offPFM_EN )
-+
-+/******************************************************************************
-+ * dmar0: DMA_CFG (DMA Configuration Register)
-+ *****************************************************************************/
-+#define DMA_CFG_offNCHN 0 /* The number of DMA channels implemented */
-+#define DMA_CFG_offUNEA 2 /* Un-aligned External Address transfer feature */
-+#define DMA_CFG_off2DET 3 /* 2-D Element Transfer feature */
-+/* bit 4:15 reserved */
-+#define DMA_CFG_offVER 16 /* DMA architecture and implementation version */
-+
-+#define DMA_CFG_mskNCHN ( 0x3 << DMA_CFG_offNCHN )
-+#define DMA_CFG_mskUNEA ( 0x1 << DMA_CFG_offUNEA )
-+#define DMA_CFG_msk2DET ( 0x1 << DMA_CFG_off2DET )
-+#define DMA_CFG_mskVER ( 0xFFFF << DMA_CFG_offVER )
-+
-+/******************************************************************************
-+ * dmar1: DMA_GCSW (DMA Global Control and Status Word Register)
-+ *****************************************************************************/
-+#define DMA_GCSW_offC0STAT 0 /* DMA channel 0 state */
-+#define DMA_GCSW_offC1STAT 3 /* DMA channel 1 state */
-+/* bit 6:11 reserved */
-+#define DMA_GCSW_offC0INT 12 /* DMA channel 0 generate interrupt */
-+#define DMA_GCSW_offC1INT 13 /* DMA channel 1 generate interrupt */
-+/* bit 14:30 reserved */
-+#define DMA_GCSW_offEN 31 /* Enable DMA engine */
-+
-+#define DMA_GCSW_mskC0STAT ( 0x7 << DMA_GCSW_offC0STAT )
-+#define DMA_GCSW_mskC1STAT ( 0x7 << DMA_GCSW_offC1STAT )
-+#define DMA_GCSW_mskC0INT ( 0x1 << DMA_GCSW_offC0INT )
-+#define DMA_GCSW_mskC1INT ( 0x1 << DMA_GCSW_offC1INT )
-+#define DMA_GCSW_mskEN ( 0x1 << DMA_GCSW_offEN )
-+
-+/******************************************************************************
-+ * dmar2: DMA_CHNSEL (DMA Channel Selection Register)
-+ *****************************************************************************/
-+#define DMA_CHNSEL_offCHAN 0 /* Selected channel number */
-+/* bit 2:31 reserved */
-+
-+#define DMA_CHNSEL_mskCHAN ( 0x3 << DMA_CHNSEL_offCHAN )
-+
-+/******************************************************************************
-+ * dmar3: DMA_ACT (DMA Action Register)
-+ *****************************************************************************/
-+#define DMA_ACT_offACMD 0 /* DMA Action Command */
-+/* bit 2:31 reserved */
-+#define DMA_ACT_mskACMD ( 0x3 << DMA_ACT_offACMD )
-+
-+/******************************************************************************
-+ * dmar4: DMA_SETUP (DMA Setup Register)
-+ *****************************************************************************/
-+#define DMA_SETUP_offLM 0 /* Local Memory Selection */
-+#define DMA_SETUP_offTDIR 1 /* Transfer Direction */
-+#define DMA_SETUP_offTES 2 /* Transfer Element Size */
-+#define DMA_SETUP_offESTR 4 /* External memory transfer Stride */
-+#define DMA_SETUP_offCIE 16 /* Interrupt Enable on Completion */
-+#define DMA_SETUP_offSIE 17 /* Interrupt Enable on explicit Stop */
-+#define DMA_SETUP_offEIE 18 /* Interrupt Enable on Error */
-+#define DMA_SETUP_offUE 19 /* Enable the Un-aligned External Address */
-+#define DMA_SETUP_off2DE 20 /* Enable the 2-D External Transfer */
-+#define DMA_SETUP_offCOA 21 /* Transfer Coalescable */
-+/* bit 22:31 reserved */
-+
-+#define DMA_SETUP_mskLM ( 0x1 << DMA_SETUP_offLM )
-+#define DMA_SETUP_mskTDIR ( 0x1 << DMA_SETUP_offTDIR )
-+#define DMA_SETUP_mskTES ( 0x3 << DMA_SETUP_offTES )
-+#define DMA_SETUP_mskESTR ( 0xFFF << DMA_SETUP_offESTR )
-+#define DMA_SETUP_mskCIE ( 0x1 << DMA_SETUP_offCIE )
-+#define DMA_SETUP_mskSIE ( 0x1 << DMA_SETUP_offSIE )
-+#define DMA_SETUP_mskEIE ( 0x1 << DMA_SETUP_offEIE )
-+#define DMA_SETUP_mskUE ( 0x1 << DMA_SETUP_offUE )
-+#define DMA_SETUP_msk2DE ( 0x1 << DMA_SETUP_off2DE )
-+#define DMA_SETUP_mskCOA ( 0x1 << DMA_SETUP_offCOA )
-+
-+/******************************************************************************
-+ * dmar5: DMA_ISADDR (DMA Internal Start Address Register)
-+ *****************************************************************************/
-+#define DMA_ISADDR_offISADDR 0 /* Internal Start Address */
-+/* bit 20:31 reserved */
-+#define DMA_ISADDR_mskISADDR ( 0xFFFFF << DMA_ISADDR_offISADDR )
-+
-+/******************************************************************************
-+ * dmar6: DMA_ESADDR (DMA External Start Address Register)
-+ *****************************************************************************/
-+/* This register holds External Start Address */
-+
-+/******************************************************************************
-+ * dmar7: DMA_TCNT (DMA Transfer Element Count Register)
-+ *****************************************************************************/
-+#define DMA_TCNT_offTCNT 0 /* DMA transfer element count */
-+/* bit 18:31 reserved */
-+#define DMA_TCNT_mskTCNT ( 0x3FFFF << DMA_TCNT_offTCNT )
-+
-+/******************************************************************************
-+ * dmar8: DMA_STATUS (DMA Status Register)
-+ *****************************************************************************/
-+#define DMA_STATUS_offSTAT 0 /* DMA channel state */
-+#define DMA_STATUS_offSTUNA 3 /* Un-aligned error on External Stride value */
-+#define DMA_STATUS_offDERR 4 /* DMA Transfer Disruption Error */
-+#define DMA_STATUS_offEUNA 5 /* Un-aligned error on the External address */
-+#define DMA_STATUS_offIUNA 6 /* Un-aligned error on the Internal address */
-+#define DMA_STATUS_offIOOR 7 /* Out-Of-Range error on the Internal address */
-+#define DMA_STATUS_offEBUS 8 /* Bus Error on an External DMA transfer */
-+#define DMA_STATUS_offESUP 9 /* DMA setup error */
-+/* bit 10:31 reserved */
-+
-+#define DMA_STATUS_mskSTAT ( 0x7 << DMA_STATUS_offSTAT )
-+#define DMA_STATUS_mskSTUNA ( 0x1 << DMDMA_STATUS_offSTUNA )
-+#define DMA_STATUS_mskDERR ( 0x1 << DMDMA_STATUS_offDERR )
-+#define DMA_STATUS_mskEUNA ( 0x1 << DMDMA_STATUS_offEUNA )
-+#define DMA_STATUS_mskIUNA ( 0x1 << DMDMA_STATUS_offIUNA )
-+#define DMA_STATUS_mskIOOR ( 0x1 << DMDMA_STATUS_offIOOR )
-+#define DMA_STATUS_mskEBUS ( 0x1 << DMDMA_STATUS_offEBUS )
-+#define DMA_STATUS_mskESUP ( 0x1 << DMDMA_STATUS_offESUP )
-+
-+/******************************************************************************
-+ * dmar9: DMA_2DSET (DMA 2D Setup Register)
-+ *****************************************************************************/
-+#define DMA_2DSET_offWECNT 0 /* The Width Element Count for a 2-D region */
-+#define DMA_2DSET_offHTSTR 16 /* The Height Stride for a 2-D region */
-+
-+#define DMA_2DSET_mskHTSTR ( 0xFFFF << DMA_2DSET_offHTSTR )
-+#define DMA_2DSET_mskWECNT ( 0xFFFF << DMA_2DSET_offWECNT )
-+
-+/******************************************************************************
-+ * dmar10: DMA_2DSCTL (DMA 2D Startup Control Register)
-+ *****************************************************************************/
-+#define DMA_2DSCTL_offSTWECNT 0 /* Startup Width Element Count for a 2-D region */
-+/* bit 16:31 reserved */
-+
-+#define DMA_2DSCTL_mskSTWECNT ( 0xFFFF << DMA_2DSCTL_offSTWECNT )
-+
-+/******************************************************************************
-+ * fpcsr: FPCSR (Floating-Point Control Status Register)
-+ *****************************************************************************/
-+#define FPCSR_offRM 0
-+#define FPCSR_offIVO 2
-+#define FPCSR_offDBZ 3
-+#define FPCSR_offOVF 4
-+#define FPCSR_offUDF 5
-+#define FPCSR_offIEX 6
-+#define FPCSR_offIVOE 7
-+#define FPCSR_offDBZE 8
-+#define FPCSR_offOVFE 9
-+#define FPCSR_offUDFE 10
-+#define FPCSR_offIEXE 11
-+#define FPCSR_offDNZ 12
-+#define FPCSR_offIVOT 13
-+#define FPCSR_offDBZT 14
-+#define FPCSR_offOVFT 15
-+#define FPCSR_offUDFT 16
-+#define FPCSR_offIEXT 17
-+#define FPCSR_offDNIT 18
-+#define FPCSR_offRIT 19
-+
-+#define FPCSR_mskRM ( 0x3 << FPCSR_offRM )
-+#define FPCSR_mskIVO ( 0x1 << FPCSR_offIVO )
-+#define FPCSR_mskDBZ ( 0x1 << FPCSR_offDBZ )
-+#define FPCSR_mskOVF ( 0x1 << FPCSR_offOVF )
-+#define FPCSR_mskUDF ( 0x1 << FPCSR_offUDF )
-+#define FPCSR_mskIEX ( 0x1 << FPCSR_offIEX )
-+#define FPCSR_mskIVOE ( 0x1 << FPCSR_offIVOE )
-+#define FPCSR_mskDBZE ( 0x1 << FPCSR_offDBZE )
-+#define FPCSR_mskOVFE ( 0x1 << FPCSR_offOVFE )
-+#define FPCSR_mskUDFE ( 0x1 << FPCSR_offUDFE )
-+#define FPCSR_mskIEXE ( 0x1 << FPCSR_offIEXE )
-+#define FPCSR_mskDNZ ( 0x1 << FPCSR_offDNZ )
-+#define FPCSR_mskIVOT ( 0x1 << FPCSR_offIVOT )
-+#define FPCSR_mskDBZT ( 0x1 << FPCSR_offDBZT )
-+#define FPCSR_mskOVFT ( 0x1 << FPCSR_offOVFT )
-+#define FPCSR_mskUDFT ( 0x1 << FPCSR_offUDFT )
-+#define FPCSR_mskIEXT ( 0x1 << FPCSR_offIEXT )
-+#define FPCSR_mskDNIT ( 0x1 << FPCSR_offDNIT )
-+#define FPCSR_mskRIT ( 0x1 << FPCSR_offRIT )
-+#define FPCSR_mskALL (FPCSR_mskIVO | FPCSR_mskDBZ | FPCSR_mskOVF | FPCSR_mskUDF | FPCSR_mskIEX)
-+#define FPCSR_mskALLE (FPCSR_mskIVOE | FPCSR_mskDBZE | FPCSR_mskOVFE | FPCSR_mskUDFE | FPCSR_mskIEXE)
-+#define FPCSR_mskALLT (FPCSR_mskIVOT | FPCSR_mskDBZT | FPCSR_mskOVFT | FPCSR_mskUDFT | FPCSR_mskIEXT |FPCSR_mskDNIT | FPCSR_mskRIT)
-+
-+/******************************************************************************
-+ * fpcfg: FPCFG (Floating-Point Configuration Register)
-+ *****************************************************************************/
-+#define FPCFG_offSP 0
-+#define FPCFG_offDP 1
-+#define FPCFG_offFREG 2
-+#define FPCFG_offFMA 4
-+#define FPCFG_offIMVER 22
-+#define FPCFG_offAVER 27
-+
-+#define FPCFG_mskSP ( 0x1 << FPCFG_offSP )
-+#define FPCFG_mskDP ( 0x1 << FPCFG_offDP )
-+#define FPCFG_mskFREG ( 0x3 << FPCFG_offFREG )
-+#define FPCFG_mskFMA ( 0x1 << FPCFG_offFMA )
-+#define FPCFG_mskIMVER ( 0x1F << FPCFG_offIMVER )
-+#define FPCFG_mskAVER ( 0x1F << FPCFG_offAVER )
-+
-+/******************************************************************************
-+ * fucpr: FUCOP_CTL (FPU and Coprocessor Enable Control Register)
-+ *****************************************************************************/
-+#define FUCOP_CTL_offCP0EN 0
-+#define FUCOP_CTL_offCP1EN 1
-+#define FUCOP_CTL_offCP2EN 2
-+#define FUCOP_CTL_offCP3EN 3
-+#define FUCOP_CTL_offAUEN 31
-+
-+#define FUCOP_CTL_mskCP0EN ( 0x1 << FUCOP_CTL_offCP0EN )
-+#define FUCOP_CTL_mskCP1EN ( 0x1 << FUCOP_CTL_offCP1EN )
-+#define FUCOP_CTL_mskCP2EN ( 0x1 << FUCOP_CTL_offCP2EN )
-+#define FUCOP_CTL_mskCP3EN ( 0x1 << FUCOP_CTL_offCP3EN )
-+#define FUCOP_CTL_mskAUEN ( 0x1 << FUCOP_CTL_offAUEN )
-+
-+#endif /* __NDS32_BITFIELD_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/bitops.h linux-3.4.113/arch/nds32/include/asm/bitops.h
---- linux-3.4.113.orig/arch/nds32/include/asm/bitops.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/bitops.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,256 @@
-+/*
-+ * linux/arch/nds32/include/asm/bitops.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_BITOPS_H__
-+#define __NDS32_BITOPS_H__
-+
-+#if defined(CONFIG_SMP) || !defined(CONFIG_CPU_DCACHE_WRITETHROUGH)
-+
-+/*
-+#include <linux/irqflags.h>
-+
-+static inline void ____atomic_set_bit(unsigned int bit, volatile unsigned long *p)
-+{
-+ unsigned long flags;
-+ unsigned long mask = 1UL << (bit & 31);
-+
-+ p += bit >> 5;
-+
-+ raw_local_irq_save(flags);
-+ *p |= mask;
-+ raw_local_irq_restore(flags);
-+}
-+
-+static inline void ____atomic_clear_bit(unsigned int bit, volatile unsigned long *p)
-+{
-+ unsigned long flags;
-+ unsigned long mask = 1UL << (bit & 31);
-+
-+ p += bit >> 5;
-+
-+ raw_local_irq_save(flags);
-+ *p &= ~mask;
-+ raw_local_irq_restore(flags);
-+}
-+
-+static inline void ____atomic_change_bit(unsigned int bit, volatile unsigned long *p)
-+{
-+ unsigned long flags;
-+ unsigned long mask = 1UL << (bit & 31);
-+
-+ p += bit >> 5;
-+
-+ raw_local_irq_save(flags);
-+ *p ^= mask;
-+ raw_local_irq_restore(flags);
-+}
-+
-+static inline int
-+____atomic_test_and_set_bit(unsigned int bit, volatile unsigned long *p)
-+{
-+ unsigned long flags;
-+ unsigned int res;
-+ unsigned long mask = 1UL << (bit & 31);
-+
-+ p += bit >> 5;
-+
-+ raw_local_irq_save(flags);
-+ res = *p;
-+ *p = res | mask;
-+ raw_local_irq_restore(flags);
-+
-+ return (res & mask) != 0;
-+}
-+static inline int
-+____atomic_test_and_clear_bit(unsigned int bit, volatile unsigned long *p)
-+{
-+ unsigned long flags;
-+ unsigned int res;
-+ unsigned long mask = 1UL << (bit & 31);
-+
-+ p += bit >> 5;
-+
-+ raw_local_irq_save(flags);
-+ res = *p;
-+ *p = res & ~mask;
-+ raw_local_irq_restore(flags);
-+
-+ return (res & mask) != 0;
-+}
-+
-+static inline int
-+____atomic_test_and_change_bit(unsigned int bit, volatile unsigned long *p)
-+{
-+ unsigned long flags;
-+ unsigned int res;
-+ unsigned long mask = 1UL << (bit & 31);
-+
-+ p += bit >> 5;
-+
-+ raw_local_irq_save(flags);
-+ res = *p;
-+ *p = res ^ mask;
-+ raw_local_irq_restore(flags);
-+
-+ return (res & mask) != 0;
-+}
-+
-+#include <asm-generic/bitops/non-atomic.h>
-+#ifndef CONFIG_SMP
-+#define ATOMIC_BITOP(name,nr,p) \
-+ (__builtin_constant_p(nr) ? ____atomic_##name(nr, p) : _##name(nr,p))
-+#else
-+#define ATOMIC_BITOP(name,nr,p) _##name(nr,p)
-+#endif
-+
-+#define set_bit(nr,p) ATOMIC_BITOP(set_bit,nr,p)
-+*/
-+
-+static inline void set_bit(int nr,volatile unsigned long *addr)
-+{
-+ unsigned long mask = BIT_MASK(nr);
-+ unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
-+ unsigned long tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\tor\t%0, %0, %2\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (tmp)
-+ : "r" (p), "r" (mask)
-+ : "memory");
-+}
-+
-+static inline void clear_bit(int nr, volatile unsigned long *addr)
-+{
-+ unsigned long mask = BIT_MASK(nr);
-+ unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
-+ unsigned long tmp;
-+
-+ mask = ~mask;
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\tand\t%0, %0, %2\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (tmp)
-+ : "r" (p), "r" (mask)
-+ : "memory");
-+}
-+
-+static inline void change_bit(int nr, volatile unsigned long *addr)
-+{
-+ unsigned long mask = BIT_MASK(nr);
-+ unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
-+ unsigned long tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\txor\t%0, %0, %2\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (tmp)
-+ : "r" (p), "r" (mask)
-+ : "memory");
-+}
-+
-+static inline int test_and_set_bit(int nr, volatile unsigned long *addr)
-+{
-+ unsigned long mask = BIT_MASK(nr);
-+ unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
-+ unsigned long tmp ,ret;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%2+$r15]\n"
-+ "\tor\t%1, %0, %3\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (ret), "=&r" (tmp)
-+ : "r" (p), "r" (mask)
-+ : "memory");
-+ return (ret & mask) != 0;
-+}
-+
-+static inline int test_and_clear_bit(int nr, volatile unsigned long *addr)
-+{
-+ unsigned long mask = BIT_MASK(nr);
-+ unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
-+ unsigned long tmp, ret;
-+ unsigned long mask2 = ~mask;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%2+$r15]\n"
-+ "\tand\t%1, %0, %3\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (ret), "=&r" (tmp)
-+ : "r" (p), "r" (mask2)
-+ : "memory");
-+ return (ret & mask) != 0;
-+}
-+
-+static inline int test_and_change_bit(int nr, volatile unsigned long *addr)
-+{
-+ unsigned long mask = BIT_MASK(nr);
-+ unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
-+ unsigned long tmp, ret;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%2+$r15]\n"
-+ "\txor\t%1, %0, %3\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (ret), "=&r" (tmp)
-+ : "r" (p), "r" (mask)
-+ : "memory");
-+ return (ret & mask) != 0;
-+}
-+#else
-+#include <linux/irqflags.h>
-+#include <asm-generic/bitops/atomic.h>
-+#endif
-+
-+#include <linux/compiler.h>
-+#include <asm-generic/bitops/non-atomic.h>
-+#include <asm-generic/bitops/__ffs.h>
-+#include <asm-generic/bitops/ffz.h>
-+#include <asm-generic/bitops/fls.h>
-+#include <asm-generic/bitops/__fls.h>
-+#include <asm-generic/bitops/fls64.h>
-+#include <asm-generic/bitops/find.h>
-+
-+#ifdef __KERNEL__
-+
-+#include <asm-generic/bitops/sched.h>
-+#include <asm-generic/bitops/ffs.h>
-+#include <asm-generic/bitops/hweight.h>
-+#include <asm-generic/bitops/lock.h>
-+
-+#include <asm-generic/bitops/le.h>
-+
-+/*
-+ * Ext2 is defined to use little-endian byte ordering.
-+ */
-+#include <asm-generic/bitops/ext2-atomic-setbit.h>
-+
-+#endif /* __KERNEL__ */
-+
-+#define smp_mb__before_clear_bit() barrier()
-+#define smp_mb__after_clear_bit() barrier()
-+
-+#endif /* __NDS32_BITOPS_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/bitsperlong.h linux-3.4.113/arch/nds32/include/asm/bitsperlong.h
---- linux-3.4.113.orig/arch/nds32/include/asm/bitsperlong.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/bitsperlong.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1 @@
-+#include <asm-generic/bitsperlong.h>
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/bug.h linux-3.4.113/arch/nds32/include/asm/bug.h
---- linux-3.4.113.orig/arch/nds32/include/asm/bug.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/bug.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,18 @@
-+/*
-+ * linux/arch/nds32/include/asm/bug.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_BUG_H__
-+#define __NDS32_BUG_H__
-+
-+#define HAVE_ARCH_BUG
-+#include <asm-generic/bug.h>
-+
-+#define BUG() do { \
-+ dump_stack(); \
-+ printk("BUG: failure at %s:%d/%s()!\n", __FILE__, __LINE__, __FUNCTION__); \
-+ panic("BUG!"); \
-+} while (0)
-+
-+#endif /* __NDS32_BUG_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/bugs.h linux-3.4.113/arch/nds32/include/asm/bugs.h
---- linux-3.4.113.orig/arch/nds32/include/asm/bugs.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/bugs.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/bugs.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_BUGS_H__
-+#define __NDS32_BUGS_H__
-+
-+static inline void check_bugs(void) {}
-+
-+#endif /* __NDS32_BUGS_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/byteorder.h linux-3.4.113/arch/nds32/include/asm/byteorder.h
---- linux-3.4.113.orig/arch/nds32/include/asm/byteorder.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/byteorder.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,15 @@
-+/*
-+ * linux/arch/nds32/include/asm/byteorder.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_BYTEORDER_H__
-+#define __NDS32_BYTEORDER_H__
-+
-+#ifdef __NDS32_EB__
-+#include <linux/byteorder/big_endian.h>
-+#else
-+#include <linux/byteorder/little_endian.h>
-+#endif
-+
-+#endif /* __NDS32_BYTEORDER_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/cacheflush.h linux-3.4.113/arch/nds32/include/asm/cacheflush.h
---- linux-3.4.113.orig/arch/nds32/include/asm/cacheflush.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/cacheflush.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,55 @@
-+/*
-+ * linux/arch/nds32/include/asm/cacheflush.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_CACHEFLUSH_H__
-+#define __NDS32_CACHEFLUSH_H__
-+
-+#include <linux/mm.h>
-+
-+#define PG_dcache_dirty PG_arch_1
-+
-+void flush_cache_mm(struct mm_struct *mm);
-+
-+void flush_cache_dup_mm(struct mm_struct *mm);
-+
-+void flush_cache_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end);
-+
-+void flush_cache_page(struct vm_area_struct *vma,
-+ unsigned long addr, unsigned long pfn);
-+
-+void flush_cache_kmaps(void);
-+
-+void flush_cache_vmap(unsigned long start, unsigned long end);
-+
-+void flush_cache_vunmap(unsigned long start, unsigned long end);
-+
-+
-+void flush_dcache_page(struct page *page);
-+
-+void copy_to_user_page(struct vm_area_struct *vma, struct page *page,
-+ unsigned long vaddr, void *dst, void *src, int len);
-+
-+void copy_from_user_page(struct vm_area_struct *vma, struct page *page,
-+ unsigned long vaddr, void *dst, void *src, int len);
-+
-+#ifndef CONFIG_CPU_CACHE_NONALIASING
-+#define ARCH_HAS_FLUSH_ANON_PAGE
-+void flush_anon_page(struct vm_area_struct *vma,
-+ struct page *page, unsigned long vaddr);
-+
-+#define ARCH_HAS_FLUSH_KERNEL_DCACHE_PAGE
-+void flush_kernel_dcache_page(struct page *page);
-+#endif
-+
-+void flush_icache_range(unsigned long start, unsigned long end);
-+
-+void flush_icache_page(struct vm_area_struct *vma, struct page *page);
-+
-+#define flush_dcache_mmap_lock(mapping) spin_lock_irq(&(mapping)->tree_lock)
-+#define flush_dcache_mmap_unlock(mapping) spin_unlock_irq(&(mapping)->tree_lock)
-+
-+#define ARCH_IMPLEMENTS_FLUSH_DCACHE_PAGE 1
-+#endif /* __NDS32_CACHEFLUSH_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/cache.h linux-3.4.113/arch/nds32/include/asm/cache.h
---- linux-3.4.113.orig/arch/nds32/include/asm/cache.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/cache.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,22 @@
-+/*
-+ * linux/arch/nds32/include/asm/cache.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_CACHE_H__
-+#define __NDS32_CACHE_H__
-+
-+#define L1_CACHE_BYTES 32
-+#define L1_CACHE_SHIFT 5
-+
-+/*
-+ * * Memory returned by kmalloc() may be used for DMA, so we must make
-+ * * sure that all such allocations are cache aligned. Otherwise,
-+ * * unrelated code may cause parts of the buffer to be read into the
-+ * * cache before the transfer is done, causing old data to be seen by
-+ * * the CPU.
-+ * */
-+#define ARCH_DMA_MINALIGN L1_CACHE_BYTES
-+
-+
-+#endif /* __NDS32_CACHE_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/cache_info.h linux-3.4.113/arch/nds32/include/asm/cache_info.h
---- linux-3.4.113.orig/arch/nds32/include/asm/cache_info.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/cache_info.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,17 @@
-+/*
-+ * linux/arch/nds32/include/asm/cache.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+struct cache_info {
-+ unsigned char cache_type;
-+ unsigned char ways;
-+ unsigned char way_bits;
-+ unsigned char line_bits;
-+ unsigned char line_size;
-+ unsigned char set_bits;
-+ unsigned short sets;
-+ unsigned short size;
-+ unsigned short aliasing_num;
-+ unsigned int aliasing_mask;
-+ unsigned int not_aliasing_mask;
-+};
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/checksum.h linux-3.4.113/arch/nds32/include/asm/checksum.h
---- linux-3.4.113.orig/arch/nds32/include/asm/checksum.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/checksum.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,173 @@
-+/*
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 1995, 96, 97, 98, 99, 2001 by Ralf Baechle
-+ * Copyright (C) 1999 Silicon Graphics, Inc.
-+ * Copyright (C) 2001 Thiemo Seufer.
-+ * Copyright (C) 2002 Maciej W. Rozycki
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+#ifndef _ASM_CHECKSUM_H
-+#define _ASM_CHECKSUM_H
-+
-+#include <linux/in6.h>
-+
-+#include <asm/uaccess.h>
-+
-+/*
-+ * computes the checksum of a memory block at buff, length len,
-+ * and adds in "sum" (32-bit)
-+ *
-+ * returns a 32-bit number suitable for feeding into itself
-+ * or csum_tcpudp_magic
-+ *
-+ * this function must be called with even lengths, except
-+ * for the last fragment, which may be odd
-+ *
-+ * it's best to have buff aligned on a 32-bit boundary
-+ */
-+unsigned int csum_partial(const void *buff, int len, unsigned int sum);
-+
-+/*
-+ * this is a new version of the above that records errors it finds in *errp,
-+ * but continues and zeros the rest of the buffer.
-+ */
-+unsigned int csum_partial_copy_from_user(const unsigned char *src, unsigned char *dst, int len,
-+ unsigned int sum, int *errp);
-+
-+/*
-+ * Copy and checksum to user
-+ */
-+#define HAVE_CSUM_COPY_USER
-+static inline unsigned int csum_and_copy_to_user (const unsigned char *src,
-+ unsigned char __user *dst,
-+ int len, int sum,
-+ int *err_ptr)
-+{
-+ sum = csum_partial(src, len, sum);
-+
-+ if (copy_to_user(dst, src, len)) {
-+ *err_ptr = -EFAULT;
-+ return -1;
-+ }
-+
-+ return sum;
-+}
-+
-+/*
-+ * the same as csum_partial, but copies from user space (but on MIPS
-+ * we have just one address space, so this is identical to the above)
-+ */
-+unsigned int csum_partial_copy_nocheck(const unsigned char *src, unsigned char *dst,
-+ int len, unsigned int sum);
-+
-+/*
-+ * Fold a partial checksum without adding pseudo headers
-+ */
-+static inline unsigned short int csum_fold(unsigned int sum)
-+{
-+ __asm__(
-+ "slli\t$p1,%0,16\n\t"
-+ "add\t%0,%0,$p1\n\t"
-+ "slt\t$p1,%0,$p1\n\t"
-+ "srli\t%0,%0,16\n\t"
-+ "add\t%0,%0,$p1\n\t"
-+ "movi\t$p1,0xffff\n\t"
-+ "xor\t%0,%0,$p1"
-+ : "=r" (sum)
-+ : "0" (sum));
-+
-+ return sum;
-+}
-+
-+/*
-+ * This is a version of ip_compute_csum() optimized for IP headers,
-+ * which always checksum on 4 octet boundaries.
-+ *
-+ * By Jorge Cwik <jorge@laser.satlink.net>, adapted for linux by
-+ * Arnt Gulbrandsen.
-+ */
-+static inline unsigned short ip_fast_csum(unsigned char *iph, unsigned int ihl)
-+{
-+ unsigned int *word = (unsigned int *) iph;
-+ unsigned int *stop = word + ihl;
-+ unsigned int csum;
-+ int carry;
-+
-+ csum = word[0];
-+ csum += word[1];
-+ carry = (csum < word[1]);
-+ csum += carry;
-+
-+ csum += word[2];
-+ carry = (csum < word[2]);
-+ csum += carry;
-+
-+ csum += word[3];
-+ carry = (csum < word[3]);
-+ csum += carry;
-+
-+ word += 4;
-+ do {
-+ csum += *word;
-+ carry = (csum < *word);
-+ csum += carry;
-+ word++;
-+ } while (word != stop);
-+
-+ return csum_fold(csum);
-+}
-+
-+static inline unsigned int csum_tcpudp_nofold(unsigned long saddr,
-+ unsigned long daddr, unsigned short len, unsigned short proto,
-+ unsigned int sum)
-+{
-+ __asm__(
-+ "add\t%0, %0, %2\n\t"
-+ "slt\t$p1, %0, %2\n\t"
-+ "add\t%0, %0, $p1\n\t"
-+
-+ "add\t%0, %0, %3\n\t"
-+ "slt\t$p1, %0, %3\n\t"
-+ "add\t%0, %0, $p1\n\t"
-+
-+ "add\t%0, %0, %4\n\t"
-+ "slt\t$p1, %0, %4\n\t"
-+ "add\t%0, %0, $p1"
-+ : "=r" (sum)
-+ : "0" (daddr), "r"(saddr),
-+#ifdef __NDS32_EL__
-+ "r" (((unsigned long)htons(len)<<16) + proto*256),
-+#else
-+ "r" (((unsigned long)(proto)<<16) + len),
-+#endif
-+ "r" ((__force unsigned long)sum));
-+
-+ return sum;
-+}
-+
-+/*
-+ * computes the checksum of the TCP/UDP pseudo-header
-+ * returns a 16-bit checksum, already complemented
-+ */
-+static inline unsigned short int csum_tcpudp_magic(unsigned long saddr,
-+ unsigned long daddr,
-+ unsigned short len,
-+ unsigned short proto,
-+ unsigned int sum)
-+{
-+ return csum_fold(csum_tcpudp_nofold(saddr, daddr, len, proto, sum));
-+}
-+
-+/*
-+ * this routine is used for miscellaneous IP-like checksums, mainly
-+ * in icmp.c
-+ */
-+static inline unsigned short ip_compute_csum(const void * buff, int len)
-+{
-+ return csum_fold(csum_partial(buff, len, 0));
-+}
-+
-+#endif /* _ASM_CHECKSUM_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/cmpxchg.h linux-3.4.113/arch/nds32/include/asm/cmpxchg.h
---- linux-3.4.113.orig/arch/nds32/include/asm/cmpxchg.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/cmpxchg.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,88 @@
-+#ifndef __ASM_NDS32_CMPXCHG_H
-+#define __ASM_NDS32_CMPXCHG_H
-+
-+#include <asm/barrier.h>
-+
-+#define xchg(ptr,x) \
-+ ((__typeof__(*(ptr)))__xchg((unsigned long)(x),(ptr),sizeof(*(ptr))))
-+
-+static inline unsigned long __xchg(unsigned long x, volatile void *ptr, int size)
-+{
-+ extern void __bad_xchg(volatile void *, int);
-+ unsigned long ret;
-+ unsigned long flags;
-+
-+ switch (size) {
-+ case 4:
-+#if defined(CONFIG_SMP) || !defined(CONFIG_CPU_DCACHE_WRITETHROUGH)
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%2+$r15]\n"
-+ "\tori\t%1, %3, #0x0\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (ret), "=&r" (flags)
-+ : "r" (ptr), "r" (x)
-+ : "memory");
-+#else
-+ raw_local_irq_save(flags);
-+ ret = *(volatile unsigned long *)ptr;
-+ *(volatile unsigned long *)ptr = x;
-+ raw_local_irq_restore(flags);
-+#endif
-+ break;
-+ default:
-+ __bad_xchg(ptr, size);
-+ ret = 0;
-+ }
-+ return ret;
-+}
-+
-+
-+#define __HAVE_ARCH_CMPXCHG 1
-+
-+static inline unsigned long __cmpxchg(volatile void * ptr, unsigned long old,
-+ unsigned long new, int size)
-+{
-+ extern void __cmpxchg_called_with_bad_pointer(void); /*nonexistence */
-+ unsigned long retval, tmp;
-+ unsigned long flags;
-+ switch (size) {
-+ case 4:
-+#if defined(CONFIG_SMP) || !defined(CONFIG_CPU_DCACHE_WRITETHROUGH)
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%3+$r15]\n"
-+ "\tsub\t%2, %0, %5\n"
-+ "\tcmovz\t%1, %4, %2\n"
-+ "\tcmovn\t%1, %0, %2\n"
-+ "\tscw\t%1, [%3+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (retval), "=&r" (flags), "=&r" (tmp)
-+ : "r" (ptr), "r" (new), "r" (old));
-+#else
-+ raw_local_irq_save(flags);
-+ retval = *(volatile unsigned long *)ptr;
-+ if (retval == old)
-+ *(volatile unsigned long *)ptr = new;
-+ raw_local_irq_restore(flags);
-+#endif
-+ break;
-+ default:
-+ __cmpxchg_called_with_bad_pointer();
-+ tmp = 0;
-+ }
-+ return retval;
-+}
-+
-+#define cmpxchg(ptr,o,n) \
-+ ({ \
-+ __typeof__(*(ptr)) _o_ = (o); \
-+ __typeof__(*(ptr)) _n_ = (n); \
-+ (__typeof__(*(ptr))) __cmpxchg((ptr), (unsigned long)_o_, \
-+ (unsigned long)_n_, sizeof(*(ptr))); \
-+ })
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/cpu.h linux-3.4.113/arch/nds32/include/asm/cpu.h
---- linux-3.4.113.orig/arch/nds32/include/asm/cpu.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/cpu.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,25 @@
-+/*
-+ * linux/arch/nds32/include/asm/cpu.h
-+ *
-+ * Copyright (C) 2004-2005 ARM Ltd.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_NDS32_CPU_H
-+#define __ASM_NDS32_CPU_H
-+
-+#include <linux/percpu.h>
-+
-+struct cpuinfo_nds32 {
-+ struct cpu cpu;
-+#ifdef CONFIG_SMP
-+ unsigned int loops_per_jiffy;
-+#endif
-+};
-+
-+DECLARE_PER_CPU(struct cpuinfo_nds32, cpu_data);
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/cputime.h linux-3.4.113/arch/nds32/include/asm/cputime.h
---- linux-3.4.113.orig/arch/nds32/include/asm/cputime.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/cputime.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/cputime.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_CPUTIME_H__
-+#define __NDS32_CPUTIME_H__
-+
-+#include <asm-generic/cputime.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/cpuver.h linux-3.4.113/arch/nds32/include/asm/cpuver.h
---- linux-3.4.113.orig/arch/nds32/include/asm/cpuver.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/cpuver.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,34 @@
-+/*
-+ * linux/arch/nds32/include/asm/cpuver.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_CPUVER_H__
-+#define __NDS32_CPUVER_H__
-+
-+#include <asm/bitfield.h>
-+#include <asm/reg_access.h>
-+
-+#define GET_CPU_ID()\
-+ (( GET_CPU_VER() & CPU_VER_mskCPUID) >> CPU_VER_offCPUID)
-+
-+#define GET_CPU_REV()\
-+ (( GET_CPU_VER() & CPU_VER_mskREV) >> CPU_VER_offREV)
-+
-+#define GET_CPU_CFGID()\
-+ (( GET_CPU_VER() & CPU_VER_mskCFGID) >> CPU_VER_offCFGID)
-+
-+#define CPU_IS_N1213_43U1HA0()\
-+ (((GET_CPU_VER() & CPU_VER_mskCPUID) == 0x0c000000) &&\
-+ ((GET_CPU_VER() & CPU_VER_mskREV) == 0x00010000))
-+
-+#define CPU_IS_N1213_43U1HB0()\
-+ (((GET_CPU_VER() & CPU_VER_mskCPUID) == 0x0c000000) &&\
-+ ((GET_CPU_VER() & CPU_VER_mskREV) == 0x00020000))
-+
-+#define CPU_IS_N1033_S()\
-+ (((GET_CPU_VER() & CPU_VER_mskCPUID) == 0x0a000000) &&\
-+ ((GET_CPU_VER() & CPU_VER_mskREV) == 0x000c0000))
-+
-+#endif
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/current.h linux-3.4.113/arch/nds32/include/asm/current.h
---- linux-3.4.113.orig/arch/nds32/include/asm/current.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/current.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,18 @@
-+/*
-+ * linux/arch/nds32/include/asm/current.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_CURRENT_H__
-+#define __NDS32_CURRENT_H__
-+
-+#include <linux/thread_info.h>
-+
-+static inline struct task_struct *get_current(void)
-+{
-+ return current_thread_info()->task;
-+}
-+
-+#define current get_current()
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/delay.h linux-3.4.113/arch/nds32/include/asm/delay.h
---- linux-3.4.113.orig/arch/nds32/include/asm/delay.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/delay.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,39 @@
-+/*
-+ * linux/arch/nds32/include/asm/delay.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_DELAY_H__
-+#define __NDS32_DELAY_H__
-+
-+#include <asm/param.h>
-+
-+static inline void __delay(unsigned long loops)
-+{
-+ __asm__ __volatile__ (
-+ "1:\n"
-+ "\taddi\t%0, %0, -1\n"
-+ "\tbgtz\t%0, 1b\n"
-+ : "=r" (loops) : "0" (loops));
-+}
-+
-+static inline void __udelay(unsigned long usecs, unsigned long lpj)
-+{
-+ usecs *= (unsigned long) (((0x8000000000000000ULL / (500000 / HZ)) +
-+ 0x80000000ULL) >> 32);
-+ usecs=(unsigned long)(((unsigned long long)usecs*lpj)>>32);
-+ __delay(usecs);
-+}
-+
-+#define udelay(usecs) __udelay((usecs), loops_per_jiffy)
-+
-+/* make sure "usecs *= ..." in udelay do not overflow. */
-+#if HZ >= 1000
-+#define MAX_UDELAY_MS 1
-+#elif HZ <= 200
-+#define MAX_UDELAY_MS 5
-+#else
-+#define MAX_UDELAY_MS (1000 / HZ)
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/device.h linux-3.4.113/arch/nds32/include/asm/device.h
---- linux-3.4.113.orig/arch/nds32/include/asm/device.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/device.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/device.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_DEVICE_H__
-+#define __NDS32_DEVICE_H__
-+
-+#include <asm-generic/device.h>
-+
-+#endif /* __NDS32_DEVICE_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/div64.h linux-3.4.113/arch/nds32/include/asm/div64.h
---- linux-3.4.113.orig/arch/nds32/include/asm/div64.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/div64.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/div64.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_DIV64_H__
-+#define __NDS32_DIV64_H__
-+
-+#include <asm-generic/div64.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/dmad.h linux-3.4.113/arch/nds32/include/asm/dmad.h
---- linux-3.4.113.orig/arch/nds32/include/asm/dmad.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/dmad.h 2016-12-01 20:59:24.332611980 +0100
-@@ -0,0 +1,1071 @@
-+/*
-+ * Copyright Andes Technology Corporation 2007-2008
-+ * All Rights Reserved.
-+ *
-+ * Revision History:
-+ *
-+ * Aug.21.2007 Created.
-+ *
-+ * DESCRIPTION
-+ *
-+ * DMA controller driver internal supplement library.
-+ *
-+ */
-+
-+#ifndef __NDS_DMAD_INC__
-+#define __NDS_DMAD_INC__
-+
-+#include <asm/spec.h>
-+
-+/*****************************************************************************
-+ * Configuration section
-+*****************************************************************************/
-+
-+/* Debug trace enable switch */
-+#define DMAD_ERROR_TRACE 1 /* message for fatal errors */
-+//MOD by river 2010.10.19
-+#define DMAD_DEBUG_TRACE 0 /* message for debug trace */
-+//End MOD by river 2010.10.19
-+
-+//#ifndef addr_t
-+typedef u32 addr_t;
-+//#endif
-+/* for amerald */
-+#define AMERALD_PRODUCT_ID 0x41471000
-+#define AMERALD_MASK 0xFFFFF000
-+
-+/*****************************************************************************
-+ * DMAC - AG101 AHB
-+*****************************************************************************/
-+/* Device base address */
-+#define DMAC_BASE DMAC_FTDMAC020_0_VA_BASE
-+
-+/* DMA controller registers (8-bit width) */
-+#define DMAC_INT (DMAC_BASE + 0x00)
-+#define DMAC_INT_TC (DMAC_BASE + 0x04)
-+#define DMAC_INT_TC_CLR (DMAC_BASE + 0x08)
-+#define DMAC_INT_ERRABT (DMAC_BASE + 0x0c)
-+#define DMAC_INT_ERRABT_CLR (DMAC_BASE + 0x10)
-+#define DMAC_TC (DMAC_BASE + 0x14)
-+#define DMAC_ERRABT (DMAC_BASE + 0x18)
-+#define DMAC_CH_EN (DMAC_BASE + 0x1c)
-+#define DMAC_CH_BUSY (DMAC_BASE + 0x20)
-+#define DMAC_CSR (DMAC_BASE + 0x24)
-+#define DMAC_SYNC (DMAC_BASE + 0x28)
-+
-+/* DMA channel registers base address */
-+#define DMAC_C0_OFFSET 0x100
-+#define DMAC_C1_OFFSET 0x120
-+#define DMAC_C2_OFFSET 0x140
-+#define DMAC_C3_OFFSET 0x160
-+#define DMAC_C4_OFFSET 0x180
-+#define DMAC_C5_OFFSET 0x1a0
-+#define DMAC_C6_OFFSET 0x1c0
-+#define DMAC_C7_OFFSET 0x1e0
-+
-+#define DMAC_C0_BASE (DMAC_BASE + DMAC_C0_OFFSET)
-+#define DMAC_C1_BASE (DMAC_BASE + DMAC_C1_OFFSET)
-+#define DMAC_C2_BASE (DMAC_BASE + DMAC_C2_OFFSET)
-+#define DMAC_C3_BASE (DMAC_BASE + DMAC_C3_OFFSET)
-+#define DMAC_C4_BASE (DMAC_BASE + DMAC_C4_OFFSET)
-+#define DMAC_C5_BASE (DMAC_BASE + DMAC_C5_OFFSET)
-+#define DMAC_C6_BASE (DMAC_BASE + DMAC_C6_OFFSET)
-+#define DMAC_C7_BASE (DMAC_BASE + DMAC_C7_OFFSET)
-+
-+#define DMAC_MAX_CHANNELS 8
-+#define DMAC_BASE_CH(n) (DMAC_C0_BASE + \
-+ (DMAC_C1_OFFSET - DMAC_C0_OFFSET) * \
-+ (addr_t)(n)) /* n = 0 ~ 3 */
-+
-+#define DMAC_CSR_OFFSET 0x00
-+#define DMAC_CFG_OFFSET 0x04
-+#define DMAC_SRC_ADDR_OFFSET 0x08
-+#define DMAC_DST_ADDR_OFFSET 0x0c
-+#define DMAC_LLP_OFFSET 0x10
-+#define DMAC_SIZE_OFFSET 0x14
-+
-+/* DMA channel 0 registers (32-bit width) */
-+#define DMAC_C0_CSR (DMAC_C0_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C0_CFG (DMAC_C0_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C0_SRC_ADDR (DMAC_C0_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C0_DST_ADDR (DMAC_C0_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C0_LLP (DMAC_C0_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C0_SIZE (DMAC_C0_BASE + DMAC_SIZE_OFFSET)
-+
-+/* DMA channel 1 registers (32-bit width) */
-+#define DMAC_C1_CSR (DMAC_C1_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C1_CFG (DMAC_C1_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C1_SRC_ADDR (DMAC_C1_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C1_DST_ADDR (DMAC_C1_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C1_LLP (DMAC_C1_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C1_SIZE (DMAC_C1_BASE + DMAC_SIZE_OFFSET)
-+
-+/* DMA channel 2 registers (32-bit width) */
-+#define DMAC_C2_CSR (DMAC_C2_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C2_CFG (DMAC_C2_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C2_SRC_ADDR (DMAC_C2_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C2_DST_ADDR (DMAC_C2_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C2_LLP (DMAC_C2_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C2_SIZE (DMAC_C2_BASE + DMAC_SIZE_OFFSET)
-+
-+/* DMA channel 3 registers (32-bit width) */
-+#define DMAC_C3_CSR (DMAC_C3_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C3_CFG (DMAC_C3_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C3_SRC_ADDR (DMAC_C3_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C3_DST_ADDR (DMAC_C3_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C3_LLP (DMAC_C3_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C3_SIZE (DMAC_C3_BASE + DMAC_SIZE_OFFSET)
-+
-+/* DMA channel 4 registers (32-bit width) */
-+#define DMAC_C4_CSR (DMAC_C4_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C4_CFG (DMAC_C4_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C4_SRC_ADDR (DMAC_C4_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C4_DST_ADDR (DMAC_C4_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C4_LLP (DMAC_C4_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C4_SIZE (DMAC_C4_BASE + DMAC_SIZE_OFFSET)
-+
-+/* DMA channel 5 registers (32-bit width) */
-+#define DMAC_C5_CSR (DMAC_C5_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C5_CFG (DMAC_C5_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C5_SRC_ADDR (DMAC_C5_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C5_DST_ADDR (DMAC_C5_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C5_LLP (DMAC_C5_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C5_SIZE (DMAC_C5_BASE + DMAC_SIZE_OFFSET)
-+
-+/* DMA channel 6 registers (32-bit width) */
-+#define DMAC_C6_CSR (DMAC_C6_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C6_CFG (DMAC_C6_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C6_SRC_ADDR (DMAC_C6_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C6_DST_ADDR (DMAC_C6_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C6_LLP (DMAC_C6_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C6_SIZE (DMAC_C6_BASE + DMAC_SIZE_OFFSET)
-+
-+/* DMA channel 7 registers (32-bit width) */
-+#define DMAC_C7_CSR (DMAC_C7_BASE + DMAC_CSR_OFFSET)
-+#define DMAC_C7_CFG (DMAC_C7_BASE + DMAC_CFG_OFFSET)
-+#define DMAC_C7_SRC_ADDR (DMAC_C7_BASE + DMAC_SRC_ADDR_OFFSET)
-+#define DMAC_C7_DST_ADDR (DMAC_C7_BASE + DMAC_DST_ADDR_OFFSET)
-+#define DMAC_C7_LLP (DMAC_C7_BASE + DMAC_LLP_OFFSET)
-+#define DMAC_C7_SIZE (DMAC_C7_BASE + DMAC_SIZE_OFFSET)
-+
-+/*****************************************************************************
-+ * DMAC defs - AG101 AHB
-+*****************************************************************************/
-+
-+/* Interrupt status register (+00) */
-+#define DMAC_INT0_MASK 0x01
-+#define DMAC_INT0_BIT 0
-+#define DMAC_INT1_MASK 0x02
-+#define DMAC_INT1_BIT 1
-+#define DMAC_INT2_MASK 0x04
-+#define DMAC_INT2_BIT 2
-+#define DMAC_INT3_MASK 0x08
-+#define DMAC_INT3_BIT 3
-+
-+/* Interrupt for terminal count status register (+0x04) */
-+#define DMAC_INT_TC0_MASK 0x01
-+#define DMAC_INT_TC0_BIT 0
-+#define DMAC_INT_TC1_MASK 0x02
-+#define DMAC_INT_TC1_BIT 1
-+#define DMAC_INT_TC2_MASK 0x04
-+#define DMAC_INT_TC2_BIT 2
-+#define DMAC_INT_TC3_MASK 0x08
-+#define DMAC_INT_TC3_BIT 3
-+#define DMAC_INT_TC4_MASK 0x01
-+#define DMAC_INT_TC4_BIT 0
-+#define DMAC_INT_TC5_MASK 0x02
-+#define DMAC_INT_TC5_BIT 1
-+#define DMAC_INT_TC6_MASK 0x04
-+#define DMAC_INT_TC6_BIT 2
-+#define DMAC_INT_TC7_MASK 0x08
-+#define DMAC_INT_TC7_BIT 3
-+
-+#define DMAC_INT_TC_MASK 0xff
-+#define DMAC_INT_TC_SHIFT 0
-+
-+/* Interrupt for terminal count clear register (+0x08) */
-+#define DMAC_INT_TC0_CLR_MASK 0x01
-+#define DMAC_INT_TC0_CLR_BIT 0
-+#define DMAC_INT_TC1_CLR_MASK 0x02
-+#define DMAC_INT_TC1_CLR_BIT 1
-+#define DMAC_INT_TC2_CLR_MASK 0x04
-+#define DMAC_INT_TC2_CLR_BIT 2
-+#define DMAC_INT_TC3_CLR_MASK 0x08
-+#define DMAC_INT_TC3_CLR_BIT 3
-+
-+#define DMAC_INT_TC_CLR_MASK 0x0f
-+#define DMAC_INT_TC_CLR_SHIFT 0
-+
-+/* Interrupt for error/abort status register (+0x0c, 32-bits width) */
-+#define DMAC_INT_ERR0_MASK 0x00000001
-+#define DMAC_INT_ERR0_BIT 0
-+#define DMAC_INT_ERR1_MASK 0x00000002
-+#define DMAC_INT_ERR1_BIT 1
-+#define DMAC_INT_ERR2_MASK 0x00000004
-+#define DMAC_INT_ERR2_BIT 2
-+#define DMAC_INT_ERR3_MASK 0x00000008
-+#define DMAC_INT_ERR3_BIT 3
-+
-+#define DMAC_INT_ERR_MASK 0x0000000f
-+#define DMAC_INT_ERR_SHIFT 0
-+
-+#define DMAC_INT_ABT0_MASK 0x00010000
-+#define DMAC_INT_ABT0_BIT 16
-+#define DMAC_INT_ABT1_MASK 0x00020000
-+#define DMAC_INT_ABT1_BIT 17
-+#define DMAC_INT_ABT2_MASK 0x00040000
-+#define DMAC_INT_ABT2_BIT 18
-+#define DMAC_INT_ABT3_MASK 0x00080000
-+#define DMAC_INT_ABT3_BIT 19
-+
-+#define DMAC_INT_ABT_MASK 0x000f0000
-+#define DMAC_INT_ABT_SHIFT 16
-+
-+/* Interrupt for error/abort status clear register (+0x10, 32-bits width) */
-+#define DMAC_INT_ERR0_CLR_MASK 0x00000001
-+#define DMAC_INT_ERR0_CLR_BIT 0
-+#define DMAC_INT_ERR1_CLR_MASK 0x00000002
-+#define DMAC_INT_ERR1_CLR_BIT 1
-+#define DMAC_INT_ERR2_CLR_MASK 0x00000004
-+#define DMAC_INT_ERR2_CLR_BIT 2
-+#define DMAC_INT_ERR3_CLR_MASK 0x00000008
-+#define DMAC_INT_ERR3_CLR_BIT 3
-+
-+#define DMAC_INT_ERR_CLR_MASK 0x0000000f
-+#define DMAC_INT_ERR_CLR_SHIFT 0
-+
-+#define DMAC_INT_ABT0_CLR_MASK 0x00010000
-+#define DMAC_INT_ABT0_CLR_BIT 16
-+#define DMAC_INT_ABT1_CLR_MASK 0x00020000
-+#define DMAC_INT_ABT1_CLR_BIT 17
-+#define DMAC_INT_ABT2_CLR_MASK 0x00040000
-+#define DMAC_INT_ABT2_CLR_BIT 18
-+#define DMAC_INT_ABT3_CLR_MASK 0x00080000
-+#define DMAC_INT_ABT3_CLR_BIT 19
-+
-+#define DMAC_INT_ABT_CLR_MASK 0x000f0000
-+#define DMAC_INT_ABT_CLR_SHIFT 16
-+
-+/* Terminal count status register (+0x14) */
-+#define DMAC_TC0_MASK 0x01
-+#define DMAC_TC0_BIT 0
-+#define DMAC_TC1_MASK 0x02
-+#define DMAC_TC1_BIT 1
-+#define DMAC_TC2_MASK 0x04
-+#define DMAC_TC2_BIT 2
-+#define DMAC_TC3_MASK 0x08
-+#define DMAC_TC3_BIT 3
-+
-+/* Error/abort status register (+0x18, 32-bits width) */
-+#define DMAC_ERR0_MASK 0x00000001
-+#define DMAC_ERR0_BIT 0
-+#define DMAC_ERR1_MASK 0x00000002
-+#define DMAC_ERR1_BIT 1
-+#define DMAC_ERR2_MASK 0x00000004
-+#define DMAC_ERR2_BIT 2
-+#define DMAC_ERR3_MASK 0x00000008
-+#define DMAC_ERR3_BIT 3
-+
-+#define DMAC_ABT0_MASK 0x00010000
-+#define DMAC_ABT0_BIT 16
-+#define DMAC_ABT1_MASK 0x00020000
-+#define DMAC_ABT1_BIT 17
-+#define DMAC_ABT2_MASK 0x00040000
-+#define DMAC_ABT2_BIT 18
-+#define DMAC_ABT3_MASK 0x00080000
-+#define DMAC_ABT3_BIT 19
-+
-+/* Channel enable status register (+0x1c) */
-+#define DMAC_CH0_EN_MASK 0x01
-+#define DMAC_CH0_EN_BIT 0
-+#define DMAC_CH1_EN_MASK 0x02
-+#define DMAC_CH1_EN_BIT 1
-+#define DMAC_CH2_EN_MASK 0x04
-+#define DMAC_CH2_EN_BIT 2
-+#define DMAC_CH3_EN_MASK 0x08
-+#define DMAC_CH3_EN_BIT 3
-+
-+/* Channel busy status register (+0x20) */
-+#define DMAC_CH0_BUSY_MASK 0x01
-+#define DMAC_CH0_BUSY_BIT 0
-+#define DMAC_CH1_BUSY_MASK 0x02
-+#define DMAC_CH1_BUSY_BIT 1
-+#define DMAC_CH2_BUSY_MASK 0x04
-+#define DMAC_CH2_BUSY_BIT 2
-+#define DMAC_CH3_BUSY_MASK 0x08
-+#define DMAC_CH3_BUSY_BIT 3
-+
-+/* Main configuration status register (+0x24) */
-+#define DMAC_DMACEN_MASK 0x01
-+#define DMAC_DMACEN_BIT 0
-+#define DMAC_M0ENDIAN_MASK 0x02
-+#define DMAC_M0ENDIAN_BIT 1
-+#define DMAC_M1ENDIAN_MASK 0x04
-+#define DMAC_M1ENDIAN_BIT 2
-+
-+ #define DMAC_ENDIAN_LITTLE 0
-+ #define DMAC_ENDIAN_BIG 1
-+
-+/* Sync register (+0x28) */
-+#define DMAC_SYNC0_MASK 0x01
-+#define DMAC_SYNC0_BIT 0
-+#define DMAC_SYNC1_MASK 0x02
-+#define DMAC_SYNC1_BIT 1
-+#define DMAC_SYNC2_MASK 0x04
-+#define DMAC_SYNC2_BIT 2
-+#define DMAC_SYNC3_MASK 0x08
-+#define DMAC_SYNC3_BIT 3
-+
-+/* DMA channel 0~n Control Registers (CH[n]_BASE + 0x00) */
-+#define DMAC_CSR_CH_EN_MASK 0x00000001
-+#define DMAC_CSR_CH_EN_BIT 0
-+
-+#define DMAC_CSR_DST_SEL_MASK 0x00000002
-+#define DMAC_CSR_DST_SEL_BIT 1
-+#define DMAC_CSR_SRC_SEL_MASK 0x00000004
-+#define DMAC_CSR_SRC_SEL_BIT 2
-+ #define DMAC_CSR_SEL_MASTER0 0x00
-+ #define DMAC_CSR_SEL_MASTER1 0x01
-+
-+#define DMAC_CSR_DSTAD_CTL_MASK 0x00000018
-+#define DMAC_CSR_DSTAD_CTL_SHIFT 3
-+#define DMAC_CSR_SRCAD_CTL_MASK 0x00000060
-+#define DMAC_CSR_SRCAD_CTL_SHIFT 5
-+ #define DMAC_CSR_AD_INC 0x00
-+ #define DMAC_CSR_AD_DEC 0x01
-+ #define DMAC_CSR_AD_FIX 0x02
-+
-+#define DMAC_CSR_MODE_MASK 0x00000080
-+#define DMAC_CSR_MODE_BIT 7
-+ #define DMAC_CSR_MODE_NORMAL 0x00
-+ #define DMAC_CSR_MODE_HSHK 0x01
-+
-+#define DMAC_CSR_DST_WIDTH_MASK 0x00000700
-+#define DMAC_CSR_DST_WIDTH_SHIFT 8
-+#define DMAC_CSR_SRC_WIDTH_MASK 0x00003800
-+#define DMAC_CSR_SRC_WIDTH_SHIFT 11
-+ #define DMAC_CSR_WIDTH_8 0x00
-+ #define DMAC_CSR_WIDTH_16 0x01
-+ #define DMAC_CSR_WIDTH_32 0x02
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+#define DMAC_CYCLE_TO_BYTES(cycle, width) ((cycle) << (width))
-+#define DMAC_BYTES_TO_CYCLE(bytes, width) ((bytes) >> (width))
-+#else
-+#define DMAC_CYCLE_TO_BYTES(cycle, width) 0
-+#define DMAC_BYTES_TO_CYCLE(bytes, width) 0
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+#define DMAC_CSR_ABT 0x00008000
-+#define DMAC_CSR_ABT_BIT 15
-+
-+#define DMAC_CSR_SRC_SIZE_MASK 0x00070000
-+#define DMAC_CSR_SRC_SIZE_SHIFT 16
-+ #define DMAC_CSR_SIZE_1 0x00
-+ #define DMAC_CSR_SIZE_4 0x01
-+ #define DMAC_CSR_SIZE_8 0x02
-+ #define DMAC_CSR_SIZE_16 0x03
-+ #define DMAC_CSR_SIZE_32 0x04
-+ #define DMAC_CSR_SIZE_64 0x05
-+ #define DMAC_CSR_SIZE_128 0x06
-+ #define DMAC_CSR_SIZE_256 0x07
-+
-+#define DMAC_CSR_PROT1 0x00080000
-+#define DMAC_CSR_PROT1_BIT 19
-+#define DMAC_CSR_PROT2 0x00100000
-+#define DMAC_CSR_PROT2_BIT 20
-+#define DMAC_CSR_PROT3 0x00200000
-+#define DMAC_CSR_PROT3_BIT 21
-+
-+#define DMAC_CSR_CHPRI_MASK 0x00c00000
-+#define DMAC_CSR_CHPRI_SHIFT 22
-+ #define DMAC_CSR_CHPRI_0 0x00
-+ #define DMAC_CSR_CHPRI_1 0x01
-+ #define DMAC_CSR_CHPRI_2 0x02
-+ #define DMAC_CSR_CHPRI_3 0x03
-+
-+#define DMAC_CSR_FF_TH_MASK 0x07000000
-+#define DMAC_CSR_FF_TH_SHIFT 24
-+ #define DMAC_CSR_FF_TH_1 0x00
-+ #define DMAC_CSR_FF_TH_2 0x01
-+ #define DMAC_CSR_FF_TH_4 0x02
-+ #define DMAC_CSR_FF_TH_8 0x03
-+ #define DMAC_CSR_FF_TH_16 0x04
-+
-+#define DMAC_CSR_TC_MSK_MSK 0x80000000
-+#define DMAC_CSR_TC_MSK_BIT 31
-+
-+/* DMA channel 0~n Configuration Registers (CH[n]_BASE + 0x04) */
-+#define DMAC_CFG_INT_TC_MSK 0x00000001
-+#define DMAC_CFG_INT_TC_MSK_BIT 0
-+#define DMAC_CFG_INT_ERR_MSK 0x00000002
-+#define DMAC_CFG_INT_ERR_MSK_BIT 1
-+#define DMAC_CFG_INT_ABT_MSK 0x00000004
-+#define DMAC_CFG_INT_ABT_MSK_BIT 2
-+
-+#define DMAC_CFG_INT_SRC_RS_MASK 0x00000078
-+#define DMAC_CFG_INT_SRC_RS_SHIFT 3
-+#define DMAC_CFG_INT_SRC_HE_MASK 0x00000080
-+#define DMAC_CFG_INT_SRC_HE_BIT 7
-+
-+#define DMAC_CFG_BUSY_MASK 0x00000100
-+#define DMAC_CFG_BUSY_BIT 8
-+
-+#define DMAC_CFG_INT_DST_RS_MASK 0x00001e00
-+#define DMAC_CFG_INT_DST_RS_SHIFT 9
-+#define DMAC_CFG_INT_DST_HE_MASK 0x00002000
-+#define DMAC_CFG_INT_DST_HE_BIT 13
-+
-+#ifdef CONFIG_PLAT_AG102
-+ #define DMAC_REQN_IDERX 0
-+ #define DMAC_REQN_IDETX 1
-+ #define DMAC_REQN_I2SAC97RX 2
-+ #define DMAC_REQN_I2SAC97TX 3
-+ #define DMAC_REQN_UART2RX 4
-+ #define DMAC_REQN_UART2TX 5
-+ #define DMAC_REQN_UART1RX 6
-+ #define DMAC_REQN_UART1TX 7
-+ #define DMAC_REQN_SDC 8
-+ #define DMAC_REQN_CFC 9
-+ #define DMAC_REQN_LPCREQ0 10
-+ #define DMAC_REQN_LPCREQ1 11
-+ #define DMAC_REQN_LPCREQ2 12
-+ #define DMAC_REQN_LPCREQ3 13
-+ #define DMAC_REQN_NONE 14
-+ #define DMAC_REQN_LPCREQ5 15
-+ #define DMAC_REQN_MAX 15
-+#else
-+ #define DMAC_REQN_NONE PMU_REQN_NONE
-+ #define DMAC_REQN_CFC PMU_REQN_CFC
-+ #define DMAC_REQN_SSP PMU_REQN_SSP
-+ #define DMAC_REQN_UART1TX PMU_REQN_UART1TX
-+ #define DMAC_REQN_UART1RX PMU_REQN_UART1RX
-+ #define DMAC_REQN_UART2TX PMU_REQN_UART2TX
-+ #define DMAC_REQN_UART2RX PMU_REQN_UART2RX
-+ #define DMAC_REQN_SDC PMU_REQN_SDC
-+ #define DMAC_REQN_I2SAC97TX PMU_REQN_I2SAC97TX
-+ #define DMAC_REQN_I2SAC97RX PMU_REQN_I2SAC97RX
-+/* for amerald ac97 ssp2 */
-+ #define DMAC_REQN_I2SAC97TX_AMERALD PMU_REQN_I2SAC97TX_AMERALD
-+ #define DMAC_REQN_I2SAC97RX_AMERALD PMU_REQN_I2SAC97RX_AMERALD
-+ #define DMAC_REQN_USB PMU_REQN_USB
-+ #define DMAC_REQN_EXT0 PMU_REQN_EXT0
-+ #define DMAC_REQN_EXT1 PMU_REQN_EXT1
-+ #define DMAC_REQN_MAX PMU_REQN_MAX
-+#endif
-+#define DMAC_CFG_INT_LLPCNT_MASK 0x000f0000
-+#define DMAC_CFG_INT_LLPCNT_SHIFT 16
-+
-+/* DMA channel 0~n Linked List Descriptor Registers (CH[n]_BASE + 0x10) */
-+#define DMAC_LLP_ADDR_MASK 0xfffffffc
-+#define DMAC_LLP_ADDR_SHIFT 2
-+#define DMAC_LLP_MASTER_MASK 0x00000001
-+#define DMAC_LLP_MASTER_BIT 0
-+ #define DMAC_LLP_MASTER_0 0
-+ #define DMAC_LLP_MASTER_1 1
-+
-+/* DMA channel 0~3 Transfer Size Registers (CH[n]_BASE + 0x14) */
-+#define DMAC_TOT_SIZE_MASK 0x003fffff
-+#define DMAC_TOT_SIZE_SHIFT 0
-+
-+
-+/*****************************************************************************
-+ * APBBR - AG101 AHB to APB Bridge
-+*****************************************************************************/
-+/* Device base address */
-+#ifdef CONFIG_PLAT_AG102
-+#define APBBR_BASE APBBR_VA_BASE
-+#else
-+#define APBBR_BASE APBBRG_FTAPBBRG020S_0_VA_BASE
-+#endif
-+
-+/* DMA channel A registers (32-bit width) */
-+#define APBBR_DMAA_BASE (APBBR_BASE + 0x80)
-+#define APBBR_DMAB_BASE (APBBR_BASE + 0x90)
-+#define APBBR_DMAC_BASE (APBBR_BASE + 0xa0)
-+#define APBBR_DMAD_BASE (APBBR_BASE + 0xb0)
-+
-+#define APBBR_DMA_MAX_CHANNELS APBBRG_FTAPBBRG020S_IRQ_COUNT
-+/* n = 0 ~ APBBRG_FTAPBBRG020S_IRQ_COUNT */
-+#define APBBR_DMA_BASE_CH(n) (APBBR_DMAA_BASE + \
-+ (APBBR_DMAB_BASE - APBBR_DMAA_BASE) * \
-+ (addr_t)(n))
-+
-+#define APBBR_DMA_SAD_OFFSET 0x00
-+#define APBBR_DMA_DAD_OFFSET 0x04
-+#define APBBR_DMA_CYC_OFFSET 0x08
-+#define APBBR_DMA_CMD_OFFSET 0x0c
-+
-+
-+/*****************************************************************************
-+ * APBBR defs - AG101 AHB to APB Bridge
-+*****************************************************************************/
-+
-+/* APBBR slave#n (n = 1~6, 8, 11, 16~23) base/size register */
-+#define APBBR_SLAVE_SIZE_MASK 0x000f0000 /* Size of address space */
-+#define APBBR_SLAVE_SIZE_SHIFT 16
-+ #define APBBR_SIZE_1M 0
-+ #define APBBR_SIZE_2M 1
-+ #define APBBR_SIZE_4M 2
-+ #define APBBR_SIZE_8M 3
-+ #define APBBR_SIZE_16M 4
-+ #define APBBR_SIZE_32M 5
-+ #define APBBR_SIZE_64M 6
-+ #define APBBR_SIZE_128M 7
-+ #define APBBR_SIZE_256M 8
-+
-+#define APBBR_SLAVE_BASE_MASK 0x3ff00000
-+#define APBBR_SLAVE_BASE_SHIFT 20
-+
-+/* APBBR DMA channel transfer cycles register
-+ * DMA cycles (data size), 1 or 4 bus data transfer cycles per DMA cycle
-+ * => transfer size = cycles * data_width * burst(1 or 4)
-+ * so, max = 16M*4*4 = 256M
-+ */
-+#define APBBR_DMA_CYC_MASK 0x00ffffff
-+#define APBBR_DMA_CYC_SHIFT 0
-+
-+/* APBBR DMA channel command register */
-+#define APBBR_DMA_CHEN_MASK 0x00000001
-+#define APBBR_DMA_CHEN_BIT 0
-+
-+#define APBBR_DMA_FINTST_MASK 0x00000002
-+#define APBBR_DMA_FINTST_BIT 1
-+#define APBBR_DMA_FINTEN_MASK 0x00000004
-+#define APBBR_DMA_FINTEN_BIT 2
-+
-+#define APBBR_DMA_BURST_MASK 0x00000008
-+#define APBBR_DMA_BURST_BIT 3
-+
-+#define APBBR_DMA_ERRINTST_MASK 0x00000010
-+#define APBBR_DMA_ERRINTST_BIT 4
-+#define APBBR_DMA_ERRINTEN_MASK 0x00000020
-+#define APBBR_DMA_ERRINTEN_BIT 5
-+
-+#define APBBR_DMA_SRCADDRSEL_MASK 0x00000040
-+#define APBBR_DMA_SRCADDRSEL_BIT 6
-+#define APBBR_DMA_DSTADDRSEL_MASK 0x00000080
-+#define APBBR_DMA_DSTADDRSEL_BIT 7
-+ #define APBBR_ADDRSEL_APB 0
-+ #define APBBR_ADDRSEL_AHB 1
-+
-+#define APBBR_DMA_SRCADDRINC_MASK 0x00000700
-+#define APBBR_DMA_SRCADDRINC_SHIFT 8
-+#define APBBR_DMA_DSTADDRINC_MASK 0x00007000
-+#define APBBR_DMA_DSTADDRINC_SHIFT 12
-+ #define APBBR_ADDRINC_FIXED 0 /* no increment */
-+ #define APBBR_ADDRINC_I1X 1 /* +1, +4 (burst) */
-+ #define APBBR_ADDRINC_I2X 2 /* +2, +8 (burst) */
-+ #define APBBR_ADDRINC_I4X 3 /* +4, +16 (burst) */
-+ #define APBBR_ADDRINC_D1 5 /* -1 */
-+ #define APBBR_ADDRINC_D2 6 /* -2 */
-+ #define APBBR_ADDRINC_D4 7 /* -4 */
-+
-+#define APBBR_DMA_DREQSEL_MASK 0x000f0000
-+#define APBBR_DMA_DREQSEL_SHIFT 16
-+#define APBBR_DMA_SREQSEL_MASK 0x0f000000
-+#define APBBR_DMA_SREQSEL_SHIFT 24
-+
-+#ifdef CONFIG_PLAT_AG102
-+ #define APBBR_REQN_NONE 0
-+ #define APBBR_REQN_CFC 1
-+ #define APBBR_REQN_SSP 2
-+ #define APBBR_REQN_SDC 8
-+ #define APBBR_REQN_I2SAC97TX 6
-+ #define APBBR_REQN_SSP2 8
-+ #define APBBR_REQN_STUART 9
-+ #define APBBR_REQN_BTUART 10
-+ #define APBBR_REQN_IRDA 11
-+ #define APBBR_REQN_SMMC 12
-+// #define APBBR_REQN_USB 0
-+ #define APBBR_REQN_I2SAC97RX 13
-+ #define APBBR_REQN_FUSB220 14
-+ #define APBBR_REQN_MMSC 15
-+ #define APBBR_REQN_MAX 15
-+#else
-+ #define APBBR_REQN_NONE 0
-+ #define APBBR_REQN_CFC 1
-+ #define APBBR_REQN_SSP 2
-+ #define APBBR_REQN_SDC 5
-+/* for amerald sd */
-+ #define APBBR_REQN_SDC_AMERALD 7
-+/* for amerald ac97 ssp2 */
-+ #define APBBR_REQN_I2SAC97TX_AMERALD 8
-+ #define APBBR_REQN_I2SAC97RX_AMERALD 9
-+
-+ #define APBBR_REQN_I2SAC97TX 6
-+ #define APBBR_REQN_SSP2 8
-+ #define APBBR_REQN_STUART 9 /* UART1 ? */
-+ #define APBBR_REQN_BTUART 10 /* UART2 ? */
-+ #define APBBR_REQN_IRDA 11
-+ #define APBBR_REQN_SMMC 12
-+ //#define APBBR_REQN_USB 13
-+ #define APBBR_REQN_I2SAC97RX 13
-+ #define APBBR_REQN_FUSB220 14
-+ #define APBBR_REQN_MMSC 15
-+ #define APBBR_REQN_MAX 15
-+#endif
-+
-+#define APBBR_DMA_DATAWIDTH_MASK 0x00300000 /* Data width of transfer */
-+#define APBBR_DMA_DATAWIDTH_SHIFT 20
-+ #define APBBR_DATAWIDTH_4 0 /* word */
-+ #define APBBR_DATAWIDTH_2 1 /* half-word */
-+ #define APBBR_DATAWIDTH_1 2 /* byte */
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+#define APBBR_DMA_CYCLE_TO_BYTES(cycle, width) ((cycle) << (2-(width)))
-+#define APBBR_DMA_BYTES_TO_CYCLE(bytes, width) ((bytes) >> (2-(width)))
-+#else
-+#define APBBR_DMA_CYCLE_TO_BYTES(cycle, width) 0
-+#define APBBR_DMA_BYTES_TO_CYCLE(bytes, width) 0
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+
-+#ifdef CONFIG_PLAT_AG102
-+
-+/*****************************************************************************
-+ * PCU - AG102 Core APB
-+*****************************************************************************/
-+/* Device base address */
-+#define PCU_BASE PCU_VA_BASE
-+/* PMU registers (32-bit width) */
-+/* Add by Dennis on 2011.03.09 */
-+#define PCU_DMA_SEL (PCU_BASE+ 0x38)
-+
-+#else /* CONFIG_PLAT_AG102 */
-+
-+/*****************************************************************************
-+ * PMU - AG101 Core APB
-+*****************************************************************************/
-+/* Device base address */
-+#define PMU_BASE PMU_FTPMU010_0_VA_BASE
-+
-+/* PMU registers (32-bit width) */
-+#define PMU_AHBDMA_REQACK (PMU_BASE + 0x90)
-+
-+#define PMU_CFC_REQACK_CFG (PMU_BASE + 0xa0)
-+#define PMU_SSP1_REQACK_CFG (PMU_BASE + 0xa4)
-+#define PMU_UART1TX_REQACK_CFG (PMU_BASE + 0xa8)
-+#define PMU_UART1RX_REQACK_CFG (PMU_BASE + 0xac)
-+#define PMU_UART2TX_REQACK_CFG (PMU_BASE + 0xb0)
-+#define PMU_UART2RX_REQACK_CFG (PMU_BASE + 0xb4)
-+#define PMU_SDC_REQACK_CFG (PMU_BASE + 0xb8)
-+#define PMU_I2SAC97TX_REQACK_CFG (PMU_BASE + 0xbc)
-+#define PMU_I2SAC97RX_REQACK_CFG (PMU_BASE + 0xc4)
-+#define PMU_UART3TX_REQACK_CFG (PMU_BASE + 0xc0)
-+#define PMU_UART3RX_REQACK_CFG (PMU_BASE + 0xcc)
-+#define PMU_USB_REQACK_CFG (PMU_BASE + 0xc8)
-+#define PMU_IRDA_REQACK_CFG (PMU_BASE + 0xd0)
-+#define PMU_EXT0_REQACK_CFG (PMU_BASE + 0xd4)
-+#define PMU_EXT1_REQACK_CFG (PMU_BASE + 0xd8)
-+
-+
-+/*****************************************************************************
-+ * PMU - AG101 Core APB
-+*****************************************************************************/
-+
-+/* Driving capability and slew rate control register 2 (+0x48) */
-+#define PMU_STUART_DCSR_MASK 0x0000000f
-+#define PMU_STUART_DCSR_SHIFT 0
-+#define PMU_BTUART_DCSR_MASK 0x00000f00
-+#define PMU_BTUART_DCSR_SHIFT 8
-+/*#define PMU_FFUART_DCSR_MASK 0x0000f000*/
-+/*#define PMU_FFUART_DCSR_SHIFT 12 */
-+#define PMU_PMU_DCSR_MASK 0x000f0000
-+#define PMU_PMU_DCSR_SHIFT 16
-+#define PMU_I2SAC97_DCSR_MASK 0x00f00000
-+#define PMU_I2SAC97_DCSR_SHIFT 20
-+#define PMU_SSP_DCSR_MASK 0x0f000000
-+#define PMU_SSP_DCSR_SHIFT 24
-+#define PMU_SD_DCSR_MASK 0xf0000000
-+#define PMU_SD_DCSR_SHIFT 28
-+
-+/* AHB DMA REQ/ACK connection configuration status register (+0x90) */
-+#define PMU_CH0_REQACK_MASK 0x0000000f
-+#define PMU_CH0_REQACK_SHIFT 0
-+#define PMU_CH1_REQACK_MASK 0x000000f0
-+#define PMU_CH1_REQACK_SHIFT 4
-+#define PMU_CH2_REQACK_MASK 0x00000f00
-+#define PMU_CH2_REQACK_SHIFT 8
-+#define PMU_CH3_REQACK_MASK 0x0000f000
-+#define PMU_CH3_REQACK_SHIFT 12
-+#define PMU_CH4_REQACK_MASK 0x000f0000
-+#define PMU_CH4_REQACK_SHIFT 16
-+#define PMU_CH5_REQACK_MASK 0x00f00000
-+#define PMU_CH5_REQACK_SHIFT 20
-+#define PMU_CH6_REQACK_MASK 0x0f000000
-+#define PMU_CH6_REQACK_SHIFT 24
-+#define PMU_CH7_REQACK_MASK 0xf0000000
-+#define PMU_CH7_REQACK_SHIFT 28
-+
-+ #define PMU_REQN_NONE 0
-+ #define PMU_REQN_CFC 1
-+ #define PMU_REQN_SSP 2
-+ #define PMU_REQN_UART1TX 3
-+ #define PMU_REQN_UART1RX 4
-+ #define PMU_REQN_UART2TX 5
-+ #define PMU_REQN_UART2RX 6
-+ #define PMU_REQN_SDC 7
-+ #define PMU_REQN_I2SAC97TX 8
-+ #define PMU_REQN_I2SAC97RX 10
-+/* for amerald ac97 ssp2 */
-+ #define PMU_REQN_I2SAC97TX_AMERALD 8
-+ #define PMU_REQN_I2SAC97RX_AMERALD 9
-+ #define PMU_REQN_USB 11
-+ #define PMU_REQN_EXT0 14
-+ #define PMU_REQN_EXT1 15
-+ #define PMU_REQN_MAX 15
-+
-+/* CFC ..., etc, REQ/ACK connection configuration registers (0xa0 ~ 0xd8) */
-+#define PMU_CHANNEL_MASK 0x00000007
-+#define PMU_CHANNEL_SHIFT 0
-+#define PMU_DMACUSED_MASK 0x00000008
-+#define PMU_DMACUSED_BIT 3
-+
-+#endif /* CONFIG_PLAT_AG102 */
-+
-+
-+/*****************************************************************************
-+ * DMAD globals section
-+ */
-+
-+enum DMAD_DMAC_CORE {
-+ DMAD_DMAC_AHB_CORE,
-+ DMAD_DMAC_APB_CORE
-+};
-+
-+enum DMAD_CHREG_FLAGS {
-+ DMAD_FLAGS_NON_BLOCK = 0x00000000,
-+ DMAD_FLAGS_SLEEP_BLOCK = 0x00000001,
-+ DMAD_FLAGS_SPIN_BLOCK = 0x00000002,
-+ DMAD_FLAGS_RING_MODE = 0x00000008, /* ring submission mode */
-+ DMAD_FLAGS_BIDIRECTION = 0x00000010, /* indicates both tx and rx */
-+};
-+
-+enum DMAD_CHDIR
-+{
-+ DMAD_DIR_A0_TO_A1 = 0,
-+ DMAD_DIR_A1_TO_A0 = 1,
-+};
-+
-+/* AHB Channel Request
-+ *
-+ * Notes for developers:
-+ * These should be channel-only properties. Controller-specific properties
-+ * should be separated as other driver structure or driver buildin-hardcode.
-+ * If controller properties are embeded in this union, request for a channel
-+ * may unexpectedly override the controller setting of the request of other
-+ * channels.
-+ */
-+typedef struct dmad_ahb_chreq
-+{
-+ /* channel property */
-+ u32 sync; /* (in) different clock domain */
-+ u32 priority; /* (in) DMAC_CSR_CHPRI_xxx */
-+ u32 hw_handshake; /* (in) hardware handshaking on/off */
-+ u32 burst_size; /* (in) DMAC_CSR_SIZE_xxx */
-+
-+ /* source property */
-+ union {
-+ u32 src_width; /* (in) DMAC_CSR_WIDTH_xxx */
-+ u32 addr0_width; /* (in) bi-direction mode alias */
-+ u32 ring_width; /* (in) ring-mode alias */
-+ };
-+ union {
-+ u32 src_ctrl; /* (in) DMAC_CSR_AD_xxx */
-+ u32 addr0_ctrl; /* (in) bi-direction mode alias */
-+ u32 ring_ctrl; /* (in) ring-mode alias */
-+ };
-+ union {
-+ u32 src_reqn; /* (in) DMAC_REQN_xxx */
-+ u32 addr0_reqn; /* (in) bi-direction mode alias */
-+ u32 ring_reqn; /* (in) ring-mode alias */
-+ };
-+
-+ /* destination property */
-+ union {
-+ u32 dst_width; /* (in) DMAC_CSR_WIDTH_xxx */
-+ u32 addr1_width; /* (in) bi-direction mode alias */
-+ u32 dev_width; /* (in) ring-mode alias */
-+ };
-+ union {
-+ u32 dst_ctrl; /* (in) DMAC_CSR_AD_xxx */
-+ u32 addr1_ctrl; /* (in) bi-direction mode alias */
-+ u32 dev_ctrl; /* (in) ring-mode alias */
-+ };
-+ union {
-+ u32 dst_reqn; /* (in) DMAC_REQN_xxx */
-+ u32 addr1_reqn; /* (in) bi-direction mode alias */
-+ u32 dev_reqn; /* (in) ring-mode alias */
-+ };
-+
-+ /* (in) transfer direction, valid only if following flags were set ...
-+ * DMAD_FLAGS_BIDIRECTION or
-+ * DMAD_FLAGS_RING_MODE
-+ * value:
-+ * 0 (addr0 -> addr1, or ring-buff to device)
-+ * 1 (addr0 <- addr1, or device to ring-buff)
-+ */
-+ u32 tx_dir;
-+
-+} dmad_ahb_chreq;
-+
-+/* APB Channel Request
-+ *
-+ * Notes for developers:
-+ * These should be channel-only properties. Controller-specific properties
-+ * should be separated as other driver structure or driver buildin-hardcode.
-+ * If controller properties are embeded in this union, request for a channel
-+ * may unexpectedly override the controller setting of the request of other
-+ * channels.
-+ */
-+typedef struct dmad_apb_chreq
-+{
-+ /* controller property (removed! should not exist in this struct) */
-+
-+ /* channel property */
-+ u32 burst_mode; /* (in) Burst mode (0/1) */
-+ u32 data_width; /* (in) APBBR_DATAWIDTH_xxx */
-+
-+ /* source property */
-+ union {
-+ u32 src_ctrl; /* (in) APBBR_ADDRINC_xxx */
-+ u32 addr0_ctrl; /* (in) bi-direction mode alias */
-+ u32 ring_ctrl; /* (in) ring-mode alias */
-+ };
-+ union {
-+ u32 src_reqn; /* (in) APBBR_REQN_xxx */
-+ u32 addr0_reqn; /* (in) bi-direction mode alias */
-+ u32 ring_reqn; /* (in) ring-mode alias */
-+ };
-+
-+ /* destination property */
-+ union {
-+ u32 dst_ctrl; /* (in) APBBR_ADDRINC_xxx */
-+ u32 addr1_ctrl; /* (in) bi-direction mode alias */
-+ u32 dev_ctrl; /* (in) ring-mode alias */
-+ };
-+ union {
-+ u32 dst_reqn; /* (in) APBBR_REQN_xxx */
-+ u32 addr1_reqn; /* (in) bi-direction mode alias */
-+ u32 dev_reqn; /* (in) ring-mode alias */
-+ };
-+
-+ /* (in) transfer direction, valid only if following flags were set ...
-+ * DMAD_FLAGS_BIDIRECTION or
-+ * DMAD_FLAGS_RING_MODE
-+ * value:
-+ * 0 (addr0 -> addr1, or ring-buff to device)
-+ * 1 (addr0 <- addr1, or device to ring-buff)
-+ */
-+ u32 tx_dir;
-+
-+} dmad_apb_chreq;
-+
-+/* Channel Request Descriptor */
-+typedef struct dmad_chreq
-+{
-+ /* common fields */
-+ u32 controller; /* (in) enum DMAD_DMAC_CORE */
-+ u32 flags; /* (in) enum DMAD_CHREQ_FLAGS */
-+
-+ /**********************************************************************
-+ * ring mode specific fields (valid only for DMAD_FLAGS_RING_MODE)
-+ * note:
-+ * - size fields are in unit of data width
-+ * * for AHB, ring size is limited to 4K * data_width of data if
-+ * hw-LLP is not used
-+ * * for AHB, ring size is limited to 4K * data_width * LLP-count
-+ * hw-if LLP is used
-+ * * for APB, ring size is limited to 16M * data_width of data
-+ * - currently sw ring mode dma supports only fixed or incremental
-+ * src/dst addressing
-+ * - ring_size shoule >= periods * period_size
-+ */
-+ dma_addr_t ring_base; /* (in) ring buffer base (pa) */
-+ dma_addr_t ring_size; /* (in) unit of data width */
-+ addr_t dev_addr; /* (in) device data port address */
-+ dma_addr_t periods; /* (in) number of ints per ring */
-+ dma_addr_t period_size; /* (in) size per int, data-width */
-+
-+
-+ /* channel-wise completion callback - called when hw-ptr catches sw-ptr
-+ * (i.e., channel stops)
-+ *
-+ * completion_cb: (in) client supplied callback function, executed in
-+ * interrupt context.
-+ * completion_data: (in) client private data to be passed to data
-+ * argument of completion_cb().
-+ */
-+ void (*completion_cb)(int channel, u16 status, void *data);
-+ void *completion_data;
-+ /*********************************************************************/
-+
-+ /* channel allocation output */
-+ u32 channel; /* (out) allocated channel */
-+ void *drq; /* (out) internal use (DMAD_DRQ *)*/
-+
-+ /* channel-alloc parameters (channel-wise properties) */
-+ union {
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ dmad_ahb_chreq ahb_req; /* (in) for AHB DMA parameters */
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ dmad_apb_chreq apb_req; /* (in) APB Bridge DMA params */
-+#endif
-+ };
-+
-+} dmad_chreq;
-+
-+/* drb states are mutual exclusive */
-+enum DMAD_DRB_STATE
-+{
-+ DMAD_DRB_STATE_FREE = 0,
-+ DMAD_DRB_STATE_READY = 0x00000001,
-+ DMAD_DRB_STATE_SUBMITTED = 0x00000002,
-+ DMAD_DRB_STATE_EXECUTED = 0x00000004,
-+ DMAD_DRB_STATE_COMPLETED = 0x00000008,
-+ //DMAD_DRB_STATE_ERROR = 0x00000010,
-+ DMAD_DRB_STATE_ABORT = 0x00000020,
-+};
-+
-+/* DMA request block
-+ * todo: replaced link with kernel struct list_head ??
-+ */
-+typedef struct dmad_drb
-+{
-+ u32 prev; /* (internal) previous node */
-+ u32 next; /* (internal) next node */
-+ u32 node; /* (internal) this node */
-+
-+ u32 state; /* (out) DRB's current state */
-+
-+ union {
-+ dma_addr_t src_addr; /* (in) source pa */
-+ dma_addr_t addr0; /* (in) bi-direction mode alias */
-+ };
-+
-+ union {
-+ dma_addr_t dst_addr; /* (in) destination pa */
-+ dma_addr_t addr1; /* (in) bi-direction mode alias */
-+ };
-+
-+ /* (in) AHB DMA (22 bits): 0 ~ 4M-1, unit is "data width"
-+ * APB DMA (24 bits): 0 ~ 16M-1, unit is "data width * burst size"
-+ * => for safe without mistakes, use dmad_make_req_cycles() to
-+ * compose this value if the addressing mode is incremental
-+ * mode (not working yet for decremental mode).
-+ */
-+ dma_addr_t req_cycle;
-+
-+ /* (in) if non-null, this sync object will be signaled upon dma
-+ * completion (for blocked-waiting dma completion)
-+ */
-+ struct completion *sync;
-+
-+} dmad_drb;
-+
-+
-+/******************************************************************************
-+ * Debug Trace Mechanism
-+ */
-+#if (DMAD_ERROR_TRACE)
-+#define dmad_err(format, arg...) printk(KERN_ERR format , ## arg)
-+#else
-+#define dmad_err(format, arg...) (void)(0)
-+#endif
-+
-+#if (DMAD_DEBUG_TRACE)
-+#define dmad_dbg(format, arg...) printk(KERN_INFO format , ## arg)
-+#else
-+#define dmad_dbg(format, arg...) (void)(0)
-+#endif
-+
-+#if (defined(CONFIG_PLATFORM_AHBDMA) || defined(CONFIG_PLATFORM_APBDMA))
-+
-+/******************************************************************************
-+ * DMAD Driver Interface
-+******************************************************************************/
-+
-+extern int dmad_channel_alloc(dmad_chreq *ch_req);
-+extern int dmad_channel_free(dmad_chreq *ch_req);
-+extern int dmad_channel_enable(const dmad_chreq *ch_req, u8 enable);
-+extern u32 dmad_max_size_per_drb(dmad_chreq *ch_req);
-+extern u32 dmad_bytes_to_cycles(dmad_chreq *ch_req, u32 byte_size);
-+
-+extern int dmad_kickoff_requests(dmad_chreq *ch_req);
-+extern int dmad_drain_requests(dmad_chreq *ch_req, u8 shutdown);
-+
-+/* for performance reason, these two functions are platform-specific */
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+extern int dmad_probe_irq_source_ahb(void);
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+extern int dmad_probe_irq_source_apb(void);
-+#endif
-+
-+/* note: hw_ptr here is phyical address of dma source or destination */
-+extern dma_addr_t dmad_probe_hw_ptr_src(dmad_chreq *ch_req);
-+extern dma_addr_t dmad_probe_hw_ptr_dst(dmad_chreq *ch_req);
-+
-+/*****************************************************************************
-+ * routines only valid in discrete (non-ring) mode
-+ */
-+extern int dmad_config_channel_dir(dmad_chreq *ch_req, u8 dir);
-+extern int dmad_alloc_drb(dmad_chreq *ch_req, dmad_drb **drb);
-+extern int dmad_free_drb(dmad_chreq *ch_req, dmad_drb *drb);
-+extern int dmad_submit_request(dmad_chreq *ch_req,
-+ dmad_drb *drb, u8 keep_fired);
-+extern int dmad_withdraw_request(dmad_chreq *ch_req, dmad_drb *drb);
-+/****************************************************************************/
-+
-+/*****************************************************************************
-+ * routines only valid in ring mode
-+ * note: sw_ptr and hw_ptr are values offset from the ring buffer base
-+ * unit of sw_ptr is data-width
-+ * unit of hw_ptr returned is byte
-+ */
-+extern int dmad_update_ring(dmad_chreq *ch_req);
-+extern int dmad_update_ring_sw_ptr(dmad_chreq *ch_req,
-+ dma_addr_t sw_ptr, u8 keep_fired);
-+extern dma_addr_t dmad_probe_ring_hw_ptr(dmad_chreq *ch_req);
-+/****************************************************************************/
-+
-+#else /* CONFIG_PLATFORM_AHBDMA || CONFIG_PLATFORM_APBDMA */
-+
-+static inline int dmad_channel_alloc(dmad_chreq *ch_req) { return -EFAULT; }
-+static inline int dmad_channel_free(dmad_chreq *ch_req) { return -EFAULT; }
-+static inline int dmad_channel_enable(const dmad_chreq *ch_req, u8 enable)
-+ { return -EFAULT; }
-+static inline u32 dmad_max_size_per_drb(dmad_chreq *ch_req) { return 0; }
-+static inline u32 dmad_bytes_to_cycles(dmad_chreq *ch_req, u32 byte_size)
-+ { return 0; }
-+static inline int dmad_kickoff_requests(dmad_chreq *ch_req) { return -EFAULT; }
-+static inline int dmad_drain_requests(dmad_chreq *ch_req, u8 shutdown)
-+ { return -EFAULT; }
-+static inline int dmad_probe_irq_source_ahb(void) { return -EFAULT; }
-+static inline int dmad_probe_irq_source_apb(void) { return -EFAULT; }
-+static inline dma_addr_t dmad_probe_hw_ptr_src(dmad_chreq *ch_req)
-+ { return (dma_addr_t)NULL; }
-+static inline dma_addr_t dmad_probe_hw_ptr_dst(dmad_chreq *ch_req)
-+ { return (dma_addr_t)NULL; }
-+static inline int dmad_config_channel_dir(dmad_chreq *ch_req, u8 dir)
-+ { return -EFAULT; }
-+static inline int dmad_alloc_drb(dmad_chreq *ch_req, dmad_drb **drb)
-+ { return -EFAULT; }
-+static inline int dmad_free_drb(dmad_chreq *ch_req, dmad_drb *drb)
-+ { return -EFAULT; }
-+static inline int dmad_submit_request(dmad_chreq *ch_req,
-+ dmad_drb *drb, u8 keep_fired) { return -EFAULT; }
-+static inline int dmad_withdraw_request(dmad_chreq *ch_req, dmad_drb *drb)
-+ { return -EFAULT; }
-+static inline int dmad_update_ring(dmad_chreq *ch_req)
-+ { return -EFAULT; }
-+static inline int dmad_update_ring_sw_ptr(dmad_chreq *ch_req,
-+ dma_addr_t sw_ptr, u8 keep_fired) { return -EFAULT; }
-+static inline dma_addr_t dmad_probe_ring_hw_ptr(dmad_chreq *ch_req)
-+ { return (dma_addr_t)NULL; }
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA || CONFIG_PLATFORM_APBDMA */
-+
-+#endif /* __NDS_DMAD_INC__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/dma.h linux-3.4.113/arch/nds32/include/asm/dma.h
---- linux-3.4.113.orig/arch/nds32/include/asm/dma.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/dma.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,17 @@
-+/*
-+ * linux/arch/nds32/include/asm/dma.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_DMA_H__
-+#define __NDS32_DMA_H__
-+
-+#define MAX_DMA_ADDRESS 0xffffffff
-+
-+#ifdef CONFIG_PCI
-+extern int isa_dma_bridge_buggy;
-+#else
-+#define isa_dma_bridge_buggy (0)
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/dma-mapping.h linux-3.4.113/arch/nds32/include/asm/dma-mapping.h
---- linux-3.4.113.orig/arch/nds32/include/asm/dma-mapping.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/dma-mapping.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,453 @@
-+/*
-+ * linux/arch/nds32/include/asm/dma-mapping.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef ASMNDS32_DMA_MAPPING_H
-+#define ASMNDS32_DMA_MAPPING_H
-+
-+#ifdef __KERNEL__
-+
-+#include <linux/mm.h> /* need struct page */
-+#include <linux/highmem.h>
-+
-+#include <asm/scatterlist.h>
-+
-+/*
-+ * DMA-consistent mapping functions. These allocate/free a region of
-+ * uncached, unwrite-buffered mapped memory space for use with DMA
-+ * devices. This is the "generic" version. The PCI specific version
-+ * is in pci.h
-+ */
-+extern void consistent_sync(void *kaddr, size_t size, int rw);
-+
-+/*
-+ * Return whether the given device DMA address mask can be supported
-+ * properly. For example, if your device can only drive the low 24-bits
-+ * during bus mastering, then you would pass 0x00ffffff as the mask
-+ * to this function.
-+ */
-+static inline int dma_supported(struct device *dev, u64 mask)
-+{
-+ return dev->dma_mask && *dev->dma_mask != 0;
-+}
-+
-+static inline int dma_set_mask(struct device *dev, u64 dma_mask)
-+{
-+ if (!dev->dma_mask || !dma_supported(dev, dma_mask))
-+ return -EIO;
-+
-+ *dev->dma_mask = dma_mask;
-+
-+ return 0;
-+}
-+
-+static inline int dma_is_consistent(dma_addr_t handle)
-+{
-+ return 0;
-+}
-+
-+/*
-+ * DMA errors are defined by all-bits-set in the DMA address.
-+ */
-+static inline int dma_mapping_error(struct device *dev, dma_addr_t dma_addr)
-+{
-+ return dma_addr == ~0;
-+}
-+
-+/*
-+ * Dummy noncoherent implementation. We don't provide a dma_cache_sync
-+ * function so drivers using this API are highlighted with build warnings.
-+ */
-+static inline void *
-+dma_alloc_noncoherent(struct device *dev, size_t size, dma_addr_t *handle, gfp_t gfp)
-+{
-+ return NULL;
-+}
-+
-+static inline void
-+dma_free_noncoherent(struct device *dev, size_t size, void *cpu_addr,
-+ dma_addr_t handle)
-+{
-+}
-+
-+/**
-+ * dma_alloc_coherent - allocate consistent memory for DMA
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @size: required memory size
-+ * @handle: bus-specific DMA address
-+ *
-+ * Allocate some uncached, unbuffered memory for a device for
-+ * performing DMA. This function allocates pages, and will
-+ * return the CPU-viewed address, and sets @handle to be the
-+ * device-viewed address.
-+ */
-+extern void *
-+dma_alloc_coherent(struct device *dev, size_t size, dma_addr_t *handle, gfp_t gfp);
-+
-+/**
-+ * dma_free_coherent - free memory allocated by dma_alloc_coherent
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @size: size of memory originally requested in dma_alloc_coherent
-+ * @cpu_addr: CPU-view address returned from dma_alloc_coherent
-+ * @handle: device-view address returned from dma_alloc_coherent
-+ *
-+ * Free (and unmap) a DMA buffer previously allocated by
-+ * dma_alloc_coherent().
-+ *
-+ * References to memory and mappings associated with cpu_addr/handle
-+ * during and after this call executing are illegal.
-+ */
-+extern void
-+dma_free_coherent(struct device *dev, size_t size, void *cpu_addr,
-+ dma_addr_t handle);
-+
-+/**
-+ * dma_mmap_coherent - map a coherent DMA allocation into user space
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @vma: vm_area_struct describing requested user mapping
-+ * @cpu_addr: kernel CPU-view address returned from dma_alloc_coherent
-+ * @handle: device-view address returned from dma_alloc_coherent
-+ * @size: size of memory originally requested in dma_alloc_coherent
-+ *
-+ * Map a coherent DMA buffer previously allocated by dma_alloc_coherent
-+ * into user space. The coherent DMA buffer must not be freed by the
-+ * driver until the user space mapping has been released.
-+ */
-+int dma_mmap_coherent(struct device *dev, struct vm_area_struct *vma,
-+ void *cpu_addr, dma_addr_t handle, size_t size);
-+
-+
-+/**
-+ * dma_alloc_writecombine - allocate writecombining memory for DMA
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @size: required memory size
-+ * @handle: bus-specific DMA address
-+ *
-+ * Allocate some uncached, buffered memory for a device for
-+ * performing DMA. This function allocates pages, and will
-+ * return the CPU-viewed address, and sets @handle to be the
-+ * device-viewed address.
-+ */
-+extern void *
-+dma_alloc_writecombine(struct device *dev, size_t size, dma_addr_t *handle, gfp_t gfp);
-+
-+#define dma_free_writecombine(dev,size,cpu_addr,handle) \
-+ dma_free_coherent(dev,size,cpu_addr,handle)
-+
-+int dma_mmap_writecombine(struct device *dev, struct vm_area_struct *vma,
-+ void *cpu_addr, dma_addr_t handle, size_t size);
-+
-+
-+/**
-+ * dma_map_single - map a single buffer for streaming DMA
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @cpu_addr: CPU direct mapped address of buffer
-+ * @size: size of buffer to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Ensure that any data held in the cache is appropriately discarded
-+ * or written back.
-+ *
-+ * The device owns this memory once this call has completed. The CPU
-+ * can regain ownership by calling dma_unmap_single() or
-+ * dma_sync_single_for_cpu().
-+ */
-+#ifndef CONFIG_DMABOUNCE
-+static inline dma_addr_t
-+dma_map_single(struct device *dev, void *cpu_addr, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ consistent_sync(cpu_addr, size, dir);
-+ return virt_to_dma(dev, (unsigned long)cpu_addr);
-+}
-+#else
-+extern dma_addr_t dma_map_single(struct device *,void *, size_t, enum dma_data_direction);
-+#endif
-+
-+/**
-+ * dma_map_page - map a portion of a page for streaming DMA
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @page: page that buffer resides in
-+ * @offset: offset into page for start of buffer
-+ * @size: size of buffer to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Ensure that any data held in the cache is appropriately discarded
-+ * or written back.
-+ *
-+ * The device owns this memory once this call has completed. The CPU
-+ * can regain ownership by calling dma_unmap_page() or
-+ * dma_sync_single_for_cpu().
-+ */
-+static inline dma_addr_t
-+dma_map_page(struct device *dev, struct page *page,
-+ unsigned long offset, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ return dma_map_single(dev, page_address(page) + offset, size, (int)dir);
-+}
-+
-+/**
-+ * dma_unmap_single - unmap a single buffer previously mapped
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @handle: DMA address of buffer
-+ * @size: size of buffer to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Unmap a single streaming mode DMA translation. The handle and size
-+ * must match what was provided in the previous dma_map_single() call.
-+ * All other usages are undefined.
-+ *
-+ * After this call, reads by the CPU to the buffer are guaranteed to see
-+ * whatever the device wrote there.
-+ */
-+#ifndef CONFIG_DMABOUNCE
-+static inline void
-+dma_unmap_single(struct device *dev, dma_addr_t handle, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ /* nothing to do */
-+}
-+#else
-+extern void dma_unmap_single(struct device *, dma_addr_t, size_t, enum dma_data_direction);
-+#endif
-+
-+/**
-+ * dma_unmap_page - unmap a buffer previously mapped through dma_map_page()
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @handle: DMA address of buffer
-+ * @size: size of buffer to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Unmap a single streaming mode DMA translation. The handle and size
-+ * must match what was provided in the previous dma_map_single() call.
-+ * All other usages are undefined.
-+ *
-+ * After this call, reads by the CPU to the buffer are guaranteed to see
-+ * whatever the device wrote there.
-+ */
-+static inline void
-+dma_unmap_page(struct device *dev, dma_addr_t handle, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ dma_unmap_single(dev, handle, size, (int)dir);
-+}
-+
-+/**
-+ * dma_map_sg - map a set of SG buffers for streaming mode DMA
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @sg: list of buffers
-+ * @nents: number of buffers to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Map a set of buffers described by scatterlist in streaming
-+ * mode for DMA. This is the scatter-gather version of the
-+ * above dma_map_single interface. Here the scatter gather list
-+ * elements are each tagged with the appropriate dma address
-+ * and length. They are obtained via sg_dma_{address,length}(SG).
-+ *
-+ * NOTE: An implementation may be able to use a smaller number of
-+ * DMA address/length pairs than there are SG table elements.
-+ * (for example via virtual mapping capabilities)
-+ * The routine returns the number of addr/length pairs actually
-+ * used, at most nents.
-+ *
-+ * Device ownership issues as mentioned above for dma_map_single are
-+ * the same here.
-+ */
-+#ifndef CONFIG_DMABOUNCE
-+static inline int
-+dma_map_sg(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+ int i;
-+
-+ for (i = 0; i < nents; i++, sg++) {
-+ void *virt;
-+ unsigned long pfn;
-+ struct page *page = sg_page(sg);
-+
-+ sg->dma_address = page_to_dma(dev, page) + sg->offset;
-+ pfn = page_to_pfn(page) + sg->offset / PAGE_SIZE;
-+ page = pfn_to_page(pfn);
-+ if (PageHighMem(page)) {
-+ virt = kmap_atomic(page);
-+ consistent_sync(virt, sg->length, dir);
-+ kunmap_atomic(virt);
-+ } else {
-+ if (sg->offset > PAGE_SIZE)
-+ panic("sg->offset:%08x > PAGE_SIZE\n", sg->offset);
-+ virt = page_address(page) + sg->offset;
-+ consistent_sync(virt, sg->length, dir);
-+ }
-+ }
-+ return nents;
-+}
-+#else
-+extern int dma_map_sg(struct device *, struct scatterlist *, int, enum dma_data_direction);
-+#endif
-+
-+/**
-+ * dma_unmap_sg - unmap a set of SG buffers mapped by dma_map_sg
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @sg: list of buffers
-+ * @nents: number of buffers to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Unmap a set of streaming mode DMA translations.
-+ * Again, CPU read rules concerning calls here are the same as for
-+ * dma_unmap_single() above.
-+ */
-+#ifndef CONFIG_DMABOUNCE
-+static inline void
-+dma_unmap_sg(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+
-+ /* nothing to do */
-+}
-+#else
-+extern void dma_unmap_sg(struct device *, struct scatterlist *, int, enum dma_data_direction);
-+#endif
-+
-+
-+/**
-+ * dma_sync_single_for_cpu
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @handle: DMA address of buffer
-+ * @size: size of buffer to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Make physical memory consistent for a single streaming mode DMA
-+ * translation after a transfer.
-+ *
-+ * If you perform a dma_map_single() but wish to interrogate the
-+ * buffer using the cpu, yet do not wish to teardown the PCI dma
-+ * mapping, you must call this function before doing so. At the
-+ * next point you give the PCI dma address back to the card, you
-+ * must first the perform a dma_sync_for_device, and then the
-+ * device again owns the buffer.
-+ */
-+#ifndef CONFIG_DMABOUNCE
-+static inline void
-+dma_sync_single_for_cpu(struct device *dev, dma_addr_t handle, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ consistent_sync((void *)dma_to_virt(dev, handle), size, dir);
-+}
-+
-+static inline void
-+dma_sync_single_for_device(struct device *dev, dma_addr_t handle, size_t size,
-+ enum dma_data_direction dir)
-+{
-+ consistent_sync((void *)dma_to_virt(dev, handle), size, dir);
-+}
-+#else
-+extern void dma_sync_single_for_cpu(struct device*, dma_addr_t, size_t, enum dma_data_direction);
-+extern void dma_sync_single_for_device(struct device*, dma_addr_t, size_t, enum dma_data_direction);
-+#endif
-+
-+
-+/**
-+ * dma_sync_sg_for_cpu
-+ * @dev: valid struct device pointer, or NULL for ISA and EISA-like devices
-+ * @sg: list of buffers
-+ * @nents: number of buffers to map
-+ * @dir: DMA transfer direction
-+ *
-+ * Make physical memory consistent for a set of streaming
-+ * mode DMA translations after a transfer.
-+ *
-+ * The same as dma_sync_single_for_* but for a scatter-gather list,
-+ * same rules and usage.
-+ */
-+#ifndef CONFIG_DMABOUNCE
-+static inline void
-+dma_sync_sg_for_cpu(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+ int i;
-+
-+ for (i = 0; i < nents; i++, sg++) {
-+ char *virt = page_address( (struct page *)sg->page_link) + sg->offset;
-+ consistent_sync(virt, sg->length, dir);
-+ }
-+}
-+
-+static inline void
-+dma_sync_sg_for_device(struct device *dev, struct scatterlist *sg, int nents,
-+ enum dma_data_direction dir)
-+{
-+ int i;
-+
-+ for (i = 0; i < nents; i++, sg++) {
-+ char *virt = page_address( (struct page *)sg->page_link) + sg->offset;
-+ consistent_sync(virt, sg->length, dir);
-+ }
-+}
-+#else
-+extern void dma_sync_sg_for_cpu(struct device*, struct scatterlist*, int, enum dma_data_direction);
-+extern void dma_sync_sg_for_device(struct device*, struct scatterlist*, int, enum dma_data_direction);
-+#endif
-+
-+#ifdef CONFIG_DMABOUNCE
-+/*
-+ * For SA-1111, IXP425, and ADI systems the dma-mapping functions are "magic"
-+ * and utilize bounce buffers as needed to work around limited DMA windows.
-+ *
-+ * On the SA-1111, a bug limits DMA to only certain regions of RAM.
-+ * On the IXP425, the PCI inbound window is 64MB (256MB total RAM)
-+ * On some ADI engineering systems, PCI inbound window is 32MB (12MB total RAM)
-+ *
-+ * The following are helper functions used by the dmabounce subystem
-+ *
-+ */
-+
-+/**
-+ * dmabounce_register_dev
-+ *
-+ * @dev: valid struct device pointer
-+ * @small_buf_size: size of buffers to use with small buffer pool
-+ * @large_buf_size: size of buffers to use with large buffer pool (can be 0)
-+ *
-+ * This function should be called by low-level platform code to register
-+ * a device as requireing DMA buffer bouncing. The function will allocate
-+ * appropriate DMA pools for the device.
-+ *
-+ */
-+extern int dmabounce_register_dev(struct device *, unsigned long, unsigned long);
-+
-+/**
-+ * dmabounce_unregister_dev
-+ *
-+ * @dev: valid struct device pointer
-+ *
-+ * This function should be called by low-level platform code when device
-+ * that was previously registered with dmabounce_register_dev is removed
-+ * from the system.
-+ *
-+ */
-+extern void dmabounce_unregister_dev(struct device *);
-+
-+/**
-+ * dma_needs_bounce
-+ *
-+ * @dev: valid struct device pointer
-+ * @dma_handle: dma_handle of unbounced buffer
-+ * @size: size of region being mapped
-+ *
-+ * Platforms that utilize the dmabounce mechanism must implement
-+ * this function.
-+ *
-+ * The dmabounce routines call this function whenever a dma-mapping
-+ * is requested to determine whether a given buffer needs to be bounced
-+ * or not. The function must return 0 if the buffer is OK for
-+ * DMA access and 1 if the buffer needs to be bounced.
-+ *
-+ */
-+extern int dma_needs_bounce(struct device*, dma_addr_t, size_t);
-+#endif /* CONFIG_DMABOUNCE */
-+
-+#endif /* __KERNEL__ */
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/elf.h linux-3.4.113/arch/nds32/include/asm/elf.h
---- linux-3.4.113.orig/arch/nds32/include/asm/elf.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/elf.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,145 @@
-+/*
-+ * linux/arch/nds32/include/asm/elf.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASMNDS32_ELF_H
-+#define __ASMNDS32_ELF_H
-+
-+/*
-+ * ELF register definitions..
-+ */
-+
-+#include <asm/ptrace.h>
-+#include <asm/user.h>
-+
-+typedef unsigned long elf_greg_t;
-+typedef unsigned long elf_freg_t[3];
-+
-+extern unsigned int elf_hwcap;
-+
-+#define EM_NDS32 167
-+
-+
-+#define R_NDS32_NONE 0
-+#define R_NDS32_16_RELA 19
-+#define R_NDS32_32_RELA 20
-+#define R_NDS32_9_PCREL_RELA 22
-+#define R_NDS32_15_PCREL_RELA 23
-+#define R_NDS32_17_PCREL_RELA 24
-+#define R_NDS32_25_PCREL_RELA 25
-+#define R_NDS32_HI20_RELA 26
-+#define R_NDS32_LO12S3_RELA 27
-+#define R_NDS32_LO12S2_RELA 28
-+#define R_NDS32_LO12S1_RELA 29
-+#define R_NDS32_LO12S0_RELA 30
-+#define R_NDS32_SDA15S3_RELA 31
-+#define R_NDS32_SDA15S2_RELA 32
-+#define R_NDS32_SDA15S1_RELA 33
-+#define R_NDS32_SDA15S0_RELA 34
-+#define R_NDS32_GOT20 37
-+#define R_NDS32_25_PLTREL 38
-+#define R_NDS32_COPY 39
-+#define R_NDS32_GLOB_DAT 40
-+#define R_NDS32_JMP_SLOT 41
-+#define R_NDS32_RELATIVE 42
-+#define R_NDS32_GOTOFF 43
-+#define R_NDS32_GOTPC20 44
-+#define R_NDS32_GOT_HI20 45
-+#define R_NDS32_GOT_LO12 46
-+#define R_NDS32_GOTPC_HI20 47
-+#define R_NDS32_GOTPC_LO12 48
-+#define R_NDS32_GOTOFF_HI20 49
-+#define R_NDS32_GOTOFF_LO12 50
-+#define R_NDS32_INSN16 51
-+#define R_NDS32_LABEL 52
-+#define R_NDS32_LONGCALL1 53
-+#define R_NDS32_LONGCALL2 54
-+#define R_NDS32_LONGCALL3 55
-+#define R_NDS32_LONGJUMP1 56
-+#define R_NDS32_LONGJUMP2 57
-+#define R_NDS32_LONGJUMP3 58
-+#define R_NDS32_LOADSTORE 59
-+#define R_NDS32_9_FIXED_RELA 60
-+#define R_NDS32_15_FIXED_RELA 61
-+#define R_NDS32_17_FIXED_RELA 62
-+#define R_NDS32_25_FIXED_RELA 63
-+#define R_NDS32_PLTREL_HI20 64
-+#define R_NDS32_PLTREL_LO12 65
-+#define R_NDS32_PLT_GOTREL_HI20 66
-+#define R_NDS32_PLT_GOTREL_LO12 67
-+#define R_NDS32_LO12S0_ORI_RELA 72
-+#define R_NDS32_DWARF2_OP1_RELA 77
-+#define R_NDS32_DWARF2_OP2_RELA 78
-+#define R_NDS32_DWARF2_LEB_RELA 79
-+#define R_NDS32_WORD_9_PCREL_RELA 94
-+#define R_NDS32_LONGCALL4 107
-+#define R_NDS32_RELA_NOP_MIX 192
-+#define R_NDS32_RELA_NOP_MAX 255
-+
-+#define ELF_NGREG (sizeof (struct pt_regs) / sizeof(elf_greg_t))
-+typedef elf_greg_t elf_gregset_t[ELF_NGREG];
-+
-+typedef struct user_fp elf_fpregset_t;
-+
-+struct elf32_hdr;
-+extern int elf_check_arch(const struct elf32_hdr *hdr);
-+
-+/*
-+ * These are used to set parameters in the core dumps.
-+ */
-+#define ELF_CLASS ELFCLASS32
-+#ifdef __NDS32_EB__
-+#define ELF_DATA ELFDATA2MSB;
-+#else
-+#define ELF_DATA ELFDATA2LSB;
-+#endif
-+#define ELF_ARCH EM_NDS32
-+#define USE_ELF_CORE_DUMP
-+#define ELF_EXEC_PAGESIZE PAGE_SIZE
-+
-+/* This is the location that an ET_DYN program is loaded if exec'ed. Typical
-+ use of this is to invoke "./ld.so someprog" to test out a new version of
-+ the loader. We need to make sure that it is out of the way of the program
-+ that it will "exec", and that there is sufficient room for the brk. */
-+
-+#define ELF_ET_DYN_BASE (2 * TASK_SIZE / 3)
-+
-+/* When the program starts, a1 contains a pointer to a function to be
-+ registered with atexit, as per the SVR4 ABI. A value of 0 means we
-+ have no such handler. */
-+#define ELF_PLAT_INIT(_r, load_addr) (_r)->NDS32_r0 = 0
-+
-+/* This yields a mask that user programs can use to figure out what
-+ instruction set this cpu supports. */
-+
-+#define ELF_HWCAP (elf_hwcap)
-+
-+/* This yields a string that ld.so will use to load implementation
-+ specific libraries for optimization. This is more specific in
-+ intent than poking at uname or /proc/cpuinfo. */
-+
-+/* For now we just provide a fairly general string that describes the
-+ processor family. This could be made more specific later if someone
-+ implemented optimisations that require it. 26-bit CPUs give you
-+ "v1l" for ARM2 (no SWP) and "v2l" for anything else (ARM1 isn't
-+ supported). 32-bit CPUs give you "v3[lb]" for anything based on an
-+ ARM6 or ARM7 core and "armv4[lb]" for anything based on a StrongARM-1
-+ core. */
-+
-+#define ELF_PLATFORM_SIZE 16
-+extern char elf_platform[];
-+#define ELF_PLATFORM (elf_platform)
-+
-+#ifdef __KERNEL__
-+
-+/* Old NetWinder binaries were compiled in such a way that the iBCS
-+ heuristic always trips on them. Until these binaries become uncommon
-+ enough not to care, don't trust the `ibcs' flag here. In any case
-+ there is no other ELF system currently supported by iBCS.
-+ @@ Could print a warning message to encourage users to upgrade. */
-+#define SET_PERSONALITY(ex) set_personality(PER_LINUX)
-+
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/emergency-restart.h linux-3.4.113/arch/nds32/include/asm/emergency-restart.h
---- linux-3.4.113.orig/arch/nds32/include/asm/emergency-restart.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/emergency-restart.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/emergency-restart.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_EMERGENCY_RESTART_H__
-+#define __NDS32_EMERGENCY_RESTART_H__
-+
-+#include <asm-generic/emergency-restart.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/errno.h linux-3.4.113/arch/nds32/include/asm/errno.h
---- linux-3.4.113.orig/arch/nds32/include/asm/errno.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/errno.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/errno.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_ERRNO_H__
-+#define __NDS32_ERRNO_H__
-+
-+#include <asm-generic/errno.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/exec.h linux-3.4.113/arch/nds32/include/asm/exec.h
---- linux-3.4.113.orig/arch/nds32/include/asm/exec.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/exec.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,6 @@
-+#ifndef __ASM_NDS32_EXEC_H
-+#define __ASM_NDS32_EXEC_H
-+
-+#define arch_align_stack(x) (x)
-+
-+#endif /* __ASM_ARM_EXEC_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/fb.h linux-3.4.113/arch/nds32/include/asm/fb.h
---- linux-3.4.113.orig/arch/nds32/include/asm/fb.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/fb.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,25 @@
-+/*
-+ * linux/arch/nds32/include/asm/fb.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_FB_H__
-+#define __NDS32_FB_H__
-+
-+
-+#include <linux/fb.h>
-+#include <linux/fs.h>
-+#include <asm/page.h>
-+
-+static inline void fb_pgprotect(struct file *file, struct vm_area_struct *vma,
-+ unsigned long off)
-+{
-+ vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
-+}
-+
-+static inline int fb_is_primary_device(struct fb_info *info)
-+{
-+ return 0;
-+}
-+
-+#endif /* __NDS32_FB_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/fcntl.h linux-3.4.113/arch/nds32/include/asm/fcntl.h
---- linux-3.4.113.orig/arch/nds32/include/asm/fcntl.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/fcntl.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,37 @@
-+/*
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 1995, 96, 97, 98, 99, 2003, 05 Ralf Baechle
-+ */
-+#ifndef _ASM_FCNTL_H
-+#define _ASM_FCNTL_H
-+
-+/*
-+ * The flavours of struct flock. "struct flock" is the ABI compliant
-+ * variant. Finally struct flock64 is the LFS variant of struct flock. As
-+ * a historic accident and inconsistence with the ABI definition it doesn't
-+ * contain all the same fields as struct flock.
-+ */
-+
-+#ifdef CONFIG_32BIT
-+#include <linux/types.h>
-+
-+struct flock {
-+ short l_type;
-+ short l_whence;
-+ off_t l_start;
-+ off_t l_len;
-+ long l_sysid;
-+ __kernel_pid_t l_pid;
-+ long pad[4];
-+};
-+
-+#define HAVE_ARCH_STRUCT_FLOCK
-+
-+#endif /* CONFIG_32BIT */
-+
-+#include <asm-generic/fcntl.h>
-+
-+#endif /* _ASM_FCNTL_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/fixmap.h linux-3.4.113/arch/nds32/include/asm/fixmap.h
---- linux-3.4.113.orig/arch/nds32/include/asm/fixmap.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/fixmap.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,88 @@
-+/*
-+ * fixmap.h: compile-time virtual memory allocation
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 1998 Ingo Molnar
-+ *
-+ * Support of BIGMEM added by Gerhard Wichert, Siemens AG, July 1999
-+ */
-+
-+#ifndef __ASM_NDS32_FIXMAP_H
-+#define __ASM_NDS32_FIXMAP_H
-+
-+#ifdef CONFIG_HIGHMEM
-+#include <linux/threads.h>
-+#include <asm/kmap_types.h>
-+#endif
-+
-+/*
-+ * Here we define all the compile-time 'special' virtual
-+ * addresses. The point is to have a constant address at
-+ * compile time, but to set the physical address only
-+ * in the boot process. We allocate these special addresses
-+ * from the end of the consistent memory region backwards.
-+ * Also this lets us do fail-safe vmalloc(), we
-+ * can guarantee that these special addresses and
-+ * vmalloc()-ed addresses never overlap.
-+ *
-+ * these 'compile-time allocated' memory buffers are
-+ * fixed-size 4k pages. (or larger if used with an increment
-+ * higher than 1) use fixmap_set(idx,phys) to associate
-+ * physical memory with fixmap indices.
-+ *
-+ * TLB entries of such buffers will not be flushed across
-+ * task switches.
-+ */
-+enum fixed_addresses {
-+ FIX_KMAP_RESERVED,
-+ FIX_KMAP_BEGIN,
-+#ifdef CONFIG_HIGHMEM
-+ FIX_KMAP_END = FIX_KMAP_BEGIN + (KM_TYPE_NR * NR_CPUS),
-+#endif
-+#ifdef CONFIG_EARLY_PRINTK
-+ FIX_EARLY_DEBUG,
-+#endif
-+ FIX_RETURN_SYSCALL,
-+ __end_of_fixed_addresses
-+};
-+#define FIXADDR_TOP ((unsigned long) (-(16 * PAGE_SIZE)))
-+#define FIXADDR_SIZE ((__end_of_fixed_addresses) << PAGE_SHIFT)
-+#define FIXADDR_START (FIXADDR_TOP - FIXADDR_SIZE)
-+
-+#define __fix_to_virt(x) (FIXADDR_TOP - ((x) << PAGE_SHIFT))
-+#define __virt_to_fix(x) ((FIXADDR_TOP - ((x)&PAGE_MASK)) >> PAGE_SHIFT)
-+
-+#define __this_fixmap_does_not_exist() WARN_ON(1)
-+/*
-+ * 'index to address' translation. If anyone tries to use the idx
-+ * directly without tranlation, we catch the bug with a NULL-deference
-+ * kernel oops. Illegal ranges of incoming indices are caught too.
-+ */
-+
-+static inline unsigned long fix_to_virt(const unsigned int idx)
-+{
-+ /*
-+ * this branch gets completely eliminated after inlining,
-+ * except when someone tries to use fixaddr indices in an
-+ * illegal way. (such as mixing up address types or using
-+ * out-of-range indices).
-+ *
-+ * If it doesn't get removed, the linker will complain
-+ * loudly with a reasonably clear error message..
-+ */
-+ if (idx >= __end_of_fixed_addresses)
-+ __this_fixmap_does_not_exist();
-+
-+ return __fix_to_virt(idx);
-+}
-+
-+static inline unsigned long virt_to_fix(const unsigned long vaddr)
-+{
-+ BUG_ON(vaddr >= FIXADDR_TOP || vaddr < FIXADDR_START);
-+ return __virt_to_fix(vaddr);
-+}
-+
-+#endif /* __ASM_NDS32_FIXMAP_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/fpu.h linux-3.4.113/arch/nds32/include/asm/fpu.h
---- linux-3.4.113.orig/arch/nds32/include/asm/fpu.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/fpu.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,100 @@
-+/*
-+ * linux/arch/nds32/include/asm/fpu.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_FPU_H
-+#define __ASM_NDS32_FPU_H
-+
-+#ifndef __ASSEMBLY__
-+#include <linux/preempt.h>
-+#include <asm/ptrace.h>
-+
-+extern void save_fpu(struct task_struct *__tsk);
-+extern void fpload(struct fpu_struct *fpregs);
-+extern void do_fpu_exception(unsigned long error_code, struct pt_regs *regs);
-+extern int do_fpu_inst(unsigned short, struct pt_regs *);
-+
-+#ifdef CONFIG_FPU
-+
-+#define test_tsk_fpu(regs) (regs->NDS32_FUCOP_CTL & FUCOP_CTL_mskCP0EN)
-+
-+struct task_struct;
-+
-+static inline void release_fpu(struct pt_regs *regs)
-+{
-+ regs->NDS32_FUCOP_CTL &= ~FUCOP_CTL_mskCP0EN;
-+}
-+
-+static inline void grab_fpu(struct pt_regs *regs)
-+{
-+ regs->NDS32_FUCOP_CTL |= FUCOP_CTL_mskCP0EN;
-+}
-+
-+static inline void enable_fpu(void)
-+{
-+ SET_FUCOP_CTL(GET_FUCOP_CTL() | FUCOP_CTL_mskCP0EN);
-+}
-+
-+static inline void disable_fpu(void)
-+{
-+ SET_FUCOP_CTL(GET_FUCOP_CTL() & ~FUCOP_CTL_mskCP0EN);
-+}
-+
-+static inline void lose_fpu(int save)
-+{
-+ preempt_disable();
-+ if (test_tsk_fpu(task_pt_regs(current))) {
-+ if (save)
-+ {
-+ save_fpu(current);
-+# ifndef CONFIG_UNLAZY_FPU
-+ last_task_used_math=NULL;
-+# endif
-+ }
-+ release_fpu(task_pt_regs(current));
-+ }
-+ preempt_enable();
-+}
-+
-+static inline void own_fpu(int restore)
-+{
-+ preempt_disable();
-+ if (!test_tsk_fpu(task_pt_regs(current))) {
-+ if (restore)
-+ {
-+# ifdef CONFIG_UNLAZY_FPU
-+ fpload(&current->thread.fpu);
-+# else
-+ if((last_task_used_math!=NULL)
-+ &&(last_task_used_math!=current))
-+ save_fpu(last_task_used_math);
-+ fpload(&current->thread.fpu);
-+ last_task_used_math=current;
-+#endif
-+ }
-+ grab_fpu(task_pt_regs(current));
-+ }
-+ preempt_enable();
-+}
-+# ifdef CONFIG_UNLAZY_FPU
-+static inline void unlazy_fpu(struct task_struct *tsk)
-+{
-+ preempt_disable();
-+ if (test_tsk_fpu(task_pt_regs(tsk)))
-+ save_fpu(tsk);
-+ preempt_enable();
-+}
-+# endif /* CONFIG_UNLAZY_FPU */
-+static inline void clear_fpu(struct pt_regs *regs)
-+{
-+ preempt_disable();
-+ if (test_tsk_fpu(regs)) {
-+ release_fpu(regs);
-+ }
-+ preempt_enable();
-+}
-+#endif /* CONFIG_FPU */
-+#endif /* __ASSEMBLY__ */
-+
-+#endif /* __ASM_NDS32_FPU_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/ftpci.h linux-3.4.113/arch/nds32/include/asm/ftpci.h
---- linux-3.4.113.orig/arch/nds32/include/asm/ftpci.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/ftpci.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,30 @@
-+/*
-+ * linux/arch/nds32/include/asm/ftpci.h
-+ *
-+ * Faraday FTPCI010 PCI Bridge Device Driver Interface
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * ChangeLog
-+ *
-+ * Peter Liao 09/26/2005 Created, heavily modified from Faraday A320 platform code.
-+ */
-+
-+#ifndef __FARADAY_PLATFORM_PCI_HEADER__
-+#define __FARADAY_PLATFORM_PCI_HEADER__
-+
-+
-+#define PCI_BRIDGE_DEVID 0x4321
-+#define PCI_BRIDGE_VENID 0x159b
-+
-+extern int ftpci_probed;
-+extern void ftpci_clear_irq(unsigned int irq);
-+extern void ftpci_mask_irq(unsigned int irq);
-+extern void ftpci_unmask_irq(unsigned int irq);
-+extern int ftpci_get_irq(void);
-+#endif /* __FARADAY_PLATFORM_PCI_HEADER__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/ftrace.h linux-3.4.113/arch/nds32/include/asm/ftrace.h
---- linux-3.4.113.orig/arch/nds32/include/asm/ftrace.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/ftrace.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,17 @@
-+#ifndef _ASM_POWERPC_FTRACE
-+#define _ASM_POWERPC_FTRACE
-+
-+#ifdef CONFIG_FUNCTION_TRACER
-+#define MCOUNT_ADDR ((long)(_mcount))
-+#define MCOUNT_INSN_SIZE 4 /* sizeof mcount call */
-+
-+#ifdef __ASSEMBLY__
-+
-+#else /* !__ASSEMBLY__ */
-+extern void _mcount(void);
-+
-+#endif /* __ASSEMBLY__ */
-+
-+#endif
-+
-+#endif /* _ASM_POWERPC_FTRACE */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/futex.h linux-3.4.113/arch/nds32/include/asm/futex.h
---- linux-3.4.113.orig/arch/nds32/include/asm/futex.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/futex.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/futex.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_FUTEX_H__
-+#define __NDS32_FUTEX_H__
-+
-+#include <asm-generic/futex.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/glue.h linux-3.4.113/arch/nds32/include/asm/glue.h
---- linux-3.4.113.orig/arch/nds32/include/asm/glue.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/glue.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,26 @@
-+/*
-+ * linux/arch/nds32/include/asm/glue.h
-+ *
-+ * Copyright (C) 1997-1999 Russell King
-+ * Copyright (C) 2000-2002 Deep Blue Solutions Ltd.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * This file provides the glue to stick the processor-specific bits
-+ * into the kernel in an efficient manner. The idea is to use branches
-+ * when we're only targetting one class of TLB, or indirect calls
-+ * when we're targetting multiple classes of TLBs.
-+ */
-+#ifdef __KERNEL__
-+
-+#ifdef __STDC__
-+#define ____glue(name,fn) name##fn
-+#else
-+#define ____glue(name,fn) name/**/fn
-+#endif
-+#define __glue(name,fn) ____glue(name,fn)
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/gpio.h linux-3.4.113/arch/nds32/include/asm/gpio.h
---- linux-3.4.113.orig/arch/nds32/include/asm/gpio.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/gpio.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,10 @@
-+#ifndef _ARCH_NDS32_GPIO_H
-+#define _ARCH_NDS32_GPIO_H
-+
-+#include <asm-generic/gpio.h>
-+#define gpio_get_value __gpio_get_value
-+#define gpio_set_value __gpio_set_value
-+#define gpio_cansleep __gpio_cansleep
-+#define gpio_to_irq __gpio_to_irq
-+
-+#endif /* _ARCH_NDS32_GPIO_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/hardirq.h linux-3.4.113/arch/nds32/include/asm/hardirq.h
---- linux-3.4.113.orig/arch/nds32/include/asm/hardirq.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/hardirq.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,36 @@
-+/*
-+ * linux/arch/nds32/include/asm/hardirq.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+#ifndef __ASM_HARDIRQ_H
-+#define __ASM_HARDIRQ_H
-+
-+#include <linux/cache.h>
-+#include <linux/threads.h>
-+#include <asm/irq.h>
-+
-+typedef struct {
-+ unsigned int __softirq_pending;
-+} ____cacheline_aligned irq_cpustat_t;
-+
-+#include <linux/irq_cpustat.h> /* Standard mappings for irq_cpustat_t above */
-+
-+#if NR_IRQS > 256
-+#define HARDIRQ_BITS 9
-+#else
-+#define HARDIRQ_BITS 8
-+#endif
-+
-+/*
-+ * The hardirq mask has to be large enough to have space
-+ * for potentially all IRQ sources in the system nesting
-+ * on a single CPU:
-+ */
-+#if (1 << HARDIRQ_BITS) < NR_IRQS
-+# error HARDIRQ_BITS is too low!
-+#endif
-+
-+#define __ARCH_IRQ_EXIT_IRQS_DISABLED 1
-+
-+extern void ack_bad_irq(unsigned int irq);
-+#endif /* __ASM_HARDIRQ_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/hardware.h linux-3.4.113/arch/nds32/include/asm/hardware.h
---- linux-3.4.113.orig/arch/nds32/include/asm/hardware.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/hardware.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,61 @@
-+/*
-+ * linux/arch/nds32/include/asm/hardware.h
-+ *
-+ * Faraday Platform Independent Hardware Configuration
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/16/2005 Created.
-+ * Peter Liao 10/04/2005 Modified for uClinux
-+ * Harry Pan 11/02/2007 Added REGxx macros.
-+ */
-+
-+#ifndef __FARADAY_PLATFORM_HARDWARE_HEADER__
-+#define __FARADAY_PLATFORM_HARDWARE_HEADER__
-+
-+#include <asm/spec.h>
-+
-+#ifndef PCIBIOS_MIN_IO
-+/* the mini io address is 0x6000,that is IO will allocate from 0-0x6000 offset*/
-+#define PCIBIOS_MIN_IO 0x0
-+#endif
-+
-+#ifndef PCIBIOS_MIN_MEM
-+/* the mini MEM address is 0x100000,that is MEM will allocate from 0-0x100000 offset*/
-+#define PCIBIOS_MIN_MEM 0x0
-+#endif
-+
-+#define pcibios_assign_all_busses() 1
-+
-+/* Pliauo add 5 to resolve __alloc_bootmem_core return NULL pointer in bootmem.c */
-+#if defined(CPU_MEM_PA_BASE) && defined(CPU_MEM_PA_SIZE)
-+ #define PA_SDRAM_BASE (CPU_MEM_PA_BASE)
-+#else
-+ #define PA_SDRAM_BASE (0x00000000)
-+#endif
-+
-+/*
-+ * Define a simple register accessing method by Harry@Nov.02.2007
-+ */
-+#define REG32(a) (*(volatile unsigned int *)(a))
-+#define REG16(a) (*(volatile unsigned short *)(a))
-+#define REG8(a) (*(volatile unsigned char *)(a))
-+
-+#endif /* __FARADAY_PLATFORM_HARDWARE_HEADER__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/highmem.h linux-3.4.113/arch/nds32/include/asm/highmem.h
---- linux-3.4.113.orig/arch/nds32/include/asm/highmem.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/highmem.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,61 @@
-+#ifndef _ASM_HIGHMEM_H
-+#define _ASM_HIGHMEM_H
-+
-+#include <asm/kmap_types.h>
-+#include <asm/fixmap.h>
-+#include <asm/pgtable.h>
-+
-+/*
-+ * Right now we initialize only a single pte table. It can be extended
-+ * easily, subsequent pte tables have to be allocated in one physical
-+ * chunk of RAM.
-+ */
-+/*
-+ * Ordering is (from lower to higher memory addresses):
-+ *
-+ * high_memory
-+ * Persistent kmap area
-+ * PKMAP_BASE
-+ * fixed_addresses
-+ * FIXADDR_START
-+ * FIXADDR_TOP
-+ * Vmalloc area
-+ * VMALLOC_START
-+ * VMALLOC_END
-+ */
-+#define PKMAP_BASE ((FIXADDR_START - PGDIR_SIZE) & (PGDIR_MASK))
-+#define LAST_PKMAP PTRS_PER_PTE
-+#define LAST_PKMAP_MASK (LAST_PKMAP - 1)
-+#define PKMAP_NR(virt) (((virt) - (PKMAP_BASE)) >> PAGE_SHIFT)
-+#define PKMAP_ADDR(nr) (PKMAP_BASE + ((nr) << PAGE_SHIFT))
-+#define kmap_prot PAGE_KERNEL
-+
-+static inline void flush_cache_kmaps(void)
-+{
-+ cpu_dcache_wbinval_all();
-+}
-+
-+/* declarations for highmem.c */
-+extern unsigned long highstart_pfn, highend_pfn;
-+
-+extern pte_t *pkmap_page_table;
-+
-+extern void *kmap_high(struct page *page);
-+extern void kunmap_high(struct page *page);
-+
-+extern void kmap_init(void);
-+
-+/*
-+ * The following functions are already defined by <linux/highmem.h>
-+ * when CONFIG_HIGHMEM is not set.
-+ */
-+#ifdef CONFIG_HIGHMEM
-+extern void *kmap(struct page *page);
-+extern void kunmap(struct page *page);
-+extern void *kmap_atomic(struct page *page);
-+extern void __kunmap_atomic(void *kvaddr);
-+extern void *kmap_atomic_pfn(unsigned long pfn);
-+extern struct page *kmap_atomic_to_page(void *ptr);
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/hw_irq.h linux-3.4.113/arch/nds32/include/asm/hw_irq.h
---- linux-3.4.113.orig/arch/nds32/include/asm/hw_irq.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/hw_irq.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/hw_irq.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_HW_IRQ_H__
-+#define __NDS32_HW_IRQ_H__
-+
-+
-+#endif /* __NDS32_HW_IRQ_H__ */
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/intc.h linux-3.4.113/arch/nds32/include/asm/intc.h
---- linux-3.4.113.orig/arch/nds32/include/asm/intc.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/intc.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,45 @@
-+/*
-+ * linux/arch/nds32/include/asm/intc.h
-+ *
-+ * Faraday FTINTC010 Interrupt Controller Device Driver Interface
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/14/2005 Created, heavily modified from Faraday CPE platform code.
-+ */
-+
-+#ifndef __FARADAY_INTC_FTINTC010_HEADER__
-+#define __FARADAY_INTC_FTINTC010_HEADER__
-+
-+#define IRQ_SOURCE_REG 0
-+#define IRQ_MASK_REG 0x04
-+#define IRQ_CLEAR_REG 0x08
-+#define IRQ_MODE_REG 0x0c
-+#define IRQ_LEVEL_REG 0x10
-+#define IRQ_STATUS_REG 0x14
-+
-+#define FIQ_SOURCE_REG 0x20
-+#define FIQ_MASK_REG 0x24
-+#define FIQ_CLEAR_REG 0x28
-+#define FIQ_MODE_REG 0x2c
-+#define FIQ_LEVEL_REG 0x30
-+#define FIQ_STATUS_REG 0x34
-+
-+#endif /* __FARADAY_INTC_FTINTC010_HEADER__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/ioctl.h linux-3.4.113/arch/nds32/include/asm/ioctl.h
---- linux-3.4.113.orig/arch/nds32/include/asm/ioctl.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/ioctl.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/ioctl.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_IOCTL_H__
-+#define __NDS32_IOCTL_H__
-+
-+#include <asm-generic/ioctl.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/ioctls.h linux-3.4.113/arch/nds32/include/asm/ioctls.h
---- linux-3.4.113.orig/arch/nds32/include/asm/ioctls.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/ioctls.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,13 @@
-+/*
-+ * linux/arch/nds32/include/asm/ioctls.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_IOCTLS_H
-+#define __ASM_NDS32_IOCTLS_H
-+
-+#define FIOQSIZE 0x545E
-+
-+#include <asm-generic/ioctls.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/io.h linux-3.4.113/arch/nds32/include/asm/io.h
---- linux-3.4.113.orig/arch/nds32/include/asm/io.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/io.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,343 @@
-+/*
-+ * linux/arch/nds32/include/asm/io.h
-+ *
-+ * Copyright (C) 1996-2000 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Modifications:
-+ * 16-Sep-1996 RMK Inlined the inx/outx functions & optimised for both
-+ * constant addresses and variable addresses.
-+ * 04-Dec-1997 RMK Moved a lot of this stuff to the new architecture
-+ * specific IO header files.
-+ * 27-Mar-1999 PJB Second parameter of memcpy_toio is const..
-+ * 04-Apr-1999 PJB Added check_signature.
-+ * 12-Dec-1999 RMK More cleanups
-+ * 18-Jun-2000 RMK Removed virt_to_* and friends definitions
-+ * 05-Oct-2004 BJD Moved memory string functions to use void __iomem
-+ */
-+#ifndef __ASM_NDS32_IO_H
-+#define __ASM_NDS32_IO_H
-+
-+#ifdef __KERNEL__
-+
-+#include <linux/types.h>
-+#include <asm/byteorder.h>
-+#include <asm/memory.h>
-+#include <asm/hardware.h>
-+#include <asm-generic/iomap.h>
-+
-+
-+/*
-+ * ISA I/O bus memory addresses are 1:1 with the physical address.
-+ */
-+#define isa_virt_to_bus virt_to_phys
-+#define isa_page_to_bus page_to_phys
-+#define isa_bus_to_virt phys_to_virt
-+
-+/*
-+ * Generic IO read/write. These perform native-endian accesses. Note
-+ * that some architectures will want to re-define __raw_{read,write}w.
-+ */
-+
-+#define __raw_writeb(v,a) (*(volatile unsigned char __force *)(a) = (v))
-+#define __raw_writew(v,a) (*(volatile unsigned short __force *)(a) = (v))
-+#define __raw_writel(v,a) (*(volatile unsigned int __force *)(a) = (v))
-+
-+#define __raw_readb(a) (*(volatile unsigned char __force *)(a))
-+#define __raw_readw(a) (*(volatile unsigned short __force *)(a))
-+#define __raw_readl(a) (*(volatile unsigned int __force *)(a))
-+
-+/*
-+ * Bad read/write accesses...
-+ */
-+extern void __readwrite_bug(const char *fn);
-+
-+/*
-+ * Now, pick up the machine-defined IO definitions
-+ */
-+#ifndef __FARADAY_PLATFORM_IO_HEADER__
-+#define __FARADAY_PLATFORM_IO_HEADER__
-+
-+#include <linux/compiler.h>
-+#include <asm/spec.h>
-+
-+#ifndef IO_SPACE_LIMIT
-+#define IO_SPACE_LIMIT 0xffffffff
-+#endif
-+
-+#ifndef __io
-+#define __io(a) ((void __iomem *)(a))
-+#endif
-+#define IO_ADDRESS(a) __io(a)
-+#ifndef __mem_pci
-+#define __mem_pci(a) (a)
-+#endif
-+
-+#endif
-+
-+#ifdef __io_pci
-+#warning machine class uses buggy __io_pci
-+#endif
-+#if defined(__arch_putb) || defined(__arch_putw) || defined(__arch_putl) || \
-+ defined(__arch_getb) || defined(__arch_getw) || defined(__arch_getl)
-+//-Tom for debug
-+//#warning machine class uses old __arch_putw or __arch_getw
-+#endif
-+
-+/*
-+ * IO port access primitives
-+ * -------------------------
-+ *
-+ * The ARM doesn't have special IO access instructions; all IO is memory
-+ * mapped. Note that these are defined to perform little endian accesses
-+ * only. Their primary purpose is to access PCI and ISA peripherals.
-+ *
-+ * Note that for a big endian machine, this implies that the following
-+ * big endian mode connectivity is in place, as described by numerious
-+ * ARM documents:
-+ *
-+ * PCI: D0-D7 D8-D15 D16-D23 D24-D31
-+ * ARM: D24-D31 D16-D23 D8-D15 D0-D7
-+ *
-+ * The machine specific io.h include defines __io to translate an "IO"
-+ * address to a memory address.
-+ *
-+ * Note that we prevent GCC re-ordering or caching values in expressions
-+ * by introducing sequence points into the in*() definitions. Note that
-+ * __raw_* do not guarantee this behaviour.
-+ *
-+ * The {in,out}[bwl] macros are for emulating x86-style PCI/ISA IO space.
-+ */
-+#ifdef __io
-+#ifdef __NDS32_EB__
-+#define inw(p) ({ unsigned int __v = be16_to_cpu(__raw_readw(__io(p))); __v; })
-+#define inl(p) ({ unsigned int __v = be32_to_cpu(__raw_readl(__io(p))); __v; })
-+#define outw(v,p) __raw_writew(cpu_to_be16(v),__io(p))
-+#define outl(v,p) __raw_writel(cpu_to_be32(v),__io(p))
-+#else
-+#define inw(p) ({ unsigned int __v = le16_to_cpu(__raw_readw(__io(p))); __v; })
-+#define inl(p) ({ unsigned int __v = le32_to_cpu(__raw_readl(__io(p))); __v; })
-+#define outw(v,p) __raw_writew(cpu_to_le16(v),__io(p))
-+#define outl(v,p) __raw_writel(cpu_to_le32(v),__io(p))
-+#endif
-+
-+#define inb(p) ({ unsigned int __v = __raw_readb(__io(p)); __v; })
-+#define outb(v,p) __raw_writeb(v,__io(p))
-+
-+#endif
-+
-+#define outb_p(val,port) outb((val),(port))
-+#define outw_p(val,port) outw((val),(port))
-+#define outl_p(val,port) outl((val),(port))
-+#define inb_p(port) inb((port))
-+#define inw_p(port) inw((port))
-+#define inl_p(port) inl((port))
-+
-+/*
-+ * String version of IO memory access ops:
-+ */
-+extern void _memcpy_fromio(void *, const volatile void __iomem *, size_t);
-+extern void _memcpy_toio(volatile void __iomem *, const void *, size_t);
-+extern void _memset_io(volatile void __iomem *, int, size_t);
-+
-+#define mmiowb()
-+
-+/*
-+ * Memory access primitives
-+ * ------------------------
-+ *
-+ * These perform PCI memory accesses via an ioremap region. They don't
-+ * take an address as such, but a cookie.
-+ *
-+ * Again, this are defined to perform little endian accesses. See the
-+ * IO port primitives for more information.
-+ */
-+#ifdef __mem_pci
-+#ifdef __NDS32_EB__
-+#define readw(c) ({ unsigned int __v = be16_to_cpu(__raw_readw(__mem_pci(c))); __v; })
-+#define readl(c) ({ unsigned int __v = be32_to_cpu(__raw_readl(__mem_pci(c))); __v; })
-+#define writew(v,c) __raw_writew(cpu_to_be16(v),__mem_pci(c))
-+#define writel(v,c) __raw_writel(cpu_to_be32(v),__mem_pci(c))
-+#else
-+#define readw(c) ({ unsigned int __v = le16_to_cpu(__raw_readw(__mem_pci(c))); __v; })
-+#define readl(c) ({ unsigned int __v = le32_to_cpu(__raw_readl(__mem_pci(c))); __v; })
-+#define writew(v,c) __raw_writew(cpu_to_le16(v),__mem_pci(c))
-+#define writel(v,c) __raw_writel(cpu_to_le32(v),__mem_pci(c))
-+#endif
-+
-+#define readb(c) ({ unsigned int __v = __raw_readb(__mem_pci(c)); __v; })
-+#define writeb(v,c) __raw_writeb(v,__mem_pci(c))
-+
-+#define readb_relaxed(addr) readb(addr)
-+#define readw_relaxed(addr) readw(addr)
-+#define readl_relaxed(addr) readl(addr)
-+
-+#define memset_io(c,v,l) _memset_io(__mem_pci(c),(v),(l))
-+#define memcpy_fromio(a,c,l) _memcpy_fromio((a),__mem_pci(c),(l))
-+#define memcpy_toio(c,a,l) _memcpy_toio(__mem_pci(c),(a),(l))
-+
-+#define eth_io_copy_and_sum(s,c,l,b) \
-+ eth_copy_and_sum((s),__mem_pci(c),(l),(b))
-+
-+#elif !defined(readb)
-+
-+#define readb(c) (__readwrite_bug("readb"),0)
-+#define readw(c) (__readwrite_bug("readw"),0)
-+#define readl(c) (__readwrite_bug("readl"),0)
-+#define writeb(v,c) __readwrite_bug("writeb")
-+#define writew(v,c) __readwrite_bug("writew")
-+#define writel(v,c) __readwrite_bug("writel")
-+
-+#define eth_io_copy_and_sum(s,c,l,b) __readwrite_bug("eth_io_copy_and_sum")
-+
-+#endif /* __mem_pci */
-+
-+/*
-+ * If this architecture has ISA IO, then define the isa_read/isa_write
-+ * macros.
-+ */
-+#ifdef __mem_isa
-+
-+#define isa_readb(addr) __raw_readb(__mem_isa(addr))
-+#define isa_readw(addr) __raw_readw(__mem_isa(addr))
-+#define isa_readl(addr) __raw_readl(__mem_isa(addr))
-+#define isa_writeb(val,addr) __raw_writeb(val,__mem_isa(addr))
-+#define isa_writew(val,addr) __raw_writew(val,__mem_isa(addr))
-+#define isa_writel(val,addr) __raw_writel(val,__mem_isa(addr))
-+#define isa_memset_io(a,b,c) _memset_io(__mem_isa(a),(b),(c))
-+#define isa_memcpy_fromio(a,b,c) _memcpy_fromio((a),__mem_isa(b),(c))
-+#define isa_memcpy_toio(a,b,c) _memcpy_toio(__mem_isa((a)),(b),(c))
-+
-+#define isa_eth_io_copy_and_sum(a,b,c,d) \
-+ eth_copy_and_sum((a),__mem_isa(b),(c),(d))
-+
-+#else /* __mem_isa */
-+
-+#define isa_readb(addr) (__readwrite_bug("isa_readb"),0)
-+#define isa_readw(addr) (__readwrite_bug("isa_readw"),0)
-+#define isa_readl(addr) (__readwrite_bug("isa_readl"),0)
-+#define isa_writeb(val,addr) __readwrite_bug("isa_writeb")
-+#define isa_writew(val,addr) __readwrite_bug("isa_writew")
-+#define isa_writel(val,addr) __readwrite_bug("isa_writel")
-+#define isa_memset_io(a,b,c) __readwrite_bug("isa_memset_io")
-+#define isa_memcpy_fromio(a,b,c) __readwrite_bug("isa_memcpy_fromio")
-+#define isa_memcpy_toio(a,b,c) __readwrite_bug("isa_memcpy_toio")
-+
-+#define isa_eth_io_copy_and_sum(a,b,c,d) \
-+ __readwrite_bug("isa_eth_io_copy_and_sum")
-+
-+#endif /* __mem_isa */
-+
-+/*
-+ * ioremap and friends.
-+ *
-+ * ioremap takes a PCI memory address, as specified in
-+ * Documentation/IO-mapping.txt.
-+ */
-+extern void __iomem * __ioremap(unsigned long, size_t, unsigned long, unsigned long);
-+extern void __iounmap(void __iomem *addr);
-+
-+#ifndef __arch_ioremap
-+#define ioremap(cookie,size) __ioremap(cookie,size,0,1)
-+#define ioremap_nocache(cookie,size) __ioremap(cookie,size,0,1)
-+#define iounmap(cookie) __iounmap(cookie)
-+#else
-+#define ioremap(cookie,size) __arch_ioremap((cookie),(size),0,1)
-+#define ioremap_nocache(cookie,size) __arch_ioremap((cookie),(size),0,1)
-+#define iounmap(cookie) __arch_iounmap(cookie)
-+#endif
-+
-+/*
-+ * can the hardware map this into one segment or not, given no other
-+ * constraints.
-+ */
-+#define BIOVEC_MERGEABLE(vec1, vec2) \
-+ ((bvec_to_phys((vec1)) + (vec1)->bv_len) == bvec_to_phys((vec2)))
-+
-+/*
-+ * Convert a physical pointer to a virtual kernel pointer for /dev/mem
-+ * access
-+ */
-+#define xlate_dev_mem_ptr(p) __va(p)
-+
-+/*
-+ * Convert a virtual cached pointer to an uncached pointer
-+ */
-+#define xlate_dev_kmem_ptr(p) p
-+static inline void readsb(const void __iomem *addr, void * data, int bytelen)
-+{
-+ unsigned char *ptr = (unsigned char *)addr;
-+ unsigned char *ptr2 = (unsigned char *)data;
-+ while(bytelen) {
-+ *ptr2 = *ptr;
-+ ptr2++;
-+ bytelen--;
-+ }
-+}
-+
-+static inline void readsw(const void __iomem *addr, void * data, int wordlen)
-+{
-+ unsigned short *ptr = (unsigned short *)addr;
-+ unsigned short *ptr2 = (unsigned short *)data;
-+ while(wordlen) {
-+ *ptr2 = *ptr;
-+ ptr2++;
-+ wordlen--;
-+ }
-+}
-+
-+static inline void readsl(const void __iomem *addr, void * data, int longlen)
-+{
-+ unsigned int *ptr = (unsigned int *)addr;
-+ unsigned int *ptr2 = (unsigned int *)data;
-+ while(longlen) {
-+ *ptr2 = *ptr;
-+ ptr2++;
-+ longlen--;
-+ }
-+}
-+static inline void writesb(void __iomem *addr, const void * data, int bytelen)
-+{
-+ unsigned char *ptr = (unsigned char *)addr;
-+ unsigned char *ptr2 = (unsigned char *)data;
-+ while(bytelen) {
-+ *ptr = *ptr2;
-+ ptr2++;
-+ bytelen--;
-+ }
-+}
-+static inline void writesw(void __iomem *addr, const void * data, int wordlen)
-+{
-+ unsigned short *ptr = (unsigned short *)addr;
-+ unsigned short *ptr2 = (unsigned short *)data;
-+ while(wordlen) {
-+ *ptr = *ptr2;
-+ ptr2++;
-+ wordlen--;
-+ }
-+}
-+static inline void writesl(void __iomem *addr, const void * data, int longlen)
-+{
-+ unsigned int *ptr = (unsigned int *)addr;
-+ unsigned int *ptr2 = (unsigned int *)data;
-+ while(longlen) {
-+ *ptr = *ptr2;
-+ ptr2++;
-+ longlen--;
-+ }
-+}
-+
-+
-+#define insb(p,d,l) BUG()
-+#define insw(p,d,l) BUG()
-+#define insl(p,d,l) BUG()
-+#define outsb(p,d,l) BUG()
-+#define outsw(p,d,l) BUG()
-+#define outsl(p,d,l) BUG()
-+
-+#endif /* __KERNEL__ */
-+#endif /* __ASM_NDS32_IO_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/ipcbuf.h linux-3.4.113/arch/nds32/include/asm/ipcbuf.h
---- linux-3.4.113.orig/arch/nds32/include/asm/ipcbuf.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/ipcbuf.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,34 @@
-+/*
-+ * linux/arch/nds32/include/asm/ipcbuf.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASMNDS32_IPCBUF_H
-+#define __ASMNDS32_IPCBUF_H
-+
-+/*
-+ * The ipc64_perm structure for arm architecture.
-+ * Note extra padding because this structure is passed back and forth
-+ * between kernel and user space.
-+ *
-+ * Pad space is left for:
-+ * - 32-bit mode_t and seq
-+ * - 2 miscellaneous 32-bit values
-+ */
-+
-+struct ipc64_perm
-+{
-+ __kernel_key_t key;
-+ __kernel_uid32_t uid;
-+ __kernel_gid32_t gid;
-+ __kernel_uid32_t cuid;
-+ __kernel_gid32_t cgid;
-+ __kernel_mode_t mode;
-+ unsigned short __pad1;
-+ unsigned short seq;
-+ unsigned short __pad2;
-+ unsigned long __unused1;
-+ unsigned long __unused2;
-+};
-+
-+#endif /* __ASMNDS32_IPCBUF_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/irqflags.h linux-3.4.113/arch/nds32/include/asm/irqflags.h
---- linux-3.4.113.orig/arch/nds32/include/asm/irqflags.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/irqflags.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,65 @@
-+/*
-+ * linux/arch/nds32/include/asm/irqflags.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#include <asm/nds32.h>
-+#include <asm/assembler.h>
-+
-+#define arch_local_irq_disable() \
-+ GIE_DISABLE();
-+
-+#define arch_local_irq_enable() \
-+ GIE_ENABLE();
-+static inline unsigned long arch_local_irq_save(void)
-+{
-+ unsigned long flags;
-+ __asm__ __volatile__(
-+ "mfsr %0, $PSW\n"
-+ "andi %0, %0, #0x1\n"
-+ "gie_disable\n"
-+ : "=r" (flags) );
-+ return flags;
-+}
-+static inline unsigned long arch_local_save_flags(void)
-+{
-+ unsigned long flags;
-+ __asm__ __volatile__(
-+ "mfsr %0, $PSW\n"
-+ "andi %0, %0, #0x1"
-+ : "=r" (flags) );
-+ return flags;
-+}
-+static inline void arch_local_irq_restore(unsigned long flags)
-+{
-+ __asm__ __volatile__(
-+ "beqz %0, 1f\n"
-+ "gie_enable\n"
-+ "1:"
-+ :: "r" (flags) );
-+}
-+static inline int arch_irqs_disabled_flags(unsigned long flags)
-+{
-+ return !flags;
-+}
-+#if 0
-+#define raw_local_irq_save(x) \
-+ __asm__ __volatile__( \
-+ "mfsr %0, $PSW\n" \
-+ "andi %0, %0, #0x1\n" \
-+ "gie_disable\n" \
-+ : "=r" (x) )
-+#define raw_local_save_flags(x) \
-+ __asm__ __volatile__( \
-+ "mfsr %0, $PSW\n" \
-+ "andi %0, %0, #0x1" \
-+ : "=r" (x) )
-+#define raw_local_irq_restore(x) \
-+ __asm__ __volatile__( \
-+ "beqz %0, 1f\n" \
-+ "gie_enable\n" \
-+ "1:" \
-+ :: "r" (x) )
-+
-+#define raw_irqs_disabled_flags(x) !(x)
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/irq.h linux-3.4.113/arch/nds32/include/asm/irq.h
---- linux-3.4.113.orig/arch/nds32/include/asm/irq.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/irq.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,50 @@
-+/*
-+ * linux/arch/nds32/include/asm/irq.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_IRQ_H
-+#define __ASM_NDS32_IRQ_H
-+
-+#include <asm/spec.h>
-+
-+#ifndef irq_canonicalize
-+#define irq_canonicalize(i) (i)
-+#endif
-+
-+#ifndef NR_IRQS
-+#define NR_IRQS 128
-+#endif
-+
-+/*
-+ * Use this value to indicate lack of interrupt
-+ * capability
-+ */
-+#ifndef NO_IRQ
-+#define NO_IRQ ((unsigned int)(-1))
-+#endif
-+
-+struct irqaction;
-+
-+extern void disable_irq_nosync(unsigned int);
-+extern void disable_irq(unsigned int);
-+extern void enable_irq(unsigned int);
-+
-+#define __IRQT_FALEDGE IRQ_TYPE_EDGE_FALLING
-+#define __IRQT_RISEDGE IRQ_TYPE_EDGE_RISING
-+#define __IRQT_LOWLVL IRQ_TYPE_LEVEL_LOW
-+#define __IRQT_HIGHLVL IRQ_TYPE_LEVEL_HIGH
-+
-+#define IRQT_NOEDGE (0)
-+#define IRQT_RISING (__IRQT_RISEDGE)
-+#define IRQT_FALLING (__IRQT_FALEDGE)
-+#define IRQT_BOTHEDGE (__IRQT_RISEDGE|__IRQT_FALEDGE)
-+#define IRQT_LOW (__IRQT_LOWLVL)
-+#define IRQT_HIGH (__IRQT_HIGHLVL)
-+#define IRQT_PROBE IRQ_TYPE_PROBE
-+
-+struct irqaction;
-+struct pt_regs;
-+
-+#endif
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/irq_regs.h linux-3.4.113/arch/nds32/include/asm/irq_regs.h
---- linux-3.4.113.orig/arch/nds32/include/asm/irq_regs.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/irq_regs.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,9 @@
-+/*
-+ * linux/arch/nds32/include/asm/irq_regs.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_IRQ_REGS_H__
-+#define __NDS32_IRQ_REGS_H__
-+#include <asm-generic/irq_regs.h>
-+#endif /* __NDS32_IRQ_REGS_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/Kbuild linux-3.4.113/arch/nds32/include/asm/Kbuild
---- linux-3.4.113.orig/arch/nds32/include/asm/Kbuild 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/Kbuild 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,3 @@
-+include include/asm-generic/Kbuild.asm
-+
-+header-y += pfm.h
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/kdebug.h linux-3.4.113/arch/nds32/include/asm/kdebug.h
---- linux-3.4.113.orig/arch/nds32/include/asm/kdebug.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/kdebug.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,14 @@
-+/*
-+ * linux/arch/nds32/include/asm/kdebug.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_KDEBUG_H__
-+#define __NDS32_KDEBUG_H__
-+
-+enum die_val {
-+ DIE_OOPS = 1,
-+ DIE_DEBUG,
-+};
-+
-+#endif /* __NDS32_KDEBUG_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/kexec.h linux-3.4.113/arch/nds32/include/asm/kexec.h
---- linux-3.4.113.orig/arch/nds32/include/asm/kexec.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/kexec.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,31 @@
-+#ifndef _NDS32_KEXEC_H
-+#define _NDS32_KEXEC_H
-+
-+#ifdef CONFIG_KEXEC
-+
-+/* Maximum physical address we can use pages from */
-+#define KEXEC_SOURCE_MEMORY_LIMIT (-1UL)
-+/* Maximum address we can reach in physical address mode */
-+#define KEXEC_DESTINATION_MEMORY_LIMIT (-1UL)
-+/* Maximum address we can use for the control code buffer */
-+#define KEXEC_CONTROL_MEMORY_LIMIT (-1UL)
-+
-+#define KEXEC_CONTROL_PAGE_SIZE 4096
-+
-+#define KEXEC_ARCH KEXEC_ARCH_NDS32
-+
-+#define KEXEC_NDS32_ATAGS_OFFSET 0x1000
-+#define KEXEC_NDS32_ZIMAGE_OFFSET 0x500000
-+
-+#ifndef __ASSEMBLY__
-+
-+struct kimage;
-+/* Provide a dummy definition to avoid build failures. */
-+static inline void crash_setup_regs(struct pt_regs *newregs,
-+ struct pt_regs *oldregs) { }
-+
-+#endif /* __ASSEMBLY__ */
-+
-+#endif /* CONFIG_KEXEC */
-+
-+#endif /* _NDS32_KEXEC_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/kgdb.h linux-3.4.113/arch/nds32/include/asm/kgdb.h
---- linux-3.4.113.orig/arch/nds32/include/asm/kgdb.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/kgdb.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,90 @@
-+/* ============================================================================
-+ *
-+ * linux/arch/nds32/include/asm/kgdb.h
-+ *
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for NDS32 KGDB support.
-+ *
-+ * Author: Harry Pan
-+ *
-+ * Revision History:
-+ *
-+ * Jul.14.2007 Initial ported by Harry.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#ifndef __ASM_NDS32_KGDB_H__
-+#define __ASM_NDS32_KGDB_H__
-+
-+#include <asm/ptrace.h>
-+
-+#define BREAK_INSTR_SIZE 2
-+#define CACHE_FLUSH_IS_SAFE 1
-+
-+#ifndef __ASSEMBLY__
-+
-+/*
-+ * Define numbers of registers we have in NDS32 arch
-+ */
-+#define NDS32_NUM_GR 32 // general registers.
-+#define NDS32_NUM_SPR 5 // special registers. (PC, D0, D1)
-+#define NDS32_NUM_CR 6 // ctrl registers.
-+#define NDS32_NUM_IR 16 // interruption registers.
-+#define NDS32_NUM_MR 11 // MMU registers.
-+#define NDS32_NUM_DR 48 // debug registers.
-+#define NDS32_NUM_PFR 4 // performance monitoring registers.
-+#define NDS32_NUM_DMAR 11 // local memory DMA registers
-+#define NDS32_NUM_RACR 1 // resource access control registers.
-+#define NDS32_NUM_IDR 2 // implementation dependent registers.
-+#define NDS32_NUM_SR (NDS32_NUM_CR + NDS32_NUM_IR + NDS32_NUM_MR + \
-+ NDS32_NUM_DR + NDS32_NUM_PFR + NDS32_NUM_DMAR + \
-+ NDS32_NUM_RACR + NDS32_NUM_IDR)
-+#define NDS32_NUM_REGS (NDS32_NUM_GR + NDS32_NUM_SPR + NDS32_NUM_SR)
-+
-+#define KGDB_MAX_NO_CPUS 1
-+#define BUFMAX 2048
-+#define NUMREGBYTES (NDS32_NUM_REGS << 2)
-+
-+/*
-+ * NDS32 virtual registers layout for GDB.
-+ */
-+enum nds32_regnum
-+{
-+ NDS32_R0_REGNUM = 0, // first integer-like argument.
-+ NDS32_R5_REGNUM = 5, // last integer-like argument.
-+ NDS32_FP_REGNUM = 28, // frame register
-+ NDS32_LP_REGNUM = 30, // link pointer
-+ NDS32_SP_REGNUM = 31, // address of stack top.
-+ NDS32_PC_REGNUM = 32,
-+ NDS32_D0LO_REGNUM = 33,
-+ NDS32_D0HI_REGNUM = 34,
-+ NDS32_D1LO_REGNUM = 35,
-+ NDS32_D1HI_REGNUM = 36,
-+ NDS32_CR0_REGNUM = 37,
-+ NDS32_IR0_REGNUM = (NDS32_CR0_REGNUM + NDS32_NUM_CR),
-+ NDS32_MR0_REGNUM = (NDS32_IR0_REGNUM + NDS32_NUM_IR),
-+ NDS32_DR0_REGNUM = (NDS32_MR0_REGNUM + NDS32_NUM_MR),
-+ NDS32_PFR0_REGNUM = (NDS32_DR0_REGNUM + NDS32_NUM_DR),
-+ NDS32_DMAR0_REGNUM = (NDS32_PFR0_REGNUM + NDS32_NUM_PFR),
-+ NDS32_RACR0_REGNUM = (NDS32_DMAR0_REGNUM + NDS32_NUM_DMAR),
-+ NDS32_IDR0_REGNUM = (NDS32_RACR0_REGNUM + NDS32_NUM_RACR),
-+ /* nds32 calling convention. */
-+ NDS32_ARG0_REGNUM = NDS32_R0_REGNUM,
-+ NDS32_ARGN_REGNUM = NDS32_R5_REGNUM,
-+ NDS32_RET_REGNUM = NDS32_R0_REGNUM,
-+};
-+
-+static inline void arch_kgdb_breakpoint(void)
-+{
-+ asm __volatile__ ( "break 0x1ff\n" );
-+}
-+
-+#endif /* !__ASSEMBLY__ */
-+#endif /* __ASM_NDS32_KGDB_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/kmap_types.h linux-3.4.113/arch/nds32/include/asm/kmap_types.h
---- linux-3.4.113.orig/arch/nds32/include/asm/kmap_types.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/kmap_types.h 2016-12-01 20:59:24.336612134 +0100
-@@ -0,0 +1,29 @@
-+/*
-+ * linux/arch/nds32/include/asm/kmap-types.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_KMAP_TYPES_H
-+#define __NDS32_KMAP_TYPES_H
-+
-+/*
-+ * This is the "bare minimum". AIO seems to require this.
-+ */
-+enum km_type {
-+ KM_BOUNCE_READ,
-+ KM_SKB_SUNRPC_DATA,
-+ KM_SKB_DATA_SOFTIRQ,
-+ KM_USER0,
-+ KM_USER1,
-+ KM_BIO_SRC_IRQ,
-+ KM_BIO_DST_IRQ,
-+ KM_PTE0,
-+ KM_PTE1,
-+ KM_IRQ0,
-+ KM_IRQ1,
-+ KM_SOFTIRQ0,
-+ KM_SOFTIRQ1,
-+ KM_TYPE_NR
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/kprobes.h linux-3.4.113/arch/nds32/include/asm/kprobes.h
---- linux-3.4.113.orig/arch/nds32/include/asm/kprobes.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/kprobes.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,86 @@
-+#ifndef _ASM_ANDES_KPROBES_H
-+#define _ASM_ANDES_KPROBES_H
-+/*
-+ * Kernel Probes (KProbes)
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * Copyright (C) IBM Corporation, 2002, 2004
-+ *
-+ * See arch/x86/kernel/kprobes.c for x86 kprobes history.
-+ */
-+#include <linux/types.h>
-+#include <linux/ptrace.h>
-+#include <linux/percpu.h>
-+
-+#define __ARCH_WANT_KPROBES_INSN_SLOT
-+
-+struct pt_regs;
-+struct kprobe;
-+
-+typedef unsigned short kprobe_opcode_t;
-+
-+#define MAX_INSN_SIZE 2
-+#define MAX_STACK_SIZE 64
-+#define MIN_STACK_SIZE(ADDR) \
-+ (((MAX_STACK_SIZE) < (((unsigned long)current_thread_info()) + \
-+ THREAD_SIZE - (unsigned long)(ADDR))) \
-+ ? (MAX_STACK_SIZE) \
-+ : (((unsigned long)current_thread_info()) + \
-+ THREAD_SIZE - (unsigned long)(ADDR)))
-+#define regs_return_value(regs) ((regs)->NDS32_r0)
-+#define flush_insn_slot(p) do { } while (0)
-+#define kretprobe_blacklist_size 0
-+
-+void arch_remove_kprobe(struct kprobe *p);
-+void kretprobe_trampoline(void);
-+
-+/* Architecture specific copy of original instruction*/
-+struct arch_specific_insn {
-+ /* copy of the original instruction */
-+ kprobe_opcode_t *insn;
-+ /*
-+ * boostable = -1: This instruction type is not boostable.
-+ * boostable = 0: This instruction type is boostable.
-+ * boostable = 1: This instruction has been boosted: we have
-+ * added a relative jump after the instruction copy in insn,
-+ * so no single-step and fixup are needed (unless there's
-+ * a post_handler or break_handler).
-+ */
-+ int boostable;
-+};
-+
-+struct prev_kprobe {
-+ struct kprobe *kp;
-+ unsigned long status;
-+ unsigned long old_flags;
-+ unsigned long saved_flags;
-+};
-+
-+/* per-cpu kprobe control block */
-+struct kprobe_ctlblk {
-+ unsigned long kprobe_status;
-+ unsigned long kprobe_old_flags;
-+ unsigned long kprobe_saved_flags;
-+ unsigned long *jprobe_saved_sp;
-+ struct pt_regs jprobe_saved_regs;
-+ kprobe_opcode_t jprobes_stack[MAX_STACK_SIZE];
-+ struct prev_kprobe prev_kprobe;
-+};
-+
-+extern int kprobe_fault_handler(struct pt_regs *regs, int trapnr);
-+extern int kprobe_exceptions_notify(struct notifier_block *self,
-+ unsigned long val, void *data);
-+#endif /* _ASM_ANDES_KPROBES_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/kvm.h linux-3.4.113/arch/nds32/include/asm/kvm.h
---- linux-3.4.113.orig/arch/nds32/include/asm/kvm.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/kvm.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,9 @@
-+/*
-+ * linux/arch/nds32/include/asm/kvm.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_KVM_H__
-+#define __NDS32_KVM_H__
-+
-+#endif /* __NDS32_KVM_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/l2_cache.h linux-3.4.113/arch/nds32/include/asm/l2_cache.h
---- linux-3.4.113.orig/arch/nds32/include/asm/l2_cache.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/l2_cache.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,134 @@
-+/*
-+ * linux/arch/nds32/include/asm/l2_cache.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef L2_CACHE_H
-+#define L2_CACHE_H
-+
-+// CCTL_CMD_OP
-+#define L2_CA_CONF_OFF 0x0
-+#define L2_IF_CONF_OFF 0x4
-+#define L2CC_SETUP_OFF 0x8
-+#define L2CC_PROT_OFF 0xC
-+#define L2CC_CTRL_OFF 0x10
-+#define L2_INT_EN_OFF 0x20
-+#define L2_STA_OFF 0x24
-+#define RDERR_ADDR_OFF 0x28
-+#define WRERR_ADDR_OFF 0x2c
-+#define EVDPTERR_ADDR_OFF 0x30
-+#define IMPL3ERR_ADDR_OFF 0x34
-+#define L2_CNT0_CTRL_OFF 0x40
-+#define L2_EVNT_CNT0_OFF 0x44
-+#define L2_CNT1_CTRL_OFF 0x48
-+#define L2_EVNT_CNT1_OFF 0x4c
-+#define L2_CCTL_CMD_OFF 0x60
-+#define L2_CCTL_STATUS_OFF 0x64
-+#define L2_LINE_TAG_OFF 0x68
-+#define L2_LINE_DPT_OFF 0x70
-+
-+#define CCTL_CMD_L2_IX_INVAL 0x0
-+#define CCTL_CMD_L2_PA_INVAL 0x1
-+#define CCTL_CMD_L2_IX_WB 0x2
-+#define CCTL_CMD_L2_PA_WB 0x3
-+#define CCTL_CMD_L2_PA_WBINVAL 0x5
-+#define CCTL_CMD_L2_SYNC 0xa
-+// CCTL_CMD_TYPE
-+#define CCTL_SINGLE_CMD 0
-+#define CCTL_BLOCK_CMD 0x10
-+#define CCTL_ALL_CMD 0x10
-+
-+/******************************************************************************
-+ * L2_CA_CONF (Cache architecture configuration)
-+ *****************************************************************************/
-+#define L2_CA_CONF_offL2SET 0
-+#define L2_CA_CONF_offL2WAY 4
-+#define L2_CA_CONF_offL2CLSZ 8
-+#define L2_CA_CONF_offL2DW 11
-+#define L2_CA_CONF_offL2PT 14
-+#define L2_CA_CONF_offL2VER 16
-+
-+#define L2_CA_CONF_mskL2SET (0xFUL << L2_CA_CONF_offL2SET)
-+#define L2_CA_CONF_mskL2WAY (0xFUL << L2_CA_CONF_offL2WAY)
-+#define L2_CA_CONF_mskL2CLSZ (0x7UL << L2_CA_CONF_offL2CLSZ)
-+#define L2_CA_CONF_mskL2DW (0x7UL << L2_CA_CONF_offL2DW)
-+#define L2_CA_CONF_mskL2PT (0x3UL << L2_CA_CONF_offL2PT)
-+#define L2_CA_CONF_mskL2VER (0xFFFFUL << L2_CA_CONF_offL2VER)
-+
-+/******************************************************************************
-+ * L2CC_SETUP (L2CC Setup register)
-+ *****************************************************************************/
-+#define L2CC_SETUP_offPART 0
-+#define L2CC_SETUP_mskPART (0x3UL << L2CC_SETUP_offPART)
-+#define L2CC_SETUP_offDDLATC 4
-+#define L2CC_SETUP_mskDDLATC (0x3UL << L2CC_SETUP_offDDLATC)
-+#define L2CC_SETUP_offTDLATC 8
-+#define L2CC_SETUP_mskTDLATC (0x3UL << L2CC_SETUP_offTDLATC)
-+
-+/******************************************************************************
-+ * L2CC_PROT (L2CC Protect register)
-+ *****************************************************************************/
-+#define L2CC_PROT_offMRWEN 31
-+#define L2CC_PROT_mskMRWEN (0x1UL << L2CC_PROT_offMRWEN)
-+//TODO finish this table
-+//
-+/******************************************************************************
-+ * L2_CCTL_STATUS_Mn (The L2CCTL command working status for Master n)
-+ *****************************************************************************/
-+#define L2CC_CTRL_offEN 31
-+#define L2CC_CTRL_mskEN (0x1UL << L2CC_CTRL_offEN)
-+
-+/******************************************************************************
-+ * L2_CCTL_STATUS_Mn (The L2CCTL command working status for Master n)
-+ *****************************************************************************/
-+#define L2_CCTL_STATUS_offCMD_COMP 31
-+#define L2_CCTL_STATUS_mskCMD_COMP (0x1 << L2_CCTL_STATUS_offCMD_COMP)
-+//TODO finish this table
-+
-+#ifndef __ASSEMBLY__
-+
-+#include <linux/smp.h>
-+#include <asm/io.h>
-+#include <asm/bitfield.h>
-+
-+#define L2C_R_REG(offset) inl(L2CC_VA_BASE + offset)
-+#define L2C_W_REG(offset, value) outl(value, L2CC_VA_BASE + offset)
-+
-+#define L2_CMD_RDY() \
-+ do{;}while((L2C_R_REG(L2_CCTL_STATUS_OFF) & L2_CCTL_STATUS_mskCMD_COMP) == 0)
-+
-+static inline unsigned long L2_CACHE_SET(void){
-+ return 64 << ( ( L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2SET) >> L2_CA_CONF_offL2SET);
-+}
-+
-+static inline unsigned long L2_CACHE_WAY(void){
-+ return 1 + ( ( L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2WAY) >> L2_CA_CONF_offL2WAY);
-+}
-+
-+static inline unsigned long L2_CACHE_LINE_SIZE(void){
-+
-+ return 4 << ( ( L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2CLSZ) >> L2_CA_CONF_offL2CLSZ);
-+}
-+
-+static inline unsigned long GET_L2CC_CTRL_CPU(unsigned long cpu){
-+ if(cpu == smp_processor_id())
-+ return L2C_R_REG(L2CC_CTRL_OFF);
-+ return L2C_R_REG(L2CC_CTRL_OFF+(cpu<<8));
-+}
-+
-+static inline void SET_L2CC_CTRL_CPU(unsigned long cpu , unsigned long val){
-+ if(cpu == smp_processor_id())
-+ L2C_W_REG(L2CC_CTRL_OFF,val);
-+ else
-+ L2C_W_REG(L2CC_CTRL_OFF+(cpu<<8),val);
-+}
-+
-+static inline unsigned long GET_L2CC_STATUS_CPU(unsigned long cpu){
-+ if(cpu == smp_processor_id())
-+ return L2C_R_REG(L2_CCTL_STATUS_OFF);
-+ return L2C_R_REG(L2_CCTL_STATUS_OFF+(cpu<<8));
-+}
-+
-+#endif
-+
-+#endif //L2_CACHE_H
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/leds.h linux-3.4.113/arch/nds32/include/asm/leds.h
---- linux-3.4.113.orig/arch/nds32/include/asm/leds.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/leds.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,51 @@
-+/*
-+ * linux/arch/nds32/include/asm/leds.h
-+ *
-+ * Copyright (C) 1998 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Event-driven interface for LEDs on machines
-+ * Added led_start and led_stop- Alex Holden, 28th Dec 1998.
-+ */
-+#ifndef ASM_NDS32_LEDS_H
-+#define ASM_NDS32_LEDS_H
-+
-+
-+typedef enum {
-+ led_idle_start,
-+ led_idle_end,
-+ led_timer,
-+ led_start,
-+ led_stop,
-+ led_claim, /* override idle & timer leds */
-+ led_release, /* restore idle & timer leds */
-+ led_start_timer_mode,
-+ led_stop_timer_mode,
-+ led_green_on,
-+ led_green_off,
-+ led_amber_on,
-+ led_amber_off,
-+ led_red_on,
-+ led_red_off,
-+ led_blue_on,
-+ led_blue_off,
-+ /*
-+ * I want this between led_timer and led_start, but
-+ * someone has decided to export this to user space
-+ */
-+ led_halted
-+} led_event_t;
-+
-+/* Use this routine to handle LEDs */
-+
-+#ifdef CONFIG_LEDS
-+extern void (*leds_event)(led_event_t);
-+#else
-+#define leds_event(e)
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/limits.h linux-3.4.113/arch/nds32/include/asm/limits.h
---- linux-3.4.113.orig/arch/nds32/include/asm/limits.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/limits.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,16 @@
-+/*
-+ * linux/arch/nds32/include/asm/limits.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_PIPE_H
-+#define __ASM_PIPE_H
-+
-+#ifndef PAGE_SIZE
-+#include <asm/page.h>
-+#endif
-+
-+#define PIPE_BUF PAGE_SIZE
-+
-+#endif
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/linkage.h linux-3.4.113/arch/nds32/include/asm/linkage.h
---- linux-3.4.113.orig/arch/nds32/include/asm/linkage.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/linkage.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,12 @@
-+/*
-+ * linux/arch/nds32/include/asm/linkage.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_LINKAGE_H__
-+#define __NDS32_LINKAGE_H__
-+
-+#define __ALIGN .align 2
-+#define __ALIGN_STR ".align 2"
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/local.h linux-3.4.113/arch/nds32/include/asm/local.h
---- linux-3.4.113.orig/arch/nds32/include/asm/local.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/local.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/local.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_LOCAL_H__
-+#define __NDS32_LOCAL_H__
-+
-+#include <asm-generic/local.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/arch.h linux-3.4.113/arch/nds32/include/asm/mach/arch.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/arch.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/arch.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,86 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/arch.h
-+ *
-+ * Copyright (C) 2000 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#ifndef __ASSEMBLY__
-+
-+struct tag;
-+struct meminfo;
-+struct sys_timer;
-+
-+struct machine_desc {
-+ /*
-+ * Note! The first four elements are used
-+ * by assembler code in head-armv.S
-+ */
-+ unsigned int nr; /* architecture number */
-+
-+ const char *name; /* architecture name */
-+ unsigned int param_offset; /* parameter page */
-+
-+ unsigned int video_start; /* start of video RAM */
-+ unsigned int video_end; /* end of video RAM */
-+
-+ unsigned int reserve_lp0 :1; /* never has lp0 */
-+ unsigned int reserve_lp1 :1; /* never has lp1 */
-+ unsigned int reserve_lp2 :1; /* never has lp2 */
-+ unsigned int soft_reboot :1; /* soft reboot */
-+ void (*fixup)(struct machine_desc *,
-+ struct tag *, char **,
-+ struct meminfo *);
-+ void (*map_io)(void);/* IO mapping function */
-+ void (*init_irq)(void);
-+ struct sys_timer *timer; /* system tick timer */
-+ void (*init_machine)(void);
-+};
-+
-+/*
-+ * * Current machine - only accessible during boot.
-+ * */
-+extern struct machine_desc *machine_desc;
-+
-+/*
-+ * Set of macros to define architecture features. This is built into
-+ * a table by the linker.
-+ */
-+#define MACHINE_START(_type,_name) \
-+const struct machine_desc __mach_desc_##_type \
-+ __attribute__((__section__(".arch.info"))) = { \
-+ .nr = MACH_TYPE_##_type, \
-+ .name = _name,
-+
-+#define MAINTAINER(n)
-+
-+#define BOOT_PARAMS(_params) \
-+ .param_offset = _params,
-+
-+#define VIDEO(_start,_end) \
-+ .video_start = _start, \
-+ .video_end = _end,
-+
-+#define DISABLE_PARPORT(_n) \
-+ .reserve_lp##_n = 1,
-+
-+#define SOFT_REBOOT \
-+ .soft_reboot = 1,
-+
-+#define MAPIO(_func) \
-+ .map_io = _func,
-+
-+#define INITIRQ(_func) \
-+ .init_irq = _func,
-+
-+#define INIT_MACHINE(_func) \
-+ .init_machine = _func,
-+
-+#define MACHINE_END \
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/dma.h linux-3.4.113/arch/nds32/include/asm/mach/dma.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/dma.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/dma.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,56 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/dma.h
-+ *
-+ * Copyright (C) 1998-2000 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * This header file describes the interface between the generic DMA handler
-+ * (dma.c) and the architecture-specific DMA backends (dma-*.c)
-+ */
-+
-+struct dma_struct;
-+typedef struct dma_struct dma_t;
-+
-+struct dma_ops {
-+ int (*request)(dmach_t, dma_t *); /* optional */
-+ void (*free)(dmach_t, dma_t *); /* optional */
-+ void (*enable)(dmach_t, dma_t *); /* mandatory */
-+ void (*disable)(dmach_t, dma_t *); /* mandatory */
-+ int (*residue)(dmach_t, dma_t *); /* optional */
-+ int (*setspeed)(dmach_t, dma_t *, int); /* optional */
-+ char *type;
-+};
-+
-+struct dma_struct {
-+ struct scatterlist buf; /* single DMA */
-+ int sgcount; /* number of DMA SG */
-+ struct scatterlist *sg; /* DMA Scatter-Gather List */
-+
-+ unsigned int active:1; /* Transfer active */
-+ unsigned int invalid:1; /* Address/Count changed */
-+ unsigned int using_sg:1; /* using scatter list? */
-+ dmamode_t dma_mode; /* DMA mode */
-+ int speed; /* DMA speed */
-+
-+ unsigned int lock; /* Device is allocated */
-+ const char *device_id; /* Device name */
-+
-+ unsigned int dma_base; /* Controller base address */
-+ int dma_irq; /* Controller IRQ */
-+ struct scatterlist cur_sg; /* Current controller buffer */
-+ unsigned int state;
-+
-+ struct dma_ops *d_ops;
-+};
-+
-+/* Prototype: void arch_dma_init(dma)
-+ * Purpose : Initialise architecture specific DMA
-+ * Params : dma - pointer to array of DMA structures
-+ */
-+extern void arch_dma_init(dma_t *dma);
-+
-+extern void isa_init_dma(dma_t *dma);
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/flash.h linux-3.4.113/arch/nds32/include/asm/mach/flash.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/flash.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/flash.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,35 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/flash.h
-+ *
-+ * Copyright (C) 2003 Russell King, All Rights Reserved.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef ASMNDS32_MACH_FLASH_H
-+#define ASMNDS32_MACH_FLASH_H
-+
-+struct mtd_partition;
-+
-+/*
-+ * map_name: the map probe function name
-+ * width: width of mapped device
-+ * init: method called at driver/device initialisation
-+ * exit: method called at driver/device removal
-+ * set_vpp: method called to enable or disable VPP
-+ * parts: optional array of mtd_partitions for static partitioning
-+ * nr_parts: number of mtd_partitions for static partitoning
-+ */
-+struct flash_platform_data {
-+ const char *map_name;
-+ unsigned int width;
-+ int (*init)(void);
-+ void (*exit)(void);
-+ void (*set_vpp)(int on);
-+ struct mtd_partition *parts;
-+ unsigned int nr_parts;
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/irda.h linux-3.4.113/arch/nds32/include/asm/mach/irda.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/irda.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/irda.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,21 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/irda.h
-+ *
-+ * Copyright (C) 2004 Russell King.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_NDS32_MACH_IRDA_H
-+#define __ASM_NDS32_MACH_IRDA_H
-+
-+struct irda_platform_data {
-+ int (*startup)(struct device *);
-+ void (*shutdown)(struct device *);
-+ int (*set_power)(struct device *, unsigned int state);
-+ void (*set_speed)(struct device *, unsigned int speed);
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/map.h linux-3.4.113/arch/nds32/include/asm/mach/map.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/map.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/map.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,37 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/map.h
-+ *
-+ * Copyright (C) 1999-2000 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Page table mapping constructs and function prototypes
-+ */
-+struct map_desc {
-+ unsigned long virtual;
-+ unsigned long physical;
-+ unsigned long length;
-+ unsigned int type;
-+};
-+
-+struct meminfo;
-+
-+#define MT_DEVICE_NCB MT_DEVICE
-+#define MT_DEVICE_NCNB MT_DEVICE
-+#define MT_DEVICE 0
-+#define MT_CACHECLEAN 1
-+#define MT_MINICLEAN 2
-+#define MT_CACHE_L1 3
-+#define MT_UXKRWX_V1 4
-+#define MT_UXKRWX_V2 5
-+#define MT_MEMORY 6
-+#define MT_ROM 7
-+#define MT_ILM 8
-+#define MT_DLM 9
-+
-+extern void create_memmap_holes(struct meminfo *);
-+extern void iotable_init(struct map_desc *, int);
-+extern void setup_io_desc(void);
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/mmc.h linux-3.4.113/arch/nds32/include/asm/mach/mmc.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/mmc.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/mmc.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,16 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/mmc.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+#ifndef ASMNDS32_MACH_MMC_H
-+#define ASMNDS32_MACH_MMC_H
-+
-+#include <linux/mmc/protocol.h>
-+
-+struct mmc_platform_data {
-+ unsigned int ocr_mask; /* available voltages */
-+ u32 (*translate_vdd)(struct device *, unsigned int);
-+ unsigned int (*status)(struct device *);
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/pci.h linux-3.4.113/arch/nds32/include/asm/mach/pci.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/pci.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/pci.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,76 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/pci.h
-+ *
-+ * Copyright (C) 2000 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+struct pci_sys_data;
-+struct pci_bus;
-+
-+struct hw_pci {
-+ struct list_head buses;
-+ int nr_controllers;
-+ int (*setup)(int nr, struct pci_sys_data *);
-+ struct pci_bus *(*scan)(int nr, struct pci_sys_data *);
-+ void (*preinit)(void);
-+ void (*postinit)(void);
-+ u8 (*swizzle)(struct pci_dev *dev, u8 *pin);
-+ int (*map_irq)(struct pci_dev *dev, u8 slot, u8 pin);
-+};
-+
-+/*
-+ * Per-controller structure
-+ */
-+struct pci_sys_data {
-+ struct list_head node;
-+ int busnr; /* primary bus number */
-+ unsigned long mem_offset; /* bus->cpu memory mapping offset */
-+ unsigned long io_offset; /* bus->cpu IO mapping offset */
-+ struct pci_bus *bus; /* PCI bus */
-+ struct resource *resource[3]; /* Primary PCI bus resources */
-+ /* Bridge swizzling */
-+ u8 (*swizzle)(struct pci_dev *, u8 *);
-+ /* IRQ mapping */
-+ int (*map_irq)(struct pci_dev *, u8, u8);
-+ struct hw_pci *hw;
-+};
-+
-+/*
-+ * This is the standard PCI-PCI bridge swizzling algorithm.
-+ */
-+u8 pci_std_swizzle(struct pci_dev *dev, u8 *pinp);
-+
-+/*
-+ * Call this with your hw_pci struct to initialise the PCI system.
-+ */
-+void pci_common_init(struct hw_pci *);
-+
-+/*
-+ * PCI controllers
-+ */
-+extern int iop321_setup(int nr, struct pci_sys_data *);
-+extern struct pci_bus *iop321_scan_bus(int nr, struct pci_sys_data *);
-+extern void iop321_init(void);
-+
-+extern int iop331_setup(int nr, struct pci_sys_data *);
-+extern struct pci_bus *iop331_scan_bus(int nr, struct pci_sys_data *);
-+extern void iop331_init(void);
-+
-+extern int dc21285_setup(int nr, struct pci_sys_data *);
-+extern struct pci_bus *dc21285_scan_bus(int nr, struct pci_sys_data *);
-+extern void dc21285_preinit(void);
-+extern void dc21285_postinit(void);
-+
-+extern int via82c505_setup(int nr, struct pci_sys_data *);
-+extern struct pci_bus *via82c505_scan_bus(int nr, struct pci_sys_data *);
-+extern void via82c505_init(void *sysdata);
-+
-+extern int pci_v3_setup(int nr, struct pci_sys_data *);
-+extern struct pci_bus *pci_v3_scan_bus(int nr, struct pci_sys_data *);
-+extern void pci_v3_preinit(void);
-+extern void pci_v3_postinit(void);
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/serial_sa1100.h linux-3.4.113/arch/nds32/include/asm/mach/serial_sa1100.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/serial_sa1100.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/serial_sa1100.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,31 @@
-+/*
-+ * linux/include/asm-arm/mach/serial_sa1100.h
-+ *
-+ * Author: Nicolas Pitre
-+ *
-+ * Moved to include/asm-arm/mach and changed lots, Russell King
-+ *
-+ * Low level machine dependent UART functions.
-+ */
-+
-+struct uart_port;
-+struct uart_info;
-+
-+/*
-+ * This is a temporary structure for registering these
-+ * functions; it is intended to be discarded after boot.
-+ */
-+struct sa1100_port_fns {
-+ void (*set_mctrl)(struct uart_port *, u_int);
-+ u_int (*get_mctrl)(struct uart_port *);
-+ void (*pm)(struct uart_port *, u_int, u_int);
-+ int (*set_wake)(struct uart_port *, u_int);
-+};
-+
-+#ifdef CONFIG_SERIAL_SA1100
-+void sa1100_register_uart_fns(struct sa1100_port_fns *fns);
-+void sa1100_register_uart(int idx, int port);
-+#else
-+#define sa1100_register_uart_fns(fns) do { } while (0)
-+#define sa1100_register_uart(idx,port) do { } while (0)
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach/time.h linux-3.4.113/arch/nds32/include/asm/mach/time.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach/time.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach/time.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,62 @@
-+/*
-+ * linux/arch/nds32/include/asm/mach/time.h
-+ *
-+ * Copyright (C) 2004 MontaVista Software, Inc.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_NDS32_MACH_TIME_H
-+#define __ASM_NDS32_MACH_TIME_H
-+
-+//#include <linux/sysdev.h>
-+
-+/*
-+ * This is our kernel timer structure.
-+ *
-+ * - init
-+ * Initialise the kernels jiffy timer source, claim interrupt
-+ * using setup_irq. This is called early on during initialisation
-+ * while interrupts are still disabled on the local CPU.
-+ * - suspend
-+ * Suspend the kernel jiffy timer source, if necessary. This
-+ * is called with interrupts disabled, after all normal devices
-+ * have been suspended. If no action is required, set this to
-+ * NULL.
-+ * - resume
-+ * Resume the kernel jiffy timer source, if necessary. This
-+ * is called with interrupts disabled before any normal devices
-+ * are resumed. If no action is required, set this to NULL.
-+ * - offset
-+ * Return the timer offset in microseconds since the last timer
-+ * interrupt. Note: this must take account of any unprocessed
-+ * timer interrupt which may be pending.
-+ */
-+
-+/* + Tom from newlib
-+ * Have the 32 bit jiffies value wrap 5 minutes after boot
-+ * so jiffies wrap bugs show up earlier.
-+ */
-+//#define INITIAL_JIFFIES ((unsigned long)(unsigned int) (-300*HZ))
-+
-+struct sys_timer {
-+// struct sys_device dev;
-+ void (*init)(void);
-+ void (*suspend)(void);
-+ void (*resume)(void);
-+ unsigned long (*offset)(void);
-+};
-+
-+extern struct sys_timer *system_timer;
-+extern void timer_tick( void);
-+
-+/*
-+ * Kernel time keeping support.
-+ */
-+extern int (*set_rtc)(void);
-+extern void save_time_delta(struct timespec *delta, struct timespec *rtc);
-+extern void restore_time_delta(struct timespec *delta, struct timespec *rtc);
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mach-types.h linux-3.4.113/arch/nds32/include/asm/mach-types.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mach-types.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mach-types.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,14 @@
-+#ifndef __ASSEMBLY__
-+/* The type of machine we're running on */
-+extern unsigned int __machine_arch_type;
-+#endif
-+
-+#define MACH_TYPE_FARADAY 758
-+
-+# ifdef machine_arch_type
-+# undef machine_arch_type
-+# define machine_arch_type __machine_arch_type
-+# else
-+# define machine_arch_type MACH_TYPE_FARADAY
-+# endif
-+# define machine_is_faraday() (machine_arch_type == MACH_TYPE_FARADAY)
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/memory.h linux-3.4.113/arch/nds32/include/asm/memory.h
---- linux-3.4.113.orig/arch/nds32/include/asm/memory.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/memory.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,218 @@
-+/*
-+ * linux/arch/nds32/include/asm/memory.h
-+ *
-+ * Copyright (C) 2000-2002 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Note: this file should not be included by non-asm/.h files
-+ */
-+#ifndef __ASM_NDS32_MEMORY_H
-+#define __ASM_NDS32_MEMORY_H
-+
-+#include <linux/compiler.h>
-+#ifndef __FARADAY_PLATFORM_INDEPENDENT_MEMORY_HEADER__
-+#define __FARADAY_PLATFORM_INDEPENDENT_MEMORY_HEADER__
-+
-+#include <asm/spec.h>
-+
-+#ifndef __ASSEMBLY__
-+#include <asm/page.h>
-+#endif
-+
-+#ifndef PHYS_OFFSET
-+#define PHYS_OFFSET CPU_MEM_PA_BASE
-+#endif
-+
-+#ifndef PAGE_OFFSET
-+#define PAGE_OFFSET (0xC0000000)
-+#endif
-+
-+#ifndef END_MEM
-+#define END_MEM (CPU_MEM_PA_LIMIT)
-+#endif
-+
-+#ifndef __virt_to_bus
-+#define __virt_to_bus __virt_to_phys
-+#endif
-+
-+#ifndef __bus_to_virt
-+#define __bus_to_virt __phys_to_virt
-+#endif
-+
-+#endif /* __FARADAY_PLATFORM_INDEPENDENT_MEMORY_HEADER__ */
-+
-+#ifndef TASK_SIZE
-+/*
-+ * TASK_SIZE - the maximum size of a user space task.
-+ * TASK_UNMAPPED_BASE - the lower boundary of the mmap VM area
-+ */
-+#define TASK_SIZE (0xbf000000UL)
-+#define TASK_UNMAPPED_BASE (0x40000000UL)
-+#endif
-+
-+/*
-+ * Page offset: 3GB
-+ */
-+#ifndef PAGE_OFFSET
-+#define PAGE_OFFSET (0xc0000000)
-+#endif
-+
-+/*
-+ * Physical vs virtual RAM address space conversion. These are
-+ * private definitions which should NOT be used outside memory.h
-+ * files. Use virt_to_phys/phys_to_virt/__pa/__va instead.
-+ */
-+#ifndef __virt_to_phys
-+#define __virt_to_phys(x) ((x) - PAGE_OFFSET + PHYS_OFFSET)
-+#define __phys_to_virt(x) ((x) - PHYS_OFFSET + PAGE_OFFSET)
-+#endif
-+
-+/*
-+ * The module space lives between the addresses given by TASK_SIZE
-+ * and PAGE_OFFSET - it must be within 32MB of the kernel text.
-+ */
-+#define MODULES_END (PAGE_OFFSET)
-+#define MODULES_VADDR (MODULES_END - 16*1048576)
-+
-+#if TASK_SIZE > MODULES_VADDR
-+#error Top of user space clashes with start of module space
-+#endif
-+
-+#ifndef __ASSEMBLY__
-+
-+/*
-+ * The DMA mask corresponding to the maximum bus address allocatable
-+ * using GFP_DMA. The default here places no restriction on DMA
-+ * allocations. This must be the smallest DMA mask in the system,
-+ * so a successful GFP_DMA allocation will always satisfy this.
-+ */
-+#ifndef ISA_DMA_THRESHOLD
-+#define ISA_DMA_THRESHOLD (0xffffffffULL)
-+#endif
-+
-+#ifndef arch_adjust_zones
-+#define arch_adjust_zones(node,size,holes) do { } while (0)
-+#endif
-+
-+/*
-+ * PFNs are used to describe any physical page; this means
-+ * PFN 0 == physical address 0.
-+ *
-+ * This is the PFN of the first RAM page in the kernel
-+ * direct-mapped view. We assume this is the first page
-+ * of RAM in the mem_map as well.
-+ */
-+#define PHYS_PFN_OFFSET (PHYS_OFFSET >> PAGE_SHIFT)
-+
-+/*
-+ * These are *only* valid on the kernel direct mapped RAM memory.
-+ * Note: Drivers should NOT use these. They are the wrong
-+ * translation for translating DMA addresses. Use the driver
-+ * DMA support - see dma-mapping.h.
-+ */
-+static inline unsigned long virt_to_phys(void *x)
-+{
-+ return __virt_to_phys((unsigned long)(x));
-+}
-+
-+static inline void *phys_to_virt(unsigned long x)
-+{
-+ return (void *)(__phys_to_virt((unsigned long)(x)));
-+}
-+
-+/*
-+ * Drivers should NOT use these either.
-+ */
-+#define __pa(x) __virt_to_phys((unsigned long)(x))
-+#define __va(x) ((void *)__phys_to_virt((unsigned long)(x)))
-+
-+/*
-+ * Virtual <-> DMA view memory address translations
-+ * Again, these are *only* valid on the kernel direct mapped RAM
-+ * memory. Use of these is *deprecated* (and that doesn't mean
-+ * use the __ prefixed forms instead.) See dma-mapping.h.
-+ */
-+static inline __deprecated unsigned long virt_to_bus(void *x)
-+{
-+ return __virt_to_bus((unsigned long)x);
-+}
-+
-+static inline __deprecated void *bus_to_virt(unsigned long x)
-+{
-+ return (void *)__bus_to_virt(x);
-+}
-+
-+/*
-+ * Conversion between a struct page and a physical address.
-+ *
-+ * Note: when converting an unknown physical address to a
-+ * struct page, the resulting pointer must be validated
-+ * using VALID_PAGE(). It must return an invalid struct page
-+ * for any physical address not corresponding to a system
-+ * RAM address.
-+ *
-+ * pfn_valid(pfn) indicates whether a PFN number is valid
-+ *
-+ * virt_to_page(k) convert a _valid_ virtual address to struct page *
-+ * virt_addr_valid(k) indicates whether a virtual address is valid
-+ */
-+#ifndef CONFIG_DISCONTIGMEM
-+
-+#define ARCH_PFN_OFFSET PHYS_PFN_OFFSET
-+#define pfn_valid(pfn) ((pfn) >= PHYS_PFN_OFFSET && (pfn) < (PHYS_PFN_OFFSET + max_mapnr))
-+
-+#define virt_to_page(kaddr) (pfn_to_page(__pa(kaddr) >> PAGE_SHIFT))
-+#define virt_addr_valid(kaddr) ((unsigned long)(kaddr) >= PAGE_OFFSET && (unsigned long)(kaddr) < (unsigned long)high_memory)
-+
-+#define PHYS_TO_NID(addr) (0)
-+
-+#else /* CONFIG_DISCONTIGMEM */
-+
-+/*
-+ * This is more complex. We have a set of mem_map arrays spread
-+ * around in memory.
-+ */
-+#include <linux/numa.h>
-+
-+#define pfn_valid(pfn) (PFN_TO_NID(pfn) < MAX_NUMNODES)
-+
-+#define virt_to_page(kaddr) \
-+ (ADDR_TO_MAPBASE(kaddr) + LOCAL_MAP_NR(kaddr))
-+#define virt_addr_valid(kaddr) (KVADDR_TO_NID(kaddr) < MAX_NUMNODES)
-+
-+/*
-+ * Common discontigmem stuff.
-+ * PHYS_TO_NID is used by the NDS32 kernel/setup.c
-+ */
-+#define PHYS_TO_NID(addr) PFN_TO_NID((addr) >> PAGE_SHIFT)
-+
-+#endif /* !CONFIG_DISCONTIGMEM */
-+
-+/*
-+ * For BIO. "will die". Kill me when bio_to_phys() and bvec_to_phys() die.
-+ */
-+#define page_to_phys(page) (page_to_pfn(page) << PAGE_SHIFT)
-+
-+/*
-+ * Optional device DMA address remapping. Do _not_ use directly!
-+ * We should really eliminate virt_to_bus() here - it's deprecated.
-+ */
-+#ifndef __arch_page_to_dma
-+#define page_to_dma(dev, page) ((dma_addr_t)__virt_to_bus((unsigned long)page_address(page)))
-+#define dma_to_virt(dev, addr) ((void *)__bus_to_virt(addr))
-+#define virt_to_dma(dev, addr) ((dma_addr_t)__virt_to_bus((unsigned long)(addr)))
-+#else
-+#define page_to_dma(dev, page) (__arch_page_to_dma(dev, page))
-+#define dma_to_virt(dev, addr) (__arch_dma_to_virt(dev, addr))
-+#define virt_to_dma(dev, addr) (__arch_virt_to_dma(dev, addr))
-+#endif
-+
-+#endif
-+
-+#include <asm-generic/memory_model.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/misc_spec.h linux-3.4.113/arch/nds32/include/asm/misc_spec.h
---- linux-3.4.113.orig/arch/nds32/include/asm/misc_spec.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/misc_spec.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,75 @@
-+/*
-+ * linux/arch/nds32/include/asm/misc_spec.h
-+ *
-+ * Faraday A320D platform dependent definitions
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/14/2005 Created
-+ * Luke Lee 10/06/2005 Modified for automatic system clock rate
-+ */
-+
-+#ifndef __A320_PLATFORM_MANUAL_DEFINITION__
-+#define __A320_PLATFORM_MANUAL_DEFINITION__
-+
-+#define BOOT_PARAMETER_PA_BASE (PHYS_OFFSET + 0x400)
-+
-+#ifdef CONFIG_AUTO_SYS_CLK
-+
-+#ifndef __ASSEMBLY__
-+extern int ag101_get_ahb_clk(void);
-+extern int ag102_get_ahb_clk(void);
-+
-+#if defined(CONFIG_PLAT_AG101)
-+#define AHB_CLK_IN ag101_get_ahb_clk()
-+#elif defined(CONFIG_PLAT_AG102)
-+#define AHB_CLK_IN ag102_get_ahb_clk()
-+
-+#endif
-+
-+#endif
-+#define TIMER_CLK_IN (CONFIG_SYS_CLK/2)
-+
-+#else
-+
-+/* Timer clock input is APB CLOCK */
-+#define TIMER_CLK_IN (CONFIG_SYS_CLK/2)
-+#define AHB_CLK_IN (CONFIG_SYS_CLK)
-+
-+#endif
-+
-+#ifndef __ASSEMBLY__
-+#include <linux/init.h>
-+
-+#ifdef CONFIG_PLATFORM_INTC
-+extern void __init intc_ftintc010_init_irq(void);
-+#define platform_init_irq intc_ftintc010_init_irq
-+#endif
-+
-+#ifdef CONFIG_PLATFORM_NOINTC
-+extern void __init nointc_init_irq(void);
-+#define platform_init_irq nointc_init_irq
-+#endif
-+
-+#endif
-+
-+#define daughter_platform_init_irq(x) /* NOP */
-+
-+#endif /*__A320_PLATFORM_MANUAL_DEFINITION__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mman.h linux-3.4.113/arch/nds32/include/asm/mman.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mman.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mman.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,22 @@
-+/*
-+ * linux/arch/nds32/include/asm/mman.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_MMAN_H__
-+#define __NDS32_MMAN_H__
-+
-+#include <asm-generic/mman.h>
-+
-+#define MAP_GROWSDOWN 0x0100 /* stack-like segment */
-+#define MAP_DENYWRITE 0x0800 /* ETXTBSY */
-+#define MAP_EXECUTABLE 0x1000 /* mark it as an executable */
-+#define MAP_LOCKED 0x2000 /* pages are locked */
-+#define MAP_NORESERVE 0x4000 /* don't check for reservations */
-+#define MAP_POPULATE 0x8000 /* populate (prefault) page tables */
-+#define MAP_NONBLOCK 0x10000 /* do not block on IO */
-+
-+#define MCL_CURRENT 1 /* lock all current mappings */
-+#define MCL_FUTURE 2 /* lock all future mappings */
-+
-+#endif /* __NDS32_MMAN_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mmu_context.h linux-3.4.113/arch/nds32/include/asm/mmu_context.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mmu_context.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mmu_context.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,84 @@
-+/*
-+ * linux/arch/nds32/include/asm/mmu_context.h
-+ *
-+ * Copyright (C) 1996 Russell King.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Changelog:
-+ * 27-06-1996 RMK Created
-+ */
-+#ifndef __ASM_NDS32_MMU_CONTEXT_H
-+#define __ASM_NDS32_MMU_CONTEXT_H
-+
-+#include <linux/spinlock.h>
-+#include <asm/tlbflush.h>
-+#include <asm-generic/mm_hooks.h>
-+
-+static inline int
-+init_new_context(struct task_struct *tsk, struct mm_struct *mm)
-+{
-+ mm->context.id = 0;
-+ return 0;
-+}
-+
-+#define destroy_context(mm) do { } while(0)
-+
-+#ifndef CONFIG_CPU_NO_CONTEXT_ID
-+#define CID_BITS 9
-+extern spinlock_t cid_lock;
-+extern unsigned int cpu_last_cid;
-+
-+static inline void
-+__new_context(struct mm_struct *mm)
-+{
-+ unsigned int cid;
-+ unsigned long flags;
-+
-+ spin_lock_irqsave(&cid_lock, flags);
-+ cid = cpu_last_cid;
-+ cpu_last_cid += 1 << TLB_MISC_offCID;
-+ if (cpu_last_cid == 0)
-+ cpu_last_cid = 1 << TLB_MISC_offCID << CID_BITS;
-+ spin_unlock_irqrestore(&cid_lock, flags);
-+
-+ if ((cid & TLB_MISC_mskCID ) == 0)
-+ flush_tlb_all();
-+
-+ mm->context.id = cid;
-+}
-+
-+static inline void
-+check_context(struct mm_struct *mm)
-+{
-+ if (unlikely((mm->context.id ^ cpu_last_cid) >> TLB_MISC_offCID >> CID_BITS))
-+ __new_context(mm);
-+}
-+#else
-+#define check_context(m)
-+#endif
-+
-+static inline void
-+enter_lazy_tlb(struct mm_struct *mm, struct task_struct *tsk)
-+{
-+}
-+
-+static inline void
-+switch_mm(struct mm_struct *prev, struct mm_struct *next,
-+ struct task_struct *tsk)
-+{
-+ unsigned int cpu = smp_processor_id();
-+
-+ if (!cpumask_test_and_set_cpu(cpu, mm_cpumask(next)) || prev != next) {
-+ check_context(next);
-+ cpu_switch_mm(next);
-+ }
-+}
-+
-+#define deactivate_mm(tsk,mm) do { } while (0)
-+#define activate_mm(prev,next) switch_mm(prev, next, NULL)
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mmu.h linux-3.4.113/arch/nds32/include/asm/mmu.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mmu.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mmu.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,42 @@
-+/*
-+ * linux/arch/nds32/include/asm/mmu.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_MMU_H
-+#define __NDS32_MMU_H
-+
-+typedef struct {
-+ unsigned int id;
-+} mm_context_t;
-+
-+#define ASID(mm) ((mm)->context.id & (TLB_MISC_mskCID >> TLB_MISC_offCID))
-+inline static unsigned long ACC_PSZ(unsigned long page_size)
-+{
-+ switch(page_size) {
-+ case(1<<12):
-+ return 0;
-+ case(1<<13):
-+ return 1;
-+ case(1<<14):
-+ return 2;
-+ case(1<<16):
-+ return 3;
-+ case(1<<18):
-+ return 4;
-+ case(1<<20):
-+ return 5;
-+ case(1<<22):
-+ return 6;
-+ case(1<<24):
-+ return 7;
-+ case(1<<26):
-+ return 8;
-+ case(1<<28):
-+ return 9;
-+ default:
-+ printk("Huge Page Size is not supported \n");
-+ return 0xffffffff;
-+ }
-+}
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/module.h linux-3.4.113/arch/nds32/include/asm/module.h
---- linux-3.4.113.orig/arch/nds32/include/asm/module.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/module.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,23 @@
-+/*
-+ * linux/arch/nds32/include/asm/module.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASM_NDS32_MODULE_H
-+#define _ASM_NDS32_MODULE_H
-+
-+struct mod_arch_specific
-+{
-+ int foo;
-+};
-+
-+#define Elf_Shdr Elf32_Shdr
-+#define Elf_Sym Elf32_Sym
-+#define Elf_Ehdr Elf32_Ehdr
-+
-+/*
-+ * Include the ARM architecture version.
-+ */
-+#define MODULE_ARCH_VERMAGIC "NDS32vN10" __stringify(__LINUX_NDS32_ARCH__) " "
-+
-+#endif /* _ASM_NDS32_MODULE_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/msgbuf.h linux-3.4.113/arch/nds32/include/asm/msgbuf.h
---- linux-3.4.113.orig/arch/nds32/include/asm/msgbuf.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/msgbuf.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,36 @@
-+/*
-+ * linux/arch/nds32/include/asm/msgbuf.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_MSGBUF_H
-+#define _ASMNDS32_MSGBUF_H
-+
-+/*
-+ * The msqid64_ds structure for arm architecture.
-+ * Note extra padding because this structure is passed back and forth
-+ * between kernel and user space.
-+ *
-+ * Pad space is left for:
-+ * - 64-bit time_t to solve y2038 problem
-+ * - 2 miscellaneous 32-bit values
-+ */
-+
-+struct msqid64_ds {
-+ struct ipc64_perm msg_perm;
-+ __kernel_time_t msg_stime; /* last msgsnd time */
-+ unsigned long __unused1;
-+ __kernel_time_t msg_rtime; /* last msgrcv time */
-+ unsigned long __unused2;
-+ __kernel_time_t msg_ctime; /* last change time */
-+ unsigned long __unused3;
-+ unsigned long msg_cbytes; /* current number of bytes on queue */
-+ unsigned long msg_qnum; /* number of messages in queue */
-+ unsigned long msg_qbytes; /* max number of bytes on queue */
-+ __kernel_pid_t msg_lspid; /* pid of last msgsnd */
-+ __kernel_pid_t msg_lrpid; /* last receive pid */
-+ unsigned long __unused4;
-+ unsigned long __unused5;
-+};
-+
-+#endif /* _ASMNDS32_MSGBUF_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/mutex.h linux-3.4.113/arch/nds32/include/asm/mutex.h
---- linux-3.4.113.orig/arch/nds32/include/asm/mutex.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/mutex.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/mutex.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_MUTEX_H__
-+#define __NDS32_MUTEX_H__
-+
-+#include <asm-generic/mutex-dec.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/namei.h linux-3.4.113/arch/nds32/include/asm/namei.h
---- linux-3.4.113.orig/arch/nds32/include/asm/namei.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/namei.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/namei.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_NAMEI_H__
-+#define __NDS32_NAMEI_H__
-+
-+#define __emul_prefix() NULL
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/nds32.h linux-3.4.113/arch/nds32/include/asm/nds32.h
---- linux-3.4.113.orig/arch/nds32/include/asm/nds32.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/nds32.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,90 @@
-+/*
-+ * linux/arch/nds32/include/asm/nds32.h -- Andes NDS32 processor register interface
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 2006 Andes Technology Corporation
-+ *
-+ */
-+#ifndef _ASM_NDS32_NDS32_H_
-+#define _ASM_NDS32_NDS32_H_
-+
-+#include <asm/bitfield.h>
-+#include <asm/reg_access.h>
-+
-+#define MSYNC( subtype) __asm__ ("\n\tmsync "#subtype);
-+#define STANDBY( cond) __asm__ ("\n\tstandby "#cond);
-+
-+#ifndef __ASSEMBLY__
-+
-+static inline void ISB( void) { __asm__ ("\n\tisb"); }
-+static inline void DSB( void) { __asm__ ("\n\tdsb"); }
-+
-+static inline void GIE_ENABLE( void)
-+{
-+ __asm__ ("gie_enable\n\t");
-+}
-+
-+static inline void GIE_DISABLE( void)
-+{
-+ __asm__ ("gie_disable\n\t");
-+}
-+
-+enum cache_t{ ICACHE, DCACHE};
-+
-+static inline unsigned long CACHE_SET( enum cache_t cache){
-+
-+ if( cache == ICACHE)
-+ return 64 << ( ( GET_ICM_CFG() & ICM_CFG_mskISET) >> ICM_CFG_offISET);
-+ else
-+ return 64 << ( ( GET_DCM_CFG() & DCM_CFG_mskDSET) >> DCM_CFG_offDSET);
-+}
-+
-+static inline unsigned long CACHE_WAY( enum cache_t cache){
-+
-+ if( cache == ICACHE)
-+ return 1 + ( ( GET_ICM_CFG() & ICM_CFG_mskIWAY) >> ICM_CFG_offIWAY);
-+ else
-+ return 1 + ( ( GET_DCM_CFG() & DCM_CFG_mskDWAY) >> DCM_CFG_offDWAY);
-+}
-+
-+static inline unsigned long CACHE_LINE_SIZE( enum cache_t cache){
-+
-+ if( cache == ICACHE)
-+ return 8 << ( ( ( GET_ICM_CFG() & ICM_CFG_mskISZ) >> ICM_CFG_offISZ) - 1);
-+ else
-+ return 8 << ( ( ( GET_DCM_CFG() & DCM_CFG_mskDSZ) >> DCM_CFG_offDSZ) - 1);
-+}
-+
-+static inline void GIE_SAVE( unsigned long *var){
-+
-+ *var = GET_PSW();
-+ GIE_DISABLE();
-+}
-+
-+static inline void GIE_RESTORE( unsigned long var){
-+
-+ if( var & PSW_mskGIE){
-+ GIE_ENABLE();
-+ }
-+}
-+
-+#endif /* __ASSEMBLY__ */
-+
-+#define IVB_BASE PHYS_OFFSET /* in user space for intr/exc/trap/break table base, 64KB aligned
-+ * We defined at the start of the physical memory */
-+
-+/* The following dispatching entry */
-+#define ENTRY_TLB_MISC (IVB_BASE + nrTLB_MISC*vENTRY_SZ) /* TLB misc eh# */
-+/* dispatched sub-entry exception handler numbering */
-+#define RD_PROT 0 /* read protrection */
-+#define WRT_PROT 1 /* write protection */
-+#define NOEXEC 2 /* non executable */
-+#define PAGE_MODIFY 3 /* page modified */
-+#define ACC_BIT 4 /* access bit */
-+#define RESVED_PTE 5 /* reserved PTE attribute */
-+/* reserved 6 ~ 16 */
-+
-+#endif /* _ASM_NDS32_NDS32_H_ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/numnodes.h linux-3.4.113/arch/nds32/include/asm/numnodes.h
---- linux-3.4.113.orig/arch/nds32/include/asm/numnodes.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/numnodes.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,25 @@
-+/*
-+ * linux/arch/nds32/include/asm/numnodes.h
-+ *
-+ * Copyright (C) 2002 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+/* This declaration for the size of the NUMA (CONFIG_DISCONTIGMEM)
-+ * memory node table is the default.
-+ *
-+ * A good place to override this value is include/asm/arch/memory.h.
-+ */
-+
-+#ifndef __ASM_NDS32_NUMNODES_H
-+#define __ASM_NDS32_NUMNODES_H
-+
-+#ifndef NODES_SHIFT
-+# define NODES_SHIFT 2 /* Normally, Max 4 Nodes */
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/page.h linux-3.4.113/arch/nds32/include/asm/page.h
---- linux-3.4.113.orig/arch/nds32/include/asm/page.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/page.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,153 @@
-+/*
-+ * linux/arch/nds32/include/asm/page.h
-+ *
-+ * Copyright (C) 1995-2003 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef _ASMNDS32_PAGE_H
-+#define _ASMNDS32_PAGE_H
-+
-+
-+#ifdef CONFIG_ANDES_PAGE_SIZE_4KB
-+#define PAGE_SHIFT 12
-+#endif
-+#ifdef CONFIG_ANDES_PAGE_SIZE_8KB
-+#define PAGE_SHIFT 13
-+#endif
-+#include <linux/const.h>
-+#define PAGE_SIZE (_AC(1,UL) << PAGE_SHIFT)
-+#define PAGE_MASK (~(PAGE_SIZE-1))
-+#define PTE_MASK PAGE_MASK
-+
-+/* PAGE_SHIFT determines the page size */
-+#define EXEC_PAGESIZE PAGE_SIZE
-+
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_16KB
-+#define LARGE_PAGE_SHIFT 14
-+#define HPAGE_SHIFT 14
-+#endif
-+
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_64KB
-+#define LARGE_PAGE_SHIFT 16
-+#define HPAGE_SHIFT 16
-+#endif
-+
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_256KB
-+#define LARGE_PAGE_SHIFT 18
-+#define HPAGE_SHIFT 18
-+#endif
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_1MB
-+#define LARGE_PAGE_SHIFT 20
-+#define HPAGE_SHIFT 20
-+#endif
-+
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_4MB
-+#define LARGE_PAGE_SHIFT 22
-+#define HPAGE_SHIFT 22
-+#endif
-+
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_16MB
-+#define LARGE_PAGE_SHIFT 24
-+#define HPAGE_SHIFT 24
-+#endif
-+
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_64MB
-+#define LARGE_PAGE_SHIFT 26
-+#define HPAGE_SHIFT 26
-+#endif
-+
-+#ifdef CONFIG_ANDES_HUGETLB_PAGE_SIZE_256MB
-+#define LARGE_PAGE_SHIFT 28
-+#define HPAGE_SHIFT 28
-+#endif
-+
-+#ifdef CONFIG_HUGETLB_PAGE
-+// taken for i386 style
-+#define LARGE_PAGE_SIZE (1UL << LARGE_PAGE_SHIFT)
-+#define LARGE_PAGE_MASK (~(LARGE_PAGE_SIZE-1))
-+// taken for SH style
-+#define HPAGE_SIZE (1UL << HPAGE_SHIFT)
-+#define HPAGE_MASK (~(HPAGE_SIZE-1))
-+#define HUGETLB_PAGE_ORDER (HPAGE_SHIFT-PAGE_SHIFT)
-+#endif
-+
-+
-+#ifdef __KERNEL__
-+
-+#ifndef __ASSEMBLY__
-+
-+struct page;
-+struct vm_area_struct;
-+#ifndef CONFIG_CPU_CACHE_NONALIASING
-+extern void copy_user_highpage(struct page *to, struct page *from,
-+ unsigned long vaddr, struct vm_area_struct *vma);
-+extern void clear_user_highpage(struct page *page, unsigned long vaddr);
-+
-+#define __HAVE_ARCH_COPY_USER_HIGHPAGE
-+#define clear_user_highpage clear_user_highpage
-+#else
-+#define clear_user_page(page, vaddr, pg) clear_page(page)
-+#define copy_user_page(to, from, vaddr, pg) copy_page(to, from)
-+#endif
-+
-+void clear_page(void *page);
-+void copy_page(void *to, void *from);
-+
-+#undef STRICT_MM_TYPECHECKS
-+
-+#ifdef STRICT_MM_TYPECHECKS
-+/*
-+ * These are used to make use of C type-checking..
-+ */
-+typedef struct { unsigned long pte; } pte_t;
-+typedef struct { unsigned long pmd; } pmd_t;
-+typedef struct { unsigned long pgd; } pgd_t;
-+typedef struct { unsigned long pgprot; } pgprot_t;
-+
-+#define pte_val(x) ((x).pte)
-+#define pmd_val(x) ((x).pmd)
-+#define pgd_val(x) ((x).pgd)
-+#define pgprot_val(x) ((x).pgprot)
-+
-+#define __pte(x) ((pte_t) { (x) } )
-+#define __pmd(x) ((pmd_t) { (x) } )
-+#define __pgd(x) ((pgd_t) { (x) } )
-+#define __pgprot(x) ((pgprot_t) { (x) } )
-+
-+#else
-+/*
-+ * .. while these make it easier on the compiler
-+ */
-+typedef unsigned long pte_t;
-+typedef unsigned long pmd_t;
-+typedef unsigned long pgd_t;
-+typedef unsigned long pgprot_t;
-+
-+#define pte_val(x) (x)
-+#define pmd_val(x) (x)
-+#define pgd_val(x) (x)
-+#define pgprot_val(x) (x)
-+
-+#define __pte(x) (x)
-+#define __pmd(x) (x)
-+#define __pgd(x) (x)
-+#define __pgprot(x) (x)
-+
-+#endif /* STRICT_MM_TYPECHECKS */
-+typedef struct page *pgtable_t;
-+
-+#include <asm/memory.h>
-+#include <asm-generic/getorder.h>
-+
-+#endif /* !__ASSEMBLY__ */
-+
-+#define VM_DATA_DEFAULT_FLAGS (VM_READ | VM_WRITE | VM_EXEC | \
-+ VM_MAYREAD | VM_MAYWRITE | VM_MAYEXEC)
-+
-+#endif /* __KERNEL__ */
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/param.h linux-3.4.113/arch/nds32/include/asm/param.h
---- linux-3.4.113.orig/arch/nds32/include/asm/param.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/param.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,36 @@
-+/*
-+ * linux/arch/nds32/include/asm/param.h
-+ *
-+ * Copyright (C) 1995-1999 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_PARAM_H
-+#define __ASM_PARAM_H
-+
-+#ifdef __KERNEL__
-+
-+# ifndef HZ
-+# define HZ CONFIG_HZ /* Internal kernel timer frequency */
-+# endif
-+
-+# define USER_HZ HZ /* User interfaces are in "ticks" */
-+# define CLOCKS_PER_SEC (USER_HZ) /* like times() */
-+#else
-+# define HZ 100
-+#endif
-+
-+//#define EXEC_PAGESIZE 4096
-+
-+#ifndef NOGROUP
-+#define NOGROUP (-1)
-+#endif
-+
-+/* max length of hostname */
-+#define MAXHOSTNAMELEN 64
-+
-+#endif
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/parport.h linux-3.4.113/arch/nds32/include/asm/parport.h
---- linux-3.4.113.orig/arch/nds32/include/asm/parport.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/parport.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,19 @@
-+/*
-+ * linux/arch/nds32/include/asm/parport.h: NDS32-specific parport initialisation
-+ *
-+ * Copyright (C) 1999, 2000 Tim Waugh <tim@cyberelk.demon.co.uk>
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This file should only be included by drivers/parport/parport_pc.c.
-+ */
-+
-+#ifndef __ASMNDS32_PARPORT_H
-+#define __ASMNDS32_PARPORT_H
-+
-+static int __devinit parport_pc_find_isa_ports (int autoirq, int autodma);
-+static int __devinit parport_pc_find_nonpci_ports (int autoirq, int autodma)
-+{
-+ return parport_pc_find_isa_ports (autoirq, autodma);
-+}
-+
-+#endif /* !(_ASMNDS32_PARPORT_H) */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/pci.h linux-3.4.113/arch/nds32/include/asm/pci.h
---- linux-3.4.113.orig/arch/nds32/include/asm/pci.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/pci.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,77 @@
-+/*
-+ * linux/arch/nds32/include/asm/pci.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef ASMNDS32_PCI_H
-+#define ASMNDS32_PCI_H
-+
-+#ifdef __KERNEL__
-+#include <asm-generic/pci-dma-compat.h>
-+
-+#include <asm/hardware.h> /* for PCIBIOS_MIN_* */
-+
-+#define pcibios_scan_all_fns(a, b) 0
-+
-+static inline void pcibios_set_master(struct pci_dev *dev)
-+{
-+ /* No special bus mastering setup handling */
-+}
-+
-+static inline void pcibios_penalize_isa_irq(int irq)
-+{
-+ /* We don't do dynamic PCI IRQ allocation */
-+}
-+
-+/*
-+ * The PCI address space does equal the physical memory address space.
-+ * The networking and block device layers use this boolean for bounce
-+ * buffer decisions.
-+ */
-+#define PCI_DMA_BUS_IS_PHYS (0)
-+
-+/*
-+ * Whether pci_unmap_{single,page} is a nop depends upon the
-+ * configuration.
-+ */
-+#define DECLARE_PCI_UNMAP_ADDR(ADDR_NAME) dma_addr_t ADDR_NAME;
-+#define DECLARE_PCI_UNMAP_LEN(LEN_NAME) __u32 LEN_NAME;
-+#define pci_unmap_addr(PTR, ADDR_NAME) ((PTR)->ADDR_NAME)
-+#define pci_unmap_addr_set(PTR, ADDR_NAME, VAL) (((PTR)->ADDR_NAME) = (VAL))
-+#define pci_unmap_len(PTR, LEN_NAME) ((PTR)->LEN_NAME)
-+#define pci_unmap_len_set(PTR, LEN_NAME, VAL) (((PTR)->LEN_NAME) = (VAL))
-+
-+#define HAVE_PCI_MMAP
-+extern int pci_mmap_page_range(struct pci_dev *dev, struct vm_area_struct *vma,
-+ enum pci_mmap_state mmap_state, int write_combine);
-+
-+extern void
-+pcibios_resource_to_bus(struct pci_dev *dev, struct pci_bus_region *region,
-+ struct resource *res);
-+
-+extern void
-+pcibios_bus_to_resource(struct pci_dev *dev, struct resource *res,
-+ struct pci_bus_region *region);
-+
-+static inline struct resource *
-+pcibios_select_root(struct pci_dev *pdev, struct resource *res)
-+{
-+ struct resource *root = NULL;
-+
-+ if (res->flags & IORESOURCE_IO)
-+ root = &ioport_resource;
-+ if (res->flags & IORESOURCE_MEM)
-+ root = &iomem_resource;
-+
-+ return root;
-+}
-+
-+#endif /* __KERNEL__ */
-+
-+/* Chances are this interrupt is wired PC-style ... */
-+static inline int pci_get_legacy_ide_irq(struct pci_dev *dev, int channel)
-+{
-+ return channel ? 15 : 14;
-+}
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/percpu.h linux-3.4.113/arch/nds32/include/asm/percpu.h
---- linux-3.4.113.orig/arch/nds32/include/asm/percpu.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/percpu.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/percpu.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_PERCPU
-+#define __NDS32_PERCPU
-+
-+#include <asm-generic/percpu.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/pfm.h linux-3.4.113/arch/nds32/include/asm/pfm.h
---- linux-3.4.113.orig/arch/nds32/include/asm/pfm.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/pfm.h 2016-12-01 20:59:24.340612287 +0100
-@@ -0,0 +1,16 @@
-+#ifndef __PFM_H_
-+#define __PFM_H_
-+
-+struct pcounter {
-+ unsigned long long pfm0; /* value of $PFMC0 */
-+ unsigned long long pfm1; /* value of $PFMC1 */
-+ unsigned long long pfm2; /* value of $PFMC2 */
-+};
-+
-+#ifdef __KERNEL__
-+void sys_pfmctl(int event0, int event1, int event2, int start);
-+int sys_getpfm(struct pcounter __user *p);
-+int sys_setpfm(int pfm0, int pfm1, int pfm2, struct pcounter __user *p);
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/pgalloc.h linux-3.4.113/arch/nds32/include/asm/pgalloc.h
---- linux-3.4.113.orig/arch/nds32/include/asm/pgalloc.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/pgalloc.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,104 @@
-+/*
-+ * linux/arch/nds32/include/asm/pgalloc.h
-+ *
-+ * Copyright (C) 2000-2001 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef _ASMNDS32_PGALLOC_H
-+#define _ASMNDS32_PGALLOC_H
-+
-+#include <asm/processor.h>
-+#include <asm/cacheflush.h>
-+#include <asm/tlbflush.h>
-+
-+/*
-+ * Since we have only two-level page tables, these are trivial
-+ */
-+#define pmd_alloc_one(mm, addr) ({ BUG(); ((pmd_t *)2); })
-+#define pmd_free(mm, pmd) do { } while (0)
-+#define pgd_populate(mm, pmd, pte) BUG()
-+#define pmd_pgtable(pmd) pmd_page(pmd)
-+
-+extern pgd_t *get_pgd_slow(struct mm_struct *mm);
-+extern void free_pgd_slow(struct mm_struct *mm, pgd_t *pgd);
-+
-+#define pgd_alloc(mm) get_pgd_slow(mm)
-+#define pgd_free(mm, pgd) free_pgd_slow(mm, pgd)
-+
-+#define check_pgt_cache() do { } while (0)
-+
-+static inline pte_t *
-+pte_alloc_one_kernel(struct mm_struct *mm, unsigned long addr)
-+{
-+ pte_t *pte;
-+
-+ pte = (pte_t *)__get_free_page(GFP_KERNEL|__GFP_REPEAT|__GFP_ZERO);
-+
-+ return pte;
-+}
-+
-+static inline pgtable_t
-+pte_alloc_one(struct mm_struct *mm, unsigned long addr)
-+{
-+ pgtable_t pte;
-+
-+ pte = alloc_pages(GFP_KERNEL|__GFP_REPEAT|__GFP_ZERO, 0);
-+ if (pte)
-+ cpu_dcache_wb_page((unsigned long)page_address(pte));
-+
-+ return pte;
-+}
-+
-+/*
-+ * Free one PTE table.
-+ */
-+static inline void pte_free_kernel(struct mm_struct *mm, pte_t *pte)
-+{
-+ if (pte) {
-+ free_page((unsigned long)pte);
-+ }
-+}
-+
-+static inline void pte_free(struct mm_struct *mm, pgtable_t pte)
-+{
-+ __free_page(pte);
-+}
-+
-+/*
-+ * Populate the pmdp entry with a pointer to the pte. This pmd is part
-+ * of the mm address space.
-+ *
-+ * Ensure that we always set both PMD entries.
-+ */
-+static inline void
-+pmd_populate_kernel(struct mm_struct *mm, pmd_t *pmdp, pte_t *ptep)
-+{
-+ unsigned long pte_ptr = (unsigned long)ptep;
-+ unsigned long pmdval;
-+
-+ BUG_ON(mm != &init_mm);
-+
-+ /*
-+ * The pmd must be loaded with the physical
-+ * address of the PTE table
-+ */
-+ pmdval = __pa(pte_ptr) | _PAGE_KERNEL_TABLE;
-+ set_pmd(pmdp, __pmd(pmdval));
-+}
-+
-+static inline void
-+pmd_populate(struct mm_struct *mm, pmd_t *pmdp, pgtable_t ptep)
-+{
-+ unsigned long pmdval;
-+
-+ BUG_ON(mm == &init_mm);
-+
-+ pmdval = page_to_pfn(ptep) << PAGE_SHIFT | _PAGE_USER_TABLE;
-+ set_pmd(pmdp, __pmd(pmdval));
-+}
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/pgtable.h linux-3.4.113/arch/nds32/include/asm/pgtable.h
---- linux-3.4.113.orig/arch/nds32/include/asm/pgtable.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/pgtable.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,429 @@
-+/*
-+ * linux/arch/nds32/include/asm/pgtable.h
-+ *
-+ * Copyright (C) 1995-2002 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef _ASMNDS32_PGTABLE_H
-+#define _ASMNDS32_PGTABLE_H
-+
-+#include <asm-generic/4level-fixup.h>
-+#include <asm-generic/sizes.h>
-+
-+#include <asm/memory.h>
-+#include <asm/vmalloc.h>
-+#include <asm/nds32.h>
-+#ifndef __ASSEMBLY__
-+#include <asm/fixmap.h>
-+#endif
-+
-+#ifdef CONFIG_CACHE_L2
-+#include <asm/l2_cache.h>
-+#endif
-+
-+#ifdef CONFIG_ANDES_PAGE_SIZE_4KB
-+#define PGDIR_SHIFT 22
-+#define PTRS_PER_PGD 1024
-+#define PMD_SHIFT 22
-+#define PTRS_PER_PMD 1
-+#define PTRS_PER_PTE 1024
-+#endif
-+
-+#ifdef CONFIG_ANDES_PAGE_SIZE_8KB
-+#define PGDIR_SHIFT 24
-+#define PTRS_PER_PGD 256
-+#define PMD_SHIFT 24
-+#define PTRS_PER_PMD 1
-+#define PTRS_PER_PTE 2048
-+#endif
-+
-+#ifndef __ASSEMBLY__
-+extern void __pte_error(const char *file, int line, unsigned long val);
-+extern void __pmd_error(const char *file, int line, unsigned long val);
-+extern void __pgd_error(const char *file, int line, unsigned long val);
-+
-+#define pte_ERROR(pte) __pte_error(__FILE__, __LINE__, pte_val(pte))
-+#define pmd_ERROR(pmd) __pmd_error(__FILE__, __LINE__, pmd_val(pmd))
-+#define pgd_ERROR(pgd) __pgd_error(__FILE__, __LINE__, pgd_val(pgd))
-+#endif /* !__ASSEMBLY__ */
-+
-+#define PMD_SIZE (1UL << PMD_SHIFT)
-+#define PMD_MASK (~(PMD_SIZE-1))
-+#define PGDIR_SIZE (1UL << PGDIR_SHIFT)
-+#define PGDIR_MASK (~(PGDIR_SIZE-1))
-+
-+/*
-+ * This is the lowest virtual address we can permit any user space
-+ * mapping to be mapped at. This is particularly important for
-+ * non-high vector CPUs.
-+ */
-+#define FIRST_USER_ADDRESS 0x8000
-+
-+#define VMALLOC_OFFSET (8 * 1024 * 1024)
-+#define VMALLOC_START (((unsigned long)high_memory + VMALLOC_OFFSET) & ~(VMALLOC_OFFSET-1))
-+#define VMALLOC_VMADDR(x) ((unsigned long)(x))
-+
-+
-+#ifdef CONFIG_HIGHMEM
-+#define CONSISTENT_BASE ((PKMAP_BASE) - (SZ_2M))
-+#define CONSISTENT_END (PKMAP_BASE)
-+#else
-+#define CONSISTENT_BASE (FIXADDR_START - SZ_2M)
-+#define CONSISTENT_END (FIXADDR_START)
-+#endif
-+#define CONSISTENT_OFFSET(x) (((unsigned long)(x) - CONSISTENT_BASE) >> PAGE_SHIFT)
-+
-+#ifdef CONFIG_HIGHMEM
-+#ifndef __ASSEMBLY__
-+#include <asm/highmem.h>
-+#endif
-+#endif
-+
-+//# define VMALLOC_END (CONSISTENT_START - PAGE_SIZE)
-+# define VMALLOC_END (0xf9000000)
-+
-+#define VMALLOC_RESERVE (128 << 20)
-+#define MAXMEM (VMALLOC_END - PAGE_OFFSET - VMALLOC_RESERVE)
-+#define MAXMEM_PFN PFN_DOWN(MAXMEM)
-+
-+#define FIRST_USER_PGD_NR 0
-+#define USER_PTRS_PER_PGD ((TASK_SIZE/PGDIR_SIZE) + FIRST_USER_PGD_NR)
-+
-+/* L2 PTE */
-+#define _PAGE_V (1UL << 0)
-+
-+#define _PAGE_M_XKRW (0UL << 1)
-+#define _PAGE_M_UR_KR (1UL << 1)
-+#define _PAGE_M_UR_KRW (2UL << 1)
-+#define _PAGE_M_URW_KRW (3UL << 1)
-+#define _PAGE_M_KR (5UL << 1)
-+#define _PAGE_M_KRW (7UL << 1)
-+
-+#define _PAGE_D (1UL << 4)
-+#define _PAGE_E (1UL << 5)
-+#define _PAGE_A (1UL << 6)
-+#define _PAGE_G (1UL << 7)
-+
-+#define _PAGE_C_DEV (0UL << 8)
-+#define _PAGE_C_DEV_WB (1UL << 8)
-+#define _PAGE_C_MEM (2UL << 8)
-+#define _PAGE_C_MEM_SHRD_WB (4UL << 8)
-+#define _PAGE_C_MEM_SHRD_WT (5UL << 8)
-+#define _PAGE_C_MEM_WB (6UL << 8)
-+#define _PAGE_C_MEM_WT (7UL << 8)
-+
-+#define _PAGE_L (1UL << 11)
-+
-+#ifndef CONFIG_NO_KERNEL_LARGE_PAGE
-+#define _HAVE_PAGE_L (_PAGE_L)
-+#else
-+#define _HAVE_PAGE_L 0
-+#endif
-+#define _PAGE_FILE (1UL << 1)
-+#define _PAGE_YOUNG 0
-+#define _PAGE_M_MASK _PAGE_M_KRW
-+#define _PAGE_C_MASK _PAGE_C_MEM_WT
-+
-+#ifdef CONFIG_SMP
-+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
-+#define _PAGE_CACHE_SHRD _PAGE_C_MEM_SHRD_WT
-+#else
-+#define _PAGE_CACHE_SHRD _PAGE_C_MEM_SHRD_WB
-+#endif
-+#else
-+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
-+#define _PAGE_CACHE_SHRD _PAGE_C_MEM_WT
-+#else
-+#define _PAGE_CACHE_SHRD _PAGE_C_MEM_WB
-+#endif
-+#endif
-+
-+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
-+#define _PAGE_CACHE _PAGE_C_MEM_WT
-+#else
-+#define _PAGE_CACHE _PAGE_C_MEM_WB
-+#endif
-+
-+/*
-+ * + Level 1 descriptor (PMD)
-+ */
-+#define PMD_TYPE_TABLE 0
-+
-+#ifndef __ASSEMBLY__
-+
-+#define _PAGE_USER_TABLE PMD_TYPE_TABLE
-+#define _PAGE_KERNEL_TABLE PMD_TYPE_TABLE
-+
-+#define PAGE_EXEC __pgprot(_PAGE_V | _PAGE_M_XKRW | _PAGE_E)
-+#define PAGE_NONE __pgprot(_PAGE_V | _PAGE_M_KRW | _PAGE_A)
-+#define PAGE_READ __pgprot(_PAGE_V | _PAGE_M_UR_KR)
-+#define PAGE_RDWR __pgprot(_PAGE_V | _PAGE_M_URW_KRW | _PAGE_D)
-+#define PAGE_COPY __pgprot(_PAGE_V | _PAGE_M_UR_KR)
-+
-+#define PAGE_UXKRWX_V1 __pgprot(_PAGE_V | _PAGE_M_KRW | _PAGE_D | _PAGE_E | _PAGE_G | _PAGE_CACHE_SHRD)
-+#define PAGE_UXKRWX_V2 __pgprot(_PAGE_V | _PAGE_M_XKRW | _PAGE_D | _PAGE_E | _PAGE_G | _PAGE_CACHE_SHRD)
-+#define PAGE_CACHE_L1 __pgprot(_HAVE_PAGE_L | _PAGE_V | _PAGE_M_KRW | _PAGE_D | _PAGE_E | _PAGE_G | _PAGE_CACHE)
-+#define PAGE_MEMORY __pgprot(_HAVE_PAGE_L | _PAGE_V | _PAGE_M_KRW | _PAGE_D | _PAGE_E | _PAGE_G | _PAGE_CACHE_SHRD)
-+#define PAGE_KERNEL __pgprot(_PAGE_V | _PAGE_M_KRW | _PAGE_D | _PAGE_E | _PAGE_G | _PAGE_CACHE_SHRD)
-+#define PAGE_DEVICE __pgprot(_PAGE_V | _PAGE_M_KRW | _PAGE_D | _PAGE_G | _PAGE_C_DEV)
-+#endif /* __ASSEMBLY__ */
-+
-+/* xwr */
-+#define __P000 (PAGE_NONE | _PAGE_CACHE_SHRD)
-+#define __P001 (PAGE_READ | _PAGE_CACHE_SHRD)
-+#define __P010 (PAGE_COPY | _PAGE_CACHE_SHRD)
-+#define __P011 (PAGE_COPY | _PAGE_CACHE_SHRD)
-+#define __P100 (PAGE_EXEC | _PAGE_CACHE_SHRD)
-+#define __P101 (PAGE_READ | _PAGE_E | _PAGE_CACHE_SHRD)
-+#define __P110 (PAGE_COPY | _PAGE_E | _PAGE_CACHE_SHRD)
-+#define __P111 (PAGE_COPY | _PAGE_E | _PAGE_CACHE_SHRD)
-+
-+#define __S000 (PAGE_NONE | _PAGE_CACHE_SHRD)
-+#define __S001 (PAGE_READ | _PAGE_CACHE_SHRD)
-+#define __S010 (PAGE_RDWR | _PAGE_CACHE_SHRD)
-+#define __S011 (PAGE_RDWR | _PAGE_CACHE_SHRD)
-+#define __S100 (PAGE_EXEC | _PAGE_CACHE_SHRD)
-+#define __S101 (PAGE_READ | _PAGE_E | _PAGE_CACHE_SHRD)
-+#define __S110 (PAGE_RDWR | _PAGE_E | _PAGE_CACHE_SHRD)
-+#define __S111 (PAGE_RDWR | _PAGE_E | _PAGE_CACHE_SHRD)
-+
-+#ifndef __ASSEMBLY__
-+/*
-+ * ZERO_PAGE is a global shared page that is always zero: used
-+ * for zero-mapped memory areas etc..
-+ */
-+extern struct page *empty_zero_page;
-+#define ZERO_PAGE(vaddr) (empty_zero_page)
-+
-+#define pte_pfn(pte) (pte_val(pte) >> PAGE_SHIFT)
-+#define pfn_pte(pfn,prot) (__pte(((pfn) << PAGE_SHIFT) | pgprot_val(prot)))
-+
-+#define pte_none(pte) !(pte_val(pte))
-+#define pte_clear(mm,addr,ptep) set_pte_at((mm),(addr),(ptep), __pte(0))
-+#define pte_page(pte) (pfn_to_page(pte_pfn(pte)))
-+
-+#define pte_index(address) (((address) >> PAGE_SHIFT) & (PTRS_PER_PTE - 1))
-+#define pte_offset_kernel(dir, address) ((pte_t *)pmd_page_kernel(*(dir)) + pte_index(address))
-+#define pte_offset_map(dir, address) ((pte_t *)page_address(pmd_page(*(dir))) + pte_index(address))
-+#define pte_offset_map_nested(dir, address) pte_offset_map(dir, address)
-+#define pmd_page_kernel(pmd) ((unsigned long) __va(pmd_val(pmd) & PAGE_MASK))
-+
-+#define pte_unmap(pte) do { } while (0)
-+#define pte_unmap_nested(pte) do { } while (0)
-+
-+#define set_pte_at(mm,addr,ptep,pteval) set_pte(ptep,pteval)
-+
-+static inline pgd_t *get_pgd( void){
-+
-+ return ( pgd_t *)phys_to_virt( GET_L1_PPTB() & L1_PPTB_mskBASE);
-+}
-+
-+static inline void set_pgd( pgd_t *pgdp, pgd_t pgd){
-+
-+ /* TODO */
-+}
-+/*
-+ * Set a level 1 translation table entry, and clean it out of
-+ * any caches such that the MMUs can load it correctly.
-+ */
-+static inline void set_pmd( pmd_t *pmdp, pmd_t pmd){
-+
-+ *pmdp = pmd;
-+#if !defined(CONFIG_CPU_DCACHE_DISABLE) && !defined(CONFIG_CPU_DCACHE_WRITETHROUGH)
-+ __asm__ volatile ( "\n\tcctl %0, L1D_VA_WB" ::"r" ( pmdp) :"memory");
-+ MSYNC( all);
-+ DSB();
-+#endif
-+}
-+
-+/*
-+ * Set a PTE and flush it out
-+ */
-+static inline void set_pte( pte_t *ptep, pte_t pte){
-+
-+ *ptep = pte;
-+#if !defined(CONFIG_CPU_DCACHE_DISABLE) && !defined(CONFIG_CPU_DCACHE_WRITETHROUGH)
-+ __asm__ volatile ( "\n\tcctl %0, L1D_VA_WB" ::"r" ( ptep) :"memory");
-+ MSYNC( all);
-+ DSB();
-+#endif
-+}
-+
-+
-+/*
-+ * The following only work if pte_present() is true.
-+ * Undefined behaviour if not..
-+ */
-+
-+/*
-+ * pte_write: this page is writeable for user mode
-+ * pte_read: this page is readable for user mode
-+ * pte_kernel_write: this page is writeable for kernel mode
-+ *
-+ * We don't have pte_kernel_read because kernel always can read.
-+ *
-+ * */
-+
-+#define pte_present(pte) (pte_val(pte) & _PAGE_V)
-+#define pte_write(pte) ((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_URW_KRW)
-+#define pte_read(pte) (((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_UR_KR) || \
-+ ((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_UR_KRW) || \
-+ ((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_URW_KRW))
-+#define pte_kernel_write(pte) (((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_URW_KRW) || \
-+ ((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_UR_KRW) || \
-+ ((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_KRW) || \
-+ (((pte_val(pte) & _PAGE_M_MASK) == _PAGE_M_XKRW) && pte_exec(pte)))
-+#define pte_exec(pte) (pte_val(pte) & _PAGE_E)
-+#define pte_dirty(pte) (pte_val(pte) & _PAGE_D)
-+#define pte_young(pte) (pte_val(pte) & _PAGE_YOUNG)
-+
-+/*
-+ * The following only works if pte_present() is not true.
-+ */
-+#define pte_file(pte) (pte_val(pte) & _PAGE_FILE)
-+#define pte_to_pgoff(x) (pte_val(x) >> 2)
-+#define pgoff_to_pte(x) __pte(((x) << 2) | _PAGE_FILE)
-+
-+#define PTE_FILE_MAX_BITS 29
-+
-+#define PTE_BIT_FUNC(fn,op) \
-+static inline pte_t pte_##fn(pte_t pte) { pte_val(pte) op; return pte; }
-+
-+static inline pte_t pte_wrprotect(pte_t pte)
-+{
-+ pte_val(pte) = pte_val(pte) & ~_PAGE_M_MASK;
-+ pte_val(pte) = pte_val(pte) | _PAGE_M_UR_KR;
-+ return pte;
-+}
-+
-+static inline pte_t pte_mkwrite(pte_t pte)
-+{
-+ pte_val(pte) = pte_val(pte) & ~_PAGE_M_MASK;
-+ pte_val(pte) = pte_val(pte) | _PAGE_M_URW_KRW;
-+ return pte;
-+}
-+
-+PTE_BIT_FUNC(exprotect, &= ~_PAGE_E);
-+PTE_BIT_FUNC(mkexec, |= _PAGE_E);
-+PTE_BIT_FUNC(mkclean, &= ~_PAGE_D);
-+PTE_BIT_FUNC(mkdirty, |= _PAGE_D);
-+PTE_BIT_FUNC(mkold, &= ~_PAGE_YOUNG);
-+PTE_BIT_FUNC(mkyoung, |= _PAGE_YOUNG);
-+static inline int pte_special(pte_t pte) { return 0; }
-+static inline pte_t pte_mkspecial(pte_t pte) { return pte; }
-+
-+/*
-+ * Mark the prot value as uncacheable and unbufferable.
-+ */
-+#define pgprot_noncached(prot) __pgprot((pgprot_val(prot)&~_PAGE_C_MASK) | _PAGE_C_DEV)
-+#define pgprot_writecombine(prot) __pgprot((pgprot_val(prot)&~_PAGE_C_MASK) | _PAGE_C_DEV_WB)
-+
-+#define pmd_none(pmd) (pmd_val(pmd)&0x1)
-+#define pmd_present(pmd) (!pmd_none(pmd))
-+#define pmd_bad(pmd) pmd_none(pmd)
-+
-+#define copy_pmd(pmdpd,pmdps) set_pmd((pmdpd), *(pmdps))
-+#define pmd_clear(pmdp) set_pmd((pmdp), __pmd(1))
-+
-+static inline pmd_t __mk_pmd(pte_t *ptep, unsigned long prot)
-+{
-+ unsigned long ptr = (unsigned long)ptep;
-+ pmd_t pmd;
-+
-+ /*
-+ * The pmd must be loaded with the physical
-+ * address of the PTE table
-+ */
-+
-+ pmd_val(pmd) = __virt_to_phys(ptr) | prot;
-+ return pmd;
-+}
-+
-+
-+#define pmd_page(pmd) virt_to_page(__va(pmd_val(pmd)))
-+
-+/*
-+ * Permanent address of a page. We never have highmem, so this is trivial.
-+ */
-+#define pages_to_mb(x) ((x) >> (20 - PAGE_SHIFT))
-+
-+/*
-+ * Conversion functions: convert a page and protection to a page entry,
-+ * and a page entry and page directory to the page they refer to.
-+ */
-+#define mk_pte(page,prot) pfn_pte(page_to_pfn(page),prot)
-+
-+/*
-+ * The "pgd_xxx()" functions here are trivial for a folded two-level
-+ * setup: the pgd is never bad, and a pmd always exists (as it's folded
-+ * into the pgd entry)
-+ */
-+#define pgd_none(pgd) (0)
-+#define pgd_bad(pgd) (0)
-+#define pgd_present(pgd) (1)
-+#define pgd_clear(pgdp) do { } while (0)
-+
-+#define page_pte_prot(page,prot) mk_pte(page, prot)
-+#define page_pte(page) mk_pte(page, __pgprot(0))
-+/* Tom:
-+ * L1PTE = $mr1 + ((virt >> PMD_SHIFT) << 2);
-+ * L2PTE = (((virt >> PAGE_SHIFT) & (PTRS_PER_PTE -1 )) << 2);
-+ * PPN = (phys & 0xfffff000);
-+ *
-+*/
-+
-+/* to find an entry in a page-table-directory */
-+#define pgd_index(address) (((address) >> PGDIR_SHIFT) & (PTRS_PER_PGD - 1))
-+#define pgd_offset(mm, address) ((mm)->pgd + pgd_index(address))
-+/* to find an entry in a kernel page-table-directory */
-+#define pgd_offset_k(addr) pgd_offset(&init_mm, addr)
-+
-+/* Find an entry in the second-level page table.. */
-+#define pmd_offset(dir, addr) ((pmd_t *)(dir))
-+
-+static inline pte_t pte_modify(pte_t pte, pgprot_t newprot)
-+{
-+ const unsigned long mask = 0xfff;
-+ pte_val(pte) = (pte_val(pte) & ~mask) | (pgprot_val(newprot) & mask);
-+ return pte;
-+}
-+
-+extern pgd_t swapper_pg_dir[PTRS_PER_PGD];
-+
-+/* Encode and decode a swap entry.
-+ *
-+ * We support up to 32GB of swap on 4k machines
-+ */
-+#define __swp_type(x) (((x).val >> 2) & 0x7f)
-+#define __swp_offset(x) ((x).val >> 9)
-+#define __swp_entry(type,offset) ((swp_entry_t) { ((type) << 2) | ((offset) << 9) })
-+#define __pte_to_swp_entry(pte) ((swp_entry_t) { pte_val(pte) })
-+#define __swp_entry_to_pte(swp) ((pte_t) { (swp).val })
-+
-+/* Needs to be defined here and not in linux/mm.h, as it is arch dependent */
-+/* FIXME: this is not correct */
-+#define kern_addr_valid(addr) (1)
-+
-+#include <asm-generic/pgtable.h>
-+
-+/*
-+ * We provide our own arch_get_unmapped_area to cope with VIPT caches.
-+ */
-+#define HAVE_ARCH_UNMAPPED_AREA
-+
-+/*
-+ * remap a physical address `phys' of size `size' with page protection `prot'
-+ * into virtual address `from'
-+ */
-+#define io_remap_pfn_range(vma,from,pfn,size,prot) \
-+ remap_pfn_range(vma, from, pfn, size, prot)
-+
-+#define pgtable_cache_init() do { } while (0)
-+
-+#endif /* !__ASSEMBLY__ */
-+
-+#endif /* _ASMNDS32_PGTABLE_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/poll.h linux-3.4.113/arch/nds32/include/asm/poll.h
---- linux-3.4.113.orig/arch/nds32/include/asm/poll.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/poll.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/poll.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASMNDS32_POLL_H
-+#define __ASMNDS32_POLL_H
-+
-+#include <asm-generic/poll.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/posix_types.h linux-3.4.113/arch/nds32/include/asm/posix_types.h
---- linux-3.4.113.orig/arch/nds32/include/asm/posix_types.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/posix_types.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,40 @@
-+/*
-+ * arch/arm/include/asm/posix_types.h
-+ *
-+ * Copyright (C) 1996-1998 Russell King.
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Changelog:
-+ * 27-06-1996 RMK Created
-+ */
-+#ifndef __ARCH_NDS32_POSIX_TYPES_H
-+#define __ARCH_NDS32_POSIX_TYPES_H
-+
-+/*
-+ * This file is generally used by user-level software, so you need to
-+ * be a little careful about namespace pollution etc. Also, we cannot
-+ * assume GCC is being used.
-+ */
-+
-+typedef unsigned short __kernel_mode_t;
-+#define __kernel_mode_t __kernel_mode_t
-+
-+typedef unsigned short __kernel_nlink_t;
-+#define __kernel_nlink_t __kernel_nlink_t
-+
-+typedef unsigned short __kernel_ipc_pid_t;
-+#define __kernel_ipc_pid_t __kernel_ipc_pid_t
-+
-+typedef unsigned short __kernel_uid_t;
-+typedef unsigned short __kernel_gid_t;
-+#define __kernel_uid_t __kernel_uid_t
-+
-+typedef unsigned short __kernel_old_dev_t;
-+#define __kernel_old_dev_t __kernel_old_dev_t
-+
-+#include <asm-generic/posix_types.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/processor.h linux-3.4.113/arch/nds32/include/asm/processor.h
---- linux-3.4.113.orig/arch/nds32/include/asm/processor.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/processor.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,133 @@
-+/*
-+ * linux/arch/nds32/include/asm/processor.h
-+ */
-+/* Copyright (C) 1995-1999 Russell King
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+/* ============================================================================
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is ptrace relative code for Andes NDS32 architecture.
-+ * Original referred from ARM, fit to NDS32.
-+ *
-+ * Revision History:
-+ *
-+ * Oct.03.2007 Original from Tom, Shawn and Steven, refined by Harry.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#ifndef __ASM_NDS32_PROCESSOR_H
-+#define __ASM_NDS32_PROCESSOR_H
-+
-+/*
-+ * Default implementation of macro that returns current
-+ * instruction pointer ("program counter").
-+ */
-+#define current_text_addr() ({ __label__ _l; _l: &&_l;})
-+
-+#ifdef __KERNEL__
-+
-+#include <asm/ptrace.h>
-+#include <asm/procinfo.h>
-+#include <asm/types.h>
-+#include <asm/cpuver.h>
-+#include <asm/sigcontext.h>
-+
-+#define KERNEL_STACK_SIZE PAGE_SIZE
-+#define STACK_TOP TASK_SIZE
-+#define STACK_TOP_MAX TASK_SIZE
-+
-+struct debug_info {
-+ u32 address;
-+ u16 insn;
-+ u8 valid;
-+};
-+
-+struct thread_struct {
-+ /* fault info */
-+ unsigned long address;
-+ unsigned long trap_no;
-+ unsigned long error_code;
-+
-+ struct fpu_struct fpu; /* Saved fpu/fpu emulator stuff. */
-+ struct audio_struct audio;
-+ struct debug_info debug; /* debugging */
-+};
-+
-+#define INIT_THREAD { }
-+
-+#ifdef __NDS32_EB__
-+#define PSW_DE PSW_mskBE
-+#else
-+#define PSW_DE 0x0
-+#endif
-+
-+#ifdef CONFIG_WBNA
-+#define PSW_valWBNA PSW_mskWBNA
-+#else
-+#define PSW_valWBNA 0x0
-+#endif
-+
-+#define start_thread(regs,pc,sp) \
-+({ \
-+ unsigned long *stack = (unsigned long *)sp; \
-+ set_fs(USER_DS); \
-+ memzero(regs->uregs, sizeof(regs->uregs)); \
-+ regs->NDS32_ipsw = (PSW_CPL_ANY | PSW_valWBNA | PSW_mskDT | PSW_mskIT | PSW_DE | PSW_mskGIE); \
-+ regs->NDS32_ir0 = (PSW_CPL_ANY | PSW_valWBNA | PSW_mskDT | PSW_mskIT | PSW_DE | PSW_SYSTEM | PSW_INTL_1); \
-+ regs->NDS32_ipc = pc; /* pc */ \
-+ regs->NDS32_sp = sp; /* $sp */ \
-+ regs->NDS32_r2 = stack[4]; /* $r2 (envp) */ \
-+ regs->NDS32_r1 = stack[1]; /* $r1 (argv) */ \
-+ regs->NDS32_r0 = stack[0]; /* $r0 (argc) */ \
-+})
-+
-+
-+/* Forward declaration, a strange C thing */
-+struct task_struct;
-+
-+/* Free all resources held by a thread. */
-+extern void release_thread(struct task_struct *);
-+#ifdef CONFIG_FPU
-+#ifndef CONFIG_UNLAZU_FPU //lazy fpu
-+extern struct task_struct *last_task_used_math;
-+#endif
-+#endif
-+#ifdef CONFIG_AUDIO
-+#ifndef CONFIG_UNLAZY_AUDIO //lazy audio
-+extern struct task_struct *last_task_used_audio;
-+#endif
-+#endif
-+
-+/* Prepare to copy thread state - unlazy all lazy status */
-+#define prepare_to_copy(tsk) do { } while (0)
-+
-+unsigned long get_wchan(struct task_struct *p);
-+
-+#define cpu_relax() barrier()
-+
-+#define task_pt_regs(task) \
-+ ((struct pt_regs *) (task_stack_page(task) + THREAD_SIZE \
-+ - 8) - 1)
-+
-+/*
-+ * Create a new kernel thread
-+ */
-+extern int kernel_thread(int (*fn)(void *), void *arg, unsigned long flags);
-+
-+#define KSTK_EIP(tsk) (((unsigned long *)(4096+(unsigned long)task_thread_info(tsk)))[1019])
-+#define KSTK_ESP(tsk) (((unsigned long *)(4096+(unsigned long)task_thread_info(tsk)))[1017])
-+
-+
-+#endif
-+
-+#endif /* __ASM_NDS32_PROCESSOR_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/proc-fns.h linux-3.4.113/arch/nds32/include/asm/proc-fns.h
---- linux-3.4.113.orig/arch/nds32/include/asm/proc-fns.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/proc-fns.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,88 @@
-+/*
-+ * linux/arch/nds32/include/asm/proc-fns.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_PROCFNS_H__
-+#define __NDS32_PROCFNS_H__
-+
-+#define CPU_NAME n12
-+
-+#ifdef __KERNEL__
-+
-+#ifdef __STDC__
-+#define ____cpu_fn(name,fn) name##fn
-+#else
-+#define ____cpu_fn(name,fn) name/**/fn
-+#endif
-+#define __cpu_fn(name,fn) ____cpu_fn(name,fn)
-+
-+#define cpu_proc_init __cpu_fn( CPU_NAME, _proc_init)
-+#define cpu_proc_fin __cpu_fn( CPU_NAME, _proc_fin)
-+#define cpu_do_idle __cpu_fn( CPU_NAME, _do_idle)
-+#define cpu_reset __cpu_fn( CPU_NAME, _reset)
-+#define cpu_switch_mm __cpu_fn( CPU_NAME, _switch_mm)
-+
-+#define cpu_dcache_inval_all __cpu_fn( CPU_NAME, _dcache_inval_all)
-+#define cpu_dcache_wbinval_all __cpu_fn( CPU_NAME, _dcache_wbinval_all)
-+#define cpu_dcache_inval_page __cpu_fn( CPU_NAME, _dcache_inval_page)
-+#define cpu_dcache_wb_page __cpu_fn( CPU_NAME, _dcache_wb_page)
-+#define cpu_dcache_wbinval_page __cpu_fn( CPU_NAME, _dcache_wbinval_page)
-+#define cpu_dcache_inval_range __cpu_fn( CPU_NAME, _dcache_inval_range)
-+#define cpu_dcache_wb_range __cpu_fn( CPU_NAME, _dcache_wb_range)
-+#define cpu_dcache_wbinval_range __cpu_fn( CPU_NAME, _dcache_wbinval_range)
-+
-+#define cpu_icache_inval_all __cpu_fn( CPU_NAME, _icache_inval_all)
-+#define cpu_icache_inval_page __cpu_fn( CPU_NAME, _icache_inval_page)
-+#define cpu_icache_inval_range __cpu_fn( CPU_NAME, _icache_inval_range)
-+
-+#define cpu_cache_wbinval_page __cpu_fn( CPU_NAME, _cache_wbinval_page)
-+#define cpu_cache_wbinval_range __cpu_fn( CPU_NAME, _cache_wbinval_range)
-+#define cpu_cache_wbinval_range_check __cpu_fn( CPU_NAME, _cache_wbinval_range_check)
-+
-+#define cpu_dma_wb_range __cpu_fn( CPU_NAME, _dma_wb_range)
-+#define cpu_dma_inval_range __cpu_fn( CPU_NAME, _dma_inval_range)
-+#define cpu_dma_wbinval_range __cpu_fn( CPU_NAME, _dma_wbinval_range)
-+
-+#include <asm/page.h>
-+
-+struct mm_struct;
-+struct vm_area_struct;
-+extern void cpu_proc_init(void);
-+extern void cpu_proc_fin(void);
-+extern void cpu_do_idle(void);
-+extern void cpu_reset(unsigned long reset);
-+extern void cpu_switch_mm(struct mm_struct *mm);
-+
-+extern void cpu_dcache_inval_all(void);
-+extern void cpu_dcache_wbinval_all(void);
-+extern void cpu_dcache_inval_page(unsigned long page);
-+extern void cpu_dcache_wb_page(unsigned long page);
-+extern void cpu_dcache_wbinval_page(unsigned long page);
-+extern void cpu_dcache_inval_range(unsigned long start, unsigned long end);
-+extern void cpu_dcache_wb_range(unsigned long start, unsigned long end);
-+extern void cpu_dcache_wbinval_range(unsigned long start, unsigned long end);
-+
-+extern void cpu_icache_inval_all(void);
-+extern void cpu_icache_inval_page(unsigned long page);
-+extern void cpu_icache_inval_range(unsigned long start, unsigned long end);
-+
-+extern void cpu_cache_wbinval_page(unsigned long page, int flushi);
-+extern void cpu_cache_wbinval_range(unsigned long start,
-+ unsigned long end, int flushi);
-+extern void cpu_cache_wbinval_range_check(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end);
-+
-+extern void cpu_dma_wb_range(unsigned long start, unsigned long end);
-+extern void cpu_dma_inval_range(unsigned long start, unsigned long end);
-+extern void cpu_dma_wbinval_range(unsigned long start, unsigned long end);
-+
-+#ifdef CONFIG_CACHE_L2
-+#define cpu_L2cache_inval __cpu_fn(CPU_NAME, _L2cache_inval)
-+#define cpu_L2cache_wb __cpu_fn(CPU_NAME, _L2cache_wb)
-+extern void cpu_L2cache_inval(void);
-+extern void cpu_L2cache_wb(void);
-+#endif
-+
-+#endif /* __KERNEL__ */
-+#endif /* __NDS32_PROCFNS_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/procinfo.h linux-3.4.113/arch/nds32/include/asm/procinfo.h
---- linux-3.4.113.orig/arch/nds32/include/asm/procinfo.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/procinfo.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,71 @@
-+/*
-+ * linux/arch/nds32/include/asm/procinfo.h
-+ *
-+ * Copyright (C) 1996-1999 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_PROCINFO_H
-+#define __ASM_PROCINFO_H
-+
-+#ifndef __ASSEMBLY__
-+
-+/*
-+ * These structure are defined in assembly
-+ * ( nds32/mm/proc-nds32.S)
-+ */
-+struct proc_info_item {
-+
-+ const char *manufacturer;
-+ const char *cpu_name;
-+};
-+
-+/*
-+ * Note! struct processor is always defined if we're
-+ * using MULTI_CPU, otherwise this entry is unused,
-+ * but still exists.
-+ *
-+ * NOTE! The following structure is defined by assembly
-+ * language, NOT C code. For more information, check:
-+ * arch/arm/mm/proc-*.S and arch/arm/kernel/head.S
-+ */
-+struct proc_info_list {
-+
-+ unsigned int cpu_val;
-+ unsigned int cpu_mask;
-+ const char *arch_name;
-+ const char *elf_name;
-+ unsigned int elf_hwcap;
-+ struct proc_info_item *info;
-+};
-+
-+extern unsigned int elf_hwcap;
-+
-+#endif /* __ASSEMBLY__ */
-+
-+#define HWCAP_MFUSR_PC 0x000001
-+#define HWCAP_EXT 0x000002
-+#define HWCAP_EXT2 0x000004
-+#define HWCAP_FPU 0x000008
-+#define HWCAP_AUDIO 0x000010
-+#define HWCAP_BASE16 0x000020
-+#define HWCAP_STRING 0x000040
-+#define HWCAP_REDUCED_REGS 0x000080
-+#define HWCAP_VIDEO 0x000100
-+#define HWCAP_ENCRYPT 0x000200
-+#define HWCAP_EDM 0x000400
-+#define HWCAP_LMDMA 0x000800
-+#define HWCAP_PFM 0x001000
-+#define HWCAP_HSMP 0x002000
-+#define HWCAP_TRACE 0x004000
-+#define HWCAP_DIV 0x008000
-+#define HWCAP_MAC 0x010000
-+#define HWCAP_L2C 0x020000
-+#define HWCAP_FPU_DP 0x040000
-+#define HWCAP_V2 0x080000
-+#define HWCAP_DX_REGS 0x100000
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/ptrace.h linux-3.4.113/arch/nds32/include/asm/ptrace.h
---- linux-3.4.113.orig/arch/nds32/include/asm/ptrace.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/ptrace.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,119 @@
-+/*
-+ * linux/arch/nds32/include/asm/ptrace.h
-+ *
-+ * Copyright (C) 1996-2003 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_NDS32_PTRACE_H
-+#define __ASM_NDS32_PTRACE_H
-+
-+#define PTRACE_GETREGS 12
-+#define PTRACE_SETREGS 13
-+#define PTRACE_GETFPREGS 14
-+#define PTRACE_SETFPREGS 15
-+#define PTRACE_GETAUREGS 18
-+#define PTRACE_SETAUREGS 19
-+
-+#define PTRACE_OLDSETOPTIONS 21
-+
-+#define PTRACE_GET_THREAD_AREA 22
-+
-+#ifndef __ASSEMBLY__
-+/* this struct defines the way the registers are stored on the
-+ stack during a system call. */
-+
-+struct pt_regs {
-+#if defined(CONFIG_ABI1)
-+ long dummy[6];
-+#endif
-+ long uregs[44];
-+};
-+#define NDS32_osp uregs[43]
-+#define NDS32_FUCOP_CTL uregs[42]
-+#define NDS32_lp uregs[41]
-+#define NDS32_gp uregs[40]
-+#define NDS32_fp uregs[39]
-+#define NDS32_r25 uregs[38]
-+#define NDS32_r24 uregs[37]
-+#define NDS32_r23 uregs[36]
-+#define NDS32_r22 uregs[35]
-+#define NDS32_r21 uregs[34]
-+#define NDS32_r20 uregs[33]
-+#define NDS32_r19 uregs[32]
-+#define NDS32_r18 uregs[31]
-+#define NDS32_r17 uregs[30]
-+#define NDS32_r16 uregs[29]
-+#define NDS32_r15 uregs[28]
-+#define NDS32_r14 uregs[27]
-+#define NDS32_r13 uregs[26]
-+#define NDS32_r12 uregs[25]
-+#define NDS32_r11 uregs[24]
-+#define NDS32_r10 uregs[23]
-+#define NDS32_r9 uregs[22]
-+#define NDS32_r8 uregs[21]
-+#define NDS32_r7 uregs[20]
-+#define NDS32_r6 uregs[19]
-+#define NDS32_r5 uregs[18]
-+#define NDS32_r4 uregs[17]
-+#define NDS32_r3 uregs[16]
-+#define NDS32_r2 uregs[15]
-+#define NDS32_r1 uregs[14]
-+#define NDS32_r0 uregs[13]
-+#if defined(CONFIG_HWZOL)
-+#define NDS32_lc uregs[11]
-+#define NDS32_le uregs[10]
-+#define NDS32_lb uregs[9]
-+#endif
-+#define NDS32_pp1 uregs[8]
-+#define NDS32_pp0 uregs[7]
-+#define NDS32_pipc uregs[6]
-+#define NDS32_pipsw uregs[5]
-+#define NDS32_ORIG_r0 uregs[4]
-+#define NDS32_sp uregs[3]
-+#define NDS32_ipc uregs[2]
-+#define NDS32_ipsw uregs[1]
-+#define NDS32_ir0 uregs[0]
-+
-+#ifdef __KERNEL__
-+#include <asm/bitfield.h>
-+
-+#define arch_has_single_step() (1)
-+struct task_struct;
-+extern void user_enable_single_step(struct task_struct *);
-+extern void user_disable_single_step(struct task_struct *);
-+
-+#define user_mode(regs) (((regs)->NDS32_ipsw & PSW_mskPOM) == 0)
-+
-+#define interrupts_enabled(regs) (!((regs)->NDS32_ipsw & ~PSW_mskGIE))
-+
-+extern void show_regs(struct pt_regs *);
-+
-+/* Are the current registers suitable for user mode?
-+ * (used to maintain security in signal handlers)
-+ */
-+static inline int valid_user_regs(struct pt_regs *regs)
-+{
-+ return user_mode(regs) && ((regs->NDS32_ipsw & PSW_mskGIE) == 1);
-+}
-+
-+static inline unsigned long regs_return_value(struct pt_regs *regs)
-+{
-+ return regs->NDS32_r0;
-+}
-+
-+
-+#define instruction_pointer(regs) ((regs)->NDS32_ipc)
-+
-+#ifdef CONFIG_SMP
-+extern unsigned long profile_pc(struct pt_regs *regs);
-+#else
-+#define profile_pc(regs) instruction_pointer(regs)
-+#endif
-+
-+#endif /* __KERNEL__ */
-+#endif /* __ASSEMBLY__ */
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/reg_access.h linux-3.4.113/arch/nds32/include/asm/reg_access.h
---- linux-3.4.113.orig/arch/nds32/include/asm/reg_access.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/reg_access.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,153 @@
-+/*
-+ * linux/arch/nds32/include/asm/reg_access.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_REG_ACCESS_H__
-+#define __NDS32_REG_ACCESS_H__
-+
-+#ifndef __ASSEMBLY__
-+#define DEFINE_GET_SYS_REG( reg) \
-+inline static unsigned long GET_##reg( void){ \
-+ unsigned long val; \
-+ __asm__ volatile ( "mfsr %0, $"#reg :"=&r" (val) ::"memory"); \
-+ return val; \
-+}
-+
-+#define DEFINE_PUT_SYS_REG( reg) \
-+inline static void SET_##reg( unsigned long val){ \
-+ __asm__ volatile ( "\n\tmtsr %0, $"#reg \
-+ "\n\tdsb" ::"r" ( val) :"memory"); \
-+}
-+
-+#define DEFINE_PUT_SYS_REG_i( reg) \
-+inline static void SET_##reg( unsigned long val){ \
-+ __asm__ volatile ( "\n\tmtsr %0, $"#reg \
-+ "\n\tisb" ::"r" ( val) :"memory"); \
-+}
-+#define DEFINE_SYS_REG_OP( reg) \
-+DEFINE_GET_SYS_REG( reg); \
-+DEFINE_PUT_SYS_REG( reg);
-+
-+#define DEFINE_SYS_REG_OP_i( reg) \
-+DEFINE_GET_SYS_REG( reg); \
-+DEFINE_PUT_SYS_REG_i( reg);
-+
-+DEFINE_SYS_REG_OP( CPU_VER);
-+DEFINE_SYS_REG_OP( ICM_CFG);
-+DEFINE_SYS_REG_OP( DCM_CFG);
-+DEFINE_SYS_REG_OP( MMU_CFG);
-+DEFINE_SYS_REG_OP( MSC_CFG);
-+DEFINE_SYS_REG_OP( CORE_ID);
-+DEFINE_SYS_REG_OP( FUCOP_EXIST);
-+
-+DEFINE_SYS_REG_OP_i( PSW);
-+DEFINE_SYS_REG_OP( IPSW);
-+DEFINE_SYS_REG_OP( P_IPSW);
-+DEFINE_SYS_REG_OP( IVB);
-+DEFINE_SYS_REG_OP( EVA);
-+DEFINE_SYS_REG_OP( P_EVA);
-+DEFINE_SYS_REG_OP( ITYPE);
-+DEFINE_SYS_REG_OP( P_ITYPE);
-+DEFINE_SYS_REG_OP( MERR);
-+DEFINE_SYS_REG_OP( IPC);
-+DEFINE_SYS_REG_OP( P_IPC);
-+DEFINE_SYS_REG_OP( OIPC);
-+DEFINE_SYS_REG_OP( P_P0);
-+DEFINE_SYS_REG_OP( P_P1);
-+DEFINE_SYS_REG_OP( INT_MASK);
-+DEFINE_SYS_REG_OP( INT_PEND);
-+DEFINE_SYS_REG_OP( INT_MASK2);
-+DEFINE_SYS_REG_OP( INT_PEND2);
-+DEFINE_SYS_REG_OP( INT_TRIGGER);
-+
-+DEFINE_SYS_REG_OP( MMU_CTL);
-+DEFINE_SYS_REG_OP( L1_PPTB);
-+DEFINE_SYS_REG_OP( TLB_VPN);
-+DEFINE_SYS_REG_OP( TLB_DATA);
-+DEFINE_SYS_REG_OP( TLB_MISC);
-+DEFINE_SYS_REG_OP( VLPT_IDX);
-+DEFINE_SYS_REG_OP( ILMB);
-+DEFINE_SYS_REG_OP( DLMB);
-+DEFINE_SYS_REG_OP( CACHE_CTL);
-+DEFINE_SYS_REG_OP( HSMP_SADDR);
-+DEFINE_SYS_REG_OP( HSMP_EADDR);
-+
-+DEFINE_SYS_REG_OP( EDM_CFG);
-+DEFINE_SYS_REG_OP( EDMSW);
-+DEFINE_SYS_REG_OP( EDM_CTL);
-+DEFINE_SYS_REG_OP( EDM_DTR);
-+DEFINE_SYS_REG_OP( BPMTC);
-+DEFINE_SYS_REG_OP( DIMBR);
-+DEFINE_SYS_REG_OP( TECR0);
-+DEFINE_SYS_REG_OP( TECR1);
-+
-+DEFINE_SYS_REG_OP( BPC0);
-+DEFINE_SYS_REG_OP( BPA0);
-+DEFINE_SYS_REG_OP( BPAM0);
-+DEFINE_SYS_REG_OP( BPV0);
-+DEFINE_SYS_REG_OP( BPCID0);
-+DEFINE_SYS_REG_OP( BPC1);
-+DEFINE_SYS_REG_OP( BPA1);
-+DEFINE_SYS_REG_OP( BPAM1);
-+DEFINE_SYS_REG_OP( BPV1);
-+DEFINE_SYS_REG_OP( BPCID1);
-+DEFINE_SYS_REG_OP( BPC2);
-+DEFINE_SYS_REG_OP( BPA2);
-+DEFINE_SYS_REG_OP( BPAM2);
-+DEFINE_SYS_REG_OP( BPV2);
-+DEFINE_SYS_REG_OP( BPCID2);
-+DEFINE_SYS_REG_OP( BPC3);
-+DEFINE_SYS_REG_OP( BPA3);
-+DEFINE_SYS_REG_OP( BPAM3);
-+DEFINE_SYS_REG_OP( BPV3);
-+DEFINE_SYS_REG_OP( BPCID3);
-+DEFINE_SYS_REG_OP( BPC4);
-+DEFINE_SYS_REG_OP( BPA4);
-+DEFINE_SYS_REG_OP( BPAM4);
-+DEFINE_SYS_REG_OP( BPV4);
-+DEFINE_SYS_REG_OP( BPCID4);
-+DEFINE_SYS_REG_OP( BPC5);
-+DEFINE_SYS_REG_OP( BPA5);
-+DEFINE_SYS_REG_OP( BPAM5);
-+DEFINE_SYS_REG_OP( BPV5);
-+DEFINE_SYS_REG_OP( BPCID5);
-+DEFINE_SYS_REG_OP( BPC6);
-+DEFINE_SYS_REG_OP( BPA6);
-+DEFINE_SYS_REG_OP( BPAM6);
-+DEFINE_SYS_REG_OP( BPV6);
-+DEFINE_SYS_REG_OP( BPCID6);
-+DEFINE_SYS_REG_OP( BPC7);
-+DEFINE_SYS_REG_OP( BPA7);
-+DEFINE_SYS_REG_OP( BPAM7);
-+DEFINE_SYS_REG_OP( BPV7);
-+DEFINE_SYS_REG_OP( BPCID7);
-+
-+DEFINE_SYS_REG_OP( PFMC0);
-+DEFINE_SYS_REG_OP( PFMC1);
-+DEFINE_SYS_REG_OP( PFMC2);
-+DEFINE_SYS_REG_OP( PFM_CTL);
-+
-+DEFINE_SYS_REG_OP( SDZ_CTL);
-+DEFINE_SYS_REG_OP( N12MISC_CTL);
-+DEFINE_SYS_REG_OP( PRUSR_ACC_CTL);
-+
-+DEFINE_SYS_REG_OP( DMA_CFG);
-+DEFINE_SYS_REG_OP( DMA_GCSW);
-+DEFINE_SYS_REG_OP( DMA_CHNSEL);
-+DEFINE_SYS_REG_OP( DMA_ACT);
-+DEFINE_SYS_REG_OP( DMA_SETUP);
-+DEFINE_SYS_REG_OP( DMA_ISADDR);
-+DEFINE_SYS_REG_OP( DMA_ESADDR);
-+DEFINE_SYS_REG_OP( DMA_TCNT);
-+DEFINE_SYS_REG_OP( DMA_STATUS);
-+DEFINE_SYS_REG_OP( DMA_2DSET);
-+DEFINE_SYS_REG_OP( DMA_2DSCTL);
-+
-+DEFINE_SYS_REG_OP( FPCSR);
-+DEFINE_SYS_REG_OP( FPCFG);
-+DEFINE_SYS_REG_OP( FUCOP_CTL);
-+
-+#endif /* !__ASSEMBLY__ */
-+
-+#endif /* __NDS32_REG_ACCESS_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/resource.h linux-3.4.113/arch/nds32/include/asm/resource.h
---- linux-3.4.113.orig/arch/nds32/include/asm/resource.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/resource.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/resource.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_RESOURCE_H__
-+#define __NDS32_RESOURCE_H__
-+
-+#include <asm-generic/resource.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/rtc.h linux-3.4.113/arch/nds32/include/asm/rtc.h
---- linux-3.4.113.orig/arch/nds32/include/asm/rtc.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/rtc.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,43 @@
-+/*
-+ * linux/arch/nds32/include/asm/rtc.h
-+ *
-+ * Copyright (C) 2003 Deep Blue Solutions Ltd.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef ASMNDS32_RTC_H
-+#define ASMNDS32_RTC_H
-+
-+struct module;
-+
-+struct rtc_ops {
-+ struct module *owner;
-+ int (*open)(void);
-+ void (*release)(void);
-+ int (*ioctl)(unsigned int, unsigned long);
-+
-+ int (*read_time)(struct rtc_time *);
-+ int (*set_time)(struct rtc_time *);
-+ int (*read_alarm)(struct rtc_wkalrm *);
-+ int (*set_alarm)(struct rtc_wkalrm *);
-+ int (*proc)(char *buf);
-+};
-+
-+void rtc_update(unsigned long, unsigned long);
-+int register_rtc(struct rtc_ops *);
-+void unregister_rtc(struct rtc_ops *);
-+
-+static inline int rtc_periodic_alarm(struct rtc_time *tm)
-+{
-+ return (tm->tm_year == -1) ||
-+ ((unsigned)tm->tm_mon >= 12) ||
-+ ((unsigned)(tm->tm_mday - 1) >= 31) ||
-+ ((unsigned)tm->tm_hour > 23) ||
-+ ((unsigned)tm->tm_min > 59) ||
-+ ((unsigned)tm->tm_sec > 59);
-+}
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/scatterlist.h linux-3.4.113/arch/nds32/include/asm/scatterlist.h
---- linux-3.4.113.orig/arch/nds32/include/asm/scatterlist.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/scatterlist.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,35 @@
-+/*
-+ * linux/arch/nds32/include/asm/scatterlist.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SCATTERLIST_H
-+#define _ASMNDS32_SCATTERLIST_H
-+
-+#include <asm/memory.h>
-+#include <asm/types.h>
-+#include <asm-generic/scatterlist.h>
-+
-+#if 0
-+struct scatterlist {
-+#ifdef CONFIG_DEBUG_SG
-+ unsigned long sg_magic;
-+#endif
-+ unsigned long page_link;
-+ unsigned int offset; /* buffer offset */
-+ dma_addr_t dma_address; /* dma address */
-+ unsigned int length; /* length */
-+};
-+
-+/*
-+ * These macros should be used after a pci_map_sg call has been done
-+ * to get bus addresses of each of the SG entries and their lengths.
-+ * You should only work with the number of sg entries pci_map_sg
-+ * returns, or alternatively stop on the first sg_dma_len(sg) which
-+ * is 0.
-+ */
-+#define sg_dma_address(sg) ((sg)->dma_address)
-+#define sg_dma_len(sg) ((sg)->length)
-+#endif
-+
-+#endif /* _ASMNDS32_SCATTERLIST_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/sections.h linux-3.4.113/arch/nds32/include/asm/sections.h
---- linux-3.4.113.orig/arch/nds32/include/asm/sections.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/sections.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/sections.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __NDS32_SECTIONS_H__
-+#define __NDS32_SECTIONS_H__
-+
-+#include <asm-generic/sections.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/segment.h linux-3.4.113/arch/nds32/include/asm/segment.h
---- linux-3.4.113.orig/arch/nds32/include/asm/segment.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/segment.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,16 @@
-+/*
-+ * linux/arch/nds32/include/asm/segment.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_SEGMENT_H
-+#define __ASM_NDS32_SEGMENT_H
-+
-+#define __KERNEL_CS 0x0
-+#define __KERNEL_DS 0x0
-+
-+#define __USER_CS 0x1
-+#define __USER_DS 0x1
-+
-+#endif /* __ASM_NDS32_SEGMENT_H */
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/semaphore.h linux-3.4.113/arch/nds32/include/asm/semaphore.h
---- linux-3.4.113.orig/arch/nds32/include/asm/semaphore.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/semaphore.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,6 @@
-+/*
-+ * linux/arch/nds32/include/asm/semaphore.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#include <linux/semaphore.h>
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/semaphore-helper.h linux-3.4.113/arch/nds32/include/asm/semaphore-helper.h
---- linux-3.4.113.orig/arch/nds32/include/asm/semaphore-helper.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/semaphore-helper.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,89 @@
-+/*
-+ * linux/arch/nds32/include/asm/semaphore-helper.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef ASMNDS32_SEMAPHORE_HELPER_H
-+#define ASMNDS32_SEMAPHORE_HELPER_H
-+
-+/*
-+ * These two _must_ execute atomically wrt each other.
-+ */
-+static inline void wake_one_more(struct semaphore * sem)
-+{
-+ unsigned long flags;
-+
-+ spin_lock_irqsave(&semaphore_wake_lock, flags);
-+ if (atomic_read(&sem->count) <= 0)
-+ sem->waking++;
-+ spin_unlock_irqrestore(&semaphore_wake_lock, flags);
-+}
-+
-+static inline int waking_non_zero(struct semaphore *sem)
-+{
-+ unsigned long flags;
-+ int ret = 0;
-+
-+ spin_lock_irqsave(&semaphore_wake_lock, flags);
-+ if (sem->waking > 0) {
-+ sem->waking--;
-+ ret = 1;
-+ }
-+ spin_unlock_irqrestore(&semaphore_wake_lock, flags);
-+ return ret;
-+}
-+
-+/*
-+ * waking non zero interruptible
-+ * 1 got the lock
-+ * 0 go to sleep
-+ * -EINTR interrupted
-+ *
-+ * We must undo the sem->count down_interruptible() increment while we are
-+ * protected by the spinlock in order to make this atomic_inc() with the
-+ * atomic_read() in wake_one_more(), otherwise we can race. -arca
-+ */
-+static inline int waking_non_zero_interruptible(struct semaphore *sem,
-+ struct task_struct *tsk)
-+{
-+ unsigned long flags;
-+ int ret = 0;
-+
-+ spin_lock_irqsave(&semaphore_wake_lock, flags);
-+ if (sem->waking > 0) {
-+ sem->waking--;
-+ ret = 1;
-+ } else if (signal_pending(tsk)) {
-+ atomic_inc(&sem->count);
-+ ret = -EINTR;
-+ }
-+ spin_unlock_irqrestore(&semaphore_wake_lock, flags);
-+ return ret;
-+}
-+
-+/*
-+ * waking_non_zero_try_lock:
-+ * 1 failed to lock
-+ * 0 got the lock
-+ *
-+ * We must undo the sem->count down_interruptible() increment while we are
-+ * protected by the spinlock in order to make this atomic_inc() with the
-+ * atomic_read() in wake_one_more(), otherwise we can race. -arca
-+ */
-+static inline int waking_non_zero_trylock(struct semaphore *sem)
-+{
-+ unsigned long flags;
-+ int ret = 1;
-+
-+ spin_lock_irqsave(&semaphore_wake_lock, flags);
-+ if (sem->waking <= 0)
-+ atomic_inc(&sem->count);
-+ else {
-+ sem->waking--;
-+ ret = 0;
-+ }
-+ spin_unlock_irqrestore(&semaphore_wake_lock, flags);
-+ return ret;
-+}
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/sembuf.h linux-3.4.113/arch/nds32/include/asm/sembuf.h
---- linux-3.4.113.orig/arch/nds32/include/asm/sembuf.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/sembuf.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,30 @@
-+/*
-+ * linux/arch/nds32/include/asm/sembuf.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SEMBUF_H
-+#define _ASMNDS32_SEMBUF_H
-+
-+/*
-+ * The semid64_ds structure for arm architecture.
-+ * Note extra padding because this structure is passed back and forth
-+ * between kernel and user space.
-+ *
-+ * Pad space is left for:
-+ * - 64-bit time_t to solve y2038 problem
-+ * - 2 miscellaneous 32-bit values
-+ */
-+
-+struct semid64_ds {
-+ struct ipc64_perm sem_perm; /* permissions .. see ipc.h */
-+ __kernel_time_t sem_otime; /* last semop time */
-+ unsigned long __unused1;
-+ __kernel_time_t sem_ctime; /* last change time */
-+ unsigned long __unused2;
-+ unsigned long sem_nsems; /* no. of semaphores in array */
-+ unsigned long __unused3;
-+ unsigned long __unused4;
-+};
-+
-+#endif /* _ASMNDS32_SEMBUF_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/serial.h linux-3.4.113/arch/nds32/include/asm/serial.h
---- linux-3.4.113.orig/arch/nds32/include/asm/serial.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/serial.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,20 @@
-+/*
-+ * linux/arch/nds32/include/asm/serial.h
-+ *
-+ * Copyright (C) 1996 Russell King.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Changelog:
-+ * 15-10-1996 RMK Created
-+ */
-+
-+#ifndef __ASM_SERIAL_H
-+#define __ASM_SERIAL_H
-+
-+#define BASE_BAUD (CONFIG_UART_CLK / 16)
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/setup.h linux-3.4.113/arch/nds32/include/asm/setup.h
---- linux-3.4.113.orig/arch/nds32/include/asm/setup.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/setup.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,232 @@
-+/*
-+ * linux/arch/nds32/include/asm/setup.h
-+ *
-+ * Copyright (C) 1997-1999 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Structure passed to kernel to tell it about the
-+ * hardware it's running on. See Documentation/arm/Setup
-+ * for more info.
-+ */
-+#ifndef __ASMNDS32_SETUP_H
-+#define __ASMNDS32_SETUP_H
-+
-+#define COMMAND_LINE_SIZE 256
-+
-+/* The list ends with an ATAG_NONE node. */
-+#define ATAG_NONE 0x00000000
-+
-+struct tag_header {
-+ u32 size;
-+ u32 tag;
-+};
-+
-+/* The list must start with an ATAG_CORE node */
-+#define ATAG_CORE 0x54410001
-+
-+struct tag_core {
-+ u32 flags; /* bit 0 = read-only */
-+ u32 pagesize;
-+ u32 rootdev;
-+};
-+
-+/* it is allowed to have multiple ATAG_MEM nodes */
-+#define ATAG_MEM 0x54410002
-+
-+struct tag_mem32 {
-+ u32 size;
-+ u32 start; /* physical start address */
-+};
-+
-+/* VGA text type displays */
-+#define ATAG_VIDEOTEXT 0x54410003
-+
-+struct tag_videotext {
-+ u8 x;
-+ u8 y;
-+ u16 video_page;
-+ u8 video_mode;
-+ u8 video_cols;
-+ u16 video_ega_bx;
-+ u8 video_lines;
-+ u8 video_isvga;
-+ u16 video_points;
-+};
-+
-+/* describes how the ramdisk will be used in kernel */
-+#define ATAG_RAMDISK 0x54410004
-+
-+struct tag_ramdisk {
-+ u32 flags; /* bit 0 = load, bit 1 = prompt */
-+ u32 size; /* decompressed ramdisk size in _kilo_ bytes */
-+ u32 start; /* starting block of floppy-based RAM disk image */
-+};
-+
-+/*M Tom
-+ * this one accidentally used virtual addresses - as such,
-+ * it's deprecated.
-+ * describes where the compressed ramdisk image lives (virtual address)
-+ */
-+#define ATAG_INITRD 0x54410005
-+
-+/* describes where the compressed ramdisk image lives (physical address) */
-+#define ATAG_INITRD2 0x54420005
-+
-+struct tag_initrd {
-+ u32 start; //M Tom va of start addr /* physical start address */
-+ u32 size; //M Tom unzipped size /* size of compressed ramdisk image in bytes */
-+};
-+
-+/* board serial number. "64 bits should be enough for everybody" */
-+#define ATAG_SERIAL 0x54410006
-+
-+struct tag_serialnr {
-+ u32 low;
-+ u32 high;
-+};
-+
-+/* board revision */
-+#define ATAG_REVISION 0x54410007
-+
-+struct tag_revision {
-+ u32 rev;
-+};
-+
-+/* initial values for vesafb-type framebuffers. see struct screen_info
-+ * in include/linux/tty.h
-+ */
-+#define ATAG_VIDEOLFB 0x54410008
-+
-+struct tag_videolfb {
-+ u16 lfb_width;
-+ u16 lfb_height;
-+ u16 lfb_depth;
-+ u16 lfb_linelength;
-+ u32 lfb_base;
-+ u32 lfb_size;
-+ u8 red_size;
-+ u8 red_pos;
-+ u8 green_size;
-+ u8 green_pos;
-+ u8 blue_size;
-+ u8 blue_pos;
-+ u8 rsvd_size;
-+ u8 rsvd_pos;
-+};
-+
-+/* command line: \0 terminated string */
-+#define ATAG_CMDLINE 0x54410009
-+
-+struct tag_cmdline {
-+ char cmdline[COMMAND_LINE_SIZE];//M Tom
-+};
-+
-+/* acorn RiscPC specific information */
-+/*-d Tom
-+#define ATAG_ACORN 0x41000101
-+
-+struct tag_acorn {
-+ u32 memc_control_reg;
-+ u32 vram_pages;
-+ u8 sounddefault;
-+ u8 adfsdrives;
-+};
-+*/
-+#define ATAG_CPE 0x41000101
-+struct tag_cpe {
-+ u32 memc_control_reg;
-+ u32 vram_pages;
-+ u8 sounddefault;
-+ u8 adfsdrives;
-+};
-+
-+
-+/* footbridge memory clock, see arch/arm/mach-footbridge/arch.c */
-+#define ATAG_MEMCLK 0x41000402
-+
-+struct tag_memclk {
-+ u32 fmemclk;
-+};
-+
-+struct tag {
-+ struct tag_header hdr;
-+ union {
-+ struct tag_core core;
-+ struct tag_mem32 mem;
-+ struct tag_videotext videotext;
-+ struct tag_ramdisk ramdisk;
-+ struct tag_initrd initrd;
-+ struct tag_serialnr serialnr;
-+ struct tag_revision revision;
-+ struct tag_videolfb videolfb;
-+ struct tag_cmdline cmdline;
-+
-+ /*
-+ * Andes specific
-+ */
-+ struct tag_cpe cpe;
-+
-+ /*
-+ * DC21285 specific
-+ */
-+ struct tag_memclk memclk;
-+ } u;
-+};
-+
-+struct tagtable {
-+ u32 tag;
-+ int (*parse)(const struct tag *);
-+};
-+
-+#define tag_member_present(tag,member) \
-+ ((unsigned long)(&((struct tag *)0L)->member + 1) \
-+ <= (tag)->hdr.size * 4)
-+
-+#define tag_next(t) ((struct tag *)((u32 *)(t) + (t)->hdr.size))
-+#define tag_size(type) ((sizeof(struct tag_header) + sizeof(struct type)) >> 2)
-+
-+#define for_each_tag(t,base) \
-+ for (t = base; t->hdr.size; t = tag_next(t))
-+
-+#ifdef __KERNEL__
-+
-+#define __tag __used __attribute__((__section__(".taglist")))
-+#define __tagtable(tag, fn) \
-+static struct tagtable __tagtable_##fn __tag = { tag, fn }
-+
-+/*
-+ * Memory map description
-+ */
-+#ifdef CONFIG_ARCH_LH7A40X
-+# define NR_BANKS 16
-+#else
-+# define NR_BANKS 8
-+#endif
-+
-+struct meminfo {
-+ int nr_banks;
-+ struct {
-+ unsigned long start;
-+ unsigned long size;
-+ int node;
-+ } bank[NR_BANKS];
-+};
-+
-+/*
-+ * Early command line parameters.
-+ */
-+struct early_params {
-+ const char *arg;
-+ void (*fn)(char **p);
-+};
-+
-+#define __early_param(name,fn) \
-+static struct early_params __early_##fn __used \
-+__attribute__((__section__("__early_param"))) = { name, fn }
-+
-+#endif
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/shmbuf.h linux-3.4.113/arch/nds32/include/asm/shmbuf.h
---- linux-3.4.113.orig/arch/nds32/include/asm/shmbuf.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/shmbuf.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,47 @@
-+/*
-+ * linux/arch/nds32/include/asm/shmbuf.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SHMBUF_H
-+#define _ASMNDS32_SHMBUF_H
-+
-+/*
-+ * The shmid64_ds structure for arm architecture.
-+ * Note extra padding because this structure is passed back and forth
-+ * between kernel and user space.
-+ *
-+ * Pad space is left for:
-+ * - 64-bit time_t to solve y2038 problem
-+ * - 2 miscellaneous 32-bit values
-+ */
-+
-+struct shmid64_ds {
-+ struct ipc64_perm shm_perm; /* operation perms */
-+ size_t shm_segsz; /* size of segment (bytes) */
-+ __kernel_time_t shm_atime; /* last attach time */
-+ unsigned long __unused1;
-+ __kernel_time_t shm_dtime; /* last detach time */
-+ unsigned long __unused2;
-+ __kernel_time_t shm_ctime; /* last change time */
-+ unsigned long __unused3;
-+ __kernel_pid_t shm_cpid; /* pid of creator */
-+ __kernel_pid_t shm_lpid; /* pid of last operator */
-+ unsigned long shm_nattch; /* no. of current attaches */
-+ unsigned long __unused4;
-+ unsigned long __unused5;
-+};
-+
-+struct shminfo64 {
-+ unsigned long shmmax;
-+ unsigned long shmmin;
-+ unsigned long shmmni;
-+ unsigned long shmseg;
-+ unsigned long shmall;
-+ unsigned long __unused1;
-+ unsigned long __unused2;
-+ unsigned long __unused3;
-+ unsigned long __unused4;
-+};
-+
-+#endif /* _ASMNDS32_SHMBUF_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/shmparam.h linux-3.4.113/arch/nds32/include/asm/shmparam.h
---- linux-3.4.113.orig/arch/nds32/include/asm/shmparam.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/shmparam.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,27 @@
-+/*
-+ * linux/arch/nds32/include/asm/shmparam.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SHMPARAM_H
-+#define _ASMNDS32_SHMPARAM_H
-+
-+/*
-+ * This should be the size of the virtually indexed cache/ways,
-+ * whichever is greater since the cache aliases every size/ways
-+ * bytes.
-+ */
-+/*
-+ * Reference ARM architecture, retain the previous code
-+ * #define SHMLBA 0x4000
-+ * #define REALSHMLBA (CACHE_SET( DCACHE) * CACHE_LINE_SIZE( DCACHE))
-+ */
-+#define SHMLBA (4 * PAGE_SIZE) /* attach addr a multiple of this */
-+#define REALSHMLBA SHMLBA
-+
-+/*
-+ * Enforce SHMLBA in shmat
-+ */
-+#define __ARCH_FORCE_SHMLBA
-+
-+#endif /* _ASMNDS32_SHMPARAM_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/sigcontext.h linux-3.4.113/arch/nds32/include/asm/sigcontext.h
---- linux-3.4.113.orig/arch/nds32/include/asm/sigcontext.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/sigcontext.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,81 @@
-+/*
-+ * linux/arch/nds32/include/asm/sigcontext.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SIGCONTEXT_H
-+#define _ASMNDS32_SIGCONTEXT_H
-+
-+/*
-+ * Signal context structure - contains all info to do with the state
-+ * before the signal handler was invoked. Note: only add new entries
-+ * to the end of the structure.
-+ */
-+struct fpu_struct {
-+ unsigned long fs_regs[32];
-+ unsigned long long fd_regs[16];
-+ unsigned long fpcsr;
-+};
-+
-+struct audio_struct {
-+ unsigned long auregs[32];
-+};
-+
-+struct zol_struct {
-+ unsigned long nds32_lc; /* $LC */
-+ unsigned long nds32_le; /* $LE */
-+ unsigned long nds32_lb; /* $LB */
-+};
-+
-+struct sigcontext {
-+ unsigned long trap_no;
-+ unsigned long error_code;
-+ unsigned long oldmask;
-+ unsigned long nds32_r0;
-+ unsigned long nds32_r1;
-+ unsigned long nds32_r2;
-+ unsigned long nds32_r3;
-+ unsigned long nds32_r4;
-+ unsigned long nds32_r5;
-+ unsigned long nds32_r6;
-+ unsigned long nds32_r7;
-+ unsigned long nds32_r8;
-+ unsigned long nds32_r9;
-+ unsigned long nds32_r10;
-+ unsigned long nds32_r11;
-+ unsigned long nds32_r12;
-+ unsigned long nds32_r13;
-+ unsigned long nds32_r14;
-+ unsigned long nds32_r15;
-+ unsigned long nds32_r16;
-+ unsigned long nds32_r17;
-+ unsigned long nds32_r18;
-+ unsigned long nds32_r19;
-+ unsigned long nds32_r20;
-+ unsigned long nds32_r21;
-+ unsigned long nds32_r22;
-+ unsigned long nds32_r23;
-+ unsigned long nds32_r24;
-+ unsigned long nds32_r25;
-+ unsigned long nds32_fp; /* $r28 */
-+ unsigned long nds32_gp; /* $r29 */
-+ unsigned long nds32_lr; /* $r30 */
-+ unsigned long nds32_sp; /* $r31 */
-+ unsigned long nds32_ipc;
-+ unsigned long fault_address;
-+#if defined(CONFIG_FPU)
-+ unsigned long used_math_flag;
-+ /* FPU Registers */
-+ struct fpu_struct fpu;
-+#endif
-+ /* Audio Registers */
-+#if defined(CONFIG_AUDIO)
-+ unsigned long used_audio_flag;
-+ struct audio_struct audio;
-+#endif
-+#if defined(CONFIG_HWZOL)
-+ struct zol_struct zol;
-+#endif
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/siginfo.h linux-3.4.113/arch/nds32/include/asm/siginfo.h
---- linux-3.4.113.orig/arch/nds32/include/asm/siginfo.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/siginfo.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/siginfo.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SIGINFO_H
-+#define _ASMNDS32_SIGINFO_H
-+
-+#include <asm-generic/siginfo.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/signal.h linux-3.4.113/arch/nds32/include/asm/signal.h
---- linux-3.4.113.orig/arch/nds32/include/asm/signal.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/signal.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,173 @@
-+/*
-+ * linux/arch/nds32/include/asm/signal.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SIGNAL_H
-+#define _ASMNDS32_SIGNAL_H
-+
-+#include <linux/types.h>
-+
-+/* Avoid too many header ordering problems. */
-+struct siginfo;
-+
-+#ifdef __KERNEL__
-+/* Most things should be clean enough to redefine this at will, if care
-+ is taken to make libc match. */
-+
-+#define _NSIG 64
-+#define _NSIG_BPW 32
-+#define _NSIG_WORDS (_NSIG / _NSIG_BPW)
-+
-+typedef unsigned long old_sigset_t; /* at least 32 bits */
-+
-+typedef struct {
-+ unsigned long sig[_NSIG_WORDS];
-+} sigset_t;
-+
-+#else
-+/* Here we must cater to libcs that poke about in kernel headers. */
-+
-+#define NSIG 32
-+typedef unsigned long sigset_t;
-+
-+#endif /* __KERNEL__ */
-+
-+#define SIGHUP 1
-+#define SIGINT 2
-+#define SIGQUIT 3
-+#define SIGILL 4
-+#define SIGTRAP 5
-+#define SIGABRT 6
-+#define SIGIOT 6
-+#define SIGBUS 7
-+#define SIGFPE 8
-+#define SIGKILL 9
-+#define SIGUSR1 10
-+#define SIGSEGV 11
-+#define SIGUSR2 12
-+#define SIGPIPE 13
-+#define SIGALRM 14
-+#define SIGTERM 15
-+#define SIGSTKFLT 16
-+#define SIGCHLD 17
-+#define SIGCONT 18
-+#define SIGSTOP 19
-+#define SIGTSTP 20
-+#define SIGTTIN 21
-+#define SIGTTOU 22
-+#define SIGURG 23
-+#define SIGXCPU 24
-+#define SIGXFSZ 25
-+#define SIGVTALRM 26
-+#define SIGPROF 27
-+#define SIGWINCH 28
-+#define SIGIO 29
-+#define SIGPOLL SIGIO
-+/*
-+#define SIGLOST 29
-+*/
-+#define SIGPWR 30
-+#define SIGSYS 31
-+#define SIGUNUSED 31
-+
-+/* These should not be considered constants from userland. */
-+#define SIGRTMIN 32
-+#define SIGRTMAX _NSIG
-+
-+#define SIGSWI 32
-+
-+/*
-+ * SA_FLAGS values:
-+ *
-+ * SA_NOCLDSTOP flag to turn off SIGCHLD when children stop.
-+ * SA_NOCLDWAIT flag on SIGCHLD to inhibit zombies.
-+ * SA_SIGINFO deliver the signal with SIGINFO structs
-+ * SA_THIRTYTWO delivers the signal in 32-bit mode, even if the task
-+ * is running in 26-bit.
-+ * SA_ONSTACK allows alternate signal stacks (see sigaltstack(2)).
-+ * SA_RESTART flag to get restarting signals (which were the default long ago)
-+ * SA_NODEFER prevents the current signal from being masked in the handler.
-+ * SA_RESETHAND clears the handler when the signal is delivered.
-+ *
-+ * SA_ONESHOT and SA_NOMASK are the historical Linux names for the Single
-+ * Unix names RESETHAND and NODEFER respectively.
-+ */
-+#define SA_NOCLDSTOP 0x00000001
-+#define SA_NOCLDWAIT 0x00000002
-+#define SA_SIGINFO 0x00000004
-+#define SA_THIRTYTWO 0x02000000
-+#define SA_RESTORER 0x04000000
-+#define SA_ONSTACK 0x08000000
-+#define SA_RESTART 0x10000000
-+#define SA_NODEFER 0x40000000
-+#define SA_RESETHAND 0x80000000
-+
-+#define SA_NOMASK SA_NODEFER
-+#define SA_ONESHOT SA_RESETHAND
-+
-+
-+/*
-+ * sigaltstack controls
-+ */
-+#define SS_ONSTACK 1
-+#define SS_DISABLE 2
-+
-+#define MINSIGSTKSZ 2048
-+#define SIGSTKSZ 8192
-+
-+#ifdef __KERNEL__
-+#define SA_IRQNOMASK 0x08000000
-+#endif
-+
-+#include <asm-generic/signal-defs.h>
-+
-+#ifdef __KERNEL__
-+struct old_sigaction {
-+ __sighandler_t sa_handler;
-+ old_sigset_t sa_mask;
-+ unsigned long sa_flags;
-+ __sigrestore_t sa_restorer;
-+};
-+
-+struct sigaction {
-+ __sighandler_t sa_handler;
-+ unsigned long sa_flags;
-+ __sigrestore_t sa_restorer;
-+ sigset_t sa_mask; /* mask last for extensibility */
-+};
-+
-+struct k_sigaction {
-+ struct sigaction sa;
-+};
-+
-+#else
-+/* Here we must cater to libcs that poke about in kernel headers. */
-+
-+struct sigaction {
-+ union {
-+ __sighandler_t _sa_handler;
-+ void (*_sa_sigaction)(int, struct siginfo *, void *);
-+ } _u;
-+ sigset_t sa_mask;
-+ unsigned long sa_flags;
-+ void (*sa_restorer)(void);
-+};
-+
-+#define sa_handler _u._sa_handler
-+#define sa_sigaction _u._sa_sigaction
-+
-+#endif /* __KERNEL__ */
-+
-+typedef struct sigaltstack {
-+ void __user *ss_sp;
-+ int ss_flags;
-+ size_t ss_size;
-+} stack_t;
-+
-+#ifdef __KERNEL__
-+#include <asm/sigcontext.h>
-+#define ptrace_signal_deliver(regs, cookie) do { } while (0)
-+#endif
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/sizes.h linux-3.4.113/arch/nds32/include/asm/sizes.h
---- linux-3.4.113.orig/arch/nds32/include/asm/sizes.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/sizes.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,53 @@
-+/*
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ */
-+/* DO NOT EDIT!! - this file automatically generated
-+ * from .s file by awk -f s2h.awk
-+ */
-+/* Size definitions
-+ * Copyright (C) ARM Limited 1998. All rights reserved.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __sizes_h
-+#define __sizes_h 1
-+
-+/* handy sizes */
-+#define SZ_1K 0x00000400
-+#define SZ_4K 0x00001000
-+#define SZ_8K 0x00002000
-+#define SZ_16K 0x00004000
-+#define SZ_64K 0x00010000
-+#define SZ_128K 0x00020000
-+#define SZ_256K 0x00040000
-+#define SZ_512K 0x00080000
-+
-+#define SZ_1M 0x00100000
-+#define SZ_2M 0x00200000
-+#define SZ_4M 0x00400000
-+#define SZ_8M 0x00800000
-+#define SZ_16M 0x01000000
-+#define SZ_32M 0x02000000
-+#define SZ_64M 0x04000000
-+#define SZ_128M 0x08000000
-+#define SZ_256M 0x10000000
-+#define SZ_512M 0x20000000
-+
-+#define SZ_1G 0x40000000
-+#define SZ_2G 0x80000000
-+
-+#endif
-+
-+/* END */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/smp.h linux-3.4.113/arch/nds32/include/asm/smp.h
---- linux-3.4.113.orig/arch/nds32/include/asm/smp.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/smp.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,42 @@
-+/*
-+ * linux/arch/nds32/include/asm/smp.h
-+ *
-+ * Copyright (C) 2004-2005 ARM Ltd.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_NDS32_SMP_H
-+#define __ASM_NDS32_SMP_H
-+
-+#include <linux/threads.h>
-+#include <linux/cpumask.h>
-+#include <linux/thread_info.h>
-+
-+#ifndef CONFIG_SMP
-+# error "<asm-nds32/smp.h> included in non-SMP build"
-+#endif
-+
-+/*
-+ * at the moment, there's not a big penalty for changing CPUs
-+ * (the >big< penalty is running SMP in the first place)
-+ */
-+#define PROC_CHANGE_PENALTY 15
-+
-+struct seq_file;
-+
-+/*
-+ * Move global data into per-processor storage.
-+ */
-+extern void smp_store_cpu_info(unsigned int cpuid);
-+
-+#define raw_smp_processor_id() (unsigned int)(GET_CORE_ID()&CORE_ID_mskCOREID)
-+
-+extern void smp_init_cpus(void);
-+extern void smp_send_timer(void);
-+extern void arch_send_call_function_single_ipi(int cpu);
-+extern void arch_send_call_function_ipi_mask(const struct cpumask *mask);
-+
-+#endif /* ifndef __ASM_NDS32_SMP_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/socket.h linux-3.4.113/arch/nds32/include/asm/socket.h
---- linux-3.4.113.orig/arch/nds32/include/asm/socket.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/socket.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/socket.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SOCKET_H
-+#define _ASMNDS32_SOCKET_H
-+
-+#include <asm-generic/socket.h>
-+
-+#endif /* _ASMNDS32_SOCKET_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/sockios.h linux-3.4.113/arch/nds32/include/asm/sockios.h
---- linux-3.4.113.orig/arch/nds32/include/asm/sockios.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/sockios.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,18 @@
-+/*
-+ * linux/arch/nds32/include/asm/sockios.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ARCH_NDS32_SOCKIOS_H
-+#define __ARCH_NDS32_SOCKIOS_H
-+
-+/* Socket-level I/O control calls. */
-+#define FIOSETOWN 0x8901
-+#define SIOCSPGRP 0x8902
-+#define FIOGETOWN 0x8903
-+#define SIOCGPGRP 0x8904
-+#define SIOCATMARK 0x8905
-+#define SIOCGSTAMP 0x8906 /* Get stamp */
-+#define SIOCGSTAMPNS 0x8907 /* Get stamp (timespec) */
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/spec-ag101.h linux-3.4.113/arch/nds32/include/asm/spec-ag101.h
---- linux-3.4.113.orig/arch/nds32/include/asm/spec-ag101.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/spec-ag101.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,237 @@
-+#ifndef __NDS32_AG101_SPECIFICATION_H__
-+#define __NDS32_AG101_SPECIFICATION_H__
-+
-+#define UART0_PA_BASE 0x99600000
-+#define UART0_VA_BASE 0xF9960000
-+#define UART0_IRQ 7
-+#define UART1_PA_BASE 0x98300000
-+#define UART1_VA_BASE 0xF9830000
-+#define UART1_IRQ 11
-+#define CFC_FTCFC010_0_PA_BASE 0x98D00000
-+#define CFC_FTCFC010_0_VA_BASE 0xF98D0000
-+#define SDC_FTSDC010_0_PA_BASE 0x98e00000
-+#define SDC_FTSDC010_0_VA_BASE 0xF98e0000
-+#define SDMC_FTSDMC021_PA_BASE 0x90300000
-+#define SDMC_FTSDMC021_VA_BASE 0xF9030000
-+#define PCIC_FTPCI100_0_PA_BASE 0x90C00000
-+#define PCIC_FTPCI100_0_VA_BASE 0xF90C0000
-+#define PCIC_FTPCI100_0_VA_LIMIT 0xF90CFFFF
-+#define PCIIO_PA_BASE 0x90C01000
-+#define PCIIO_VA_BASE 0xFE901000
-+#define PCIIO_0_PA_BASE 0x90C01000
-+#define PCIIO_0_VA_BASE 0xFE901000
-+#define PCIIO_VA_LIMIT 0xFE9FFFFF
-+#define AHB_ATFAHBC020S_0_PA_BASE 0x90100000
-+#define AHB_ATFAHBC020S_0_VA_BASE 0xF9010000
-+
-+/* DMAC */
-+#define DMAC_FTDMAC020_PA_COUNT 1
-+#define DMAC_FTDMAC020_PA_BASE 0x90400000
-+#define DMAC_FTDMAC020_PA_LIMIT 0x90400FFF
-+#define DMAC_FTDMAC020_PA_SIZE 0x00001000
-+#define DMAC_FTDMAC020_0_PA_BASE 0x90400000
-+#define DMAC_FTDMAC020_0_PA_LIMIT 0x90400FFF
-+#define DMAC_FTDMAC020_0_PA_SIZE 0x00001000
-+#define DMAC_FTDMAC020_VA_COUNT 1
-+#define DMAC_FTDMAC020_VA_BASE 0xF9040000
-+#define DMAC_FTDMAC020_VA_LIMIT 0xF9040FFF
-+#define DMAC_FTDMAC020_VA_SIZE 0x00001000
-+#define DMAC_FTDMAC020_0_VA_BASE 0xF9040000
-+#define DMAC_FTDMAC020_0_VA_LIMIT 0xF9040FFF
-+#define DMAC_FTDMAC020_0_VA_SIZE 0x00001000
-+
-+/* TIMER */
-+#define TIMER_FTTMR010_PA_COUNT 1
-+#define TIMER_FTTMR010_PA_BASE 0x98400000
-+#define TIMER_FTTMR010_PA_LIMIT 0x98400FFF
-+#define TIMER_FTTMR010_PA_SIZE 0x00001000
-+#define TIMER_FTTMR010_0_PA_BASE 0x98400000
-+#define TIMER_FTTMR010_0_PA_LIMIT 0x98400FFF
-+#define TIMER_FTTMR010_0_PA_SIZE 0x00001000
-+#define TIMER_FTTMR010_VA_COUNT 1
-+#define TIMER_FTTMR010_VA_BASE 0xF9840000
-+#define TIMER_FTTMR010_VA_LIMIT 0xF9840FFF
-+#define TIMER_FTTMR010_VA_SIZE 0x00001000
-+#define TIMER_FTTMR010_0_VA_BASE 0xF9840000
-+#define TIMER_FTTMR010_0_VA_LIMIT 0xF9840FFF
-+#define TIMER_FTTMR010_0_VA_SIZE 0x00001000
-+
-+/* RTC */
-+#define RTC_FTRTC010_PA_COUNT 1
-+#define RTC_FTRTC010_PA_BASE 0x98600000
-+#define RTC_FTRTC010_PA_LIMIT 0x98600FFF
-+#define RTC_FTRTC010_PA_SIZE 0x00001000
-+#define RTC_FTRTC010_0_PA_BASE 0x98600000
-+#define RTC_FTRTC010_0_PA_LIMIT 0x98600FFF
-+#define RTC_FTRTC010_0_PA_SIZE 0x00001000
-+#define RTC_FTRTC010_VA_COUNT 1
-+#define RTC_FTRTC010_VA_BASE 0xF9860000
-+#define RTC_FTRTC010_VA_LIMIT 0xF9860FFF
-+#define RTC_FTRTC010_VA_SIZE 0x00001000
-+#define RTC_FTRTC010_0_VA_BASE 0xF9860000
-+#define RTC_FTRTC010_0_VA_LIMIT 0xF9860FFF
-+#define RTC_FTRTC010_0_VA_SIZE 0x00001000
-+
-+/* WDT */
-+#define WDT_FTWDT010_PA_COUNT 1
-+#define WDT_FTWDT010_PA_BASE 0x98500000
-+#define WDT_FTWDT010_PA_LIMIT 0x98500FFF
-+#define WDT_FTWDT010_PA_SIZE 0x00001000
-+#define WDT_FTWDT010_0_PA_BASE 0x98500000
-+#define WDT_FTWDT010_0_PA_LIMIT 0x98500FFF
-+#define WDT_FTWDT010_0_PA_SIZE 0x00001000
-+#define WDT_FTWDT010_VA_COUNT 1
-+#define WDT_FTWDT010_VA_BASE 0xF9850000
-+#define WDT_FTWDT010_VA_LIMIT 0xF9850FFF
-+#define WDT_FTWDT010_VA_SIZE 0x00001000
-+#define WDT_FTWDT010_0_VA_BASE 0xF9850000
-+#define WDT_FTWDT010_0_VA_LIMIT 0xF9850FFF
-+#define WDT_FTWDT010_0_VA_SIZE 0x00001000
-+
-+/* GPIO */
-+#define GPIO_FTGPIO010_PA_COUNT 1
-+#define GPIO_FTGPIO010_PA_BASE 0x98700000
-+#define GPIO_FTGPIO010_PA_LIMIT 0x98700FFF
-+#define GPIO_FTGPIO010_PA_SIZE 0x00001000
-+#define GPIO_FTGPIO010_0_PA_BASE 0x98700000
-+#define GPIO_FTGPIO010_0_PA_LIMIT 0x98700FFF
-+#define GPIO_FTGPIO010_0_PA_SIZE 0x00001000
-+#define GPIO_FTGPIO010_VA_COUNT 1
-+#define GPIO_FTGPIO010_VA_BASE 0xF9870000
-+#define GPIO_FTGPIO010_VA_LIMIT 0xF9870FFF
-+#define GPIO_FTGPIO010_VA_SIZE 0x00001000
-+#define GPIO_FTGPIO010_0_VA_BASE 0xF9870000
-+#define GPIO_FTGPIO010_0_VA_LIMIT 0xF9870FFF
-+#define GPIO_FTGPIO010_0_VA_SIZE 0x00001000
-+
-+
-+/* USB OTG */
-+#define USB_FOTG2XX_0_PA_COUNT 1
-+#define USB_FOTG2XX_0_PA_BASE 0x90B00000
-+#define USB_FOTG2XX_0_PA_LIMIT 0x90B00FFF
-+#define USB_FOTG2XX_0_PA_SIZE 0x00001000
-+#define USB_FOTG2XX_0_VA_BASE 0xF90B0000
-+#define USB_FOTG2XX_0_VA_LIMIT 0xF90B0FFF
-+#define USB_FOTG2XX_0_VA_SIZE 0x00001000
-+#define USB_FOTG2XX_0_IRQ 26
-+#define USB_FOTG2XX_PA_COUNT 1
-+#define USB_FOTG2XX_PA_BASE 0x90B00000
-+#define USB_FOTG2XX_PA_LIMIT 0x90B00FFF
-+#define USB_FOTG2XX_PA_SIZE 0x00001000
-+#define USB_FOTG2XX_VA_BASE 0xF90B0000
-+#define USB_FOTG2XX_VA_LIMIT 0xF90B0FFF
-+#define USB_FOTG2XX_VA_SIZE 0x00001000
-+#define USB_FOTG2XX_IRQ 26
-+#define USB_FOTG2XX_IRQ_COUNT 1
-+
-+/* SSP */
-+#define SSP_FTSSP010_PA_COUNT 1
-+#define SSP_FTSSP010_PA_BASE 0x99400000
-+#define SSP_FTSSP010_PA_LIMIT 0x99400FFF
-+#define SSP_FTSSP010_PA_SIZE 0x00001000
-+#define SSP_FTSSP010_0_PA_BASE 0x99400000
-+#define SSP_FTSSP010_0_PA_LIMIT 0x99400FFF
-+#define SSP_FTSSP010_0_PA_SIZE 0x00001000
-+#define SSP_FTSSP010_VA_COUNT 1
-+#define SSP_FTSSP010_VA_BASE 0xF9940000
-+#define SSP_FTSSP010_VA_LIMIT 0xF9940FFF
-+#define SSP_FTSSP010_VA_SIZE 0x00001000
-+#define SSP_FTSSP010_0_VA_BASE 0xF9940000
-+#define SSP_FTSSP010_0_VA_LIMIT 0xF9940FFF
-+#define SSP_FTSSP010_0_VA_SIZE 0x00001000
-+
-+/* APBBRG */
-+#define APBBRG_FTAPBBRG020S_PA_COUNT 1
-+#define APBBRG_FTAPBBRG020S_PA_BASE 0x90500000
-+#define APBBRG_FTAPBBRG020S_PA_LIMIT 0x90500FFF
-+#define APBBRG_FTAPBBRG020S_PA_SIZE 0x00001000
-+#define APBBRG_FTAPBBRG020S_0_PA_BASE 0x90500000
-+#define APBBRG_FTAPBBRG020S_0_PA_LIMIT 0x90500FFF
-+#define APBBRG_FTAPBBRG020S_0_PA_SIZE 0x00001000
-+#define APBBRG_FTAPBBRG020S_1_PA_BASE 0x90E00000
-+#define APBBRG_FTAPBBRG020S_1_PA_LIMIT 0x90E00FFF
-+#define APBBRG_FTAPBBRG020S_1_PA_SIZE 0x00001000
-+#define APBBRG_FTAPBBRG020S_VA_COUNT 1
-+#define APBBRG_FTAPBBRG020S_VA_BASE 0xF9050000
-+#define APBBRG_FTAPBBRG020S_VA_LIMIT 0xF9050FFF
-+#define APBBRG_FTAPBBRG020S_VA_SIZE 0x00001000
-+#define APBBRG_FTAPBBRG020S_0_VA_BASE 0xF9050000
-+#define APBBRG_FTAPBBRG020S_0_VA_LIMIT 0xF9050FFF
-+#define APBBRG_FTAPBBRG020S_0_VA_SIZE 0x00001000
-+#define APBBRG_FTAPBBRG020S_1_VA_BASE 0xF90E0000
-+#define APBBRG_FTAPBBRG020S_1_VA_LIMIT 0xF90E0FFF
-+#define APBBRG_FTAPBBRG020S_1_VA_SIZE 0x00001000
-+
-+/* I2C */
-+#define I2C_FTI2C010_PA_COUNT 1
-+#define I2C_FTI2C010_PA_BASE 0x98A00000
-+#define I2C_FTI2C010_PA_LIMIT 0x98A00FFF
-+#define I2C_FTI2C010_PA_SIZE 0x00001000
-+#define I2C_FTI2C010_0_PA_BASE 0x98A00000
-+#define I2C_FTI2C010_0_PA_LIMIT 0x98A00FFF
-+#define I2C_FTI2C010_0_PA_SIZE 0x00001000
-+#define I2C_FTI2C010_VA_COUNT 1
-+#define I2C_FTI2C010_VA_BASE 0xF98A0000
-+#define I2C_FTI2C010_VA_LIMIT 0xF98A0FFF
-+#define I2C_FTI2C010_VA_SIZE 0x00001000
-+#define I2C_FTI2C010_0_VA_BASE 0xF98A0000
-+#define I2C_FTI2C010_0_VA_LIMIT 0xF98A0FFF
-+#define I2C_FTI2C010_0_VA_SIZE 0x00001000
-+
-+/* L2CC */
-+#define L2CC_PA_BASE 0x90F00000 /* reserved */
-+#define L2CC_VA_BASE 0xF90F0000 /* FIXME */
-+
-+#define LED_PA_COUNT 1
-+#define LED_PA_BASE 0x902FF000
-+#define LED_PA_LIMIT 0x90200FFF
-+#define LED_PA_SIZE 0x00001000
-+#define LED_0_PA_BASE 0x90200000
-+#define LED_0_PA_LIMIT 0x90200FFF
-+#define LED_0_PA_SIZE 0x00001000
-+#define LED_VA_COUNT 1
-+#define LED_VA_BASE 0xF9020000
-+#define LED_VA_LIMIT 0xF9020000
-+#define LED_VA_SIZE 0x00001000
-+#define LED_0_VA_BASE 0xF9020000
-+#define LED_0_VA_LIMIT 0xF9020000
-+#define LED_0_VA_SIZE 0x00001000
-+
-+/* MAC */
-+#define MAC_FTMAC100_PA_COUNT 1
-+#define MAC_FTMAC100_PA_BASE 0x90900000
-+#define MAC_FTMAC100_PA_LIMIT 0x90900FFF
-+#define MAC_FTMAC100_PA_SIZE 0x00001000
-+#define MAC_FTMAC100_0_PA_BASE 0x90900000
-+#define MAC_FTMAC100_0_PA_LIMIT 0x90900FFF
-+#define MAC_FTMAC100_0_PA_SIZE 0x00001000
-+#define MAC_FTMAC100_1_PA_BASE 0x92000000
-+#define MAC_FTMAC100_1_PA_LIMIT 0x92000FFF
-+#define MAC_FTMAC100_1_PA_SIZE 0x00001000
-+#define MAC_FTMAC100_VA_COUNT 1
-+#define MAC_FTMAC100_VA_BASE 0xF9090000
-+#define MAC_FTMAC100_VA_LIMIT 0xF9090FFF
-+#define MAC_FTMAC100_VA_SIZE 0x00001000
-+#define MAC_FTMAC100_0_VA_BASE 0xF9090000
-+#define MAC_FTMAC100_0_VA_LIMIT 0xF9090FFF
-+#define MAC_FTMAC100_0_VA_SIZE 0x00001000
-+#define MAC_FTMAC100_1_VA_BASE 0xF9200000
-+#define MAC_FTMAC100_1_VA_LIMIT 0xF9200FFF
-+#define MAC_FTMAC100_1_VA_SIZE 0x00001000
-+
-+/* LCD */
-+#define LCD_FTLCDC100_PA_COUNT 1
-+#define LCD_FTLCDC100_PA_BASE 0x90600000
-+#define LCD_FTLCDC100_PA_LIMIT 0x90600FFF
-+#define LCD_FTLCDC100_PA_SIZE 0x00001000
-+#define LCD_FTLCDC100_0_PA_BASE 0x90600000
-+#define LCD_FTLCDC100_0_PA_LIMIT 0x90600FFF
-+#define LCD_FTLCDC100_0_PA_SIZE 0x00001000
-+#define LCD_FTLCDC100_VA_COUNT 1
-+#define LCD_FTLCDC100_VA_BASE 0xF9060000
-+#define LCD_FTLCDC100_VA_LIMIT 0xF9060FFF
-+#define LCD_FTLCDC100_VA_SIZE 0x00001000
-+#define LCD_FTLCDC100_0_VA_BASE 0xF9060000
-+#define LCD_FTLCDC100_0_VA_LIMIT 0xF9060FFF
-+#define LCD_FTLCDC100_0_VA_SIZE 0x00001000
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/spec-ag102.h linux-3.4.113/arch/nds32/include/asm/spec-ag102.h
---- linux-3.4.113.orig/arch/nds32/include/asm/spec-ag102.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/spec-ag102.h 2016-12-01 20:59:24.344612443 +0100
-@@ -0,0 +1,167 @@
-+#ifndef __NDS32_AG102_SPECIFICATION_H__
-+#define __NDS32_AG102_SPECIFICATION_H__
-+
-+#define UART0_PA_BASE 0x94200000
-+#define UART0_VA_BASE 0xF9420000
-+#define UART0_IRQ 10
-+#define UART1_PA_BASE 0x94600000
-+#define UART1_VA_BASE 0xF9460000
-+#define UART1_IRQ 11
-+#define AMIC_PA_BASE 0x90F00000
-+#define AMIC_VA_BASE 0xF90F0000
-+#define GMAC_PA_BASE 0x90B00000
-+#define GMAC_VA_BASE 0xF90B0000
-+#define APBBR_PA_BASE 0x90D00000
-+#define APBBR_VA_BASE 0xF90D0000
-+#define GMAC_IRQ 25
-+#define TIMER_PA_BASE 0x94900000
-+#define TIMER_VA_BASE 0xF9490000
-+#define L2CC_PA_BASE 0x90900000
-+#define L2CC_VA_BASE 0xF9090000
-+#define CFC_FTCFC010_0_PA_BASE 0x94000000
-+#define CFC_FTCFC010_0_VA_BASE 0xF9400000
-+#define SDC_FTSDC010_0_PA_BASE 0x94400000
-+#define SDC_FTSDC010_0_VA_BASE 0xF9440000
-+#define PCU_PA_BASE 0x94800000
-+#define PCU_VA_BASE 0xF9480000
-+#define PCIC_FTPCI100_0_PA_BASE 0x90000000
-+#define PCIC_FTPCI100_0_VA_BASE 0xF9000000
-+#define PCIC_FTPCI100_0_VA_LIMIT 0xF9000FFF
-+#define PCIIO_PA_BASE 0x90001000
-+#define PCIIO_VA_BASE 0xF8901000
-+#define PCIIO_0_PA_BASE 0x90001000
-+#define PCIIO_0_VA_BASE 0xF8901000
-+#define PCIIO_VA_LIMIT 0xF89FFFFF
-+#define LPC_IO_PA_BASE 0x90100000
-+#define LPC_IO_VA_BASE 0xF9010000
-+#define LPC_REG_PA_BASE 0x90200000
-+#define LPC_REG_VA_BASE 0xF9020000
-+#define LPC_IRQ 29
-+#define GPU_PA_BASE 0x90A00000
-+#define GPU_VA_BASE 0xFEA00000
-+#define IDE_FTIDE020_VA_BASE 0xF9070000
-+#define IDE_FTIDE020_PA_BASE 0x90700000
-+#define IDE_FTIDE020_IRQ 1
-+#define USB_FOTG2XX_0_PA_BASE 0x90800000
-+#define USB_FOTG2XX_0_VA_BASE 0xF9080000
-+#define USB_FOTG2XX_0_IRQ 26
-+#define DDR2C_PA_BASE 0x90500000
-+#define DDR2C_VA_BASE 0xF9050000
-+#define GPIO_VA_BASE 0xF94C0000
-+#define GPIO_PA_BASE 0x94C00000
-+
-+#define PLATFORM_LPC_IRQ_BASE 180
-+#define PLATFORM_LPC_IRQ_TOTALCOUNT 22
-+
-+/* DMAC */
-+#define DMAC_FTDMAC020_PA_COUNT 1
-+#define DMAC_FTDMAC020_PA_BASE 0x90600000
-+#define DMAC_FTDMAC020_PA_LIMIT 0x90600FFF
-+#define DMAC_FTDMAC020_PA_SIZE 0x00001000
-+#define DMAC_FTDMAC020_0_PA_BASE 0x90600000
-+#define DMAC_FTDMAC020_0_PA_LIMIT 0x90600FFF
-+#define DMAC_FTDMAC020_0_PA_SIZE 0x00001000
-+#define DMAC_FTDMAC020_VA_COUNT 1
-+#define DMAC_FTDMAC020_VA_BASE 0xF9060000
-+#define DMAC_FTDMAC020_VA_LIMIT 0xF9060FFF
-+#define DMAC_FTDMAC020_VA_SIZE 0x00001000
-+#define DMAC_FTDMAC020_0_VA_BASE 0xF9060000
-+#define DMAC_FTDMAC020_0_VA_LIMIT 0xF9060FFF
-+#define DMAC_FTDMAC020_0_VA_SIZE 0x00001000
-+
-+/* TIMER */
-+#define TIMER_FTTMR010_PA_COUNT 1
-+#define TIMER_FTTMR010_PA_BASE 0x94900000
-+#define TIMER_FTTMR010_PA_LIMIT 0x94900FFF
-+#define TIMER_FTTMR010_PA_SIZE 0x00001000
-+#define TIMER_FTTMR010_0_PA_BASE 0x94900000
-+#define TIMER_FTTMR010_0_PA_LIMIT 0x94900FFF
-+#define TIMER_FTTMR010_0_PA_SIZE 0x00001000
-+#define TIMER_FTTMR010_VA_COUNT 1
-+#define TIMER_FTTMR010_VA_BASE 0xF9490000
-+#define TIMER_FTTMR010_VA_LIMIT 0xF9490FFF
-+#define TIMER_FTTMR010_VA_SIZE 0x00001000
-+#define TIMER_FTTMR010_0_VA_BASE 0xF9490000
-+#define TIMER_FTTMR010_0_VA_LIMIT 0xF9490FFF
-+#define TIMER_FTTMR010_0_VA_SIZE 0x00001000
-+
-+/* WDT */
-+#define WDT_FTWDT010_PA_COUNT 1
-+#define WDT_FTWDT010_PA_BASE 0x94A00000
-+#define WDT_FTWDT010_PA_LIMIT 0x94A00FFF
-+#define WDT_FTWDT010_PA_SIZE 0x00001000
-+#define WDT_FTWDT010_0_PA_BASE 0x94A00000
-+#define WDT_FTWDT010_0_PA_LIMIT 0x94A00FFF
-+#define WDT_FTWDT010_0_PA_SIZE 0x00001000
-+#define WDT_FTWDT010_VA_COUNT 1
-+#define WDT_FTWDT010_VA_BASE 0xF94A0000
-+#define WDT_FTWDT010_VA_LIMIT 0xF94A0FFF
-+#define WDT_FTWDT010_VA_SIZE 0x00001000
-+#define WDT_FTWDT010_0_VA_BASE 0xF94A0000
-+#define WDT_FTWDT010_0_VA_LIMIT 0xF94A0FFF
-+#define WDT_FTWDT010_0_VA_SIZE 0x00001000
-+
-+/* RTC */
-+#define RTC_FTRTC010_PA_COUNT 1
-+#define RTC_FTRTC010_PA_BASE 0x94B00000
-+#define RTC_FTRTC010_PA_LIMIT 0x94B00FFF
-+#define RTC_FTRTC010_PA_SIZE 0x00001000
-+#define RTC_FTRTC010_0_PA_BASE 0x94B00000
-+#define RTC_FTRTC010_0_PA_LIMIT 0x94B00FFF
-+#define RTC_FTRTC010_0_PA_SIZE 0x00001000
-+#define RTC_FTRTC010_VA_COUNT 1
-+#define RTC_FTRTC010_VA_BASE 0xF94B0000
-+#define RTC_FTRTC010_VA_LIMIT 0xF94B0FFF
-+#define RTC_FTRTC010_VA_SIZE 0x00001000
-+#define RTC_FTRTC010_0_VA_BASE 0xF94B0000
-+#define RTC_FTRTC010_0_VA_LIMIT 0xF94B0FFF
-+#define RTC_FTRTC010_0_VA_SIZE 0x00001000
-+
-+/* GPIO */
-+#define GPIO_FTGPIO010_PA_COUNT 1
-+#define GPIO_FTGPIO010_PA_BASE 0x94C00000
-+#define GPIO_FTGPIO010_PA_LIMIT 0x94C00FFF
-+#define GPIO_FTGPIO010_PA_SIZE 0x00001000
-+#define GPIO_FTGPIO010_0_PA_BASE 0x94C00000
-+#define GPIO_FTGPIO010_0_PA_LIMIT 0x94C00FFF
-+#define GPIO_FTGPIO010_0_PA_SIZE 0x00001000
-+#define GPIO_FTGPIO010_VA_COUNT 1
-+#define GPIO_FTGPIO010_VA_BASE 0xF94C0000
-+#define GPIO_FTGPIO010_VA_LIMIT 0xF94C0FFF
-+#define GPIO_FTGPIO010_VA_SIZE 0x00001000
-+#define GPIO_FTGPIO010_0_VA_BASE 0xF94C0000
-+#define GPIO_FTGPIO010_0_VA_LIMIT 0xF94C0FFF
-+#define GPIO_FTGPIO010_0_VA_SIZE 0x00001000
-+
-+/* SSP */
-+#define SSP_FTSSP010_PA_BASE 0x94500000
-+#define SSP_FTSSP010_0_PA_BASE 0x94500000
-+#define SSP_FTSSP010_VA_BASE 0xF9450000
-+#define SSP_FTSSP010_0_VA_BASE 0xF9450000
-+
-+/* SPI */
-+#define SPI_FTSSP010_PA_BASE 0x94100000
-+#define SPI_FTSSP010_0_PA_BASE 0x94100000
-+#define SPI_FTSSP010_VA_BASE 0xF9410000
-+#define SPI_FTSSP010_0_VA_BASE 0xF9410000
-+
-+/* AHB Controller */
-+#define AHB_ATFAHBC020S_0_PA_BASE 0x90C00000
-+#define AHB_ATFAHBC020S_0_VA_BASE 0xF90C0000
-+
-+#define I2C_FTI2C010_PA_COUNT 1
-+#define I2C_FTI2C010_PA_BASE 0x94E00000
-+#define I2C_FTI2C010_PA_LIMIT 0x94E00FFF
-+#define I2C_FTI2C010_PA_SIZE 0x00001000
-+#define I2C_FTI2C010_0_PA_BASE 0x94E00000
-+#define I2C_FTI2C010_0_PA_LIMIT 0x94E00FFF
-+#define I2C_FTI2C010_0_PA_SIZE 0x00001000
-+#define I2C_FTI2C010_VA_COUNT 1
-+#define I2C_FTI2C010_VA_BASE 0xF94E0000
-+#define I2C_FTI2C010_VA_LIMIT 0xF94E0FFF
-+#define I2C_FTI2C010_VA_SIZE 0x00001000
-+#define I2C_FTI2C010_0_VA_BASE 0xF94E0000
-+#define I2C_FTI2C010_0_VA_LIMIT 0xF94E0FFF
-+#define I2C_FTI2C010_0_VA_SIZE 0x00001000
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/spec.h linux-3.4.113/arch/nds32/include/asm/spec.h
---- linux-3.4.113.orig/arch/nds32/include/asm/spec.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/spec.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,510 @@
-+/*
-+ * linux/arch/nds32/include/asm/spec.h
-+ *
-+ * AG101 Platform Independent Specification
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/14/2005 Created.
-+ * 09/15/2005 Completed.
-+ */
-+
-+#ifndef __FARADAY_PLATFORM_INDEPENDENT_SPECIFICATION__
-+#define __FARADAY_PLATFORM_INDEPENDENT_SPECIFICATION__
-+
-+#include <asm/glue.h>
-+#ifdef CONFIG_PLAT_AG102
-+#include <asm/spec-ag102.h>
-+#else
-+#include <asm/spec-ag101.h>
-+#endif
-+
-+/*
-+ * Platform dependent specification
-+ */
-+#define PLATFORM_NAME "Andes AG101"
-+
-+/*
-+ * Component counts
-+ */
-+
-+/* INTC */
-+#define INTC_COUNT 2
-+#define INTC_FTINTC010_COUNT 2
-+/* TIMER */
-+#define TIMER_COUNT 1
-+#define TIMER_FTTMR010_COUNT 1
-+/* SSP */
-+#define SSP_COUNT 1
-+#define SSP_FTSSP010_COUNT 1
-+/* PMU */
-+#define PMU_COUNT 1
-+#define PMU_FTPMU010_COUNT 1
-+/* MAC */
-+#define MAC_COUNT 1
-+#define MAC_FTMAC100_COUNT 1
-+
-+/* SDC */
-+#define SDC_COUNT 1
-+#define SDC_FTSDC010_COUNT 1
-+/* AHBDMA */
-+#define AHBDMA_COUNT 1
-+/* APBDMA */
-+#define APBDMA_COUNT 1
-+/* RTC */
-+#define RTC_COUNT 1
-+#define RTC_FTRTC010_COUNT 1
-+/* WDT */
-+#define WDT_COUNT 1
-+#define WDT_FTWDT010_COUNT 1
-+/* GPIO */
-+#define GPIO_COUNT 1
-+#define GPIO_FTGPIO010_COUNT 1
-+/* CFC */
-+#define CFC_COUNT 1
-+#define CFC_FTCFC010_COUNT 1
-+/* LCD */
-+#define LCD_COUNT 1
-+#define LCD_FTLCDC100_COUNT 1
-+/* I2C */
-+#define I2C_COUNT 1
-+#define I2C_FTI2C010_COUNT 1
-+/* USB */
-+#define USB_COUNT 3
-+#define USB_FOTG2XX_COUNT 1
-+#define USB_FUSBH200_COUNT 1
-+#define USB_FUSB220_COUNT 1
-+/* DMAC */
-+#define DMAC_COUNT 1
-+#define DMAC_FTDMAC020_COUNT 1
-+/* KMI */
-+#define KMI_COUNT 2
-+#define KMI_FTKBC010_COUNT 2
-+/* PCI */
-+#define PCI_COUNT 1
-+/* PCIMEM */
-+#define PCIMEM_COUNT 1
-+/* PCIIO */
-+#define PCIIO_COUNT 1
-+/* PCIC */
-+#define PCIC_COUNT 1
-+#define PCIC_FTPCI100_COUNT 1
-+
-+/*
-+ * Hierarchial Component IDs
-+ */
-+
-+#define PLATFORM_AHBDMA_DMAC_FTDMAC020_ID 0
-+#define PLATFORM_APBDMA_APBBRG_FTAPBBRG020S_ID 0
-+
-+/*
-+ * Number of interrupts
-+ */
-+
-+#define PLATFORM_IRQ_TOTALCOUNT 32
-+#define PLATFORM_AHBDMA_IRQ_TOTALCOUNT 8
-+#define PLATFORM_APBDMA_IRQ_TOTALCOUNT 4
-+
-+#define PLATFORM_IRQ_BASE 0
-+#define PLATFORM_AHBDMA_IRQ_BASE 64
-+#define PLATFORM_APBDMA_IRQ_BASE 72
-+#define PLATFORM_PCI_IRQ_BASE 176
-+#define PLATFORM_INTERRUPTS 202
-+
-+/*
-+ * IRQ trigger level and trigger mode
-+ */
-+
-+#define PLATFORM_IRQ_TRIGGER_MODE 0x000EC880
-+#define PLATFORM_IRQ_TRIGGER_LEVEL 0x10000000
-+#define PLATFORM_AHBDMA_IRQ_TRIGGER_MODE 0x00000000
-+#define PLATFORM_AHBDMA_IRQ_TRIGGER_LEVEL 0xFFFFFFFF
-+#define PLATFORM_APBDMA_IRQ_TRIGGER_MODE 0x00000000
-+#define PLATFORM_APBDMA_IRQ_TRIGGER_LEVEL 0xFFFFFFFF
-+
-+/*
-+ * Interrupt numbers of Hierarchical Architecture
-+ */
-+
-+/* AHBDMA */
-+#define PLATFORM_AHBDMA_IRQ 21
-+
-+/* APBDMA */
-+#define PLATFORM_APBDMA_IRQ 24
-+
-+/* PCI */
-+#ifdef CONFIG_XC5_PCI
-+#define PLATFORM_PCI_IRQ 10
-+#else
-+#define PLATFORM_PCI_IRQ 28
-+#endif
-+
-+
-+/*
-+ * Interrrupt numbers
-+ */
-+
-+/* TIMER */
-+#define TIMER_FTTMR010_IRQ_COUNT 3
-+#define TIMER_FTTMR010_IRQ0 19
-+#define TIMER_FTTMR010_0_IRQ0 19
-+#define TIMER_FTTMR010_IRQ1 14
-+#define TIMER_FTTMR010_0_IRQ1 14
-+#define TIMER_FTTMR010_IRQ2 15
-+#define TIMER_FTTMR010_0_IRQ2 15
-+
-+/* SSP */
-+#define SSP_FTSSP010_IRQ_COUNT 1
-+#define SSP_FTSSP010_IRQ 6
-+#define SSP_FTSSP010_0_IRQ 6
-+
-+/* MAC */
-+#define MAC_FTMAC100_IRQ_COUNT 1
-+#define MAC_FTMAC100_IRQ 25
-+#define MAC_FTMAC100_0_IRQ 25
-+#define MAC_FTMAC100_1_IRQ 133
-+
-+/* SDC */
-+#define SDC_FTSDC010_IRQ_COUNT 1
-+#define SDC_FTSDC010_IRQ 5
-+#define SDC_FTSDC010_0_IRQ 5
-+
-+/* RTC */
-+#define RTC_FTRTC010_IRQ_COUNT 2
-+#define RTC_FTRTC010_IRQ0 17
-+#define RTC_FTRTC010_0_IRQ0 17
-+#define RTC_FTRTC010_IRQ1 18
-+#define RTC_FTRTC010_0_IRQ1 18
-+
-+/* WDT */
-+#define WDT_FTWDT010_IRQ_COUNT 1
-+#define WDT_FTWDT010_IRQ 16
-+#define WDT_FTWDT010_0_IRQ 16
-+
-+/* GPIO */
-+#define GPIO_FTGPIO010_IRQ_COUNT 1
-+#define GPIO_FTGPIO010_IRQ 13
-+#define GPIO_FTGPIO010_0_IRQ 13
-+
-+/* CFC */
-+#define CFC_FTCFC010_IRQ_COUNT 2
-+#define CFC_FTCFC010_IRQ0 0
-+#define CFC_FTCFC010_0_IRQ0 0
-+#define CFC_FTCFC010_IRQ1 1
-+#define CFC_FTCFC010_0_IRQ1 1
-+
-+/* LCD */
-+#define LCD_FTLCDC100_IRQ_COUNT 1
-+#define LCD_FTLCDC100_IRQ 20
-+#define LCD_FTLCDC100_0_IRQ 20
-+
-+/* I2C */
-+#define I2C_FTI2C010_IRQ_COUNT 1
-+#define I2C_FTI2C010_IRQ 3
-+#define I2C_FTI2C010_0_IRQ 3
-+
-+/* USB */
-+#define USB_FUSBH200_IRQ_COUNT 1
-+#define USB_FUSBH200_IRQ 29
-+#define USB_FUSBH200_0_IRQ 29
-+#define USB_FUSB220_IRQ_COUNT 1
-+#define USB_FUSB220_IRQ 26
-+#define USB_FUSB220_0_IRQ 26
-+
-+/* DMAC */
-+#define DMAC_FTDMAC020_IRQ_COUNT 8
-+#define DMAC_FTDMAC020_IRQ0 64
-+#define DMAC_FTDMAC020_0_IRQ0 64
-+#define DMAC_FTDMAC020_IRQ1 65
-+#define DMAC_FTDMAC020_0_IRQ1 65
-+#define DMAC_FTDMAC020_IRQ2 66
-+#define DMAC_FTDMAC020_0_IRQ2 66
-+#define DMAC_FTDMAC020_IRQ3 67
-+#define DMAC_FTDMAC020_0_IRQ3 67
-+#define DMAC_FTDMAC020_IRQ4 68
-+#define DMAC_FTDMAC020_0_IRQ4 68
-+#define DMAC_FTDMAC020_IRQ5 69
-+#define DMAC_FTDMAC020_0_IRQ5 69
-+#define DMAC_FTDMAC020_IRQ6 70
-+#define DMAC_FTDMAC020_0_IRQ6 70
-+#define DMAC_FTDMAC020_IRQ7 71
-+#define DMAC_FTDMAC020_0_IRQ7 71
-+
-+/* APBBRG */
-+#define APBBRG_FTAPBBRG020S_IRQ_COUNT 4
-+#define APBBRG_FTAPBBRG020S_IRQ0 72
-+#define APBBRG_FTAPBBRG020S_0_IRQ0 72
-+#define APBBRG_FTAPBBRG020S_IRQ1 73
-+#define APBBRG_FTAPBBRG020S_0_IRQ1 73
-+#define APBBRG_FTAPBBRG020S_IRQ2 74
-+#define APBBRG_FTAPBBRG020S_0_IRQ2 74
-+#define APBBRG_FTAPBBRG020S_IRQ3 75
-+#define APBBRG_FTAPBBRG020S_0_IRQ3 75
-+#define APBBRG_FTAPBBRG020S_1_IRQ0 172
-+#define APBBRG_FTAPBBRG020S_1_IRQ1 173
-+#define APBBRG_FTAPBBRG020S_1_IRQ2 174
-+#define APBBRG_FTAPBBRG020S_1_IRQ3 175
-+
-+/* KMI */
-+#define KMI_FTKBC010_IRQ_COUNT 1
-+#define KMI_FTKBC010_IRQ 30
-+#define KMI_FTKBC010_0_IRQ 30
-+#define KMI_FTKBC010_1_IRQ 31
-+
-+/* PCIC */
-+#define PCIC_FTPCI100_IRQ_COUNT 4
-+#define PCIC_FTPCI100_IRQ0 176
-+#define PCIC_FTPCI100_0_IRQ0 176
-+#define PCIC_FTPCI100_IRQ1 177
-+#define PCIC_FTPCI100_0_IRQ1 177
-+#define PCIC_FTPCI100_IRQ2 178
-+#define PCIC_FTPCI100_0_IRQ2 178
-+#define PCIC_FTPCI100_IRQ3 179
-+#define PCIC_FTPCI100_0_IRQ3 179
-+
-+/*
-+ * Base addresses
-+ */
-+
-+/* CPU */
-+#define CPU_MEM_PA_BASE CONFIG_MEMORY_START
-+
-+
-+/* INTC */
-+#define INTC_FTINTC010_PA_COUNT 1
-+#define INTC_FTINTC010_PA_BASE 0x98800000
-+#define INTC_FTINTC010_PA_LIMIT 0x98800FFF
-+#define INTC_FTINTC010_PA_SIZE 0x00001000
-+#define INTC_FTINTC010_0_PA_BASE 0x98800000
-+#define INTC_FTINTC010_0_PA_LIMIT 0x98800FFF
-+#define INTC_FTINTC010_0_PA_SIZE 0x00001000
-+#define INTC_FTINTC010_1_PA_BASE 0xB0800000
-+#define INTC_FTINTC010_1_PA_LIMIT 0xB0800FFF
-+#define INTC_FTINTC010_1_PA_SIZE 0x00001000
-+#define INTC_FTINTC010_VA_COUNT 1
-+#define INTC_FTINTC010_VA_BASE 0xF9880000
-+#define INTC_FTINTC010_VA_LIMIT 0xF9880FFF
-+#define INTC_FTINTC010_VA_SIZE 0x00001000
-+#define INTC_FTINTC010_0_VA_BASE 0xF9880000
-+#define INTC_FTINTC010_0_VA_LIMIT 0xF9880FFF
-+#define INTC_FTINTC010_0_VA_SIZE 0x00001000
-+#define INTC_FTINTC010_1_VA_BASE 0xFB080000
-+#define INTC_FTINTC010_1_VA_LIMIT 0xFB080FFF
-+#define INTC_FTINTC010_1_VA_SIZE 0x00001000
-+
-+/* PMU */
-+#define PMU_FTPMU010_PA_COUNT 1
-+#define PMU_FTPMU010_PA_BASE 0x98100000
-+#define PMU_FTPMU010_PA_LIMIT 0x98100FFF
-+#define PMU_FTPMU010_PA_SIZE 0x00001000
-+#define PMU_FTPMU010_0_PA_BASE 0x98100000
-+#define PMU_FTPMU010_0_PA_LIMIT 0x98100FFF
-+#define PMU_FTPMU010_0_PA_SIZE 0x00001000
-+#define PMU_FTPMU010_VA_COUNT 1
-+#define PMU_FTPMU010_VA_BASE 0xF9810000
-+#define PMU_FTPMU010_VA_LIMIT 0xF9810FFF
-+#define PMU_FTPMU010_VA_SIZE 0x00001000
-+#define PMU_FTPMU010_0_VA_BASE 0xF9810000
-+#define PMU_FTPMU010_0_VA_LIMIT 0xF9810FFF
-+#define PMU_FTPMU010_0_VA_SIZE 0x00001000
-+
-+/* USB */
-+#define USB_FUSBH200_PA_COUNT 1
-+#define USB_FUSBH200_PA_BASE 0x92000000
-+#define USB_FUSBH200_PA_LIMIT 0x92000FFF
-+#define USB_FUSBH200_PA_SIZE 0x00001000
-+#define USB_FUSBH200_0_PA_BASE 0x92000000
-+#define USB_FUSBH200_0_PA_LIMIT 0x92000FFF
-+#define USB_FUSBH200_0_PA_SIZE 0x00001000
-+#define USB_FUSBH200_VA_COUNT 1
-+#define USB_FUSBH200_VA_BASE 0xF9200000
-+#define USB_FUSBH200_VA_LIMIT 0xF9200FFF
-+#define USB_FUSBH200_VA_SIZE 0x00001000
-+#define USB_FUSBH200_0_VA_BASE 0xF9200000
-+#define USB_FUSBH200_0_VA_LIMIT 0xF9200FFF
-+#define USB_FUSBH200_0_VA_SIZE 0x00001000
-+#define USB_FUSB220_PA_COUNT 1
-+#define USB_FUSB220_PA_BASE 0x90B00000
-+#define USB_FUSB220_PA_LIMIT 0x90B00FFF
-+#define USB_FUSB220_PA_SIZE 0x00001000
-+#define USB_FUSB220_0_PA_BASE 0x90B00000
-+#define USB_FUSB220_0_PA_LIMIT 0x90B00FFF
-+#define USB_FUSB220_0_PA_SIZE 0x00001000
-+#define USB_FUSB220_VA_COUNT 1
-+#define USB_FUSB220_VA_BASE 0xF90B0000
-+#define USB_FUSB220_VA_LIMIT 0xF90B0FFF
-+#define USB_FUSB220_VA_SIZE 0x00001000
-+#define USB_FUSB220_0_VA_BASE 0xF90B0000
-+#define USB_FUSB220_0_VA_LIMIT 0xF90B0FFF
-+#define USB_FUSB220_0_VA_SIZE 0x00001000
-+
-+/* KMI */
-+#define KMI_FTKBC010_PA_COUNT 1
-+#define KMI_FTKBC010_PA_BASE 0x97200000
-+#define KMI_FTKBC010_PA_LIMIT 0x97200FFF
-+#define KMI_FTKBC010_PA_SIZE 0x00001000
-+#define KMI_FTKBC010_0_PA_BASE 0x97200000
-+#define KMI_FTKBC010_0_PA_LIMIT 0x97200FFF
-+#define KMI_FTKBC010_0_PA_SIZE 0x00001000
-+#define KMI_FTKBC010_1_PA_BASE 0x97300000
-+#define KMI_FTKBC010_1_PA_LIMIT 0x97300FFF
-+#define KMI_FTKBC010_1_PA_SIZE 0x00001000
-+#define KMI_FTKBC010_VA_COUNT 1
-+#define KMI_FTKBC010_VA_BASE 0xF9720000
-+#define KMI_FTKBC010_VA_LIMIT 0xF9720FFF
-+#define KMI_FTKBC010_VA_SIZE 0x00001000
-+#define KMI_FTKBC010_0_VA_BASE 0xF9720000
-+#define KMI_FTKBC010_0_VA_LIMIT 0xF9720FFF
-+#define KMI_FTKBC010_0_VA_SIZE 0x00001000
-+#define KMI_FTKBC010_1_VA_BASE 0xF9730000
-+#define KMI_FTKBC010_1_VA_LIMIT 0xF9730FFF
-+#define KMI_FTKBC010_1_VA_SIZE 0x00001000
-+
-+/* PCIMEM */
-+#define PCIMEM_PA_COUNT 1
-+#define PCIMEM_PA_BASE 0xA0000000
-+#define PCIMEM_PA_LIMIT 0xAFFFFFFF
-+#define PCIMEM_PA_SIZE 0x10000000
-+#define PCIMEM_0_PA_BASE 0xA0000000
-+#define PCIMEM_0_PA_LIMIT 0xAFFFFFFF
-+#define PCIMEM_0_PA_SIZE 0x10000000
-+
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA_MODULE
-+#define CONFIG_PLATFORM_AHBDMA
-+#endif
-+
-+#ifdef CONFIG_PLATFORM_APBDMA_MODULE
-+#define CONFIG_PLATFORM_APBDMA
-+#endif
-+
-+#include <asm/misc_spec.h> /* Manual defined spec */
-+
-+/*
-+ * Platform independent specification
-+ */
-+
-+#define NR_IRQS PLATFORM_INTERRUPTS
-+
-+#ifndef TIMER_CLK_IN
-+#error Missing platform dependent symbol TIMER_CLK_IN in <asm/arch/platform/misc_spec.h> file.
-+#endif
-+
-+/*
-+ * Macros for retrieving IP related information
-+ */
-+#define IP_IDENTIFIER __glue(__glue(IPMODULE,_),__glue(IPNAME,_))
-+
-+#define IP_COUNT __glue(IP_IDENTIFIER,COUNT)
-+
-+#define IP_IRQ_COUNT __glue(IP_IDENTIFIER,IRQ_COUNT)
-+#define IP_IRQ(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ)
-+#define IP_irq __glue(IP_IDENTIFIER,irq)
-+
-+#define IP_PA_COUNT __glue(IP_IDENTIFIER,PA_COUNT)
-+#define IP_PA_BASE(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE)
-+#define IP_PA_LIMIT(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT)
-+#define IP_PA_SIZE(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE)
-+#define IP_pa_base __glue(IP_IDENTIFIER,pa_base)
-+#define IP_pa_limit __glue(IP_IDENTIFIER,pa_limit)
-+#define IP_pa_size __glue(IP_IDENTIFIER,pa_size)
-+
-+#define IP_VA_COUNT __glue(IP_IDENTIFIER,VA_COUNT)
-+#define IP_VA_BASE(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE)
-+#define IP_VA_LIMIT(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT)
-+#define IP_VA_SIZE(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE)
-+#define IP_va_base __glue(IP_IDENTIFIER,va_base)
-+#define IP_va_limit __glue(IP_IDENTIFIER,va_limit)
-+#define IP_va_size __glue(IP_IDENTIFIER,va_size)
-+
-+/*
-+ * Facility macros
-+ */
-+/* IRQ0~7 */
-+#define IP_IRQ0(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ0)
-+#define IP_IRQ1(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ1)
-+#define IP_IRQ2(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ2)
-+#define IP_IRQ3(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ3)
-+#define IP_IRQ4(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ4)
-+#define IP_IRQ5(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ5)
-+#define IP_IRQ6(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ6)
-+#define IP_IRQ7(n) __glue(__glue(IP_IDENTIFIER,n),_IRQ7)
-+
-+/* PA_BASE0~7 */
-+#define IP_PA_BASE0(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE0)
-+#define IP_PA_BASE1(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE1)
-+#define IP_PA_BASE2(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE2)
-+#define IP_PA_BASE3(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE3)
-+#define IP_PA_BASE4(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE4)
-+#define IP_PA_BASE5(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE5)
-+#define IP_PA_BASE6(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE6)
-+#define IP_PA_BASE7(n) __glue(__glue(IP_IDENTIFIER,n),_PA_BASE7)
-+
-+/* PA_LIMIT0~7 */
-+#define IP_PA_LIMIT0(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT0)
-+#define IP_PA_LIMIT1(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT1)
-+#define IP_PA_LIMIT2(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT2)
-+#define IP_PA_LIMIT3(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT3)
-+#define IP_PA_LIMIT4(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT4)
-+#define IP_PA_LIMIT5(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT5)
-+#define IP_PA_LIMIT6(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT6)
-+#define IP_PA_LIMIT7(n) __glue(__glue(IP_IDENTIFIER,n),_PA_LIMIT7)
-+
-+/* PA_SIZE0~7 */
-+#define IP_PA_SIZE0(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE0)
-+#define IP_PA_SIZE1(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE1)
-+#define IP_PA_SIZE2(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE2)
-+#define IP_PA_SIZE3(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE3)
-+#define IP_PA_SIZE4(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE4)
-+#define IP_PA_SIZE5(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE5)
-+#define IP_PA_SIZE6(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE6)
-+#define IP_PA_SIZE7(n) __glue(__glue(IP_IDENTIFIER,n),_PA_SIZE7)
-+
-+/* VA_BASE0~7 */
-+#define IP_VA_BASE0(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE0)
-+#define IP_VA_BASE1(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE1)
-+#define IP_VA_BASE2(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE2)
-+#define IP_VA_BASE3(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE3)
-+#define IP_VA_BASE4(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE4)
-+#define IP_VA_BASE5(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE5)
-+#define IP_VA_BASE6(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE6)
-+#define IP_VA_BASE7(n) __glue(__glue(IP_IDENTIFIER,n),_VA_BASE7)
-+
-+/* VA_LIMIT0~7 */
-+#define IP_VA_LIMIT0(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT0)
-+#define IP_VA_LIMIT1(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT1)
-+#define IP_VA_LIMIT2(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT2)
-+#define IP_VA_LIMIT3(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT3)
-+#define IP_VA_LIMIT4(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT4)
-+#define IP_VA_LIMIT5(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT5)
-+#define IP_VA_LIMIT6(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT6)
-+#define IP_VA_LIMIT7(n) __glue(__glue(IP_IDENTIFIER,n),_VA_LIMIT7)
-+
-+/* VA_SIZE0~7 */
-+#define IP_VA_SIZE0(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE0)
-+#define IP_VA_SIZE1(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE1)
-+#define IP_VA_SIZE2(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE2)
-+#define IP_VA_SIZE3(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE3)
-+#define IP_VA_SIZE4(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE4)
-+#define IP_VA_SIZE5(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE5)
-+#define IP_VA_SIZE6(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE6)
-+#define IP_VA_SIZE7(n) __glue(__glue(IP_IDENTIFIER,n),_VA_SIZE7)
-+
-+#endif /* __FARADAY_PLATFORM_INDEPENDENT_SPECIFICATION__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/spinlock.h linux-3.4.113/arch/nds32/include/asm/spinlock.h
---- linux-3.4.113.orig/arch/nds32/include/asm/spinlock.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/spinlock.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,183 @@
-+/*
-+ * linux/arch/nds32/include/asm/spinlock.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_SPINLOCK_H
-+#define __ASM_SPINLOCK_H
-+
-+#include <asm/processor.h>
-+
-+#define arch_spin_is_locked(x) ((x)->lock != 0)
-+
-+#define arch_spin_unlock_wait(lock) \
-+ do { while (arch_spin_is_locked(lock)) cpu_relax(); } while (0)
-+
-+#define arch_spin_lock_flags(lock, flags) arch_spin_lock(lock)
-+
-+static inline void arch_spin_lock(arch_spinlock_t *lock)
-+{
-+ unsigned long tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\tbnez\t%0, 1b\n"
-+ "\tmovi\t%0, #0x1\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (tmp)
-+ : "r" (&lock->lock)
-+ : "memory");
-+}
-+
-+static inline int arch_spin_trylock(arch_spinlock_t *lock)
-+{
-+ unsigned long ret, tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%2+$r15]\n"
-+ "\tmovi\t%1, #0x1\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ : "=&r" (ret), "=&r" (tmp)
-+ : "r" (&lock->lock)
-+ : "memory");
-+
-+ return ret == 0;
-+}
-+
-+static inline void arch_spin_unlock(arch_spinlock_t *lock)
-+{
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "\tswi\t$r15, [%0]\n"
-+ :
-+ : "r" (&lock->lock)
-+ : "memory");
-+}
-+
-+static inline void arch_write_lock(arch_rwlock_t *rw)
-+{
-+ unsigned long tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\tbnez\t%0, 1b\n"
-+ "\tsethi\t%0, 0x80000\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (tmp)
-+ : "r" (&rw->lock)
-+ : "memory");
-+}
-+
-+static inline void arch_write_unlock(arch_rwlock_t *rw)
-+{
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "\tswi\t$r15, [%0]\n"
-+ :
-+ : "r" (&rw->lock)
-+ : "memory");
-+}
-+
-+#define arch_write_can_lock(x) ((x)->lock == 0)
-+static inline void arch_read_lock(arch_rwlock_t *rw)
-+{
-+ int tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\tbltz\t%0, 1b\n"
-+ "\taddi\t%0, %0, #1\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (tmp)
-+ : "r" (&rw->lock)
-+ : "memory");
-+}
-+
-+static inline void arch_read_unlock(arch_rwlock_t *rw)
-+{
-+ unsigned long tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "1:\n"
-+ "\tllw\t%0, [%1+$r15]\n"
-+ "\taddi\t%0, %0, #-1\n"
-+ "\tscw\t%0, [%1+$r15]\n"
-+ "\tbeqz\t%0, 1b\n"
-+ : "=&r" (tmp)
-+ : "r" (&rw->lock)
-+ : "memory");
-+}
-+
-+static inline int arch_read_trylock(arch_rwlock_t *rw)
-+{
-+ unsigned long ret, tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "\tmovi\t%0, #0x0\n"
-+ "1:\n"
-+ "\tllw\t%1, [%2+$r15]\n"
-+ "\tbltz\t%1, 2f\n"
-+ "\taddi\t%1, %1, #1\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ "\tmovi\t%0, #0x1\n"
-+ "\tj\t3f\n"
-+ "2:\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "3:\n"
-+ : "=&r" (ret), "=&r" (tmp)
-+ : "r" (&rw->lock)
-+ : "memory");
-+
-+ return ret;
-+}
-+
-+static inline int arch_write_trylock(arch_rwlock_t *rw)
-+{
-+ unsigned long ret, tmp;
-+
-+ __asm__ __volatile__(
-+ "xor\t$r15, $r15, $r15\n"
-+ "\tmovi\t%0, #0x0\n"
-+ "1:\n"
-+ "\tllw\t%1, [%2+$r15]\n"
-+ "\tbnez\t%1, 2f\n"
-+ "\tsethi\t%1, 0x80000\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "\tbeqz\t%1, 1b\n"
-+ "\tmovi\t%0, #0x1\n"
-+ "\tj\t3f\n"
-+ "2:\n"
-+ "\tscw\t%1, [%2+$r15]\n"
-+ "3:\n"
-+ : "=&r" (ret), "=&r" (tmp)
-+ : "r" (&rw->lock)
-+ : "memory");
-+
-+ return ret;
-+}
-+
-+#define arch_read_lock_flags(lock, flags) arch_read_lock(lock)
-+#define arch_write_lock_flags(lock, flags) arch_write_lock(lock)
-+
-+#define arch_read_can_lock(x) ((x)->lock < 0x80000000)
-+
-+#define arch_spin_relax(lock) cpu_relax()
-+#define arch_read_relax(lock) cpu_relax()
-+#define arch_write_relax(lock) cpu_relax()
-+
-+#endif /* __ASM_SPINLOCK_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/spinlock_types.h linux-3.4.113/arch/nds32/include/asm/spinlock_types.h
---- linux-3.4.113.orig/arch/nds32/include/asm/spinlock_types.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/spinlock_types.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,25 @@
-+/*
-+ * linux/arch/nds32/include/asm/spinlock_types.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASM_SPINLOCK_TYPES_H
-+#define _ASM_SPINLOCK_TYPES_H
-+
-+#ifndef __LINUX_SPINLOCK_TYPES_H
-+# error "please don't include this file directly"
-+#endif
-+
-+typedef struct {
-+ volatile unsigned int lock;
-+} arch_spinlock_t;
-+
-+#define __ARCH_SPIN_LOCK_UNLOCKED { 0 }
-+
-+typedef struct {
-+ volatile unsigned int lock;
-+} arch_rwlock_t;
-+
-+#define __ARCH_RW_LOCK_UNLOCKED { 0 }
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/statfs.h linux-3.4.113/arch/nds32/include/asm/statfs.h
---- linux-3.4.113.orig/arch/nds32/include/asm/statfs.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/statfs.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/statfs.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_STATFS_H
-+#define _ASMNDS32_STATFS_H
-+
-+#include <asm-generic/statfs.h>
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/stat.h linux-3.4.113/arch/nds32/include/asm/stat.h
---- linux-3.4.113.orig/arch/nds32/include/asm/stat.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/stat.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,101 @@
-+/*
-+ * linux/arch/nds32/include/asm/stat.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_STAT_H
-+#define _ASMNDS32_STAT_H
-+
-+struct __old_kernel_stat {
-+ unsigned short st_dev;
-+ unsigned short st_ino;
-+ unsigned short st_mode;
-+ unsigned short st_nlink;
-+ unsigned short st_uid;
-+ unsigned short st_gid;
-+ unsigned short st_rdev;
-+ unsigned long st_size;
-+ unsigned long st_atime;
-+ unsigned long st_mtime;
-+ unsigned long st_ctime;
-+};
-+
-+#define STAT_HAVE_NSEC
-+
-+struct stat {
-+#if defined(__NDS32_EB__)
-+ unsigned short st_dev;
-+ unsigned short __pad1;
-+#else
-+ unsigned long st_dev;
-+#endif
-+ unsigned long st_ino;
-+ unsigned short st_mode;
-+ unsigned short st_nlink;
-+ unsigned short st_uid;
-+ unsigned short st_gid;
-+#if defined(__NDS32_EB__)
-+ unsigned short st_rdev;
-+ unsigned short __pad2;
-+#else
-+ unsigned long st_rdev;
-+#endif
-+ unsigned long st_size;
-+ unsigned long st_blksize;
-+ unsigned long st_blocks;
-+ unsigned long st_atime;
-+ unsigned long st_atime_nsec;
-+ unsigned long st_mtime;
-+ unsigned long st_mtime_nsec;
-+ unsigned long st_ctime;
-+ unsigned long st_ctime_nsec;
-+ unsigned long __unused4;
-+ unsigned long __unused5;
-+};
-+
-+/* This matches struct stat64 in glibc2.1, hence the absolutely
-+ * insane amounts of padding around dev_t's.
-+ * Note: The kernel zero's the padded region because glibc might read them
-+ * in the hope that the kernel has stretched to using larger sizes.
-+ */
-+
-+struct stat64 {
-+ unsigned long long st_dev;
-+ unsigned long __pad0;
-+
-+#define STAT64_HAS_BROKEN_ST_INO 1
-+ unsigned long __st_ino;
-+ unsigned int st_mode;
-+ unsigned int st_nlink;
-+
-+ unsigned long st_uid;
-+ unsigned long st_gid;
-+
-+ unsigned long long st_rdev;
-+ unsigned int __pad3;
-+
-+ unsigned long long st_size;
-+ unsigned long st_blksize;
-+
-+//#if defined(__NDS32EB__)
-+// unsigned long __pad4; // Future possible st_blocks hi bits
-+ unsigned long long st_blocks; // Number 512-byte blocks allocated.
-+//#else // Must be little
-+// unsigned long st_blocks; // Number 512-byte blocks allocated.
-+// unsigned long __pad4; // Future possible st_blocks hi bits
-+//#endif
-+
-+ unsigned long st_atime;
-+ unsigned long st_atime_nsec;
-+
-+ unsigned long st_mtime;
-+ unsigned long st_mtime_nsec;
-+
-+ unsigned long st_ctime;
-+ unsigned long st_ctime_nsec;
-+
-+ unsigned long long st_ino;
-+};
-+
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/string.h linux-3.4.113/arch/nds32/include/asm/string.h
---- linux-3.4.113.orig/arch/nds32/include/asm/string.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/string.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,45 @@
-+/*
-+ * linux/arch/nds32/include/asm/string.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_STRING_H
-+#define __ASM_NDS32_STRING_H
-+
-+/*
-+ * We don't do inline string functions, since the
-+ * optimised inline asm versions are not small.
-+ */
-+
-+#define __HAVE_ARCH_STRRCHR
-+extern char * strrchr(const char * s, int c);
-+
-+#define __HAVE_ARCH_STRCHR
-+extern char * strchr(const char * s, int c);
-+
-+#define __HAVE_ARCH_MEMCPY
-+extern void * memcpy(void *, const void *, __kernel_size_t);
-+
-+#define __HAVE_ARCH_MEMMOVE
-+extern void * memmove(void *, const void *, __kernel_size_t);
-+
-+#define __HAVE_ARCH_MEMZERO
-+#define __HAVE_ARCH_MEMSET
-+extern void * memset(void *, int, __kernel_size_t);
-+
-+extern void __memzero(void *ptr, __kernel_size_t n);
-+
-+#define memset(p,v,n) \
-+ ({ \
-+ if ((n) != 0) { \
-+ if (__builtin_constant_p((v)) && (v) == 0) \
-+ __memzero((p),(n)); \
-+ else \
-+ memset((p),(v),(n)); \
-+ } \
-+ (p); \
-+ })
-+
-+#define memzero(p,n) ({ if ((n) != 0) __memzero((p),(n)); (p); })
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/suspend.h linux-3.4.113/arch/nds32/include/asm/suspend.h
---- linux-3.4.113.orig/arch/nds32/include/asm/suspend.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/suspend.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,9 @@
-+/*
-+ * linux/arch/nds32/include/asm/suspend.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_SUSPEND_H
-+#define _ASMNDS32_SUSPEND_H
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/swab.h linux-3.4.113/arch/nds32/include/asm/swab.h
---- linux-3.4.113.orig/arch/nds32/include/asm/swab.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/swab.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,34 @@
-+/*
-+ * include/asm/byteorder.h
-+ * Copyright (C) 2008 Andes Technology, Inc.
-+ */
-+
-+#ifndef __NDS32_SWAB_H__
-+#define __NDS32_SWAB_H__
-+
-+#include <linux/types.h>
-+#include <linux/compiler.h>
-+
-+static __inline__ __attribute_const__ __u32 ___arch__swab32(__u32 x)
-+{
-+ __asm__("wsbh %0, %0\n\t" /* word swap byte within halfword */
-+ "rotri %0, %0, #16\n"
-+ : "=r" (x) : "0" (x));
-+ return x;
-+}
-+
-+static __inline__ __attribute_const__ __u16 ___arch__swab16(__u16 x)
-+{
-+ __asm__("wsbh %0, %0\n" /* word swap byte within halfword */
-+ : "=r" (x) : "0" (x));
-+ return x;
-+}
-+#define __arch_swab32(x) ___arch__swab32(x)
-+#define __arch_swab16(x) ___arch__swab16(x)
-+
-+#if !defined(__STRICT_ANSI__) || defined(__KERNEL__)
-+# define __BYTEORDER_HAS_U64__
-+# define __SWAB_64_THRU_32__
-+#endif
-+
-+#endif /* __NDS32_SWAB_H__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/switch_to.h linux-3.4.113/arch/nds32/include/asm/switch_to.h
---- linux-3.4.113.orig/arch/nds32/include/asm/switch_to.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/switch_to.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,18 @@
-+#ifndef __ASM_NDS32_SWITCH_TO_H
-+#define __ASM_NDS32_SWITCH_TO_H
-+
-+#include <linux/thread_info.h>
-+
-+/*
-+ * switch_to(prev, next) should switch from task `prev' to `next'
-+ * `prev' will never be the same as `next'. schedule() itself
-+ * contains the memory barrier to tell GCC not to cache `current'.
-+ */
-+extern struct task_struct *__switch_to(struct task_struct *, struct thread_info *, struct thread_info *);
-+
-+#define switch_to( prev, next, last) \
-+do { \
-+ last = __switch_to( prev, task_thread_info( prev), task_thread_info( next)); \
-+} while (0)
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/system.h linux-3.4.113/arch/nds32/include/asm/system.h
---- linux-3.4.113.orig/arch/nds32/include/asm/system.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/system.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,4 @@
-+/* FILE TO BE DELETED. DO NOT ADD STUFF HERE! */
-+#include <asm/barrier.h>
-+#include <asm/switch_to.h>
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/termbits.h linux-3.4.113/arch/nds32/include/asm/termbits.h
---- linux-3.4.113.orig/arch/nds32/include/asm/termbits.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/termbits.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,198 @@
-+#ifndef __ASM_NDS32_TERMBITS_H
-+#define __ASM_NDS32_TERMBITS_H
-+
-+typedef unsigned char cc_t;
-+typedef unsigned int speed_t;
-+typedef unsigned int tcflag_t;
-+
-+#define NCCS 19
-+struct termios {
-+ tcflag_t c_iflag; /* input mode flags */
-+ tcflag_t c_oflag; /* output mode flags */
-+ tcflag_t c_cflag; /* control mode flags */
-+ tcflag_t c_lflag; /* local mode flags */
-+ cc_t c_line; /* line discipline */
-+ cc_t c_cc[NCCS]; /* control characters */
-+};
-+
-+struct termios2 {
-+ tcflag_t c_iflag; /* input mode flags */
-+ tcflag_t c_oflag; /* output mode flags */
-+ tcflag_t c_cflag; /* control mode flags */
-+ tcflag_t c_lflag; /* local mode flags */
-+ cc_t c_line; /* line discipline */
-+ cc_t c_cc[NCCS]; /* control characters */
-+ speed_t c_ispeed; /* input speed */
-+ speed_t c_ospeed; /* output speed */
-+};
-+
-+struct ktermios {
-+ tcflag_t c_iflag; /* input mode flags */
-+ tcflag_t c_oflag; /* output mode flags */
-+ tcflag_t c_cflag; /* control mode flags */
-+ tcflag_t c_lflag; /* local mode flags */
-+ cc_t c_line; /* line discipline */
-+ cc_t c_cc[NCCS]; /* control characters */
-+ speed_t c_ispeed; /* input speed */
-+ speed_t c_ospeed; /* output speed */
-+};
-+
-+
-+/* c_cc characters */
-+#define VINTR 0
-+#define VQUIT 1
-+#define VERASE 2
-+#define VKILL 3
-+#define VEOF 4
-+#define VTIME 5
-+#define VMIN 6
-+#define VSWTC 7
-+#define VSTART 8
-+#define VSTOP 9
-+#define VSUSP 10
-+#define VEOL 11
-+#define VREPRINT 12
-+#define VDISCARD 13
-+#define VWERASE 14
-+#define VLNEXT 15
-+#define VEOL2 16
-+
-+/* c_iflag bits */
-+#define IGNBRK 0000001
-+#define BRKINT 0000002
-+#define IGNPAR 0000004
-+#define PARMRK 0000010
-+#define INPCK 0000020
-+#define ISTRIP 0000040
-+#define INLCR 0000100
-+#define IGNCR 0000200
-+#define ICRNL 0000400
-+#define IUCLC 0001000
-+#define IXON 0002000
-+#define IXANY 0004000
-+#define IXOFF 0010000
-+#define IMAXBEL 0020000
-+#define IUTF8 0040000
-+
-+/* c_oflag bits */
-+#define OPOST 0000001
-+#define OLCUC 0000002
-+#define ONLCR 0000004
-+#define OCRNL 0000010
-+#define ONOCR 0000020
-+#define ONLRET 0000040
-+#define OFILL 0000100
-+#define OFDEL 0000200
-+#define NLDLY 0000400
-+#define NL0 0000000
-+#define NL1 0000400
-+#define CRDLY 0003000
-+#define CR0 0000000
-+#define CR1 0001000
-+#define CR2 0002000
-+#define CR3 0003000
-+#define TABDLY 0014000
-+#define TAB0 0000000
-+#define TAB1 0004000
-+#define TAB2 0010000
-+#define TAB3 0014000
-+#define XTABS 0014000
-+#define BSDLY 0020000
-+#define BS0 0000000
-+#define BS1 0020000
-+#define VTDLY 0040000
-+#define VT0 0000000
-+#define VT1 0040000
-+#define FFDLY 0100000
-+#define FF0 0000000
-+#define FF1 0100000
-+
-+/* c_cflag bit meaning */
-+#define CBAUD 0010017
-+#define B0 0000000 /* hang up */
-+#define B50 0000001
-+#define B75 0000002
-+#define B110 0000003
-+#define B134 0000004
-+#define B150 0000005
-+#define B200 0000006
-+#define B300 0000007
-+#define B600 0000010
-+#define B1200 0000011
-+#define B1800 0000012
-+#define B2400 0000013
-+#define B4800 0000014
-+#define B9600 0000015
-+#define B19200 0000016
-+#define B38400 0000017
-+#define EXTA B19200
-+#define EXTB B38400
-+#define CSIZE 0000060
-+#define CS5 0000000
-+#define CS6 0000020
-+#define CS7 0000040
-+#define CS8 0000060
-+#define CSTOPB 0000100
-+#define CREAD 0000200
-+#define PARENB 0000400
-+#define PARODD 0001000
-+#define HUPCL 0002000
-+#define CLOCAL 0004000
-+#define CBAUDEX 0010000
-+#define BOTHER 0010000
-+#define B57600 0010001
-+#define B115200 0010002
-+#define B230400 0010003
-+#define B460800 0010004
-+#define B500000 0010005
-+#define B576000 0010006
-+#define B921600 0010007
-+#define B1000000 0010010
-+#define B1152000 0010011
-+#define B1500000 0010012
-+#define B2000000 0010013
-+#define B2500000 0010014
-+#define B3000000 0010015
-+#define B3500000 0010016
-+#define B4000000 0010017
-+#define CIBAUD 002003600000 /* input baud rate */
-+#define CMSPAR 010000000000 /* mark or space (stick) parity */
-+#define CRTSCTS 020000000000 /* flow control */
-+
-+#define IBSHIFT 16
-+
-+/* c_lflag bits */
-+#define ISIG 0000001
-+#define ICANON 0000002
-+#define XCASE 0000004
-+#define ECHO 0000010
-+#define ECHOE 0000020
-+#define ECHOK 0000040
-+#define ECHONL 0000100
-+#define NOFLSH 0000200
-+#define TOSTOP 0000400
-+#define ECHOCTL 0001000
-+#define ECHOPRT 0002000
-+#define ECHOKE 0004000
-+#define FLUSHO 0010000
-+#define PENDIN 0040000
-+#define IEXTEN 0100000
-+#define EXTPROC 0200000
-+
-+/* tcflow() and TCXONC use these */
-+#define TCOOFF 0
-+#define TCOON 1
-+#define TCIOFF 2
-+#define TCION 3
-+
-+/* tcflush() and TCFLSH use these */
-+#define TCIFLUSH 0
-+#define TCOFLUSH 1
-+#define TCIOFLUSH 2
-+
-+/* tcsetattr uses these */
-+#define TCSANOW 0
-+#define TCSADRAIN 1
-+#define TCSAFLUSH 2
-+
-+#endif /* __ASM_NDS32_TERMBITS_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/termios.h linux-3.4.113/arch/nds32/include/asm/termios.h
---- linux-3.4.113.orig/arch/nds32/include/asm/termios.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/termios.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,116 @@
-+/*
-+ * linux/arch/nds32/include/asm/termios.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_TERMIOS_H
-+#define __ASM_NDS32_TERMIOS_H
-+
-+#include <asm/termbits.h>
-+#include <asm/ioctls.h>
-+
-+struct winsize {
-+ unsigned short ws_row;
-+ unsigned short ws_col;
-+ unsigned short ws_xpixel;
-+ unsigned short ws_ypixel;
-+};
-+
-+#define NCC 8
-+struct termio {
-+ unsigned short c_iflag; /* input mode flags */
-+ unsigned short c_oflag; /* output mode flags */
-+ unsigned short c_cflag; /* control mode flags */
-+ unsigned short c_lflag; /* local mode flags */
-+ unsigned char c_line; /* line discipline */
-+ unsigned char c_cc[NCC]; /* control characters */
-+};
-+
-+#ifdef __KERNEL__
-+/* intr=^C quit=^| erase=del kill=^U
-+ eof=^D vtime=\0 vmin=\1 sxtc=\0
-+ start=^Q stop=^S susp=^Z eol=\0
-+ reprint=^R discard=^U werase=^W lnext=^V
-+ eol2=\0
-+*/
-+#define INIT_C_CC "\003\034\177\025\004\0\1\0\021\023\032\0\022\017\027\026\0"
-+#endif
-+
-+/* modem lines */
-+#define TIOCM_LE 0x001
-+#define TIOCM_DTR 0x002
-+#define TIOCM_RTS 0x004
-+#define TIOCM_ST 0x008
-+#define TIOCM_SR 0x010
-+#define TIOCM_CTS 0x020
-+#define TIOCM_CAR 0x040
-+#define TIOCM_RNG 0x080
-+#define TIOCM_DSR 0x100
-+#define TIOCM_CD TIOCM_CAR
-+#define TIOCM_RI TIOCM_RNG
-+#define TIOCM_OUT1 0x2000
-+#define TIOCM_OUT2 0x4000
-+#define TIOCM_LOOP 0x8000
-+
-+/* ioctl (fd, TIOCSERGETLSR, &result) where result may be as below */
-+
-+/* line disciplines */
-+#define N_TTY 0
-+#define N_SLIP 1
-+#define N_MOUSE 2
-+#define N_PPP 3
-+#define N_STRIP 4
-+#define N_AX25 5
-+#define N_X25 6 /* X.25 async */
-+#define N_6PACK 7
-+#define N_MASC 8 /* Reserved for Mobitex module <kaz@cafe.net> */
-+#define N_R3964 9 /* Reserved for Simatic R3964 module */
-+#define N_PROFIBUS_FDL 10 /* Reserved for Profibus <Dave@mvhi.com> */
-+#define N_IRDA 11 /* Linux IrDa - http://irda.sourceforge.net/ */
-+#define N_SMSBLOCK 12 /* SMS block mode - for talking to GSM data cards about SMS messages */
-+#define N_HDLC 13 /* synchronous HDLC */
-+#define N_SYNC_PPP 14
-+#define N_HCI 15 /* Bluetooth HCI UART */
-+
-+#ifdef __KERNEL__
-+
-+/*
-+ * Translate a "termio" structure into a "termios". Ugh.
-+ */
-+#define SET_LOW_TERMIOS_BITS(termios, termio, x) { \
-+ unsigned short __tmp; \
-+ get_user(__tmp,&(termio)->x); \
-+ *(unsigned short *) &(termios)->x = __tmp; \
-+}
-+
-+#define user_termio_to_kernel_termios(termios, termio) \
-+({ \
-+ SET_LOW_TERMIOS_BITS(termios, termio, c_iflag); \
-+ SET_LOW_TERMIOS_BITS(termios, termio, c_oflag); \
-+ SET_LOW_TERMIOS_BITS(termios, termio, c_cflag); \
-+ SET_LOW_TERMIOS_BITS(termios, termio, c_lflag); \
-+ copy_from_user((termios)->c_cc, (termio)->c_cc, NCC); \
-+})
-+
-+/*
-+ * Translate a "termios" structure into a "termio". Ugh.
-+ */
-+#define kernel_termios_to_user_termio(termio, termios) \
-+({ \
-+ put_user((termios)->c_iflag, &(termio)->c_iflag); \
-+ put_user((termios)->c_oflag, &(termio)->c_oflag); \
-+ put_user((termios)->c_cflag, &(termio)->c_cflag); \
-+ put_user((termios)->c_lflag, &(termio)->c_lflag); \
-+ put_user((termios)->c_line, &(termio)->c_line); \
-+ copy_to_user((termio)->c_cc, (termios)->c_cc, NCC); \
-+})
-+
-+#define user_termios_to_kernel_termios(k, u) copy_from_user(k, u, sizeof(struct termios))
-+#define kernel_termios_to_user_termios(u, k) copy_to_user(u, k, sizeof(struct termios))
-+
-+#define user_termios_to_kernel_termios_1(k, u) copy_from_user(k, u, sizeof(struct termios))
-+#define kernel_termios_to_user_termios_1(u, k) copy_to_user(u, k, sizeof(struct termios))
-+
-+#endif /* __KERNEL__ */
-+
-+#endif /* __ASM_NDS32_TERMIOS_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/thread_info.h linux-3.4.113/arch/nds32/include/asm/thread_info.h
---- linux-3.4.113.orig/arch/nds32/include/asm/thread_info.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/thread_info.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,145 @@
-+/*
-+ * linux/arch/nds32/include/asm/thread_info.h
-+ *
-+ * Copyright (C) 2002 Russell King.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef __ASM_NDS32_THREAD_INFO_H
-+#define __ASM_NDS32_THREAD_INFO_H
-+
-+#ifdef __KERNEL__
-+
-+#define THREAD_SHIFT (13)
-+#define THREAD_SIZE (1 << THREAD_SHIFT)
-+
-+#ifndef __ASSEMBLY__
-+
-+struct task_struct;
-+struct exec_domain;
-+
-+#include <asm/ptrace.h>
-+#include <asm/types.h>
-+
-+
-+typedef struct {
-+ unsigned long seg;
-+} mm_segment_t;
-+//typedef unsigned long mm_segment_t;
-+
-+struct cpu_context_save {
-+ unsigned long r6;
-+ unsigned long r7;
-+ unsigned long r8;
-+ unsigned long r9;
-+ unsigned long r10;
-+ unsigned long r11;
-+ unsigned long r12;
-+ unsigned long r13;
-+ unsigned long r14;
-+ unsigned long fp;
-+ unsigned long pc;
-+};
-+
-+/*
-+ * low level task data that entry.S needs immediate access to.
-+ * __switch_to() assumes cpu_context follows immediately after cpu_domain.
-+ */
-+struct thread_info {
-+ unsigned long flags; /* low level flags */
-+ __s32 preempt_count; /* 0 => preemptable, <0 => bug */
-+ mm_segment_t addr_limit; /* address limit */
-+ struct task_struct *task; /* main task structure */
-+ struct exec_domain *exec_domain; /* execution domain */
-+ __u32 cpu; /* cpu */
-+ struct cpu_context_save* sp_save; /* cpu context */
-+ struct restart_block restart_block;
-+};
-+
-+#define INIT_THREAD_INFO(tsk) \
-+{ \
-+ .task = &tsk, \
-+ .exec_domain = &default_exec_domain, \
-+ .flags = 0, \
-+ .cpu = 0, \
-+ .preempt_count = 1, \
-+ .addr_limit = KERNEL_DS, \
-+ .restart_block = { \
-+ .fn = do_no_restart_syscall, \
-+ }, \
-+}
-+
-+#define init_thread_info (init_thread_union.thread_info)
-+#define init_stack (init_thread_union.stack)
-+
-+
-+/*
-+ * how to get the thread information struct from C
-+ */
-+static inline struct thread_info *current_thread_info(void) __attribute_const__;
-+
-+static inline struct thread_info *current_thread_info(void)
-+{
-+ register unsigned long sp asm ("$sp"); //M Tom asm -> __asm__ __volatile__
-+ return (struct thread_info *)(sp & ~(THREAD_SIZE - 1));
-+}
-+
-+#define get_thread_info(ti) get_task_struct((ti)->task)
-+#define put_thread_info(ti) put_task_struct((ti)->task)
-+
-+#define thread_saved_pc(tsk) \
-+ ((unsigned long)(task_thread_info(tsk)->sp_save->pc))
-+#define thread_saved_fp(tsk) \
-+ ((unsigned long)(task_thread_info(tsk)->sp_save->fp))
-+#endif
-+
-+#define THREAD_SIZE_ORDER (1)
-+/*
-+ * We use bit 30 of the preempt_count to indicate that kernel
-+ * preemption is occuring. See include/asm-arm/hardirq.h.
-+ */
-+#define PREEMPT_ACTIVE 0x40000000
-+
-+/*
-+ * thread information flags:
-+ * TIF_SYSCALL_TRACE - syscall trace active
-+ * TIF_NOTIFY_RESUME - resumption notification requested
-+ * TIF_SIGPENDING - signal pending
-+ * TIF_NEED_RESCHED - rescheduling necessary
-+ * TIF_USEDFPU - FPU was used by this task this quantum (SMP)
-+ * TIF_POLLING_NRFLAG - true if poll_idle() is polling TIF_NEED_RESCHED
-+ * TIF_USEDAUDIO - Audio has been used by this task and no need to init the regs
-+ */
-+#define TIF_SIGPENDING 1
-+#define TIF_NEED_RESCHED 2
-+#define TIF_SINGLESTEP 3
-+#define TIF_NOTIFY_RESUME 5
-+#define TIF_SYSCALL_TRACE 8
-+#define TIF_RESTORE_SIGMASK 9
-+#define TIF_USEDFPU 16
-+#define TIF_POLLING_NRFLAG 17
-+#define TIF_MEMDIE 18
-+#define TIF_FREEZE 19
-+#define TIF_USEDAUDIO 20
-+
-+#define _TIF_SIGPENDING (1 << TIF_SIGPENDING)
-+#define _TIF_NEED_RESCHED (1 << TIF_NEED_RESCHED)
-+#define _TIF_SINGLESTEP (1 << TIF_SINGLESTEP)
-+#define _TIF_NOTIFY_RESUME (1 << TIF_NOTIFY_RESUME)
-+#define _TIF_SYSCALL_TRACE (1 << TIF_SYSCALL_TRACE)
-+#define _TIF_RESTORE_SIGMASK (1 << TIF_RESTORE_SIGMASK)
-+#define _TIF_POLLING_NRFLAG (1 << TIF_POLLING_NRFLAG)
-+#define _TIF_FREEZE (1 << TIF_FREEZE)
-+
-+/*
-+ * Change these and you break ASM code in entry-common.S
-+ */
-+#define _TIF_WORK_MASK 0x000000ff
-+#define _TIF_WORK_SYSCALL_ENTRY (_TIF_SYSCALL_TRACE | _TIF_SINGLESTEP)
-+#define _TIF_WORK_SYSCALL_LEAVE (_TIF_SYSCALL_TRACE | _TIF_SINGLESTEP)
-+
-+#endif /* __KERNEL__ */
-+#endif /* __ASM_NDS32_THREAD_INFO_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/timer.h linux-3.4.113/arch/nds32/include/asm/timer.h
---- linux-3.4.113.orig/arch/nds32/include/asm/timer.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/timer.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,94 @@
-+/*
-+ * include/arch/nds32/include/asm/timer.h
-+ *
-+ * Faraday FTTMR010 Timer Device Driver Interface
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Note
-+ *
-+ * As IP_COUNT might be greater than one, timer ID is computed as follows:
-+ * id=0~2 : Timer 1~3 of the first FTTMR010 IP
-+ * id=3~5 : Timer 1~3 of the second FTTMR010 IP
-+ * ...
-+ * Therefore:
-+ * (id / 3) : Compute which IP
-+ * (id % 3) : Compute which timer in this IP
-+ * Notice:
-+ * For simplicity's sake, all code does not check for invalid timer id
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/14/2005 Created, heavily modified from Faraday CPE platform code.
-+ */
-+
-+
-+#ifndef __FARADAY_TIMER_FTTMR010_HEADER__
-+#define __FARADAY_TIMER_FTTMR010_HEADER__
-+
-+/*
-+ * Definition of register offsets
-+ */
-+
-+#define TIMER1_COUNT 0x0
-+#define TIMER1_LOAD 0x4
-+#define TIMER1_MATCH1 0x8
-+#define TIMER1_MATCH2 0xC
-+
-+#define TIMER2_COUNT 0x10
-+#define TIMER2_LOAD 0x14
-+#define TIMER2_MATCH1 0x18
-+#define TIMER2_MATCH2 0x1C
-+
-+#define TIMER3_COUNT 0x20
-+#define TIMER3_LOAD 0x24
-+#define TIMER3_MATCH1 0x28
-+#define TIMER3_MATCH2 0x2C
-+
-+#define TIMER_TMCR 0x30
-+#define TIMER_INTRSTATE 0x34
-+#define TIMER_INTRMASK 0x38
-+
-+/* Each timer's register address is offset by 0x10 */
-+#define TIMER_OFFSET 0x10
-+
-+/*
-+ * Definition of TMCR bits
-+ */
-+
-+#define TM1ENABLE 1
-+#define TM1CLOCK (1<<1)
-+#define TM1OFENABLE (1<<2)
-+
-+#define TM2ENABLE (1<<3)
-+#define TM2CLOCK (1<<4)
-+#define TM2OFENABLE (1<<5)
-+
-+#define TM3ENABLE (1<<6)
-+#define TM3CLOCK (1<<7)
-+#define TM3OFENABLE (1<<8)
-+
-+#define TM1UPDOWN (1<<9)
-+#define TM2UPDOWN (1<<10)
-+#define TM3UPDOWN (1<<11)
-+
-+
-+#define TM1MATCH1 (1 << 0)
-+#define TM1MATCH2 (1 << 1)
-+#define TM1OVERFLOW (1 << 2)
-+#define TM2MATCH1 (1 << 3)
-+#define TM2MATCH2 (1 << 4)
-+#define TM2OVERFLOW (1 << 5)
-+#define TM3MATCH1 (1 << 6)
-+#define TM3MATCH2 (1 << 7)
-+#define TM3OVERFLOW (1 << 8)
-+
-+struct sys_timer;
-+extern struct sys_timer platform_timer;
-+
-+#endif // __FARADAY_TIMER_FTTMR010_HEADER__
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/timex.h linux-3.4.113/arch/nds32/include/asm/timex.h
---- linux-3.4.113.orig/arch/nds32/include/asm/timex.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/timex.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,36 @@
-+/*
-+ * linux/arch/nds32/include/asm/timex.h
-+ *
-+ * Copyright (C) 1997,1998 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Architecture Specific TIME specifications
-+ */
-+#ifndef _ASMNDS32_TIMEX_H
-+#define _ASMNDS32_TIMEX_H
-+
-+#ifndef __FARADAY_PLATFORM_INDEPENDENT_TIMEX_HEADER__
-+#define __FARADAY_PLATFORM_INDEPENDENT_TIMEX_HEADER__
-+
-+#include <asm/spec.h>
-+
-+#ifndef CLOCK_TICK_RATE
-+#define CLOCK_TICK_RATE (TIMER_CLK_IN)
-+#endif
-+
-+#endif /* __FARADAY_PLATFORM_INDEPENDENT_TIMEX_HEADER__ */
-+
-+typedef unsigned long cycles_t;
-+
-+extern cycles_t cacheflush_time;
-+
-+static inline cycles_t get_cycles (void)
-+{
-+ return 0;
-+}
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/tlbflush.h linux-3.4.113/arch/nds32/include/asm/tlbflush.h
---- linux-3.4.113.orig/arch/nds32/include/asm/tlbflush.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/tlbflush.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,80 @@
-+/*
-+ * linux/arch/nds32/include/asm/tlbflush.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_TLBFLUSH_H
-+#define _ASMNDS32_TLBFLUSH_H
-+
-+#include <linux/spinlock.h>
-+#include <linux/mm.h>
-+#include <nds32_intrinsic.h>
-+
-+static inline void local_flush_tlb_all(void)
-+{
-+ asm("tlbop FLUA\n");
-+ __nds32__isb();
-+}
-+static inline void local_flush_tlb_mm(struct mm_struct *mm)
-+{
-+ asm("tlbop FLUA\n");
-+ __nds32__isb();
-+}
-+static inline void local_flush_tlb_kernel_range(unsigned long start,
-+ unsigned long end)
-+{
-+ while(start < end) {
-+ asm("tlbop %0, INV"::"r" (start));
-+ __nds32__isb();
-+ start += PAGE_SIZE;
-+ }
-+}
-+
-+#ifndef CONFIG_CPU_NO_CONTEXT_ID
-+void local_flush_tlb_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end);
-+void local_flush_tlb_page(struct vm_area_struct *vma, unsigned long addr);
-+#else
-+static inline void local_flush_tlb_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end)
-+{
-+ if ((end - start) > 0x400000) {
-+ asm("tlbop FLUA");
-+ __nds32__isb();
-+ return ;
-+ }
-+ while(start < end) {
-+ asm("tlbop %0, INV"::"r" (start));
-+ __nds32__isb();
-+ start += PAGE_SIZE;
-+ }
-+}
-+
-+static inline void local_flush_tlb_page(struct vm_area_struct *vma,
-+ unsigned long addr)
-+{
-+ asm("tlbop %0, INV"::"r" (addr));
-+ __nds32__isb();
-+}
-+#endif
-+
-+#ifndef CONFIG_SMP
-+#define flush_tlb_all local_flush_tlb_all
-+#define flush_tlb_mm local_flush_tlb_mm
-+#define flush_tlb_range local_flush_tlb_range
-+#define flush_tlb_page local_flush_tlb_page
-+#define flush_tlb_kernel_range local_flush_tlb_kernel_range
-+#else
-+void flush_tlb_all(void);
-+void flush_tlb_mm(struct mm_struct *mm);
-+void flush_tlb_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end);
-+void flush_tlb_page(struct vm_area_struct *vma, unsigned long addr);
-+void flush_tlb_kernel_range(unsigned long start, unsigned long end);
-+#endif
-+
-+void update_mmu_cache(struct vm_area_struct *vma,
-+ unsigned long address, pte_t* pte);
-+void tlb_migrate_finish(struct mm_struct *mm);
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/tlb.h linux-3.4.113/arch/nds32/include/asm/tlb.h
---- linux-3.4.113.orig/arch/nds32/include/asm/tlb.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/tlb.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,30 @@
-+/*
-+ * linux/arch/nds32/include/asm/tlb.h
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASMNDS32_TLB_H
-+#define __ASMNDS32_TLB_H
-+
-+#define tlb_start_vma(tlb,vma) \
-+ do { \
-+ if (!tlb->fullmm) \
-+ flush_cache_range(vma, vma->vm_start, vma->vm_end); \
-+ } while (0)
-+
-+#define tlb_end_vma(tlb,vma) \
-+ do { \
-+ if(!tlb->fullmm) \
-+ flush_tlb_range(vma, vma->vm_start, vma->vm_end); \
-+ } while (0)
-+
-+#define __tlb_remove_tlb_entry(tlb, pte, addr) do { } while (0)
-+
-+#define tlb_flush(tlb) flush_tlb_mm((tlb)->mm)
-+
-+#include <asm-generic/tlb.h>
-+
-+#define __pte_free_tlb(tlb, pte, addr) pte_free((tlb)->mm, pte)
-+#define __pmd_free_tlb(tlb, pmd, addr) pmd_free((tln)->mm, pmd)
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/topology.h linux-3.4.113/arch/nds32/include/asm/topology.h
---- linux-3.4.113.orig/arch/nds32/include/asm/topology.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/topology.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,11 @@
-+/*
-+ * linux/arch/nds32/include/asm/topology.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASM_NDS32_TOPOLOGY_H
-+#define _ASM_NDS32_TOPOLOGY_H
-+
-+#include <asm-generic/topology.h>
-+
-+#endif /* _ASM_NDS32_TOPOLOGY_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/traps.h linux-3.4.113/arch/nds32/include/asm/traps.h
---- linux-3.4.113.orig/arch/nds32/include/asm/traps.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/traps.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,25 @@
-+/*
-+ * linux/arch/nds32/include/asm/traps.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_TRAP_H
-+#define _ASMNDS32_TRAP_H
-+
-+#include <linux/list.h>
-+
-+struct undef_hook {
-+ struct list_head node;
-+ u32 instr_mask;
-+ u32 instr_val;
-+ u32 cpsr_mask;
-+ u32 cpsr_val;
-+ int (*fn)(struct pt_regs *regs, unsigned int instr);
-+};
-+
-+void register_undef_hook(struct undef_hook *hook);
-+void unregister_undef_hook(struct undef_hook *hook);
-+
-+extern void __init early_trap_init(void);
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/types.h linux-3.4.113/arch/nds32/include/asm/types.h
---- linux-3.4.113.orig/arch/nds32/include/asm/types.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/types.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,16 @@
-+#ifndef __ASM_NDS32_TYPES_H
-+#define __ASM_NDS32_TYPES_H
-+
-+#include <asm-generic/int-ll64.h>
-+
-+/*
-+ * These aren't exported outside the kernel to avoid name space clashes
-+ */
-+#ifdef __KERNEL__
-+
-+#define BITS_PER_LONG 32
-+
-+#endif /* __KERNEL__ */
-+
-+#endif
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/uaccess.h linux-3.4.113/arch/nds32/include/asm/uaccess.h
---- linux-3.4.113.orig/arch/nds32/include/asm/uaccess.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/uaccess.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,428 @@
-+/*
-+ * linux/arch/nds32/include/asm/uaccess.h
-+ *
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#ifndef _ASMANDES_UACCESS_H
-+#define _ASMANDES_UACCESS_H
-+
-+/*
-+ * User space memory access functions
-+ */
-+#include <linux/sched.h>
-+#include <asm/errno.h>
-+#include <asm/memory.h>
-+#include <asm/system.h>
-+#include <asm/types.h>
-+#include <linux/mm.h>
-+
-+#define VERIFY_READ 0
-+#define VERIFY_WRITE 1
-+
-+/*
-+ * The exception table consists of pairs of addresses: the first is the
-+ * address of an instruction that is allowed to fault, and the second is
-+ * the address at which the program should continue. No registers are
-+ * modified, so it is entirely up to the continuation code to figure out
-+ * what to do.
-+ *
-+ * All the routines below use bits of fixup code that are out of line
-+ * with the main instruction path. This means when everything is well,
-+ * we don't even have to jump over them. Further, they do not intrude
-+ * on our cache or tlb entries.
-+ */
-+
-+struct exception_table_entry
-+{
-+ unsigned long insn, fixup;
-+};
-+
-+extern int fixup_exception(struct pt_regs *regs);
-+
-+#define KERNEL_DS ((mm_segment_t) { ~0UL })
-+#define USER_DS ((mm_segment_t) {TASK_SIZE - 1})
-+
-+#define get_ds() (KERNEL_DS)
-+#define get_fs() (current_thread_info()->addr_limit)
-+
-+static inline void set_fs (mm_segment_t fs)
-+{
-+ current_thread_info()->addr_limit = fs;
-+}
-+
-+#define segment_eq(a, b) ((a.seg) == (b.seg))
-+
-+#define __range_ok(addr, size) (size <= get_fs().seg && addr <= (get_fs().seg -size))
-+
-+#define access_ok(type, addr, size) \
-+ __range_ok((unsigned long)addr, (unsigned long)size)
-+/*
-+ * Single-value transfer routines. They automatically use the right
-+ * size if we just have the right pointer type. Note that the functions
-+ * which read from user space (*get_*) need to take care not to leak
-+ * kernel data even if the calling code is buggy and fails to check
-+ * the return value. This means zeroing out the destination variable
-+ * or buffer on error. Normally this is done out of line by the
-+ * fixup code, but there are a few places where it intrudes on the
-+ * main code path. When we only write to user space, there is no
-+ * problem.
-+ *
-+ * The "__xxx" versions of the user access functions do not verify the
-+ * address space - it must have been done previously with a separate
-+ * "access_ok()" call.
-+ *
-+ * The "xxx_error" versions set the third argument to EFAULT if an
-+ * error occurs, and leave it unchanged on success. Note that these
-+ * versions are void (ie, don't return a value as such).
-+ */
-+
-+extern int __get_user_1(void *);
-+extern int __get_user_2(void *);
-+extern int __get_user_4(void *);
-+extern int __get_user_8(void *);
-+extern int __get_user_bad(void);
-+
-+#define __get_user_x(__r2,__p,__e,__s,__i...) \
-+ __asm__ __volatile__ ( \
-+ __asmeq("%0", "$r0") __asmeq("%1", "$r2") \
-+ "bal __get_user_" #__s \
-+ : "=&r" (__e), "=r" (__r2) \
-+ : "0" (__p) \
-+ : __i, "cc")
-+
-+#define get_user(x,p) \
-+ ({ \
-+ const register typeof(*(p)) __user *__p asm("$r0") = (p);\
-+ register unsigned long __r2 asm("$r2"); \
-+ register int __e asm("$r0"); \
-+ switch (sizeof(*(__p))) { \
-+ case 1: \
-+ __get_user_x(__r2, __p, __e, 1, "$lp"); \
-+ break; \
-+ case 2: \
-+ __get_user_x(__r2, __p, __e, 2, "$r3", "$lp"); \
-+ break; \
-+ case 4: \
-+ __get_user_x(__r2, __p, __e, 4, "$lp"); \
-+ break; \
-+ case 8: \
-+ __get_user_x(__r2, __p, __e, 8, "$lp"); \
-+ break; \
-+ default: __e = __get_user_bad(); break; \
-+ } \
-+ x = (typeof(*(p))) __r2; \
-+ __e; \
-+ })
-+
-+#define __get_user(x,ptr) \
-+({ \
-+ long __gu_err = 0; \
-+ __get_user_err((x),(ptr),__gu_err); \
-+ __gu_err; \
-+})
-+
-+#define __get_user_error(x,ptr,err) \
-+({ \
-+ __get_user_err((x),(ptr),err); \
-+ (void) 0; \
-+})
-+
-+#define __get_user_err(x,ptr,err) \
-+do { \
-+ unsigned long __gu_addr = (unsigned long)(ptr); \
-+ unsigned long __gu_val; \
-+ __chk_user_ptr(ptr); \
-+ switch (sizeof(*(ptr))) { \
-+ case 1: __get_user_asm_byte(__gu_val,__gu_addr,err); break; \
-+ case 2: __get_user_asm_half(__gu_val,__gu_addr,err); break; \
-+ case 4: __get_user_asm_word(__gu_val,__gu_addr,err); break; \
-+ default: (__gu_val) = __get_user_bad(); \
-+ } \
-+ (x) = (__typeof__(*(ptr)))__gu_val; \
-+} while (0)
-+
-+#define __get_user_asm_byte(x,addr,err) \
-+ __asm__ __volatile__( \
-+ "1: lbi %1,[%2]\n" \
-+ "2:\n" \
-+ " .section .fixup,\"ax\"\n" \
-+ " .align 2\n" \
-+ "3: move %0, %3\n" \
-+ " move %1, #0\n" \
-+ " b 2b\n" \
-+ " .previous\n" \
-+ " .section __ex_table,\"a\"\n" \
-+ " .align 3\n" \
-+ " .long 1b, 3b\n" \
-+ " .previous" \
-+ : "+r" (err), "=&r" (x) \
-+ : "r" (addr), "i" (-EFAULT) \
-+ : "cc")
-+
-+#ifndef __NDS32_EB__
-+#define __get_user_asm_half(x,__gu_addr,err) \
-+({ \
-+ unsigned long __b1, __b2; \
-+ __get_user_asm_byte(__b1, __gu_addr, err); \
-+ __get_user_asm_byte(__b2, __gu_addr + 1, err); \
-+ (x) = __b1 | (__b2 << 8); \
-+})
-+#else
-+#define __get_user_asm_half(x,__gu_addr,err) \
-+({ \
-+ unsigned long __b1, __b2; \
-+ __get_user_asm_byte(__b1, __gu_addr, err); \
-+ __get_user_asm_byte(__b2, __gu_addr + 1, err); \
-+ (x) = (__b1 << 8) | __b2; \
-+})
-+#endif
-+
-+#define __get_user_asm_word(x,addr,err) \
-+ __asm__ __volatile__( \
-+ "1: lwi %1,[%2]\n" \
-+ "2:\n" \
-+ " .section .fixup,\"ax\"\n" \
-+ " .align 2\n" \
-+ "3: move %0, %3\n" \
-+ " move %1, #0\n" \
-+ " b 2b\n" \
-+ " .previous\n" \
-+ " .section __ex_table,\"a\"\n" \
-+ " .align 3\n" \
-+ " .long 1b, 3b\n" \
-+ " .previous" \
-+ : "+r" (err), "=&r" (x) \
-+ : "r" (addr), "i" (-EFAULT) \
-+ : "cc")
-+
-+extern int __put_user_1(void *, unsigned int);
-+extern int __put_user_2(void *, unsigned int);
-+extern int __put_user_4(void *, unsigned int);
-+extern int __put_user_8(void *, unsigned long long);
-+extern int __put_user_bad(void);
-+
-+#ifdef _GCC444
-+#define __put_user_x(__r2,__p,__e,__s) \
-+ __asm__ __volatile__ ( \
-+ __asmeq("%0", "$r0") __asmeq("%2", "$r2") \
-+ "bal __put_user_" #__s \
-+ : "=&r" (__e) \
-+ : "0" (__p), "r" (__r2) \
-+ : "$p0", "$lp", "cc")
-+#else
-+#define __put_user_x(__r2,__p,__e,__s) \
-+ __asm__ __volatile__ ( \
-+ __asmeq("%0", "$r0") __asmeq("%2", "$r2") \
-+ "bal __put_user_" #__s \
-+ : "=&r" (__e) \
-+ : "0" (__p), "r" (__r2) \
-+ : "$r26", "$lp", "cc")
-+#endif
-+
-+#define put_user(x,p) \
-+ ({ \
-+ const register typeof(*(p)) __r2 asm("$r2") = (x); \
-+ const register typeof(*(p)) __user *__p asm("$r0") = (p);\
-+ register int __e asm("$r0"); \
-+ switch (sizeof(*(__p))) { \
-+ case 1: \
-+ __put_user_x(__r2, __p, __e, 1); \
-+ break; \
-+ case 2: \
-+ __put_user_x(__r2, __p, __e, 2); \
-+ break; \
-+ case 4: \
-+ __put_user_x(__r2, __p, __e, 4); \
-+ break; \
-+ case 8: \
-+ __put_user_x(__r2, __p, __e, 8); \
-+ break; \
-+ default: __e = __put_user_bad(); break; \
-+ } \
-+ __e; \
-+ })
-+
-+#define __put_user(x,ptr) \
-+({ \
-+ long __pu_err = 0; \
-+ __put_user_err((x),(ptr),__pu_err); \
-+ __pu_err; \
-+})
-+
-+#define __put_user_error(x,ptr,err) \
-+({ \
-+ __put_user_err((x),(ptr),err); \
-+ (void) 0; \
-+})
-+
-+#define __put_user_err(x,ptr,err) \
-+do { \
-+ unsigned long __pu_addr = (unsigned long)(ptr); \
-+ __typeof__(*(ptr)) __pu_val = (x); \
-+ __chk_user_ptr(ptr); \
-+ switch (sizeof(*(ptr))) { \
-+ case 1: __put_user_asm_byte(__pu_val,__pu_addr,err); break; \
-+ case 2: __put_user_asm_half(__pu_val,__pu_addr,err); break; \
-+ case 4: __put_user_asm_word(__pu_val,__pu_addr,err); break; \
-+ case 8: __put_user_asm_dword(__pu_val,__pu_addr,err); break; \
-+ default: __put_user_bad(); \
-+ } \
-+} while (0)
-+
-+#define __put_user_asm_byte(x,__pu_addr,err) \
-+ __asm__ __volatile__( \
-+ "1: sbi %1,[%2]\n" \
-+ "2:\n" \
-+ " .section .fixup,\"ax\"\n" \
-+ " .align 2\n" \
-+ "3: move %0, %3\n" \
-+ " b 2b\n" \
-+ " .previous\n" \
-+ " .section __ex_table,\"a\"\n" \
-+ " .align 3\n" \
-+ " .long 1b, 3b\n" \
-+ " .previous" \
-+ : "+r" (err) \
-+ : "r" (x), "r" (__pu_addr), "i" (-EFAULT) \
-+ : "cc")
-+
-+#ifndef __NDS32_EB__
-+#define __put_user_asm_half(x,__pu_addr,err) \
-+({ \
-+ unsigned long __temp = (unsigned long)(x); \
-+ __put_user_asm_byte(__temp, __pu_addr, err); \
-+ __put_user_asm_byte(__temp >> 8, __pu_addr + 1, err); \
-+})
-+#else
-+#define __put_user_asm_half(x,__pu_addr,err) \
-+({ \
-+ unsigned long __temp = (unsigned long)(x); \
-+ __put_user_asm_byte(__temp >> 8, __pu_addr, err); \
-+ __put_user_asm_byte(__temp, __pu_addr + 1, err); \
-+})
-+#endif
-+
-+#define __put_user_asm_word(x,__pu_addr,err) \
-+ __asm__ __volatile__( \
-+ "1: swi %1,[%2]\n" \
-+ "2:\n" \
-+ " .section .fixup,\"ax\"\n" \
-+ " .align 2\n" \
-+ "3: move %0, %3\n" \
-+ " b 2b\n" \
-+ " .previous\n" \
-+ " .section __ex_table,\"a\"\n" \
-+ " .align 3\n" \
-+ " .long 1b, 3b\n" \
-+ " .previous" \
-+ : "+r" (err) \
-+ : "r" (x), "r" (__pu_addr), "i" (-EFAULT) \
-+ : "cc")
-+
-+#ifdef __NDS32_EB__
-+#define __reg_oper0 "%H2"
-+#define __reg_oper1 "%L2"
-+#else
-+#define __reg_oper0 "%L2"
-+#define __reg_oper1 "%H2"
-+#endif
-+
-+#define __put_user_asm_dword(x, __pu_addr, __pu_err) \
-+ __asm__ __volatile__ ( \
-+ "\n1:\tswi " __reg_oper0 ",[%1]\n" \
-+ "\n2:\tswi " __reg_oper1 ",[%1+4]\n" \
-+ "3:\n" \
-+ " .section .fixup,\"ax\"\n" \
-+ " .align 2\n" \
-+ "4: move %0, %3\n" \
-+ " b 3b\n" \
-+ " .previous\n" \
-+ " .section __ex_table,\"a\"\n" \
-+ " .align 3\n" \
-+ " .long 1b, 4b\n" \
-+ " .long 2b, 4b\n" \
-+ " .previous" \
-+ : "+r"(__pu_err) \
-+ : "r"(__pu_addr), "r"(x), "i"(-EFAULT) \
-+ : "cc")
-+extern unsigned long __arch_copy_from_user(void *to, const void __user *from, unsigned long n);
-+extern unsigned long __arch_copy_to_user(void __user *to, const void *from, unsigned long n);
-+extern unsigned long __arch_clear_user(void __user *addr, unsigned long n);
-+extern unsigned long __arch_strncpy_from_user(char *to, const char __user *from, unsigned long count);
-+extern unsigned long __arch_strnlen_user(const char __user *s, long n);
-+
-+static inline unsigned long copy_from_user(void *to, const void __user *from, unsigned long n)
-+{
-+ if (access_ok(VERIFY_READ, from, n))
-+ n = __arch_copy_from_user(to, from, n);
-+ else /* security hole - plug it */
-+ memzero(to, n);
-+ return n;
-+}
-+
-+static inline unsigned long __copy_from_user(void *to, const void __user *from, unsigned long n)
-+{
-+ return __arch_copy_from_user(to, from, n);
-+}
-+
-+static inline unsigned long copy_to_user(void __user *to, const void *from, unsigned long n)
-+{
-+ if (access_ok(VERIFY_WRITE, to, n))
-+ n = __arch_copy_to_user(to, from, n);
-+ return n;
-+}
-+
-+static inline unsigned long __copy_to_user(void __user *to, const void *from, unsigned long n)
-+{
-+ return __arch_copy_to_user(to, from, n);
-+}
-+
-+#define __copy_to_user_inatomic __copy_to_user
-+#define __copy_from_user_inatomic __copy_from_user
-+
-+static inline unsigned long clear_user (void __user *to, unsigned long n)
-+{
-+ if (access_ok(VERIFY_WRITE, to, n))
-+ n = __arch_clear_user(to, n);
-+ return n;
-+}
-+
-+static inline unsigned long __clear_user (void __user *to, unsigned long n)
-+{
-+ return __arch_clear_user(to, n);
-+}
-+
-+/*
-+ * We check the flags of vma here before __arch_strncpy_from_user().
-+ * An alternative way to do it is using lwup instruction in __arch_strncpy_from_user().
-+ * TODO: Should perform performance evaluation of the two.
-+ */
-+static inline long strncpy_from_user (char *dst, const char __user *src, long count)
-+{
-+ long res = -EFAULT;
-+ if (access_ok(VERIFY_READ, src, 1))
-+ res = __arch_strncpy_from_user(dst, src, count);
-+ return res;
-+}
-+
-+static inline long __strncpy_from_user (char *dst, const char __user *src, long count)
-+{
-+ return __arch_strncpy_from_user(dst, src, count);
-+}
-+
-+#define strlen_user(s) strnlen_user(s, ~0UL >> 1)
-+
-+static inline long strnlen_user(const char __user *s, long n)
-+{
-+ unsigned long res = 0;
-+
-+ if (segment_eq(get_fs(),KERNEL_DS) || ((unsigned long)s < get_fs().seg))
-+ res = __arch_strnlen_user(s, n);
-+
-+ return res;
-+}
-+#endif /* _ASMNDS32_UACCESS_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/ucontext.h linux-3.4.113/arch/nds32/include/asm/ucontext.h
---- linux-3.4.113.orig/arch/nds32/include/asm/ucontext.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/ucontext.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,17 @@
-+/*
-+ * linux/arch/nds32/include/asm/ucontext.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _ASMNDS32_UCONTEXT_H
-+#define _ASMNDS32_UCONTEXT_H
-+
-+struct ucontext {
-+ unsigned long uc_flags;
-+ struct ucontext *uc_link;
-+ stack_t uc_stack;
-+ struct sigcontext uc_mcontext;
-+ sigset_t uc_sigmask; /* mask last for extensibility */
-+};
-+
-+#endif /* !_ASMNDS32_UCONTEXT_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/unaligned.h linux-3.4.113/arch/nds32/include/asm/unaligned.h
---- linux-3.4.113.orig/arch/nds32/include/asm/unaligned.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/unaligned.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,24 @@
-+/*
-+ * linux/arch/nds32/include/asm/unaligned.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef __ASM_NDS32_UNALIGNED_H
-+#define __ASM_NDS32_UNALIGNED_H
-+
-+#include <linux/unaligned/le_byteshift.h>
-+#include <linux/unaligned/be_byteshift.h>
-+#include <linux/unaligned/generic.h>
-+
-+/*
-+ * Select endianness
-+ */
-+#if defined(__NDS32_EB__)
-+#define get_unaligned __get_unaligned_be
-+#define put_unaligned __put_unaligned_be
-+#else
-+#define get_unaligned __get_unaligned_le
-+#define put_unaligned __put_unaligned_le
-+#endif
-+
-+#endif /* __ASM_NDS32_UNALIGNED_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/uncompress.h linux-3.4.113/arch/nds32/include/asm/uncompress.h
---- linux-3.4.113.orig/arch/nds32/include/asm/uncompress.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/uncompress.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,65 @@
-+/*
-+ * linux/arch/nds32/include/asm/uncompress.h
-+ *
-+ * Faraday Linux Boot Loader UART (FTUART010) Routines
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * Note
-+ *
-+ * The first UART (FTUART010) in the system is used for dumping debug messages.
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/21/2005 Created. Heavily modified from Faraday CPE port.
-+ */
-+
-+#include <asm/spec.h>
-+
-+#ifdef CONFIG_PLAT_AG102
-+#define UART_PA_BASE 0x94200000
-+#else
-+#define UART_PA_BASE 0x99600000
-+#endif
-+
-+#define arch_decomp_setup()
-+#define arch_decomp_wdog()
-+
-+#ifndef STANDALONE_DEBUG
-+#define putstr debug_puts
-+#endif
-+
-+#define SERIAL_THR 0x00
-+#define SERIAL_LSR 0x14
-+#define SERIAL_LSR_THRE 0x20
-+
-+static inline void uncompress_puts(const char *s)
-+{
-+ volatile unsigned *status = (volatile unsigned *)(UART_PA_BASE+SERIAL_LSR);
-+ while (*s) {
-+ while ((*status & SERIAL_LSR_THRE)==0);
-+
-+ *(volatile unsigned*)(UART_PA_BASE+SERIAL_THR) = (unsigned)*s;
-+
-+ if (*s == '\n') {
-+ while ((*status & SERIAL_LSR_THRE)==0);
-+ *(volatile unsigned*)(UART_PA_BASE+SERIAL_THR) = '\r';
-+ }
-+ s++;
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/unistd.h linux-3.4.113/arch/nds32/include/asm/unistd.h
---- linux-3.4.113.orig/arch/nds32/include/asm/unistd.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/unistd.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,468 @@
-+/*
-+ * linux/arch/nds32/include/asm/unistd.h
-+ *
-+ * Copyright (C) 2001-2003 Russell King
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Please forward _all_ changes to this file to rmk@arm.linux.org.uk,
-+ * no matter what the change is. Thanks!
-+ */
-+/* ============================================================================
-+ *
-+ * linux/arch/nds32/include/asm/unistd.h
-+ *
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is syscall scheme for Andes NDS32 architecture.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.07.2007 Original from Shawn and Tom, refined by Harry.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+
-+#ifndef __ASM_NDS32_UNISTD_H
-+#define __ASM_NDS32_UNISTD_H
-+
-+#define __NR_SYSCALL_BASE 0x5000
-+#define __NR_NDS32_BASE 0x7000
-+/*
-+ * This file contains the system call numbers.
-+ */
-+
-+#define __NR_restart_syscall (__NR_SYSCALL_BASE+ 0)
-+#define __NR_exit (__NR_SYSCALL_BASE+ 1)
-+#define __NR_fork (__NR_SYSCALL_BASE+ 2)
-+#define __NR_read (__NR_SYSCALL_BASE+ 3)
-+#define __NR_write (__NR_SYSCALL_BASE+ 4)
-+#define __NR_open (__NR_SYSCALL_BASE+ 5)
-+#define __NR_close (__NR_SYSCALL_BASE+ 6)
-+#define __NR_waitpid (__NR_SYSCALL_BASE+ 7)
-+ /* 7 was sys_waitpid */
-+#define __NR_creat (__NR_SYSCALL_BASE+ 8)
-+#define __NR_link (__NR_SYSCALL_BASE+ 9)
-+#define __NR_unlink (__NR_SYSCALL_BASE+ 10)
-+#define __NR_execve (__NR_SYSCALL_BASE+ 11)
-+#define __NR_chdir (__NR_SYSCALL_BASE+ 12)
-+#define __NR_time (__NR_SYSCALL_BASE+ 13)
-+#define __NR_mknod (__NR_SYSCALL_BASE+ 14)
-+#define __NR_chmod (__NR_SYSCALL_BASE+ 15)
-+#define __NR_lchown (__NR_SYSCALL_BASE+ 16)
-+ /* 17 was sys_break */
-+ /* 18 was sys_oldstat */
-+#define __NR_lseek (__NR_SYSCALL_BASE+ 19)
-+#define __NR_getpid (__NR_SYSCALL_BASE+ 20)
-+#define __NR_mount (__NR_SYSCALL_BASE+ 21)
-+#define __NR_umount (__NR_SYSCALL_BASE+ 22)
-+#define __NR_setuid (__NR_SYSCALL_BASE+ 23)
-+#define __NR_getuid (__NR_SYSCALL_BASE+ 24)
-+#define __NR_stime (__NR_SYSCALL_BASE+ 25)
-+#define __NR_ptrace (__NR_SYSCALL_BASE+ 26)
-+#define __NR_alarm (__NR_SYSCALL_BASE+ 27)
-+ /* 28 was sys_oldfstat */
-+#define __NR_pause (__NR_SYSCALL_BASE+ 29)
-+#define __NR_utime (__NR_SYSCALL_BASE+ 30)
-+ /* 31 was sys_stty */
-+ /* 32 was sys_gtty */
-+#define __NR_access (__NR_SYSCALL_BASE+ 33)
-+#define __NR_nice (__NR_SYSCALL_BASE+ 34)
-+ /* 35 was sys_ftime */
-+#define __NR_sync (__NR_SYSCALL_BASE+ 36)
-+#define __NR_kill (__NR_SYSCALL_BASE+ 37)
-+#define __NR_rename (__NR_SYSCALL_BASE+ 38)
-+#define __NR_mkdir (__NR_SYSCALL_BASE+ 39)
-+#define __NR_rmdir (__NR_SYSCALL_BASE+ 40)
-+#define __NR_dup (__NR_SYSCALL_BASE+ 41)
-+#define __NR_pipe (__NR_SYSCALL_BASE+ 42)
-+#define __NR_times (__NR_SYSCALL_BASE+ 43)
-+ /* 44 was sys_prof */
-+#define __NR_brk (__NR_SYSCALL_BASE+ 45)
-+#define __NR_setgid (__NR_SYSCALL_BASE+ 46)
-+#define __NR_getgid (__NR_SYSCALL_BASE+ 47)
-+ /* 48 was sys_signal */
-+#define __NR_geteuid (__NR_SYSCALL_BASE+ 49)
-+#define __NR_getegid (__NR_SYSCALL_BASE+ 50)
-+#define __NR_acct (__NR_SYSCALL_BASE+ 51)
-+#define __NR_umount2 (__NR_SYSCALL_BASE+ 52)
-+ /* 53 was sys_lock */
-+#define __NR_ioctl (__NR_SYSCALL_BASE+ 54)
-+#define __NR_fcntl (__NR_SYSCALL_BASE+ 55)
-+ /* 56 was sys_mpx */
-+#define __NR_setpgid (__NR_SYSCALL_BASE+ 57)
-+ /* 58 was sys_ulimit */
-+ /* 59 was sys_olduname */
-+#define __NR_umask (__NR_SYSCALL_BASE+ 60)
-+#define __NR_chroot (__NR_SYSCALL_BASE+ 61)
-+#define __NR_ustat (__NR_SYSCALL_BASE+ 62)
-+#define __NR_dup2 (__NR_SYSCALL_BASE+ 63)
-+#define __NR_getppid (__NR_SYSCALL_BASE+ 64)
-+#define __NR_getpgrp (__NR_SYSCALL_BASE+ 65)
-+#define __NR_setsid (__NR_SYSCALL_BASE+ 66)
-+#define __NR_sigaction (__NR_SYSCALL_BASE+ 67)
-+ /* 68 was sys_sgetmask */
-+ /* 69 was sys_ssetmask */
-+#define __NR_setreuid (__NR_SYSCALL_BASE+ 70)
-+#define __NR_setregid (__NR_SYSCALL_BASE+ 71)
-+#define __NR_sigsuspend (__NR_SYSCALL_BASE+ 72)
-+#define __NR_sigpending (__NR_SYSCALL_BASE+ 73)
-+#define __NR_sethostname (__NR_SYSCALL_BASE+ 74)
-+#define __NR_setrlimit (__NR_SYSCALL_BASE+ 75)
-+#define __NR_getrlimit (__NR_SYSCALL_BASE+ 76) /* Back compat 2GB limited rlimit */
-+#define __NR_getrusage (__NR_SYSCALL_BASE+ 77)
-+#define __NR_gettimeofday (__NR_SYSCALL_BASE+ 78)
-+#define __NR_settimeofday (__NR_SYSCALL_BASE+ 79)
-+#define __NR_getgroups (__NR_SYSCALL_BASE+ 80)
-+#define __NR_setgroups (__NR_SYSCALL_BASE+ 81)
-+#define __NR_select (__NR_SYSCALL_BASE+ 82)
-+#define __NR_symlink (__NR_SYSCALL_BASE+ 83)
-+ /* 84 was sys_lstat */
-+#define __NR_readlink (__NR_SYSCALL_BASE+ 85)
-+#define __NR_uselib (__NR_SYSCALL_BASE+ 86)
-+#define __NR_swapon (__NR_SYSCALL_BASE+ 87)
-+#define __NR_reboot (__NR_SYSCALL_BASE+ 88)
-+#define __NR_readdir (__NR_SYSCALL_BASE+ 89)
-+#define __NR_mmap (__NR_SYSCALL_BASE+ 90)
-+#define __NR_munmap (__NR_SYSCALL_BASE+ 91)
-+#define __NR_truncate (__NR_SYSCALL_BASE+ 92)
-+#define __NR_ftruncate (__NR_SYSCALL_BASE+ 93)
-+#define __NR_fchmod (__NR_SYSCALL_BASE+ 94)
-+#define __NR_fchown (__NR_SYSCALL_BASE+ 95)
-+#define __NR_getpriority (__NR_SYSCALL_BASE+ 96)
-+#define __NR_setpriority (__NR_SYSCALL_BASE+ 97)
-+ /* 98 was sys_profil */
-+#define __NR_statfs (__NR_SYSCALL_BASE+ 99)
-+#define __NR_fstatfs (__NR_SYSCALL_BASE+100)
-+ /* 101 was sys_ioperm */
-+#define __NR_socketcall (__NR_SYSCALL_BASE+102)
-+#define __NR_syslog (__NR_SYSCALL_BASE+103)
-+#define __NR_setitimer (__NR_SYSCALL_BASE+104)
-+#define __NR_getitimer (__NR_SYSCALL_BASE+105)
-+#define __NR_stat (__NR_SYSCALL_BASE+106)
-+#define __NR_lstat (__NR_SYSCALL_BASE+107)
-+#define __NR_fstat (__NR_SYSCALL_BASE+108)
-+ /* 109 was sys_uname */
-+ /* 110 was sys_iopl */
-+#define __NR_vhangup (__NR_SYSCALL_BASE+111)
-+ /* 112 was sys_idle */
-+#define __NR_syscall (__NR_SYSCALL_BASE+113) /* syscall to call a syscall! */
-+#define __NR_wait4 (__NR_SYSCALL_BASE+114)
-+#define __NR_swapoff (__NR_SYSCALL_BASE+115)
-+#define __NR_sysinfo (__NR_SYSCALL_BASE+116)
-+#define __NR_ipc (__NR_SYSCALL_BASE+117)
-+#define __NR_fsync (__NR_SYSCALL_BASE+118)
-+#define __NR_sigreturn (__NR_SYSCALL_BASE+119)
-+#define __NR_clone (__NR_SYSCALL_BASE+120)
-+#define __NR_setdomainname (__NR_SYSCALL_BASE+121)
-+#define __NR_uname (__NR_SYSCALL_BASE+122)
-+ /* 123 was sys_modify_ldt */
-+#define __NR_adjtimex (__NR_SYSCALL_BASE+124)
-+#define __NR_mprotect (__NR_SYSCALL_BASE+125)
-+#define __NR_sigprocmask (__NR_SYSCALL_BASE+126)
-+ /* 127 was sys_create_module */
-+#define __NR_init_module (__NR_SYSCALL_BASE+128)
-+#define __NR_delete_module (__NR_SYSCALL_BASE+129)
-+ /* 130 was sys_get_kernel_syms */
-+#define __NR_quotactl (__NR_SYSCALL_BASE+131)
-+#define __NR_getpgid (__NR_SYSCALL_BASE+132)
-+#define __NR_fchdir (__NR_SYSCALL_BASE+133)
-+#define __NR_bdflush (__NR_SYSCALL_BASE+134)
-+#define __NR_sysfs (__NR_SYSCALL_BASE+135)
-+#define __NR_personality (__NR_SYSCALL_BASE+136)
-+ /* 137 was sys_afs_syscall */
-+#define __NR_setfsuid (__NR_SYSCALL_BASE+138)
-+#define __NR_setfsgid (__NR_SYSCALL_BASE+139)
-+#define __NR__llseek (__NR_SYSCALL_BASE+140)
-+#define __NR_getdents (__NR_SYSCALL_BASE+141)
-+#define __NR__newselect (__NR_SYSCALL_BASE+142)
-+#define __NR_flock (__NR_SYSCALL_BASE+143)
-+#define __NR_msync (__NR_SYSCALL_BASE+144)
-+#define __NR_readv (__NR_SYSCALL_BASE+145)
-+#define __NR_writev (__NR_SYSCALL_BASE+146)
-+#define __NR_getsid (__NR_SYSCALL_BASE+147)
-+#define __NR_fdatasync (__NR_SYSCALL_BASE+148)
-+#define __NR__sysctl (__NR_SYSCALL_BASE+149)
-+#define __NR_mlock (__NR_SYSCALL_BASE+150)
-+#define __NR_munlock (__NR_SYSCALL_BASE+151)
-+#define __NR_mlockall (__NR_SYSCALL_BASE+152)
-+#define __NR_munlockall (__NR_SYSCALL_BASE+153)
-+#define __NR_sched_setparam (__NR_SYSCALL_BASE+154)
-+#define __NR_sched_getparam (__NR_SYSCALL_BASE+155)
-+#define __NR_sched_setscheduler (__NR_SYSCALL_BASE+156)
-+#define __NR_sched_getscheduler (__NR_SYSCALL_BASE+157)
-+#define __NR_sched_yield (__NR_SYSCALL_BASE+158)
-+#define __NR_sched_get_priority_max (__NR_SYSCALL_BASE+159)
-+#define __NR_sched_get_priority_min (__NR_SYSCALL_BASE+160)
-+#define __NR_sched_rr_get_interval (__NR_SYSCALL_BASE+161)
-+#define __NR_nanosleep (__NR_SYSCALL_BASE+162)
-+#define __NR_mremap (__NR_SYSCALL_BASE+163)
-+#define __NR_setresuid (__NR_SYSCALL_BASE+164)
-+#define __NR_getresuid (__NR_SYSCALL_BASE+165)
-+#define __NR_getpagesize (__NR_SYSCALL_BASE+166)
-+ /* 167 was sys_query_module */
-+#define __NR_poll (__NR_SYSCALL_BASE+168)
-+#define __NR_nfsservctl (__NR_SYSCALL_BASE+169)
-+#define __NR_setresgid (__NR_SYSCALL_BASE+170)
-+#define __NR_getresgid (__NR_SYSCALL_BASE+171)
-+#define __NR_prctl (__NR_SYSCALL_BASE+172)
-+#define __NR_rt_sigreturn (__NR_SYSCALL_BASE+173)
-+#define __NR_rt_sigaction (__NR_SYSCALL_BASE+174)
-+#define __NR_rt_sigprocmask (__NR_SYSCALL_BASE+175)
-+#define __NR_rt_sigpending (__NR_SYSCALL_BASE+176)
-+#define __NR_rt_sigtimedwait (__NR_SYSCALL_BASE+177)
-+#define __NR_rt_sigqueueinfo (__NR_SYSCALL_BASE+178)
-+#define __NR_rt_sigsuspend (__NR_SYSCALL_BASE+179)
-+#define __NR_pread64 (__NR_SYSCALL_BASE+180)
-+#define __NR_pwrite64 (__NR_SYSCALL_BASE+181)
-+#define __NR_chown (__NR_SYSCALL_BASE+182)
-+#define __NR_getcwd (__NR_SYSCALL_BASE+183)
-+#define __NR_capget (__NR_SYSCALL_BASE+184)
-+#define __NR_capset (__NR_SYSCALL_BASE+185)
-+#define __NR_sigaltstack (__NR_SYSCALL_BASE+186)
-+#define __NR_sendfile (__NR_SYSCALL_BASE+187)
-+ /* 188 reserved */
-+ /* 189 reserved */
-+#define __NR_vfork (__NR_SYSCALL_BASE+190)
-+#define __NR_ugetrlimit (__NR_SYSCALL_BASE+191) /* SuS compliant getrlimit */
-+#define __NR_mmap2 (__NR_SYSCALL_BASE+192)
-+#define __NR_truncate64 (__NR_SYSCALL_BASE+193)
-+#define __NR_ftruncate64 (__NR_SYSCALL_BASE+194)
-+#define __NR_stat64 (__NR_SYSCALL_BASE+195)
-+#define __NR_lstat64 (__NR_SYSCALL_BASE+196)
-+#define __NR_fstat64 (__NR_SYSCALL_BASE+197)
-+#define __NR_lchown32 (__NR_SYSCALL_BASE+198)
-+#define __NR_getuid32 (__NR_SYSCALL_BASE+199)
-+#define __NR_getgid32 (__NR_SYSCALL_BASE+200)
-+#define __NR_geteuid32 (__NR_SYSCALL_BASE+201)
-+#define __NR_getegid32 (__NR_SYSCALL_BASE+202)
-+#define __NR_setreuid32 (__NR_SYSCALL_BASE+203)
-+#define __NR_setregid32 (__NR_SYSCALL_BASE+204)
-+#define __NR_getgroups32 (__NR_SYSCALL_BASE+205)
-+#define __NR_setgroups32 (__NR_SYSCALL_BASE+206)
-+#define __NR_fchown32 (__NR_SYSCALL_BASE+207)
-+#define __NR_setresuid32 (__NR_SYSCALL_BASE+208)
-+#define __NR_getresuid32 (__NR_SYSCALL_BASE+209)
-+#define __NR_setresgid32 (__NR_SYSCALL_BASE+210)
-+#define __NR_getresgid32 (__NR_SYSCALL_BASE+211)
-+#define __NR_chown32 (__NR_SYSCALL_BASE+212)
-+#define __NR_setuid32 (__NR_SYSCALL_BASE+213)
-+#define __NR_setgid32 (__NR_SYSCALL_BASE+214)
-+#define __NR_setfsuid32 (__NR_SYSCALL_BASE+215)
-+#define __NR_setfsgid32 (__NR_SYSCALL_BASE+216)
-+#define __NR_getdents64 (__NR_SYSCALL_BASE+217)
-+#define __NR_pivot_root (__NR_SYSCALL_BASE+218)
-+#define __NR_mincore (__NR_SYSCALL_BASE+219)
-+#define __NR_madvise (__NR_SYSCALL_BASE+220)
-+#define __NR_fcntl64 (__NR_SYSCALL_BASE+221)
-+ /* 222 for tux */
-+ /* 223 is unused */
-+#define __NR_gettid (__NR_SYSCALL_BASE+224)
-+#define __NR_readahead (__NR_SYSCALL_BASE+225)
-+#define __NR_setxattr (__NR_SYSCALL_BASE+226)
-+#define __NR_lsetxattr (__NR_SYSCALL_BASE+227)
-+#define __NR_fsetxattr (__NR_SYSCALL_BASE+228)
-+#define __NR_getxattr (__NR_SYSCALL_BASE+229)
-+#define __NR_lgetxattr (__NR_SYSCALL_BASE+230)
-+#define __NR_fgetxattr (__NR_SYSCALL_BASE+231)
-+#define __NR_listxattr (__NR_SYSCALL_BASE+232)
-+#define __NR_llistxattr (__NR_SYSCALL_BASE+233)
-+#define __NR_flistxattr (__NR_SYSCALL_BASE+234)
-+#define __NR_removexattr (__NR_SYSCALL_BASE+235)
-+#define __NR_lremovexattr (__NR_SYSCALL_BASE+236)
-+#define __NR_fremovexattr (__NR_SYSCALL_BASE+237)
-+#define __NR_tkill (__NR_SYSCALL_BASE+238)
-+#define __NR_sendfile64 (__NR_SYSCALL_BASE+239)
-+#define __NR_futex (__NR_SYSCALL_BASE+240)
-+#define __NR_sched_setaffinity (__NR_SYSCALL_BASE+241)
-+#define __NR_sched_getaffinity (__NR_SYSCALL_BASE+242)
-+#define __NR_io_setup (__NR_SYSCALL_BASE+243)
-+#define __NR_io_destroy (__NR_SYSCALL_BASE+244)
-+#define __NR_io_getevents (__NR_SYSCALL_BASE+245)
-+#define __NR_io_submit (__NR_SYSCALL_BASE+246)
-+#define __NR_io_cancel (__NR_SYSCALL_BASE+247)
-+#define __NR_exit_group (__NR_SYSCALL_BASE+248)
-+#define __NR_lookup_dcookie (__NR_SYSCALL_BASE+249)
-+#define __NR_epoll_create (__NR_SYSCALL_BASE+250)
-+#define __NR_epoll_ctl (__NR_SYSCALL_BASE+251)
-+#define __NR_epoll_wait (__NR_SYSCALL_BASE+252)
-+#define __NR_remap_file_pages (__NR_SYSCALL_BASE+253)
-+ /* 254 for set_thread_area */
-+ /* 255 for get_thread_area */
-+#define __NR_set_tid_address (__NR_SYSCALL_BASE+256)
-+#define __NR_timer_create (__NR_SYSCALL_BASE+257)
-+#define __NR_timer_settime (__NR_SYSCALL_BASE+258)
-+#define __NR_timer_gettime (__NR_SYSCALL_BASE+259)
-+#define __NR_timer_getoverrun (__NR_SYSCALL_BASE+260)
-+#define __NR_timer_delete (__NR_SYSCALL_BASE+261)
-+#define __NR_clock_settime (__NR_SYSCALL_BASE+262)
-+#define __NR_clock_gettime (__NR_SYSCALL_BASE+263)
-+#define __NR_clock_getres (__NR_SYSCALL_BASE+264)
-+#define __NR_clock_nanosleep (__NR_SYSCALL_BASE+265)
-+#define __NR_statfs64 (__NR_SYSCALL_BASE+266)
-+#define __NR_fstatfs64 (__NR_SYSCALL_BASE+267)
-+#define __NR_tgkill (__NR_SYSCALL_BASE+268)
-+#define __NR_utimes (__NR_SYSCALL_BASE+269)
-+#define __NR_fadvise64_64 (__NR_SYSCALL_BASE+270)
-+#define __NR_pciconfig_iobase (__NR_SYSCALL_BASE+271)
-+#define __NR_pciconfig_read (__NR_SYSCALL_BASE+272)
-+#define __NR_pciconfig_write (__NR_SYSCALL_BASE+273)
-+#define __NR_mq_open (__NR_SYSCALL_BASE+274)
-+#define __NR_mq_unlink (__NR_SYSCALL_BASE+275)
-+#define __NR_mq_timedsend (__NR_SYSCALL_BASE+276)
-+#define __NR_mq_timedreceive (__NR_SYSCALL_BASE+277)
-+#define __NR_mq_notify (__NR_SYSCALL_BASE+278)
-+#define __NR_mq_getsetattr (__NR_SYSCALL_BASE+279)
-+#define __NR_waitid (__NR_SYSCALL_BASE+280)
-+#define __NR_add_key (__NR_SYSCALL_BASE+281)
-+#define __NR_request_key (__NR_SYSCALL_BASE+282)
-+#define __NR_keyctl (__NR_SYSCALL_BASE+283)
-+#define __NR_ioprio_set (__NR_SYSCALL_BASE+284)
-+#define __NR_ioprio_get (__NR_SYSCALL_BASE+285)
-+#define __NR_inotify_init (__NR_SYSCALL_BASE+286)
-+#define __NR_inotify_add_watch (__NR_SYSCALL_BASE+287)
-+#define __NR_inotify_rm_watch (__NR_SYSCALL_BASE+288)
-+#define __NR_migrate_pages (__NR_SYSCALL_BASE+289)
-+#define __NR_openat (__NR_SYSCALL_BASE+290)
-+#define __NR_mkdirat (__NR_SYSCALL_BASE+291)
-+#define __NR_mknodat (__NR_SYSCALL_BASE+292)
-+#define __NR_fchownat (__NR_SYSCALL_BASE+293)
-+#define __NR_futimesat (__NR_SYSCALL_BASE+294)
-+#define __NR_fstatat64 (__NR_SYSCALL_BASE+295)
-+#define __NR_unlinkat (__NR_SYSCALL_BASE+296)
-+#define __NR_renameat (__NR_SYSCALL_BASE+297)
-+#define __NR_linkat (__NR_SYSCALL_BASE+298)
-+#define __NR_symlinkat (__NR_SYSCALL_BASE+299)
-+#define __NR_readlinkat (__NR_SYSCALL_BASE+300)
-+#define __NR_fchmodat (__NR_SYSCALL_BASE+301)
-+#define __NR_faccessat (__NR_SYSCALL_BASE+302)
-+#define __NR_pselect6 (__NR_SYSCALL_BASE+303)
-+#define __NR_ppoll (__NR_SYSCALL_BASE+304)
-+#define __NR_unshare (__NR_SYSCALL_BASE+305)
-+#define __NR_set_robust_list (__NR_SYSCALL_BASE+306)
-+#define __NR_get_robust_list (__NR_SYSCALL_BASE+307)
-+#define __NR_splice (__NR_SYSCALL_BASE+308)
-+#define __NR_sync_file_range2 (__NR_SYSCALL_BASE+309)
-+#define __NR_tee (__NR_SYSCALL_BASE+310)
-+#define __NR_vmsplice (__NR_SYSCALL_BASE+311)
-+#define __NR_move_pages (__NR_SYSCALL_BASE+312)
-+#define __NR_fadvise64 (__NR_SYSCALL_BASE+313)
-+#define __NR_utimensat (__NR_SYSCALL_BASE+314)
-+#define __NR_signalfd (__NR_SYSCALL_BASE+315)
-+#define __NR_timerfd_create (__NR_SYSCALL_BASE+316)
-+#define __NR_eventfd (__NR_SYSCALL_BASE+317)
-+#define __NR_fallocate (__NR_SYSCALL_BASE+318)
-+#define __NR_timerfd_settime (__NR_SYSCALL_BASE+319)
-+#define __NR_timerfd_gettime (__NR_SYSCALL_BASE+320)
-+#define __NR_getcpu (__NR_SYSCALL_BASE+321)
-+#define __NR_signalfd4 (__NR_SYSCALL_BASE+322)
-+#define __NR_eventfd2 (__NR_SYSCALL_BASE+323)
-+#define __NR_epoll_create1 (__NR_SYSCALL_BASE+324)
-+#define __NR_dup3 (__NR_SYSCALL_BASE+325)
-+#define __NR_pipe2 (__NR_SYSCALL_BASE+326)
-+#define __NR_inotify_init1 (__NR_SYSCALL_BASE+327)
-+#define __NR_kexec_load (__NR_SYSCALL_BASE+328)
-+#define __NR_accept (__NR_SYSCALL_BASE+329)
-+#define __NR_bind (__NR_SYSCALL_BASE+330)
-+#define __NR_connect (__NR_SYSCALL_BASE+331)
-+#define __NR_getpeername (__NR_SYSCALL_BASE+332)
-+#define __NR_getsockname (__NR_SYSCALL_BASE+333)
-+#define __NR_getsockopt (__NR_SYSCALL_BASE+334)
-+#define __NR_listen (__NR_SYSCALL_BASE+335)
-+#define __NR_recv (__NR_SYSCALL_BASE+336)
-+#define __NR_recvfrom (__NR_SYSCALL_BASE+337)
-+#define __NR_recvmsg (__NR_SYSCALL_BASE+338)
-+#define __NR_send (__NR_SYSCALL_BASE+339)
-+#define __NR_sendmsg (__NR_SYSCALL_BASE+340)
-+#define __NR_sendto (__NR_SYSCALL_BASE+341)
-+#define __NR_setsockopt (__NR_SYSCALL_BASE+342)
-+#define __NR_shutdown (__NR_SYSCALL_BASE+343)
-+#define __NR_socket (__NR_SYSCALL_BASE+344)
-+#define __NR_socketpair (__NR_SYSCALL_BASE+345)
-+#define __NR_prlimit64 (__NR_SYSCALL_BASE+346)
-+#define __NR_accept4 (__NR_SYSCALL_BASE+347)
-+#define __NR_recvmmsg (__NR_SYSCALL_BASE+348)
-+#define __NR_sendmmsg (__NR_SYSCALL_BASE+349)
-+#define __NR_fanotify_init (__NR_SYSCALL_BASE+350)
-+#define __NR_fanotify_mark (__NR_SYSCALL_BASE+351)
-+#define __NR_msgget (__NR_SYSCALL_BASE+352)
-+#define __NR_msgctl (__NR_SYSCALL_BASE+353)
-+#define __NR_msgrcv (__NR_SYSCALL_BASE+354)
-+#define __NR_msgsnd (__NR_SYSCALL_BASE+355)
-+#define __NR_semget (__NR_SYSCALL_BASE+356)
-+#define __NR_semctl (__NR_SYSCALL_BASE+357)
-+#define __NR_semtimedop (__NR_SYSCALL_BASE+358)
-+#define __NR_semop (__NR_SYSCALL_BASE+359)
-+#define __NR_shmget (__NR_SYSCALL_BASE+360)
-+#define __NR_shmctl (__NR_SYSCALL_BASE+361)
-+#define __NR_shmat (__NR_SYSCALL_BASE+362)
-+#define __NR_shmdt (__NR_SYSCALL_BASE+363)
-+#define __NR_syncfs (__NR_SYSCALL_BASE+364)
-+#define __NR_setns (__NR_SYSCALL_BASE+365)
-+#define __NR_name_to_handle_at (__NR_SYSCALL_BASE+366)
-+#define __NR_open_by_handle_at (__NR_SYSCALL_BASE+367)
-+#define __NR_process_vm_readv (__NR_SYSCALL_BASE+368)
-+#define __NR_process_vm_writev (__NR_SYSCALL_BASE+369)
-+#define __NR_clock_adjtime (__NR_SYSCALL_BASE+370)
-+#define __NR_get_mempolicy (__NR_SYSCALL_BASE+371)
-+#define __NR_mbind (__NR_SYSCALL_BASE+372)
-+#define __NR_perf_event_open (__NR_SYSCALL_BASE+373)
-+#define __NR_preadv (__NR_SYSCALL_BASE+374)
-+#define __NR_pwritev (__NR_SYSCALL_BASE+375)
-+#define __NR_rt_tgsigqueueinfo (__NR_SYSCALL_BASE+376)
-+#define __NR_set_mempolicy (__NR_SYSCALL_BASE+377)
-+#define __NR_epoll_pwait (__NR_SYSCALL_BASE+378)
-+
-+
-+
-+
-+#define __NR_lmmap (__NR_NDS32_BASE+ 1)
-+#define __NR_lmunmap (__NR_NDS32_BASE+ 2)
-+#define __NR_lmdma (__NR_NDS32_BASE+ 3)
-+#define __NR_pfmctl (__NR_NDS32_BASE+ 4)
-+#define __NR_getpfm (__NR_NDS32_BASE+ 5)
-+#define __NR_setpfm (__NR_NDS32_BASE+ 6)
-+#define __NR_wbna (__NR_NDS32_BASE+ 7)
-+
-+
-+
-+#ifdef __KERNEL__
-+
-+#define __ARCH_WANT_IPC_PARSE_VERSION
-+#define __ARCH_WANT_OLD_READDIR
-+#define __ARCH_WANT_STAT64
-+#define __ARCH_WANT_SYS_ALARM
-+#define __ARCH_WANT_SYS_GETHOSTNAME
-+#define __ARCH_WANT_SYS_PAUSE
-+#define __ARCH_WANT_SYS_TIME
-+#define __ARCH_WANT_SYS_UTIME
-+#define __ARCH_WANT_SYS_SOCKETCALL
-+#define __ARCH_WANT_SYS_FADVISE64
-+#define __ARCH_WANT_SYS_GETPGRP
-+#define __ARCH_WANT_SYS_LLSEEK
-+#define __ARCH_WANT_SYS_NICE
-+#define __ARCH_WANT_SYS_OLD_GETRLIMIT
-+#define __ARCH_WANT_SYS_OLD_MMAP
-+#define __ARCH_WANT_SYS_OLDUMOUNT
-+#define __ARCH_WANT_SYS_SIGPENDING
-+#define __ARCH_WANT_SYS_SIGPROCMASK
-+#define __ARCH_WANT_SYS_RT_SIGACTION
-+
-+/*
-+ * "Conditional" syscalls
-+ *
-+ * What we want is __attribute__((weak,alias("sys_ni_syscall"))),
-+ * but it doesn't work on all toolchains, so we just do it by hand
-+ */
-+#define cond_syscall(x) asm(".weak\t" #x "\n\t.set\t" #x ",sys_ni_syscall");
-+
-+#endif
-+#endif /* __ASM_NDS32_UNISTD_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/user.h linux-3.4.113/arch/nds32/include/asm/user.h
---- linux-3.4.113.orig/arch/nds32/include/asm/user.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/user.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,89 @@
-+/*
-+ * linux/arch/nds32/include/asm/user.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef _NDS32_USER_H
-+#define _NDS32_USER_H
-+
-+#include <asm/page.h>
-+#include <asm/ptrace.h>
-+/* Core file format: The core file is written in such a way that gdb
-+ can understand it and provide useful information to the user (under
-+ linux we use the 'trad-core' bfd). There are quite a number of
-+ obstacles to being able to view the contents of the floating point
-+ registers, and until these are solved you will not be able to view the
-+ contents of them. Actually, you can read in the core file and look at
-+ the contents of the user struct to find out what the floating point
-+ registers contain.
-+ The actual file contents are as follows:
-+ UPAGE: 1 page consisting of a user struct that tells gdb what is present
-+ in the file. Directly after this is a copy of the task_struct, which
-+ is currently not used by gdb, but it may come in useful at some point.
-+ All of the registers are stored as part of the upage. The upage should
-+ always be only one page.
-+ DATA: The data area is stored. We use current->end_text to
-+ current->brk to pick up all of the user variables, plus any memory
-+ that may have been malloced. No attempt is made to determine if a page
-+ is demand-zero or if a page is totally unused, we just cover the entire
-+ range. All of the addresses are rounded in such a way that an integral
-+ number of pages is written.
-+ STACK: We need the stack information in order to get a meaningful
-+ backtrace. We need to write the data from (esp) to
-+ current->start_stack, so we round each of these off in order to be able
-+ to write an integer number of pages.
-+ The minimum core file size is 3 pages, or 12288 bytes.
-+*/
-+
-+struct user_fp {
-+ struct fp_reg {
-+ unsigned int sign1:1;
-+ unsigned int unused:15;
-+ unsigned int sign2:1;
-+ unsigned int exponent:14;
-+ unsigned int j:1;
-+ unsigned int mantissa1:31;
-+ unsigned int mantissa0:32;
-+ } fpregs[8];
-+ unsigned int fpsr:32;
-+ unsigned int fpcr:32;
-+ unsigned char ftype[8];
-+ unsigned int init_flag;
-+};
-+
-+/* When the kernel dumps core, it starts by dumping the user struct -
-+ this will be used by gdb to figure out where the data and stack segments
-+ are within the file, and what virtual addresses to use. */
-+struct user{
-+/* We start with the registers, to mimic the way that "memory" is returned
-+ from the ptrace(3,...) function. */
-+ struct pt_regs regs; /* Where the registers are actually stored */
-+/* ptrace does not yet supply these. Someday.... */
-+ int u_fpvalid; /* True if math co-processor being used. */
-+ /* for this mess. Not yet used. */
-+/* The rest of this junk is to help gdb figure out what goes where */
-+ unsigned long int u_tsize; /* Text segment size (pages). */
-+ unsigned long int u_dsize; /* Data segment size (pages). */
-+ unsigned long int u_ssize; /* Stack segment size (pages). */
-+ unsigned long start_code; /* Starting virtual address of text. */
-+ unsigned long start_stack; /* Starting virtual address of stack area.
-+ This is actually the bottom of the stack,
-+ the top of the stack is always found in the
-+ esp register. */
-+ long int signal; /* Signal that caused the core dump. */
-+ int reserved; /* No longer used */
-+ struct pt_regs * u_ar0; /* Used by gdb to help find the values for */
-+ /* the registers. */
-+ unsigned long magic; /* To uniquely identify a core file */
-+ char u_comm[32]; /* User command that was responsible */
-+ int u_debugreg[8];
-+ struct user_fp u_fp; /* FP state */
-+ struct user_fp_struct * u_fp0;/* Used by gdb to help find the values for */
-+ /* the FP registers. */
-+};
-+#define NBPG PAGE_SIZE
-+#define UPAGES 1
-+#define HOST_TEXT_START_ADDR (u.start_code)
-+#define HOST_STACK_END_ADDR (u.start_stack + u.u_ssize * NBPG)
-+
-+#endif /* _NDS32_USER_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/vga.h linux-3.4.113/arch/nds32/include/asm/vga.h
---- linux-3.4.113.orig/arch/nds32/include/asm/vga.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/vga.h 2016-12-01 20:59:24.348612597 +0100
-@@ -0,0 +1,17 @@
-+/*
-+ * linux/arch/nds32/include/asm/vga.h
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#ifndef ASMNDS32_VGA_H
-+#define ASMNDS32_VGA_H
-+
-+#include <asm/hardware.h>
-+#include <asm/io.h>
-+
-+#define VGA_MAP_MEM(x) (PCIMEM_BASE + (x))
-+
-+#define vga_readb(x) (*((volatile unsigned char *)x))
-+#define vga_writeb(x,y) (*((volatile unsigned char *)y) = (x))
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/vmalloc.h linux-3.4.113/arch/nds32/include/asm/vmalloc.h
---- linux-3.4.113.orig/arch/nds32/include/asm/vmalloc.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/vmalloc.h 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,31 @@
-+/*
-+ * linux/arch/nds32/include/asm/vmalloc.h
-+ *
-+ * Faraday Platform Independent Virtual Memory Configuration
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/16/2005 Copy from Faraday CPE codes.
-+ */
-+
-+#ifndef __FARADAY_PLATFORM_INDEPENDENT_VMALLOC_HEADER__
-+#define __FARADAY_PLATFORM_INDEPENDENT_VMALLOC_HEADER__
-+
-+#endif /* __FARADAY_PLATFORM_INDEPENDENT_VMALLOC_HEADER__ */
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/xor.h linux-3.4.113/arch/nds32/include/asm/xor.h
---- linux-3.4.113.orig/arch/nds32/include/asm/xor.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/xor.h 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,157 @@
-+/*
-+ * linux/arch/nds32/include/asm/xor.h
-+ *
-+ * Copyright (C) 2001 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <asm-generic/xor.h>
-+
-+#define __XOR(a1, a2) a1 ^= a2
-+
-+
-+#define GET_BLOCK_2(dst) \
-+ __asm__( \
-+ " lmw.bim %1, [%0], %2 \n"\
-+ : "=r" (dst), "=r" (a1), "=r" (a2) \
-+ : "0" (dst))
-+
-+#define GET_BLOCK_4(dst) \
-+ __asm__( \
-+ " lmw.bim %1, [%0], %1 \n" \ //ldmia %0, {%1, %2, %3, %4}
-+ " lmw.bim %2, [%0], %2 \n" \
-+ " lmw.bim %3, [%0], %3 \n" \
-+ " lmw.bim %4, [%0], %4 \n" \
-+ : "=r" (dst), "=r" (a1), "=r" (a2), "=r" (a3), "=r" (a4) \
-+ : "0" (dst))
-+
-+#define XOR_BLOCK_2(src) \
-+ __asm__(\
-+ " lmw.bim %1, [%0], %2 \n " \
-+ " lmw.bim %2, [%0], %2 \n" \
-+ : "=r" (src), "=r" (b1), "=r" (b2) \
-+ : "0" (src)); \
-+ __XOR(a1, b1); __XOR(a2, b2);
-+
-+
-+#define XOR_BLOCK_4(src) \
-+ __asm__(\
-+ "lmw.bim %1, [%0], %1 \n " \ // ldmia %0!, {%1, %2, %3, %4}
-+ "lmw.bim %2, [%0], %2 \n " \
-+ "lmw.bim %3, [%0], %3 \n " \
-+ "lmw.bim %4, [%0], %4 \n " \
-+ : "=r" (src), "=r" (b1), "=r" (b2), "=r" (b3), "=r" (b4) \
-+ : "0" (src)); \
-+ __XOR(a1, b1); __XOR(a2, b2); __XOR(a3, b3); __XOR(a4, b4)
-+
-+#define PUT_BLOCK_2(dst) \
-+ __asm__ __volatile__( \
-+ " smw.bim %2, [%0], %3" \
-+ : "=r" (dst) \
-+ : "0" (dst), "r" (a1), "r" (a2))
-+
-+#define PUT_BLOCK_4(dst) \
-+ __asm__ __volatile__( \
-+ " smw.bim %2, [%0], %5 \n" \
-+ : "=r" (dst) \
-+ : "0" (dst), "r" (a1), "r" (a2), "r" (a3), "r" (a4))
-+
-+static void
-+xor_nds32regs_2(unsigned long bytes, unsigned long *p1, unsigned long *p2)
-+{
-+ unsigned int lines = bytes / sizeof(unsigned long) / 4;
-+ register unsigned int a1 __asm__("r4");
-+ register unsigned int a2 __asm__("r5");
-+ register unsigned int a3 __asm__("r6");
-+ register unsigned int a4 __asm__("r7");
-+ register unsigned int b1 __asm__("r8");
-+ register unsigned int b2 __asm__("r9");
-+ register unsigned int b3 __asm__("p0");
-+ register unsigned int b4 __asm__("ra");
-+
-+ do {
-+ GET_BLOCK_4(p1);
-+ XOR_BLOCK_4(p2);
-+ PUT_BLOCK_4(p1);
-+ } while (--lines);
-+}
-+
-+static void
-+xor_nds32regs_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
-+ unsigned long *p3)
-+{
-+ unsigned int lines = bytes / sizeof(unsigned long) / 4;
-+ register unsigned int a1 __asm__("r4");
-+ register unsigned int a2 __asm__("r5");
-+ register unsigned int a3 __asm__("r6");
-+ register unsigned int a4 __asm__("r7");
-+ register unsigned int b1 __asm__("r8");
-+ register unsigned int b2 __asm__("r9");
-+ register unsigned int b3 __asm__("p0");
-+ register unsigned int b4 __asm__("ra");
-+
-+ do {
-+ GET_BLOCK_4(p1);
-+ XOR_BLOCK_4(p2);
-+ XOR_BLOCK_4(p3);
-+ PUT_BLOCK_4(p1);
-+ } while (--lines);
-+}
-+
-+static void
-+xor_nds32regs_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
-+ unsigned long *p3, unsigned long *p4)
-+{
-+ unsigned int lines = bytes / sizeof(unsigned long) / 2;
-+ register unsigned int a1 __asm__("r8");
-+ register unsigned int a2 __asm__("r9");
-+ register unsigned int b1 __asm__("p0");
-+ register unsigned int b2 __asm__("ra");
-+
-+ do {
-+ GET_BLOCK_2(p1);
-+ XOR_BLOCK_2(p2);
-+ XOR_BLOCK_2(p3);
-+ XOR_BLOCK_2(p4);
-+ PUT_BLOCK_2(p1);
-+ } while (--lines);
-+}
-+
-+static void
-+xor_nds32regs_5(unsigned long bytes, unsigned long *p1, unsigned long *p2,
-+ unsigned long *p3, unsigned long *p4, unsigned long *p5)
-+{
-+ unsigned int lines = bytes / sizeof(unsigned long) / 2;
-+ register unsigned int a1 __asm__("r8");
-+ register unsigned int a2 __asm__("r9");
-+ register unsigned int b1 __asm__("p0");
-+ register unsigned int b2 __asm__("ra");
-+
-+ do {
-+ GET_BLOCK_2(p1);
-+ XOR_BLOCK_2(p2);
-+ XOR_BLOCK_2(p3);
-+ XOR_BLOCK_2(p4);
-+ XOR_BLOCK_2(p5);
-+ PUT_BLOCK_2(p1);
-+ } while (--lines);
-+}
-+
-+static struct xor_block_template xor_block_nds32regs = {
-+ .name = "nds32regs",
-+ .do_2 = xor_nds32regs_2,
-+ .do_3 = xor_nds32regs_3,
-+ .do_4 = xor_nds32regs_4,
-+ .do_5 = xor_nds32regs_5,
-+};
-+
-+#undef XOR_TRY_TEMPLATES
-+#define XOR_TRY_TEMPLATES \
-+ do { \
-+ xor_speed(&xor_block_nds32regs); \
-+ xor_speed(&xor_block_8regs); \
-+ xor_speed(&xor_block_32regs); \
-+ } while (0)
-diff -Nur linux-3.4.113.orig/arch/nds32/Kconfig linux-3.4.113/arch/nds32/Kconfig
---- linux-3.4.113.orig/arch/nds32/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/Kconfig 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,249 @@
-+#
-+# For a description of the syntax of this configuration file,
-+# see Documentation/kbuild/kconfig-language.txt.
-+#
-+
-+config NDS32
-+ bool
-+ default y
-+ select RTC_LIB
-+ select HAVE_OPROFILE
-+ select HAVE_ARCH_KGDB
-+ select HAVE_KPROBES
-+ select HAVE_KRETPROBES
-+ select HAVE_FUNCTION_TRACER
-+ select HAVE_FUNCTION_GRAPH_TRACER
-+ select HAVE_FUNCTION_TRACE_MCOUNT_TEST
-+ select SYS_SUPPORTS_APM_EMULATION
-+ select HAVE_IDE
-+ select HAVE_MEMBLOCK
-+ select HAVE_MEMBLOCK_NODE_MAP
-+
-+config GENERIC_GPIO
-+ bool
-+ default n
-+
-+config GENERIC_TIME
-+ bool
-+ default y
-+
-+config GENERIC_CLOCKEVENTS
-+ bool
-+ default y
-+
-+config NO_IOPORT
-+ bool
-+ default y
-+
-+config GENERIC_IOMAP
-+ def_bool y
-+
-+config GENERIC_LOCKBREAK
-+ bool
-+ default y
-+ depends on SMP && PREEMPT
-+
-+config RWSEM_GENERIC_SPINLOCK
-+ bool
-+ default y
-+
-+config RWSEM_XCHGADD_ALGORITHM
-+ bool
-+
-+config GENERIC_HWEIGHT
-+ bool
-+ default y
-+
-+config GENERIC_FIND_NEXT_BIT
-+ bool
-+ default y
-+
-+config GENERIC_CALIBRATE_DELAY
-+ bool
-+ default y
-+
-+config GENERIC_BUST_SPINLOCK
-+ bool
-+
-+config GENERIC_HARDIRQS
-+ bool
-+ default y
-+
-+config GENERIC_HARDIRQS_NO__DO_IRQ
-+ def_bool y
-+
-+config LOCKDEP_SUPPORT
-+ bool
-+ default y
-+
-+config STACKTRACE_SUPPORT
-+ bool
-+ default y
-+
-+config HAVE_LATENCYTOP_SUPPORT
-+ def_bool y
-+
-+source "init/Kconfig"
-+source "kernel/Kconfig.freezer"
-+
-+menu "System Type"
-+source "arch/nds32/platforms/Kconfig"
-+source "arch/nds32/Kconfig.cpu"
-+
-+config VECTORS_BASE
-+ hex
-+ default 0xfeff0000 if MMU || CPU_HIGH_VECTOR
-+ default DRAM_BASE if REMAP_VECTORS_TO_RAM
-+ default 0x00000000
-+ help
-+ The base address of exception vectors.
-+
-+config MMU
-+ bool
-+ default y
-+
-+endmenu
-+
-+menu "Kernel Features"
-+source "kernel/time/Kconfig"
-+
-+config SMP
-+ bool "Symmetric Multi-Processing"
-+ depends on PLATFORM_AMIC
-+ select USE_GENERIC_SMP_HELPERS
-+ help
-+ This enables support for systems with more than one CPU. If you have
-+ a system with only one CPU, like most personal computers, say N. If
-+ you have a system with more than one CPU, say Y.
-+
-+ If you say N here, the kernel will run on single and multiprocessor
-+ machines, but will use only one CPU of a multiprocessor machine. If
-+ you say Y here, the kernel will run on many, but not all, single
-+ processor machines. On a single processor machine, the kernel will
-+ run faster if you say N here.
-+
-+ See also the <file:Documentation/smp.tex>,
-+ <file:Documentation/smp.txt>, <file:Documentation/i386/IO-APIC.txt>,
-+ <file:Documentation/nmi_watchdog.txt> and the SMP-HOWTO available at
-+ <http://www.linuxdoc.org/docs.html#howto>.
-+
-+ If you don't know what to do here, say N.
-+
-+config NR_CPUS
-+ int "Maximum number of CPUs (2-32)"
-+ depends on SMP
-+ default "4"
-+
-+source "kernel/Kconfig.preempt"
-+source "mm/Kconfig"
-+
-+config FORCE_MAX_ZONEORDER
-+ int "MAX_ORDER for the Page Allocator"
-+ default "11"
-+
-+source "kernel/Kconfig.hz"
-+
-+config CMDLINE
-+ string "Default kernel command string"
-+ default "mem=64M@0x0 initrd=0x800000,8M root=/dev/ram0 rw console=ttyS0,38400n8 rootfstype=ext2 init=/sbin/init -s"
-+
-+endmenu
-+
-+menu "Power management options"
-+
-+config SYS_SUPPORTS_APM_EMULATION
-+ bool
-+
-+config ARCH_SUSPEND_POSSIBLE
-+ def_bool y
-+
-+source "kernel/power/Kconfig"
-+
-+if PLAT_AG101 || PLAT_AG102
-+source "drivers/cpufreq/Kconfig"
-+
-+if PLAT_AG101
-+choice
-+ prompt "Default CPUFreq Implementation"
-+ depends on CPU_FREQ
-+ default AG101_CPU_FREQ_SCALING_MODE
-+ help
-+ This option sets which CPUFreq governor shall be loaded at
-+ startup. If in doubt, select 'performance'.
-+config AG101_CPU_FREQ_SCALING_MODE
-+ bool "AG101 Frequency Scaling Mode"
-+ help
-+ Rescale CPU frequency and Bus clock without changing PLL.
-+
-+config AG101_CPU_FREQ_FCS
-+ bool "AG101 Frequency Change Sequence (FCS)"
-+ help
-+ The Frequency Change Sequence (FCS) is used to change the system
-+ clock frequency. While in the FCS, the system clocks stop. This
-+ mode is intended for setting a different frequency to overwrite
-+ the default value at initial boot-up. This can be used as a powr-
-+ saving feature that allows the AG101 to run at the minimum required
-+ frequency
-+endchoice
-+endif
-+
-+if PLAT_AG102
-+choice
-+ prompt "Default CPUFreq Implementation"
-+ depends on CPU_FREQ
-+ default AG102_CPU_FREQ_SCALING_MODE
-+ help
-+ This option sets which CPUFreq governor shall be loaded at
-+ startup. If in doubt, select 'performance'.
-+config AG102_CPU_FREQ_SCALING_MODE
-+ bool "AG102 Frequency Scaling Mode"
-+ help
-+ Rescale CPU frequency and Bus clock without changing PLL.
-+
-+config AG102_CPU_FREQ_FCS
-+ bool "AG102 Frequency Change Sequence (FCS)"
-+ help
-+ The Frequency Change Sequence (FCS) is used to change the system
-+ clock frequency. While in the FCS, the system clocks stop. This
-+ mode is intended for setting a different frequency to overwrite
-+ the default value at initial boot-up. This can be used as a powr-
-+ saving feature that allows the AG101 to run at the minimum required
-+ frequency
-+endchoice
-+endif
-+
-+
-+endif
-+
-+endmenu
-+
-+menu "Bus options"
-+
-+config PCI
-+ bool "PCI support"
-+ help
-+ Find out whether you have a PCI motherboard. PCI is the name of a
-+ bus system, i.e. the way the CPU talks to the other stuff inside
-+ your box. Other bus systems are ISA, EISA, MicroChannel (MCA) or
-+ VESA. If you have PCI, say Y, otherwise N.
-+
-+ The PCI-HOWTO, available from
-+ <http://www.tldp.org/docs.html#howto>, contains valuable
-+ information about which PCI hardware does work under Linux and which
-+ doesn't.
-+
-+source "drivers/pci/Kconfig"
-+
-+endmenu
-+
-+menu "Executable file formats"
-+source "fs/Kconfig.binfmt"
-+endmenu
-+
-+source "net/Kconfig"
-+source "drivers/Kconfig"
-+source "fs/Kconfig"
-+source "arch/nds32/Kconfig.debug"
-+source "security/Kconfig"
-+source "crypto/Kconfig"
-+source "lib/Kconfig"
-diff -Nur linux-3.4.113.orig/arch/nds32/Kconfig.cpu linux-3.4.113/arch/nds32/Kconfig.cpu
---- linux-3.4.113.orig/arch/nds32/Kconfig.cpu 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/Kconfig.cpu 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,148 @@
-+comment "Processor Features"
-+config CPU_N1213
-+ bool
-+
-+config CPU_N1213_43U1HA0
-+ bool
-+
-+config CPU_N1233F
-+ bool
-+
-+config CPU_CUSTOM
-+ bool
-+
-+config FPU
-+ bool "fpu support"
-+
-+config UNLAZY_FPU
-+ bool "Unlazy FPU support"
-+ depends on FPU
-+ help
-+ Say Y here to enable unlazy FPU and disable lazy FPU.
-+
-+
-+config AUDIO
-+ bool "audio support" if CPU_CUSTOM
-+
-+config HWZOL
-+ bool "hardware zero overhead loop support"
-+ default y
-+
-+config UNLAZY_AUDIO
-+ bool "Unlazy audio support"
-+ depends on AUDIO
-+ help
-+ Say Y here to enable unlazy audio and disable lazy audio.
-+choice
-+ prompt "Vector Interrupt Controller mode"
-+ default IVIC_INTC
-+config IVIC_INTC
-+ bool "IVIC mode with Interrupt Controller"
-+config IVIC
-+ bool "IVIC mode"
-+config EVIC
-+ bool "EVIC mode"
-+endchoice
-+
-+config CPU_NO_CONTEXT_ID
-+ def_bool CPU_N1213_43U1HA0 || SMP
-+
-+config CPU_CACHE_NONALIASING
-+ bool "Non-aliasing cache"
-+
-+choice
-+ prompt "Paging -- page size "
-+ default ANDES_PAGE_SIZE_4KB
-+config ANDES_PAGE_SIZE_4KB
-+ bool "use 4KB page size"
-+config ANDES_PAGE_SIZE_8KB
-+ bool "use 8KB page size"
-+endchoice
-+
-+config NO_KERNEL_LARGE_PAGE
-+ def_bool CPU_N1213_43U1HA0 || SMP
-+
-+config CPU_ICACHE_DISABLE
-+ bool "Disable I-Cache"
-+ help
-+ Say Y here to disable the processor instruction cache. Unless
-+ you have a reason not to or are unsure, say N.
-+
-+config CPU_DCACHE_DISABLE
-+ bool "Disable D-Cache"
-+ help
-+ Say Y here to disable the processor data cache. Unless
-+ you have a reason not to or are unsure, say N.
-+
-+config CPU_DCACHE_WRITETHROUGH
-+ bool "Force write through D-cache"
-+ depends on !CPU_DCACHE_DISABLE
-+ help
-+ Say Y here to use the data cache in writethrough mode. Unless you
-+ specifically require this or are unsure, say N.
-+
-+config KEXEC
-+ bool "Kexec system call (EXPERIMENTAL)"
-+ depends on EXPERIMENTAL
-+ help
-+ kexec is a system call that implements the ability to shutdown your
-+ current kernel, and to start another kernel. It is like a reboot
-+ but it is independent of the system firmware. And like a reboot
-+ you can start any kernel with it, not just Linux.
-+
-+ It is an ongoing process to be certain the hardware in a machine
-+ is properly shutdown, so do not be surprised if this code does not
-+ initially work for you. It may help to enable device hotplugging
-+ support.
-+
-+config ABI1
-+ bool "Allow ABI 1 binaries to run with this kernel (EXPERIMENTAL)"
-+ depends on EXPERIMENTAL
-+ default n
-+ help
-+ This option preserves the old syscall interface of ABI 1. If
-+ you know you'll be using ABI 2 or 2fp then you can say N here.
-+ If this option is not selected and you attempt to execute a
-+ legacy ABI binary then the result will be UNPREDICTABLE
-+ (in fact it can be predicted that it won't work at all). If
-+ in doubt say Y.
-+
-+config WBNA
-+ bool "WBNA"
-+ default n
-+ help
-+ Say Y here to enable write-back memory with no-write-allocation policy.
-+
-+config HSS
-+ bool "Using Hardware Single-Step (HSS) instead of software breakpoint"
-+ default y
-+
-+config ALIGNMENT_TRAP
-+ tristate "Kernel support unaligned access handling"
-+ depends on EXPERIMENTAL
-+ default y
-+ help
-+ Andes processors cannot fetch/store information which is not
-+ naturally aligned on the bus, i.e., a 4 byte fetch must start at an
-+ address divisible by 4. On 32-bit Andes processors, these non-aligned
-+ fetch/store instructions will be emulated in software if you say
-+ here, which has a severe performance impact. This is necessary for
-+ correct operation of some network protocols. With an IP-only
-+ configuration it is safe to say N, otherwise say Y.
-+
-+config HIGHMEM
-+ bool "High Memory Support"
-+ depends on MMU
-+ help
-+ The address space of ARM processors is only 4 Gigabytes large
-+ and it has to accommodate user address space, kernel address
-+ space as well as some memory mapped IO. That means that, if you
-+ have a large amount of physical memory and/or IO, not all of the
-+ memory can be "permanently mapped" by the kernel. The physical
-+ memory that is not permanently mapped is called "high memory".
-+
-+ Depending on the selected kernel/user memory split, minimum
-+ vmalloc space and actual amount of RAM, you may not need this
-+ option which should result in a slightly faster kernel.
-+
-+ If unsure, say n.
-diff -Nur linux-3.4.113.orig/arch/nds32/Kconfig.debug linux-3.4.113/arch/nds32/Kconfig.debug
---- linux-3.4.113.orig/arch/nds32/Kconfig.debug 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/Kconfig.debug 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,82 @@
-+menu "Kernel hacking"
-+
-+config TRACE_IRQFLAGS_SUPPORT
-+ bool
-+ default y
-+
-+source "lib/Kconfig.debug"
-+
-+config FRAME_POINTER
-+ bool
-+ default y
-+ help
-+ If you say N here, the resulting kernel will be slightly smaller and
-+ faster. However, when a problem occurs with the kernel, the
-+ information that is reported is severely limited. Most people
-+ should say Y here.
-+
-+config DEBUG_USER
-+ bool "Verbose user fault messages"
-+ help
-+ When a user program crashes due to an exception, the kernel can
-+ print a brief message explaining what the problem was. This is
-+ sometimes helpful for debugging but serves no purpose on a
-+ production system. Most people should say N here.
-+
-+ In addition, you need to pass user_debug=N on the kernel command
-+ line to enable this feature. N consists of the sum of:
-+
-+ 1 - undefined instruction events
-+ 2 - system calls
-+ 4 - invalid data aborts
-+ 8 - SIGSEGV faults
-+ 16 - SIGBUS faults
-+
-+config DEBUG_ERRORS
-+ bool "Verbose kernel error messages"
-+ depends on DEBUG_KERNEL
-+ help
-+ This option controls verbose debugging information which can be
-+ printed when the kernel detects an internal error. This debugging
-+ information is useful to kernel hackers when tracking down problems,
-+ but mostly meaningless to other people. It's safe to say Y unless
-+ you are concerned with the code size or don't want to see these
-+ messages.
-+
-+config DEBUG_LL
-+ bool "Kernel low-level debugging functions"
-+ depends on DEBUG_KERNEL
-+ help
-+ Say Y here to include definitions of printascii, printchar, printhex
-+ in the kernel. This is helpful if you are debugging code that
-+ executes before the console is initialized.
-+
-+config CCTL
-+ tristate "User space cache control support (EXPERIMENTAL)"
-+ depends on EXPERIMENTAL
-+ help
-+ export cache control to user space via /proc
-+
-+ If unsure, say N.
-+
-+config ELFCHK_DEFAULT_ENABLE
-+ bool "Enable ELF-Core Checking by default"
-+ default n
-+ select PROC_FS
-+ help
-+ ELF-Core Checking is a mechanism which prevents ELF binary from
-+ being loaded if it requires any feature that the underlying platform
-+ doesn't support.
-+
-+ If you say Y here, the resulting kernel enables ELF-Core Checking
-+ mechanism by default.
-+config EARLY_PRINTK
-+ bool "Early printk support"
-+ default y
-+ help
-+ Say Y here if you want to have an early console using the
-+ earlyprintk=<name>[,<addr>][,<options>] kernel parameter. It
-+ is assumed that the early console device has been initialised
-+ by the boot loader prior to starting the Linux kernel.
-+
-+endmenu
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/asm-offsets.c linux-3.4.113/arch/nds32/kernel/asm-offsets.c
---- linux-3.4.113.orig/arch/nds32/kernel/asm-offsets.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/asm-offsets.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,72 @@
-+/*
-+ * Copyright (C) 1995-2003 Russell King
-+ * 2001-2002 Keith Owens
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * Generate definitions needed by assembly language modules.
-+ * This code generates raw asm output which is post-processed to extract
-+ * and format the required data.
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/sched.h>
-+#include <linux/mm.h>
-+#include <asm/mach/arch.h>
-+#include <asm/thread_info.h>
-+#include <asm/memory.h>
-+#include <asm/procinfo.h>
-+
-+/*
-+ * Make sure that the compiler and target are compatible.
-+ */
-+
-+#if __GNUC__ < 3 || \
-+ (__GNUC__ == 3 && __GNUC_MINOR__ < 4) || \
-+ (__GNUC__ == 3 && __GNUC_MINOR__ == 4 && __GNUC_PATCHLEVEL__ != 0 && \
-+ __GNUC_PATCHLEVEL__ < 4) || \
-+ (__GNUC__ == 4 && __GNUC_MINOR__ < 2)
-+#error Your compiler is too buggy; it is known to miscompile kernels.
-+#error Known good compilers: 3.4.4, 4.2
-+#endif
-+
-+/* Use marker if you need to separate the values later */
-+
-+#define DEFINE(sym, val) \
-+ asm volatile("\n->" #sym " %0 " #val : : "i" (val))
-+
-+#define BLANK() asm volatile("\n->" : : )
-+
-+int main(void)
-+{
-+ DEFINE(TSK_ACTIVE_MM, offsetof(struct task_struct, active_mm));
-+ BLANK();
-+ DEFINE(TI_FLAGS, offsetof(struct thread_info, flags));
-+ DEFINE(TI_PREEMPT, offsetof(struct thread_info, preempt_count));
-+ DEFINE(TI_ADDR_LIMIT, offsetof(struct thread_info, addr_limit));
-+ DEFINE(TI_TASK, offsetof(struct thread_info, task));
-+ DEFINE(TI_EXEC_DOMAIN, offsetof(struct thread_info, exec_domain));
-+ DEFINE(TI_CPU, offsetof(struct thread_info, cpu));
-+// DEFINE(TI_TP_VALUE, offsetof(struct thread_info, tp_value));
-+ DEFINE(TI_SP_SAVE, offsetof(struct thread_info, sp_save));
-+ BLANK();
-+ DEFINE(S_FRAME_SIZE, sizeof(struct pt_regs));
-+ BLANK();
-+ DEFINE(MM_CONTEXT_ID, offsetof(struct mm_struct, context.id));
-+ BLANK();
-+ DEFINE(VMA_VM_MM, offsetof(struct vm_area_struct, vm_mm));
-+ DEFINE(VMA_VM_FLAGS, offsetof(struct vm_area_struct, vm_flags));
-+ BLANK();
-+ DEFINE(VM_EXEC, VM_EXEC);
-+ BLANK();
-+ DEFINE(VIRT_OFFSET, PAGE_OFFSET);
-+ BLANK();
-+ DEFINE(SIZEOF_MACHINE_DESC, sizeof(struct machine_desc));
-+ DEFINE(MACHINFO_TYPE, offsetof(struct machine_desc, nr));
-+ DEFINE(MACHINFO_NAME, offsetof(struct machine_desc, name));
-+ BLANK();
-+ DEFINE(PROC_INFO_SZ, sizeof(struct proc_info_list));
-+
-+ return 0;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/audio.c linux-3.4.113/arch/nds32/kernel/audio.c
---- linux-3.4.113.orig/arch/nds32/kernel/audio.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/audio.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,218 @@
-+/*
-+ * arch/nds32/kernel/audio.c
-+ *
-+ * Copyright (C) 2001 Manuela Cirronis, Paolo Alberelli
-+ * Copyright (C) 2002 STMicroelectronics Limited
-+ * Author : Stuart Menefy
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * Started from SH4 version:
-+ * Copyright (C) 1999, 2000 Kaz Kojima & Niibe Yutaka
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ */
-+#include <linux/sched.h>
-+#include <linux/signal.h>
-+#include <asm/processor.h>
-+#include <asm/user.h>
-+#include <asm/io.h>
-+#include <asm/bitfield.h>
-+#include <asm/audio.h>
-+#include "audio.h"
-+/*
-+ * Initially load the audio with signalling NANS. This bit pattern
-+ * has the property that no matter whether considered as single or as
-+ * double precision, it still represents a signalling NAN.
-+ */
-+
-+static struct audio_struct init_audioregs = {
-+ .auregs = {[0...31] = NAN32}
-+};
-+
-+void save_audio(struct task_struct *tsk)
-+{
-+ unsigned int tmp;
-+ enable_audio();
-+ asm volatile ("mfsr %0, $MSC_CFG\n\t"
-+ "andi %0, %0, %2\n\t"
-+ "srli %0, %0, %3\n\t"
-+ "slti %0, %0, 2\n\t"
-+ "bnez %0, 99f\n\t"
-+ "amfar %0, $D0.L24\n\t"
-+ "swi %0, [%1+0x0]\n\t"
-+ "amfar %0, $D1.L24\n\t"
-+ "swi %0, [%1+0x4]\n\t"
-+ "99:\n\t"
-+ "amfar %0, $I0\n\t"
-+ "swi %0, [%1+0x8]\n\t"
-+ "amfar %0, $I1\n\t"
-+ "swi %0, [%1+0xc]\n\t"
-+ "amfar %0, $I2\n\t"
-+ "swi %0, [%1+0x10]\n\t"
-+ "amfar %0, $I3\n\t"
-+ "swi %0, [%1+0x14]\n\t"
-+ "amfar %0, $I4\n\t"
-+ "swi %0, [%1+0x18]\n\t"
-+ "amfar %0, $I5\n\t"
-+ "swi %0, [%1+0x1c]\n\t"
-+ "amfar %0, $I6\n\t"
-+ "swi %0, [%1+0x20]\n\t"
-+ "amfar %0, $I7\n\t"
-+ "swi %0, [%1+0x24]\n\t"
-+ "amfar %0, $M1\n\t"
-+ "swi %0, [%1+0x28]\n\t"
-+ "amfar %0, $M2\n\t"
-+ "swi %0, [%1+0x2c]\n\t"
-+ "amfar %0, $M3\n\t"
-+ "swi %0, [%1+0x30]\n\t"
-+ "amfar %0, $M5\n\t"
-+ "swi %0, [%1+0x34]\n\t"
-+ "amfar %0, $M6\n\t"
-+ "swi %0, [%1+0x38]\n\t"
-+ "amfar %0, $M7\n\t"
-+ "swi %0, [%1+0x3c]\n\t"
-+ "amfar %0, $MOD\n\t"
-+ "swi %0, [%1+0x40]\n\t"
-+ "amfar %0, $LB\n\t"
-+ "swi %0, [%1+0x44]\n\t"
-+ "amfar %0, $LE\n\t"
-+ "swi %0, [%1+0x48]\n\t"
-+ "amfar %0, $LC\n\t"
-+ "swi %0, [%1+0x4c]\n\t"
-+ "amfar %0, $ADM_VBASE\n\t"
-+ "swi %0, [%1+0x50]\n\t"
-+ "amfar %0, $SHFT_CTL0\n\t"
-+ "swi %0, [%1+0x54]\n\t"
-+ "amfar %0, $SHFT_CTL1\n\t"
-+ "swi %0, [%1+0x58]\n\t"
-+ "amfar2 %0, $CB_CTL\n\t"
-+ "swi %0, [%1+0x5c]\n\t"
-+ "amfar2 %0, $CBB0\n\t"
-+ "swi %0, [%1+0x60]\n\t"
-+ "amfar2 %0, $CBB1\n\t"
-+ "swi %0, [%1+0x64]\n\t"
-+ "amfar2 %0, $CBB2\n\t"
-+ "swi %0, [%1+0x68]\n\t"
-+ "amfar2 %0, $CBB3\n\t"
-+ "swi %0, [%1+0x6c]\n\t"
-+ "amfar2 %0, $CBE0\n\t"
-+ "swi %0, [%1+0x70]\n\t"
-+ "amfar2 %0, $CBE1\n\t"
-+ "swi %0, [%1+0x74]\n\t"
-+ "amfar2 %0, $CBE2\n\t"
-+ "swi %0, [%1+0x78]\n\t"
-+ "amfar2 %0, $CBE3\n\t"
-+ "swi %0, [%1+0x7c]\n\t":"=&r" (tmp)
-+ :"r"(&tsk->thread.audio), "i"(MSC_CFG_mskAUDIO),
-+ "i"(MSC_CFG_offAUDIO)
-+ :"memory");
-+ disable_audio();
-+}
-+
-+void audioload(struct audio_struct *audioregs)
-+{
-+ unsigned int tmp;
-+ enable_audio();
-+ asm volatile ("mfsr %0, $MSC_CFG\n\t"
-+ "andi %0, %0, %2\n\t"
-+ "srli %0, %0, %3\n\t"
-+ "slti %0, %0, 2\n\t"
-+ "bnez %0, 98f\n\t"
-+ "lwi %0, [%1+0x0]\n\t"
-+ "amtar %0, $D0.L24\n\t"
-+ "lwi %0, [%1+0x4]\n\t"
-+ "amtar %0, $D1.L24\n\t"
-+ "98:\n\t"
-+ "lwi %0, [%1+0x8]\n\t"
-+ "amtar %0, $I0\n\t"
-+ "lwi %0, [%1+0xc]\n\t"
-+ "amtar %0, $I1\n\t"
-+ "lwi %0, [%1+0x10]\n\t"
-+ "amtar %0, $I2\n\t"
-+ "lwi %0, [%1+0x14]\n\t"
-+ "amtar %0, $I3\n\t"
-+ "lwi %0, [%1+0x18]\n\t"
-+ "amtar %0, $I4\n\t"
-+ "lwi %0, [%1+0x1c]\n\t"
-+ "amtar %0, $I5\n\t"
-+ "lwi %0, [%1+0x20]\n\t"
-+ "amtar %0, $I6\n\t"
-+ "lwi %0, [%1+0x24]\n\t"
-+ "amtar %0, $I7\n\t"
-+ "lwi %0, [%1+0x28]\n\t"
-+ "amtar %0, $M1\n\t"
-+ "lwi %0, [%1+0x2c]\n\t"
-+ "amtar %0, $M2\n\t"
-+ "lwi %0, [%1+0x30]\n\t"
-+ "amtar %0, $M3\n\t"
-+ "lwi %0, [%1+0x34]\n\t"
-+ "amtar %0, $M5\n\t"
-+ "lwi %0, [%1+0x38]\n\t"
-+ "amtar %0, $M6\n\t"
-+ "lwi %0, [%1+0x3c]\n\t"
-+ "amtar %0, $M7\n\t"
-+ "lwi %0, [%1+0x40]\n\t"
-+ "amtar %0, $MOD\n\t"
-+ "lwi %0, [%1+0x44]\n\t"
-+ "amtar %0, $LB\n\t"
-+ "lwi %0, [%1+0x48]\n\t"
-+ "amtar %0, $LE\n\t"
-+ "lwi %0, [%1+0x4c]\n\t"
-+ "amtar %0, $LC\n\t"
-+ "lwi %0, [%1+0x50]\n\t"
-+ "amtar %0, $ADM_VBASE\n\t"
-+ "lwi %0, [%1+0x54]\n\t"
-+ "amtar %0, $SHFT_CTL0\n\t"
-+ "lwi %0, [%1+0x58]\n\t"
-+ "amtar %0, $SHFT_CTL1\n\t"
-+ "lwi %0, [%1+0x5c]\n\t"
-+ "amtar2 %0, $CB_CTL\n\t"
-+ "lwi %0, [%1+0x60]\n\t"
-+ "amtar2 %0, $CBB0\n\t"
-+ "lwi %0, [%1+0x64]\n\t"
-+ "amtar2 %0, $CBB1\n\t"
-+ "lwi %0, [%1+0x68]\n\t"
-+ "amtar2 %0, $CBB2\n\t"
-+ "lwi %0, [%1+0x6c]\n\t"
-+ "amtar2 %0, $CBB3\n\t"
-+ "lwi %0, [%1+0x70]\n\t"
-+ "amtar2 %0, $CBE0\n\t"
-+ "lwi %0, [%1+0x74]\n\t"
-+ "amtar2 %0, $CBE1\n\t"
-+ "lwi %0, [%1+0x78]\n\t"
-+ "amtar2 %0, $CBE2\n\t"
-+ "lwi %0, [%1+0x7c]\n\t"
-+ "amtar2 %0, $CBE3\n\t":"=&r" (tmp)
-+ :"r"(audioregs), "i"(MSC_CFG_mskAUDIO),
-+ "i"(MSC_CFG_offAUDIO));
-+ disable_audio();
-+}
-+
-+void do_audio_context_switch(unsigned long error_code, struct pt_regs *regs)
-+{
-+ struct task_struct *tsk = current;
-+
-+ if (!user_mode(regs))
-+ die("Audio used in kernel", regs, error_code);
-+
-+ /* Enable to use audio. */
-+ grab_audio(regs);
-+#ifndef CONFIG_UNLAZY_AUDIO //Lazy audio is used
-+ if (last_task_used_audio == current)
-+ return;
-+
-+ if (last_task_used_audio != NULL)
-+ /* Other processes audio state, save away */
-+ save_audio(last_task_used_audio);
-+ last_task_used_audio = current;
-+#endif
-+ if (test_tsk_thread_flag(tsk, TIF_USEDAUDIO)) {
-+ audioload(&current->thread.audio);
-+ } else {
-+ /* First time audio user. */
-+ audioload(&init_audioregs);
-+ set_tsk_thread_flag(tsk, TIF_USEDAUDIO);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/audio.h linux-3.4.113/arch/nds32/kernel/audio.h
---- linux-3.4.113.orig/arch/nds32/kernel/audio.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/audio.h 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,2 @@
-+
-+#define NAN32 0x0UL
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/bios32.c linux-3.4.113/arch/nds32/kernel/bios32.c
---- linux-3.4.113.orig/arch/nds32/kernel/bios32.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/bios32.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,711 @@
-+/*
-+ * linux/arch/nds32/kernel/bios32.c
-+ *
-+ * PCI bios-type initialisation for PCI machines
-+ *
-+ * Bits taken from various places.
-+ *
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ */
-+#include <linux/module.h>
-+#include <linux/kernel.h>
-+#include <linux/pci.h>
-+#include <linux/slab.h>
-+#include <linux/init.h>
-+
-+#include <asm/io.h>
-+#include <asm/mach-types.h>
-+#include <asm/mach/pci.h>
-+
-+static int debug_pci;
-+static int use_firmware;
-+
-+/*
-+ * We can't use pci_find_device() here since we are
-+ * called from interrupt context.
-+ */
-+static void pcibios_bus_report_status(struct pci_bus *bus, u_int status_mask,
-+ int warn)
-+{
-+ struct pci_dev *dev;
-+
-+ list_for_each_entry(dev, &bus->devices, bus_list) {
-+ u16 status;
-+
-+ /*
-+ * ignore host bridge - we handle
-+ * that separately
-+ */
-+ if (dev->bus->number == 0 && dev->devfn == 0)
-+ continue;
-+
-+ pci_read_config_word(dev, PCI_STATUS, &status);
-+ if (status == 0xffff)
-+ continue;
-+
-+ if ((status & status_mask) == 0)
-+ continue;
-+
-+ /* clear the status errors */
-+ pci_write_config_word(dev, PCI_STATUS, status & status_mask);
-+
-+ if (warn)
-+ printk("(%s: %04X) ", pci_name(dev), status);
-+ }
-+
-+ list_for_each_entry(dev, &bus->devices, bus_list)
-+ if (dev->subordinate)
-+ pcibios_bus_report_status(dev->subordinate, status_mask, warn);
-+}
-+
-+void pcibios_report_status(u_int status_mask, int warn)
-+{
-+ struct list_head *l;
-+
-+ list_for_each(l, &pci_root_buses) {
-+ struct pci_bus *bus = pci_bus_b(l);
-+
-+ pcibios_bus_report_status(bus, status_mask, warn);
-+ }
-+}
-+
-+/*
-+ * We don't use this to fix the device, but initialisation of it.
-+ * It's not the correct use for this, but it works.
-+ * Note that the arbiter/ISA bridge appears to be buggy, specifically in
-+ * the following area:
-+ * 1. park on CPU
-+ * 2. ISA bridge ping-pong
-+ * 3. ISA bridge master handling of target RETRY
-+ *
-+ * Bug 3 is responsible for the sound DMA grinding to a halt. We now
-+ * live with bug 2.
-+ */
-+static void __devinit pci_fixup_83c553(struct pci_dev *dev)
-+{
-+ /*
-+ * Set memory region to start at address 0, and enable IO
-+ */
-+ pci_write_config_dword(dev, PCI_BASE_ADDRESS_0,
-+ PCI_BASE_ADDRESS_SPACE_MEMORY);
-+ pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_IO);
-+
-+ dev->resource[0].end -= dev->resource[0].start;
-+ dev->resource[0].start = 0;
-+
-+ /*
-+ * All memory requests from ISA to be channelled to PCI
-+ */
-+ pci_write_config_byte(dev, 0x48, 0xff);
-+
-+ /*
-+ * Enable ping-pong on bus master to ISA bridge transactions.
-+ * This improves the sound DMA substantially. The fixed
-+ * priority arbiter also helps (see below).
-+ */
-+ pci_write_config_byte(dev, 0x42, 0x01);
-+
-+ /*
-+ * Enable PCI retry
-+ */
-+ pci_write_config_byte(dev, 0x40, 0x22);
-+
-+ /*
-+ * We used to set the arbiter to "park on last master" (bit
-+ * 1 set), but unfortunately the CyberPro does not park the
-+ * bus. We must therefore park on CPU. Unfortunately, this
-+ * may trigger yet another bug in the 553.
-+ */
-+ pci_write_config_byte(dev, 0x83, 0x02);
-+
-+ /*
-+ * Make the ISA DMA request lowest priority, and disable
-+ * rotating priorities completely.
-+ */
-+ pci_write_config_byte(dev, 0x80, 0x11);
-+ pci_write_config_byte(dev, 0x81, 0x00);
-+
-+ /*
-+ * Route INTA input to IRQ 11, and set IRQ11 to be level
-+ * sensitive.
-+ */
-+ pci_write_config_word(dev, 0x44, 0xb000);
-+ outb(0x08, 0x4d1);
-+}
-+
-+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_WINBOND, PCI_DEVICE_ID_WINBOND_83C553,
-+ pci_fixup_83c553);
-+
-+static void __devinit pci_fixup_unassign(struct pci_dev *dev)
-+{
-+ dev->resource[0].end -= dev->resource[0].start;
-+ dev->resource[0].start = 0;
-+}
-+
-+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_WINBOND2, PCI_DEVICE_ID_WINBOND2_89C940F,
-+ pci_fixup_unassign);
-+
-+/*
-+ * Prevent the PCI layer from seeing the resources allocated to this device
-+ * if it is the host bridge by marking it as such. These resources are of
-+ * no consequence to the PCI layer (they are handled elsewhere).
-+ */
-+static void __devinit pci_fixup_dec21285(struct pci_dev *dev)
-+{
-+ int i;
-+
-+ if (dev->devfn == 0) {
-+ dev->class &= 0xff;
-+ dev->class |= PCI_CLASS_BRIDGE_HOST << 8;
-+ for (i = 0; i < PCI_NUM_RESOURCES; i++) {
-+ dev->resource[i].start = 0;
-+ dev->resource[i].end = 0;
-+ dev->resource[i].flags = 0;
-+ }
-+ }
-+}
-+
-+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_21285,
-+ pci_fixup_dec21285);
-+
-+/*
-+ * PCI IDE controllers use non-standard I/O port decoding, respect it.
-+ */
-+static void __devinit pci_fixup_ide_bases(struct pci_dev *dev)
-+{
-+ struct resource *r;
-+ int i;
-+
-+ if ((dev->class >> 8) != PCI_CLASS_STORAGE_IDE)
-+ return;
-+
-+ for (i = 0; i < PCI_NUM_RESOURCES; i++) {
-+ r = dev->resource + i;
-+ if ((r->start & ~0x80) == 0x374) {
-+ r->start |= 2;
-+ r->end = r->start;
-+ }
-+ }
-+}
-+
-+DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, pci_fixup_ide_bases);
-+
-+/*
-+ * Put the DEC21142 to sleep
-+ */
-+static void __devinit pci_fixup_dec21142(struct pci_dev *dev)
-+{
-+ pci_write_config_dword(dev, 0x40, 0x80000000);
-+}
-+
-+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_21142,
-+ pci_fixup_dec21142);
-+
-+/*
-+ * The CY82C693 needs some rather major fixups to ensure that it does
-+ * the right thing. Idea from the Alpha people, with a few additions.
-+ *
-+ * We ensure that the IDE base registers are set to 1f0/3f4 for the
-+ * primary bus, and 170/374 for the secondary bus. Also, hide them
-+ * from the PCI subsystem view as well so we won't try to perform
-+ * our own auto-configuration on them.
-+ *
-+ * In addition, we ensure that the PCI IDE interrupts are routed to
-+ * IRQ 14 and IRQ 15 respectively.
-+ *
-+ * The above gets us to a point where the IDE on this device is
-+ * functional. However, The CY82C693U _does not work_ in bus
-+ * master mode without locking the PCI bus solid.
-+ */
-+static void __devinit pci_fixup_cy82c693(struct pci_dev *dev)
-+{
-+ if ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE) {
-+ u32 base0, base1;
-+
-+ if (dev->class & 0x80) { /* primary */
-+ base0 = 0x1f0;
-+ base1 = 0x3f4;
-+ } else { /* secondary */
-+ base0 = 0x170;
-+ base1 = 0x374;
-+ }
-+
-+ pci_write_config_dword(dev, PCI_BASE_ADDRESS_0,
-+ base0 | PCI_BASE_ADDRESS_SPACE_IO);
-+ pci_write_config_dword(dev, PCI_BASE_ADDRESS_1,
-+ base1 | PCI_BASE_ADDRESS_SPACE_IO);
-+
-+ dev->resource[0].start = 0;
-+ dev->resource[0].end = 0;
-+ dev->resource[0].flags = 0;
-+
-+ dev->resource[1].start = 0;
-+ dev->resource[1].end = 0;
-+ dev->resource[1].flags = 0;
-+ } else if (PCI_FUNC(dev->devfn) == 0) {
-+ /*
-+ * Setup IDE IRQ routing.
-+ */
-+ pci_write_config_byte(dev, 0x4b, 14);
-+ pci_write_config_byte(dev, 0x4c, 15);
-+
-+ /*
-+ * Disable FREQACK handshake, enable USB.
-+ */
-+ pci_write_config_byte(dev, 0x4d, 0x41);
-+
-+ /*
-+ * Enable PCI retry, and PCI post-write buffer.
-+ */
-+ pci_write_config_byte(dev, 0x44, 0x17);
-+
-+ /*
-+ * Enable ISA master and DMA post write buffering.
-+ */
-+ pci_write_config_byte(dev, 0x45, 0x03);
-+ }
-+}
-+
-+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_CONTAQ, PCI_DEVICE_ID_CONTAQ_82C693,
-+ pci_fixup_cy82c693);
-+
-+void __devinit pcibios_update_irq(struct pci_dev *dev, int irq)
-+{
-+ if (debug_pci)
-+ printk("PCI: Assigning IRQ %02d to %s\n", irq, pci_name(dev));
-+ pci_write_config_byte(dev, PCI_INTERRUPT_LINE, irq);
-+}
-+
-+/*
-+ * If the bus contains any of these devices, then we must not turn on
-+ * parity checking of any kind. Currently this is CyberPro 20x0 only.
-+ */
-+static inline int pdev_bad_for_parity(struct pci_dev *dev)
-+{
-+ return (dev->vendor == PCI_VENDOR_ID_INTERG &&
-+ (dev->device == PCI_DEVICE_ID_INTERG_2000 ||
-+ dev->device == PCI_DEVICE_ID_INTERG_2010));
-+}
-+
-+/*
-+ * Adjust the device resources from bus-centric to Linux-centric.
-+ */
-+static void __devinit
-+pdev_fixup_device_resources(struct pci_sys_data *root, struct pci_dev *dev)
-+{
-+ resource_size_t offset;
-+ int i;
-+
-+ for (i = 0; i < PCI_NUM_RESOURCES; i++) {
-+ if (dev->resource[i].start == 0)
-+ continue;
-+ if (dev->resource[i].flags & IORESOURCE_MEM)
-+ offset = root->mem_offset;
-+ else
-+ offset = root->io_offset;
-+
-+ dev->resource[i].start += offset;
-+ dev->resource[i].end += offset;
-+ }
-+}
-+
-+static void __devinit
-+pbus_assign_bus_resources(struct pci_bus *bus, struct pci_sys_data *root)
-+{
-+ struct pci_dev *dev = bus->self;
-+ int i;
-+
-+ if (!dev) {
-+ /*
-+ * Assign root bus resources.
-+ */
-+ for (i = 0; i < 3; i++)
-+ bus->resource[i] = root->resource[i];
-+ }
-+}
-+
-+/*
-+ * pcibios_fixup_bus - Called after each bus is probed,
-+ * but before its children are examined.
-+ */
-+void __devinit pcibios_fixup_bus(struct pci_bus *bus)
-+{
-+ struct pci_sys_data *root = bus->sysdata;
-+ struct pci_dev *dev;
-+ u16 features =
-+ PCI_COMMAND_SERR | PCI_COMMAND_PARITY | PCI_COMMAND_FAST_BACK;
-+
-+ pbus_assign_bus_resources(bus, root);
-+
-+ /*
-+ * Walk the devices on this bus, working out what we can
-+ * and can't support.
-+ */
-+ list_for_each_entry(dev, &bus->devices, bus_list) {
-+ u16 status;
-+
-+ pdev_fixup_device_resources(root, dev);
-+
-+ pci_read_config_word(dev, PCI_STATUS, &status);
-+
-+ /*
-+ * If any device on this bus does not support fast back
-+ * to back transfers, then the bus as a whole is not able
-+ * to support them. Having fast back to back transfers
-+ * on saves us one PCI cycle per transaction.
-+ */
-+ if (!(status & PCI_STATUS_FAST_BACK))
-+ features &= ~PCI_COMMAND_FAST_BACK;
-+
-+ if (pdev_bad_for_parity(dev))
-+ features &= ~(PCI_COMMAND_SERR | PCI_COMMAND_PARITY);
-+
-+ switch (dev->class >> 8) {
-+#if defined(CONFIG_ISA) || defined(CONFIG_EISA)
-+ case PCI_CLASS_BRIDGE_ISA:
-+ case PCI_CLASS_BRIDGE_EISA:
-+ /*
-+ * If this device is an ISA bridge, set isa_bridge
-+ * to point at this device. We will then go looking
-+ * for things like keyboard, etc.
-+ */
-+ isa_bridge = dev;
-+ break;
-+#endif
-+ case PCI_CLASS_BRIDGE_PCI:
-+ pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &status);
-+ status |=
-+ PCI_BRIDGE_CTL_PARITY | PCI_BRIDGE_CTL_MASTER_ABORT;
-+ status &=
-+ ~(PCI_BRIDGE_CTL_BUS_RESET |
-+ PCI_BRIDGE_CTL_FAST_BACK);
-+ pci_write_config_word(dev, PCI_BRIDGE_CONTROL, status);
-+ break;
-+
-+ case PCI_CLASS_BRIDGE_CARDBUS:
-+ pci_read_config_word(dev, PCI_CB_BRIDGE_CONTROL,
-+ &status);
-+ status |=
-+ PCI_CB_BRIDGE_CTL_PARITY |
-+ PCI_CB_BRIDGE_CTL_MASTER_ABORT;
-+ pci_write_config_word(dev, PCI_CB_BRIDGE_CONTROL,
-+ status);
-+ break;
-+ }
-+ }
-+
-+ /*
-+ * Now walk the devices again, this time setting them up.
-+ */
-+ list_for_each_entry(dev, &bus->devices, bus_list) {
-+ u16 cmd;
-+
-+ pci_read_config_word(dev, PCI_COMMAND, &cmd);
-+ cmd |= features;
-+ pci_write_config_word(dev, PCI_COMMAND, cmd);
-+
-+ pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE,
-+ L1_CACHE_BYTES >> 2);
-+ }
-+
-+ /*
-+ * Propagate the flags to the PCI bridge.
-+ */
-+ if (bus->self && bus->self->hdr_type == PCI_HEADER_TYPE_BRIDGE) {
-+ if (features & PCI_COMMAND_FAST_BACK)
-+ bus->bridge_ctl |= PCI_BRIDGE_CTL_FAST_BACK;
-+ if (features & PCI_COMMAND_PARITY)
-+ bus->bridge_ctl |= PCI_BRIDGE_CTL_PARITY;
-+ }
-+
-+ /*
-+ * Report what we did for this bus
-+ */
-+ printk(KERN_INFO "PCI: bus%d: Fast back to back transfers %sabled\n",
-+ bus->number, (features & PCI_COMMAND_FAST_BACK) ? "en" : "dis");
-+}
-+
-+/*
-+ * Convert from Linux-centric to bus-centric addresses for bridge devices.
-+ */
-+void
-+pcibios_resource_to_bus(struct pci_dev *dev, struct pci_bus_region *region,
-+ struct resource *res)
-+{
-+ struct pci_sys_data *root = dev->sysdata;
-+ unsigned long offset = 0;
-+
-+ if (res->flags & IORESOURCE_IO)
-+ offset = root->io_offset;
-+ if (res->flags & IORESOURCE_MEM)
-+ offset = root->mem_offset;
-+
-+ region->start = res->start - offset;
-+ region->end = res->end - offset;
-+}
-+
-+void __devinit
-+pcibios_bus_to_resource(struct pci_dev *dev, struct resource *res,
-+ struct pci_bus_region *region)
-+{
-+ struct pci_sys_data *root = dev->sysdata;
-+ unsigned long offset = 0;
-+
-+ if (res->flags & IORESOURCE_IO)
-+ offset = root->io_offset;
-+ if (res->flags & IORESOURCE_MEM)
-+ offset = root->mem_offset;
-+
-+ res->start = region->start + offset;
-+ res->end = region->end + offset;
-+}
-+
-+#ifdef CONFIG_HOTPLUG
-+EXPORT_SYMBOL(pcibios_fixup_bus);
-+EXPORT_SYMBOL(pcibios_resource_to_bus);
-+EXPORT_SYMBOL(pcibios_bus_to_resource);
-+#endif
-+
-+/*
-+ * This is the standard PCI-PCI bridge swizzling algorithm:
-+ *
-+ * Dev: 0 1 2 3
-+ * A A B C D
-+ * B B C D A
-+ * C C D A B
-+ * D D A B C
-+ * ^^^^^^^^^^ irq pin on bridge
-+ */
-+u8 __devinit pci_std_swizzle(struct pci_dev *dev, u8 * pinp)
-+{
-+ int pin = *pinp - 1;
-+
-+ while (dev->bus->self) {
-+ pin = (pin + PCI_SLOT(dev->devfn)) & 3;
-+ /*
-+ * move up the chain of bridges,
-+ * swizzling as we go.
-+ */
-+ dev = dev->bus->self;
-+ }
-+ *pinp = pin + 1;
-+
-+ return PCI_SLOT(dev->devfn);
-+}
-+
-+/*
-+ * Swizzle the device pin each time we cross a bridge.
-+ * This might update pin and returns the slot number.
-+ */
-+static u8 __devinit pcibios_swizzle(struct pci_dev *dev, u8 * pin)
-+{
-+ struct pci_sys_data *sys = dev->sysdata;
-+ int slot = 0, oldpin = *pin;
-+
-+ if (sys->swizzle)
-+ slot = sys->swizzle(dev, pin);
-+
-+ if (debug_pci)
-+ printk("PCI: %s swizzling pin %d => pin %d slot %d\n",
-+ pci_name(dev), oldpin, *pin, slot);
-+
-+ return slot;
-+}
-+
-+/*
-+ * Map a slot/pin to an IRQ.
-+ */
-+static int pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
-+{
-+ struct pci_sys_data *sys = dev->sysdata;
-+ int irq = -1;
-+
-+ if (sys->map_irq)
-+ irq = sys->map_irq(dev, slot, pin);
-+
-+ if (debug_pci)
-+ printk("PCI: %s mapping slot %d pin %d => irq %d\n",
-+ pci_name(dev), slot, pin, irq);
-+
-+ return irq;
-+}
-+
-+static void __init pcibios_init_hw(struct hw_pci *hw)
-+{
-+ struct pci_sys_data *sys = NULL;
-+ int ret;
-+ int nr, busnr;
-+
-+ for (nr = busnr = 0; nr < hw->nr_controllers; nr++) {
-+ sys = kmalloc(sizeof(struct pci_sys_data), GFP_KERNEL);
-+ if (!sys)
-+ panic("PCI: unable to allocate sys data!");
-+
-+ memset(sys, 0, sizeof(struct pci_sys_data));
-+
-+ sys->hw = hw;
-+ sys->busnr = busnr;
-+ sys->swizzle = hw->swizzle;
-+ sys->map_irq = hw->map_irq;
-+ sys->resource[0] = &ioport_resource;
-+ sys->resource[1] = &iomem_resource;
-+
-+ ret = hw->setup(nr, sys);
-+
-+ if (ret > 0) {
-+ sys->bus = hw->scan(nr, sys);
-+
-+ if (!sys->bus)
-+ panic("PCI: unable to scan bus!");
-+
-+ busnr = sys->bus->subordinate + 1;
-+
-+ list_add(&sys->node, &hw->buses);
-+ } else {
-+ kfree(sys);
-+ if (ret < 0)
-+ break;
-+ }
-+ }
-+}
-+
-+void __init pci_common_init(struct hw_pci *hw)
-+{
-+ struct pci_sys_data *sys;
-+
-+ INIT_LIST_HEAD(&hw->buses);
-+
-+ if (hw->preinit)
-+ hw->preinit();
-+ pcibios_init_hw(hw);
-+ if (hw->postinit)
-+ hw->postinit();
-+
-+ pci_fixup_irqs(pcibios_swizzle, pcibios_map_irq);
-+
-+ list_for_each_entry(sys, &hw->buses, node) {
-+ struct pci_bus *bus = sys->bus;
-+
-+ if (!use_firmware) {
-+ /*
-+ * Size the bridge windows.
-+ */
-+ pci_bus_size_bridges(bus);
-+
-+ /*
-+ * Assign resources.
-+ */
-+ pci_bus_assign_resources(bus);
-+ }
-+
-+ /*
-+ * Tell drivers about devices found.
-+ */
-+ pci_bus_add_devices(bus);
-+ }
-+}
-+
-+char *__devinit pcibios_setup(char *str)
-+{
-+ if (!strcmp(str, "debug")) {
-+ debug_pci = 1;
-+ return NULL;
-+ } else if (!strcmp(str, "firmware")) {
-+ use_firmware = 1;
-+ return NULL;
-+ }
-+ return str;
-+}
-+
-+/*
-+ * From arch/i386/kernel/pci-i386.c:
-+ *
-+ * We need to avoid collisions with `mirrored' VGA ports
-+ * and other strange ISA hardware, so we always want the
-+ * addresses to be allocated in the 0x000-0x0ff region
-+ * modulo 0x400.
-+ *
-+ * Why? Because some silly external IO cards only decode
-+ * the low 10 bits of the IO address. The 0x00-0xff region
-+ * is reserved for motherboard devices that decode all 16
-+ * bits, so it's ok to allocate at, say, 0x2800-0x28ff,
-+ * but we want to try to avoid allocating at 0x2900-0x2bff
-+ * which might be mirrored at 0x0100-0x03ff..
-+ */
-+void pcibios_align_resource(void *data, struct resource *res,
-+ resource_size_t size, resource_size_t align)
-+{
-+ resource_size_t start = res->start;
-+
-+ if (res->flags & IORESOURCE_IO && start & 0x300)
-+ start = (start + 0x3ff) & ~0x3ff;
-+
-+ res->start = (start + align - 1) & ~(align - 1);
-+}
-+
-+/**
-+ * pcibios_enable_device - Enable I/O and memory.
-+ * @dev: PCI device to be enabled
-+ */
-+int pcibios_enable_device(struct pci_dev *dev, int mask)
-+{
-+ u16 cmd, old_cmd;
-+ int idx;
-+ struct resource *r;
-+
-+ pci_read_config_word(dev, PCI_COMMAND, &cmd);
-+ old_cmd = cmd;
-+ for (idx = 0; idx < 6; idx++) {
-+ /* Only set up the requested stuff */
-+ if (!(mask & (1 << idx)))
-+ continue;
-+
-+ r = dev->resource + idx;
-+ if (!r->start && r->end) {
-+ printk(KERN_ERR "PCI: Device %s not available because"
-+ " of resource collisions\n", pci_name(dev));
-+ return -EINVAL;
-+ }
-+ if (r->flags & IORESOURCE_IO)
-+ cmd |= PCI_COMMAND_IO;
-+ if (r->flags & IORESOURCE_MEM)
-+ cmd |= PCI_COMMAND_MEMORY;
-+ }
-+
-+ /*
-+ * Bridges (eg, cardbus bridges) need to be fully enabled
-+ */
-+ if ((dev->class >> 16) == PCI_BASE_CLASS_BRIDGE)
-+ cmd |= PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
-+
-+ if (cmd != old_cmd) {
-+ printk("PCI: enabling device %s (%04x -> %04x)\n",
-+ pci_name(dev), old_cmd, cmd);
-+ pci_write_config_word(dev, PCI_COMMAND, cmd);
-+ }
-+ return 0;
-+}
-+
-+int pci_mmap_page_range(struct pci_dev *dev, struct vm_area_struct *vma,
-+ enum pci_mmap_state mmap_state, int write_combine)
-+{
-+ struct pci_sys_data *root = dev->sysdata;
-+ unsigned long phys;
-+
-+ if (mmap_state == pci_mmap_io) {
-+ return -EINVAL;
-+ } else {
-+ phys = vma->vm_pgoff + (root->mem_offset >> PAGE_SHIFT);
-+ }
-+
-+ /*
-+ * Mark this as IO
-+ */
-+ vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
-+
-+ if (remap_pfn_range(vma, vma->vm_start, phys,
-+ vma->vm_end - vma->vm_start, vma->vm_page_prot))
-+ return -EAGAIN;
-+
-+ return 0;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/calls.S linux-3.4.113/arch/nds32/kernel/calls.S
---- linux-3.4.113.orig/arch/nds32/kernel/calls.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/calls.S 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,400 @@
-+/*
-+ * linux/arch/nds32/kernel/calls.S
-+ *
-+ * Copyright (C) 1995-2004 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * This file is included twice in entry-common.S
-+ */
-+
-+/* 0 */ CALL(sys_restart_syscall)
-+ CALL(sys_exit)
-+ CALL(sys_fork_wrapper)
-+ CALL(sys_read)
-+ CALL(sys_write)
-+/* 5 */ CALL(sys_open)
-+ CALL(sys_close)
-+ CALL(sys_waitpid)
-+ CALL(sys_creat)
-+ CALL(sys_link)
-+/* 10 */ CALL(sys_unlink)
-+ CALL(sys_execve_wrapper)
-+ CALL(sys_chdir)
-+ CALL(sys_time) /* used by libc4 */
-+ CALL(sys_mknod)
-+/* 15 */ CALL(sys_chmod)
-+ CALL(sys_lchown16)
-+ CALL(sys_ni_syscall) /* was sys_break */
-+ CALL(sys_ni_syscall) /* was sys_stat */
-+ CALL(sys_lseek)
-+/* 20 */ CALL(sys_getpid)
-+ CALL(sys_mount)
-+ CALL(sys_oldumount) /* used by libc4 */
-+ CALL(sys_setuid16)
-+ CALL(sys_getuid16)
-+/* 25 */ CALL(sys_stime)
-+ CALL(sys_ptrace)
-+ CALL(sys_alarm) /* used by libc4 */
-+ CALL(sys_ni_syscall) /* was sys_fstat */
-+ CALL(sys_pause)
-+/* 30 */ CALL(sys_utime) /* used by libc4 */
-+ CALL(sys_ni_syscall) /* was sys_stty */
-+ CALL(sys_ni_syscall) /* was sys_getty */
-+ CALL(sys_access)
-+ CALL(sys_nice)
-+/* 35 */ CALL(sys_ni_syscall) /* was sys_ftime */
-+ CALL(sys_sync)
-+ CALL(sys_kill)
-+ CALL(sys_rename)
-+ CALL(sys_mkdir)
-+/* 40 */ CALL(sys_rmdir)
-+ CALL(sys_dup)
-+ CALL(sys_pipe)
-+ CALL(sys_times)
-+ CALL(sys_ni_syscall) /* was sys_prof */
-+/* 45 */ CALL(sys_brk)
-+ CALL(sys_setgid16)
-+ CALL(sys_getgid16)
-+ CALL(sys_ni_syscall) /* was sys_signal */
-+ CALL(sys_geteuid16)
-+/* 50 */ CALL(sys_getegid16)
-+ CALL(sys_acct)
-+ CALL(sys_umount)
-+ CALL(sys_ni_syscall) /* was sys_lock */
-+ CALL(sys_ioctl)
-+/* 55 */ CALL(sys_fcntl)
-+ CALL(sys_ni_syscall) /* was sys_mpx */
-+ CALL(sys_setpgid)
-+ CALL(sys_ni_syscall) /* was sys_ulimit */
-+ CALL(sys_cacheflush) /* was sys_olduname */
-+/* 60 */ CALL(sys_umask)
-+ CALL(sys_chroot)
-+ CALL(sys_ustat)
-+ CALL(sys_dup2)
-+ CALL(sys_getppid)
-+/* 65 */ CALL(sys_getpgrp)
-+ CALL(sys_setsid)
-+ CALL(sys_sigaction)
-+ CALL(sys_ni_syscall) /* was sys_sgetmask */
-+ CALL(sys_ni_syscall) /* was sys_ssetmask */
-+/* 70 */ CALL(sys_setreuid16)
-+ CALL(sys_setregid16)
-+ CALL(sys_sigsuspend_wrapper)
-+ CALL(sys_sigpending)
-+ CALL(sys_sethostname)
-+/* 75 */ CALL(sys_setrlimit)
-+ CALL(sys_old_getrlimit) /* used by libc4 */
-+ CALL(sys_getrusage)
-+ CALL(sys_gettimeofday)
-+ CALL(sys_settimeofday)
-+/* 80 */ CALL(sys_getgroups16)
-+ CALL(sys_setgroups16)
-+ CALL(old_select) /* used by libc4 */
-+ CALL(sys_symlink)
-+ CALL(sys_ni_syscall) /* was sys_lstat */
-+/* 85 */ CALL(sys_readlink)
-+ CALL(sys_uselib)
-+ CALL(sys_swapon)
-+ CALL(sys_reboot)
-+ CALL(sys_old_readdir) /* used by libc4 */
-+/* 90 */ CALL(sys_old_mmap) /* used by libc4 */
-+ CALL(sys_munmap)
-+ CALL(sys_truncate)
-+ CALL(sys_ftruncate)
-+ CALL(sys_fchmod)
-+/* 95 */ CALL(sys_fchown16)
-+ CALL(sys_getpriority)
-+ CALL(sys_setpriority)
-+ CALL(sys_ni_syscall) /* was sys_profil */
-+ CALL(sys_statfs)
-+/* 100 */ CALL(sys_fstatfs)
-+ CALL(sys_ni_syscall)
-+ CALL(sys_socketcall)
-+ CALL(sys_syslog)
-+ CALL(sys_setitimer)
-+/* 105 */ CALL(sys_getitimer)
-+ CALL(sys_newstat)
-+ CALL(sys_newlstat)
-+ CALL(sys_newfstat)
-+ CALL(sys_ni_syscall) /* was sys_uname */
-+/* 110 */ CALL(sys_ni_syscall) /* was sys_iopl */
-+ CALL(sys_vhangup)
-+ CALL(sys_ni_syscall)
-+ CALL(sys_syscall) /* call a syscall */
-+ CALL(sys_wait4)
-+/* 115 */ CALL(sys_swapoff)
-+ CALL(sys_sysinfo)
-+ CALL(sys_ipc)
-+ CALL(sys_fsync)
-+ CALL(sys_sigreturn_wrapper)
-+/* 120 */ CALL(sys_clone_wrapper)
-+ CALL(sys_setdomainname)
-+ CALL(sys_newuname)
-+ CALL(sys_ni_syscall)
-+ CALL(sys_adjtimex)
-+/* 125 */ CALL(sys_mprotect)
-+ CALL(sys_sigprocmask)
-+ CALL(sys_ni_syscall) /* was sys_create_module */
-+ CALL(sys_init_module)
-+ CALL(sys_delete_module)
-+/* 130 */ CALL(sys_ni_syscall) /* was sys_get_kernel_syms */
-+ CALL(sys_quotactl)
-+ CALL(sys_getpgid)
-+ CALL(sys_fchdir)
-+ CALL(sys_bdflush)
-+/* 135 */ CALL(sys_sysfs)
-+ CALL(sys_personality)
-+ CALL(sys_ni_syscall) /* was _sys_afs_syscall */
-+ CALL(sys_setfsuid16)
-+ CALL(sys_setfsgid16)
-+/* 140 */ CALL(sys_llseek)
-+ CALL(sys_getdents)
-+ CALL(sys_select)
-+ CALL(sys_flock)
-+ CALL(sys_msync)
-+/* 145 */ CALL(sys_readv)
-+ CALL(sys_writev)
-+ CALL(sys_getsid)
-+ CALL(sys_fdatasync)
-+ CALL(sys_sysctl)
-+/* 150 */ CALL(sys_mlock)
-+ CALL(sys_munlock)
-+ CALL(sys_mlockall)
-+ CALL(sys_munlockall)
-+ CALL(sys_sched_setparam)
-+/* 155 */ CALL(sys_sched_getparam)
-+ CALL(sys_sched_setscheduler)
-+ CALL(sys_sched_getscheduler)
-+ CALL(sys_sched_yield)
-+ CALL(sys_sched_get_priority_max)
-+/* 160 */ CALL(sys_sched_get_priority_min)
-+ CALL(sys_sched_rr_get_interval)
-+ CALL(sys_nanosleep)
-+ CALL(sys_nds32_mremap)
-+ CALL(sys_setresuid16)
-+/* 165 */ CALL(sys_getresuid16)
-+ CALL(sys_getpagesize)
-+ CALL(sys_ni_syscall) /* was sys_query_module */
-+ CALL(sys_poll)
-+ CALL(sys_ni_syscall) /* was nfsservctl */
-+/* 170 */ CALL(sys_setresgid16)
-+ CALL(sys_getresgid16)
-+ CALL(sys_prctl)
-+ CALL(sys_rt_sigreturn_wrapper)
-+ CALL(sys_rt_sigaction)
-+/* 175 */ CALL(sys_rt_sigprocmask)
-+ CALL(sys_rt_sigpending)
-+ CALL(sys_rt_sigtimedwait)
-+ CALL(sys_rt_sigqueueinfo)
-+ CALL(sys_rt_sigsuspend_wrapper)
-+/* 180 */ CALL(sys_pread64)
-+ CALL(sys_pwrite64)
-+ CALL(sys_chown16)
-+ CALL(sys_getcwd)
-+ CALL(sys_capget)
-+/* 185 */ CALL(sys_capset)
-+ CALL(sys_sigaltstack_wrapper)
-+ CALL(sys_sendfile)
-+ CALL(sys_ni_syscall)
-+ CALL(sys_ni_syscall)
-+/* 190 */ CALL(sys_vfork_wrapper)
-+ CALL(sys_getrlimit)
-+ CALL(sys_mmap2)
-+ CALL(sys_truncate64)
-+ CALL(sys_ftruncate64)
-+/* 195 */ CALL(sys_stat64)
-+ CALL(sys_lstat64)
-+ CALL(sys_fstat64)
-+ CALL(sys_lchown)
-+ CALL(sys_getuid)
-+/* 200 */ CALL(sys_getgid)
-+ CALL(sys_geteuid)
-+ CALL(sys_getegid)
-+ CALL(sys_setreuid)
-+ CALL(sys_setregid)
-+/* 205 */ CALL(sys_getgroups)
-+ CALL(sys_setgroups)
-+ CALL(sys_fchown)
-+ CALL(sys_setresuid)
-+ CALL(sys_getresuid)
-+/* 210 */ CALL(sys_setresgid)
-+ CALL(sys_getresgid)
-+ CALL(sys_chown)
-+ CALL(sys_setuid)
-+ CALL(sys_setgid)
-+/* 215 */ CALL(sys_setfsuid)
-+ CALL(sys_setfsgid)
-+ CALL(sys_getdents64)
-+ CALL(sys_pivot_root)
-+ CALL(sys_mincore)
-+/* 220 */ CALL(sys_madvise)
-+ CALL(sys_fcntl64)
-+ CALL(sys_ni_syscall) /* TUX */
-+ CALL(sys_ni_syscall)
-+ CALL(sys_gettid)
-+/* 225 */ CALL(sys_readahead)
-+ CALL(sys_setxattr)
-+ CALL(sys_lsetxattr)
-+ CALL(sys_fsetxattr)
-+ CALL(sys_getxattr)
-+/* 230 */ CALL(sys_lgetxattr)
-+ CALL(sys_fgetxattr)
-+ CALL(sys_listxattr)
-+ CALL(sys_llistxattr)
-+ CALL(sys_flistxattr)
-+/* 235 */ CALL(sys_removexattr)
-+ CALL(sys_lremovexattr)
-+ CALL(sys_fremovexattr)
-+ CALL(sys_tkill)
-+ CALL(sys_sendfile64)
-+/* 240 */ CALL(sys_futex_wrapper)
-+ CALL(sys_sched_setaffinity)
-+ CALL(sys_sched_getaffinity)
-+ CALL(sys_io_setup)
-+ CALL(sys_io_destroy)
-+/* 245 */ CALL(sys_io_getevents)
-+ CALL(sys_io_submit)
-+ CALL(sys_io_cancel)
-+ CALL(sys_exit_group)
-+ CALL(sys_lookup_dcookie)
-+/* 250 */ CALL(sys_epoll_create)
-+ CALL(sys_epoll_ctl)
-+ CALL(sys_epoll_wait)
-+ CALL(sys_remap_file_pages)
-+ CALL(sys_ni_syscall) /* sys_set_thread_area */
-+/* 255 */ CALL(sys_ni_syscall) /* sys_get_thread_area */
-+ CALL(sys_set_tid_address)
-+ CALL(sys_timer_create)
-+ CALL(sys_timer_settime)
-+ CALL(sys_timer_gettime)
-+/* 260 */ CALL(sys_timer_getoverrun)
-+ CALL(sys_timer_delete)
-+ CALL(sys_clock_settime)
-+ CALL(sys_clock_gettime)
-+ CALL(sys_clock_getres)
-+/* 265 */ CALL(sys_clock_nanosleep)
-+ CALL(sys_statfs64)
-+ CALL(sys_fstatfs64)
-+ CALL(sys_tgkill)
-+ CALL(sys_utimes)
-+/* 270 */ CALL(sys_fadvise64_64_wrapper)
-+ CALL(sys_pciconfig_iobase)
-+ CALL(sys_pciconfig_read)
-+ CALL(sys_pciconfig_write)
-+ CALL(sys_mq_open)
-+/* 275 */ CALL(sys_mq_unlink)
-+ CALL(sys_mq_timedsend)
-+ CALL(sys_mq_timedreceive)
-+ CALL(sys_mq_notify)
-+ CALL(sys_mq_getsetattr)
-+/* 280 */ CALL(sys_waitid)
-+ CALL(sys_add_key)
-+ CALL(sys_request_key)
-+ CALL(sys_keyctl)
-+ CALL(sys_ioprio_set)
-+/* 285 */ CALL(sys_ioprio_get)
-+ CALL(sys_inotify_init)
-+ CALL(sys_inotify_add_watch)
-+ CALL(sys_inotify_rm_watch)
-+ CALL(sys_migrate_pages)
-+/* 290 */ CALL(sys_openat)
-+ CALL(sys_mkdirat)
-+ CALL(sys_mknodat)
-+ CALL(sys_fchownat)
-+ CALL(sys_futimesat)
-+/* 295 */ CALL(sys_fstatat64)
-+ CALL(sys_unlinkat)
-+ CALL(sys_renameat)
-+ CALL(sys_linkat)
-+ CALL(sys_symlinkat)
-+/* 300 */ CALL(sys_readlinkat)
-+ CALL(sys_fchmodat)
-+ CALL(sys_faccessat)
-+ CALL(sys_pselect6) /* sys_pselect6 */
-+ CALL(sys_ppoll) /* sys_ppoll */
-+/* 305 */ CALL(sys_unshare)
-+ CALL(sys_set_robust_list)
-+ CALL(sys_get_robust_list)
-+ CALL(sys_splice)
-+ CALL(sys_sync_file_range2)
-+/* 310 */ CALL(sys_tee)
-+ CALL(sys_vmsplice)
-+ CALL(sys_move_pages)
-+ CALL(sys_fadvise64)
-+ CALL(sys_utimensat)
-+/* 315 */ CALL(sys_signalfd)
-+ CALL(sys_timerfd_create)
-+ CALL(sys_eventfd)
-+ CALL(sys_fallocate)
-+ CALL(sys_timerfd_settime)
-+/* 320 */ CALL(sys_timerfd_gettime)
-+ CALL(sys_getcpu)
-+ CALL(sys_signalfd4)
-+ CALL(sys_eventfd2)
-+ CALL(sys_epoll_create1)
-+/* 325 */ CALL(sys_dup3)
-+ CALL(sys_pipe2)
-+ CALL(sys_inotify_init1)
-+ CALL(sys_kexec_load)
-+ CALL(sys_accept)
-+/* 330 */ CALL(sys_bind)
-+ CALL(sys_connect)
-+ CALL(sys_getpeername)
-+ CALL(sys_getsockname)
-+ CALL(sys_getsockopt)
-+/* 335 */ CALL(sys_listen)
-+ CALL(sys_recv)
-+ CALL(sys_recvfrom)
-+ CALL(sys_recvmsg)
-+ CALL(sys_send)
-+/* 340 */ CALL(sys_sendmsg)
-+ CALL(sys_sendto)
-+ CALL(sys_setsockopt)
-+ CALL(sys_shutdown)
-+ CALL(sys_socket)
-+/* 345 */ CALL(sys_socketpair)
-+ CALL(sys_prlimit64)
-+ CALL(sys_accept4)
-+ CALL(sys_recvmmsg)
-+ CALL(sys_sendmmsg)
-+/* 350 */ CALL(sys_fanotify_init)
-+ CALL(sys_fanotify_mark)
-+ CALL(sys_msgget)
-+ CALL(sys_msgctl)
-+ CALL(sys_msgrcv)
-+/* 355 */ CALL(sys_msgsnd)
-+ CALL(sys_semget)
-+ CALL(sys_semctl)
-+ CALL(sys_semtimedop)
-+ CALL(sys_semop)
-+/* 360 */ CALL(sys_shmget)
-+ CALL(sys_shmctl)
-+ CALL(sys_shmat)
-+ CALL(sys_shmdt)
-+ CALL(sys_syncfs)
-+/* 365 */ CALL(sys_setns)
-+ CALL(sys_name_to_handle_at)
-+ CALL(sys_open_by_handle_at)
-+ CALL(sys_process_vm_readv)
-+ CALL(sys_process_vm_writev)
-+/* 370 */ CALL(sys_clock_adjtime)
-+ CALL(sys_get_mempolicy)
-+ CALL(sys_mbind)
-+ CALL(sys_perf_event_open)
-+ CALL(sys_preadv)
-+/* 375 */ CALL(sys_pwritev)
-+ CALL(sys_rt_tgsigqueueinfo)
-+ CALL(sys_set_mempolicy)
-+ CALL(sys_epoll_pwait)
-+
-+#ifndef syscalls_counted
-+.equ syscalls_padding, ((NR_syscalls + 3) & ~3) - NR_syscalls
-+#define syscalls_counted
-+#endif
-+ .rept syscalls_padding
-+ CALL(sys_ni_syscall)
-+ .endr
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/early_printk.c linux-3.4.113/arch/nds32/kernel/early_printk.c
---- linux-3.4.113.orig/arch/nds32/kernel/early_printk.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/early_printk.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,126 @@
-+/*
-+ * Earlyprintk support.
-+ *
-+ * Copyright (C) 2012 ARM Ltd.
-+ * Author: Catalin Marinas <catalin.marinas@arm.com>
-+ *
-+ * This program is free software: you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
-+ */
-+#include <linux/kernel.h>
-+#include <linux/console.h>
-+#include <linux/init.h>
-+#include <linux/string.h>
-+#include <linux/mm.h>
-+#include <linux/io.h>
-+
-+#include <linux/serial_reg.h>
-+#include <asm/setup.h>
-+
-+extern void __iomem *early_io_map(phys_addr_t phys);
-+static void __iomem *early_base;
-+static void (*printch) (char ch);
-+
-+/*
-+ * 8250/16550 (8-bit aligned registers) single character TX.
-+ */
-+static void uart8250_8bit_printch(char ch)
-+{
-+ while (!(readb(early_base + UART_LSR) & UART_LSR_THRE)) ;
-+ writeb(ch, early_base + UART_TX);
-+}
-+
-+/*
-+ * 8250/16550 (32-bit aligned registers) single character TX.
-+ */
-+static void uart8250_32bit_printch(char ch)
-+{
-+ while (!(readl(early_base + (UART_LSR << 2)) & UART_LSR_THRE)) ;
-+ writel(ch, early_base + (UART_TX << 2));
-+}
-+
-+struct earlycon_match {
-+ const char *name;
-+ void (*printch) (char ch);
-+};
-+
-+static const struct earlycon_match earlycon_match[] __initconst = {
-+ {.name = "uart8250-8bit",.printch = uart8250_8bit_printch,},
-+ {.name = "uart8250-32bit",.printch = uart8250_32bit_printch,},
-+ {}
-+};
-+
-+static void early_write(struct console *con, const char *s, unsigned n)
-+{
-+ while (n-- > 0) {
-+ if (*s == '\n')
-+ printch('\r');
-+ printch(*s);
-+ s++;
-+ }
-+}
-+
-+static struct console early_console_dev = {
-+ .name = "earlycon",
-+ .write = early_write,
-+ .flags = CON_PRINTBUFFER | CON_BOOT,
-+ .index = -1,
-+};
-+
-+/*
-+ * Parse earlyprintk=... parameter in the format:
-+ *
-+ * <name>[,<addr>][,<options>]
-+ *
-+ * and register the early console. It is assumed that the UART has been
-+ * initialised by the bootloader already.
-+ */
-+static int __init setup_early_printk(char *buf)
-+{
-+ const struct earlycon_match *match = earlycon_match;
-+ phys_addr_t paddr = 0;
-+
-+ if (!buf) {
-+ pr_warning("No earlyprintk arguments passed.\n");
-+ return 0;
-+ }
-+
-+ while (match->name) {
-+ size_t len = strlen(match->name);
-+ if (!strncmp(buf, match->name, len)) {
-+ buf += len;
-+ break;
-+ }
-+ match++;
-+ }
-+ if (!match->name) {
-+ pr_warning("Unknown earlyprintk arguments: %s\n", buf);
-+ return 0;
-+ }
-+
-+ /* I/O address */
-+ if (!strncmp(buf, ",0x", 3)) {
-+ char *e;
-+ paddr = simple_strtoul(buf + 1, &e, 16);
-+ buf = e;
-+ }
-+
-+ if (paddr)
-+ early_base = early_io_map(paddr);
-+ printch = match->printch;
-+ //early_console = &early_console_dev;
-+ register_console(&early_console_dev);
-+
-+ return 0;
-+}
-+
-+early_param("earlyprintk", setup_early_printk);
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/elfchk.c linux-3.4.113/arch/nds32/kernel/elfchk.c
---- linux-3.4.113.orig/arch/nds32/kernel/elfchk.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/elfchk.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,190 @@
-+#include <linux/module.h>
-+#include <linux/kallsyms.h>
-+#include <asm/hardware.h>
-+#include <asm/uaccess.h>
-+#include <asm/elf.h>
-+#include <asm/fpu.h>
-+#include <asm/audio.h>
-+#include <linux/elf.h>
-+#include <linux/proc_fs.h>
-+
-+#define ELF_CHECKING_OS
-+#include "nds32-elf.h"
-+
-+extern struct proc_dir_entry *proc_dir_cpu;
-+
-+#ifdef CONFIG_ELFCHK_DEFAULT_ENABLE
-+static int elf_check_en = 1;
-+#else
-+static int elf_check_en = 0;
-+#endif
-+
-+struct reg_struct {
-+
-+ const char *name;
-+ int idx;
-+};
-+
-+static struct reg_struct regs[] = {
-+
-+ {"cpu_ver", CPU_SR_INDEX(0, 0, 0)},
-+ {"icm_cfg", CPU_SR_INDEX(0, 1, 0)},
-+ {"dcm_cfg", CPU_SR_INDEX(0, 2, 0)},
-+ {"mmu_cfg", CPU_SR_INDEX(0, 3, 0)},
-+ {"msc_cfg", CPU_SR_INDEX(0, 4, 0)},
-+#ifdef CONFIG_FPU
-+ {"fucop_exist", CPU_SR_INDEX(0, 5, 0)}
-+#endif
-+};
-+
-+#ifdef CONFIG_FPU
-+static unsigned int read_fpu_fpcfg(void)
-+{
-+ unsigned int fpcfg = 0;
-+
-+ enable_fpu();
-+ asm volatile ("fmfcfg %0\n\t":"=&r" (fpcfg));
-+ disable_fpu();
-+
-+ return fpcfg;
-+}
-+#endif
-+
-+static unsigned int read_cpu_sr(unsigned int idx)
-+{
-+ switch (idx) {
-+
-+ case CPU_SR_INDEX(0, 0, 0):
-+ return GET_CPU_VER();
-+ case CPU_SR_INDEX(0, 1, 0):
-+ return GET_ICM_CFG();
-+ case CPU_SR_INDEX(0, 2, 0):
-+ return GET_DCM_CFG();
-+ case CPU_SR_INDEX(0, 3, 0):
-+ return GET_MMU_CFG();
-+ case CPU_SR_INDEX(0, 4, 0):
-+ return GET_MSC_CFG();
-+ case CPU_SR_INDEX(0, 5, 0):
-+ return GET_FUCOP_EXIST();
-+
-+ default:
-+ printk(KERN_ERR
-+ "%s: invalid system register index (%d, %d, %d)\n",
-+ __func__, (idx >> 7) & 0x7, (idx >> 3) & 0xf, idx & 0x7);
-+
-+ return SR_NOT_EXIST;
-+ }
-+}
-+
-+static unsigned int reg_read_callback(unsigned int idx)
-+{
-+ if (HW_IS_CPU(idx)) {
-+
-+ return read_cpu_sr(SR_INDEX(idx));
-+ } else if (HW_IS_FPU(idx)) {
-+
-+#ifdef CONFIG_FPU
-+ if (SR_FPU_FPCFG == SR_INDEX(idx))
-+ return read_fpu_fpcfg();
-+ else
-+ return SR_NOT_EXIST;
-+#endif
-+ } else if (HW_IS_AUDIO(idx)) {
-+
-+ return SR_NOT_EXIST;
-+ }
-+
-+ return SR_NOT_EXIST;
-+}
-+
-+#define BUFLEN 1024
-+
-+int do_elf_check_arch(const struct elf32_hdr *hdr)
-+{
-+ static char msg_buf[BUFLEN];
-+ unsigned int err;
-+ int buf_status = 0;
-+
-+ if (!elf_check_en)
-+ return 1;
-+
-+ err =
-+ elf_check((void *)hdr, reg_read_callback, msg_buf, BUFLEN,
-+ &buf_status);
-+
-+ if (err)
-+ printk(KERN_WARNING "%s", msg_buf);
-+
-+ return !err;
-+}
-+
-+static int proc_elf_check_read(char *page, char **start, off_t off, int count,
-+ int *eof, void *data)
-+{
-+ return sprintf(page, "%d\n", elf_check_en);
-+}
-+
-+#define INPUTLEN 10
-+static int proc_elf_check_write(struct file *file, const char __user * buffer,
-+ unsigned long count, void *data)
-+{
-+ unsigned long en;
-+ char inbuf[INPUTLEN];
-+
-+ if (count > INPUTLEN - 1)
-+ count = INPUTLEN - 1;
-+
-+ if (copy_from_user(inbuf, buffer, count))
-+ return -EFAULT;
-+
-+ inbuf[count] = '\0';
-+
-+ if (!sscanf(inbuf, "%lu", &en) || en > 3)
-+ return -EFAULT;
-+
-+ elf_check_en = en & 0x01;
-+
-+ return count;
-+}
-+
-+static int proc_elf_check_read_reg(char *page, char **start,
-+ off_t off, int count, int *eof, void *data)
-+{
-+ unsigned long val = read_cpu_sr(*(int *)data);
-+
-+ return sprintf(page, "0x%08lx\n", val);
-+}
-+
-+int __init elf_check_init(void)
-+{
-+ static struct proc_dir_entry *res_elf_check;
-+ int i;
-+
-+ if (!proc_dir_cpu) {
-+ if (!(proc_dir_cpu = proc_mkdir("cpu", NULL)))
-+ return -ENOMEM;
-+ }
-+
-+ res_elf_check =
-+ create_proc_entry("elf_core_checking", S_IWUSR | S_IRUGO,
-+ proc_dir_cpu);
-+ if (!res_elf_check)
-+ return -ENOMEM;
-+
-+ res_elf_check->read_proc = proc_elf_check_read;
-+ res_elf_check->write_proc = proc_elf_check_write;
-+
-+ for (i = 0; i < ARRAY_SIZE(regs); i++) {
-+
-+ if (!create_proc_read_entry(regs[i].name, S_IWUSR | S_IRUGO,
-+ proc_dir_cpu,
-+ proc_elf_check_read_reg,
-+ &regs[i].idx))
-+
-+ return -ENOMEM;
-+ }
-+
-+ return 0;
-+}
-+
-+module_init(elf_check_init);
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/ex-entry.S linux-3.4.113/arch/nds32/kernel/ex-entry.S
---- linux-3.4.113.orig/arch/nds32/kernel/ex-entry.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/ex-entry.S 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,294 @@
-+#include <linux/linkage.h>
-+#include <asm/memory.h>
-+#include <asm/nds32.h>
-+#include <asm/assembler.h>
-+#include <asm/errno.h>
-+#include <asm/asm-offsets.h>
-+#include <asm/page.h>
-+
-+ .macro push_zol
-+#ifdef CONFIG_HWZOL
-+ mfusr $r10, $LB
-+ mfusr $r11, $LE
-+ mfusr $r12, $LC
-+#endif
-+ .endm
-+ .macro save_user_regs
-+ /* $p1 is VA of percpu data */
-+ sethi $p0, hi20(PAGE_OFFSET - PHYS_OFFSET)
-+ add $p1, $p1, $p0
-+
-+ /* change to kernel stack */
-+ mfsr $p0, $IPSW
-+ andi $p0, $p0, #PSW_mskPOM
-+ cmovz $sp, $r25, $p0
-+
-+ /* 8 byte aligned */
-+ movi $r25, #~7
-+ and $r25, $sp, $r25
-+ smw.adm $sp, [$r25], $sp, #0x1
-+ move $sp, $r25
-+
-+#if defined(CONFIG_FPU) || defined(CONFIG_AUDIO)
-+ mfsr $r25, $FUCOP_CTL
-+ push $r25
-+ bclr $r25, $r25, #FUCOP_CTL_offCP0EN
-+ mtsr $r25, $FUCOP_CTL
-+#else
-+ addi $sp, $sp, -4
-+#endif
-+ pushm $r28, $r30
-+
-+ /* zero fp if user mode*/
-+ movi $r25, #0x0
-+ cmovz $fp, $r25, $p0
-+
-+ lwi $r25, [$p1+#0x0]
-+ pushm $r0, $r25
-+#ifdef CONFIG_HWZOL
-+ push_zol
-+#endif
-+ mfsr $r9, $P_P1
-+ mfsr $r8, $P_P0
-+ mfsr $r7, $P_IPC
-+ mfsr $r6, $P_IPSW
-+ mfsr $r18, $IPC
-+ mfsr $r17, $IPSW
-+ mfsr $r16, $PSW
-+ pushm $r6, $r13
-+ push $r0
-+ lwi $p0, [$p1+#0x8]
-+ push $p0
-+ pushm $r16, $r18
-+
-+ andi $r19, $r16, #PSW_mskINTL
-+ slti $r20, $r19, #4
-+ bnez $r20, 1f
-+ addi $r21, $r16, #-2
-+ mtsr $r21, $PSW
-+ isb
-+1:
-+ addi $sp, $sp, -S_OFF
-+ .endm
-+
-+ .text
-+
-+/*
-+ * Exception Vector
-+ */
-+exception_handlers:
-+ .long unhandled_exceptions !Reset/NMI
-+ .long unhandled_exceptions !TLB fill
-+ .long do_page_fault !PTE not present
-+ .long do_dispatch_tlb_misc !TLB misc
-+ .long unhandled_exceptions !TLB VLPT
-+ .long unhandled_exceptions !Machine Error
-+ .long do_debug_trap !Debug related
-+ .long do_dispatch_general !General exception
-+ .long eh_syscall !Syscall
-+ .long asm_do_IRQ !IRQ
-+
-+common_exception_handler:
-+ save_user_regs
-+ lwi $p0, [$p1+#0x4]
-+ andi $p1, $p0, #0x78
-+ bnez $p1, 1f
-+ sethi $lp, hi20(ret_from_exception)
-+ ori $lp, $lp, lo12(ret_from_exception)
-+ sethi $p1, hi20(exception_handlers)
-+ ori $p1, $p1, lo12(exception_handlers)
-+ lw $p1, [$p1+$p0<<2]
-+ move $r0, $p0
-+ mfsr $r1, $EVA
-+ mfsr $r2, $ITYPE
-+ move $r3, $sp
-+ mfsr $r4, $OIPC
-+ /* enable gie if it is enabled in IPSW. */
-+ mfsr $r21, $PSW
-+ andi $r17, $r17, #0x1
-+ or $r21, $r21, $r17
-+ mtsr $r21, $PSW
-+ dsb
-+ jr $p1
-+
-+ /* syscall */
-+1:
-+ addi $p1, $p0, #-8
-+ bnez $p1, 2f
-+ sethi $lp, hi20(ret_from_exception)
-+ ori $lp, $lp, lo12(ret_from_exception)
-+ sethi $p1, hi20(exception_handlers)
-+ ori $p1, $p1, lo12(exception_handlers)
-+ lwi $p1, [$p1+#0x8<<2]
-+ jr $p1
-+
-+ /* interrupt */
-+2:
-+#ifdef CONFIG_TRACE_IRQFLAGS
-+ jal arch_trace_hardirqs_off
-+#endif
-+#if defined(CONFIG_EVIC) || defined(CONFIG_IVIC)
-+ addi $r0, $p0, #-9
-+#else
-+# ifdef CONFIG_IVIC_INTC
-+ jal get_IntSrc
-+# else
-+# error "Not configure Vector Interrupt Controller mode"
-+# endif
-+#endif
-+ move $r1, $sp
-+ sethi $lp, hi20(ret_from_intr)
-+ ori $lp, $lp, lo12(ret_from_intr)
-+ sethi $p0, hi20(exception_handlers)
-+ ori $p0, $p0, lo12(exception_handlers)
-+ lwi $p0, [$p0+#0x9<<2]
-+ jr $p0
-+
-+ .macro EXCEPTION_VECTOR, num
-+ .align 6
-+ .ifc \num, 6
-+ mfsr $p0, $EDM_CTL
-+ andi $p0, $p0, EDM_CTL_mskV3_EDM_MODE
-+ tnez $p0, 0x1a
-+ .endif
-+ /* $p1 is PA of percpu data */
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ movi $p1, #0x0
-+#else
-+ mfsr $p1, $CORE_ID
-+#endif
-+ slli $p1, $p1, #0x9
-+ li $p0, #(PHYS_OFFSET+0x6000)
-+ or $p1, $p1, $p0
-+
-+ /*
-+ * 0x0 saved $r25
-+ * 0x4 vector number
-+ * 0x8 user stack pointer
-+ * 0xc kernel stack pointer
-+ */
-+ swi $r25, [$p1+0x0]
-+ movi $p0, \num
-+ swi $p0, [$p1+#0x4]
-+ swi $sp, [$p1+#0x8]
-+ lwi $r25, [$p1+#0xc]
-+ sethi $p0, hi20(common_exception_handler)
-+ ori $p0, $p0, lo12(common_exception_handler)
-+ jral.ton $p0, $p0
-+ .endm
-+
-+ .macro IPI_VECTOR, num
-+ .align 6
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ movi $p1, #0x0
-+#else
-+ mfsr $p1, $CORE_ID
-+#endif
-+ slli $p1, $p1, #0x9
-+ li $p0, #(PHYS_OFFSET+0x6000)
-+ or $p1, $p1, $p0
-+
-+ /*
-+ * 0x10 indicator of CPU is initialized
-+ * 0x14 CPU init function
-+ */
-+ swi $r25, [$p1+0x0]
-+ movi $p0, \num
-+ swi $p0, [$p1+#0x4]
-+ swi $sp, [$p1+#0x8]
-+ lwi $r25, [$p1+#0xc]
-+ lwi $p0, [$p1+#0x10]
-+ beqz $p0, 1f
-+ sethi $p0, hi20(common_exception_handler)
-+ ori $p0, $p0, lo12(common_exception_handler)
-+ jral.ton $p0, $p0
-+1:
-+ lwi $p0, [$p1+#0x14]
-+ jr $p0
-+
-+ .endm
-+
-+ .section ".text.init", #alloc, #execinstr
-+ .global exception_vector
-+exception_vector:
-+ EXCEPTION_VECTOR 0
-+ EXCEPTION_VECTOR 1
-+ EXCEPTION_VECTOR 2
-+ EXCEPTION_VECTOR 3
-+ EXCEPTION_VECTOR 4
-+ EXCEPTION_VECTOR 5
-+ EXCEPTION_VECTOR 6
-+ EXCEPTION_VECTOR 7
-+ EXCEPTION_VECTOR 8
-+#ifdef CONFIG_EVIC
-+ EXCEPTION_VECTOR 9
-+#else
-+ IPI_VECTOR 9
-+#endif
-+ EXCEPTION_VECTOR 10
-+ EXCEPTION_VECTOR 11
-+ EXCEPTION_VECTOR 12
-+ EXCEPTION_VECTOR 13
-+ EXCEPTION_VECTOR 14
-+ EXCEPTION_VECTOR 15
-+ EXCEPTION_VECTOR 16
-+ EXCEPTION_VECTOR 17
-+ EXCEPTION_VECTOR 18
-+ EXCEPTION_VECTOR 19
-+ EXCEPTION_VECTOR 20
-+ EXCEPTION_VECTOR 21
-+ EXCEPTION_VECTOR 22
-+ EXCEPTION_VECTOR 23
-+ EXCEPTION_VECTOR 24
-+ EXCEPTION_VECTOR 25
-+ EXCEPTION_VECTOR 26
-+ EXCEPTION_VECTOR 27
-+ EXCEPTION_VECTOR 28
-+ EXCEPTION_VECTOR 29
-+ EXCEPTION_VECTOR 30
-+ EXCEPTION_VECTOR 31
-+ EXCEPTION_VECTOR 32
-+ EXCEPTION_VECTOR 33
-+ EXCEPTION_VECTOR 34
-+ EXCEPTION_VECTOR 35
-+ EXCEPTION_VECTOR 36
-+ EXCEPTION_VECTOR 37
-+ EXCEPTION_VECTOR 38
-+ EXCEPTION_VECTOR 39
-+ EXCEPTION_VECTOR 40
-+#ifdef CONFIG_EVIC
-+ IPI_VECTOR 41
-+#else
-+ EXCEPTION_VECTOR 41
-+#endif
-+ EXCEPTION_VECTOR 42
-+ EXCEPTION_VECTOR 43
-+ EXCEPTION_VECTOR 44
-+ EXCEPTION_VECTOR 45
-+ EXCEPTION_VECTOR 46
-+ EXCEPTION_VECTOR 47
-+ EXCEPTION_VECTOR 48
-+ EXCEPTION_VECTOR 49
-+ EXCEPTION_VECTOR 50
-+ EXCEPTION_VECTOR 51
-+ EXCEPTION_VECTOR 52
-+ EXCEPTION_VECTOR 53
-+ EXCEPTION_VECTOR 54
-+ EXCEPTION_VECTOR 55
-+ EXCEPTION_VECTOR 56
-+ EXCEPTION_VECTOR 57
-+ EXCEPTION_VECTOR 58
-+ EXCEPTION_VECTOR 59
-+ EXCEPTION_VECTOR 60
-+ EXCEPTION_VECTOR 61
-+ EXCEPTION_VECTOR 62
-+ EXCEPTION_VECTOR 63
-+ EXCEPTION_VECTOR 64
-+ EXCEPTION_VECTOR 65
-+ EXCEPTION_VECTOR 66
-+ EXCEPTION_VECTOR 67
-+ EXCEPTION_VECTOR 68
-+ EXCEPTION_VECTOR 69
-+ EXCEPTION_VECTOR 70
-+ EXCEPTION_VECTOR 71
-+ EXCEPTION_VECTOR 72
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/ex-exit.S linux-3.4.113/arch/nds32/kernel/ex-exit.S
---- linux-3.4.113.orig/arch/nds32/kernel/ex-exit.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/ex-exit.S 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,220 @@
-+#include <linux/linkage.h>
-+#include <asm/unistd.h>
-+#include <asm/assembler.h>
-+#include <asm/nds32.h>
-+#include <asm/asm-offsets.h>
-+#include <asm/thread_info.h>
-+
-+#define why $r8 // Linux syscall (!= 0)
-+#define tsk $r9 // current thread_info
-+
-+
-+ .macro pop_zol
-+#ifdef CONFIG_HWZOL
-+ mtusr $r10, $LB
-+ mtusr $r11, $LE
-+ mtusr $r12, $LC
-+#endif
-+ .endm
-+
-+ .macro restore_user_regs_first
-+ setgie.d
-+ isb
-+ /* $p1 is VA of percpu data */
-+#ifdef CONFIG_CPU_N1213_43U1HA0
-+ movi $p1, #0x0
-+#else
-+ mfsr $p1, $CORE_ID
-+#endif
-+ andi $p1, $p1, #0x3
-+ slli $p1, $p1, #0x9
-+ sethi $p0, #0xc0006
-+ or $p1, $p1, $p0
-+
-+ addi $sp, $sp, S_OFF
-+ popm $r16, $r18
-+ mtsr $r16, $PSW
-+ pop $r16
-+ swi $r16, [$p1+#0x8]
-+ addi $sp, $sp, #4 !pop $r0
-+ popm $r6, $r13
-+ mtsr $r17, $IPSW
-+ mtsr $r18, $IPC
-+ mtsr $r6, $P_IPSW
-+ mtsr $r7, $P_IPC
-+ mtsr $r8, $P_P0
-+ mtsr $r9, $P_P1
-+#ifdef CONFIG_HWZOL
-+ pop_zol
-+#endif
-+ .endm
-+
-+ .macro restore_user_regs_last
-+ popm $r28, $r30
-+#if defined(CONFIG_FPU) || defined(CONFIG_AUDIO)
-+ pop $p0
-+ mtsr $p0, $FUCOP_CTL
-+#else
-+ addi $sp, $sp, 4
-+#endif
-+
-+ pop $p0
-+ cmovn $sp, $p0, $p0
-+
-+ mfsr $p0, $IPSW
-+ andi $p0, $p0, #PSW_mskPOM
-+ bnez $p0, 1f
-+ swi $sp, [$p1+#0xc]
-+ lwi $sp, [$p1+#0x8]
-+1:
-+ // This is SW workaround for Bug #6294
-+ li $p0, 0xc0000000
-+ cctl $p0, L1D_VA_INVAL
-+ lwi $p1, [$p0]
-+
-+ iret
-+ nop
-+
-+ .endm
-+
-+ .macro restore_user_regs
-+ restore_user_regs_first
-+ popm $r0, $r25
-+ restore_user_regs_last
-+ .endm
-+
-+ .macro fast_restore_user_regs
-+ restore_user_regs_first
-+ addi $sp, $sp, #4
-+ popm $r1, $r25
-+ restore_user_regs_last
-+ .endm
-+
-+#ifdef CONFIG_PREEMPT
-+ .macro preempt_stop
-+ .endm
-+#else
-+ .macro preempt_stop
-+ setgie.d
-+ isb
-+ .endm
-+#define resume_kernel no_work_pending
-+#endif
-+
-+ENTRY(ret_from_exception)
-+ preempt_stop
-+ENTRY(ret_from_intr)
-+ get_thread_info tsk
-+ move why, #0 ! not system call
-+
-+/*
-+ * judge Kernel or user mode
-+ *
-+ */
-+ lwi $p0, [$sp+(#S_IPSW+#S_OFF)]
-+! mfsr $p0, $IPSW ! Check if in nested interrupt
-+ andi $p0, $p0, #PSW_mskINTL
-+ bnez $p0, resume_kernel ! done with iret
-+ j resume_userspace
-+
-+
-+/*
-+ * This is the fast syscall return path. We do as little as
-+ * possible here, and this includes saving $r0 back into the SVC
-+ * stack.
-+ * fixed: tsk - $r9, why - $r8, $r7 - syscall #, $r8 - syscall table pointer
-+ */
-+ENTRY(ret_fast_syscall)
-+ gie_disable
-+ lwi $r1, [tsk+#TI_FLAGS]
-+ andi $p1, $r1, #_TIF_WORK_MASK
-+ bnez $p1, fast_work_pending
-+ fast_restore_user_regs ! iret
-+
-+/*
-+ * Ok, we need to do extra processing,
-+ * enter the slow path returning from syscall, while pending work.
-+ */
-+fast_work_pending:
-+ swi $r0, [$sp+(#S_R0+#S_OFF)] ! what is different from ret_from_exception
-+ ! addi $sp, $sp, S_OFF
-+ move why, #1 ! come from a syscall
-+work_pending:
-+ andi $p1, $r1, #_TIF_NEED_RESCHED
-+ bnez $p1, work_resched
-+
-+ andi $p1, $r1, #_TIF_SIGPENDING|#_TIF_NOTIFY_RESUME
-+ beqz $p1, no_work_pending
-+
-+ move $r0, $sp ! 'regs'
-+ move $r2, why
-+ gie_enable
-+ bal do_notify_resume
-+
-+ b ret_slow_syscall ! return from slow_restore_user_regs
-+
-+work_resched:
-+ bal schedule ! path, return to user mode
-+
-+/*
-+ * "slow" syscall return path.
-+ * "why" tells us if this was a real syscall.
-+ */
-+ENTRY(resume_userspace)
-+ENTRY(ret_slow_syscall)
-+ gie_disable
-+ lwi $p0, [$sp+(#S_IPSW+#S_OFF)]
-+! mfsr $p0, $IPSW ! Check if in nested interrupt
-+ andi $p0, $p0, #PSW_mskINTL
-+ bnez $p0, no_work_pending ! done with iret
-+ lwi $r1, [tsk+#TI_FLAGS]
-+ andi $p1, $r1, #_TIF_WORK_MASK
-+ bnez $p1, work_pending ! handle work_resched, sig_pend
-+
-+no_work_pending:
-+#ifdef CONFIG_TRACE_IRQFLAGS
-+ lwi $p0, [$sp+(#S_IPSW+#S_OFF)]
-+ andi $p0, $p0, #0x1
-+ la $r10, arch_trace_hardirqs_off
-+ la $r9, arch_trace_hardirqs_on
-+ cmovz $r9, $p0, $r10
-+ jral $r9
-+#endif
-+ restore_user_regs ! return from iret
-+
-+
-+/*
-+ * preemptive kernel
-+ */
-+#ifdef CONFIG_PREEMPT
-+resume_kernel:
-+ gie_disable
-+ lwi $t0, [tsk+#TI_PREEMPT]
-+ bnez $t0, no_work_pending
-+need_resched:
-+ lwi $t0, [tsk+#TI_FLAGS]
-+ andi $p1, $t0, #_TIF_NEED_RESCHED
-+ beqz $p1, no_work_pending
-+
-+ lwi $t0, [$sp+(#S_IPSW+#S_OFF)] ! Interrupts off?
-+ andi $t0, $t0, #1
-+ beqz $t0, no_work_pending
-+
-+ jal preempt_schedule_irq
-+ b need_resched
-+#endif
-+
-+/*
-+ * This is how we return from a fork.
-+ */
-+ENTRY(ret_from_fork)
-+ bal schedule_tail
-+ get_thread_info tsk
-+ lwi $r1, [tsk+#TI_FLAGS] ! check for syscall tracing
-+ move why, #1
-+ andi $p1, $r1, #_TIF_WORK_SYSCALL_LEAVE ! are we tracing syscalls?
-+ beqz $p1, ret_slow_syscall
-+ move $r0, $sp
-+ bal syscall_trace_leave
-+ b ret_slow_syscall
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/ex-scall.S linux-3.4.113/arch/nds32/kernel/ex-scall.S
---- linux-3.4.113.orig/arch/nds32/kernel/ex-scall.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/ex-scall.S 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,288 @@
-+#include <linux/linkage.h>
-+#include <asm/unistd.h>
-+#include <asm/assembler.h>
-+#include <asm/nds32.h>
-+#include <asm/asm-offsets.h>
-+#include <asm/thread_info.h>
-+
-+/*
-+ * $r0 = previous task_struct,
-+ * $r1 = previous thread_info,
-+ * $r2 = next thread_info
-+ * previous and next are guaranteed not to be the same.
-+ */
-+
-+ENTRY(_switch)
-+ smw.adm $r6, [$sp], $r14, #0xa
-+ swi $sp, [$r1+ TI_SP_SAVE] /* Save $sp to task structure */
-+ lwi $sp, [$r2+ TI_SP_SAVE] /* Get $sp from task structure */
-+ lmw.bim $r6, [$sp], $r14, #0xa
-+ ret
-+
-+/*
-+ * These are the registers used in the syscall handler, and allow us
-+ * to have in theory up to 6 arguments to a function - $r0 to $r5.
-+ * $r7 is reserved for the system call number for Andes architecture.
-+ *
-+ * Note that tbl == why is intentional.
-+ * We must set at least "tsk" and "why" when calling ret_with_reschedule.
-+ */
-+#define tbl $r8 // syscall table pointer
-+#define why $r8 // Linux syscall (!= 0)
-+#define tsk $r9 // current thread_info
-+
-+/*
-+ * Get the system call number. let $r7 take a system call nr.
-+ *
-+ * if it is called from library function, $r7 is filled by library call
-+ * when user program make a system call. and swid bitfield of $ir6 will
-+ * always be encoded as 0x7fff.
-+ *
-+ * if it is called from kernel code, $r7 will be writen as syscall nr
-+ * by retrieving from $ir6 'swid' bitfiled
-+ */
-+ .macro get_scno
-+ mfsr $r7, $ITYPE
-+#ifdef CONFIG_PLAT_QEMU
-+ slli $r7, $r7, #1
-+ srli $r7, $r7, #ITYPE_offSWID+1
-+#else
-+ srli $r7, $r7, #ITYPE_offSWID
-+#endif
-+ .endm
-+
-+ .macro updateipc
-+ addi $r17, $r18, #4
-+ swi $r17, [$sp + S_OFF + S_IPC]
-+ .endm
-+
-+ .equ NR_syscalls,0
-+#define CALL(x) .equ NR_syscalls,NR_syscalls+1
-+#include "calls.S"
-+#undef CALL
-+#define CALL(x) .long x
-+
-+ENTRY(eh_syscall)
-+ updateipc
-+
-+ get_scno
-+ gie_enable
-+ get_thread_info tsk
-+ lwi $p0, [tsk+#TI_FLAGS] ! check for syscall tracing
-+
-+ andi $p1, $p0, #_TIF_WORK_SYSCALL_ENTRY ! are we tracing syscalls?
-+ bnez $p1, __sys_trace
-+
-+ la $lp, ret_fast_syscall ! return address
-+
-+ li $p0, __NR_NDS32_BASE
-+ addi $p0, $p0, -1
-+ slt $p0, $p0, $r7
-+ beqz $p0, 1f
-+ addi $r1, $SP, #0
-+ move $r0, $r7
-+ b nds32_syscall
-+1:
-+ ! check upper syscall limit,
-+ andi $r7, $r7, #0xfff
-+ addi $p1, $r7, #-NR_syscalls ! syscall number of syscall instruction is guarded by addembler
-+ bgez $p1, _SCNO_EXCEED ! call sys_* routine
-+ la tbl, sys_call_table ! load syscall table pointer
-+ slli $p1, $r7, #2
-+ add $p1, tbl, $p1
-+ lwi $p1, [$p1]
-+ jr $p1 ! no return
-+
-+_SCNO_EXCEED:
-+ ori $r0, $r7, #0
-+ ori $r1, $sp, #0
-+ b bad_syscall
-+
-+/*
-+ * This is the really slow path. We're going to be doing
-+ * context switches, and waiting for our parent to respond.
-+ */
-+__sys_trace:
-+ move $r1, $sp
-+ move $r0, $r7 ! trace entry [IP = 0]
-+ bal syscall_trace_enter
-+ move $r7, $r0
-+ la $lp, __sys_trace_return ! return address
-+
-+ li $p0, __NR_NDS32_BASE
-+ addi $p0, $p0, -1
-+ slt $p0, $p0, $r7
-+ beqz $p0, 1f
-+ addi $r1, $SP, #0
-+ b nds32_syscall
-+1:
-+ andi $r7, $r7, #0xfff
-+ addi $p1, $sp, #S_R0+S_OFF ! pointer to regs
-+ addi $p0, $r7, -#NR_syscalls ! check upper syscall limit
-+ bgez $p0, _SCNO_EXCEED
-+ lmw.bi $r0, [$p1], $r5 ! have to reload $r0 - $r5
-+
-+ slli $p0, $r7, #2 ! call sys_* routine
-+ la tbl, sys_call_table ! load syscall table pointer
-+ add $p0, tbl, $p0
-+ lwi $p0, [$p0]
-+ jr $p0
-+
-+__sys_trace_return:
-+ swi $r0, [$sp+(#S_R0+S_OFF)] ! T: save returned $r0
-+ bal syscall_trace_leave
-+ b ret_slow_syscall
-+
-+ .type sys_call_table, #object
-+ENTRY(sys_call_table)
-+#include "calls.S"
-+
-+/*
-+ * Special system call wrappers
-+ *
-+ * $r0 = syscall number
-+ * $r8 = syscall table
-+ */
-+ .type sys_syscall, #function
-+sys_syscall:
-+
-+ li $p0, __NR_NDS32_BASE
-+ addi $p0, $p0, -1
-+ slt $p0, $p0, $r0
-+ beqz $p0, 1f
-+ addi $r1, $SP, #0
-+ b nds32_syscall
-+1:
-+ bltz $r0, 3f ! Guard whether syscall number is between 0~0x7fff.
-+ andi $r0, $r0, #0xfff
-+ addi $p1, $r0, #-NR_syscalls
-+ bgtz $p1, 3f
-+ move $p1, $r0
-+ move $r0, $r1
-+ move $r1, $r2
-+ move $r2, $r3
-+ move $r3, $r4
-+ move $r4, $r5
-+! add for syscall 6 args
-+ lwi $r5, [$sp + (#S_SP + #S_OFF) ]
-+ lwi $r5, [$r5 + #S_OFF]
-+! ~add for syscall 6 args
-+
-+ lw $p1, [tbl+$p1<<2]
-+ jr $p1
-+3: b sys_ni_syscall
-+
-+sys_fork_wrapper:
-+ addi $r0, $sp, #0
-+ b sys_fork
-+
-+sys_vfork_wrapper:
-+ addi $r0, $sp, #0
-+ b sys_vfork
-+
-+sys_execve_wrapper:
-+ addi $r3, $sp, #0
-+ b sys_execve
-+
-+sys_clone_wrapper:
-+ addi $r5, $SP, #0
-+ b sys_clone
-+
-+sys_sigsuspend_wrapper:
-+ addi $r3, $sp, #0
-+ b sys_sigsuspend
-+
-+sys_rt_sigsuspend_wrapper:
-+ addi $r2, $sp, #0
-+ b sys_rt_sigsuspend
-+
-+sys_sigreturn_wrapper:
-+ addi $r0, $sp, #0
-+ b sys_sigreturn
-+
-+sys_rt_sigreturn_wrapper:
-+ addi $r0, $sp, #0
-+ b sys_rt_sigreturn
-+
-+sys_sigaltstack_wrapper:
-+ lwi $r2, [$sp+(#S_OFF + S_SP)]
-+ b do_sigaltstack
-+
-+sys_futex_wrapper:
-+ b sys_futex
-+
-+#ifdef CONFIG_FUNCTION_TRACER
-+ .global _mcount
-+ .global ftrace_stub
-+_mcount:
-+ sethi $r15, hi20(function_trace_stop)
-+ lwi $r15, [$r15 + lo12(function_trace_stop)]
-+ bnez $r15, _ftrace_stub
-+
-+ sethi $r15, hi20(ftrace_trace_function)
-+ lwi $p0, [$r15 + lo12(ftrace_trace_function)]
-+ sethi $r15, hi20(ftrace_stub)
-+ ori $r15, $r15, lo12(ftrace_stub)
-+ bne $r15, $p0, trace
-+
-+#ifdef CONFIG_FUNCTION_GRAPH_TRACER
-+ sethi $p0, hi20(ftrace_graph_return)
-+ lwi $p0, [$p0 + lo12(ftrace_graph_return)]
-+ bne $r15, $p0, _ftrace_graph_caller
-+
-+ sethi $r15, hi20(ftrace_graph_entry)
-+ lwi $r15, [$r15 + lo12(ftrace_graph_entry)]
-+ sethi $p0, hi20(ftrace_graph_entry_stub)
-+ ori $p0, $p0, lo12(ftrace_graph_entry_stub)
-+ bne $r15, $p0, _ftrace_graph_caller
-+#endif
-+
-+_ftrace_stub:
-+ftrace_stub:
-+ ret
-+
-+trace:
-+ smw.adm $r0, [$sp], $r5, #10
-+ move $r0, $lp
-+ sethi $r15, hi20(get_selfpc)
-+ ori $r15, $r15, lo12(get_selfpc)
-+ jral $r15
-+ move $r1, $r0
-+ lwi $r0, [$sp+36]
-+ jral $p0
-+ lmw.bim $r0, [$sp], $r5, #10
-+ ret
-+#endif
-+
-+#ifdef CONFIG_FUNCTION_GRAPH_TRACER
-+ .global ftrace_graph_caller
-+ .global return_to_handler
-+_ftrace_graph_caller:
-+ftrace_graph_caller:
-+ sethi $p1, hi20(function_trace_stop)
-+ lwi $p1, [$p1 + lo12(function_trace_stop)]
-+ bnez $p1, ftrace_stub
-+
-+ sethi $p1, hi20(prepare_ftrace_return)
-+ ori $p1, $p1, lo12(prepare_ftrace_return)
-+
-+ smw.adm $r0, [$sp], $r5, #10
-+ move $r0, $lp
-+ sethi $p0, hi20(get_selfpc)
-+ ori $p0, $p0, lo12(get_selfpc)
-+ jral $p0
-+ move $r1, $r0
-+ addi $r0, $sp, #36
-+ jral $p1
-+ lmw.bim $r0, [$sp], $r5, #10
-+ ret
-+
-+return_to_handler:
-+ smw.adm $r0, [$sp], $r5, #10
-+ sethi $r15, hi20(ftrace_return_to_handler)
-+ ori $r15, $r15, lo12(ftrace_return_to_handler)
-+ jral $r15
-+ move $r15, $r0
-+ lmw.bim $r0, [$sp], $r5, #10
-+ jr $r15
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/fpu.c linux-3.4.113/arch/nds32/kernel/fpu.c
---- linux-3.4.113.orig/arch/nds32/kernel/fpu.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/fpu.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,306 @@
-+/*
-+ * arch/nds32/kernel/fpu.c
-+ *
-+ * Copyright (C) 2001 Manuela Cirronis, Paolo Alberelli
-+ * Copyright (C) 2002 STMicroelectronics Limited
-+ * Author : Stuart Menefy
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * Started from SH4 version:
-+ * Copyright (C) 1999, 2000 Kaz Kojima & Niibe Yutaka
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ */
-+#include <linux/sched.h>
-+#include <linux/signal.h>
-+#include <asm/processor.h>
-+#include <asm/user.h>
-+#include <asm/io.h>
-+#include <asm/bitfield.h>
-+#include <asm/fpu.h>
-+#include "fpu.h"
-+
-+extern void do_revinsn(struct pt_regs *regs);
-+extern int do_fpu_denorm(struct pt_regs *regs, struct fpu_struct *fpu);
-+
-+static struct fpu_struct init_fpuregs = {
-+ .fs_regs = {[0 ... 31] = sNAN32},
-+ .fd_regs = {[0 ... 15] = sNAN64},
-+ .fpcsr = FPCSR_INIT
-+};
-+
-+void save_fpu(struct task_struct *tsk)
-+{
-+ unsigned int fpcfg, fpcsr;
-+ enable_fpu();
-+ asm volatile ("fmfcfg %0\n\t":"=&r" (fpcfg));
-+ fpcfg = ((fpcfg & FPCFG_mskFREG) >> FPCFG_offFREG);
-+
-+ switch (fpcfg) {
-+ case 3:
-+ asm volatile ("fsdi $fd31, [%0+0xf8]\n\t"
-+ "fsdi $fd30, [%0+0xf0]\n\t"
-+ "fsdi $fd29, [%0+0xe8]\n\t"
-+ "fsdi $fd28, [%0+0xe0]\n\t"
-+ "fsdi $fd27, [%0+0xd8]\n\t"
-+ "fsdi $fd26, [%0+0xd0]\n\t"
-+ "fsdi $fd25, [%0+0xc8]\n\t"
-+ "fsdi $fd24, [%0+0xc0]\n\t"
-+ "fsdi $fd23, [%0+0xb8]\n\t"
-+ "fsdi $fd22, [%0+0xb0]\n\t"
-+ "fsdi $fd21, [%0+0xa8]\n\t"
-+ "fsdi $fd20, [%0+0xa0]\n\t"
-+ "fsdi $fd19, [%0+0x98]\n\t"
-+ "fsdi $fd18, [%0+0x90]\n\t"
-+ "fsdi $fd17, [%0+0x88]\n\t"
-+ "fsdi $fd16, [%0+0x80]\n\t"
-+ : /* no output */
-+ :"r" (&tsk->thread.fpu)
-+ :"memory");
-+ /* fall through */
-+ case 2:
-+ asm volatile ("fssi $fs31, [%0+0x7c]\n\t"
-+ "fssi $fs30, [%0+0x78]\n\t"
-+ "fssi $fs29, [%0+0x74]\n\t"
-+ "fssi $fs28, [%0+0x70]\n\t"
-+ "fssi $fs27, [%0+0x6c]\n\t"
-+ "fssi $fs26, [%0+0x68]\n\t"
-+ "fssi $fs25, [%0+0x64]\n\t"
-+ "fssi $fs24, [%0+0x60]\n\t"
-+ "fssi $fs23, [%0+0x5c]\n\t"
-+ "fssi $fs22, [%0+0x58]\n\t"
-+ "fssi $fs21, [%0+0x54]\n\t"
-+ "fssi $fs20, [%0+0x50]\n\t"
-+ "fssi $fs19, [%0+0x4c]\n\t"
-+ "fssi $fs18, [%0+0x48]\n\t"
-+ "fssi $fs17, [%0+0x44]\n\t"
-+ "fssi $fs16, [%0+0x40]\n\t"
-+ : /* no output */
-+ :"r" (&tsk->thread.fpu)
-+ :"memory");
-+ /* fall through */
-+ case 1:
-+ asm volatile ("fssi $fs15, [%0+0x3c]\n\t"
-+ "fssi $fs14, [%0+0x38]\n\t"
-+ "fssi $fs13, [%0+0x34]\n\t"
-+ "fssi $fs12, [%0+0x30]\n\t"
-+ "fssi $fs11, [%0+0x2c]\n\t"
-+ "fssi $fs10, [%0+0x28]\n\t"
-+ "fssi $fs9, [%0+0x24]\n\t"
-+ "fssi $fs8, [%0+0x20]\n\t"
-+ : /* no output */
-+ :"r" (&tsk->thread.fpu)
-+ :"memory");
-+ /* fall through */
-+ case 0:
-+ asm volatile ("fssi $fs7, [%1+0x1c]\n\t"
-+ "fssi $fs6, [%1+0x18]\n\t"
-+ "fssi $fs5, [%1+0x14]\n\t"
-+ "fssi $fs4, [%1+0x10]\n\t"
-+ "fssi $fs3, [%1+0xc]\n\t"
-+ "fssi $fs2, [%1+0x8]\n\t"
-+ "fssi $fs1, [%1+0x4]\n\t"
-+ "fssi $fs0, [%1+0x0]\n\t"
-+ "fmfcsr %0\n\t"
-+ "swi %0, [%1+0x100]\n\t"
-+ :"=&r" (fpcsr)
-+ :"r"(&tsk->thread.fpu)
-+ :"memory");
-+ }
-+ disable_fpu();
-+}
-+
-+void fpload(struct fpu_struct *fpregs)
-+{
-+ unsigned int fpcfg, fpcsr;
-+ enable_fpu();
-+
-+ asm volatile ("fmfcfg %0\n\t":"=&r" (fpcfg));
-+ fpcfg = ((fpcfg & FPCFG_mskFREG) >> FPCFG_offFREG);
-+
-+ switch (fpcfg) {
-+ case 3:
-+ asm volatile ("fldi $fd31, [%0+0xf8]\n\t"
-+ "fldi $fd30, [%0+0xf0]\n\t"
-+ "fldi $fd29, [%0+0xe8]\n\t"
-+ "fldi $fd28, [%0+0xe0]\n\t"
-+ "fldi $fd27, [%0+0xd8]\n\t"
-+ "fldi $fd26, [%0+0xd0]\n\t"
-+ "fldi $fd25, [%0+0xc8]\n\t"
-+ "fldi $fd24, [%0+0xc0]\n\t"
-+ "fldi $fd23, [%0+0xb8]\n\t"
-+ "fldi $fd22, [%0+0xb0]\n\t"
-+ "fldi $fd21, [%0+0xa8]\n\t"
-+ "fldi $fd20, [%0+0xa0]\n\t"
-+ "fldi $fd19, [%0+0x98]\n\t"
-+ "fldi $fd18, [%0+0x90]\n\t"
-+ "fldi $fd17, [%0+0x88]\n\t"
-+ "fldi $fd16, [%0+0x80]\n\t"
-+ : /* no output */
-+ :"r" (fpregs));
-+ /* fall through */
-+ case 2:
-+ asm volatile ("flsi $fs31, [%0+0x7c]\n\t"
-+ "flsi $fs30, [%0+0x78]\n\t"
-+ "flsi $fs29, [%0+0x74]\n\t"
-+ "flsi $fs28, [%0+0x70]\n\t"
-+ "flsi $fs27, [%0+0x6c]\n\t"
-+ "flsi $fs26, [%0+0x68]\n\t"
-+ "flsi $fs25, [%0+0x64]\n\t"
-+ "flsi $fs24, [%0+0x60]\n\t"
-+ "flsi $fs23, [%0+0x5c]\n\t"
-+ "flsi $fs22, [%0+0x58]\n\t"
-+ "flsi $fs21, [%0+0x54]\n\t"
-+ "flsi $fs20, [%0+0x50]\n\t"
-+ "flsi $fs19, [%0+0x4c]\n\t"
-+ "flsi $fs18, [%0+0x48]\n\t"
-+ "flsi $fs17, [%0+0x44]\n\t"
-+ "flsi $fs16, [%0+0x40]\n\t"
-+ : /* no output */
-+ :"r" (fpregs));
-+ /* fall through */
-+ case 1:
-+ asm volatile ("flsi $fs15, [%0+0x3c]\n\t"
-+ "flsi $fs14, [%0+0x38]\n\t"
-+ "flsi $fs13, [%0+0x34]\n\t"
-+ "flsi $fs12, [%0+0x30]\n\t"
-+ "flsi $fs11, [%0+0x2c]\n\t"
-+ "flsi $fs10, [%0+0x28]\n\t"
-+ "flsi $fs9, [%0+0x24]\n\t"
-+ "flsi $fs8, [%0+0x20]\n\t"
-+ : /* no output */
-+ :"r" (fpregs));
-+ /* fall through */
-+ case 0:
-+ asm volatile ("flsi $fs7, [%1+0x1c]\n\t"
-+ "flsi $fs6, [%1+0x18]\n\t"
-+ "flsi $fs5, [%1+0x14]\n\t"
-+ "flsi $fs4, [%1+0x10]\n\t"
-+ "flsi $fs3, [%1+0xc]\n\t"
-+ "flsi $fs2, [%1+0x8]\n\t"
-+ "flsi $fs1, [%1+0x4]\n\t"
-+ "flsi $fs0, [%1+0x0]\n\t"
-+ "lwi %0, [%1+0x100]\n\t"
-+ "fmtcsr %0\n\t":"=&r" (fpcsr)
-+ :"r"(fpregs));
-+ }
-+ disable_fpu();
-+}
-+
-+void do_fpu_context_switch(unsigned long error_code, struct pt_regs *regs)
-+{
-+ /* Enable to use FPU. */
-+
-+ if (!user_mode(regs)) {
-+ printk(KERN_ERR "BUG: FPU is used in kernel mode.\n");
-+ BUG();
-+ return;
-+ }
-+
-+ grab_fpu(regs);
-+#ifndef CONFIG_UNLAZY_FPU //Lazy FPU is used
-+ if (last_task_used_math == current)
-+ return;
-+ if (last_task_used_math != NULL)
-+ /* Other processes fpu state, save away */
-+ save_fpu(last_task_used_math);
-+ last_task_used_math = current;
-+#endif
-+ if (used_math()) {
-+ fpload(&current->thread.fpu);
-+ } else {
-+ /* First time FPU user. */
-+ fpload(&init_fpuregs);
-+ set_used_math();
-+ }
-+
-+}
-+
-+void do_fpu_exception(unsigned long error_code, struct pt_regs *regs)
-+{
-+ unsigned int subtype =
-+ ((GET_ITYPE() & ITYPE_mskSTYPE) >> ITYPE_offSTYPE);
-+ unsigned int cpid = ((GET_ITYPE() & ITYPE_mskCPID) >> ITYPE_offCPID);
-+
-+ /* FPU */
-+ if ((cpid == 0) && (GET_FUCOP_EXIST() & FUCOP_EXIST_mskCP0ISFPU)) {
-+ /* Coprocessor disabled exception */
-+ if (subtype == 1) {
-+ preempt_disable();
-+ do_fpu_context_switch(error_code, regs);
-+ preempt_enable();
-+ }
-+ /* Coprocessor exception */
-+ else if (subtype == 2) {
-+ siginfo_t si = { 0 };
-+ unsigned int fpcsr;
-+ enable_fpu();
-+ asm volatile ("fmfcsr %0\n\t":"=&r" (fpcsr));
-+ disable_fpu();
-+
-+ if (fpcsr & FPCSR_mskALLT) {
-+ si.si_signo = SIGFPE;
-+ /* Exception handling, denorm input, UDF and OVF */
-+ if (fpcsr & FPCSR_mskDNIT) {
-+ unsigned int rfpcsr;
-+ lose_fpu(1);
-+ si.si_signo =
-+ do_fpu_denorm(regs,
-+ &current->thread.fpu);
-+ own_fpu(1);
-+
-+ if (si.si_signo == SIGFPE) {
-+ rfpcsr =
-+ current->thread.fpu.fpcsr;
-+
-+ if (rfpcsr & FPCSR_mskIVO)
-+ si.si_code = FPE_FLTINV;
-+ if (rfpcsr & FPCSR_mskDBZ)
-+ si.si_code = FPE_FLTDIV;
-+ if (rfpcsr & FPCSR_mskOVF)
-+ si.si_code = FPE_FLTOVF;
-+ if (rfpcsr & FPCSR_mskUDF)
-+ si.si_code = FPE_FLTUND;
-+ if (rfpcsr & FPCSR_mskIEX)
-+ si.si_code = FPE_FLTRES;
-+ } else if (si.si_code == SIGILL)
-+ show_regs(regs);
-+ else if (si.si_code == SIGBUS)
-+ si.si_code = BUS_ADRERR;
-+ } else if (fpcsr & FPCSR_mskRIT) {
-+ printk("Reserved Instruction\n");
-+ show_regs(regs);
-+ if (!user_mode(regs))
-+ do_exit(SIGILL);
-+ si.si_signo = SIGILL;
-+ } else if (fpcsr & FPCSR_mskUDFT)
-+ si.si_code = FPE_FLTUND;
-+ else if (fpcsr & FPCSR_mskOVFT)
-+ si.si_code = FPE_FLTOVF;
-+ else if (fpcsr & FPCSR_mskIVOT)
-+ si.si_code = FPE_FLTINV;
-+ else if (fpcsr & FPCSR_mskDBZT)
-+ si.si_code = FPE_FLTDIV;
-+ else if (fpcsr & FPCSR_mskIEXT)
-+ si.si_code = FPE_FLTRES;
-+ /* If something went wrong, signal */
-+ if (si.si_signo) {
-+ if (si.si_code == SIGILL) {
-+ force_sig(si.si_signo, current);
-+ } else {
-+ si.si_addr =
-+ (void __user *)
-+ instruction_pointer(regs);
-+ force_sig_info(si.si_signo, &si,
-+ current);
-+ }
-+ }
-+ } else {
-+ printk("Bad FPU exception\n");
-+ BUG();
-+ }
-+ }
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/fpu.h linux-3.4.113/arch/nds32/kernel/fpu.h
---- linux-3.4.113.orig/arch/nds32/kernel/fpu.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/fpu.h 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,13 @@
-+
-+
-+/*
-+ * Initially load the FPU with signalling NANS. This bit pattern
-+ * has the property that no matter whether considered as single or as
-+ * double precision, it still represents a signalling NAN.
-+ */
-+
-+ #define sNAN64 0xFFFFFFFFFFFFFFFFULL
-+ #define sNAN32 0xFFFFFFFFUL
-+
-+ #define FPCSR_INIT 0x0 /* Hardware reset value */
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/ftrace.c linux-3.4.113/arch/nds32/kernel/ftrace.c
---- linux-3.4.113.orig/arch/nds32/kernel/ftrace.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/ftrace.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,219 @@
-+/*
-+ * Code for replacing ftrace calls with jumps.
-+ *
-+ * Copyright (C) 2007-2008 Steven Rostedt <srostedt@redhat.com>
-+ *
-+ * Thanks goes out to P.A. Semi, Inc for supplying me with a PPC64 box.
-+ *
-+ * Added function graph tracer code, taken from x86 that was written
-+ * by Frederic Weisbecker, and ported to PPC by Steven Rostedt.
-+ *
-+ */
-+
-+#include <linux/spinlock.h>
-+#include <linux/hardirq.h>
-+#include <linux/uaccess.h>
-+#include <linux/module.h>
-+#include <linux/ftrace.h>
-+#include <linux/percpu.h>
-+#include <linux/init.h>
-+#include <linux/list.h>
-+
-+#include <asm/cacheflush.h>
-+#include <asm/ftrace.h>
-+
-+# define GET_ADDR(addr) (*(unsigned long *)addr)
-+
-+#ifdef CONFIG_DYNAMIC_FTRACE
-+static unsigned int ftrace_nop_replace(void)
-+{
-+// return PPC_INST_NOP;
-+ return 0;
-+}
-+
-+static unsigned int
-+ftrace_call_replace(unsigned long ip, unsigned long addr, int link)
-+{
-+ unsigned int op;
-+
-+ addr = GET_ADDR(addr);
-+
-+ /* if (link) set op to 'bl' else 'b' */
-+// op = create_branch((unsigned int *)ip, addr, link ? 1 : 0);
-+
-+ return op;
-+}
-+
-+static int
-+ftrace_modify_code(unsigned long ip, unsigned int old, unsigned int new)
-+{
-+ unsigned int replaced;
-+
-+ /*
-+ * Note: Due to modules and __init, code can
-+ * disappear and change, we need to protect against faulting
-+ * as well as code changing. We do this by using the
-+ * probe_kernel_* functions.
-+ *
-+ * No real locking needed, this code is run through
-+ * kstop_machine, or before SMP starts.
-+ */
-+
-+ /* read the text we want to modify */
-+ if (probe_kernel_read(&replaced, (void *)ip, MCOUNT_INSN_SIZE))
-+ return -EFAULT;
-+
-+ /* Make sure it is what we expect it to be */
-+ if (replaced != old)
-+ return -EINVAL;
-+
-+ /* replace the text with the new text */
-+ if (probe_kernel_write((void *)ip, &new, MCOUNT_INSN_SIZE))
-+ return -EPERM;
-+
-+ flush_icache_range(ip, ip + 8);
-+
-+ return 0;
-+}
-+
-+int ftrace_make_nop(struct module *mod,
-+ struct dyn_ftrace *rec, unsigned long addr)
-+{
-+ unsigned long ip = rec->ip;
-+ unsigned int old, new;
-+
-+ old = ftrace_call_replace(ip, addr, 1);
-+ new = ftrace_nop_replace();
-+ return ftrace_modify_code(ip, old, new);
-+}
-+
-+int ftrace_make_call(struct dyn_ftrace *rec, unsigned long addr)
-+{
-+ unsigned long ip = rec->ip;
-+ unsigned int old, new;
-+
-+ old = ftrace_nop_replace();
-+ new = ftrace_call_replace(ip, addr, 1);
-+ return ftrace_modify_code(ip, old, new);
-+}
-+
-+int ftrace_update_ftrace_func(ftrace_func_t func)
-+{
-+ unsigned long ip = (unsigned long)(&ftrace_call);
-+ unsigned int old, new;
-+ int ret;
-+
-+ old = *(unsigned int *)&ftrace_call;
-+ new = ftrace_call_replace(ip, (unsigned long)func, 1);
-+ ret = ftrace_modify_code(ip, old, new);
-+
-+ return ret;
-+}
-+
-+int __init ftrace_dyn_arch_init(void *data)
-+{
-+ /* caller expects data to be zero */
-+ unsigned long *p = data;
-+
-+ *p = 0;
-+
-+ return 0;
-+}
-+#endif /* CONFIG_DYNAMIC_FTRACE */
-+
-+#ifdef CONFIG_FUNCTION_GRAPH_TRACER
-+
-+#ifdef CONFIG_DYNAMIC_FTRACE
-+extern void ftrace_graph_call(void);
-+extern void ftrace_graph_stub(void);
-+
-+int ftrace_enable_ftrace_graph_caller(void)
-+{
-+ unsigned long ip = (unsigned long)(&ftrace_graph_call);
-+ unsigned long addr = (unsigned long)(&ftrace_graph_caller);
-+ unsigned long stub = (unsigned long)(&ftrace_graph_stub);
-+ unsigned int old, new;
-+
-+ old = ftrace_call_replace(ip, stub, 0);
-+ new = ftrace_call_replace(ip, addr, 0);
-+
-+ return ftrace_modify_code(ip, old, new);
-+}
-+
-+int ftrace_disable_ftrace_graph_caller(void)
-+{
-+ unsigned long ip = (unsigned long)(&ftrace_graph_call);
-+ unsigned long addr = (unsigned long)(&ftrace_graph_caller);
-+ unsigned long stub = (unsigned long)(&ftrace_graph_stub);
-+ unsigned int old, new;
-+
-+ old = ftrace_call_replace(ip, addr, 0);
-+ new = ftrace_call_replace(ip, stub, 0);
-+
-+ return ftrace_modify_code(ip, old, new);
-+}
-+#endif /* CONFIG_DYNAMIC_FTRACE */
-+int get_selfpc(unsigned long mcount_lp)
-+{
-+ unsigned long symbol_size, offset;
-+ kallsyms_lookup_size_offset(mcount_lp, &symbol_size, &offset);
-+ return mcount_lp - offset;
-+}
-+
-+/*
-+ * Hook the return address and push it in the stack of return addrs
-+ * in current thread info.
-+ */
-+void prepare_ftrace_return(unsigned long *parent, unsigned long self_addr)
-+{
-+ unsigned long old;
-+ int faulted;
-+ struct ftrace_graph_ent trace;
-+ unsigned long return_hooker = (unsigned long)&return_to_handler;
-+
-+ if (unlikely(atomic_read(&current->tracing_graph_pause)))
-+ return;
-+
-+ /*
-+ * Protect against fault, even if it shouldn't
-+ * happen. This tool is too much intrusive to
-+ * ignore such a protection.
-+ */
-+ asm volatile ("1: lwi %[old], [%[parent]]\n"
-+ "2: swi %[return_hooker], [%[parent]]\n"
-+ " movi %[faulted], 0\n"
-+ "3:\n"
-+ ".section .fixup, \"ax\"\n"
-+ ".align 2 \n"
-+ "4: movi %[faulted], 1\n"
-+ " b 3b\n"
-+ ".previous\n"
-+ ".section __ex_table,\"a\"\n"
-+ ".align 3 \n"
-+ ".long 1b,4b\n"
-+ ".long 2b,4b\n"
-+ ".previous":[old] "=&r"(old),[faulted] "=r"(faulted)
-+ :[parent] "r"(parent),[return_hooker] "r"(return_hooker)
-+ :"memory");
-+
-+ if (unlikely(faulted)) {
-+ ftrace_graph_stop();
-+ WARN_ON(1);
-+ return;
-+ }
-+
-+ trace.func = self_addr;
-+ trace.depth = current->curr_ret_stack + 1;
-+
-+ /* Only trace if the calling function expects to */
-+ if (!ftrace_graph_entry(&trace)) {
-+ *parent = old;
-+ return;
-+ }
-+
-+ if (ftrace_push_return_trace(old, self_addr, &trace.depth, 0) == -EBUSY) {
-+ *parent = old;
-+ return;
-+ }
-+}
-+#endif /* CONFIG_FUNCTION_GRAPH_TRACER */
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/head.S linux-3.4.113/arch/nds32/kernel/head.S
---- linux-3.4.113.orig/arch/nds32/kernel/head.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/head.S 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,350 @@
-+/*
-+ * arch/nds32/kernel/head.S
-+ *
-+ * NDS32 Kernel startup code
-+ *
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ */
-+#include <linux/linkage.h>
-+#include <linux/init.h>
-+#include <asm/assembler.h>
-+#include <asm/mach-types.h>
-+#include <asm/procinfo.h>
-+#include <asm/ptrace.h>
-+#include <asm/asm-offsets.h>
-+//#include <asm/system.h>
-+#include <asm/page.h>
-+#include <asm/pgtable.h>
-+#include <asm/l2_cache.h>
-+#include <asm/sizes.h>
-+
-+/*
-+ * We place the page tables 16K below TEXTADDR. Therefore, we must make sure
-+ * that TEXTADDR is correctly set. Currently, we expect the least significant
-+ * 16 bits to be 0x8000, but we could probably relax this restriction to
-+ * TEXTADDR >= PAGE_OFFSET + 0x4000
-+ *
-+ * Note that swapper_pg_dir is the virtual address of the page tables, and
-+ * pgtbl gives us a position-independent reference to these tables. We can
-+ * do this because _stext == TEXTADDR
-+ */
-+
-+ .globl swapper_pg_dir
-+ .equ swapper_pg_dir, TEXTADDR - 0x4000
-+
-+/*
-+ * Kernel startup entry point.
-+ * ---------------------------
-+ *
-+ * This is normally called from the decompressor code. The requirements
-+ * are: MMU = off, D-cache = off, I-cache = dont care, $r0 = 0,
-+ * $r1 = machine nr.
-+ *
-+ * This code is mostly position independent, so if you link the kernel at
-+ * 0xc0008000, you call this at __pa(0xc0008000).
-+ *
-+ * See linux/arch/nds32/tools/mach-types for the complete list of machine
-+ * numbers for $r1.
-+ *
-+ * We're trying to keep crap to a minimum; DO NOT add any machine specific
-+ * crap here - that's what the boot loader (or in extreme, well justified
-+ * circumstances, zImage) is for.
-+ */
-+ .section ".head.text", "ax"
-+ .type _stext, %function
-+ENTRY(_stext)
-+ setgie.d ! Disable interrupt
-+ isb
-+ move $r1, #MACH_TYPE_FARADAY ! Note: as far, we are in the Superuser mode
-+ jal __lookup_processor_type ! get processor id, $r5=procinfo, $r9=cpuid, invalid processor $r5=0
-+ li $r2, 'p'
-+ beqz $r5, __error ! yes, error 'p'
-+ jal __lookup_machine_type ! $r5=machinfo
-+ li $r2, 'a'
-+ beqz $r5, __error
-+
-+/*
-+ * Create a temporary mapping area for booting, before start_kernel
-+ */
-+ sethi $r4, hi20(swapper_pg_dir)
-+ li $p0, (PAGE_OFFSET - PHYS_OFFSET)
-+ sub $r4, $r4, $p0
-+ tlbop FlushAll ! invalidate TLB\n"
-+ isb
-+ mtsr $r4, $L1_PPTB ! load page table pointer\n"
-+
-+/* set NTC0 cacheable/writeback, mutliple page size in use */
-+ mfsr $r3, $MMU_CTL
-+ li $r0, ~0x6
-+ and $r3, $r3, $r0
-+ ori $r3, $r3, 0x404
-+ mtsr $r3, $MMU_CTL
-+ isb
-+
-+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ li $r2, #(PHYS_OFFSET + 0x7bf)
-+#else
-+ li $r2, #(PHYS_OFFSET + 0x6bf) ! to remember here
-+#endif
-+ movi $r3, #0x5
-+ mtsr $r3, $TLB_MISC
-+
-+ sethi $r3, hi20(PAGE_OFFSET)
-+ li $r0, #PHYS_OFFSET
-+ sethi $r5, hi20(SZ_1M) ! Use 1MB pages
-+ sethi $r6, hi20(PHYS_OFFSET+SZ_32M) ! Create 32MB first, leave the rest in paging_init()
-+_tlb:
-+ mtsr $r3, $TLB_VPN
-+ dsb
-+ tlbop $r2, RWR
-+ isb
-+ add $r0, $r0, $r5
-+ add $r3, $r3, $r5
-+ add $r2, $r2, $r5
-+ bne $r0, $r6, _tlb
-+
-+ mtsr $r3, $TLB_MISC ! setup access page size
-+ li $r2, #~0xf
-+ and $r3, $r3, $r2
-+#ifdef CONFIG_ANDES_PAGE_SIZE_8KB
-+ ori $r3, $r3, #0x1
-+#endif
-+ mtsr $r3, $TLB_MISC
-+
-+ mfsr $r0, $MISC_CTL ! Enable BTB and RTP
-+ li $r1, #~0x3
-+ and $r0, $r0, $r1
-+ mtsr $r0, $MISC_CTL
-+
-+/*
-+ * Disable L2CC and wait until L2CC registers are mapped into memory to use L2$.
-+ */
-+#ifdef CONFIG_CACHE_L2
-+ li $p0, L2CC_PA_BASE
-+ li $p1, 0
-+ swi $p1, [$p0 + L2CC_CTRL_OFF]
-+#endif
-+
-+#ifdef CONFIG_PLAT_AG102
-+/*
-+ * Set GPUBA to 0x0c000006. GPUB 0x1c000000, FB size 64MB.
-+ */
-+ li $p0, DDR2C_PA_BASE + 0x02a4
-+ li $p1, 0x0c000006
-+ swi $p1, [$p0]
-+#endif
-+
-+ mfsr $p1, $PSW
-+ li $r15, #~0x43df ! clear WBNA|DME|IME|DT|IT|POM|INTL|GIE
-+ and $p1, $p1, $r15
-+#ifdef __NDS32_EB__
-+ #ifdef CONFIG_WBNA
-+ ori $p1, $p1, #0x40ea ! set WBNA|DT|IT|BE|POM:super|INTL:1
-+ #else
-+ ori $p1, $p1, #0xea ! set ----|DT|IT|BE|POM:super|INTL:1
-+ #endif
-+#else
-+ #ifdef CONFIG_WBNA
-+ ori $p1, $p1, #0x40ca ! set WBNA|DT|IT|--|POM:super|INTL:1
-+ #else
-+ ori $p1, $p1, #0xca ! set ----|DT|IT|--|POM:super|INTL:1
-+ #endif
-+#endif
-+
-+ mtsr $p1, $IPSW ! when iret, it will automatically enable MMU
-+ la $lp, __mmap_switched
-+ mtsr $lp, $IPC
-+ iret
-+ nop
-+
-+ .type __switch_data, %object
-+__switch_data:
-+ .long __mmap_switched
-+ .long _sdata ! $r5
-+ .long __bss_start ! $r6
-+ .long _end ! $r7
-+ .long __machine_arch_type ! $r5
-+ .long init_thread_union + 8192 ! $sp
-+
-+
-+/*
-+ * The following fragment of code is executed with the MMU on in MMU mode,
-+ * and uses absolute addresses; this is not position independent.
-+ *
-+ * $r0
-+ * $r10 = points to proc info
-+ * $r8 = points to machine info,
-+ * $r1 = machine ID, 0x2c8 for Andes AG101 board
-+ * $r9 = processor ID of value in version register
-+ */
-+ .align
-+ .type __mmap_switched, %function
-+__mmap_switched:
-+ la $r3, __switch_data + 4
-+ lmw.bim $r5, [$r3], $r7
-+
-+ move $fp, #0 ! Clear BSS (and zero $fp)
-+ beq $r7, $r6, _RRT
-+1: swi.bi $fp, [$r6], #4
-+ bne $r7, $r6, 1b
-+
-+_RRT:
-+ lmw.bim $r4, [$r3], $r4, #0b0001
-+ sw $r1, [$r4] ! Save machine type to memory
-+ b start_kernel
-+
-+
-+/*
-+ * Read processor ID register (CP#15, $CR0), and look up in the linker-built
-+ * supported processor list. Note that we can't use the absolute addresses
-+ * for the __proc_info lists since we aren't running with the MMU on
-+ * (and therefore, we are not in the correct address space). We have to
-+ * calculate the offset.
-+ *
-+ * $r9 = cpuid, get from $CPU_VER
-+ * Returns:
-+ * $r3, $r4, $r6 corrupted
-+ * $r5 = proc_info pointer in physical address space
-+ * $r9 = cpuid
-+ */
-+
-+ .type __lookup_processor_type, %function
-+__lookup_processor_type:
-+ la $r5, __proc_info_begin
-+ la $r6, __proc_info_end
-+ mfsr $r9, $CPU_VER ! get cpu version
-+ li $p0, (PAGE_OFFSET - PHYS_OFFSET)
-+1:
-+ sub $p1, $r5, $p0
-+ lmw.bi $r3, [$p1], $r4 ! value, mask
-+ and $r4, $r4, $r9 ! mask wanted bits
-+ xor $p1, $r3, $r4
-+ beqz $p1, 2f
-+ addi $r5, $r5, #PROC_INFO_SZ ! sizeof(proc_info_list)
-+ bne $r5, $r6, 1b
-+
-+ move $r5, #0 ! unknown processor -> exit
-+2: ret
-+
-+
-+
-+/*
-+ * Lookup machine architecture in the linker-build list of architectures.
-+ * Note that we can't use the absolute addresses for the __arch_info
-+ * lists since we aren't running with the MMU on (and therefore, we are
-+ * not in the correct address space). We have to calculate the offset.
-+ *
-+ * $r1 = machine architecture number
-+ * Returns:
-+ * $r3, $r4, $r6 corrupted
-+ * $r5 = mach_info pointer in physical address space
-+ */
-+ .type __lookup_machine_type, %function
-+__lookup_machine_type:
-+ la $r5, __arch_info_begin
-+ la $r6, __arch_info_end
-+1:
-+ li $p0, (PAGE_OFFSET - PHYS_OFFSET)
-+ sub $p1, $r5, $p0
-+ lwi $r3, [$p1] ! use PA to get machine type
-+ xor $p1, $r3, $r1 ! matches loader number?
-+ beqz $p1, 2f ! found
-+ addi $r5, $r5, #SIZEOF_MACHINE_DESC ! next machine_desc
-+ bne $r5, $r6, 1b
-+ move $r5, #0 ! unknown machine
-+2: ret
-+
-+
-+/*
-+ * Exception handling. Something went wrong and we can't proceed. We
-+ * ought to tell the user, but since we don't have any guarantee that
-+ * we're even running on the right architecture, we do virtually nothing.
-+ *
-+ * a = invalid architecture
-+ * p = invalid processor
-+ *
-+ * Generally, only serious errors cause this.
-+ */
-+__error:
-+ li $r1, UART0_PA_BASE
-+ sw $r2, [$r1]
-+die: b die
-+
-+
-+
-+#ifdef CONFIG_SMP
-+
-+ .type secondary_startup, %function
-+ENTRY(secondary_startup)
-+ /*
-+ * Common entry point for secondary CPUs.
-+ *
-+ * Lookup the processor type - there is no need to check the
-+ * machine type as it has already been validated by the
-+ * primary processor.
-+ */
-+ mfsr $r0, $MMU_CTL
-+ ori $r0, $r0, #4
-+#ifndef CONFIG_NO_KERNEL_LARGE_PAGE
-+ ori $r0, $r0, #0x400
-+#endif
-+ mtsr $r0, $MMU_CTL
-+
-+ movi $r15, #0x01
-+ swi $r15, [$p1+#0x10]
-+ lwi $sp, [$p1+#0x18]
-+
-+ /*
-+ * Set stack, L1_PPTB, and enable mmu
-+ */
-+ sethi $r4, hi20(swapper_pg_dir)
-+ li $p0, (PAGE_OFFSET - PHYS_OFFSET)
-+ sub $r4, $r4, $p0
-+
-+ tlbop FlushAll
-+ isb
-+ mtsr $r4, $L1_PPTB
-+
-+#ifdef CONFIG_CACHE_L2
-+ li $r0, #0x1801
-+ mtsr $r0, $HSMP_SADDR
-+ isb
-+ li $r0, #(L2CC_PA_BASE+0x10) ! L2CC Control
-+ lwi $r1, [$r0]
-+ li $r2, #~(0xf << 28)
-+ and $r1, $r1, $r2
-+ bset $r1, $r1, #29
-+ bset $r1, $r1, #31
-+ swi $r1, [$r0]
-+#endif
-+
-+ move $fp, #0
-+
-+ mfsr $p1, $PSW
-+ li $r15, #~0x43df ! clear WBNA|DME|IME|DT|IT|POM|INTL|GIE
-+ and $p1, $p1, $r15
-+#ifdef __NDS32_EB__
-+ #ifdef CONFIG_WBNA
-+ ori $p1, $p1, #0x40ea ! set WBNA|DT|IT|BE|POM:super|INTL:1
-+ #else
-+ ori $p1, $p1, #0xea ! set ----|DT|IT|BE|POM:super|INTL:1
-+ #endif
-+#else
-+ #ifdef CONFIG_WBNA
-+ ori $p1, $p1, #0x40ca ! set WBNA|DT|IT|--|POM:super|INTL:1
-+ #else
-+ ori $p1, $p1, #0xca ! set ----|DT|IT|--|POM:super|INTL:1
-+ #endif
-+#endif
-+
-+ mtsr $p1, $IPSW ! when iret, it will automatically enable MMU
-+ la $lp, secondary_start_kernel
-+ mtsr $lp, $IPC
-+ iret
-+ nop
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/init_task.c linux-3.4.113/arch/nds32/kernel/init_task.c
---- linux-3.4.113.orig/arch/nds32/kernel/init_task.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/init_task.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,25 @@
-+/*
-+ * linux/arch/nds32/kernel/init_task.c
-+ *
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ */
-+#include <linux/module.h>
-+#include <linux/init_task.h>
-+#include <linux/mqueue.h>
-+#include <linux/fs.h>
-+
-+#include <asm/uaccess.h>
-+
-+static struct signal_struct init_signals = INIT_SIGNALS(init_signals);
-+static struct sighand_struct init_sighand = INIT_SIGHAND(init_sighand);
-+
-+/* Initial task structure */
-+struct task_struct init_task = INIT_TASK(init_task);
-+EXPORT_SYMBOL(init_task);
-+
-+/*
-+ * Initial thread structure. Alignment of this is handled by a special
-+ * linker map entry.
-+ */
-+union thread_union init_thread_union __init_task_data =
-+ { INIT_THREAD_INFO(init_task) };
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/io.c linux-3.4.113/arch/nds32/kernel/io.c
---- linux-3.4.113.orig/arch/nds32/kernel/io.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/io.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,51 @@
-+#include <linux/module.h>
-+#include <linux/types.h>
-+
-+#include <asm/io.h>
-+
-+/*
-+ * Copy data from IO memory space to "real" memory space.
-+ * This needs to be optimized.
-+ */
-+void _memcpy_fromio(void *to, const volatile void __iomem * from, size_t count)
-+{
-+ unsigned char *t = to;
-+ while (count) {
-+ count--;
-+ *t = readb(from);
-+ t++;
-+ from++;
-+ }
-+}
-+
-+/*
-+ * Copy data from "real" memory space to IO memory space.
-+ * This needs to be optimized.
-+ */
-+void _memcpy_toio(volatile void __iomem * to, const void *from, size_t count)
-+{
-+ const unsigned char *f = from;
-+ while (count) {
-+ count--;
-+ writeb(*f, to);
-+ f++;
-+ to++;
-+ }
-+}
-+
-+/*
-+ * "memset" on IO memory space.
-+ * This needs to be optimized.
-+ */
-+void _memset_io(volatile void __iomem * dst, int c, size_t count)
-+{
-+ while (count) {
-+ count--;
-+ writeb(c, dst);
-+ dst++;
-+ }
-+}
-+
-+EXPORT_SYMBOL(_memcpy_fromio);
-+EXPORT_SYMBOL(_memcpy_toio);
-+EXPORT_SYMBOL(_memset_io);
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/irq.c linux-3.4.113/arch/nds32/kernel/irq.c
---- linux-3.4.113.orig/arch/nds32/kernel/irq.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/irq.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,122 @@
-+/*
-+ * linux/arch/nds32/kernel/irq.c
-+ *
-+ * Copyright (C) 1992 Linus Torvalds
-+ * Modifications for ARM processor Copyright (C) 1995-2000 Russell King.
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * This file contains the code used by various IRQ handling routines:
-+ * asking for different IRQ's should be done through these routines
-+ * instead of just grabbing them. Thus setups with different IRQ numbers
-+ * shouldn't result in any weird surprises, and installing new handlers
-+ * should be easier.
-+ *
-+ * IRQ's are in fact implemented a bit like signal handlers for the kernel.
-+ * Naturally it's not a 1:1 relation, but there are similarities.
-+ */
-+#include <linux/kernel_stat.h>
-+#include <linux/module.h>
-+#include <linux/interrupt.h>
-+#include <linux/irq.h>
-+#include <linux/slab.h>
-+#include <linux/random.h>
-+#include <linux/seq_file.h>
-+#include <linux/kallsyms.h>
-+
-+void (*init_arch_irq) (void)__initdata = NULL;
-+unsigned long irq_err_count;
-+
-+void ack_bad_irq(unsigned int irq)
-+{
-+ printk("bad IRQ %d\n", irq);
-+}
-+
-+int show_interrupts(struct seq_file *p, void *v)
-+{
-+ int i = *(loff_t *) v, cpu;
-+ struct irqaction *action;
-+ unsigned long flags;
-+
-+ if (i == 0) {
-+ char cpuname[12];
-+
-+ seq_printf(p, " ");
-+ for_each_present_cpu(cpu) {
-+ sprintf(cpuname, "CPU%d", cpu);
-+ seq_printf(p, " %10s", cpuname);
-+ }
-+ seq_putc(p, '\n');
-+ }
-+
-+ if (i < NR_IRQS) {
-+ raw_spin_lock_irqsave(&irq_desc[i].lock, flags);
-+ action = irq_desc[i].action;
-+ if (!action)
-+ goto unlock;
-+
-+ seq_printf(p, "%3d: ", i);
-+ for_each_present_cpu(cpu)
-+ seq_printf(p, "%10u ", kstat_irqs_cpu(i, cpu));
-+ seq_printf(p, " %s", action->name);
-+ for (action = action->next; action; action = action->next)
-+ seq_printf(p, ", %s", action->name);
-+
-+ seq_putc(p, '\n');
-+unlock:
-+ raw_spin_unlock_irqrestore(&irq_desc[i].lock, flags);
-+ } else if (i == NR_IRQS) {
-+ seq_printf(p, "Err: %10lu\n", irq_err_count);
-+ }
-+ return 0;
-+}
-+
-+/*
-+ * do_IRQ handles all hardware IRQ's. Decoded IRQs should not
-+ * come via this function. Instead, they should provide their
-+ * own 'handler'
-+ */
-+asmlinkage void asm_do_IRQ(unsigned int irq, struct pt_regs *regs)
-+{
-+ struct pt_regs *old_regs = set_irq_regs(regs);
-+
-+ /*
-+ * Some hardware gives randomly wrong interrupts. Rather
-+ * than crashing, do something sensible.
-+ */
-+ if (unlikely(irq >= NR_IRQS)) {
-+ printk(KERN_EMERG "IRQ exceeds NR_IRQS\n");
-+ BUG();
-+ }
-+
-+ irq_enter();
-+ generic_handle_irq(irq);
-+ irq_exit();
-+ set_irq_regs(old_regs);
-+
-+}
-+
-+void __init init_IRQ(void)
-+{
-+ int irq;
-+
-+ for (irq = 0; irq < NR_IRQS; irq++)
-+ irq_set_noprobe(irq);
-+
-+ init_arch_irq();
-+}
-+
-+#ifdef CONFIG_TRACE_IRQFLAGS
-+void notrace arch_trace_hardirqs_on(void)
-+{
-+ trace_hardirqs_on();
-+}
-+
-+void notrace arch_trace_hardirqs_off(void)
-+{
-+ trace_hardirqs_off();
-+}
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/kgdb.c linux-3.4.113/arch/nds32/kernel/kgdb.c
---- linux-3.4.113.orig/arch/nds32/kernel/kgdb.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/kgdb.c 2016-12-01 20:59:24.352612751 +0100
-@@ -0,0 +1,291 @@
-+/* ============================================================================
-+ *
-+ * arch/nds32/kernel/kgdb.c
-+ *
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for NDS32 KGDB support.
-+ *
-+ * Author: Harry Pan
-+ *
-+ * Revision History:
-+ *
-+ * Nov.23.2007 Initial ported by Harry,
-+ * inherited from the KGDB in 2.6.11 and 2.4.35.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#include <linux/types.h>
-+#include <linux/kernel.h>
-+#include <linux/signal.h>
-+#include <linux/sched.h>
-+#include <linux/mm.h>
-+#include <linux/spinlock.h>
-+#include <linux/personality.h>
-+#include <linux/ptrace.h>
-+#include <linux/elf.h>
-+#include <linux/interrupt.h>
-+#include <linux/init.h>
-+#include <linux/kgdb.h>
-+#include <linux/kdebug.h>
-+
-+#include <asm/atomic.h>
-+#include <asm/io.h>
-+#include <asm/pgtable.h>
-+#include <asm/system.h>
-+#include <asm/uaccess.h>
-+#include <asm/unistd.h>
-+#include <asm/ptrace.h>
-+#include <asm/traps.h>
-+
-+// ============================================================================
-+// regs_to_gdb_regs()
-+//
-+// Make a local copy of the registers passed into the handler (bletch).
-+// ============================================================================
-+void pt_regs_to_gdb_regs(unsigned long *gregs, struct pt_regs *kregs)
-+{
-+ int regno;
-+
-+ /* Initialize all to zero (??) */
-+ for (regno = 0; regno < NDS32_NUM_REGS; regno++)
-+ gregs[regno] = 0;
-+
-+ gregs[0] = kregs->NDS32_r0;
-+ gregs[1] = kregs->NDS32_r1;
-+ gregs[2] = kregs->NDS32_r2;
-+ gregs[3] = kregs->NDS32_r3;
-+ gregs[4] = kregs->NDS32_r4;
-+ gregs[5] = kregs->NDS32_r5;
-+ gregs[6] = kregs->NDS32_r6;
-+ gregs[7] = kregs->NDS32_r7;
-+ gregs[8] = kregs->NDS32_r8;
-+ gregs[9] = kregs->NDS32_r9;
-+ gregs[10] = kregs->NDS32_r10;
-+ gregs[11] = kregs->NDS32_r11;
-+ gregs[12] = kregs->NDS32_r12;
-+ gregs[13] = kregs->NDS32_r13;
-+ gregs[14] = kregs->NDS32_r14;
-+ gregs[15] = kregs->NDS32_r15;
-+ gregs[16] = kregs->NDS32_r16;
-+ gregs[17] = kregs->NDS32_r17;
-+ gregs[18] = kregs->NDS32_r18;
-+ gregs[19] = kregs->NDS32_r19;
-+ gregs[20] = kregs->NDS32_r20;
-+ gregs[21] = kregs->NDS32_r21;
-+ gregs[22] = kregs->NDS32_r22;
-+ gregs[23] = kregs->NDS32_r23;
-+ gregs[24] = kregs->NDS32_r24;
-+ gregs[25] = kregs->NDS32_r25;
-+ gregs[26] = kregs->NDS32_pp0;
-+ gregs[27] = kregs->NDS32_pp1;
-+ gregs[28] = kregs->NDS32_fp;
-+ gregs[29] = kregs->NDS32_gp;
-+ gregs[30] = kregs->NDS32_lp;
-+ gregs[31] = kregs->NDS32_sp;
-+ gregs[32] = kregs->NDS32_ipc;
-+ gregs[33] = kregs->NDS32_d0lo;
-+ gregs[34] = kregs->NDS32_d0hi;
-+ gregs[35] = kregs->NDS32_d1lo;
-+ gregs[36] = kregs->NDS32_d1hi;
-+ gregs[NDS32_IR0_REGNUM] = kregs->NDS32_ipsw;
-+}
-+
-+// ============================================================================
-+// gdb_regs_to_regs()
-+//
-+// Copy local gdb registers back to kgdb regs, for later copy to kernel.
-+// ============================================================================
-+void gdb_regs_to_pt_regs(unsigned long *gregs, struct pt_regs *kregs)
-+{
-+ kregs->NDS32_r0 = gregs[0];
-+ kregs->NDS32_r1 = gregs[1];
-+ kregs->NDS32_r2 = gregs[2];
-+ kregs->NDS32_r3 = gregs[3];
-+ kregs->NDS32_r4 = gregs[4];
-+ kregs->NDS32_r5 = gregs[5];
-+ kregs->NDS32_r6 = gregs[6];
-+ kregs->NDS32_r7 = gregs[7];
-+ kregs->NDS32_r8 = gregs[8];
-+ kregs->NDS32_r9 = gregs[9];
-+ kregs->NDS32_r10 = gregs[10];
-+ kregs->NDS32_r11 = gregs[11];
-+ kregs->NDS32_r12 = gregs[12];
-+ kregs->NDS32_r13 = gregs[13];
-+ kregs->NDS32_r14 = gregs[14];
-+ kregs->NDS32_r15 = gregs[15];
-+ kregs->NDS32_r16 = gregs[16];
-+ kregs->NDS32_r17 = gregs[17];
-+ kregs->NDS32_r18 = gregs[18];
-+ kregs->NDS32_r19 = gregs[19];
-+ kregs->NDS32_r20 = gregs[20];
-+ kregs->NDS32_r21 = gregs[21];
-+ kregs->NDS32_r22 = gregs[22];
-+ kregs->NDS32_r23 = gregs[23];
-+ kregs->NDS32_r24 = gregs[24];
-+ kregs->NDS32_r25 = gregs[25];
-+ kregs->NDS32_pp0 = gregs[26];
-+ kregs->NDS32_pp1 = gregs[27];
-+ kregs->NDS32_fp = gregs[28];
-+ kregs->NDS32_gp = gregs[29];
-+ kregs->NDS32_lp = gregs[30];
-+ kregs->NDS32_sp = gregs[31];
-+ kregs->NDS32_ipc = gregs[32];
-+ kregs->NDS32_d0lo = gregs[33];
-+ kregs->NDS32_d0hi = gregs[34];
-+ kregs->NDS32_d1lo = gregs[35];
-+ kregs->NDS32_d1hi = gregs[36];
-+ kregs->NDS32_ipsw = gregs[NDS32_IR0_REGNUM];
-+}
-+
-+// ----------------------------------------------------------------------------
-+// kgdb_get_user_regs()
-+//
-+// Get user process registers.
-+// ----------------------------------------------------------------------------
-+static inline struct pt_regs *kgdb_get_user_regs(struct task_struct *task)
-+{
-+ return (struct pt_regs *)
-+ ((unsigned long)task_thread_info(task) + THREAD_SIZE -
-+ 8 - sizeof(struct pt_regs));
-+}
-+
-+// ============================================================================
-+// sleeping_thread_to_gdb_regs()
-+//
-+// ============================================================================
-+void sleeping_thread_to_gdb_regs(unsigned long *gregs, struct task_struct *task)
-+{
-+ int regno;
-+ struct pt_regs *tregs;
-+
-+ /* Just making sure... */
-+ if (task == NULL)
-+ return;
-+
-+ /* Initialize to zero */
-+ for (regno = 0; regno < NDS32_NUM_REGS; regno++)
-+ gregs[regno] = 0;
-+
-+ /* Otherwise, we have only some registers from switch_to() */
-+ tregs = kgdb_get_user_regs(task);
-+
-+ gregs[0] = tregs->NDS32_r0;
-+ gregs[1] = tregs->NDS32_r1;
-+ gregs[2] = tregs->NDS32_r2;
-+ gregs[3] = tregs->NDS32_r3;
-+ gregs[4] = tregs->NDS32_r4;
-+ gregs[5] = tregs->NDS32_r5;
-+ gregs[6] = tregs->NDS32_r6;
-+ gregs[7] = tregs->NDS32_r7;
-+ gregs[8] = tregs->NDS32_r8;
-+ gregs[9] = tregs->NDS32_r9;
-+ gregs[10] = tregs->NDS32_r10;
-+ gregs[11] = tregs->NDS32_r11;
-+ gregs[12] = tregs->NDS32_r12;
-+ gregs[13] = tregs->NDS32_r13;
-+ gregs[14] = tregs->NDS32_r14;
-+ gregs[15] = tregs->NDS32_r15;
-+ gregs[16] = tregs->NDS32_r16;
-+ gregs[17] = tregs->NDS32_r17;
-+ gregs[18] = tregs->NDS32_r18;
-+ gregs[19] = tregs->NDS32_r19;
-+ gregs[20] = tregs->NDS32_r20;
-+ gregs[21] = tregs->NDS32_r21;
-+ gregs[22] = tregs->NDS32_r22;
-+ gregs[23] = tregs->NDS32_r23;
-+ gregs[24] = tregs->NDS32_r24;
-+ gregs[25] = tregs->NDS32_r25;
-+ gregs[26] = tregs->NDS32_pp0;
-+ gregs[27] = tregs->NDS32_pp1;
-+ gregs[28] = tregs->NDS32_fp;
-+ gregs[29] = tregs->NDS32_gp;
-+ gregs[30] = tregs->NDS32_lp;
-+ gregs[31] = tregs->NDS32_sp;
-+ gregs[32] = tregs->NDS32_ipc;
-+ gregs[33] = tregs->NDS32_d0lo;
-+ gregs[34] = tregs->NDS32_d0hi;
-+ gregs[35] = tregs->NDS32_d1lo;
-+ gregs[36] = tregs->NDS32_d1hi;
-+ gregs[NDS32_IR0_REGNUM] = tregs->NDS32_ipsw;
-+}
-+
-+int kgdb_arch_handle_exception(int exception_vector, int signo,
-+ int err_code, char *remcom_in_buffer,
-+ char *remcom_out_buffer,
-+ struct pt_regs *linux_regs)
-+{
-+ long addr;
-+ char *ptr;
-+
-+ if (0 == atomic_dec_if_positive(&kgdb_setting_breakpoint))
-+ linux_regs->NDS32_ipc += 2;
-+
-+ switch (remcom_in_buffer[0]) {
-+ case 'k':
-+ case 'D':
-+ case 'c':
-+ case 's':
-+ kgdb_contthread = NULL;
-+
-+ /*
-+ * Try to read optional parameter, pc unchanged if no parm.
-+ * If this was a compiled breakpoint, we need to move
-+ * to the next instruction or we will just breakpoint
-+ * over and over again.
-+ */
-+ ptr = &remcom_in_buffer[1];
-+ if (kgdb_hex2long(&ptr, &addr)) {
-+ linux_regs->NDS32_ipc = addr;
-+ }
-+ linux_regs->NDS32_ipsw &= ~0x800;
-+ if (remcom_in_buffer[0] == 's') {
-+ linux_regs->NDS32_ipsw |= 0x800;
-+ }
-+
-+ return 0;
-+ }
-+
-+ return -1;
-+}
-+
-+static int kgdb_notify(struct notifier_block *self,
-+ unsigned long cmd, void *ptr)
-+{
-+ struct die_args *args = ptr;
-+ unsigned long addr = args->err;
-+ if (addr > TASK_SIZE) {
-+ kgdb_handle_exception(args->trapnr, args->signr,
-+ args->err, args->regs);
-+ return NOTIFY_STOP;
-+ }
-+ return NOTIFY_DONE;
-+}
-+
-+static struct notifier_block kgdb_notifier = {
-+ .notifier_call = kgdb_notify,
-+};
-+
-+int kgdb_arch_init(void)
-+{
-+ register_die_notifier(&kgdb_notifier);
-+}
-+
-+void kgdb_arch_exit(void)
-+{
-+ unregister_die_notifier(&kgdb_notifier);
-+}
-+
-+struct kgdb_arch arch_kgdb_ops = {
-+#ifdef __NDS32_EL__
-+ .gdb_bpt_instr = {0xeb, 0xff}
-+#else
-+ .gdb_bpt_instr = {0xff, 0xeb}
-+#endif
-+};
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/kprobes.c linux-3.4.113/arch/nds32/kernel/kprobes.c
---- linux-3.4.113.orig/arch/nds32/kernel/kprobes.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/kprobes.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,869 @@
-+/*
-+ * Kernel Probes (KProbes)
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * Copyright (C) IBM Corporation, 2002, 2004
-+ *
-+ * 2002-Oct Created by Vamsi Krishna S <vamsi_krishna@in.ibm.com> Kernel
-+ * Probes initial implementation ( includes contributions from
-+ * Rusty Russell).
-+ * 2004-July Suparna Bhattacharya <suparna@in.ibm.com> added jumper probes
-+ * interface to access function arguments.
-+ * 2004-Oct Jim Keniston <jkenisto@us.ibm.com> and Prasanna S Panchamukhi
-+ * <prasanna@in.ibm.com> adapted for x86_64 from i386.
-+ * 2005-Mar Roland McGrath <roland@redhat.com>
-+ * Fixed to handle %rip-relative addressing mode correctly.
-+ * 2005-May Hien Nguyen <hien@us.ibm.com>, Jim Keniston
-+ * <jkenisto@us.ibm.com> and Prasanna S Panchamukhi
-+ * <prasanna@in.ibm.com> added function-return probes.
-+ * 2005-May Rusty Lynch <rusty.lynch@intel.com>
-+ * Added function return probes functionality
-+ * 2006-Feb Masami Hiramatsu <hiramatu@sdl.hitachi.co.jp> added
-+ * kprobe-booster and kretprobe-booster for i386.
-+ * 2007-Dec Masami Hiramatsu <mhiramat@redhat.com> added kprobe-booster
-+ * and kretprobe-booster for x86-64
-+ * 2007-Dec Masami Hiramatsu <mhiramat@redhat.com>, Arjan van de Ven
-+ * <arjan@infradead.org> and Jim Keniston <jkenisto@us.ibm.com>
-+ * unified x86 kprobes code.
-+ */
-+
-+#include <linux/kprobes.h>
-+#include <linux/ptrace.h>
-+#include <linux/string.h>
-+#include <linux/slab.h>
-+#include <linux/hardirq.h>
-+#include <linux/preempt.h>
-+#include <linux/module.h>
-+#include <linux/kdebug.h>
-+
-+#include <asm/cacheflush.h>
-+#include <asm/uaccess.h>
-+
-+#ifdef __NDS32_EL__
-+#define SZINSN(insn) (((insn & 0x00000080) == 0) ? 4 : 2)
-+#define BREAK16_1FE 0xFEEB
-+#else
-+#define SZINSN(insn) (((insn & 0x80000000) == 0) ? 4 : 2)
-+#define BREAK16_1FE 0xEBFE
-+#endif
-+
-+void jprobe_return_point(void);
-+
-+DEFINE_PER_CPU(struct kprobe *, current_kprobe) = NULL;
-+DEFINE_PER_CPU(struct kprobe_ctlblk, kprobe_ctlblk);
-+
-+#if 0
-+/* Insert a jump instruction at address 'from', which jumps to address 'to'.*/
-+static void __kprobes set_jmp_op(void *from, void *to)
-+{
-+ struct __arch_jmp_op {
-+ char op;
-+ s32 raddr;
-+ } __attribute__ ((packed)) * jop;
-+ jop = (struct __arch_jmp_op *)from;
-+ jop->raddr = (s32) ((long)(to) - ((long)(from) + 5));
-+ jop->op = RELATIVEJUMP_INSTRUCTION;
-+}
-+
-+/*
-+ * Check for the REX prefix which can only exist on X86_64
-+ * X86_32 always returns 0
-+ */
-+static int __kprobes is_REX_prefix(kprobe_opcode_t * insn)
-+{
-+#ifdef CONFIG_X86_64
-+ if ((*insn & 0xf0) == 0x40)
-+ return 1;
-+#endif
-+ return 0;
-+}
-+
-+/*
-+ * Returns non-zero if opcode is boostable.
-+ * RIP relative instructions are adjusted at copying time in 64 bits mode
-+ */
-+static int __kprobes can_boost(kprobe_opcode_t * opcodes)
-+{
-+ kprobe_opcode_t opcode;
-+ kprobe_opcode_t *orig_opcodes = opcodes;
-+
-+ if (search_exception_tables(opcodes))
-+ return 0; /* Page fault may occur on this address. */
-+
-+retry:
-+ if (opcodes - orig_opcodes > MAX_INSN_SIZE - 1)
-+ return 0;
-+ opcode = *(opcodes++);
-+
-+ /* 2nd-byte opcode */
-+ if (opcode == 0x0f) {
-+ if (opcodes - orig_opcodes > MAX_INSN_SIZE - 1)
-+ return 0;
-+ return test_bit(*opcodes,
-+ (unsigned long *)twobyte_is_boostable);
-+ }
-+
-+ switch (opcode & 0xf0) {
-+#ifdef CONFIG_X86_64
-+ case 0x40:
-+ goto retry; /* REX prefix is boostable */
-+#endif
-+ case 0x60:
-+ if (0x63 < opcode && opcode < 0x67)
-+ goto retry; /* prefixes */
-+ /* can't boost Address-size override and bound */
-+ return (opcode != 0x62 && opcode != 0x67);
-+ case 0x70:
-+ return 0; /* can't boost conditional jump */
-+ case 0xc0:
-+ /* can't boost software-interruptions */
-+ return (0xc1 < opcode && opcode < 0xcc) || opcode == 0xcf;
-+ case 0xd0:
-+ /* can boost AA* and XLAT */
-+ return (opcode == 0xd4 || opcode == 0xd5 || opcode == 0xd7);
-+ case 0xe0:
-+ /* can boost in/out and absolute jmps */
-+ return ((opcode & 0x04) || opcode == 0xea);
-+ case 0xf0:
-+ if ((opcode & 0x0c) == 0 && opcode != 0xf1)
-+ goto retry; /* lock/rep(ne) prefix */
-+ /* clear and set flags are boostable */
-+ return (opcode == 0xf5 || (0xf7 < opcode && opcode < 0xfe));
-+ default:
-+ /* segment override prefixes are boostable */
-+ if (opcode == 0x26 || opcode == 0x36 || opcode == 0x3e)
-+ goto retry; /* prefixes */
-+ /* CS override prefix and call are not boostable */
-+ return (opcode != 0x2e && opcode != 0x9a);
-+ }
-+}
-+
-+/*
-+ * Returns non-zero if opcode modifies the interrupt flag.
-+ */
-+static int __kprobes is_IF_modifier(kprobe_opcode_t * insn)
-+{
-+ switch (*insn) {
-+ case 0xfa: /* cli */
-+ case 0xfb: /* sti */
-+ case 0xcf: /* iret/iretd */
-+ case 0x9d: /* popf/popfd */
-+ return 1;
-+ }
-+
-+ /*
-+ * on X86_64, 0x40-0x4f are REX prefixes so we need to look
-+ * at the next byte instead.. but of course not recurse infinitely
-+ */
-+ if (is_REX_prefix(insn))
-+ return is_IF_modifier(++insn);
-+
-+ return 0;
-+}
-+
-+/*
-+ * Adjust the displacement if the instruction uses the %rip-relative
-+ * addressing mode.
-+ * If it does, Return the address of the 32-bit displacement word.
-+ * If not, return null.
-+ * Only applicable to 64-bit x86.
-+ */
-+static void __kprobes fix_riprel(struct kprobe *p)
-+{
-+#ifdef CONFIG_X86_64
-+ u8 *insn = p->ainsn.insn;
-+ s64 disp;
-+ int need_modrm;
-+
-+ /* Skip legacy instruction prefixes. */
-+ while (1) {
-+ switch (*insn) {
-+ case 0x66:
-+ case 0x67:
-+ case 0x2e:
-+ case 0x3e:
-+ case 0x26:
-+ case 0x64:
-+ case 0x65:
-+ case 0x36:
-+ case 0xf0:
-+ case 0xf3:
-+ case 0xf2:
-+ ++insn;
-+ continue;
-+ }
-+ break;
-+ }
-+
-+ /* Skip REX instruction prefix. */
-+ if (is_REX_prefix(insn))
-+ ++insn;
-+
-+ if (*insn == 0x0f) {
-+ /* Two-byte opcode. */
-+ ++insn;
-+ need_modrm = test_bit(*insn,
-+ (unsigned long *)twobyte_has_modrm);
-+ } else
-+ /* One-byte opcode. */
-+ need_modrm = test_bit(*insn,
-+ (unsigned long *)onebyte_has_modrm);
-+
-+ if (need_modrm) {
-+ u8 modrm = *++insn;
-+ if ((modrm & 0xc7) == 0x05) {
-+ /* %rip+disp32 addressing mode */
-+ /* Displacement follows ModRM byte. */
-+ ++insn;
-+ /*
-+ * The copied instruction uses the %rip-relative
-+ * addressing mode. Adjust the displacement for the
-+ * difference between the original location of this
-+ * instruction and the location of the copy that will
-+ * actually be run. The tricky bit here is making sure
-+ * that the sign extension happens correctly in this
-+ * calculation, since we need a signed 32-bit result to
-+ * be sign-extended to 64 bits when it's added to the
-+ * %rip value and yield the same 64-bit result that the
-+ * sign-extension of the original signed 32-bit
-+ * displacement would have given.
-+ */
-+ disp = (u8 *) p->addr + *((s32 *) insn) -
-+ (u8 *) p->ainsn.insn;
-+ BUG_ON((s64) (s32) disp != disp); /* Sanity check. */
-+ *(s32 *) insn = (s32) disp;
-+ }
-+ }
-+#endif
-+}
-+#endif
-+
-+static void __kprobes arch_copy_kprobe(struct kprobe *p)
-+{
-+ memcpy(p->ainsn.insn, p->addr, MAX_INSN_SIZE * sizeof(kprobe_opcode_t));
-+ flush_icache_range((unsigned long)p->ainsn.insn,
-+ (unsigned long)p->ainsn.insn +
-+ MAX_INSN_SIZE * sizeof(kprobe_opcode_t));
-+
-+// fix_riprel(p);
-+
-+// if (can_boost(p->addr))
-+// p->ainsn.boostable = 0;
-+// else
-+ p->ainsn.boostable = -1;
-+
-+ p->opcode = *p->addr;
-+}
-+
-+int __kprobes arch_prepare_kprobe(struct kprobe *p)
-+{
-+ /* insn: must be on special executable page on x86. */
-+ p->ainsn.insn = get_insn_slot();
-+ if (!p->ainsn.insn)
-+ return -ENOMEM;
-+ arch_copy_kprobe(p);
-+ return 0;
-+}
-+
-+void __kprobes arch_arm_kprobe(struct kprobe *p)
-+{
-+ *p->addr = BREAK16_1FE;
-+ flush_icache_range((unsigned long)p->addr,
-+ (unsigned long)p->addr + sizeof(kprobe_opcode_t));
-+}
-+
-+void __kprobes arch_disarm_kprobe(struct kprobe *p)
-+{
-+ *p->addr = p->opcode;
-+ flush_icache_range((unsigned long)p->addr,
-+ (unsigned long)p->addr + sizeof(kprobe_opcode_t));
-+}
-+
-+void __kprobes arch_remove_kprobe(struct kprobe *p)
-+{
-+ if (p->ainsn.insn) {
-+ free_insn_slot(p->ainsn.insn, (p->ainsn.boostable == 1));
-+ p->ainsn.insn = NULL;
-+ }
-+}
-+
-+static void __kprobes save_previous_kprobe(struct kprobe_ctlblk *kcb)
-+{
-+ kcb->prev_kprobe.kp = kprobe_running();
-+ kcb->prev_kprobe.status = kcb->kprobe_status;
-+ kcb->prev_kprobe.old_flags = kcb->kprobe_old_flags;
-+ kcb->prev_kprobe.saved_flags = kcb->kprobe_saved_flags;
-+}
-+
-+static void __kprobes restore_previous_kprobe(struct kprobe_ctlblk *kcb)
-+{
-+ __get_cpu_var(current_kprobe) = kcb->prev_kprobe.kp;
-+ kcb->kprobe_status = kcb->prev_kprobe.status;
-+ kcb->kprobe_old_flags = kcb->prev_kprobe.old_flags;
-+ kcb->kprobe_saved_flags = kcb->prev_kprobe.saved_flags;
-+}
-+
-+static void __kprobes set_current_kprobe(struct kprobe *p, struct pt_regs *regs,
-+ struct kprobe_ctlblk *kcb)
-+{
-+ __get_cpu_var(current_kprobe) = p;
-+// kcb->kprobe_saved_flags = kcb->kprobe_old_flags
-+// = regs->NDS32_ipsw & PSW_mskHSS;
-+}
-+
-+static void __kprobes prepare_singlestep(struct kprobe *p, struct pt_regs *regs)
-+{
-+ regs->NDS32_ipsw |= PSW_mskHSS;
-+ /* single step inline if the instruction is an int3 */
-+// if (p->opcode == BREAK16_1FE)
-+// regs->NDS32_ipc = (unsigned long)p->addr;
-+// else
-+ regs->NDS32_ipc = (unsigned long)p->ainsn.insn;
-+}
-+
-+void __kprobes arch_prepare_kretprobe(struct kretprobe_instance *ri,
-+ struct pt_regs *regs)
-+{
-+ ri->ret_addr = (kprobe_opcode_t *) regs->NDS32_lp;
-+ regs->NDS32_lp = (unsigned long)&kretprobe_trampoline;
-+}
-+
-+static void __kprobes setup_singlestep(struct kprobe *p, struct pt_regs *regs,
-+ struct kprobe_ctlblk *kcb)
-+{
-+#if !defined(CONFIG_PREEMPT) || defined(CONFIG_FREEZER)
-+ if (p->ainsn.boostable == 1 && !p->post_handler) {
-+ /* Boost up -- we can execute copied instructions directly */
-+ reset_current_kprobe();
-+ regs->NDS32_ipc = (unsigned long)p->ainsn.insn;
-+ preempt_enable_no_resched();
-+ return;
-+ }
-+#endif
-+ prepare_singlestep(p, regs);
-+ kcb->kprobe_status = KPROBE_HIT_SS;
-+}
-+
-+/*
-+ * We have reentered the kprobe_handler(), since another probe was hit while
-+ * within the handler. We save the original kprobes variables and just single
-+ * step on the instruction of the new probe without calling any user handlers.
-+ */
-+static int __kprobes reenter_kprobe(struct kprobe *p, struct pt_regs *regs,
-+ struct kprobe_ctlblk *kcb)
-+{
-+ switch (kcb->kprobe_status) {
-+#if 0
-+ case KPROBE_HIT_SSDONE:
-+#ifdef CONFIG_X86_64
-+ /* TODO: Provide re-entrancy from post_kprobes_handler() and
-+ * avoid exception stack corruption while single-stepping on
-+ * the instruction of the new probe.
-+ */
-+ arch_disarm_kprobe(p);
-+ regs->ip = (unsigned long)p->addr;
-+ reset_current_kprobe();
-+ preempt_enable_no_resched();
-+ break;
-+#endif
-+#endif
-+ case KPROBE_HIT_ACTIVE:
-+ save_previous_kprobe(kcb);
-+ set_current_kprobe(p, regs, kcb);
-+ kprobes_inc_nmissed_count(p);
-+ prepare_singlestep(p, regs);
-+ kcb->kprobe_status = KPROBE_REENTER;
-+ break;
-+ case KPROBE_HIT_SS:
-+ if (p == kprobe_running()) {
-+ regs->NDS32_ipc &= ~PSW_mskHSS;
-+// regs->NDS32_ipc |= kcb->kprobe_saved_flags;
-+ return 0;
-+ } else {
-+ /* A probe has been hit in the codepath leading up
-+ * to, or just after, single-stepping of a probed
-+ * instruction. This entire codepath should strictly
-+ * reside in .kprobes.text section. Raise a warning
-+ * to highlight this peculiar case.
-+ */
-+ }
-+ default:
-+ /* impossible cases */
-+ WARN_ON(1);
-+ return 0;
-+ }
-+
-+ return 1;
-+}
-+
-+/*
-+ * Interrupts are disabled on entry as trap3 is an interrupt gate and they
-+ * remain disabled thorough out this function.
-+ */
-+static int __kprobes kprobe_handler(struct pt_regs *regs)
-+{
-+ kprobe_opcode_t *addr;
-+ struct kprobe *p;
-+ struct kprobe_ctlblk *kcb;
-+
-+ addr = (kprobe_opcode_t *) regs->NDS32_ipc;
-+ if (*addr != BREAK16_1FE) {
-+ /*
-+ * The breakpoint instruction was removed right
-+ * after we hit it. Another cpu has removed
-+ * either a probepoint or a debugger breakpoint
-+ * at this address. In either case, no further
-+ * handling of this interrupt is appropriate.
-+ * Back up over the (now missing) int3 and run
-+ * the original instruction.
-+ */
-+ return 1;
-+ }
-+
-+ /*
-+ * We don't want to be preempted for the entire
-+ * duration of kprobe processing. We conditionally
-+ * re-enable preemption at the end of this function,
-+ * and also in reenter_kprobe() and setup_singlestep().
-+ */
-+ preempt_disable();
-+
-+ kcb = get_kprobe_ctlblk();
-+ p = get_kprobe(addr);
-+
-+ if (p) {
-+ if (kprobe_running()) {
-+ if (reenter_kprobe(p, regs, kcb))
-+ return 1;
-+ } else {
-+ set_current_kprobe(p, regs, kcb);
-+ kcb->kprobe_status = KPROBE_HIT_ACTIVE;
-+
-+ /*
-+ * If we have no pre-handler or it returned 0, we
-+ * continue with normal processing. If we have a
-+ * pre-handler and it returned non-zero, it prepped
-+ * for calling the break_handler below on re-entry
-+ * for jprobe processing, so get out doing nothing
-+ * more here.
-+ */
-+ if (!p->pre_handler || !p->pre_handler(p, regs))
-+ setup_singlestep(p, regs, kcb);
-+ return 1;
-+ }
-+ } else if (kprobe_running()) {
-+ p = __get_cpu_var(current_kprobe);
-+ if (p->break_handler && p->break_handler(p, regs)) {
-+ setup_singlestep(p, regs, kcb);
-+ return 1;
-+ }
-+ }
-+ /* else: not a kprobe fault; let the kernel handle it */
-+ preempt_enable_no_resched();
-+ return 0;
-+}
-+
-+/*
-+ * When a retprobed function returns, this code saves registers and
-+ * calls trampoline_handler() runs, which calls the kretprobe's handler.
-+ */
-+static void __used __kprobes kretprobe_trampoline_holder(void)
-+{
-+ asm volatile (".global kretprobe_trampoline \n"
-+ "kretprobe_trampoline: \n"
-+ "smw.adm $r15, [$sp], $r15, #0x0\n"
-+ "smw.adm $r0, [$sp], $r5, #0x1 \n"
-+ "addi $r0, $sp, #-76 \n"
-+ "bal trampoline_handler \n"
-+ "move $lp, $r0 \n"
-+ "lmw.bim $r0, [$sp], $r5, #0x1 \n"
-+ "lmw.bim $r15, [$sp], $r15, #0x0\n"
-+ "ret \n");
-+}
-+
-+/*
-+ * Called from kretprobe_trampoline
-+ */
-+static __used __kprobes void *trampoline_handler(struct pt_regs *regs)
-+{
-+ struct kretprobe_instance *ri = NULL;
-+ struct hlist_head *head, empty_rp;
-+ struct hlist_node *node, *tmp;
-+ unsigned long flags, orig_ret_address = 0;
-+ unsigned long trampoline_address = (unsigned long)&kretprobe_trampoline;
-+
-+ INIT_HLIST_HEAD(&empty_rp);
-+ kretprobe_hash_lock(current, &head, &flags);
-+
-+ /*
-+ * It is possible to have multiple instances associated with a given
-+ * task either because multiple functions in the call path have
-+ * return probes installed on them, and/or more than one
-+ * return probe was registered for a target function.
-+ *
-+ * We can handle this because:
-+ * - instances are always pushed into the head of the list
-+ * - when multiple return probes are registered for the same
-+ * function, the (chronologically) first instance's ret_addr
-+ * will be the real return address, and all the rest will
-+ * point to kretprobe_trampoline.
-+ */
-+ hlist_for_each_entry_safe(ri, node, tmp, head, hlist) {
-+ if (ri->task != current)
-+ /* another task is sharing our hash bucket */
-+ continue;
-+
-+ if (ri->rp && ri->rp->handler) {
-+ __get_cpu_var(current_kprobe) = &ri->rp->kp;
-+ get_kprobe_ctlblk()->kprobe_status = KPROBE_HIT_ACTIVE;
-+ ri->rp->handler(ri, regs);
-+ __get_cpu_var(current_kprobe) = NULL;
-+ }
-+
-+ orig_ret_address = (unsigned long)ri->ret_addr;
-+ recycle_rp_inst(ri, &empty_rp);
-+
-+ if (orig_ret_address != trampoline_address)
-+ /*
-+ * This is the real return address. Any other
-+ * instances associated with this task are for
-+ * other calls deeper on the call stack
-+ */
-+ break;
-+ }
-+
-+ kretprobe_assert(ri, orig_ret_address, trampoline_address);
-+
-+ kretprobe_hash_unlock(current, &flags);
-+
-+ hlist_for_each_entry_safe(ri, node, tmp, &empty_rp, hlist) {
-+ hlist_del(&ri->hlist);
-+ kfree(ri);
-+ }
-+ return (void *)orig_ret_address;
-+}
-+
-+/*
-+ * Called after single-stepping. p->addr is the address of the
-+ * instruction whose first byte has been replaced by the "int 3"
-+ * instruction. To avoid the SMP problems that can occur when we
-+ * temporarily put back the original opcode to single-step, we
-+ * single-stepped a copy of the instruction. The address of this
-+ * copy is p->ainsn.insn.
-+ *
-+ * This function prepares to return from the post-single-step
-+ * interrupt. We have to fix up the stack as follows:
-+ *
-+ * 0) Except in the case of absolute or indirect jump or call instructions,
-+ * the new ip is relative to the copied instruction. We need to make
-+ * it relative to the original instruction.
-+ *
-+ * 1) If the single-stepped instruction was pushfl, then the TF and IF
-+ * flags are set in the just-pushed flags, and may need to be cleared.
-+ *
-+ * 2) If the single-stepped instruction was a call, the return address
-+ * that is atop the stack is the address following the copied instruction.
-+ * We need to make it the address following the original instruction.
-+ *
-+ * If this is the first time we've single-stepped the instruction at
-+ * this probepoint, and the instruction is boostable, boost it: add a
-+ * jump instruction after the copied instruction, that jumps to the next
-+ * instruction after the probepoint.
-+ */
-+static void __kprobes resume_execution(struct kprobe *p,
-+ struct pt_regs *regs,
-+ struct kprobe_ctlblk *kcb)
-+{
-+// unsigned long *tos = stack_addr(regs);
-+// unsigned long copy_ip = (unsigned long)p->ainsn.insn;
-+// unsigned long orig_ip = (unsigned long)p->addr;
-+ kprobe_opcode_t *insn = p->ainsn.insn;
-+ unsigned long rawinsn = *(unsigned long *)insn;
-+ int size = SZINSN(rawinsn);
-+ regs->NDS32_ipc = (unsigned long)p->addr + size;
-+ regs->NDS32_ipsw &= ~PSW_mskHSS;
-+#if 0
-+
-+ /*skip the REX prefix */
-+ if (is_REX_prefix(insn))
-+ insn++;
-+
-+ regs->flags &= ~X86_EFLAGS_TF;
-+ switch (*insn) {
-+ case 0x9c: /* pushfl */
-+ *tos &= ~(X86_EFLAGS_TF | X86_EFLAGS_IF);
-+ *tos |= kcb->kprobe_old_flags;
-+ break;
-+ case 0xc2: /* iret/ret/lret */
-+ case 0xc3:
-+ case 0xca:
-+ case 0xcb:
-+ case 0xcf:
-+ case 0xea: /* jmp absolute -- ip is correct */
-+ /* ip is already adjusted, no more changes required */
-+ p->ainsn.boostable = 1;
-+ goto no_change;
-+ case 0xe8: /* call relative - Fix return addr */
-+ *tos = orig_ip + (*tos - copy_ip);
-+ break;
-+#ifdef CONFIG_X86_32
-+ case 0x9a: /* call absolute -- same as call absolute, indirect */
-+ *tos = orig_ip + (*tos - copy_ip);
-+ goto no_change;
-+#endif
-+ case 0xff:
-+ if ((insn[1] & 0x30) == 0x10) {
-+ /*
-+ * call absolute, indirect
-+ * Fix return addr; ip is correct.
-+ * But this is not boostable
-+ */
-+ *tos = orig_ip + (*tos - copy_ip);
-+ goto no_change;
-+ } else if (((insn[1] & 0x31) == 0x20) ||
-+ ((insn[1] & 0x31) == 0x21)) {
-+ /*
-+ * jmp near and far, absolute indirect
-+ * ip is correct. And this is boostable
-+ */
-+ p->ainsn.boostable = 1;
-+ goto no_change;
-+ }
-+ default:
-+ break;
-+ }
-+
-+ if (p->ainsn.boostable == 0) {
-+ if ((regs->ip > copy_ip) &&
-+ (regs->ip - copy_ip) + 5 < MAX_INSN_SIZE) {
-+ /*
-+ * These instructions can be executed directly if it
-+ * jumps back to correct address.
-+ */
-+ set_jmp_op((void *)regs->ip,
-+ (void *)orig_ip + (regs->ip - copy_ip));
-+ p->ainsn.boostable = 1;
-+ } else {
-+ p->ainsn.boostable = -1;
-+ }
-+ }
-+
-+ regs->ip += orig_ip - copy_ip;
-+
-+no_change:
-+ restore_btf();
-+#endif
-+}
-+
-+/*
-+ * Interrupts are disabled on entry as trap1 is an interrupt gate and they
-+ * remain disabled thoroughout this function.
-+ */
-+static int __kprobes post_kprobe_handler(struct pt_regs *regs)
-+{
-+ struct kprobe *cur = kprobe_running();
-+ struct kprobe_ctlblk *kcb = get_kprobe_ctlblk();
-+
-+ if (!cur)
-+ return 0;
-+
-+ resume_execution(cur, regs, kcb);
-+ regs->NDS32_ipsw |= kcb->kprobe_saved_flags;
-+
-+ if ((kcb->kprobe_status != KPROBE_REENTER) && cur->post_handler) {
-+ kcb->kprobe_status = KPROBE_HIT_SSDONE;
-+ cur->post_handler(cur, regs, 0);
-+ }
-+
-+ /* Restore back the original saved kprobes variables and continue. */
-+ if (kcb->kprobe_status == KPROBE_REENTER) {
-+ restore_previous_kprobe(kcb);
-+ goto out;
-+ }
-+ reset_current_kprobe();
-+out:
-+ preempt_enable_no_resched();
-+
-+ /*
-+ * if somebody else is singlestepping across a probe point, flags
-+ * will have TF set, in which case, continue the remaining processing
-+ * of do_debug, as if this is not a probe hit.
-+ */
-+ if (regs->NDS32_ipsw & PSW_mskHSS)
-+ return 0;
-+
-+ return 1;
-+}
-+
-+int __kprobes kprobe_fault_handler(struct pt_regs *regs, int trapnr)
-+{
-+ struct kprobe *cur = kprobe_running();
-+ struct kprobe_ctlblk *kcb = get_kprobe_ctlblk();
-+
-+ switch (kcb->kprobe_status) {
-+ case KPROBE_HIT_SS:
-+ case KPROBE_REENTER:
-+ /*
-+ * We are here because the instruction being single
-+ * stepped caused a page fault. We reset the current
-+ * kprobe and the ip points back to the probe address
-+ * and allow the page fault handler to continue as a
-+ * normal page fault.
-+ */
-+ regs->NDS32_ipc = (unsigned long)cur->addr;
-+ regs->NDS32_ipsw |= kcb->kprobe_old_flags;
-+ if (kcb->kprobe_status == KPROBE_REENTER)
-+ restore_previous_kprobe(kcb);
-+ else
-+ reset_current_kprobe();
-+ preempt_enable_no_resched();
-+ break;
-+ case KPROBE_HIT_ACTIVE:
-+ case KPROBE_HIT_SSDONE:
-+ /*
-+ * We increment the nmissed count for accounting,
-+ * we can also use npre/npostfault count for accounting
-+ * these specific fault cases.
-+ */
-+ kprobes_inc_nmissed_count(cur);
-+
-+ /*
-+ * We come here because instructions in the pre/post
-+ * handler caused the page_fault, this could happen
-+ * if handler tries to access user space by
-+ * copy_from_user(), get_user() etc. Let the
-+ * user-specified handler try to fix it first.
-+ */
-+ if (cur->fault_handler && cur->fault_handler(cur, regs, trapnr))
-+ return 1;
-+
-+ /*
-+ * In case the user-specified fault handler returned
-+ * zero, try to fix up.
-+ */
-+ if (fixup_exception(regs))
-+ return 1;
-+
-+ /*
-+ * fixup routine could not handle it,
-+ * Let do_page_fault() fix it.
-+ */
-+ break;
-+ default:
-+ break;
-+ }
-+ return 0;
-+}
-+
-+/*
-+ * Wrapper routine for handling exceptions.
-+ */
-+int __kprobes kprobe_exceptions_notify(struct notifier_block *self,
-+ unsigned long val, void *data)
-+{
-+ struct die_args *args = data;
-+ int ret = NOTIFY_DONE;
-+ int why = args->trapnr & 0xf;
-+
-+ if (args->regs && user_mode(args->regs))
-+ return ret;
-+
-+ switch (why) {
-+ case 1:
-+ if (kprobe_handler(args->regs))
-+ ret = NOTIFY_STOP;
-+ break;
-+ case 7:
-+ if (post_kprobe_handler(args->regs))
-+ ret = NOTIFY_STOP;
-+ break;
-+ default:
-+ break;
-+ }
-+ return ret;
-+}
-+
-+int __kprobes setjmp_pre_handler(struct kprobe *p, struct pt_regs *regs)
-+{
-+ struct jprobe *jp = container_of(p, struct jprobe, kp);
-+ unsigned long addr;
-+ struct kprobe_ctlblk *kcb = get_kprobe_ctlblk();
-+
-+ kcb->jprobe_saved_regs = *regs;
-+ kcb->jprobe_saved_sp = regs->NDS32_sp;
-+ addr = (unsigned long)(kcb->jprobe_saved_sp);
-+
-+ /*
-+ * As Linus pointed out, gcc assumes that the callee
-+ * owns the argument space and could overwrite it, e.g.
-+ * tailcall optimization. So, to be absolutely safe
-+ * we also save and restore enough stack bytes to cover
-+ * the argument area.
-+ */
-+ memcpy(kcb->jprobes_stack, (kprobe_opcode_t *) addr,
-+ MIN_STACK_SIZE(addr));
-+ regs->NDS32_ipsw &= ~PSW_mskGIE;
-+ trace_hardirqs_off();
-+ regs->NDS32_ipc = (unsigned long)(jp->entry);
-+ return 1;
-+}
-+
-+void __kprobes jprobe_return(void)
-+{
-+ struct kprobe_ctlblk *kcd = get_kprobe_ctlblk();
-+ asm volatile (" move $sp, %0\n"
-+ " .globl jprobe_return_point\n"
-+ " jprobe_return_point: \n"
-+ " break #0x1fe \n"::"r" (kcd->
-+ jprobe_saved_sp));
-+}
-+
-+int __kprobes longjmp_break_handler(struct kprobe *p, struct pt_regs *regs)
-+{
-+ struct kprobe_ctlblk *kcb = get_kprobe_ctlblk();
-+ struct jprobe *jp = container_of(p, struct jprobe, kp);
-+
-+ if (regs->NDS32_ipc == jprobe_return_point) {
-+ if (regs->NDS32_sp != kcb->jprobe_saved_sp) {
-+ struct pt_regs *saved_regs = &kcb->jprobe_saved_regs;
-+ printk(KERN_ERR
-+ "current sp %p does not match saved sp %p\n",
-+ regs->NDS32_sp, kcb->jprobe_saved_sp);
-+ printk(KERN_ERR "Saved registers for jprobe %p\n", jp);
-+ show_regs(saved_regs);
-+ printk(KERN_ERR "Current registers\n");
-+ show_regs(regs);
-+ BUG();
-+ }
-+ *regs = kcb->jprobe_saved_regs;
-+ memcpy((kprobe_opcode_t *) (kcb->jprobe_saved_sp),
-+ kcb->jprobes_stack,
-+ MIN_STACK_SIZE(kcb->jprobe_saved_sp));
-+ preempt_enable_no_resched();
-+ return 1;
-+ }
-+ return 0;
-+}
-+
-+int __init arch_init_kprobes(void)
-+{
-+ return 0;
-+}
-+
-+int __kprobes arch_trampoline_kprobe(struct kprobe *p)
-+{
-+ return 0;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/machine_kexec.c linux-3.4.113/arch/nds32/kernel/machine_kexec.c
---- linux-3.4.113.orig/arch/nds32/kernel/machine_kexec.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/machine_kexec.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,80 @@
-+/*
-+ * machine_kexec.c - handle transition of Linux booting another kernel
-+ */
-+
-+#include <linux/mm.h>
-+#include <linux/kexec.h>
-+#include <linux/delay.h>
-+#include <linux/reboot.h>
-+#include <linux/io.h>
-+#include <asm/pgtable.h>
-+#include <asm/pgalloc.h>
-+#include <asm/mmu_context.h>
-+#include <asm/cacheflush.h>
-+#include <asm/mach-types.h>
-+
-+extern const unsigned char relocate_new_kernel[];
-+extern const unsigned int relocate_new_kernel_size;
-+
-+extern void setup_mm_for_reboot(char mode);
-+
-+extern unsigned long kexec_start_address;
-+extern unsigned long kexec_indirection_page;
-+extern unsigned long kexec_mach_type;
-+extern unsigned long kexec_boot_atags;
-+
-+/*
-+ * Provide a dummy crash_notes definition while crash dump arrives to nds32.
-+ * This prevents breakage of crash_notes attribute in kernel/ksysfs.c.
-+ */
-+
-+int machine_kexec_prepare(struct kimage *image)
-+{
-+ return 0;
-+}
-+
-+void machine_kexec_cleanup(struct kimage *image)
-+{
-+}
-+
-+void machine_shutdown(void)
-+{
-+}
-+
-+void machine_crash_shutdown(struct pt_regs *regs)
-+{
-+}
-+
-+void machine_kexec(struct kimage *image)
-+{
-+ unsigned long page_list;
-+ unsigned long reboot_code_buffer_phys;
-+ void *reboot_code_buffer;
-+
-+ page_list = image->head & PAGE_MASK;
-+
-+ /* we need both effective and real address here */
-+ reboot_code_buffer_phys =
-+ page_to_pfn(image->control_code_page) << PAGE_SHIFT;
-+ reboot_code_buffer = page_address(image->control_code_page);
-+
-+ /* Prepare parameters for reboot_code_buffer */
-+ kexec_start_address = image->start;
-+ kexec_indirection_page = page_list;
-+ kexec_mach_type = machine_arch_type;
-+ kexec_boot_atags =
-+ image->start - KEXEC_NDS32_ZIMAGE_OFFSET + KEXEC_NDS32_ATAGS_OFFSET;
-+
-+ /* copy our kernel relocation code to the control code page */
-+ memcpy(reboot_code_buffer,
-+ relocate_new_kernel, relocate_new_kernel_size);
-+
-+ flush_icache_range((unsigned long)reboot_code_buffer,
-+ (unsigned long)reboot_code_buffer +
-+ KEXEC_CONTROL_PAGE_SIZE);
-+ printk(KERN_INFO "Bye!\n");
-+
-+ cpu_proc_fin();
-+ setup_mm_for_reboot(0); /* mode is not used, so just pass 0 */
-+ cpu_reset(reboot_code_buffer_phys);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/Makefile linux-3.4.113/arch/nds32/kernel/Makefile
---- linux-3.4.113.orig/arch/nds32/kernel/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/Makefile 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,45 @@
-+#
-+# Makefile for the linux kernel.
-+#
-+
-+CPPFLAGS_vmlinux.lds +=-DTEXTADDR=$(TEXTADDR) -DDATAADDR=$(DATAADDR)
-+AFLAGS_head.o := -DTEXTADDR=$(TEXTADDR) -DDATAADDR=$(DATAADDR)
-+
-+# Object file lists.
-+
-+obj-y := ex-entry.o ex-exit.o ex-scall.o irq.o \
-+ process.o ptrace.o setup.o signal.o \
-+ sys_nds32.o time.o traps.o io.o proc.o \
-+ elfchk.o
-+ifdef CONFIG_FUNCTION_TRACER
-+CFLAGS_REMOVE_ftrace.o = -pg
-+CFLAGS_REMOVE_ex-entry.o = -pg
-+CFLAGS_REMOVE_ex-exit.o = -pg
-+CFLAGS_REMOVE_ex-scall.o = -pg
-+CFLAGS_REMOVE_stacktrace.o = -pg
-+CFLAGS_REMOVE_traps.o = -pg
-+endif
-+
-+obj-$(CONFIG_MODULES) += nds32_ksyms.o module.o
-+obj-$(CONFIG_ISA_DMA) += dma-isa.o
-+obj-$(CONFIG_PCI) += bios32.o
-+obj-$(CONFIG_SMP) += smp.o
-+obj-$(CONFIG_KGDB) += kgdb.o
-+obj-$(CONFIG_STACKTRACE) += stacktrace.o
-+obj-$(CONFIG_KPROBES) += kprobes.o
-+obj-$(CONFIG_FPU) += fpu.o
-+obj-$(CONFIG_AUDIO) += audio.o
-+obj-$(CONFIG_FUNCTION_GRAPH_TRACER) += ftrace.o
-+obj-$(CONFIG_KEXEC) += machine_kexec.o relocate_kernel.o
-+obj-$(CONFIG_EARLY_PRINTK) += early_printk.o
-+
-+extra-y := head.o init_task.o vmlinux.lds
-+
-+CFLAGS_fpu.o += \
-+ $(shell $(CC) -E -dM -xc /dev/null | grep -o -m1 NDS32_EXT_FPU_SP | sed -e 's/NDS32_EXT_FPU_SP/-mext-fpu-sp/') \
-+ $(shell $(CC) -E -dM -xc /dev/null | grep -o -m1 NDS32_EXT_FPU_DP | sed -e 's/NDS32_EXT_FPU_DP/-mext-fpu-dp/')
-+ifdef CONFIG_FPU
-+CFLAGS_elfchk.o += \
-+ $(shell $(CC) -E -dM -xc /dev/null | grep -o -m1 NDS32_EXT_FPU_SP | sed -e 's/NDS32_EXT_FPU_SP/-mext-fpu-sp/') \
-+ $(shell $(CC) -E -dM -xc /dev/null | grep -o -m1 NDS32_EXT_FPU_DP | sed -e 's/NDS32_EXT_FPU_DP/-mext-fpu-dp/')
-+endif
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/module.c linux-3.4.113/arch/nds32/kernel/module.c
---- linux-3.4.113.orig/arch/nds32/kernel/module.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/module.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,314 @@
-+/*
-+ * linux/arch/nds32/kernel/module.c
-+ *
-+ * Copyright (C) 2002 Russell King.
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Module allocation method suggested by Andi Kleen.
-+ */
-+#include <linux/module.h>
-+#include <linux/elf.h>
-+#include <linux/vmalloc.h>
-+#include <linux/slab.h>
-+#include <linux/mm.h>
-+
-+#include <asm/pgtable.h>
-+
-+#define DEBUG 0
-+#if DEBUG
-+#define PRINTK printk
-+#else
-+#define PRINTK(x...)
-+#endif
-+
-+void *module_alloc(unsigned long size)
-+{
-+#ifdef CONFIG_KPROBES
-+ if (size == 0)
-+ return NULL;
-+ return vmalloc_exec(size);
-+#else
-+ return __vmalloc_node_range(size, 1, MODULES_VADDR, MODULES_END,
-+ GFP_KERNEL, PAGE_KERNEL, -1,
-+ __builtin_return_address(0));
-+#endif
-+}
-+
-+void module_free(struct module *module, void *region)
-+{
-+ vfree(region);
-+}
-+
-+int module_frob_arch_sections(Elf_Ehdr * hdr,
-+ Elf_Shdr * sechdrs,
-+ char *secstrings, struct module *mod)
-+{
-+ return 0;
-+}
-+
-+void do_reloc16(unsigned int val, unsigned int *loc, unsigned int val_mask,
-+ unsigned int val_shift, unsigned int loc_mask,
-+ unsigned int partial_in_place, unsigned int swap)
-+{
-+ unsigned int tmp = 0, tmp2 = 0;
-+
-+ __asm__ __volatile__("\tlhi.bi\t%0, [%2], 0\n"
-+ "\tbeqz\t%3, 1f\n"
-+ "\twsbh\t%0, %1\n"
-+ "1:\n":"=r"(tmp):"0"(tmp), "r"(loc), "r"(swap)
-+ );
-+
-+ tmp2 = tmp & loc_mask;
-+ if (partial_in_place) {
-+ tmp &= (!loc_mask);
-+ tmp =
-+ tmp2 | ((tmp + ((val & val_mask) >> val_shift)) & val_mask);
-+ } else {
-+ tmp = tmp2 | ((val & val_mask) >> val_shift);
-+ }
-+
-+ __asm__ __volatile__("\tbeqz\t%3, 2f\n"
-+ "\twsbh\t%0, %1\n"
-+ "2:\n"
-+ "\tshi.bi\t%0, [%2], 0\n":"=r"(tmp):"0"(tmp),
-+ "r"(loc), "r"(swap)
-+ );
-+}
-+
-+void do_reloc32(unsigned int val, unsigned int *loc, unsigned int val_mask,
-+ unsigned int val_shift, unsigned int loc_mask,
-+ unsigned int partial_in_place, unsigned int swap)
-+{
-+ unsigned int tmp = 0, tmp2 = 0;
-+
-+ __asm__ __volatile__("\tlmw.bi\t%0, [%2], %0, 0\n"
-+ "\tbeqz\t%3, 1f\n"
-+ "\twsbh\t%0, %1\n"
-+ "\trotri\t%0, %1, 16\n"
-+ "1:\n":"=r"(tmp):"0"(tmp), "r"(loc), "r"(swap)
-+ );
-+
-+ tmp2 = tmp & loc_mask;
-+ if (partial_in_place) {
-+ tmp &= (!loc_mask);
-+ tmp =
-+ tmp2 | ((tmp + ((val & val_mask) >> val_shift)) & val_mask);
-+ } else {
-+ tmp = tmp2 | ((val & val_mask) >> val_shift);
-+ }
-+
-+ __asm__ __volatile__("\tbeqz\t%3, 2f\n"
-+ "\twsbh\t%0, %1\n"
-+ "\trotri\t%0, %1, 16\n"
-+ "2:\n"
-+ "\tsmw.bi\t%0, [%2], %0, 0\n":"=r"(tmp):"0"(tmp),
-+ "r"(loc), "r"(swap)
-+ );
-+}
-+
-+static inline int exceed_limit(int offset, unsigned int val_mask,
-+ struct module *module, Elf32_Rela * rel,
-+ unsigned int relindex, unsigned int reloc_order)
-+{
-+ int abs_off = offset < 0 ? ~offset : offset;
-+
-+ if (abs_off & (~val_mask)) {
-+ printk(KERN_ERR "\n%s: relocation type %d out of range.\n"
-+ "please rebuild the kernel module with gcc option \"-Wa,-mno-small-text\".\n",
-+ module->name, ELF32_R_TYPE(rel->r_info));
-+ PRINTK("section %d reloc %d offset 0x%x relative 0x%x.\n"
-+ relindex, reloc_order, rel->r_offset, offset);
-+ return true;
-+ }
-+ return false;
-+}
-+
-+#ifdef __NDS32_EL__
-+#define NEED_SWAP 1
-+#else
-+#define NEED_SWAP 0
-+#endif
-+
-+int
-+apply_relocate_add(Elf32_Shdr * sechdrs, const char *strtab,
-+ unsigned int symindex, unsigned int relindex,
-+ struct module *module)
-+{
-+ Elf32_Shdr *symsec = sechdrs + symindex;
-+ Elf32_Shdr *relsec = sechdrs + relindex;
-+ Elf32_Shdr *dstsec = sechdrs + relsec->sh_info;
-+ Elf32_Rela *rel = (void *)relsec->sh_addr;
-+ unsigned int i;
-+
-+ for (i = 0; i < relsec->sh_size / sizeof(Elf32_Rela); i++, rel++) {
-+ Elf32_Addr *loc;
-+ Elf32_Sym *sym;
-+ Elf32_Addr v;
-+ s32 offset;
-+
-+ offset = ELF32_R_SYM(rel->r_info);
-+ if (offset < 0
-+ || offset > (symsec->sh_size / sizeof(Elf32_Sym))) {
-+ printk(KERN_ERR "%s: bad relocation\n", module->name);
-+ PRINTK("section %d reloc %d\n", module->name, relindex,
-+ i);
-+ return -ENOEXEC;
-+ }
-+
-+ sym = ((Elf32_Sym *) symsec->sh_addr) + offset;
-+
-+ if (rel->r_offset < 0
-+ || rel->r_offset > dstsec->sh_size - sizeof(u16)) {
-+ printk(KERN_ERR "%s: out of bounds relocation\n",
-+ module->name);
-+ PRINTK("section %d reloc %d offset 0x%0x size %d\n",
-+ relindex, i, rel->r_offset, dstsec->sh_size);
-+ return -ENOEXEC;
-+ }
-+
-+ loc = (Elf32_Addr *) (dstsec->sh_addr + rel->r_offset);
-+ v = sym->st_value + rel->r_addend;
-+
-+ switch (ELF32_R_TYPE(rel->r_info)) {
-+ case R_NDS32_NONE:
-+ case R_NDS32_INSN16:
-+ case R_NDS32_LABEL:
-+ case R_NDS32_LONGCALL1:
-+ case R_NDS32_LONGCALL2:
-+ case R_NDS32_LONGCALL3:
-+ case R_NDS32_LONGCALL4:
-+ case R_NDS32_LONGJUMP1:
-+ case R_NDS32_LONGJUMP2:
-+ case R_NDS32_LONGJUMP3:
-+ case R_NDS32_9_FIXED_RELA:
-+ case R_NDS32_15_FIXED_RELA:
-+ case R_NDS32_17_FIXED_RELA:
-+ case R_NDS32_25_FIXED_RELA:
-+ case R_NDS32_LOADSTORE:
-+ case R_NDS32_DWARF2_OP1_RELA:
-+ case R_NDS32_DWARF2_OP2_RELA:
-+ case R_NDS32_DWARF2_LEB_RELA:
-+ case R_NDS32_RELA_NOP_MIX...R_NDS32_RELA_NOP_MAX:
-+ break;
-+
-+ case R_NDS32_32_RELA:
-+ do_reloc32(v, loc, 0xffffffff, 0, 0, 0, 0);
-+ break;
-+
-+ case R_NDS32_HI20_RELA:
-+ do_reloc32(v, loc, 0xfffff000, 12, 0xfff00000, 0,
-+ NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_LO12S3_RELA:
-+ do_reloc32(v, loc, 0x00000fff, 3, 0xfffff000, 0,
-+ NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_LO12S2_RELA:
-+ do_reloc32(v, loc, 0x00000fff, 2, 0xfffff000, 0,
-+ NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_LO12S1_RELA:
-+ do_reloc32(v, loc, 0x00000fff, 1, 0xfffff000, 0,
-+ NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_LO12S0_RELA:
-+ case R_NDS32_LO12S0_ORI_RELA:
-+ do_reloc32(v, loc, 0x00000fff, 0, 0xfffff000, 0,
-+ NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_9_PCREL_RELA:
-+ if (exceed_limit
-+ ((v - (Elf32_Addr) loc), 0x000000ff, module, rel,
-+ relindex, i))
-+ return -ENOEXEC;
-+ do_reloc16(v - (Elf32_Addr) loc, loc, 0x000001ff, 1,
-+ 0xffffff00, 0, NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_15_PCREL_RELA:
-+ if (exceed_limit
-+ ((v - (Elf32_Addr) loc), 0x00003fff, module, rel,
-+ relindex, i))
-+ return -ENOEXEC;
-+ do_reloc32(v - (Elf32_Addr) loc, loc, 0x00007fff, 1,
-+ 0xffffc000, 0, NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_17_PCREL_RELA:
-+ if (exceed_limit
-+ ((v - (Elf32_Addr) loc), 0x0000ffff, module, rel,
-+ relindex, i))
-+ return -ENOEXEC;
-+ do_reloc32(v - (Elf32_Addr) loc, loc, 0x0001ffff, 1,
-+ 0xffff0000, 0, NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_25_PCREL_RELA:
-+ if (exceed_limit
-+ ((v - (Elf32_Addr) loc), 0x00ffffff, module, rel,
-+ relindex, i))
-+ return -ENOEXEC;
-+ do_reloc32(v - (Elf32_Addr) loc, loc, 0x01ffffff, 1,
-+ 0xff000000, 0, NEED_SWAP);
-+ break;
-+ case R_NDS32_WORD_9_PCREL_RELA:
-+ if (exceed_limit
-+ ((v - (Elf32_Addr) loc), 0x000000ff, module, rel,
-+ relindex, i))
-+ return -ENOEXEC;
-+ do_reloc32(v - (Elf32_Addr) loc, loc, 0x000001ff, 1,
-+ 0xffffff00, 0, NEED_SWAP);
-+ break;
-+
-+ case R_NDS32_SDA15S3_RELA:
-+ case R_NDS32_SDA15S2_RELA:
-+ case R_NDS32_SDA15S1_RELA:
-+ case R_NDS32_SDA15S0_RELA:
-+ printk(KERN_ERR "%s: unsupported relocation type %d.\n",
-+ module->name, ELF32_R_TYPE(rel->r_info));
-+ printk(KERN_ERR
-+ "Small data section access doesn't work in the kernel space; "
-+ "please rebuild the kernel module with gcc option -G0.\n");
-+ PRINTK("section %d reloc %d offset 0x%x size %d\n",
-+ relindex, i, rel->r_offset, dstsec->sh_size);
-+ break;
-+
-+ default:
-+ printk(KERN_ERR "%s: unsupported relocation type %d.\n",
-+ module->name, ELF32_R_TYPE(rel->r_info));
-+ PRINTK("section %d reloc %d offset 0x%x size %d\n",
-+ relindex, i, rel->r_offset, dstsec->sh_size);
-+ }
-+ }
-+ return 0;
-+}
-+
-+int
-+apply_relocate(Elf32_Shdr * sechdrs, const char *strtab,
-+ unsigned int symindex, unsigned int relsec,
-+ struct module *module)
-+{
-+// printk(KERN_ERR "module %s: non-ADD RELOCATION unsupported\n", module->name);
-+// return -ENOEXEC;
-+ return 0;
-+}
-+
-+int
-+module_finalize(const Elf32_Ehdr * hdr, const Elf_Shdr * sechdrs,
-+ struct module *module)
-+{
-+ return 0;
-+}
-+
-+void module_arch_cleanup(struct module *mod)
-+{
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/nds32-elf.h linux-3.4.113/arch/nds32/kernel/nds32-elf.h
---- linux-3.4.113.orig/arch/nds32/kernel/nds32-elf.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/nds32-elf.h 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,855 @@
-+#ifndef _NDS32_ELF_CHECK
-+#define _NDS32_ELF_CHECK
-+
-+//#define TEST_ELF_CHECK_FUNC
-+#ifdef TEST_ELF_CHECK_FUNC
-+#include <stdio.h>
-+#include <stdlib.h>
-+#endif
-+
-+//#include <stdio.h>
-+//#include <stdarg.h>
-+
-+#ifdef __cplusplus
-+extern "C"
-+{
-+#else
-+#include <stdbool.h>
-+#endif //#ifdef __cplusplus
-+
-+
-+ enum ELF_HEADER_FLAG_FIELD
-+ {
-+ EHFF_ARCH_VER = 0xF0000000, EHFF_ARCH_VER_SHIFT = 28,
-+ //EHFF_RESERVED = 0x08000000,
-+ EHFF_HAS_ZOL = 0x04000000,
-+ EHFF_ISA_DSP = 0x02000000,
-+ EHFF_ISA_FPU_MAC = 0x01000000,
-+ EHFF_FPU_REG = 0x00C00000, EHFF_FPU_REG_SHIFT = 22,
-+ EHFF_ISA_L2C = 0x00200000,
-+ EHFF_ISA_NO_MAC = 0x00100000,
-+ EHFF_ISA_MAC_DX = 0x00100000,
-+ EHFF_ISA_FPU_DP = 0x00080000,
-+ //EHFF_RESERVED = 0x00040000,
-+ EHFF_ISA_SATURATION = 0x00020000,
-+ EHFF_REDUCED_REGS = 0x00010000,
-+ EHFF_ISA_STRING = 0x00008000,
-+ EHFF_ISA_16BIT = 0x00004000,
-+ EHFF_ISA_IFC = 0x00004000,
-+ EHFF_ISA_DIV = 0x00002000,
-+ EHFF_ISA_DIV_DX = 0x00002000,
-+ EHFF_ISA_AUDIO = 0x00001000,
-+ EHFF_ISA_FPU_SP = 0x00000800,
-+ EHFF_ISA_EXT2 = 0x00000400,
-+ EHFF_ISA_EXT = 0x00000200,
-+ EHFF_ISA_EIT = 0x00000100,
-+ EHFF_ISA_MFUSR_PC = 0x00000100,
-+ EHFF_ABI_VER = 0x000000F0,
-+ EHFF_ELF_VER = 0x0000000F, EHFF_ELF_VER_SHIFT = 0,
-+ };
-+
-+
-+ enum ELF_HEADER_FLAG_FIELD_ARCH_VER
-+ {
-+ EHFF_ARCH_VER_RESERVED = 0x0,
-+ EHFF_ARCH_VER_V1 = 0x1,
-+ EHFF_ARCH_VER_V2 = 0x2,
-+ EHFF_ARCH_VER_V3 = 0x3,
-+ EHFF_ARCH_VER_V3M = 0x4,
-+ };
-+
-+ static const char *EHFF_ARCH_VER_MSG[] =
-+ {
-+ "RESERVED",
-+ "BASE V1",
-+ "BASE V2",
-+ "BASE V3",
-+ "BASE V3M",
-+ };
-+
-+
-+
-+
-+ /* ----------------------------------------------------------- */
-+ /* 4-bit for ABI signature, allow up to 16 ABIs */
-+ /* 0 : for OLD ABI V0, phase out
-+ * 1 : for V1 , starting with V0 toolchain
-+ * 2 : for V2
-+ * 3 : for V2FP (fs0, fs1 as function parameter)
-+ * 4 : for AABI */
-+ /* only old N1213HC use V0 */
-+ /* New ABI is used due to return register is changed to r0 from r5 */
-+ /* ----------------------------------------------------------- */
-+#define E_NDS_ABI_V0 0x00000000
-+#define E_NDS_ABI_V1 0x00000010
-+#define E_NDS_ABI_V2 0x00000020
-+#define E_NDS_ABI_V2FP 0x00000030
-+#define E_NDS_ABI_AABI 0x00000040
-+#define E_NDS_ABI_V2FP_PLUS 0x00000050
-+
-+ /* ---------------------------------------------------------------------------- */
-+ /* This flag signifies the version of Andes ELF */
-+ /* note : */
-+ /* 1. v1.3.1 and beyond is accompanying with Baseline ISA 1.0b/2.0/... in ELF. */
-+ /* 2. v1.3.1 is accompanying with Baseline ISA 1.0b in ELF. */
-+ /* ... | MAC | ... | DIV | ... */
-+ /* 3. v1.3.1 is accompanying with Baseline ISA 2.0 and beyond in ELF. */
-+ /* ... | MAC_DX | ... | DIV_DX | ... */
-+ /* ---------------------------------------------------------------------------- */
-+
-+ enum ELF_HEADER_FLAG_FIELD_ELF_VER
-+ {
-+ EHFF_ELF_VER_1_3_0 = 0x0,
-+ EHFF_ELF_VER_1_3_1 = 0x1,
-+ EHFF_ELF_VER_1_4_0 = 0x2,
-+ };
-+
-+ static const char *EHFF_ELF_VER_MSG[] =
-+ {
-+ "1.3.0",
-+ "1.3.1",
-+ "1.4.0",
-+ };
-+ /* */
-+ /* sr layout : */
-+ /* sr[14..10] : hardware components */
-+ /* cpu / fpu / audio / ... */
-+ /* sr[9..0] : sr index number dedicated for sr[14..10] */
-+ /* */
-+
-+ //
-+ // sr[14..10] definition:
-+ // 0 : cpu
-+ // 1 : fpu
-+ // 2 : audio
-+#define INDEX_HW_MASK 0x00007c00
-+#define INDEX_HW_CPU 0x00000000
-+#define INDEX_HW_FPU 0x00000400
-+#define INDEX_HW_AUDIO 0x00000800
-+#define HW_IS_CPU(sr) ((sr & INDEX_HW_MASK) == INDEX_HW_CPU)
-+#define HW_IS_FPU(sr) ((sr & INDEX_HW_MASK) == INDEX_HW_FPU)
-+#define HW_IS_AUDIO(sr) ((sr & INDEX_HW_MASK) == INDEX_HW_AUDIO)
-+
-+ //
-+ // sr[9..0] definition:
-+ // if (HW_IS_CPU(sr)) // cpu score
-+ // sr[9..0] defined in chap 9 of Andes-Privilege-Architecture spec.
-+ // else if (HW_IS_FPU(sr)) // fpu score
-+ // sr[9..0] == SR_FPU_FPCFG, FPCFG defined in FPU_ISA_EXT spec.
-+ // else if (HW_IS_AUDIO(sr)) // audio score
-+ // //none register is used in loader checking mechanism
-+ //
-+#define SR_INDEX_MASK 0x000003ff
-+#define SR_INDEX(sr) (sr & SR_INDEX_MASK)
-+#define CPU_SR_INDEX(x,y,z) ((x << 7) + (y << 3) + z)
-+#define FPU_SR_FPCFG() (INDEX_HW_FPU)
-+
-+ //FPU-belonged system registers
-+#define SR_FPU_FPCFG 0x00
-+
-+#define SR_NOT_EXIST 0xffffffff
-+
-+ typedef unsigned int (* CALLBACK_FUNC) (unsigned int index);
-+
-+
-+ static const char *NEC_MSG_FPU_reg[5] =
-+ {
-+ "N/A",
-+ " 8SP/ 4DP",
-+ "16SP/ 8DP",
-+ "32SP/16DP",
-+ "32SP/32DP"
-+ };
-+ static const char *NEC_MSG_endian[2] =
-+ {
-+ "little",
-+ "big"
-+ };
-+
-+#define EM_NDS32 167
-+#if defined elf_check_swap_2 || defined elf_check_swap_4
-+#error "ERROR : elf_check_swap_2 and elf_check_swap_4 are multiple defined"
-+#endif
-+#define elf_check_swap_2(data) (((data&0x0000ff00)>>8) | ((data&0x000000ff)<<8))
-+#define elf_check_swap_4(data) (((data&0xff000000)>>24) | \
-+ ((data&0x00ff0000)>>8) | \
-+ ((data&0x0000ff00)<<8) | \
-+ ((data&0x000000ff)<<24))
-+
-+#define MSC_CFG_BASEV 0x0000e000
-+
-+#define CPU_VER_EXT 0x00000001
-+#define CPU_VER_A16 0x00000002
-+#define CPU_VER_EXT2 0x00000004
-+#define CPU_VER_FPU 0x00000008
-+#define CPU_VER_STRING 0x00000010
-+#define CPU_VER_SATURATION 0x00000020
-+
-+#define MSC_CFG_DIV 0x00000020
-+#define MSC_CFG_MAC 0x00000040
-+#define MSC_CFG_L2C 0x00000200
-+#define MSC_CFG_REDUCED_REG 0x00000400
-+#define MSC_CFG_NOD 0x00010000
-+#define MSC_CFG_AUDIO 0x00000180
-+#define MSC_CFG_AUDIO_NONE 0x00000000
-+#define MSC_CFG_IFC 0x00080000
-+#define MSC_CFG_MCU 0x00100000
-+#define MSC_CFG_EX9IT 0x01000000
-+#define MSC_CFG_MSC_EXT 0xc0000000
-+
-+#define MSC_CFG2_DSPPF 0x00000018
-+#define MSC_CFG2_ZOL 0x00000020
-+
-+#define MMU_CFG_DE 0x04000000
-+
-+ typedef struct nds32_elfinfo_s
-+ {
-+ unsigned int endian; // 1.local-used constant definition
-+ // 0 : little , 1 : big
-+ // 2.system-used constant definition
-+ // little / big depends on system definition
-+ unsigned int machine; //magic number (167 for nds32 machine)
-+ unsigned int mfusr_pc; //reclaim in baseline v2
-+ unsigned int abi; // abi version
-+ unsigned int base16; // 0 : not support , 1 : support
-+ unsigned int pex1;
-+ unsigned int div; //reclaim in baseline v2
-+ unsigned int pex2;
-+ unsigned int fpu; //fpu single precision
-+ unsigned int audio;
-+ unsigned int string;
-+ unsigned int reduced_regs;
-+ unsigned int saturation;
-+ unsigned int ifc;
-+ unsigned int elf_ver; //elf version number, 0 for v1.3.0, 1 for v1.3.1
-+ unsigned int l2c;
-+ unsigned int mac; //reclaim in baseline v2
-+ //unsigned int isa_ver;//0x0, baseline = baseline V1 - 16 bit ISA
-+ //0x1, baseline = baseline V1
-+ //0x2, baseline = baseline V1 + V2 extension ISA
-+ //unsigned int fpu_sp; //fpu double precision
-+ //unsigned int fpu_reg; //fpu registers capacity
-+ } nds32_elfinfo_t;
-+
-+ typedef enum nds32_elfchk_e
-+ {
-+ endian_chk = 0,
-+ machine_chk,
-+ isa_chk,
-+ abi_chk
-+ } nds32_elfchk_t;
-+
-+ typedef enum ELF_Fail_Type
-+ {
-+ EFT_NONE,
-+ EFT_WARNING,
-+ EFT_ERROR
-+ }ELF_Fail_Type;
-+
-+ static inline void NEC_itoa(unsigned int value, char *buf, const unsigned int base)
-+ {
-+ char temp[10] = "\0", ch;
-+ int len = 1, index;
-+
-+ while(value > 0)
-+ {
-+ ch = value%base;
-+ value = value/base;
-+ if(ch >= 10)
-+ ch = ch+'a'-10;
-+ else
-+ ch = ch+'0';
-+ temp[len++] = ch;
-+ }
-+ len--;
-+
-+ index = len;
-+ while(index >= 0)
-+ {
-+ buf[index] = temp[len-index];
-+ index--;
-+ }
-+ }
-+
-+ static inline void NEC_format(char *buf, unsigned int width)
-+ {
-+ unsigned int len = strlen(buf);
-+ memmove(buf+(width-len), buf, len+1);
-+ memset(buf, ' ', (width-len));
-+ }
-+
-+ static void NEC_sprintf(char *buf, const char *str, ...)
-+ {
-+ int width, len = 0;
-+ va_list ap;
-+ char token, temp[100];
-+ buf[0] = '\0';
-+
-+
-+ va_start(ap, str);
-+ while(*str != '\0')
-+ {
-+ if(*str != '%')
-+ buf[len++] = *str;
-+ else //*str == '%'
-+ {
-+ token = *(++str);
-+
-+ width = 0;
-+ while(token >= '0' && token <= '9')
-+ {
-+ width *= 10;
-+ width += token-'0';
-+ token = *(++str);
-+ }
-+
-+ switch(token)
-+ {
-+ case 'd':
-+ NEC_itoa(va_arg(ap, unsigned int), temp, 10);
-+ break;
-+ case 'x':
-+ NEC_itoa(va_arg(ap, unsigned int), temp, 16);
-+ break;
-+ case 's':
-+ strcpy(temp, va_arg(ap, char *));
-+ break;
-+ }
-+
-+ if(width != 0)
-+ NEC_format(temp, width);
-+
-+ buf[len++] = '\0';
-+ strcat(buf, temp);
-+ len = strlen(buf);
-+ }
-+
-+ str++;
-+ }
-+ buf[len] = '\0';
-+ }
-+
-+ //NDS32 strcat for avoiding buf overflow
-+ static inline void NEC_strcat_safety(char *destination, unsigned int destination_size, char *source)
-+ {
-+ strncat(destination, source, destination_size - strlen(destination) - 1);
-+ }
-+
-+ //NDS32 Elf Check print
-+ static inline void NEC_print(char *buf, unsigned int len, ELF_Fail_Type type, const char *name, const char *cpu, const char *elf, const char *error_message)
-+ {
-+ char temp[100];
-+ switch(type)
-+ {
-+ case EFT_NONE:
-+ NEC_sprintf(temp, "\t | %9s | %9s | %14s\n", cpu, elf, name);
-+ break;
-+ case EFT_WARNING:
-+ NEC_sprintf(temp, "\t?| %9s | %9s | %14s Warning: %s\n", cpu, elf, name, error_message);
-+ break;
-+ case EFT_ERROR:
-+ NEC_sprintf(temp, "\t!| %9s | %9s | %14s Error: %s\n", cpu, elf, name, error_message);
-+ break;
-+ }
-+ NEC_strcat_safety(buf, len, temp);
-+ }
-+
-+ static inline bool NEC_check_bool(char *buf, unsigned int len, ELF_Fail_Type type, const char *isa, bool cpu, bool elf)
-+ {
-+ bool code;
-+ const char *NEC_MSG_ISA[2] = { "OFF", "ON" };
-+ if(!cpu && elf)
-+ code = 1;
-+ else
-+ {
-+ code = 0;
-+ type = EFT_NONE;
-+ }
-+ NEC_print(buf, len, type, isa, NEC_MSG_ISA[cpu], NEC_MSG_ISA[elf], "Not supported by CPU");
-+ return code;
-+ }
-+
-+ static inline ELF_Fail_Type elf_ver_and_arch_ver_compatibility_check(unsigned int elf_ver, unsigned int arch_ver)
-+ {
-+ switch(elf_ver)
-+ {
-+ case EHFF_ELF_VER_1_3_0:
-+ switch(arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ return EFT_NONE;
-+ default:
-+ return EFT_ERROR;
-+ }
-+ case EHFF_ELF_VER_1_3_1:
-+ switch(arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ case EHFF_ARCH_VER_V2:
-+ case EHFF_ARCH_VER_V3M:
-+ return EFT_NONE;
-+ default:
-+ return EFT_ERROR;
-+ }
-+ case EHFF_ELF_VER_1_4_0:
-+ switch(arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ case EHFF_ARCH_VER_V2:
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ return EFT_NONE;
-+ default:
-+ return EFT_ERROR;
-+ }
-+ }
-+ return EFT_ERROR;
-+ }
-+
-+
-+ static inline ELF_Fail_Type arch_ver_check(unsigned int CPU, unsigned int ELF)
-+ {
-+ switch(CPU)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ switch(ELF)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ return EFT_NONE;
-+ default:
-+ return EFT_ERROR;
-+ }
-+ case EHFF_ARCH_VER_V2:
-+ switch(ELF)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ case EHFF_ARCH_VER_V2:
-+ return EFT_NONE;
-+ default:
-+ return EFT_ERROR;
-+ }
-+ case EHFF_ARCH_VER_V3:
-+ switch(ELF)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ case EHFF_ARCH_VER_V2:
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ return EFT_NONE;
-+ default:
-+ return EFT_ERROR;
-+ }
-+ case EHFF_ARCH_VER_V3M:
-+ switch(ELF)
-+ {
-+ case EHFF_ARCH_VER_V3M:
-+ return EFT_NONE;
-+ default:
-+ return EFT_ERROR;
-+ }
-+ }
-+ return EFT_ERROR;
-+ }
-+
-+ // buf : buffer of char*, put Target Isa Info into *buf
-+ // len : length of buffer (at least 300 chars in length)
-+ // buf_status : status of buffer
-+ // 0 : ok
-+ // 1 : overflow
-+#define TARGET_ISA_INFO_LEN 2000
-+ static inline unsigned int elf_check (unsigned char *ehdr, CALLBACK_FUNC reg_read_callback, char *buf, unsigned int len, unsigned int *buf_status)
-+ {
-+ unsigned int SR_msc_cfg, SR_msc_cfg2 = 0, SR_cpu_ver, SR_mmu_cfg, fpcfg, fucop_exist, fpu_mount;
-+ unsigned int CPU_DIV_DX_ISA, CPU_MAC_DX_ISA;
-+ unsigned int eflag, ELF_arch_ver, ELF_elf_ver, CPU_arch_ver;
-+ unsigned short machine;
-+ unsigned char big_endian_elf = 0, big_endian_cpu;
-+
-+ char temp[100];
-+ char temp_cpu[10];
-+ char temp_elf[10];
-+ int n_error, n_warning;
-+ int CPU_support;
-+ unsigned char FPU_reg_elf, FPU_reg_cpu;
-+ ELF_Fail_Type error_type;
-+
-+
-+
-+ n_error = 0;
-+ n_warning = 0;
-+
-+ buf[0] = '\0';
-+ *buf_status = 0;
-+
-+ SR_cpu_ver = reg_read_callback(CPU_SR_INDEX(0,0,0));
-+ SR_msc_cfg = reg_read_callback(CPU_SR_INDEX(0,4,0));
-+ SR_mmu_cfg = reg_read_callback(CPU_SR_INDEX(0,3,0));
-+
-+ if (SR_msc_cfg & MSC_CFG_MSC_EXT)
-+ SR_msc_cfg2 = reg_read_callback(CPU_SR_INDEX(0,4,1));
-+
-+ switch(*((char*)(ehdr+5)))
-+ {
-+ case 1:
-+ big_endian_elf = 0;
-+ break;
-+ case 2:
-+ big_endian_elf = 1;
-+ break;
-+ }
-+
-+ if(SR_mmu_cfg & MMU_CFG_DE)
-+ big_endian_cpu = 1;
-+ else
-+ big_endian_cpu = 0;
-+
-+
-+ /* 20091106 note :
-+ * 1. In term of OS, elf_check() would be used in OS kernel and ld.so
-+ * 2. Since OS is running on SID, eflag/machine did not need endian conversion for big endian format.
-+ * 3. Later, elf_check interface is going to cover "OS" case by adding a new parameter.
-+ *
-+ */
-+#ifdef ELF_CHECKING_OS
-+ eflag = *((unsigned int *)(ehdr+36));
-+ machine = *((unsigned short*)(ehdr+18));
-+#else // GDB loader / SID loader
-+ eflag = (big_endian_elf == 0)? *((unsigned int *)(ehdr+36)) : elf_check_swap_4(*((unsigned int *)(ehdr+36)));
-+ machine = (big_endian_elf == 0)? *((unsigned short*)(ehdr+18)) : elf_check_swap_2(*((unsigned short*)(ehdr+18)));
-+#endif
-+
-+ ELF_arch_ver = (eflag & EHFF_ARCH_VER) >> EHFF_ARCH_VER_SHIFT;
-+ ELF_elf_ver = (eflag & EHFF_ELF_VER) >> EHFF_ELF_VER_SHIFT;
-+
-+ CPU_arch_ver = ((SR_msc_cfg & MSC_CFG_BASEV) >> 13) + 1;
-+ if(CPU_arch_ver == 3)
-+ if(SR_msc_cfg & MSC_CFG_MCU)
-+ CPU_arch_ver = 4;
-+
-+ /*Basic version check
-+
-+ 1.ELF version check
-+ 2.Architecture version check
-+ 3.Machine check
-+ */
-+ if(ELF_elf_ver > EHFF_ELF_VER_1_4_0)
-+ {
-+ NEC_sprintf(temp, "Error: unsupport ELF version: 0x%x\n", ELF_elf_ver);
-+ NEC_strcat_safety(buf, len, temp);
-+ return 1;
-+ }
-+ NEC_sprintf(temp, "ELF version: %s\n", EHFF_ELF_VER_MSG[ELF_elf_ver]);
-+ NEC_strcat_safety(buf, len, temp);
-+
-+
-+ if(elf_ver_and_arch_ver_compatibility_check(ELF_elf_ver, ELF_arch_ver) == EFT_ERROR)
-+ {
-+ NEC_sprintf(temp, "Error: architecture version is not supported in this ELF version: %s\n", EHFF_ARCH_VER_MSG[ELF_arch_ver]);
-+ NEC_strcat_safety(buf, len, temp);
-+ return 1;
-+ }
-+
-+ NEC_sprintf(temp, "\t %9s %9s \n", "CPU", "ELF");
-+ NEC_strcat_safety(buf, len, temp);
-+ if(big_endian_cpu != big_endian_elf)
-+ {
-+ error_type = EFT_ERROR;
-+ n_error++;
-+ }
-+ else
-+ error_type = EFT_NONE;
-+ NEC_print(buf, len, error_type, "endianess", NEC_MSG_endian[big_endian_cpu], NEC_MSG_endian[big_endian_elf], "endianess mismatch");
-+
-+
-+
-+
-+ if (EM_NDS32 != machine)
-+ {
-+ error_type = EFT_ERROR;
-+ n_error++;
-+ }
-+ else
-+ error_type = EFT_NONE;
-+ NEC_sprintf(temp_cpu, "%d", EM_NDS32);
-+ NEC_sprintf(temp_elf, "%d", machine);
-+ NEC_print(buf, len, error_type, "machine", temp_cpu, temp_elf, "wrong machine");
-+
-+
-+ error_type = arch_ver_check(CPU_arch_ver, ELF_arch_ver);
-+ if(error_type == EFT_ERROR)
-+ n_error++;
-+ NEC_print(buf, len, error_type, "BASELINE ISA", EHFF_ARCH_VER_MSG[CPU_arch_ver], EHFF_ARCH_VER_MSG[ELF_arch_ver], "BASELINE ISA mismatch");
-+
-+ /*Prepare reference variables
-+
-+ 1.DIV, MAC, DX
-+ 2.FPU
-+ */
-+
-+ CPU_MAC_DX_ISA = 0;
-+ CPU_DIV_DX_ISA = 0;
-+ switch(CPU_arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ if (SR_msc_cfg & MSC_CFG_MAC)
-+ CPU_MAC_DX_ISA = 1;
-+ if (SR_msc_cfg & MSC_CFG_DIV)
-+ CPU_DIV_DX_ISA = 1;
-+ break;
-+ case EHFF_ARCH_VER_V2:
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ if (!(SR_msc_cfg & MSC_CFG_NOD))
-+ {
-+ CPU_MAC_DX_ISA = 1;
-+ CPU_DIV_DX_ISA = 1;
-+ }
-+ break;
-+ }
-+ fpu_mount = 0;
-+ if (SR_cpu_ver & CPU_VER_FPU)
-+ {
-+ fucop_exist = reg_read_callback(CPU_SR_INDEX(0,5,0));
-+ if (fucop_exist & 0x80000000)
-+ {
-+ fpu_mount = 1;
-+ fpcfg = reg_read_callback(FPU_SR_FPCFG());
-+ }
-+ else
-+ fpu_mount = 0;
-+ }
-+
-+ //Parse Configuration field (bit 27~8)
-+
-+ //bit 27 Reserved
-+ //bit 26 ZOL
-+ CPU_support = 0;
-+ if ((SR_msc_cfg & MSC_CFG_MSC_EXT) && (SR_msc_cfg2 & MSC_CFG2_ZOL))
-+ CPU_support = 1;
-+ if (ELF_elf_ver == EHFF_ELF_VER_1_4_0)
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "ZOL", CPU_support, eflag & EHFF_HAS_ZOL);
-+
-+ //bit 25 DSP
-+ CPU_support = 0;
-+ if ((SR_msc_cfg & MSC_CFG_MSC_EXT) && (SR_msc_cfg2 & MSC_CFG2_DSPPF))
-+ CPU_support = 1;
-+ if (ELF_elf_ver == EHFF_ELF_VER_1_4_0)
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "DSP ISA", CPU_support, eflag & EHFF_ISA_DSP);
-+
-+ //bit 24
-+ CPU_support = 0;
-+ if(fpu_mount)
-+ if(fpcfg & 0x00000010)
-+ CPU_support = 1;
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "FPU MAC ISA", CPU_support, eflag & EHFF_ISA_FPU_MAC);
-+
-+ //bit 23~22
-+ if(fpu_mount)
-+ FPU_reg_cpu = ((fpcfg >> 2) & 0x3) + 1;
-+ else
-+ FPU_reg_cpu = 0;
-+
-+ if(eflag & (EHFF_ISA_FPU_SP | EHFF_ISA_FPU_DP | EHFF_ISA_FPU_MAC))
-+ FPU_reg_elf = ((eflag & EHFF_FPU_REG) >> EHFF_FPU_REG_SHIFT) + 1;
-+ else
-+ FPU_reg_elf = 0;
-+ if(FPU_reg_elf > FPU_reg_cpu)
-+ {
-+ error_type = EFT_ERROR;
-+ n_error++;
-+ }
-+ else
-+ error_type = EFT_NONE;
-+ NEC_print(buf, len, error_type, "FPU REGISTER", NEC_MSG_FPU_reg[FPU_reg_cpu], NEC_MSG_FPU_reg[FPU_reg_elf],
-+ "FPU REGISTERS not supported by CPU");
-+ //bit 21
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "L2C ISA", SR_msc_cfg & MSC_CFG_L2C, eflag & EHFF_ISA_L2C);
-+
-+ //bit 20
-+ //MAC_DX check
-+ // Target Machine certainly has MAC_DX under the following conditions:
-+ // 1. Baseline V1 ISA && MSC_CFG.MAC (softcore version)
-+ // 2. Baseline V2 ISA && D0/D1 support
-+ // 3. Baseline V3 ISA && D0/D1 support
-+
-+ switch(ELF_arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "MAC/MAC DX ISA", CPU_MAC_DX_ISA, !(eflag & EHFF_ISA_NO_MAC));
-+ break;
-+ case EHFF_ARCH_VER_V2:
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "MAC DX ISA", CPU_MAC_DX_ISA, eflag & EHFF_ISA_MAC_DX);
-+ break;
-+ }
-+ //bit 19
-+ CPU_support = 0;
-+ if(fpu_mount)
-+ if(fpcfg & 0x00000002)
-+ CPU_support = 1;
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "FPU DP ISA", CPU_support, eflag & EHFF_ISA_FPU_DP);
-+
-+
-+ //bit 18 Reserved
-+ //bit 17
-+ switch(ELF_elf_ver)
-+ {
-+ case EHFF_ELF_VER_1_3_0:
-+ case EHFF_ELF_VER_1_3_1:
-+ break;
-+ case EHFF_ELF_VER_1_4_0:
-+ switch(ELF_arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "SATURATION ISA", SR_cpu_ver & CPU_VER_SATURATION, eflag & EHFF_ISA_SATURATION);
-+ break;
-+ }
-+ break;
-+ }
-+ //bit 16
-+ if(SR_msc_cfg & MSC_CFG_REDUCED_REG)
-+ CPU_support = 0;
-+ else
-+ CPU_support = 1;
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "32 GPR", CPU_support, (eflag & EHFF_REDUCED_REGS) == 0);
-+
-+ //bit 15
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "STRING ISA", SR_cpu_ver & CPU_VER_STRING, eflag & EHFF_ISA_STRING);
-+
-+ //bit 14
-+ switch(ELF_elf_ver)
-+ {
-+ case EHFF_ELF_VER_1_3_0:
-+ case EHFF_ELF_VER_1_3_1:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "16-BIT ISA", SR_cpu_ver & CPU_VER_A16, eflag & EHFF_ISA_16BIT);
-+ break;
-+ case EHFF_ELF_VER_1_4_0:
-+ switch(ELF_arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ case EHFF_ARCH_VER_V2:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "16-BIT ISA", SR_cpu_ver & CPU_VER_A16, eflag & EHFF_ISA_16BIT);
-+ break;
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "IFC ISA", SR_msc_cfg & MSC_CFG_IFC, eflag & EHFF_ISA_IFC);
-+ break;
-+ }
-+ break;
-+ }
-+
-+ //bit 13
-+ switch(ELF_arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "DIV DX ISA", CPU_DIV_DX_ISA, eflag & EHFF_ISA_DIV);
-+ break;
-+ case EHFF_ARCH_VER_V2:
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "DIV DX ISA", CPU_DIV_DX_ISA, eflag & EHFF_ISA_DIV_DX);
-+ break;
-+ }
-+ //bit 12
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "AUDIO/DSP ISA", SR_msc_cfg & MSC_CFG_AUDIO, eflag & EHFF_ISA_AUDIO);
-+ //bit 11
-+ CPU_support = 0;
-+ if(fpu_mount)
-+ if(fpcfg & 0x00000001)
-+ CPU_support = 1;
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "FPU SP ISA", CPU_support, eflag & EHFF_ISA_FPU_SP);
-+
-+ //bit 10
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "PEX2 ISA", SR_cpu_ver & CPU_VER_EXT2, eflag & EHFF_ISA_EXT2);
-+
-+ //bit 9
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "PEX1 ISA", SR_cpu_ver & CPU_VER_EXT, eflag & EHFF_ISA_EXT);
-+
-+ //bit 8
-+ CPU_support = 0;
-+ if(CPU_arch_ver == EHFF_ARCH_VER_V3M)
-+ CPU_support = 1;
-+ switch(ELF_elf_ver)
-+ {
-+ case EHFF_ELF_VER_1_3_0:
-+ case EHFF_ELF_VER_1_3_1:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "MFUSR_PC ISA", CPU_support, eflag & EHFF_ISA_MFUSR_PC);
-+ break;
-+ case EHFF_ELF_VER_1_4_0:
-+ switch(ELF_arch_ver)
-+ {
-+ case EHFF_ARCH_VER_V1:
-+ case EHFF_ARCH_VER_V2:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "MFUSR_PC ISA", CPU_support, eflag & EHFF_ISA_MFUSR_PC);
-+ break;
-+ case EHFF_ARCH_VER_V3:
-+ case EHFF_ARCH_VER_V3M:
-+ n_error += NEC_check_bool(buf, len, EFT_ERROR, "EIT ISA", SR_msc_cfg & MSC_CFG_EX9IT, eflag & EHFF_ISA_EIT);
-+ break;
-+ }
-+ break;
-+ }
-+
-+ if(n_error)
-+ {
-+ NEC_strcat_safety(buf, len, (char*)"Error: ELF and CPU mismatch\n");
-+ NEC_sprintf(temp, "Total Error: %d\n", n_error);
-+ NEC_strcat_safety(buf, len, temp);
-+
-+ NEC_strcat_safety(buf, len, (char*)"Usage error, Consult Andes Toolchains and their compatible Andes cores for the Toolchain-CPU compatibility.\n");
-+ NEC_strcat_safety(buf, len, (char*)"The Loader Checking can be disabled under Debug Configuration.\n");
-+ }
-+ else
-+ NEC_strcat_safety(buf, len, (char*)"NDS32 ELF checking pass\n");
-+
-+ if(n_warning)
-+ {
-+ NEC_sprintf(temp, "Total Warning: %d\n", n_warning);
-+ NEC_strcat_safety(buf, len, temp);
-+ }
-+
-+
-+ // checking buf overflow
-+ if(strlen(buf) >= len)
-+ *buf_status = 1;
-+
-+ return n_error;
-+ } //end of elf_check
-+
-+#undef elf_check_swap_2
-+#undef elf_check_swap_4
-+
-+#undef MSC_CFG_BASEV
-+
-+#undef CPU_VER_STRING
-+#undef CPU_VER_EXT
-+#undef CPU_VER_A16
-+#undef CPU_VER_EXT2
-+#undef CPU_VER_FPU
-+#undef CPU_VER_SATURATION
-+
-+#undef MSC_CFG_DIV
-+#undef MSC_CFG_MAC
-+#undef MSC_CFG_L2C
-+#undef MSC_CFG_REDUCED_REG
-+#undef MSC_CFG_NOD
-+#undef MSC_CFG_AUDIO
-+#undef MSC_CFG_AUDIO_NONE
-+#undef MSC_CFG_IFC
-+#undef MSC_CFG_MCU
-+#undef MSC_CFG_EX9IT
-+#undef MSC_CFG_MSC_EXT
-+
-+#undef MSC_CFG2_DSPPF
-+#undef MSC_CFG2_ZOL
-+
-+#undef MMU_CFG_DE
-+
-+#ifdef __cplusplus
-+}
-+#endif //#ifdef __cplusplus
-+
-+#endif //end of _NDS32_ELF_CHECK
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/nds32_ksyms.c linux-3.4.113/arch/nds32/kernel/nds32_ksyms.c
---- linux-3.4.113.orig/arch/nds32/kernel/nds32_ksyms.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/nds32_ksyms.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,103 @@
-+/*
-+ * arch/nds32/kernel/nds32_ksyms.c
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/string.h>
-+#include <linux/delay.h>
-+#include <linux/in6.h>
-+#include <linux/syscalls.h>
-+
-+#include <asm/checksum.h>
-+#include <asm/io.h>
-+#include <asm/system.h>
-+#include <asm/uaccess.h>
-+
-+/*
-+ * libgcc functions - functions that are used internally by the
-+ * compiler... (prototypes are not correct though, but that
-+ * doesn't really matter since they're not versioned).
-+ */
-+extern void __ashldi3(void);
-+extern void __ashrdi3(void);
-+extern void __divsi3(void);
-+extern void __lshrdi3(void);
-+extern void __modsi3(void);
-+extern void __muldi3(void);
-+extern void __ucmpdi2(void);
-+extern void __udivdi3(void);
-+extern void __umoddi3(void);
-+extern void __udivmoddi4(void);
-+extern void __udivsi3(void);
-+extern void __umodsi3(void);
-+
-+/*
-+ * This has a special calling convention; it doesn't
-+ * modify any of the usual registers, except for LR.
-+ */
-+#define EXPORT_SYMBOL_ALIAS(sym,orig) \
-+ const struct kernel_symbol __ksymtab_##sym \
-+ __attribute__((section("__ksymtab"))) = \
-+ { (unsigned long)&orig, #sym };
-+
-+/*
-+ * floating point math emulator support.
-+ * These symbols will never change their calling convention...
-+ */
-+
-+/* networking */
-+EXPORT_SYMBOL(csum_partial);
-+EXPORT_SYMBOL(csum_partial_copy_nocheck);
-+
-+/* string / mem functions */
-+EXPORT_SYMBOL(strchr);
-+EXPORT_SYMBOL(strrchr);
-+EXPORT_SYMBOL(memset);
-+EXPORT_SYMBOL(memcpy);
-+EXPORT_SYMBOL(memmove);
-+EXPORT_SYMBOL(__memzero);
-+
-+/* user mem (segment) */
-+EXPORT_SYMBOL(__arch_copy_from_user);
-+EXPORT_SYMBOL(__arch_copy_to_user);
-+EXPORT_SYMBOL(__arch_clear_user);
-+EXPORT_SYMBOL(__arch_strnlen_user);
-+EXPORT_SYMBOL(__arch_strncpy_from_user);
-+
-+EXPORT_SYMBOL(__get_user_1);
-+EXPORT_SYMBOL(__get_user_2);
-+EXPORT_SYMBOL(__get_user_4);
-+EXPORT_SYMBOL(__get_user_8);
-+
-+EXPORT_SYMBOL(__put_user_1);
-+EXPORT_SYMBOL(__put_user_2);
-+EXPORT_SYMBOL(__put_user_4);
-+EXPORT_SYMBOL(__put_user_8);
-+
-+/* gcc lib functions */
-+EXPORT_SYMBOL(__ashldi3);
-+EXPORT_SYMBOL(__ashrdi3);
-+EXPORT_SYMBOL(__divsi3);
-+EXPORT_SYMBOL(__lshrdi3);
-+EXPORT_SYMBOL(__modsi3);
-+EXPORT_SYMBOL(__muldi3);
-+EXPORT_SYMBOL(__ucmpdi2);
-+EXPORT_SYMBOL(__udivdi3);
-+EXPORT_SYMBOL(__umoddi3);
-+EXPORT_SYMBOL(__udivmoddi4);
-+EXPORT_SYMBOL(__udivsi3);
-+EXPORT_SYMBOL(__umodsi3);
-+
-+/* syscalls */
-+EXPORT_SYMBOL(sys_write);
-+EXPORT_SYMBOL(sys_lseek);
-+EXPORT_SYMBOL(sys_exit);
-+EXPORT_SYMBOL(sys_wait4);
-+
-+/* cache handling */
-+
-+EXPORT_SYMBOL(cpu_icache_inval_all);
-+EXPORT_SYMBOL(cpu_dcache_wbinval_all);
-+EXPORT_SYMBOL(cpu_dma_inval_range);
-+EXPORT_SYMBOL(cpu_dma_wb_range);
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/proc.c linux-3.4.113/arch/nds32/kernel/proc.c
---- linux-3.4.113.orig/arch/nds32/kernel/proc.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/proc.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,81 @@
-+/*
-+ * linux/arch/nds32/kernel/setup.c
-+ *
-+ * Copyright (C) 1995-2001 Russell King
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+/* ============================================================================
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for Andes NDS32 architecture.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.05.2007 Initial ported by Tom, revised and patched for KGDB
-+ * by Harry.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+
-+#include <asm/procinfo.h>
-+
-+struct proc_info_item info_item = {
-+ "AndesCore",
-+#ifndef CONFIG_CPU_ICACHE_DISABLE
-+ "I"
-+#endif
-+#ifndef CONFIG_CPU_DCACHE_DISABLE
-+ "D"
-+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ "(wt)"
-+#else
-+ "(wb)"
-+#endif
-+#endif
-+};
-+
-+struct proc_info_list n10_proc_info
-+ __attribute__ ((section(".proc.info.init"))) = {
-+.cpu_val = 0x0a000000,.cpu_mask = 0xff000000,.arch_name =
-+ "NDS32 N10",.elf_name = "NDS32 ELF",.elf_hwcap = 0,.info =
-+ &info_item,};
-+
-+struct proc_info_list n12_proc_info
-+ __attribute__ ((section(".proc.info.init"))) = {
-+.cpu_val = 0x0c000000,.cpu_mask = 0xff000000,.arch_name =
-+ "NDS32 N12",.elf_name = "NDS32 ELF",.elf_hwcap = 0,.info =
-+ &info_item,};
-+
-+struct proc_info_list n13_proc_info
-+ __attribute__ ((section(".proc.info.init"))) = {
-+.cpu_val = 0x0d000000,.cpu_mask = 0xff000000,.arch_name =
-+ "NDS32 N13",.elf_name = "NDS32 ELF",.elf_hwcap = 0,.info =
-+ &info_item,};
-+
-+struct proc_info_list n968_proc_info
-+ __attribute__ ((section(".proc.info.init"))) = {
-+.cpu_val = 0x19000000,.cpu_mask = 0xff000000,.arch_name =
-+ "NDS32 N968",.elf_name = "NDS32 ELF",.elf_hwcap = 0,.info =
-+ &info_item,};
-+
-+struct proc_info_list n1068_proc_info
-+ __attribute__ ((section(".proc.info.init"))) = {
-+.cpu_val = 0x1a000000,.cpu_mask = 0xff000000,.arch_name =
-+ "NDS32 N1068",.elf_name = "NDS32 ELF",.elf_hwcap = 0,.info =
-+ &info_item,};
-+
-+// the last one (a roust way to do so)
-+struct proc_info_list nXX_proc_info
-+ __attribute__ ((section(".proc.info.init"))) = {
-+.cpu_val = 0x00000000,.cpu_mask = 0x00000000,.arch_name =
-+ "NDS32 N??",.elf_name = "NDS32 ELF",.elf_hwcap = 0,.info =
-+ &info_item,};
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/process.c linux-3.4.113/arch/nds32/kernel/process.c
---- linux-3.4.113.orig/arch/nds32/kernel/process.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/process.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,630 @@
-+/*
-+ * linux/arch/nds32/kernel/process.c
-+ */
-+/* Copyright (C) 1996-2000 Russell King - Converted to ARM.
-+ * Original Copyright (C) 1995 Linus Torvalds
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+/* ============================================================================
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is process implementation for NDS32 architecture, and it
-+ * is original referred from ARM.
-+ *
-+ * Revision History:
-+ *
-+ * Oct.02.2007 Initial ported by Tom, Shawn, Steven, and Harry.
-+ * Oct.03.2007 Updated get_wchan() for info under /proc.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#include <linux/module.h>
-+#include <linux/sched.h>
-+#include <linux/delay.h>
-+#include <linux/kallsyms.h>
-+#include <asm/hardware.h>
-+#include <asm/leds.h>
-+#include <asm/uaccess.h>
-+#include <asm/elf.h>
-+#include <asm/fpu.h>
-+#include <asm/audio.h>
-+#include <linux/elf.h>
-+#include <linux/tick.h>
-+#include <linux/proc_fs.h>
-+
-+extern const char *processor_modes[];
-+extern void setup_mm_for_reboot(char mode);
-+extern struct task_struct *_switch(struct task_struct *last,
-+ struct thread_info *prev,
-+ struct thread_info *next);
-+
-+#ifndef CONFIG_UNLAZY_FPU
-+struct task_struct *last_task_used_math = NULL;
-+#endif
-+#ifndef CONFIG_UNLAZY_AUDIO
-+struct task_struct *last_task_used_audio = NULL;
-+#endif
-+static volatile int hlt_counter;
-+
-+#ifdef CONFIG_PROC_FS
-+struct proc_dir_entry *proc_dir_cpu;
-+EXPORT_SYMBOL(proc_dir_cpu);
-+#endif
-+
-+extern inline void arch_reset(char mode)
-+{
-+ if (mode == 's') {
-+ /* Use cpu handler, jump to 0 */
-+ cpu_reset(0);
-+ } else {
-+ /*
-+ * Suppose there should be HW function.
-+ * Here we used one tick watchdog as a trick.
-+ * It is not very good idea in the view of SoC
-+ * design, but smart in firmware functionality.
-+ * Harry@Jan,08.2008
-+ */
-+ REG32(WDT_FTWDT010_0_VA_BASE + 0x0C) = 0; // WdCR
-+ REG32(WDT_FTWDT010_0_VA_BASE + 0x04) = 1; // WdLoad
-+ REG32(WDT_FTWDT010_0_VA_BASE + 0x08) = 0x5AB9; // WdRestart
-+ REG32(WDT_FTWDT010_0_VA_BASE + 0x0C) = 0x13; // Go...
-+ }
-+}
-+
-+#ifndef arch_idle
-+static inline void arch_idle(void)
-+{
-+ cpu_do_idle();
-+}
-+#endif
-+
-+void disable_hlt(void)
-+{
-+ hlt_counter++;
-+}
-+
-+EXPORT_SYMBOL(disable_hlt);
-+
-+void enable_hlt(void)
-+{
-+ hlt_counter--;
-+}
-+
-+EXPORT_SYMBOL(enable_hlt);
-+
-+static int __init nohlt_setup(char *__unused)
-+{
-+ hlt_counter = 1;
-+ return 1;
-+}
-+
-+static int __init hlt_setup(char *__unused)
-+{
-+ hlt_counter = 0;
-+ return 1;
-+}
-+
-+__setup("nohlt", nohlt_setup);
-+__setup("hlt", hlt_setup);
-+
-+/*
-+ * The following aren't currently used.
-+ */
-+
-+void (*pm_idle) (void) = NULL;
-+EXPORT_SYMBOL(pm_idle);
-+
-+void (*pm_power_off) (void);
-+EXPORT_SYMBOL(pm_power_off);
-+
-+/*
-+ * This is our default idle handler. We need to disable
-+ * interrupts here to ensure we don't miss a wakeup call.
-+ */
-+void default_idle(void)
-+{
-+ local_irq_disable();
-+ if (!need_resched() && !hlt_counter)
-+ arch_idle();
-+ local_irq_enable();
-+}
-+
-+/*
-+ * The idle thread. We try to conserve power, while trying to keep
-+ * overall latency low. The architecture specific idle is passed
-+ * a value to indicate the level of "idleness" of the system.
-+ */
-+void cpu_idle(void)
-+{
-+
-+ /* endless idle loop with no priority at all */
-+ while (1) {
-+ void (*idle) (void) = pm_idle;
-+
-+ if (!idle)
-+ idle = default_idle;
-+ tick_nohz_idle_enter();
-+ leds_event(led_idle_start);
-+ while (!need_resched())
-+ idle();
-+ leds_event(led_idle_end);
-+ tick_nohz_idle_exit();
-+ preempt_enable_no_resched();
-+ schedule();
-+ preempt_disable();
-+ }
-+}
-+
-+static char reboot_mode = 'h';
-+
-+int __init reboot_setup(char *str)
-+{
-+ reboot_mode = str[0];
-+ return 1;
-+}
-+
-+#ifdef CONFIG_PLAT_AG102
-+static int cpub_pwroff(void)
-+{
-+ //PCU_SET_REG(PCS9_PARA,
-+ // PCU_PREPARE(PCS9_PARA, IE, 0x0) |
-+ // PCU_PREPARE(PCS9_PARA, CMD, PCS_CMD_SCALING) |
-+ // PCU_PREPARE(PCS9_PARA, SYNC, PCS_SYNC_SRC) |
-+ // PCU_PREPARE(PCS9_PARA, NXTPAR, 0x1b) // turn off cpub power
-+ //);
-+ //printk("cpub Power off: ok!!!OKOKOK\n");
-+ //REG32(PCU_VA_BASE + 0x1A4) = (0x0000001B & 0x00FFFFFF)| ((0x2 << 24) & 0x0F000000) | ((0x1 << 28) & 0x70000000) | 0x00000000;
-+ //__asm__ volatile ("standby wait_done\n");
-+ //PCU_SET_REG(PCS9_ST1, 0x0); // clear status
-+ //REG32(PCU_VA_BASE + 0x1A8) = 0x0;
-+
-+ //par = PCS_POWER_CPUB;
-+ //PCU_SET_REG(PCS9_PARA,
-+ //PCU_PREPARE(PCS9_PARA, IE, 0x1) |
-+ //PCU_PREPARE(PCS9_PARA, CMD, PCS_CMD_PW_DOWN) |
-+ //PCU_PREPARE(PCS9_PARA, SYNC, PCS_SYNC_SRC) |
-+ //PCU_PREPARE(PCS9_PARA, NXTPAR, 0x6) // turn off all power
-+
-+ //printk("cpua Power off: ok!!!YAYAYA\n");
-+ //printk("The value = 0x%08x\n", (0x00000006 & 0x00FFFFFF)| ((0x1 << 24) & 0x0F000000) | ((0x2 << 28) & 0x70000000) | 0x80000000);
-+ REG32(PCU_VA_BASE + 0x1A4) =
-+ (0x00000006 & 0x00FFFFFF) | ((0x1 << 24) & 0x0F000000) |
-+ ((0x2 << 28) & 0x70000000) | 0x80000000;
-+ __asm__ volatile ("standby wake_grant\n");
-+ return (0);
-+}
-+#else
-+static int cpub_pwroff(void)
-+{
-+ return 0;
-+}
-+
-+#endif
-+
-+__setup("reboot=", reboot_setup);
-+
-+void machine_halt(void)
-+{
-+ //ADD by river 2011.04.14
-+ cpub_pwroff();
-+}
-+
-+EXPORT_SYMBOL(machine_halt);
-+
-+void machine_power_off(void)
-+{
-+ if (pm_power_off)
-+ pm_power_off();
-+}
-+
-+EXPORT_SYMBOL(machine_power_off);
-+
-+void machine_restart(char *__unused)
-+{
-+ /*
-+ * Clean and disable cache, and turn off interrupts
-+ */
-+ cpu_proc_fin();
-+
-+ /*
-+ * Tell the mm system that we are going to reboot -
-+ * we may need it to insert some 1:1 mappings so that
-+ * soft boot works.
-+ */
-+ setup_mm_for_reboot(reboot_mode);
-+
-+ /*
-+ * Now call the architecture specific reboot code.
-+ */
-+ arch_reset(reboot_mode);
-+
-+ /*
-+ * Whoops - the architecture was unable to reboot.
-+ * Tell the user!
-+ */
-+ mdelay(1000);
-+ printk("Reboot failed -- System halted\n");
-+ while (1) ;
-+}
-+
-+EXPORT_SYMBOL(machine_restart);
-+
-+void show_regs(struct pt_regs *regs)
-+{
-+ print_symbol("PC is at %s\n", instruction_pointer(regs));
-+ print_symbol("LR is at %s\n", regs->NDS32_lp);
-+ printk("pc : [<%08lx>] lp : [<%08lx>] %s\n"
-+ "sp : %08lx fp : %08lx gp : %08lx\n",
-+ instruction_pointer(regs),
-+ regs->NDS32_lp, print_tainted(), regs->NDS32_sp,
-+ regs->NDS32_fp, regs->NDS32_gp);
-+ printk("r25: %08lx r24 : %08lx\n", regs->NDS32_r25, regs->NDS32_r24);
-+
-+ printk("r23: %08lx r22: %08lx r21: %08lx r20: %08lx\n",
-+ regs->NDS32_r23, regs->NDS32_r22,
-+ regs->NDS32_r21, regs->NDS32_r20);
-+ printk("r19: %08lx r18: %08lx r17: %08lx r16: %08lx\n",
-+ regs->NDS32_r19, regs->NDS32_r18,
-+ regs->NDS32_r17, regs->NDS32_r16);
-+ printk("r15: %08lx r14: %08lx r13: %08lx r12: %08lx\n",
-+ regs->NDS32_r15, regs->NDS32_r14,
-+ regs->NDS32_r13, regs->NDS32_r12);
-+ printk("r11: %08lx r10: %08lx r9 : %08lx r8 : %08lx\n",
-+ regs->NDS32_r11, regs->NDS32_r10,
-+ regs->NDS32_r9, regs->NDS32_r8);
-+ printk("r7 : %08lx r6 : %08lx r5 : %08lx r4 : %08lx\n",
-+ regs->NDS32_r7, regs->NDS32_r6, regs->NDS32_r5, regs->NDS32_r4);
-+ printk("r3 : %08lx r2 : %08lx r1 : %08lx r0 : %08lx\n",
-+ regs->NDS32_r3, regs->NDS32_r2, regs->NDS32_r1, regs->NDS32_r0);
-+ printk(" IRQs o%s Segment %s\n",
-+ interrupts_enabled(regs) ? "n" : "ff",
-+ segment_eq(get_fs(), get_ds())? "kernel" : "user");
-+}
-+
-+void show_fpregs(struct user_fp *regs)
-+{
-+ int i;
-+
-+ for (i = 0; i < 8; i++) {
-+ unsigned long *p;
-+ char type;
-+
-+ p = (unsigned long *)(regs->fpregs + i);
-+
-+ switch (regs->ftype[i]) {
-+ case 1:
-+ type = 'f';
-+ break;
-+ case 2:
-+ type = 'd';
-+ break;
-+ case 3:
-+ type = 'e';
-+ break;
-+ default:
-+ type = '?';
-+ break;
-+ }
-+ if (regs->init_flag)
-+ type = '?';
-+
-+ printk(" f%d(%c): %08lx %08lx %08lx%c",
-+ i, type, p[0], p[1], p[2], i & 1 ? '\n' : ' ');
-+ }
-+
-+ printk("FPSR: %08lx FPCR: %08lx\n",
-+ (unsigned long)regs->fpsr, (unsigned long)regs->fpcr);
-+}
-+
-+/*
-+ * Task structure and kernel stack allocation.
-+ */
-+static unsigned long *thread_info_head;
-+static unsigned int nr_thread_info;
-+
-+#define EXTRA_TASK_STRUCT 4
-+#define ll_alloc_task_struct() ((struct thread_info *) __get_free_pages(GFP_KERNEL,1))
-+#define ll_free_task_struct(p) free_pages((unsigned long)(p),1)
-+
-+struct thread_info *alloc_thread_info(struct task_struct *task)
-+{
-+ struct thread_info *thread = NULL;
-+
-+ if (EXTRA_TASK_STRUCT) {
-+ unsigned long *p = thread_info_head;
-+
-+ if (p) {
-+ thread_info_head = (unsigned long *)p[0];
-+ nr_thread_info -= 1;
-+ }
-+ thread = (struct thread_info *)p;
-+ }
-+
-+ if (!thread)
-+ thread = ll_alloc_task_struct();
-+
-+#ifdef CONFIG_MAGIC_SYSRQ
-+ /*
-+ * The stack must be cleared if you want SYSRQ-T to
-+ * give sensible stack usage information
-+ */
-+ if (thread) {
-+ char *p = (char *)thread;
-+ memzero(p + KERNEL_STACK_SIZE, KERNEL_STACK_SIZE);
-+ }
-+#endif
-+ return thread;
-+}
-+
-+void free_thread_info(struct thread_info *thread)
-+{
-+ if (EXTRA_TASK_STRUCT && nr_thread_info < EXTRA_TASK_STRUCT) {
-+ unsigned long *p = (unsigned long *)thread;
-+ p[0] = (unsigned long)thread_info_head;
-+ thread_info_head = p;
-+ nr_thread_info += 1;
-+ } else
-+ ll_free_task_struct(thread);
-+}
-+
-+/*
-+ * Free current thread data structures etc..
-+ */
-+void exit_thread(void)
-+{
-+#if defined(CONFIG_FPU)
-+# ifndef CONFIG_UNLAZY_FPU
-+ if (last_task_used_math == current) {
-+ last_task_used_math = NULL;
-+ }
-+# endif
-+#endif
-+#if defined(CONFIG_AUDIO)
-+# ifndef CONFIG_UNLAZY_AUDIO
-+ if (last_task_used_audio == current) {
-+ last_task_used_audio = NULL;
-+ }
-+# endif
-+#endif
-+}
-+
-+void flush_thread(void)
-+{
-+ struct task_struct *tsk = current;
-+
-+ memset(&tsk->thread.debug, 0, sizeof(struct debug_info));
-+#if defined(CONFIG_FPU)
-+ clear_fpu(task_pt_regs(tsk));
-+ clear_used_math();
-+# ifndef CONFIG_UNLAZY_FPU
-+ if (last_task_used_math == current) {
-+ last_task_used_math = NULL;
-+ }
-+# endif
-+#endif
-+
-+#if defined(CONFIG_AUDIO)
-+ clear_audio(task_pt_regs(tsk));
-+ clear_tsk_thread_flag(tsk, TIF_USEDAUDIO);
-+# ifndef CONFIG_UNLAZY_AUDIO
-+ if (last_task_used_audio == current) {
-+ last_task_used_audio = NULL;
-+ }
-+# endif
-+#endif
-+
-+}
-+
-+void release_thread(struct task_struct *dead_task)
-+{
-+}
-+
-+asmlinkage void ret_from_fork(void) __asm__("ret_from_fork");
-+
-+/*
-+ * Shuffle the argument into the correct register before calling the
-+ * thread function. $r1 is the thread argument, $r2 is the pointer to
-+ * the thread function, and $r3 points to the exit function.
-+ */
-+extern void kernel_thread_helper(void);
-+asm(".section .text\n"
-+ " .align\n"
-+ " .type kernel_thread_helper, #function\n"
-+ "kernel_thread_helper:\n"
-+ " move $r2, $lp\n"
-+ " move $r0, $r1\n"
-+ " move $lp, $r3\n"
-+ " jr $r2 \n"
-+ " .size kernel_thread_helper, . - kernel_thread_helper\n"
-+ " .previous");
-+
-+pid_t kernel_thread(int (*fn) (void *), void *arg, unsigned long flags)
-+{
-+ struct pt_regs regs;
-+
-+ memset(&regs, 0, sizeof(regs));
-+
-+ regs.NDS32_r1 = (unsigned long)arg;
-+ regs.NDS32_r2 = (unsigned long)fn;
-+ /* to apply right path */
-+ regs.NDS32_lp = regs.NDS32_r2;
-+ regs.NDS32_r3 = (unsigned long)do_exit;
-+ regs.NDS32_ipc = (unsigned long)kernel_thread_helper;
-+
-+#ifdef __NDS32_EB__
-+#define PSW_DE PSW_mskBE
-+#else
-+#define PSW_DE 0x0
-+#endif
-+
-+#ifdef CONFIG_WBNA
-+#define PSW_valWBNA PSW_mskWBNA
-+#else
-+#define PSW_valWBNA 0x0
-+#endif
-+
-+ regs.NDS32_ipsw =
-+ (PSW_CPL_ANY | PSW_valWBNA | PSW_mskDT | PSW_mskIT | PSW_DE |
-+ PSW_SYSTEM | PSW_INTL_1 | PSW_mskGIE);
-+ regs.NDS32_ir0 =
-+ (PSW_CPL_ANY | PSW_valWBNA | PSW_mskDT | PSW_mskIT | PSW_DE |
-+ PSW_SYSTEM | PSW_INTL_1);
-+
-+ return do_fork(flags | CLONE_VM | CLONE_UNTRACED, 0, &regs, 0, NULL,
-+ NULL);
-+}
-+
-+EXPORT_SYMBOL(kernel_thread);
-+
-+int
-+copy_thread(unsigned long clone_flags, unsigned long stack_start,
-+ unsigned long stk_sz, struct task_struct *p, struct pt_regs *regs)
-+{
-+ struct thread_info *thread = task_thread_info(p);
-+ struct pt_regs *childregs;
-+
-+ childregs =
-+ ((struct pt_regs *)((unsigned long)thread + THREAD_SIZE - 8)) - 1;
-+
-+ *childregs = *regs;
-+ childregs->NDS32_r0 = 0; /* child get zero as ret. */
-+ childregs->NDS32_sp = stack_start;
-+ childregs->NDS32_osp = 0;
-+
-+ thread->sp_save = ((struct cpu_context_save *)(childregs)) - 1;
-+ /* cpu context switching */
-+ thread->sp_save->pc = (unsigned long)ret_from_fork;
-+ if (clone_flags & CLONE_SETTLS)
-+ childregs->NDS32_r25 = regs->NDS32_r3;
-+
-+#ifdef CONFIG_FPU
-+ if (used_math()) {
-+# ifdef CONFIG_UNLAZY_FPU
-+ unlazy_fpu(current);
-+# else
-+ preempt_disable();
-+ if (last_task_used_math == current)
-+ save_fpu(current);
-+ preempt_enable();
-+# endif
-+ p->thread.fpu = current->thread.fpu;
-+ clear_fpu(task_pt_regs(p));
-+ set_stopped_child_used_math(p);
-+ }
-+#endif
-+
-+#ifdef CONFIG_AUDIO
-+ if (test_tsk_thread_flag(current, TIF_USEDAUDIO)) {
-+# ifdef CONFIG_UNLAZY_AUDIO
-+ unlazy_audio(current);
-+# else
-+ preempt_disable();
-+ if (last_task_used_audio == current)
-+ save_audio(current);
-+ preempt_enable();
-+# endif
-+ p->thread.audio = current->thread.audio;
-+ clear_audio(childregs);
-+ set_tsk_thread_flag(p, TIF_USEDAUDIO);
-+ }
-+#endif
-+
-+#ifdef CONFIG_HWZOL
-+ childregs->NDS32_lb = 0;
-+ childregs->NDS32_le = 0;
-+ childregs->NDS32_lc = 0;
-+#endif
-+
-+ return 0;
-+}
-+
-+struct task_struct *__switch_to(struct task_struct *last,
-+ struct thread_info *prev,
-+ struct thread_info *next)
-+{
-+#if defined(CONFIG_FPU) || defined(CONFIG_AUDIO)
-+# ifdef CONFIG_UNLAZY_FPU
-+ unlazy_fpu(prev->task);
-+# endif
-+# ifdef CONFIG_UNLAZY_AUDIO
-+ unlazy_audio(prev->task);
-+# endif
-+ if (!(next->task->flags & PF_KTHREAD)) {
-+#ifdef CONFIG_FPU
-+ clear_fpu(task_pt_regs(next->task));
-+#endif
-+#ifdef CONFIG_AUDIO
-+ clear_audio(task_pt_regs(next->task));
-+#endif
-+ }
-+#endif
-+ return _switch(last, prev, next);
-+}
-+
-+/*
-+ * fill in the fpe structure for a core dump...
-+ */
-+int dump_fpu(struct pt_regs *regs, elf_fpregset_t * fpu)
-+{
-+ int fpvalid = 0;
-+
-+#if 0 // XXX defined(CONFIG_FPU)
-+ struct task_struct *tsk = current;
-+
-+ fpvalid = !!tsk_used_math(tsk);
-+ if (fpvalid) {
-+ unlazy_fpu(tsk, regs);
-+ memcpy(fpu, &tsk->thread.fpu, sizeof(*fpu));
-+ }
-+#endif
-+
-+ return fpvalid;
-+}
-+
-+EXPORT_SYMBOL(dump_fpu);
-+
-+unsigned long get_wchan(struct task_struct *p)
-+{
-+ unsigned long fp, lr;
-+ unsigned long stack_start, stack_end;
-+ int count = 0;
-+
-+ if (!p || p == current || p->state == TASK_RUNNING)
-+ return 0;
-+
-+#ifdef CONFIG_FRAME_POINTER
-+ stack_start = (unsigned long)end_of_stack(p);
-+ stack_end = (unsigned long)task_stack_page(p) + THREAD_SIZE;
-+
-+ fp = thread_saved_fp(p);
-+ do {
-+ if (fp < stack_start || fp > stack_end)
-+ return 0;
-+ lr = ((unsigned long *)fp)[0];
-+ if (!in_sched_functions(lr))
-+ return lr;
-+ fp = *(unsigned long *)(fp + 4);
-+ } while (count++ < 16);
-+ return 0;
-+#else
-+ return 0;
-+#endif
-+}
-+
-+EXPORT_SYMBOL(get_wchan);
-+
-+extern int do_elf_check_arch(const struct elf32_hdr *hdr);
-+
-+int elf_check_arch(const struct elf32_hdr *hdr)
-+{
-+ return do_elf_check_arch(hdr);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/ptrace.c linux-3.4.113/arch/nds32/kernel/ptrace.c
---- linux-3.4.113.orig/arch/nds32/kernel/ptrace.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/ptrace.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,919 @@
-+/*
-+ * linux/arch/nds32/kernel/ptrace.c
-+ */
-+/* By Ross Biro 1/23/92
-+ * edited by Linus Torvalds
-+ * ARM modifications Copyright (C) 2000 Russell King
-+ * NDS32 modifications Copyright (C) 2007 Harry Pan
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+/* ============================================================================
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for Andes NDS32 architecture.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.31.2007 Initial ported by Tom, Shawn, and Steven,
-+ * revised by Harry.
-+ * Current implmentation is based on Andes Instruction
-+ * Set Architecture Specification (AS-0001-0001)
-+ * version:3.7 date:7-20-2007.
-+ * It is original taken from ARM, then fit to NDS32.
-+ * Aug.15.2007 Mainly updated breakpoint handling base on NDS32 ISA.
-+ * I also did code revise.
-+ * Nov.14.2007 Fixed up ptrace_set_bpt() while handling 16-bit insn.
-+ * Nov.27.2007 Added checking duplicate breakpoints in
-+ * add_breakpoint(), based on Shawn's idea.
-+ * Dec.06.2007 Added get_user_gpr().
-+ * Apr.17.2009 Added support for FPU and Audio regs.
-+ * Added support for PTRACE_GETFPREGS, PTRACE_SETFPREGS,
-+ * PTRACE_GETAUREGS, PTRACE_SETAUREGS
-+ *
-+ * Note:
-+ *
-+ * Current layout: 0-31 GR, 32-34 SPR, 35-... SR, index start from zero.
-+ *
-+ * +----------+-----+--------------+---+--------+
-+ * | GR | SPR | SR |...| Audio |
-+ * +----------+-----+--------------+---+--------+
-+ * 0 32 35 ...500 531
-+ *
-+ * ============================================================================
-+ */
-+#include <linux/kernel.h>
-+#include <linux/sched.h>
-+#include <linux/mm.h>
-+#include <linux/smp.h>
-+#include <linux/ptrace.h>
-+#include <linux/user.h>
-+#include <linux/security.h>
-+#include <linux/init.h>
-+
-+#include <asm/uaccess.h>
-+#include <asm/pgtable.h>
-+#include <asm/system.h>
-+#include <asm/traps.h>
-+#include <asm/fpu.h>
-+#include <asm/audio.h>
-+
-+#include "ptrace.h"
-+
-+#ifdef __NDS32_EL__
-+#define BREAKINST 0x01EA
-+#else
-+#define BREAKINST 0xEA01
-+#endif
-+
-+/* get_user_reg()
-+ *
-+ * This routine will get a word off of the processes privileged stack.
-+ * the offset is how far from the base addr as stored in the THREAD.
-+ * this routine assumes that all the privileged stacks are in our
-+ * data space.
-+ */
-+static inline unsigned int get_user_reg(struct task_struct *task, int offset)
-+{
-+ return task_pt_regs(task)->uregs[offset];
-+}
-+
-+#if !defined(CONFIG_HSS)
-+/* get_user_gpr()
-+ *
-+ */
-+static unsigned int get_user_gpr(struct task_struct *task, int idx)
-+{
-+ unsigned int ret;
-+
-+ if (idx < 26) // r0 to r25
-+ ret = get_user_reg(task, idx + 13);
-+ else if (idx == 26 || idx == 27) // p0, p1
-+ ret = get_user_reg(task, idx - 26 + 7);
-+ else if (idx > 27 && idx < 31) // fp, gp, lp
-+ ret = get_user_reg(task, idx + 11);
-+ else if (idx == 31) // sp
-+ ret = get_user_reg(task, 3);
-+ else
-+ ret = 0;
-+
-+ return ret;
-+}
-+#endif
-+
-+/* put_user_reg()
-+ *
-+ * this routine will put a word on the processes privileged stack.
-+ * the offset is how far from the base addr as stored in the THREAD.
-+ * this routine assumes that all the privileged stacks are in our
-+ * data space.
-+ */
-+static inline int put_user_reg(struct task_struct *task, int offset, long data)
-+{
-+ struct pt_regs newregs, *regs = task_pt_regs(task);
-+ int ret = -EINVAL;
-+
-+ newregs = *regs;
-+ newregs.uregs[offset] = data;
-+
-+ if (valid_user_regs(&newregs)) {
-+ regs->uregs[offset] = data;
-+ ret = 0;
-+ }
-+
-+ return ret;
-+}
-+
-+#if !defined(CONFIG_HSS)
-+/*
-+ * Read instruction.
-+ */
-+static inline int
-+read_insn(struct task_struct *task, unsigned long addr, u32 * res)
-+{
-+ int ret;
-+ *res = 0;
-+ ret = access_process_vm(task, addr, res, 2, 0);
-+ if (ret != 2)
-+ return 0;
-+#ifdef __NDS32_EL__
-+ *res = swab16(*res);
-+#endif
-+ if ((*res) & 0x8000)
-+ return 2;
-+
-+ ret = access_process_vm(task, addr, res, 4, 0);
-+ if (ret != 4)
-+ return 0;
-+#ifdef __NDS32_EL__
-+ *res = swab32(*res);
-+#endif
-+ return 4;
-+}
-+
-+/* get_branch_address()
-+ *
-+ * Decode branch instructions and destination.
-+ */
-+static unsigned long
-+get_branch_address(struct task_struct *child,
-+ unsigned long pc, unsigned long insn, unsigned int size)
-+{
-+ unsigned int tpc = 0;
-+
-+ /*
-+ * TODO: COLE
-+ * would it be simpler if we use two BREAKs,
-+ * one for take, one for not
-+ */
-+
-+ if (size == 4) {
-+ /* 32-bit instruction */
-+ if ((insn & 0x7e000000) == 0x4c000000) // BR1
-+ {
-+ int cond, imm14s;
-+ unsigned int rt, ra;
-+
-+ rt = (insn >> 20) & 0x1f;
-+ ra = (insn >> 15) & 0x1f;
-+ cond = (insn >> 14) & 0x01;
-+ imm14s = insn & 0x00003fff;
-+
-+ if (imm14s & 0x00002000) // sign extend
-+ imm14s -= (0x00002000 << 1);
-+
-+ rt = get_user_gpr(child, rt);
-+ ra = get_user_gpr(child, ra);
-+
-+ if (((cond == 1) && (rt != ra)) || // bne
-+ ((cond == 0) && (rt == ra))) // beq
-+ tpc = pc + (imm14s << 1);
-+ } else if ((insn & 0x7e000000) == 0x4e000000) // BR2
-+ {
-+ int cond, imm16s, taken = 0;
-+ int rt;
-+
-+ rt = (insn >> 20) & 0x1f;
-+ cond = (insn >> 16) & 0x0f;
-+ imm16s = insn & 0x0000ffff;
-+
-+ if (imm16s & 0x00008000) // sign extend
-+ imm16s -= (0x00008000 << 1);
-+
-+ rt = get_user_gpr(child, rt);
-+
-+ switch (cond) {
-+ case 0x02: // beqz
-+ if (rt == 0)
-+ taken = 1;
-+ break;
-+ case 0x03: // bnez
-+ if (rt != 0)
-+ taken = 1;
-+ break;
-+ case 0x06: // bgtz
-+ if (rt > 0)
-+ taken = 1;
-+ break;
-+ case 0x07: // blez
-+ if (rt <= 0)
-+ taken = 1;
-+ break;
-+ case 0x04: // bgez
-+ case 0x0c: // bgezal
-+ if (rt >= 0)
-+ taken = 1;
-+ break;
-+ case 0x05: // bltz
-+ case 0x0d: // bltzal
-+ if (rt < 0)
-+ taken = 1;
-+ break;
-+ default:
-+ printk(KERN_WARNING
-+ "ptrace: unknown conditional branch.\n");
-+ break;
-+ }
-+
-+ if (taken)
-+ tpc = pc + (imm16s << 1);
-+ } else if ((insn & 0x7e000000) == 0x48000000) // JI
-+ {
-+ int imm24s;
-+
-+ imm24s = insn & 0x00ffffff;
-+
-+ if (imm24s & 0x00800000) // sign extend
-+ imm24s -= (0x00800000 << 1);
-+
-+ tpc = pc + (imm24s << 1);
-+ } else if ((insn & 0x7e000000) == 0x4a000000) // JREG
-+ {
-+ unsigned int rb = (insn >> 10) & 0x1f;
-+
-+ tpc = get_user_gpr(child, rb);
-+ }
-+
-+ } else {
-+ /* 16-bit instruction */
-+
-+ if ((insn & 0xf800) == 0xc000) // beqz38
-+ {
-+ unsigned int rt3;
-+
-+ rt3 = (insn >> 8) & 0x07;
-+
-+ rt3 = get_user_gpr(child, rt3);
-+
-+ if (rt3 == 0) {
-+ int imm8s;
-+
-+ imm8s = insn & 0x00ff;
-+
-+ if (imm8s & 0x0080) // sign extend
-+ imm8s -= (0x0080 << 1);
-+
-+ tpc = pc + (imm8s << 1);
-+ }
-+ }
-+
-+ if ((insn & 0xf800) == 0xc800) // bnez38
-+ {
-+ unsigned int rt3;
-+
-+ rt3 = (insn >> 8) & 0x07;
-+
-+ rt3 = get_user_gpr(child, rt3);
-+
-+ if (rt3 != 0) {
-+ int imm8s;
-+
-+ imm8s = insn & 0x00ff;
-+
-+ if (imm8s & 0x0080) // sign extend
-+ imm8s -= (0x0080 << 1);
-+
-+ tpc = pc + (imm8s << 1);
-+ }
-+ }
-+
-+ if ((insn & 0xf800) == 0xd000) // beqs38, j8
-+ {
-+ unsigned int rt3, r5;
-+
-+ rt3 = (insn >> 8) & 0x07;
-+
-+ rt3 = get_user_gpr(child, rt3);
-+ r5 = get_user_gpr(child, 5);
-+
-+ if (r5 == rt3) {
-+ int imm8s;
-+ imm8s = insn & 0x00ff;
-+
-+ if (imm8s & 0x0080) // sign extend
-+ imm8s -= (0x0080 << 1);
-+
-+ tpc = pc + (imm8s << 1);
-+ }
-+ }
-+
-+ if ((insn & 0xf800) == 0xd800) // bnes38
-+ {
-+ unsigned int rt3, r5;
-+
-+ rt3 = (insn >> 8) & 0x07;
-+
-+ r5 = get_user_gpr(child, 5);
-+ rt3 = get_user_gpr(child, rt3);
-+
-+ if (r5 != rt3) {
-+ int imm8s;
-+
-+ imm8s = insn & 0x00ff;
-+
-+ if (imm8s & 0x0080) // sign extend
-+ imm8s -= (0x0080 << 1);
-+
-+ tpc = pc + (imm8s << 1);
-+ }
-+ }
-+
-+ if ((insn & 0xffe0) == 0xdd00 || // jr5
-+ (insn & 0xffe0) == 0xdd80 || // ret5
-+ (insn & 0xffe0) == 0xdd20) // jral5
-+ {
-+ unsigned int rb5;
-+
-+ rb5 = insn & 0x1f;
-+
-+ tpc = get_user_gpr(child, rb5);
-+ }
-+
-+ if ((insn & 0xfe00) == 0xe800) {
-+ int taken = 0;
-+ unsigned int r15;
-+
-+ r15 = get_user_gpr(child, 15);
-+
-+ if (insn & 0x0100) // bnezs8
-+ {
-+ if (r15 != 0)
-+ taken = 1;
-+ } else // beqzs8
-+ {
-+ if (r15 == 0)
-+ taken = 1;
-+ }
-+
-+ if (taken) {
-+ int imm8s;
-+
-+ imm8s = insn & 0x00ff;
-+
-+ if (imm8s & 0x0080) // sign extend
-+ imm8s -= (0x0080 << 1);
-+
-+ tpc = pc + (imm8s << 1);
-+ }
-+ }
-+ }
-+
-+ return tpc;
-+}
-+
-+/*
-+ * Swap instructions in the user program.
-+ * swap in new_insn. save orignal value in old_insn
-+ * assume new_insn is 2-bytes long
-+ */
-+static int
-+swap_insn(struct task_struct *task, unsigned long addr,
-+ u16 * old_insn, u16 * new_insn)
-+{
-+ int ret;
-+
-+ ret = access_process_vm(task, addr, old_insn, 2, 0);
-+ if (ret == 2)
-+ ret = access_process_vm(task, addr, new_insn, 2, 1);
-+
-+ return ret;
-+}
-+
-+/*
-+ * Add one breakpoint in the user program.
-+ */
-+static void
-+add_breakpoint(struct task_struct *task, struct debug_info *dbg,
-+ unsigned long addr)
-+{
-+ u16 new_insn = BREAKINST;
-+ int res;
-+
-+ if (dbg->valid) {
-+ printk(KERN_ERR "ptrace: too many breakpoints\n");
-+ return;
-+ }
-+
-+ dbg->address = addr;
-+ res = swap_insn(task, addr, &dbg->insn, &new_insn);
-+ if (res == 2)
-+ dbg->valid = 1;
-+ if (!dbg->valid)
-+ printk(KERN_ERR "ptrace: fail to add breakpoint\n");
-+}
-+
-+/*
-+ * Clear one software breakpoint in the user program.
-+ */
-+static void clear_breakpoint(struct task_struct *task, struct debug_info *dbg)
-+{
-+ int ret;
-+ unsigned int addr = dbg->address;
-+ u16 old_insn;
-+
-+ if (!dbg->valid) {
-+ return;
-+ }
-+ dbg->valid = 0;
-+
-+ ret = swap_insn(task, addr, &old_insn, &dbg->insn);
-+
-+ if (ret != 2 || old_insn != BREAKINST) {
-+ printk(KERN_ERR "ptrace: %s:%d: corrupted NDS16 breakpoint at "
-+ "0x%08x (0x%04x)\n", task->comm, task->pid,
-+ addr, old_insn);
-+ }
-+}
-+
-+/*
-+ * ptrace_set_swbk
-+ * Set breakpoint in user program.
-+ */
-+void ptrace_set_swbk(struct task_struct *child)
-+{
-+ struct pt_regs *regs;
-+ unsigned long pc;
-+ unsigned int size;
-+ u32 insn;
-+
-+ /*
-+ * always clear before set,
-+ * since in some sepcial case, it may fail to hit
-+ */
-+ ptrace_cancel_swbk(child);
-+ regs = task_pt_regs(child);
-+ pc = instruction_pointer(regs);
-+ size = read_insn(child, pc, &insn);
-+
-+ printk(KERN_DEBUG " STEP.size=%d\n", size);
-+
-+ if (size > 0) {
-+ struct debug_info *dbg = &child->thread.debug;
-+ unsigned int tpc;
-+
-+ /* Predict next PC. */
-+ tpc = get_branch_address(child, pc, insn, size);
-+
-+ if (tpc) {
-+ printk(KERN_DEBUG " STEP.addr=0x%x\n", tpc);
-+ add_breakpoint(child, dbg, tpc);
-+ } else {
-+ if (size == 4) {
-+ printk(KERN_DEBUG " STEP.addr=0x%x\n",
-+ (unsigned int)(pc + 4));
-+ add_breakpoint(child, dbg, pc + 4);
-+ } else if (size == 2) {
-+ printk(KERN_DEBUG " STEP.addr=0x%x\n",
-+ (unsigned int)(pc + 2));
-+ add_breakpoint(child, dbg, pc + 2);
-+ } else {
-+ printk(KERN_ERR
-+ "ptrace: bad step address, pc + %d\n",
-+ size);
-+ }
-+ }
-+ }
-+}
-+
-+/*
-+ * Ensure no single-step breakpoint is pending. Returns non-zero
-+ * value if child was being single-stepped.
-+ */
-+void ptrace_cancel_swbk(struct task_struct *child)
-+{
-+ if (!child->thread.debug.valid) {
-+ return;
-+ }
-+
-+ clear_breakpoint(child, &child->thread.debug);
-+}
-+#endif /* end of !defined (CONFIG_HSS) */
-+
-+/*
-+ * Called by kernel/ptrace.c when detaching..
-+ *
-+ * Make sure the single step bit is not set.
-+ */
-+void ptrace_disable(struct task_struct *child)
-+{
-+ user_disable_single_step(child);
-+}
-+
-+/*
-+ * Handle hitting a breakpoint.
-+ */
-+void send_sigtrap(struct task_struct *tsk, struct pt_regs *regs,
-+ int error_code, int si_code)
-+{
-+ struct siginfo info;
-+
-+#if !defined (CONFIG_HSS)
-+ /* clear the swbk; otherwise the user will see it */
-+ ptrace_cancel_swbk(tsk);
-+#endif
-+
-+ tsk->thread.trap_no = 1;
-+ tsk->thread.error_code = error_code;
-+
-+ memset(&info, 0, sizeof(info));
-+ info.si_signo = SIGTRAP;
-+ info.si_code = si_code;
-+
-+ info.si_addr = (void __user *)instruction_pointer(regs);
-+
-+ /* Send us the fake SIGTRAP */
-+ force_sig_info(SIGTRAP, &info, tsk);
-+}
-+
-+/* ptrace_read_user()
-+ *
-+ * Read the word at offset "off" into the "struct user". We
-+ * actually access the pt_regs stored on the kernel stack.
-+ */
-+static int
-+ptrace_read_user(struct task_struct *tsk, unsigned long off,
-+ unsigned long __user * ret)
-+{
-+ unsigned long tmp = 0;
-+
-+ if (off < 500) {
-+ if (off & 3 || off >= sizeof(struct user))
-+ return -EIO;
-+
-+ if (off < sizeof(struct pt_regs))
-+ tmp = get_user_reg(tsk, off >> 2);
-+
-+ return put_user(tmp, ret);
-+ } else if (off < 532) {
-+#ifdef CONFIG_AUDIO
-+ off -= 500;
-+ if (test_tsk_thread_flag(tsk, TIF_USEDAUDIO)) {
-+#ifdef CONFIG_UNLAZY_AUDIO
-+ unlazy_audio(tsk);
-+#else
-+ preempt_disable();
-+ if (last_task_used_audio == tsk)
-+ save_audio(tsk);
-+ preempt_enable();
-+#endif
-+ tmp = tsk->thread.audio.auregs[off];
-+ }
-+#endif
-+ return put_user(tmp, ret);
-+ } else
-+ return -EIO;
-+}
-+
-+/* ptrace_write_user()
-+ *
-+ * Write the word at offset "off" into "struct user". We
-+ * actually access the pt_regs stored on the kernel stack.
-+ */
-+static int
-+ptrace_write_user(struct task_struct *tsk, unsigned long off, unsigned long val)
-+{
-+ if (off < 500) {
-+ if (off & 3 || off >= sizeof(struct user))
-+ return -EIO;
-+
-+ if (off >= sizeof(struct pt_regs))
-+ return 0;
-+
-+ return put_user_reg(tsk, off >> 2, val);
-+ } else if (off < 532) {
-+#ifdef CONFIG_AUDIO
-+ off -= 500;
-+ if (!test_tsk_thread_flag(tsk, TIF_USEDAUDIO)) {
-+ /* First time Audio user. */
-+ memset(&tsk->thread.audio, 0,
-+ sizeof(struct audio_struct));
-+ set_tsk_thread_flag(tsk, TIF_USEDAUDIO);
-+ } else {
-+#ifdef CONFIG_UNLAZY_AUDIO
-+ unlazy_audio(tsk);
-+#else
-+ if (last_task_used_audio == tsk) {
-+ preempt_disable();
-+ save_audio(tsk);
-+ preempt_enable();
-+ }
-+#endif
-+ /* Let the lazy mechanism do the restore. */
-+ clear_audio(task_pt_regs(tsk));
-+ }
-+ tsk->thread.audio.auregs[off] = val;
-+#endif
-+ return 0;
-+ } else
-+ return -EIO;
-+}
-+
-+/* ptrace_getregs()
-+ *
-+ * Get all user integer registers.
-+ */
-+static int ptrace_getregs(struct task_struct *tsk, void __user * uregs)
-+{
-+ struct pt_regs *regs = task_pt_regs(tsk);
-+
-+ return copy_to_user(uregs, regs, sizeof(struct pt_regs)) ? -EFAULT : 0;
-+}
-+
-+/* ptrace_setregs()
-+ *
-+ * Set all user integer registers.
-+ */
-+static int ptrace_setregs(struct task_struct *tsk, void __user * uregs)
-+{
-+ struct pt_regs newregs;
-+ int ret;
-+
-+ ret = -EFAULT;
-+ if (copy_from_user(&newregs, uregs, sizeof(struct pt_regs)) == 0) {
-+ struct pt_regs *regs = task_pt_regs(tsk);
-+
-+ ret = -EINVAL;
-+ if (valid_user_regs(&newregs)) {
-+ *regs = newregs;
-+ ret = 0;
-+ }
-+ }
-+
-+ return ret;
-+}
-+
-+/* ptrace_getfpregs()
-+ *
-+ * Get the child FPU state.
-+ */
-+static int ptrace_getfpregs(struct task_struct *tsk, void __user * ufpregs)
-+{
-+#ifdef CONFIG_FPU
-+ if (used_math()) {
-+# ifdef CONFIG_UNLAZY_FPU
-+ unlazy_fpu(tsk);
-+# else
-+ preempt_disable();
-+ if (last_task_used_math == tsk)
-+ save_fpu(tsk);
-+ preempt_enable();
-+# endif
-+ return copy_to_user(ufpregs, &tsk->thread.fpu,
-+ sizeof(struct fpu_struct)) ? -EFAULT : 0;
-+ } else {
-+ /* First time FPU user. */
-+ memset(ufpregs, -1, sizeof(struct fpu_struct));
-+ return 0;
-+ }
-+
-+#else
-+ return -EFAULT;
-+#endif
-+}
-+
-+/*
-+ * Set the child FPU state.
-+ */
-+static int ptrace_setfpregs(struct task_struct *tsk, void __user * ufpregs)
-+{
-+#ifdef CONFIG_FPU
-+ int ret;
-+
-+# ifndef CONFIG_UNLAZY_FPU
-+ if (last_task_used_math == tsk)
-+# endif
-+ clear_fpu(task_pt_regs(tsk));
-+
-+ ret =
-+ copy_from_user(&tsk->thread.fpu, ufpregs,
-+ sizeof(struct fpu_struct)) ? -EFAULT : 0;
-+
-+ if (!ret && !used_math()) {
-+ /* First time Audio user. */
-+ set_used_math();
-+ }
-+
-+ return ret;
-+#else
-+ return -EFAULT;
-+#endif
-+}
-+
-+/* ptrace_getauregs()
-+ *
-+ * Get the child Audio state.
-+ */
-+static int ptrace_getauregs(struct task_struct *tsk, void __user * uauregs)
-+{
-+#ifdef CONFIG_AUDIO
-+ if (test_tsk_thread_flag(tsk, TIF_USEDAUDIO)) {
-+#ifdef CONFIG_UNLAZY_AUDIO
-+ unlazy_audio(tsk);
-+#else
-+ preempt_disable();
-+ if (last_task_used_audio == tsk)
-+ save_audio(tsk);
-+ preempt_enable();
-+#endif
-+ return copy_to_user(uauregs, &tsk->thread.audio,
-+ sizeof(struct audio_struct)) ? -EFAULT : 0;
-+ } else {
-+ /* First time Audio user. */
-+ memset(uauregs, 0, sizeof(struct audio_struct));
-+ return 0;
-+ }
-+
-+#else
-+ return -EFAULT;
-+#endif
-+}
-+
-+/*
-+ * Set the child Audio state.
-+ */
-+static int ptrace_setauregs(struct task_struct *tsk, void __user * uauregs)
-+{
-+#ifdef CONFIG_AUDIO
-+ int ret;
-+
-+#ifdef CONFIG_UNLAZY_AUDIO
-+ clear_audio(task_pt_regs(tsk));
-+#else
-+ if (last_task_used_audio == tsk)
-+ clear_audio(task_pt_regs(tsk));
-+#endif
-+ ret =
-+ copy_from_user(&tsk->thread.audio, uauregs,
-+ sizeof(struct audio_struct)) ? -EFAULT : 0;
-+
-+ if (!ret && !test_tsk_thread_flag(tsk, TIF_USEDAUDIO)) {
-+ /* First time Audio user. */
-+ set_tsk_thread_flag(tsk, TIF_USEDAUDIO);
-+ }
-+
-+ return ret;
-+#else
-+ return -EFAULT;
-+#endif
-+}
-+
-+/* do_ptrace()
-+ *
-+ * Provide ptrace defined service.
-+ */
-+long arch_ptrace(struct task_struct *child, long request, unsigned long addr,
-+ unsigned long data)
-+{
-+ int ret;
-+
-+ switch (request) {
-+ case PTRACE_PEEKUSR:
-+ ret =
-+ ptrace_read_user(child, addr, (unsigned long __user *)data);
-+ break;
-+
-+ case PTRACE_POKEUSR:
-+ ret = ptrace_write_user(child, addr, data);
-+ break;
-+
-+ case PTRACE_GETREGS:
-+ ret = ptrace_getregs(child, (void __user *)data);
-+ break;
-+
-+ case PTRACE_SETREGS:
-+ ret = ptrace_setregs(child, (void __user *)data);
-+ break;
-+
-+ case PTRACE_GETFPREGS:
-+ ret = ptrace_getfpregs(child, (void __user *)data);
-+ break;
-+
-+ case PTRACE_SETAUREGS:
-+ ret = ptrace_setauregs(child, (void __user *)data);
-+ break;
-+
-+ case PTRACE_GETAUREGS:
-+ ret = ptrace_getauregs(child, (void __user *)data);
-+ break;
-+
-+ case PTRACE_SETFPREGS:
-+ ret = ptrace_setfpregs(child, (void __user *)data);
-+ break;
-+/*
-+ case PTRACE_GET_THREAD_AREA:
-+ ret = put_user(task_thread_info(child)->tp_value,
-+ (unsigned long __user *) data);
-+ break;
-+*/
-+
-+ default:
-+ ret = ptrace_request(child, request, addr, data);
-+ break;
-+ }
-+
-+ return ret;
-+}
-+
-+void user_enable_single_step(struct task_struct *child)
-+{
-+ struct pt_regs *regs;
-+ regs = task_pt_regs(child);
-+#ifdef CONFIG_HSS
-+ regs->NDS32_ipsw |= PSW_mskHSS;
-+#else
-+ ptrace_set_swbk(child);
-+#endif
-+ set_tsk_thread_flag(child, TIF_SINGLESTEP);
-+}
-+
-+void user_disable_single_step(struct task_struct *child)
-+{
-+ struct pt_regs *regs;
-+ regs = task_pt_regs(child);
-+#ifdef CONFIG_HSS
-+ regs->NDS32_ipsw &= ~PSW_mskHSS;
-+#else
-+ ptrace_cancel_swbk(child);
-+#endif
-+ clear_tsk_thread_flag(child, TIF_SINGLESTEP);
-+}
-+
-+/* sys_trace()
-+ *
-+ * syscall trace handler.
-+ */
-+static inline void do_syscall_trace(void)
-+{
-+ if (!test_thread_flag(TIF_SYSCALL_TRACE))
-+ return;
-+ if (!(current->ptrace & PT_PTRACED))
-+ return;
-+
-+ /* the 0x80 provides a way for the tracing parent to distinguish
-+ between a syscall stop and SIGTRAP delivery */
-+ ptrace_notify(SIGTRAP | ((current->ptrace & PT_TRACESYSGOOD)
-+ ? 0x80 : 0));
-+ /*
-+ * this isn't the same as continuing with a signal, but it will do
-+ * for normal use. strace only continues with a signal if the
-+ * stopping signal is not SIGTRAP. -brl
-+ */
-+ if (current->exit_code) {
-+ send_sig(current->exit_code, current, 1);
-+ current->exit_code = 0;
-+ }
-+}
-+
-+asmlinkage int syscall_trace_enter(int syscall, struct pt_regs *regs)
-+{
-+ int orig_r0;
-+
-+ orig_r0 = regs->NDS32_ORIG_r0;
-+ regs->NDS32_ORIG_r0 = syscall;
-+ do_syscall_trace();
-+ syscall = regs->NDS32_ORIG_r0;
-+ regs->NDS32_ORIG_r0 = orig_r0;
-+ return syscall & 0xfff;
-+}
-+
-+asmlinkage void syscall_trace_leave(struct pt_regs *regs)
-+{
-+ do_syscall_trace();
-+
-+ /* synthsize a single-step */
-+#if !defined(CONFIG_HSS)
-+ /* for SWBK, break should be remove */
-+ ptrace_cancel_swbk(current);
-+#endif
-+ if (test_thread_flag(TIF_SINGLESTEP)) {
-+ printk(KERN_INFO "synthsize trap (tf=0x%0x\n",
-+ (unsigned int)current_thread_info()->flags);
-+ send_sigtrap(current, regs, 0, TRAP_BRKPT);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/ptrace.h linux-3.4.113/arch/nds32/kernel/ptrace.h
---- linux-3.4.113.orig/arch/nds32/kernel/ptrace.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/ptrace.h 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,48 @@
-+/*
-+ * linux/arch/nds32/kernel/ptrace.h
-+ */
-+/* Copyright (C) 2000-2003 Russell King
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+/* ============================================================================
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for Andes NDS32 architecture.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.31.2007 Initial ported by Tom, Shawn, and Steven,
-+ * revised by Harry.
-+ * Current implmentation is based on Andes Instruction
-+ * Set Architecture Specification (AS-0001-0001)
-+ * version:3.7 date:7-20-2007.
-+ * It is original taken from ARM, then fit to NDS32.
-+ *
-+ * Note:
-+ *
-+ * Current layout: 0-31 GR, 32-34 SPR, 35-... SR, index start from zero.
-+ *
-+ * +----------+-----+--------------+
-+ * | GR | SPR | SR |
-+ * +-------------------------------+
-+ * 0 32 35 ...
-+ *
-+ * ============================================================================
-+ */
-+#ifndef __KERNEL_PTRACE_H__
-+#define __KERNEL_PTRACE_H__
-+
-+extern void ptrace_cancel_swbk(struct task_struct *);
-+extern void ptrace_set_swbk(struct task_struct *);
-+extern void ptrace_break(struct task_struct *, struct pt_regs *);
-+extern void send_sigtrap(struct task_struct *tsk, struct pt_regs *regs,
-+ int error_code, int si_code);
-+
-+#endif // __KERNEL_PTRACE_H__
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/relocate_kernel.S linux-3.4.113/arch/nds32/kernel/relocate_kernel.S
---- linux-3.4.113.orig/arch/nds32/kernel/relocate_kernel.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/relocate_kernel.S 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,89 @@
-+/*
-+ * relocate_kernel.S - put the kernel image in place to boot
-+ */
-+
-+#include <asm/kexec.h>
-+
-+ .globl relocate_new_kernel
-+relocate_new_kernel:
-+ la $r0, kexec_indirection_page
-+ slli $r0, $r0, 2
-+ srli $r0, $r0, 2
-+ lwi $r0, [$r0]
-+ la $r1, kexec_start_address
-+ slli $r1, $r1, 2
-+ srli $r1, $r1, 2
-+ lwi $r1, [$r1]
-+
-+0: /* top, read another word for the indirection page */
-+ lwi.bi $r3, [$r0], #4
-+
-+ /* Is it a destination page. Put destination address to r4 */
-+ andi $p0, $r3, #1
-+ beqz $p0, 1f
-+ li $p0, ~#1
-+ and $r4, $r3, $p0
-+ b 0b
-+1:
-+ /* Is it an indirection page */
-+ andi $p0, $r3, #2
-+ beqz $p0, 1f
-+ li $p0, ~#2
-+ and $r0, $r3, $p0
-+ b 0b
-+1:
-+ /* are we done ? */
-+ andi $p0, $r3, #4
-+ beqz $p0, 1f
-+ b 2f
-+1:
-+ /* is it source ? */
-+ andi $p0, $r3, #8
-+ beqz $p0, 0b
-+ li $p0, ~#8
-+ and $r3, $r3, $p0
-+ li $r6, #(1024/16) /* 16 words per loop */
-+9:
-+ lmw.bim $r7, [$r3], $r22
-+ smw.bim $r7, [$r4], $r22
-+ addi $r6, $r6, -1
-+ bnez $r6, 9b
-+ b 0b
-+2:
-+ /* Jump to relocated kernel */
-+ move $lp, $r1
-+ li $r0, 0
-+ la $r1, kexec_mach_type
-+ slli $r1, $r1, 2
-+ srli $r1, $r1, 2
-+ lwi $r1, [$r1]
-+ la $r2, kexec_boot_atags
-+ slli $r2, $r2, 2
-+ srli $r2, $r2, 2
-+ lwi $r2, [$r2]
-+ ret
-+
-+ .globl kexec_start_address
-+kexec_start_address:
-+ .long 0x0
-+
-+ .globl kexec_indirection_page
-+kexec_indirection_page:
-+ .long 0x0
-+
-+ .globl kexec_mach_type
-+kexec_mach_type:
-+ .long 0x0
-+
-+ /* phy addr of the atags for the new kernel */
-+ .globl kexec_boot_atags
-+kexec_boot_atags:
-+ .long 0x0
-+
-+relocate_new_kernel_end:
-+
-+ .globl relocate_new_kernel_size
-+relocate_new_kernel_size:
-+ .long relocate_new_kernel_end - relocate_new_kernel
-+
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/setup.c linux-3.4.113/arch/nds32/kernel/setup.c
---- linux-3.4.113.orig/arch/nds32/kernel/setup.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/setup.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,1049 @@
-+/*
-+ * linux/arch/nds32/kernel/setup.c
-+ *
-+ * Copyright (C) 1995-2001 Russell King
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+/* ============================================================================
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for Andes NDS32 architecture.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.05.2007 Initial ported by Tom, revised and patched for KGDB
-+ * by Harry.
-+ * Aug.26.2008 Some reworks on CPU info output for SMP.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#include <linux/module.h>
-+#include <linux/ioport.h>
-+#include <linux/delay.h>
-+#include <linux/utsname.h>
-+#include <linux/initrd.h>
-+#include <linux/console.h>
-+#include <linux/bootmem.h>
-+#include <linux/seq_file.h>
-+#include <linux/screen_info.h>
-+#include <linux/root_dev.h>
-+#include <linux/cpu.h>
-+#include <linux/fs.h>
-+#include <linux/memblock.h>
-+#include <asm/cpu.h>
-+#include <asm/setup.h>
-+#include <asm/mach-types.h>
-+#include <asm/cacheflush.h>
-+#include <asm/mach/arch.h>
-+#include <asm/mach/time.h>
-+#include <asm/cpuver.h>
-+#include <asm/procinfo.h>
-+#include <asm/traps.h>
-+#include <asm/fpu.h>
-+#include <asm/cache_info.h>
-+#include <nds32_intrinsic.h>
-+
-+#ifndef MEM_SIZE
-+#define MEM_SIZE CONFIG_SDRAM_SIZE
-+#endif
-+
-+#ifndef RAMDISK_SIZE
-+#define RAMDISK_SIZE CONFIG_BLK_DEV_RAM_SIZE
-+#endif
-+
-+extern void (*init_arch_irq) (void);
-+
-+extern void paging_init(struct machine_desc *desc);
-+extern void reboot_setup(char *str);
-+extern int root_mountflags;
-+extern unsigned long _stext, _text, _etext, _sdata, _edata, _end;
-+extern unsigned int ag101_cpufreq_get(unsigned int dummy);
-+
-+unsigned long cpu_id, cpu_rev, cpu_cfgid;
-+char *endianness = NULL;
-+
-+unsigned int __machine_arch_type;
-+EXPORT_SYMBOL(__machine_arch_type);
-+
-+unsigned int elf_hwcap;
-+EXPORT_SYMBOL(elf_hwcap);
-+
-+unsigned char aux_device_present;
-+
-+char elf_platform[ELF_PLATFORM_SIZE];
-+EXPORT_SYMBOL(elf_platform);
-+
-+unsigned long phys_initrd_start __initdata = 0;
-+unsigned long phys_initrd_size __initdata = 0;
-+
-+static struct meminfo meminfo __initdata = { 0, };
-+
-+static const char *machine_name;
-+static struct proc_info_item proc_info;
-+static char command_line[COMMAND_LINE_SIZE];
-+
-+struct machine_desc *machine_desc __initdata;
-+
-+static char default_command_line[COMMAND_LINE_SIZE] __initdata = CONFIG_CMDLINE;
-+
-+DEFINE_PER_CPU(struct cpuinfo_nds32, cpu_data);
-+
-+/*
-+ * Standard memory resources
-+ */
-+static struct resource mem_res[] = {
-+ {
-+ .name = "Video RAM",
-+ .start = 0,
-+ .end = 0,
-+ .flags = IORESOURCE_MEM},
-+ {
-+ .name = "Kernel text",
-+ .start = 0,
-+ .end = 0,
-+ .flags = IORESOURCE_MEM},
-+ {
-+ .name = "Kernel data",
-+ .start = 0,
-+ .end = 0,
-+ .flags = IORESOURCE_MEM}
-+};
-+
-+#define video_ram mem_res[0]
-+#define kernel_code mem_res[1]
-+#define kernel_data mem_res[2]
-+
-+static struct resource io_res[] = {
-+ {
-+ .name = "reserved",
-+ .start = 0x3bc,
-+ .end = 0x3be,
-+ .flags = IORESOURCE_IO | IORESOURCE_BUSY},
-+ {
-+ .name = "reserved",
-+ .start = 0x378,
-+ .end = 0x37f,
-+ .flags = IORESOURCE_IO | IORESOURCE_BUSY},
-+ {
-+ .name = "reserved",
-+ .start = 0x278,
-+ .end = 0x27f,
-+ .flags = IORESOURCE_IO | IORESOURCE_BUSY}
-+};
-+
-+#define lp0 io_res[0]
-+#define lp1 io_res[1]
-+#define lp2 io_res[2]
-+
-+/*
-+ * The following string table, must sync with HWCAP_xx bitmask,
-+ * which is defined in <asm/procinfo.h>
-+ */
-+static const char *hwcap_str[] = {
-+ "mfusr_pc",
-+ "perf1",
-+ "perf2",
-+ "fpu",
-+ "audio",
-+ "16b",
-+ "string",
-+ "reduced_regs",
-+ "video",
-+ "encrypt",
-+ "edm",
-+ "lmdma",
-+ "pfm",
-+ "hsmp",
-+ "trace",
-+ "div",
-+ "mac",
-+ "l2c",
-+ "dx_regs",
-+ "v2",
-+ NULL,
-+};
-+
-+static void __init squash_mem_tags(struct tag *tag)
-+{
-+ for (; tag->hdr.size; tag = tag_next(tag))
-+ if (tag->hdr.tag == ATAG_MEM)
-+ tag->hdr.tag = ATAG_NONE;
-+}
-+
-+struct cache_info L1_cache_info[2];
-+
-+static void __init dump_cpu_info(int cpu)
-+{
-+ int i = 0, aliasing_num;
-+#ifdef CONFIG_CACHE_L2
-+ unsigned long l2set, l2way, l2clsz;
-+#endif
-+ printk("CPU%d Features: ", cpu);
-+
-+ for (i = 0; hwcap_str[i]; i++) {
-+ if (elf_hwcap & (1 << i))
-+ printk("%s ", hwcap_str[i]);
-+ }
-+
-+ printk("\n");
-+
-+ L1_cache_info[ICACHE].cache_type = ICACHE;
-+ L1_cache_info[ICACHE].ways = CACHE_WAY(ICACHE);
-+ L1_cache_info[ICACHE].way_bits = ilog2(CACHE_WAY(ICACHE));
-+ L1_cache_info[ICACHE].line_size = CACHE_LINE_SIZE(ICACHE);
-+ L1_cache_info[ICACHE].line_bits = ilog2(CACHE_LINE_SIZE(ICACHE));
-+ L1_cache_info[ICACHE].sets = CACHE_SET(ICACHE);
-+ L1_cache_info[ICACHE].set_bits = ilog2(CACHE_SET(ICACHE));
-+ L1_cache_info[ICACHE].size =
-+ CACHE_SET(ICACHE) * CACHE_WAY(ICACHE) * CACHE_LINE_SIZE(ICACHE) /
-+ 1024;
-+ printk("L1I:%dKB/%dS/%dW/%dB\n", L1_cache_info[ICACHE].size,
-+ L1_cache_info[ICACHE].sets, L1_cache_info[ICACHE].ways,
-+ L1_cache_info[ICACHE].line_size);
-+ aliasing_num =
-+ L1_cache_info[ICACHE].size * 1024 / PAGE_SIZE /
-+ L1_cache_info[ICACHE].ways;
-+ if (aliasing_num & 1 && aliasing_num != 1)
-+ printk
-+ ("%s: not alising:%d, it should be multiple of 2 if it ia aliasing cache.\n",
-+ __func__, aliasing_num);
-+ L1_cache_info[ICACHE].aliasing_num = aliasing_num;
-+ L1_cache_info[ICACHE].aliasing_mask = (aliasing_num - 1) << PAGE_SHIFT;
-+ L1_cache_info[ICACHE].not_aliasing_mask =
-+ ~L1_cache_info[ICACHE].aliasing_mask;
-+ L1_cache_info[DCACHE].cache_type = DCACHE;
-+ L1_cache_info[DCACHE].ways = CACHE_WAY(DCACHE);
-+ L1_cache_info[DCACHE].way_bits = ilog2(CACHE_WAY(DCACHE));
-+ L1_cache_info[DCACHE].line_size = CACHE_LINE_SIZE(DCACHE);
-+ L1_cache_info[DCACHE].line_bits = ilog2(CACHE_LINE_SIZE(DCACHE));
-+ L1_cache_info[DCACHE].sets = CACHE_SET(DCACHE);
-+ L1_cache_info[DCACHE].set_bits = ilog2(CACHE_SET(DCACHE));
-+ L1_cache_info[DCACHE].size =
-+ CACHE_SET(DCACHE) * CACHE_WAY(DCACHE) * CACHE_LINE_SIZE(DCACHE) /
-+ 1024;
-+ printk("L1D:%dKB/%dS/%dW/%dB\n", L1_cache_info[DCACHE].size,
-+ L1_cache_info[DCACHE].sets, L1_cache_info[DCACHE].ways,
-+ L1_cache_info[DCACHE].line_size);
-+ aliasing_num =
-+ L1_cache_info[DCACHE].size * 1024 / PAGE_SIZE /
-+ L1_cache_info[DCACHE].ways;
-+#ifdef CONFIG_HIGHMEM
-+ if (aliasing_num > 1 && CONFIG_HIGHMEM)
-+ WARN(1,
-+ "%s: HIGHMEM is not supported for alising VIPT cache. aliasing_num:%d\n",
-+ __func__, aliasing_num);
-+#else
-+ if (aliasing_num & 1 && aliasing_num != 1)
-+ printk
-+ ("%s: not alising:%d, it should be multiple of 2 if it ia aliasing cache.\n",
-+ __func__, aliasing_num);
-+#endif
-+ L1_cache_info[DCACHE].aliasing_num = aliasing_num;
-+ L1_cache_info[DCACHE].aliasing_mask = (aliasing_num - 1) << PAGE_SHIFT;
-+ L1_cache_info[DCACHE].not_aliasing_mask =
-+ ~L1_cache_info[DCACHE].aliasing_mask;
-+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ printk("L1 D-Cache is WRITE-THROUGH\n");
-+#else
-+ printk("L1 D-Cache is WRITE-BACK\n");
-+#endif
-+
-+
-+#ifdef CONFIG_CACHE_L2
-+ /* Here translation is on but I/O address is not mapped yet. */
-+ SET_PSW(GET_PSW() & ~PSW_mskDT);
-+ DSB();
-+ l2set =
-+ 64 << ((inl(L2CC_PA_BASE + L2_CA_CONF_OFF) & L2_CA_CONF_mskL2SET) >>
-+ L2_CA_CONF_offL2SET);
-+ l2way =
-+ 1 +
-+ ((inl(L2CC_PA_BASE + L2_CA_CONF_OFF) & L2_CA_CONF_mskL2WAY) >>
-+ L2_CA_CONF_offL2WAY);
-+ l2clsz =
-+ 4 << ((inl(L2CC_PA_BASE + L2_CA_CONF_OFF) & L2_CA_CONF_mskL2CLSZ) >>
-+ L2_CA_CONF_offL2CLSZ);
-+ SET_PSW(GET_PSW() | PSW_mskDT);
-+ DSB();
-+
-+ printk("L2:%luKB/%luS/%luW/%luB\n",
-+ l2set * l2way * l2clsz / 1024, l2set, l2way, l2clsz);
-+#endif
-+#ifdef CONFIG_FPU
-+ /* Disable fpu and enable when it is used. */
-+ disable_fpu();
-+ printk("FPU is able to use.\n");
-+#endif
-+}
-+
-+static void __init setup_processor(void)
-+{
-+ unsigned long tmp = 0;
-+ struct proc_info_list *list;
-+ extern struct proc_info_list __proc_info_begin, __proc_info_end;
-+
-+ register unsigned coreid = GET_CPU_VER();
-+ for (list = &__proc_info_begin; list < &__proc_info_end; list++)
-+// if (list->cpu_val == (GET_CPU_VER() & CPU_VER_mskCPUID))
-+ if (list->cpu_val == (coreid & list->cpu_mask))
-+ break;
-+ /*
-+ * If the architecture type is not recognised, then we
-+ * can co nothing...
-+ */
-+ if (list >= &__proc_info_end) {
-+ printk
-+ ("Processor configuration botched (CPU_VER 0x%lx), unable to continue.\n",
-+ GET_CPU_VER());
-+ while (1) ;
-+ }
-+
-+ proc_info = *list->info;
-+
-+ cpu_dcache_inval_all(); // XXX head.S turn $$ on, need change.
-+ cpu_icache_inval_all();
-+ DSB();
-+ ISB();
-+
-+ cpu_id = GET_CPU_ID();
-+ cpu_rev = GET_CPU_REV();
-+ cpu_cfgid = GET_CPU_CFGID();
-+
-+ printk("CPU: %s, %s %s, CPU_VER 0x%08lx(id %lu, rev %lu, cfg %lu)\n",
-+ list->arch_name,
-+ proc_info.manufacturer, proc_info.cpu_name,
-+ GET_CPU_VER(), cpu_id, cpu_rev, cpu_cfgid);
-+
-+ elf_hwcap |= HWCAP_MFUSR_PC;
-+
-+ if (((GET_MSC_CFG() & MSC_CFG_mskBASEV) >> MSC_CFG_offBASEV) == 0) {
-+ if (CPU_IS_N1213_43U1HA0() || CPU_IS_N1213_43U1HB0())
-+ elf_hwcap &= ~HWCAP_MFUSR_PC;
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskDIV)
-+ elf_hwcap |= HWCAP_DIV;
-+
-+ if ((GET_MSC_CFG() & MSC_CFG_mskMAC)
-+ || (cpu_id == 12 && cpu_rev < 4))
-+ elf_hwcap |= HWCAP_MAC;
-+ } else {
-+ elf_hwcap |= HWCAP_V2;
-+ elf_hwcap |= HWCAP_DIV;
-+ elf_hwcap |= HWCAP_MAC;
-+ }
-+
-+ if (cpu_cfgid & 0x0001)
-+ elf_hwcap |= HWCAP_EXT;
-+
-+ if (cpu_cfgid & 0x0002)
-+ elf_hwcap |= HWCAP_BASE16;
-+
-+ if (cpu_cfgid & 0x0004)
-+ elf_hwcap |= HWCAP_EXT2;
-+
-+ if (cpu_cfgid & 0x0008)
-+ elf_hwcap |= HWCAP_FPU;
-+
-+ if (cpu_cfgid & 0x0010)
-+ elf_hwcap |= HWCAP_STRING;
-+
-+ if (GET_MMU_CFG() & MMU_CFG_mskDE)
-+ endianness = "MSB";
-+ else
-+ endianness = "LSB";
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskEDM)
-+ elf_hwcap |= HWCAP_EDM;
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskLMDMA)
-+ elf_hwcap |= HWCAP_LMDMA;
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskPFM)
-+ elf_hwcap |= HWCAP_PFM;
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskHSMP)
-+ elf_hwcap |= HWCAP_HSMP;
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskTRACE)
-+ elf_hwcap |= HWCAP_TRACE;
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskAUDIO)
-+ elf_hwcap |= HWCAP_AUDIO;
-+
-+ if (GET_MSC_CFG() & MSC_CFG_mskL2C)
-+ elf_hwcap |= HWCAP_L2C;
-+
-+#ifdef CONFIG_ANDES_PAGE_SIZE_4KB
-+ if (CPU_IS_N1213_43U1HA0()) {
-+ /*
-+ * Downsize dcache to bypass N1213-43u1h inconsistent
-+ * use of PA and VA in fill-buffer logic issue.
-+ */
-+
-+ if ((CACHE_SET(DCACHE) * CACHE_LINE_SIZE(DCACHE)) > 4096)
-+ tmp |= 0x02 << SDZ_CTL_offDCDZ;
-+
-+ if ((CACHE_SET(ICACHE) * CACHE_LINE_SIZE(ICACHE)) > 4096)
-+ tmp |= 0x02 << SDZ_CTL_offICDZ;
-+
-+ SET_SDZ_CTL(tmp);
-+ ISB();
-+ printk("CPU%i enabled dcache downsizing to half set/4-way.\n",
-+ smp_processor_id());
-+ }
-+#endif /* CONFIG_ANDES_PAGE_SIZE_4KB */
-+
-+#ifdef CONFIG_CACHE_L2
-+#ifdef CONFIG_PLAT_AG102
-+ SET_HSMP_SADDR((CPU_MEM_PA_BASE & HSMP_SADDR_mskSADDR) |
-+ (0xC00 << HSMP_SADDR_offRANGE) | HSMP_SADDR_mskEN);
-+#endif
-+
-+ /* Here translation is on but I/O address is not mapped yet. */
-+ SET_PSW(GET_PSW() & ~PSW_mskDT);
-+ DSB();
-+
-+ /* This is the time when we enable L2$. */
-+ /* All masters can't write another master register */
-+ tmp = inl(L2CC_PA_BASE + L2CC_PROT_OFF);
-+ tmp &= ~L2CC_PROT_mskMRWEN;
-+ outl(tmp, L2CC_PA_BASE + L2CC_PROT_OFF);
-+
-+ /* All masters share the whole cache memory space */
-+ tmp = inl(L2CC_PA_BASE + L2CC_SETUP_OFF);
-+ tmp &= ~L2CC_SETUP_mskPART;
-+ outl(tmp, L2CC_PA_BASE + L2CC_SETUP_OFF);
-+
-+ /* each master access self master, does not add master base */
-+ tmp = inl(L2CC_PA_BASE + L2CC_CTRL_OFF);
-+ tmp |= L2CC_CTRL_mskEN;
-+ outl(tmp, L2CC_PA_BASE + L2CC_CTRL_OFF);
-+
-+ SET_PSW(GET_PSW() | PSW_mskDT);
-+ ISB();
-+#endif
-+ tmp = GET_CACHE_CTL();
-+#ifndef CONFIG_CPU_DCACHE_DISABLE
-+ tmp |= CACHE_CTL_mskDC_EN;
-+#endif
-+
-+#ifndef CONFIG_CPU_ICACHE_DISABLE
-+ tmp |= CACHE_CTL_mskIC_EN;
-+#endif
-+ SET_CACHE_CTL(tmp);
-+ DSB();
-+ ISB();
-+
-+ sprintf(elf_platform, "%s %s", list->elf_name, endianness);
-+
-+ dump_cpu_info(smp_processor_id());
-+}
-+
-+static struct machine_desc *__init setup_machine(unsigned int nr)
-+{
-+ struct machine_desc *list;
-+
-+ extern struct machine_desc __arch_info_begin, __arch_info_end;
-+ /*
-+ * locate machine in the list of supported machines.
-+ */
-+ for (list = &__arch_info_begin; list < &__arch_info_end; list++)
-+ if (list->nr == nr)
-+ break;
-+ /*
-+ * If the architecture type is not recognised, then we
-+ * can co nothing...
-+ */
-+ if (list >= &__arch_info_end) {
-+ printk("Architecture configuration botched (nr 0x%x), unable "
-+ "to continue.\n", nr);
-+ while (1) ;
-+ }
-+
-+ printk(KERN_INFO "Machine: %s\n", list->name);
-+
-+ return list;
-+}
-+
-+static void __init early_initrd(char **p)
-+{
-+ unsigned long start, size;
-+
-+ start = memparse(*p, p);
-+ if (**p == ',') {
-+ size = memparse((*p) + 1, p);
-+
-+ phys_initrd_start = start; //pa
-+ phys_initrd_size = size;
-+ }
-+ printk(KERN_INFO
-+ "phys_initrd_start at 0x%08lx, phys_initrd_size:0x%08lx\n",
-+ phys_initrd_start, phys_initrd_size);
-+ //memblock_reserve(phys_initrd_start, phys_initrd_size);
-+}
-+
-+__early_param("initrd=", early_initrd);
-+
-+/*
-+ * Pick out the memory size. We look for mem=size@start,
-+ * where start and size are "size[KkMm]"
-+ */
-+static void __init early_mem(char **p)
-+{
-+ static int usermem __initdata = 0;
-+ unsigned long size, start;
-+
-+ /*
-+ * If the user specifies memory size, we
-+ * blow away any automatically generated
-+ * size.
-+ */
-+ if (usermem == 0) {
-+ usermem = 1;
-+ meminfo.nr_banks = 0;
-+ }
-+
-+ start = PHYS_OFFSET; //Tom 0x0
-+ size = memparse(*p, p);
-+ if (**p == '@')
-+ start = memparse(*p + 1, p);
-+
-+ meminfo.bank[meminfo.nr_banks].start = start;
-+ meminfo.bank[meminfo.nr_banks].size = size;
-+ meminfo.bank[meminfo.nr_banks].node = PHYS_TO_NID(start);
-+ memblock_add_node(meminfo.bank[meminfo.nr_banks].start,
-+ meminfo.bank[meminfo.nr_banks].size, 0);
-+ meminfo.nr_banks += 1;
-+
-+}
-+
-+__early_param("mem=", early_mem);
-+
-+/*
-+ * Initial parsing of the command line.
-+ */
-+void __init parse_cmdline(char **cmdline_p, char *from)
-+{
-+ char c = ' ', *to = command_line;
-+ int len = 0;
-+
-+ for (;;) {
-+ if (c == ' ') {
-+ extern struct early_params __early_begin, __early_end;
-+ struct early_params *p;
-+
-+ for (p = &__early_begin; p < &__early_end; p++) {
-+ int len = strlen(p->arg);
-+
-+ if (memcmp(from, p->arg, len) == 0) {
-+ if (to != command_line)
-+ to -= 1;
-+ from += len;
-+ p->fn(&from);
-+
-+ while (*from != ' ' && *from != '\0')
-+ from++;
-+ break;
-+ }
-+ }
-+ }
-+ c = *from++;
-+ if (!c)
-+ break;
-+ if (COMMAND_LINE_SIZE <= ++len)
-+ break;
-+ *to++ = c;
-+ }
-+ *to = '\0';
-+ *cmdline_p = command_line;
-+}
-+
-+static void __init
-+setup_ramdisk(int doload, int prompt, int image_start, unsigned int rd_sz)
-+{
-+#ifdef CONFIG_BLK_DEV_RAM
-+ extern int rd_size, rd_image_start, rd_prompt, rd_doload;
-+
-+ rd_image_start = image_start;
-+ rd_prompt = prompt;
-+ rd_doload = doload;
-+
-+ if (rd_sz)
-+ rd_size = rd_sz;
-+#endif
-+}
-+
-+static void __init
-+request_standard_resources(struct meminfo *mi, struct machine_desc *mdesc)
-+{
-+ struct resource *res;
-+ int i;
-+
-+ kernel_code.start = virt_to_phys(&_text);
-+ kernel_code.end = virt_to_phys(&_etext - 1);
-+ kernel_data.start = virt_to_phys(&_sdata);
-+ kernel_data.end = virt_to_phys(&_end - 1);
-+
-+ for (i = 0; i < mi->nr_banks; i++) {
-+ unsigned long virt_start, virt_end;
-+
-+ if (mi->bank[i].size == 0)
-+ continue;
-+
-+ virt_start = __phys_to_virt(mi->bank[i].start);
-+ virt_end = virt_start + mi->bank[i].size - 1;
-+
-+ res = alloc_bootmem_low(sizeof(*res));
-+ res->name = "System RAM";
-+ res->start = __virt_to_phys(virt_start);
-+ res->end = __virt_to_phys(virt_end);
-+ res->flags = IORESOURCE_MEM | IORESOURCE_BUSY;
-+
-+ request_resource(&iomem_resource, res);
-+
-+ if (kernel_code.start >= res->start &&
-+ kernel_code.end <= res->end)
-+ request_resource(res, &kernel_code);
-+ if (kernel_data.start >= res->start &&
-+ kernel_data.end <= res->end)
-+ request_resource(res, &kernel_data);
-+ }
-+
-+ if (mdesc->video_start) {
-+ video_ram.start = mdesc->video_start;
-+ video_ram.end = mdesc->video_end;
-+ request_resource(&iomem_resource, &video_ram);
-+ }
-+
-+ /*
-+ * Some machines don't have the possibility of ever
-+ * possessing lp0, lp1 or lp2
-+ */
-+ if (mdesc->reserve_lp0)
-+ request_resource(&ioport_resource, &lp0);
-+ if (mdesc->reserve_lp1)
-+ request_resource(&ioport_resource, &lp1);
-+ if (mdesc->reserve_lp2)
-+ request_resource(&ioport_resource, &lp2);
-+}
-+
-+/*
-+ * Tag parsing.
-+ *
-+ * This is the new way of passing data to the kernel at boot time. Rather
-+ * than passing a fixed inflexible structure to the kernel, we pass a list
-+ * of variable-sized tags to the kernel. The first tag must be a ATAG_CORE
-+ * tag for the list to be recognised (to distinguish the tagged list from
-+ * a param_struct). The list is terminated with a zero-length tag (this tag
-+ * is not parsed in any way).
-+ */
-+//flag bit 0 = read-only
-+static int __init parse_tag_core(const struct tag *tag)
-+{
-+ if (tag->hdr.size > 2) {
-+ if ((tag->u.core.flags & 1) == 0)
-+ root_mountflags &= ~MS_RDONLY;
-+ ROOT_DEV = old_decode_dev(tag->u.core.rootdev);
-+ }
-+ return 0;
-+}
-+
-+__tagtable(ATAG_CORE, parse_tag_core);
-+
-+static int __init parse_tag_mem32(const struct tag *tag)
-+{
-+ if (meminfo.nr_banks >= NR_BANKS) {
-+ printk(KERN_WARNING
-+ "Ignoring memory bank 0x%08x size %dKB\n",
-+ tag->u.mem.start, tag->u.mem.size / 1024);
-+ return -EINVAL;
-+ }
-+ meminfo.bank[meminfo.nr_banks].start = tag->u.mem.start;
-+ meminfo.bank[meminfo.nr_banks].size = tag->u.mem.size;
-+ memblock_add_node(meminfo.bank[meminfo.nr_banks].start,
-+ meminfo.bank[meminfo.nr_banks].size, 0);
-+ meminfo.bank[meminfo.nr_banks].node = PHYS_TO_NID(tag->u.mem.start);
-+ meminfo.nr_banks += 1;
-+
-+ return 0;
-+}
-+
-+__tagtable(ATAG_MEM, parse_tag_mem32);
-+
-+#if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)
-+struct screen_info screen_info = {
-+ .orig_video_lines = 30,
-+ .orig_video_cols = 80,
-+ .orig_video_mode = 0,
-+ .orig_video_ega_bx = 0,
-+ .orig_video_isVGA = 1,
-+ .orig_video_points = 8
-+};
-+
-+static int __init parse_tag_videotext(const struct tag *tag)
-+{
-+ screen_info.orig_x = tag->u.videotext.x;
-+ screen_info.orig_y = tag->u.videotext.y;
-+ screen_info.orig_video_page = tag->u.videotext.video_page;
-+ screen_info.orig_video_mode = tag->u.videotext.video_mode;
-+ screen_info.orig_video_cols = tag->u.videotext.video_cols;
-+ screen_info.orig_video_ega_bx = tag->u.videotext.video_ega_bx;
-+ screen_info.orig_video_lines = tag->u.videotext.video_lines;
-+ screen_info.orig_video_isVGA = tag->u.videotext.video_isvga;
-+ screen_info.orig_video_points = tag->u.videotext.video_points;
-+ return 0;
-+}
-+
-+__tagtable(ATAG_VIDEOTEXT, parse_tag_videotext);
-+#endif
-+
-+static int __init parse_tag_ramdisk(const struct tag *tag)
-+{
-+ setup_ramdisk((tag->u.ramdisk.flags & 1) == 0,
-+ (tag->u.ramdisk.flags & 2) == 0,
-+ tag->u.ramdisk.start, tag->u.ramdisk.size);
-+ return 0;
-+}
-+
-+__tagtable(ATAG_RAMDISK, parse_tag_ramdisk);
-+
-+static int __init parse_tag_initrd(const struct tag *tag)
-+{
-+ printk(KERN_WARNING "ATAG_INITRD is deprecated; "
-+ "please update your bootloader.\n");
-+ phys_initrd_start = __virt_to_phys(tag->u.initrd.start);
-+ phys_initrd_size = tag->u.initrd.size;
-+ return 0;
-+}
-+
-+__tagtable(ATAG_INITRD, parse_tag_initrd);
-+
-+static int __init parse_tag_initrd2(const struct tag *tag)
-+{
-+ phys_initrd_start = tag->u.initrd.start;
-+ phys_initrd_size = tag->u.initrd.size;
-+ return 0;
-+}
-+
-+__tagtable(ATAG_INITRD2, parse_tag_initrd2);
-+
-+static int __init parse_tag_revision(const struct tag *tag)
-+{
-+ return 0;
-+}
-+
-+__tagtable(ATAG_REVISION, parse_tag_revision);
-+
-+static int __init parse_tag_cmdline(const struct tag *tag)
-+{
-+ strlcpy(default_command_line, tag->u.cmdline.cmdline,
-+ COMMAND_LINE_SIZE);
-+ return 0;
-+}
-+
-+__tagtable(ATAG_CMDLINE, parse_tag_cmdline);
-+
-+/*
-+ * Scan the tag table for this tag, and call its parse function.
-+ * The tag table is built by the linker from all the __tagtable
-+ * declarations.
-+ */
-+static int __init parse_tag(const struct tag *tag)
-+{
-+ extern struct tagtable __tagtable_begin, __tagtable_end;
-+ struct tagtable *t;
-+
-+ for (t = &__tagtable_begin; t < &__tagtable_end; t++)
-+ if (tag->hdr.tag == t->tag) {
-+ t->parse(tag);
-+ break;
-+ }
-+
-+ return t < &__tagtable_end;
-+}
-+
-+/*
-+ * Parse all tags in the list, checking both the global and architecture
-+ * specific tag tables.
-+ */
-+static void __init parse_tags(const struct tag *t)
-+{
-+ for (; t->hdr.size; t = tag_next(t))
-+ if (!parse_tag(t))
-+ printk(KERN_WARNING
-+ "Ignoring unrecognised tag 0x%08x\n",
-+ t->hdr.tag);
-+}
-+
-+/*
-+ * This holds our defaults.
-+ */
-+static struct init_tags {
-+ struct tag_header hdr1;
-+ struct tag_core core;
-+ struct tag_header hdr2;
-+ struct tag_mem32 mem;
-+ struct tag_header hdr3;
-+} init_tags __initdata = {
-+ {tag_size(tag_core), ATAG_CORE}, //hdr1
-+ {0, PAGE_SIZE, 0xff},
-+ {tag_size(tag_mem32), ATAG_MEM}, //hdr2
-+ {MEM_SIZE, PHYS_OFFSET},
-+ {0, ATAG_NONE}
-+};
-+
-+static unsigned long __init setup_memory(void)
-+{
-+ unsigned long bootmap_size;
-+ unsigned long ram_start_pfn;
-+ unsigned long free_ram_start_pfn;
-+ phys_addr_t memory_start, memory_end;
-+ struct memblock_region *region;
-+
-+ memory_end = memory_start = 0;
-+
-+ /* Find main memory where is the kernel */
-+ for_each_memblock(memory, region) {
-+ memory_start = region->base;
-+ memory_end = region->base + region->size;
-+ printk(KERN_INFO "%s: Memory: 0x%x-0x%x\n", __func__,
-+ memory_start, memory_end);
-+ }
-+
-+ if (!memory_end) {
-+ panic("No memory!");
-+ }
-+
-+ ram_start_pfn = PFN_UP(memblock_start_of_DRAM());
-+ /* free_ram_start_pfn is first page after kernel */
-+ free_ram_start_pfn = PFN_UP(__pa(&_end));
-+ max_pfn = PFN_DOWN(memblock_end_of_DRAM());
-+
-+ /* it could update max_pfn */
-+ if (max_pfn - ram_start_pfn <= MAXMEM_PFN)
-+ max_low_pfn = max_pfn;
-+ else {
-+ max_low_pfn = MAXMEM_PFN + ram_start_pfn;
-+#ifndef CONFIG_HIGHMEM
-+ max_pfn = MAXMEM_PFN + ram_start_pfn;
-+#endif
-+ }
-+ /* high_memory is related with VMALLOC */
-+ high_memory = (void *)__va(max_low_pfn * PAGE_SIZE);
-+ min_low_pfn = free_ram_start_pfn;
-+
-+ /*
-+ * initialize the boot-time allocator (with low memory only).
-+ *
-+ * This makes the memory from the end of the kernel to the end of
-+ * RAM usable.
-+ * init_bootmem sets the global values min_low_pfn, max_low_pfn.
-+ */
-+ bootmap_size = init_bootmem_node(NODE_DATA(0), free_ram_start_pfn,
-+ ram_start_pfn, max_low_pfn);
-+ free_bootmem(PFN_PHYS(free_ram_start_pfn),
-+ (max_low_pfn - free_ram_start_pfn) << PAGE_SHIFT);
-+ reserve_bootmem(PFN_PHYS(free_ram_start_pfn), bootmap_size,
-+ BOOTMEM_DEFAULT);
-+
-+ for_each_memblock(reserved, region) {
-+ if (region->size != 0) {
-+ printk(KERN_INFO "Reserved - 0x%08x-0x%08x\n",
-+ (u32) region->base, (u32) region->size);
-+ reserve_bootmem(region->base, region->size,
-+ BOOTMEM_DEFAULT);
-+ }
-+ }
-+ return max_low_pfn;
-+}
-+
-+void __init setup_arch(char **cmdline_p)
-+{
-+ struct tag *tags = (struct tag *)&init_tags;
-+ struct machine_desc *mdesc;
-+ char *from = default_command_line;
-+
-+ setup_processor();
-+ mdesc = setup_machine(machine_arch_type);
-+ machine_desc = mdesc;
-+ machine_name = mdesc->name;
-+
-+ if (mdesc->soft_reboot)
-+ reboot_setup("s");
-+
-+ if (mdesc->param_offset)
-+ tags = phys_to_virt(mdesc->param_offset);
-+
-+ if (tags->hdr.tag != ATAG_CORE)
-+ tags = (struct tag *)&init_tags;
-+
-+ if (tags->hdr.tag == ATAG_CORE) {
-+ if (meminfo.nr_banks != 0)
-+ squash_mem_tags(tags);
-+ parse_tags(tags);
-+ }
-+
-+ init_mm.start_code = (unsigned long)&_text;
-+ init_mm.end_code = (unsigned long)&_etext;
-+ init_mm.end_data = (unsigned long)&_edata;
-+ init_mm.brk = (unsigned long)&_end;
-+
-+ memcpy(boot_command_line, from, COMMAND_LINE_SIZE);
-+ boot_command_line[COMMAND_LINE_SIZE - 1] = '\0';
-+ parse_cmdline(cmdline_p, from);
-+
-+ /* use generic way to parse */
-+ parse_early_param();
-+
-+ /* setup bootmem allocator */
-+ setup_memory();
-+
-+ strlcpy(command_line, from, COMMAND_LINE_SIZE);
-+ *cmdline_p = command_line;
-+
-+ paging_init(mdesc);
-+ request_standard_resources(&meminfo, mdesc); //- for test only
-+
-+#ifdef CONFIG_SMP
-+ smp_init_cpus();
-+#endif
-+
-+ /*
-+ * Set up various architecture-specific pointers
-+ */
-+ init_arch_irq = mdesc->init_irq;
-+ system_timer = mdesc->timer;
-+ if (mdesc->init_machine)
-+ mdesc->init_machine();
-+
-+#if defined(CONFIG_VT)
-+#if defined(CONFIG_VGA_CONSOLE)
-+ conswitchp = &vga_con;
-+#elif defined(CONFIG_DUMMY_CONSOLE)
-+ conswitchp = &dummy_con; //+ Tom: we will reach here
-+#endif
-+#endif
-+
-+ early_trap_init();
-+}
-+
-+/*
-+ * cpu_init - initialise one CPU.
-+ *
-+ * cpu_init dumps the cache information, initialises SMP specific
-+ * information.
-+ */
-+
-+void __init cpu_init(void)
-+{
-+ unsigned int cpu = smp_processor_id(), tmp = 0;
-+
-+ if (cpu >= NR_CPUS) {
-+ printk(KERN_CRIT "CPU%u: bad primary CPU number\n", cpu);
-+ BUG();
-+ }
-+
-+ if (system_state == SYSTEM_BOOTING)
-+ dump_cpu_info(cpu);
-+
-+ tmp = 1 << IVB_offESZ;
-+#ifdef CONFIG_EVIC
-+ tmp |= 1 << IVB_offEVIC;
-+#endif
-+ SET_IVB(tmp | IVB_BASE);
-+ tmp = 0x10003;
-+ SET_INT_MASK(tmp);
-+ ISB();
-+}
-+
-+static int __init topology_init(void)
-+{
-+ int cpu;
-+
-+ for_each_possible_cpu(cpu)
-+ register_cpu(&per_cpu(cpu_data, cpu).cpu, cpu);
-+
-+ return 0;
-+}
-+
-+subsys_initcall(topology_init);
-+
-+static int c_show(struct seq_file *m, void *v)
-+{
-+ int i;
-+
-+ seq_printf(m, "Processor\t: %s %s (id %lu, rev %lu, cfg %lu)\n",
-+ proc_info.manufacturer, proc_info.cpu_name,
-+ cpu_id, cpu_rev, cpu_cfgid);
-+#if defined(CONFIG_AG101_CPU_FREQ_SCALING_MODE) || defined(CONFIG_AG101_CPU_FREQ_FCS)
-+ seq_printf(m, "MHz\t\t: %u\n", ag101_cpufreq_get(1) / 1000);
-+#endif
-+
-+ seq_printf(m, "L1I\t\t: %luKB/%luS/%luW/%luB\n",
-+ CACHE_SET(ICACHE) * CACHE_WAY(ICACHE) *
-+ CACHE_LINE_SIZE(ICACHE) / 1024, CACHE_SET(ICACHE),
-+ CACHE_WAY(ICACHE), CACHE_LINE_SIZE(ICACHE));
-+
-+ seq_printf(m, "L1D\t\t: %luKB/%luS/%luW/%luB\n",
-+ CACHE_SET(DCACHE) * CACHE_WAY(DCACHE) *
-+ CACHE_LINE_SIZE(DCACHE) / 1024, CACHE_SET(DCACHE),
-+ CACHE_WAY(DCACHE), CACHE_LINE_SIZE(DCACHE));
-+
-+#if defined(CONFIG_SMP)
-+ for_each_online_cpu(i) {
-+ seq_printf(m, "Processor\t: %d\n", i);
-+ seq_printf(m, "BogoMIPS\t: %lu.%02lu\n\n",
-+ per_cpu(cpu_data,
-+ i).loops_per_jiffy / (500000UL / HZ),
-+ (per_cpu(cpu_data, i).loops_per_jiffy /
-+ (5000UL / HZ)) % 100);
-+ }
-+#else /* CONFIG_SMP */
-+ seq_printf(m, "BogoMIPS\t: %lu.%02lu\n",
-+ loops_per_jiffy / (500000 / HZ),
-+ (loops_per_jiffy / (5000 / HZ)) % 100);
-+#endif
-+
-+ /* dump out the processor features */
-+ seq_puts(m, "Features\t: ");
-+
-+ for (i = 0; hwcap_str[i]; i++)
-+ if (elf_hwcap & (1 << i))
-+ seq_printf(m, "%s ", hwcap_str[i]);
-+
-+ seq_puts(m, "\n\n");
-+ seq_printf(m, "Hardware\t: %s\n", elf_platform);
-+
-+ return 0;
-+}
-+
-+static void *c_start(struct seq_file *m, loff_t * pos)
-+{
-+ return *pos < 1 ? (void *)1 : NULL;
-+}
-+
-+static void *c_next(struct seq_file *m, void *v, loff_t * pos)
-+{
-+ ++*pos;
-+ return NULL;
-+}
-+
-+static void c_stop(struct seq_file *m, void *v)
-+{
-+}
-+
-+struct seq_operations cpuinfo_op = {
-+ .start = c_start,
-+ .next = c_next,
-+ .stop = c_stop,
-+ .show = c_show
-+};
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/signal.c linux-3.4.113/arch/nds32/kernel/signal.c
---- linux-3.4.113.orig/arch/nds32/kernel/signal.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/signal.c 2016-12-01 20:59:27.776744798 +0100
-@@ -0,0 +1,850 @@
-+/*
-+ * linux/arch/nds32/kernel/signal.c
-+ *
-+ * Copyright (C) 1995-2002 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/errno.h>
-+#include <linux/signal.h>
-+#include <linux/ptrace.h>
-+#include <linux/personality.h>
-+#include <linux/freezer.h>
-+#include <linux/tracehook.h>
-+
-+#include <asm/cacheflush.h>
-+#include <asm/ucontext.h>
-+#include <asm/uaccess.h>
-+#include <asm/unistd.h>
-+#include <asm/fpu.h>
-+#include <asm/audio.h>
-+
-+#include "ptrace.h"
-+#include "signal.h"
-+#include "fpu.h"
-+#include "audio.h"
-+
-+#define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
-+
-+/*
-+ * For NDS32 syscalls, we encode the syscall number into the instruction.
-+ */
-+#if defined( __NDS32_EL__)
-+#define SWI_SYS_SIGRETURN (0xeb0e0a64)
-+#define SWI_SYS_RT_SIGRETURN (0xab150a64)
-+#define SWI_SYS_RESTART (0x0b000a64) /* syscall __NR_restart_syscall */
-+#define SWI_SYS_RESTART_LWIBI (0x0180af0d) /* lwi.bi $p0, [$sp], 4 */
-+#define SWI_SYS_RESTART_JRP0 (0x0068004a) /* jr $p0 */
-+#elif defined(__NDS32_EB__)
-+#define SWI_SYS_SIGRETURN (0x6400000b|(__NR_sigreturn<<5))
-+#define SWI_SYS_RT_SIGRETURN (0x6400000b|(__NR_rt_sigreturn<<5))
-+#define SWI_SYS_RESTART (0x640a000b) /* syscall __NR_restart_syscall */
-+#define SWI_SYS_RESTART_LWIBI (0x0daf8001) /* lwi.bi $p0, [$sp], 4 */
-+#define SWI_SYS_RESTART_JRP0 (0x4a006800) /* jr $p0 */
-+#else
-+#error "NDS32, but neither __NDS32_EB__, nor __NDS32_EL__???"
-+#endif
-+
-+#ifdef CONFIG_FPU
-+static struct fpu_struct init_fpuregs = {
-+ .fs_regs = {[0 ... 31] = sNAN32},
-+ .fd_regs = {[0 ... 15] = sNAN64},
-+ .fpcsr = FPCSR_INIT
-+};
-+#endif
-+#ifdef CONFIG_AUDIO
-+static struct audio_struct init_audioregs = {
-+ .auregs = {[0...31] = NAN32}
-+};
-+#endif
-+const unsigned long retcodes[2] = {
-+ SWI_SYS_SIGRETURN,
-+ SWI_SYS_RT_SIGRETURN
-+};
-+
-+const unsigned long syscall_restart_code[3] = {
-+ SWI_SYS_RESTART, /* syscall __NR_restart_syscall */
-+ SWI_SYS_RESTART_LWIBI, /* lwi.bi $p0, [$sp], 4 */
-+ SWI_SYS_RESTART_JRP0 /* jr $p0 */
-+};
-+
-+static int do_signal(sigset_t * oldset, struct pt_regs *regs, int syscall);
-+
-+/*
-+ * atomically swap in the new signal mask, and wait for a signal.
-+ */
-+asmlinkage int sys_sigsuspend(int restart, unsigned long oldmask,
-+ old_sigset_t mask, struct pt_regs *regs)
-+{
-+ sigset_t blocked;
-+
-+ mask &= _BLOCKABLE;
-+ current->saved_sigmask = current->blocked;
-+ siginitset(&blocked, mask);
-+ set_current_blocked(&blocked);
-+
-+ current->state = TASK_INTERRUPTIBLE;
-+ schedule();
-+ set_thread_flag(TIF_RESTORE_SIGMASK);
-+ return -ERESTARTNOHAND;
-+}
-+
-+asmlinkage int sys_rt_sigsuspend(sigset_t __user * unewset, size_t sigsetsize,
-+ struct pt_regs *regs)
-+{
-+ sigset_t newset;
-+
-+ /* XXX: Don't preclude handling different sized sigset_t's. */
-+ if (sigsetsize != sizeof(sigset_t))
-+ return -EINVAL;
-+
-+ if (copy_from_user(&newset, unewset, sizeof(newset)))
-+ return -EFAULT;
-+ sigdelsetmask(&newset, ~_BLOCKABLE);
-+ current->saved_sigmask = current->blocked;
-+ set_current_blocked(&newset);
-+ current->state = TASK_INTERRUPTIBLE;
-+ schedule();
-+ set_thread_flag(TIF_RESTORE_SIGMASK);
-+ return -ERESTARTNOHAND;
-+}
-+
-+asmlinkage int sys_sigaction(int sig, const struct old_sigaction __user * act,
-+ struct old_sigaction __user * oact)
-+{
-+ struct k_sigaction new_ka, old_ka;
-+ int ret;
-+
-+ if (act) {
-+ old_sigset_t mask;
-+ if (!access_ok(VERIFY_READ, act, sizeof(*act)) ||
-+ __get_user(new_ka.sa.sa_handler, &act->sa_handler) ||
-+ __get_user(new_ka.sa.sa_restorer, &act->sa_restorer)) {
-+
-+ return -EFAULT;
-+ }
-+ __get_user(new_ka.sa.sa_flags, &act->sa_flags);
-+ __get_user(mask, &act->sa_mask);
-+
-+ siginitset(&new_ka.sa.sa_mask, mask);
-+ }
-+
-+ ret = do_sigaction(sig, act ? &new_ka : NULL, oact ? &old_ka : NULL);
-+
-+ if (!ret && oact) {
-+
-+ if (!access_ok(VERIFY_WRITE, oact, sizeof(*oact)) ||
-+ __put_user(old_ka.sa.sa_handler, &oact->sa_handler) ||
-+ __put_user(old_ka.sa.sa_restorer, &oact->sa_restorer)) {
-+
-+ return -EFAULT;
-+ }
-+ __put_user(old_ka.sa.sa_flags, &oact->sa_flags);
-+ __put_user(old_ka.sa.sa_mask.sig[0], &oact->sa_mask);
-+ }
-+
-+ return ret;
-+}
-+
-+/*
-+ * Auxiliary signal frame. This saves stuff like FP state.
-+ * The layout of this structure is not part of the user ABI.
-+ */
-+struct aux_sigframe {
-+};
-+
-+/*
-+ * Do a signal return; undo the signal stack. These are aligned to 64-bit.
-+ */
-+struct sigframe {
-+ struct sigcontext sc;
-+ unsigned long extramask[_NSIG_WORDS - 1];
-+ unsigned long retcode;
-+ struct aux_sigframe aux __attribute__ ((aligned(8)));
-+};
-+
-+struct rt_sigframe {
-+ struct siginfo __user *pinfo;
-+ void __user *puc;
-+ struct siginfo info;
-+ struct ucontext uc;
-+ unsigned long retcode;
-+ struct aux_sigframe aux __attribute__ ((aligned(8)));
-+};
-+
-+#ifdef CONFIG_FPU
-+static inline int restore_sigcontext_fpu(struct pt_regs *regs,
-+ struct sigcontext __user * sc)
-+{
-+ struct task_struct *tsk = current;
-+ unsigned long used_math_flag;
-+ int ret = 0;
-+
-+ if (!(GET_FUCOP_EXIST() & FUCOP_EXIST_mskCP0ISFPU))
-+ return 0;
-+
-+ __get_user_error(used_math_flag, &sc->used_math_flag, ret);
-+
-+ if (!used_math_flag)
-+ return 0;
-+
-+ set_used_math();
-+
-+#ifdef CONFIG_UNLAZY_FPU
-+ clear_fpu(regs);
-+#else
-+ preempt_disable();
-+ if (current == last_task_used_math) {
-+ last_task_used_math = NULL;
-+ release_fpu(regs);
-+ }
-+ preempt_enable();
-+#endif
-+
-+ return __copy_from_user(&tsk->thread.fpu, &sc->fpu,
-+ sizeof(struct fpu_struct));
-+}
-+
-+static inline int setup_sigcontext_fpu(struct pt_regs *regs,
-+ struct sigcontext __user * sc)
-+{
-+ struct task_struct *tsk = current;
-+ int ret = 0;
-+
-+ if (!(GET_FUCOP_EXIST() & FUCOP_EXIST_mskCP0ISFPU))
-+ return 0;
-+
-+ __put_user_error(used_math(), &sc->used_math_flag, ret);
-+
-+ if (!used_math())
-+ return ret;
-+
-+ preempt_disable();
-+#ifdef CONFIG_UNLAZY_FPU
-+ unlazy_fpu(tsk);
-+#else
-+ if (last_task_used_math != NULL)
-+ save_fpu(last_task_used_math);
-+#endif
-+ ret = __copy_to_user(&sc->fpu, &tsk->thread.fpu,
-+ sizeof(struct fpu_struct));
-+
-+ grab_fpu(task_pt_regs(tsk));
-+ fpload(&init_fpuregs);
-+#ifndef CONFIG_UNLAZY_FPU //Lazy FPU
-+ last_task_used_math = current;
-+#endif
-+ preempt_enable();
-+ return ret;
-+}
-+#else
-+static inline int
-+restore_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user * sc)
-+{
-+ return 0;
-+}
-+
-+static inline int
-+setup_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user * sc)
-+{
-+ return 0;
-+}
-+#endif /* CONFIG_FPU */
-+
-+#ifdef CONFIG_AUDIO
-+static inline int restore_sigcontext_audio(struct pt_regs *regs,
-+ struct sigcontext __user * sc)
-+{
-+ struct task_struct *tsk = current;
-+ unsigned long used_audio_flag;
-+ int ret = 0;
-+
-+ if (!(GET_MSC_CFG() & MSC_CFG_mskAUDIO))
-+ return 0;
-+
-+ __get_user_error(used_audio_flag, &sc->used_audio_flag, ret);
-+
-+ if (!used_audio_flag)
-+ return 0;
-+
-+ set_tsk_thread_flag(tsk, TIF_USEDAUDIO);
-+#ifdef CONFIG_UNLAZY_AUDIO
-+ clear_audio(regs);
-+#else
-+ preempt_disable();
-+ if (current == last_task_used_audio) {
-+ last_task_used_audio = NULL;
-+ clear_audio(regs);
-+ }
-+ preempt_enable();
-+#endif
-+
-+ return __copy_from_user(&tsk->thread.audio, &sc->audio,
-+ sizeof(struct audio_struct));
-+}
-+
-+static inline int setup_sigcontext_audio(struct pt_regs *regs,
-+ struct sigcontext __user * sc)
-+{
-+ struct task_struct *tsk = current;
-+ int ret = 0;
-+
-+ if (!(GET_MSC_CFG() & MSC_CFG_mskAUDIO))
-+ return 0;
-+
-+ __put_user_error(test_tsk_thread_flag(tsk, TIF_USEDAUDIO),
-+ &sc->used_audio_flag, ret);
-+
-+ if (!test_tsk_thread_flag(tsk, TIF_USEDAUDIO))
-+ return ret;
-+
-+ preempt_disable();
-+#ifdef CONFIG_UNLAZY_AUDIO
-+ unlazy_audio(tsk);
-+#else
-+ if (NULL != last_task_used_audio) {
-+ save_audio(tsk);
-+ }
-+#endif
-+ ret = __copy_to_user(&sc->audio, &tsk->thread.audio,
-+ sizeof(struct audio_struct));
-+
-+ grab_audio(task_pt_regs(tsk));
-+ audioload(&init_audioregs);
-+#ifndef CONFIG_UNLAZY_AUDIO //Lazy audio
-+ last_task_used_audio = current;
-+#endif
-+ preempt_enable();
-+ return ret;
-+}
-+#else /*CONFIG_AUDIO */
-+static inline int
-+restore_sigcontext_audio(struct pt_regs *regs, struct sigcontext __user * sc)
-+{
-+ return 0;
-+}
-+
-+static inline int
-+setup_sigcontext_audio(struct pt_regs *regs, struct sigcontext __user * sc)
-+{
-+ return 0;
-+}
-+#endif
-+
-+static int restore_sigcontext(struct pt_regs *regs,
-+ struct sigcontext __user * sc,
-+ struct aux_sigframe __user * aux)
-+{
-+ int err = 0;
-+
-+ __get_user_error(regs->NDS32_r0, &sc->nds32_r0, err);
-+ __get_user_error(regs->NDS32_r1, &sc->nds32_r1, err);
-+ __get_user_error(regs->NDS32_r2, &sc->nds32_r2, err);
-+ __get_user_error(regs->NDS32_r3, &sc->nds32_r3, err);
-+ __get_user_error(regs->NDS32_r4, &sc->nds32_r4, err);
-+ __get_user_error(regs->NDS32_r5, &sc->nds32_r5, err);
-+ __get_user_error(regs->NDS32_r6, &sc->nds32_r6, err);
-+ __get_user_error(regs->NDS32_r7, &sc->nds32_r7, err);
-+ __get_user_error(regs->NDS32_r8, &sc->nds32_r8, err);
-+ __get_user_error(regs->NDS32_r9, &sc->nds32_r9, err);
-+ __get_user_error(regs->NDS32_r10, &sc->nds32_r10, err);
-+ __get_user_error(regs->NDS32_r11, &sc->nds32_r11, err);
-+ __get_user_error(regs->NDS32_r12, &sc->nds32_r12, err);
-+ __get_user_error(regs->NDS32_r13, &sc->nds32_r13, err);
-+ __get_user_error(regs->NDS32_r14, &sc->nds32_r14, err);
-+ __get_user_error(regs->NDS32_r15, &sc->nds32_r15, err);
-+ __get_user_error(regs->NDS32_r16, &sc->nds32_r16, err);
-+ __get_user_error(regs->NDS32_r17, &sc->nds32_r17, err);
-+ __get_user_error(regs->NDS32_r18, &sc->nds32_r18, err);
-+ __get_user_error(regs->NDS32_r19, &sc->nds32_r19, err);
-+ __get_user_error(regs->NDS32_r20, &sc->nds32_r20, err);
-+
-+ __get_user_error(regs->NDS32_r21, &sc->nds32_r21, err);
-+ __get_user_error(regs->NDS32_r22, &sc->nds32_r22, err);
-+ __get_user_error(regs->NDS32_r23, &sc->nds32_r23, err);
-+ __get_user_error(regs->NDS32_r24, &sc->nds32_r24, err);
-+ __get_user_error(regs->NDS32_r25, &sc->nds32_r25, err);
-+ __get_user_error(regs->NDS32_fp, &sc->nds32_fp, err);
-+ __get_user_error(regs->NDS32_gp, &sc->nds32_gp, err);
-+ __get_user_error(regs->NDS32_lp, &sc->nds32_lp, err);
-+ __get_user_error(regs->NDS32_sp, &sc->nds32_sp, err);
-+
-+ __get_user_error(regs->NDS32_ipc, &sc->nds32_ipc, err);
-+#if defined(CONFIG_HWZOL)
-+ __get_user_error(regs->NDS32_lc, &sc->zol.nds32_lc, err);
-+ __get_user_error(regs->NDS32_le, &sc->zol.nds32_le, err);
-+ __get_user_error(regs->NDS32_lb, &sc->zol.nds32_lb, err);
-+#endif
-+
-+ err |= !valid_user_regs(regs);
-+ err |= restore_sigcontext_audio(regs, sc);
-+ err |= restore_sigcontext_fpu(regs, sc);
-+
-+ return err;
-+}
-+
-+asmlinkage int sys_sigreturn(struct pt_regs *regs)
-+{
-+ struct sigframe __user *frame;
-+ sigset_t set;
-+
-+ /* Always make any pending restarted system calls return -EINTR */
-+ current_thread_info()->restart_block.fn = do_no_restart_syscall;
-+
-+ /*
-+ * Since we stacked the signal on a 64-bit boundary,
-+ * then 'sp' should be word aligned here. If it's
-+ * not, then the user is trying to mess with us.
-+ */
-+ if (regs->NDS32_sp & 7)
-+ goto badframe;
-+
-+ frame = (struct sigframe __user *)regs->NDS32_sp;
-+
-+ if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
-+ goto badframe;
-+
-+ if (__get_user(set.sig[0], &frame->sc.oldmask)
-+ || (_NSIG_WORDS > 1
-+ && __copy_from_user(&set.sig[1], &frame->extramask,
-+ sizeof(frame->extramask))))
-+ goto badframe;
-+
-+ sigdelsetmask(&set, ~_BLOCKABLE);
-+ spin_lock_irq(&current->sighand->siglock);
-+ current->blocked = set;
-+ recalc_sigpending();
-+ spin_unlock_irq(&current->sighand->siglock);
-+
-+ if (restore_sigcontext(regs, &frame->sc, &frame->aux))
-+ goto badframe;
-+
-+ return regs->NDS32_r0;
-+
-+badframe:
-+ force_sig(SIGSEGV, current);
-+ return 0;
-+}
-+
-+asmlinkage int sys_rt_sigreturn(struct pt_regs *regs)
-+{
-+ struct rt_sigframe __user *frame;
-+ sigset_t set;
-+
-+ /* Always make any pending restarted system calls return -EINTR */
-+ current_thread_info()->restart_block.fn = do_no_restart_syscall;
-+
-+ /*
-+ * Since we stacked the signal on a 64-bit boundary,
-+ * then 'sp' should be word aligned here. If it's
-+ * not, then the user is trying to mess with us.
-+ */
-+ if (regs->NDS32_sp & 7)
-+ goto badframe;
-+
-+ frame = (struct rt_sigframe __user *)regs->NDS32_sp;
-+
-+ if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
-+ goto badframe;
-+
-+ if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
-+ goto badframe;
-+
-+ sigdelsetmask(&set, ~_BLOCKABLE);
-+ spin_lock_irq(&current->sighand->siglock);
-+ current->blocked = set;
-+ recalc_sigpending();
-+ spin_unlock_irq(&current->sighand->siglock);
-+
-+ if (restore_sigcontext(regs, &frame->uc.uc_mcontext, &frame->aux))
-+ goto badframe;
-+
-+ if (do_sigaltstack(&frame->uc.uc_stack, NULL, regs->NDS32_sp) ==
-+ -EFAULT)
-+ goto badframe;
-+
-+ return regs->NDS32_r0;
-+
-+badframe:
-+ force_sig(SIGSEGV, current);
-+ return 0;
-+}
-+
-+static int setup_sigcontext(struct sigcontext __user * sc,
-+ struct aux_sigframe __user * aux,
-+ struct pt_regs *regs, unsigned long mask)
-+{
-+ int err = 0;
-+
-+ err |= setup_sigcontext_fpu(regs, sc);
-+ err |= setup_sigcontext_audio(regs, sc);
-+
-+ __put_user_error(regs->NDS32_r0, &sc->nds32_r0, err);
-+ __put_user_error(regs->NDS32_r1, &sc->nds32_r1, err);
-+ __put_user_error(regs->NDS32_r2, &sc->nds32_r2, err);
-+ __put_user_error(regs->NDS32_r3, &sc->nds32_r3, err);
-+ __put_user_error(regs->NDS32_r4, &sc->nds32_r4, err);
-+ __put_user_error(regs->NDS32_r5, &sc->nds32_r5, err);
-+ __put_user_error(regs->NDS32_r6, &sc->nds32_r6, err);
-+ __put_user_error(regs->NDS32_r7, &sc->nds32_r7, err);
-+ __put_user_error(regs->NDS32_r8, &sc->nds32_r8, err);
-+ __put_user_error(regs->NDS32_r9, &sc->nds32_r9, err);
-+ __put_user_error(regs->NDS32_r10, &sc->nds32_r10, err);
-+ __put_user_error(regs->NDS32_r11, &sc->nds32_r11, err);
-+ __put_user_error(regs->NDS32_r12, &sc->nds32_r12, err);
-+ __put_user_error(regs->NDS32_r13, &sc->nds32_r13, err);
-+ __put_user_error(regs->NDS32_r14, &sc->nds32_r14, err);
-+ __put_user_error(regs->NDS32_r15, &sc->nds32_r15, err);
-+ __put_user_error(regs->NDS32_r16, &sc->nds32_r16, err);
-+ __put_user_error(regs->NDS32_r17, &sc->nds32_r17, err);
-+ __put_user_error(regs->NDS32_r18, &sc->nds32_r18, err);
-+ __put_user_error(regs->NDS32_r19, &sc->nds32_r19, err);
-+ __put_user_error(regs->NDS32_r20, &sc->nds32_r20, err);
-+
-+ __put_user_error(regs->NDS32_r21, &sc->nds32_r21, err);
-+ __put_user_error(regs->NDS32_r22, &sc->nds32_r22, err);
-+ __put_user_error(regs->NDS32_r23, &sc->nds32_r23, err);
-+ __put_user_error(regs->NDS32_r24, &sc->nds32_r24, err);
-+ __put_user_error(regs->NDS32_r25, &sc->nds32_r25, err);
-+ __put_user_error(regs->NDS32_fp, &sc->nds32_fp, err);
-+ __put_user_error(regs->NDS32_gp, &sc->nds32_gp, err);
-+ __put_user_error(regs->NDS32_lp, &sc->nds32_lp, err);
-+ __put_user_error(regs->NDS32_sp, &sc->nds32_sp, err);
-+ __put_user_error(regs->NDS32_ipc, &sc->nds32_ipc, err);
-+#if defined(CONFIG_HWZOL)
-+ __get_user_error(regs->NDS32_lc, &sc->zol.nds32_lc, err);
-+ __get_user_error(regs->NDS32_le, &sc->zol.nds32_le, err);
-+ __get_user_error(regs->NDS32_lb, &sc->zol.nds32_lb, err);
-+#endif
-+
-+ __put_user_error(current->thread.trap_no, &sc->trap_no, err);
-+ __put_user_error(current->thread.error_code, &sc->error_code, err);
-+ __put_user_error(current->thread.address, &sc->fault_address, err);
-+ __put_user_error(mask, &sc->oldmask, err);
-+
-+ return err;
-+}
-+
-+static inline void __user *get_sigframe(struct k_sigaction *ka,
-+ struct pt_regs *regs, int framesize)
-+{
-+ unsigned long sp = regs->NDS32_sp;
-+ void __user *frame;
-+
-+ /*
-+ * This is the X/Open sanctioned signal stack switching.
-+ */
-+ if ((ka->sa.sa_flags & SA_ONSTACK) && !sas_ss_flags(sp))
-+ sp = current->sas_ss_sp + current->sas_ss_size;
-+
-+ /*
-+ * ATPCS B01 mandates 8-byte alignment
-+ */
-+ frame = (void __user *)((sp - framesize) & ~7);
-+
-+ /*
-+ * Check that we can actually write to the signal frame.
-+ */
-+ if (!access_ok(VERIFY_WRITE, frame, framesize))
-+ frame = NULL;
-+
-+ return frame;
-+}
-+
-+static int setup_return(struct pt_regs *regs, struct k_sigaction *ka,
-+ unsigned long __user * rc, void __user * frame,
-+ int usig)
-+{
-+ unsigned long handler = (unsigned long)ka->sa.sa_handler;
-+ unsigned long retcode;
-+ struct sigframe *sf = (struct sigframe *)frame;
-+
-+ /*
-+ * Maybe we need to deliver a 32-bit signal to a 26-bit task.
-+ */
-+ if (ka->sa.sa_flags & SA_RESTORER) {
-+ retcode = (unsigned long)ka->sa.sa_restorer;
-+ } else {
-+
-+ unsigned int idx = 0; //thumb;
-+ unsigned long line_size = CACHE_LINE_SIZE(ICACHE);
-+ unsigned long start, end;
-+
-+ if (ka->sa.sa_flags & SA_SIGINFO)
-+ idx++;
-+
-+ if (__put_user(retcodes[idx], rc))
-+ return 1;
-+
-+ /*
-+ * Ensure that the instruction cache sees
-+ * the return code written onto the stack.
-+ */
-+ start = (unsigned long)rc & ~(line_size - 1);
-+ end = start + line_size;
-+ flush_icache_range(start, end);
-+
-+ retcode = KERN_SIGRETURN_CODE + (idx << 2);
-+ }
-+
-+ regs->NDS32_r0 = usig;
-+ regs->NDS32_r1 = 0;
-+ regs->NDS32_r2 = (unsigned long)&sf->sc;
-+ regs->NDS32_sp = (unsigned long)frame;
-+ regs->NDS32_lp = retcode;
-+ regs->NDS32_ipc = handler;
-+ /* Also store handler address in r15 for updating GP in the handler. */
-+ regs->NDS32_r15 = handler;
-+
-+ return 0;
-+}
-+
-+static int setup_frame(int usig, struct k_sigaction *ka, sigset_t * set,
-+ struct pt_regs *regs)
-+{
-+ struct sigframe __user *frame = get_sigframe(ka, regs, sizeof(*frame));
-+ int err = 0;
-+
-+ if (!frame)
-+ return 1;
-+
-+ err |= setup_sigcontext(&frame->sc, &frame->aux, regs, set->sig[0]);
-+
-+ if (_NSIG_WORDS > 1) {
-+ err |= __copy_to_user(frame->extramask, &set->sig[1],
-+ sizeof(frame->extramask));
-+ }
-+
-+ if (err == 0)
-+ err = setup_return(regs, ka, &frame->retcode, frame, usig);
-+
-+ return err;
-+}
-+
-+static int setup_rt_frame(int usig, struct k_sigaction *ka, siginfo_t * info,
-+ sigset_t * set, struct pt_regs *regs)
-+{
-+ struct rt_sigframe __user *frame =
-+ get_sigframe(ka, regs, sizeof(*frame));
-+ stack_t stack;
-+ int err = 0;
-+
-+ if (!frame)
-+ return 1;
-+
-+ __put_user_error(&frame->info, &frame->pinfo, err);
-+ __put_user_error(&frame->uc, &frame->puc, err);
-+ err |= copy_siginfo_to_user(&frame->info, info);
-+
-+ __put_user_error(0, &frame->uc.uc_flags, err);
-+ __put_user_error(NULL, &frame->uc.uc_link, err);
-+
-+ memset(&stack, 0, sizeof(stack));
-+ stack.ss_sp = (void __user *)current->sas_ss_sp;
-+ stack.ss_flags = sas_ss_flags(regs->NDS32_sp); //NDS32_sp
-+ stack.ss_size = current->sas_ss_size;
-+ err |= __copy_to_user(&frame->uc.uc_stack, &stack, sizeof(stack));
-+
-+ err |= setup_sigcontext(&frame->uc.uc_mcontext, &frame->aux,
-+ regs, set->sig[0]);
-+ err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
-+
-+ if (err == 0)
-+ err = setup_return(regs, ka, &frame->retcode, frame, usig);
-+
-+ if (err == 0) {
-+ /*
-+ * For realtime signals we must also set the second and third
-+ * arguments for the signal handler.
-+ * -- Peter Maydell <pmaydell@chiark.greenend.org.uk> 2000-12-06
-+ */
-+ regs->NDS32_r1 = (unsigned long)&frame->info;
-+ regs->NDS32_r2 = (unsigned long)&frame->uc;
-+ }
-+
-+ return err;
-+}
-+
-+static inline void setup_restart_syscall(struct pt_regs *regs)
-+{
-+ regs->NDS32_r0 = regs->NDS32_ORIG_r0;
-+ regs->NDS32_ipc -= 4;
-+}
-+
-+/*
-+ * OK, we're invoking a handler
-+ */
-+static void handle_signal(unsigned long sig, struct k_sigaction *ka,
-+ siginfo_t * info, sigset_t * oldset,
-+ struct pt_regs *regs, int syscall)
-+{
-+ struct thread_info *thread = current_thread_info();
-+ struct task_struct *tsk = current;
-+ int usig = sig;
-+ int ret;
-+
-+ /*
-+ * If we were from a system call, check for system call restarting...
-+ */
-+ if (syscall) {
-+ switch (regs->NDS32_r0) {
-+ case -ERESTART_RESTARTBLOCK:
-+ case -ERESTARTNOHAND:
-+ regs->NDS32_r0 = -EINTR;
-+ break;
-+ case -ERESTARTSYS:
-+ if (!(ka->sa.sa_flags & SA_RESTART)) {
-+ regs->NDS32_r0 = -EINTR;
-+ break;
-+ }
-+ /* fallthrough */
-+ case -ERESTARTNOINTR:
-+ setup_restart_syscall(regs);
-+ }
-+ }
-+
-+ /*
-+ * translate the signal
-+ */
-+ if (usig < 32 && thread->exec_domain
-+ && thread->exec_domain->signal_invmap)
-+ usig = thread->exec_domain->signal_invmap[usig];
-+
-+ /*
-+ * Set up the stack frame
-+ */
-+ if (ka->sa.sa_flags & SA_SIGINFO)
-+ ret = setup_rt_frame(usig, ka, info, oldset, regs);
-+ else
-+ ret = setup_frame(usig, ka, oldset, regs);
-+
-+ /*
-+ * Check that the resulting registers are actually sane.
-+ */
-+ ret |= !valid_user_regs(regs);
-+
-+ /*
-+ * Block the signal if we were unsuccessful.
-+ */
-+ if (ret == 0) {
-+ spin_lock_irq(&tsk->sighand->siglock);
-+ sigorsets(&tsk->blocked, &tsk->blocked, &ka->sa.sa_mask);
-+ if (!(ka->sa.sa_flags & SA_NODEFER))
-+ sigaddset(&tsk->blocked, sig);
-+ recalc_sigpending();
-+ spin_unlock_irq(&tsk->sighand->siglock);
-+#if 0 & defined(CONFIG_HSS)
-+ /* COLE: i marked this tempory.
-+ It doesn't behave the same as x86 */
-+ /* Clear HSS when entering the signal handler,
-+ User should be step into signal handler */
-+ if (regs->NDS32_ipsw & PSW_mskHSS) {
-+ regs->NDS32_ipsw &= ~PSW_mskHSS;
-+ printk(KERN_INFO "clear for sig %d. pc=0x%08x\n", sig,
-+ regs->NDS32_ipc);
-+ }
-+#endif
-+ return;
-+ }
-+
-+ force_sigsegv(sig, tsk);
-+}
-+
-+/*
-+ * Note that 'init' is a special process: it doesn't get signals it doesn't
-+ * want to handle. Thus you cannot kill init even with a SIGKILL even by
-+ * mistake.
-+ *
-+ * Note that we go through the signals twice: once to check the signals that
-+ * the kernel can handle, and then we build all the user-level signal handling
-+ * stack-frames in one go after that.
-+ */
-+asmlinkage int do_signal(sigset_t * oldset, struct pt_regs *regs, int syscall)
-+{
-+ struct k_sigaction ka;
-+ siginfo_t info;
-+ int signr;
-+
-+ /*
-+ * We want the common case to go fast, which
-+ * is why we may in certain cases get here from
-+ * kernel mode. Just return without doing anything
-+ * if so.
-+ */
-+
-+ if (!user_mode(regs))
-+ return 0;
-+
-+ if (try_to_freeze())
-+ goto no_signal;
-+
-+ if (test_thread_flag(TIF_RESTORE_SIGMASK))
-+ oldset = &current->saved_sigmask;
-+
-+ signr = get_signal_to_deliver(&info, &ka, regs, NULL);
-+
-+ if (signr > 0) {
-+ handle_signal(signr, &ka, &info, oldset, regs, syscall);
-+ /*
-+ * A signal was successfully delivered; the saved
-+ * sigmask will have been stored in the signal frame,
-+ * and will be restored by sigreturn, so we can simply
-+ * clear the TIF_RESTORE_SIGMASK flag.
-+ */
-+ if (test_thread_flag(TIF_RESTORE_SIGMASK))
-+ clear_thread_flag(TIF_RESTORE_SIGMASK);
-+ return 1;
-+ }
-+
-+no_signal:
-+ /*
-+ * No signal to deliver to the process - restart the syscall.
-+ */
-+ if (syscall) {
-+ switch (regs->NDS32_r0) {
-+ u32 __user *usp;
-+
-+ case -ERESTART_RESTARTBLOCK:
-+ regs->NDS32_sp -= 4;
-+ usp = (u32 __user *) regs->NDS32_sp;
-+
-+ if (put_user(regs->NDS32_ipc, usp) == 0)
-+ regs->NDS32_ipc = KERN_RESTART_CODE;
-+ else {
-+ regs->NDS32_sp += 4;
-+ force_sigsegv(0, current);
-+ }
-+ regs->NDS32_r0 = regs->NDS32_ORIG_r0;
-+ break;
-+
-+ case -ERESTARTNOHAND:
-+ case -ERESTARTSYS:
-+ case -ERESTARTNOINTR:
-+
-+ setup_restart_syscall(regs);
-+ break;
-+ }
-+ if (test_thread_flag(TIF_RESTORE_SIGMASK)) {
-+ clear_thread_flag(TIF_RESTORE_SIGMASK);
-+ sigprocmask(SIG_SETMASK, &current->saved_sigmask, NULL);
-+ }
-+ }
-+
-+ return 0;
-+}
-+
-+asmlinkage void do_notify_resume(struct pt_regs *regs,
-+ unsigned int thread_flags, int syscall)
-+{
-+ if (thread_flags & _TIF_SIGPENDING)
-+ do_signal(&current->blocked, regs, syscall);
-+ if (thread_flags & _TIF_NOTIFY_RESUME) {
-+ clear_thread_flag(TIF_NOTIFY_RESUME);
-+ tracehook_notify_resume(regs);
-+ if (current->replacement_session_keyring)
-+ key_replace_session_keyring();
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/signal.h linux-3.4.113/arch/nds32/kernel/signal.h
---- linux-3.4.113.orig/arch/nds32/kernel/signal.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/signal.h 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,20 @@
-+/*
-+ * linux/arch/arm/kernel/signal.h
-+ *
-+ * Copyright (C) 2005-2009 Russell King.
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <asm/fixmap.h>
-+
-+#define RETURN_SYSCALL_BASE (0x2000)
-+#define RETURN_SYSCALL_PA_BASE (PHYS_OFFSET | RETURN_SYSCALL_BASE)
-+
-+#define KERN_SIGRETURN_CODE (fix_to_virt(FIX_RETURN_SYSCALL))
-+#define KERN_RESTART_CODE (KERN_SIGRETURN_CODE + sizeof(retcodes))
-+
-+extern const unsigned long retcodes[2];
-+extern const unsigned long syscall_restart_code[3];
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/smp.c linux-3.4.113/arch/nds32/kernel/smp.c
---- linux-3.4.113.orig/arch/nds32/kernel/smp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/smp.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,335 @@
-+/*
-+ * linux/arch/nds32/kernel/smp.c
-+ *
-+ * Copyright (C) 2002 ARM Limited, All Rights Reserved.
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/delay.h>
-+#include <linux/init.h>
-+#include <linux/spinlock.h>
-+#include <linux/sched.h>
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/cache.h>
-+#include <linux/profile.h>
-+#include <linux/errno.h>
-+#include <linux/mm.h>
-+#include <linux/cpu.h>
-+#include <linux/smp.h>
-+#include <linux/seq_file.h>
-+#include <asm/atomic.h>
-+#include <asm/cacheflush.h>
-+#include <asm/cpu.h>
-+#include <asm/processor.h>
-+#include <asm/tlbflush.h>
-+#include <asm/ptrace.h>
-+#include <linux/err.h>
-+#include <asm/irq_regs.h>
-+#include <asm/mmu_context.h>
-+#include <asm/mmu.h>
-+
-+void smp_init_cpus(void)
-+{
-+ int i;
-+ for (i = 0; i < NR_CPUS; i++)
-+ cpu_set(i, cpu_possible_map);
-+}
-+
-+int setup_profiling_timer(unsigned int multiplier)
-+{
-+ return 0;
-+}
-+
-+struct tlb_data {
-+ struct vm_area_struct *vma;
-+ unsigned long start;
-+ unsigned long end;
-+};
-+
-+static void ipi_flush_tlb_all(void *data)
-+{
-+ local_flush_tlb_all();
-+}
-+
-+void flush_tlb_all(void)
-+{
-+ on_each_cpu(ipi_flush_tlb_all, NULL, 1);
-+}
-+
-+static void ipi_flush_tlb_mm(void *data)
-+{
-+ struct mm_struct *mm = (struct mm_struct *)data;
-+ local_flush_tlb_mm(mm);
-+}
-+
-+void flush_tlb_mm(struct mm_struct *mm)
-+{
-+ on_each_cpu(ipi_flush_tlb_mm, mm, 1);
-+}
-+
-+static void ipi_flush_tlb_page(void *data)
-+{
-+ struct tlb_data *t = (struct tlb_data *)data;
-+ local_flush_tlb_page(t->vma, t->start);
-+}
-+
-+void flush_tlb_page(struct vm_area_struct *vma, unsigned long addr)
-+{
-+ struct tlb_data data;
-+
-+ data.vma = vma;
-+ data.start = addr;
-+ on_each_cpu(ipi_flush_tlb_page, &data, 1);
-+}
-+
-+static void ipi_flush_tlb_range(void *data)
-+{
-+ struct tlb_data *t = (struct tlb_data *)data;
-+ local_flush_tlb_range(t->vma, t->start, t->end);
-+}
-+
-+void flush_tlb_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end)
-+{
-+ struct tlb_data data;
-+
-+ data.vma = vma;
-+ data.start = start;
-+ data.end = end;
-+ on_each_cpu(ipi_flush_tlb_range, &data, 1);
-+}
-+
-+static void ipi_flush_tlb_kernel_range(void *data)
-+{
-+ struct tlb_data *t = (struct tlb_data *)data;
-+ local_flush_tlb_kernel_range(t->start, t->end);
-+}
-+
-+void flush_tlb_kernel_range(unsigned long start, unsigned long end)
-+{
-+ struct tlb_data data;
-+
-+ data.start = start;
-+ data.end = end;
-+ on_each_cpu(ipi_flush_tlb_kernel_range, &data, 1);
-+}
-+
-+/* IPI implementation */
-+static inline unsigned long read_ipi_trigger(void)
-+{
-+ /* AMIC IPI trigger register */
-+ return *(volatile unsigned long *)(AMIC_VA_BASE + 0x40);
-+}
-+
-+static inline void write_ipi_trigger(const struct cpumask *mask)
-+{
-+ unsigned long data = *cpus_addr(*mask);
-+ *(volatile unsigned long *)(AMIC_VA_BASE + 0x40) = data;
-+}
-+
-+static inline void clear_ipi_status(void)
-+{
-+ *(volatile unsigned long *)(AMIC_VA_BASE + 0x44) = 0xf;
-+ asm("msync store\nisb");
-+}
-+
-+static void __init send_IPI_boot(int cpu, struct task_struct *tsk)
-+{
-+ extern void secondary_startup(void);
-+ unsigned long *ptr = (unsigned long *)(0xc0006000 + (cpu << 9));
-+ ptr[5] = virt_to_phys(secondary_startup);
-+ ptr[6] = (unsigned long)task_stack_page(tsk) + THREAD_SIZE - 8;
-+ asm("cctl %0, L1D_VA_WB, alevel\n"::"r"(ptr));
-+ asm("cctl %0, L1D_VA_INVAL, alevel\nmsync\ndsb\n"::"r"(ptr));
-+ write_ipi_trigger(get_cpu_mask(cpu));
-+}
-+
-+static int __init wait_cpu_boot_done(int cpu)
-+{
-+ int i, state;
-+ for (i = 0; i < 10000; i++) {
-+ state = read_ipi_trigger();
-+ if ((state & (1 << cpu)) == 0)
-+ break;
-+ udelay(100);
-+ }
-+ return (i == 10000) ? -1 : 0;
-+}
-+
-+void __init secondary_start_kernel(void)
-+{
-+ unsigned long tmp;
-+ unsigned int cpu = smp_processor_id();
-+
-+ atomic_inc(&init_mm.mm_count);
-+ current->active_mm = &init_mm;
-+
-+ /*
-+ * enable cache.
-+ */
-+
-+#ifdef CONFIG_ANDES_PAGE_SIZE_4KB
-+ if (CPU_IS_N1213_43U1HA0()) {
-+ /* Downsize cache to bypass cache aliasing issue */
-+
-+ if ((CACHE_SET(ICACHE) * CACHE_LINE_SIZE(ICACHE)) > 4096)
-+ tmp = 0x02 << SDZ_CTL_offICDZ;
-+
-+ if ((CACHE_SET(DCACHE) * CACHE_LINE_SIZE(DCACHE)) > 4096)
-+ tmp |= 0x02 << SDZ_CTL_offDCDZ;
-+
-+ SET_SDZ_CTL(tmp);
-+ ISB();
-+// printk("CPU%d enabled cache downsizing.\n", cpu);
-+ }
-+#endif /* CONFIG_ANDES_PAGE_SIZE_4KB */
-+
-+ tmp = GET_CACHE_CTL();
-+#ifndef CONFIG_CPU_DCACHE_DISABLE
-+ tmp |= CACHE_CTL_mskDC_EN;
-+#endif
-+
-+#ifndef CONFIG_CPU_ICACHE_DISABLE
-+ tmp |= CACHE_CTL_mskIC_EN;
-+#endif
-+ SET_CACHE_CTL(tmp);
-+ DSB();
-+ ISB();
-+
-+ preempt_disable();
-+ local_irq_enable();
-+
-+ //assume all of cores runs the same speed
-+ //calibrate_delay();
-+ /* store cpu info ot the second cpu */
-+ smp_store_cpu_info(cpu);
-+
-+ clear_ipi_status();
-+ cpu_idle();
-+}
-+
-+/*
-+ * Called by both boot and secondaries to move global data into
-+ * per-processor storage.
-+ */
-+void __init smp_store_cpu_info(unsigned int cpuid)
-+{
-+ struct cpuinfo_nds32 *cpu_info = &per_cpu(cpu_data, cpuid);
-+
-+ cpu_info->loops_per_jiffy = loops_per_jiffy;
-+}
-+
-+/* functions be used by generic layer */
-+void arch_send_call_function_single_ipi(int cpu)
-+{
-+ write_ipi_trigger(get_cpu_mask(cpu));
-+}
-+
-+void arch_send_call_function_ipi_mask(const struct cpumask *mask)
-+{
-+ write_ipi_trigger(mask);
-+}
-+
-+static void __init smp_boot_one_cpu(int cpu)
-+{
-+ struct task_struct *idle;
-+ int ret;
-+
-+ idle = fork_idle(cpu);
-+ if (IS_ERR(idle))
-+ panic(KERN_ERR "Fork failed for CPU %d", cpu);
-+
-+ send_IPI_boot(cpu, idle);
-+ ret = wait_cpu_boot_done(cpu);
-+ if (ret == 0)
-+ cpu_set(cpu, cpu_online_map);
-+ else
-+ put_task_struct(idle);
-+}
-+
-+static void ipi_timer(void *data)
-+{
-+ profile_tick(CPU_PROFILING);
-+ update_process_times(user_mode(get_irq_regs()));
-+}
-+
-+void smp_send_timer(void)
-+{
-+ smp_call_function(ipi_timer, NULL, 0);
-+}
-+
-+static void ipi_stop(void *data)
-+{
-+ cpu_clear(smp_processor_id(), cpu_online_map);
-+ local_irq_enable();
-+ for (;;) ;
-+}
-+
-+void smp_send_stop(void)
-+{
-+ smp_call_function(ipi_stop, NULL, 0);
-+}
-+
-+void smp_send_reschedule(int cpu)
-+{
-+ write_ipi_trigger(get_cpu_mask(cpu));
-+}
-+
-+static void ipi_handler(unsigned int irq, struct irq_desc *desc)
-+{
-+ clear_ipi_status();
-+ generic_smp_call_function_single_interrupt();
-+ generic_smp_call_function_interrupt();
-+}
-+
-+void __init smp_prepare_cpus(unsigned int max_cpus)
-+{
-+ /*
-+ * XXX detect how many cores exist
-+ */
-+ int i;
-+ unsigned int cpu = smp_processor_id();
-+
-+ /* store master core cpu info */
-+ smp_store_cpu_info(cpu);
-+ for (i = 0; i < max_cpus; i++)
-+ cpu_set(i, cpu_present_map);
-+
-+ /* setup IPI handler */
-+ set_irq_chip(32, &dummy_irq_chip);
-+ set_irq_chained_handler(32, ipi_handler);
-+}
-+
-+int __cpuinit __cpu_up(unsigned int cpu)
-+{
-+ smp_boot_one_cpu(cpu);
-+ return cpu_online(cpu) ? 0 : -ENOSYS;
-+}
-+
-+void __init smp_cpus_done(unsigned int max_cpus)
-+{
-+ int cpu;
-+ unsigned long bogosum = 0;
-+
-+ for_each_online_cpu(cpu)
-+ bogosum += per_cpu(cpu_data, cpu).loops_per_jiffy;
-+
-+ printk(KERN_INFO "SMP: Total of %d processors activated "
-+ "(%lu.%02lu BogoMIPS).\n",
-+ num_online_cpus(),
-+ bogosum / (500000 / HZ), (bogosum / (5000 / HZ)) % 100);
-+
-+ /* now we can set all interruption don't cared */
-+ *(volatile unsigned long *)(AMIC_VA_BASE + 0x4) = 0xffffffff;
-+}
-+
-+void __init smp_prepare_boot_cpu(void)
-+{
-+ unsigned int cpu = smp_processor_id();
-+ unsigned long *ptr = (unsigned long *)(0xc0006000 + (cpu << 9));
-+ ptr[4] = 1;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/stacktrace.c linux-3.4.113/arch/nds32/kernel/stacktrace.c
---- linux-3.4.113.orig/arch/nds32/kernel/stacktrace.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/stacktrace.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,41 @@
-+#include <linux/sched.h>
-+#include <linux/stacktrace.h>
-+void save_stack_trace(struct stack_trace *trace)
-+{
-+ save_stack_trace_tsk(current, trace);
-+}
-+
-+void save_stack_trace_tsk(struct task_struct *tsk, struct stack_trace *trace)
-+{
-+ unsigned long *fpn;
-+ int skip = trace->skip;
-+ int savesched;
-+
-+ if (tsk == current) {
-+ __asm__ __volatile__("\tori\t%0, $fp, #0\n":"=r"(fpn));
-+ savesched = 1;
-+ } else {
-+ fpn = (unsigned long *)thread_saved_fp(tsk);
-+ savesched = 0;
-+ }
-+
-+ while (!kstack_end(fpn) && !((unsigned long)fpn & 0x3)
-+ && (fpn >= (unsigned long *)TASK_SIZE)) {
-+ unsigned long lpp, fpp;
-+ lpp = fpn[0];
-+ fpp = fpn[-1];
-+ if (!__kernel_text_address(lpp))
-+ break;
-+
-+ if (savesched || !in_sched_functions(lpp)) {
-+ if (skip) {
-+ skip--;
-+ } else {
-+ trace->entries[trace->nr_entries++] = lpp;
-+ if (trace->nr_entries >= trace->max_entries)
-+ break;
-+ }
-+ }
-+ fpn = (unsigned long *)fpp;
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/sys_nds32.c linux-3.4.113/arch/nds32/kernel/sys_nds32.c
---- linux-3.4.113.orig/arch/nds32/kernel/sys_nds32.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/sys_nds32.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,331 @@
-+/*
-+ * linux/arch/nds32/kernel/sys_nds32.c
-+ *
-+ * Copyright (C) People who wrote linux/arch/i386/kernel/sys_i386.c
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * This file contains various random system calls that
-+ * have a non-standard calling sequence on the Linux/nds32
-+ * platform.
-+ */
-+#include <linux/module.h>
-+#include <linux/errno.h>
-+#include <linux/sched.h>
-+#include <linux/slab.h>
-+#include <linux/mm.h>
-+#include <linux/sem.h>
-+#include <linux/msg.h>
-+#include <linux/shm.h>
-+#include <linux/stat.h>
-+#include <linux/syscalls.h>
-+#include <linux/mman.h>
-+#include <linux/fs.h>
-+#include <linux/file.h>
-+#include <linux/utsname.h>
-+#include <linux/ipc.h>
-+
-+#include <asm/uaccess.h>
-+#include <asm/unistd.h>
-+#include <asm/pfm.h>
-+
-+extern unsigned long do_mremap(unsigned long addr, unsigned long old_len,
-+ unsigned long new_len, unsigned long flags,
-+ unsigned long new_addr);
-+
-+struct mmap_arg_struct {
-+ unsigned long addr;
-+ unsigned long len;
-+ unsigned long prot;
-+ unsigned long flags;
-+ unsigned long fd;
-+ unsigned long offset;
-+};
-+
-+asmlinkage unsigned long sys_mmap2(unsigned long addr, unsigned long len,
-+ unsigned long prot, unsigned long flags,
-+ unsigned long fd, unsigned long pgoff)
-+{
-+ if (pgoff & (~PAGE_MASK >> 12))
-+ return -EINVAL;
-+
-+ return sys_mmap_pgoff(addr, len, prot, flags, fd,
-+ pgoff >> (PAGE_SHIFT - 12));
-+}
-+
-+asmlinkage unsigned long
-+sys_nds32_mremap(unsigned long addr, unsigned long old_len,
-+ unsigned long new_len, unsigned long flags,
-+ unsigned long new_addr)
-+{
-+ unsigned long ret = -EINVAL;
-+
-+ if (flags & MREMAP_FIXED && new_addr < FIRST_USER_ADDRESS)
-+ goto out;
-+
-+ down_write(&current->mm->mmap_sem);
-+ ret = do_mremap(addr, old_len, new_len, flags, new_addr);
-+ up_write(&current->mm->mmap_sem);
-+
-+out:
-+ return ret;
-+}
-+
-+/*
-+ * Perform the select(nd, in, out, ex, tv) and mmap() system
-+ * calls.
-+ */
-+
-+struct sel_arg_struct {
-+ unsigned long n;
-+ fd_set __user *inp, *outp, *exp;
-+ struct timeval __user *tvp;
-+};
-+
-+asmlinkage int old_select(struct sel_arg_struct __user * arg)
-+{
-+ struct sel_arg_struct a;
-+
-+ if (copy_from_user(&a, arg, sizeof(a)))
-+ return -EFAULT;
-+ /* sys_select() does the appropriate kernel locking */
-+ return sys_select(a.n, a.inp, a.outp, a.exp, a.tvp);
-+}
-+
-+/*
-+ * sys_ipc() is the de-multiplexer for the SysV IPC calls..
-+ *
-+ * This is really horribly ugly.
-+ */
-+asmlinkage long sys_ipc(unsigned int call, int first, unsigned long second,
-+ unsigned long third, void __user * ptr, long fifth)
-+{
-+ int version, ret;
-+
-+ version = call >> 16; /* hack for backward compatibility */
-+ call &= 0xffff;
-+
-+ switch (call) {
-+ case SEMOP:
-+ return sys_semtimedop(first, (struct sembuf __user *)ptr,
-+ second, NULL);
-+ case SEMTIMEDOP:
-+ return sys_semtimedop(first, (struct sembuf __user *)ptr,
-+ second,
-+ (const struct timespec __user *)fifth);
-+
-+ case SEMGET:
-+ return sys_semget(first, second, third);
-+ case SEMCTL:{
-+ union semun fourth;
-+ if (!ptr)
-+ return -EINVAL;
-+ if (get_user(fourth.__pad, (void __user * __user *)ptr))
-+ return -EFAULT;
-+ return sys_semctl(first, second, third, fourth);
-+ }
-+
-+ case MSGSND:
-+ return sys_msgsnd(first, (struct msgbuf __user *)ptr,
-+ second, third);
-+ case MSGRCV:
-+ switch (version) {
-+ case 0:{
-+ struct ipc_kludge tmp;
-+ if (!ptr)
-+ return -EINVAL;
-+ if (copy_from_user
-+ (&tmp, (struct ipc_kludge __user *)ptr,
-+ sizeof(tmp)))
-+ return -EFAULT;
-+ return sys_msgrcv(first, tmp.msgp, second,
-+ tmp.msgtyp, third);
-+ }
-+ default:
-+ return sys_msgrcv(first,
-+ (struct msgbuf __user *)ptr,
-+ second, fifth, third);
-+ }
-+ case MSGGET:
-+ return sys_msgget((key_t) first, second);
-+ case MSGCTL:
-+ return sys_msgctl(first, second, (struct msqid_ds __user *)ptr);
-+
-+ case SHMAT:
-+ switch (version) {
-+ default:{
-+ ulong raddr;
-+ ret =
-+ do_shmat(first, (char __user *)ptr, second,
-+ &raddr);
-+ if (ret)
-+ return ret;
-+ return put_user(raddr, (ulong __user *) third);
-+ }
-+ case 1: /* Of course, we don't support iBCS2! */
-+ return -EINVAL;
-+ }
-+ case SHMDT:
-+ return sys_shmdt((char __user *)ptr);
-+ case SHMGET:
-+ return sys_shmget(first, second, third);
-+ case SHMCTL:
-+ return sys_shmctl(first, second, (struct shmid_ds __user *)ptr);
-+ default:
-+ return -ENOSYS;
-+ }
-+}
-+
-+/* Fork a new task - this creates a new program thread.
-+ * This is called indirectly via a small wrapper
-+ */
-+asmlinkage int sys_fork(struct pt_regs *regs)
-+{
-+ return do_fork(SIGCHLD, regs->NDS32_sp, regs, 0, NULL, NULL);
-+}
-+
-+/* Clone a task - this clones the calling program thread.
-+ * This is called indirectly via a small wrapper
-+ */
-+asmlinkage int sys_clone(unsigned long clone_flags, unsigned long newsp,
-+ int __user * parent_tidptr, int tls_val,
-+ int __user * child_tidptr, struct pt_regs *regs)
-+{
-+ if (!newsp)
-+ newsp = regs->NDS32_sp;
-+
-+ return do_fork(clone_flags, newsp, regs, 0, parent_tidptr,
-+ child_tidptr);
-+}
-+
-+asmlinkage int sys_vfork(struct pt_regs *regs)
-+{
-+ return do_fork(CLONE_VFORK | CLONE_VM | SIGCHLD, regs->NDS32_sp, regs,
-+ 0, NULL, NULL);
-+}
-+
-+/* sys_execve() executes a new program.
-+ * This is called indirectly via a small wrapper
-+ */
-+asmlinkage int sys_execve(const char __user * filenamei,
-+ const char __user * const __user * argv,
-+ const char __user * const __user * envp,
-+ struct pt_regs *regs)
-+{
-+ int error;
-+ char *filename;
-+
-+ filename = getname(filenamei);
-+ error = PTR_ERR(filename);
-+ if (IS_ERR(filename))
-+ goto out;
-+
-+ error = do_execve(filename, argv, envp, regs);
-+ putname(filename);
-+
-+out:
-+ return error;
-+}
-+
-+asmlinkage unsigned long sys_getpagesize(void)
-+{
-+ return PAGE_SIZE; /* Possibly older binaries want 8192 on sun4's? */
-+}
-+
-+int kernel_execve(const char *filename, const char *const argv[],
-+ const char *const envp[])
-+{
-+ struct pt_regs regs;
-+ int ret;
-+
-+ memset(&regs, 0, sizeof(struct pt_regs));
-+ ret = do_execve(filename, argv, envp, &regs);
-+
-+ if (ret < 0) {
-+ goto out;
-+ }
-+ /*
-+ * Save argc to the register structure for userspace.
-+ */
-+ regs.NDS32_r0 = ret;
-+
-+ /*
-+ * We were successful. We won't be returning to our caller, but
-+ * instead to user space by manipulating the kernel stack.
-+ */
-+ asm("addi $r0, %0, %1\n\t"
-+ "move $r1, %2\n\t"
-+ "move $r2, %3\n\t"
-+ "bal memmove\n\t" /* copy regs to top of stack */
-+ "move $r8, #0\n\t" /* not a syscall */
-+ "move $r9, %0\n\t" /* thread structure */
-+ "move $sp, $r0\n\t" /* reposition stack pointer */
-+"b resume_userspace":
-+: "r"(current_thread_info()),
-+ "ir"(THREAD_SIZE - 8 - sizeof(regs)),
-+ "r"(&regs), "ir"(sizeof(regs))
-+#ifdef _GCC444
-+: "$r0", "$r1", "$r2", "$r4", "$r5", "$r8", "$r9", "$p0", "$p1",
-+ "memory");
-+#else
-+: "$r0", "$r1", "$r2", "$r4", "$r5", "$r8", "$r9", "$r26", "$r27",
-+ "memory");
-+#endif
-+out:
-+ return ret;
-+}
-+
-+EXPORT_SYMBOL(kernel_execve);
-+
-+int sys_cacheflush(unsigned int start, unsigned int end)
-+{
-+ struct vm_area_struct *vma;
-+
-+ vma = find_vma(current->mm, start);
-+ if (!vma)
-+ return 0;
-+ cpu_cache_wbinval_range_check(vma, start, end);
-+ return 0;
-+}
-+
-+asmlinkage long sys_fadvise64_64_wrapper(int fd, int advice, loff_t offset,
-+ loff_t len)
-+{
-+ return sys_fadvise64_64(fd, offset, len, advice);
-+}
-+
-+asmlinkage int nds32_syscall(int number, struct pt_regs *regs)
-+{
-+ switch (number) {
-+ case 0x7000: /* cacheflush */
-+ return sys_cacheflush(regs->NDS32_r1, regs->NDS32_r2);
-+
-+#ifdef CONFIG_OPROFILE
-+ case __NR_pfmctl:
-+ sys_pfmctl(regs->NDS32_r1, regs->NDS32_r2, regs->NDS32_r3,
-+ regs->NDS32_r4);
-+ return 0;
-+
-+ case __NR_getpfm:
-+ return sys_getpfm((struct pcounter __user *)regs->NDS32_r1);
-+
-+ case __NR_setpfm:
-+ return sys_setpfm(regs->NDS32_r1, regs->NDS32_r2,
-+ regs->NDS32_r3,
-+ (struct pcounter __user *)regs->NDS32_r4);
-+#endif
-+ case __NR_wbna:
-+ if (regs->NDS32_r1)
-+ regs->NDS32_ipsw |= PSW_mskWBNA;
-+ else
-+ regs->NDS32_ipsw &= ~PSW_mskWBNA;
-+ return 0;
-+
-+ default:
-+ return -ENOSYS;
-+ }
-+ return -ENOSYS;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/time.c linux-3.4.113/arch/nds32/kernel/time.c
---- linux-3.4.113.orig/arch/nds32/kernel/time.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/time.c 2016-12-01 20:59:24.356612904 +0100
-@@ -0,0 +1,94 @@
-+/*
-+ * linux/arch/nds32/kernel/time.c
-+ *
-+ * Copyright (C) 1991, 1992, 1995 Linus Torvalds
-+ * Modifications for ARM (C) 1994-2001 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * This file contains the ARM-specific time handling details:
-+ * reading the RTC at bootup, etc...
-+ *
-+ * 1994-07-02 Alan Modra
-+ * fixed set_rtc_mmss, fixed time.year for >= 2000, new mktime
-+ * 1998-12-20 Updated NTP code according to technical memorandum Jan '96
-+ * "A Kernel Model for Precision Timekeeping" by Dave Mills
-+ */
-+#include <linux/sched.h>
-+#include <linux/profile.h>
-+#include <linux/timer.h>
-+#include <asm/irq_regs.h>
-+#include <linux/syscore_ops.h>
-+
-+#include <asm/mach/arch.h>
-+#include <asm/mach/time.h>
-+
-+/*
-+ * Our system timer.
-+ */
-+struct sys_timer *system_timer;
-+
-+#ifdef CONFIG_SMP
-+unsigned long profile_pc(struct pt_regs *regs)
-+{
-+ unsigned long fp, pc = instruction_pointer(regs);
-+
-+ if (in_lock_functions(pc)) {
-+ fp = regs->NDS32_fp;
-+ pc = ((unsigned long *)fp)[-1];
-+ }
-+
-+ return pc;
-+}
-+
-+EXPORT_SYMBOL(profile_pc);
-+#endif
-+#if defined(CONFIG_PM) && !defined(CONFIG_GENERIC_CLOCKEVENTS)
-+static int timer_suspend(void)
-+{
-+ if (system_timer->suspend)
-+ system_timer->suspend();
-+
-+ return 0;
-+}
-+
-+static void timer_resume(void)
-+{
-+ if (system_timer->resume)
-+ system_timer->resume();
-+}
-+#else
-+#define timer_suspend NULL
-+#define timer_resume NULL
-+#endif
-+#ifdef CONFIG_ARCH_USES_GETTIMEOFFSET
-+u32 arch_gettimeoffset(void)
-+{
-+ if (system_timer->offset != NULL)
-+ return system_timer->offset() * 1000;
-+
-+ return 0;
-+}
-+#endif /* CONFIG_ARCH_USES_GETTIMEOFFSET */
-+static struct syscore_ops timer_syscore_ops = {
-+ .suspend = timer_suspend,
-+ .resume = timer_resume,
-+};
-+
-+static int __init timer_init_syscore_ops(void)
-+{
-+ register_syscore_ops(&timer_syscore_ops);
-+
-+ return 0;
-+}
-+
-+device_initcall(timer_init_syscore_ops);
-+
-+void __init time_init(void)
-+{
-+ system_timer = machine_desc->timer;
-+ system_timer->init(); // link to cpe_timer_init
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/traps.c linux-3.4.113/arch/nds32/kernel/traps.c
---- linux-3.4.113.orig/arch/nds32/kernel/traps.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/traps.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,733 @@
-+/*
-+ * linux/arch/nds32/kernel/traps.c
-+ *
-+ * Copyright (C) 1995-2002 Russell King
-+ * Fragments that appear the same as linux/arch/i386/kernel/traps.c (C) Linus Torvalds
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * 'traps.c' handles hardware exceptions after we have saved some state in
-+ * 'linux/arch/nds32/lib/traps.S'. Mostly a debugging aid, but will probably
-+ * kill the offending process.
-+ */
-+/* ============================================================================
-+ *
-+ * linux/arch/nds32/kernel/traps.c
-+ *
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is trap handling for NDS32 core, initial refer from ARM.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.16.2007 Initial ported by Tom, revised for KGDB by Harry.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#include <linux/module.h>
-+#include <linux/personality.h>
-+#include <linux/kallsyms.h>
-+#include <linux/hardirq.h>
-+#include <linux/kdebug.h>
-+
-+#include <asm/cacheflush.h>
-+#include <asm/uaccess.h>
-+#include <asm/unistd.h>
-+#include <asm/traps.h>
-+#include <asm/fpu.h>
-+#include <asm/audio.h>
-+
-+#include <linux/ptrace.h>
-+#include <nds32_intrinsic.h>
-+#include "ptrace.h"
-+#include "signal.h"
-+
-+extern void show_pte(struct mm_struct *mm, unsigned long addr);
-+
-+#ifdef CONFIG_DEBUG_USER
-+unsigned int user_debug;
-+
-+static int __init user_debug_setup(char *str)
-+{
-+ get_option(&str, &user_debug);
-+ return 1;
-+}
-+
-+__setup("user_debug=", user_debug_setup);
-+#endif
-+
-+/*
-+ * Dump out the contents of some memory nicely...
-+ */
-+void dump_mem(const char *str, unsigned long bottom, unsigned long top)
-+{
-+ unsigned long p = bottom & ~31;
-+ mm_segment_t fs;
-+ int i;
-+
-+ /*
-+ * We need to switch to kernel mode so that we can use __get_user
-+ * to safely read from kernel space. Note that we now dump the
-+ * code first, just in case the backtrace kills us.
-+ */
-+ fs = get_fs();
-+ set_fs(KERNEL_DS);
-+
-+ printk("%s(0x%08lx to 0x%08lx)\n", str, bottom, top);
-+
-+ for (p = bottom & ~31; p < top;) {
-+ printk("%04lx: ", p & 0xffff);
-+
-+ for (i = 0; i < 8; i++, p += 4) {
-+ unsigned int val;
-+
-+ if (p < bottom || p >= top)
-+ printk(" ");
-+ else {
-+ __get_user(val, (unsigned long *)p);
-+ printk("%08x ", val);
-+ }
-+ }
-+ printk("\n");
-+ }
-+
-+ set_fs(fs);
-+}
-+
-+EXPORT_SYMBOL(dump_mem);
-+
-+/* These intrinsic functions are not supported in V2 toolchains of BSP321. */
-+#ifndef __NDS32_BASELINE_V2__
-+#define DEBUG_TLB_CACHE
-+#endif
-+#ifdef DEBUG_TLB_CACHE
-+/* This is the number of TLB entries. User should change it if necessary. */
-+#define TLB_NUM 128
-+unsigned int tlb_misc_new[TLB_NUM], tlb_vpn_new[TLB_NUM], tlb_data_new[TLB_NUM];
-+/* To get the whole TLB contents once it uses va=0x0 */
-+void dump_tlb(unsigned long va)
-+{
-+ unsigned int rd_num, tlb_vpn, tlb_misc, tlb_data, mmu_cfg, tlb_num;
-+
-+ /* save tlb system registers */
-+ tlb_vpn = __nds32__mfsr(NDS32_SR_TLB_VPN);
-+ tlb_misc = __nds32__mfsr(NDS32_SR_TLB_MISC);
-+ tlb_data = __nds32__mfsr(NDS32_SR_TLB_DATA);
-+ mmu_cfg = __nds32__mfsr(NDS32_SR_MMU_CFG);
-+ tlb_num =
-+ (((mmu_cfg & MMU_CFG_mskTBW) >> MMU_CFG_offTBW) +
-+ 1) * (1 << (((mmu_cfg & MMU_CFG_mskTBS) >> MMU_CFG_offTBS) + 2));
-+
-+ for (rd_num = 0; rd_num < tlb_num; rd_num++) {
-+ /* read tlb entry with index */
-+ __nds32__tlbop_trd(rd_num);
-+ __nds32__dsb();
-+ tlb_vpn_new[rd_num] = __nds32__mfsr(NDS32_SR_TLB_VPN);
-+ tlb_misc_new[rd_num] = __nds32__mfsr(NDS32_SR_TLB_MISC);
-+ tlb_data_new[rd_num] = __nds32__mfsr(NDS32_SR_TLB_DATA);
-+ }
-+
-+ /* restore tlb system registers */
-+ __nds32__mtsr(tlb_vpn, NDS32_SR_TLB_VPN);
-+ __nds32__mtsr(tlb_misc, NDS32_SR_TLB_MISC);
-+ __nds32__dsb();
-+
-+ printk("cur VPN:%08x, MISC:%08x, DATA:%08x\n", tlb_vpn, tlb_misc,
-+ tlb_data);
-+ /* to read out all the data */
-+ for (rd_num = 0; rd_num < tlb_num; rd_num++) {
-+ /*unsigned int vpn = tlb_vpn_new[rd_num] & PAGE_MASK; */
-+ if (tlb_data_new[rd_num] & 0x1)
-+ if (va == 0x0
-+ || (va != 0x0
-+ && (tlb_vpn_new[rd_num] == (va & PAGE_MASK))))
-+ printk
-+ ("idx:0x%08x, VPN:%08x, MISC:%08x, DATA:%08x\n",
-+ rd_num, tlb_vpn_new[rd_num],
-+ tlb_misc_new[rd_num],
-+ tlb_data_new[rd_num]);
-+ }
-+}
-+
-+EXPORT_SYMBOL(dump_tlb);
-+
-+struct cache_element {
-+ unsigned int pa;
-+ unsigned int wd;
-+ unsigned int cacheline[8];
-+ unsigned char dirty;
-+ unsigned char valid;
-+ unsigned char lock;
-+};
-+
-+/* This is the number of cache entries. User should change it if necessary. */
-+#define CACHE_SET_NUM 0x100
-+#define CACHE_WAY_NUM 0x4
-+volatile struct cache_element ce[CACHE_SET_NUM][CACHE_WAY_NUM];
-+#define CCTL_mskDIRTY 0x400000
-+#define CCTL_offDIRTY 22
-+#define CCTL_mskVALID 0x2
-+#define CCTL_offVALID 1
-+#define CCTL_mskLOCK 0x1
-+#define CCTL_offLOCK 0
-+#define CCTL_mskTAG 0x3ffffc
-+#define CCTL_offTAG 0x2
-+extern unsigned long va2idx(unsigned long va, unsigned int cache_type,
-+ unsigned long *way_offset);
-+#include <asm/cache_info.h>
-+extern struct cache_info L1_cache_info[2];
-+void dump_cache(unsigned int cache_type)
-+{
-+ volatile unsigned long idx, way, ra, tag, i;
-+ unsigned long sets, ways, line_size, set_bits, way_bits, line_bits,
-+ way_offset;
-+
-+ ways = L1_cache_info[DCACHE].ways;
-+ sets = L1_cache_info[DCACHE].sets;
-+ set_bits = L1_cache_info[cache_type].set_bits;
-+ way_bits = L1_cache_info[cache_type].way_bits;
-+ line_bits = L1_cache_info[cache_type].line_bits;
-+ line_size = L1_cache_info[cache_type].line_size;
-+ way_offset = set_bits + line_bits;
-+
-+ if (cache_type != ICACHE && cache_type != DCACHE) {
-+ printk("%s not supported cache_type:%x\n", __func__,
-+ cache_type);
-+ return;
-+ }
-+
-+ /* NDS32_CCTL_L1I_IX_RTAG Read tag L1I cache */
-+ /* NDS32_CCTL_L1I_IX_RWD Read word data L1I cache */
-+
-+ for (idx = 0; idx < sets; idx++) {
-+ for (way = 0; way < ways; way++) {
-+ ra = (way << way_offset) | (idx << line_bits);
-+ if (cache_type == ICACHE)
-+ tag =
-+ __nds32__cctlidx_read
-+ (NDS32_CCTL_L1I_IX_RTAG, ra);
-+ else
-+ tag =
-+ __nds32__cctlidx_read
-+ (NDS32_CCTL_L1D_IX_RTAG, ra);
-+ ce[idx][way].dirty =
-+ (unsigned char)(tag & CCTL_mskDIRTY) >>
-+ CCTL_offDIRTY;
-+ ce[idx][way].valid =
-+ (unsigned char)(tag & CCTL_mskVALID) >>
-+ CCTL_offVALID;
-+ ce[idx][way].lock =
-+ (unsigned char)(tag & CCTL_mskLOCK) >> CCTL_offLOCK;
-+ ce[idx][way].pa =
-+ (tag & CCTL_mskTAG) >> CCTL_offTAG << PAGE_SHIFT;
-+ for (i = 0; i < line_size / 4; i++) {
-+ if (cache_type == ICACHE)
-+ ce[idx][way].cacheline[i] =
-+ __nds32__cctlidx_read
-+ (NDS32_CCTL_L1I_IX_RWD,
-+ (ra | i << 2));
-+ else
-+ ce[idx][way].cacheline[i] =
-+ __nds32__cctlidx_read
-+ (NDS32_CCTL_L1D_IX_RWD,
-+ (ra | i << 2));
-+ }
-+ }
-+ }
-+ printk("dump %s\n", cache_type ? "DCACHE" : "ICACHE");
-+ printk("%8s %4s %4s %1s %1s %1s %8s %8s %8s %8s %8s %8s %8s %8s\n",
-+ "ADDRESS", "SET", "WAY", "V", "D", "L", "00", "04", "08", "0C",
-+ "10", "14", "18", "1C");
-+ for (idx = 0; idx < sets; idx++) {
-+ for (way = 0; way < ways; way++) {
-+ printk("%08lx %04lx %04lx %1u %1u %1u ",
-+ ce[idx][way].pa +
-+ ((idx * line_size) % PAGE_SIZE), idx, way,
-+ ce[idx][way].valid, ce[idx][way].dirty,
-+ ce[idx][way].lock);
-+ for (i = 0; i < line_size / 4; i++) {
-+ printk("%08x ", ce[idx][way].cacheline[i]);
-+ }
-+ printk("\n");
-+ }
-+ }
-+}
-+
-+EXPORT_SYMBOL(dump_cache);
-+
-+void dump_cache_va(unsigned int cache_type, unsigned int va)
-+{
-+ volatile struct cache_element cache_entry[4];
-+ volatile unsigned long idx, way, tag, ra, i;
-+ unsigned long ways, line_size, set_bits, line_bits, way_offset;
-+
-+ ways = L1_cache_info[cache_type].ways;
-+ line_size = CACHE_LINE_SIZE(cache_type);
-+ set_bits = L1_cache_info[cache_type].set_bits;
-+ line_bits = L1_cache_info[cache_type].line_bits;
-+
-+ if (cache_type != ICACHE && cache_type != DCACHE) {
-+ printk("%s not supported cache_type:%x\n", __func__,
-+ cache_type);
-+ return;
-+ }
-+ idx = va2idx(va, cache_type, &way_offset);
-+ //idx = (va & (((1 << set_bits) - 1) << line_bits)) >> line_bits;
-+ for (way = 0; way < ways; way++) {
-+ ra = (way << way_offset) | idx;
-+ if (cache_type == ICACHE)
-+ tag = __nds32__cctlidx_read(NDS32_CCTL_L1I_IX_RTAG, ra);
-+ else
-+ tag = __nds32__cctlidx_read(NDS32_CCTL_L1D_IX_RTAG, ra);
-+ cache_entry[way].dirty =
-+ (unsigned char)(tag & CCTL_mskDIRTY) >> CCTL_offDIRTY;
-+ cache_entry[way].valid =
-+ (unsigned char)(tag & CCTL_mskVALID) >> CCTL_offVALID;
-+ cache_entry[way].lock =
-+ (unsigned char)(tag & CCTL_mskLOCK) >> CCTL_offLOCK;
-+ cache_entry[way].pa =
-+ (tag & CCTL_mskTAG) >> CCTL_offTAG << PAGE_SHIFT;
-+ for (i = 0; i < line_size / 4; i++) {
-+ if (cache_type == ICACHE)
-+ cache_entry[way].cacheline[i] =
-+ __nds32__cctlidx_read(NDS32_CCTL_L1I_IX_RWD,
-+ (ra | i << 2));
-+ else
-+ cache_entry[way].cacheline[i] =
-+ __nds32__cctlidx_read(NDS32_CCTL_L1D_IX_RWD,
-+ (ra | i << 2));
-+ }
-+ }
-+ printk("dump %s va:%x\n", cache_type ? "DCACHE" : "ICACHE", va);
-+
-+ printk("%8s %4s %4s %1s %1s %1s %8s %8s %8s %8s %8s %8s %8s %8s\n",
-+ "ADDRESS", "SET", "WAY", "V", "D", "L", "00", "04", "08", "0C",
-+ "10", "14", "18", "1C");
-+ for (way = 0; way < ways; way++) {
-+ printk("%08lx %04lx %04lx %1u %1u %1u ",
-+ cache_entry[way].pa +
-+ (((idx >> line_bits) * line_size) % PAGE_SIZE),
-+ (idx >> line_bits), way, cache_entry[way].valid,
-+ cache_entry[way].dirty, cache_entry[way].lock);
-+ for (i = 0; i < 8; i++) {
-+ printk("%08x ", cache_entry[way].cacheline[i]);
-+ }
-+ printk("\n");
-+ }
-+}
-+
-+EXPORT_SYMBOL(dump_cache_va);
-+#endif
-+
-+static void dump_instr(struct pt_regs *regs)
-+{
-+ unsigned long addr = instruction_pointer(regs);
-+ const int width = 8;
-+ mm_segment_t fs;
-+ int i;
-+
-+ return;
-+ /*
-+ * We need to switch to kernel mode so that we can use __get_user
-+ * to safely read from kernel space. Note that we now dump the
-+ * code first, just in case the backtrace kills us.
-+ */
-+ fs = get_fs();
-+ set_fs(KERNEL_DS);
-+
-+ printk("Code: ");
-+ for (i = -4; i < 1; i++) {
-+ unsigned int val, bad;
-+
-+ bad = __get_user(val, &((u32 *) addr)[i]);
-+
-+ if (!bad)
-+ printk(i == 0 ? "(%0*x) " : "%0*x ", width, val);
-+ else {
-+ printk("bad PC value.");
-+ break;
-+ }
-+ }
-+ printk("\n");
-+
-+ set_fs(fs);
-+}
-+
-+#define LOOP_TIMES (100)
-+void dump_stack(void)
-+{
-+ int cnt = LOOP_TIMES;
-+#ifndef CONFIG_FRAME_POINTER
-+ unsigned long *stack;
-+ unsigned long addr;
-+
-+ __asm__ __volatile__("\tori\t%0, $sp, #0\n":"=r"(stack));
-+ printk("Call Trace:\n");
-+ while (!kstack_end(stack)) {
-+ addr = *stack++;
-+ if (__kernel_text_address(addr)) {
-+ printk("[<%08lx>] ", addr);
-+ print_symbol("%s\n", addr);
-+ }
-+ cnt--;
-+ if (cnt < 0)
-+ break;
-+ }
-+ printk("\n");
-+#else
-+ unsigned long *fpn;
-+ __asm__ __volatile__("\tori\t%0, $fp, #0\n":"=r"(fpn));
-+ printk("Call Trace:\n");
-+ while (!kstack_end((void *)fpn) && !((unsigned long)fpn & 0x3)
-+ && ((unsigned long)fpn >= TASK_SIZE)) {
-+ unsigned long lpp, fpp;
-+#if !defined(NDS32_ABI_2)
-+ lpp = fpn[0];
-+ fpp = fpn[1];
-+#else
-+ lpp = fpn[0];
-+ fpp = fpn[-1];
-+#endif
-+ if (__kernel_text_address(lpp)) {
-+ printk("[<%08lx>] ", lpp);
-+ print_symbol("%s\n", lpp);
-+ fpn = (unsigned long *)fpp;
-+ }
-+ cnt--;
-+ if (cnt < 0)
-+ break;
-+ }
-+ printk("\n");
-+#endif
-+}
-+
-+EXPORT_SYMBOL(dump_stack);
-+
-+void show_stack(struct task_struct *tsk, unsigned long *sp)
-+{
-+ unsigned long fp;
-+
-+ if (!tsk)
-+ tsk = current;
-+
-+ if (tsk != current)
-+ fp = thread_saved_fp(tsk);
-+ else
-+ asm("move %0, $fp":"=r"(fp));
-+
-+ dump_stack();
-+ barrier();
-+}
-+
-+DEFINE_SPINLOCK(die_lock);
-+
-+/*
-+ * This function is protected against re-entrancy.
-+ */
-+void die(const char *str, struct pt_regs *regs, int err)
-+{
-+ struct task_struct *tsk = current;
-+ static int die_counter;
-+
-+ console_verbose();
-+ spin_lock_irq(&die_lock);
-+ bust_spinlocks(1);
-+
-+ printk("Internal error: %s: %x [#%d]\n", str, err, ++die_counter);
-+ print_modules();
-+ printk("CPU: %i\n", smp_processor_id());
-+ show_regs(regs);
-+ printk("Process %s (pid: %d, stack limit = 0x%p)\n",
-+ tsk->comm, tsk->pid, task_thread_info(tsk) + 1);
-+
-+ if (!user_mode(regs) || in_interrupt()) {
-+ dump_mem("Stack: ", regs->NDS32_sp,
-+ 8192 + (unsigned long)task_thread_info(tsk));
-+ dump_instr(regs);
-+ dump_stack();
-+ }
-+
-+ bust_spinlocks(0);
-+ spin_unlock_irq(&die_lock);
-+ do_exit(SIGSEGV);
-+}
-+
-+void die_if_kernel(const char *str, struct pt_regs *regs, int err)
-+{
-+ if (user_mode(regs))
-+ return;
-+
-+ die(str, regs, err);
-+}
-+
-+int bad_syscall(int n, struct pt_regs *regs)
-+{
-+ struct thread_info *thread = current_thread_info();
-+ siginfo_t info;
-+
-+ if (current->personality != PER_LINUX && thread->exec_domain->handler) {
-+ thread->exec_domain->handler(n, regs);
-+ return regs->NDS32_r0;
-+ }
-+#ifdef CONFIG_DEBUG_USER
-+ if (user_debug & UDBG_SYSCALL) {
-+ printk(KERN_ERR "[%d] %s: obsolete system call %08x.\n",
-+ current->pid, current->comm, n);
-+ dump_instr(regs);
-+ }
-+#endif
-+
-+ info.si_signo = SIGILL;
-+ info.si_errno = 0;
-+ info.si_code = ILL_ILLTRP;
-+ info.si_addr = (void __user *)instruction_pointer(regs) - 4;
-+
-+ force_sig_info(SIGILL, &info, current);
-+ die_if_kernel("Oops - bad syscall", regs, n);
-+ return regs->NDS32_r0;
-+}
-+
-+void __pte_error(const char *file, int line, unsigned long val)
-+{
-+ printk("%s:%d: bad pte %08lx.\n", file, line, val);
-+}
-+
-+void __pmd_error(const char *file, int line, unsigned long val)
-+{
-+ printk("%s:%d: bad pmd %08lx.\n", file, line, val);
-+}
-+
-+void __pgd_error(const char *file, int line, unsigned long val)
-+{
-+ printk("%s:%d: bad pgd %08lx.\n", file, line, val);
-+}
-+
-+extern char exception_vector[73][64];
-+void __init trap_init(void)
-+{
-+ return;
-+}
-+
-+void __init early_trap_init(void)
-+{
-+ unsigned long ivb = 0;
-+ unsigned long base = 0xc0000000;
-+
-+ memcpy((unsigned long *)base, (unsigned long *)exception_vector,
-+ sizeof(exception_vector));
-+ ivb = __nds32__mfsr(NDS32_SR_IVB);
-+#ifdef CONFIG_EVIC
-+ __nds32__mtsr((ivb & ~IVB_mskESZ) | (2 << IVB_offESZ) |
-+ (1 << IVB_offEVIC) | IVB_BASE, NDS32_SR_IVB);
-+#else
-+ /* Check platform support. */
-+# if defined (CONFIG_IVIC_INTC)
-+ if (((ivb & IVB_mskNIVIC) >> IVB_offNIVIC) >= 2)
-+ panic
-+ ("IVIC mode is not allowed on the platform with interrupt controller\n");
-+# elif defined(CONFIG_IVIC)
-+ if (((ivb & IVB_mskNIVIC) >> IVB_offNIVIC) < 2)
-+ panic
-+ ("IVIC mode is not allowed on the platform without interrupt controller\n");
-+# endif
-+ __nds32__mtsr((ivb & ~IVB_mskESZ) | (2 << IVB_offESZ) | IVB_BASE,
-+ NDS32_SR_IVB);
-+#endif
-+ __nds32__mtsr(0x10003, NDS32_SR_INT_MASK);
-+ /*
-+ * Copy signal return handlers into the vector page, and
-+ * set sigreturn to be a pointer to these.
-+ */
-+ memcpy((void *)KERN_SIGRETURN_CODE, retcodes, sizeof(retcodes));
-+ memcpy((void *)KERN_RESTART_CODE, syscall_restart_code,
-+ sizeof(syscall_restart_code));
-+
-+ /*
-+ * 0x2000 is 8K-aligned of 0x1240 = 73 vectors * 64byte
-+ * 0x1000 is page saving sigreturn & restart code
-+ */
-+ flush_icache_range(base, base + 0x3000);
-+}
-+
-+#if 0
-+COLE:use send_sigtrap instread
-+ static __inline__ void do_trap(int trapnr, int signr, const char *str,
-+ struct pt_regs *regs,
-+ unsigned long error_code, siginfo_t * info)
-+{
-+ if (user_mode(regs)) {
-+ /* trap_signal */
-+ struct task_struct *tsk = current;
-+ tsk->thread.error_code = error_code;
-+ tsk->thread.trap_no = trapnr;
-+ if (info)
-+ force_sig_info(signr, info, tsk);
-+ else
-+ force_sig(signr, tsk);
-+ return;
-+ } else {
-+ /* kernel_trap */
-+ if (!fixup_exception(regs))
-+ die(str, regs, error_code);
-+ return;
-+ }
-+}
-+#endif
-+
-+/*
-+ * I modified original debug_trap to apply KGDB stuff,
-+ * Harry@Jul.18.2007
-+ */
-+void do_debug_trap(unsigned long entry, unsigned long addr,
-+ unsigned long type, struct pt_regs *regs)
-+{
-+ if (notify_die(DIE_DEBUG, "debug", regs, addr, type, SIGTRAP)
-+ == NOTIFY_STOP)
-+ return;
-+
-+#if !defined(CONFIG_HSS)
-+ /* clear the swbk; otherwise the user will see it */
-+ if (test_tsk_thread_flag(current, TIF_SINGLESTEP))
-+ ptrace_cancel_swbk(current);
-+#endif
-+
-+ /* do_trap(1, SIGTRAP, 0, regs, 0, NULL); */
-+ if (user_mode(regs)) {
-+ /* trap_signal */
-+ send_sigtrap(current, regs, 0, TRAP_BRKPT);
-+ } else {
-+ /* kernel_trap */
-+ if (!fixup_exception(regs))
-+ die("unexpected kernel_trap", regs, 0);
-+ }
-+}
-+
-+void unhandled_interruption(struct pt_regs *regs)
-+{
-+ siginfo_t si;
-+ printk("unhandled_interruption\n");
-+ show_regs(regs);
-+ if (!user_mode(regs))
-+ do_exit(SIGKILL);
-+ si.si_signo = SIGKILL;
-+ si.si_errno = 0;
-+ force_sig_info(SIGKILL, &si, current);
-+}
-+
-+void unhandled_exceptions(unsigned long entry, unsigned long addr,
-+ unsigned long type, struct pt_regs *regs)
-+{
-+ siginfo_t si;
-+ printk("Unhandled Exception: entry: %lx addr:%lx itype:%lx\n", entry,
-+ addr, type);
-+ show_regs(regs);
-+ if (!user_mode(regs))
-+ do_exit(SIGKILL);
-+ si.si_signo = SIGKILL;
-+ si.si_errno = 0;
-+ si.si_addr = (void *)addr;
-+ force_sig_info(SIGKILL, &si, current);
-+}
-+
-+extern int do_page_fault(unsigned long entry, unsigned long addr,
-+ unsigned int error_code, struct pt_regs *regs);
-+
-+/*
-+ * 2:DEF dispatch for TLB MISC exception handler
-+*/
-+
-+void do_dispatch_tlb_misc(unsigned long entry, unsigned long addr,
-+ unsigned long type, struct pt_regs *regs)
-+{
-+ type = type & (ITYPE_mskINST | ITYPE_mskETYPE);
-+ if ((type & 0xf) < 5)
-+ do_page_fault(entry, addr, type, regs);
-+ else
-+ unhandled_exceptions(entry, addr, type, regs);
-+}
-+
-+int (*do_unaligned_access) (unsigned long entry, unsigned long addr,
-+ unsigned long type, struct pt_regs * regs) = NULL;
-+
-+EXPORT_SYMBOL(do_unaligned_access);
-+
-+void do_revinsn(struct pt_regs *regs)
-+{
-+ siginfo_t si;
-+ printk("Reserved Instruction\n");
-+ show_regs(regs);
-+ if (!user_mode(regs))
-+ do_exit(SIGILL);
-+ si.si_signo = SIGILL;
-+ si.si_errno = 0;
-+ force_sig_info(SIGILL, &si, current);
-+}
-+
-+/*
-+ * 7:DEF dispatch for General exception handler
-+ */
-+void do_dispatch_general(unsigned long entry, unsigned long addr,
-+ unsigned long itype, struct pt_regs *regs,
-+ unsigned long oipc)
-+{
-+ unsigned int swid = itype >> ITYPE_offSWID;
-+ unsigned long type = itype & (ITYPE_mskINST | ITYPE_mskETYPE);
-+ if (type == 0) { /* Alignment check */
-+
-+ if (do_unaligned_access) {
-+
-+ int ret = do_unaligned_access(entry, addr, type, regs);
-+
-+ if (ret == 0)
-+ return;
-+
-+ if (ret == -EFAULT)
-+ printk
-+ ("Unhandled unaligned access exception\n");
-+ }
-+ do_page_fault(entry, addr, type, regs);
-+ } else if (type == 1) /* Reserved instruction */
-+ do_revinsn(regs);
-+ else if (type == 6) { /* Coprocessor */
-+ if (((GET_ITYPE() & ITYPE_mskSTYPE) >> ITYPE_offSTYPE) == 3) {
-+#ifdef CONFIG_AUDIO
-+ preempt_disable();
-+ do_audio_context_switch(type, regs);
-+ preempt_enable();
-+#else
-+ unhandled_exceptions(entry, addr, type, regs);
-+#endif
-+ } else {
-+#ifdef CONFIG_FPU
-+ do_fpu_exception(type, regs);
-+#else
-+ unhandled_exceptions(entry, addr, type, regs);
-+#endif
-+ }
-+ } else if (type == 2 && swid == 0x1a) {
-+ /* trap, used on v3 EDM target debugging workaround */
-+ /*
-+ * DIPC(OIPC) is passed as parameter before
-+ * interrupt is enabled, so the DIPC will not be corrupted
-+ * even though interrupts are coming in
-+ */
-+ /*
-+ * 1. update ipc
-+ * 2. update pt_regs ipc with oipc
-+ * 3. update pt_regs ipsw (clear DEX)
-+ */
-+ __asm__ volatile ("mtsr %0, $IPC\n\t"::"r" (oipc));
-+ regs->NDS32_ipc = oipc;
-+ regs->NDS32_ipsw &= ~0x400;
-+ do_debug_trap(entry, addr, itype, regs);
-+ } else
-+ unhandled_exceptions(entry, addr, type, regs);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/kernel/vmlinux.lds.S linux-3.4.113/arch/nds32/kernel/vmlinux.lds.S
---- linux-3.4.113.orig/arch/nds32/kernel/vmlinux.lds.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/kernel/vmlinux.lds.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,74 @@
-+#include <asm/page.h>
-+#include <asm/thread_info.h>
-+#include <asm/cache.h>
-+#include <asm/memory.h>
-+
-+#define LOAD_OFFSET (PAGE_OFFSET - PHYS_OFFSET)
-+#include <asm-generic/vmlinux.lds.h>
-+
-+OUTPUT_ARCH(nds32)
-+ENTRY(_stext_lma)
-+jiffies = jiffies_64;
-+
-+SECTIONS
-+{
-+ _stext_lma = TEXTADDR - LOAD_OFFSET;
-+ . = TEXTADDR;
-+ __init_begin = .;
-+ HEAD_TEXT_SECTION
-+ INIT_TEXT_SECTION(PAGE_SIZE)
-+ /* These sections are arch specific. */
-+ .arch_info : AT(ADDR(.arch_info) - LOAD_OFFSET) {
-+ . = ALIGN(4);
-+ VMLINUX_SYMBOL(__proc_info_begin) = .;
-+ *(.proc.info.init)
-+ VMLINUX_SYMBOL(__proc_info_end) = .;
-+ __arch_info_begin = .;
-+ *(.arch.info)
-+ __arch_info_end = .;
-+ __tagtable_begin = .;
-+ *(.taglist)
-+ __tagtable_end = .;
-+ . = ALIGN(16);
-+ __pv_table_begin = .;
-+ *(.pv_table)
-+ __pv_table_end = .;
-+ __early_begin = .;
-+ *(__early_param)
-+ __early_end = .;
-+ }
-+
-+ INIT_DATA_SECTION(16)
-+ PERCPU_SECTION(L1_CACHE_BYTES)
-+ __init_end = .;
-+
-+ . = ALIGN(PAGE_SIZE);
-+ _stext = .;
-+ /* Real text segment */
-+ .text : AT(ADDR(.text) - LOAD_OFFSET) {
-+ _text = .; /* Text and read-only data */
-+ TEXT_TEXT
-+ SCHED_TEXT
-+ LOCK_TEXT
-+ KPROBES_TEXT
-+ IRQENTRY_TEXT
-+ *(.fixup)
-+ }
-+
-+ _etext = .; /* End of text and rodata section */
-+
-+ _sdata = .;
-+ RO_DATA_SECTION(PAGE_SIZE)
-+ RW_DATA_SECTION(L1_CACHE_BYTES, PAGE_SIZE, THREAD_SIZE)
-+ _edata = .;
-+
-+ EXCEPTION_TABLE(16)
-+ NOTES
-+ BSS_SECTION(4, 4, 4)
-+ _end = .;
-+
-+ STABS_DEBUG
-+ DWARF_DEBUG
-+
-+ DISCARDS
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/copy_page.S linux-3.4.113/arch/nds32/lib/copy_page.S
---- linux-3.4.113.orig/arch/nds32/lib/copy_page.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/copy_page.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,36 @@
-+/*
-+ * linux/arch/nds32/lib/copypage.S
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ */
-+#include <linux/linkage.h>
-+#include <asm/page.h>
-+
-+ .text
-+ENTRY(copy_page)
-+ pushm $r2, $r10
-+ movi $r2, PAGE_SIZE >> 5
-+.Lcopy_loop:
-+ lmw.bim $r3, [$r1], $r10
-+ smw.bim $r3, [$r0], $r10
-+ subi45 $r2, #1
-+ bnez38 $r2, .Lcopy_loop
-+ popm $r2, $r10
-+ ret
-+
-+ENTRY(clear_page)
-+ pushm $r1, $r9
-+ movi $r1, PAGE_SIZE >> 5
-+ movi55 $r2, #0
-+ movi55 $r3, #0
-+ movi55 $r4, #0
-+ movi55 $r5, #0
-+ movi55 $r6, #0
-+ movi55 $r7, #0
-+ movi55 $r8, #0
-+ movi55 $r9, #0
-+.Lclear_loop:
-+ smw.bim $r2, [$r0], $r9
-+ subi45 $r1, #1
-+ bnez38 $r1, .Lclear_loop
-+ popm $r1, $r9
-+ ret
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/csum_partial.c linux-3.4.113/arch/nds32/lib/csum_partial.c
---- linux-3.4.113.orig/arch/nds32/lib/csum_partial.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/csum_partial.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,135 @@
-+/*
-+ * INET An implementation of the TCP/IP protocol suite for the LINUX
-+ * operating system. INET is implemented using the BSD Socket
-+ * interface as the means of communication with the user level.
-+ *
-+ * MIPS specific IP/TCP/UDP checksumming routines
-+ *
-+ * Authors: Ralf Baechle, <ralf@waldorf-gmbh.de>
-+ * Lots of code moved from tcp.c and ip.c; see those files
-+ * for more names.
-+ *
-+ * This program is free software; you can redistribute it and/or
-+ * modify it under the terms of the GNU General Public License
-+ * as published by the Free Software Foundation; either version
-+ * 2 of the License, or (at your option) any later version.
-+ */
-+#include <linux/module.h>
-+#include <linux/types.h>
-+
-+#include <net/checksum.h>
-+#include <asm/byteorder.h>
-+#include <asm/string.h>
-+#include <asm/uaccess.h>
-+
-+#define addc(_t,_r) \
-+ __asm__ __volatile__ ( \
-+ "add\t%0, %0, %1\n\t" \
-+ "slt\t$p1, %0, %1\n\t" \
-+ "add\r%0, %0, $p1\n\t" \
-+ : "=r"(_t) \
-+ : "r"(_r), "0"(_t));
-+
-+static inline unsigned short from32to16(unsigned int x)
-+{
-+ /* 32 bits --> 16 bits + carry */
-+ x = (x & 0xffff) + (x >> 16);
-+ /* 16 bits + carry --> 16 bits including carry */
-+ x = (x & 0xffff) + (x >> 16);
-+ return (unsigned short)x;
-+}
-+
-+static inline unsigned int do_csum(const unsigned char *buff, int len)
-+{
-+ int odd;
-+ register unsigned int result = 0;
-+ register unsigned int count;
-+ if (len <= 0)
-+ goto out;
-+ odd = 1 & (unsigned long)buff;
-+ if (odd) {
-+ result = be16_to_cpu(*buff);
-+ len--;
-+ buff++;
-+ }
-+ count = len >> 1; /* nr of 16-bit words.. */
-+ if (count) {
-+ if (2 & (unsigned long)buff) {
-+ result += *(unsigned short *)buff;
-+ count--;
-+ len -= 2;
-+ buff += 2;
-+ }
-+ count >>= 1; /* nr of 32-bit words.. */
-+ if (count) {
-+ while (count >= 8) {
-+ __asm__
-+ __volatile__("lmw.bi $r17, [%1], $r24\n\t"
-+ "add\t%0, %0, $r17\n\t"
-+ "slt\t$p1, %0, $r17\n\t"
-+ "add\r%0, %0, $p1\n\t"
-+ "add\t%0, %0, $r18\n\t"
-+ "slt\t$p1, %0, $r18\n\t"
-+ "add\r%0, %0, $p1\n\t"
-+ "add\t%0, %0, $r19\n\t"
-+ "slt\t$p1, %0, $r19\n\t"
-+ "add\r%0, %0, $p1\n\t"
-+ "add\t%0, %0, $r20\n\t"
-+ "slt\t$p1, %0, $r20\n\t"
-+ "add\r%0, %0, $p1\n\t"
-+ "add\t%0, %0, $r21\n\t"
-+ "slt\t$p1, %0, $r21\n\t"
-+ "add\r%0, %0, $p1\n\t"
-+ "add\t%0, %0, $r22\n\t"
-+ "slt\t$p1, %0, $r22\n\t"
-+ "add\r%0, %0, $p1\n\t"
-+ "add\t%0, %0, $r23\n\t"
-+ "slt\t$p1, %0, $r23\n\t"
-+ "add\r%0, %0, $p1\n\t"
-+ "add\t%0, %0, $r24\n\t"
-+ "slt\t$p1, %0, $r24\n\t"
-+ "add\r%0, %0, $p1\n\t":"=r"
-+ (result)
-+ :"r"(buff), "0"(result)
-+ :"$r17", "$r18", "$r19",
-+ "$r20", "$r21", "$r22", "$r23",
-+ "$r24");
-+ count -= 8;
-+ buff += 32;
-+ }
-+ while (count) {
-+ unsigned int w = *(unsigned int *)buff;
-+ count--;
-+ buff += 4;
-+ addc(result, w);
-+ }
-+ result = (result & 0xffff) + (result >> 16);
-+ }
-+ if (len & 2) {
-+ result += *(unsigned short *)buff;
-+ buff += 2;
-+ }
-+ }
-+ if (len & 1)
-+ result += le16_to_cpu(*buff);
-+ result = from32to16(result);
-+ if (odd)
-+ result = swab16(result);
-+out:
-+ return result;
-+}
-+
-+/*
-+ * computes a partial checksum, e.g. for TCP/UDP fragments
-+ */
-+/*
-+ * why bother folding?
-+ */
-+unsigned int csum_partial(const void *buff, int len, unsigned int sum)
-+{
-+ unsigned int result = 0;
-+// printk("csum_partial %x %x %x\n", buff, len, sum);
-+ result = do_csum(buff, len);
-+ addc(result, sum);
-+ return (unsigned short)from32to16(result);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/csum_partial_copy.c linux-3.4.113/arch/nds32/lib/csum_partial_copy.c
---- linux-3.4.113.orig/arch/nds32/lib/csum_partial_copy.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/csum_partial_copy.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,58 @@
-+/*
-+ * INET An implementation of the TCP/IP protocol suite for the LINUX
-+ * operating system. INET is implemented using the BSD Socket
-+ * interface as the means of communication with the user level.
-+ *
-+ * MIPS specific IP/TCP/UDP checksumming routines
-+ *
-+ * Authors: Ralf Baechle, <ralf@waldorf-gmbh.de>
-+ * Lots of code moved from tcp.c and ip.c; see those files
-+ * for more names.
-+ *
-+ * This program is free software; you can redistribute it and/or
-+ * modify it under the terms of the GNU General Public License
-+ * as published by the Free Software Foundation; either version
-+ * 2 of the License, or (at your option) any later version.
-+ */
-+#include <linux/kernel.h>
-+#include <net/checksum.h>
-+#include <linux/types.h>
-+#include <asm/byteorder.h>
-+#include <asm/string.h>
-+#include <asm/uaccess.h>
-+
-+/*
-+ * copy while checksumming, otherwise like csum_partial
-+ */
-+unsigned int csum_partial_copy_nocheck(const unsigned char *src,
-+ unsigned char *dst, int len,
-+ unsigned int sum)
-+{
-+ /*
-+ * It's 2:30 am and I don't feel like doing it real ...
-+ * This is lots slower than the real thing (tm)
-+ */
-+ sum = csum_partial(src, len, sum);
-+ memcpy(dst, src, len);
-+
-+ return sum;
-+}
-+
-+/*
-+ * Copy from userspace and compute checksum. If we catch an exception
-+ * then zero the rest of the buffer.
-+ */
-+unsigned int csum_partial_copy_from_user(const unsigned char *src,
-+ unsigned char *dst, int len,
-+ unsigned int sum, int *err_ptr)
-+{
-+ int missing;
-+
-+ missing = copy_from_user(dst, src, len);
-+ if (missing) {
-+ memset(dst + len - missing, 0, missing);
-+ *err_ptr = -EFAULT;
-+ }
-+
-+ return csum_partial(dst, len, sum);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/divmod.c linux-3.4.113/arch/nds32/lib/divmod.c
---- linux-3.4.113.orig/arch/nds32/lib/divmod.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/divmod.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,46 @@
-+extern unsigned long udivmodsi4(unsigned long num, unsigned long den,
-+ int modwanted);
-+
-+long __divsi3(long a, long b)
-+{
-+ int neg = 0;
-+ long res;
-+
-+ if (a < 0) {
-+ a = -a;
-+ neg = !neg;
-+ }
-+
-+ if (b < 0) {
-+ b = -b;
-+ neg = !neg;
-+ }
-+
-+ res = udivmodsi4(a, b, 0);
-+
-+ if (neg)
-+ res = -res;
-+
-+ return res;
-+}
-+
-+long __modsi3(long a, long b)
-+{
-+ int neg = 0;
-+ long res;
-+
-+ if (a < 0) {
-+ a = -a;
-+ neg = 1;
-+ }
-+
-+ if (b < 0)
-+ b = -b;
-+
-+ res = udivmodsi4(a, b, 1);
-+
-+ if (neg)
-+ res = -res;
-+
-+ return res;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/findbit.S linux-3.4.113/arch/nds32/lib/findbit.S
---- linux-3.4.113.orig/arch/nds32/lib/findbit.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/findbit.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,108 @@
-+/*
-+ * linux/arch/nds32/lib/findbit.S
-+ *
-+ * Copyright (C) 1995-2000 Russell King
-+ * Copyright (C) 2006 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/linkage.h>
-+
-+ .text
-+
-+/*
-+ * Purpose : Find a 'zero' bit
-+ * Prototype: int find_first_zero_bit(void *addr, int maxbit);
-+ */
-+ENTRY(_find_first_zero_bit)
-+ move $r2, #0
-+ move $p0, #0 ! Reset bit count
-+next_word:
-+ move $r4, #4
-+ lmw.bim $p1, [$r0], $p1
-+ li $r3, #0xffffffff ! Inversion mask
-+ xor $p1, $p1, $r3 ! Inverted the word
-+ addi $p0, $p0, #32
-+ beqz $p1, next_word
-+ addi $p0, $p0, #-32
-+next_byte:
-+ beqz $r4, next_word
-+ andi $r3, $p1, #0xff ! Get the next byte
-+ bnez $r3, found ! Found zero bit in this byte
-+ addi $p0, $p0, #8 ! Update bit count
-+ addi $r4, $r4, #-1
-+ srli $p1, $p1, #8
-+ bgt $r1, $p0, next_byte
-+ addi $r0, $r1, #1 ! Return not found
-+ ret
-+
-+/*
-+ * Purpose : Find next 'zero' bit
-+ * Prototype: int find_next_zero_bit(void *addr, int maxbit, int offset)
-+ */
-+ENTRY(_find_next_zero_bit)
-+ beqz $r2, _find_first_zero_bit ! If offset=0, goto find_first_zero_bit
-+ srli $p0, $r2, #5 ! Get offset byte count
-+ slli $p0, $p0, #2
-+ add $r0, $r0, $p0 ! $r0 is the first word to load
-+ lmw.bim $p1, [$r0], $p1
-+ li $p0, #0xffffffff ! Inversion mask
-+ xor $p1, $p1, $p0 ! Inverted the word
-+ andi $r4, $r2, #31 ! Left bits in offset
-+ srl $p1, $p1, $r4 ! Shift out the left bits
-+ xor $p0, $p0, $p0
-+ subri $r4, $r4, #31
-+loop:
-+ andi $r3, $p1, #0xff ! The first byte to check
-+ bnez $r3, found ! Found zero bit in this byte
-+ addi $p0, $p0, #8
-+ addi $r4, $r4, #-8
-+ srli $p1, $p1, #8 ! Move on to the next byte
-+ bgtz $r4, loop
-+ b next_word
-+
-+/*
-+ * One or more bits in the LSB of $p1 are assumed to be set.
-+ */
-+
-+found:
-+ move $p1, $r3
-+ xor $r4, $r4, $r4
-+ andi $r5, $p1, #0x0f ! Get bits 0-3
-+ move $r3, #4 ! For 0 case (no set bit found)
-+ cmovn $r3, $r4, $r5 ! Not 0 case (There's set bit in these 4 bits)
-+ add $p0, $p0, $r3 ! Update bit count
-+ slli $r3, $p1, #4 ! Not 0 case (Find set bit in these 4 bits)
-+ cmovn $p1, $r3, $r5 ! For 0 case (Find set bit in the rest 4 bits)
-+ andi $r5, $p1, #0x30 ! Get 4-5
-+ move $r3, #2 ! For 0 case (no set bit found)
-+ cmovn $r3, $r4, $r5 ! Not 0 case (There's set bit in these 2 bits)
-+ add $p0, $p0, $r3 ! Update bit count
-+ slli $r3, $p1, #2 ! Not 0 case (Find set bit in these 2 bits)
-+ cmovn $p1, $r3, $r5 ! For 0 case (Find set bit in the rest 2 bits)
-+ andi $r5, $p1, #0x40 ! Get bit 6
-+ move $r3, #1 ! For 0 case (bit 6 is not set)
-+ cmovn $r3, $r4, $r5 ! Not 0 case (bit 6 is set bit)
-+ add $r5, $p0, $r3
-+ add $r0, $r5, $r2
-+ ret
-+
-+ENTRY(_ext2_find_first_zero_bit)
-+ pushm $r2, $r4
-+ move $r2, #0
-+ move $p0, #0 ! Reset bit count
-+1:
-+ lbi.bi $r3, [$r0], #1
-+ xori $r3, $r3, #0xff
-+ addi $p0, $p0, #8
-+ beqz $r3, 1b
-+ addi $p0, $p0, #-8
-+
-+2:
-+ b found ! No return
-+ popm $r2, $r4
-+ ret
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/getuser.S linux-3.4.113/arch/nds32/lib/getuser.S
---- linux-3.4.113.orig/arch/nds32/lib/getuser.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/getuser.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,79 @@
-+/*
-+ * linux/arch/nds32/lib/getuser.S
-+ *
-+ * Copyright (C) 2001 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Idea from x86 version, (C) Copyright 1998 Linus Torvalds
-+ *
-+ * These functions have a non-standard call interface to make them more
-+ * efficient, especially as they return an error value in addition to
-+ * the "real" return value.
-+ *
-+ * __get_user_X
-+ *
-+ * Inputs: $r0 contains the address
-+ * Outputs: $r0 is the error code
-+ * $r2, $r3 contains the zero-extended value
-+ * lr corrupted
-+ *
-+ * No other registers must be altered. (see include/asm-nds32/uaccess.h
-+ * for specific ASM register usage).
-+ *
-+ * Note that ADDR_LIMIT is either 0 or 0xc0000000.
-+ * Note also that it is intended that __get_user_bad is not global.
-+ */
-+#include <asm/asm-offsets.h>
-+#include <asm/thread_info.h>
-+#include <asm/errno.h>
-+#include <linux/linkage.h>
-+
-+
-+ENTRY(__get_user_1)
-+1: lbi $r2, [$r0]
-+ move $r0, #0
-+ ret
-+
-+ENTRY(__get_user_2)
-+2: lbi.bi $r2, [$r0], #1
-+3: lbi $r3, [$r0]
-+#ifndef __NDS32_EB__
-+ slli $p1, $r3, #8
-+ or $r2, $r2, $p1
-+#else
-+ slli $p1, $r2, #8
-+ or $r2, $r3, $p1
-+#endif
-+ move $r0, #0
-+ ret
-+
-+ENTRY(__get_user_4)
-+4: lwi $r2, [$r0]
-+ move $r0, #0
-+ ret
-+
-+ENTRY(__get_user_8)
-+5: lwi.bi $r2, [$r0], #4
-+6: lwi $r3, [$r0]
-+ move $r0, #0
-+ ret
-+
-+__get_user_bad_8:
-+ move $r3, #0
-+__get_user_bad:
-+ move $r2, #0
-+ move $r0, #-EFAULT
-+ ret
-+
-+.section __ex_table, "a"
-+ .long 1b, __get_user_bad
-+ .long 2b, __get_user_bad
-+ .long 3b, __get_user_bad
-+ .long 4b, __get_user_bad
-+ .long 5b, __get_user_bad_8
-+ .long 6b, __get_user_bad_8
-+.previous
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/libgcc2.c linux-3.4.113/arch/nds32/lib/libgcc2.c
---- linux-3.4.113.orig/arch/nds32/lib/libgcc2.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/libgcc2.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,351 @@
-+#define BITS_PER_UNIT 8
-+#include "longlong.h"
-+typedef unsigned int UQItype __attribute__ ((mode(QI)));
-+typedef int SItype __attribute__ ((mode(SI)));
-+typedef unsigned int USItype __attribute__ ((mode(SI)));
-+typedef int DItype __attribute__ ((mode(DI)));
-+typedef unsigned int UDItype __attribute__ ((mode(DI)));
-+
-+typedef int word_type __attribute__ ((mode(__word__)));
-+
-+#define Wtype SItype
-+#define UWtype USItype
-+#define DWtype DItype
-+#define UDWtype UDItype
-+
-+#ifdef __NDS32_EB__
-+struct DWstruct {
-+ Wtype high, low;
-+};
-+#else
-+struct DWstruct {
-+ Wtype low, high;
-+};
-+#endif
-+
-+typedef union {
-+ struct DWstruct s;
-+ DWtype ll;
-+} DWunion;
-+DWtype __negdi2(DWtype u)
-+{
-+ const DWunion uu = {.ll = u };
-+ const DWunion w = { {.low = -uu.s.low,
-+ .high = -uu.s.high - ((UWtype) - uu.s.low > 0)}
-+ };
-+
-+ return w.ll;
-+}
-+
-+DWtype __lshrdi3(DWtype u, word_type b)
-+{
-+ const DWunion uu = {.ll = u };
-+ const word_type bm = (sizeof(Wtype) * BITS_PER_UNIT) - b;
-+ DWunion w;
-+
-+ if (b == 0)
-+ return u;
-+
-+ if (bm <= 0) {
-+ w.s.high = 0;
-+ w.s.low = (UWtype) uu.s.high >> -bm;
-+ } else {
-+ const UWtype carries = (UWtype) uu.s.high << bm;
-+
-+ w.s.high = (UWtype) uu.s.high >> b;
-+ w.s.low = ((UWtype) uu.s.low >> b) | carries;
-+ }
-+
-+ return w.ll;
-+}
-+
-+DWtype __ashldi3(DWtype u, word_type b)
-+{
-+ const DWunion uu = {.ll = u };
-+ const word_type bm = (sizeof(Wtype) * BITS_PER_UNIT) - b;
-+ DWunion w;
-+
-+ if (b == 0)
-+ return u;
-+
-+ if (bm <= 0) {
-+ w.s.low = 0;
-+ w.s.high = (UWtype) uu.s.low << -bm;
-+ } else {
-+ const UWtype carries = (UWtype) uu.s.low >> bm;
-+
-+ w.s.low = (UWtype) uu.s.low << b;
-+ w.s.high = ((UWtype) uu.s.high << b) | carries;
-+ }
-+
-+ return w.ll;
-+}
-+
-+DWtype __ashrdi3(DWtype u, word_type b)
-+{
-+ const DWunion uu = {.ll = u };
-+ const word_type bm = (sizeof(Wtype) * BITS_PER_UNIT) - b;
-+ DWunion w;
-+
-+ if (b == 0)
-+ return u;
-+
-+ if (bm <= 0) {
-+ /* w.s.high = 1..1 or 0..0 */
-+ w.s.high = uu.s.high >> (sizeof(Wtype) * BITS_PER_UNIT - 1);
-+ w.s.low = uu.s.high >> -bm;
-+ } else {
-+ const UWtype carries = (UWtype) uu.s.high << bm;
-+
-+ w.s.high = uu.s.high >> b;
-+ w.s.low = ((UWtype) uu.s.low >> b) | carries;
-+ }
-+
-+ return w.ll;
-+}
-+
-+DWtype __muldi3(DWtype u, DWtype v)
-+{
-+ const DWunion uu = {.ll = u };
-+ const DWunion vv = {.ll = v };
-+ DWunion w = {.ll = __umulsidi3(uu.s.low, vv.s.low) };
-+
-+ w.s.high += ((UWtype) uu.s.low * (UWtype) vv.s.high
-+ + (UWtype) uu.s.high * (UWtype) vv.s.low);
-+
-+ return w.ll;
-+}
-+
-+const UQItype __clz_tab[] = {
-+ 0, 1, 2, 2, 3, 3, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 5, 5, 5, 5, 5, 5,
-+ 5, 5, 5, 5, 5, 5, 5, 5,
-+ 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
-+ 6, 6, 6, 6, 6, 6, 6, 6,
-+ 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
-+ 7, 7, 7, 7, 7, 7, 7, 7,
-+ 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
-+ 7, 7, 7, 7, 7, 7, 7, 7,
-+ 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8,
-+ 8, 8, 8, 8, 8, 8, 8, 8,
-+ 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8,
-+ 8, 8, 8, 8, 8, 8, 8, 8,
-+ 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8,
-+ 8, 8, 8, 8, 8, 8, 8, 8,
-+ 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8,
-+ 8, 8, 8, 8, 8, 8, 8, 8,
-+};
-+
-+UDWtype __udivmoddi4(UDWtype n, UDWtype d, UDWtype * rp)
-+{
-+ const DWunion nn = {.ll = n };
-+ const DWunion dd = {.ll = d };
-+ DWunion rr;
-+ UWtype d0, d1, n0, n1, n2;
-+ UWtype q0, q1;
-+ UWtype b, bm;
-+ DWunion ww;
-+
-+ d0 = dd.s.low;
-+ d1 = dd.s.high;
-+ n0 = nn.s.low;
-+ n1 = nn.s.high;
-+
-+#if !UDIV_NEEDS_NORMALIZATION
-+ if (d1 == 0) {
-+ if (d0 > n1) {
-+ /* 0q = nn / 0D */
-+
-+ udiv_qrnnd(q0, n0, n1, n0, d0);
-+ q1 = 0;
-+
-+ /* Remainder in n0. */
-+ } else {
-+ /* qq = NN / 0d */
-+
-+ if (d0 == 0)
-+ d0 = 1 / d0; /* Divide intentionally by zero. */
-+
-+ udiv_qrnnd(q1, n1, 0, n1, d0);
-+ udiv_qrnnd(q0, n0, n1, n0, d0);
-+
-+ /* Remainder in n0. */
-+ }
-+
-+ if (rp != 0) {
-+ rr.s.low = n0;
-+ rr.s.high = 0;
-+ *rp = rr.ll;
-+ }
-+ }
-+#else /* UDIV_NEEDS_NORMALIZATION */
-+
-+ if (d1 == 0) {
-+ if (d0 > n1) {
-+ /* 0q = nn / 0D */
-+
-+ count_leading_zeros(bm, d0);
-+
-+ if (bm != 0) {
-+ /* Normalize, i.e. make the most significant bit of the
-+ denominator set. */
-+
-+ d0 = d0 << bm;
-+ n1 = (n1 << bm) | (n0 >> (W_TYPE_SIZE - bm));
-+ n0 = n0 << bm;
-+ }
-+
-+ udiv_qrnnd(q0, n0, n1, n0, d0);
-+ q1 = 0;
-+
-+ /* Remainder in n0 >> bm. */
-+ } else {
-+ /* qq = NN / 0d */
-+
-+ if (d0 == 0)
-+ d0 = 1 / d0; /* Divide intentionally by zero. */
-+
-+ count_leading_zeros(bm, d0);
-+
-+ if (bm == 0) {
-+ /* From (n1 >= d0) /\ (the most significant bit of d0 is set),
-+ conclude (the most significant bit of n1 is set) /\ (the
-+ leading quotient digit q1 = 1).
-+
-+ This special case is necessary, not an optimization.
-+ (Shifts counts of W_TYPE_SIZE are undefined.) */
-+
-+ n1 -= d0;
-+ q1 = 1;
-+ } else {
-+ /* Normalize. */
-+
-+ b = W_TYPE_SIZE - bm;
-+
-+ d0 = d0 << bm;
-+ n2 = n1 >> b;
-+ n1 = (n1 << bm) | (n0 >> b);
-+ n0 = n0 << bm;
-+
-+ udiv_qrnnd(q1, n1, n2, n1, d0);
-+ }
-+
-+ /* n1 != d0... */
-+
-+ udiv_qrnnd(q0, n0, n1, n0, d0);
-+
-+ /* Remainder in n0 >> bm. */
-+ }
-+
-+ if (rp != 0) {
-+ rr.s.low = n0 >> bm;
-+ rr.s.high = 0;
-+ *rp = rr.ll;
-+ }
-+ }
-+#endif /* UDIV_NEEDS_NORMALIZATION */
-+
-+ else {
-+ if (d1 > n1) {
-+ /* 00 = nn / DD */
-+
-+ q0 = 0;
-+ q1 = 0;
-+
-+ /* Remainder in n1n0. */
-+ if (rp != 0) {
-+ rr.s.low = n0;
-+ rr.s.high = n1;
-+ *rp = rr.ll;
-+ }
-+ } else {
-+ /* 0q = NN / dd */
-+
-+ count_leading_zeros(bm, d1);
-+ if (bm == 0) {
-+ /* From (n1 >= d1) /\ (the most significant bit of d1 is set),
-+ conclude (the most significant bit of n1 is set) /\ (the
-+ quotient digit q0 = 0 or 1).
-+
-+ This special case is necessary, not an optimization. */
-+
-+ /* The condition on the next line takes advantage of that
-+ n1 >= d1 (true due to program flow). */
-+ if (n1 > d1 || n0 >= d0) {
-+ q0 = 1;
-+ sub_ddmmss(n1, n0, n1, n0, d1, d0);
-+ } else
-+ q0 = 0;
-+
-+ q1 = 0;
-+
-+ if (rp != 0) {
-+ rr.s.low = n0;
-+ rr.s.high = n1;
-+ *rp = rr.ll;
-+ }
-+ } else {
-+ UWtype m1, m0;
-+ /* Normalize. */
-+
-+ b = W_TYPE_SIZE - bm;
-+
-+ d1 = (d1 << bm) | (d0 >> b);
-+ d0 = d0 << bm;
-+ n2 = n1 >> b;
-+ n1 = (n1 << bm) | (n0 >> b);
-+ n0 = n0 << bm;
-+
-+ udiv_qrnnd(q0, n1, n2, n1, d1);
-+ umul_ppmm(m1, m0, q0, d0);
-+
-+ if (m1 > n1 || (m1 == n1 && m0 > n0)) {
-+ q0--;
-+ sub_ddmmss(m1, m0, m1, m0, d1, d0);
-+ }
-+
-+ q1 = 0;
-+
-+ /* Remainder in (n1n0 - m1m0) >> bm. */
-+ if (rp != 0) {
-+ sub_ddmmss(n1, n0, n1, n0, m1, m0);
-+ rr.s.low = (n1 << b) | (n0 >> bm);
-+ rr.s.high = n1 >> bm;
-+ *rp = rr.ll;
-+ }
-+ }
-+ }
-+ }
-+
-+ ww.s.low = q0, ww.s.high = q1;
-+ return ww.ll;
-+}
-+
-+UDWtype __umoddi3(UDWtype u, UDWtype v)
-+{
-+ UDWtype w;
-+
-+ (void)__udivmoddi4(u, v, &w);
-+
-+ return w;
-+}
-+
-+UDWtype __udivdi3(UDWtype n, UDWtype d)
-+{
-+ return __udivmoddi4(n, d, (UDWtype *) 0);
-+}
-+
-+word_type __ucmpdi2(DWtype a, DWtype b)
-+{
-+ const DWunion au = {.ll = a };
-+ const DWunion bu = {.ll = b };
-+
-+ if ((UWtype) au.s.high < (UWtype) bu.s.high)
-+ return 0;
-+ else if ((UWtype) au.s.high > (UWtype) bu.s.high)
-+ return 2;
-+ if ((UWtype) au.s.low < (UWtype) bu.s.low)
-+ return 0;
-+ else if ((UWtype) au.s.low > (UWtype) bu.s.low)
-+ return 2;
-+ return 1;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/longlong.h linux-3.4.113/arch/nds32/lib/longlong.h
---- linux-3.4.113.orig/arch/nds32/lib/longlong.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/longlong.h 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,105 @@
-+#define __BITS4 (W_TYPE_SIZE / 4)
-+#define __ll_B ((UWtype) 1 << (W_TYPE_SIZE / 2))
-+#define __ll_lowpart(t) ((UWtype) (t) & (__ll_B - 1))
-+#define __ll_highpart(t) ((UWtype) (t) >> (W_TYPE_SIZE / 2))
-+
-+#define W_TYPE_SIZE (4 * 8)
-+#define UHWtype USItype
-+
-+#define sub_ddmmss(sh, sl, ah, al, bh, bl) \
-+ do { \
-+ UWtype __x; \
-+ __x = (al) - (bl); \
-+ (sh) = (ah) - (bh) - (__x > (al)); \
-+ (sl) = __x; \
-+ } while (0)
-+
-+#define umul_ppmm(w1, w0, u, v) \
-+ do { \
-+ UWtype __x0, __x1, __x2, __x3; \
-+ UHWtype __ul, __vl, __uh, __vh; \
-+ \
-+ __ul = __ll_lowpart (u); \
-+ __uh = __ll_highpart (u); \
-+ __vl = __ll_lowpart (v); \
-+ __vh = __ll_highpart (v); \
-+ \
-+ __x0 = (UWtype) __ul * __vl; \
-+ __x1 = (UWtype) __ul * __vh; \
-+ __x2 = (UWtype) __uh * __vl; \
-+ __x3 = (UWtype) __uh * __vh; \
-+ \
-+ __x1 += __ll_highpart (__x0);/* this can't give carry */ \
-+ __x1 += __x2; /* but this indeed can */ \
-+ if (__x1 < __x2) /* did we get it? */ \
-+ __x3 += __ll_B; /* yes, add it in the proper pos. */ \
-+ \
-+ (w1) = __x3 + __ll_highpart (__x1); \
-+ (w0) = __ll_lowpart (__x1) * __ll_B + __ll_lowpart (__x0); \
-+ } while (0)
-+
-+#define __umulsidi3(u, v) \
-+ ({DWunion __w; \
-+ umul_ppmm (__w.s.high, __w.s.low, u, v); \
-+ __w.ll; })
-+
-+#define __udiv_qrnnd_c(q, r, n1, n0, d) \
-+ do { \
-+ UWtype __d1, __d0, __q1, __q0; \
-+ UWtype __r1, __r0, __m; \
-+ __d1 = __ll_highpart (d); \
-+ __d0 = __ll_lowpart (d); \
-+ \
-+ __r1 = (n1) % __d1; \
-+ __q1 = (n1) / __d1; \
-+ __m = (UWtype) __q1 * __d0; \
-+ __r1 = __r1 * __ll_B | __ll_highpart (n0); \
-+ if (__r1 < __m) \
-+ { \
-+ __q1--, __r1 += (d); \
-+ if (__r1 >= (d)) /* i.e. we didn't get carry when adding to __r1 */\
-+ if (__r1 < __m) \
-+ __q1--, __r1 += (d); \
-+ } \
-+ __r1 -= __m; \
-+ \
-+ __r0 = __r1 % __d1; \
-+ __q0 = __r1 / __d1; \
-+ __m = (UWtype) __q0 * __d0; \
-+ __r0 = __r0 * __ll_B | __ll_lowpart (n0); \
-+ if (__r0 < __m) \
-+ { \
-+ __q0--, __r0 += (d); \
-+ if (__r0 >= (d)) \
-+ if (__r0 < __m) \
-+ __q0--, __r0 += (d); \
-+ } \
-+ __r0 -= __m; \
-+ \
-+ (q) = (UWtype) __q1 * __ll_B | __q0; \
-+ (r) = __r0; \
-+ } while (0)
-+
-+#define UDIV_NEEDS_NORMALIZATION 1
-+#define udiv_qrnnd __udiv_qrnnd_c
-+
-+#define count_leading_zeros(count, x) \
-+ do { \
-+ UWtype __xr = (x); \
-+ UWtype __a; \
-+ \
-+ if (W_TYPE_SIZE <= 32) \
-+ { \
-+ __a = __xr < ((UWtype)1<<2*__BITS4) \
-+ ? (__xr < ((UWtype)1<<__BITS4) ? 0 : __BITS4) \
-+ : (__xr < ((UWtype)1<<3*__BITS4) ? 2*__BITS4 : 3*__BITS4); \
-+ } \
-+ else \
-+ { \
-+ for (__a = W_TYPE_SIZE - 8; __a > 0; __a -= 8) \
-+ if (((__xr >> __a) & 0xff) != 0) \
-+ break; \
-+ } \
-+ \
-+ (count) = W_TYPE_SIZE - (__clz_tab[__xr >> __a] + __a); \
-+ } while (0)
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/Makefile linux-3.4.113/arch/nds32/lib/Makefile
---- linux-3.4.113.orig/arch/nds32/lib/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/Makefile 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,19 @@
-+#
-+# linux/arch/nds32/lib/Makefile
-+#
-+# Copyright (C) 2006 Andes Technology Corporation
-+#
-+
-+lib-y := csum_partial_copy.o csum_partial.o \
-+ copy_page.o memcpy.o memmove.o \
-+ memset.o memzero.o strncpy_from_user.o \
-+ strnlen_user.o strchr.o strrchr.o \
-+ uaccess.o getuser.o \
-+ putuser.o libgcc2.o divmod.o udivmod.o udivmodsi4.o
-+
-+ifdef CONFIG_FUNCTION_TRACER
-+CFLAGS_REMOVE_libgcc2.o = -pg
-+CFLAGS_REMOVE_divmod.o = -pg
-+CFLAGS_REMOVE_udivmod.o = -pg
-+CFLAGS_REMOVE_udivmodsi4.o = -pg
-+endif
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/memcpy.S linux-3.4.113/arch/nds32/lib/memcpy.S
---- linux-3.4.113.orig/arch/nds32/lib/memcpy.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/memcpy.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,101 @@
-+/*
-+ * linux/arch/nds32/lib/memcpy.S -- Memory copy function.
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 2001 Hiroyuki Kondo, and Hirokazu Takata
-+ * Copyright (C) 2004 Hirokazu Takata
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ */
-+
-+#include <linux/linkage.h>
-+
-+/*
-+ void *memcpy(void *dst, const void *src, int n);
-+
-+ dst: $r0
-+ src: $r1
-+ n : $r2
-+ ret: $r0 - pointer to the memory area dst.
-+*/
-+
-+#include <linux/linkage.h>
-+
-+ .text
-+
-+ENTRY(memcpy)
-+ move $r5, $r0
-+ beq $r0, $r1, quit_memcpy
-+ beqz $r2, quit_memcpy
-+ srli $r3, $r2, #5 ! check if len < cache-line size 32
-+ beqz $r3, word_copy_entry
-+ andi $r4, $r0, #0x3 ! check byte-align
-+ beqz $r4, unalign_word_copy_entry
-+
-+ addi $r4, $r4,#-4
-+ abs $r4, $r4 ! check how many un-align byte to copy
-+ sub $r2, $r2, $r4 ! update $R2
-+
-+unalign_byte_copy:
-+ lbi.bi $r3, [$r1], #1
-+ addi $r4, $r4, #-1
-+ sbi.bi $r3, [$r0], #1
-+ bnez $r4, unalign_byte_copy
-+ beqz $r2, quit_memcpy
-+
-+unalign_word_copy_entry:
-+ andi $r3, $r0, 0x1f ! check cache-line unaligncount
-+ beqz $r3, cache_copy
-+
-+ addi $r3, $r3, #-32
-+ abs $r3, $r3
-+ sub $r2, $r2, $r3 ! update $R2
-+
-+unalign_word_copy:
-+ lmw.bim $r4, [$r1], $r4
-+ addi $r3, $r3, #-4
-+ smw.bim $r4, [$r0], $r4
-+ bnez $r3, unalign_word_copy
-+ beqz $r2, quit_memcpy
-+
-+ addi $r3, $r2, #-32 ! to check $r2< cache_line , than go to word_copy
-+ bltz $r3, word_copy_entry
-+cache_copy:
-+ srli $r3, $r2, #5
-+ beqz $r3, word_copy_entry
-+ pushm $r6, $r13
-+3:
-+ lmw.bim $r6, [$r1], $r13
-+ addi $r3, $r3, #-1
-+ smw.bim $r6, [$r0], $r13
-+ bnez $r3, 3b
-+ popm $r6, $r13
-+
-+word_copy_entry:
-+ andi $r2, $r2, #31
-+
-+ beqz $r2, quit_memcpy
-+5:
-+ srli $r3, $r2, #2
-+ beqz $r3, byte_copy
-+word_copy:
-+ lmw.bim $r4, [$r1], $r4
-+ addi $r3, $r3, #-1
-+ smw.bim $r4, [$r0], $r4
-+ bnez $r3, word_copy
-+ andi $r2, $r2, #3
-+ beqz $r2, quit_memcpy
-+byte_copy:
-+ lbi.bi $r3, [$r1], #1
-+ addi $r2, $r2, #-1
-+
-+ sbi.bi $r3, [$r0], #1
-+ bnez $r2, byte_copy
-+quit_memcpy:
-+ move $r0, $r5
-+ ret
-+
-+ .end
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/memmove.S linux-3.4.113/arch/nds32/lib/memmove.S
---- linux-3.4.113.orig/arch/nds32/lib/memmove.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/memmove.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,80 @@
-+/*
-+ * linux/arch/nds32/lib/memmove.S -- Memory move function.
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 2001 Hiroyuki Kondo, and Hirokazu Takata
-+ * Copyright (C) 2004 Hirokazu Takata
-+ * Copyright (C) 2006 Andes Technology Corporation
-+ *
-+ */
-+
-+#include <linux/linkage.h>
-+
-+/*
-+ void *memmove(void *dst, const void *src, int n);
-+
-+ dst: $r0
-+ src: $r1
-+ n : $r2
-+ ret: $r0 - pointer to the memory area dst.
-+*/
-+ .text
-+
-+ENTRY(memmove)
-+ move $r5, $r0 ! Set return value = det
-+ beq $r0, $r1, exit_memcpy ! Exit when det = src
-+ beqz $r2, exit_memcpy ! Exit when n = 0
-+ pushm $t0, $t1 ! Save reg
-+ srli $p1, $r2, #2 ! $p1 is how many words to copy
-+
-+ ! Avoid data lost when memory overlap
-+ ! Copy data reversely when src < dst
-+ slt $p0, $r0, $r1 ! check if $r0 < $r1
-+ beqz $p0, do_reverse ! branch if dst > src
-+
-+ ! No reverse, dst < src
-+ andi $r2, $r2, #3 ! How many bytes are less than a word
-+ li $t0, #1 ! Determining copy direction in byte_cpy
-+ beqz $p1, byte_cpy ! When n is less than a word
-+
-+word_cpy:
-+ lmw.bim $p0, [$r1], $p0 ! Read a word from src
-+ addi $p1, $p1, #-1 ! How many words left to copy
-+ smw.bim $p0, [$r0], $p0 ! Copy the word to det
-+ bnez $p1, word_cpy ! If remained words > 0
-+ beqz $r2, end_memcpy ! No left bytes to copy
-+ b byte_cpy
-+
-+do_reverse:
-+ add $r0, $r0, $r2 ! Start with the end of $r0
-+ add $r1, $r1, $r2 ! Start with the end of $r1
-+ andi $r2, $r2, #3 ! How many bytes are less than a word
-+ li $t0, #-1 ! Determining copy direction in byte_cpy
-+ beqz $p1, reverse_byte_cpy ! When n is less than a word
-+
-+reverse_word_cpy:
-+ lmw.adm $p0, [$r1], $p0 ! Read a word from src
-+ addi $p1, $p1, #-1 ! How many words left to copy
-+ smw.adm $p0, [$r0], $p0 ! Copy the word to det
-+ bnez $p1, reverse_word_cpy ! If remained words > 0
-+ beqz $r2, end_memcpy ! No left bytes to copy
-+
-+reverse_byte_cpy:
-+ addi $r0, $r0, #-1
-+ addi $r1, $r1, #-1
-+byte_cpy: ! Less than 4 bytes to copy now
-+ lb.bi $p0, [$r1], $t0 ! Read a byte from src
-+ addi $r2, $r2, #-1 ! How many bytes left to copy
-+ sb.bi $p0, [$r0], $t0 ! copy the byte to det
-+ bnez $r2, byte_cpy ! If remained bytes > 0
-+
-+end_memcpy:
-+ popm $t0, $t1
-+exit_memcpy:
-+ move $r0, $r5
-+ ret
-+
-+ .end
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/memset.S linux-3.4.113/arch/nds32/lib/memset.S
---- linux-3.4.113.orig/arch/nds32/lib/memset.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/memset.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,51 @@
-+
-+/*
-+ * linux/arch/nds32/lib/memset.S -- memset function.
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 2001,2002 Hiroyuki Kondo, and Hirokazu Takata
-+ * Copyright (C) 2004 Hirokazu Takata
-+ * Copyright (C) 2006 Andes Technology Corporation
-+ *
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+
-+/*
-+ void *memset(void *dst, int val, int len);
-+
-+ dst: $r0
-+ val: $r1
-+ len: $r2
-+ ret: $r0 - pointer to the memory area dst.
-+*/
-+ .text
-+ENTRY(memset)
-+ move $r5, $r0 ! Return value
-+ beqz $r2, end_memset ! Exit when len = 0
-+ srli $p1, $r2, 2 ! $p1 is how many words to copy
-+ andi $r2, $r2, 3 ! How many bytes are less than a word
-+ beqz $p1, byte_set ! When n is less than a word
-+
-+ ! set $r1 from ??????ab to abababab
-+ andi $r1, $r1, #0x00ff ! $r1 = 000000ab
-+ slli $p0, $r1, #8 ! $p0 = 0000ab00
-+ or $r1, $r1, $p0 ! $r1 = 0000abab
-+ slli $p0, $r1, #16 ! $p0 = abab0000
-+ or $r1, $r1, $p0 ! $r1 = abababab
-+word_set:
-+ addi $p1, $p1, #-1 ! How many words left to copy
-+ smw.bim $r1, [$r0], $r1 ! Copy the word to det
-+ bnez $p1, word_set ! Still words to set, continue looping
-+ beqz $r2, end_memset ! No left byte to set
-+byte_set: ! Less than 4 bytes left to set
-+ addi $r2, $r2, #-1 ! Decrease len by 1
-+ sbi.bi $r1, [$r0], #1 ! Set data of the next byte to $r1
-+ bnez $r2, byte_set ! Still bytes left to set
-+end_memset:
-+ move $r0, $r5
-+ ret
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/memzero.S linux-3.4.113/arch/nds32/lib/memzero.S
---- linux-3.4.113.orig/arch/nds32/lib/memzero.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/memzero.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,36 @@
-+/*
-+ * linux/arch/nds32/lib/memzero.S
-+ *
-+ * Copyright (C) 1995-2000 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+
-+ .text
-+/*
-+ * void *__memzero(void *dst, int len);
-+ *
-+ * dst: $r0
-+ * len: $r1
-+ * ret: $r0 - pointer to the memory area dst.
-+ *
-+ * Call memset(dst, 0, len) to perform memzero.
-+ * Currently no optimization because only being referenced in 31 files
-+ * (For comparison, memset being referenced in 2527 files)
-+ */
-+ENTRY(__memzero)
-+ beqz $r1, 1f
-+ push $lp
-+ move $r2, $r1
-+ move $r1, #0
-+ push $r0
-+ bal memset
-+ pop $r0
-+ pop $lp
-+1:
-+ ret
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/putuser.S linux-3.4.113/arch/nds32/lib/putuser.S
---- linux-3.4.113.orig/arch/nds32/lib/putuser.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/putuser.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,68 @@
-+/*
-+ * linux/arch/nds32/lib/putuser.S
-+ *
-+ * Copyright (C) 2001 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Idea from x86 version, (C) Copyright 1998 Linus Torvalds
-+ *
-+ * These functions have a non-standard call interface to make
-+ * them more efficient, especially as they return an error
-+ * value in addition to the "real" return value.
-+ *
-+ * __put_user_X
-+ *
-+ * Inputs: $r0 contains the address
-+ * $r2, $r3 contains the value
-+ * Outputs: $r0 is the error code
-+ * lr corrupted
-+ *
-+ * No other registers must be altered. (see include/asm-arm/uaccess.h
-+ * for specific ASM register usage).
-+ *
-+ * Note that ADDR_LIMIT is either 0 or 0xc0000000
-+ * Note also that it is intended that __put_user_bad is not global.
-+ */
-+#include <asm/asm-offsets.h>
-+#include <asm/thread_info.h>
-+#include <asm/errno.h>
-+#include <linux/linkage.h>
-+
-+ .text
-+
-+ENTRY(__put_user_1)
-+1: sb $r2, [$r0]
-+ move $r0, #0
-+ ret
-+
-+ENTRY(__put_user_2)
-+2: shi $r2, [$r0] ! Store input halfword
-+ move $r0, #0
-+ ret
-+
-+ENTRY(__put_user_4)
-+3: sw $r2, [$r0]
-+ move $r0, #0
-+ ret
-+
-+ENTRY(__put_user_8)
-+5: swi.bi $r2, [$r0], #4
-+6: sw $r3, [$r0]
-+ move $r0, #0
-+ ret
-+
-+__put_user_bad:
-+ move $r0, #-EFAULT
-+ ret
-+
-+.section __ex_table, "a"
-+ .long 1b, __put_user_bad
-+ .long 2b, __put_user_bad
-+ .long 3b, __put_user_bad
-+ .long 5b, __put_user_bad
-+ .long 6b, __put_user_bad
-+.previous
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/strchr.S linux-3.4.113/arch/nds32/lib/strchr.S
---- linux-3.4.113.orig/arch/nds32/lib/strchr.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/strchr.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,37 @@
-+/*
-+ * linux/arch/nds32/lib/strchr.S
-+ *
-+ * Copyright (C) 1995-2000 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * ASM optimised string functions
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+
-+/*
-+ * Prototype: char *strrchr(const char *s, int c);
-+ * Purpose : Returns a pointer to the first occurrence of the character c
-+ * in the string s. Here "character" means "byte" - these functions
-+ * do not work with wide or multi-byte characters.
-+ */
-+
-+ .text
-+
-+ENTRY(strchr)
-+ move $r5, $r0 ! Setup return value
-+ andi $r1, $r1, #0xff ! Wipe out useless bits
-+loop:
-+ lbi.bi $p0, [$r5], #1 ! Load the next byte
-+ beqz $p0, exit ! Reach EOS (NULL), return NULL
-+ bne $p0, $r1, loop ! Continue if != c
-+ addi $r5, $r5, #-1 ! Found
-+exit:
-+ cmovz $r5, $p0, $p0 ! Return NULL if EOS (NULL)
-+ move $r0, $r5
-+ ret
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/strncpy_from_user.S linux-3.4.113/arch/nds32/lib/strncpy_from_user.S
---- linux-3.4.113.orig/arch/nds32/lib/strncpy_from_user.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/strncpy_from_user.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,45 @@
-+/*
-+ * linux/arch/nds32/lib/strncpy_from_user.S
-+ *
-+ * Copyright (C) 1995-2000 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+#include <asm/errno.h>
-+
-+
-+/*
-+ * Copy a string from user space to kernel space.
-+ * $r0 = dst, $r1 = src, $r2 = n (byte length)
-+ * returns the number of characters copied (strlen of copied string),
-+ * -EFAULT on exception, or "len" if we fill the whole buffer
-+ */
-+
-+ .text
-+ .align 4
-+ENTRY(__arch_strncpy_from_user)
-+ move $p1, $r1 ! Record the start src addr
-+loop:
-+ addi $r2, $r2, #-1 ! Decrease n by 1
-+ bltz $r2, exit ! Exit if n < 0
-+USER( lbi.bi, $p0, [$r1], #1) ! Load the byte from src
-+ sbi.bi $p0, [$r0], #1 ! Store the byte to dst
-+ bnez $p0, loop ! Continue looping if terminator is not reached
-+ addi $r1, $r1, #-1 ! Don't count the terminator
-+exit:
-+ sub $r0, $r1, $p1 ! Get copied count
-+ ret
-+
-+ .section .fixup,"ax"
-+ .align 0
-+9001: xor $p0, $p0, $p0
-+ sb $p0, [$r0] ! Zero the buffer
-+ move $r0, -EFAULT ! Return -EFAULT
-+ ret
-+ .previous
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/strnlen_user.S linux-3.4.113/arch/nds32/lib/strnlen_user.S
---- linux-3.4.113.orig/arch/nds32/lib/strnlen_user.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/strnlen_user.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,43 @@
-+/*
-+ * linux/arch/nds32/lib/strnlen_user.S
-+ *
-+ * Copyright (C) 1995-2000 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+#include <asm/errno.h>
-+
-+ .text
-+
-+/* Prototype: unsigned long ___arch_strnlen_user(const char *str, long n)
-+ * Purpose : get length of a string in user memory
-+ * Params : str - address of string in user memory
-+ * Returns : length of string *including terminator*
-+ * or zero on exception, or n + 1 if too long
-+ */
-+ .align 4
-+ENTRY(__arch_strnlen_user)
-+ move $p0, $r0 ! Record the start addr
-+ ! beqz $r0, exit ! Exit when Null address
-+ beqz $r1, exit ! Exit when n = 0
-+loop:
-+USER( lbi.bi, $p1, [$r0], #1) ! Load the next byte
-+ beqz $p1, exit ! Exit when terminator is reached
-+ addi $r1, $r1, #-1 ! Decrease n by 1
-+ bnez $r1, loop ! Continue looping if n != 0
-+ addi $r0, $r0, #1 ! Return n+1 if too long
-+exit:
-+ sub $r0, $r0, $p0 ! Get the counted length
-+ ret
-+
-+ .section .fixup,"ax"
-+ .align 0
-+9001: move $r0, #0 ! Return 0 on exception
-+ ret
-+ .previous
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/strrchr.S linux-3.4.113/arch/nds32/lib/strrchr.S
---- linux-3.4.113.orig/arch/nds32/lib/strrchr.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/strrchr.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,37 @@
-+/*
-+ * linux/arch/nds32/lib/strrchr.S
-+ *
-+ * Copyright (C) 1995-2000 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * ASM optimised string functions
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+
-+ .text
-+/*
-+ * Prototype: char *strrchr(const char *s, int c);
-+ * Purpose : Returns a pointer to the last occurrence of the character c
-+ * in the string s. Here "character" means "byte" - these functions
-+ * do not work with wide or multi-byte characters.
-+ */
-+ .align 4
-+ENTRY(strrchr)
-+ move $r5, #0
-+ beqz $r0, exit
-+ andi $r1, $r1, #0xff ! Wipe out useless bits
-+loop:
-+ lbi $p0, [$r0] ! Load the next byte
-+ xor $p1, $p0, $r1 ! Test if the byte == c
-+ cmovz $r5, $r0, $p1 ! Save the current position
-+ addi $r0, $r0, #1 ! Move on to the next byte
-+ bnez $p0, loop ! Continue if not NULL (EOS)
-+exit:
-+ move $r0, $r5
-+ ret
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/uaccess.S linux-3.4.113/arch/nds32/lib/uaccess.S
---- linux-3.4.113.orig/arch/nds32/lib/uaccess.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/uaccess.S 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,159 @@
-+/*
-+ * linux/arch/nds32/lib/uaccess.S
-+ *
-+ * Copyright (C) 1995, 1996,1997,1998 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Routines to block copy data to/from user memory
-+ * These are highly optimised both for the 4k page size
-+ * and for various alignments.
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+#include <asm/errno.h>
-+
-+ .text
-+
-+//#define PAGE_SHIFT 12
-+
-+/* Prototype: int __arch_copy_to_user(void *to, const char *from, size_t n)
-+ * Purpose : copy a block to user memory from kernel memory
-+ * Params : to - user memory
-+ * : from - kernel memory
-+ * : n - number of bytes to copy
-+ * Returns : Number of bytes NOT copied.
-+ */
-+
-+ENTRY(__arch_copy_to_user)
-+ push $r0
-+ push $r2
-+ beqz $r2, ctu_exit
-+ srli $p0, $r2, #2 ! $p0 = number of word to clear
-+ andi $r2, $r2, #3 ! Bytes less than a word to copy
-+ beqz $p0, byte_ctu ! Only less than a word to copy
-+word_ctu:
-+ lmw.bim $p1, [$r1], $p1 ! Load the next word
-+USER( smw.bim,$p1, [$r0], $p1) ! Store the next word
-+ addi $p0, $p0, #-1 ! Decrease word count
-+ bnez $p0, word_ctu ! Continue looping to copy all words
-+ beqz $r2, ctu_exit ! No left bytes to copy
-+byte_ctu:
-+ lbi.bi $p1, [$r1], #1 ! Load the next byte
-+USER( sbi.bi, $p1, [$r0], #1) ! Store the next byte
-+ addi $r2, $r2, #-1 ! Decrease byte count
-+ bnez $r2, byte_ctu ! Continue looping to clear all left bytes
-+ctu_exit:
-+ move $r0, $r2 ! Set return value
-+ pop $r2
-+ pop $r2 ! Pop saved $r0 to $r2 to not corrupt return value
-+ ret
-+
-+ .section .fixup,"ax"
-+ .align 0
-+9001:
-+ pop $p1 ! Original $r2, n
-+ pop $p0 ! Original $r0, void *to
-+ sub $r1, $r0, $p0 ! Bytes copied
-+ sub $r2, $p1, $r1 ! Bytes left to copy
-+ push $lp
-+ move $r0, $p0
-+ bal __memzero ! Clean up the memory
-+ pop $lp
-+ move $r0, $r2
-+ ret
-+
-+ .previous
-+
-+/* Prototype: unsigned long __arch_copy_from_user(void *to,const void *from,unsigned long n);
-+ * Purpose : copy a block from user memory to kernel memory
-+ * Params : to - kernel memory
-+ * : from - user memory
-+ * : n - number of bytes to copy
-+ * Returns : Number of bytes NOT copied.
-+ */
-+
-+
-+ENTRY(__arch_copy_from_user)
-+ push $r1
-+ push $r2
-+ beqz $r2, cfu_exit
-+ srli $p0, $r2, #2 ! $p0 = number of word to clear
-+ andi $r2, $r2, #3 ! Bytes less than a word to copy
-+ beqz $p0, byte_cfu ! Only less than a word to copy
-+word_cfu:
-+USER( lmw.bim,$p1, [$r1], $p1) ! Load the next word
-+ smw.bim $p1, [$r0], $p1 ! Store the next word
-+ addi $p0, $p0, #-1 ! Decrease word count
-+ bnez $p0, word_cfu ! Continue looping to copy all words
-+ beqz $r2, cfu_exit ! No left bytes to copy
-+byte_cfu:
-+USER( lbi.bi, $p1, [$r1], #1) ! Load the next byte
-+ sbi.bi $p1, [$r0], #1 ! Store the next byte
-+ addi $r2, $r2, #-1 ! Decrease byte count
-+ bnez $r2, byte_cfu ! Continue looping to clear all left bytes
-+cfu_exit:
-+ move $r0, $r2 ! Set return value
-+ pop $r2
-+ pop $r1
-+ ret
-+
-+ .section .fixup,"ax"
-+ .align 0
-+ /*
-+ * We took an exception. $r0 contains a pointer to
-+ * the byte not copied.
-+ */
-+9001:
-+ pop $p1 ! Original $r2, n
-+ pop $p0 ! Original $r0, void *to
-+ sub $r1, $r1, $p0 ! Bytes copied
-+ sub $r2, $p1, $r1 ! Bytes left to copy
-+ push $lp
-+ bal __memzero ! Clean up the memory
-+ pop $lp
-+ move $r0, $r2
-+ ret
-+ .previous
-+
-+/* Prototype: int __arch_clear_user(void *addr, size_t sz)
-+ * Purpose : clear some user memory
-+ * Params : addr - user memory address to clear
-+ * : sz - number of bytes to clear
-+ * Returns : number of bytes NOT cleared
-+ */
-+ .align 5
-+ENTRY(__arch_clear_user)
-+ pushm $r0, $r1
-+ beqz $r1, clear_exit
-+ xor $p1, $p1, $p1 ! Use $p1=0 to clear mem
-+ srli $p0, $r1, #2 ! $p0 = number of word to clear
-+ andi $r1, $r1, #3 ! Bytes less than a word to copy
-+ beqz $p0, byte_clear ! Only less than a word to clear
-+word_clear:
-+USER( smw.bim,$p1, [$r0], $p1) ! Clear the word
-+ addi $p0, $p0, #-1 ! Decrease word count
-+ bnez $p0, word_clear ! Continue looping to clear all words
-+ beqz $r1, clear_exit ! No left bytes to copy
-+byte_clear:
-+USER( sbi.bi, $p1, [$r0], #1) ! Clear the byte
-+ addi $r1, $r1, #-1 ! Decrease byte count
-+ bnez $r1, byte_clear ! Continue looping to clear all left bytes
-+clear_exit:
-+ move $r0, $r1 ! Set return value
-+ pop $r1
-+ pop $r1 ! Pop saved $r0 to $r1 to not corrupt return value
-+ ret
-+
-+ .section .fixup,"ax"
-+ .align 0
-+9001:
-+ popm $p0, $p1 ! $p0 = original $r0, *addr, $p1 = original $r1, n
-+ sub $p0, $r0, $p0 ! Bytes copied
-+ sub $r0, $p1, $p0 ! Bytes left to copy
-+ ret
-+ .previous
-+
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/udivmod.c linux-3.4.113/arch/nds32/lib/udivmod.c
---- linux-3.4.113.orig/arch/nds32/lib/udivmod.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/udivmod.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,12 @@
-+extern unsigned long udivmodsi4(unsigned long num, unsigned long den,
-+ int modwanted);
-+
-+long __udivsi3(long a, long b)
-+{
-+ return udivmodsi4(a, b, 0);
-+}
-+
-+long __umodsi3(long a, long b)
-+{
-+ return udivmodsi4(a, b, 1);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/lib/udivmodsi4.c linux-3.4.113/arch/nds32/lib/udivmodsi4.c
---- linux-3.4.113.orig/arch/nds32/lib/udivmodsi4.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/lib/udivmodsi4.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,21 @@
-+unsigned long udivmodsi4(unsigned long num, unsigned long den, int modwanted)
-+{
-+ unsigned long bit = 1;
-+ unsigned long res = 0;
-+
-+ while (den < num && bit && !(den & (1L << 31))) {
-+ den <<= 1;
-+ bit <<= 1;
-+ }
-+ while (bit) {
-+ if (num >= den) {
-+ num -= den;
-+ res |= bit;
-+ }
-+ bit >>= 1;
-+ den >>= 1;
-+ }
-+ if (modwanted)
-+ return num;
-+ return res;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/Makefile linux-3.4.113/arch/nds32/Makefile
---- linux-3.4.113.orig/arch/nds32/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/Makefile 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,100 @@
-+#
-+# arch/nds32/Makefile
-+#
-+# This file is subject to the terms and conditions of the GNU General Public
-+# License. See the file "COPYING" in the main directory of this archive
-+# for more details.
-+#
-+# Copyright (C) 1995-2001 by Russell King
-+
-+LDFLAGS_vmlinux :=-nostdlib --no-undefined -X
-+OBJCOPYFLAGS :=-O binary -R .note -R .note.gnu.build-id -R .comment -S
-+GZFLAGS :=-9
-+KBUILD_CFLAGS +=-pipe -mno-sched-prolog-epilog
-+
-+# Do not use arch/nds32/defconfig - it's always outdated.
-+# Select a platform tht is kept up-to-date
-+KBUILD_DEFCONFIG := orca_defconfig
-+
-+ifeq ($(CONFIG_FRAME_POINTER),y)
-+KBUILD_CFLAGS +=-fno-omit-frame-pointer
-+endif
-+
-+comma = ,
-+
-+# This selects which instruction set is used.
-+# Note that GCC does not numerically define an architecture version
-+# macro, but instead defines a whole series of macros which makes
-+# testing for a specific architecture or later rather impossible.
-+arch-y +=-D__nds32__
-+gcc_ver :=$(shell $(CC) -E -dM -xc /dev/null | grep __VERSION__ | sed 's/\#define __VERSION__ //')
-+ifeq ($(shell expr `echo $(gcc_ver)` \>= 4.9.2 ), 1)
-+arch-y += \
-+ $(shell $(CC) -E -dM -xc /dev/null | \
-+ grep -o -m1 NDS32_EXT_FPU_SP | \
-+ sed -e 's/NDS32_EXT_FPU_SP/-mno-ext-fpu-sp -mfloat-abi=soft/') \
-+ $(shell $(CC) -E -dM -xc /dev/null | \
-+ grep -o -m1 NDS32_EXT_FPU_DP | \
-+ sed -e 's/NDS32_EXT_FPU_DP/-mno-ext-fpu-dp -mfloat-abi=soft/')
-+tune-y =-D__OPTIMIZE__ -mcmodel=large -D__ARCH_WANT_SYS_WAITPID
-+else
-+$(shell echo $(__VERSION__))
-+arch-y += $(shell $(CC) -E -dM -xc /dev/null | grep -o -m1 NDS32_EXT_FPU_SP | \
-+ sed -e 's/NDS32_EXT_FPU_SP/-mno-ext-fpu-sp/') \
-+ $(shell $(CC) -E -dM -xc /dev/null | grep -o -m1 NDS32_EXT_FPU_DP | \
-+ sed -e 's/NDS32_EXT_FPU_DP/-mno-ext-fpu-dp/') \
-+ $(shell $(CC) -E -dM -xc /dev/null | grep -o -m1 NDS32_ABI | \
-+ sed -e 's/NDS32_ABI/-mabi=2/')
-+tune-y =-D__OPTIMIZE__ -G0 -D__ARCH_WANT_SYS_WAITPID -D_GCC444
-+endif
-+
-+# This is a workaround for FUNCTION_TRACER because v3push will push $fp, $gp and $lp.
-+ifdef CONFIG_FUNCTION_TRACER
-+arch-y += -mno-v3push
-+endif
-+# This selects how we optimise for the processor.
-+# Need -Unds32 for gcc < 3.x
-+CHECKFLAGS += -D__nds32__
-+
-+KBUILD_CFLAGS +=$(CFLAGS_ABI) $(arch-y) $(tune-y) -Unds32 -DSTRICT_MM_TYPECHECKS # for c-style checking for page.h
-+KBUILD_AFLAGS +=$(AFLAGS_ABI) $(arch-y) $(tune-y)
-+
-+#Default value
-+head-y := arch/nds32/kernel/head.o arch/nds32/kernel/init_task.o
-+textaddr-y := 0xC000C000
-+
-+TEXTADDR := $(textaddr-y)
-+
-+export TEXTADDR DATAADDR GZFLAGS
-+
-+
-+# If we have a machine-specific directory, then include it in the build.
-+core-y += arch/nds32/kernel/ arch/nds32/mm/
-+core-y += arch/nds32/platforms/
-+core-$(CONFIG_FPU) += arch/nds32/math-emu/
-+
-+drivers-$(CONFIG_OPROFILE) += arch/nds32/oprofile/
-+
-+libs-y += arch/nds32/lib/
-+
-+boot := arch/nds32/boot
-+
-+.PHONY: FORCE
-+
-+Image: vmlinux
-+ $(Q)$(MAKE) $(build)=$(boot) $(boot)/$@
-+
-+CLEAN_FILES += include/asm-nds32/constants.h*
-+
-+# We use MRPROPER_FILES and CLEAN_FILES now
-+archclean:
-+ $(Q)$(MAKE) $(clean)=$(boot)
-+
-+.PHONY: arch/nds32/kernel/asm-offsets.s
-+arch/nds32/kernel/asm-offsets.s: arch/nds32/kernel/asm-offsets.c
-+ $(Q)$(MAKE) $(build)=$(build-dir) $(target-dir)$(notdir $@)
-+
-+
-+define archhelp
-+ echo ' Image - kernel image (arch/$(ARCH)/boot/Image)'
-+endef
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_add.c linux-3.4.113/arch/nds32/math-emu/dp_add.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_add.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_add.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,179 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ *
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_add(ieee754dp x, ieee754dp y)
-+{
-+ COMPXDP;
-+ COMPYDP;
-+
-+ EXPLODEXDP;
-+ EXPLODEYDP;
-+
-+ CLEARCX;
-+
-+ FLUSHXDP;
-+ FLUSHYDP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "add", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ if (xs == ys)
-+ return x;
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_xcpt(ieee754dp_indef(), "add", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ return x;
-+
-+ /* Zero handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ if (xs == ys)
-+ return x;
-+ else
-+ return ieee754dp_zero(ieee754_csr.rm == IEEE754_RD);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ return x;
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ DPDNORMX;
-+
-+ /* FALL THROUGH */
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ DPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ DPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ assert(xm & DP_HIDDEN_BIT);
-+ assert(ym & DP_HIDDEN_BIT);
-+
-+ /* provide guard,round and stick bit space */
-+ xm <<= 3;
-+ ym <<= 3;
-+
-+ if (xe > ye) {
-+ /* have to shift y fraction right to align
-+ */
-+ int s = xe - ye;
-+ ym = XDPSRS(ym, s);
-+ ye += s;
-+ } else if (ye > xe) {
-+ /* have to shift x fraction right to align
-+ */
-+ int s = ye - xe;
-+ xm = XDPSRS(xm, s);
-+ xe += s;
-+ }
-+ assert(xe == ye);
-+ assert(xe <= DP_EMAX);
-+
-+ if (xs == ys) {
-+ /* generate 28 bit result of adding two 27 bit numbers
-+ * leaving result in xm,xs,xe
-+ */
-+ xm = xm + ym;
-+ xe = xe;
-+ xs = xs;
-+
-+ if (xm >> (DP_MBITS + 1 + 3)) { /* carry out */
-+ xm = XDPSRS1(xm);
-+ xe++;
-+ }
-+ } else {
-+ if (xm >= ym) {
-+ xm = xm - ym;
-+ xe = xe;
-+ xs = xs;
-+ } else {
-+ xm = ym - xm;
-+ xe = xe;
-+ xs = ys;
-+ }
-+ if (xm == 0)
-+ return ieee754dp_zero(ieee754_csr.rm == IEEE754_RD);
-+
-+ /* normalize to rounding precision */
-+ while ((xm >> (DP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+
-+ }
-+ DPNORMRET2(xs, xe, xm, "add", x, y);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_cmp.c linux-3.4.113/arch/nds32/math-emu/dp_cmp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_cmp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_cmp.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,66 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+int ieee754dp_cmp(ieee754dp x, ieee754dp y, int cmp, int sig)
-+{
-+ COMPXDP;
-+ COMPYDP;
-+
-+ EXPLODEXDP;
-+ EXPLODEYDP;
-+ FLUSHXDP;
-+ FLUSHYDP;
-+ CLEARCX; /* Even clear inexact flag here */
-+
-+ if (ieee754dp_isnan(x) || ieee754dp_isnan(y)) {
-+ if (sig || xc == IEEE754_CLASS_SNAN || yc == IEEE754_CLASS_SNAN)
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ if (cmp & IEEE754_CUN)
-+ return 1;
-+ if (cmp & (IEEE754_CLT | IEEE754_CGT)) {
-+ if (sig && SETANDTESTCX(IEEE754_INVALID_OPERATION))
-+ return ieee754si_xcpt(0, "fcmpf", x);
-+ }
-+ return 0;
-+ } else {
-+ s64 vx = x.bits;
-+ s64 vy = y.bits;
-+
-+ if (vx < 0)
-+ vx = -vx ^ DP_SIGN_BIT;
-+ if (vy < 0)
-+ vy = -vy ^ DP_SIGN_BIT;
-+
-+ if (vx < vy)
-+ return (cmp & IEEE754_CLT) != 0;
-+ else if (vx == vy)
-+ return (cmp & IEEE754_CEQ) != 0;
-+ else
-+ return (cmp & IEEE754_CGT) != 0;
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_div.c linux-3.4.113/arch/nds32/math-emu/dp_div.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_div.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_div.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,155 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_div(ieee754dp x, ieee754dp y)
-+{
-+ COMPXDP;
-+ COMPYDP;
-+
-+ EXPLODEXDP;
-+ EXPLODEYDP;
-+
-+ CLEARCX;
-+
-+ FLUSHXDP;
-+ FLUSHYDP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_xcpt(ieee754dp_indef(), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ return ieee754dp_zero(xs ^ ys);
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ return ieee754dp_inf(xs ^ ys);
-+
-+ /* Zero handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_xcpt(ieee754dp_indef(), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ SETCX(IEEE754_ZERO_DIVIDE);
-+ return ieee754dp_xcpt(ieee754dp_inf(xs ^ ys), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ return ieee754dp_zero(xs == ys ? 0 : 1);
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ DPDNORMX;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ DPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ DPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ assert(xm & DP_HIDDEN_BIT);
-+ assert(ym & DP_HIDDEN_BIT);
-+
-+ /* provide rounding space */
-+ xm <<= 3;
-+ ym <<= 3;
-+
-+ {
-+ /* now the dirty work */
-+
-+ u64 rm = 0;
-+ int re = xe - ye;
-+ u64 bm;
-+
-+ for (bm = DP_MBIT(DP_MBITS + 2); bm; bm >>= 1) {
-+ if (xm >= ym) {
-+ xm -= ym;
-+ rm |= bm;
-+ if (xm == 0)
-+ break;
-+ }
-+ xm <<= 1;
-+ }
-+ rm <<= 1;
-+ if (xm)
-+ rm |= 1; /* have remainder, set sticky */
-+
-+ assert(rm);
-+
-+ /* normalise rm to rounding precision ?
-+ */
-+ while ((rm >> (DP_MBITS + 3)) == 0) {
-+ rm <<= 1;
-+ re--;
-+ }
-+
-+ DPNORMRET2(xs == ys ? 0 : 1, re, rm, "div", x, y);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_fint.c linux-3.4.113/arch/nds32/math-emu/dp_fint.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_fint.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_fint.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,79 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_fint(int x)
-+{
-+ u64 xm;
-+ int xe;
-+ int xs;
-+
-+ CLEARCX;
-+
-+ if (x == 0)
-+ return ieee754dp_zero(0);
-+ if (x == 1 || x == -1)
-+ return ieee754dp_one(x < 0);
-+ if (x == 10 || x == -10)
-+ return ieee754dp_ten(x < 0);
-+
-+ xs = (x < 0);
-+ if (xs) {
-+ if (x == (1 << 31))
-+ xm = ((unsigned)1 << 31); /* max neg can't be safely negated */
-+ else
-+ xm = -x;
-+ } else {
-+ xm = x;
-+ }
-+
-+#if 1
-+ /* normalize - result can never be inexact or overflow */
-+ xe = DP_MBITS;
-+ while ((xm >> DP_MBITS) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ return builddp(xs, xe + DP_EBIAS, xm & ~DP_HIDDEN_BIT);
-+#else
-+ /* normalize */
-+ xe = DP_MBITS + 3;
-+ while ((xm >> (DP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ DPNORMRET1(xs, xe, xm, "fint", x);
-+#endif
-+}
-+
-+ieee754dp ieee754dp_funs(unsigned int u)
-+{
-+ if ((int)u < 0)
-+ return ieee754dp_add(ieee754dp_1e31(),
-+ ieee754dp_fint(u & ~(1 << 31)));
-+ return ieee754dp_fint(u);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_flong.c linux-3.4.113/arch/nds32/math-emu/dp_flong.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_flong.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_flong.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,77 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_flong(s64 x)
-+{
-+ u64 xm;
-+ int xe;
-+ int xs;
-+
-+ CLEARCX;
-+
-+ if (x == 0)
-+ return ieee754dp_zero(0);
-+ if (x == 1 || x == -1)
-+ return ieee754dp_one(x < 0);
-+ if (x == 10 || x == -10)
-+ return ieee754dp_ten(x < 0);
-+
-+ xs = (x < 0);
-+ if (xs) {
-+ if (x == (1ULL << 63))
-+ xm = (1ULL << 63); /* max neg can't be safely negated */
-+ else
-+ xm = -x;
-+ } else {
-+ xm = x;
-+ }
-+
-+ /* normalize */
-+ xe = DP_MBITS + 3;
-+ if (xm >> (DP_MBITS + 1 + 3)) {
-+ /* shunt out overflow bits */
-+ while (xm >> (DP_MBITS + 1 + 3)) {
-+ XDPSRSX1();
-+ }
-+ } else {
-+ /* normalize in grs extended double precision */
-+ while ((xm >> (DP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ }
-+ DPNORMRET1(xs, xe, xm, "dp_flong", x);
-+}
-+
-+ieee754dp ieee754dp_fulong(u64 u)
-+{
-+ if ((s64) u < 0)
-+ return ieee754dp_add(ieee754dp_1e63(),
-+ ieee754dp_flong(u & ~(1ULL << 63)));
-+ return ieee754dp_flong(u);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_frexp.c linux-3.4.113/arch/nds32/math-emu/dp_frexp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_frexp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_frexp.c 2016-12-01 20:59:24.360613059 +0100
-@@ -0,0 +1,52 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+/* close to ieeep754dp_logb
-+*/
-+ieee754dp ieee754dp_frexp(ieee754dp x, int *eptr)
-+{
-+ COMPXDP;
-+ CLEARCX;
-+ EXPLODEXDP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ case IEEE754_CLASS_ZERO:
-+ *eptr = 0;
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ DPDNORMX;
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ *eptr = xe + 1;
-+ return builddp(xs, -1 + DP_EBIAS, xm & ~DP_HIDDEN_BIT);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_fsp.c linux-3.4.113/arch/nds32/math-emu/dp_fsp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_fsp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_fsp.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,71 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_fsp(ieee754sp x)
-+{
-+ COMPXSP;
-+
-+ EXPLODEXSP;
-+
-+ CLEARCX;
-+
-+ FLUSHXSP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "fsp");
-+ case IEEE754_CLASS_QNAN:
-+ return ieee754dp_nanxcpt(builddp(xs,
-+ DP_EMAX + 1 + DP_EBIAS,
-+ ((u64) xm
-+ << (DP_MBITS -
-+ SP_MBITS))), "fsp", x);
-+ case IEEE754_CLASS_INF:
-+ return ieee754dp_inf(xs);
-+ case IEEE754_CLASS_ZERO:
-+ return ieee754dp_zero(xs);
-+ case IEEE754_CLASS_DNORM:
-+ /* normalize */
-+ while ((xm >> SP_MBITS) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+
-+ /* CANT possibly overflow,underflow, or need rounding
-+ */
-+
-+ /* drop the hidden bit */
-+ xm &= ~SP_HIDDEN_BIT;
-+
-+ return builddp(xs, xe + DP_EBIAS, (u64) xm << (DP_MBITS - SP_MBITS));
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_logb.c linux-3.4.113/arch/nds32/math-emu/dp_logb.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_logb.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_logb.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,53 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_logb(ieee754dp x)
-+{
-+ COMPXDP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXDP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ return ieee754dp_nanxcpt(x, "logb", x);
-+ case IEEE754_CLASS_QNAN:
-+ return x;
-+ case IEEE754_CLASS_INF:
-+ return ieee754dp_inf(0);
-+ case IEEE754_CLASS_ZERO:
-+ return ieee754dp_inf(1);
-+ case IEEE754_CLASS_DNORM:
-+ DPDNORMX;
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ return ieee754dp_fint(xe);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_modf.c linux-3.4.113/arch/nds32/math-emu/dp_modf.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_modf.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_modf.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,79 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+/* modf function is always exact for a finite number
-+*/
-+ieee754dp ieee754dp_modf(ieee754dp x, ieee754dp * ip)
-+{
-+ COMPXDP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXDP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ case IEEE754_CLASS_ZERO:
-+ *ip = x;
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ /* far to small */
-+ *ip = ieee754dp_zero(xs);
-+ return x;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ if (xe < 0) {
-+ *ip = ieee754dp_zero(xs);
-+ return x;
-+ }
-+ if (xe >= DP_MBITS) {
-+ *ip = x;
-+ return ieee754dp_zero(xs);
-+ }
-+ /* generate ipart mantissa by clearing bottom bits
-+ */
-+ *ip = builddp(xs, xe + DP_EBIAS,
-+ ((xm >> (DP_MBITS - xe)) << (DP_MBITS - xe)) &
-+ ~DP_HIDDEN_BIT);
-+
-+ /* generate fpart mantissa by clearing top bits
-+ * and normalizing (must be able to normalize)
-+ */
-+ xm = (xm << (64 - (DP_MBITS - xe))) >> (64 - (DP_MBITS - xe));
-+ if (xm == 0)
-+ return ieee754dp_zero(xs);
-+
-+ while ((xm >> DP_MBITS) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ return builddp(xs, xe + DP_EBIAS, xm & ~DP_HIDDEN_BIT);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_mul.c linux-3.4.113/arch/nds32/math-emu/dp_mul.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_mul.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_mul.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,170 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_mul(ieee754dp x, ieee754dp y)
-+{
-+ COMPXDP;
-+ COMPYDP;
-+
-+ EXPLODEXDP;
-+ EXPLODEYDP;
-+
-+ CLEARCX;
-+
-+ FLUSHXDP;
-+ FLUSHYDP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "mul", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_xcpt(ieee754dp_indef(), "mul", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ return ieee754dp_inf(xs ^ ys);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ return ieee754dp_zero(xs ^ ys);
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ DPDNORMX;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ DPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ DPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ /* rm = xm * ym, re = xe+ye basicly */
-+ assert(xm & DP_HIDDEN_BIT);
-+ assert(ym & DP_HIDDEN_BIT);
-+ {
-+ int re = xe + ye;
-+ int rs = xs ^ ys;
-+ u64 rm;
-+
-+ /* shunt to top of word */
-+ xm <<= 64 - (DP_MBITS + 1);
-+ ym <<= 64 - (DP_MBITS + 1);
-+
-+ /* multiply 32bits xm,ym to give high 32bits rm with stickness
-+ */
-+
-+ /* 32 * 32 => 64 */
-+#define DPXMULT(x, y) ((u64)(x) * (u64)y)
-+
-+ {
-+ unsigned lxm = xm;
-+ unsigned hxm = xm >> 32;
-+ unsigned lym = ym;
-+ unsigned hym = ym >> 32;
-+ u64 lrm;
-+ u64 hrm;
-+
-+ lrm = DPXMULT(lxm, lym);
-+ hrm = DPXMULT(hxm, hym);
-+
-+ {
-+ u64 t = DPXMULT(lxm, hym);
-+ {
-+ u64 at = lrm + (t << 32);
-+ hrm += at < lrm;
-+ lrm = at;
-+ }
-+ hrm = hrm + (t >> 32);
-+ }
-+
-+ {
-+ u64 t = DPXMULT(hxm, lym);
-+ {
-+ u64 at = lrm + (t << 32);
-+ hrm += at < lrm;
-+ lrm = at;
-+ }
-+ hrm = hrm + (t >> 32);
-+ }
-+ rm = hrm | (lrm != 0);
-+ }
-+
-+ /*
-+ * sticky shift down to normal rounding precision
-+ */
-+ if ((s64) rm < 0) {
-+ rm = (rm >> (64 - (DP_MBITS + 1 + 3))) |
-+ ((rm << (DP_MBITS + 1 + 3)) != 0);
-+ re++;
-+ } else {
-+ rm = (rm >> (64 - (DP_MBITS + 1 + 3 + 1))) |
-+ ((rm << (DP_MBITS + 1 + 3 + 1)) != 0);
-+ }
-+ assert(rm & (DP_HIDDEN_BIT << 3));
-+ DPNORMRET2(rs, re, rm, "mul", x, y);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_scalb.c linux-3.4.113/arch/nds32/math-emu/dp_scalb.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_scalb.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_scalb.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,56 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_scalb(ieee754dp x, int n)
-+{
-+ COMPXDP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXDP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ return ieee754dp_nanxcpt(x, "scalb", x, n);
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ case IEEE754_CLASS_ZERO:
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ DPDNORMX;
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ DPNORMRET2(xs, xe + n, xm << 3, "scalb", x, n);
-+}
-+
-+ieee754dp ieee754dp_ldexp(ieee754dp x, int n)
-+{
-+ return ieee754dp_scalb(x, n);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_simple.c linux-3.4.113/arch/nds32/math-emu/dp_simple.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_simple.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_simple.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,87 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+int ieee754dp_finite(ieee754dp x)
-+{
-+ return DPBEXP(x) != DP_EMAX + 1 + DP_EBIAS;
-+}
-+
-+ieee754dp ieee754dp_copysign(ieee754dp x, ieee754dp y)
-+{
-+ CLEARCX;
-+ DPSIGN(x) = DPSIGN(y);
-+ return x;
-+}
-+
-+ieee754dp ieee754dp_neg(ieee754dp x)
-+{
-+ COMPXDP;
-+
-+ EXPLODEXDP;
-+ CLEARCX;
-+ FLUSHXDP;
-+
-+ /*
-+ * Invert the sign ALWAYS to prevent an endless recursion on
-+ * pow() in libc.
-+ */
-+ /* quick fix up */
-+ DPSIGN(x) ^= 1;
-+
-+ if (xc == IEEE754_CLASS_SNAN) {
-+ ieee754dp y = ieee754dp_indef();
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ DPSIGN(y) = DPSIGN(x);
-+ return ieee754dp_nanxcpt(y, "neg");
-+ }
-+
-+ if (ieee754dp_isnan(x)) /* but not infinity */
-+ return ieee754dp_nanxcpt(x, "neg", x);
-+ return x;
-+}
-+
-+ieee754dp ieee754dp_abs(ieee754dp x)
-+{
-+ COMPXDP;
-+
-+ EXPLODEXDP;
-+ CLEARCX;
-+ FLUSHXDP;
-+
-+ if (xc == IEEE754_CLASS_SNAN) {
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "neg");
-+ }
-+
-+ if (ieee754dp_isnan(x)) /* but not infinity */
-+ return ieee754dp_nanxcpt(x, "abs", x);
-+
-+ /* quick fix up */
-+ DPSIGN(x) = 0;
-+ return x;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_sqrt.c linux-3.4.113/arch/nds32/math-emu/dp_sqrt.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_sqrt.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_sqrt.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,164 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision square root
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+static const unsigned table[] = {
-+ 0, 1204, 3062, 5746, 9193, 13348, 18162, 23592,
-+ 29598, 36145, 43202, 50740, 58733, 67158, 75992,
-+ 85215, 83599, 71378, 60428, 50647, 41945, 34246,
-+ 27478, 21581, 16499, 12183, 8588, 5674, 3403,
-+ 1742, 661, 130
-+};
-+
-+ieee754dp ieee754dp_sqrt(ieee754dp x)
-+{
-+ struct _ieee754_csr oldcsr;
-+ ieee754dp y, z, t;
-+ unsigned scalx, yh;
-+ COMPXDP;
-+
-+ EXPLODEXDP;
-+ CLEARCX;
-+ FLUSHXDP;
-+
-+ /* x == INF or NAN? */
-+ switch (xc) {
-+ case IEEE754_CLASS_QNAN:
-+ /* sqrt(Nan) = Nan */
-+ return ieee754dp_nanxcpt(x, "sqrt");
-+ case IEEE754_CLASS_SNAN:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "sqrt");
-+ case IEEE754_CLASS_ZERO:
-+ /* sqrt(0) = 0 */
-+ return x;
-+ case IEEE754_CLASS_INF:
-+ if (xs) {
-+ /* sqrt(-Inf) = Nan */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "sqrt");
-+ }
-+ /* sqrt(+Inf) = Inf */
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ DPDNORMX;
-+ /* fall through */
-+ case IEEE754_CLASS_NORM:
-+ if (xs) {
-+ /* sqrt(-x) = Nan */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "sqrt");
-+ }
-+ break;
-+ }
-+
-+ /* save old csr; switch off INX enable & flag; set RN rounding */
-+ oldcsr = ieee754_csr;
-+ ieee754_csr.mx &= ~IEEE754_INEXACT;
-+ ieee754_csr.sx &= ~IEEE754_INEXACT;
-+ ieee754_csr.rm = IEEE754_RN;
-+
-+ /* adjust exponent to prevent overflow */
-+ scalx = 0;
-+ if (xe > 512) { /* x > 2**-512? */
-+ xe -= 512; /* x = x / 2**512 */
-+ scalx += 256;
-+ } else if (xe < -512) { /* x < 2**-512? */
-+ xe += 512; /* x = x * 2**512 */
-+ scalx -= 256;
-+ }
-+
-+ y = x = builddp(0, xe + DP_EBIAS, xm & ~DP_HIDDEN_BIT);
-+
-+ /* magic initial approximation to almost 8 sig. bits */
-+ yh = y.bits >> 32;
-+ yh = (yh >> 1) + 0x1ff80000;
-+ yh = yh - table[(yh >> 15) & 31];
-+ y.bits = ((u64) yh << 32) | (y.bits & 0xffffffff);
-+
-+ /* Heron's rule once with correction to improve to ~18 sig. bits */
-+ /* t=x/y; y=y+t; py[n0]=py[n0]-0x00100006; py[n1]=0; */
-+ t = ieee754dp_div(x, y);
-+ y = ieee754dp_add(y, t);
-+ y.bits -= 0x0010000600000000LL;
-+ y.bits &= 0xffffffff00000000LL;
-+
-+ /* triple to almost 56 sig. bits: y ~= sqrt(x) to within 1 ulp */
-+ /* t=y*y; z=t; pt[n0]+=0x00100000; t+=z; z=(x-z)*y; */
-+ z = t = ieee754dp_mul(y, y);
-+ t.parts.bexp += 0x001;
-+ t = ieee754dp_add(t, z);
-+ z = ieee754dp_mul(ieee754dp_sub(x, z), y);
-+
-+ /* t=z/(t+x) ; pt[n0]+=0x00100000; y+=t; */
-+ t = ieee754dp_div(z, ieee754dp_add(t, x));
-+ t.parts.bexp += 0x001;
-+ y = ieee754dp_add(y, t);
-+
-+ /* twiddle last bit to force y correctly rounded */
-+
-+ /* set RZ, clear INEX flag */
-+ ieee754_csr.rm = IEEE754_RZ;
-+ ieee754_csr.sx &= ~IEEE754_INEXACT;
-+
-+ /* t=x/y; ...chopped quotient, possibly inexact */
-+ t = ieee754dp_div(x, y);
-+
-+ if (ieee754_csr.sx & IEEE754_INEXACT || t.bits != y.bits) {
-+
-+ if (!(ieee754_csr.sx & IEEE754_INEXACT))
-+ /* t = t-ulp */
-+ t.bits -= 1;
-+
-+ /* add inexact to result status */
-+ oldcsr.cx |= IEEE754_INEXACT;
-+ oldcsr.sx |= IEEE754_INEXACT;
-+
-+ switch (oldcsr.rm) {
-+ case IEEE754_RP:
-+ y.bits += 1;
-+ /* drop through */
-+ case IEEE754_RN:
-+ t.bits += 1;
-+ break;
-+ }
-+
-+ /* y=y+t; ...chopped sum */
-+ y = ieee754dp_add(y, t);
-+
-+ /* adjust scalx for correctly rounded sqrt(x) */
-+ scalx -= 1;
-+ }
-+
-+ /* py[n0]=py[n0]+scalx; ...scale back y */
-+ y.parts.bexp += scalx;
-+
-+ /* restore rounding mode, possibly set inexact */
-+ ieee754_csr = oldcsr;
-+
-+ return y;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_sub.c linux-3.4.113/arch/nds32/math-emu/dp_sub.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_sub.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_sub.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,187 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+ieee754dp ieee754dp_sub(ieee754dp x, ieee754dp y)
-+{
-+ COMPXDP;
-+ COMPYDP;
-+
-+ EXPLODEXDP;
-+ EXPLODEYDP;
-+
-+ CLEARCX;
-+
-+ FLUSHXDP;
-+ FLUSHYDP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_nanxcpt(ieee754dp_indef(), "sub", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ if (xs != ys)
-+ return x;
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754dp_xcpt(ieee754dp_indef(), "sub", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ return ieee754dp_inf(ys ^ 1);
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ return x;
-+
-+ /* Zero handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ if (xs != ys)
-+ return x;
-+ else
-+ return ieee754dp_zero(ieee754_csr.rm == IEEE754_RD);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ return x;
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ /* quick fix up */
-+ DPSIGN(y) ^= 1;
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ DPDNORMX;
-+ /* FAAL THOROUGH */
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ /* normalize ym,ye */
-+ DPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ /* normalize xm,xe */
-+ DPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ /* flip sign of y and handle as add */
-+ ys ^= 1;
-+
-+ assert(xm & DP_HIDDEN_BIT);
-+ assert(ym & DP_HIDDEN_BIT);
-+
-+ /* provide guard,round and stick bit dpace */
-+ xm <<= 3;
-+ ym <<= 3;
-+
-+ if (xe > ye) {
-+ /* have to shift y fraction right to align
-+ */
-+ int s = xe - ye;
-+ ym = XDPSRS(ym, s);
-+ ye += s;
-+ } else if (ye > xe) {
-+ /* have to shift x fraction right to align
-+ */
-+ int s = ye - xe;
-+ xm = XDPSRS(xm, s);
-+ xe += s;
-+ }
-+ assert(xe == ye);
-+ assert(xe <= DP_EMAX);
-+
-+ if (xs == ys) {
-+ /* generate 28 bit result of adding two 27 bit numbers
-+ */
-+ xm = xm + ym;
-+ xe = xe;
-+ xs = xs;
-+
-+ if (xm >> (DP_MBITS + 1 + 3)) { /* carry out */
-+ xm = XDPSRS1(xm); /* shift preserving sticky */
-+ xe++;
-+ }
-+ } else {
-+ if (xm >= ym) {
-+ xm = xm - ym;
-+ xe = xe;
-+ xs = xs;
-+ } else {
-+ xm = ym - xm;
-+ xe = xe;
-+ xs = ys;
-+ }
-+ if (xm == 0) {
-+ if (ieee754_csr.rm == IEEE754_RD)
-+ return ieee754dp_zero(1); /* round negative inf. => sign = -1 */
-+ else
-+ return ieee754dp_zero(0); /* other round modes => sign = 1 */
-+ }
-+
-+ /* normalize to rounding precision
-+ */
-+ while ((xm >> (DP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ }
-+ DPNORMRET2(xs, xe, xm, "sub", x, y);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_tint.c linux-3.4.113/arch/nds32/math-emu/dp_tint.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_tint.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_tint.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,121 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include <linux/kernel.h>
-+#include "ieee754dp.h"
-+
-+int ieee754dp_tint(ieee754dp x)
-+{
-+ COMPXDP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXDP;
-+ FLUSHXDP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754si_xcpt(ieee754si_indef(), "dp_tint", x);
-+ case IEEE754_CLASS_ZERO:
-+ return 0;
-+ case IEEE754_CLASS_DNORM:
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ if (xe > 31) {
-+ /* Set invalid. We will only use overflow for floating
-+ point overflow */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754si_xcpt(ieee754si_indef(), "dp_tint", x);
-+ }
-+ /* oh gawd */
-+ if (xe > DP_MBITS) {
-+ xm <<= xe - DP_MBITS;
-+ } else if (xe < DP_MBITS) {
-+ u64 residue;
-+ int round;
-+ int sticky;
-+ int odd;
-+
-+ if (xe < -1) {
-+ residue = xm;
-+ round = 0;
-+ sticky = residue != 0;
-+ xm = 0;
-+ } else {
-+ residue = xm << (64 - DP_MBITS + xe);
-+ round = (residue >> 63) != 0;
-+ sticky = (residue << 1) != 0;
-+ xm >>= DP_MBITS - xe;
-+ }
-+ /* Note: At this point upper 32 bits of xm are guaranteed
-+ to be zero */
-+ odd = (xm & 0x1) != 0x0;
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ if (round && (sticky || odd))
-+ xm++;
-+ break;
-+ case IEEE754_RZ:
-+ break;
-+ case IEEE754_RU: /* toward +Infinity */
-+ if ((round || sticky) && !xs)
-+ xm++;
-+ break;
-+ case IEEE754_RD: /* toward -Infinity */
-+ if ((round || sticky) && xs)
-+ xm++;
-+ break;
-+ }
-+ /* look for valid corner case 0x80000000 */
-+ if ((xm >> 31) != 0 && (xs == 0 || xm != 0x80000000)) {
-+ /* This can happen after rounding */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754si_xcpt(ieee754si_indef(), "dp_tint", x);
-+ }
-+ if (round || sticky)
-+ SETCX(IEEE754_INEXACT);
-+ }
-+ if (xs)
-+ return -xm;
-+ else
-+ return xm;
-+}
-+
-+unsigned int ieee754dp_tuns(ieee754dp x)
-+{
-+ ieee754dp hb = ieee754dp_1e31();
-+
-+ /* what if x < 0 ?? */
-+ if (ieee754dp_lt(x, hb))
-+ return (unsigned)ieee754dp_tint(x);
-+
-+ return (unsigned)ieee754dp_tint(ieee754dp_sub(x, hb)) |
-+ ((unsigned)1 << 31);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/dp_tlong.c linux-3.4.113/arch/nds32/math-emu/dp_tlong.c
---- linux-3.4.113.orig/arch/nds32/math-emu/dp_tlong.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/dp_tlong.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,123 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+s64 ieee754dp_tlong(ieee754dp x)
-+{
-+ COMPXDP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXDP;
-+ FLUSHXDP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754di_xcpt(ieee754di_indef(), "dp_tlong", x);
-+ case IEEE754_CLASS_ZERO:
-+ return 0;
-+ case IEEE754_CLASS_DNORM:
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ if (xe >= 63) {
-+ /* look for valid corner case */
-+ if (xe == 63 && xs && xm == DP_HIDDEN_BIT)
-+ return -0x8000000000000000LL;
-+ /* Set invalid. We will only use overflow for floating
-+ point overflow */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754di_xcpt(ieee754di_indef(), "dp_tlong", x);
-+ }
-+ /* oh gawd */
-+ if (xe > DP_MBITS) {
-+ xm <<= xe - DP_MBITS;
-+ } else if (xe < DP_MBITS) {
-+ u64 residue;
-+ int round;
-+ int sticky;
-+ int odd;
-+
-+ if (xe < -1) {
-+ residue = xm;
-+ round = 0;
-+ sticky = residue != 0;
-+ xm = 0;
-+ } else {
-+ /* Shifting a u64 64 times does not work,
-+ * so we do it in two steps. Be aware that xe
-+ * may be -1 */
-+ residue = xm << (xe + 1);
-+ residue <<= 63 - DP_MBITS;
-+ round = (residue >> 63) != 0;
-+ sticky = (residue << 1) != 0;
-+ xm >>= DP_MBITS - xe;
-+ }
-+ odd = (xm & 0x1) != 0x0;
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ if (round && (sticky || odd))
-+ xm++;
-+ break;
-+ case IEEE754_RZ:
-+ break;
-+ case IEEE754_RU: /* toward +Infinity */
-+ if ((round || sticky) && !xs)
-+ xm++;
-+ break;
-+ case IEEE754_RD: /* toward -Infinity */
-+ if ((round || sticky) && xs)
-+ xm++;
-+ break;
-+ }
-+ if ((xm >> 63) != 0) {
-+ /* This can happen after rounding */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754di_xcpt(ieee754di_indef(), "dp_tlong", x);
-+ }
-+ if (round || sticky)
-+ SETCX(IEEE754_INEXACT);
-+ }
-+ if (xs)
-+ return -xm;
-+ else
-+ return xm;
-+}
-+
-+u64 ieee754dp_tulong(ieee754dp x)
-+{
-+ ieee754dp hb = ieee754dp_1e63();
-+
-+ /* what if x < 0 ?? */
-+ if (ieee754dp_lt(x, hb))
-+ return (u64) ieee754dp_tlong(x);
-+
-+ return (u64) ieee754dp_tlong(ieee754dp_sub(x, hb)) | (1ULL << 63);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/fpuemu.c linux-3.4.113/arch/nds32/math-emu/fpuemu.c
---- linux-3.4.113.orig/arch/nds32/math-emu/fpuemu.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/fpuemu.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,565 @@
-+/*
-+ * linux/arch/nds32/math-emu/fpuemu.c: a nds32 coprocessor (fpu) instruction emulator
-+ *
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * Kevin D. Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com
-+ * Copyright (C) 2000 MIPS Technologies, Inc.
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * A complete emulator for MIPS coprocessor 1 instructions. This is
-+ * required for #float(switch) or #float(trap), where it catches all
-+ * COP1 instructions via the "CoProcessor Unusable" exception.
-+ *
-+ * More surprisingly it is also required for #float(ieee), to help out
-+ * the hardware fpu at the boundaries of the IEEE-754 representation
-+ * (denormalised values, infinities, underflow, etc). It is made
-+ * quite nasty because emulation of some non-COP1 instructions is
-+ * required, e.g. in branch delay slots.
-+ *
-+ * Note if you know that you won't have an fpu, then you'll get much
-+ * better performance by compiling with -msoft-float!
-+ */
-+#include <linux/sched.h>
-+#include <linux/debugfs.h>
-+
-+#include <asm/processor.h>
-+#include <asm/ptrace.h>
-+#include <asm/bitfield.h>
-+#include <asm/uaccess.h>
-+
-+#include "ieee754.h"
-+#include "insn.h"
-+#include "fpu_emulator.h"
-+
-+/* Function which emulates a floating point instruction. */
-+
-+static int fpu_emu(struct pt_regs *, struct fpu_struct *, unsigned long);
-+
-+/* Further private data for which no space exists in fpu_struct */
-+
-+struct fpu_emulator_stats fpuemustats;
-+
-+/* rounding mode */
-+#define FPU_FPCSR_RN 0x0 /* nearest */
-+#define FPU_FPCSR_RU 0x1 /* towards +Infinity */
-+#define FPU_FPCSR_RD 0x2 /* towards -Infinity */
-+#define FPU_FPCSR_RZ 0x3 /* towards zero */
-+
-+/* Convert Mips rounding mode (0..3) to IEEE library modes. */
-+static const unsigned char ieee_rm[4] = {
-+ [FPU_FPCSR_RN] = IEEE754_RN,
-+ [FPU_FPCSR_RU] = IEEE754_RU,
-+ [FPU_FPCSR_RD] = IEEE754_RD,
-+ [FPU_FPCSR_RZ] = IEEE754_RZ,
-+};
-+
-+/* Convert IEEE library modes to NDS32 rounding mode (0..3). */
-+static const unsigned char nds32_rm[4] = {
-+ [IEEE754_RN] = FPU_FPCSR_RN,
-+ [IEEE754_RZ] = FPU_FPCSR_RZ,
-+ [IEEE754_RD] = FPU_FPCSR_RD,
-+ [IEEE754_RU] = FPU_FPCSR_RU,
-+};
-+
-+/*
-+ * In the Linux kernel, we support selection of FPR format on the
-+ * basis of the Status.FR bit. This does imply that, if a full 32
-+ * FPRs are desired, there needs to be a flip-flop that can be written
-+ * to one at that bit position. In any case, O32 MIPS ABI uses
-+ * only the even FPRs (Status.FR = 0).
-+ */
-+
-+#define CP0_STATUS_FR_SUPPORT
-+
-+#ifdef CP0_STATUS_FR_SUPPORT
-+#define FR_BIT ST0_FR
-+#else
-+#define FR_BIT 0
-+#endif
-+
-+#define SIFROMREG(si, x) ((si) = *((unsigned long *)ctx + x))
-+#define SITOREG(si, x) (*((unsigned long *)ctx + x)= (si))
-+
-+#ifdef __NDS32_EL__
-+#define DIFROMREG(di, x) ((di) = (unsigned long long)ptr[2*x] << 32 | (unsigned long long)ptr[2*x+1])
-+#define DITOREG(di, x) ptr[2*x] = (di) >> 32; ptr[2*x+1] = (unsigned long)(di)
-+#else
-+#define DIFROMREG(di, x) ((di) = (unsigned long long)ptr[2*x+1] << 32 | (unsigned long long)ptr[2*x])
-+#define DITOREG(di, x) ptr[2*x+1] = (di) >> 32; ptr[2*x] = (unsigned long)(di)
-+#endif
-+
-+#define SPFROMREG(sp, x) SIFROMREG((sp).bits, x)
-+#define SPTOREG(sp, x) SITOREG((sp).bits, x)
-+#define DPFROMREG(dp, x) DIFROMREG((dp).bits, x)
-+#define DPTOREG(dp, x) DITOREG((dp).bits, x)
-+
-+#define DEF3OP(name, p, f1, f2, f3) \
-+static ieee754##p fpemu_##p##_##name(ieee754##p r, ieee754##p s, \
-+ ieee754##p t) \
-+{ \
-+ struct _ieee754_csr ieee754_csr_save; \
-+ s = f1(s, t); \
-+ ieee754_csr_save = ieee754_csr; \
-+ s = f2(s, r); \
-+ ieee754_csr_save.cx |= ieee754_csr.cx; \
-+ ieee754_csr_save.sx |= ieee754_csr.sx; \
-+ s = f3(s); \
-+ ieee754_csr.cx |= ieee754_csr_save.cx; \
-+ ieee754_csr.sx |= ieee754_csr_save.sx; \
-+ return s; \
-+}
-+
-+DEF3OP(madd, sp, ieee754sp_mul, ieee754sp_add,);
-+DEF3OP(msub, sp, ieee754sp_mul, ieee754sp_sub,);
-+DEF3OP(nmadd, sp, ieee754sp_mul, ieee754sp_add, ieee754sp_neg);
-+DEF3OP(nmsub, sp, ieee754sp_mul, ieee754sp_sub, ieee754sp_neg);
-+DEF3OP(madd, dp, ieee754dp_mul, ieee754dp_add,);
-+DEF3OP(msub, dp, ieee754dp_mul, ieee754dp_sub,);
-+DEF3OP(nmadd, dp, ieee754dp_mul, ieee754dp_add, ieee754dp_neg);
-+DEF3OP(nmsub, dp, ieee754dp_mul, ieee754dp_sub, ieee754dp_neg);
-+
-+/*
-+ * Emulate the floating point instruction w/ denorm input pointed at by IPC.
-+ * According to spec, only FPU arithmetic, data format conversion, and compare instructions.
-+ */
-+
-+static int fpuEmulate(struct pt_regs *regs, struct fpu_struct *fpu)
-+{
-+ unsigned long insn = 0, addr = regs->NDS32_ipc;
-+ unsigned long emulpc, contpc;
-+ unsigned char *pc = (void *)&insn;
-+ char c;
-+ int i = 0;
-+
-+ for (i = 0; i < 4; i++) {
-+ if (__get_user(c, (unsigned char *)addr++))
-+ return SIGBUS;
-+ *pc++ = c;
-+ }
-+
-+ insn = be32_to_cpu(insn);
-+
-+ emulpc = regs->NDS32_ipc;
-+ contpc = regs->NDS32_ipc + 4;
-+
-+ fpuemustats.emulated++;
-+ switch (NDS32Insn_OPCODE(insn)) {
-+ case cop0_op:
-+ switch (NDS32Insn_OPCODE_COP0(insn)) {
-+
-+ case fs1_op:
-+ case fs2_op:
-+ case fd1_op:
-+ case fd2_op:
-+ {
-+ int sig;
-+
-+ /* a real fpu computation instruction */
-+ if ((sig = fpu_emu(regs, fpu, insn)))
-+ return sig;
-+ }
-+ break;
-+
-+ default:
-+ return SIGILL;
-+ }
-+ break;
-+ default:
-+ return SIGILL;
-+ }
-+
-+ /* we did it !! */
-+ regs->NDS32_ipc = contpc;
-+
-+ return 0;
-+}
-+
-+/*
-+ * Conversion table from NDS32 fcmp TYP
-+ * cond = ieee754dp_cmp(x,y,IEEE754_UN,sig);
-+ */
-+static const unsigned char cmptab[8] = {
-+ IEEE754_CEQ,
-+ IEEE754_CLT,
-+ IEEE754_CLT | IEEE754_CEQ,
-+ IEEE754_CUN,
-+ 0,
-+ 0,
-+ 0,
-+ 0,
-+};
-+
-+/*
-+ * Emulate a single FPU arithmetic instruction.
-+ */
-+static int fpu_emu(struct pt_regs *xcp, struct fpu_struct *ctx,
-+ unsigned long insn)
-+{
-+ int rfmt; /* resulting format */
-+ unsigned rfpcsr = 0; /* resulting csr */
-+ unsigned long *ptr = (unsigned long *)ctx;
-+ union {
-+ ieee754dp d;
-+ ieee754sp s;
-+ int w;
-+ } rv; /* resulting value */
-+
-+ fpuemustats.fpuops++;
-+ switch (rfmt = NDS32Insn_OPCODE_COP0(insn)) {
-+ case fs1_op:{
-+ union {
-+ ieee754sp(*t) (ieee754sp, ieee754sp, ieee754sp);
-+ ieee754sp(*b) (ieee754sp, ieee754sp);
-+ ieee754sp(*u) (ieee754sp);
-+ } handler;
-+
-+ switch (NDS32Insn_OPCODE_BIT69(insn)) {
-+ case fadds_op:
-+ handler.b = ieee754sp_add;
-+ goto scopbop;
-+ case fsubs_op:
-+ handler.b = ieee754sp_sub;
-+ goto scopbop;
-+ case fmadds_op:
-+ handler.t = fpemu_sp_madd;
-+ goto scoptop;
-+ case fmsubs_op:
-+ handler.t = fpemu_sp_msub;
-+ goto scoptop;
-+ case fnmadds_op:
-+ handler.t = fpemu_sp_nmadd;
-+ goto scoptop;
-+ case fnmsubs_op:
-+ handler.t = fpemu_sp_nmsub;
-+ goto scoptop;
-+ case fmuls_op:
-+ handler.b = ieee754sp_mul;
-+ goto scopbop;
-+ case fdivs_op:
-+ handler.b = ieee754sp_div;
-+ goto scopbop;
-+
-+ /* binary op on handler */
-+scoptop:
-+ {
-+ ieee754sp fd, fr, fs, ft;
-+
-+ SPFROMREG(fr,
-+ NDS32Insn_OPCODE_Rt(insn));
-+ SPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ SPFROMREG(ft,
-+ NDS32Insn_OPCODE_Rb(insn));
-+ fd = (*handler.t) (fr, fs, ft);
-+ SPTOREG(fd, NDS32Insn_OPCODE_Rt(insn));
-+ }
-+scopbop:
-+ {
-+ ieee754sp fs, ft;
-+
-+ SPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ SPFROMREG(ft,
-+ NDS32Insn_OPCODE_Rb(insn));
-+
-+ rv.s = (*handler.b) (fs, ft);
-+ goto copcsr;
-+ }
-+scopuop:
-+ {
-+ ieee754sp fs;
-+
-+ SPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ rv.s = (*handler.u) (fs);
-+ goto copcsr;
-+ }
-+copcsr:
-+ if (ieee754_cxtest(IEEE754_INEXACT))
-+ rfpcsr |= FPCSR_mskIEX;
-+ if (ieee754_cxtest(IEEE754_UNDERFLOW))
-+ rfpcsr |= FPCSR_mskUDF;
-+ if (ieee754_cxtest(IEEE754_OVERFLOW))
-+ rfpcsr |= FPCSR_mskOVF;
-+ if (ieee754_cxtest(IEEE754_ZERO_DIVIDE))
-+ rfpcsr |= FPCSR_mskDBZ;
-+ if (ieee754_cxtest(IEEE754_INVALID_OPERATION))
-+ rfpcsr |= FPCSR_mskIVO;
-+ break;
-+
-+ case fs1_f2op_op:
-+ switch (NDS32Insn_OPCODE_BIT1014(insn)) {
-+ case fs2d_op:{
-+ ieee754sp fs;
-+ SPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra
-+ (insn));
-+ rv.d = ieee754dp_fsp(fs);
-+ rfmt = fd1_op;
-+ goto copcsr;
-+ }
-+ case fsqrts_op:
-+ handler.u = ieee754sp_sqrt;
-+ goto scopuop;
-+ case fabss_op:
-+ handler.u = ieee754sp_abs;
-+ goto scopuop;
-+ default:
-+ return SIGILL;
-+ }
-+ default:
-+ return SIGILL;
-+ }
-+ break;
-+ }
-+
-+ case fs2_op:
-+ switch (NDS32Insn_OPCODE_BIT69(insn)) {
-+ case fcmpeqs_op:
-+ case fcmpeqs_e_op:
-+ case fcmplts_op:
-+ case fcmplts_e_op:
-+ case fcmples_op:
-+ case fcmples_e_op:
-+ case fcmpuns_op:
-+ case fcmpuns_e_op:
-+ {
-+ unsigned int cmpop =
-+ NDS32Insn_OPCODE_BIT69(insn);
-+ if (cmpop < 0x8) {
-+ ieee754sp fs, ft;
-+
-+ SPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ SPFROMREG(ft,
-+ NDS32Insn_OPCODE_Rb(insn));
-+ rv.w =
-+ ieee754sp_cmp(fs, ft,
-+ cmptab[(cmpop >> 1) &
-+ 0x7],
-+ cmpop & 0x1);
-+ if ((cmpop & 0x1)
-+ &&
-+ ieee754_cxtest
-+ (IEEE754_INVALID_OPERATION))
-+ rfpcsr = FPCSR_mskIVO;
-+ else
-+ goto copcsr;
-+ } else
-+ return SIGILL;
-+ }
-+ break;
-+
-+ default:
-+ return SIGILL;
-+ }
-+ break;
-+
-+ case fd1_op:
-+ {
-+ union {
-+ ieee754dp(*t) (ieee754dp, ieee754dp, ieee754dp);
-+ ieee754dp(*b) (ieee754dp, ieee754dp);
-+ ieee754dp(*u) (ieee754dp);
-+ } handler;
-+
-+ switch (NDS32Insn_OPCODE_BIT69(insn)) {
-+ case faddd_op:
-+ handler.b = ieee754dp_add;
-+ goto dcopbop;
-+ case fsubd_op:
-+ handler.b = ieee754dp_sub;
-+ goto dcopbop;
-+ case fmaddd_op:
-+ handler.t = fpemu_dp_madd;
-+ goto tdcoptop;
-+ case fmsubd_op:
-+ handler.t = fpemu_dp_msub;
-+ goto tdcoptop;
-+ case fnmaddd_op:
-+ handler.t = fpemu_dp_nmadd;
-+ goto tdcoptop;
-+ case fnmsubd_op:
-+ handler.t = fpemu_dp_nmsub;
-+ goto tdcoptop;
-+
-+tdcoptop:
-+ {
-+ ieee754dp fd, fr, fs, ft;
-+
-+ DPFROMREG(fr,
-+ NDS32Insn_OPCODE_Rt(insn));
-+ DPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ DPFROMREG(ft,
-+ NDS32Insn_OPCODE_Rb(insn));
-+ fd = (*handler.t) (fr, fs, ft);
-+ DPTOREG(fd, NDS32Insn_OPCODE_Rt(insn));
-+ goto copcsr;
-+ }
-+
-+ case fmuld_op:
-+ handler.b = ieee754dp_mul;
-+ goto dcopbop;
-+ case fdivd_op:
-+ handler.b = ieee754dp_div;
-+ goto dcopbop;
-+
-+ /* binary op on handler */
-+dcopbop: {
-+ ieee754dp fs, ft;
-+
-+ DPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ DPFROMREG(ft,
-+ NDS32Insn_OPCODE_Rb(insn));
-+
-+ rv.d = (*handler.b) (fs, ft);
-+ goto copcsr;
-+ }
-+dcopuop: {
-+ ieee754dp fs;
-+
-+ DPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ rv.d = (*handler.u) (fs);
-+ goto copcsr;
-+ }
-+
-+ case fd1_f2op_op:
-+ switch (NDS32Insn_OPCODE_BIT1014(insn)) {
-+ case fd2s_op:{
-+ ieee754dp fs;
-+
-+ DPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra
-+ (insn));
-+ rv.s = ieee754sp_fdp(fs);
-+ rfmt = fd1_op;
-+ goto copcsr;
-+ }
-+ case fsqrtd_op:
-+ handler.u = ieee754dp_sqrt;
-+ goto dcopuop;
-+ case fabsd_op:
-+ handler.u = ieee754dp_abs;
-+ goto dcopuop;
-+ default:
-+ return SIGILL;
-+ }
-+ default:
-+ return SIGILL;
-+ }
-+ break;
-+ }
-+
-+ case fd2_op:
-+ switch (NDS32Insn_OPCODE_BIT69(insn)) {
-+ case fcmpeqd_op:
-+ case fcmpeqd_e_op:
-+ case fcmpltd_op:
-+ case fcmpltd_e_op:
-+ case fcmpled_op:
-+ case fcmpled_e_op:
-+ case fcmpund_op:
-+ case fcmpund_e_op:
-+ {
-+ unsigned cmpop = NDS32Insn_OPCODE_BIT69(insn);
-+ if (cmpop < 0x8) {
-+ ieee754dp fs, ft;
-+
-+ DPFROMREG(fs,
-+ NDS32Insn_OPCODE_Ra(insn));
-+ DPFROMREG(ft,
-+ NDS32Insn_OPCODE_Rb(insn));
-+ rv.w =
-+ ieee754dp_cmp(fs, ft,
-+ cmptab[(cmpop >> 1) &
-+ 0x7],
-+ cmpop & 0x1);
-+ rfmt = fs2_op;
-+ if ((cmpop & 0x1)
-+ &&
-+ ieee754_cxtest
-+ (IEEE754_INVALID_OPERATION))
-+ rfpcsr = FPCSR_mskIVO;
-+ else
-+ goto copcsr;
-+ } else
-+ return SIGILL;
-+ }
-+ break;
-+ default:
-+ return SIGILL;
-+ }
-+ break;
-+
-+ default:
-+ return SIGILL;
-+ }
-+
-+ /*
-+ * Now we can safely write the result back to the register file.
-+ */
-+ switch (rfmt) {
-+ case fd1_op:
-+ case fd2_op:
-+ DPTOREG(rv.d, NDS32Insn_OPCODE_Rt(insn));
-+ break;
-+ case fs1_op:
-+ case fs2_op:
-+ SPTOREG(rv.s, NDS32Insn_OPCODE_Rt(insn));
-+ break;
-+ default:
-+ return SIGILL;
-+ }
-+
-+ /*
-+ * Update the fpu CSR register for this operation.
-+ * If an exception is required, generate a tidy SIGFPE exception,
-+ * without updating the result register.
-+ * Note: cause exception bits do not accumulate, they are rewritten
-+ * for each op; only the flag/sticky bits accumulate.
-+ */
-+ ctx->fpcsr = (ctx->fpcsr & ~FPCSR_mskALL) | rfpcsr;
-+ if ((ctx->fpcsr << 5) & ctx->fpcsr & FPCSR_mskALLE) {
-+ return SIGFPE;
-+ }
-+
-+ return 0;
-+}
-+
-+int do_fpu_denorm(struct pt_regs *regs, struct fpu_struct *fpu)
-+{
-+ int sig = 0;
-+
-+ /*
-+ * The 'ieee754_csr' is an alias of
-+ * fpcsr->RM. No need to copy fpcsr->RM to
-+ * ieee754_csr. But ieee754_csr.rm is ieee
-+ * library modes. (not NDS32 rounding mode)
-+ */
-+ /* convert to ieee library modes */
-+ ieee754_csr.rm = ieee_rm[ieee754_csr.rm];
-+ sig = fpuEmulate(regs, fpu);
-+ /* revert to NDS32 rounding mode */
-+ ieee754_csr.rm = nds32_rm[ieee754_csr.rm];
-+
-+ return sig;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/fpu_emulator.h linux-3.4.113/arch/nds32/math-emu/fpu_emulator.h
---- linux-3.4.113.orig/arch/nds32/math-emu/fpu_emulator.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/fpu_emulator.h 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,36 @@
-+/*
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * Further private data for which no space exists in mips_fpu_struct.
-+ * This should be subsumed into the mips_fpu_struct structure as
-+ * defined in processor.h as soon as the absurd wired absolute assembler
-+ * offsets become dynamic at compile time.
-+ *
-+ * Kevin D. Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com
-+ * Copyright (C) 2000 MIPS Technologies, Inc. All rights reserved.
-+ */
-+#ifndef _ASM_FPU_EMULATOR_H
-+#define _ASM_FPU_EMULATOR_H
-+
-+struct fpu_emulator_stats {
-+ unsigned int emulated;
-+ unsigned int loads;
-+ unsigned int stores;
-+ unsigned int fpuops;
-+ unsigned int errors;
-+};
-+
-+extern struct fpu_emulator_stats fpuemustats;
-+
-+#endif /* _ASM_FPU_EMULATOR_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754.c linux-3.4.113/arch/nds32/math-emu/ieee754.c
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,125 @@
-+/* ieee754 floating point arithmetic
-+ * single and double precision
-+ *
-+ * BUGS
-+ * not much dp done
-+ * doesn't generate IEEE754_INEXACT
-+ *
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754int.h"
-+#include "ieee754sp.h"
-+#include "ieee754dp.h"
-+
-+#define DP_EBIAS 1023
-+#define DP_EMIN (-1022)
-+#define DP_EMAX 1023
-+
-+#define SP_EBIAS 127
-+#define SP_EMIN (-126)
-+#define SP_EMAX 127
-+
-+/* special constants
-+*/
-+
-+#if (defined(BYTE_ORDER) && BYTE_ORDER == LITTLE_ENDIAN) || defined(__NDS32_EL__)
-+#define SPSTR(s, b, m) {m, b, s}
-+#define DPSTR(s, b, mh, ml) {ml, mh, b, s}
-+#endif
-+
-+#ifdef __NDS32_EB__
-+#define SPSTR(s, b, m) {s, b, m}
-+#define DPSTR(s, b, mh, ml) {s, b, mh, ml}
-+#endif
-+
-+const struct ieee754dp_konst __ieee754dp_spcvals[] = {
-+ DPSTR(0, DP_EMIN - 1 + DP_EBIAS, 0, 0), /* + zero */
-+ DPSTR(1, DP_EMIN - 1 + DP_EBIAS, 0, 0), /* - zero */
-+ DPSTR(0, DP_EBIAS, 0, 0), /* + 1.0 */
-+ DPSTR(1, DP_EBIAS, 0, 0), /* - 1.0 */
-+ DPSTR(0, 3 + DP_EBIAS, 0x40000, 0), /* + 10.0 */
-+ DPSTR(1, 3 + DP_EBIAS, 0x40000, 0), /* - 10.0 */
-+ DPSTR(0, DP_EMAX + 1 + DP_EBIAS, 0, 0), /* + infinity */
-+ DPSTR(1, DP_EMAX + 1 + DP_EBIAS, 0, 0), /* - infinity */
-+ DPSTR(0, DP_EMAX + 1 + DP_EBIAS, 0x7FFFF, 0xFFFFFFFF), /* + indef quiet Nan */
-+ DPSTR(0, DP_EMAX + DP_EBIAS, 0xFFFFF, 0xFFFFFFFF), /* + max */
-+ DPSTR(1, DP_EMAX + DP_EBIAS, 0xFFFFF, 0xFFFFFFFF), /* - max */
-+ DPSTR(0, DP_EMIN + DP_EBIAS, 0, 0), /* + min normal */
-+ DPSTR(1, DP_EMIN + DP_EBIAS, 0, 0), /* - min normal */
-+ DPSTR(0, DP_EMIN - 1 + DP_EBIAS, 0, 1), /* + min denormal */
-+ DPSTR(1, DP_EMIN - 1 + DP_EBIAS, 0, 1), /* - min denormal */
-+ DPSTR(0, 31 + DP_EBIAS, 0, 0), /* + 1.0e31 */
-+ DPSTR(0, 63 + DP_EBIAS, 0, 0), /* + 1.0e63 */
-+};
-+
-+const struct ieee754sp_konst __ieee754sp_spcvals[] = {
-+ SPSTR(0, SP_EMIN - 1 + SP_EBIAS, 0), /* + zero */
-+ SPSTR(1, SP_EMIN - 1 + SP_EBIAS, 0), /* - zero */
-+ SPSTR(0, SP_EBIAS, 0), /* + 1.0 */
-+ SPSTR(1, SP_EBIAS, 0), /* - 1.0 */
-+ SPSTR(0, 3 + SP_EBIAS, 0x200000), /* + 10.0 */
-+ SPSTR(1, 3 + SP_EBIAS, 0x200000), /* - 10.0 */
-+ SPSTR(0, SP_EMAX + 1 + SP_EBIAS, 0), /* + infinity */
-+ SPSTR(1, SP_EMAX + 1 + SP_EBIAS, 0), /* - infinity */
-+ SPSTR(0, SP_EMAX + 1 + SP_EBIAS, 0x3FFFFF), /* + indef quiet Nan */
-+ SPSTR(0, SP_EMAX + SP_EBIAS, 0x7FFFFF), /* + max normal */
-+ SPSTR(1, SP_EMAX + SP_EBIAS, 0x7FFFFF), /* - max normal */
-+ SPSTR(0, SP_EMIN + SP_EBIAS, 0), /* + min normal */
-+ SPSTR(1, SP_EMIN + SP_EBIAS, 0), /* - min normal */
-+ SPSTR(0, SP_EMIN - 1 + SP_EBIAS, 1), /* + min denormal */
-+ SPSTR(1, SP_EMIN - 1 + SP_EBIAS, 1), /* - min denormal */
-+ SPSTR(0, 31 + SP_EBIAS, 0), /* + 1.0e31 */
-+ SPSTR(0, 63 + SP_EBIAS, 0), /* + 1.0e63 */
-+};
-+
-+int ieee754si_xcpt(int r, const char *op, ...)
-+{
-+ struct ieee754xctx ax;
-+
-+ if (!TSTX())
-+ return r;
-+ ax.op = op;
-+ ax.rt = IEEE754_RT_SI;
-+ ax.rv.si = r;
-+ va_start(ax.ap, op);
-+ ieee754_xcpt(&ax);
-+ va_end(ax.ap);
-+ return ax.rv.si;
-+}
-+
-+s64 ieee754di_xcpt(s64 r, const char *op, ...)
-+{
-+ struct ieee754xctx ax;
-+
-+ if (!TSTX())
-+ return r;
-+ ax.op = op;
-+ ax.rt = IEEE754_RT_DI;
-+ ax.rv.di = r;
-+ va_start(ax.ap, op);
-+ ieee754_xcpt(&ax);
-+ va_end(ax.ap);
-+ return ax.rv.di;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754d.c linux-3.4.113/arch/nds32/math-emu/ieee754d.c
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754d.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754d.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,134 @@
-+/*
-+ * Some debug functions
-+ *
-+ * MIPS floating point support
-+ *
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * Nov 7, 2000
-+ * Modified to build and operate in Linux kernel environment.
-+ *
-+ * Kevin D. Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com
-+ * Copyright (C) 2000 MIPS Technologies, Inc. All rights reserved.
-+ */
-+
-+#include <linux/kernel.h>
-+#include "ieee754.h"
-+
-+#define DP_EBIAS 1023
-+#define DP_EMIN (-1022)
-+#define DP_EMAX 1023
-+#define DP_FBITS 52
-+
-+#define SP_EBIAS 127
-+#define SP_EMIN (-126)
-+#define SP_EMAX 127
-+#define SP_FBITS 23
-+
-+#define DP_MBIT(x) ((u64)1 << (x))
-+#define DP_HIDDEN_BIT DP_MBIT(DP_FBITS)
-+#define DP_SIGN_BIT DP_MBIT(63)
-+
-+#define SP_MBIT(x) ((u32)1 << (x))
-+#define SP_HIDDEN_BIT SP_MBIT(SP_FBITS)
-+#define SP_SIGN_BIT SP_MBIT(31)
-+
-+#define SPSIGN(sp) (sp.parts.sign)
-+#define SPBEXP(sp) (sp.parts.bexp)
-+#define SPMANT(sp) (sp.parts.mant)
-+
-+#define DPSIGN(dp) (dp.parts.sign)
-+#define DPBEXP(dp) (dp.parts.bexp)
-+#define DPMANT(dp) (dp.parts.mant)
-+
-+ieee754dp ieee754dp_dump(char *m, ieee754dp x)
-+{
-+ int i;
-+
-+ printk("%s", m);
-+ printk("<%08x,%08x>\n", (unsigned)(x.bits >> 32), (unsigned)x.bits);
-+ printk("\t=");
-+ switch (ieee754dp_class(x)) {
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_SNAN:
-+ printk("Nan %c", DPSIGN(x) ? '-' : '+');
-+ for (i = DP_FBITS - 1; i >= 0; i--)
-+ printk("%c", DPMANT(x) & DP_MBIT(i) ? '1' : '0');
-+ break;
-+ case IEEE754_CLASS_INF:
-+ printk("%cInfinity", DPSIGN(x) ? '-' : '+');
-+ break;
-+ case IEEE754_CLASS_ZERO:
-+ printk("%cZero", DPSIGN(x) ? '-' : '+');
-+ break;
-+ case IEEE754_CLASS_DNORM:
-+ printk("%c0.", DPSIGN(x) ? '-' : '+');
-+ for (i = DP_FBITS - 1; i >= 0; i--)
-+ printk("%c", DPMANT(x) & DP_MBIT(i) ? '1' : '0');
-+ printk("e%d", DPBEXP(x) - DP_EBIAS);
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ printk("%c1.", DPSIGN(x) ? '-' : '+');
-+ for (i = DP_FBITS - 1; i >= 0; i--)
-+ printk("%c", DPMANT(x) & DP_MBIT(i) ? '1' : '0');
-+ printk("e%d", DPBEXP(x) - DP_EBIAS);
-+ break;
-+ default:
-+ printk("Illegal/Unknown IEEE754 value class");
-+ }
-+ printk("\n");
-+ return x;
-+}
-+
-+ieee754sp ieee754sp_dump(char *m, ieee754sp x)
-+{
-+ int i;
-+
-+ printk("%s=", m);
-+ printk("<%08x>\n", (unsigned)x.bits);
-+ printk("\t=");
-+ switch (ieee754sp_class(x)) {
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_SNAN:
-+ printk("Nan %c", SPSIGN(x) ? '-' : '+');
-+ for (i = SP_FBITS - 1; i >= 0; i--)
-+ printk("%c", SPMANT(x) & SP_MBIT(i) ? '1' : '0');
-+ break;
-+ case IEEE754_CLASS_INF:
-+ printk("%cInfinity", SPSIGN(x) ? '-' : '+');
-+ break;
-+ case IEEE754_CLASS_ZERO:
-+ printk("%cZero", SPSIGN(x) ? '-' : '+');
-+ break;
-+ case IEEE754_CLASS_DNORM:
-+ printk("%c0.", SPSIGN(x) ? '-' : '+');
-+ for (i = SP_FBITS - 1; i >= 0; i--)
-+ printk("%c", SPMANT(x) & SP_MBIT(i) ? '1' : '0');
-+ printk("e%d", SPBEXP(x) - SP_EBIAS);
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ printk("%c1.", SPSIGN(x) ? '-' : '+');
-+ for (i = SP_FBITS - 1; i >= 0; i--)
-+ printk("%c", SPMANT(x) & SP_MBIT(i) ? '1' : '0');
-+ printk("e%d", SPBEXP(x) - SP_EBIAS);
-+ break;
-+ default:
-+ printk("Illegal/Unknown IEEE754 value class");
-+ }
-+ printk("\n");
-+ return x;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754dp.c linux-3.4.113/arch/nds32/math-emu/ieee754dp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754dp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754dp.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,239 @@
-+/* IEEE754 floating point arithmetic
-+ * double precision: common utilities
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754dp.h"
-+
-+int ieee754dp_class(ieee754dp x)
-+{
-+ COMPXDP;
-+ EXPLODEXDP;
-+ return xc;
-+}
-+
-+int ieee754dp_isnan(ieee754dp x)
-+{
-+ return ieee754dp_class(x) >= IEEE754_CLASS_SNAN;
-+}
-+
-+int ieee754dp_issnan(ieee754dp x)
-+{
-+ assert(ieee754dp_isnan(x));
-+ return ((DPMANT(x) & DP_MBIT(DP_MBITS - 1)) == DP_MBIT(DP_MBITS - 1));
-+}
-+
-+ieee754dp ieee754dp_xcpt(ieee754dp r, const char *op, ...)
-+{
-+ struct ieee754xctx ax;
-+ if (!TSTX())
-+ return r;
-+
-+ ax.op = op;
-+ ax.rt = IEEE754_RT_DP;
-+ ax.rv.dp = r;
-+ va_start(ax.ap, op);
-+ ieee754_xcpt(&ax);
-+ va_end(ax.ap);
-+ return ax.rv.dp;
-+}
-+
-+ieee754dp ieee754dp_nanxcpt(ieee754dp r, const char *op, ...)
-+{
-+ struct ieee754xctx ax;
-+
-+ assert(ieee754dp_isnan(r));
-+
-+ if (!ieee754dp_issnan(r)) /* QNAN does not cause invalid op !! */
-+ return r;
-+
-+ if (!SETANDTESTCX(IEEE754_INVALID_OPERATION)) {
-+ /* not enabled convert to a quiet NaN */
-+ DPMANT(r) &= (~DP_MBIT(DP_MBITS - 1));
-+ if (ieee754dp_isnan(r))
-+ return r;
-+ else
-+ return ieee754dp_indef();
-+ }
-+
-+ ax.op = op;
-+ ax.rt = 0;
-+ ax.rv.dp = r;
-+ va_start(ax.ap, op);
-+ ieee754_xcpt(&ax);
-+ va_end(ax.ap);
-+ return ax.rv.dp;
-+}
-+
-+ieee754dp ieee754dp_bestnan(ieee754dp x, ieee754dp y)
-+{
-+ assert(ieee754dp_isnan(x));
-+ assert(ieee754dp_isnan(y));
-+
-+ if (DPMANT(x) > DPMANT(y))
-+ return x;
-+ else
-+ return y;
-+}
-+
-+static u64 get_rounding(int sn, u64 xm)
-+{
-+ /* inexact must round of 3 bits
-+ */
-+ if (xm & (DP_MBIT(3) - 1)) {
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RZ:
-+ break;
-+ case IEEE754_RN:
-+ xm += 0x3 + ((xm >> 3) & 1);
-+ /* xm += (xm&0x8)?0x4:0x3 */
-+ break;
-+ case IEEE754_RU: /* toward +Infinity */
-+ if (!sn) /* ?? */
-+ xm += 0x8;
-+ break;
-+ case IEEE754_RD: /* toward -Infinity */
-+ if (sn) /* ?? */
-+ xm += 0x8;
-+ break;
-+ }
-+ }
-+ return xm;
-+}
-+
-+/* generate a normal/denormal number with over,under handling
-+ * sn is sign
-+ * xe is an unbiased exponent
-+ * xm is 3bit extended precision value.
-+ */
-+ieee754dp ieee754dp_format(int sn, int xe, u64 xm)
-+{
-+ assert(xm); /* we don't gen exact zeros (probably should) */
-+
-+ assert((xm >> (DP_MBITS + 1 + 3)) == 0); /* no execess */
-+ assert(xm & (DP_HIDDEN_BIT << 3));
-+
-+ if (xe < DP_EMIN) {
-+ /* strip lower bits */
-+ int es = DP_EMIN - xe;
-+
-+ if (ieee754_csr.nod) {
-+ SETCX(IEEE754_UNDERFLOW);
-+ SETCX(IEEE754_INEXACT);
-+
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ return ieee754dp_zero(sn);
-+ case IEEE754_RZ:
-+ return ieee754dp_zero(sn);
-+ case IEEE754_RU: /* toward +Infinity */
-+ if (sn == 0)
-+ return ieee754dp_min(0);
-+ else
-+ return ieee754dp_zero(1);
-+ case IEEE754_RD: /* toward -Infinity */
-+ if (sn == 0)
-+ return ieee754dp_zero(0);
-+ else
-+ return ieee754dp_min(1);
-+ }
-+ }
-+
-+ if (xe == DP_EMIN - 1
-+ && get_rounding(sn, xm) >> (DP_MBITS + 1 + 3)) {
-+ /* Not tiny after rounding */
-+ SETCX(IEEE754_INEXACT);
-+ xm = get_rounding(sn, xm);
-+ xm >>= 1;
-+ /* Clear grs bits */
-+ xm &= ~(DP_MBIT(3) - 1);
-+ xe++;
-+ } else {
-+ /* sticky right shift es bits
-+ */
-+ xm = XDPSRS(xm, es);
-+ xe += es;
-+ assert((xm & (DP_HIDDEN_BIT << 3)) == 0);
-+ assert(xe == DP_EMIN);
-+ }
-+ }
-+ if (xm & (DP_MBIT(3) - 1)) {
-+ SETCX(IEEE754_INEXACT);
-+ if ((xm & (DP_HIDDEN_BIT << 3)) == 0) {
-+ SETCX(IEEE754_UNDERFLOW);
-+ }
-+
-+ /* inexact must round of 3 bits
-+ */
-+ xm = get_rounding(sn, xm);
-+ /* adjust exponent for rounding add overflowing
-+ */
-+ if (xm >> (DP_MBITS + 3 + 1)) {
-+ /* add causes mantissa overflow */
-+ xm >>= 1;
-+ xe++;
-+ }
-+ }
-+ /* strip grs bits */
-+ xm >>= 3;
-+
-+ assert((xm >> (DP_MBITS + 1)) == 0); /* no execess */
-+ assert(xe >= DP_EMIN);
-+
-+ if (xe > DP_EMAX) {
-+ SETCX(IEEE754_OVERFLOW);
-+ SETCX(IEEE754_INEXACT);
-+ /* -O can be table indexed by (rm,sn) */
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ return ieee754dp_inf(sn);
-+ case IEEE754_RZ:
-+ return ieee754dp_max(sn);
-+ case IEEE754_RU: /* toward +Infinity */
-+ if (sn == 0)
-+ return ieee754dp_inf(0);
-+ else
-+ return ieee754dp_max(1);
-+ case IEEE754_RD: /* toward -Infinity */
-+ if (sn == 0)
-+ return ieee754dp_max(0);
-+ else
-+ return ieee754dp_inf(1);
-+ }
-+ }
-+ /* gen norm/denorm/zero */
-+
-+ if ((xm & DP_HIDDEN_BIT) == 0) {
-+ /* we underflow (tiny/zero) */
-+ assert(xe == DP_EMIN);
-+ if (ieee754_csr.mx & IEEE754_UNDERFLOW)
-+ SETCX(IEEE754_UNDERFLOW);
-+ return builddp(sn, DP_EMIN - 1 + DP_EBIAS, xm);
-+ } else {
-+ assert((xm >> (DP_MBITS + 1)) == 0); /* no execess */
-+ assert(xm & DP_HIDDEN_BIT);
-+
-+ return builddp(sn, xe + DP_EBIAS, xm & ~DP_HIDDEN_BIT);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754dp.h linux-3.4.113/arch/nds32/math-emu/ieee754dp.h
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754dp.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754dp.h 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,83 @@
-+/*
-+ * IEEE754 floating point
-+ * double precision internal header file
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+
-+#include "ieee754int.h"
-+
-+#define assert(expr) ((void)0)
-+
-+/* 3bit extended double precision sticky right shift */
-+#define XDPSRS(v,rs) \
-+ ((rs > (DP_MBITS+3))?1:((v) >> (rs)) | ((v) << (64-(rs)) != 0))
-+
-+#define XDPSRSX1() \
-+ (xe++, (xm = (xm >> 1) | (xm & 1)))
-+
-+#define XDPSRS1(v) \
-+ (((v) >> 1) | ((v) & 1))
-+
-+/* convert denormal to normalized with extended exponent */
-+#define DPDNORMx(m,e) \
-+ while( (m >> DP_MBITS) == 0) { m <<= 1; e--; }
-+#define DPDNORMX DPDNORMx(xm, xe)
-+#define DPDNORMY DPDNORMx(ym, ye)
-+
-+static inline ieee754dp builddp(int s, int bx, u64 m)
-+{
-+ ieee754dp r;
-+
-+ assert((s) == 0 || (s) == 1);
-+ assert((bx) >= DP_EMIN - 1 + DP_EBIAS
-+ && (bx) <= DP_EMAX + 1 + DP_EBIAS);
-+ assert(((m) >> DP_MBITS) == 0);
-+
-+ r.parts.sign = s;
-+ r.parts.bexp = bx;
-+ r.parts.mant = m;
-+ return r;
-+}
-+
-+extern int ieee754dp_isnan(ieee754dp);
-+extern int ieee754dp_issnan(ieee754dp);
-+extern int ieee754si_xcpt(int, const char *, ...);
-+extern s64 ieee754di_xcpt(s64, const char *, ...);
-+extern ieee754dp ieee754dp_xcpt(ieee754dp, const char *, ...);
-+extern ieee754dp ieee754dp_nanxcpt(ieee754dp, const char *, ...);
-+extern ieee754dp ieee754dp_bestnan(ieee754dp, ieee754dp);
-+extern ieee754dp ieee754dp_format(int, int, u64);
-+
-+
-+#define DPNORMRET2(s, e, m, name, a0, a1) \
-+{ \
-+ ieee754dp V = ieee754dp_format(s, e, m); \
-+ if(TSTX()) \
-+ return ieee754dp_xcpt(V, name, a0, a1); \
-+ else \
-+ return V; \
-+}
-+
-+#define DPNORMRET1(s, e, m, name, a0) DPNORMRET2(s, e, m, name, a0, a0)
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754.h linux-3.4.113/arch/nds32/math-emu/ieee754.h
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754.h 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,467 @@
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * Nov 7, 2000
-+ * Modification to allow integration with Linux kernel
-+ *
-+ * Kevin D. Kissell, kevink@mips.com and Carsten Langgard, carstenl@mips.com
-+ * Copyright (C) 2000 MIPS Technologies, Inc. All rights reserved.
-+ */
-+#ifndef __ARCH_MIPS_MATH_EMU_IEEE754_H
-+#define __ARCH_MIPS_MATH_EMU_IEEE754_H
-+
-+#include <asm/byteorder.h>
-+#include <linux/types.h>
-+#include <linux/sched.h>
-+
-+/*
-+ * Not very pretty, but the Linux kernel's normal va_list definition
-+ * does not allow it to be used as a structure element, as it is here.
-+ */
-+#ifndef _STDARG_H
-+#include <stdarg.h>
-+#endif
-+
-+#ifdef __LITTLE_ENDIAN
-+struct ieee754dp_konst {
-+ unsigned mantlo:32;
-+ unsigned manthi:20;
-+ unsigned bexp:11;
-+ unsigned sign:1;
-+};
-+struct ieee754sp_konst {
-+ unsigned mant:23;
-+ unsigned bexp:8;
-+ unsigned sign:1;
-+};
-+
-+typedef union _ieee754dp {
-+ struct ieee754dp_konst oparts;
-+ struct {
-+ u64 mant:52;
-+ unsigned int bexp:11;
-+ unsigned int sign:1;
-+ } parts;
-+ u64 bits;
-+ double d;
-+} ieee754dp;
-+
-+typedef union _ieee754sp {
-+ struct ieee754sp_konst parts;
-+ float f;
-+ u32 bits;
-+} ieee754sp;
-+#endif
-+
-+#ifdef __BIG_ENDIAN
-+struct ieee754dp_konst {
-+ unsigned sign:1;
-+ unsigned bexp:11;
-+ unsigned manthi:20;
-+ unsigned mantlo:32;
-+};
-+
-+typedef union _ieee754dp {
-+ struct ieee754dp_konst oparts;
-+ struct {
-+ unsigned int sign:1;
-+ unsigned int bexp:11;
-+ u64 mant:52;
-+ } parts;
-+ double d;
-+ u64 bits;
-+} ieee754dp;
-+
-+struct ieee754sp_konst {
-+ unsigned sign:1;
-+ unsigned bexp:8;
-+ unsigned mant:23;
-+};
-+
-+typedef union _ieee754sp {
-+ struct ieee754sp_konst parts;
-+ float f;
-+ u32 bits;
-+} ieee754sp;
-+#endif
-+
-+/*
-+ * single precision (often aka float)
-+*/
-+int ieee754sp_finite(ieee754sp x);
-+int ieee754sp_class(ieee754sp x);
-+
-+ieee754sp ieee754sp_abs(ieee754sp x);
-+ieee754sp ieee754sp_neg(ieee754sp x);
-+ieee754sp ieee754sp_scalb(ieee754sp x, int);
-+ieee754sp ieee754sp_logb(ieee754sp x);
-+
-+/* x with sign of y */
-+ieee754sp ieee754sp_copysign(ieee754sp x, ieee754sp y);
-+
-+ieee754sp ieee754sp_add(ieee754sp x, ieee754sp y);
-+ieee754sp ieee754sp_sub(ieee754sp x, ieee754sp y);
-+ieee754sp ieee754sp_mul(ieee754sp x, ieee754sp y);
-+ieee754sp ieee754sp_div(ieee754sp x, ieee754sp y);
-+
-+ieee754sp ieee754sp_fint(int x);
-+ieee754sp ieee754sp_funs(unsigned x);
-+ieee754sp ieee754sp_flong(s64 x);
-+ieee754sp ieee754sp_fulong(u64 x);
-+ieee754sp ieee754sp_fdp(ieee754dp x);
-+
-+int ieee754sp_tint(ieee754sp x);
-+unsigned int ieee754sp_tuns(ieee754sp x);
-+s64 ieee754sp_tlong(ieee754sp x);
-+u64 ieee754sp_tulong(ieee754sp x);
-+
-+int ieee754sp_cmp(ieee754sp x, ieee754sp y, int cop, int sig);
-+/*
-+ * basic sp math
-+ */
-+ieee754sp ieee754sp_modf(ieee754sp x, ieee754sp * ip);
-+ieee754sp ieee754sp_frexp(ieee754sp x, int *exp);
-+ieee754sp ieee754sp_ldexp(ieee754sp x, int exp);
-+
-+ieee754sp ieee754sp_ceil(ieee754sp x);
-+ieee754sp ieee754sp_floor(ieee754sp x);
-+ieee754sp ieee754sp_trunc(ieee754sp x);
-+
-+ieee754sp ieee754sp_sqrt(ieee754sp x);
-+
-+/*
-+ * double precision (often aka double)
-+*/
-+int ieee754dp_finite(ieee754dp x);
-+int ieee754dp_class(ieee754dp x);
-+
-+/* x with sign of y */
-+ieee754dp ieee754dp_copysign(ieee754dp x, ieee754dp y);
-+
-+ieee754dp ieee754dp_add(ieee754dp x, ieee754dp y);
-+ieee754dp ieee754dp_sub(ieee754dp x, ieee754dp y);
-+ieee754dp ieee754dp_mul(ieee754dp x, ieee754dp y);
-+ieee754dp ieee754dp_div(ieee754dp x, ieee754dp y);
-+
-+ieee754dp ieee754dp_abs(ieee754dp x);
-+ieee754dp ieee754dp_neg(ieee754dp x);
-+ieee754dp ieee754dp_scalb(ieee754dp x, int);
-+
-+/* return exponent as integer in floating point format
-+ */
-+ieee754dp ieee754dp_logb(ieee754dp x);
-+
-+ieee754dp ieee754dp_fint(int x);
-+ieee754dp ieee754dp_funs(unsigned x);
-+ieee754dp ieee754dp_flong(s64 x);
-+ieee754dp ieee754dp_fulong(u64 x);
-+ieee754dp ieee754dp_fsp(ieee754sp x);
-+
-+ieee754dp ieee754dp_ceil(ieee754dp x);
-+ieee754dp ieee754dp_floor(ieee754dp x);
-+ieee754dp ieee754dp_trunc(ieee754dp x);
-+
-+int ieee754dp_tint(ieee754dp x);
-+unsigned int ieee754dp_tuns(ieee754dp x);
-+s64 ieee754dp_tlong(ieee754dp x);
-+u64 ieee754dp_tulong(ieee754dp x);
-+
-+int ieee754dp_cmp(ieee754dp x, ieee754dp y, int cop, int sig);
-+/*
-+ * basic sp math
-+ */
-+ieee754dp ieee754dp_modf(ieee754dp x, ieee754dp * ip);
-+ieee754dp ieee754dp_frexp(ieee754dp x, int *exp);
-+ieee754dp ieee754dp_ldexp(ieee754dp x, int exp);
-+
-+ieee754dp ieee754dp_ceil(ieee754dp x);
-+ieee754dp ieee754dp_floor(ieee754dp x);
-+ieee754dp ieee754dp_trunc(ieee754dp x);
-+
-+ieee754dp ieee754dp_sqrt(ieee754dp x);
-+
-+
-+
-+/* 5 types of floating point number
-+*/
-+#define IEEE754_CLASS_NORM 0x00
-+#define IEEE754_CLASS_ZERO 0x01
-+#define IEEE754_CLASS_DNORM 0x02
-+#define IEEE754_CLASS_INF 0x03
-+#define IEEE754_CLASS_SNAN 0x04
-+#define IEEE754_CLASS_QNAN 0x05
-+
-+/* exception numbers */
-+#define IEEE754_INVALID_OPERATION 0x01
-+#define IEEE754_ZERO_DIVIDE 0x02
-+#define IEEE754_OVERFLOW 0x04
-+#define IEEE754_UNDERFLOW 0x08
-+#define IEEE754_INEXACT 0x10
-+
-+/* cmp operators
-+*/
-+#define IEEE754_CLT 0x01
-+#define IEEE754_CEQ 0x02
-+#define IEEE754_CGT 0x04
-+#define IEEE754_CUN 0x08
-+
-+/* rounding mode
-+*/
-+#define IEEE754_RN 0 /* round to nearest */
-+#define IEEE754_RZ 1 /* round toward zero */
-+#define IEEE754_RD 2 /* round toward -Infinity */
-+#define IEEE754_RU 3 /* round toward +Infinity */
-+
-+/* other naming */
-+#define IEEE754_RM IEEE754_RD
-+#define IEEE754_RP IEEE754_RU
-+
-+/* "normal" comparisons
-+*/
-+static inline int ieee754sp_eq(ieee754sp x, ieee754sp y)
-+{
-+ return ieee754sp_cmp(x, y, IEEE754_CEQ, 0);
-+}
-+
-+static inline int ieee754sp_ne(ieee754sp x, ieee754sp y)
-+{
-+ return ieee754sp_cmp(x, y,
-+ IEEE754_CLT | IEEE754_CGT | IEEE754_CUN, 0);
-+}
-+
-+static inline int ieee754sp_lt(ieee754sp x, ieee754sp y)
-+{
-+ return ieee754sp_cmp(x, y, IEEE754_CLT, 0);
-+}
-+
-+static inline int ieee754sp_le(ieee754sp x, ieee754sp y)
-+{
-+ return ieee754sp_cmp(x, y, IEEE754_CLT | IEEE754_CEQ, 0);
-+}
-+
-+static inline int ieee754sp_gt(ieee754sp x, ieee754sp y)
-+{
-+ return ieee754sp_cmp(x, y, IEEE754_CGT, 0);
-+}
-+
-+
-+static inline int ieee754sp_ge(ieee754sp x, ieee754sp y)
-+{
-+ return ieee754sp_cmp(x, y, IEEE754_CGT | IEEE754_CEQ, 0);
-+}
-+
-+static inline int ieee754dp_eq(ieee754dp x, ieee754dp y)
-+{
-+ return ieee754dp_cmp(x, y, IEEE754_CEQ, 0);
-+}
-+
-+static inline int ieee754dp_ne(ieee754dp x, ieee754dp y)
-+{
-+ return ieee754dp_cmp(x, y,
-+ IEEE754_CLT | IEEE754_CGT | IEEE754_CUN, 0);
-+}
-+
-+static inline int ieee754dp_lt(ieee754dp x, ieee754dp y)
-+{
-+ return ieee754dp_cmp(x, y, IEEE754_CLT, 0);
-+}
-+
-+static inline int ieee754dp_le(ieee754dp x, ieee754dp y)
-+{
-+ return ieee754dp_cmp(x, y, IEEE754_CLT | IEEE754_CEQ, 0);
-+}
-+
-+static inline int ieee754dp_gt(ieee754dp x, ieee754dp y)
-+{
-+ return ieee754dp_cmp(x, y, IEEE754_CGT, 0);
-+}
-+
-+static inline int ieee754dp_ge(ieee754dp x, ieee754dp y)
-+{
-+ return ieee754dp_cmp(x, y, IEEE754_CGT | IEEE754_CEQ, 0);
-+}
-+
-+
-+/*
-+ * Like strtod
-+ */
-+ieee754dp ieee754dp_fstr(const char *s, char **endp);
-+char *ieee754dp_tstr(ieee754dp x, int prec, int fmt, int af);
-+
-+
-+/*
-+ * The control status register
-+ */
-+struct _ieee754_csr {
-+#ifdef __BIG_ENDIAN
-+ unsigned pad0:12;
-+ unsigned cx:7; /* exceptions this operation */
-+ unsigned nod:1; /* set 1 for no denormalised numbers */
-+ unsigned mx:5; /* exception enable mask */
-+ unsigned sx:5; /* exceptions total */
-+ unsigned rm:2; /* current rounding mode */
-+#endif
-+#ifdef __LITTLE_ENDIAN
-+ unsigned rm:2; /* current rounding mode */
-+ unsigned sx:5; /* exceptions total */
-+ unsigned mx:5; /* exception enable mask */
-+ unsigned nod:1; /* set 1 for no denormalised numbers */
-+ unsigned cx:7; /* exceptions this operation */
-+ unsigned pad0:12;
-+#endif
-+};
-+#define ieee754_csr (*(struct _ieee754_csr *)(&current->thread.fpu.fpcsr))
-+
-+static inline unsigned ieee754_getrm(void)
-+{
-+ return (ieee754_csr.rm);
-+}
-+static inline unsigned ieee754_setrm(unsigned rm)
-+{
-+ return (ieee754_csr.rm = rm);
-+}
-+
-+/*
-+ * get current exceptions
-+ */
-+static inline unsigned ieee754_getcx(void)
-+{
-+ return (ieee754_csr.cx);
-+}
-+
-+/* test for current exception condition
-+ */
-+static inline int ieee754_cxtest(unsigned n)
-+{
-+ return (ieee754_csr.cx & n);
-+}
-+
-+/*
-+ * get sticky exceptions
-+ */
-+static inline unsigned ieee754_getsx(void)
-+{
-+ return (ieee754_csr.sx);
-+}
-+
-+/* clear sticky conditions
-+*/
-+static inline unsigned ieee754_clrsx(void)
-+{
-+ return (ieee754_csr.sx = 0);
-+}
-+
-+/* test for sticky exception condition
-+ */
-+static inline int ieee754_sxtest(unsigned n)
-+{
-+ return (ieee754_csr.sx & n);
-+}
-+
-+/* debugging */
-+ieee754sp ieee754sp_dump(char *s, ieee754sp x);
-+ieee754dp ieee754dp_dump(char *s, ieee754dp x);
-+
-+#define IEEE754_SPCVAL_PZERO 0
-+#define IEEE754_SPCVAL_NZERO 1
-+#define IEEE754_SPCVAL_PONE 2
-+#define IEEE754_SPCVAL_NONE 3
-+#define IEEE754_SPCVAL_PTEN 4
-+#define IEEE754_SPCVAL_NTEN 5
-+#define IEEE754_SPCVAL_PINFINITY 6
-+#define IEEE754_SPCVAL_NINFINITY 7
-+#define IEEE754_SPCVAL_INDEF 8
-+#define IEEE754_SPCVAL_PMAX 9 /* +max norm */
-+#define IEEE754_SPCVAL_NMAX 10 /* -max norm */
-+#define IEEE754_SPCVAL_PMIN 11 /* +min norm */
-+#define IEEE754_SPCVAL_NMIN 12 /* +min norm */
-+#define IEEE754_SPCVAL_PMIND 13 /* +min denorm */
-+#define IEEE754_SPCVAL_NMIND 14 /* +min denorm */
-+#define IEEE754_SPCVAL_P1E31 15 /* + 1.0e31 */
-+#define IEEE754_SPCVAL_P1E63 16 /* + 1.0e63 */
-+
-+extern const struct ieee754dp_konst __ieee754dp_spcvals[];
-+extern const struct ieee754sp_konst __ieee754sp_spcvals[];
-+#define ieee754dp_spcvals ((const ieee754dp *)__ieee754dp_spcvals)
-+#define ieee754sp_spcvals ((const ieee754sp *)__ieee754sp_spcvals)
-+
-+/*
-+ * Return infinity with given sign
-+ */
-+#define ieee754dp_inf(sn) (ieee754dp_spcvals[IEEE754_SPCVAL_PINFINITY+(sn)])
-+#define ieee754dp_zero(sn) (ieee754dp_spcvals[IEEE754_SPCVAL_PZERO+(sn)])
-+#define ieee754dp_one(sn) (ieee754dp_spcvals[IEEE754_SPCVAL_PONE+(sn)])
-+#define ieee754dp_ten(sn) (ieee754dp_spcvals[IEEE754_SPCVAL_PTEN+(sn)])
-+#define ieee754dp_indef() (ieee754dp_spcvals[IEEE754_SPCVAL_INDEF])
-+#define ieee754dp_max(sn) (ieee754dp_spcvals[IEEE754_SPCVAL_PMAX+(sn)])
-+#define ieee754dp_min(sn) (ieee754dp_spcvals[IEEE754_SPCVAL_PMIN+(sn)])
-+#define ieee754dp_mind(sn) (ieee754dp_spcvals[IEEE754_SPCVAL_PMIND+(sn)])
-+#define ieee754dp_1e31() (ieee754dp_spcvals[IEEE754_SPCVAL_P1E31])
-+#define ieee754dp_1e63() (ieee754dp_spcvals[IEEE754_SPCVAL_P1E63])
-+
-+#define ieee754sp_inf(sn) (ieee754sp_spcvals[IEEE754_SPCVAL_PINFINITY+(sn)])
-+#define ieee754sp_zero(sn) (ieee754sp_spcvals[IEEE754_SPCVAL_PZERO+(sn)])
-+#define ieee754sp_one(sn) (ieee754sp_spcvals[IEEE754_SPCVAL_PONE+(sn)])
-+#define ieee754sp_ten(sn) (ieee754sp_spcvals[IEEE754_SPCVAL_PTEN+(sn)])
-+#define ieee754sp_indef() (ieee754sp_spcvals[IEEE754_SPCVAL_INDEF])
-+#define ieee754sp_max(sn) (ieee754sp_spcvals[IEEE754_SPCVAL_PMAX+(sn)])
-+#define ieee754sp_min(sn) (ieee754sp_spcvals[IEEE754_SPCVAL_PMIN+(sn)])
-+#define ieee754sp_mind(sn) (ieee754sp_spcvals[IEEE754_SPCVAL_PMIND+(sn)])
-+#define ieee754sp_1e31() (ieee754sp_spcvals[IEEE754_SPCVAL_P1E31])
-+#define ieee754sp_1e63() (ieee754sp_spcvals[IEEE754_SPCVAL_P1E63])
-+
-+/*
-+ * Indefinite integer value
-+ */
-+#define ieee754si_indef() INT_MAX
-+#ifdef LONG_LONG_MAX
-+#define ieee754di_indef() LONG_LONG_MAX
-+#else
-+#define ieee754di_indef() ((s64)(~0ULL>>1))
-+#endif
-+
-+/* IEEE exception context, passed to handler */
-+struct ieee754xctx {
-+ const char *op; /* operation name */
-+ int rt; /* result type */
-+ union {
-+ ieee754sp sp; /* single precision */
-+ ieee754dp dp; /* double precision */
-+#ifdef IEEE854_XP
-+ ieee754xp xp; /* extended precision */
-+#endif
-+ int si; /* standard signed integer (32bits) */
-+ s64 di; /* extended signed integer (64bits) */
-+ } rv; /* default result format implied by op */
-+ va_list ap;
-+};
-+
-+/* result types for xctx.rt */
-+#define IEEE754_RT_SP 0
-+#define IEEE754_RT_DP 1
-+#define IEEE754_RT_XP 2
-+#define IEEE754_RT_SI 3
-+#define IEEE754_RT_DI 4
-+
-+extern void ieee754_xcpt(struct ieee754xctx *xcp);
-+
-+/* compat */
-+#define ieee754dp_fix(x) ieee754dp_tint(x)
-+#define ieee754sp_fix(x) ieee754sp_tint(x)
-+
-+#endif /* __ARCH_MIPS_MATH_EMU_IEEE754_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754int.h linux-3.4.113/arch/nds32/math-emu/ieee754int.h
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754int.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754int.h 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,165 @@
-+/*
-+ * IEEE754 floating point
-+ * common internal header file
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+
-+#include "ieee754.h"
-+
-+#define DP_EBIAS 1023
-+#define DP_EMIN (-1022)
-+#define DP_EMAX 1023
-+#define DP_MBITS 52
-+
-+#define SP_EBIAS 127
-+#define SP_EMIN (-126)
-+#define SP_EMAX 127
-+#define SP_MBITS 23
-+
-+#define DP_MBIT(x) ((u64)1 << (x))
-+#define DP_HIDDEN_BIT DP_MBIT(DP_MBITS)
-+#define DP_SIGN_BIT DP_MBIT(63)
-+
-+#define SP_MBIT(x) ((u32)1 << (x))
-+#define SP_HIDDEN_BIT SP_MBIT(SP_MBITS)
-+#define SP_SIGN_BIT SP_MBIT(31)
-+
-+
-+#define SPSIGN(sp) (sp.parts.sign)
-+#define SPBEXP(sp) (sp.parts.bexp)
-+#define SPMANT(sp) (sp.parts.mant)
-+
-+#define DPSIGN(dp) (dp.parts.sign)
-+#define DPBEXP(dp) (dp.parts.bexp)
-+#define DPMANT(dp) (dp.parts.mant)
-+
-+#define CLPAIR(x, y) ((x)*6+(y))
-+
-+#define CLEARCX \
-+ (ieee754_csr.cx = 0)
-+
-+#define SETCX(x) \
-+ (ieee754_csr.cx |= (x), ieee754_csr.sx |= (x))
-+
-+#define SETANDTESTCX(x) \
-+ (SETCX(x), ieee754_csr.mx & (x))
-+
-+#define TSTX() \
-+ (ieee754_csr.cx & ieee754_csr.mx)
-+
-+
-+#define COMPXSP \
-+ unsigned xm; int xe; int xs; int xc
-+
-+#define COMPYSP \
-+ unsigned ym; int ye; int ys; int yc
-+
-+#define EXPLODESP(v, vc, vs, ve, vm) \
-+{\
-+ vs = SPSIGN(v);\
-+ ve = SPBEXP(v);\
-+ vm = SPMANT(v);\
-+ if(ve == SP_EMAX+1+SP_EBIAS){\
-+ if(vm == 0)\
-+ vc = IEEE754_CLASS_INF;\
-+ else if(vm & SP_MBIT(SP_MBITS-1)) \
-+ vc = IEEE754_CLASS_SNAN;\
-+ else \
-+ vc = IEEE754_CLASS_QNAN;\
-+ } else if(ve == SP_EMIN-1+SP_EBIAS) {\
-+ if(vm) {\
-+ ve = SP_EMIN;\
-+ vc = IEEE754_CLASS_DNORM;\
-+ } else\
-+ vc = IEEE754_CLASS_ZERO;\
-+ } else {\
-+ ve -= SP_EBIAS;\
-+ vm |= SP_HIDDEN_BIT;\
-+ vc = IEEE754_CLASS_NORM;\
-+ }\
-+}
-+#define EXPLODEXSP EXPLODESP(x, xc, xs, xe, xm)
-+#define EXPLODEYSP EXPLODESP(y, yc, ys, ye, ym)
-+
-+
-+#define COMPXDP \
-+u64 xm; int xe; int xs; int xc
-+
-+#define COMPYDP \
-+u64 ym; int ye; int ys; int yc
-+
-+#define EXPLODEDP(v, vc, vs, ve, vm) \
-+{\
-+ vm = DPMANT(v);\
-+ vs = DPSIGN(v);\
-+ ve = DPBEXP(v);\
-+ if(ve == DP_EMAX+1+DP_EBIAS){\
-+ if(vm == 0)\
-+ vc = IEEE754_CLASS_INF;\
-+ else if(vm & DP_MBIT(DP_MBITS-1)) \
-+ vc = IEEE754_CLASS_SNAN;\
-+ else \
-+ vc = IEEE754_CLASS_QNAN;\
-+ } else if(ve == DP_EMIN-1+DP_EBIAS) {\
-+ if(vm) {\
-+ ve = DP_EMIN;\
-+ vc = IEEE754_CLASS_DNORM;\
-+ } else\
-+ vc = IEEE754_CLASS_ZERO;\
-+ } else {\
-+ ve -= DP_EBIAS;\
-+ vm |= DP_HIDDEN_BIT;\
-+ vc = IEEE754_CLASS_NORM;\
-+ }\
-+}
-+#define EXPLODEXDP EXPLODEDP(x, xc, xs, xe, xm)
-+#define EXPLODEYDP EXPLODEDP(y, yc, ys, ye, ym)
-+
-+#define FLUSHDP(v, vc, vs, ve, vm) \
-+ if(vc==IEEE754_CLASS_DNORM) {\
-+ if(ieee754_csr.nod) {\
-+ SETCX(IEEE754_INEXACT);\
-+ vc = IEEE754_CLASS_ZERO;\
-+ ve = DP_EMIN-1+DP_EBIAS;\
-+ vm = 0;\
-+ v = ieee754dp_zero(vs);\
-+ }\
-+ }
-+
-+#define FLUSHSP(v, vc, vs, ve, vm) \
-+ if(vc==IEEE754_CLASS_DNORM) {\
-+ if(ieee754_csr.nod) {\
-+ SETCX(IEEE754_INEXACT);\
-+ vc = IEEE754_CLASS_ZERO;\
-+ ve = SP_EMIN-1+SP_EBIAS;\
-+ vm = 0;\
-+ v = ieee754sp_zero(vs);\
-+ }\
-+ }
-+
-+#define FLUSHXDP FLUSHDP(x, xc, xs, xe, xm)
-+#define FLUSHYDP FLUSHDP(y, yc, ys, ye, ym)
-+#define FLUSHXSP FLUSHSP(x, xc, xs, xe, xm)
-+#define FLUSHYSP FLUSHSP(y, yc, ys, ye, ym)
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754m.c linux-3.4.113/arch/nds32/math-emu/ieee754m.c
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754m.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754m.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,55 @@
-+/*
-+ * floor, trunc, ceil
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754.h"
-+
-+ieee754dp ieee754dp_floor(ieee754dp x)
-+{
-+ ieee754dp i;
-+
-+ if (ieee754dp_lt(ieee754dp_modf(x, &i), ieee754dp_zero(0)))
-+ return ieee754dp_sub(i, ieee754dp_one(0));
-+ else
-+ return i;
-+}
-+
-+ieee754dp ieee754dp_ceil(ieee754dp x)
-+{
-+ ieee754dp i;
-+
-+ if (ieee754dp_gt(ieee754dp_modf(x, &i), ieee754dp_zero(0)))
-+ return ieee754dp_add(i, ieee754dp_one(0));
-+ else
-+ return i;
-+}
-+
-+ieee754dp ieee754dp_trunc(ieee754dp x)
-+{
-+ ieee754dp i;
-+
-+ (void)ieee754dp_modf(x, &i);
-+ return i;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754sp.c linux-3.4.113/arch/nds32/math-emu/ieee754sp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754sp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754sp.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,239 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+int ieee754sp_class(ieee754sp x)
-+{
-+ COMPXSP;
-+ EXPLODEXSP;
-+ return xc;
-+}
-+
-+int ieee754sp_isnan(ieee754sp x)
-+{
-+ return ieee754sp_class(x) >= IEEE754_CLASS_SNAN;
-+}
-+
-+int ieee754sp_issnan(ieee754sp x)
-+{
-+ assert(ieee754sp_isnan(x));
-+ return (SPMANT(x) & SP_MBIT(SP_MBITS - 1));
-+}
-+
-+ieee754sp ieee754sp_xcpt(ieee754sp r, const char *op, ...)
-+{
-+ struct ieee754xctx ax;
-+
-+ if (!TSTX())
-+ return r;
-+
-+ ax.op = op;
-+ ax.rt = IEEE754_RT_SP;
-+ ax.rv.sp = r;
-+ va_start(ax.ap, op);
-+ ieee754_xcpt(&ax);
-+ va_end(ax.ap);
-+ return ax.rv.sp;
-+}
-+
-+ieee754sp ieee754sp_nanxcpt(ieee754sp r, const char *op, ...)
-+{
-+ struct ieee754xctx ax;
-+
-+ assert(ieee754sp_isnan(r));
-+
-+ if (!ieee754sp_issnan(r)) /* QNAN does not cause invalid op !! */
-+ return r;
-+
-+ if (!SETANDTESTCX(IEEE754_INVALID_OPERATION)) {
-+ /* not enabled convert to a quiet NaN */
-+ SPMANT(r) &= (~SP_MBIT(SP_MBITS - 1));
-+ if (ieee754sp_isnan(r))
-+ return r;
-+ else
-+ return ieee754sp_indef();
-+ }
-+
-+ ax.op = op;
-+ ax.rt = 0;
-+ ax.rv.sp = r;
-+ va_start(ax.ap, op);
-+ ieee754_xcpt(&ax);
-+ va_end(ax.ap);
-+ return ax.rv.sp;
-+}
-+
-+ieee754sp ieee754sp_bestnan(ieee754sp x, ieee754sp y)
-+{
-+ assert(ieee754sp_isnan(x));
-+ assert(ieee754sp_isnan(y));
-+
-+ if (SPMANT(x) > SPMANT(y))
-+ return x;
-+ else
-+ return y;
-+}
-+
-+static unsigned get_rounding(int sn, unsigned xm)
-+{
-+ /* inexact must round of 3 bits
-+ */
-+ if (xm & (SP_MBIT(3) - 1)) {
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RZ:
-+ break;
-+ case IEEE754_RN:
-+ xm += 0x3 + ((xm >> 3) & 1);
-+ /* xm += (xm&0x8)?0x4:0x3 */
-+ break;
-+ case IEEE754_RU: /* toward +Infinity */
-+ if (!sn) /* ?? */
-+ xm += 0x8;
-+ break;
-+ case IEEE754_RD: /* toward -Infinity */
-+ if (sn) /* ?? */
-+ xm += 0x8;
-+ break;
-+ }
-+ }
-+ return xm;
-+}
-+
-+/* generate a normal/denormal number with over,under handling
-+ * sn is sign
-+ * xe is an unbiased exponent
-+ * xm is 3bit extended precision value.
-+ */
-+ieee754sp ieee754sp_format(int sn, int xe, unsigned xm)
-+{
-+ assert(xm); /* we don't gen exact zeros (probably should) */
-+
-+ assert((xm >> (SP_MBITS + 1 + 3)) == 0); /* no execess */
-+ assert(xm & (SP_HIDDEN_BIT << 3));
-+
-+ if (xe < SP_EMIN) {
-+ /* strip lower bits */
-+ int es = SP_EMIN - xe;
-+
-+ if (ieee754_csr.nod) {
-+ SETCX(IEEE754_UNDERFLOW);
-+ SETCX(IEEE754_INEXACT);
-+
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ return ieee754sp_zero(sn);
-+ case IEEE754_RZ:
-+ return ieee754sp_zero(sn);
-+ case IEEE754_RU: /* toward +Infinity */
-+ if (sn == 0)
-+ return ieee754sp_min(0);
-+ else
-+ return ieee754sp_zero(1);
-+ case IEEE754_RD: /* toward -Infinity */
-+ if (sn == 0)
-+ return ieee754sp_zero(0);
-+ else
-+ return ieee754sp_min(1);
-+ }
-+ }
-+
-+ if (xe == SP_EMIN - 1
-+ && get_rounding(sn, xm) >> (SP_MBITS + 1 + 3)) {
-+ /* Not tiny after rounding */
-+ SETCX(IEEE754_INEXACT);
-+ xm = get_rounding(sn, xm);
-+ xm >>= 1;
-+ /* Clear grs bits */
-+ xm &= ~(SP_MBIT(3) - 1);
-+ xe++;
-+ } else {
-+ /* sticky right shift es bits
-+ */
-+ SPXSRSXn(es);
-+ assert((xm & (SP_HIDDEN_BIT << 3)) == 0);
-+ assert(xe == SP_EMIN);
-+ }
-+ }
-+ if (xm & (SP_MBIT(3) - 1)) {
-+ SETCX(IEEE754_INEXACT);
-+ if ((xm & (SP_HIDDEN_BIT << 3)) == 0) {
-+ SETCX(IEEE754_UNDERFLOW);
-+ }
-+
-+ /* inexact must round of 3 bits
-+ */
-+ xm = get_rounding(sn, xm);
-+ /* adjust exponent for rounding add overflowing
-+ */
-+ if (xm >> (SP_MBITS + 1 + 3)) {
-+ /* add causes mantissa overflow */
-+ xm >>= 1;
-+ xe++;
-+ }
-+ }
-+ /* strip grs bits */
-+ xm >>= 3;
-+
-+ assert((xm >> (SP_MBITS + 1)) == 0); /* no execess */
-+ assert(xe >= SP_EMIN);
-+
-+ if (xe > SP_EMAX) {
-+ SETCX(IEEE754_OVERFLOW);
-+ SETCX(IEEE754_INEXACT);
-+ /* -O can be table indexed by (rm,sn) */
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ return ieee754sp_inf(sn);
-+ case IEEE754_RZ:
-+ return ieee754sp_max(sn);
-+ case IEEE754_RU: /* toward +Infinity */
-+ if (sn == 0)
-+ return ieee754sp_inf(0);
-+ else
-+ return ieee754sp_max(1);
-+ case IEEE754_RD: /* toward -Infinity */
-+ if (sn == 0)
-+ return ieee754sp_max(0);
-+ else
-+ return ieee754sp_inf(1);
-+ }
-+ }
-+ /* gen norm/denorm/zero */
-+
-+ if ((xm & SP_HIDDEN_BIT) == 0) {
-+ /* we underflow (tiny/zero) */
-+ assert(xe == SP_EMIN);
-+ if (ieee754_csr.mx & IEEE754_UNDERFLOW)
-+ SETCX(IEEE754_UNDERFLOW);
-+ return buildsp(sn, SP_EMIN - 1 + SP_EBIAS, xm);
-+ } else {
-+ assert((xm >> (SP_MBITS + 1)) == 0); /* no execess */
-+ assert(xm & SP_HIDDEN_BIT);
-+
-+ return buildsp(sn, xe + SP_EBIAS, xm & ~SP_HIDDEN_BIT);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754sp.h linux-3.4.113/arch/nds32/math-emu/ieee754sp.h
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754sp.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754sp.h 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,89 @@
-+/*
-+ * IEEE754 floating point
-+ * double precision internal header file
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+
-+#include "ieee754int.h"
-+
-+#define assert(expr) ((void)0)
-+
-+/* 3bit extended single precision sticky right shift */
-+#define SPXSRSXn(rs) \
-+ (xe += rs, \
-+ xm = (rs > (SP_MBITS+3))?1:((xm) >> (rs)) | ((xm) << (32-(rs)) != 0))
-+
-+#define SPXSRSX1() \
-+ (xe++, (xm = (xm >> 1) | (xm & 1)))
-+
-+#define SPXSRSYn(rs) \
-+ (ye+=rs, \
-+ ym = (rs > (SP_MBITS+3))?1:((ym) >> (rs)) | ((ym) << (32-(rs)) != 0))
-+
-+#define SPXSRSY1() \
-+ (ye++, (ym = (ym >> 1) | (ym & 1)))
-+
-+/* convert denormal to normalized with extended exponent */
-+#define SPDNORMx(m,e) \
-+ while( (m >> SP_MBITS) == 0) { m <<= 1; e--; }
-+#define SPDNORMX SPDNORMx(xm, xe)
-+#define SPDNORMY SPDNORMx(ym, ye)
-+
-+static inline ieee754sp buildsp(int s, int bx, unsigned m)
-+{
-+ ieee754sp r;
-+
-+ assert((s) == 0 || (s) == 1);
-+ assert((bx) >= SP_EMIN - 1 + SP_EBIAS
-+ && (bx) <= SP_EMAX + 1 + SP_EBIAS);
-+ assert(((m) >> SP_MBITS) == 0);
-+
-+ r.parts.sign = s;
-+ r.parts.bexp = bx;
-+ r.parts.mant = m;
-+
-+ return r;
-+}
-+
-+extern int ieee754sp_isnan(ieee754sp);
-+extern int ieee754sp_issnan(ieee754sp);
-+extern int ieee754si_xcpt(int, const char *, ...);
-+extern s64 ieee754di_xcpt(s64, const char *, ...);
-+extern ieee754sp ieee754sp_xcpt(ieee754sp, const char *, ...);
-+extern ieee754sp ieee754sp_nanxcpt(ieee754sp, const char *, ...);
-+extern ieee754sp ieee754sp_bestnan(ieee754sp, ieee754sp);
-+extern ieee754sp ieee754sp_format(int, int, unsigned);
-+
-+
-+#define SPNORMRET2(s, e, m, name, a0, a1) \
-+{ \
-+ ieee754sp V = ieee754sp_format(s, e, m); \
-+ if(TSTX()) \
-+ return ieee754sp_xcpt(V, name, a0, a1); \
-+ else \
-+ return V; \
-+}
-+
-+#define SPNORMRET1(s, e, m, name, a0) SPNORMRET2(s, e, m, name, a0, a0)
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/ieee754xcpt.c linux-3.4.113/arch/nds32/math-emu/ieee754xcpt.c
---- linux-3.4.113.orig/arch/nds32/math-emu/ieee754xcpt.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/ieee754xcpt.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,48 @@
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+/**************************************************************************
-+ * Nov 7, 2000
-+ * Added preprocessor hacks to map to Linux kernel diagnostics.
-+ *
-+ * Kevin D. Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com
-+ * Copyright (C) 2000 MIPS Technologies, Inc. All rights reserved.
-+ *************************************************************************/
-+
-+#include <linux/kernel.h>
-+#include "ieee754.h"
-+
-+/*
-+ * Very naff exception handler (you can plug in your own and
-+ * override this).
-+ */
-+
-+static const char *const rtnames[] = {
-+ "sp", "dp", "xp", "si", "di"
-+};
-+
-+void ieee754_xcpt(struct ieee754xctx *xcp)
-+{
-+ printk(KERN_DEBUG "floating point exception in \"%s\", type=%s\n",
-+ xcp->op, rtnames[xcp->rt]);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/insn.h linux-3.4.113/arch/nds32/math-emu/insn.h
---- linux-3.4.113.orig/arch/nds32/math-emu/insn.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/insn.h 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,101 @@
-+#ifndef _ASM_INST_H
-+#define _ASM_INST_H
-+
-+#define cop0_op 0x35
-+
-+/*
-+ * COP0 field of opcodes.
-+ */
-+#define fs1_op 0x0
-+#define fs2_op 0x4
-+#define fd1_op 0x8
-+#define fd2_op 0xc
-+
-+/*
-+ * FS1 opcode.
-+ */
-+enum fs1 {
-+ fadds_op, fsubs_op, fcpynss_op, fcpyss_op,
-+ fmadds_op, fmsubs_op, fcmovns_op, fcmovzs_op,
-+ fnmadds_op, fnmsubs_op,
-+ fmuls_op = 0xc, fdivs_op,
-+ fs1_f2op_op = 0xf
-+};
-+
-+/*
-+ * FS1/F2OP opcode.
-+ */
-+enum fs1_f2 {
-+ fs2d_op, fsqrts_op, fabss_op = 0x5,
-+ fui2s_op = 0x8, fsi2s_op = 0xc,
-+ fs2ui_op = 0x10, fs2ui_z_op = 0x14,
-+ fs2si_op = 0x18, fs2si_z_op = 0x1c
-+};
-+
-+/*
-+ * FS2 opcode.
-+ */
-+enum fs2 {
-+ fcmpeqs_op, fcmpeqs_e_op, fcmplts_op, fcmplts_e_op,
-+ fcmples_op, fcmples_e_op, fcmpuns_op, fcmpuns_e_op
-+};
-+
-+/*
-+ * FD1 opcode.
-+ */
-+enum fd1 {
-+ faddd_op, fsubd_op, fcpynsd_op, fcpysd_op,
-+ fmaddd_op, fmsubd_op, fcmovnd_op, fcmovzd_op,
-+ fnmaddd_op, fnmsubd_op,
-+ fmuld_op = 0xc, fdivd_op, fd1_f2op_op = 0xf
-+};
-+
-+/*
-+ * FD1/F2OP opcode.
-+ */
-+enum fd1_f2 {
-+ fd2s_op, fsqrtd_op, fabsd_op = 0x5,
-+ fui2d_op = 0x8, fsi2d_op = 0xc,
-+ fd2ui_op = 0x10, fd2ui_z_op = 0x14,
-+ fd2si_op = 0x18, fd2si_z_op = 0x1c
-+};
-+
-+/*
-+ * FD2 opcode.
-+ */
-+enum fd2 {
-+ fcmpeqd_op, fcmpeqd_e_op, fcmpltd_op, fcmpltd_e_op,
-+ fcmpled_op, fcmpled_e_op, fcmpund_op, fcmpund_e_op
-+};
-+
-+
-+#define NDS32Insn(x) x
-+
-+#define I_OPCODE_off 25
-+#define NDS32Insn_OPCODE(x) (NDS32Insn(x) >> I_OPCODE_off)
-+
-+#define I_OPCODE_offRt 20
-+#define I_OPCODE_mskRt (0x1fUL << I_OPCODE_offRt)
-+#define NDS32Insn_OPCODE_Rt(x) ((NDS32Insn(x) & I_OPCODE_mskRt) >> I_OPCODE_offRt)
-+
-+#define I_OPCODE_offRa 15
-+#define I_OPCODE_mskRa (0x1fUL << I_OPCODE_offRa)
-+#define NDS32Insn_OPCODE_Ra(x) ((NDS32Insn(x) & I_OPCODE_mskRa) >> I_OPCODE_offRa)
-+
-+#define I_OPCODE_offRb 10
-+#define I_OPCODE_mskRb (0x1fUL << I_OPCODE_offRb)
-+#define NDS32Insn_OPCODE_Rb(x) ((NDS32Insn(x) & I_OPCODE_mskRb) >> I_OPCODE_offRb)
-+
-+#define I_OPCODE_offbit1014 10
-+#define I_OPCODE_mskbit1014 (0x1fUL << I_OPCODE_offbit1014)
-+#define NDS32Insn_OPCODE_BIT1014(x) ((NDS32Insn(x) & I_OPCODE_mskbit1014) >> I_OPCODE_offbit1014)
-+
-+#define I_OPCODE_offbit69 6
-+#define I_OPCODE_mskbit69 (0xfUL << I_OPCODE_offbit69)
-+#define NDS32Insn_OPCODE_BIT69(x) ((NDS32Insn(x) & I_OPCODE_mskbit69) >> I_OPCODE_offbit69)
-+
-+#define I_OPCODE_offCOP0 0
-+#define I_OPCODE_mskCOP0 (0x3fUL << I_OPCODE_offCOP0)
-+#define NDS32Insn_OPCODE_COP0(x) ((NDS32Insn(x) & I_OPCODE_mskCOP0) >> I_OPCODE_offCOP0)
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/Makefile linux-3.4.113/arch/nds32/math-emu/Makefile
---- linux-3.4.113.orig/arch/nds32/math-emu/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/Makefile 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,13 @@
-+#
-+# Makefile for the Linux/nds32 kernel FPU emulation.
-+#
-+
-+obj-y := fpuemu.o ieee754m.o ieee754d.o ieee754dp.o ieee754sp.o ieee754.o \
-+ ieee754xcpt.o dp_frexp.o dp_modf.o dp_div.o dp_mul.o dp_sub.o \
-+ dp_add.o dp_fsp.o dp_cmp.o dp_logb.o dp_scalb.o dp_simple.o \
-+ dp_tint.o dp_fint.o dp_tlong.o dp_flong.o sp_frexp.o sp_modf.o \
-+ sp_div.o sp_mul.o sp_sub.o sp_add.o sp_fdp.o sp_cmp.o sp_logb.o \
-+ sp_scalb.o sp_simple.o sp_tint.o sp_fint.o sp_tlong.o sp_flong.o \
-+ dp_sqrt.o sp_sqrt.o
-+
-+EXTRA_CFLAGS += -Werror
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_add.c linux-3.4.113/arch/nds32/math-emu/sp_add.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_add.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_add.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,173 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_add(ieee754sp x, ieee754sp y)
-+{
-+ COMPXSP;
-+ COMPYSP;
-+
-+ EXPLODEXSP;
-+ EXPLODEYSP;
-+
-+ CLEARCX;
-+
-+ FLUSHXSP;
-+ FLUSHYSP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "add", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ if (xs == ys)
-+ return x;
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_xcpt(ieee754sp_indef(), "add", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ return x;
-+
-+ /* Zero handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ if (xs == ys)
-+ return x;
-+ else
-+ return ieee754sp_zero(ieee754_csr.rm == IEEE754_RD);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ return x;
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ SPDNORMX;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ SPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ SPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ assert(xm & SP_HIDDEN_BIT);
-+ assert(ym & SP_HIDDEN_BIT);
-+
-+ /* provide guard,round and stick bit space */
-+ xm <<= 3;
-+ ym <<= 3;
-+
-+ if (xe > ye) {
-+ /* have to shift y fraction right to align
-+ */
-+ int s = xe - ye;
-+ SPXSRSYn(s);
-+ } else if (ye > xe) {
-+ /* have to shift x fraction right to align
-+ */
-+ int s = ye - xe;
-+ SPXSRSXn(s);
-+ }
-+ assert(xe == ye);
-+ assert(xe <= SP_EMAX);
-+
-+ if (xs == ys) {
-+ /* generate 28 bit result of adding two 27 bit numbers
-+ * leaving result in xm,xs,xe
-+ */
-+ xm = xm + ym;
-+ xe = xe;
-+ xs = xs;
-+
-+ if (xm >> (SP_MBITS + 1 + 3)) { /* carry out */
-+ SPXSRSX1();
-+ }
-+ } else {
-+ if (xm >= ym) {
-+ xm = xm - ym;
-+ xe = xe;
-+ xs = xs;
-+ } else {
-+ xm = ym - xm;
-+ xe = xe;
-+ xs = ys;
-+ }
-+ if (xm == 0)
-+ return ieee754sp_zero(ieee754_csr.rm == IEEE754_RD);
-+
-+ /* normalize in extended single precision */
-+ while ((xm >> (SP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+
-+ }
-+ SPNORMRET2(xs, xe, xm, "add", x, y);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_cmp.c linux-3.4.113/arch/nds32/math-emu/sp_cmp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_cmp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_cmp.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,66 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+int ieee754sp_cmp(ieee754sp x, ieee754sp y, int cmp, int sig)
-+{
-+ COMPXSP;
-+ COMPYSP;
-+
-+ EXPLODEXSP;
-+ EXPLODEYSP;
-+ FLUSHXSP;
-+ FLUSHYSP;
-+ CLEARCX; /* Even clear inexact flag here */
-+
-+ if (ieee754sp_isnan(x) || ieee754sp_isnan(y)) {
-+ if (sig || xc == IEEE754_CLASS_SNAN || yc == IEEE754_CLASS_SNAN)
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ if (cmp & IEEE754_CUN)
-+ return 1;
-+ if (cmp & (IEEE754_CLT | IEEE754_CGT)) {
-+ if (sig && SETANDTESTCX(IEEE754_INVALID_OPERATION))
-+ return ieee754si_xcpt(0, "fcmpf", x);
-+ }
-+ return 0;
-+ } else {
-+ int vx = x.bits;
-+ int vy = y.bits;
-+
-+ if (vx < 0)
-+ vx = -vx ^ SP_SIGN_BIT;
-+ if (vy < 0)
-+ vy = -vy ^ SP_SIGN_BIT;
-+
-+ if (vx < vy)
-+ return (cmp & IEEE754_CLT) != 0;
-+ else if (vx == vy)
-+ return (cmp & IEEE754_CEQ) != 0;
-+ else
-+ return (cmp & IEEE754_CGT) != 0;
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_div.c linux-3.4.113/arch/nds32/math-emu/sp_div.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_div.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_div.c 2016-12-01 20:59:24.364613214 +0100
-@@ -0,0 +1,155 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_div(ieee754sp x, ieee754sp y)
-+{
-+ COMPXSP;
-+ COMPYSP;
-+
-+ EXPLODEXSP;
-+ EXPLODEYSP;
-+
-+ CLEARCX;
-+
-+ FLUSHXSP;
-+ FLUSHYSP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_xcpt(ieee754sp_indef(), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ return ieee754sp_zero(xs ^ ys);
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ return ieee754sp_inf(xs ^ ys);
-+
-+ /* Zero handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_xcpt(ieee754sp_indef(), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ SETCX(IEEE754_ZERO_DIVIDE);
-+ return ieee754sp_xcpt(ieee754sp_inf(xs ^ ys), "div", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ return ieee754sp_zero(xs == ys ? 0 : 1);
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ SPDNORMX;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ SPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ SPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ assert(xm & SP_HIDDEN_BIT);
-+ assert(ym & SP_HIDDEN_BIT);
-+
-+ /* provide rounding space */
-+ xm <<= 3;
-+ ym <<= 3;
-+
-+ {
-+ /* now the dirty work */
-+
-+ unsigned rm = 0;
-+ int re = xe - ye;
-+ unsigned bm;
-+
-+ for (bm = SP_MBIT(SP_MBITS + 2); bm; bm >>= 1) {
-+ if (xm >= ym) {
-+ xm -= ym;
-+ rm |= bm;
-+ if (xm == 0)
-+ break;
-+ }
-+ xm <<= 1;
-+ }
-+ rm <<= 1;
-+ if (xm)
-+ rm |= 1; /* have remainder, set sticky */
-+
-+ assert(rm);
-+
-+ /* normalise rm to rounding precision ?
-+ */
-+ while ((rm >> (SP_MBITS + 3)) == 0) {
-+ rm <<= 1;
-+ re--;
-+ }
-+
-+ SPNORMRET2(xs == ys ? 0 : 1, re, rm, "div", x, y);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_fdp.c linux-3.4.113/arch/nds32/math-emu/sp_fdp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_fdp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_fdp.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,76 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_fdp(ieee754dp x)
-+{
-+ COMPXDP;
-+ ieee754sp nan;
-+
-+ EXPLODEXDP;
-+
-+ CLEARCX;
-+
-+ FLUSHXDP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "fdp");
-+ case IEEE754_CLASS_QNAN:
-+ nan = buildsp(xs, SP_EMAX + 1 + SP_EBIAS, (u32)
-+ (xm >> (DP_MBITS - SP_MBITS)));
-+ if (!ieee754sp_isnan(nan))
-+ nan = ieee754sp_indef();
-+ return ieee754sp_nanxcpt(nan, "fdp", x);
-+ case IEEE754_CLASS_INF:
-+ return ieee754sp_inf(xs);
-+ case IEEE754_CLASS_ZERO:
-+ return ieee754sp_zero(xs);
-+ case IEEE754_CLASS_DNORM:
-+ /* can't possibly be sp representable */
-+ SETCX(IEEE754_UNDERFLOW);
-+ SETCX(IEEE754_INEXACT);
-+ if ((ieee754_csr.rm == IEEE754_RU && !xs) ||
-+ (ieee754_csr.rm == IEEE754_RD && xs))
-+ return ieee754sp_xcpt(ieee754sp_mind(xs), "fdp", x);
-+ return ieee754sp_xcpt(ieee754sp_zero(xs), "fdp", x);
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+
-+ {
-+ u32 rm;
-+
-+ /* convert from DP_MBITS to SP_MBITS+3 with sticky right shift
-+ */
-+ rm = (xm >> (DP_MBITS - (SP_MBITS + 3))) |
-+ ((xm << (64 - (DP_MBITS - (SP_MBITS + 3)))) != 0);
-+
-+ SPNORMRET1(xs, xe, rm, "fdp", x);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_fint.c linux-3.4.113/arch/nds32/math-emu/sp_fint.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_fint.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_fint.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,78 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_fint(int x)
-+{
-+ unsigned xm;
-+ int xe;
-+ int xs;
-+
-+ CLEARCX;
-+
-+ if (x == 0)
-+ return ieee754sp_zero(0);
-+ if (x == 1 || x == -1)
-+ return ieee754sp_one(x < 0);
-+ if (x == 10 || x == -10)
-+ return ieee754sp_ten(x < 0);
-+
-+ xs = (x < 0);
-+ if (xs) {
-+ if (x == (1 << 31))
-+ xm = ((unsigned)1 << 31); /* max neg can't be safely negated */
-+ else
-+ xm = -x;
-+ } else {
-+ xm = x;
-+ }
-+ xe = SP_MBITS + 3;
-+
-+ if (xm >> (SP_MBITS + 1 + 3)) {
-+ /* shunt out overflow bits
-+ */
-+ while (xm >> (SP_MBITS + 1 + 3)) {
-+ SPXSRSX1();
-+ }
-+ } else {
-+ /* normalize in grs extended single precision
-+ */
-+ while ((xm >> (SP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ }
-+ SPNORMRET1(xs, xe, xm, "fint", x);
-+}
-+
-+ieee754sp ieee754sp_funs(unsigned int u)
-+{
-+ if ((int)u < 0)
-+ return ieee754sp_add(ieee754sp_1e31(),
-+ ieee754sp_fint(u & ~(1 << 31)));
-+ return ieee754sp_fint(u);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_flong.c linux-3.4.113/arch/nds32/math-emu/sp_flong.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_flong.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_flong.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,77 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_flong(s64 x)
-+{
-+ u64 xm; /* <--- need 64-bit mantissa temp */
-+ int xe;
-+ int xs;
-+
-+ CLEARCX;
-+
-+ if (x == 0)
-+ return ieee754sp_zero(0);
-+ if (x == 1 || x == -1)
-+ return ieee754sp_one(x < 0);
-+ if (x == 10 || x == -10)
-+ return ieee754sp_ten(x < 0);
-+
-+ xs = (x < 0);
-+ if (xs) {
-+ if (x == (1ULL << 63))
-+ xm = (1ULL << 63); /* max neg can't be safely negated */
-+ else
-+ xm = -x;
-+ } else {
-+ xm = x;
-+ }
-+ xe = SP_MBITS + 3;
-+
-+ if (xm >> (SP_MBITS + 1 + 3)) {
-+ /* shunt out overflow bits
-+ */
-+ while (xm >> (SP_MBITS + 1 + 3)) {
-+ SPXSRSX1();
-+ }
-+ } else {
-+ /* normalize in grs extended single precision */
-+ while ((xm >> (SP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ }
-+ SPNORMRET1(xs, xe, xm, "sp_flong", x);
-+}
-+
-+ieee754sp ieee754sp_fulong(u64 u)
-+{
-+ if ((s64) u < 0)
-+ return ieee754sp_add(ieee754sp_1e63(),
-+ ieee754sp_flong(u & ~(1ULL << 63)));
-+ return ieee754sp_flong(u);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_frexp.c linux-3.4.113/arch/nds32/math-emu/sp_frexp.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_frexp.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_frexp.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,52 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+/* close to ieeep754sp_logb
-+*/
-+ieee754sp ieee754sp_frexp(ieee754sp x, int *eptr)
-+{
-+ COMPXSP;
-+ CLEARCX;
-+ EXPLODEXSP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ case IEEE754_CLASS_ZERO:
-+ *eptr = 0;
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ SPDNORMX;
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ *eptr = xe + 1;
-+ return buildsp(xs, -1 + SP_EBIAS, xm & ~SP_HIDDEN_BIT);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_logb.c linux-3.4.113/arch/nds32/math-emu/sp_logb.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_logb.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_logb.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,53 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_logb(ieee754sp x)
-+{
-+ COMPXSP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXSP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ return ieee754sp_nanxcpt(x, "logb", x);
-+ case IEEE754_CLASS_QNAN:
-+ return x;
-+ case IEEE754_CLASS_INF:
-+ return ieee754sp_inf(0);
-+ case IEEE754_CLASS_ZERO:
-+ return ieee754sp_inf(1);
-+ case IEEE754_CLASS_DNORM:
-+ SPDNORMX;
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ return ieee754sp_fint(xe);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_modf.c linux-3.4.113/arch/nds32/math-emu/sp_modf.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_modf.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_modf.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,79 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+/* modf function is always exact for a finite number
-+*/
-+ieee754sp ieee754sp_modf(ieee754sp x, ieee754sp * ip)
-+{
-+ COMPXSP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXSP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ case IEEE754_CLASS_ZERO:
-+ *ip = x;
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ /* far to small */
-+ *ip = ieee754sp_zero(xs);
-+ return x;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ if (xe < 0) {
-+ *ip = ieee754sp_zero(xs);
-+ return x;
-+ }
-+ if (xe >= SP_MBITS) {
-+ *ip = x;
-+ return ieee754sp_zero(xs);
-+ }
-+ /* generate ipart mantissa by clearing bottom bits
-+ */
-+ *ip = buildsp(xs, xe + SP_EBIAS,
-+ ((xm >> (SP_MBITS - xe)) << (SP_MBITS - xe)) &
-+ ~SP_HIDDEN_BIT);
-+
-+ /* generate fpart mantissa by clearing top bits
-+ * and normalizing (must be able to normalize)
-+ */
-+ xm = (xm << (32 - (SP_MBITS - xe))) >> (32 - (SP_MBITS - xe));
-+ if (xm == 0)
-+ return ieee754sp_zero(xs);
-+
-+ while ((xm >> SP_MBITS) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ return buildsp(xs, xe + SP_EBIAS, xm & ~SP_HIDDEN_BIT);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_mul.c linux-3.4.113/arch/nds32/math-emu/sp_mul.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_mul.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_mul.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,168 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_mul(ieee754sp x, ieee754sp y)
-+{
-+ COMPXSP;
-+ COMPYSP;
-+
-+ EXPLODEXSP;
-+ EXPLODEYSP;
-+
-+ CLEARCX;
-+
-+ FLUSHXSP;
-+ FLUSHYSP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "mul", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_xcpt(ieee754sp_indef(), "mul", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ return ieee754sp_inf(xs ^ ys);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ return ieee754sp_zero(xs ^ ys);
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ SPDNORMX;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ SPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ SPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ /* rm = xm * ym, re = xe+ye basicly */
-+ assert(xm & SP_HIDDEN_BIT);
-+ assert(ym & SP_HIDDEN_BIT);
-+
-+ {
-+ int re = xe + ye;
-+ int rs = xs ^ ys;
-+ unsigned rm;
-+
-+ /* shunt to top of word */
-+ xm <<= 32 - (SP_MBITS + 1);
-+ ym <<= 32 - (SP_MBITS + 1);
-+
-+ /* multiply 32bits xm,ym to give high 32bits rm with stickness
-+ */
-+ {
-+ unsigned short lxm = xm & 0xffff;
-+ unsigned short hxm = xm >> 16;
-+ unsigned short lym = ym & 0xffff;
-+ unsigned short hym = ym >> 16;
-+ unsigned lrm;
-+ unsigned hrm;
-+
-+ lrm = lxm * lym; /* 16 * 16 => 32 */
-+ hrm = hxm * hym; /* 16 * 16 => 32 */
-+
-+ {
-+ unsigned t = lxm * hym; /* 16 * 16 => 32 */
-+ {
-+ unsigned at = lrm + (t << 16);
-+ hrm += at < lrm;
-+ lrm = at;
-+ }
-+ hrm = hrm + (t >> 16);
-+ }
-+
-+ {
-+ unsigned t = hxm * lym; /* 16 * 16 => 32 */
-+ {
-+ unsigned at = lrm + (t << 16);
-+ hrm += at < lrm;
-+ lrm = at;
-+ }
-+ hrm = hrm + (t >> 16);
-+ }
-+ rm = hrm | (lrm != 0);
-+ }
-+
-+ /*
-+ * sticky shift down to normal rounding precision
-+ */
-+ if ((int)rm < 0) {
-+ rm = (rm >> (32 - (SP_MBITS + 1 + 3))) |
-+ ((rm << (SP_MBITS + 1 + 3)) != 0);
-+ re++;
-+ } else {
-+ rm = (rm >> (32 - (SP_MBITS + 1 + 3 + 1))) |
-+ ((rm << (SP_MBITS + 1 + 3 + 1)) != 0);
-+ }
-+ assert(rm & (SP_HIDDEN_BIT << 3));
-+
-+ SPNORMRET2(rs, re, rm, "mul", x, y);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_scalb.c linux-3.4.113/arch/nds32/math-emu/sp_scalb.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_scalb.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_scalb.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,56 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_scalb(ieee754sp x, int n)
-+{
-+ COMPXSP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXSP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ return ieee754sp_nanxcpt(x, "scalb", x, n);
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ case IEEE754_CLASS_ZERO:
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ SPDNORMX;
-+ break;
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ SPNORMRET2(xs, xe + n, xm << 3, "scalb", x, n);
-+}
-+
-+ieee754sp ieee754sp_ldexp(ieee754sp x, int n)
-+{
-+ return ieee754sp_scalb(x, n);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_simple.c linux-3.4.113/arch/nds32/math-emu/sp_simple.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_simple.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_simple.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,87 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+int ieee754sp_finite(ieee754sp x)
-+{
-+ return SPBEXP(x) != SP_EMAX + 1 + SP_EBIAS;
-+}
-+
-+ieee754sp ieee754sp_copysign(ieee754sp x, ieee754sp y)
-+{
-+ CLEARCX;
-+ SPSIGN(x) = SPSIGN(y);
-+ return x;
-+}
-+
-+ieee754sp ieee754sp_neg(ieee754sp x)
-+{
-+ COMPXSP;
-+
-+ EXPLODEXSP;
-+ CLEARCX;
-+ FLUSHXSP;
-+
-+ /*
-+ * Invert the sign ALWAYS to prevent an endless recursion on
-+ * pow() in libc.
-+ */
-+ /* quick fix up */
-+ SPSIGN(x) ^= 1;
-+
-+ if (xc == IEEE754_CLASS_SNAN) {
-+ ieee754sp y = ieee754sp_indef();
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ SPSIGN(y) = SPSIGN(x);
-+ return ieee754sp_nanxcpt(y, "neg");
-+ }
-+
-+ if (ieee754sp_isnan(x)) /* but not infinity */
-+ return ieee754sp_nanxcpt(x, "neg", x);
-+ return x;
-+}
-+
-+ieee754sp ieee754sp_abs(ieee754sp x)
-+{
-+ COMPXSP;
-+
-+ EXPLODEXSP;
-+ CLEARCX;
-+ FLUSHXSP;
-+
-+ if (xc == IEEE754_CLASS_SNAN) {
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "abs");
-+ }
-+
-+ if (ieee754sp_isnan(x)) /* but not infinity */
-+ return ieee754sp_nanxcpt(x, "abs", x);
-+
-+ /* quick fix up */
-+ SPSIGN(x) = 0;
-+ return x;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_sqrt.c linux-3.4.113/arch/nds32/math-emu/sp_sqrt.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_sqrt.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_sqrt.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,116 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision square root
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_sqrt(ieee754sp x)
-+{
-+ int ix, s, q, m, t, i;
-+ unsigned int r;
-+ COMPXSP;
-+
-+ /* take care of Inf and NaN */
-+
-+ EXPLODEXSP;
-+ CLEARCX;
-+ FLUSHXSP;
-+
-+ /* x == INF or NAN? */
-+ switch (xc) {
-+ case IEEE754_CLASS_QNAN:
-+ /* sqrt(Nan) = Nan */
-+ return ieee754sp_nanxcpt(x, "sqrt");
-+ case IEEE754_CLASS_SNAN:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "sqrt");
-+ case IEEE754_CLASS_ZERO:
-+ /* sqrt(0) = 0 */
-+ return x;
-+ case IEEE754_CLASS_INF:
-+ if (xs) {
-+ /* sqrt(-Inf) = Nan */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "sqrt");
-+ }
-+ /* sqrt(+Inf) = Inf */
-+ return x;
-+ case IEEE754_CLASS_DNORM:
-+ case IEEE754_CLASS_NORM:
-+ if (xs) {
-+ /* sqrt(-x) = Nan */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "sqrt");
-+ }
-+ break;
-+ }
-+
-+ ix = x.bits;
-+
-+ /* normalize x */
-+ m = (ix >> 23);
-+ if (m == 0) { /* subnormal x */
-+ for (i = 0; (ix & 0x00800000) == 0; i++)
-+ ix <<= 1;
-+ m -= i - 1;
-+ }
-+ m -= 127; /* unbias exponent */
-+ ix = (ix & 0x007fffff) | 0x00800000;
-+ if (m & 1) /* odd m, double x to make it even */
-+ ix += ix;
-+ m >>= 1; /* m = [m/2] */
-+
-+ /* generate sqrt(x) bit by bit */
-+ ix += ix;
-+ q = s = 0; /* q = sqrt(x) */
-+ r = 0x01000000; /* r = moving bit from right to left */
-+
-+ while (r != 0) {
-+ t = s + r;
-+ if (t <= ix) {
-+ s = t + r;
-+ ix -= t;
-+ q += r;
-+ }
-+ ix += ix;
-+ r >>= 1;
-+ }
-+
-+ if (ix != 0) {
-+ SETCX(IEEE754_INEXACT);
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RP:
-+ q += 2;
-+ break;
-+ case IEEE754_RN:
-+ q += (q & 1);
-+ break;
-+ }
-+ }
-+ ix = (q >> 1) + 0x3f000000;
-+ ix += (m << 23);
-+ x.bits = ix;
-+ return x;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_sub.c linux-3.4.113/arch/nds32/math-emu/sp_sub.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_sub.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_sub.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,180 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+ieee754sp ieee754sp_sub(ieee754sp x, ieee754sp y)
-+{
-+ COMPXSP;
-+ COMPYSP;
-+
-+ EXPLODEXSP;
-+ EXPLODEYSP;
-+
-+ CLEARCX;
-+
-+ FLUSHXSP;
-+ FLUSHYSP;
-+
-+ switch (CLPAIR(xc, yc)) {
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_nanxcpt(ieee754sp_indef(), "sub", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
-+ case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
-+ return x;
-+
-+ /* Infinity handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
-+ if (xs != ys)
-+ return x;
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754sp_xcpt(ieee754sp_indef(), "sub", x, y);
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
-+ return ieee754sp_inf(ys ^ 1);
-+
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
-+ return x;
-+
-+ /* Zero handling
-+ */
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
-+ if (xs != ys)
-+ return x;
-+ else
-+ return ieee754sp_zero(ieee754_csr.rm == IEEE754_RD);
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
-+ return x;
-+
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
-+ case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
-+ /* quick fix up */
-+ DPSIGN(y) ^= 1;
-+ return y;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
-+ SPDNORMX;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
-+ SPDNORMY;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
-+ SPDNORMX;
-+ break;
-+
-+ case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
-+ break;
-+ }
-+ /* flip sign of y and handle as add */
-+ ys ^= 1;
-+
-+ assert(xm & SP_HIDDEN_BIT);
-+ assert(ym & SP_HIDDEN_BIT);
-+
-+ /* provide guard,round and stick bit space */
-+ xm <<= 3;
-+ ym <<= 3;
-+
-+ if (xe > ye) {
-+ /* have to shift y fraction right to align
-+ */
-+ int s = xe - ye;
-+ SPXSRSYn(s);
-+ } else if (ye > xe) {
-+ /* have to shift x fraction right to align
-+ */
-+ int s = ye - xe;
-+ SPXSRSXn(s);
-+ }
-+ assert(xe == ye);
-+ assert(xe <= SP_EMAX);
-+
-+ if (xs == ys) {
-+ /* generate 28 bit result of adding two 27 bit numbers
-+ */
-+ xm = xm + ym;
-+ xe = xe;
-+ xs = xs;
-+
-+ if (xm >> (SP_MBITS + 1 + 3)) { /* carry out */
-+ SPXSRSX1(); /* shift preserving sticky */
-+ }
-+ } else {
-+ if (xm >= ym) {
-+ xm = xm - ym;
-+ xe = xe;
-+ xs = xs;
-+ } else {
-+ xm = ym - xm;
-+ xe = xe;
-+ xs = ys;
-+ }
-+ if (xm == 0) {
-+ if (ieee754_csr.rm == IEEE754_RD)
-+ return ieee754sp_zero(1); /* round negative inf. => sign = -1 */
-+ else
-+ return ieee754sp_zero(0); /* other round modes => sign = 1 */
-+ }
-+ /* normalize to rounding precision
-+ */
-+ while ((xm >> (SP_MBITS + 3)) == 0) {
-+ xm <<= 1;
-+ xe--;
-+ }
-+ }
-+ SPNORMRET2(xs, xe, xm, "sub", x, y);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_tint.c linux-3.4.113/arch/nds32/math-emu/sp_tint.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_tint.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_tint.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,125 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include <linux/kernel.h>
-+#include "ieee754sp.h"
-+
-+int ieee754sp_tint(ieee754sp x)
-+{
-+ COMPXSP;
-+
-+ CLEARCX;
-+
-+ EXPLODEXSP;
-+ FLUSHXSP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754si_xcpt(ieee754si_indef(), "sp_tint", x);
-+ case IEEE754_CLASS_ZERO:
-+ return 0;
-+ case IEEE754_CLASS_DNORM:
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ if (xe >= 31) {
-+ /* look for valid corner case */
-+ if (xe == 31 && xs && xm == SP_HIDDEN_BIT)
-+ return -0x80000000;
-+ /* Set invalid. We will only use overflow for floating
-+ point overflow */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754si_xcpt(ieee754si_indef(), "sp_tint", x);
-+ }
-+ /* oh gawd */
-+ if (xe > SP_MBITS) {
-+ xm <<= xe - SP_MBITS;
-+ } else {
-+ u32 residue;
-+ int round;
-+ int sticky;
-+ int odd;
-+
-+ if (xe < -1) {
-+ residue = xm;
-+ round = 0;
-+ sticky = residue != 0;
-+ xm = 0;
-+ } else {
-+ /* Shifting a u32 32 times does not work,
-+ * so we do it in two steps. Be aware that xe
-+ * may be -1 */
-+ residue = xm << (xe + 1);
-+ residue <<= 31 - SP_MBITS;
-+ round = (residue >> 31) != 0;
-+ sticky = (residue << 1) != 0;
-+ xm >>= SP_MBITS - xe;
-+ }
-+ odd = (xm & 0x1) != 0x0;
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ if (round && (sticky || odd))
-+ xm++;
-+ break;
-+ case IEEE754_RZ:
-+ break;
-+ case IEEE754_RU: /* toward +Infinity */
-+ if ((round || sticky) && !xs)
-+ xm++;
-+ break;
-+ case IEEE754_RD: /* toward -Infinity */
-+ if ((round || sticky) && xs)
-+ xm++;
-+ break;
-+ }
-+ if ((xm >> 31) != 0) {
-+ /* This can happen after rounding */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754si_xcpt(ieee754si_indef(), "sp_tint", x);
-+ }
-+ if (round || sticky)
-+ SETCX(IEEE754_INEXACT);
-+ }
-+ if (xs)
-+ return -xm;
-+ else
-+ return xm;
-+}
-+
-+unsigned int ieee754sp_tuns(ieee754sp x)
-+{
-+ ieee754sp hb = ieee754sp_1e31();
-+
-+ /* what if x < 0 ?? */
-+ if (ieee754sp_lt(x, hb))
-+ return (unsigned)ieee754sp_tint(x);
-+
-+ return (unsigned)ieee754sp_tint(ieee754sp_sub(x, hb)) |
-+ ((unsigned)1 << 31);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/math-emu/sp_tlong.c linux-3.4.113/arch/nds32/math-emu/sp_tlong.c
---- linux-3.4.113.orig/arch/nds32/math-emu/sp_tlong.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/math-emu/sp_tlong.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,119 @@
-+/* IEEE754 floating point arithmetic
-+ * single precision
-+ */
-+/*
-+ * MIPS floating point support
-+ * Copyright (C) 1994-2000 Algorithmics Ltd.
-+ * http://www.algor.co.uk
-+ *
-+ * ########################################################################
-+ *
-+ * This program is free software; you can distribute it and/or modify it
-+ * under the terms of the GNU General Public License (Version 2) as
-+ * published by the Free Software Foundation.
-+ *
-+ * This program is distributed in the hope it will be useful, but WITHOUT
-+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
-+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
-+ * for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License along
-+ * with this program; if not, write to the Free Software Foundation, Inc.,
-+ * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
-+ *
-+ * ########################################################################
-+ */
-+
-+#include "ieee754sp.h"
-+
-+s64 ieee754sp_tlong(ieee754sp x)
-+{
-+ COMPXDP; /* <-- need 64-bit mantissa tmp */
-+
-+ CLEARCX;
-+
-+ EXPLODEXSP;
-+ FLUSHXSP;
-+
-+ switch (xc) {
-+ case IEEE754_CLASS_SNAN:
-+ case IEEE754_CLASS_QNAN:
-+ case IEEE754_CLASS_INF:
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754di_xcpt(ieee754di_indef(), "sp_tlong", x);
-+ case IEEE754_CLASS_ZERO:
-+ return 0;
-+ case IEEE754_CLASS_DNORM:
-+ case IEEE754_CLASS_NORM:
-+ break;
-+ }
-+ if (xe >= 63) {
-+ /* look for valid corner case */
-+ if (xe == 63 && xs && xm == SP_HIDDEN_BIT)
-+ return -0x8000000000000000LL;
-+ /* Set invalid. We will only use overflow for floating
-+ point overflow */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754di_xcpt(ieee754di_indef(), "sp_tlong", x);
-+ }
-+ /* oh gawd */
-+ if (xe > SP_MBITS) {
-+ xm <<= xe - SP_MBITS;
-+ } else if (xe < SP_MBITS) {
-+ u32 residue;
-+ int round;
-+ int sticky;
-+ int odd;
-+
-+ if (xe < -1) {
-+ residue = xm;
-+ round = 0;
-+ sticky = residue != 0;
-+ xm = 0;
-+ } else {
-+ residue = xm << (32 - SP_MBITS + xe);
-+ round = (residue >> 31) != 0;
-+ sticky = (residue << 1) != 0;
-+ xm >>= SP_MBITS - xe;
-+ }
-+ odd = (xm & 0x1) != 0x0;
-+ switch (ieee754_csr.rm) {
-+ case IEEE754_RN:
-+ if (round && (sticky || odd))
-+ xm++;
-+ break;
-+ case IEEE754_RZ:
-+ break;
-+ case IEEE754_RU: /* toward +Infinity */
-+ if ((round || sticky) && !xs)
-+ xm++;
-+ break;
-+ case IEEE754_RD: /* toward -Infinity */
-+ if ((round || sticky) && xs)
-+ xm++;
-+ break;
-+ }
-+ if ((xm >> 63) != 0) {
-+ /* This can happen after rounding */
-+ SETCX(IEEE754_INVALID_OPERATION);
-+ return ieee754di_xcpt(ieee754di_indef(), "sp_tlong", x);
-+ }
-+ if (round || sticky)
-+ SETCX(IEEE754_INEXACT);
-+ }
-+ if (xs)
-+ return -xm;
-+ else
-+ return xm;
-+}
-+
-+u64 ieee754sp_tulong(ieee754sp x)
-+{
-+ ieee754sp hb = ieee754sp_1e63();
-+
-+ /* what if x < 0 ?? */
-+ if (ieee754sp_lt(x, hb))
-+ return (u64) ieee754sp_tlong(x);
-+
-+ return (u64) ieee754sp_tlong(ieee754sp_sub(x, hb)) | (1ULL << 63);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/alignment.c linux-3.4.113/arch/nds32/mm/alignment.c
---- linux-3.4.113.orig/arch/nds32/mm/alignment.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/alignment.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,560 @@
-+/*
-+ * linux/arch/nds32/mm/alignment.c
-+ *
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/proc_fs.h>
-+#include <linux/uaccess.h>
-+
-+#include <asm/unaligned.h>
-+
-+#ifdef CONFIG_PROC_FS
-+extern struct proc_dir_entry *proc_dir_cpu;
-+#endif
-+
-+#define DEBUG(enable, tagged, ...) \
-+ do{ \
-+ if (enable) { \
-+ if (tagged) \
-+ printk(KERN_WARNING "[ %30s() ] ", __func__); \
-+ printk(KERN_WARNING __VA_ARGS__); \
-+ } \
-+ } while (0)
-+
-+#define RT(inst) (((inst) >> 20) & 0x1FUL)
-+#define RA(inst) (((inst) >> 15) & 0x1FUL)
-+#define RB(inst) (((inst) >> 10) & 0x1FUL)
-+#define SV(inst) (((inst) >> 8) & 0x3UL)
-+#define IMM(inst) (((inst) >> 0) & 0x3FFFUL)
-+
-+#define RA3(inst) (((inst) >> 3) & 0x7UL)
-+#define RT3(inst) (((inst) >> 6) & 0x7UL)
-+#define IMM3U(inst) (((inst) >> 0) & 0x7UL)
-+
-+#define RA5(inst) (((inst) >> 0) & 0x1FUL)
-+#define RT4(inst) (((inst) >> 5) & 0xFUL)
-+
-+extern int (*do_unaligned_access)
-+ (unsigned long entry, unsigned long addr,
-+ unsigned long type, struct pt_regs * regs);
-+extern int va_present(struct mm_struct *mm, unsigned long addr);
-+extern int va_kernel_present(unsigned long addr);
-+extern int va_readable(struct pt_regs *regs, unsigned long addr);
-+extern int va_writable(struct pt_regs *regs, unsigned long addr);
-+
-+static int mode = 0x3;
-+module_param(mode, int, 1);
-+
-+static inline unsigned long *idx_to_addr(struct pt_regs *regs, int idx)
-+{
-+ /* this should be consistent with ptrace.h */
-+ if (idx >= 0 && idx <= 25) /* R0-R25 */
-+ return &regs->NDS32_r0 + idx;
-+ else if (idx >= 28 && idx <= 30) /* FP, GP, LP */
-+ return &regs->NDS32_fp + (idx - 28);
-+ else if (idx == 31) /* SP */
-+ return &regs->NDS32_sp;
-+ else
-+ return NULL; /* cause a segfault */
-+}
-+
-+static inline unsigned long get_inst(unsigned long addr)
-+{
-+ /* FIXME: consider 16-bit inst. */
-+ return be32_to_cpu(get_unaligned((u32 *) addr));
-+}
-+
-+static inline unsigned long get_data(unsigned long addr, int len)
-+{
-+ if (len == 4)
-+ return get_unaligned((u32 *) addr);
-+ else
-+ return get_unaligned((u16 *) addr);
-+}
-+
-+static inline void set_data(unsigned long addr, unsigned long val, int len)
-+{
-+ if (len == 4)
-+ put_unaligned(val, (u32 *) addr);
-+ else
-+ put_unaligned(val, (u16 *) addr);
-+}
-+
-+static inline unsigned long sign_extend(unsigned long val, int len)
-+{
-+ unsigned long ret = 0;
-+ unsigned char *s, *t;
-+ int i = 0;
-+
-+ val = cpu_to_le32(val);
-+
-+ s = (void *)&val;
-+ t = (void *)&ret;
-+
-+ while (i++ < len)
-+ *t++ = *s++;
-+
-+ if (((*(t - 1)) & 0x80) && (i < 4)) {
-+
-+ while (i++ <= 4)
-+ *t++ = 0xff;
-+ }
-+
-+ return le32_to_cpu(ret);
-+}
-+
-+static inline int do_16(unsigned long inst, struct pt_regs *regs)
-+{
-+ int imm, regular, load, len, addr_mode, idx_mode;
-+ unsigned long unaligned_addr, target_val, source_idx, target_idx,
-+ shift = 0;
-+ switch ((inst >> 9) & 0x3F) {
-+
-+ case 0x12: /* LHI333 */
-+ imm = 1;
-+ regular = 1;
-+ load = 1;
-+ len = 2;
-+ addr_mode = 3;
-+ idx_mode = 3;
-+ break;
-+ case 0x10: /* LWI333 */
-+ imm = 1;
-+ regular = 1;
-+ load = 1;
-+ len = 4;
-+ addr_mode = 3;
-+ idx_mode = 3;
-+ break;
-+ case 0x11: /* LWI333.bi */
-+ imm = 1;
-+ regular = 0;
-+ load = 1;
-+ len = 4;
-+ addr_mode = 3;
-+ idx_mode = 3;
-+ break;
-+ case 0x1A: /* LWI450 */
-+ imm = 0;
-+ regular = 1;
-+ load = 1;
-+ len = 4;
-+ addr_mode = 5;
-+ idx_mode = 4;
-+ break;
-+ case 0x16: /* SHI333 */
-+ imm = 1;
-+ regular = 1;
-+ load = 0;
-+ len = 2;
-+ addr_mode = 3;
-+ idx_mode = 3;
-+ break;
-+ case 0x14: /* SWI333 */
-+ imm = 1;
-+ regular = 1;
-+ load = 0;
-+ len = 4;
-+ addr_mode = 3;
-+ idx_mode = 3;
-+ break;
-+ case 0x15: /* SWI333.bi */
-+ imm = 1;
-+ regular = 0;
-+ load = 0;
-+ len = 4;
-+ addr_mode = 3;
-+ idx_mode = 3;
-+ break;
-+ case 0x1B: /* SWI450 */
-+ imm = 0;
-+ regular = 1;
-+ load = 0;
-+ len = 4;
-+ addr_mode = 5;
-+ idx_mode = 4;
-+ break;
-+
-+ default:
-+ return -EFAULT;
-+ }
-+
-+ if (addr_mode == 3) {
-+ unaligned_addr = *idx_to_addr(regs, RA3(inst));
-+ source_idx = RA3(inst);
-+ } else {
-+ unaligned_addr = *idx_to_addr(regs, RA5(inst));
-+ source_idx = RA5(inst);
-+ }
-+
-+ if (idx_mode == 3)
-+ target_idx = RT3(inst);
-+ else
-+ target_idx = RT4(inst);
-+
-+ if (imm)
-+ shift = IMM3U(inst) * len;
-+
-+ if (regular)
-+ unaligned_addr += shift;
-+ else
-+ *idx_to_addr(regs, source_idx) = unaligned_addr + shift;
-+
-+ if (load) {
-+
-+ if (!va_readable(regs, unaligned_addr))
-+ return -EACCES;
-+
-+ if (!access_ok(VERIFY_READ, (void *)unaligned_addr, len))
-+ return -EACCES;
-+
-+ *idx_to_addr(regs, target_idx) = get_data(unaligned_addr, len);
-+ } else {
-+
-+ if (!va_writable(regs, unaligned_addr))
-+ return -EACCES;
-+
-+ if (!access_ok(VERIFY_WRITE, (void *)unaligned_addr, len))
-+ return -EACCES;
-+
-+ target_val = *idx_to_addr(regs, target_idx);
-+ set_data(unaligned_addr, target_val, len);
-+ }
-+
-+ regs->NDS32_ipc += 2;
-+
-+ return 0;
-+}
-+
-+static inline int do_32(unsigned long inst, struct pt_regs *regs)
-+{
-+ int imm, regular, load, len, sign_ext;
-+ unsigned long unsligned_addr, target_val, shift;
-+
-+ unsligned_addr = *idx_to_addr(regs, RA(inst));
-+
-+ switch ((inst >> 25) << 1) {
-+
-+ case 0x02: /* LHI */
-+ imm = 1;
-+ regular = 1;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x0A: /* LHI.bi */
-+ imm = 1;
-+ regular = 0;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x22: /* LHSI */
-+ imm = 1;
-+ regular = 1;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 1;
-+ break;
-+ case 0x2A: /* LHSI.bi */
-+ imm = 1;
-+ regular = 0;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 1;
-+ break;
-+ case 0x04: /* LWI */
-+ imm = 1;
-+ regular = 1;
-+ load = 1;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+ case 0x0C: /* LWI.bi */
-+ imm = 1;
-+ regular = 0;
-+ load = 1;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+ case 0x12: /* SHI */
-+ imm = 1;
-+ regular = 1;
-+ load = 0;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x1A: /* SHI.bi */
-+ imm = 1;
-+ regular = 0;
-+ load = 0;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x14: /* SWI */
-+ imm = 1;
-+ regular = 1;
-+ load = 0;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+ case 0x1C: /* SWI.bi */
-+ imm = 1;
-+ regular = 0;
-+ load = 0;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+
-+ default:
-+ switch (inst & 0xff) {
-+
-+ case 0x01: /* LH */
-+ imm = 0;
-+ regular = 1;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x05: /* LH.bi */
-+ imm = 0;
-+ regular = 0;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x11: /* LHS */
-+ imm = 0;
-+ regular = 1;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 1;
-+ break;
-+ case 0x15: /* LHS.bi */
-+ imm = 0;
-+ regular = 0;
-+ load = 1;
-+ len = 2;
-+ sign_ext = 1;
-+ break;
-+ case 0x02: /* LW */
-+ imm = 0;
-+ regular = 1;
-+ load = 1;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+ case 0x06: /* LW.bi */
-+ imm = 0;
-+ regular = 0;
-+ load = 1;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+ case 0x09: /* SH */
-+ imm = 0;
-+ regular = 1;
-+ load = 0;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x0D: /* SH.bi */
-+ imm = 0;
-+ regular = 0;
-+ load = 0;
-+ len = 2;
-+ sign_ext = 0;
-+ break;
-+ case 0x0A: /* SW */
-+ imm = 0;
-+ regular = 1;
-+ load = 0;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+ case 0x0E: /* SW.bi */
-+ imm = 0;
-+ regular = 0;
-+ load = 0;
-+ len = 4;
-+ sign_ext = 0;
-+ break;
-+
-+ default:
-+ return -EFAULT;
-+ }
-+ }
-+
-+ if (imm)
-+ shift = IMM(inst) * len;
-+ else
-+ shift = *idx_to_addr(regs, RB(inst)) << SV(inst);
-+
-+ if (regular)
-+ unsligned_addr += shift;
-+ else
-+ *idx_to_addr(regs, RA(inst)) = unsligned_addr + shift;
-+
-+ if (load) {
-+
-+ if (!va_readable(regs, unsligned_addr))
-+ return -EACCES;
-+
-+ if (!access_ok(VERIFY_READ, (void *)unsligned_addr, len))
-+ return -EACCES;
-+
-+ if (sign_ext)
-+ *idx_to_addr(regs, RT(inst)) =
-+ sign_extend(get_data(unsligned_addr, len), len);
-+ else
-+ *idx_to_addr(regs, RT(inst)) =
-+ get_data(unsligned_addr, len);
-+ } else {
-+
-+ if (!va_writable(regs, unsligned_addr))
-+ return -EACCES;
-+
-+ if (!access_ok(VERIFY_WRITE, (void *)unsligned_addr, len))
-+ return -EACCES;
-+
-+ target_val = *idx_to_addr(regs, RT(inst));
-+ set_data(unsligned_addr, target_val, len);
-+ }
-+
-+ regs->NDS32_ipc += 4;
-+
-+ return 0;
-+}
-+
-+static int _do_unaligned_access(unsigned long entry, unsigned long addr,
-+ unsigned long type, struct pt_regs *regs)
-+{
-+ unsigned long inst;
-+ int ret = -EFAULT;
-+
-+ if (user_mode(regs)) {
-+ /* user mode */
-+ if (!va_present(current->mm, addr))
-+ return ret;
-+ } else {
-+ /* kernel mode */
-+ if (!va_kernel_present(addr))
-+ return ret;
-+ }
-+
-+ inst = get_inst(regs->NDS32_ipc);
-+
-+ DEBUG(mode & 0x04, 1,
-+ "Faulting Addr: 0x%08lx, PC: 0x%08lx [ 0x%08lx ]\n", addr,
-+ regs->NDS32_ipc, inst);
-+
-+ if ((user_mode(regs) && (mode & 0x01))
-+ || (!user_mode(regs) && (mode & 0x02))) {
-+
-+ mm_segment_t seg = get_fs();
-+
-+ set_fs(KERNEL_DS);
-+
-+ if (inst & 0x80000000)
-+ ret = do_16((inst >> 16) & 0xffff, regs);
-+ else
-+ ret = do_32(inst, regs);
-+
-+ set_fs(seg);
-+ }
-+
-+ return ret;
-+}
-+
-+#ifdef CONFIG_PROC_FS
-+
-+static int proc_alignment_read(char *page, char **start, off_t off, int count,
-+ int *eof, void *data)
-+{
-+ char *p = page;
-+ int len;
-+
-+ p += sprintf(p, "(0x01) User Mode: %s\n", mode & 0x01 ? "on" : "off");
-+ p += sprintf(p, "(0x02) Kernel Mode: %s\n", mode & 0x02 ? "on" : "off");
-+ p += sprintf(p, "(0x04) Warning: %s\n", mode & 0x04 ? "on" : "off");
-+
-+ len = (p - page) - off;
-+ if (len < 0)
-+ len = 0;
-+
-+ *eof = (len <= count) ? 1 : 0;
-+ *start = page + off;
-+
-+ return len;
-+}
-+
-+#define INPUTLEN 12 /* '0' + 'x' + 8digit + '\n' + '\0' */
-+
-+static int proc_alignment_write(struct file *file, const char __user * buffer,
-+ unsigned long count, void *data)
-+{
-+ unsigned long en;
-+ char *endp;
-+ char inbuf[INPUTLEN];
-+
-+ if (count > INPUTLEN - 1)
-+ return -EFAULT;
-+
-+ if (copy_from_user(inbuf, buffer, count))
-+ return -EFAULT;
-+
-+ inbuf[count - 1] = '\0';
-+
-+ en = simple_strtoul(inbuf, &endp, 0);
-+ if (en > 0x07)
-+ return -EFAULT;
-+
-+ mode = en & 0x7;
-+
-+ return count;
-+}
-+
-+#endif /* CONFIG_PROC_FS */
-+
-+static int __init unaligned_access_init(void)
-+{
-+#ifdef CONFIG_PROC_FS
-+ static struct proc_dir_entry *res_alignment;
-+
-+ if (!proc_dir_cpu)
-+ if (!(proc_dir_cpu = proc_mkdir("cpu", NULL)))
-+ return -ENOMEM;
-+
-+ if (!
-+ (res_alignment =
-+ create_proc_entry("alignment", S_IWUSR | S_IRUGO, proc_dir_cpu)))
-+ return -ENOMEM;
-+
-+ res_alignment->read_proc = proc_alignment_read;
-+ res_alignment->write_proc = proc_alignment_write;
-+#endif
-+ do_unaligned_access = _do_unaligned_access;
-+
-+ return 0;
-+}
-+
-+static void __exit unaligned_access_exit(void)
-+{
-+#ifdef CONFIG_PROC_FS
-+ remove_proc_entry("alignment", proc_dir_cpu);
-+#endif
-+ do_unaligned_access = NULL;
-+}
-+
-+MODULE_AUTHOR("Roy Lee");
-+MODULE_DESCRIPTION("Unaligned Access Handler");
-+MODULE_LICENSE("GPL");
-+
-+module_init(unaligned_access_init);
-+module_exit(unaligned_access_exit);
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/cacheflush.c linux-3.4.113/arch/nds32/mm/cacheflush.c
---- linux-3.4.113.orig/arch/nds32/mm/cacheflush.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/cacheflush.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,355 @@
-+#include <linux/mm.h>
-+#include <linux/sched.h>
-+#include <linux/fs.h>
-+#include <linux/pagemap.h>
-+#include <linux/module.h>
-+#include <asm/cacheflush.h>
-+#include <asm/proc-fns.h>
-+#include <asm/shmparam.h>
-+#include <asm/cache_info.h>
-+
-+extern struct cache_info L1_cache_info[2];
-+
-+#ifdef CONFIG_CPU_CACHE_NONALIASING
-+void flush_cache_mm(struct mm_struct *mm)
-+{
-+}
-+
-+void flush_cache_dup_mm(struct mm_struct *mm)
-+{
-+}
-+
-+void flush_cache_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end)
-+{
-+}
-+
-+void flush_cache_page(struct vm_area_struct *vma,
-+ unsigned long addr, unsigned long pfn)
-+{
-+}
-+
-+void flush_cache_vmap(unsigned long start, unsigned long end)
-+{
-+}
-+
-+void flush_cache_vunmap(unsigned long start, unsigned long end)
-+{
-+}
-+
-+void flush_dcache_page(struct page *page)
-+{
-+ struct address_space *mapping;
-+
-+ if (!PageHighMem(page)) {
-+ mapping = page_mapping(page);
-+ if (mapping && !mapping_mapped(mapping))
-+ set_bit(PG_dcache_dirty, &page->flags);
-+ else
-+ cpu_dcache_wbinval_page((unsigned long)
-+ page_address(page));
-+ } else {
-+ unsigned long kaddr = (unsigned long)kmap_atomic(page);
-+ cpu_dcache_wbinval_page(kaddr);
-+ kunmap_atomic((void *)kaddr);
-+ }
-+}
-+
-+void copy_to_user_page(struct vm_area_struct *vma, struct page *page,
-+ unsigned long vaddr, void *dst, void *src, int len)
-+{
-+ unsigned long line_size, start, end;
-+
-+ memcpy(dst, src, len);
-+ if (vma->vm_flags & VM_EXEC) {
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ start = (unsigned long)dst & ~(line_size - 1);
-+ end =
-+ ((unsigned long)dst + len + line_size - 1) & ~(line_size -
-+ 1);
-+ cpu_cache_wbinval_range(start, end, 1);
-+ }
-+}
-+
-+void copy_from_user_page(struct vm_area_struct *vma, struct page *page,
-+ unsigned long vaddr, void *dst, void *src, int len)
-+{
-+ memcpy(dst, src, len);
-+}
-+
-+void flush_icache_range(unsigned long start, unsigned long end)
-+{
-+ cpu_cache_wbinval_range(start, end, 1);
-+}
-+
-+void flush_icache_page(struct vm_area_struct *vma, struct page *page)
-+{
-+}
-+
-+void update_mmu_cache(struct vm_area_struct *vma, unsigned long addr,
-+ pte_t * pte)
-+{
-+ struct page *page;
-+ unsigned long pfn = pte_pfn(*pte);
-+
-+ if (!pfn_valid(pfn))
-+ return;
-+
-+ if (vma->vm_mm == current->active_mm)
-+ asm("mtsr %1, $mr2\ndsb\n"
-+ "tlbop %0, RWR\nisb\n"
-+ ::"r"(*pte), "r"(addr));
-+
-+ page = pfn_to_page(pfn);
-+
-+ if ((test_and_clear_bit(PG_dcache_dirty, &page->flags)) ||
-+ (vma->vm_flags & VM_EXEC)) {
-+
-+ if (!PageHighMem(page)) {
-+ cpu_cache_wbinval_page((unsigned long)
-+ page_address(page),
-+ vma->vm_flags & VM_EXEC);
-+ } else {
-+ unsigned long kaddr = (unsigned long)kmap_atomic(page);
-+ cpu_cache_wbinval_page(kaddr, vma->vm_flags & VM_EXEC);
-+ kunmap_atomic((void *)kaddr);
-+ }
-+ }
-+}
-+#else
-+int va_present(struct mm_struct *mm, unsigned long addr);
-+
-+static inline unsigned long aliasing(unsigned long addr, unsigned long page)
-+{
-+ return ((addr & PAGE_MASK) ^ page) & (REALSHMLBA - 1);
-+}
-+
-+static inline unsigned long kremap0(unsigned long uaddr, unsigned long pa)
-+{
-+ unsigned long kaddr, pte;
-+
-+#define BASE_ADDR0 0xffffc000
-+ kaddr = BASE_ADDR0 | (uaddr & L1_cache_info[DCACHE].aliasing_mask);
-+ pte = (pa | PAGE_KERNEL);
-+ asm("mtsr %1, $mr2\ndsb\n"
-+ "tlbop %0, RWLK\nisb\n"
-+ ::"r"(pte), "r"(kaddr));
-+ return kaddr;
-+}
-+
-+static inline void kunmap01(unsigned long kaddr)
-+{
-+ asm volatile ("tlbop %0, UNLK\n\t"
-+ "tlbop %0, INV\n\t"
-+ ::"r" (kaddr));
-+}
-+
-+static inline unsigned long kremap1(unsigned long uaddr, unsigned long pa)
-+{
-+ unsigned long kaddr, pte;
-+
-+#define BASE_ADDR1 0xffff8000
-+ kaddr = BASE_ADDR1 | (uaddr & L1_cache_info[DCACHE].aliasing_mask);
-+ pte = (pa | PAGE_KERNEL);
-+ asm("mtsr %1, $mr2\ndsb\n"
-+ "tlbop %0, RWLK\nisb\n"
-+ ::"r"(pte), "r"(kaddr));
-+ return kaddr;
-+}
-+
-+void flush_cache_mm(struct mm_struct *mm)
-+{
-+ cpu_dcache_wbinval_all();
-+ cpu_icache_inval_all();
-+}
-+
-+void flush_cache_dup_mm(struct mm_struct *mm)
-+{
-+}
-+
-+void flush_cache_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end)
-+{
-+ if ((end - start) > 8 * PAGE_SIZE) {
-+ cpu_dcache_wbinval_all();
-+ if (vma->vm_flags & VM_EXEC)
-+ cpu_icache_inval_all();
-+ return;
-+ }
-+
-+ while (start < end) {
-+ if (va_present(vma->vm_mm, start))
-+ cpu_cache_wbinval_page(start, vma->vm_flags & VM_EXEC);
-+ start += PAGE_SIZE;
-+ }
-+}
-+
-+void flush_cache_page(struct vm_area_struct *vma,
-+ unsigned long addr, unsigned long pfn)
-+{
-+ unsigned long vto, flags;
-+
-+ local_irq_save(flags);
-+ vto = kremap0(addr, pfn << PAGE_SHIFT);
-+ cpu_cache_wbinval_page(vto, vma->vm_flags & VM_EXEC);
-+ kunmap01(vto);
-+ local_irq_restore(flags);
-+}
-+
-+void flush_cache_vmap(unsigned long start, unsigned long end)
-+{
-+ cpu_dcache_wbinval_all();
-+}
-+
-+void flush_cache_vunmap(unsigned long start, unsigned long end)
-+{
-+ cpu_dcache_wbinval_all();
-+}
-+
-+void copy_user_highpage(struct page *to, struct page *from,
-+ unsigned long vaddr, struct vm_area_struct *vma)
-+{
-+ unsigned long vto, vfrom, flags, kto, kfrom, pfrom, pto;
-+ kto = ((unsigned long)page_address(to) & PAGE_MASK);
-+ kfrom = ((unsigned long)page_address(from) & PAGE_MASK);
-+ pto = page_to_phys(to);
-+ pfrom = page_to_phys(from);
-+
-+ if (aliasing(vaddr, (unsigned long)kfrom))
-+ cpu_dcache_wb_page((unsigned long)kfrom);
-+ if (aliasing(vaddr, (unsigned long)kto))
-+ cpu_dcache_inval_page((unsigned long)kto);
-+ local_irq_save(flags);
-+ vto = kremap0(vaddr, pto);
-+ vfrom = kremap1(vaddr, pfrom);
-+ copy_page((void *)vto, (void *)vfrom);
-+ kunmap01(vfrom);
-+ kunmap01(vto);
-+ local_irq_restore(flags);
-+}
-+
-+EXPORT_SYMBOL(copy_user_highpage);
-+
-+void clear_user_highpage(struct page *page, unsigned long vaddr)
-+{
-+ unsigned long vto, flags, kto;
-+
-+ kto = ((unsigned long)page_address(page) & PAGE_MASK);
-+
-+ local_irq_save(flags);
-+ if (aliasing(kto, vaddr) && kto != 0) {
-+ cpu_dcache_inval_page(kto);
-+ cpu_icache_inval_page(kto);
-+ }
-+ vto = kremap0(vaddr, page_to_phys(page));
-+ clear_page((void *)vto);
-+ kunmap01(vto);
-+ local_irq_restore(flags);
-+}
-+
-+EXPORT_SYMBOL(clear_user_highpage);
-+
-+void flush_dcache_page(struct page *page)
-+{
-+ struct address_space *mapping;
-+
-+ mapping = page_mapping(page);
-+ if (mapping && !mapping_mapped(mapping))
-+ set_bit(PG_dcache_dirty, &page->flags);
-+ else {
-+ int i, pc;
-+ unsigned long vto, kaddr, flags;
-+ cpu_dcache_wbinval_page((unsigned long)page_address(page));
-+ kaddr = (unsigned long)page_address(page);
-+ pc = CACHE_SET(DCACHE) * CACHE_LINE_SIZE(DCACHE) / PAGE_SIZE;
-+ for (i = 0; i < pc; i++) {
-+ local_irq_save(flags);
-+ vto = kremap0(kaddr + i * PAGE_SIZE, __pa(kaddr));
-+ cpu_dcache_wbinval_page(vto);
-+ kunmap01(vto);
-+ local_irq_restore(flags);
-+ }
-+ }
-+}
-+
-+void copy_to_user_page(struct vm_area_struct *vma, struct page *page,
-+ unsigned long vaddr, void *dst, void *src, int len)
-+{
-+ unsigned long line_size, start, end, vto, flags;
-+
-+ local_irq_save(flags);
-+ vto = kremap0(vaddr, page_to_phys(page));
-+ dst = (void *)(vto | (vaddr & (PAGE_SIZE - 1)));
-+ memcpy(dst, src, len);
-+ if (vma->vm_flags & VM_EXEC) {
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ start = (unsigned long)dst & ~(line_size - 1);
-+ end =
-+ ((unsigned long)dst + len + line_size - 1) & ~(line_size -
-+ 1);
-+ cpu_cache_wbinval_range(start, end, 1);
-+ }
-+ kunmap01(vto);
-+ local_irq_restore(flags);
-+}
-+
-+void copy_from_user_page(struct vm_area_struct *vma, struct page *page,
-+ unsigned long vaddr, void *dst, void *src, int len)
-+{
-+ unsigned long vto, flags;
-+
-+ local_irq_save(flags);
-+ vto = kremap0(vaddr, page_to_phys(page));
-+ src = (void *)(vto | (vaddr & (PAGE_SIZE - 1)));
-+ memcpy(dst, src, len);
-+ kunmap01(vto);
-+ local_irq_restore(flags);
-+}
-+
-+void flush_anon_page(struct vm_area_struct *vma,
-+ struct page *page, unsigned long vaddr)
-+{
-+ if (!PageAnon(page))
-+ return;
-+
-+ if (vma->vm_mm != current->active_mm)
-+ return;
-+
-+ cpu_cache_wbinval_page(vaddr & PAGE_MASK, vma->vm_flags & VM_EXEC);
-+}
-+
-+void flush_kernel_dcache_page(struct page *page)
-+{
-+ cpu_dcache_wbinval_page((unsigned long)page_address(page));
-+}
-+
-+void flush_icache_range(unsigned long start, unsigned long end)
-+{
-+ cpu_cache_wbinval_range(start, end, 1);
-+}
-+
-+void flush_icache_page(struct vm_area_struct *vma, struct page *page)
-+{
-+}
-+
-+void update_mmu_cache(struct vm_area_struct *vma, unsigned long addr,
-+ pte_t * pte)
-+{
-+ struct page *page;
-+ unsigned long pfn = pte_pfn(*pte);
-+
-+ if (!pfn_valid(pfn))
-+ return;
-+
-+ if (vma->vm_mm == current->active_mm) {
-+ asm("mtsr %1, $mr2\ndsb\n"
-+ "tlbop %0, RWR\nisb\n"
-+ ::"r"(*pte), "r"(addr));
-+ }
-+
-+ page = pfn_to_page(pfn);
-+ if (test_and_clear_bit(PG_dcache_dirty, &page->flags) ||
-+ (vma->vm_flags & VM_EXEC))
-+ cpu_dcache_wbinval_page((unsigned long)page_address(page));
-+}
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/cctl.c linux-3.4.113/arch/nds32/mm/cctl.c
---- linux-3.4.113.orig/arch/nds32/mm/cctl.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/cctl.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,284 @@
-+/*
-+ * linux/arch/nds32/mm/cctl.c
-+ *
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include "cctl.h"
-+
-+#define DEBUG( enable, tagged, ...) \
-+ do{ \
-+ if( enable){ \
-+ if( tagged) \
-+ printk( "[ %30s() ] ", __func__); \
-+ printk( __VA_ARGS__); \
-+ } \
-+ } while( 0)
-+
-+static int debug = 1;
-+module_param(debug, int, 0);
-+
-+static int proc_read_cache_en(char *page, char **start, off_t off,
-+ int count, int *eof, void *data)
-+{
-+
-+ if (!strncmp(data, "ic_en", 7))
-+ return sprintf(page, "I-cache: %s\n",
-+ (GET_CACHE_CTL() & CACHE_CTL_mskIC_EN) ?
-+ "Enabled" : "Disabled");
-+ else
-+ return sprintf(page, "D-cache: %s\n",
-+ (GET_CACHE_CTL() & CACHE_CTL_mskDC_EN) ?
-+ "Enabled" : "Disabled");
-+}
-+
-+static int proc_write_cache_en(struct file *file, const char *buffer,
-+ unsigned long count, void *data)
-+{
-+
-+ unsigned long en, saved_gie;
-+ char inbuf[INPUTLEN];
-+
-+ if (count > INPUTLEN - 1)
-+ count = INPUTLEN - 1;
-+
-+ if (copy_from_user(inbuf, buffer, count))
-+ return -EFAULT;
-+
-+ inbuf[count] = '\0';
-+
-+ if (!sscanf(inbuf, "%lu", &en) || en > 1)
-+ return -EFAULT;
-+
-+ GIE_SAVE(&saved_gie);
-+
-+ if (!strncmp(data, "ic_en", 7)) {
-+
-+ if (en && !(GET_CACHE_CTL() & CACHE_CTL_mskIC_EN)) {
-+
-+ SET_CACHE_CTL(GET_CACHE_CTL() | CACHE_CTL_mskIC_EN);
-+ DEBUG(debug, 1, "I-cache: Enabled\n");
-+ } else if (!en && (GET_CACHE_CTL() & CACHE_CTL_mskIC_EN)) {
-+
-+ SET_CACHE_CTL(GET_CACHE_CTL() & ~CACHE_CTL_mskIC_EN);
-+ cpu_icache_inval_all();
-+ DEBUG(debug, 1, "I-cache: Disabled\n");
-+ }
-+ } else {
-+ if (en && !(GET_CACHE_CTL() & CACHE_CTL_mskDC_EN)) {
-+
-+ SET_CACHE_CTL(GET_CACHE_CTL() | CACHE_CTL_mskDC_EN);
-+ DEBUG(debug, 1, "D-cache: Enabled\n");
-+ } else if (!en && (GET_CACHE_CTL() & CACHE_CTL_mskDC_EN)) {
-+
-+ SET_CACHE_CTL(GET_CACHE_CTL() & ~CACHE_CTL_mskDC_EN);
-+ cpu_dcache_wbinval_all();
-+ DEBUG(debug, 1, "D-cache: Disabled\n");
-+ }
-+ }
-+
-+ GIE_RESTORE(saved_gie);
-+
-+ return count;
-+}
-+
-+struct entry_struct proc_table_cache_en[] = {
-+
-+ {"ic_en", 0644, proc_read_cache_en, proc_write_cache_en},
-+ {"dc_en", 0644, proc_read_cache_en, proc_write_cache_en},
-+ {NULL, 0, NULL, NULL}
-+};
-+
-+static int sprint_cache_sdz(char *buf, unsigned long size, unsigned long way,
-+ unsigned sdz)
-+{
-+
-+ return sprintf(buf, "[%c] %luK x %lu\n[%c] %luK x %lu\n"
-+ "[%c] %luK x %lu\n[%c] %luK x %lu\n",
-+ (sdz == 0) ? '*' : ' ', (size / 1024), way,
-+ (sdz == 1) ? '*' : ' ', (size / 1024), way / 2,
-+ (sdz == 2) ? '*' : ' ', (size / 1024) / 2, way,
-+ (sdz == 3) ? '*' : ' ', (size / 1024) / 2, way / 2);
-+}
-+
-+static int proc_read_cache_sdz(char *page, char **start, off_t off,
-+ int count, int *eof, void *data)
-+{
-+
-+ if (!strncmp(data, "ic_sdz", 7)) {
-+
-+ return sprint_cache_sdz(page,
-+ CACHE_LINE_SIZE(ICACHE) *
-+ CACHE_SET(ICACHE), CACHE_WAY(ICACHE),
-+ (GET_SDZ_CTL() & SDZ_CTL_mskICDZ) >>
-+ SDZ_CTL_offICDZ);
-+ } else {
-+ return sprint_cache_sdz(page,
-+ CACHE_LINE_SIZE(DCACHE) *
-+ CACHE_SET(DCACHE), CACHE_WAY(DCACHE),
-+ (GET_SDZ_CTL() & SDZ_CTL_mskDCDZ) >>
-+ SDZ_CTL_offDCDZ);
-+ }
-+}
-+
-+static int proc_write_cache_sdz(struct file *file, const char *buffer,
-+ unsigned long count, void *data)
-+{
-+
-+ unsigned long mode, saved_gie, saved_cctl;
-+ char inbuf[INPUTLEN];
-+
-+ if (count > INPUTLEN - 1)
-+ count = INPUTLEN - 1;
-+
-+ if (copy_from_user(inbuf, buffer, count))
-+ return -EFAULT;
-+
-+ inbuf[count] = '\0';
-+
-+ if (!sscanf(inbuf, "%lu", &mode) || mode > 3)
-+ return -EFAULT;
-+
-+ GIE_SAVE(&saved_gie);
-+
-+ saved_cctl = GET_CACHE_CTL();
-+ DEBUG(debug, 1, "saved_gie: %ld, saved_cctl: 0x%08lx\n", saved_gie,
-+ saved_cctl);
-+
-+ if (!strncmp(data, "ic_sdz", 7)) {
-+
-+ DEBUG(debug, 1, "IC_SDZ: mode %ld\n", mode);
-+
-+ if (mode == 2 || mode == 3) {
-+
-+ if (CACHE_LINE_SIZE(ICACHE) * CACHE_SET(ICACHE) / 2 <
-+ 4096) {
-+
-+ GIE_RESTORE(saved_gie);
-+ DEBUG(debug, 1, "Error: way size < 4096\n");
-+ return -1;
-+ }
-+ }
-+
-+ /* turn off and flush cache */
-+ DEBUG(debug, 1, "turning off cache\n");
-+ SET_CACHE_CTL(saved_cctl & ~CACHE_CTL_mskIC_EN);
-+ DEBUG(debug, 1, "flushing cache\n");
-+ cpu_icache_inval_all();
-+
-+ /* perform down size operation */
-+ DEBUG(debug, 1, "downsizing cache\n");
-+ SET_SDZ_CTL((GET_SDZ_CTL() & ~SDZ_CTL_mskICDZ) |
-+ (mode << SDZ_CTL_offICDZ));
-+ } else {
-+
-+ DEBUG(debug, 1, "DC_SDZ: mode %ld\n", mode);
-+
-+ if (mode == 2 || mode == 3) {
-+
-+ if (CACHE_LINE_SIZE(DCACHE) * CACHE_SET(DCACHE) / 2 <
-+ 4096) {
-+
-+ GIE_RESTORE(saved_gie);
-+ DEBUG(debug, 1, "Error: way size < 4096\n");
-+ return -1;
-+ }
-+ }
-+
-+ /* turn off and flush cache */
-+ DEBUG(debug, 1, "turning off cache\n");
-+ SET_CACHE_CTL(saved_cctl & ~CACHE_CTL_mskDC_EN);
-+ DEBUG(debug, 1, "flushing cache\n");
-+ cpu_dcache_wbinval_all();
-+
-+ /* perform down size operation */
-+ DEBUG(debug, 1, "downsizing cache\n");
-+ SET_SDZ_CTL((GET_SDZ_CTL() & ~SDZ_CTL_mskDCDZ) |
-+ (mode << SDZ_CTL_offDCDZ));
-+ }
-+
-+ /* turn on cache ( if it was enabled) */
-+ DEBUG(debug, 1, "restoring saved_cctl : 0x%08lx\n", saved_cctl);
-+ SET_CACHE_CTL(saved_cctl);
-+
-+ DEBUG(debug, 1, "restoring saved_git: %ld\n", saved_gie);
-+ GIE_RESTORE(saved_gie);
-+
-+ return count;
-+}
-+
-+struct entry_struct proc_table_cache_sdz[] = {
-+
-+ {"ic_sdz", 0644, proc_read_cache_sdz, proc_write_cache_sdz},
-+ {"dc_sdz", 0644, proc_read_cache_sdz, proc_write_cache_sdz},
-+ {NULL, 0, NULL, NULL}
-+};
-+
-+static struct proc_dir_entry *proc_cctl;
-+
-+static void create_seq_entry(struct entry_struct *e, mode_t mode,
-+ struct proc_dir_entry *parent)
-+{
-+
-+ struct proc_dir_entry *entry = create_proc_entry(e->name, mode, parent);
-+
-+ if (entry) {
-+
-+ entry->read_proc = e->readop;
-+ entry->write_proc = e->writeop;
-+ entry->data = e->name;
-+ }
-+}
-+
-+static void install_proc_table(struct entry_struct *table)
-+{
-+
-+ while (table->name) {
-+
-+ create_seq_entry(table, table->perm, proc_cctl);
-+ table++;
-+ }
-+}
-+
-+static void remove_proc_table(struct entry_struct *table)
-+{
-+
-+ while (table->name) {
-+
-+ remove_proc_entry(table->name, proc_cctl);
-+ table++;
-+ }
-+}
-+
-+static int __init init_cctl(void)
-+{
-+
-+ DEBUG(debug, 1, "CCTL module registered\n");
-+
-+ proc_cctl = proc_mkdir("cctl", NULL);
-+
-+ install_proc_table(proc_table_cache_en);
-+ install_proc_table(proc_table_cache_sdz);
-+
-+ return 0;
-+}
-+
-+static void __exit cleanup_cctl(void)
-+{
-+
-+ remove_proc_table(proc_table_cache_sdz);
-+ remove_proc_table(proc_table_cache_en);
-+ remove_proc_entry("cctl", NULL);
-+
-+ DEBUG(debug, 1, "CCTL module unregistered\n");
-+}
-+
-+module_init(init_cctl);
-+module_exit(cleanup_cctl);
-+
-+MODULE_LICENSE("GPL");
-+MODULE_DESCRIPTION("Userspace Cache Control Module");
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/cctl.h linux-3.4.113/arch/nds32/mm/cctl.h
---- linux-3.4.113.orig/arch/nds32/mm/cctl.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/cctl.h 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,22 @@
-+#ifndef CCTL_H
-+#define CCTL_H
-+
-+#include <linux/module.h>
-+#include <linux/blkdev.h>
-+#include <linux/proc_fs.h>
-+#include <asm/nds32.h>
-+
-+#define INPUTLEN 32
-+
-+extern void cpu_icache_flush(void);
-+extern void cpu_dcache_flush(void);
-+
-+struct entry_struct{
-+
-+ char *name;
-+ int perm;
-+ read_proc_t *readop;
-+ write_proc_t *writeop;
-+};
-+
-+#endif /* CCTL_H */
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/consistent.c linux-3.4.113/arch/nds32/mm/consistent.c
---- linux-3.4.113.orig/arch/nds32/mm/consistent.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/consistent.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,448 @@
-+/*
-+ * linux/arch/nds32/mm/consistent.c
-+ *
-+ * Copyright (C) 2000-2004 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * DMA uncached mapping support.
-+ */
-+#include <linux/dma-mapping.h>
-+#include <linux/sched.h>
-+#include <linux/slab.h>
-+#include <asm/cacheflush.h>
-+#include <asm/tlbflush.h>
-+#include <asm/pgtable.h>
-+#include <linux/module.h>
-+
-+/*
-+ * This is the page table (2MB) covering uncached, DMA consistent allocations
-+ */
-+static pte_t *consistent_pte;
-+static DEFINE_RAW_SPINLOCK(consistent_lock);
-+
-+/*
-+ * VM region handling support.
-+ *
-+ * This should become something generic, handling VM region allocations for
-+ * vmalloc and similar (ioremap, module space, etc).
-+ *
-+ * I envisage vmalloc()'s supporting vm_struct becoming:
-+ *
-+ * struct vm_struct {
-+ * struct vm_region region;
-+ * unsigned long flags;
-+ * struct page **pages;
-+ * unsigned int nr_pages;
-+ * unsigned long phys_addr;
-+ * };
-+ *
-+ * get_vm_area() would then call vm_region_alloc with an appropriate
-+ * struct vm_region head (eg):
-+ *
-+ * struct vm_region vmalloc_head = {
-+ * .vm_list = LIST_HEAD_INIT(vmalloc_head.vm_list),
-+ * .vm_start = VMALLOC_START,
-+ * .vm_end = VMALLOC_END,
-+ * };
-+ *
-+ * However, vmalloc_head.vm_start is variable (typically, it is dependent on
-+ * the amount of RAM found at boot time.) I would imagine that get_vm_area()
-+ * would have to initialise this each time prior to calling vm_region_alloc().
-+ */
-+struct arch_vm_region {
-+ struct list_head vm_list;
-+ unsigned long vm_start;
-+ unsigned long vm_end;
-+ struct page *vm_pages;
-+};
-+
-+static struct arch_vm_region consistent_head = {
-+ .vm_list = LIST_HEAD_INIT(consistent_head.vm_list),
-+ .vm_start = CONSISTENT_BASE,
-+ .vm_end = CONSISTENT_END,
-+};
-+
-+static struct arch_vm_region *vm_region_alloc(struct arch_vm_region *head,
-+ size_t size, int gfp)
-+{
-+ unsigned long addr = head->vm_start, end = head->vm_end - size;
-+ unsigned long flags;
-+ struct arch_vm_region *c, *new;
-+
-+ new = kmalloc(sizeof(struct arch_vm_region), gfp);
-+ if (!new)
-+ goto out;
-+
-+ raw_spin_lock_irqsave(&consistent_lock, flags);
-+
-+ list_for_each_entry(c, &head->vm_list, vm_list) {
-+ if ((addr + size) < addr)
-+ goto nospc;
-+ if ((addr + size) <= c->vm_start)
-+ goto found;
-+ addr = c->vm_end;
-+ if (addr > end)
-+ goto nospc;
-+ }
-+
-+found:
-+ /*
-+ * Insert this entry _before_ the one we found.
-+ */
-+ list_add_tail(&new->vm_list, &c->vm_list);
-+ new->vm_start = addr;
-+ new->vm_end = addr + size;
-+
-+ raw_spin_unlock_irqrestore(&consistent_lock, flags);
-+ return new;
-+
-+nospc:
-+ raw_spin_unlock_irqrestore(&consistent_lock, flags);
-+ kfree(new);
-+out:
-+ return NULL;
-+}
-+
-+static struct arch_vm_region *vm_region_find(struct arch_vm_region *head,
-+ unsigned long addr)
-+{
-+ struct arch_vm_region *c;
-+
-+ list_for_each_entry(c, &head->vm_list, vm_list) {
-+ if (c->vm_start == addr)
-+ goto out;
-+ }
-+ c = NULL;
-+out:
-+ return c;
-+}
-+
-+#ifdef CONFIG_HUGETLB_PAGE
-+#error ARM Coherent DMA allocator does not (yet) support huge TLB
-+#endif
-+
-+static void *__dma_alloc(struct device *dev, size_t size, dma_addr_t * handle,
-+ int gfp, pgprot_t prot)
-+{
-+ struct page *page;
-+ struct arch_vm_region *c;
-+ unsigned long order;
-+ unsigned int i;
-+ u64 mask = ISA_DMA_THRESHOLD, limit;
-+
-+ if (!consistent_pte) {
-+ printk(KERN_ERR "%s: not initialised\n", __func__);
-+ dump_stack();
-+ return NULL;
-+ }
-+
-+ if (dev) {
-+ mask = dev->coherent_dma_mask;
-+
-+ /*
-+ * Sanity check the DMA mask - it must be non-zero, and
-+ * must be able to be satisfied by a DMA allocation.
-+ */
-+ if (mask == 0) {
-+ dev_warn(dev, "coherent DMA mask is unset\n");
-+ goto no_page;
-+ }
-+
-+ if ((~mask) & ISA_DMA_THRESHOLD) {
-+ dev_warn(dev, "coherent DMA mask %#llx is smaller "
-+ "than system GFP_DMA mask %#llx\n",
-+ mask, (unsigned long long)ISA_DMA_THRESHOLD);
-+ goto no_page;
-+ }
-+ }
-+
-+ /*
-+ * Sanity check the allocation size.
-+ */
-+ size = PAGE_ALIGN(size);
-+ limit = (mask + 1) & ~mask;
-+ if ((limit && size >= limit) ||
-+ size >= (CONSISTENT_END - CONSISTENT_BASE)) {
-+ printk(KERN_WARNING "coherent allocation too big "
-+ "(requested %#x mask %#llx)\n", size, mask);
-+ goto no_page;
-+ }
-+
-+ order = get_order(size);
-+
-+ if (mask != 0xffffffff)
-+ gfp |= GFP_DMA;
-+
-+ page = alloc_pages(gfp, order);
-+ if (!page)
-+ goto no_page;
-+
-+ for (i = 1; i < (1 << order); i++)
-+ atomic_set(&(page + i)->_count, 1);
-+
-+ /*
-+ * Invalidate any data that might be lurking in the
-+ * kernel direct-mapped region for device DMA.
-+ */
-+ {
-+ unsigned long kaddr = (unsigned long)page_address(page);
-+ memset(page_address(page), 0, size);
-+ cpu_dma_wbinval_range(kaddr, kaddr + size);
-+ }
-+
-+ /*
-+ * Allocate a virtual address in the consistent mapping region.
-+ */
-+ c = vm_region_alloc(&consistent_head, size,
-+ gfp & ~(__GFP_DMA | __GFP_HIGHMEM));
-+ if (c) {
-+ pte_t *pte = consistent_pte + CONSISTENT_OFFSET(c->vm_start);
-+ struct page *end = page + (1 << order);
-+
-+ c->vm_pages = page;
-+
-+ /*
-+ * Set the "dma handle"
-+ */
-+ *handle = page_to_dma(dev, page);
-+
-+ do {
-+ BUG_ON(!pte_none(*pte));
-+
-+ /*
-+ * x86 does not mark the pages reserved...
-+ */
-+ SetPageReserved(page);
-+ set_pte(pte, mk_pte(page, prot));
-+ page++;
-+ pte++;
-+ } while (size -= PAGE_SIZE);
-+
-+ /*
-+ * Free the otherwise unused pages.
-+ */
-+ while (page < end) {
-+ __free_page(page);
-+ page++;
-+ }
-+
-+ return (void *)c->vm_start;
-+ }
-+
-+ if (page)
-+ __free_pages(page, order);
-+no_page:
-+ *handle = ~0;
-+ return NULL;
-+}
-+
-+/*
-+ * Allocate DMA-coherent memory space and return both the kernel remapped
-+ * virtual and bus address for that space.
-+ */
-+void *dma_alloc_coherent(struct device *dev, size_t size, dma_addr_t * handle,
-+ gfp_t gfp)
-+{
-+ return __dma_alloc(dev, size, handle, gfp,
-+ pgprot_noncached(PAGE_KERNEL));
-+}
-+
-+EXPORT_SYMBOL(dma_alloc_coherent);
-+
-+/*
-+ * Allocate a writecombining region, in much the same way as
-+ * dma_alloc_coherent above.
-+ */
-+void *dma_alloc_writecombine(struct device *dev, size_t size,
-+ dma_addr_t * handle, gfp_t gfp)
-+{
-+ return __dma_alloc(dev, size, handle, gfp,
-+ pgprot_writecombine(PAGE_KERNEL));
-+}
-+
-+EXPORT_SYMBOL(dma_alloc_writecombine);
-+
-+static int dma_mmap(struct device *dev, struct vm_area_struct *vma,
-+ void *cpu_addr, dma_addr_t dma_addr, size_t size)
-+{
-+ unsigned long flags, user_size, kern_size;
-+ struct arch_vm_region *c;
-+ int ret = -ENXIO;
-+
-+ user_size = (vma->vm_end - vma->vm_start) >> PAGE_SHIFT;
-+
-+ raw_spin_lock_irqsave(&consistent_lock, flags);
-+ c = vm_region_find(&consistent_head, (unsigned long)cpu_addr);
-+ raw_spin_unlock_irqrestore(&consistent_lock, flags);
-+
-+ if (c) {
-+ unsigned long off = vma->vm_pgoff;
-+
-+ kern_size = (c->vm_end - c->vm_start) >> PAGE_SHIFT;
-+
-+ if (off < kern_size && user_size <= (kern_size - off)) {
-+ vma->vm_flags |= VM_RESERVED;
-+ ret = remap_pfn_range(vma, vma->vm_start,
-+ page_to_pfn(c->vm_pages) + off,
-+ user_size << PAGE_SHIFT,
-+ vma->vm_page_prot);
-+ }
-+ }
-+
-+ return ret;
-+}
-+
-+int dma_mmap_coherent(struct device *dev, struct vm_area_struct *vma,
-+ void *cpu_addr, dma_addr_t dma_addr, size_t size)
-+{
-+ vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
-+ return dma_mmap(dev, vma, cpu_addr, dma_addr, size);
-+}
-+
-+EXPORT_SYMBOL(dma_mmap_coherent);
-+
-+int dma_mmap_writecombine(struct device *dev, struct vm_area_struct *vma,
-+ void *cpu_addr, dma_addr_t dma_addr, size_t size)
-+{
-+ vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
-+ return dma_mmap(dev, vma, cpu_addr, dma_addr, size);
-+}
-+
-+EXPORT_SYMBOL(dma_mmap_writecombine);
-+
-+/*
-+ * free a page as defined by the above mapping.
-+ */
-+void dma_free_coherent(struct device *dev, size_t size, void *cpu_addr,
-+ dma_addr_t handle)
-+{
-+ struct arch_vm_region *c;
-+ unsigned long flags, addr;
-+ pte_t *ptep;
-+
-+ size = PAGE_ALIGN(size);
-+
-+ raw_spin_lock_irqsave(&consistent_lock, flags);
-+
-+ c = vm_region_find(&consistent_head, (unsigned long)cpu_addr);
-+ if (!c)
-+ goto no_area;
-+
-+ if ((c->vm_end - c->vm_start) != size) {
-+ printk(KERN_ERR "%s: freeing wrong coherent size (%ld != %d)\n",
-+ __func__, c->vm_end - c->vm_start, size);
-+ dump_stack();
-+ size = c->vm_end - c->vm_start;
-+ }
-+
-+ ptep = consistent_pte + CONSISTENT_OFFSET(c->vm_start);
-+ addr = c->vm_start;
-+ do {
-+ pte_t pte = ptep_get_and_clear(&init_mm, addr, ptep);
-+ unsigned long pfn;
-+
-+ ptep++;
-+ addr += PAGE_SIZE;
-+
-+ if (!pte_none(pte) && pte_present(pte)) {
-+ pfn = pte_pfn(pte);
-+
-+ if (pfn_valid(pfn)) {
-+ struct page *page = pfn_to_page(pfn);
-+
-+ /*
-+ * x86 does not mark the pages reserved...
-+ */
-+ ClearPageReserved(page);
-+
-+ __free_page(page);
-+ continue;
-+ }
-+ }
-+
-+ printk(KERN_CRIT "%s: bad page in kernel page table\n",
-+ __func__);
-+ } while (size -= PAGE_SIZE);
-+
-+ flush_tlb_kernel_range(c->vm_start, c->vm_end);
-+
-+ list_del(&c->vm_list);
-+
-+ raw_spin_unlock_irqrestore(&consistent_lock, flags);
-+
-+ kfree(c);
-+ return;
-+
-+no_area:
-+ raw_spin_unlock_irqrestore(&consistent_lock, flags);
-+ printk(KERN_ERR "%s: trying to free invalid coherent area: %p\n",
-+ __func__, cpu_addr);
-+ dump_stack();
-+}
-+
-+EXPORT_SYMBOL(dma_free_coherent);
-+
-+/*
-+ * Initialise the consistent memory allocation.
-+ */
-+static int __init consistent_init(void)
-+{
-+ pgd_t *pgd;
-+ pmd_t *pmd;
-+ pte_t *pte;
-+ int ret = 0;
-+
-+ do {
-+ pgd = pgd_offset(&init_mm, CONSISTENT_BASE);
-+ pmd = pmd_alloc(&init_mm, pgd, CONSISTENT_BASE);
-+ if (!pmd) {
-+ printk(KERN_ERR "%s: no pmd tables\n", __func__);
-+ ret = -ENOMEM;
-+ break;
-+ }
-+ /* The first level mapping may be created in somewhere.
-+ * It's not necessary to warn here. */
-+ /* WARN_ON(!pmd_none(*pmd)); */
-+
-+ pte = pte_alloc_kernel(pmd, CONSISTENT_BASE);
-+ if (!pte) {
-+ ret = -ENOMEM;
-+ break;
-+ }
-+
-+ consistent_pte = pte;
-+ } while (0);
-+
-+ return ret;
-+}
-+
-+core_initcall(consistent_init);
-+
-+/*
-+ * Make an area consistent for devices.
-+ */
-+void consistent_sync(void *vaddr, size_t size, int direction)
-+{
-+ unsigned long start = (unsigned long)vaddr;
-+ unsigned long end = start + size;
-+
-+ switch (direction) {
-+ case DMA_FROM_DEVICE: /* invalidate only */
-+ cpu_dma_inval_range(start, end);
-+ break;
-+ case DMA_TO_DEVICE: /* writeback only */
-+ cpu_dma_wb_range(start, end);
-+ break;
-+ case DMA_BIDIRECTIONAL: /* writeback and invalidate */
-+ cpu_dma_wbinval_range(start, end);
-+ break;
-+ default:
-+ BUG();
-+ }
-+}
-+
-+EXPORT_SYMBOL(consistent_sync);
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/extable.c linux-3.4.113/arch/nds32/mm/extable.c
---- linux-3.4.113.orig/arch/nds32/mm/extable.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/extable.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,18 @@
-+/*
-+ * linux/arch/nds32/mm/extable.c
-+ *
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ */
-+#include <linux/module.h>
-+#include <asm/uaccess.h>
-+
-+int fixup_exception(struct pt_regs *regs)
-+{
-+ const struct exception_table_entry *fixup;
-+
-+ fixup = search_exception_tables(instruction_pointer(regs));
-+ if (fixup)
-+ regs->NDS32_ipc = fixup->fixup;
-+
-+ return fixup != NULL;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/fault.c linux-3.4.113/arch/nds32/mm/fault.c
---- linux-3.4.113.orig/arch/nds32/mm/fault.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/fault.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,507 @@
-+/*
-+ * linux/arch/arm/mm/fault.c
-+ *
-+ * Copyright (C) 1995 Linus Torvalds
-+ * Modifications for ARM processor (c) 1995-2004 Russell King
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+/* ============================================================================
-+ *
-+ * linux/arch/nds32/mm/fault.c
-+ *
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ * This file is part of Linux and should be licensed under the GPL.
-+ * See the file COPYING for conditions for redistribution.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for NDS32 architecture, referred from ARM's
-+ * implementation.
-+ *
-+ * Revision History:
-+ *
-+ * Nov.26.2007 Initial ported by Tom, Shawn, and Steven,
-+ * patched for KGDB and refined code by Harry.
-+ *
-+ * Note:
-+ *
-+ * ============================================================================
-+ */
-+#include <linux/module.h>
-+#include <linux/signal.h>
-+#include <linux/ptrace.h>
-+#include <linux/mm.h>
-+#include <linux/init.h>
-+#include <linux/hardirq.h>
-+
-+#include <asm/system.h>
-+#include <asm/pgtable.h>
-+#include <asm/tlbflush.h>
-+#include <asm/uaccess.h>
-+
-+#include "fault.h"
-+
-+/*
-+ * This is useful to dump out the page tables associated with
-+ * 'addr' in mm 'mm'.
-+ */
-+void show_pte(struct mm_struct *mm, unsigned long addr)
-+{
-+ pgd_t *pgd;
-+ if (!mm)
-+ mm = &init_mm;
-+
-+ printk(KERN_ALERT "pgd = %p\n", mm->pgd);
-+ pgd = pgd_offset(mm, addr);
-+ printk(KERN_ALERT "[%08lx] *pgd=%08lx", addr, pgd_val(*pgd));
-+
-+ do {
-+ pmd_t *pmd;
-+
-+ if (pgd_none(*pgd))
-+ break;
-+
-+ if (pgd_bad(*pgd)) {
-+ printk("(bad)");
-+ break;
-+ }
-+
-+ pmd = pmd_offset(pgd, addr);
-+#if PTRS_PER_PMD != 1
-+ printk(", *pmd=%08lx", pmd_val(*pmd));
-+#endif
-+
-+ if (pmd_none(*pmd))
-+ break;
-+
-+ if (pmd_bad(*pmd)) {
-+ printk("(bad)");
-+ break;
-+ }
-+#ifndef CONFIG_HIGHMEM
-+ {
-+ pte_t *pte;
-+ /* We must not map this if we have highmem enabled */
-+ pte = pte_offset_map(pmd, addr);
-+ printk(", *pte=%08lx", pte_val(*pte));
-+ pte_unmap(pte);
-+ }
-+#endif
-+ } while (0);
-+
-+ printk("\n");
-+}
-+
-+/*
-+ * Oops. The kernel tried to access some page that wasn't present.
-+ */
-+static void
-+__do_kernel_fault(struct mm_struct *mm, unsigned long addr, unsigned int fsr,
-+ struct pt_regs *regs)
-+{
-+ /*
-+ * Are we prepared to handle this kernel fault?
-+ */
-+ if (fixup_exception(regs))
-+ return;
-+
-+ /*
-+ * No handler, we'll have to terminate things with extreme prejudice.
-+ */
-+ bust_spinlocks(1);
-+ printk(KERN_ALERT
-+ "__do_kernel_fault: Unable to handle kernel %s at virtual address %08lx\n",
-+ (addr < PAGE_SIZE) ? "NULL pointer dereference" :
-+ "paging request", addr);
-+
-+ show_pte(mm, addr);
-+ die("Oops", regs, fsr);
-+ bust_spinlocks(0);
-+ do_exit(SIGKILL);
-+}
-+
-+/*
-+ * Something tried to access memory that isn't in our memory map..
-+ * User mode accesses just cause a SIGSEGV
-+ */
-+static void
-+__do_user_fault(struct task_struct *tsk, unsigned long addr,
-+ unsigned int fsr, int code, struct pt_regs *regs)
-+{
-+ struct siginfo si;
-+
-+#ifdef CONFIG_DEBUG_USER
-+ if (user_debug & UDBG_SEGV) {
-+ printk(KERN_DEBUG
-+ "%s: unhandled page fault at 0x%08lx, code 0x%03x\n",
-+ tsk->comm, addr, fsr);
-+ show_pte(tsk->mm, addr);
-+ show_regs(regs);
-+ }
-+#endif
-+
-+ tsk->thread.address = addr;
-+ tsk->thread.error_code = fsr;
-+ tsk->thread.trap_no = 14;
-+ si.si_signo = SIGSEGV;
-+ si.si_errno = 0;
-+ si.si_code = code;
-+ si.si_addr = (void __user *)addr;
-+ force_sig_info(SIGSEGV, &si, tsk);
-+}
-+
-+void do_bad_area(unsigned long addr, unsigned int fsr, struct pt_regs *regs)
-+{
-+ struct task_struct *tsk = current;
-+ struct mm_struct *mm = tsk->active_mm;
-+
-+ /*
-+ * If we are in kernel mode at this point, we
-+ * have no context to handle this fault with.
-+ */
-+ if (user_mode(regs)) {
-+ __do_user_fault(tsk, addr, fsr, SEGV_MAPERR, regs);
-+ } else {
-+ __do_kernel_fault(mm, addr, fsr, regs);
-+ }
-+}
-+
-+#define VM_FAULT_BADMAP 0x010000
-+#define VM_FAULT_BADACCESS 0x020000
-+
-+void do_page_fault(unsigned long entry, unsigned long addr,
-+ unsigned int error_code, struct pt_regs *regs)
-+{
-+ struct task_struct *tsk;
-+ struct mm_struct *mm;
-+ struct vm_area_struct *vma;
-+ siginfo_t info;
-+ int fault;
-+ unsigned int mask = VM_READ | VM_WRITE | VM_EXEC;
-+ unsigned int flags = FAULT_FLAG_ALLOW_RETRY | FAULT_FLAG_KILLABLE;
-+
-+ error_code = error_code & (ITYPE_mskINST | ITYPE_mskETYPE);
-+ tsk = current;
-+ mm = tsk->mm;
-+ info.si_code = SEGV_MAPERR;
-+ /*
-+ * We fault-in kernel-space virtual memory on-demand. The
-+ * 'reference' page table is init_mm.pgd.
-+ *
-+ * NOTE! We MUST NOT take any locks for this case. We may
-+ * be in an interrupt or a critical region, and should
-+ * only copy the information from the master page table,
-+ * nothing more.
-+ */
-+ if (addr >= TASK_SIZE) {
-+ if (user_mode(regs))
-+ goto bad_area_nosemaphore;
-+
-+ if (addr >= TASK_SIZE && addr < VMALLOC_END && (entry == 2))
-+ goto vmalloc_fault;
-+ else
-+ goto no_context;
-+ }
-+
-+ /*
-+ * If we're in an interrupt or have no user
-+ * context, we must not take the fault..
-+ */
-+ if (unlikely(in_atomic() || !mm))
-+ goto no_context;
-+
-+ /*
-+ * As per x86, we may deadlock here. However, since the kernel only
-+ * validly references user space from well defined areas of the code,
-+ * we can bug out early if this is from code which shouldn't.
-+ */
-+ if (unlikely(!down_read_trylock(&mm->mmap_sem))) {
-+ if (!user_mode(regs) &&
-+ !search_exception_tables(instruction_pointer(regs)))
-+ goto no_context;
-+retry:
-+ down_read(&mm->mmap_sem);
-+ } else {
-+ /*
-+ * The above down_read_trylock() might have succeeded in which
-+ * case, we'll have missed the might_sleep() from down_read().
-+ */
-+ might_sleep();
-+#ifdef CONFIG_DEBUG_VM
-+ if (!user_mode(regs) &&
-+ !search_exception_tables(instruction_pointer(regs)))
-+ goto no_context;
-+#endif
-+ }
-+
-+ vma = find_vma(mm, addr);
-+
-+ if (unlikely(!vma))
-+ goto bad_area;
-+
-+ if (vma->vm_start <= addr)
-+ goto good_area;
-+
-+ if (unlikely(!(vma->vm_flags & VM_GROWSDOWN)))
-+ goto bad_area;
-+
-+ if (unlikely(expand_stack(vma, addr)))
-+ goto bad_area;
-+
-+ /*
-+ * Ok, we have a good vm_area for this memory access, so
-+ * we can handle it..
-+ */
-+
-+good_area:
-+ info.si_code = SEGV_ACCERR;
-+
-+ /* first do some preliminary protection checks */
-+ if (entry == 2) {
-+ if (error_code & ITYPE_mskINST)
-+ mask = VM_EXEC;
-+ else {
-+ mask = VM_READ | VM_WRITE;
-+ if (vma->vm_flags & VM_WRITE)
-+ flags |= FAULT_FLAG_WRITE;
-+ }
-+ } else if (entry == 3) {
-+ switch (error_code & ITYPE_mskETYPE) {
-+ case RD_PROT:
-+ mask = VM_READ;
-+ break;
-+ case WRT_PROT:
-+ mask = VM_WRITE;
-+ flags |= FAULT_FLAG_WRITE;
-+ break;
-+ case NOEXEC:
-+ mask = VM_EXEC;
-+ break;
-+ case PAGE_MODIFY:
-+ mask = VM_WRITE;
-+ flags |= FAULT_FLAG_WRITE;
-+ break;
-+ case ACC_BIT:
-+ BUG();
-+ default:
-+ break;
-+ }
-+
-+ }
-+ if (!(vma->vm_flags & mask))
-+ goto bad_area;
-+
-+ /*
-+ * If for any reason at all we couldn't handle the fault,
-+ * make sure we exit gracefully rather than endlessly redo
-+ * the fault.
-+ */
-+
-+ fault = handle_mm_fault(mm, vma, addr, flags);
-+
-+ /*
-+ * If we need to retry but a fatal signal is pending, handle the
-+ * signal first. We do not need to release the mmap_sem because it
-+ * would already be released in __lock_page_or_retry in mm/filemap.c.
-+ */
-+ if ((fault & VM_FAULT_RETRY) && fatal_signal_pending(current))
-+ return;
-+
-+ if (unlikely(fault & VM_FAULT_ERROR)) {
-+ if (fault & VM_FAULT_OOM)
-+ goto out_of_memory;
-+ else if (fault & VM_FAULT_SIGBUS)
-+ goto do_sigbus;
-+ BUG();
-+ }
-+
-+ /*
-+ * Major/minor page fault accounting is only done on the initial
-+ * attempt. If we go through a retry, it is extremely likely that the
-+ * page will be found in page cache at that point.
-+ */
-+ if (flags & FAULT_FLAG_ALLOW_RETRY) {
-+ if (fault & VM_FAULT_MAJOR)
-+ tsk->maj_flt++;
-+ else
-+ tsk->min_flt++;
-+ if (fault & VM_FAULT_RETRY) {
-+ flags &= ~FAULT_FLAG_ALLOW_RETRY;
-+ flags |= FAULT_FLAG_TRIED;
-+
-+ /* No need to up_read(&mm->mmap_sem) as we would
-+ * have already released it in __lock_page_or_retry
-+ * in mm/filemap.c.
-+ */
-+ goto retry;
-+ }
-+ }
-+
-+ up_read(&mm->mmap_sem);
-+ return;
-+
-+ /*
-+ * Something tried to access memory that isn't in our memory map..
-+ * Fix it, but check if it's kernel or user first..
-+ */
-+bad_area:
-+ up_read(&mm->mmap_sem);
-+
-+bad_area_nosemaphore:
-+
-+ /* User mode accesses just cause a SIGSEGV */
-+
-+ if (user_mode(regs)) {
-+ tsk->thread.address = addr;
-+ tsk->thread.error_code = error_code;
-+ tsk->thread.trap_no = 14;
-+ info.si_signo = SIGSEGV;
-+ info.si_errno = 0;
-+ /* info.si_code has been set above */
-+ info.si_addr = (void *)addr;
-+ force_sig_info(SIGSEGV, &info, tsk);
-+ return;
-+ }
-+
-+no_context:
-+
-+ /* Are we prepared to handle this kernel fault?
-+ *
-+ * (The kernel has valid exception-points in the source
-+ * when it acesses user-memory. When it fails in one
-+ * of those points, we find it in a table and do a jump
-+ * to some fixup code that loads an appropriate error
-+ * code)
-+ */
-+
-+ {
-+ const struct exception_table_entry *entry;
-+
-+ if ((entry =
-+ search_exception_tables(instruction_pointer(regs))) !=
-+ NULL) {
-+ /* Adjust the instruction pointer in the stackframe */
-+ instruction_pointer(regs) = entry->fixup;
-+ return;
-+ }
-+ }
-+
-+ /*
-+ * Oops. The kernel tried to access some bad page. We'll have to
-+ * terminate things with extreme prejudice.
-+ */
-+
-+ bust_spinlocks(1);
-+ printk(KERN_ALERT
-+ "Unable to handle kernel %s at virtual address %08lx\n",
-+ (addr < PAGE_SIZE) ? "NULL pointer dereference" :
-+ "paging request", addr);
-+
-+ show_pte(mm, addr);
-+ die("Oops", regs, error_code);
-+ bust_spinlocks(0);
-+ do_exit(SIGKILL);
-+
-+ /* TODO: verify this necessity */
-+ return;
-+
-+ /*
-+ * We ran out of memory, or some other thing happened to us that made
-+ * us unable to handle the page fault gracefully.
-+ */
-+
-+out_of_memory:
-+ up_read(&mm->mmap_sem);
-+ if (!user_mode(regs))
-+ goto no_context;
-+ pagefault_out_of_memory();
-+ return;
-+
-+do_sigbus:
-+ up_read(&mm->mmap_sem);
-+
-+ /* Kernel mode? Handle exceptions or die */
-+ if (!user_mode(regs))
-+ goto no_context;
-+
-+ /*
-+ * Send a sigbus
-+ */
-+ tsk->thread.address = addr;
-+ tsk->thread.error_code = error_code;
-+ tsk->thread.trap_no = 14;
-+ info.si_signo = SIGBUS;
-+ info.si_errno = 0;
-+ info.si_code = BUS_ADRERR;
-+ info.si_addr = (void *)addr;
-+ force_sig_info(SIGBUS, &info, tsk);
-+
-+ return;
-+
-+vmalloc_fault:
-+ {
-+ /*
-+ * Synchronize this task's top level page-table
-+ * with the 'reference' page table.
-+ *
-+ * Use current_pgd instead of tsk->active_mm->pgd
-+ * since the latter might be unavailable if this
-+ * code is executed in a misfortunately run irq
-+ * (like inside schedule() between switch_mm and
-+ * switch_to...).
-+ */
-+
-+ unsigned int index = pgd_index(addr);
-+ pgd_t *pgd, *pgd_k;
-+ pud_t *pud, *pud_k;
-+ pmd_t *pmd, *pmd_k;
-+ pte_t *pte_k;
-+
-+ pgd = (pgd_t *) __va(GET_L1_PPTB()) + index;
-+ pgd_k = init_mm.pgd + index;
-+
-+ if (!pgd_present(*pgd_k))
-+ goto no_context;
-+
-+ pud = pud_offset(pgd, addr);
-+ pud_k = pud_offset(pgd_k, addr);
-+ if (!pud_present(*pud_k))
-+ goto no_context;
-+
-+ pmd = pmd_offset(pud, addr);
-+ pmd_k = pmd_offset(pud_k, addr);
-+ if (!pmd_present(*pmd_k))
-+ goto no_context;
-+
-+ if (!pmd_present(*pmd)) {
-+ set_pmd(pmd, *pmd_k);
-+ /* TODO: need to do a cache flush like arm,
-+ * maybe add at header file */
-+ } else
-+
-+ BUG_ON(pmd_page(*pmd) != pmd_page(*pmd_k));
-+
-+ /*
-+ * Since the vmalloc area is global, we don't
-+ * need to copy individual PTE's, it is enough to
-+ * copy the pgd pointer into the pte page of the
-+ * root task. If that is there, we'll find our pte if
-+ * it exists.
-+ */
-+
-+ /* Make sure the actual PTE exists as well to
-+ * catch kernel vmalloc-area accesses to non-mapped
-+ * addres. If we don't do this, this will just
-+ * silently loop forever.
-+ */
-+
-+ pte_k = pte_offset_kernel(pmd_k, addr);
-+ if (!pte_present(*pte_k))
-+ goto no_context;
-+
-+ return;
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/fault.h linux-3.4.113/arch/nds32/mm/fault.h
---- linux-3.4.113.orig/arch/nds32/mm/fault.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/fault.h 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,5 @@
-+void do_bad_area(unsigned long addr, unsigned int fsr, struct pt_regs *regs);
-+
-+void show_pte(struct mm_struct *mm, unsigned long addr);
-+
-+unsigned long search_exception_table(unsigned long addr);
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/highmem.c linux-3.4.113/arch/nds32/mm/highmem.c
---- linux-3.4.113.orig/arch/nds32/mm/highmem.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/highmem.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,76 @@
-+#include <linux/export.h>
-+#include <linux/highmem.h>
-+#include <linux/sched.h>
-+#include <linux/smp.h>
-+#include <linux/interrupt.h>
-+#include <linux/bootmem.h>
-+#include <asm/fixmap.h>
-+#include <asm/tlbflush.h>
-+
-+void *kmap(struct page *page)
-+{
-+ unsigned long vaddr;
-+ might_sleep();
-+ if (!PageHighMem(page))
-+ return page_address(page);
-+ vaddr = (unsigned long)kmap_high(page);
-+ return (void *)vaddr;
-+}
-+
-+EXPORT_SYMBOL(kmap);
-+
-+void kunmap(struct page *page)
-+{
-+ BUG_ON(in_interrupt());
-+ if (!PageHighMem(page))
-+ return;
-+ kunmap_high(page);
-+}
-+
-+EXPORT_SYMBOL(kunmap);
-+
-+/*
-+ * kmap_atomic/kunmap_atomic is significantly faster than kmap/kunmap because
-+ * no global lock is needed and because the kmap code must perform a global TLB
-+ * invalidation when the kmap pool wraps.
-+ *
-+ * However when holding an atomic kmap is is not legal to sleep, so atomic
-+ * kmaps are appropriate for short, tight code paths only.
-+ */
-+void *kmap_atomic(struct page *page)
-+{
-+ unsigned int idx;
-+ unsigned long vaddr, pte;
-+ int type;
-+
-+ pagefault_disable();
-+ if (!PageHighMem(page))
-+ return page_address(page);
-+
-+ type = kmap_atomic_idx_push();
-+
-+ idx = type + KM_TYPE_NR * smp_processor_id();
-+ vaddr = __fix_to_virt(FIX_KMAP_BEGIN + idx);
-+ pte = (page_to_pfn(page) << PAGE_SHIFT) | (PAGE_KERNEL);
-+ asm volatile ("mtsr %0, $TLB_VPN\n\t"
-+ "dsb\n\t"
-+ "tlbop %1, RWLK\n\t"
-+ "isb\n\t"
-+ ::"r" (vaddr), "r"(pte));
-+ return (void *)vaddr;
-+}
-+
-+EXPORT_SYMBOL(kmap_atomic);
-+
-+void __kunmap_atomic(void *kvaddr)
-+{
-+ if (kvaddr >= (void *)FIXADDR_START) {
-+ kmap_atomic_idx_pop();
-+ asm volatile ("tlbop %0, UNLK\n\t"
-+ "tlbop %0, INV\n\t"
-+ ::"r" (kvaddr));
-+ }
-+ pagefault_enable();
-+}
-+
-+EXPORT_SYMBOL(__kunmap_atomic);
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/init.c linux-3.4.113/arch/nds32/mm/init.c
---- linux-3.4.113.orig/arch/nds32/mm/init.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/init.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,438 @@
-+/*
-+ * linux/arch/nds32/mm/init.c
-+ *
-+ * Copyright (C) 1995-2002 Russell King
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+#include <linux/kernel.h>
-+#include <linux/errno.h>
-+#include <linux/swap.h>
-+#include <linux/init.h>
-+#include <linux/bootmem.h>
-+#include <linux/mman.h>
-+#include <linux/nodemask.h>
-+#include <linux/initrd.h>
-+#include <linux/highmem.h>
-+#include <linux/memblock.h>
-+
-+#include <asm/sections.h>
-+#include <asm/mach-types.h>
-+#include <asm/hardware.h>
-+#include <asm/setup.h>
-+#include <asm/tlb.h>
-+#include <asm/page.h>
-+
-+#include <asm/mach/arch.h>
-+#include <asm/mach/map.h>
-+
-+#include "mm.h"
-+#include "../../kernel/signal.h"
-+
-+#define TABLE_SIZE (PTRS_PER_PTE * sizeof(pte_t))
-+
-+DEFINE_PER_CPU(struct mmu_gather, mmu_gathers);
-+DEFINE_SPINLOCK(anon_alias_lock);
-+extern pgd_t swapper_pg_dir[PTRS_PER_PGD];
-+extern unsigned long phys_initrd_start;
-+extern unsigned long phys_initrd_size;
-+
-+/*
-+ * empty_zero_page is a special page that is used for
-+ * zero-initialized data and COW.
-+ */
-+struct page *empty_zero_page;
-+
-+void show_mem(unsigned int flags)
-+{
-+ int free = 0, total = 0, reserved = 0;
-+ int shared = 0, cached = 0, slab = 0, node;
-+
-+ printk("Mem-info:\n");
-+ show_free_areas(flags);
-+ printk("Free swap: %6ldkB\n", nr_swap_pages << (PAGE_SHIFT - 10));
-+
-+ for_each_online_node(node) {
-+ struct page *page, *end;
-+
-+ page = NODE_MEM_MAP(node);
-+ end = page + NODE_DATA(node)->node_spanned_pages;
-+
-+ do {
-+ total++;
-+ if (PageReserved(page))
-+ reserved++;
-+ else if (PageSwapCache(page))
-+ cached++;
-+ else if (PageSlab(page))
-+ slab++;
-+ else if (!page_count(page))
-+ free++;
-+ else
-+ shared += page_count(page) - 1;
-+ page++;
-+ } while (page < end);
-+ }
-+
-+ printk("%d pages of RAM\n", total);
-+ printk("%d free pages\n", free);
-+ printk("%d reserved pages\n", reserved);
-+ printk("%d slab pages\n", slab);
-+ printk("%d pages shared\n", shared);
-+ printk("%d pages swap cached\n", cached);
-+}
-+
-+struct node_info {
-+ unsigned int start;
-+ unsigned int end;
-+ int bootmap_pages;
-+};
-+
-+#define O_PFN_DOWN(x) ((x) >> PAGE_SHIFT)
-+#define V_PFN_DOWN(x) O_PFN_DOWN(__pa(x))
-+
-+#define O_PFN_UP(x) (PAGE_ALIGN(x) >> PAGE_SHIFT)
-+#define V_PFN_UP(x) O_PFN_UP(__pa(x))
-+
-+#define PFN_SIZE(x) ((x) >> PAGE_SHIFT)
-+#define PFN_RANGE(s,e) PFN_SIZE(PAGE_ALIGN((unsigned long)(e)) - \
-+ (((unsigned long)(s)) & PAGE_MASK))
-+#ifdef CONFIG_EARLY_PRINTK
-+#include <asm/fixmap.h>
-+
-+/*
-+ * Using tlbop to create an early I/O mapping
-+ */
-+void __iomem *__init early_io_map(phys_addr_t pa)
-+{
-+ unsigned long va;
-+ pa &= PAGE_MASK;
-+ pa += pgprot_val(PAGE_DEVICE);
-+ va = fix_to_virt(FIX_EARLY_DEBUG);
-+ /* insert and lock this page to tlb entry directly */
-+ asm volatile ("mtsr %0, $TLB_VPN\n\t"
-+ "dsb\n\t"
-+ "tlbop %1, RWLK\n\t" "isb\n\t"::"r" (va), "r"(pa));
-+ return (void __iomem *)va;
-+}
-+
-+int __init early_io_unmap(void)
-+{
-+ unsigned long va;
-+ va = fix_to_virt(FIX_EARLY_DEBUG);
-+ asm volatile ("tlbop %0, UNLK\n\t"
-+ "tlbop %0, INV\n\t" "isb\n\t"::"r" (va));
-+ return 0;
-+}
-+
-+late_initcall(early_io_unmap);
-+#endif
-+
-+static void __init zone_sizes_init(void)
-+{
-+ unsigned long zones_size[MAX_NR_ZONES];
-+
-+ /* Clear the zone sizes */
-+ memset(zones_size, 0, sizeof(zones_size));
-+
-+ zones_size[ZONE_NORMAL] = max_low_pfn;
-+#ifdef CONFIG_HIGHMEM
-+ zones_size[ZONE_HIGHMEM] = max_pfn;
-+#endif
-+ free_area_init_nodes(zones_size);
-+
-+}
-+
-+/*
-+ * Map all physical memory under high_memory into kernel's address space.
-+ *
-+ * This is explicitly coded for two-level page tables, so if you need
-+ * something else then this needs to change.
-+ */
-+static void __init map_ram(void)
-+{
-+ unsigned long v, p, e;
-+ pgd_t *pge;
-+ pud_t *pue;
-+ pmd_t *pme;
-+ pte_t *pte;
-+ /* These mark extents of read-only kernel pages...
-+ * ...from vmlinux.lds.S
-+ */
-+
-+ p = (u32) memblock_start_of_DRAM() & PAGE_MASK;
-+ e = min((u32) memblock_end_of_DRAM(), (u32) __pa(high_memory));
-+
-+ v = (u32) __va(p);
-+ pge = pgd_offset_k(v);
-+
-+ while (p < e) {
-+ int j;
-+ pue = pud_offset(pge, v);
-+ pme = pmd_offset(pue, v);
-+
-+ if ((u32) pue != (u32) pge || (u32) pme != (u32) pge) {
-+ panic("%s: Kernel hardcoded for "
-+ "two-level page tables", __func__);
-+ }
-+
-+ /* Alloc one page for holding PTE's... */
-+ pte = (pte_t *) alloc_bootmem_low_pages(PAGE_SIZE);
-+ set_pmd(pme, __pmd(__pa(pte) + _PAGE_KERNEL_TABLE));
-+
-+ /* Fill the newly allocated page with PTE'S */
-+ for (j = 0; p < e && j < PTRS_PER_PTE;
-+ v += PAGE_SIZE, p += PAGE_SIZE, j++, pte++) {
-+ /* Create mapping between p and v. */
-+ /* TODO: more fine grant for page access permission */
-+ set_pte(pte, __pte(p + pgprot_val(PAGE_KERNEL)));
-+ }
-+
-+ pge++;
-+ }
-+}
-+
-+static void __init fixedrange_init(void)
-+{
-+ unsigned long vaddr, phys, prot;
-+ pgd_t *pgd;
-+ pud_t *pud;
-+ pmd_t *pmd;
-+ pte_t *pte;
-+
-+ /*
-+ * Fixed mappings:
-+ */
-+ vaddr = __fix_to_virt(__end_of_fixed_addresses - 1);
-+ pgd = swapper_pg_dir + pgd_index(vaddr);
-+ pud = pud_offset(pgd, vaddr);
-+ pmd = pmd_offset(pud, vaddr);
-+ pte = (pte_t *) alloc_bootmem_low_pages(PAGE_SIZE);
-+ set_pmd(pmd, __pmd(__pa(pte) + _PAGE_KERNEL_TABLE));
-+
-+ /* create return_syscall mapping. */
-+ vaddr = __fix_to_virt(FIX_RETURN_SYSCALL);
-+ phys = RETURN_SYSCALL_PA_BASE;
-+ prot = PAGE_UXKRWX_V2;
-+ pte = pte_offset_kernel(pmd, vaddr);
-+ set_pte(pte, pfn_pte(phys >> PAGE_SHIFT, prot));
-+
-+#ifdef CONFIG_HIGHMEM
-+ /*
-+ * Permanent kmaps:
-+ */
-+ vaddr = PKMAP_BASE;
-+
-+ pgd = swapper_pg_dir + pgd_index(vaddr);
-+ pud = pud_offset(pgd, vaddr);
-+ pmd = pmd_offset(pud, vaddr);
-+ pte = (pte_t *) alloc_bootmem_low_pages(PAGE_SIZE);
-+ set_pmd(pmd, __pmd(__pa(pte) + _PAGE_KERNEL_TABLE));
-+ pkmap_page_table = pte;
-+#endif /* CONFIG_HIGHMEM */
-+}
-+
-+/*
-+ * paging_init() sets up the page tables, initialises the zone memory
-+ * maps, and sets up the zero page, bad page and bad page tables.
-+ */
-+void __init paging_init(struct machine_desc *mdesc)
-+{
-+ void *zero_page;
-+ int i;
-+
-+ printk(KERN_INFO "Setting up paging and PTEs.\n");
-+
-+#ifdef CONFIG_BLK_DEV_INITRD
-+ if (phys_initrd_size) {
-+ /* assume initrd is put on node 0 */
-+ reserve_bootmem_node(NODE_DATA(0), phys_initrd_start,
-+ phys_initrd_size, BOOTMEM_DEFAULT);
-+ initrd_start = __phys_to_virt(phys_initrd_start);
-+ initrd_end = initrd_start + phys_initrd_size;
-+ printk(KERN_INFO
-+ "initrd_start at 0x%08lx, initrd_end at 0x%08lx\n",
-+ initrd_start, initrd_end);
-+ }
-+#endif
-+
-+ /* clear out the init_mm.pgd that will contain the kernel's mappings */
-+ for (i = 0; i < PTRS_PER_PGD; i++)
-+ swapper_pg_dir[i] = __pgd(1);
-+
-+ map_ram();
-+
-+ if (mdesc->map_io)
-+ mdesc->map_io();
-+
-+ fixedrange_init();
-+
-+ /* allocate space for empty_zero_page */
-+ zero_page = alloc_bootmem_low_pages(PAGE_SIZE);
-+ memset(zero_page, 0, PAGE_SIZE);
-+
-+ zone_sizes_init();
-+
-+ empty_zero_page = virt_to_page(zero_page);
-+#ifdef CONFIG_NO_KERNEL_LARGE_PAGE
-+ SET_MMU_CTL(GET_MMU_CTL() & ~0x400);
-+#endif
-+#ifdef CONFIG_SMP
-+ cpu_dcache_wbinval_all();
-+#endif
-+ flush_dcache_page(empty_zero_page);
-+}
-+
-+static inline int free_area(unsigned long addr, unsigned long end, char *s)
-+{
-+ unsigned int size = (end - addr) >> 10;
-+ int pages = 0;
-+
-+ for (; addr < end; addr += PAGE_SIZE) {
-+ struct page *page = virt_to_page(addr);
-+ ClearPageReserved(page);
-+ init_page_count(page);
-+ free_page(addr);
-+ totalram_pages++;
-+ pages++;
-+ }
-+
-+ if (size && s)
-+ printk(KERN_INFO "free_area: Freeing %s memory: %dK\n", s,
-+ size);
-+
-+ return pages;
-+}
-+
-+/* Free the reserved page into the buddy system, so it gets managed. */
-+static inline void __free_reserved_page(struct page *page)
-+{
-+ ClearPageReserved(page);
-+ init_page_count(page);
-+ __free_page(page);
-+}
-+
-+#ifdef CONFIG_HIGHMEM
-+void free_highmem_page(struct page *page)
-+{
-+ __free_reserved_page(page);
-+ totalram_pages++;
-+ totalhigh_pages++;
-+}
-+#endif
-+
-+static inline void __init free_highmem(void)
-+{
-+#ifdef CONFIG_HIGHMEM
-+ unsigned long pfn;
-+ for (pfn = PFN_UP(__pa(high_memory)); pfn < max_pfn; pfn++) {
-+ phys_addr_t paddr = (phys_addr_t) pfn << PAGE_SHIFT;
-+ if (!memblock_is_reserved(paddr))
-+ free_highmem_page(pfn_to_page(pfn));
-+ }
-+#endif
-+}
-+
-+static void __init set_max_mapnr_init(void)
-+{
-+ max_mapnr = max_pfn;
-+}
-+
-+/*
-+ * mem_init() marks the free areas in the mem_map and tells us how much
-+ * memory is free. This is done after various parts of the system have
-+ * claimed their memory after the kernel image.
-+ */
-+void __init mem_init(void)
-+{
-+ phys_addr_t memory_start = memblock_start_of_DRAM();
-+ BUG_ON(!mem_map);
-+ set_max_mapnr_init();
-+
-+ free_highmem();
-+
-+ /* this will put all low memory onto the freelists */
-+ totalram_pages += free_all_bootmem();
-+
-+ printk(KERN_INFO "virtual kernel memory layout:\n"
-+ " fixmap : 0x%08lx - 0x%08lx (%4ld kB)\n"
-+#ifdef CONFIG_HIGHMEM
-+ " pkmap : 0x%08lx - 0x%08lx (%4ld kB)\n"
-+#endif
-+ " consist : 0x%08lx - 0x%08lx (%4ld MB)\n"
-+ " vmalloc : 0x%08lx - 0x%08lx (%4ld MB)\n"
-+ " lowmem : 0x%08lx - 0x%08lx (%4ld MB)\n"
-+ " .init : 0x%08lx - 0x%08lx (%4ld kB)\n"
-+ " .data : 0x%08lx - 0x%08lx (%4ld kB)\n"
-+ " .text : 0x%08lx - 0x%08lx (%4ld kB)\n",
-+ FIXADDR_START, FIXADDR_TOP, (FIXADDR_TOP - FIXADDR_START) >> 10,
-+#ifdef CONFIG_HIGHMEM
-+ PKMAP_BASE, PKMAP_BASE + LAST_PKMAP * PAGE_SIZE,
-+ (LAST_PKMAP * PAGE_SIZE) >> 10,
-+#endif
-+ CONSISTENT_BASE, CONSISTENT_END,
-+ ((CONSISTENT_END) - (CONSISTENT_BASE)) >> 20, VMALLOC_START,
-+ (unsigned long)VMALLOC_END, (VMALLOC_END - VMALLOC_START) >> 20,
-+ (unsigned long)__va(memory_start), (unsigned long)high_memory,
-+ ((unsigned long)high_memory -
-+ (unsigned long)__va(memory_start)) >> 20,
-+ (unsigned long)&__init_begin, (unsigned long)&__init_end,
-+ ((unsigned long)&__init_end -
-+ (unsigned long)&__init_begin) >> 10, (unsigned long)&_etext,
-+ (unsigned long)&_edata,
-+ ((unsigned long)&_edata - (unsigned long)&_etext) >> 10,
-+ (unsigned long)&_text, (unsigned long)&_etext,
-+ ((unsigned long)&_etext - (unsigned long)&_text) >> 10);
-+
-+ /*
-+ * Check boundaries twice: Some fundamental inconsistencies can
-+ * be detected at build time already.
-+ */
-+#define __FIXADDR_TOP (-PAGE_SIZE)
-+#ifdef CONFIG_HIGHMEM
-+ BUILD_BUG_ON(PKMAP_BASE + LAST_PKMAP * PAGE_SIZE > FIXADDR_START);
-+ BUILD_BUG_ON((CONSISTENT_END) > PKMAP_BASE);
-+#endif
-+ BUILD_BUG_ON(VMALLOC_END > CONSISTENT_BASE);
-+#define high_memory (-128UL << 20)
-+ BUILD_BUG_ON(VMALLOC_START >= VMALLOC_END);
-+#undef high_memory
-+#undef __FIXADDR_TOP
-+
-+#ifdef CONFIG_HIGHMEM
-+ BUG_ON(PKMAP_BASE + LAST_PKMAP * PAGE_SIZE > FIXADDR_START);
-+ BUG_ON(CONSISTENT_END > PKMAP_BASE);
-+#endif
-+ BUG_ON(VMALLOC_END > CONSISTENT_BASE);
-+ BUG_ON(VMALLOC_START >= VMALLOC_END);
-+ BUG_ON((unsigned long)high_memory > VMALLOC_START);
-+
-+ return;
-+}
-+
-+void free_initmem(void)
-+{
-+ free_area((unsigned long)(&__init_begin),
-+ (unsigned long)(&__init_end), "init");
-+}
-+
-+#ifdef CONFIG_BLK_DEV_INITRD
-+static int keep_initrd;
-+
-+void free_initrd_mem(unsigned long start, unsigned long end)
-+{
-+ if (!keep_initrd)
-+ free_area(start, end, "initrd");
-+}
-+
-+static int __init keepinitrd_setup(char *__unused)
-+{
-+ keep_initrd = 1;
-+ return 1;
-+}
-+
-+__setup("keepinitrd", keepinitrd_setup);
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/ioremap.c linux-3.4.113/arch/nds32/mm/ioremap.c
---- linux-3.4.113.orig/arch/nds32/mm/ioremap.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/ioremap.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,89 @@
-+/*
-+ * linux/arch/nds32/mm/ioremap.c
-+ *
-+ * Re-map IO memory to kernel address space so that we can access it.
-+ *
-+ * (C) Copyright 1995 1996 Linus Torvalds
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * Hacked for ARM by Phil Blundell <philb@gnu.org>
-+ * Hacked to allow all architectures to build, and various cleanups
-+ * by Russell King
-+ *
-+ * This allows a driver to remap an arbitrary region of bus memory into
-+ * virtual space. One should *only* use readl, writel, memcpy_toio and
-+ * so on with such remapped areas.
-+ *
-+ * Because the ARM only has a 32-bit address space we can't address the
-+ * whole of the (physical) PCI space at once. PCI huge-mode addressing
-+ * allows us to circumvent this restriction by splitting PCI space into
-+ * two 2GB chunks and mapping only one at a time into processor memory.
-+ * We use MMU protection domains to trap any attempt to access the bank
-+ * that is not currently mapped. (This isn't fully implemented yet.)
-+ */
-+#include <linux/module.h>
-+#include <linux/vmalloc.h>
-+#include <linux/io.h>
-+#include <asm/cacheflush.h>
-+
-+/*
-+ * Remap an arbitrary physical address space into the kernel virtual
-+ * address space. Needed when the kernel wants to access high addresses
-+ * directly.
-+ *
-+ * NOTE! We need to allow non-page-aligned mappings too: we will obviously
-+ * have to convert them into an offset in a page-aligned mapping, but the
-+ * caller shouldn't need to know that small detail.
-+ *
-+ * 'flags' are the extra L_PTE_ flags that you want to specify for this
-+ * mapping. See include/asm-arm/proc-armv/pgtable.h for more information.
-+ */
-+void __iomem *__ioremap(unsigned long phys_addr, size_t size,
-+ unsigned long flags, unsigned long align)
-+{
-+ struct vm_struct *area;
-+ unsigned long addr, offset, last_addr;
-+ pgprot_t prot;
-+
-+ /* Don't allow wraparound or zero size */
-+ last_addr = phys_addr + size - 1;
-+ if (!size || last_addr < phys_addr)
-+ return NULL;
-+
-+ /*
-+ * Mappings have to be page-aligned
-+ */
-+ offset = phys_addr & ~PAGE_MASK;
-+ phys_addr &= PAGE_MASK;
-+ size = PAGE_ALIGN(last_addr + 1) - phys_addr;
-+
-+ /*
-+ * Ok, go for it..
-+ */
-+ area = get_vm_area(size, VM_IOREMAP);
-+ if (!area)
-+ return NULL;
-+
-+ area->phys_addr = phys_addr;
-+ addr = (unsigned long)area->addr;
-+ /* TODO: verify this value for ioremap */
-+ prot = __pgprot(_PAGE_V | _PAGE_M_KRW | _PAGE_D |
-+ _PAGE_G | _PAGE_C_DEV | flags);
-+ /* TODO: verify this use generic ioremap_page_range instead of
-+ * self's remap_area_pages */
-+ if (ioremap_page_range(addr, addr + size, phys_addr, prot)) {
-+ vunmap((void *)addr);
-+ return NULL;
-+ }
-+ return (__force void __iomem *)(offset + (char *)addr);
-+
-+}
-+
-+EXPORT_SYMBOL(__ioremap);
-+
-+void __iounmap(void __iomem * addr)
-+{
-+ vunmap((void *)(PAGE_MASK & (unsigned long)addr));
-+}
-+
-+EXPORT_SYMBOL(__iounmap);
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/Makefile linux-3.4.113/arch/nds32/mm/Makefile
---- linux-3.4.113.orig/arch/nds32/mm/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/Makefile 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,24 @@
-+#
-+# Makefile for the linux arm-specific parts of the memory manager.
-+#
-+
-+obj-y := consistent.o extable.o \
-+ fault.o init.o ioremap.o mmap.o \
-+ mm-nds32.o cacheflush.o
-+
-+obj-y += proc-n12.o
-+obj-$(CONFIG_CCTL) += cctl.o
-+obj-$(CONFIG_ALIGNMENT_TRAP) += alignment.o
-+ifneq ($(CONFIG_CPU_NO_CONTEXT_ID), y)
-+obj-y += tlb.o
-+endif
-+gcc_ver :=$(shell $(CC) -E -dM -xc /dev/null | grep __VERSION__ | sed 's/\#define __VERSION__ //')
-+ifeq ($(shell expr `echo $(gcc_ver)` \>= 4.9.2 ), 1)
-+CFLAGS_proc-n12.o += -fomit-frame-pointer
-+else
-+CFLAGS_proc-n12.o += -fomit-frame-pointer -mno-16bit
-+endif
-+obj-$(CONFIG_HIGHMEM) += highmem.o
-+ifdef CONFIG_FUNCTION_TRACER
-+CFLAGS_REMOVE_proc-n12.o = -pg
-+endif
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/mmap.c linux-3.4.113/arch/nds32/mm/mmap.c
---- linux-3.4.113.orig/arch/nds32/mm/mmap.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/mmap.c 2016-12-01 20:59:24.368613368 +0100
-@@ -0,0 +1,101 @@
-+/*
-+ * linux/arch/nds32/mm/mmap.c
-+ *
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ */
-+#include <linux/sched.h>
-+#include <linux/mman.h>
-+#include <linux/shm.h>
-+
-+#define COLOUR_ALIGN(addr,pgoff) \
-+ ((((addr)+REALSHMLBA-1)&~(REALSHMLBA-1)) + \
-+ (((pgoff)<<PAGE_SHIFT) & (REALSHMLBA-1)))
-+
-+/*
-+ * We need to ensure that shared mappings are correctly aligned to
-+ * avoid aliasing issues with VIPT caches. We need to ensure that
-+ * a specific page of an object is always mapped at a multiple of
-+ * SHMLBA bytes.
-+ *
-+ * We unconditionally provide this function for all cases, however
-+ * in the VIVT case, we optimise out the alignment rules.
-+ */
-+unsigned long
-+arch_get_unmapped_area(struct file *filp, unsigned long addr,
-+ unsigned long len, unsigned long pgoff,
-+ unsigned long flags)
-+{
-+ struct mm_struct *mm = current->mm;
-+ struct vm_area_struct *vma;
-+ unsigned long start_addr;
-+ int do_align = 0;
-+#ifdef CONFIG_CPU_CACHE_NONALIASING
-+ int aliasing = 0;
-+#else
-+ int aliasing = 1;
-+#endif
-+
-+ /*
-+ * We only need to do colour alignment if either the I or D
-+ * caches alias.
-+ */
-+ if (aliasing)
-+ do_align = filp || (flags & MAP_SHARED);
-+
-+ /*
-+ * We should enforce the MAP_FIXED case. However, currently
-+ * the generic kernel code doesn't allow us to handle this.
-+ */
-+ if (flags & MAP_FIXED) {
-+ if (aliasing && flags & MAP_SHARED && addr & (REALSHMLBA - 1))
-+ return -EINVAL;
-+ return addr;
-+ }
-+
-+ if (len > TASK_SIZE)
-+ return -ENOMEM;
-+
-+ if (addr) {
-+ if (do_align)
-+ addr = COLOUR_ALIGN(addr, pgoff);
-+ else
-+ addr = PAGE_ALIGN(addr);
-+
-+ vma = find_vma(mm, addr);
-+ if (TASK_SIZE - len >= addr &&
-+ (!vma || addr + len <= vma->vm_start))
-+ return addr;
-+ }
-+ start_addr = addr = mm->free_area_cache;
-+
-+full_search:
-+ if (do_align)
-+ addr = COLOUR_ALIGN(addr, pgoff);
-+ else
-+ addr = PAGE_ALIGN(addr);
-+
-+ for (vma = find_vma(mm, addr);; vma = vma->vm_next) {
-+ /* At this point: (!vma || addr < vma->vm_end). */
-+ if (TASK_SIZE - len < addr) {
-+ /*
-+ * Start a new search - just in case we missed
-+ * some holes.
-+ */
-+ if (start_addr != TASK_UNMAPPED_BASE) {
-+ start_addr = addr = TASK_UNMAPPED_BASE;
-+ goto full_search;
-+ }
-+ return -ENOMEM;
-+ }
-+ if (!vma || addr + len <= vma->vm_start) {
-+ /*
-+ * Remember the place where we stopped the search:
-+ */
-+ mm->free_area_cache = addr + len;
-+ return addr;
-+ }
-+ addr = vma->vm_end;
-+ if (do_align)
-+ addr = COLOUR_ALIGN(addr, pgoff);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/mm.h linux-3.4.113/arch/nds32/mm/mm.h
---- linux-3.4.113.orig/arch/nds32/mm/mm.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/mm.h 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,19 @@
-+/* the upper-most page table pointer */
-+
-+#ifdef CONFIG_MMU
-+
-+extern pmd_t *top_pmd;
-+
-+#define TOP_PTE(x) pte_offset_kernel(top_pmd, x)
-+
-+static inline pmd_t *pmd_off(pgd_t *pgd, unsigned long virt)
-+{
-+ return pmd_offset(pgd, virt);
-+}
-+
-+static inline pmd_t *pmd_off_k(unsigned long virt)
-+{
-+ return pmd_off(pgd_offset_k(virt), virt);
-+}
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/mm-nds32.c linux-3.4.113/arch/nds32/mm/mm-nds32.c
---- linux-3.4.113.orig/arch/nds32/mm/mm-nds32.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/mm-nds32.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,267 @@
-+/*
-+ * linux/arch/nds32/mm/mm-nds32.c
-+ *
-+ * Copyright (C) 1998-2002 Russell King
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * Page table sludge for Andes N10/N12 processor architectures.
-+ */
-+#include <linux/module.h>
-+#include <linux/mm.h>
-+#include <linux/bootmem.h>
-+#include <linux/init_task.h>
-+
-+#include <asm/pgalloc.h>
-+#include <asm/pgtable.h>
-+#include <asm/setup.h>
-+#include <asm/fixmap.h>
-+
-+#include <asm/mach/map.h>
-+#include "./../kernel/signal.h"
-+
-+extern void _text, _stext, _etext;
-+extern void *high_memory;
-+
-+#define FIRST_KERNEL_PGD_NR (USER_PTRS_PER_PGD)
-+
-+/*
-+ * need to get a 4k page for level 1
-+ */
-+
-+pgd_t *get_pgd_slow(struct mm_struct *mm)
-+{
-+ pgd_t *new_pgd, *init_pgd;
-+ int i;
-+
-+ new_pgd = (pgd_t *) __get_free_pages(GFP_KERNEL, 0); //M order 0: one page
-+ if (!new_pgd)
-+ return NULL;
-+ for (i = 0; i < PTRS_PER_PGD; i++) {
-+ (*new_pgd) = 1;
-+ new_pgd++;
-+ }
-+ new_pgd -= PTRS_PER_PGD;
-+
-+ init_pgd = pgd_offset_k(0);
-+
-+ memcpy(new_pgd + FIRST_KERNEL_PGD_NR, init_pgd + FIRST_KERNEL_PGD_NR,
-+ (PTRS_PER_PGD - FIRST_KERNEL_PGD_NR) * sizeof(pgd_t));
-+
-+ cpu_dcache_wb_range((unsigned long)new_pgd,
-+ (unsigned long)new_pgd +
-+ PTRS_PER_PGD * sizeof(pgd_t));
-+ inc_zone_page_state(virt_to_page((unsigned long *)new_pgd),
-+ NR_PAGETABLE);
-+
-+ return new_pgd;
-+}
-+
-+void free_pgd_slow(struct mm_struct *mm, pgd_t * pgd)
-+{
-+ pmd_t *pmd;
-+ struct page *pte;
-+
-+ if (!pgd)
-+ return;
-+
-+ pmd = (pmd_t *) pgd;
-+ if (pmd_none(*pmd))
-+ goto free;
-+ if (pmd_bad(*pmd)) {
-+ pmd_ERROR(*pmd);
-+ pmd_clear(pmd);
-+ goto free;
-+ }
-+
-+ pte = pmd_page(*pmd);
-+ pmd_clear(pmd);
-+ dec_zone_page_state(virt_to_page((unsigned long *)pgd), NR_PAGETABLE);
-+ pte_free(mm, pte);
-+ pmd_free(mm, pmd);
-+free:
-+ free_pages((unsigned long)pgd, 0);
-+}
-+
-+/*
-+ * Add a PAGE mapping between VIRT and PHYS in domain
-+ * DOMAIN with protection PROT. Note that due to the
-+ * way we map the PTEs, we must allocate two PTE_SIZE'd
-+ * blocks - one for the Linux pte table, and one for
-+ * the hardware pte table.
-+ */
-+static inline void
-+alloc_init_page(unsigned long virt, unsigned long phys, unsigned int prot_l1,
-+ pgprot_t prot)
-+{
-+ pmd_t *pmdp;
-+ pte_t *ptep;
-+
-+ pmdp = pmd_offset(pgd_offset_k(virt), virt); //L1PTE
-+ if (pmd_none(*pmdp)) { //must not or 0xc0000000
-+ ptep = alloc_bootmem_low_pages(PTRS_PER_PTE * sizeof(pte_t));
-+ set_pmd(pmdp, __mk_pmd(ptep, 0));
-+ }
-+ ptep = pte_offset_kernel(pmdp, virt); //L2PTE
-+ set_pte(ptep, pfn_pte(phys >> PAGE_SHIFT, prot));
-+}
-+
-+/*
-+ * Clear any PGD mapping. On a two-level page table system,
-+ * the clearance is done by the middle-level functions (pmd)
-+ * rather than the top-level (pgd) functions.
-+ */
-+static inline void clear_mapping(unsigned long virt)
-+{
-+ pmd_clear(pmd_offset(pgd_offset_k(virt), virt));
-+}
-+
-+struct mem_types {
-+ unsigned int prot_pte;
-+ unsigned int prot_l1;
-+};
-+
-+static struct mem_types mem_types[] __initdata = {
-+ [MT_DEVICE] = {
-+ .prot_pte = 0x9f, //_KERNPG_TABLE,
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ },
-+ [MT_CACHECLEAN] = {
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ .prot_pte = 0x0, //_KERNPG_TABLE,
-+ },
-+ [MT_MINICLEAN] = {
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ .prot_pte = 0x0, // _KERNPG_TABLE,
-+ },
-+ [MT_CACHE_L1] = {
-+ .prot_pte = PAGE_CACHE_L1,
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ },
-+ [MT_UXKRWX_V1] = {
-+ .prot_pte = PAGE_UXKRWX_V1,
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ },
-+ [MT_UXKRWX_V2] = {
-+ .prot_pte = PAGE_UXKRWX_V2,
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ },
-+ [MT_MEMORY] = {
-+ .prot_pte = PAGE_MEMORY,
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ },
-+ [MT_ROM] = {
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ .prot_pte = 0x2bb, // _KERNPG_TABLE,
-+ },
-+ [MT_ILM] = {
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ .prot_pte = 0x2b7, // _KERNPG_TABLE,
-+ },
-+ [MT_DLM] = {
-+ .prot_l1 = PMD_TYPE_TABLE,
-+ .prot_pte = 0x297, // _KERNPG_TABLE,
-+ }
-+};
-+
-+/*
-+ * Create the page directory entries and any necessary
-+ * page tables for the mapping specified by `md'. We
-+ * are able to cope here with varying sizes and address
-+ * offsets, and we take full advantage of sections.
-+ */
-+static void __init create_mapping(struct map_desc *md)
-+{
-+ unsigned long virt, length;
-+ int prot_l1;
-+ pgprot_t prot_pte;
-+ long off;
-+
-+ printk("virt:0x%08lx,phys:%08lx,size:%08lx,pte:%08x\n",
-+ md->virtual, md->physical, md->length,
-+ __pgprot(mem_types[md->type].prot_pte));
-+
-+ if (md->virtual < TASK_SIZE) {
-+ printk(KERN_WARNING "BUG: not creating mapping area for "
-+ "0x%08lx at 0x%08lx in user region, next frame\n",
-+ md->physical, md->virtual);
-+ panic("In :%s, line:%d", __func__, __LINE__);
-+ return;
-+ }
-+
-+ if ((md->type == MT_DEVICE || md->type == MT_ROM) &&
-+ md->virtual >= PAGE_OFFSET && md->virtual < VMALLOC_END) {
-+ printk(KERN_WARNING "BUG: mapping area for 0x%08lx at 0x%08lx "
-+ "overlaps vmalloc space, next frame\n",
-+ md->physical, md->virtual);
-+ panic("In :%s, line:%d", __func__, __LINE__);
-+ }
-+
-+ prot_pte = __pgprot(mem_types[md->type].prot_pte);
-+ prot_l1 = mem_types[md->type].prot_l1;
-+ virt = md->virtual;
-+ off = md->physical - virt;
-+
-+ length = md->length;
-+ if (mem_types[md->type].prot_l1 == 1 &&
-+ (virt & 0xfffff || (virt + off) & 0xfffff
-+ || (virt + length) & 0xfffff)) {
-+ printk(KERN_WARNING
-+ "BUG: map area for 0x%08lx at 0x%08lx can not "
-+ "be mapped using pages, ignoring. next frame\n",
-+ md->physical, md->virtual);
-+ panic("In :%s, line:%d", __func__, __LINE__);
-+ return;
-+ }
-+
-+ while (length >= PAGE_SIZE) {
-+#ifdef CONFIG_SMP
-+ if (((virt >= (unsigned long)&_text)
-+ && (virt < (unsigned long)&_etext))
-+ || ((virt >= 0xc0000000) && (virt < 0xc0008000)))
-+ prot_pte = __pgprot(mem_types[MT_CACHE_L1].prot_pte);
-+#endif
-+ alloc_init_page(virt, virt + off, prot_l1, prot_pte);
-+ virt += PAGE_SIZE;
-+ length -= PAGE_SIZE;
-+ }
-+}
-+
-+/*
-+ * In order to soft-boot, we need to insert a 1:1 mapping in place of
-+ * the user-mode pages. This will then ensure that we have predictable
-+ * results when turning the mmu off
-+ */
-+void setup_mm_for_reboot(char mode)
-+{
-+ unsigned long pmdval;
-+ pgd_t *pgd;
-+ pmd_t *pmd;
-+ int i;
-+
-+ if (current->mm && current->mm->pgd)
-+ pgd = current->mm->pgd;
-+ else
-+ pgd = init_mm.pgd;
-+
-+ for (i = 0; i < USER_PTRS_PER_PGD; i++) {
-+ pmdval = (i << PGDIR_SHIFT);
-+ pmd = pmd_offset(pgd + i, i << PGDIR_SHIFT);
-+ set_pmd(pmd, __pmd(pmdval));
-+ }
-+}
-+
-+/*
-+ * Create the architecture specific mappings
-+ */
-+void __init iotable_init(struct map_desc *io_desc, int nr)
-+{
-+ int i;
-+
-+ for (i = 0; i < nr; i++) {
-+ create_mapping(io_desc + i);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/proc-n12.c linux-3.4.113/arch/nds32/mm/proc-n12.c
---- linux-3.4.113.orig/arch/nds32/mm/proc-n12.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/proc-n12.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,845 @@
-+/*
-+ * linux/arch/nds32/mm/proc-nds32.c
-+ *
-+ * Copyright (C) 2006 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ *
-+ * These are the low level assembler for performing cache and TLB
-+ * functions on the nds32.
-+ *
-+ */
-+#include <linux/module.h>
-+#include <linux/sched.h>
-+#include <linux/mm.h>
-+#include <asm/nds32.h>
-+#include <asm/pgtable.h>
-+#include <asm/tlbflush.h>
-+#include <asm/cacheflush.h>
-+#ifdef CONFIG_CACHE_L2
-+#include <asm/l2_cache.h>
-+#endif
-+#include <nds32_intrinsic.h>
-+
-+#include <asm/cache_info.h>
-+extern struct cache_info L1_cache_info[2];
-+
-+#ifdef CONFIG_CACHE_L2
-+void n12_L2cache_inval(void)
-+{
-+ unsigned long cmd = CCTL_CMD_L2_IX_INVAL | CCTL_ALL_CMD;
-+
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, CCTL_CMD_L2_SYNC);
-+ L2_CMD_RDY();
-+}
-+
-+void n12_L2cache_wb(void)
-+{
-+ unsigned long cmd = CCTL_CMD_L2_IX_WB | CCTL_ALL_CMD;
-+
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, CCTL_CMD_L2_SYNC);
-+ L2_CMD_RDY();
-+}
-+#endif
-+
-+int va_kernel_present(unsigned long addr)
-+{
-+ pmd_t *pmd;
-+ pte_t *ptep, pte;
-+ int ret = 0;
-+
-+ pmd = pmd_offset(pgd_offset_k(addr), addr);
-+ if (!pmd_none(*pmd)) {
-+ ptep = pte_offset_map(pmd, addr);
-+ pte = *ptep;
-+ if (pte_present(pte))
-+ ret = 1;
-+ }
-+ return ret;
-+}
-+
-+int va_present(struct mm_struct *mm, unsigned long addr)
-+{
-+ pgd_t *pgd;
-+ pud_t *pud;
-+ pmd_t *pmd;
-+ pte_t *ptep, pte;
-+ int ret = 0;
-+
-+ pgd = pgd_offset(mm, addr);
-+ if (!pgd_none(*pgd)) {
-+ pud = pud_offset(pgd, addr);
-+ if (!pud_none(*pud)) {
-+ pmd = pmd_offset(pud, addr);
-+ if (!pmd_none(*pmd)) {
-+ ptep = pte_offset_map(pmd, addr);
-+ pte = *ptep;
-+ if (pte_present(pte))
-+ ret = 1;
-+ }
-+ }
-+ }
-+ return ret;
-+
-+}
-+
-+int va_readable(struct pt_regs *regs, unsigned long addr)
-+{
-+ struct mm_struct *mm = current->mm;
-+ pgd_t *pgd;
-+ pud_t *pud;
-+ pmd_t *pmd;
-+ pte_t *ptep, pte;
-+ int ret = 0;
-+
-+ if (user_mode(regs)) {
-+ /* user mode */
-+ pgd = pgd_offset(mm, addr);
-+ if (!pgd_none(*pgd)) {
-+ pud = pud_offset(pgd, addr);
-+ if (!pud_none(*pud)) {
-+ pmd = pmd_offset(pud, addr);
-+ if (!pmd_none(*pmd)) {
-+ ptep = pte_offset_map(pmd, addr);
-+ pte = *ptep;
-+ if (pte_present(pte) && pte_read(pte))
-+ ret = 1;
-+ }
-+ }
-+ }
-+ } else {
-+ /* superuser mode is always readable, so we can only
-+ * check it is present or not*/
-+ pmd = pmd_offset(pgd_offset_k(addr), addr);
-+ if (!pmd_none(*pmd)) {
-+ ptep = pte_offset_map(pmd, addr);
-+ pte = *ptep;
-+ if (pte_present(pte))
-+ ret = 1;
-+ }
-+ }
-+ return ret;
-+}
-+
-+int va_writable(struct pt_regs *regs, unsigned long addr)
-+{
-+ struct mm_struct *mm = current->mm;
-+ pgd_t *pgd;
-+ pud_t *pud;
-+ pmd_t *pmd;
-+ pte_t *ptep, pte;
-+ int ret = 0;
-+
-+ if (user_mode(regs)) {
-+ /* user mode */
-+ pgd = pgd_offset(mm, addr);
-+ if (!pgd_none(*pgd)) {
-+ pud = pud_offset(pgd, addr);
-+ if (!pud_none(*pud)) {
-+ pmd = pmd_offset(pud, addr);
-+ if (!pmd_none(*pmd)) {
-+ ptep = pte_offset_map(pmd, addr);
-+ pte = *ptep;
-+ if (pte_present(pte) && pte_write(pte))
-+ ret = 1;
-+ }
-+ }
-+ }
-+ } else {
-+ /* superuser mode */
-+ pmd = pmd_offset(pgd_offset_k(addr), addr);
-+ if (!pmd_none(*pmd)) {
-+ ptep = pte_offset_map(pmd, addr);
-+ pte = *ptep;
-+ if (pte_present(pte) && pte_kernel_write(pte))
-+ ret = 1;
-+ }
-+ }
-+ return ret;
-+}
-+
-+#if 0
-+static inline void flush_fill_buffer(void)
-+{
-+ unsigned long kaddr, pte, flags;
-+
-+ local_irq_save(flags);
-+#define BASE_ADDR2 0xffff4000
-+ kaddr = BASE_ADDR2;
-+ pte = (0x6000 | _PAGE_V | _PAGE_M_KRW | _PAGE_G | _PAGE_C_DEV);
-+ asm("tlbop %0, INV\nisb\n"::"r"(kaddr));
-+ asm("mtsr %1, $mr2\ndsb\n"
-+ "tlbop %0, RWR\nisb\n"::"r"(pte), "r"(kaddr));
-+asm("lmw.bi $r0, [%0], $r1\n"::"r"(kaddr):"$r0", "$r1");
-+ local_irq_restore(flags);
-+}
-+#else
-+static inline void flush_fill_buffer(void)
-+{
-+}
-+#endif
-+
-+/*
-+ * All
-+ */
-+void n12_icache_inval_all(void)
-+{
-+ unsigned long end, line_size;
-+
-+ line_size = L1_cache_info[ICACHE].line_size;
-+ end =
-+ line_size * L1_cache_info[ICACHE].ways * L1_cache_info[ICACHE].sets;
-+
-+ do {
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_IX_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_IX_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_IX_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_IX_INVAL"::"r" (end));
-+ } while (end > 0);
-+}
-+
-+void n12_dcache_inval_all(void)
-+{
-+#ifdef CONFIG_PLAT_AG102
-+ __asm__ volatile ("\n\tcctl L1D_INVALALL");
-+#else
-+ unsigned long end, line_size;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ end =
-+ line_size * L1_cache_info[DCACHE].ways * L1_cache_info[DCACHE].sets;
-+
-+ do {
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+ } while (end > 0);
-+#endif
-+}
-+
-+void n12_dcache_wb_all(void)
-+{
-+#ifdef __NDS32_BASELINE_V3
-+#ifdef CONFIG_CACHE_L2
-+ __nds32__cctl_l1d_wball_alvl();
-+#else
-+ __nds32__cctl_l1d_wball_one_lvl();
-+#endif
-+#else
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ unsigned long end, line_size;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ end =
-+ line_size * L1_cache_info[DCACHE].ways * L1_cache_info[DCACHE].sets;
-+
-+ do {
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+ } while (end > 0);
-+#endif
-+#endif
-+}
-+
-+void n12_dcache_wbinval_all(void)
-+{
-+ unsigned long end, line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ unsigned long saved_gie;
-+#endif
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ end =
-+ line_size * L1_cache_info[DCACHE].ways * L1_cache_info[DCACHE].sets;
-+
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ GIE_SAVE(&saved_gie);
-+#endif
-+#ifdef __NDS32_BASELINE_V3
-+#ifdef CONFIG_CACHE_L2
-+ __nds32__cctl_l1d_wball_alvl();
-+#else
-+ __nds32__cctl_l1d_wball_one_lvl();
-+#endif
-+ __nds32__cctl_l1d_invalall();
-+#else
-+ do {
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+#endif
-+#ifndef CONFIG_PLAT_AG102
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+#endif
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+#endif
-+#ifndef CONFIG_PLAT_AG102
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+#endif
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+#endif
-+#ifndef CONFIG_PLAT_AG102
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+#endif
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_WB"::"r" (end));
-+#endif
-+#ifndef CONFIG_PLAT_AG102
-+ __asm__ volatile ("\n\tcctl %0, L1D_IX_INVAL"::"r" (end));
-+#endif
-+ } while (end > 0);
-+#ifdef CONFIG_PLAT_AG102
-+ __asm__ volatile ("\n\tcctl L1D_INVALALL");
-+#endif
-+#endif
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ GIE_RESTORE(saved_gie);
-+#endif
-+}
-+
-+/*
-+ * Page
-+ */
-+void n12_icache_inval_page(unsigned long start)
-+{
-+ unsigned long line_size, end;
-+
-+ line_size = L1_cache_info[ICACHE].line_size;
-+ end = start + PAGE_SIZE;
-+
-+ do {
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_INVAL"::"r" (end));
-+ } while (end != start);
-+}
-+
-+void n12_dcache_inval_page(unsigned long start)
-+{
-+ unsigned long line_size, end;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ end = start + PAGE_SIZE;
-+
-+ flush_fill_buffer();
-+ do {
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ } while (end != start);
-+}
-+
-+void n12_dcache_wb_page(unsigned long start)
-+{
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ unsigned long line_size, end;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ end = start + PAGE_SIZE;
-+
-+ flush_fill_buffer();
-+ do {
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+ end -= line_size;
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+ } while (end != start);
-+#endif
-+}
-+
-+void n12_dcache_wbinval_page(unsigned long start)
-+{
-+ unsigned long line_size, end;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ end = start + PAGE_SIZE;
-+
-+ flush_fill_buffer();
-+ do {
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+#endif
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+#endif
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+#endif
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ end -= line_size;
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (end));
-+#endif
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (end));
-+ } while (end != start);
-+}
-+
-+void n12_cache_wbinval_page(unsigned long page, int flushi)
-+{
-+ n12_dcache_wbinval_page(page);
-+ if (flushi)
-+ n12_icache_inval_page(page);
-+}
-+
-+/* These functions are used to invalidate cache by idx instead of
-+ * virtual address. User can use virtual address to do this purpose.
-+ * It supports 4way and 32KB cache size with 32bytes cacheline size. */
-+#include <nds32_intrinsic.h>
-+//#define WB_WITH_IDX
-+inline unsigned long va2idx(unsigned long va, unsigned int cache_type,
-+ unsigned long *way_offset)
-+{
-+ unsigned char set_bits, way_bits, line_bits;
-+ unsigned int idx;
-+ set_bits = L1_cache_info[cache_type].set_bits;
-+ way_bits = L1_cache_info[cache_type].way_bits;
-+ line_bits = L1_cache_info[cache_type].line_bits;
-+ *way_offset = set_bits + line_bits;
-+
-+ idx = (va & (((1 << set_bits) - 1) << line_bits));
-+ return idx;
-+}
-+
-+static inline void n12_dcache_inval_idx(unsigned long p)
-+{
-+ unsigned long idx, i, way_offset;
-+ unsigned char ways;
-+ ways = L1_cache_info[DCACHE].ways;
-+
-+ /* Unroll loop. Not support 2 ways invalidate. */
-+ if (ways == 2)
-+ panic("This way size is not supported. ways:%u, %s\n", ways,
-+ __func__);
-+ idx = va2idx(p, DCACHE, &way_offset);
-+ for (i = 0; i < ways / 4; i++) {
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | i << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | (i + 1) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | (i + 2) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | (i + 3) << way_offset));
-+ }
-+}
-+
-+static inline void n12_dcache_wb_idx(unsigned long p)
-+{
-+ unsigned long idx, i, way_offset;
-+ unsigned char ways;
-+ ways = L1_cache_info[DCACHE].ways;
-+
-+ /* Unroll the loop. Not support 2 ways invalidate. */
-+ if (ways == 2)
-+ panic("This way size is not supported. ways:%d, %s\n", ways,
-+ __func__);
-+ idx = va2idx(p, DCACHE, &way_offset);
-+ for (i = 0; i < ways / 4; i++) {
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | i << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | i << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | (i + 1) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | (i + 1) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | (i + 2) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | (i + 2) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | (i + 3) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_INVAL,
-+ (idx | (i + 3) << way_offset));
-+ }
-+}
-+
-+static inline void n12_dcache_wbinval_idx(unsigned long p)
-+{
-+ unsigned long idx, i, way_offset;
-+ unsigned char ways;
-+ ways = L1_cache_info[DCACHE].ways;
-+
-+ /* Unroll the loop. Not support 2 ways invalidate. */
-+ if (ways == 2)
-+ panic("This way size is not supported. ways:%d, %s\n", ways,
-+ __func__);
-+ idx = va2idx(p, DCACHE, &way_offset);
-+ for (i = 0; i < ways / 4; i++) {
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | i << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | (i + 1) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | (i + 2) << way_offset));
-+ __nds32__cctlidx_wbinval(NDS32_CCTL_L1D_IX_WB,
-+ (idx | (i + 3) << way_offset));
-+ }
-+}
-+
-+/*
-+ * Range
-+ */
-+void n12_icache_inval_range(unsigned long start, unsigned long end)
-+{
-+ unsigned long line_size;
-+
-+ line_size = L1_cache_info[ICACHE].line_size;
-+
-+ while (end > start) {
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_INVAL"::"r" (start));
-+ start += line_size;
-+ }
-+}
-+
-+void n12_dcache_inval_range(unsigned long start, unsigned long end)
-+{
-+ unsigned long line_size;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+
-+ flush_fill_buffer();
-+ while (end > start) {
-+#ifdef WB_WITH_IDX
-+ n12_dcache_inval_idx(start);
-+#else
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (start));
-+#endif
-+ start += line_size;
-+ }
-+}
-+
-+void n12_dcache_wb_range(unsigned long start, unsigned long end)
-+{
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+ unsigned long line_size;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+
-+ flush_fill_buffer();
-+ while (end > start) {
-+#ifdef WB_WITH_IDX
-+ n12_dcache_wb_idx(start);
-+#else
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (start));
-+#endif
-+ start += line_size;
-+ }
-+#endif
-+}
-+
-+void n12_dcache_wbinval_range(unsigned long start, unsigned long end)
-+{
-+ unsigned long line_size;
-+
-+ line_size = L1_cache_info[DCACHE].line_size;
-+
-+ flush_fill_buffer();
-+ while (end > start) {
-+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
-+#ifdef WB_WITH_IDX
-+ n12_dcache_wbinval_idx(start);
-+#else
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_WB"::"r" (start));
-+#endif
-+#endif
-+ __asm__ volatile ("\n\tcctl %0, L1D_VA_INVAL"::"r" (start));
-+ start += line_size;
-+ }
-+}
-+
-+void n12_cache_wbinval_range(unsigned long start, unsigned long end, int flushi)
-+{
-+ n12_dcache_wbinval_range(start, end);
-+ if (flushi)
-+ n12_icache_inval_range(start, end);
-+}
-+
-+void n12_cache_wbinval_range_check(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end)
-+{
-+ unsigned long line_size, t_start, t_end;
-+ int flushi;
-+
-+ flushi = vma->vm_flags & VM_EXEC;
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ start = start & ~(line_size - 1);
-+ end = (end + line_size - 1) & ~(line_size - 1);
-+
-+ if ((end - start) > (8 * PAGE_SIZE)) {
-+ n12_dcache_wbinval_all();
-+ if (flushi)
-+ n12_icache_inval_all();
-+ return;
-+ }
-+
-+ t_start = (start + PAGE_SIZE) & PAGE_MASK;
-+ t_end = ((end - 1) & PAGE_MASK);
-+
-+ if ((start & PAGE_MASK) == t_end) {
-+ if (va_present(vma->vm_mm, start))
-+ n12_cache_wbinval_range(start, end, flushi);
-+ return;
-+ }
-+
-+ if (va_present(vma->vm_mm, start))
-+ n12_cache_wbinval_range(start, t_start, flushi);
-+
-+ if (va_present(vma->vm_mm, end - 1))
-+ n12_cache_wbinval_range(t_end, end, flushi);
-+
-+ while (t_start < t_end) {
-+ if (va_present(vma->vm_mm, t_start))
-+ n12_cache_wbinval_page(t_start, flushi);
-+ t_start += PAGE_SIZE;
-+ }
-+}
-+
-+/*
-+ * DMA
-+ */
-+void n12_dma_wb_range(unsigned long start, unsigned long end)
-+{
-+ unsigned long line_size;
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ start = start & (~(line_size - 1));
-+ end = (end + line_size - 1) & (~(line_size - 1));
-+ if (unlikely(start == end))
-+ return;
-+
-+ n12_dcache_wb_range(start, end);
-+
-+#ifdef CONFIG_CACHE_L2
-+ {
-+ unsigned long p_start = __pa(start);
-+ unsigned long p_end = __pa(end);
-+ unsigned long cmd;
-+ //TODO Can Use PAGE Mode to optimize if range large than PAGE_SIZE
-+ line_size = L2_CACHE_LINE_SIZE();
-+ cmd =
-+ (p_start & ~(line_size - 1)) | CCTL_CMD_L2_PA_WB |
-+ CCTL_SINGLE_CMD;
-+ do {
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ cmd += line_size;
-+ p_start += line_size;
-+ } while (p_end > p_start);
-+ cmd = CCTL_CMD_L2_SYNC;
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ L2_CMD_RDY();
-+
-+ }
-+#endif
-+}
-+
-+#ifdef CONFIG_CACHE_L2
-+void n12_l2dcache_wbinval_range(unsigned long start, unsigned long end)
-+{
-+ unsigned long p_start;
-+ unsigned long p_end;
-+ unsigned long cmd;
-+ unsigned long line_size;
-+
-+ p_start = __pa(start);
-+ p_end = __pa(end);
-+ //TODO Can Use PAGE Mode to optimize if range large than PAGE_SIZE
-+ line_size = L2_CACHE_LINE_SIZE();
-+ cmd =
-+ (p_start & ~(line_size - 1)) | CCTL_CMD_L2_PA_WBINVAL |
-+ CCTL_SINGLE_CMD;
-+ do {
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ cmd += line_size;
-+ p_start += line_size;
-+ } while (p_end > p_start);
-+ cmd = CCTL_CMD_L2_SYNC;
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ L2_CMD_RDY();
-+
-+}
-+#endif
-+
-+void n12_dma_inval_range(unsigned long start, unsigned long end)
-+{
-+ unsigned long line_size;
-+ unsigned long old_start = start;
-+ unsigned long old_end = end;
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ start = start & (~(line_size - 1));
-+ end = (end + line_size - 1) & (~(line_size - 1));
-+ if (unlikely(start == end))
-+ return;
-+ if (start != old_start) {
-+ n12_dcache_wbinval_range(start, start + line_size);
-+#ifdef CONFIG_CACHE_L2
-+ n12_l2dcache_wbinval_range(start, start + line_size);
-+#endif
-+ }
-+ if (end != old_end) {
-+ n12_dcache_wbinval_range(end - line_size, end);
-+#ifdef CONFIG_CACHE_L2
-+ n12_l2dcache_wbinval_range(end - line_size, end);
-+#endif
-+ }
-+ n12_dcache_inval_range(start, end);
-+#ifdef CONFIG_CACHE_L2
-+ unsigned long p_start = __pa(start);
-+ unsigned long p_end = __pa(end);
-+ unsigned long cmd;
-+ //TODO Can Use PAGE Mode to optimize if range large than PAGE_SIZE
-+ line_size = L2_CACHE_LINE_SIZE();
-+ cmd =
-+ (p_start & ~(line_size - 1)) | CCTL_CMD_L2_PA_INVAL |
-+ CCTL_SINGLE_CMD;
-+ do {
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ cmd += line_size;
-+ p_start += line_size;
-+ } while (p_end > p_start);
-+ cmd = CCTL_CMD_L2_SYNC;
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ L2_CMD_RDY();
-+#endif
-+
-+}
-+
-+void n12_dma_wbinval_range(unsigned long start, unsigned long end)
-+{
-+ unsigned long line_size;
-+ line_size = L1_cache_info[DCACHE].line_size;
-+ start = start & (~(line_size - 1));
-+ end = (end + line_size - 1) & (~(line_size - 1));
-+ if (unlikely(start == end))
-+ return;
-+
-+ n12_dcache_wbinval_range(start, end);
-+#ifdef CONFIG_CACHE_L2
-+ {
-+ unsigned long p_start = __pa(start);
-+ unsigned long p_end = __pa(end);
-+ unsigned long cmd;
-+ //TODO Can Use PAGE Mode to optimize if range large than PAGE_SIZE
-+ line_size = L2_CACHE_LINE_SIZE();
-+ cmd =
-+ (p_start & ~(line_size - 1)) | CCTL_CMD_L2_PA_WBINVAL |
-+ CCTL_SINGLE_CMD;
-+ do {
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ cmd += line_size;
-+ p_start += line_size;
-+ } while (p_end > p_start);
-+ cmd = CCTL_CMD_L2_SYNC;
-+ L2_CMD_RDY();
-+ L2C_W_REG(L2_CCTL_CMD_OFF, cmd);
-+ L2_CMD_RDY();
-+
-+ }
-+#endif
-+}
-+
-+void n12_proc_init(void)
-+{
-+}
-+
-+void n12_proc_fin(void)
-+{
-+}
-+
-+void n12_do_idle(void)
-+{
-+ STANDBY(no_wake_grant);
-+}
-+
-+void n12_reset(unsigned long reset)
-+{
-+ GIE_DISABLE();
-+ SET_CACHE_CTL(GET_CACHE_CTL() &
-+ ~(CACHE_CTL_mskIC_EN | CACHE_CTL_mskDC_EN));
-+ n12_dcache_wbinval_all();
-+ n12_icache_inval_all();
-+
-+ __asm__ __volatile__("jr.toff %0\n\t"::"r"(reset));
-+}
-+
-+void n12_switch_mm(struct mm_struct *mm)
-+{
-+ unsigned long cid;
-+#ifndef CONFIG_CPU_NO_CONTEXT_ID
-+ cid = GET_TLB_MISC();
-+ cid = (cid & ~TLB_MISC_mskCID) | mm->context.id;
-+ SET_TLB_MISC(cid);
-+#endif
-+ SET_L1_PPTB(__pa(mm->pgd));
-+ //workaround N10 single-entry cache flush issue
-+ //the following line can be removed once the issue is fixed.
-+ __asm__ __volatile__("tlbop %0, INV"::"r"(cid));
-+ __nds32__isb();
-+#ifdef CONFIG_CPU_NO_CONTEXT_ID
-+ local_flush_tlb_mm(mm);
-+#endif
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/mm/tlb.c linux-3.4.113/arch/nds32/mm/tlb.c
---- linux-3.4.113.orig/arch/nds32/mm/tlb.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/mm/tlb.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,47 @@
-+#include <linux/spinlock_types.h>
-+#include <linux/mm.h>
-+#include <linux/sched.h>
-+#include <asm/nds32.h>
-+#include <nds32_intrinsic.h>
-+
-+unsigned int cpu_last_cid = { TLB_MISC_mskCID + (2 << TLB_MISC_offCID) };
-+
-+DEFINE_SPINLOCK(cid_lock);
-+
-+void local_flush_tlb_range(struct vm_area_struct *vma,
-+ unsigned long start, unsigned long end)
-+{
-+ unsigned long flags, ocid, ncid;
-+
-+ if ((end - start) > 0x400000) {
-+ asm("tlbop FLUA");
-+ __nds32__isb();
-+ return;
-+ }
-+
-+ spin_lock_irqsave(&cid_lock, flags);
-+ ocid = GET_TLB_MISC();
-+ ncid = (ocid & ~TLB_MISC_mskCID) | vma->vm_mm->context.id;
-+ SET_TLB_MISC(ncid);
-+ while (start < end) {
-+ asm("tlbop %0, INV"::"r"(start));
-+ __nds32__isb();
-+ start += PAGE_SIZE;
-+ }
-+ SET_TLB_MISC(ocid);
-+ spin_unlock_irqrestore(&cid_lock, flags);
-+}
-+
-+void local_flush_tlb_page(struct vm_area_struct *vma, unsigned long addr)
-+{
-+ unsigned long flags, ocid, ncid;
-+
-+ spin_lock_irqsave(&cid_lock, flags);
-+ ocid = GET_TLB_MISC();
-+ ncid = (ocid & ~TLB_MISC_mskCID) | vma->vm_mm->context.id;
-+ SET_TLB_MISC(ncid);
-+ asm("tlbop %0, INV"::"r"(addr));
-+ __nds32__isb();
-+ SET_TLB_MISC(ocid);
-+ spin_unlock_irqrestore(&cid_lock, flags);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/oprofile/common.c linux-3.4.113/arch/nds32/oprofile/common.c
---- linux-3.4.113.orig/arch/nds32/oprofile/common.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/oprofile/common.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,104 @@
-+/*
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 2004, 2005 Ralf Baechle
-+ * Copyright (C) 2005 MIPS Technologies, Inc.
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ */
-+#include <linux/errno.h>
-+#include <linux/init.h>
-+#include <linux/oprofile.h>
-+#include <linux/smp.h>
-+
-+#include "op_impl.h"
-+
-+extern struct op_nds32_model op_model_nds32_ops __attribute__ ((weak));
-+
-+static struct op_nds32_model *model;
-+
-+static struct op_counter_config ctr[20];
-+
-+static int op_nds32_setup(void)
-+{
-+ /* Pre-compute the values to stuff in the hardware registers. */
-+ model->reg_setup(ctr);
-+
-+ /* Configure the registers on all cpus. */
-+ on_each_cpu(model->cpu_setup, NULL, 1);
-+
-+ return 0;
-+}
-+
-+static int op_nds32_create_files(struct super_block *sb, struct dentry *root)
-+{
-+ int i;
-+
-+ for (i = 0; i < model->num_counters; ++i) {
-+ struct dentry *dir;
-+ char buf[4];
-+
-+ snprintf(buf, sizeof buf, "%d", i);
-+ dir = oprofilefs_mkdir(sb, root, buf);
-+
-+ oprofilefs_create_ulong(sb, dir, "enabled", &ctr[i].enabled);
-+ oprofilefs_create_ulong(sb, dir, "event", &ctr[i].event);
-+ oprofilefs_create_ulong(sb, dir, "count", &ctr[i].count);
-+ oprofilefs_create_ulong(sb, dir, "kernel", &ctr[i].kernel);
-+ oprofilefs_create_ulong(sb, dir, "user", &ctr[i].user);
-+ oprofilefs_create_ulong(sb, dir, "exl", &ctr[i].exl);
-+ /* Dummy. */
-+ oprofilefs_create_ulong(sb, dir, "unit_mask",
-+ &ctr[i].unit_mask);
-+ }
-+
-+ return 0;
-+}
-+
-+static int op_nds32_start(void)
-+{
-+ on_each_cpu(model->cpu_start, NULL, 1);
-+
-+ return 0;
-+}
-+
-+static void op_nds32_stop(void)
-+{
-+ /* Disable performance monitoring for all counters. */
-+ on_each_cpu(model->cpu_stop, NULL, 1);
-+}
-+
-+int __init oprofile_arch_init(struct oprofile_operations *ops)
-+{
-+ struct op_nds32_model *lmodel = NULL;
-+ int res;
-+
-+ lmodel = &op_model_nds32_ops;
-+
-+ if (!lmodel)
-+ return -ENODEV;
-+
-+ res = lmodel->init();
-+ if (res)
-+ return res;
-+
-+ model = lmodel;
-+
-+ ops->create_files = op_nds32_create_files;
-+ ops->setup = op_nds32_setup;
-+ ops->start = op_nds32_start;
-+ ops->stop = op_nds32_stop;
-+ ops->cpu_type = lmodel->cpu_type;
-+
-+ printk(KERN_INFO "oprofile: using %s performance monitoring.\n",
-+ lmodel->cpu_type);
-+
-+ return 0;
-+}
-+
-+void oprofile_arch_exit(void)
-+{
-+ if (model)
-+ model->exit();
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/oprofile/Makefile linux-3.4.113/arch/nds32/oprofile/Makefile
---- linux-3.4.113.orig/arch/nds32/oprofile/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/oprofile/Makefile 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,11 @@
-+EXTRA_CFLAGS :=
-+
-+obj-$(CONFIG_OPROFILE) += oprofile.o
-+
-+DRIVER_OBJS = $(addprefix ../../../drivers/oprofile/, \
-+ oprof.o cpu_buffer.o buffer_sync.o \
-+ event_buffer.o oprofile_files.o \
-+ oprofilefs.o oprofile_stats.o \
-+ timer_int.o )
-+
-+oprofile-y := $(DRIVER_OBJS) common.o op_model_nds32.o
-diff -Nur linux-3.4.113.orig/arch/nds32/oprofile/op_impl.h linux-3.4.113/arch/nds32/oprofile/op_impl.h
---- linux-3.4.113.orig/arch/nds32/oprofile/op_impl.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/oprofile/op_impl.h 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,42 @@
-+/**
-+ * @file arch/alpha/oprofile/op_impl.h
-+ *
-+ * @remark Copyright 2002 OProfile authors
-+ * @remark Read the file COPYING
-+ *
-+ * @author Richard Henderson <rth@twiddle.net>
-+ */
-+
-+#ifndef OP_IMPL_H
-+#define OP_IMPL_H 1
-+
-+struct pt_regs;
-+
-+extern int null_perf_irq(struct pt_regs *regs);
-+extern int (*perf_irq)(struct pt_regs *regs);
-+
-+/* Per-counter configuration as set via oprofilefs. */
-+struct op_counter_config {
-+ unsigned long enabled;
-+ unsigned long event;
-+ unsigned long count;
-+ /* Dummies because I am too lazy to hack the userspace tools. */
-+ unsigned long kernel;
-+ unsigned long user;
-+ unsigned long exl;
-+ unsigned long unit_mask;
-+};
-+
-+/* Per-architecture configury and hooks. */
-+struct op_nds32_model {
-+ void (*reg_setup) (struct op_counter_config *);
-+ void (*cpu_setup) (void * dummy);
-+ int (*init)(void);
-+ void (*exit)(void);
-+ void (*cpu_start)(void *args);
-+ void (*cpu_stop)(void *args);
-+ char *cpu_type;
-+ unsigned char num_counters;
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/oprofile/op_model_nds32.c linux-3.4.113/arch/nds32/oprofile/op_model_nds32.c
---- linux-3.4.113.orig/arch/nds32/oprofile/op_model_nds32.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/oprofile/op_model_nds32.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,400 @@
-+/*
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ *
-+ * Copyright (C) 2004, 2005 by Ralf Baechle
-+ * Copyright (C) 2005 by MIPS Technologies, Inc.
-+ * Copyright (C) 2007 Andes Technology Corporation
-+ */
-+#include <linux/oprofile.h>
-+#include <linux/interrupt.h>
-+#include <linux/smp.h>
-+#include <asm/irq_regs.h>
-+#include <asm/nds32.h>
-+#include <asm/uaccess.h>
-+#include <asm/pfm.h>
-+
-+#include "op_impl.h"
-+
-+#ifdef CONFIG_PLAT_AG102
-+#include <asm/amic.h>
-+#define NDS32_PERFCNTR_IRQA 23
-+#define NDS32_PERFCNTR_IRQB 22
-+#else
-+#define NDS32_PERFCNTR_IRQA 10
-+#endif
-+#define NDS32_PERFCTL_EN(num) (1 << num)
-+#define NDS32_PERFCTL_INTEN (1UL << 3)
-+#define NDS32_PERFCTL_OVERFLOW (1UL << 6)
-+#define NDS32_PERFCTL_NOKERNEL (1UL << 9)
-+#define NDS32_PERFCTL_NOUSER (1UL << 12)
-+#define NDS32_PERFCTL_EVENT_0(event) (event << 15)
-+#define NDS32_PERFCTL_EVENT_1(event) (event << 16)
-+#define NDS32_PERFCTL_EVENT_2(event) (event << 22)
-+
-+static unsigned long long ov0, ov1, ov2;
-+static int syscall = 0;
-+
-+struct pmu_counter {
-+ volatile unsigned long ovf;
-+ unsigned long reset_counter;
-+};
-+
-+enum { PFMC0, PFMC1, PFMC2, MAX_COUNTERS };
-+
-+static struct pmu_counter results[MAX_COUNTERS];
-+
-+static inline unsigned int read_perfcntr(int counter)
-+{
-+ switch (counter) {
-+ case PFMC0:
-+ return GET_PFMC0();
-+ break;
-+ case PFMC1:
-+ return GET_PFMC1();
-+ break;
-+ case PFMC2:
-+ return GET_PFMC2();
-+ break;
-+ default:
-+ printk(KERN_ERR
-+ "Oprofile read_perfcntr: CPU has no %d performance counters\n",
-+ counter);
-+ }
-+
-+ return 0;
-+}
-+
-+static inline unsigned int read_perfctrl(void)
-+{
-+ return GET_PFM_CTL();
-+}
-+
-+static inline void write_perfcntr(int counter, unsigned int value)
-+{
-+ switch (counter) {
-+ case PFMC0:
-+ SET_PFMC0(value);
-+ break;
-+ case PFMC1:
-+ SET_PFMC1(value);
-+ break;
-+ case PFMC2:
-+ SET_PFMC2(value);
-+ break;
-+ default:
-+ printk(KERN_ERR
-+ "Oprofile write_perfcntr: CPU has no %d performance counters\n",
-+ counter);
-+ }
-+}
-+
-+static inline void write_perfctrl(unsigned int value)
-+{
-+ SET_PFM_CTL(value);
-+}
-+
-+struct op_nds32_model op_model_nds32_ops;
-+
-+static struct nds32_register_config {
-+ unsigned int control[3];
-+ unsigned int counter[3];
-+} reg;
-+
-+/* Compute all of the registers in preparation for enabling profiling. */
-+
-+static void nds32_reg_setup(struct op_counter_config *ctr)
-+{
-+ unsigned int counters = op_model_nds32_ops.num_counters;
-+ int i;
-+
-+ /* Compute the performance counter control word. */
-+ /* For now count kernel and user mode */
-+ for (i = 0; i < counters; i++) {
-+ reg.control[i] = 0;
-+ reg.counter[i] = 0;
-+
-+ if (!ctr[i].enabled)
-+ continue;
-+
-+ switch (i) {
-+ case 0:
-+ reg.control[i] = NDS32_PERFCTL_EVENT_0(ctr[i].event) |
-+ (NDS32_PERFCTL_INTEN << i);
-+ break;
-+ case 1:
-+ reg.control[i] = NDS32_PERFCTL_EVENT_1(ctr[i].event) |
-+ (NDS32_PERFCTL_INTEN << i);
-+ break;
-+ case 2:
-+ reg.control[i] = NDS32_PERFCTL_EVENT_2(ctr[i].event) |
-+ (NDS32_PERFCTL_INTEN << i);
-+ break;
-+ default:
-+ printk(KERN_ERR
-+ "Oprofile nds32_reg_setup: CPU has no %d performance counters\n",
-+ i);
-+ }
-+ if (!(ctr[i].kernel))
-+ reg.control[i] |= (NDS32_PERFCTL_NOKERNEL << i);
-+ if (!(ctr[i].user))
-+ reg.control[i] |= (NDS32_PERFCTL_NOUSER << i);
-+ reg.counter[i] = -ctr[i].count;
-+ }
-+}
-+
-+/* Program all of the registers in preparation for enabling profiling. */
-+
-+static void nds32_cpu_setup(void *args)
-+{
-+ unsigned int counters = op_model_nds32_ops.num_counters;
-+
-+ switch (counters) {
-+ case 3:
-+ write_perfcntr(2, reg.counter[2]);
-+ case 2:
-+ write_perfcntr(1, reg.counter[1]);
-+ case 1:
-+ write_perfcntr(0, reg.counter[0]);
-+ }
-+ write_perfctrl(0);
-+}
-+
-+/* Start all counters on current CPU */
-+static void nds32_cpu_start(void *args)
-+{
-+ unsigned int counters = op_model_nds32_ops.num_counters;
-+ unsigned int value = 0;
-+
-+ switch (counters) {
-+ case 3:
-+ if (reg.control[2])
-+ value |= (NDS32_PERFCTL_EN(2) | reg.control[2]);
-+ case 2:
-+ if (reg.control[1])
-+ value |= (NDS32_PERFCTL_EN(1) | reg.control[1]);
-+ case 1:
-+ if (reg.control[0])
-+ value |= (NDS32_PERFCTL_EN(0) | reg.control[0]);
-+ }
-+ write_perfctrl(value);
-+}
-+
-+/* Stop all counters on current CPU */
-+static void nds32_cpu_stop(void *args)
-+{
-+ write_perfctrl(0);
-+}
-+
-+static irqreturn_t nds32_perfcount_handler(int irq, void *dev_id)
-+{
-+ unsigned int control, i;
-+
-+ control = read_perfctrl();
-+ write_perfctrl(0);
-+
-+ if (syscall) {
-+ if (control & PFM_CTL_mskOVF0)
-+ ov0++;
-+ if (control & PFM_CTL_mskOVF1)
-+ ov1++;
-+ if (control & PFM_CTL_mskOVF2)
-+ ov2++;
-+ } else {
-+ for (i = 0; i < MAX_COUNTERS; i++) {
-+ if ((control & (NDS32_PERFCTL_INTEN << i))
-+ && (control & (NDS32_PERFCTL_OVERFLOW << i))) {
-+ oprofile_add_sample(get_irq_regs(), i);
-+ write_perfcntr(i, reg.counter[i]);
-+ break;
-+ }
-+ }
-+ }
-+ write_perfctrl(control);
-+
-+ return IRQ_HANDLED;
-+}
-+
-+static inline int n_counters(void)
-+{
-+ return 3;
-+}
-+
-+static inline void reset_counters(int counters)
-+{
-+ switch (counters) {
-+ case 3:
-+ write_perfcntr(2, 0);
-+ case 2:
-+ write_perfcntr(1, 0);
-+ case 1:
-+ write_perfcntr(0, 0);
-+ }
-+ write_perfctrl(0);
-+}
-+
-+static int __init nds32_init(void)
-+{
-+ int counters, ret;
-+
-+ counters = n_counters();
-+ if (counters == 0) {
-+ printk(KERN_ERR "Oprofile: CPU has no performance counters\n");
-+ return -ENODEV;
-+ }
-+
-+ reset_counters(counters);
-+
-+ op_model_nds32_ops.num_counters = counters;
-+ op_model_nds32_ops.cpu_type = "nds32";
-+
-+ ret =
-+ request_irq(NDS32_PERFCNTR_IRQA, nds32_perfcount_handler,
-+ IRQF_SHARED, "NDS32 PERFCNTR", (void *)results);
-+ if (ret < 0) {
-+ printk(KERN_ERR "oprofile: unable to request IRQ%d\n",
-+ NDS32_PERFCNTR_IRQA);
-+ return ret;
-+ }
-+#ifdef CONFIG_PLAT_AG102
-+ unsigned int tmp;
-+ /* Set NDS32_PERFCNTR_IRQA to bind on core A */
-+ tmp =
-+ *(volatile unsigned long *)(AMIC_VA_BASE + CPUID0 +
-+ ((NDS32_PERFCNTR_IRQA >> 4) << 2));
-+ tmp &= ~(0x11 << ((NDS32_PERFCNTR_IRQA & ~0x10) * 2));
-+ *(volatile unsigned long *)(AMIC_VA_BASE + CPUID0 +
-+ ((NDS32_PERFCNTR_IRQA >> 4) << 2)) = tmp;
-+ tmp =
-+ (*(volatile unsigned long *)(AMIC_VA_BASE + CPUDC)) & ~(1 <<
-+ NDS32_PERFCNTR_IRQA);
-+ *(volatile unsigned long *)(AMIC_VA_BASE + CPUDC) = tmp;
-+
-+ ret =
-+ request_irq(NDS32_PERFCNTR_IRQB, nds32_perfcount_handler,
-+ IRQF_SHARED, "NDS32 PERFCNTR", (void *)results);
-+ if (ret < 0) {
-+ printk(KERN_ERR "oprofile: unable to request IRQ%d\n",
-+ NDS32_PERFCNTR_IRQB);
-+ return ret;
-+ }
-+ /* Set NDS32_PERFCNTR_IRQB to bind on core B */
-+ tmp =
-+ *(volatile unsigned long *)(AMIC_VA_BASE + CPUID0 +
-+ ((NDS32_PERFCNTR_IRQB >> 4) << 2));
-+ tmp &= ~(0x11 << ((NDS32_PERFCNTR_IRQB & ~0x10) * 2));
-+ tmp |= 1 << ((NDS32_PERFCNTR_IRQB & ~0x10) * 2);
-+ *(volatile unsigned long *)(AMIC_VA_BASE + CPUID0 +
-+ ((NDS32_PERFCNTR_IRQB >> 4) << 2)) = tmp;
-+ tmp =
-+ (*(volatile unsigned long *)(AMIC_VA_BASE + CPUDC)) & ~(1 <<
-+ NDS32_PERFCNTR_IRQB);
-+ *(volatile unsigned long *)(AMIC_VA_BASE + CPUDC) = tmp;
-+#endif
-+
-+ return 0;
-+}
-+
-+static void nds32_exit(void)
-+{
-+ reset_counters(op_model_nds32_ops.num_counters);
-+
-+ free_irq(NDS32_PERFCNTR_IRQA, results);
-+#ifdef CONFIG_PLAT_AG102
-+ free_irq(NDS32_PERFCNTR_IRQB, results);
-+#endif
-+}
-+
-+void sys_pfmctl(int event0, int event1, int event2, int start)
-+{
-+ unsigned int ctl = 0;
-+
-+ if (start) {
-+ syscall = 1;
-+ if (event0 >= 0)
-+ ctl |=
-+ (NDS32_PERFCTL_EVENT_0(event0) |
-+ (NDS32_PERFCTL_INTEN << 0) | NDS32_PERFCTL_EN(0));
-+ if (event1 >= 0)
-+ ctl |=
-+ (NDS32_PERFCTL_EVENT_1(event1) |
-+ (NDS32_PERFCTL_INTEN << 1) | NDS32_PERFCTL_EN(1));
-+ if (event2 >= 0)
-+ ctl |=
-+ (NDS32_PERFCTL_EVENT_2(event2) |
-+ (NDS32_PERFCTL_INTEN << 2) | NDS32_PERFCTL_EN(2));
-+ } else {
-+ syscall = 0;
-+ if (event0 >= 0)
-+ ctl &=
-+ ~((NDS32_PERFCTL_INTEN << 0) | NDS32_PERFCTL_EN(0));
-+ if (event1 >= 0)
-+ ctl &=
-+ ~((NDS32_PERFCTL_INTEN << 1) | NDS32_PERFCTL_EN(1));
-+ if (event2 >= 0)
-+ ctl &=
-+ ~((NDS32_PERFCTL_INTEN << 2) | NDS32_PERFCTL_EN(2));
-+ }
-+
-+ write_perfctrl(ctl);
-+
-+}
-+
-+int sys_getpfm(struct pcounter __user * p)
-+{
-+ struct pcounter pfm;
-+ unsigned int control;
-+
-+ control = read_perfctrl();
-+ write_perfctrl(0);
-+
-+ pfm.pfm0 = ov0 << 32 | GET_PFMC0();
-+ pfm.pfm1 = ov1 << 32 | GET_PFMC1();
-+ pfm.pfm2 = ov2 << 32 | GET_PFMC2();
-+
-+ if (copy_to_user(p, &pfm, sizeof(pfm)))
-+ return -EFAULT;
-+
-+ write_perfctrl(control);
-+
-+ return 0;
-+}
-+
-+int sys_setpfm(int pfm0, int pfm1, int pfm2, struct pcounter __user * p)
-+{
-+ struct pcounter pfm;
-+ unsigned int control;
-+
-+ control = read_perfctrl();
-+ write_perfctrl(0);
-+
-+ if (copy_from_user(&pfm, p, sizeof(pfm)))
-+ return -EFAULT;
-+
-+ if (pfm0) {
-+ SET_PFMC0((unsigned int)(pfm.pfm0 & 0xffffffff));
-+ ov0 = pfm.pfm0 >> 32;
-+ }
-+ if (pfm1) {
-+ SET_PFMC1((unsigned int)(pfm.pfm1 & 0xffffffff));
-+ ov1 = pfm.pfm1 >> 32;
-+ }
-+ if (pfm2) {
-+ SET_PFMC2((unsigned int)(pfm.pfm2 & 0xffffffff));
-+ ov2 = pfm.pfm2 >> 32;
-+ }
-+
-+ write_perfctrl(control);
-+
-+ return 0;
-+}
-+
-+struct op_nds32_model op_model_nds32_ops = {
-+ .reg_setup = nds32_reg_setup,
-+ .cpu_setup = nds32_cpu_setup,
-+ .init = nds32_init,
-+ .exit = nds32_exit,
-+ .cpu_start = nds32_cpu_start,
-+ .cpu_stop = nds32_cpu_stop,
-+};
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/cpu-fcs.c linux-3.4.113/arch/nds32/platforms/ag101/cpu-fcs.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/cpu-fcs.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/cpu-fcs.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,401 @@
-+/*
-+ * linux/arch/nds32/platforms/ag101/cpu-fcs.c
-+ *
-+ * Copyright (C) 2002,2003 Intrinsyc Software
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * History:
-+ * 31-Jul-2002 : Initial version [FB]
-+ * 29-Jan-2003 : added PXA255 support [FB]
-+ * 20-Apr-2003 : ported to v2.5 (Dustin McIntire, Sensoria Corp.)
-+ * 18-Jun-2008 : ported to NDS32 architecture ( Roy Lee, Andestech Corp.)
-+ *
-+ * Note:
-+ * This driver may change the memory bus clock rate, but will not do any
-+ * platform specific access timing changes... for example if you have flash
-+ * memory connected to CS0, you will need to register a platform specific
-+ * notifier which will adjust the memory access strobes to maintain a
-+ * minimum strobe width.
-+ *
-+ */
-+#include <linux/module.h>
-+#include <linux/cpufreq.h>
-+#include <linux/interrupt.h>
-+
-+#include <asm/hardware.h>
-+#include <asm/localmem.h>
-+#include <asm/system.h>
-+#include <asm/nds32.h>
-+#include <asm/irq_regs.h>
-+
-+#define NDS32_FCS_IRQ 8
-+#define AG101_MIN_FREQ 100000
-+#define AG101_MAX_FREQ 400000
-+#define OSC_KHZ 10000 /* 10 MHz AG101 */
-+
-+#define USE_CACHE 0
-+struct ag101_freq_struct {
-+
-+ unsigned int khz; /* cpu_clk in khz */
-+ unsigned int pll; /* pll mul */
-+ unsigned int div; /* ahb div */
-+ unsigned int frange; /* pll1 freq range */
-+};
-+
-+struct ag101_freq_struct ag101_run_freqs[] = {
-+
-+ /* khz , pll, div, frange pll/cpu/ahb/apb */
-+ {100000, 10, 2, 0}, /* 400/400/050/025 */
-+ {200000, 20, 4, 1}, /* 400/400/050/025 */
-+ {300000, 30, 6, 2}, /* 400/400/050/025 */
-+ {400000, 40, 8, 2}, /* 400/400/050/025 */
-+ {500000, 50, 10, 3}, /* 500/500/050/025 */
-+ {0,}
-+};
-+
-+#define NUM_RUN_FREQS ARRAY_SIZE( ag101_run_freqs)
-+static struct cpufreq_frequency_table ag101_run_freq_table[NUM_RUN_FREQS + 1];
-+
-+/* Use the turbo mode frequencies for the CPUFREQ_POLICY_POWERSAVE policy */
-+static struct ag101_freq_struct ag101_turbo_freqs[] = {
-+
-+ /* khz , pll, div, frange pll/cpu/ahb/apb */
-+ {100000, 10, 2, 0}, /* 400/400/050/025 */
-+ {200000, 20, 4, 1}, /* 400/400/050/025 */
-+ {300000, 30, 6, 2}, /* 400/400/050/025 */
-+ {400000, 40, 8, 2}, /* 400/400/050/025 */
-+ {500000, 50, 10, 3}, /* 500/500/050/025 */
-+ {0,}
-+};
-+
-+#define NUM_TURBO_FREQS ARRAY_SIZE( ag101_turbo_freqs)
-+static struct cpufreq_frequency_table ag101_turbo_freq_table[NUM_TURBO_FREQS +
-+ 1];
-+
-+/* Generic helper function get CPU clocks in kHz */
-+unsigned int ag101_cpufreq_get(unsigned int dummy)
-+{
-+
-+ unsigned int mul = (REG32(PMU_FTPMU010_VA_BASE + 0x30) >> 3UL) & 0x01ff; /* pll1 mul */
-+ return OSC_KHZ * mul;
-+}
-+
-+/* find a valid frequency point */
-+static int ag101_verify_policy(struct cpufreq_policy *policy)
-+{
-+
-+ struct cpufreq_frequency_table *ag101_freqs_table;
-+
-+ if (policy->policy == CPUFREQ_POLICY_PERFORMANCE) {
-+
-+ ag101_freqs_table = ag101_run_freq_table;
-+ } else if (policy->policy == CPUFREQ_POLICY_POWERSAVE) {
-+
-+ ag101_freqs_table = ag101_turbo_freq_table;
-+ } else {
-+ printk
-+ ("CPU PXA: Unknown policy found. Using CPUFREQ_POLICY_PERFORMANCE\n");
-+ ag101_freqs_table = ag101_run_freq_table;
-+ }
-+
-+ printk("Verified CPU policy: %dKhz min to %dKhz max\n", policy->min,
-+ policy->max);
-+
-+ return cpufreq_frequency_table_verify(policy, ag101_freqs_table);
-+}
-+
-+static int cal_edivahbclk(int div)
-+{
-+
-+ switch (div) {
-+
-+ case 1:
-+ case 2:
-+ case 3:
-+ case 4:
-+ case 5:
-+ case 6:
-+ return --div;
-+ case 8:
-+ return 8;
-+ case 10:
-+ return 9;
-+ case 12:
-+ return 10;
-+ case 14:
-+ return 11;
-+ case 15:
-+ return 12;
-+ case 18:
-+ return 13;
-+ case 20:
-+ return 14;
-+ default:
-+ printk("Error: No such CPU/AHB frequency ratio %d", div);
-+ }
-+
-+ return 9;
-+}
-+
-+void start_fcs(unsigned int pll, unsigned int frange, unsigned int div)
-+{
-+
-+ /* PDLLCR0 */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x30) &= ~0x00003ff8; /* clear PLL1NS and PLL1FRANG fields */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x30) |= (pll << 3); /* set PLL1NS */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x30) |= (frange << 12); /* set PLL1FRANG */
-+
-+ /* PMODE */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) &= ~0x000000ff; /* clear EDIVAHBCLK field */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) |= (div << 4); /* set EDIVAHBCLK [7:4] */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) |= (1UL << 2); /* [2]: FCS */
-+
-+ __asm__ __volatile__("msync all");
-+ __asm__ __volatile__("isb");
-+ __asm__ __volatile__("standby wake_grant");
-+ REG32(PMU_FTPMU010_VA_BASE + 0x30) |= (1UL << 16); /* PDLLCR0 bit[16]==1:disable dll */
-+}
-+
-+void end_fcs(void)
-+{
-+
-+ /* Leave this function as a place marker. */
-+}
-+
-+static int nds32_fcs_handler(int irq, void *dev_id)
-+{
-+
-+ REG32(PMU_FTPMU010_VA_BASE + 0x20) = (1UL << 17); /* Clear IntFCS PMSR[17] */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) &= ~(1UL << 2); /* Power Mode Register */
-+
-+ return 1;
-+}
-+
-+static int ag101_speedstep(int idx)
-+{
-+
-+ unsigned int pll, frange, div;
-+ unsigned long flags = 0;
-+ int irq, saved_irq_mask;
-+ void (*do_fcs) (unsigned int pll, unsigned int frange,
-+ unsigned int div);
-+
-+#if USE_CACHE
-+
-+ int i;
-+ int line_size = CACHE_LINE_SIZE(ICACHE);
-+ unsigned long start = ((unsigned long)start_fcs) & ~(line_size - 1);
-+ unsigned long end =
-+ (((unsigned long)end_fcs) + line_size) & ~(line_size - 1);
-+
-+ printk("&start_fcs(): 0x%08lx, aligned to: 0x%08lx\n",
-+ (unsigned long)start_fcs, start);
-+ printk("&end_fcs(): 0x%08lx, aligned to: 0x%08lx\n",
-+ (unsigned long)end_fcs, end);
-+
-+ for (i = start; i <= end; i += CACHE_LINE_SIZE(ICACHE))
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_FILLCK"::
-+ "r" (i):"memory");
-+
-+ do_fcs = start_fcs;
-+#else
-+ unsigned long buf, aligned_buf, len = PAGE_SIZE;
-+
-+ buf = (unsigned long)kmalloc(0x100000 + 1000, GFP_KERNEL);
-+ if (!buf)
-+ printk("Error: kmalloc( base) failed\n");
-+
-+ aligned_buf = (buf + 0x100000 - 1) & 0xFFF00000;
-+
-+ if (sys_lmmap(LM_ILM, aligned_buf, aligned_buf + 0x1000, 0, NULL)) {
-+ printk("Error: lmmap failed, can't scale frequency.\n");
-+#ifdef CONFIG_CPU_FREQ_DEBUG
-+ WARN_ON(1);
-+#endif
-+ return 0;
-+ }
-+
-+ if (((GET_ILMB() & ILMB_mskILMSZ) >> ILMB_offILMSZ) == 9)
-+ len = 0x400;
-+ else if (((GET_ILMB() & ILMB_mskILMSZ) >> ILMB_offILMSZ) == 10)
-+ len = 0x800;
-+ memcpy((unsigned char *)aligned_buf, (unsigned char *)start_fcs, len);
-+
-+ do_fcs = (void *)aligned_buf;
-+#endif
-+ pll = ag101_run_freqs[idx].pll;
-+ div = cal_edivahbclk(ag101_run_freqs[idx].div);
-+ frange = ag101_run_freqs[idx].frange;
-+
-+ irq =
-+ request_irq(NDS32_FCS_IRQ, nds32_fcs_handler,
-+ IRQF_DISABLED | IRQF_TRIGGER_FALLING,
-+ "NDS32 Frequency Change Sequence",
-+ (void *)ag101_run_freqs);
-+ if (irq < 0)
-+ printk(KERN_ERR "Error: unable to request FCS IRQ%d\n",
-+ NDS32_FCS_IRQ);
-+
-+ local_irq_save(flags);
-+
-+ saved_irq_mask = REG32(INTC_FTINTC010_VA_BASE + 0x04);
-+ REG32(INTC_FTINTC010_VA_BASE + 0x04) = (1UL << NDS32_FCS_IRQ);
-+
-+ do_fcs(pll, frange, div);
-+
-+ REG32(INTC_FTINTC010_VA_BASE + 0x04) = saved_irq_mask;
-+
-+ local_irq_restore(flags);
-+ free_irq(NDS32_FCS_IRQ, ag101_run_freqs);
-+
-+#if USE_CACHE
-+ for (i = start; i <= end; i += CACHE_LINE_SIZE(ICACHE))
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_ULCK"::"r" (i):"memory");
-+#else
-+ if (sys_lmunmap(aligned_buf, 0))
-+ printk("Error: lmunmap failed\n");
-+
-+ kfree((void *)buf);
-+#endif
-+ return 1;
-+}
-+
-+static int ag101_set_target(struct cpufreq_policy *policy,
-+ unsigned int target_freq, unsigned int relation)
-+{
-+
-+ unsigned int idx;
-+ struct cpufreq_frequency_table *ag101_freqs_table;
-+ struct ag101_freq_struct *ag101_freq_settings;
-+ struct cpufreq_freqs freqs;
-+
-+ /* Get the current policy */
-+ if (policy->policy == CPUFREQ_POLICY_PERFORMANCE) {
-+
-+ ag101_freq_settings = ag101_run_freqs;
-+ ag101_freqs_table = ag101_run_freq_table;
-+ } else if (policy->policy == CPUFREQ_POLICY_POWERSAVE) {
-+
-+ ag101_freq_settings = ag101_turbo_freqs;
-+ ag101_freqs_table = ag101_turbo_freq_table;
-+ } else {
-+ printk
-+ ("Unknown FCS policy found. Using CPUFREQ_POLICY_PERFORMANCE\n");
-+ ag101_freq_settings = ag101_run_freqs;
-+ ag101_freqs_table = ag101_run_freq_table;
-+ }
-+
-+ /* Lookup the next frequency */
-+ if (cpufreq_frequency_table_target
-+ (policy, ag101_freqs_table, target_freq, relation, &idx))
-+ return -EINVAL;
-+
-+ freqs.old = policy->cur;
-+ freqs.new = ag101_freq_settings[idx].khz;
-+ freqs.cpu = policy->cpu;
-+
-+ /*
-+ * Tell everyone what we're about to do...
-+ * you should add a notify client with any platform specific
-+ * Vcc changing capability
-+ */
-+ cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
-+
-+ if (freqs.new != freqs.old) {
-+ if (!ag101_speedstep(idx))
-+ return -ENODEV;
-+ }
-+
-+ /*
-+ * Tell everyone what we've just done...
-+ * you should add a notify client with any platform specific
-+ * SDRAM refresh timer adjustments
-+ */
-+ cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
-+
-+ return 0;
-+}
-+
-+static int ag101_cpufreq_init(struct cpufreq_policy *policy)
-+{
-+
-+ int i;
-+ /* set default policy and cpuinfo */
-+ policy->governor = CPUFREQ_DEFAULT_GOVERNOR;
-+ policy->policy = CPUFREQ_POLICY_PERFORMANCE;
-+ policy->cpuinfo.max_freq = AG101_MAX_FREQ;
-+ policy->cpuinfo.min_freq = AG101_MIN_FREQ;
-+ policy->cpuinfo.transition_latency = 1000; /* FIXME: 1 ms, assumed */
-+ policy->cur = ag101_cpufreq_get(0); /* current freq */
-+ policy->min = policy->max = policy->cur;
-+
-+ /* Generate the run cpufreq_frequency_table struct */
-+ for (i = 0; i < NUM_RUN_FREQS; i++) {
-+
-+ ag101_run_freq_table[i].frequency = ag101_run_freqs[i].khz;
-+ ag101_run_freq_table[i].index = i;
-+ }
-+
-+ ag101_run_freq_table[i].frequency = CPUFREQ_TABLE_END;
-+
-+ /* Generate the turbo cpufreq_frequency_table struct */
-+ for (i = 0; i < NUM_TURBO_FREQS; i++) {
-+
-+ ag101_turbo_freq_table[i].frequency = ag101_turbo_freqs[i].khz;
-+ ag101_turbo_freq_table[i].index = i;
-+ }
-+
-+ ag101_turbo_freq_table[i].frequency = CPUFREQ_TABLE_END;
-+
-+ printk("CPU frequency change support initialized\n");
-+
-+ return 0;
-+}
-+
-+static struct cpufreq_driver ag101_cpufreq_driver = {
-+
-+ .verify = ag101_verify_policy,
-+ .target = ag101_set_target,
-+ .init = ag101_cpufreq_init,
-+ .get = ag101_cpufreq_get,
-+ .name = "AG101",
-+};
-+
-+static int __init ag101_cpu_init(void)
-+{
-+
-+ if (CPU_IS_N1213_43U1HA0() || CPU_IS_N1213_43U1HB0()) {
-+
-+ /* Clear IntFS, IntFCS and irq8 */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x20) = (1UL << 16);
-+ return cpufreq_register_driver(&ag101_cpufreq_driver);
-+ } else
-+ return -ENODEV;
-+}
-+
-+static void __exit ag101_cpu_exit(void)
-+{
-+
-+ if (CPU_IS_N1213_43U1HA0() || CPU_IS_N1213_43U1HB0())
-+ cpufreq_unregister_driver(&ag101_cpufreq_driver);
-+}
-+
-+MODULE_AUTHOR("Andes Technology Corporation");
-+MODULE_DESCRIPTION("CPU frequency changing driver for the AG101 architecture");
-+MODULE_LICENSE("GPL");
-+module_init(ag101_cpu_init);
-+module_exit(ag101_cpu_exit);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/devices.c linux-3.4.113/arch/nds32/platforms/ag101/devices.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/devices.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/devices.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,94 @@
-+#include <linux/serial_8250.h>
-+#include <asm/mach-types.h>
-+#include <asm/sizes.h>
-+#include <asm/mach/arch.h>
-+#include <asm/mach/map.h>
-+#include <asm/spec.h>
-+#include <asm/intc.h>
-+#include <asm/timer.h>
-+
-+const struct map_desc platform_io_desc[] __initdata = {
-+ {UART0_VA_BASE, UART0_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {UART1_VA_BASE, UART1_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {INTC_FTINTC010_0_VA_BASE, INTC_FTINTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {TIMER_FTTMR010_0_VA_BASE, TIMER_FTTMR010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SSP_FTSSP010_0_VA_BASE, SSP_FTSSP010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {PMU_FTPMU010_0_VA_BASE, PMU_FTPMU010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {MAC_FTMAC100_0_VA_BASE, MAC_FTMAC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SDC_FTSDC010_0_VA_BASE, SDC_FTSDC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {RTC_FTRTC010_0_VA_BASE, RTC_FTRTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {WDT_FTWDT010_0_VA_BASE, WDT_FTWDT010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {GPIO_FTGPIO010_0_VA_BASE, GPIO_FTGPIO010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {CFC_FTCFC010_0_VA_BASE, CFC_FTCFC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {LCD_FTLCDC100_0_VA_BASE, LCD_FTLCDC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {I2C_FTI2C010_0_VA_BASE, I2C_FTI2C010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {DMAC_FTDMAC020_0_VA_BASE, DMAC_FTDMAC020_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {APBBRG_FTAPBBRG020S_0_VA_BASE, APBBRG_FTAPBBRG020S_0_PA_BASE,
-+ PAGE_SIZE, MT_DEVICE_NCB},
-+ {KMI_FTKBC010_0_VA_BASE, KMI_FTKBC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCNB},
-+ {KMI_FTKBC010_1_VA_BASE, KMI_FTKBC010_1_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCNB},
-+ {USB_FUSB220_0_VA_BASE, USB_FUSB220_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCNB},
-+ {PCIIO_0_VA_BASE, PCIIO_0_PA_BASE, 0x000FF000, MT_DEVICE_NCB},
-+ {PCIC_FTPCI100_0_VA_BASE, PCIC_FTPCI100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {LED_VA_BASE, LED_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {SDMC_FTSDMC021_VA_BASE, SDMC_FTSDMC021_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {L2CC_VA_BASE, L2CC_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB}
-+};
-+
-+static void __init platform_map_io(void)
-+{
-+ iotable_init((struct map_desc *)platform_io_desc,
-+ ARRAY_SIZE(platform_io_desc));
-+}
-+
-+static struct uart_port uart0 = {
-+ .membase = (void __iomem *)UART0_VA_BASE,
-+ .irq = UART0_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 0,
-+ .mapbase = UART0_PA_BASE,
-+};
-+
-+static struct uart_port uart1 = {
-+ .membase = (void __iomem *)UART1_VA_BASE,
-+ .irq = UART1_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 1,
-+ .mapbase = UART1_PA_BASE,
-+};
-+
-+void ag101_calc_ahb_clk(void);
-+static void __init soc_init(void)
-+{
-+ ag101_calc_ahb_clk();
-+ early_serial_setup(&uart0);
-+ early_serial_setup(&uart1);
-+}
-+
-+MACHINE_START(FARADAY, PLATFORM_NAME)
-+ .param_offset = BOOT_PARAMETER_PA_BASE,.map_io = platform_map_io,.init_irq = platform_init_irq,.timer = &platform_timer, /* defined in timer.c */
-+ .init_machine = soc_init, MACHINE_END
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/fia320.c linux-3.4.113/arch/nds32/platforms/ag101/fia320.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/fia320.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/fia320.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,103 @@
-+/*
-+ * linux/arch/nds32/platforms/ag101/fia320.c
-+ *
-+ * Faraday A320D Platform Dependent Functions
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/26/2005 Created
-+ * Peter Liao 09/29/2005 Port dynamically getting AHB clock
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/init.h>
-+#include <linux/pm.h>
-+#include <linux/sched.h>
-+#include <linux/irq.h>
-+
-+#include <asm/hardware.h>
-+#include <asm/spec.h>
-+
-+#ifdef CONFIG_AUTO_SYS_CLK
-+#include <nds32_intrinsic.h>
-+#define AG101B0 (0x0c020003)
-+
-+/*
-+ * Table for ahb divisor, PMODE[07:04]
-+ */
-+static const int ahb_div[16] = {
-+ 1, 2, 3, 4, 5, 6, 3, 5,
-+ 8, 10, 12, 14, 15, 18, 20, -1
-+};
-+
-+/* ag101_get_ahb_clk()
-+ *
-+ * return AHB clock in Hz.
-+ */
-+static int ahbclk;
-+void ag101_calc_ahb_clk(void)
-+{
-+ /*
-+ * FIXME: We should not put AG101 term in here, Harry@Oct.23.2007
-+ */
-+ const unsigned int osc = 10; // OSC in MHz
-+ unsigned int mul, div, cpu, pll;
-+ unsigned int ahb = 0; // ahb clk in Hz
-+ unsigned int cpu_ver;
-+
-+ mul = (REG32(PMU_FTPMU010_0_VA_BASE + 0x30) >> 3) & 0x01ff; // pll1 mul
-+ div = (REG32(PMU_FTPMU010_0_VA_BASE + 0x4) >> 8) & 0x000f; // pll1 div
-+ ahb = (REG32(PMU_FTPMU010_0_VA_BASE + 0x4) >> 4) & 0x000f; // ahb div
-+ div += 1;
-+
-+ pll = (osc * mul / div); // depend on OSC.
-+
-+ //AG101B0 PLL divider fix
-+ cpu_ver = __nds32__mfsr(NDS32_SR_CPU_VER);
-+ if (AG101B0 == cpu_ver)
-+ pll >>= 1;
-+
-+ if (-1 != ahb_div[ahb]) {
-+ if ((ahb == 6) || (ahb == 7)) // special cases for 3:2 & 5:2
-+ cpu = pll >> 1; // divide by 2
-+ else
-+ cpu = pll;
-+
-+ ahb = pll / ahb_div[ahb]; // become ahb clk in MHz.
-+
-+ printk("AG101 auto-detected AHB clock: CPU/AHB=%uMHz/%uMHz\n",
-+ cpu, ahb);
-+ ahb *= 1000000; // become ahb clk in Hz.
-+ ahbclk = (int)ahb;
-+ } else {
-+ printk("Unknown AHB divisor:0x%x\n", ahb);
-+ ahbclk = 0;
-+ }
-+
-+ ahbclk = (int)ahb;
-+}
-+
-+int ag101_get_ahb_clk(void)
-+{
-+ return ahbclk;
-+}
-+
-+EXPORT_SYMBOL(ag101_get_ahb_clk);
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/freq-scaling.c linux-3.4.113/arch/nds32/platforms/ag101/freq-scaling.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/freq-scaling.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/freq-scaling.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,367 @@
-+/*
-+ * linux/arch/nds32/platforms/ag101/cpu-fcs.c
-+ *
-+ * Copyright (C) 2002,2003 Intrinsyc Software
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * History:
-+ * 31-Jul-2002 : Initial version [FB]
-+ * 29-Jan-2003 : added PXA255 support [FB]
-+ * 20-Apr-2003 : ported to v2.5 (Dustin McIntire, Sensoria Corp.)
-+ * 18-Jun-2008 : ported to NDS32 architecture ( Roy Lee, Andestech Corp.)
-+ *
-+ * Note:
-+ * This driver may change the memory bus clock rate, but will not do any
-+ * platform specific access timing changes... for example if you have flash
-+ * memory connected to CS0, you will need to register a platform specific
-+ * notifier which will adjust the memory access strobes to maintain a
-+ * minimum strobe width.
-+ *
-+ */
-+#include <linux/module.h>
-+#include <linux/cpufreq.h>
-+#include <linux/interrupt.h>
-+
-+#include <asm/hardware.h>
-+#include <asm/localmem.h>
-+#include <asm/system.h>
-+#include <asm/nds32.h>
-+#include <asm/irq_regs.h>
-+
-+#define NDS32_FCS_IRQ 8
-+#define AG101_MIN_FREQ 70000
-+#define AG101_MAX_FREQ 420000
-+#define OSC_KHZ 10000 /* 10 MHz AG101 */
-+
-+#define USE_CACHE 0
-+struct ag101_freq_struct {
-+
-+ unsigned int khz; /* cpu_clk in khz */
-+ unsigned int sf; /* scaling factor */
-+ unsigned int cr; /* clock ratio */
-+};
-+
-+struct ag101_freq_struct ag101_run_freqs[] = {
-+
-+ /* khz , sf, cr pll/cpu/ahb/apb */
-+ {AG101_MAX_FREQ / 6, 6, 1}, /* 420/070/070/035 */
-+ {AG101_MAX_FREQ / 1, 1, 6}, /* 420/420/070/035 */
-+ {0}
-+};
-+
-+#define NUM_RUN_FREQS ARRAY_SIZE( ag101_run_freqs)
-+static struct cpufreq_frequency_table ag101_run_freq_table[NUM_RUN_FREQS + 1];
-+
-+/* Use the turbo mode frequencies for the CPUFREQ_POLICY_POWERSAVE policy */
-+static struct ag101_freq_struct ag101_turbo_freqs[] = {
-+
-+ /* khz , sf, cr pll/cpu/ahb/apb */
-+ {AG101_MAX_FREQ / 6, 6, 1}, /* 420/070/070/035 */
-+ {AG101_MAX_FREQ / 1, 1, 6}, /* 420/420/070/035 */
-+ {0}
-+};
-+
-+#define NUM_TURBO_FREQS ARRAY_SIZE( ag101_turbo_freqs)
-+static struct cpufreq_frequency_table ag101_turbo_freq_table[NUM_TURBO_FREQS +
-+ 1];
-+
-+/* Generic helper function get CPU clocks in kHz */
-+unsigned int ag101_cpufreq_get(unsigned int dummy)
-+{
-+
-+ unsigned int pll = (REG32(PMU_FTPMU010_VA_BASE + 0x30) >> 3UL) & 0x01ff; /* pll */
-+ unsigned int sf = (REG32(PMU_FTPMU010_VA_BASE + 0x0c) >> 8UL) & 0x0f; /* scaling factor */
-+
-+ return OSC_KHZ * pll / (sf + 1);
-+}
-+
-+/* find a valid frequency point */
-+static int ag101_verify_policy(struct cpufreq_policy *policy)
-+{
-+
-+ struct cpufreq_frequency_table *ag101_freqs_table;
-+
-+ if (policy->policy == CPUFREQ_POLICY_PERFORMANCE) {
-+
-+ ag101_freqs_table = ag101_run_freq_table;
-+ } else if (policy->policy == CPUFREQ_POLICY_POWERSAVE) {
-+
-+ ag101_freqs_table = ag101_turbo_freq_table;
-+ } else {
-+ printk
-+ ("CPU PXA: Unknown policy found. Using CPUFREQ_POLICY_PERFORMANCE\n");
-+ ag101_freqs_table = ag101_run_freq_table;
-+ }
-+
-+ printk("Verified CPU policy: %dKhz min to %dKhz max\n", policy->min,
-+ policy->max);
-+
-+ return cpufreq_frequency_table_verify(policy, ag101_freqs_table);
-+}
-+
-+void start_fcs(unsigned int sf, unsigned cr)
-+{
-+
-+ /* set EFSF in PMODE [11:8] */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) &= ~(0xfUL << 8);
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) |= (sf << 8);
-+
-+ /* set EDIVAHBCLK [7:4] */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) &= ~(0xffUL << 0);
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) |= (cr << 4);
-+
-+ /* PMR[1]: scaling mode */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) |= (1UL << 1);
-+
-+ __asm__ __volatile__("msync all");
-+ __asm__ __volatile__("isb");
-+ __asm__ __volatile__("standby wake_grant");
-+ // REG32( PMU_FTPMU010_VA_BASE + 0x30) |= ( 1UL << 16); /* PDLLCR0 bit[16]==1:disable dll */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x0c) &= ~(1UL << 1); /* Power Mode Register */
-+}
-+
-+void end_fcs(void)
-+{
-+
-+ /* Leave this function as a place marker. */
-+}
-+
-+static int cal_edivahbclk(int div)
-+{
-+
-+ switch (div) {
-+
-+ case 1:
-+ case 2:
-+ case 3:
-+ case 4:
-+ case 5:
-+ case 6:
-+ return --div;
-+ case 8:
-+ return 8;
-+ case 10:
-+ return 9;
-+ case 12:
-+ return 10;
-+ case 14:
-+ return 11;
-+ case 15:
-+ return 12;
-+ case 18:
-+ return 13;
-+ case 20:
-+ return 14;
-+ default:
-+ printk("Error: No such CPU/AHB frequency ratio %d", div);
-+ }
-+
-+ return 9;
-+}
-+
-+static int ag101_speedstep(int idx)
-+{
-+
-+ unsigned int sf, cr;
-+ unsigned long flags = 0;
-+ void (*do_fcs) (unsigned int efsf, unsigned int edivhbaclk);
-+
-+#if USE_CACHE
-+
-+ int i;
-+ int line_size = CACHE_LINE_SIZE(ICACHE);
-+ unsigned long start = ((unsigned long)start_fcs) & ~(line_size - 1);
-+ unsigned long end =
-+ (((unsigned long)end_fcs) + line_size) & ~(line_size - 1);
-+
-+ printk("&start_fcs(): 0x%08lx, aligned to: 0x%08lx\n",
-+ (unsigned long)start_fcs, start);
-+ printk("&end_fcs(): 0x%08lx, aligned to: 0x%08lx\n",
-+ (unsigned long)end_fcs, end);
-+
-+ for (i = start; i <= end; i += CACHE_LINE_SIZE(ICACHE))
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_FILLCK"::
-+ "r" (i):"memory");
-+
-+ do_fcs = start_fcs;
-+#else
-+ unsigned long buf, aligned_buf, len = PAGE_SIZE;
-+
-+ buf = (unsigned long)kmalloc(0x100000 + 1000, GFP_KERNEL);
-+ if (!buf)
-+ printk("Error: kmalloc( base) failed\n");
-+
-+ aligned_buf = (buf + 0x100000 - 1) & 0xFFF00000;
-+
-+ if (sys_lmmap(LM_ILM, aligned_buf, aligned_buf + 0x1000, 0, NULL)) {
-+ printk("Error: lmmap failed, can't scale frequency.\n");
-+#ifdef CONFIG_CPU_FREQ_DEBUG
-+ WARN_ON(1);
-+#endif
-+ return 0;
-+ }
-+
-+ if (((GET_ILMB() & ILMB_mskILMSZ) >> ILMB_offILMSZ) == 9)
-+ len = 0x400;
-+ else if (((GET_ILMB() & ILMB_mskILMSZ) >> ILMB_offILMSZ) == 10)
-+ len = 0x800;
-+ memcpy((unsigned char *)aligned_buf, (unsigned char *)start_fcs, len);
-+
-+ do_fcs = (void *)aligned_buf;
-+#endif
-+ sf = ag101_run_freqs[idx].sf - 1;
-+ cr = cal_edivahbclk(ag101_run_freqs[idx].cr);
-+
-+ local_irq_save(flags);
-+ do_fcs(sf, cr);
-+ local_irq_restore(flags);
-+
-+#if USE_CACHE
-+ for (i = start; i <= end; i += CACHE_LINE_SIZE(ICACHE))
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_ULCK"::"r" (i):"memory");
-+#else
-+ if (sys_lmunmap(aligned_buf, 0))
-+ printk("Error: lmunmap failed\n");
-+
-+ kfree((void *)buf);
-+#endif
-+ return 1;
-+}
-+
-+static int ag101_set_target(struct cpufreq_policy *policy,
-+ unsigned int target_freq, unsigned int relation)
-+{
-+
-+ unsigned int idx;
-+ struct cpufreq_frequency_table *ag101_freqs_table;
-+ struct ag101_freq_struct *ag101_freq_settings;
-+ struct cpufreq_freqs freqs;
-+
-+ /* Get the current policy */
-+ if (policy->policy == CPUFREQ_POLICY_PERFORMANCE) {
-+
-+ ag101_freq_settings = ag101_run_freqs;
-+ ag101_freqs_table = ag101_run_freq_table;
-+ } else if (policy->policy == CPUFREQ_POLICY_POWERSAVE) {
-+
-+ ag101_freq_settings = ag101_turbo_freqs;
-+ ag101_freqs_table = ag101_turbo_freq_table;
-+ } else {
-+ printk
-+ ("Unknown FCS policy found. Using CPUFREQ_POLICY_PERFORMANCE\n");
-+ ag101_freq_settings = ag101_run_freqs;
-+ ag101_freqs_table = ag101_run_freq_table;
-+ }
-+
-+ /* Lookup the next frequency */
-+ if (cpufreq_frequency_table_target
-+ (policy, ag101_freqs_table, target_freq, relation, &idx))
-+ return -EINVAL;
-+
-+ freqs.old = policy->cur;
-+ freqs.new = ag101_freq_settings[idx].khz;
-+ freqs.cpu = policy->cpu;
-+
-+ /*
-+ * Tell everyone what we're about to do...
-+ * you should add a notify client with any platform specific
-+ * Vcc changing capability
-+ */
-+ cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
-+
-+ if (freqs.new != freqs.old) {
-+
-+ if (!ag101_speedstep(idx))
-+ return -ENODEV;
-+ }
-+
-+ /*
-+ * Tell everyone what we've just done...
-+ * you should add a notify client with any platform specific
-+ * SDRAM refresh timer adjustments
-+ */
-+ cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
-+
-+ return 0;
-+}
-+
-+static int ag101_cpufreq_init(struct cpufreq_policy *policy)
-+{
-+
-+ int i;
-+ /* set default policy and cpuinfo */
-+ policy->governor = CPUFREQ_DEFAULT_GOVERNOR;
-+ policy->policy = CPUFREQ_POLICY_PERFORMANCE;
-+ policy->cpuinfo.max_freq = AG101_MAX_FREQ;
-+ policy->cpuinfo.min_freq = AG101_MIN_FREQ;
-+ policy->cpuinfo.transition_latency = 1000; /* FIXME: 1 ms, assumed */
-+ policy->cur = ag101_cpufreq_get(0); /* current freq */
-+ policy->min = policy->max = policy->cur;
-+
-+ /* Generate the run cpufreq_frequency_table struct */
-+ for (i = 0; i < NUM_RUN_FREQS; i++) {
-+
-+ ag101_run_freq_table[i].frequency = ag101_run_freqs[i].khz;
-+ ag101_run_freq_table[i].index = i;
-+ }
-+
-+ ag101_run_freq_table[i].frequency = CPUFREQ_TABLE_END;
-+
-+ /* Generate the turbo cpufreq_frequency_table struct */
-+ for (i = 0; i < NUM_TURBO_FREQS; i++) {
-+
-+ ag101_turbo_freq_table[i].frequency = ag101_turbo_freqs[i].khz;
-+ ag101_turbo_freq_table[i].index = i;
-+ }
-+
-+ ag101_turbo_freq_table[i].frequency = CPUFREQ_TABLE_END;
-+
-+ printk("CPU frequency change support initialized\n");
-+
-+ return 0;
-+}
-+
-+static struct cpufreq_driver ag101_cpufreq_driver = {
-+
-+ .verify = ag101_verify_policy,
-+ .target = ag101_set_target,
-+ .init = ag101_cpufreq_init,
-+ .get = ag101_cpufreq_get,
-+ .name = "AG101",
-+};
-+
-+static int __init ag101_cpu_init(void)
-+{
-+
-+ if (CPU_IS_N1213_43U1HA0() || CPU_IS_N1213_43U1HB0())
-+ return cpufreq_register_driver(&ag101_cpufreq_driver);
-+ else
-+ return -ENODEV;
-+}
-+
-+static void __exit ag101_cpu_exit(void)
-+{
-+
-+ if (CPU_IS_N1213_43U1HA0() || CPU_IS_N1213_43U1HB0())
-+ cpufreq_unregister_driver(&ag101_cpufreq_driver);
-+}
-+
-+MODULE_AUTHOR("Andes Technology Corporation");
-+MODULE_DESCRIPTION("CPU frequency changing driver for the AG101 architecture");
-+MODULE_LICENSE("GPL");
-+module_init(ag101_cpu_init);
-+module_exit(ag101_cpu_exit);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/Kconfig linux-3.4.113/arch/nds32/platforms/ag101/Kconfig
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/Kconfig 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,9 @@
-+menu "AG101 Platform Options"
-+
-+config AUTO_SYS_CLK
-+ bool "Automatic AHB Clock Detection"
-+ default y
-+ help
-+ Automatic detection of AHB clock
-+
-+endmenu
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/Makefile linux-3.4.113/arch/nds32/platforms/ag101/Makefile
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/Makefile 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,5 @@
-+obj-y = devices.o
-+obj-$(CONFIG_AUTO_SYS_CLK) += fia320.o
-+obj-$(CONFIG_PM) += pm.o sleep.o
-+obj-$(CONFIG_AG101_CPU_FREQ_FCS) += cpu-fcs.o
-+obj-$(CONFIG_AG101_CPU_FREQ_SCALING_MODE) += freq-scaling.o
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/pm.c linux-3.4.113/arch/nds32/platforms/ag101/pm.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/pm.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/pm.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,190 @@
-+/*
-+ * AG101 Power Management Routines
-+ *
-+ * Copyright (c) 2007 Harry Pan <harry@andestech.com>
-+ *
-+ * This program is free software; you can redistribute it and/or
-+ * modify it under the terms of the GNU General Public License.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for AG101 power management routines.
-+ * It is initail referred from 2.6.11 SA1100 PM driver.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.13.2007 Initial code by Harry.
-+ */
-+#include <linux/init.h>
-+#include <linux/suspend.h>
-+#include <linux/errno.h>
-+#include <linux/time.h>
-+#include <linux/delay.h>
-+
-+#include <asm/hardware.h>
-+#include <asm/memory.h>
-+#include <asm/system.h>
-+#include <asm/mach/time.h>
-+#include <asm/cacheflush.h>
-+
-+extern void ag101_cpu_sleep(void);
-+extern void ag101_cpu_resume(void);
-+extern void ag101_cpu_resume2(void);
-+
-+#include <asm/timer.h>
-+/*
-+ * AG101 PMU sleep mode handler.
-+ */
-+void ag101_pmu_sleep(void)
-+{
-+ int i;
-+ static int irq_saves[3];
-+
-+ irq_saves[0] = REG32(INTC_FTINTC010_VA_BASE + 0x4);
-+ irq_saves[1] = REG32(INTC_FTINTC010_VA_BASE + 0xc);
-+ irq_saves[2] = REG32(INTC_FTINTC010_VA_BASE + 0x10);
-+
-+ /* save SDRAM settings */
-+ for (i = 0; i < 0x30; i += 4)
-+ REG32(PMU_FTPMU010_VA_BASE + 0x50 + i) = REG32(SDMC_FTSDMC021_VA_BASE + i); //SDRAMC
-+
-+ /* set resume return address */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x88) =
-+ virt_to_phys(ag101_cpu_resume) | 0x10000000;
-+ REG32(PMU_FTPMU010_VA_BASE + 0x8c) = (u32) ag101_cpu_resume2;
-+ REG32(PMU_FTPMU010_VA_BASE + 0x80) = GET_L1_PPTB();
-+
-+ /* setup wakeup sources */
-+ REG32(PMU_FTPMU010_VA_BASE + 0x14) |= -1;
-+ REG32(PMU_FTPMU010_VA_BASE + 0x10) |= 0x1fff;
-+
-+ cpu_dcache_wbinval_all();
-+ cpu_icache_inval_all();
-+ SET_CACHE_CTL(GET_CACHE_CTL() & ~CACHE_CTL_mskDC_EN);
-+ ag101_cpu_sleep();
-+
-+#ifndef CONFIG_ANDES_PAGE_SIZE_8KB
-+
-+ if (CPU_IS_N1213_43U1HA0()) {
-+ int tmp = 0;
-+ /* Downsize cache to bypass cache aliasing issue */
-+
-+ if ((CACHE_SET(ICACHE) * CACHE_LINE_SIZE(ICACHE)) > 4096)
-+ tmp = 0x02 << SDZ_CTL_offICDZ;
-+
-+ if ((CACHE_SET(DCACHE) * CACHE_LINE_SIZE(DCACHE)) > 4096)
-+ tmp |= 0x02 << SDZ_CTL_offDCDZ;
-+
-+ SET_SDZ_CTL(tmp);
-+ ISB();
-+ }
-+#endif
-+
-+ SET_CACHE_CTL(GET_CACHE_CTL() | CACHE_CTL_mskDC_EN);
-+ REG32(INTC_FTINTC010_VA_BASE + 0x4) = irq_saves[0];
-+ REG32(INTC_FTINTC010_VA_BASE + 0xc) = irq_saves[1];
-+ REG32(INTC_FTINTC010_VA_BASE + 0x10) = irq_saves[2];
-+}
-+
-+static int ag101_pm_valid(suspend_state_t state)
-+{
-+ switch (state) {
-+ case PM_SUSPEND_ON:
-+ case PM_SUSPEND_STANDBY:
-+ case PM_SUSPEND_MEM:
-+ return 1;
-+
-+ default:
-+ return 0;
-+ }
-+}
-+
-+static int ag101_pm_begin(suspend_state_t state)
-+{
-+ /* TBD if we need it */
-+ return 0;
-+}
-+
-+static unsigned long irq_save;
-+static inline void setup_wakeup_event(void)
-+{
-+ REG32(GPIO_FTGPIO010_VA_BASE + 0x20) = 1;
-+ irq_save = REG32(INTC_FTINTC010_VA_BASE + 0x4);
-+ REG32(INTC_FTINTC010_VA_BASE + 0x4) &= ~(1 << 19);
-+ REG32(INTC_FTINTC010_VA_BASE + 0x4) |= 1 << 13;
-+}
-+
-+static inline void remove_wakeup_event(void)
-+{
-+ REG32(GPIO_FTGPIO010_VA_BASE + 0x30) = 1;
-+ REG32(GPIO_FTGPIO010_VA_BASE + 0x20) = 0;
-+ REG32(INTC_FTINTC010_VA_BASE + 0x4) = irq_save;
-+}
-+
-+static inline void cpu_standby(void)
-+{
-+ asm __volatile__("standby no_wake_grant");
-+}
-+
-+static int ag101_pm_enter(suspend_state_t state)
-+{
-+ switch (state) {
-+ case PM_SUSPEND_STANDBY:
-+ setup_wakeup_event();
-+ cpu_standby();
-+ remove_wakeup_event();
-+ return 0;
-+ case PM_SUSPEND_MEM:
-+ ag101_pmu_sleep();
-+ return 0;
-+ default:
-+ return -EINVAL;
-+ }
-+}
-+
-+/*
-+ * Called after processes are frozen, but before we shutdown devices.
-+ */
-+static int ag101_pm_prepare(void)
-+{
-+ /* TBD if we need it */
-+ return 0;
-+}
-+
-+/*
-+ * Called after devices are wakeuped, but before processes are thawed.
-+ */
-+static void ag101_pm_finish(void)
-+{
-+ /* TBD if we need it */
-+}
-+
-+static void ag101_pm_end(void)
-+{
-+ /* TBD if we need it */
-+}
-+
-+/*
-+ * Set to PM_DISK_FIRMWARE so we can quickly veto suspend-to-disk.
-+ */
-+static struct platform_suspend_ops ag101_pm_ops = {
-+ .valid = ag101_pm_valid,
-+ .begin = ag101_pm_begin,
-+ .prepare = ag101_pm_prepare,
-+ .enter = ag101_pm_enter,
-+ .finish = ag101_pm_finish,
-+ .end = ag101_pm_end,
-+};
-+
-+static int __init ag101_pm_init(void)
-+{
-+ printk("PM driver init\n");
-+ suspend_set_ops(&ag101_pm_ops);
-+ REG32(GPIO_FTGPIO010_VA_BASE + 0x30) = 1;
-+ REG32(INTC_FTINTC010_VA_BASE + 0x0c) &= ~(1 << 13);
-+ REG32(INTC_FTINTC010_VA_BASE + 0x10) &= ~(1 << 13);
-+
-+ return 0;
-+}
-+
-+late_initcall(ag101_pm_init);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101/sleep.S linux-3.4.113/arch/nds32/platforms/ag101/sleep.S
---- linux-3.4.113.orig/arch/nds32/platforms/ag101/sleep.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101/sleep.S 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,118 @@
-+/*
-+ * AG101 Assembler Sleep/WakeUp Management Routines
-+ *
-+ * Copyright (c) 2007 Harry Pan <harry@andestech.com>
-+ *
-+ * This program is free software; you can redistribute it and/or
-+ * modify it under the terms of the GNU General Public License.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for AG101 suspend/wakeup.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.13.2007 Initial code by Harry.
-+ */
-+#include <linux/linkage.h>
-+#include <asm/assembler.h>
-+#include <asm/hardware.h>
-+#include <asm/spec.h>
-+
-+ .text
-+
-+/* ag101_cpu_suspend()
-+ *
-+ * Causes AG101 to enter sleep state
-+ */
-+
-+ENTRY(ag101_cpu_sleep)
-+ pushm $r0, $r30
-+ mfusr $r0, $d0.lo ! $d0 lo byte
-+ mfusr $r1, $d0.hi ! $d0 hi byte
-+ mfusr $r2, $d1.lo ! $d1 lo byte
-+ mfusr $r3, $d1.hi ! $d1 hi byte
-+ mfsr $r4, $mr0
-+ mfsr $r5, $mr1
-+ mfsr $r6, $mr4
-+ mfsr $r7, $mr6
-+ mfsr $r8, $mr7
-+ mfsr $r9, $mr8
-+ mfsr $r10, $ir0
-+ mfsr $r11, $ir1
-+ mfsr $r12, $ir2
-+ mfsr $r13, $ir3
-+ mfsr $r14, $ir9
-+ mfsr $r15, $ir10
-+ mfsr $r16, $ir12
-+ mfsr $r17, $ir13
-+ mfsr $r18, $ir14
-+ mfsr $r19, $ir15
-+ pushm $r0, $r19
-+
-+ sethi $r0, hi20(PMU_FTPMU010_0_VA_BASE + 0x84)
-+ ori $r2, $r0, lo12(PMU_FTPMU010_0_VA_BASE + 0x84)
-+ swi $r31, [$r2]
-+
-+ lwi $r2, [$r0+#0x0c] ! sleep mode
-+ ori $r2, $r2, #1
-+ swi $r2, [$r0+#0x0c] ! sleep mode
-+ standby wake_grant
-+1:
-+ b 1b ! loop waiting for sleep
-+
-+/* ag101_cpu_resume()
-+ *
-+ * Entry point from boot code back to kernel.
-+ *
-+ */
-+
-+ENTRY(ag101_cpu_resume)
-+ mfsr $r2, $mr0
-+ ori $r2, $r2, #0x6
-+#ifdef CONFIG_ANDES_PAGE_SIZE_8KB
-+ ori $r2, $r2, #0x1
-+#endif
-+ mtsr $r2, $mr0
-+
-+ sethi $r2, hi20(PMU_FTPMU010_0_PA_BASE + 0x80)
-+ ori $r2, $r2, lo12(PMU_FTPMU010_0_PA_BASE + 0x80)
-+ lwi $r3, [$r2]
-+ lwi $r4, [$r2 + 0xc]
-+ mtsr $r3, $mr1
-+
-+ mfsr $r0, $mr8
-+ ori $r0, $r0, #0x1
-+ mtsr $r0, $mr8
-+
-+ sethi $r2, hi20(AHB_ATFAHBC020S_0_PA_BASE + 0x88)
-+ ori $r2, $r2, lo12(AHB_ATFAHBC020S_0_PA_BASE + 0x88)
-+ movi $r3, #0x1
-+ swi $r3, [$r2]
-+
-+ jral.ton $r4, $r4
-+
-+ENTRY(ag101_cpu_resume2)
-+ popm $r0, $r19
-+ mtusr $r0, $d0.lo ! $d0 lo byte
-+ mtusr $r1, $d0.hi ! $d0 hi byte
-+ mtusr $r2, $d1.lo ! $d1 lo byte
-+ mtusr $r3, $d1.hi ! $d1 hi byte
-+ mtsr $r4, $mr0
-+ mtsr $r5, $mr1
-+ mtsr $r6, $mr4
-+ mtsr $r7, $mr6
-+ mtsr $r8, $mr7
-+ mtsr $r9, $mr8
-+ mtsr $r10, $ir0
-+ mtsr $r11, $ir1
-+ mtsr $r12, $ir2
-+ mtsr $r13, $ir3
-+ mtsr $r14, $ir9
-+ mtsr $r15, $ir10
-+ mtsr $r16, $ir12
-+ mtsr $r17, $ir13
-+ mtsr $r18, $ir14
-+ mtsr $r19, $ir15
-+ popm $r0, $r30
-+ ret
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101p/devices.c linux-3.4.113/arch/nds32/platforms/ag101p/devices.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag101p/devices.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101p/devices.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,104 @@
-+#include <linux/serial_8250.h>
-+#include <asm/mach-types.h>
-+#include <asm/sizes.h>
-+#include <asm/mach/arch.h>
-+#include <asm/mach/map.h>
-+#include <asm/spec.h>
-+#include <asm/timer.h>
-+
-+const struct map_desc platform_io_desc[] __initdata = {
-+ {UART0_VA_BASE, UART0_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {UART1_VA_BASE, UART1_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {INTC_FTINTC010_0_VA_BASE, INTC_FTINTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {TIMER_FTTMR010_0_VA_BASE, TIMER_FTTMR010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SSP_FTSSP010_0_VA_BASE, SSP_FTSSP010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {PMU_FTPMU010_0_VA_BASE, PMU_FTPMU010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {MAC_FTMAC100_0_VA_BASE, MAC_FTMAC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SDC_FTSDC010_0_VA_BASE, SDC_FTSDC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {RTC_FTRTC010_0_VA_BASE, RTC_FTRTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {WDT_FTWDT010_0_VA_BASE, WDT_FTWDT010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {GPIO_FTGPIO010_0_VA_BASE, GPIO_FTGPIO010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {CFC_FTCFC010_0_VA_BASE, CFC_FTCFC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {LCD_FTLCDC100_0_VA_BASE, LCD_FTLCDC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {I2C_FTI2C010_0_VA_BASE, I2C_FTI2C010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {DMAC_FTDMAC020_0_VA_BASE, DMAC_FTDMAC020_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {APBBRG_FTAPBBRG020S_0_VA_BASE, APBBRG_FTAPBBRG020S_0_PA_BASE,
-+ PAGE_SIZE, MT_DEVICE_NCB},
-+ {USB_FOTG2XX_0_VA_BASE, USB_FOTG2XX_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {PCIIO_0_VA_BASE, PCIIO_0_PA_BASE, (0x000FF000 & PAGE_MASK),
-+ MT_DEVICE_NCB},
-+ {PCIC_FTPCI100_0_VA_BASE, PCIC_FTPCI100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {AHB_ATFAHBC020S_0_VA_BASE, AHB_ATFAHBC020S_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {LED_VA_BASE, LED_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {SDMC_FTSDMC021_VA_BASE, SDMC_FTSDMC021_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {L2CC_VA_BASE, L2CC_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB}
-+};
-+
-+static void __init platform_map_io(void)
-+{
-+ iotable_init((struct map_desc *)platform_io_desc,
-+ ARRAY_SIZE(platform_io_desc));
-+}
-+
-+static struct uart_port uart0 = {
-+ .membase = (void __iomem *)UART0_VA_BASE,
-+ .irq = UART0_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 0,
-+ .mapbase = UART0_PA_BASE,
-+};
-+
-+static struct uart_port uart1 = {
-+ .membase = (void __iomem *)UART1_VA_BASE,
-+ .irq = UART1_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 1,
-+ .mapbase = UART1_PA_BASE,
-+};
-+
-+static void __init soc_init(void)
-+{
-+ early_serial_setup(&uart0);
-+ early_serial_setup(&uart1);
-+}
-+
-+MACHINE_START(FARADAY, PLATFORM_NAME)
-+ .param_offset = BOOT_PARAMETER_PA_BASE,
-+ .map_io = platform_map_io,
-+ .init_irq = platform_init_irq,
-+ .timer = &platform_timer, /* defined in timer.c */
-+ .init_machine = soc_init,
-+MACHINE_END static struct platform_device usb_dev_otg_host = {
-+ .name = "fotg-ehci",
-+};
-+
-+static int __init fotg_init(void)
-+{
-+ platform_device_register(&usb_dev_otg_host);
-+ return 0;
-+}
-+
-+device_initcall(fotg_init);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101p/interrupt-latency.c linux-3.4.113/arch/nds32/platforms/ag101p/interrupt-latency.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag101p/interrupt-latency.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101p/interrupt-latency.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,197 @@
-+/*
-+ * interrupt_latency v1.0 11/25/01
-+ * www.embeddedlinuxinterfacing.com
-+ *
-+ * The original location of this code is
-+ * http://www.embeddedlinuxinterfacing.com/chapters/11/
-+ *
-+ * Copyright (C) 2001 by Craig Hollabaugh
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU Library General Public License as
-+ * published by the Free Software Foundation; either version 2 of the
-+ * License, or (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful, but
-+ * WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
-+ * Library General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU Library General Public
-+ * License along with this program; if not, write to the
-+ * Free Software Foundation, Inc.,
-+ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ */
-+
-+/*
-+ * interrupt_latency.c is based on procfs_example.c by Erik Mouw.
-+ * For more information, please see, The Linux Kernel Procfs Guide, Erik Mouw
-+ * http://kernelnewbies.org/documents/kdoc/procfs-guide/lkprocfsguide.html
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/kernel.h>
-+#include <linux/init.h>
-+#include <linux/proc_fs.h>
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <nds32_intrinsic.h>
-+
-+#define ILT_MODULE_VERSION "1.0"
-+#define MODULE_NAME "interrupt_latency"
-+
-+#define USE_PFM
-+static int interruptcount = 0;
-+#ifdef USE_PFM
-+static unsigned int start_cycle = 0, finish_cycle = 0;
-+static unsigned int start_inst = 0, finish_inst = 0;
-+static unsigned int start_int = 0, finish_int = 0;
-+#else
-+static struct timeval tv1, tv2; /* do_gettimeofday fills these */
-+#endif
-+
-+#define INTERRUPT 9
-+
-+static struct proc_dir_entry *interrupt_latency_file;
-+
-+/*
-+ * function interrupt_interrupt_latency
-+ * This function is the interrupt handler for interrupt 7. It sets the tv2
-+ * structure using do_gettimeofday. It then deasserts D7.
-+ */
-+static irqreturn_t interrupt_interrupt_latency(int irq, void *dev_id)
-+{
-+ unsigned int ir15, pfm_ctl;
-+#ifdef USE_PFM
-+ /* disable counter */
-+ pfm_ctl = 0x4410000; //cycles, instructions and icache misses
-+ //pfm_ctl = 0x4c0000; //instructions and interrupts
-+ //pfm_ctl = 0x4510000; //icache accesses and misses
-+ __nds32__mtsr(pfm_ctl, NDS32_SR_PFM_CTL); //instructions and interrupts
-+ finish_cycle = __nds32__mfsr(NDS32_SR_PFMC0);
-+ finish_inst = __nds32__mfsr(NDS32_SR_PFMC2);
-+ finish_int = __nds32__mfsr(NDS32_SR_PFMC1);
-+#else
-+ do_gettimeofday(&tv2);
-+#endif
-+ /* deassert the interrupt signal */
-+ ir15 = __nds32__mfsr(NDS32_SR_INT_PEND);
-+ __nds32__mtsr((~0x10000) & ir15, NDS32_SR_INT_PEND);
-+ __nds32__dsb();
-+
-+ interruptcount++;
-+ return IRQ_HANDLED;
-+}
-+
-+/*
-+ * function proc_read_interrupt_latency
-+ * The kernel executes this function when a read operation occurs on
-+ * /proc/interrupt_latency. This function sets the tv1 structure. It asserts
-+ * D7 which should immediately cause interrupt 7 to occur. The handler
-+ * records tv2 and deasserts D7. This function returns the time differential
-+ * between tv2 and tv1.
-+ */
-+static int proc_read_interrupt_latency(char *page, char **start, off_t off,
-+ int count, int *eof, void *data)
-+{
-+ int len;
-+ unsigned int ir15, pfm_ctl;
-+#ifdef USE_PFM
-+ //pfm_ctl = 0x4c0007;
-+ //pfm_ctl = 0x4510007;
-+ pfm_ctl = 0x4410007;
-+ start_cycle = __nds32__mfsr(NDS32_SR_PFMC0);
-+ start_inst = __nds32__mfsr(NDS32_SR_PFMC2);
-+ start_int = __nds32__mfsr(NDS32_SR_PFMC1);
-+ __nds32__mtsr(pfm_ctl, NDS32_SR_PFM_CTL);
-+#else
-+ do_gettimeofday(&tv1);
-+#endif
-+ /* assert the interrupt signal */
-+ ir15 = __nds32__mfsr(NDS32_SR_INT_PEND);
-+ __nds32__mtsr(0x10000 | ir15, NDS32_SR_INT_PEND);
-+ __nds32__dsb();
-+
-+#ifdef USE_PFM
-+ len =
-+ sprintf(page,
-+ "Cnt0 %11u Start %11u Finish %11u Cycles %11u\n"
-+ "Cnt2 %11u Start %11u Finish %11u icache miss %11u\n"
-+ "Cnt1 %11u Start %11u Finish %11u Instructions %11u\n"
-+ "Count %11i\n", ((pfm_ctl & 0x8000) >> 15), start_cycle,
-+ finish_cycle, (finish_cycle - start_cycle),
-+ ((pfm_ctl & 0xfc00000) >> 22), start_inst, finish_inst,
-+ (finish_inst - start_inst), ((pfm_ctl & 0x3f0000) >> 16),
-+ start_int, finish_int, (finish_int - start_int),
-+ interruptcount);
-+#else
-+ len = sprintf(page, "Start %9i.%06i\nFinish %9i.%06i\nLatency %17i\n\
-+Count %19i\n", (int)tv1.tv_sec, (int)tv1.tv_usec, (int)tv2.tv_sec, (int)tv2.tv_usec, (int)(tv2.tv_usec - tv1.tv_usec), interruptcount);
-+#endif
-+ *eof = 1;
-+ return len;
-+}
-+
-+/*
-+ * function init_interrupt_latency
-+ * This function creates the /proc directory entry interrupt_latency. It
-+ * also configures the parallel port then requests interrupt 7 from Linux.
-+ */
-+static int __init init_interrupt_latency(void)
-+{
-+ int rv = 0;
-+ unsigned int ir14;
-+
-+ interrupt_latency_file =
-+ create_proc_entry("interrupt_latency", 0444, NULL);
-+ if (interrupt_latency_file == NULL) {
-+ return -ENOMEM;
-+ }
-+
-+ interrupt_latency_file->data = NULL;
-+ interrupt_latency_file->read_proc = &proc_read_interrupt_latency;
-+ interrupt_latency_file->write_proc = NULL;
-+
-+ /* request interrupt from linux */
-+ rv = request_irq(INTERRUPT, interrupt_interrupt_latency, IRQF_DISABLED,
-+ "interrupt_latency", (void *)NULL);
-+ if (rv) {
-+ printk("Can't get interrupt %d\n", INTERRUPT);
-+ goto no_interrupt_latency;
-+ }
-+
-+ /* unmask SWI */
-+ ir14 = __nds32__mfsr(NDS32_SR_INT_MASK);
-+ __nds32__mtsr((0x10000 | ir14), NDS32_SR_INT_MASK);
-+ __nds32__dsb();
-+
-+ /* everything initialized */
-+ printk(KERN_INFO "%s %s initialized\n", MODULE_NAME,
-+ ILT_MODULE_VERSION);
-+ return 0;
-+
-+ /* remove the proc entry on error */
-+no_interrupt_latency:
-+ remove_proc_entry("interrupt_latency", NULL);
-+ return 0;
-+}
-+
-+/*
-+ * function cleanup_interrupt_latency
-+ * This function frees interrupt then removes the /proc directory entry
-+ * interrupt_latency.
-+ */
-+static void __exit cleanup_interrupt_latency(void)
-+{
-+ /* free the interrupt */
-+ free_irq(INTERRUPT, (void *)NULL);
-+
-+ remove_proc_entry("interrupt_latency", NULL);
-+
-+ printk(KERN_INFO "%s %s removed\n", MODULE_NAME, ILT_MODULE_VERSION);
-+}
-+
-+module_init(init_interrupt_latency);
-+module_exit(cleanup_interrupt_latency);
-+
-+MODULE_DESCRIPTION("interrupt_latency proc module");
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101p/Kconfig linux-3.4.113/arch/nds32/platforms/ag101p/Kconfig
---- linux-3.4.113.orig/arch/nds32/platforms/ag101p/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101p/Kconfig 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,11 @@
-+menu "AG101P Platform Options"
-+config CACHE_L2
-+bool "Support L2 cache"
-+ default n
-+
-+config MEASURE_INTERRUPT_LATENCY
-+ bool "Measure interrupt latency"
-+ default n
-+ help
-+ Enable measuring interrupt latency with software interrupt
-+endmenu
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag101p/Makefile linux-3.4.113/arch/nds32/platforms/ag101p/Makefile
---- linux-3.4.113.orig/arch/nds32/platforms/ag101p/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag101p/Makefile 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,2 @@
-+obj-y = devices.o
-+obj-$(CONFIG_MEASURE_INTERRUPT_LATENCY) += interrupt-latency.o
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/ahbclkcal.c linux-3.4.113/arch/nds32/platforms/ag102/ahbclkcal.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/ahbclkcal.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/ahbclkcal.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,216 @@
-+#include <linux/module.h>
-+#include <linux/init.h>
-+#include <linux/pm.h>
-+#include <linux/sched.h>
-+#include <linux/irq.h>
-+
-+#include <asm/hardware.h>
-+#include <asm/spec.h>
-+#ifdef CONFIG_AUTO_SYS_CLK
-+
-+#define OSCH3_CLK 33000000
-+#define OSCH_CLK 25000000
-+#define MHZ 1000000
-+/*
-+ * Table for ahb divisor, PMODE[07:04]
-+ */
-+static const int ahb_div[16] = {
-+ 1, 2, 3, 4, 5, 6, 3, 5,
-+ 8, 10, 12, 14, 15, 18, 20, -1
-+};
-+
-+/* ag102_get_ahb_clk()
-+ *
-+ * return AHB clock in Hz.
-+ */
-+static int ahbclk;
-+void ag102_calc_ahb_clk(void)
-+{
-+ unsigned int pcs1_param;
-+ unsigned int pcs4_param;
-+ unsigned int pcs5_param;
-+ unsigned int main_PLL_div;
-+ unsigned int main_PLL_out;
-+ unsigned int ratio;
-+ unsigned int main_PLL_N;
-+ unsigned int main_PLL_M = 1;
-+ unsigned int F_core0;
-+ unsigned int F_core1;
-+ unsigned int F_l2cc;
-+ unsigned int F_ddr2;
-+ unsigned int F_ahb;
-+ unsigned int F_apb;
-+ unsigned int F_pci;
-+
-+ pcs1_param = REG32(PCU_VA_BASE + 0xa4); //pcs1 parameter register, for core/ahb/apb clk ratio setting
-+ main_PLL_div = (pcs1_param >> 4) & 0x3;
-+ ratio = pcs1_param & 0xf;
-+
-+ pcs4_param = REG32(PCU_VA_BASE + 0x104); //pcs4 parameter register, for main PLL setting
-+ main_PLL_N = pcs4_param & 0xff;
-+ main_PLL_out = (OSCH3_CLK * main_PLL_N / main_PLL_M) >> main_PLL_div;
-+
-+ pcs5_param = REG32(PCU_VA_BASE + 0x124); //pcs5 parameter register, for PCI PLL/DLL setting
-+
-+ switch (ratio) {
-+ case 0:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 2;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 1:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 3;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 2:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 1;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 2;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 3:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 1;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 3;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 4:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 2;
-+ F_l2cc = F_core0 >> 2;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 2;
-+ F_apb = F_ahb >> 1;
-+ break;
-+ case 5:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 2;
-+ F_l2cc = F_core0 >> 2;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 3;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 6:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 2;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 7:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0;
-+ F_ddr2 = F_core0 >> 1;
-+ F_ahb = F_core0 >> 3;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 8:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = OSCH_CLK * 24 / 2;
-+ F_ahb = F_core0 >> 2;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 9:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = OSCH_CLK * 24 / 2;
-+ F_ahb = F_core0 >> 3;
-+ F_apb = F_ahb >> 1;
-+ break;
-+ case 10:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 1;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = OSCH_CLK * 24 / 2;
-+ F_ahb = F_core0 >> 2;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 11:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 1;
-+ F_l2cc = F_core0 >> 1;
-+ F_ddr2 = OSCH_CLK * 24 / 2;
-+ F_ahb = F_core0 >> 3;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 12:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 2;
-+ F_l2cc = F_core0 >> 2;
-+ F_ddr2 = OSCH_CLK * 24 / 2;
-+ F_ahb = F_core0 >> 2;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 13:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0 >> 2;
-+ F_l2cc = F_core0 >> 2;
-+ F_ddr2 = OSCH_CLK * 24 / 2;
-+ F_ahb = F_core0 >> 3;
-+ F_apb = F_ahb >> 1;
-+ break;
-+
-+ case 14:
-+ F_core0 = main_PLL_out;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0;
-+ F_ddr2 = F_core0;
-+ F_ahb = F_core0;
-+ F_apb = F_ahb;
-+ break;
-+ default: // 15
-+ F_core0 = OSCH3_CLK;
-+ F_core1 = F_core0;
-+ F_l2cc = F_core0;
-+ F_ddr2 = F_core0;
-+ F_ahb = F_core0;
-+ F_apb = F_ahb;
-+ break;
-+ }
-+
-+ F_pci = OSCH_CLK * 24 / 9;
-+ if ((pcs5_param & 0x800) == 0)
-+ F_pci = F_pci >> 1;
-+
-+ ahbclk = (int)F_ahb;
-+}
-+
-+int ag102_get_ahb_clk(void)
-+{
-+ //return ahbclk+MHZ;
-+ return ahbclk;
-+}
-+
-+EXPORT_SYMBOL(ag102_get_ahb_clk);
-+#else
-+void ag102_calc_ahb_clk(void)
-+{
-+}
-+#endif
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/devices.c linux-3.4.113/arch/nds32/platforms/ag102/devices.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/devices.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/devices.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,181 @@
-+#include <linux/serial_8250.h>
-+#include <asm/mach-types.h>
-+#include <asm/sizes.h>
-+#include <asm/mach/arch.h>
-+#include <asm/mach/map.h>
-+#include <asm/timer.h>
-+#include <linux/platform_device.h>
-+#include <linux/usb/g_hid.h>
-+
-+extern void amic_init(void);
-+
-+const struct map_desc platform_io_desc[] __initdata = {
-+ {UART0_VA_BASE, UART0_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {UART1_VA_BASE, UART1_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {AMIC_VA_BASE, AMIC_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {GMAC_VA_BASE, GMAC_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {APBBR_VA_BASE, APBBR_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {TIMER_VA_BASE, TIMER_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {L2CC_VA_BASE, L2CC_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {PCIIO_0_VA_BASE, PCIIO_0_PA_BASE, 0x0000F000, MT_DEVICE_NCB},
-+ {PCIC_FTPCI100_0_VA_BASE, PCIC_FTPCI100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SDC_FTSDC010_0_VA_BASE, SDC_FTSDC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {RTC_FTRTC010_0_VA_BASE, RTC_FTRTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {WDT_FTWDT010_0_VA_BASE, WDT_FTWDT010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {I2C_FTI2C010_0_VA_BASE, I2C_FTI2C010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {GPIO_FTGPIO010_0_VA_BASE, GPIO_FTGPIO010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {PCU_VA_BASE, PCU_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {LPC_IO_VA_BASE, LPC_IO_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {LPC_REG_VA_BASE, LPC_REG_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {DMAC_FTDMAC020_0_VA_BASE, DMAC_FTDMAC020_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {GPU_VA_BASE, GPU_PA_BASE, SZ_64K, MT_DEVICE_NCB},
-+ {IDE_FTIDE020_VA_BASE, IDE_FTIDE020_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {USB_FOTG2XX_0_VA_BASE, USB_FOTG2XX_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {CFC_FTCFC010_0_VA_BASE, CFC_FTCFC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SSP_FTSSP010_0_VA_BASE, SSP_FTSSP010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SPI_FTSSP010_0_VA_BASE, SPI_FTSSP010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {DDR2C_VA_BASE, DDR2C_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {AHB_ATFAHBC020S_0_VA_BASE, AHB_ATFAHBC020S_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB}
-+ //{ GPIO_VA_BASE, GPIO_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB }
-+};
-+
-+/* hid descriptor for a keyboard */
-+static struct hidg_func_descriptor my_hid_data = {
-+ .subclass = 0, /* No subclass */
-+ .protocol = 1, /* Keyboard */
-+ .report_length = 8,
-+ .report_desc_length = 63,
-+ .report_desc = {
-+ 0x05, 0x01, /* USAGE_PAGE (Generic Desktop) */
-+ 0x09, 0x06, /* USAGE (Keyboard) */
-+ 0xa1, 0x01, /* COLLECTION (Application) */
-+ 0x05, 0x07, /* USAGE_PAGE (Keyboard) */
-+ 0x19, 0xe0, /* USAGE_MINIMUM (Keyboard LeftControl) */
-+ 0x29, 0xe7, /* USAGE_MAXIMUM (Keyboard Right GUI) */
-+ 0x15, 0x00, /* LOGICAL_MINIMUM (0) */
-+ 0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
-+ 0x75, 0x01, /* REPORT_SIZE (1) */
-+ 0x95, 0x08, /* REPORT_COUNT (8) */
-+ 0x81, 0x02, /* INPUT (Data,Var,Abs) */
-+ 0x95, 0x01, /* REPORT_COUNT (1) */
-+ 0x75, 0x08, /* REPORT_SIZE (8) */
-+ 0x81, 0x03, /* INPUT (Cnst,Var,Abs) */
-+ 0x95, 0x05, /* REPORT_COUNT (5) */
-+ 0x75, 0x01, /* REPORT_SIZE (1) */
-+ 0x05, 0x08, /* USAGE_PAGE (LEDs) */
-+ 0x19, 0x01, /* USAGE_MINIMUM (Num Lock) */
-+ 0x29, 0x05, /* USAGE_MAXIMUM (Kana) */
-+ 0x91, 0x02, /* OUTPUT (Data,Var,Abs) */
-+ 0x95, 0x01, /* REPORT_COUNT (1) */
-+ 0x75, 0x03, /* REPORT_SIZE (3) */
-+ 0x91, 0x03, /* OUTPUT (Cnst,Var,Abs) */
-+ 0x95, 0x06, /* REPORT_COUNT (6) */
-+ 0x75, 0x08, /* REPORT_SIZE (8) */
-+ 0x15, 0x00, /* LOGICAL_MINIMUM (0) */
-+ 0x25, 0x65, /* LOGICAL_MAXIMUM (101) */
-+ 0x05, 0x07, /* USAGE_PAGE (Keyboard) */
-+ 0x19, 0x00, /* USAGE_MINIMUM (Reserved) */
-+ 0x29, 0x65, /* USAGE_MAXIMUM (Keyboard Application) */
-+ 0x81, 0x00, /* INPUT (Data,Ary,Abs) */
-+ 0xc0 /* END_COLLECTION */
-+ }
-+};
-+
-+static struct platform_device my_hid = {
-+ .name = "hidg",
-+ .id = 0,
-+ .num_resources = 0,
-+ .resource = 0,
-+ .dev.platform_data = &my_hid_data,
-+};
-+
-+static void __init platform_map_io(void)
-+{
-+ iotable_init((struct map_desc *)platform_io_desc,
-+ ARRAY_SIZE(platform_io_desc));
-+}
-+
-+static struct resource ftgmac100_resources[] = {
-+ [0] = {
-+ .start = GMAC_PA_BASE,
-+ .end = GMAC_PA_BASE + SZ_4K - 1,
-+ .flags = IORESOURCE_MEM,
-+ },
-+ [1] = {
-+ .start = GMAC_IRQ,
-+ .flags = IORESOURCE_IRQ,
-+ },
-+};
-+
-+static struct platform_device ftgmac100_device = {
-+ .name = "ftgmac100",
-+ .id = 0,
-+ .num_resources = ARRAY_SIZE(ftgmac100_resources),
-+ .resource = ftgmac100_resources,
-+};
-+
-+static int __init devices_init(void)
-+{
-+ platform_device_register(&ftgmac100_device);
-+ platform_device_register(&my_hid);
-+ return 0;
-+}
-+
-+arch_initcall(devices_init);
-+
-+static struct uart_port uart0 = {
-+ .membase = (void __iomem *)UART0_VA_BASE,
-+ .irq = UART0_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 0,
-+ .mapbase = UART0_PA_BASE,
-+};
-+
-+static struct uart_port uart1 = {
-+ .membase = (void __iomem *)UART1_VA_BASE,
-+ .irq = UART1_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 1,
-+ .mapbase = UART1_PA_BASE,
-+};
-+
-+void ag102_calc_ahb_clk(void);
-+static void __init soc_init(void)
-+{
-+ ag102_calc_ahb_clk();
-+ early_serial_setup(&uart0);
-+ early_serial_setup(&uart1);
-+}
-+
-+MACHINE_START(FARADAY, PLATFORM_NAME)
-+ .param_offset = BOOT_PARAMETER_PA_BASE,.map_io = platform_map_io,.init_irq = amic_init,.timer = &platform_timer, /* defined in timer.c */
-+.init_machine = soc_init,
-+ MACHINE_END static struct platform_device usb_dev_otg_host = {
-+ .name = "fotg-ehci",
-+};
-+
-+static int __init fotg_init(void)
-+{
-+ platform_device_register(&usb_dev_otg_host);
-+ return 0;
-+}
-+
-+device_initcall(fotg_init);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/freq-scaling.c linux-3.4.113/arch/nds32/platforms/ag102/freq-scaling.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/freq-scaling.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/freq-scaling.c 2016-12-01 20:59:24.372613522 +0100
-@@ -0,0 +1,512 @@
-+/*
-+ * linux/arch/nds32/platforms/ag102/cpu-fcs.c
-+ *
-+ * Copyright (C) 2002,2003 Intrinsyc Software
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * History:
-+ * 31-Jul-2002 : Initial version [FB]
-+ * 29-Jan-2003 : added PXA255 support [FB]
-+ * 20-Apr-2003 : ported to v2.5 (Dustin McIntire, Sensoria Corp.)
-+ * 18-Jun-2008 : ported to NDS32 architecture ( Roy Lee, Andestech Corp.)
-+ * 13-Oct-2010 : ported to NDS32 AG102 architecture(Gavin Guo, Andestech Corp.)
-+ *
-+ * Note:
-+ * This driver may change the memory bus clock rate, but will not do any
-+ * platform specific access timing changes... for example if you have flash
-+ * memory connected to CS0, you will need to register a platform specific
-+ * notifier which will adjust the memory access strobes to maintain a
-+ * minimum strobe width.
-+ *
-+ */
-+#include <linux/module.h>
-+#include <linux/cpufreq.h>
-+#include <linux/interrupt.h>
-+
-+#include <linux/delay.h>
-+#include <asm/hardware.h>
-+#include <asm/localmem.h>
-+#include <asm/system.h>
-+#include <asm/nds32.h>
-+#include <asm/irq_regs.h>
-+#include "pcu.h"
-+
-+void __ddr_fsc_lock_start();
-+void __ddr_fsc_lock_end();
-+#define AG102_MIN_FREQ 200000000
-+#define AG102_MAX_FREQ 1000000000
-+#define OSCH3_CLK 33000000 /* 33MHz AG102 */
-+
-+struct ag102_freq_struct {
-+ unsigned int khz; /* cpu_clk in khz */
-+ unsigned int sf; /* scaling factor */
-+ unsigned int cr; /* clock ratio */
-+};
-+
-+struct ag102_freq_struct ag102_run_freqs[] = {
-+ /* khz sf, cr */
-+ {OSCH3_CLK * 7, 7, 0}, /* CPUA 231MHz */
-+ {OSCH3_CLK * 8, 8, 0}, /* CPUA 264MHz */
-+ {OSCH3_CLK * 9, 9, 0},
-+ {OSCH3_CLK * 10, 10, 0},
-+ {OSCH3_CLK * 11, 11, 0},
-+ {OSCH3_CLK * 12, 12, 0},
-+ {OSCH3_CLK * 13, 13, 0},
-+ {OSCH3_CLK * 14, 14, 0},
-+ {OSCH3_CLK * 15, 15, 0},
-+ {OSCH3_CLK * 16, 16, 0},
-+ /*
-+ * {OSCH3_CLK * 17, 17, 0},
-+ * {OSCH3_CLK * 18, 18, 0},
-+ * {OSCH3_CLK * 19, 19, 0},
-+ * {OSCH3_CLK * 20, 20, 0},
-+ * {OSCH3_CLK * 21, 21, 0},
-+ * {OSCH3_CLK * 22, 22, 0},
-+ * {OSCH3_CLK * 23, 23, 0},
-+ * {OSCH3_CLK * 24, 24, 0},
-+ * {OSCH3_CLK * 25, 25, 0},
-+ * {OSCH3_CLK * 26, 26, 0},
-+ * {OSCH3_CLK * 27, 27, 0},
-+ * {OSCH3_CLK * 28, 28, 0},
-+ * {OSCH3_CLK * 29, 29, 0},
-+ * {OSCH3_CLK * 30, 30, 0},
-+ */
-+ {0} /* The last 30 is CPUA 1000MHz */
-+};
-+
-+#define NUM_RUN_FREQS ARRAY_SIZE(ag102_run_freqs)
-+static struct cpufreq_frequency_table ag102_run_freq_table[NUM_RUN_FREQS + 1];
-+
-+/* Generic helper function get CPU clocks in kHz */
-+unsigned int ag102_cpufreq_get(unsigned int dummy)
-+{
-+ unsigned int main_PLL_M = 1;
-+ unsigned int main_PLL_out;
-+ unsigned int main_PLL_div;
-+ unsigned int ratio;
-+ unsigned int main_PLL_N;
-+ unsigned int pcs1_param;
-+ unsigned int pcs4_param;
-+
-+ pcs1_param = PCU_GET_REG(PCS1_ST2);
-+ main_PLL_div = PCU_EXTRACT(PCS1_ST2, DIV, pcs1_param);
-+ ratio = PCU_EXTRACT(PCS1_ST2, RATIO, pcs1_param);
-+
-+ pcs4_param = PCU_GET_REG(PCS4_ST2);
-+ main_PLL_N = PCU_EXTRACT(PCS4_ST2, N_FACTOR, pcs4_param);
-+ main_PLL_out = (OSCH3_CLK * main_PLL_N / main_PLL_M) >> main_PLL_div;
-+
-+ printk("CPU frequency is %d\n", main_PLL_out);
-+ return main_PLL_out;
-+}
-+
-+/* find a valid frequency point */
-+static int ag102_verify_policy(struct cpufreq_policy *policy)
-+{
-+ printk("Verified CPU policy: %dKhz min to %dKhz max\n", policy->min,
-+ policy->max);
-+ return cpufreq_frequency_table_verify(policy, ag102_run_freq_table);
-+}
-+
-+void wakeup_and_ddr_train(void)
-+{
-+ unsigned int csr_reg;
-+ unsigned long ddr2_va_base = DDR2C_VA_BASE;
-+ /* issue standby */
-+ /*standby(PCU_STBY_WAIT_DONE); */
-+ __asm__ __volatile__("__fcs_stby:");
-+ __asm__ __volatile__("standby wait_done");
-+ /* Fill the inline assembly codes into Cache to avoid SDRAM access before the data training is done */
-+ __asm__ __volatile__("__ddr_fsc_lock_start:\n"
-+ "li $p0, %0 \n"
-+ "lwi $p1, [$p0 + 0x1f0] \n"
-+ "ori $p1, $p1, 0x100 \n"
-+ "swi $p1, [$p0 + 0x1f0] ! DLL Reset \n"
-+ "msync \n"
-+ "isb \n"
-+ "1: \n"
-+ "lwi $p1, [$p0 + 0x1f0] \n"
-+ "andi $p1, $p1, 0x100 \n"
-+ "bnez $p1, 1b ! Wait until DLL reset is done\n"
-+ "__trigger_dt:\n"
-+ "li $p0, %1 \n"
-+ "lwi $p1, [$p0] \n"
-+ "li $p0, 0x40000000 \n"
-+ "or $p1, $p1, $p0 \n"
-+ "li $p0, %2 \n"
-+ "swi $p1, [$p0] ! Trigger data training\n"
-+ "msync \n"
-+ "isb \n"
-+ "li $p0, %3 \n"
-+ "__wait_init_0:\n"
-+ "lwi $p1, [$p0 + 0xc] \n"
-+ "srli $p1, $p1, 23 \n"
-+ "andi $p1, $p1, 0x1 \n"
-+ "bnez $p1, __wait_init_0 ! Wait until init bit in CSR == 0\n"
-+ "lwi $p1, [$p0 + 0xc] \n"
-+ "srli $p1, $p1, 20 \n"
-+ "andi $p1, $p1, 0x1 \n"
-+ "beqz $p1, __dt_pass ! Monitor data training result\n"
-+ "li $p0, 0xff942000 \n"
-+ "li $p1, 0x45 \n"
-+ "swi $p1, [$p0] ! put 'E' to UART\n"
-+ "li $p1, 0x52 \n"
-+ "swi $p1, [$p0] ! put 'R' to UART\n"
-+ "li $p1, 0x52 \n"
-+ "swi $p1, [$p0] ! put 'R' to UART\n"
-+ "li $p1, 0x4f \n"
-+ "swi $p1, [$p0] ! put 'O' to UART\n"
-+ "li $p1, 0x52 \n"
-+ "swi $p1, [$p0] ! put 'R' to UART\n"
-+ "li $p1, 0xd \n"
-+ "swi $p1, [$p0] ! put '\\r' to UART\n"
-+ "li $p1, 0xa \n"
-+ "swi $p1, [$p0] ! put '\\n' to UART\n"
-+ "j __ddr_fsc_lock_end \n"
-+ "__dt_pass:\n"
-+ "li $p0, 0xff942000 \n"
-+ "li $p1, 0x50 \n"
-+ "swi $p1, [$p0] ! put 'P' to UART\n"
-+ "li $p1, 'A \n"
-+ "swi $p1, [$p0] ! put 'A' to UART\n"
-+ "li $p1, 0x53 \n"
-+ "swi $p1, [$p0] ! put 'S' to UART\n"
-+ "li $p1, 0x53 \n"
-+ "swi $p1, [$p0] ! put 'S' to UART\n"
-+ "li $p1, '\\r \n"
-+ "swi $p1, [$p0] ! put '\\r' to UART\n"
-+ "li $p1, '\\n \n"
-+ "swi $p1, [$p0] ! put '\\n' to UART\n"
-+ "__ddr_fsc_lock_end: \n"::
-+ "r"
-+ (ddr2_va_base),
-+ "r"
-+ (ddr2_va_base),
-+ "r"(ddr2_va_base), "r"(ddr2_va_base));
-+
-+ csr_reg = GET_REG(DDR2C_VA_BASE + 0xc);
-+ if (csr_reg & 0x100000) {
-+ printk("\n###### Data training error ######\nCSR = 0x%x\n\n",
-+ csr_reg);
-+ }
-+}
-+
-+void check_status()
-+{
-+ unsigned int reg_value_tmp;
-+
-+ /*
-+ * CPU will continue if it is waked up
-+ * => check status
-+ */
-+ reg_value_tmp = PCU_GET_REG(BSM_STATUS);
-+ if (PCU_EXTRACT(BSM_STATUS, STS, reg_value_tmp) != PCS_BSM_DONE) {
-+ printk("ERROR: BSM status is not expected:0x%x\n",
-+ reg_value_tmp);
-+ }
-+ PCU_SET_REG(BSM_STATUS, 0x0); // write to clear the status
-+
-+ /*
-+ * Maybe we will need the following code in the future
-+ * if (pcs1_used) {
-+ * reg_value_tmp = PCU_GET_REG(PCS1_ST1);
-+ * if (PCU_EXTRACT(PCS1_ST1, STS, reg_value_tmp) != PCS_STS_DONE) {
-+ * printk("ERROR: PCS1 status is not expected:0x%x\n", reg_value_tmp);
-+ * printk("DEBUG: PCS1 status 2 is 0x%x\n", PCU_GET_REG(PCS1_ST2));
-+ * }
-+ * PCU_SET_REG(PCS1_ST1, 0x0); // write to clear the status
-+ * pcs1_used = 0;
-+ * }
-+ */
-+
-+ /* if (pcs4_used) { */
-+ reg_value_tmp = PCU_GET_REG(PCS4_ST1);
-+ if (PCU_EXTRACT(PCS4_ST1, STS, reg_value_tmp) != PCS_STS_DONE) {
-+ printk("ERROR: PCS4 status is not expected:0x%x\n",
-+ reg_value_tmp);
-+ printk("DEBUG: PCS4 status 2 is 0x%x\n", PCU_GET_REG(PCS4_ST2));
-+ }
-+ PCU_SET_REG(PCS4_ST1, 0x0); /* write to clear the status */
-+ /* pcs4_used = 0; */
-+ /* } */
-+
-+}
-+
-+void start_fcs(unsigned int pll_n_factor, unsigned org_div_param)
-+{
-+ unsigned int pll_range;
-+ unsigned int pcs4_prmtr;
-+
-+ /*
-+ * We must keep the frequency between 266~533.
-+ * because this is the frequency having been tested.
-+ */
-+ if (org_div_param == 0) {
-+ if ((pll_n_factor < 7) || (pll_n_factor > 16)) { /* 266~533 */
-+ printk("\npll_n_factor:%d, org_div_param:%d\n",
-+ pll_n_factor, org_div_param);
-+ printk
-+ ("The input is not accepted! Please input the other value\n");
-+ return;
-+ }
-+ } else { /* div = 1(the divsior is 2), (pll_n_factor*33MHz/2) */
-+ if (pll_n_factor < 16) { /* (533/2~1000/2) */
-+ printk("\npll_n_factor:%d, org_div_param:%d\n",
-+ pll_n_factor, org_div_param);
-+ printk
-+ ("The input is not accepted! Please input the other value\n");
-+ return;
-+ }
-+
-+ }
-+ /* Setup the pll_range, pcu need to know the frequency which we setup */
-+ if (org_div_param == 0) {
-+ if (pll_n_factor <= 15) {
-+ pll_range = 2;
-+ } else
-+ pll_range = 3;
-+ } else if (org_div_param == 1) {
-+ if (pll_n_factor >= 16 && pll_n_factor <= 30) {
-+ pll_range = 2;
-+ } else
-+ pll_range = 3;
-+ }
-+
-+ printk("\npll_n_factor:%d, org_div_param:%d, pll_range:%d\n",
-+ pll_n_factor, org_div_param, pll_range);
-+ /* PCS4 */
-+ PCU_SET_REG(PCS4_CFG, 0); /* stop */
-+ pcs4_prmtr = PCU_PREPARE(PCS4_PARA, IE, 1) | PCU_PREPARE(PCS4_PARA, CMD, PCS_CMD_NOP) | PCU_PREPARE(PCS4_PARA, SYNC, 1) | PCU_PREPARE(PCS4_PARA, PWDN, 0) | PCU_PREPARE(PCS4_PARA, RANGE, pll_range) | /* PLL range */
-+ pll_n_factor; /* PLL N factor */
-+ PCU_SET_REG(PCS4_PARA, pcs4_prmtr);
-+
-+ /* BSM */
-+ PCU_SET_REG(BSM_CTRL, PCU_PREPARE(BSM_CTRL, IE, 1) | PCU_PREPARE(BSM_CTRL, CMD, PCS_CMD_SCALING | PCS_CMD_DRAM_SF) | PCU_PREPARE(BSM_CTRL, SYNC, 1) | PCU_PREPARE(BSM_CTRL, LINK0, 4) | /* scaling link start */
-+ PCU_PREPARE(BSM_CTRL, LINK1, 0x0)); /* wakeup link start */
-+ wakeup_and_ddr_train();
-+ check_status();
-+}
-+
-+void end_fcs(void)
-+{
-+ /* Leave this function as a place marker. */
-+}
-+
-+#define LPS_PREC 8
-+void calibration()
-+{
-+ unsigned long ticks, loopbit, lpj;
-+ int lps_precision = LPS_PREC;
-+
-+ lpj = (1 << 12);
-+
-+ printk(KERN_INFO "Calibrating delay loop... ");
-+ while ((lpj <<= 1) != 0) {
-+ /* wait for "start of" clock tick */
-+ ticks = jiffies;
-+ while (ticks == jiffies)
-+ /* nothing */ ;
-+ /* Go .. */
-+ ticks = jiffies;
-+ __delay(lpj);
-+ ticks = jiffies - ticks;
-+ if (ticks)
-+ break;
-+ }
-+
-+ /*
-+ * Do a binary approximation to get lpj set to
-+ * equal one clock (up to lps_precision bits)
-+ */
-+ lpj >>= 1;
-+ loopbit = lpj;
-+ while (lps_precision-- && (loopbit >>= 1)) {
-+ lpj |= loopbit;
-+ ticks = jiffies;
-+ while (ticks == jiffies)
-+ /* nothing */ ;
-+ ticks = jiffies;
-+ __delay(lpj);
-+ if (jiffies != ticks) /* longer than 1 tick */
-+ lpj &= ~loopbit;
-+ }
-+
-+ printk(KERN_CONT "%lu.%02lu BogoMIPS modified(lpj=%lu)\n",
-+ lpj / (500000 / HZ), (lpj / (5000 / HZ)) % 100, lpj);
-+}
-+
-+static int ag102_speedstep(int idx)
-+{
-+ unsigned int j;
-+ char ch = 'a';
-+ unsigned int sf, cr;
-+ unsigned long flags = 0;
-+ unsigned long org_div_param;
-+ void (*do_fcs) (unsigned int efsf, unsigned int edivhbaclk);
-+ int i;
-+ int line_size = CACHE_LINE_SIZE(ICACHE);
-+ unsigned long start =
-+ ((unsigned long)__ddr_fsc_lock_start) & ~(line_size - 1);
-+ unsigned long end =
-+ (((unsigned long)__ddr_fsc_lock_end) + line_size) & ~(line_size -
-+ 1);
-+
-+ printk("&__ddr_fsc_lock_start(): 0x%08lx, aligned to: 0x%08lx\n",
-+ (unsigned long)__ddr_fsc_lock_start, start);
-+ printk("&__ddr_fsc_lock_end(): 0x%08lx, aligned to: 0x%08lx\n",
-+ (unsigned long)__ddr_fsc_lock_end, end);
-+
-+ for (i = start; i <= end; i += CACHE_LINE_SIZE(ICACHE))
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_FILLCK"::
-+ "r" (i):"memory");
-+
-+ do_fcs = start_fcs;
-+ org_div_param = (PCU_GET_REG(PCS1_ST2) >> 4) & 0x3;
-+ sf = ag102_run_freqs[idx].sf;
-+ if (org_div_param == 1)
-+ sf *= 2;
-+#if 0
-+ calibration();
-+ printk("pcu read value,before frequency scaling:");
-+ ag102_cpufreq_get(0);
-+#endif
-+ local_irq_save(flags);
-+ do_fcs(sf, org_div_param);
-+ local_irq_restore(flags);
-+#if 0
-+ printk("\npcu read value,after frequency scaling:");
-+ ag102_cpufreq_get(0);
-+#endif
-+
-+ for (i = start; i <= end; i += CACHE_LINE_SIZE(ICACHE))
-+ __asm__ volatile ("\n\tcctl %0, L1I_VA_ULCK"::"r" (i):"memory");
-+
-+ return 1;
-+}
-+
-+static int ag102_set_target(struct cpufreq_policy *policy,
-+ unsigned int target_freq, unsigned int relation)
-+{
-+ unsigned int idx, i, j;
-+ char ch = 'a';
-+ struct cpufreq_frequency_table *ag102_freqs_table;
-+ struct ag102_freq_struct *ag102_freq_settings;
-+ struct cpufreq_freqs freqs;
-+
-+ ag102_freq_settings = ag102_run_freqs;
-+ ag102_freqs_table = ag102_run_freq_table;
-+
-+ if (target_freq > AG102_MAX_FREQ || target_freq < AG102_MIN_FREQ) {
-+ printk
-+ ("\nThe frequency you input is illegal!!Please enter the frequency between %d ~ %d\n",
-+ AG102_MIN_FREQ, AG102_MAX_FREQ);
-+ return -EINVAL;
-+ }
-+
-+ /* Lookup the next frequency */
-+ if (cpufreq_frequency_table_target
-+ (policy, ag102_freqs_table, target_freq, relation, &idx))
-+ return -EINVAL;
-+
-+ freqs.old = policy->cur;
-+ freqs.new = ag102_freq_settings[idx].khz;
-+ freqs.cpu = policy->cpu;
-+
-+ /*
-+ * Tell everyone what we're about to do...
-+ * you should add a notify client with any platform specific
-+ * Vcc changing capability
-+ */
-+ cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
-+
-+ if (freqs.new != freqs.old) {
-+
-+ if (!ag102_speedstep(idx))
-+ return -ENODEV;
-+ }
-+
-+ /*
-+ * Tell everyone what we've just done...
-+ * you should add a notify client with any platform specific
-+ * SDRAM refresh timer adjustments
-+ */
-+ cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
-+#if 0
-+ printk("After CPUFREQ_POSTCHANGE, scaling:\n");
-+ calibration();
-+ printk("Speed test...");
-+ for (i = 0; i < 26; i++) {
-+ for (j = 0; j < 500000000; j++) ;
-+ printk("%c", ch);
-+ ch += 1;
-+ }
-+ printk("\n");
-+#endif
-+ return 0;
-+}
-+
-+static int ag102_cpufreq_init(struct cpufreq_policy *policy)
-+{
-+ int i;
-+ /* set default policy and cpuinfo */
-+ policy->governor = CPUFREQ_DEFAULT_GOVERNOR;
-+ policy->policy = CPUFREQ_POLICY_PERFORMANCE;
-+ policy->cpuinfo.max_freq = AG102_MAX_FREQ;
-+ policy->cpuinfo.min_freq = AG102_MIN_FREQ;
-+ policy->cpuinfo.transition_latency = 1000; /* FIXME: 1 ms, assumed */
-+ policy->cur = ag102_cpufreq_get(0); /* current freq */
-+ policy->min = AG102_MIN_FREQ;
-+ policy->max = AG102_MAX_FREQ;
-+
-+ /* Generate the run cpufreq_frequency_table struct */
-+ for (i = 0; i < NUM_RUN_FREQS; i++) {
-+
-+ ag102_run_freq_table[i].frequency = ag102_run_freqs[i].khz;
-+ ag102_run_freq_table[i].index = i;
-+ }
-+
-+ ag102_run_freq_table[i].frequency = CPUFREQ_TABLE_END;
-+
-+ printk("CPU frequency change support initialized\n");
-+
-+ return 0;
-+}
-+
-+static struct cpufreq_driver ag102_cpufreq_driver = {
-+
-+ .verify = ag102_verify_policy,
-+ .target = ag102_set_target,
-+ .init = ag102_cpufreq_init,
-+ .get = ag102_cpufreq_get,
-+ .name = "AG102",
-+};
-+
-+static int __init ag102_cpu_init(void)
-+{
-+ return cpufreq_register_driver(&ag102_cpufreq_driver);
-+}
-+
-+static void __exit ag102_cpu_exit(void)
-+{
-+ cpufreq_unregister_driver(&ag102_cpufreq_driver);
-+}
-+
-+MODULE_AUTHOR("Andes Technology Corporation");
-+MODULE_DESCRIPTION("CPU frequency changing driver for the AG102 architecture");
-+MODULE_LICENSE("GPL");
-+module_init(ag102_cpu_init);
-+module_exit(ag102_cpu_exit);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/gmac.h linux-3.4.113/arch/nds32/platforms/ag102/gmac.h
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/gmac.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/gmac.h 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,354 @@
-+#ifdef CONFIG_PLAT_AG102
-+#include <asm/spec-ag102.h>
-+#else
-+#include <asm/spec-ag101.h>
-+#endif
-+
-+#ifndef __GMAC_H
-+#define __GMAC_H
-+
-+// ======================================================
-+// GMAC register definition
-+// ======================================================
-+// GMAC register
-+//
-+//#define CPE_GMAC_BASE 0xFF90B000 //VA Base
-+#define CPE_DDR2_MEM_BASE 0x00000000
-+
-+#define BIT_MASK(bit_h, bit_l) ((((UINT32)0x1<<(1+bit_h-bit_l))-(UINT32)0x1)<<bit_l)
-+
-+#define GMAC_REG_ISR (GMAC_VA_BASE+0x0) // interrupt sataus register
-+#define GMAC_REG_IME (GMAC_VA_BASE+0x4) // interrupt enable register
-+#define GMAC_REG_MAC_MADR (GMAC_VA_BASE+0x8) // mac most signification address
-+#define GMAC_REG_MAC_LADR (GMAC_VA_BASE+0xc) // mac least signification address
-+#define GMAC_REG_NPTXPD (GMAC_VA_BASE+0x18) // normal priority poll demand
-+#define GMAC_REG_RXPD (GMAC_VA_BASE+0x1c) // receive poll demand
-+#define GMAC_REG_HPTXPD (GMAC_VA_BASE+0x28) // high priority poll demand
-+#define GMAC_REG_NPTXR_BADR (GMAC_VA_BASE+0x20) // normal proprity tx ring base
-+#define GMAC_REG_RXR_BADR (GMAC_VA_BASE+0x24) // rx ring base
-+#define GMAC_REG_HPTXR_BADR (GMAC_VA_BASE+0x28) // high priority tx ring base
-+#define GMAC_REG_DBLAC (GMAC_VA_BASE+0x38) // DMA burst lenght and arbitration control
-+#define GMAC_REG_DMAFIFOS (GMAC_VA_BASE+0x3c) // DMA FIFO status
-+#define GMAC_REG_REVR (GMAC_VA_BASE+0x40) // revision
-+#define GMAC_REG_FEAR (GMAC_VA_BASE+0x44) // feature register
-+#define GMAC_REG_TPAFCR (GMAC_VA_BASE+0x48) // Tramsmit Prority Arbitration and FIFO control
-+#define GMAC_REG_MACCR (GMAC_VA_BASE+0x50) // mac control register
-+#define GMAC_REG_MACSR (GMAC_VA_BASE+0x54) // mac status register
-+#define GMAC_REG_PHYCR (GMAC_VA_BASE+0x60) // phy control register
-+#define GMAC_REG_PHYDATA (GMAC_VA_BASE+0x64) // phy data register
-+#define GMAC_REG_WOLCR (GMAC_VA_BASE+0x70) // wake-on-lan control register
-+#define GMAC_REG_WOLSR (GMAC_VA_BASE+0x74) // wake-on-lan status register
-+#define GMAC_REG_WFCRC (GMAC_VA_BASE+0x78) // wake-up frame CRC register
-+#define GMAC_REG_WFBM1 (GMAC_VA_BASE+0x80) // wake-up frame byte mask 1st
-+#define GMAC_REG_WFBM2 (GMAC_VA_BASE+0x84) // wake-up frame byte mask 2nd
-+#define GMAC_REG_WFBM3 (GMAC_VA_BASE+0x88) // wake-up frame byte mask 3rd
-+#define GMAC_REG_WFBM4 (GMAC_VA_BASE+0x8c) // wake-up frame byte mask 4th
-+#define GMAC_REG_RXR_PTR (GMAC_VA_BASE+0x98) //
-+#define GMAC_REG_TPKT_CNT (GMAC_VA_BASE+0xa0) // tx packet count
-+#define GMAC_REG_TMCOL_SCOL (GMAC_VA_BASE+0xa4) // tx mcol and scol count
-+#define GMAC_REG_TECOL_FAIL (GMAC_VA_BASE+0xa8) // tx ecol and fail count
-+#define GMAC_REG_TLCOL_URUN (GMAC_VA_BASE+0xac) // tx lcol and urun count
-+#define GMAC_REG_RPKT_CNT (GMAC_VA_BASE+0xb0) // rx packet count
-+#define GMAC_REG_BROPKT_CNT (GMAC_VA_BASE+0xb4) // broad cast packet count
-+#define GMAC_REG_MULPKT_CNT (GMAC_VA_BASE+0xb8) // multicast packet count
-+#define GMAC_REG_RPF_AEP (GMAC_VA_BASE+0xbc) //
-+#define GMAC_REG_RUNT_CNT (GMAC_VA_BASE+0xc0) // rx runt packet
-+#define GMAC_REG_CRCER_FLT (GMAC_VA_BASE+0xc4) // crc error and FLT
-+#define GMAC_REG_RCOL_LOST (GMAC_VA_BASE+0xc8) // rx lost and collision count
-+
-+// interrupt enable
-+#define GMAC_IME_PHY_STS_CHG_MASK (BIT_MASK(9, 9)) //
-+#define GMAC_IME_PHY_STS_CHG_OFFSET (9)
-+#define GMAC_IME_AHB_ERR_MASK (BIT_MASK(8, 8)) //
-+#define GMAC_IME_AHB_ERR_OFFSET (8)
-+#define GMAC_IME_TPKT_LOST_MASK (BIT_MASK(7, 7)) //
-+#define GMAC_IME_TPKT_LOST_OFFSET (7)
-+#define GMAC_IME_TXBUF_UNAVA_MASK (BIT_MASK(6, 6)) //
-+#define GMAC_IME_TXBUF_UNAVA_OFFSET (6)
-+#define GMAC_IME_TPKT2F_MASK (BIT_MASK(5, 5)) //
-+#define GMAC_IME_TPKT2F_OFFSET (5)
-+#define GMAC_IME_TPKT2B_MASK (BIT_MASK(4, 4)) //
-+#define GMAC_IME_TPKT2B_OFFSET (4)
-+#define GMAC_IME_RPKT_LOST_MASK (BIT_MASK(3, 3)) //
-+#define GMAC_IME_RPKT_LOST_OFFSET (3)
-+#define GMAC_IME_RXBUF_UNAVA_MASK (BIT_MASK(2, 2)) //
-+#define GMAC_IME_RXBUF_UNAVA_OFFSET (2)
-+#define GMAC_IME_RPKT2F_MASK (BIT_MASK(1, 1)) //
-+#define GMAC_IME_RPKT2F_OFFSET (1)
-+#define GMAC_IME_RPKT2B_MASK (BIT_MASK(0, 0)) //
-+#define GMAC_IME_RPKT2B_OFFSET (0)
-+
-+
-+// interrupt status
-+#define GMAC_ISR_PHY_STS_CHG_MASK (BIT_MASK(9, 9)) //
-+#define GMAC_ISR_PHY_STS_CHG_OFFSET (9)
-+#define GMAC_ISR_AHB_ERR_MASK (BIT_MASK(8, 8)) //
-+#define GMAC_ISR_AHB_ERR_OFFSET (8)
-+#define GMAC_ISR_TPKT_LOST_MASK (BIT_MASK(7, 7)) //
-+#define GMAC_ISR_TPKT_LOST_OFFSET (7)
-+#define GMAC_ISR_TXBUF_UNAVA_MASK (BIT_MASK(6, 6)) //
-+#define GMAC_ISR_TXBUF_UNAVA_OFFSET (6)
-+#define GMAC_ISR_TPKT2F_MASK (BIT_MASK(5, 5)) //
-+#define GMAC_ISR_TPKT2F_OFFSET (5)
-+#define GMAC_ISR_TPKT2B_MASK (BIT_MASK(4, 4)) //
-+#define GMAC_ISR_TPKT2B_OFFSET (4)
-+#define GMAC_ISR_RPKT_LOST_MASK (BIT_MASK(3, 3)) //
-+#define GMAC_ISR_RPKT_LOST_OFFSET (3)
-+#define GMAC_ISR_RXBUF_UNAVA_MASK (BIT_MASK(2, 2)) //
-+#define GMAC_ISR_RXBUF_UNAVA_OFFSET (2)
-+#define GMAC_ISR_RPKT2F_MASK (BIT_MASK(1, 1)) //
-+#define GMAC_ISR_RPKT2F_OFFSET (1)
-+#define GMAC_ISR_RPKT2B_MASK (BIT_MASK(0, 0)) //
-+#define GMAC_ISR_RPKT2B_OFFSET (0)
-+
-+//bit field for TPAFCR control
-+#define GMAC_TPAFCR_TFIFO_SIZE_MASK (BIT_MASK(29, 27)) //
-+#define GMAC_TPAFCR_TFIFO_SIZE_OFFSET (27)
-+#define GMAC_TPAFCR_RFIFO_SIZE_MASK (BIT_MASK(26, 24)) //
-+#define GMAC_TPAFCR_RFIFO_SIZE_OFFSET (24)
-+#define GMAC_TPAFCR_EARLY_TXTHR_MASK (BIT_MASK(23, 16)) //
-+#define GMAC_TPAFCR_EARLY_TXTHR_OFFSET (16)
-+#define GMAC_TPAFCR_EARLY_RXTHR_MASK (BIT_MASK(15, 8)) //
-+#define GMAC_TPAFCR_EARLY_RXTHR_OFFSET (8)
-+#define GMAC_TPAFCR_HPKT_THR_MASK (BIT_MASK(7, 4)) //
-+#define GMAC_TPAFCR_HPKT_THR_OFFSET (4)
-+#define GMAC_TPAFCR_NPKT_THR_MASK (BIT_MASK(3, 0)) //
-+#define GMAC_TPAFCR_NPKT_THR_OFFSET (0)
-+
-+//bit field for MAC control
-+#define GMAC_MACCR_SW_RST_MASK (BIT_MASK(31, 31)) //
-+#define GMAC_MACCR_SW_RST_OFFSET (31)
-+#define GMAC_MACCR_DIRECT_PATH_MASK (BIT_MASK(21, 21)) //
-+#define GMAC_MACCR_DIRECT_PATH_OFFSET (21)
-+#define GMAC_MACCR_SPEED_MASK (BIT_MASK(19, 19)) //
-+#define GMAC_MACCR_SPEED_OFFSET (19)
-+#define GMAC_MACCR_DISCARD_CRCERR_MASK (BIT_MASK(18, 18)) //
-+#define GMAC_MACCR_DISCARD_CRCERR_OFFSET (18)
-+#define GMAC_MACCR_BROADPKT_EN_MASK (BIT_MASK(17, 17)) //
-+#define GMAC_MACCR_BROADPKT_EN_OFFSET (17)
-+#define GMAC_MACCR_RX_MULTIPKT_EN_MASK (BIT_MASK(16, 16)) //
-+#define GMAC_MACCR_RX_MULTIPKT_EN_OFFSET (16)
-+#define GMAC_MACCR_RX_HT_EN_MASK (BIT_MASK(15, 15)) //
-+#define GMAC_MACCR_RX_HT_EN_OFFSET (15)
-+#define GMAC_MACCR_RX_ALLADR_MASK (BIT_MASK(14, 14)) //
-+#define GMAC_MACCR_RX_ALLADR_OFFSET (14)
-+#define GMAC_MACCR_JUMBO_LF_MASK (BIT_MASK(13, 13)) //
-+#define GMAC_MACCR_JUMBO_LF_OFFSET (13)
-+#define GMAC_MACCR_RX_RUNT_MASK (BIT_MASK(12, 12)) //
-+#define GMAC_MACCR_RX_RUNT_OFFSET (12)
-+#define GMAC_MACCR_CRC_APD_MASK (BIT_MASK(10, 10)) //
-+#define GMAC_MACCR_CRC_APD_OFFSET (10)
-+#define GMAC_MACCR_GMAC_MODE_MASK (BIT_MASK(9, 9)) //
-+#define GMAC_MACCR_GMAC_MODE_OFFSET (9)
-+#define GMAC_MACCR_FULLDUP_MASK (BIT_MASK(8, 8)) //
-+#define GMAC_MACCR_FULLDUP_OFFSET (8)
-+#define GMAC_MACCR_ENRX_IN_HALFTX_MASK (BIT_MASK(7, 7)) //
-+#define GMAC_MACCR_ENRX_IN_HALFTX_OFFSET (7)
-+#define GMAC_MACCR_LOOP_EN_MASK (BIT_MASK(6, 6)) //
-+#define GMAC_MACCR_LOOP_EN_OFFSET (6)
-+#define GMAC_MACCR_HPTXR_EN_MASK (BIT_MASK(5, 5)) //
-+#define GMAC_MACCR_HPTXR_EN_OFFSET (5)
-+#define GMAC_MACCR_REMOVE_VLAN_MASK (BIT_MASK(4, 4)) //
-+#define GMAC_MACCR_REMOVE_VLAN_OFFSET (4)
-+#define GMAC_MACCR_RXMAC_EN_MASK (BIT_MASK(3, 3)) //
-+#define GMAC_MACCR_RXMAC_EN_OFFSET (3)
-+#define GMAC_MACCR_TXMAC_EN_MASK (BIT_MASK(2, 2)) //
-+#define GMAC_MACCR_TXMAC_EN_OFFSET (2)
-+#define GMAC_MACCR_RXDMA_EN_MASK (BIT_MASK(1, 1)) //
-+#define GMAC_MACCR_RXDMA_EN_OFFSET (1)
-+#define GMAC_MACCR_TXDMA_EN_MASK (BIT_MASK(0, 0)) //
-+#define GMAC_MACCR_TXDMA_EN_OFFSET (0)
-+
-+//bit field for PHY control
-+#define GMAC_PHYCR_MIIWR_MASK (BIT_MASK(27, 27)) //
-+#define GMAC_PHYCR_MIIWR_OFFSET (27)
-+#define GMAC_PHYCR_MIIRD_MASK (BIT_MASK(26, 26)) //
-+#define GMAC_PHYCR_MIIRD_OFFSET (26)
-+#define GMAC_PHYCR_REGAD_MASK (BIT_MASK(25, 21)) // register address
-+#define GMAC_PHYCR_REGAD_OFFSET (21)
-+#define GMAC_PHYCR_PHYAD_MASK (BIT_MASK(20, 16)) // phy address
-+#define GMAC_PHYCR_PHYAD_OFFSET (16)
-+#define GMAC_PHYCR_MDC_CYCTHR_MASK (BIT_MASK(5, 0)) // cycle threshold
-+#define GMAC_PHYCR_MDC_CYCTHR_OFFSET (0)
-+
-+//bit field for PHY data
-+#define GMAC_PHYDATA_MIIRDATA_MASK (BIT_MASK(31, 16)) // read data
-+#define GMAC_PHYDATA_MIIRDATA_OFFSET (16)
-+#define GMAC_PHYDATA_MIIWDATA_MASK (BIT_MASK(15, 0)) // write data
-+#define GMAC_PHYDATA_MIIWDATA_OFFSET (0)
-+
-+//bit field for WOLCR
-+#define GMAC_WOLCR_WOL_TYPE_MASK (BIT_MASK(258, 24)) //
-+#define GMAC_WOLCR_WOL_TYPE_OFFSET (24)
-+#define GMAC_WOLCR_SW_PDNPHY_MASK (BIT_MASK(18, 18)) //
-+#define GMAC_WOLCR_SW_PDNPHY_OFFSET (18)
-+#define GMAC_WOLCR_WAKEUP_SEL_MASK (BIT_MASK(17, 16)) //
-+#define GMAC_WOLCR_WAKEUP_SEL_OFFSET (16)
-+#define GMAC_WOLCR_PWRSAV_MASK (BIT_MASK(15, 15)) //
-+#define GMAC_WOLCR_PWRSAV_OFFSET (15)
-+#define GMAC_WOLCR_WAKEUP4_EN_MASK (BIT_MASK(6, 6)) //
-+#define GMAC_WOLCR_WAKEUP4_EN_OFFSET (6)
-+#define GMAC_WOLCR_WAKEUP3_EN_MASK (BIT_MASK(5, 5)) //
-+#define GMAC_WOLCR_WAKEUP3_EN_OFFSET (5)
-+#define GMAC_WOLCR_WAKEUP2_EN_MASK (BIT_MASK(4, 4)) //
-+#define GMAC_WOLCR_WAKEUP2_EN_OFFSET (4)
-+#define GMAC_WOLCR_WAKEUP1_EN_MASK (BIT_MASK(3, 3)) //
-+#define GMAC_WOLCR_WAKEUP1_EN_OFFSET (3)
-+#define GMAC_WOLCR_MAGICPKT_EN_MASK (BIT_MASK(2, 2)) //
-+#define GMAC_WOLCR_MAGICPKT_EN_OFFSET (2)
-+#define GMAC_WOLCR_LINKCHG1_EN_MASK (BIT_MASK(1, 1)) // read data
-+#define GMAC_WOLCR_LINKCHG1_EN_OFFSET (1)
-+#define GMAC_WOLCR_LINKCHG0_EN_MASK (BIT_MASK(0, 0)) // write data
-+#define GMAC_WOLCR_LINKCHG0_EN_OFFSET (0)
-+
-+//bit field for WOLSR
-+#define GMAC_WOLSR_WAKEUP4_STS_MASK (BIT_MASK(6, 6)) //
-+#define GMAC_WOLSR_WAKEUP4_STS_OFFSET (6)
-+#define GMAC_WOLSR_WAKEUP3_STS_MASK (BIT_MASK(5, 5)) //
-+#define GMAC_WOLSR_WAKEUP3_STS_OFFSET (5)
-+#define GMAC_WOLSR_WAKEUP2_STS_MASK (BIT_MASK(4, 4)) //
-+#define GMAC_WOLSR_WAKEUP2_STS_OFFSET (4)
-+#define GMAC_WOLSR_WAKEUP1_STS_MASK (BIT_MASK(3, 3)) //
-+#define GMAC_WOLSR_WAKEUP1_STS_OFFSET (3)
-+#define GMAC_WOLSR_MAGICPKT_STS_MASK (BIT_MASK(2, 2)) //
-+#define GMAC_WOLSR_MAGICPKT_STS_OFFSET (2)
-+#define GMAC_WOLSR_LINKCHG1_STS_MASK (BIT_MASK(1, 1)) // read data
-+#define GMAC_WOLSR_LINKCHG1_STS_OFFSET (1)
-+#define GMAC_WOLSR_LINKCHG0_STS_MASK (BIT_MASK(0, 0)) // write data
-+#define GMAC_WOLSR_LINKCHG0_STS_OFFSET (0)
-+
-+// feature
-+#define GMAC_FEAR_TFIFO_RSIZE_MASK (BIT_MASK(5, 3)) // tx fifo size
-+#define GMAC_FEAR_TFIFO_RSIZE_OFFSET (3)
-+#define GMAC_FEAR_RFIFO_RSIZE_MASK (BIT_MASK(2, 0)) // rx fufo size
-+#define GMAC_FEAR_RFIFO_RSIZE_OFFSET (0)
-+
-+// ======================================================
-+// GMAC access macro
-+// ======================================================
-+#define GMAC_SET_FIELD(reg, field, value) SET_FIELD(GMAC_REG_##reg, GMAC_##reg##_##field##_##MASK, GMAC_##reg##_##field##_##OFFSET, value)
-+#define GMAC_GET_FIELD(reg, field) GET_FIELD(GMAC_REG_##reg, GMAC_##reg##_##field##_##MASK, GMAC_##reg##_##field##_##OFFSET)
-+#define GMAC_TEST_FIELD(reg, field) TEST_FIELD(GMAC_REG_##reg, GMAC_##reg##_##field##_##MASK)
-+
-+#define GMAC_SET_REG(reg, value) SET_REG(GMAC_REG_##reg, value)
-+#define GMAC_GET_REG(reg) GET_REG(GMAC_REG_##reg)
-+#define GMAC_TEST_BIT(reg, field, value) VAR_TEST_BIT(value, GMAC_##reg##_##field##_##MASK)
-+
-+#define GMAC_EXTRACT(reg, field, value) EXTRACT_FIELD(value, GMAC_##reg##_##field##_##MASK, GMAC_##reg##_##field##_##OFFSET )
-+#define GMAC_PREPARE(reg, field, value) PREPARE_FIELD(value, GMAC_##reg##_##field##_##MASK, GMAC_##reg##_##field##_##OFFSET )
-+
-+#define GMAC_DEFAULT(reg, field) PREPARE_FIELD(GMAC_##reg##_##field##_##DEFAULT, GMAC_##reg##_##field##_##MASK, GMAC_##reg##_##field##_##OFFSET )
-+
-+#define GMAC_TEST_SIG(var, sig) VAR_TEST_BIT(var, GMAC_ISR_SIG_##sig)
-+#define GMAC_SET_SIG(var, sig) VAR_SET_BIT(var, GMAC_ISR_SIG_##sig)
-+#define GMAC_CLR_SIG(var, sig) VAR_CLR_BIT(var, GMAC_ISR_SIG_##sig)
-+
-+#define FTGMAC100_MEM_BASE (CPE_DDR2_MEM_BASE + 0x00700000) //new: higher space of RAM
-+#define FTGMAC100_TXR_BASE (FTGMAC100_MEM_BASE) // 2048 des., 4 byte, 4 DWs
-+#define FTGMAC100_RXR_BASE (FTGMAC100_MEM_BASE+ 4096*4*4*2) // offset 2 BASE ADDRESS
-+#define FTGMAC100_TXBUF_BASE (FTGMAC100_MEM_BASE+ 0x100000) // offset 2 SIZE ADDRESS
-+#define FTGMAC100_RXBUF_BASE (FTGMAC100_MEM_BASE+ 0x400000) // offset 3 SIZE ADDRESS
-+
-+#define FTGMAC100_DESCRIPTOR_BYTE 16
-+#define FTGMAC100_RXBUF_SIZE 1024
-+
-+//#define GMAC_DAH (0xef12)
-+//#define GMAC_DAL (0x3456789a)
-+#define GMAC_DAH (0x5555)
-+#define GMAC_DAL (0x55555555)
-+
-+// ======================================================
-+// DAVICOM DM9161A PHY register definition
-+// ======================================================
-+#define DVC_PHY_ID (0x0181b8a0)
-+#define DVC_PHY_ADDR (0x0)
-+#define DVC_PHY_REG_CTL (0)
-+#define DVC_PHY_REG_STS (1)
-+#define DVC_PHY_REG_CFG (17)
-+#define DVC_PHY_REG_CTL_SW_RST (0x1<<15)
-+#define DVC_PHY_REG_CTL_AN_EN (0x1<<12)
-+#define DVC_PHY_REG_CTL_AN_RST (0x1<<9)
-+#define DVC_PHY_REG_CTL_LOOPBACK (0x1<<14)
-+
-+// ======================================================
-+// Marvell 88E1119R GPHY register definition
-+// ======================================================
-+#define MAR_GPHY_ID (0x01410e80)
-+#define MAR_GPHY_ADDR (0x1f)
-+#define MAR_GPHY_REG_CTL (0)
-+#define MAR_GPHY_REG_STS (1)
-+#define MAR_GPHY_REG_ID0 (2)
-+#define MAR_GPHY_REG_ID1 (3)
-+#define MAR_GPHY_REG_LPA (5)
-+#define MAR_GPHY_REG_COP_CTL (16) // page 0
-+#define MAR_GPHY_REG_MAC1 (16) // page 2
-+#define MAR_GPHY_REG_LED_CTL (16) // page 3
-+#define MAR_GPHY_REG_PKT_GEN (16) // page 6
-+#define MAR_GPHY_REG_COP_STS1 (17) // page 0
-+#define MAR_GPHY_REG_LED_POLAR (17) // page 3
-+#define MAR_GPHY_REG_COP_STS2 (19) // page 0
-+#define MAR_GPHY_REG_MAC2 (21) // page 2
-+#define MAR_GPHY_REG_MAC_INT_EN (18) // page 0
-+#define MAR_GPHY_REG_MAC_STS (19) // page 2
-+#define MAR_GPHY_REG_PAGE (22)
-+
-+#define MAR_GPHY_REG_CTL_SW_RST (0x1<<15)
-+#define MAR_GPHY_REG_CTL_AN_EN (0x1<<12)
-+#define MAR_GPHY_REG_CTL_START_AN (0x1<<9)
-+#define MAR_GPHY_REG_CTL_FULL_DUP (0x1<<8)
-+#define MAR_GPHY_REG_CTL_LOOPBACK (0x1<<14)
-+#define MAR_GPHY_REG_CTL_SPEED ((0x1<<13)|(0x1<<6))
-+#define MAR_GPHY_REG_CTL_SPEED_1000M (0x1<<6)
-+#define MAR_GPHY_REG_CTL_SPEED_100M (0x1<<13)
-+#define MAR_GPHY_REG_CTL_SPEED_10M (0x0)
-+#define MAR_GPHY_REG_STS_AN_COMPLETE (0x1<<5)
-+#define MAR_GPHY_REG_MAC1_CLK125_DIS (0x1<<2)
-+#define MAR_GPHY_REG_MAC2_SPEED (0x7)
-+#define MAR_GPHY_REG_MAC2_SPEED_1000M (0x6)
-+#define MAR_GPHY_REG_MAC2_SPEED_100M (0x1) //(0x5)
-+#define MAR_GPHY_REG_MAC2_SPEED_10M (0x4)
-+#define MAR_GPHY_REG_MAC2_LINE_LOOPBACK (0x1<<14)
-+#define MAR_GPHY_REG_EN_STUB (0x1<<5)
-+
-+typedef struct {
-+ UINT8 speed; // 0=10Mbps, 1=100Mbps, 2=1000Mbps
-+ UINT8 duplex; // 0=half, 1=full
-+} ETH_PHY_STAT;
-+
-+
-+INT32 gmac_test_main();
-+INT32 gmac_stress_main(UINT32 test_item, UINT32 test_cnt);
-+INT32 gmac_phy_check();
-+INT32 gmac_phy_pwr_ctl(UINT32 pwr);
-+
-+void eth_mac_init(ETH_PHY_STAT *phy_stat);
-+void eth_mac_config(UINT32 type);
-+void eth_mac_register_dump();
-+INT32 eth_mac_interrupt_setup();
-+
-+INT32 eth_phy_detect(UINT32* phy_addr, UINT32* phy_id);
-+INT32 eth_phy_hook_driver (UINT32 phy_id);
-+
-+void eth_phy_init_mar(UINT32 phy_addr);
-+void eth_phy_init_dvc(UINT32 phy_addr);
-+//typedef void (*FP_ETH_PHY_INIT)(UINT32 phy_addr);
-+
-+void eth_phy_config_dvc(UINT32 type, UINT32 phy_addr);
-+void eth_phy_config_mar(UINT32 type, UINT32 phy_addr);
-+//typedef void (*FP_ETH_PHY_CONFIG)(UINT32 type, UINT32 phy_addr);
-+
-+UINT32 eth_phy_stat_dvc(UINT32 phy_addr, ETH_PHY_STAT *phy_stat);
-+UINT32 eth_phy_stat_mar(UINT32 phy_addr, ETH_PHY_STAT *phy_stat);
-+//typedef UINT32 (*FP_ETH_PHY_STAT)(UINT32 phy_addr, ETH_PHY_STAT *phy_stat);
-+
-+//typedef UINT32 (*FP_ETH_PHY_REG_READ)(UINT32 phy_addr, UINT32 phy_page, UINT32 phy_reg, UINT32 *phy_data);
-+//typedef UINT32 (*FP_ETH_PHY_REG_WRITE)(UINT32 phy_addr, UINT32 phy_page, UINT32 phy_reg, UINT32 phy_data);
-+
-+//extern FP_ETH_PHY_CONFIG eth_phy_config;
-+//extern FP_ETH_PHY_INIT eth_phy_init;
-+//extern FP_ETH_PHY_STAT eth_phy_stat;
-+//extern FP_ETH_PHY_REG_WRITE eth_phy_reg_write;
-+//extern FP_ETH_PHY_REG_READ eth_phy_reg_read;
-+
-+
-+#endif // __GMAC_H
-\ No newline at end of file
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/Kconfig linux-3.4.113/arch/nds32/platforms/ag102/Kconfig
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/Kconfig 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,16 @@
-+menu "AG102 Platform Options"
-+
-+config CACHE_L2
-+ bool "Support L2 cache"
-+ default y
-+
-+config LPC
-+ bool "LPC support"
-+
-+config AUTO_SYS_CLK
-+ bool "Automatic AHB Clock Detection"
-+ default y
-+ help
-+ Automatic detection of AHB clock
-+
-+endmenu
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/lpc.c linux-3.4.113/arch/nds32/platforms/ag102/lpc.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/lpc.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/lpc.c 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,230 @@
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/delay.h>
-+
-+#include <asm/spec.h>
-+
-+#define LPC_REG_SCR 0x10
-+#define LPC_REG_SIR 0x14
-+#define LPC_REG_SIMR 0x18
-+
-+/*
-+ * Level trigger IRQ chip methods
-+ */
-+
-+static void lpc_level_unmask_irq(unsigned int irq)
-+{
-+ unsigned int val;
-+// *(volatile unsigned int *) (LPC_REG_BASE + LPC_REG_SIR) =
-+// 1 << (irq - PLATFORM_LPC_IRQ_BASE);
-+ val = *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIMR);
-+ val &= ~(1 << (irq - PLATFORM_LPC_IRQ_BASE));
-+ *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIMR) = val;
-+}
-+
-+static void lpc_level_mask_irq(unsigned int irq)
-+{
-+ unsigned int val;
-+ val = *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIMR);
-+ val |= 1 << (irq - PLATFORM_LPC_IRQ_BASE);
-+ *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIMR) = val;
-+}
-+
-+static void lpc_level_ack_irq(unsigned int irq)
-+{
-+ *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIR) =
-+ 1 << (irq - PLATFORM_LPC_IRQ_BASE);
-+}
-+
-+static struct irq_chip lpc_simple_chip = {
-+ .ack = lpc_level_ack_irq,
-+ .mask = lpc_level_mask_irq,
-+ .unmask = lpc_level_unmask_irq,
-+};
-+
-+void lpc_irq_rounter(unsigned int irq, struct irq_desc *desc)
-+{
-+ unsigned int lpc_status;
-+ unsigned int lpc_mask;
-+ unsigned int lpc_irq;
-+ int i;
-+ struct irq_desc *lpc_desc;
-+
-+ desc->chip->mask(irq);
-+ desc->chip->ack(irq);
-+
-+ lpc_status = *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIR);
-+ lpc_mask = *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIMR);
-+ *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIMR) = 0xffffffff;
-+ for (i = 0; i < PLATFORM_LPC_IRQ_TOTALCOUNT; i++) {
-+ if (!(~lpc_mask & (1 << i) & lpc_status))
-+ continue;
-+ lpc_irq = PLATFORM_LPC_IRQ_BASE + i;
-+ lpc_desc = irq_desc + lpc_irq;
-+ lpc_desc->handle_irq(lpc_irq, lpc_desc);
-+ *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIR) =
-+ 1 << i;
-+ }
-+ *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SIMR) = lpc_mask;
-+
-+ desc->chip->unmask(irq);
-+}
-+
-+int __init lpc_init_irq(void)
-+{
-+ int i;
-+
-+ *(volatile unsigned int *)(LPC_REG_VA_BASE + LPC_REG_SCR) = 0x1f3;
-+ /* Register all IRQ */
-+ for (i = PLATFORM_LPC_IRQ_BASE;
-+ i < PLATFORM_LPC_IRQ_BASE + PLATFORM_LPC_IRQ_TOTALCOUNT; i++) {
-+ // level trigger
-+ set_irq_chip(i, &lpc_simple_chip);
-+ set_irq_handler(i, handle_simple_irq);
-+
-+ }
-+ set_irq_chained_handler(LPC_IRQ, lpc_irq_rounter);
-+
-+ return 0;
-+}
-+
-+device_initcall(lpc_init_irq);
-+
-+#define ITE_ADDR 0x2e
-+#define ITE_DATA 0x2f
-+void outlpc(unsigned int addr, unsigned int data)
-+{
-+ *(volatile unsigned int *)(LPC_IO_VA_BASE + 4 * addr) = data;
-+}
-+
-+unsigned int inlpc(unsigned int addr)
-+{
-+ return *(volatile unsigned int *)(LPC_IO_VA_BASE + 4 * addr);
-+}
-+
-+int __init ite8717_init(void)
-+{
-+ unsigned char data1, data2;
-+ unsigned int count;
-+ /* enter configure mode */
-+ outlpc(ITE_ADDR, 0x87);
-+ outlpc(ITE_ADDR, 0x01);
-+ outlpc(ITE_ADDR, 0x55);
-+ outlpc(ITE_ADDR, 0x55);
-+ /* check chip */
-+ outlpc(ITE_ADDR, 0x20);
-+ data1 = inlpc(ITE_DATA);
-+ outlpc(ITE_ADDR, 0x21);
-+ data2 = inlpc(ITE_DATA);
-+ if ((data1 != 0x87) && (data2 != 0x17))
-+ goto not_found;
-+ /* earlyio program */
-+ outlpc(ITE_ADDR, 0x07); // LDN=0 -> FDC
-+ outlpc(ITE_DATA, 0x00);
-+ outlpc(ITE_ADDR, 0x30); // Enable FDC
-+ outlpc(ITE_DATA, 0x01);
-+ outlpc(ITE_ADDR, 0xf1); // Set (Index 0F1h) = 90h
-+ outlpc(ITE_DATA, 0x80);
-+
-+ outlpc(0x64, 0xaa); // Send KBC self-test command
-+ count = 0;
-+ do {
-+ if (count++ > 0x10000)
-+ break;
-+ data1 = ~inlpc(0x64);
-+ } while (data1 & 0x01);
-+ data2 = inlpc(0x60);
-+ outlpc(0x64, 0xcb); // Set PS2 mode
-+ count = 0;
-+ do {
-+ if (count++ > 0x10000)
-+ break;
-+ data1 = inlpc(0x64);
-+ } while (data1 & 0x02);
-+ outlpc(0x60, 0x01);
-+ count = 0;
-+ do {
-+ if (count++ > 0x10000)
-+ break;
-+ data1 = inlpc(0x64);
-+ } while (data1 & 0x02);
-+ outlpc(0x64, 0x60); // 60h = write 8042 command byte
-+ count = 0;
-+ do {
-+ if (count++ > 0x10000)
-+ break;
-+ data1 = inlpc(0x64);
-+ } while (data1 & 0x02);
-+ outlpc(0x60, 0x45); // AT interface, keyboard enabled, system flag
-+ count = 0;
-+ do {
-+ if (count++ > 0x10000)
-+ break;
-+ data1 = inlpc(0x64);
-+ } while (data1 & 0x02);
-+ outlpc(0x64, 0xae);
-+ count = 0;
-+ do {
-+ if (count++ > 0x10000)
-+ break;
-+ data1 = ~inlpc(0x64);
-+ } while (data1 & 0x01);
-+ outlpc(ITE_ADDR, 0x23);
-+ outlpc(ITE_DATA, 0x00);
-+
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x04);
-+ outlpc(ITE_ADDR, 0xf0);
-+ data1 = inlpc(ITE_DATA);
-+ data1 &= 0x18;
-+ data1 |= 0x0;
-+ outlpc(ITE_DATA, data1);
-+ outlpc(ITE_ADDR, 0xf2);
-+ data1 = inlpc(ITE_DATA);
-+ data1 &= 0x2e;
-+ data1 |= 0xa;
-+ outlpc(ITE_DATA, data1);
-+ outlpc(ITE_ADDR, 0xf4);
-+ data1 = inlpc(ITE_DATA);
-+ data1 &= 0xaf;
-+ data1 |= 0x80;
-+ outlpc(ITE_DATA, data1);
-+ outlpc(ITE_ADDR, 0xf5);
-+ data1 = inlpc(ITE_DATA);
-+ data1 &= 0x3f;
-+ data1 |= 0x0;
-+ outlpc(ITE_DATA, data1);
-+ /* initialize all device */
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x04);
-+ outlpc(ITE_ADDR, 0x30);
-+ outlpc(ITE_DATA, 0x01);
-+#if 1
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x05);
-+ outlpc(ITE_ADDR, 0xf0);
-+ outlpc(ITE_DATA, 0x4e);
-+ outlpc(ITE_ADDR, 0x71);
-+ outlpc(ITE_DATA, 0x01);
-+#endif
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x06);
-+ outlpc(ITE_ADDR, 0x30);
-+ outlpc(ITE_DATA, 0x01);
-+#if 1
-+ outlpc(ITE_ADDR, 0xf0);
-+ outlpc(ITE_DATA, 0x01);
-+ outlpc(ITE_ADDR, 0x71);
-+ outlpc(ITE_DATA, 0x01);
-+#endif
-+
-+ /* exit configure mode */
-+ outlpc(ITE_ADDR, 0x02);
-+ outlpc(ITE_DATA, 0x02);
-+ return 0;
-+not_found:
-+ printk("ITE8717 not found\n");
-+ return -1;
-+}
-+
-+subsys_initcall(ite8717_init);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/Makefile linux-3.4.113/arch/nds32/platforms/ag102/Makefile
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/Makefile 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,5 @@
-+obj-y += devices.o ahbclkcal.o
-+obj-$(CONFIG_LPC) += lpc.o
-+obj-$(CONFIG_PM) += pm.o sleep.o
-+obj-$(CONFIG_AG102_CPU_FREQ_FCS) += cpu-fcs.o
-+obj-$(CONFIG_AG102_CPU_FREQ_SCALING_MODE) += freq-scaling.o
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/pcu.h linux-3.4.113/arch/nds32/platforms/ag102/pcu.h
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/pcu.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/pcu.h 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,1887 @@
-+#ifndef __PCU_H
-+#define __PCU_H
-+#include <asm/spec.h>
-+#define CPE_PCU_BASE PCU_VA_BASE
-+//Data type
-+typedef enum Bool {
-+ FALSE,
-+ TRUE
-+} BOOL;
-+
-+typedef enum {
-+ SUCCESS=0,
-+ FAIL
-+} STATUS;
-+
-+typedef unsigned char UINT8;
-+typedef char INT8;
-+typedef unsigned short UINT16;
-+typedef short INT16;
-+typedef unsigned int UINT32;
-+typedef int INT32;
-+typedef unsigned long long UINT64;
-+typedef long long INT64;
-+
-+//Registion IO operation macro
-+#define REG32(a) (*(volatile UINT32 *)(a))
-+#define REG16(a) (*(volatile UINT16 *)(a))
-+#define REG8(a) (*(volatile UINT8 *)(a))
-+
-+#define inb(a) REG8(a)
-+#define inhw(a) REG16(a)
-+#define inw(a) REG32(a)
-+
-+#define outb(a, v) (REG8(a) = (UINT8)(v))
-+#define outhw(a, v) (REG16(a) = (UINT16)(v))
-+#define outw(a, v) (REG32(a) = (UINT32)(v))
-+
-+
-+// Register bit operation macro
-+#define ANDES_BIT_MASK(bit_h, bit_l) ((((UINT32)0x1<<(1+bit_h-bit_l))-(UINT32)0x1)<<bit_l)
-+
-+
-+#define SET_BIT(addr, bit) do { outw(addr, (inw(addr) | (0x1<<(bit)))); } while(0)
-+#define CLR_BIT(addr, bit) do { outw(addr, (inw(addr) & (~(0x1<<(bit))))); } while(0)
-+
-+#define SET_FIELD(addr, mask, offset, value) do {\
-+ outw(addr, ((inw(addr) & (~mask)) | (((value) << (offset)) &(mask)))); \
-+ } while (0)
-+#define GET_FIELD(addr, mask, offset) ((inw(addr)&(mask))>> (offset))
-+
-+#define TEST_FIELD(addr, mask) (inw(addr)&(mask))
-+
-+#define SET_REG(addr, value) do { outw(addr, value); } while (0)
-+#define GET_REG(addr) (inw(addr))
-+
-+#define CHECK_FIELD(value, mask) ( (value)&(mask) )
-+#define EXTRACT_FIELD(value, mask, offset) ( ((value)&(mask))>>(offset) )
-+#define PREPARE_FIELD(value, mask, offset) ( ((value)<<(offset))&(mask) )
-+
-+
-+// Variable bit operation macro
-+#define VAR_TEST_BIT(var, sig) ((var)&(sig))
-+#define VAR_SET_BIT(var, sig) ((var) = (var)|(sig))
-+#define VAR_CLR_BIT(var, sig) ((var) = (var)&(~(sig)))
-+// ============================
-+// PCU register definition
-+// ============================
-+#define PCU_REG_VER (CPE_PCU_BASE+0x000) //version
-+#define PCU_REG_SPINFO (CPE_PCU_BASE+0x004) //scartch pad information
-+#define PCU_REG_SOCID (CPE_PCU_BASE+0x010) //SoC ID
-+#define PCU_REG_AHB_CFG (CPE_PCU_BASE+0x014) //AHB device configuration
-+#define PCU_REG_APB_CFG (CPE_PCU_BASE+0x018) //APB device configuration
-+#define PCU_REG_DCSR0 (CPE_PCU_BASE+0x020) //driving capability and slew rate control 0
-+#define PCU_REG_DCSR1 (CPE_PCU_BASE+0x024) //driving capability and slew rate control 1
-+#define PCU_REG_DCSR2 (CPE_PCU_BASE+0x028) //driving capability and slew rate control 2
-+#define PCU_REG_MFPS0 (CPE_PCU_BASE+0x030) //multi-function port setting 0
-+#define PCU_REG_MFPS1 (CPE_PCU_BASE+0x034) //multi-function port setting 1
-+#define PCU_REG_DMA_SEL (CPE_PCU_BASE+0x038) //dma engin selection
-+#define PCU_REG_OSC_CTRL (CPE_PCU_BASE+0x040) //OSC control register
-+#define PCU_REG_PWM_DIV (CPE_PCU_BASE+0x044) //PWM clock divider value
-+#define PCU_REG_MISC (CPE_PCU_BASE+0x048) //misc register
-+#define PCU_REG_BSM_CTRL (CPE_PCU_BASE+0x080) //BSM control register
-+#define PCU_REG_BSM_STATUS (CPE_PCU_BASE+0x084) //BSM status
-+#define PCU_REG_WAKEUP_SEN (CPE_PCU_BASE+0x088) //wakeup event signal sensitivity
-+#define PCU_REG_WAKEUP_STATUS (CPE_PCU_BASE+0x08c) //wakeup event status
-+#define PCU_REG_RESET_TIMER (CPE_PCU_BASE+0x090) //reset timer register
-+#define PCU_REG_INTR (CPE_PCU_BASE+0x094) //interrup register
-+#define PCU_REG_PCS1_CFG (CPE_PCU_BASE+0x0a0)
-+#define PCU_REG_PCS1_PARA (CPE_PCU_BASE+0x0a4)
-+#define PCU_REG_PCS1_ST1 (CPE_PCU_BASE+0x0a8)
-+#define PCU_REG_PCS1_ST2 (CPE_PCU_BASE+0x0ac)
-+#define PCU_REG_PCS1_PDD (CPE_PCU_BASE+0x0b0)
-+#define PCU_REG_PCS2_CFG (CPE_PCU_BASE+0x0c0)
-+#define PCU_REG_PCS2_PARA (CPE_PCU_BASE+0x0c4)
-+#define PCU_REG_PCS2_ST1 (CPE_PCU_BASE+0x0c8)
-+#define PCU_REG_PCS2_ST2 (CPE_PCU_BASE+0x0cc)
-+#define PCU_REG_PCS2_PDD (CPE_PCU_BASE+0x0d0)
-+#define PCU_REG_PCS3_CFG (CPE_PCU_BASE+0x0e0)
-+#define PCU_REG_PCS3_PARA (CPE_PCU_BASE+0x0e4)
-+#define PCU_REG_PCS3_ST1 (CPE_PCU_BASE+0x0e8)
-+#define PCU_REG_PCS3_ST2 (CPE_PCU_BASE+0x0ec)
-+#define PCU_REG_PCS3_PDD (CPE_PCU_BASE+0x0f0)
-+#define PCU_REG_PCS4_CFG (CPE_PCU_BASE+0x100)
-+#define PCU_REG_PCS4_PARA (CPE_PCU_BASE+0x104)
-+#define PCU_REG_PCS4_ST1 (CPE_PCU_BASE+0x108)
-+#define PCU_REG_PCS4_ST2 (CPE_PCU_BASE+0x10c)
-+#define PCU_REG_PCS4_PDD (CPE_PCU_BASE+0x110)
-+#define PCU_REG_PCS5_CFG (CPE_PCU_BASE+0x120)
-+#define PCU_REG_PCS5_PARA (CPE_PCU_BASE+0x124)
-+#define PCU_REG_PCS5_ST1 (CPE_PCU_BASE+0x128)
-+#define PCU_REG_PCS5_ST2 (CPE_PCU_BASE+0x12c)
-+#define PCU_REG_PCS5_PDD (CPE_PCU_BASE+0x130)
-+#define PCU_REG_PCS6_CFG (CPE_PCU_BASE+0x140)
-+#define PCU_REG_PCS6_PARA (CPE_PCU_BASE+0x144)
-+#define PCU_REG_PCS6_ST1 (CPE_PCU_BASE+0x148)
-+#define PCU_REG_PCS6_ST2 (CPE_PCU_BASE+0x14c)
-+#define PCU_REG_PCS6_PDD (CPE_PCU_BASE+0x150)
-+#define PCU_REG_PCS7_CFG (CPE_PCU_BASE+0x160)
-+#define PCU_REG_PCS7_PARA (CPE_PCU_BASE+0x164)
-+#define PCU_REG_PCS7_ST1 (CPE_PCU_BASE+0x168)
-+#define PCU_REG_PCS7_ST2 (CPE_PCU_BASE+0x16c)
-+#define PCU_REG_PCS7_PDD (CPE_PCU_BASE+0x170)
-+#define PCU_REG_PCS8_CFG (CPE_PCU_BASE+0x180)
-+#define PCU_REG_PCS8_PARA (CPE_PCU_BASE+0x184)
-+#define PCU_REG_PCS8_ST1 (CPE_PCU_BASE+0x188)
-+#define PCU_REG_PCS8_ST2 (CPE_PCU_BASE+0x18c)
-+#define PCU_REG_PCS8_PDD (CPE_PCU_BASE+0x190)
-+#define PCU_REG_PCS9_CFG (CPE_PCU_BASE+0x1a0)
-+#define PCU_REG_PCS9_PARA (CPE_PCU_BASE+0x1a4)
-+#define PCU_REG_PCS9_ST1 (CPE_PCU_BASE+0x1a8)
-+#define PCU_REG_PCS9_ST2 (CPE_PCU_BASE+0x1ac)
-+#define PCU_REG_PCS9_PDD (CPE_PCU_BASE+0x1b0)
-+
-+#define PCU_SCRATCH_OFFSET_SHIFT (8)
-+#define PCU_SCRATCH_SIZE_SHIFT (2) // in byte, 2 means (1<<2) = 4 bytes
-+#define PCU_REG_SCRATCH_MEM (CPE_PCU_BASE+ (PCU_SPINFO_OFFSET_DEFAULT<<PCU_SCRATCH_OFFSET_SHIFT) )
-+
-+// revision register
-+#define PCU_VER_VER_MASK (ANDES_BIT_MASK(31, 16))
-+#define PCU_VER_VER_OFFSET (16)
-+#define PCU_VER_VER_DEFAULT (0x1)
-+#define PCU_VER_PCSNO_MASK (ANDES_BIT_MASK(7, 0))
-+#define PCU_VER_PCSNO_OFFSET (0)
-+#define PCU_VER_PCSNO_DEFAULT (0x9)
-+#define PCU_VER_DEFAULT ((PCU_VER_VER_DEFAULT << PCU_VER_VER_OFFSET ) |\
-+ (PCU_VER_PCSNO_DEFAULT << PCU_VER_PCSNO_OFFSET))
-+
-+//scratch pad info
-+#define PCU_SPINFO_OFFSET_MASK (ANDES_BIT_MASK(11, 8))
-+#define PCU_SPINFO_OFFSET_OFFSET (8)
-+#define PCU_SPINFO_OFFSET_DEFAULT (0x4)
-+#define PCU_SPINFO_SIZE_MASK (ANDES_BIT_MASK(7, 0))
-+#define PCU_SPINFO_SIZE_OFFSET (0)
-+#define PCU_SPINFO_SIZE_DEFAULT (0x40)
-+#define PCU_SPINFO_DEFAULT ((PCU_SPINFO_OFFSET_DEFAULT << PCU_SPINFO_OFFSET_OFFSET) |\
-+ (PCU_SPINFO_SIZE_DEFAULT << PCU_SPINFO_SIZE_OFFSET ))
-+
-+// revision register
-+#define PCU_SOCID_DEV_MASK (ANDES_BIT_MASK(31, 16))
-+#define PCU_SOCID_DEV_OFFSET (16)
-+#define PCU_SOCID_DEV_DEFAULT (0x102)
-+#define PCU_SOCID_MAJ_MASK (ANDES_BIT_MASK(15, 4))
-+#define PCU_SOCID_MAJ_OFFSET (4)
-+#define PCU_SOCID_MAJ_DEFAULT (0x1)
-+#define PCU_SOCID_MIN_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_SOCID_MIN_OFFSET (0)
-+#define PCU_SOCID_MIN_DEFAULT (0x0)
-+#define PCU_SOCID_DEFAULT ((PCU_SOCID_DEV_DEFAULT << PCU_SOCID_DEV_OFFSET) |\
-+ (PCU_SOCID_MAJ_DEFAULT << PCU_SOCID_MAJ_OFFSET) |\
-+ (PCU_SOCID_MIN_DEFAULT << PCU_SOCID_MIN_OFFSET))
-+
-+// AHB configuration
-+#define PCU_AHB_CFG_AHB2AHB_MEM3_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_AHB_CFG_AHB2AHB_MEM3_OFFSET (31)
-+#define PCU_AHB_CFG_AHB2AHB_MEM3_DEFAULT (0x1)
-+#define PCU_AHB_CFG_AHB2AHB_MEM2_MASK (ANDES_BIT_MASK(30, 30))
-+#define PCU_AHB_CFG_AHB2AHB_MEM2_OFFSET (30)
-+#define PCU_AHB_CFG_AHB2AHB_MEM2_DEFAULT (0x1)
-+#define PCU_AHB_CFG_AHB2AHB_MEM1_MASK (ANDES_BIT_MASK(29, 29))
-+#define PCU_AHB_CFG_AHB2AHB_MEM1_OFFSET (29)
-+#define PCU_AHB_CFG_AHB2AHB_MEM1_DEFAULT (0x1)
-+#define PCU_AHB_CFG_AHB2AHB_MEM0_MASK (ANDES_BIT_MASK(28, 28))
-+#define PCU_AHB_CFG_AHB2AHB_MEM0_OFFSET (28)
-+#define PCU_AHB_CFG_AHB2AHB_MEM0_DEFAULT (0x1)
-+#define PCU_AHB_CFG_AHB2AHB_REG_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_AHB_CFG_AHB2AHB_REG_OFFSET (27)
-+#define PCU_AHB_CFG_AHB2AHB_REG_DEFAULT (0x1)
-+#define PCU_AHB_CFG_L2CC_MASK (ANDES_BIT_MASK(20, 20))
-+#define PCU_AHB_CFG_L2CC_OFFSET (20)
-+#define PCU_AHB_CFG_L2CC_DEFAULT (0x1)
-+#define PCU_AHB_CFG_PCI_MEM_MASK (ANDES_BIT_MASK(19, 19))
-+#define PCU_AHB_CFG_PCI_MEM_OFFSET (19)
-+#define PCU_AHB_CFG_PCI_MEM_DEFAULT (0x1)
-+#define PCU_AHB_CFG_PCI_IO_MASK (ANDES_BIT_MASK(18, 18))
-+#define PCU_AHB_CFG_PCI_IO_OFFSET (18)
-+#define PCU_AHB_CFG_PCI_IO_DEFAULT (0x1)
-+#define PCU_AHB_CFG_LPC_REG_MASK (ANDES_BIT_MASK(17, 17))
-+#define PCU_AHB_CFG_LPC_REG_OFFSET (17)
-+#define PCU_AHB_CFG_LPC_REG_DEFAULT (0x1)
-+#define PCU_AHB_CFG_LPC_IO_MASK (ANDES_BIT_MASK(16, 16))
-+#define PCU_AHB_CFG_LPC_IO_OFFSET (16)
-+#define PCU_AHB_CFG_LPC_IO_DEFAULT (0x1)
-+#define PCU_AHB_CFG_INTC_MASK (ANDES_BIT_MASK(15, 15))
-+#define PCU_AHB_CFG_INTC_OFFSET (15)
-+#define PCU_AHB_CFG_INTC_DEFAULT (0x1)
-+#define PCU_AHB_CFG_USB_MASK (ANDES_BIT_MASK(14, 14))
-+#define PCU_AHB_CFG_USB_OFFSET (14)
-+#define PCU_AHB_CFG_USB_DEFAULT (0x1)
-+#define PCU_AHB_CFG_IDE_MASK (ANDES_BIT_MASK(13, 13))
-+#define PCU_AHB_CFG_IDE_OFFSET (13)
-+#define PCU_AHB_CFG_IDE_DEFAULT (0x1)
-+#define PCU_AHB_CFG_GMAC_MASK (ANDES_BIT_MASK(12, 12))
-+#define PCU_AHB_CFG_GMAC_OFFSET (12)
-+#define PCU_AHB_CFG_GMAC_DEFAULT (0x1)
-+#define PCU_AHB_CFG_GPU_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_AHB_CFG_GPU_OFFSET (9)
-+#define PCU_AHB_CFG_GPU_DEFAULT (0x1)
-+#define PCU_AHB_CFG_DLM2_MASK (ANDES_BIT_MASK(8, 8))
-+#define PCU_AHB_CFG_DLM2_OFFSET (8)
-+#define PCU_AHB_CFG_DLM2_DEFAULT (0x1)
-+#define PCU_AHB_CFG_DMAC_MASK (ANDES_BIT_MASK(7, 7))
-+#define PCU_AHB_CFG_DMAC_OFFSET (7)
-+#define PCU_AHB_CFG_DMAC_DEFAULT (0x1)
-+#define PCU_AHB_CFG_DDR2_MEM_MASK (ANDES_BIT_MASK(6, 6))
-+#define PCU_AHB_CFG_DDR2_MEM_OFFSET (6)
-+#define PCU_AHB_CFG_DDR2_MEM_DEFAULT (0x1)
-+#define PCU_AHB_CFG_DDR2C_MASK (ANDES_BIT_MASK(5, 5))
-+#define PCU_AHB_CFG_DDR2C_OFFSET (5)
-+#define PCU_AHB_CFG_DDR2C_DEFAULT (0x1)
-+#define PCU_AHB_CFG_SPI_MASK (ANDES_BIT_MASK(4, 4))
-+#define PCU_AHB_CFG_SPI_OFFSET (4)
-+#define PCU_AHB_CFG_SPI_DEFAULT (0x1)
-+#define PCU_AHB_CFG_DLM1_MASK (ANDES_BIT_MASK(3, 3))
-+#define PCU_AHB_CFG_DLM1_OFFSET (3)
-+#define PCU_AHB_CFG_DLM1_DEFAULT (0x1)
-+#define PCU_AHB_CFG_APB_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_AHB_CFG_APB_OFFSET (2)
-+#define PCU_AHB_CFG_APB_DEFAULT (0x1)
-+#define PCU_AHB_CFG_APBREG_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_AHB_CFG_APBREG_OFFSET (1)
-+#define PCU_AHB_CFG_APBREG_DEFAULT (0x1)
-+#define PCU_AHB_CFG_AHBC_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_AHB_CFG_AHBC_OFFSET (0)
-+#define PCU_AHB_CFG_AHBC_DEFAULT (0x1)
-+#define PCU_AHB_CFG_DEFAULT ((PCU_AHB_CFG_AHB2AHB_MEM3_DEFAULT << PCU_AHB_CFG_AHB2AHB_MEM3_OFFSET) |\
-+ (PCU_AHB_CFG_AHB2AHB_MEM2_DEFAULT << PCU_AHB_CFG_AHB2AHB_MEM2_OFFSET) |\
-+ (PCU_AHB_CFG_AHB2AHB_MEM1_DEFAULT << PCU_AHB_CFG_AHB2AHB_MEM1_OFFSET) |\
-+ (PCU_AHB_CFG_AHB2AHB_MEM0_DEFAULT << PCU_AHB_CFG_AHB2AHB_MEM0_OFFSET) |\
-+ (PCU_AHB_CFG_AHB2AHB_REG_DEFAULT << PCU_AHB_CFG_AHB2AHB_REG_OFFSET ) |\
-+ (PCU_AHB_CFG_L2CC_DEFAULT << PCU_AHB_CFG_L2CC_OFFSET ) |\
-+ (PCU_AHB_CFG_PCI_MEM_DEFAULT << PCU_AHB_CFG_PCI_MEM_OFFSET ) |\
-+ (PCU_AHB_CFG_PCI_IO_DEFAULT << PCU_AHB_CFG_PCI_IO_OFFSET ) |\
-+ (PCU_AHB_CFG_LPC_REG_DEFAULT << PCU_AHB_CFG_LPC_REG_OFFSET ) |\
-+ (PCU_AHB_CFG_LPC_IO_DEFAULT << PCU_AHB_CFG_LPC_IO_OFFSET ) |\
-+ (PCU_AHB_CFG_INTC_DEFAULT << PCU_AHB_CFG_INTC_OFFSET ) |\
-+ (PCU_AHB_CFG_USB_DEFAULT << PCU_AHB_CFG_USB_OFFSET ) |\
-+ (PCU_AHB_CFG_IDE_DEFAULT << PCU_AHB_CFG_IDE_OFFSET ) |\
-+ (PCU_AHB_CFG_GMAC_DEFAULT << PCU_AHB_CFG_GMAC_OFFSET ) |\
-+ (PCU_AHB_CFG_GPU_DEFAULT << PCU_AHB_CFG_GPU_OFFSET ) |\
-+ (PCU_AHB_CFG_DLM2_DEFAULT << PCU_AHB_CFG_DLM2_OFFSET ) |\
-+ (PCU_AHB_CFG_DMAC_DEFAULT << PCU_AHB_CFG_DMAC_OFFSET ) |\
-+ (PCU_AHB_CFG_DDR2_MEM_DEFAULT << PCU_AHB_CFG_DDR2_MEM_OFFSET ) |\
-+ (PCU_AHB_CFG_DDR2C_DEFAULT << PCU_AHB_CFG_DDR2C_OFFSET ) |\
-+ (PCU_AHB_CFG_SPI_DEFAULT << PCU_AHB_CFG_SPI_OFFSET ) |\
-+ (PCU_AHB_CFG_DLM1_DEFAULT << PCU_AHB_CFG_DLM1_OFFSET ) |\
-+ (PCU_AHB_CFG_APB_DEFAULT << PCU_AHB_CFG_APB_OFFSET ) |\
-+ (PCU_AHB_CFG_APBREG_DEFAULT << PCU_AHB_CFG_APBREG_OFFSET ) |\
-+ (PCU_AHB_CFG_AHBC_DEFAULT << PCU_AHB_CFG_AHBC_OFFSET ))
-+
-+// APB configuration
-+#define PCU_APB_CFG_PWM_MASK (ANDES_BIT_MASK(23, 23))
-+#define PCU_APB_CFG_PWM_OFFSET (23)
-+#define PCU_APB_CFG_PWM_DEFAULT (0x1)
-+#define PCU_APB_CFG_I2C_MASK (ANDES_BIT_MASK(22, 22))
-+#define PCU_APB_CFG_I2C_OFFSET (22)
-+#define PCU_APB_CFG_I2C_DEFAULT (0x1)
-+#define PCU_APB_CFG_GPIO_MASK (ANDES_BIT_MASK(20, 20))
-+#define PCU_APB_CFG_GPIO_OFFSET (20)
-+#define PCU_APB_CFG_GPIO_DEFAULT (0x1)
-+#define PCU_APB_CFG_RTC_MASK (ANDES_BIT_MASK(19, 19))
-+#define PCU_APB_CFG_RTC_OFFSET (19)
-+#define PCU_APB_CFG_RTC_DEFAULT (0x1)
-+#define PCU_APB_CFG_WDT_MASK (ANDES_BIT_MASK(18, 18))
-+#define PCU_APB_CFG_WDT_OFFSET (18)
-+#define PCU_APB_CFG_WDT_DEFAULT (0x1)
-+#define PCU_APB_CFG_TMR_MASK (ANDES_BIT_MASK(17, 17))
-+#define PCU_APB_CFG_TMR_OFFSET (17)
-+#define PCU_APB_CFG_TMR_DEFAULT (0x1)
-+#define PCU_APB_CFG_PCU_MASK (ANDES_BIT_MASK(16, 16))
-+#define PCU_APB_CFG_PCU_OFFSET (16)
-+#define PCU_APB_CFG_PCU_DEFAULT (0x1)
-+#define PCU_APB_CFG_UART2_MASK (ANDES_BIT_MASK(8, 8))
-+#define PCU_APB_CFG_UART2_OFFSET (8)
-+#define PCU_APB_CFG_UART2_DEFAULT (0x1)
-+#define PCU_APB_CFG_AC97I2C_MASK (ANDES_BIT_MASK(6, 6))
-+#define PCU_APB_CFG_AC97I2C_OFFSET (6)
-+#define PCU_APB_CFG_AC97I2C_DEFAULT (0x1)
-+#define PCU_APB_CFG_SDC_MASK (ANDES_BIT_MASK(5, 5))
-+#define PCU_APB_CFG_SDC_OFFSET (5)
-+#define PCU_APB_CFG_SDC_DEFAULT (0x1)
-+#define PCU_APB_CFG_UART1_MASK (ANDES_BIT_MASK(3, 3))
-+#define PCU_APB_CFG_UART1_OFFSET (3)
-+#define PCU_APB_CFG_UART1_DEFAULT (0x1)
-+#define PCU_APB_CFG_SSP_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_APB_CFG_SSP_OFFSET (2)
-+#define PCU_APB_CFG_SSP_DEFAULT (0x1)
-+#define PCU_APB_CFG_CFC_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_APB_CFG_CFC_OFFSET (1)
-+#define PCU_APB_CFG_CFC_DEFAULT (0x1)
-+#define PCU_APB_CFG_DEFAULT ((PCU_APB_CFG_PWM_DEFAULT << PCU_APB_CFG_PWM_OFFSET ) |\
-+ (PCU_APB_CFG_I2C_DEFAULT << PCU_APB_CFG_I2C_OFFSET ) |\
-+ (PCU_APB_CFG_GPIO_DEFAULT << PCU_APB_CFG_GPIO_OFFSET ) |\
-+ (PCU_APB_CFG_RTC_DEFAULT << PCU_APB_CFG_RTC_OFFSET ) |\
-+ (PCU_APB_CFG_WDT_DEFAULT << PCU_APB_CFG_WDT_OFFSET ) |\
-+ (PCU_APB_CFG_TMR_DEFAULT << PCU_APB_CFG_TMR_OFFSET ) |\
-+ (PCU_APB_CFG_PCU_DEFAULT << PCU_APB_CFG_PCU_OFFSET ) |\
-+ (PCU_APB_CFG_UART2_DEFAULT << PCU_APB_CFG_UART2_OFFSET ) |\
-+ (PCU_APB_CFG_AC97I2C_DEFAULT << PCU_APB_CFG_AC97I2C_OFFSET) |\
-+ (PCU_APB_CFG_SDC_DEFAULT << PCU_APB_CFG_SDC_OFFSET ) |\
-+ (PCU_APB_CFG_UART1_DEFAULT << PCU_APB_CFG_UART1_OFFSET ) |\
-+ (PCU_APB_CFG_SSP_DEFAULT << PCU_APB_CFG_SSP_OFFSET ) |\
-+ (PCU_APB_CFG_CFC_DEFAULT << PCU_APB_CFG_CFC_OFFSET ))
-+
-+// Driving Capability and Slew Rate
-+#define PCU_DCSR0_GPU_MASK (ANDES_BIT_MASK(22, 20))
-+#define PCU_DCSR0_GPU_OFFSET (20)
-+#define PCU_DCSR0_GPU_DEFAULT (0xb)
-+#define PCU_DCSR0_GMAC_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_DCSR0_GMAC_OFFSET (16)
-+#define PCU_DCSR0_GMAC_DEFAULT (0x3)
-+#define PCU_DCSR0_ULPI_MASK (ANDES_BIT_MASK(15, 12))
-+#define PCU_DCSR0_ULPI_OFFSET (12)
-+#define PCU_DCSR0_ULPI_DEFAULT (0xb)
-+#define PCU_DCSR0_LPC_MASK (ANDES_BIT_MASK(11, 8))
-+#define PCU_DCSR0_LPC_OFFSET (8)
-+#define PCU_DCSR0_LPC_DEFAULT (0xb)
-+#define PCU_DCSR0_PCIAHB_MASK (ANDES_BIT_MASK(4, 0))
-+#define PCU_DCSR0_PCIAHB_OFFSET (0)
-+#define PCU_DCSR0_PCIAHB_DEFAULT (0xb)
-+#define PCU_DCSR1_I2C_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_DCSR1_I2C_OFFSET (0)
-+#define PCU_DCSR1_I2C_DEFAULT (0x9)
-+#define PCU_DCSR2_PCU_MASK (ANDES_BIT_MASK(31, 28))
-+#define PCU_DCSR2_PCU_OFFSET (28)
-+#define PCU_DCSR2_PCU_DEFAULT (0x3)
-+#define PCU_DCSR2_GPIO_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_DCSR2_GPIO_OFFSET (24)
-+#define PCU_DCSR2_GPIO_DEFAULT (0x9)
-+#define PCU_DCSR2_CFC_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_DCSR2_CFC_OFFSET (20)
-+#define PCU_DCSR2_CFC_DEFAULT (0xb)
-+#define PCU_DCSR2_SD_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_DCSR2_SD_OFFSET (16)
-+#define PCU_DCSR2_SD_DEFAULT (0xb)
-+#define PCU_DCSR2_SPI_MASK (ANDES_BIT_MASK(15, 12))
-+#define PCU_DCSR2_SPI_OFFSET (12)
-+#define PCU_DCSR2_SPI_DEFAULT (0x9)
-+#define PCU_DCSR2_AC97_MASK (ANDES_BIT_MASK(11, 8))
-+#define PCU_DCSR2_AC97_OFFSET (8)
-+#define PCU_DCSR2_AC97_DEFAULT (0xb)
-+#define PCU_DCSR2_UART2_MASK (ANDES_BIT_MASK(7, 4))
-+#define PCU_DCSR2_UART2_OFFSET (4)
-+#define PCU_DCSR2_UART2_DEFAULT (0x9)
-+#define PCU_DCSR2_UART1_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_DCSR2_UART1_OFFSET (0)
-+#define PCU_DCSR2_UART1_DEFAULT (0x9)
-+#define PCU_DCSR0_DEFAULT ((PCU_DCSR0_GPU_DEFAULT << PCU_DCSR0_GPU_OFFSET ) |\
-+ (PCU_DCSR0_GMAC_DEFAULT << PCU_DCSR0_GMAC_OFFSET ) |\
-+ (PCU_DCSR0_ULPI_DEFAULT << PCU_DCSR0_ULPI_OFFSET ) |\
-+ (PCU_DCSR0_LPC_DEFAULT << PCU_DCSR0_LPC_OFFSET ) |\
-+ (PCU_DCSR0_PCIAHB_DEFAULT << PCU_DCSR0_PCIAHB_OFFSET))
-+#define PCU_DCSR0_DFT_MASK ((PCU_DCSR0_GPU_MASK ) |\
-+ (PCU_DCSR0_GMAC_MASK ) |\
-+ (PCU_DCSR0_ULPI_MASK ) |\
-+ (PCU_DCSR0_LPC_MASK ) |\
-+ (PCU_DCSR0_PCIAHB_MASK))
-+
-+#define PCU_DCSR1_DEFAULT (PCU_DCSR1_I2C_DEFAULT << PCU_DCSR1_I2C_OFFSET )
-+#define PCU_DCSR1_DFT_MASK (PCU_DCSR1_I2C_MASK)
-+
-+#define PCU_DCSR2_DEFAULT ((PCU_DCSR2_PCU_DEFAULT << PCU_DCSR2_PCU_OFFSET ) |\
-+ (PCU_DCSR2_GPIO_DEFAULT << PCU_DCSR2_GPIO_OFFSET ) |\
-+ (PCU_DCSR2_CFC_DEFAULT << PCU_DCSR2_CFC_OFFSET ) |\
-+ (PCU_DCSR2_SD_DEFAULT << PCU_DCSR2_SD_OFFSET ) |\
-+ (PCU_DCSR2_SPI_DEFAULT << PCU_DCSR2_SPI_OFFSET ) |\
-+ (PCU_DCSR2_AC97_DEFAULT << PCU_DCSR2_AC97_OFFSET ) |\
-+ (PCU_DCSR2_UART2_DEFAULT << PCU_DCSR2_UART2_OFFSET ) |\
-+ (PCU_DCSR2_UART1_DEFAULT << PCU_DCSR2_UART1_OFFSET ))
-+#define PCU_DCSR2_DFT_MASK ((PCU_DCSR2_PCU_MASK ) |\
-+ (PCU_DCSR2_GPIO_MASK ) |\
-+ (PCU_DCSR2_CFC_MASK ) |\
-+ (PCU_DCSR2_SD_MASK ) |\
-+ (PCU_DCSR2_SPI_MASK ) |\
-+ (PCU_DCSR2_AC97_MASK ) |\
-+ (PCU_DCSR2_UART2_MASK) |\
-+ (PCU_DCSR2_UART1_MASK))
-+
-+//multi function port setting
-+#define PCU_MFPS0_ENDIAN_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_MFPS0_ENDIAN_OFFSET (31)
-+//#define PCU_MFPS0_ENDIAN_DEFAULT (0x)
-+#define PCU_MFPS0_IVB_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_MFPS0_IVB_OFFSET (28)
-+//#define PCU_MFPS0_IVB_DEFAULT (0x)
-+#define PCU_MFPS0_AHBTARGET_MASK (ANDES_BIT_MASK(4, 4))
-+#define PCU_MFPS0_AHBTARGET_OFFSET (4)
-+//#define PCU_MFPS0_AHBTARGET_DEFAULT (0x)
-+#define PCU_MFPS0_AHBDBG_MASK (ANDES_BIT_MASK(3, 3))
-+#define PCU_MFPS0_AHBDBG_OFFSET (3)
-+//#define PCU_MFPS0_AHBDBG_DEFAULT (0x)
-+#define PCU_MFPS0_MINI_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_MFPS0_MINI_OFFSET (2)
-+//#define PCU_MFPS0_MINI_DEFAULT (0x)
-+#define PCU_MFPS0_IDE_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_MFPS0_IDE_OFFSET (1)
-+//#define PCU_MFPS0_IDE_DEFAULT (0x)
-+#define PCU_MFPS0_PCI_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_MFPS0_PCI_OFFSET (0)
-+//#define PCU_MFPS0_PCI_DEFAULT (0x)
-+
-+#define PCU_MFPS1_EXT_INT_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_MFPS1_EXT_INT_OFFSET (31)
-+#define PCU_MFPS1_EXT_INT_DEFAULT (0x0)
-+#define PCU_MFPS1_AHB_FAST_REQ_MASK (ANDES_BIT_MASK(30, 30))
-+#define PCU_MFPS1_AHB_FAST_REQ_OFFSET (30)
-+#define PCU_MFPS1_AHB_FAST_REQ_DEFAULT (0x1)
-+#define PCU_MFPS1_HSMP_FAST_REQ_MASK (ANDES_BIT_MASK(29, 29))
-+#define PCU_MFPS1_HSMP_FAST_REQ_OFFSET (29)
-+#define PCU_MFPS1_HSMP_FAST_REQ_DEFAULT (0x1)
-+#define PCU_MFPS1_DVO_MASK (ANDES_BIT_MASK(28, 28))
-+#define PCU_MFPS1_DVO_OFFSET (28)
-+#define PCU_MFPS1_DVO_DEFAULT (0x0)
-+#define PCU_MFPS1_SD_GPIO_MASK (ANDES_BIT_MASK(10, 10))
-+#define PCU_MFPS1_SD_GPIO_OFFSET (10)
-+#define PCU_MFPS1_SD_GPIO_DEFAULT (0x1)
-+#define PCU_MFPS1_SPI_GPIO_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_MFPS1_SPI_GPIO_OFFSET (9)
-+#define PCU_MFPS1_SPI_GPIO_DEFAULT (0x1)
-+#define PCU_MFPS1_UART2_GPIO_MASK (ANDES_BIT_MASK(8, 8))
-+#define PCU_MFPS1_UART2_GPIO_OFFSET (8)
-+#define PCU_MFPS1_UART2_GPIO_DEFAULT (0x1)
-+#define PCU_MFPS1_UART1_GPIO_MASK (ANDES_BIT_MASK(7, 7))
-+#define PCU_MFPS1_UART1_GPIO_OFFSET (7)
-+#define PCU_MFPS1_UART1_GPIO_DEFAULT (0x1)
-+#define PCU_MFPS1_I2C_GPIO_MASK (ANDES_BIT_MASK(6, 6))
-+#define PCU_MFPS1_I2C_GPIO_OFFSET (6)
-+#define PCU_MFPS1_I2C_GPIO_DEFAULT (0x1)
-+#define PCU_MFPS1_PME_GPIO_MASK (ANDES_BIT_MASK(5, 5))
-+#define PCU_MFPS1_PME_GPIO_OFFSET (5)
-+#define PCU_MFPS1_PME_GPIO_DEFAULT (0x1)
-+#define PCU_MFPS1_PWEN_GPIO_MASK (ANDES_BIT_MASK(4, 4))
-+#define PCU_MFPS1_PWEN_GPIO_OFFSET (4)
-+#define PCU_MFPS1_PWEN_GPIO_DEFAULT (0x1)
-+#define PCU_MFPS1_AC97_GPIO_MASK (ANDES_BIT_MASK(3, 3))
-+#define PCU_MFPS1_AC97_GPIO_OFFSET (3)
-+#define PCU_MFPS1_AC97_GPIO_DEFAULT (0x0)
-+#define PCU_MFPS1_PWM1_GPIO_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_MFPS1_PWM1_GPIO_OFFSET (2)
-+#define PCU_MFPS1_PWM1_GPIO_DEFAULT (0x0)
-+#define PCU_MFPS1_PWM0_GPIO_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_MFPS1_PWM0_GPIO_OFFSET (1)
-+#define PCU_MFPS1_PWM0_GPIO_DEFAULT (0x0)
-+#define PCU_MFPS1_SUSPEND_GPIO_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_MFPS1_SUSPEND_GPIO_OFFSET (0)
-+#define PCU_MFPS1_SUSPEND_GPIO_DEFAULT (0x0)
-+#define PCU_MFPS1_DEFAULT ((PCU_MFPS1_EXT_INT_DEFAULT << PCU_MFPS1_EXT_INT_OFFSET )|\
-+ (PCU_MFPS1_AHB_FAST_REQ_DEFAULT << PCU_MFPS1_AHB_FAST_REQ_OFFSET )|\
-+ (PCU_MFPS1_HSMP_FAST_REQ_DEFAULT << PCU_MFPS1_HSMP_FAST_REQ_OFFSET)|\
-+ (PCU_MFPS1_DVO_DEFAULT << PCU_MFPS1_DVO_OFFSET )|\
-+ (PCU_MFPS1_SD_GPIO_DEFAULT << PCU_MFPS1_SD_GPIO_OFFSET )|\
-+ (PCU_MFPS1_SPI_GPIO_DEFAULT << PCU_MFPS1_SPI_GPIO_OFFSET )|\
-+ (PCU_MFPS1_UART2_GPIO_DEFAULT << PCU_MFPS1_UART2_GPIO_OFFSET )|\
-+ (PCU_MFPS1_UART1_GPIO_DEFAULT << PCU_MFPS1_UART1_GPIO_OFFSET )|\
-+ (PCU_MFPS1_I2C_GPIO_DEFAULT << PCU_MFPS1_I2C_GPIO_OFFSET )|\
-+ (PCU_MFPS1_PME_GPIO_DEFAULT << PCU_MFPS1_PME_GPIO_OFFSET )|\
-+ (PCU_MFPS1_PWEN_GPIO_DEFAULT << PCU_MFPS1_PWEN_GPIO_OFFSET )|\
-+ (PCU_MFPS1_AC97_GPIO_DEFAULT << PCU_MFPS1_AC97_GPIO_OFFSET )|\
-+ (PCU_MFPS1_PWM1_GPIO_DEFAULT << PCU_MFPS1_PWM1_GPIO_OFFSET )|\
-+ (PCU_MFPS1_PWM0_GPIO_DEFAULT << PCU_MFPS1_PWM0_GPIO_OFFSET )|\
-+ (PCU_MFPS1_SUSPEND_GPIO_DEFAULT << PCU_MFPS1_SUSPEND_GPIO_OFFSET ))
-+#define PCU_MFPS1_DFT_MASK ((PCU_MFPS1_EXT_INT_MASK )|\
-+ (PCU_MFPS1_AHB_FAST_REQ_MASK )|\
-+ (PCU_MFPS1_HSMP_FAST_REQ_MASK)|\
-+ (PCU_MFPS1_DVO_MASK )|\
-+ (PCU_MFPS1_SD_GPIO_MASK )|\
-+ (PCU_MFPS1_SPI_GPIO_MASK )|\
-+ (PCU_MFPS1_UART2_GPIO_MASK )|\
-+ (PCU_MFPS1_UART1_GPIO_MASK )|\
-+ (PCU_MFPS1_I2C_GPIO_MASK )|\
-+ (PCU_MFPS1_PME_GPIO_MASK )|\
-+ (PCU_MFPS1_PWEN_GPIO_MASK )|\
-+ (PCU_MFPS1_AC97_GPIO_MASK )|\
-+ (PCU_MFPS1_PWM1_GPIO_MASK )|\
-+ (PCU_MFPS1_PWM0_GPIO_MASK )|\
-+ (PCU_MFPS1_SUSPEND_GPIO_MASK ))
-+
-+//DMA engine selection
-+#define PCU_DMA_SEL_CFC_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_CFC_OFFSET (9)
-+#define PCU_DMA_SEL_CFC_DEFAULT (0x0)
-+#define PCU_DMA_SEL_SD_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_SD_OFFSET (9)
-+#define PCU_DMA_SEL_SD_DEFAULT (0x0)
-+#define PCU_DMA_SEL_UART2_TX_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_UART2_TX_OFFSET (9)
-+#define PCU_DMA_SEL_UART2_TX_DEFAULT (0x0)
-+#define PCU_DMA_SEL_UART2_RX_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_UART2_RX_OFFSET (9)
-+#define PCU_DMA_SEL_UART2_RX_DEFAULT (0x0)
-+#define PCU_DMA_SEL_UART1_TX_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_UART1_TX_OFFSET (9)
-+#define PCU_DMA_SEL_UART1_TX_DEFAULT (0x0)
-+#define PCU_DMA_SEL_UART1_RX_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_UART1_RX_OFFSET (9)
-+#define PCU_DMA_SEL_UART1_RX_DEFAULT (0x0)
-+#define PCU_DMA_SEL_AC97_TX_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_AC97_TX_OFFSET (9)
-+#define PCU_DMA_SEL_AC97_TX_DEFAULT (0x0)
-+#define PCU_DMA_SEL_AC97_RX_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_DMA_SEL_AC97_RX_OFFSET (9)
-+#define PCU_DMA_SEL_AC97_RX_DEFAULT (0x0)
-+#define PCU_DMA_SEL_DEFAULT ((PCU_DMA_SEL_CFC_DEFAULT << PCU_DMA_SEL_CFC_OFFSET ) |\
-+ (PCU_DMA_SEL_SD_DEFAULT << PCU_DMA_SEL_SD_OFFSET ) |\
-+ (PCU_DMA_SEL_UART2_TX_DEFAULT << PCU_DMA_SEL_UART2_TX_OFFSET) |\
-+ (PCU_DMA_SEL_UART2_RX_DEFAULT << PCU_DMA_SEL_UART2_RX_OFFSET) |\
-+ (PCU_DMA_SEL_UART1_TX_DEFAULT << PCU_DMA_SEL_UART1_TX_OFFSET) |\
-+ (PCU_DMA_SEL_UART1_RX_DEFAULT << PCU_DMA_SEL_UART1_RX_OFFSET) |\
-+ (PCU_DMA_SEL_AC97_TX_DEFAULT << PCU_DMA_SEL_AC97_TX_OFFSET ) |\
-+ (PCU_DMA_SEL_AC97_RX_DEFAULT << PCU_DMA_SEL_AC97_RX_OFFSET ) )
-+#define PCU_DMA_SEL_DFT_MASK ((PCU_DMA_SEL_CFC_MASK ) |\
-+ (PCU_DMA_SEL_SD_MASK ) |\
-+ (PCU_DMA_SEL_UART2_TX_MASK) |\
-+ (PCU_DMA_SEL_UART2_RX_MASK) |\
-+ (PCU_DMA_SEL_UART1_TX_MASK) |\
-+ (PCU_DMA_SEL_UART1_RX_MASK) |\
-+ (PCU_DMA_SEL_AC97_TX_MASK ) |\
-+ (PCU_DMA_SEL_AC97_RX_MASK ) )
-+
-+// OSC control
-+#define PCU_OSC_CTRL_OSCH3RAN_MASK (ANDES_BIT_MASK(9, 8))
-+#define PCU_OSC_CTRL_OSCH3RAN_OFFSET (8)
-+//#define PCU_OSC_CTRL_OSCH3RAN_DEFAULT (0x0)
-+#define PCU_OSC_CTRL_OSCH2RAN_MASK (ANDES_BIT_MASK(7, 6))
-+#define PCU_OSC_CTRL_OSCH2RAN_OFFSET (6)
-+#define PCU_OSC_CTRL_OSCH2RAN_DEFAULT (0x2)
-+#define PCU_OSC_CTRL_OSCH1RAN_MASK (ANDES_BIT_MASK(5, 4))
-+#define PCU_OSC_CTRL_OSCH1RAN_OFFSET (4)
-+//#define PCU_OSC_CTRL_OSCH1RAN_DEFAULT (0x0)
-+#define PCU_OSC_CTRL_OSCHTRI_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_OSC_CTRL_OSCHTRI_OFFSET (2)
-+#define PCU_OSC_CTRL_OSCHTRI_DEFAULT (0x0)
-+#define PCU_OSC_CTRL_OSCHSTABLE_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_OSC_CTRL_OSCHSTABLE_OFFSET (1)
-+//#define PCU_OSC_CTRL_OSCHSTABLE_DEFAULT (0x0)
-+#define PCU_OSC_CTRL_OSCHOFF_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_OSC_CTRL_OSCHOFF_OFFSET (0)
-+//#define PCU_OSC_CTRL_OSCHOFF_DEFAULT (0x0)
-+#define PCU_OSC_CTRL_DEFAULT (PCU_OSC_CTRL_OSCH2RAN_DEFAULT << PCU_OSC_CTRL_OSCH2RAN_OFFSET )
-+#define PCU_OSC_CTRL_DFT_MASK (PCU_OSC_CTRL_OSCH2RAN_MASK )
-+
-+// PWM divider
-+#define PCU_PWM_DIV_DIV_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PWM_DIV_DIV_OFFSET (0)
-+#define PCU_PWM_DIV_DIV_DEFAULT (0x0)
-+#define PCU_PWM_DIV_DEFAULT (PCU_PWM_DIV_DIV_DEFAULT<<PCU_PWM_DIV_DIV_OFFSET)
-+#define PCU_PWM_DIV_DFT_MASK (PCU_PWM_DIV_DIV_MASK)
-+
-+// MISC
-+#define PCU_MISC_HW_RST_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_MISC_HW_RST_OFFSET (31)
-+#define PCU_MISC_HW_RST_DEFAULT (0x0)
-+#define PCU_MISC_WD_RST_MASK (ANDES_BIT_MASK(30, 30))
-+#define PCU_MISC_WD_RST_OFFSET (30)
-+#define PCU_MISC_WD_RST_DEFAULT (0x0)
-+#define PCU_MISC_CPUB_SRST_MASK (ANDES_BIT_MASK(29, 29))
-+#define PCU_MISC_CPUB_SRST_OFFSET (29)
-+#define PCU_MISC_CPUB_SRST_DEFAULT (0x0)
-+#define PCU_MISC_CPUA_SRST_MASK (ANDES_BIT_MASK(28, 28))
-+#define PCU_MISC_CPUA_SRST_OFFSET (28)
-+#define PCU_MISC_CPUA_SRST_DEFAULT (0x0)
-+#define PCU_MISC_PW_FAIL_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_MISC_PW_FAIL_OFFSET (27)
-+#define PCU_MISC_PW_FAIL_DEFAULT (0x0)
-+#define PCU_MISC_PW_DAILY_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_MISC_PW_DAILY_OFFSET (26)
-+#define PCU_MISC_PW_DAILY_DEFAULT (0x0)
-+#define PCU_MISC_PW_LPC_MASK (ANDES_BIT_MASK(25, 25))
-+#define PCU_MISC_PW_LPC_OFFSET (25)
-+#define PCU_MISC_PW_LPC_DEFAULT (0x0)
-+#define PCU_MISC_PW_PCI_MASK (ANDES_BIT_MASK(24, 24))
-+#define PCU_MISC_PW_PCI_OFFSET (24)
-+#define PCU_MISC_PW_PCI_DEFAULT (0x0)
-+#define PCU_MISC_PW_RTC_MASK (ANDES_BIT_MASK(23, 23))
-+#define PCU_MISC_PW_RTC_OFFSET (23)
-+#define PCU_MISC_PW_RTC_DEFAULT (0x0)
-+#define PCU_MISC_PW_WOL_MASK (ANDES_BIT_MASK(22, 22))
-+#define PCU_MISC_PW_WOL_OFFSET (2)
-+#define PCU_MISC_PW_WOL_DEFAULT (0x0)
-+#define PCU_MISC_PW_GPIO5_MASK (ANDES_BIT_MASK(21, 21))
-+#define PCU_MISC_PW_GPIO5_OFFSET (21)
-+#define PCU_MISC_PW_GPIO5_DEFAULT (0x0)
-+#define PCU_MISC_PW_GPIO4_MASK (ANDES_BIT_MASK(20, 20))
-+#define PCU_MISC_PW_GPIO4_OFFSET (20)
-+#define PCU_MISC_PW_GPIO4_DEFAULT (0x0)
-+#define PCU_MISC_PW_GPIO3_MASK (ANDES_BIT_MASK(19, 19))
-+#define PCU_MISC_PW_GPIO3_OFFSET (19)
-+#define PCU_MISC_PW_GPIO3_DEFAULT (0x0)
-+#define PCU_MISC_PW_GPIO2_MASK (ANDES_BIT_MASK(18, 18))
-+#define PCU_MISC_PW_GPIO2_OFFSET (18)
-+#define PCU_MISC_PW_GPIO2_DEFAULT (0x0)
-+#define PCU_MISC_PW_GPIO1_MASK (ANDES_BIT_MASK(17, 17))
-+#define PCU_MISC_PW_GPIO1_OFFSET (17)
-+#define PCU_MISC_PW_GPIO1_DEFAULT (0x0)
-+#define PCU_MISC_PW_GPIO0_MASK (ANDES_BIT_MASK(16, 16))
-+#define PCU_MISC_PW_GPIO0_OFFSET (16)
-+#define PCU_MISC_PW_GPIO0_DEFAULT (0x0)
-+#define PCU_MISC_EN_CPUB_MASK (ANDES_BIT_MASK(15, 15))
-+#define PCU_MISC_EN_CPUB_OFFSET (15)
-+#define PCU_MISC_EN_CPUB_DEFAULT (0x0)
-+#define PCU_MISC_EN_CPUA_MASK (ANDES_BIT_MASK(14, 14))
-+#define PCU_MISC_EN_CPUA_OFFSET (14)
-+#define PCU_MISC_EN_CPUA_DEFAULT (0x1)
-+#define PCU_MISC_DDR_DLL_TEST_MASK (ANDES_BIT_MASK(12, 12))
-+#define PCU_MISC_DDR_DLL_TEST_OFFSET (12)
-+#define PCU_MISC_DDR_DLL_TEST_DEFAULT (0x0)
-+#define PCU_MISC_DDR_DDQ_TEST_MASK (ANDES_BIT_MASK(11, 11))
-+#define PCU_MISC_DDR_DDQ_TEST_OFFSET (11)
-+#define PCU_MISC_DDR_DDQ_TEST_DEFAULT (0x0)
-+#define PCU_MISC_DDR_DLL_SRST_MASK (ANDES_BIT_MASK(10, 10))
-+#define PCU_MISC_DDR_DLL_SRST_OFFSET (10)
-+#define PCU_MISC_DDR_DLL_SRST_DEFAULT (0x0)
-+#define PCU_MISC_DDR_PLL_BYPASS_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_MISC_DDR_PLL_BYPASS_OFFSET (9)
-+#define PCU_MISC_DDR_PLL_BYPASS_DEFAULT (0x0)
-+#define PCU_MISC_400MHZ_SEL_MASK (ANDES_BIT_MASK(8, 8))
-+#define PCU_MISC_400MHZ_SEL_OFFSET (8)
-+#define PCU_MISC_400MHZ_SEL_DEFAULT (0x0)
-+#define PCU_MISC_EXLM_WAIT_B_MASK (ANDES_BIT_MASK(7, 6))
-+#define PCU_MISC_EXLM_WAIT_B_OFFSET (6)
-+#define PCU_MISC_EXLM_WAIT_B_DEFAULT (0x0)
-+#define PCU_MISC_EXLM_WAIT_A_MASK (ANDES_BIT_MASK(5, 4))
-+#define PCU_MISC_EXLM_WAIT_A_OFFSET (4)
-+#define PCU_MISC_EXLM_WAIT_A_DEFAULT (0x0)
-+#define PCU_MISC_USB_WAKE_MASK (ANDES_BIT_MASK(3, 3))
-+#define PCU_MISC_USB_WAKE_OFFSET (3)
-+#define PCU_MISC_USB_WAKE_DEFAULT (0x0)
-+#define PCU_MISC_RST_PCI_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_MISC_RST_PCI_OFFSET (2)
-+#define PCU_MISC_RST_PCI_DEFAULT (0x0)
-+#define PCU_MISC_RST_CPUB_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_MISC_RST_CPUB_OFFSET (1)
-+#define PCU_MISC_RST_CPUB_DEFAULT (0x0)
-+#define PCU_MISC_RST_CPUA_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_MISC_RST_CPUA_OFFSET (0)
-+#define PCU_MISC_RST_CPUA_DEFAULT (0x0)
-+#define PCU_MISC_DEFAULT (/*(PCU_MISC_EN_CPUB_DEFAULT << PCU_MISC_EN_CPUB_OFFSET )|*/\
-+ (PCU_MISC_EN_CPUA_DEFAULT << PCU_MISC_EN_CPUA_OFFSET )|\
-+ (PCU_MISC_DDR_DLL_TEST_DEFAULT << PCU_MISC_DDR_DLL_TEST_OFFSET )|\
-+ (PCU_MISC_DDR_DDQ_TEST_DEFAULT << PCU_MISC_DDR_DDQ_TEST_OFFSET )|\
-+ (PCU_MISC_DDR_DLL_SRST_DEFAULT << PCU_MISC_DDR_DLL_SRST_OFFSET )|\
-+ (PCU_MISC_DDR_PLL_BYPASS_DEFAULT << PCU_MISC_DDR_PLL_BYPASS_OFFSET )|\
-+ (PCU_MISC_400MHZ_SEL_DEFAULT << PCU_MISC_400MHZ_SEL_OFFSET )|\
-+ (PCU_MISC_EXLM_WAIT_B_DEFAULT << PCU_MISC_EXLM_WAIT_B_OFFSET )|\
-+ (PCU_MISC_EXLM_WAIT_A_DEFAULT << PCU_MISC_EXLM_WAIT_A_OFFSET )|\
-+ (PCU_MISC_USB_WAKE_DEFAULT << PCU_MISC_USB_WAKE_OFFSET )|\
-+ (PCU_MISC_RST_PCI_DEFAULT << PCU_MISC_RST_PCI_OFFSET )|\
-+ (PCU_MISC_RST_CPUB_DEFAULT << PCU_MISC_RST_CPUB_OFFSET )|\
-+ (PCU_MISC_RST_CPUA_DEFAULT << PCU_MISC_RST_CPUA_OFFSET ))
-+#define PCU_MISC_DFT_MASK (/*(PCU_MISC_EN_CPUB_MASK )|*/\
-+ (PCU_MISC_EN_CPUA_MASK )|\
-+ (PCU_MISC_DDR_DLL_TEST_MASK )|\
-+ (PCU_MISC_DDR_DDQ_TEST_MASK )|\
-+ (PCU_MISC_DDR_DLL_SRST_MASK )|\
-+ (PCU_MISC_DDR_PLL_BYPASS_MASK)|\
-+ (PCU_MISC_400MHZ_SEL_MASK )|\
-+ (PCU_MISC_EXLM_WAIT_B_MASK )|\
-+ (PCU_MISC_EXLM_WAIT_A_MASK )|\
-+ (PCU_MISC_USB_WAKE_MASK )|\
-+ (PCU_MISC_RST_PCI_MASK )|\
-+ (PCU_MISC_RST_CPUB_MASK )|\
-+ (PCU_MISC_RST_CPUA_MASK ))
-+#define PCU_MISC_W1C_MASK ((PCU_MISC_HW_RST_MASK )|\
-+ (PCU_MISC_WD_RST_MASK )|\
-+ (PCU_MISC_CPUB_SRST_MASK)|\
-+ (PCU_MISC_CPUA_SRST_MASK))
-+
-+// BSM control and status
-+#define PCU_BSM_CTRL_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_BSM_CTRL_IE_OFFSET (31)
-+#define PCU_BSM_CTRL_IE_DEFAULT (0x0)
-+#define PCU_BSM_CTRL_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_BSM_CTRL_CMD_OFFSET (28)
-+#define PCU_BSM_CTRL_CMD_DEFAULT (0x0)
-+#define PCU_BSM_CTRL_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_BSM_CTRL_SYNC_OFFSET (24)
-+#define PCU_BSM_CTRL_SYNC_DEFAULT (0x3)
-+#define PCU_BSM_CTRL_LINK1_MASK (ANDES_BIT_MASK(7, 4))
-+#define PCU_BSM_CTRL_LINK1_OFFSET (4)
-+#define PCU_BSM_CTRL_LINK1_DEFAULT (0x0)
-+#define PCU_BSM_CTRL_LINK0_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_BSM_CTRL_LINK0_OFFSET (0)
-+#define PCU_BSM_CTRL_LINK0_DEFAULT (0x0)
-+#define PCU_BSM_CTRL_DEFAULT ((PCU_BSM_CTRL_IE_DEFAULT << PCU_BSM_CTRL_IE_OFFSET ) |\
-+ (PCU_BSM_CTRL_CMD_DEFAULT << PCU_BSM_CTRL_CMD_OFFSET ) |\
-+ (PCU_BSM_CTRL_SYNC_DEFAULT << PCU_BSM_CTRL_SYNC_OFFSET ) |\
-+ (PCU_BSM_CTRL_LINK1_DEFAULT << PCU_BSM_CTRL_LINK1_OFFSET) |\
-+ (PCU_BSM_CTRL_LINK0_DEFAULT << PCU_BSM_CTRL_LINK0_OFFSET))
-+
-+#define PCU_BSM_STATUS_STS_MASK (ANDES_BIT_MASK(31, 28))
-+#define PCU_BSM_STATUS_STS_OFFSET (28)
-+#define PCU_BSM_STATUS_STS_DEFAULT (0x0)
-+#define PCU_BSM_STATUS_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_BSM_STATUS_SYNC_OFFSET (24)
-+#define PCU_BSM_STATUS_SYNC_DEFAULT (0x0)
-+#define PCU_BSM_STATUS_CI1_MASK (ANDES_BIT_MASK(7, 4))
-+#define PCU_BSM_STATUS_CI1_OFFSET (4)
-+#define PCU_BSM_STATUS_CI1_DEFAULT (0x0)
-+#define PCU_BSM_STATUS_CI0_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_BSM_STATUS_CI0_OFFSET (0)
-+#define PCU_BSM_STATUS_CI0_DEFAULT (0x0)
-+#define PCU_BSM_STATUS_DEFAULT ((PCU_BSM_STATUS_STS_DEFAULT << PCU_BSM_STATUS_STS_OFFSET) |\
-+ (PCU_BSM_STATUS_CI1_DEFAULT << PCU_BSM_STATUS_CI1_OFFSET) |\
-+ (PCU_BSM_STATUS_CI0_DEFAULT << PCU_BSM_STATUS_CI0_OFFSET))
-+
-+//wakeup event sensitivity
-+#define PCU_WAKEUP_SEN_POL15_MASK (ANDES_BIT_MASK(15, 15))
-+#define PCU_WAKEUP_SEN_POL15_OFFSET (15)
-+#define PCU_WAKEUP_SEN_POL15_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL14_MASK (ANDES_BIT_MASK(14, 14))
-+#define PCU_WAKEUP_SEN_POL14_OFFSET (14)
-+#define PCU_WAKEUP_SEN_POL14_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL13_MASK (ANDES_BIT_MASK(13, 13))
-+#define PCU_WAKEUP_SEN_POL13_OFFSET (13)
-+#define PCU_WAKEUP_SEN_POL13_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL12_MASK (ANDES_BIT_MASK(12, 12))
-+#define PCU_WAKEUP_SEN_POL12_OFFSET (12)
-+#define PCU_WAKEUP_SEN_POL12_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL11_MASK (ANDES_BIT_MASK(11, 11))
-+#define PCU_WAKEUP_SEN_POL11_OFFSET (11)
-+#define PCU_WAKEUP_SEN_POL11_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL10_MASK (ANDES_BIT_MASK(10, 10))
-+#define PCU_WAKEUP_SEN_POL10_OFFSET (10)
-+#define PCU_WAKEUP_SEN_POL10_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL9_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_WAKEUP_SEN_POL9_OFFSET (9)
-+#define PCU_WAKEUP_SEN_POL9_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL8_MASK (ANDES_BIT_MASK(8, 8))
-+#define PCU_WAKEUP_SEN_POL8_OFFSET (8)
-+#define PCU_WAKEUP_SEN_POL8_DEFAULT (0x1)
-+#define PCU_WAKEUP_SEN_POL7_MASK (ANDES_BIT_MASK(7, 7))
-+#define PCU_WAKEUP_SEN_POL7_OFFSET (7)
-+#define PCU_WAKEUP_SEN_POL7_DEFAULT (0x1)
-+#define PCU_WAKEUP_SEN_POL6_MASK (ANDES_BIT_MASK(6, 6))
-+#define PCU_WAKEUP_SEN_POL6_OFFSET (6)
-+#define PCU_WAKEUP_SEN_POL6_DEFAULT (0x1)
-+#define PCU_WAKEUP_SEN_POL5_MASK (ANDES_BIT_MASK(5, 5))
-+#define PCU_WAKEUP_SEN_POL5_OFFSET (5)
-+#define PCU_WAKEUP_SEN_POL5_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL4_MASK (ANDES_BIT_MASK(4, 4))
-+#define PCU_WAKEUP_SEN_POL4_OFFSET (4)
-+#define PCU_WAKEUP_SEN_POL4_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL3_MASK (ANDES_BIT_MASK(3, 3))
-+#define PCU_WAKEUP_SEN_POL3_OFFSET (3)
-+#define PCU_WAKEUP_SEN_POL3_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL2_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_WAKEUP_SEN_POL2_OFFSET (2)
-+#define PCU_WAKEUP_SEN_POL2_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL1_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_WAKEUP_SEN_POL1_OFFSET (1)
-+#define PCU_WAKEUP_SEN_POL1_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL0_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_WAKEUP_SEN_POL0_OFFSET (0)
-+#define PCU_WAKEUP_SEN_POL0_DEFAULT (0x0)
-+#define PCU_WAKEUP_SEN_POL_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_WAKEUP_SEN_POL_OFFSET (0)
-+#define PCU_WAKEUP_SEN_POL_DEFAULT ((PCU_WAKEUP_SEN_POL15_DEFAULT << PCU_WAKEUP_SEN_POL15_OFFSET) |\
-+ (PCU_WAKEUP_SEN_POL14_DEFAULT << PCU_WAKEUP_SEN_POL14_OFFSET) |\
-+ (PCU_WAKEUP_SEN_POL13_DEFAULT << PCU_WAKEUP_SEN_POL13_OFFSET) |\
-+ (PCU_WAKEUP_SEN_POL12_DEFAULT << PCU_WAKEUP_SEN_POL12_OFFSET) |\
-+ (PCU_WAKEUP_SEN_POL11_DEFAULT << PCU_WAKEUP_SEN_POL11_OFFSET) |\
-+ (PCU_WAKEUP_SEN_POL10_DEFAULT << PCU_WAKEUP_SEN_POL10_OFFSET) |\
-+ (PCU_WAKEUP_SEN_POL9_DEFAULT << PCU_WAKEUP_SEN_POL9_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL8_DEFAULT << PCU_WAKEUP_SEN_POL8_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL7_DEFAULT << PCU_WAKEUP_SEN_POL7_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL6_DEFAULT << PCU_WAKEUP_SEN_POL6_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL5_DEFAULT << PCU_WAKEUP_SEN_POL5_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL4_DEFAULT << PCU_WAKEUP_SEN_POL4_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL3_DEFAULT << PCU_WAKEUP_SEN_POL3_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL2_DEFAULT << PCU_WAKEUP_SEN_POL3_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL1_DEFAULT << PCU_WAKEUP_SEN_POL2_OFFSET ) |\
-+ (PCU_WAKEUP_SEN_POL0_DEFAULT << PCU_WAKEUP_SEN_POL0_OFFSET ) )
-+#define PCU_WAKEUP_SEN_DEFAULT (PCU_WAKEUP_SEN_POL_DEFAULT)
-+#define PCU_WAKEUP_SEN_DFT_MASK (PCU_WAKEUP_SEN_POL_MASK)
-+
-+#define PCU_WAKEUP_SEN_GPIO0_POL_MASK PCU_WAKEUP_SEN_POL0_MASK
-+#define PCU_WAKEUP_SEN_GPIO0_POL_OFFSET PCU_WAKEUP_SEN_POL0_OFFSET
-+#define PCU_WAKEUP_SEN_GPIO0_POL_DEFAULT PCU_WAKEUP_SEN_POL0_DEFAULT
-+#define PCU_WAKEUP_SEN_GPIO1_POL_MASK PCU_WAKEUP_SEN_POL1_MASK
-+#define PCU_WAKEUP_SEN_GPIO1_POL_OFFSET PCU_WAKEUP_SEN_POL1_OFFSET
-+#define PCU_WAKEUP_SEN_GPIO1_POL_DEFAULT PCU_WAKEUP_SEN_POL1_DEFAULT
-+#define PCU_WAKEUP_SEN_GPIO2_POL_MASK PCU_WAKEUP_SEN_POL2_MASK
-+#define PCU_WAKEUP_SEN_GPIO2_POL_OFFSET PCU_WAKEUP_SEN_POL2_OFFSET
-+#define PCU_WAKEUP_SEN_GPIO2_POL_DEFAULT PCU_WAKEUP_SEN_POL2_DEFAULT
-+#define PCU_WAKEUP_SEN_GPIO3_POL_MASK PCU_WAKEUP_SEN_POL3_MASK
-+#define PCU_WAKEUP_SEN_GPIO3_POL_OFFSET PCU_WAKEUP_SEN_POL3_OFFSET
-+#define PCU_WAKEUP_SEN_GPIO3_POL_DEFAULT PCU_WAKEUP_SEN_POL3_DEFAULT
-+#define PCU_WAKEUP_SEN_GPIO4_POL_MASK PCU_WAKEUP_SEN_POL4_MASK
-+#define PCU_WAKEUP_SEN_GPIO4_POL_OFFSET PCU_WAKEUP_SEN_POL4_OFFSET
-+#define PCU_WAKEUP_SEN_GPIO4_POL_DEFAULT PCU_WAKEUP_SEN_POL4_DEFAULT
-+#define PCU_WAKEUP_SEN_GPIO5_POL_MASK PCU_WAKEUP_SEN_POL5_MASK
-+#define PCU_WAKEUP_SEN_GPIO5_POL_OFFSET PCU_WAKEUP_SEN_POL5_OFFSET
-+#define PCU_WAKEUP_SEN_GPIO5_POL_DEFAULT PCU_WAKEUP_SEN_POL5_DEFAULT
-+#define PCU_WAKEUP_SEN_WOL_POL_MASK PCU_WAKEUP_SEN_POL6_MASK
-+#define PCU_WAKEUP_SEN_WOL_POL_OFFSET PCU_WAKEUP_SEN_POL6_OFFSET
-+#define PCU_WAKEUP_SEN_WOL_POL_DEFAULT PCU_WAKEUP_SEN_POL6_DEFAULT
-+#define PCU_WAKEUP_SEN_RTC_POL_MASK PCU_WAKEUP_SEN_POL7_MASK
-+#define PCU_WAKEUP_SEN_RTC_POL_OFFSET PCU_WAKEUP_SEN_POL7_OFFSET
-+#define PCU_WAKEUP_SEN_RTC_POL_DEFAULT PCU_WAKEUP_SEN_POL7_DEFAULT
-+#define PCU_WAKEUP_SEN_DAY_POL_OFFSET PCU_WAKEUP_SEN_POL8_OFFSET
-+#define PCU_WAKEUP_SEN_DAY_POL_DEFAULT PCU_WAKEUP_SEN_POL8_DEFAULT
-+#define PCU_WAKEUP_SEN_DBG_POL_MASK PCU_WAKEUP_SEN_POL9_MASK
-+#define PCU_WAKEUP_SEN_DBG_POL_OFFSET PCU_WAKEUP_SEN_POL9_OFFSET
-+#define PCU_WAKEUP_SEN_DBG_POL_DEFAULT PCU_WAKEUP_SEN_POL9_DEFAULT
-+#define PCU_WAKEUP_SEN_PCI_POL_MASK PCU_WAKEUP_SEN_POL10_MASK
-+#define PCU_WAKEUP_SEN_PCI_POL_OFFSET PCU_WAKEUP_SEN_POL10_OFFSET
-+#define PCU_WAKEUP_SEN_PCI_POL_DEFAULT PCU_WAKEUP_SEN_POL10_DEFAULT
-+#define PCU_WAKEUP_SEN_LPC_POL_MASK PCU_WAKEUP_SEN_POL11_MASK
-+#define PCU_WAKEUP_SEN_LPC_POL_OFFSET PCU_WAKEUP_SEN_POL11_OFFSET
-+#define PCU_WAKEUP_SEN_LPC_POL_DEFAULT PCU_WAKEUP_SEN_POL11_DEFAULT
-+
-+// wakeup event status register
-+#define PCU_WAKEUP_STATUS_SIG_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_WAKEUP_STATUS_SIG_OFFSET (0)
-+#define PCU_WAKEUP_STATUS_SIG_DEFAULT (0x0)
-+#define PCU_WAKEUP_STATUS_DEFAULT (PCU_WAKEUP_STATUS_SIG_DEFAULT << PCU_WAKEUP_STATUS_SIG_OFFSET)
-+#define PCU_WAKEUP_STATUS_DFT_MASK (PCU_WAKEUP_STATUS_SIG_MASK)
-+
-+//reset timing
-+#define PCU_RESET_TIMER_RG3_MASK (ANDES_BIT_MASK(31, 24))
-+#define PCU_RESET_TIMER_RG3_OFFSET (24)
-+#define PCU_RESET_TIMER_RG3_DEFAULT PCU_RESET_TIMER_RG3_CNT_DEFAULT // in rtl fast reset, this will be 0x2
-+#define PCU_RESET_TIMER_RG3_SRC_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_RESET_TIMER_RG3_SRC_OFFSET (31)
-+#define PCU_RESET_TIMER_RG3_SRC_DEFAULT (0x0)
-+#define PCU_RESET_TIMER_RG3_CNT_MASK (ANDES_BIT_MASK(30, 24))
-+#define PCU_RESET_TIMER_RG3_CNT_OFFSET (24)
-+#define PCU_RESET_TIMER_RG3_CNT_DEFAULT (0x4)
-+#define PCU_RESET_TIMER_RG2_MASK (ANDES_BIT_MASK(23, 16))
-+#define PCU_RESET_TIMER_RG2_OFFSET (16)
-+#define PCU_RESET_TIMER_RG2_DEFAULT PCU_RESET_TIMER_RG2_CNT_DEFAULT // in rtl fast reset, this will be 0x2
-+#define PCU_RESET_TIMER_RG2_SRC_MASK (ANDES_BIT_MASK(23, 23))
-+#define PCU_RESET_TIMER_RG2_SRC_OFFSET (23)
-+#define PCU_RESET_TIMER_RG2_SRC_DEFAULT (0x0)
-+#define PCU_RESET_TIMER_RG2_CNT_MASK (ANDES_BIT_MASK(22, 16))
-+#define PCU_RESET_TIMER_RG2_CNT_OFFSET (16)
-+#define PCU_RESET_TIMER_RG2_CNT_DEFAULT (0x4)
-+#define PCU_RESET_TIMER_RG1_MASK (ANDES_BIT_MASK(15, 8))
-+#define PCU_RESET_TIMER_RG1_OFFSET (8)
-+#define PCU_RESET_TIMER_RG1_DEFAULT PCU_RESET_TIMER_RG1_CNT_DEFAULT // in rtl fast reset, this will be 0x2
-+#define PCU_RESET_TIMER_RG1_SRC_MASK (ANDES_BIT_MASK(15, 15))
-+#define PCU_RESET_TIMER_RG1_SRC_OFFSET (15)
-+#define PCU_RESET_TIMER_RG1_SRC_DEFAULT (0x0)
-+#define PCU_RESET_TIMER_RG1_CNT_MASK (ANDES_BIT_MASK(14, 8))
-+#define PCU_RESET_TIMER_RG1_CNT_OFFSET (8)
-+#define PCU_RESET_TIMER_RG1_CNT_DEFAULT (0x4)
-+#define PCU_RESET_TIMER_RG0_MASK (ANDES_BIT_MASK(7, 0))
-+#define PCU_RESET_TIMER_RG0_OFFSET (0)
-+#define PCU_RESET_TIMER_RG0_DEFAULT PCU_RESET_TIMER_RG0_CNT_DEFAULT // in rtl fast reset, this will be 0x2
-+#define PCU_RESET_TIMER_RG0_SRC_MASK (ANDES_BIT_MASK(7, 7))
-+#define PCU_RESET_TIMER_RG0_SRC_OFFSET (7)
-+#define PCU_RESET_TIMER_RG0_SRC_DEFAULT (0x0)
-+#define PCU_RESET_TIMER_RG0_CNT_MASK (ANDES_BIT_MASK(6, 0))
-+#define PCU_RESET_TIMER_RG0_CNT_OFFSET (0)
-+#define PCU_RESET_TIMER_RG0_CNT_DEFAULT (0x4)
-+
-+#define PCU_RESET_TIMER_DEFAULT 0x0 /*((PCU_RESET_TIMER_RG3_DEFAULT << PCU_RESET_TIMER_RG3_OFFSET)|\
-+ (PCU_RESET_TIMER_RG2_DEFAULT << PCU_RESET_TIMER_RG2_OFFSET)|\
-+ (PCU_RESET_TIMER_RG1_DEFAULT << PCU_RESET_TIMER_RG1_OFFSET)|\
-+ (PCU_RESET_TIMER_RG0_DEFAULT << PCU_RESET_TIMER_RG0_OFFSET))*/
-+#define PCU_RESET_TIMER_DFT_MASK 0x0 /*((PCU_RESET_TIMER_RG3_MASK)|\
-+ (PCU_RESET_TIMER_RG2_MASK)|\
-+ (PCU_RESET_TIMER_RG1_MASK)|\
-+ (PCU_RESET_TIMER_RG0_MASK))*/
-+#define PCU_RST_TIMER_SRC_500US (0x1)
-+#define PCU_RST_TIMER_SRC_30US (0x0)
-+
-+// interrupt
-+#define PCU_INTR_GPIOSEC_MASK (ANDES_BIT_MASK(11, 11))
-+#define PCU_INTR_PWRLOW_MASK (ANDES_BIT_MASK(10, 10))
-+#define PCU_INTR_PCS9_MASK (ANDES_BIT_MASK(9, 9))
-+#define PCU_INTR_PCS9_OFFSET (9)
-+#define PCU_INTR_PCS9_DEFAULT (0x0)
-+#define PCU_INTR_PCS8_MASK (ANDES_BIT_MASK(8, 8))
-+#define PCU_INTR_PCS8_OFFSET (8)
-+#define PCU_INTR_PCS8_DEFAULT (0x0)
-+#define PCU_INTR_PCS7_MASK (ANDES_BIT_MASK(7, 7))
-+#define PCU_INTR_PCS7_OFFSET (7)
-+#define PCU_INTR_PCS7_DEFAULT (0x0)
-+#define PCU_INTR_PCS6_MASK (ANDES_BIT_MASK(6, 6))
-+#define PCU_INTR_PCS6_OFFSET (6)
-+#define PCU_INTR_PCS6_DEFAULT (0x0)
-+#define PCU_INTR_PCS5_MASK (ANDES_BIT_MASK(5, 5))
-+#define PCU_INTR_PCS5_OFFSET (5)
-+#define PCU_INTR_PCS5_DEFAULT (0x0)
-+#define PCU_INTR_PCS4_MASK (ANDES_BIT_MASK(4, 4))
-+#define PCU_INTR_PCS4_OFFSET (4)
-+#define PCU_INTR_PCS4_DEFAULT (0x0)
-+#define PCU_INTR_PCS3_MASK (ANDES_BIT_MASK(3, 3))
-+#define PCU_INTR_PCS3_OFFSET (3)
-+#define PCU_INTR_PCS3_DEFAULT (0x0)
-+#define PCU_INTR_PCS2_MASK (ANDES_BIT_MASK(2, 2))
-+#define PCU_INTR_PCS2_OFFSET (2)
-+#define PCU_INTR_PCS2_DEFAULT (0x0)
-+#define PCU_INTR_PCS1_MASK (ANDES_BIT_MASK(1, 1))
-+#define PCU_INTR_PCS1_OFFSET (1)
-+#define PCU_INTR_PCS1_DEFAULT (0x0)
-+#define PCU_INTR_BSM_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_INTR_BSM_OFFSET (0)
-+#define PCU_INTR_BSM_DEFAULT (0x0)
-+#define PCU_INTR_DEFAULT (0x0)
-+
-+// bits field for PCS1 registers
-+#define PCU_PCS1_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS1_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS1_CFG_TYPE_DEFAULT (0x1)
-+#define PCU_PCS1_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS1_CFG_WR_OFFSET (27)
-+#define PCU_PCS1_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS1_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS1_CFG_SR_OFFSET (0)
-+#define PCU_PCS1_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS1_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS1_CFG_LS_OFFSET (20)
-+#define PCU_PCS1_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS1_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS1_CFG_LW_OFFSET (16)
-+#define PCU_PCS1_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS1_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS1_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS1_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS1_CFG_DEFAULT ((PCU_PCS1_CFG_TYPE_DEFAULT << PCU_PCS1_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS1_CFG_WR_DEFAULT << PCU_PCS1_CFG_WR_OFFSET )|\
-+ (PCU_PCS1_CFG_SR_DEFAULT << PCU_PCS1_CFG_SR_OFFSET )|\
-+ (PCU_PCS1_CFG_LS_DEFAULT << PCU_PCS1_CFG_LS_OFFSET )|\
-+ (PCU_PCS1_CFG_LW_DEFAULT << PCU_PCS1_CFG_LW_OFFSET )|\
-+ (PCU_PCS1_CFG_WKEN_DEFAULT << PCU_PCS1_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS1_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS1_PARA_IE_OFFSET (31)
-+#define PCU_PCS1_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS1_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS1_PARA_CMD_OFFSET (28)
-+#define PCU_PCS1_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS1_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS1_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS1_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS1_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS1_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS1_PARA_NXTPAR_DEFAULT (0x1)
-+#define PCU_PCS1_PARA_DIV_MASK (ANDES_BIT_MASK(5, 4))
-+#define PCU_PCS1_PARA_DIV_OFFSET (4)
-+//#define PCU_PCS1_PARA_DIV_DEFAULT (0x0) //jumper setting
-+#define PCU_PCS1_PARA_RATIO_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS1_PARA_RATIO_OFFSET (0)
-+//#define PCU_PCS1_PARA_RATIO_DEFAULT (0x0) //jumper setting
-+#define PCU_PCS1_PARA_DEFAULT ((PCU_PCS1_PARA_IE_DEFAULT << PCU_PCS1_PARA_IE_OFFSET )|\
-+ (PCU_PCS1_PARA_CMD_DEFAULT << PCU_PCS1_PARA_CMD_OFFSET )|\
-+ (PCU_PCS1_PARA_SYNC_DEFAULT << PCU_PCS1_PARA_SYNC_OFFSET))
-+#define PCU_PCS1_PARA_DFT_MASK ((PCU_PCS1_PARA_IE_MASK )|\
-+ (PCU_PCS1_PARA_CMD_MASK )|\
-+ (PCU_PCS1_PARA_SYNC_MASK))
-+
-+#define PCU_PCS1_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS1_ST1_STS_OFFSET (28)
-+#define PCU_PCS1_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS1_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS1_ST1_ERR_OFFSET (0)
-+#define PCU_PCS1_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS1_ST1_DEFAULT ((PCU_PCS1_ST1_STS_DEFAULT << PCU_PCS1_ST1_STS_OFFSET )|\
-+ (PCU_PCS1_ST1_ERR_DEFAULT << PCU_PCS1_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS1_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS1_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS1_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS1_ST2_CURPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS1_ST2_CURPAR_OFFSET (0)
-+//#define PCU_PCS1_ST2_CURPAR_DEFAULT (0x0)
-+#define PCU_PCS1_ST2_DIV_MASK (ANDES_BIT_MASK(5, 4))
-+#define PCU_PCS1_ST2_DIV_OFFSET (4)
-+//#define PCU_PCS1_ST2_DIV_DEFAULT (0x0) //jumper setting
-+#define PCU_PCS1_ST2_RATIO_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS1_ST2_RATIO_OFFSET (0)
-+//#define PCU_PCS1_ST2_RATIO_DEFAULT (0x0) //jumper setting
-+#define PCU_PCS1_ST2_DEFAULT (PCU_PCS1_ST2_SYNC_DEFAULT << PCU_PCS1_ST2_SYNC_OFFSET)
-+#define PCU_PCS1_ST2_DFT_MASK (PCU_PCS1_ST2_SYNC_MASK)
-+
-+
-+// bits field for PCS2 registers
-+#define PCU_PCS2_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS2_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS2_CFG_TYPE_DEFAULT (0x2)
-+#define PCU_PCS2_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS2_CFG_WR_OFFSET (27)
-+#define PCU_PCS2_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS2_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS2_CFG_SR_OFFSET (0)
-+#define PCU_PCS2_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS2_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS2_CFG_LS_OFFSET (20)
-+#define PCU_PCS2_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS2_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS2_CFG_LW_OFFSET (16)
-+#define PCU_PCS2_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS2_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS2_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS2_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS2_CFG_DEFAULT ((PCU_PCS2_CFG_TYPE_DEFAULT << PCU_PCS2_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS2_CFG_WR_DEFAULT << PCU_PCS2_CFG_WR_OFFSET )|\
-+ (PCU_PCS2_CFG_SR_DEFAULT << PCU_PCS2_CFG_SR_OFFSET )|\
-+ (PCU_PCS2_CFG_LS_DEFAULT << PCU_PCS2_CFG_LS_OFFSET )|\
-+ (PCU_PCS2_CFG_LW_DEFAULT << PCU_PCS2_CFG_LW_OFFSET )|\
-+ (PCU_PCS2_CFG_WKEN_DEFAULT << PCU_PCS2_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS2_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS2_PARA_IE_OFFSET (31)
-+#define PCU_PCS2_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS2_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS2_PARA_CMD_OFFSET (28)
-+#define PCU_PCS2_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS2_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS2_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS2_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS2_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS2_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS2_PARA_NXTPAR_DEFAULT (0x0)
-+#define PCU_PCS2_PARA_DEFAULT ((PCU_PCS2_PARA_IE_DEFAULT << PCU_PCS2_PARA_IE_OFFSET )|\
-+ (PCU_PCS2_PARA_CMD_DEFAULT << PCU_PCS2_PARA_CMD_OFFSET )|\
-+ (PCU_PCS2_PARA_SYNC_DEFAULT << PCU_PCS2_PARA_SYNC_OFFSET )|\
-+ (PCU_PCS2_PARA_NXTPAR_DEFAULT << PCU_PCS2_PARA_NXTPAR_OFFSET))
-+#define PCU_PCS2_PARA_DFT_MASK ((PCU_PCS2_PARA_IE_MASK )|\
-+ (PCU_PCS2_PARA_CMD_MASK )|\
-+ (PCU_PCS2_PARA_SYNC_MASK )|\
-+ (PCU_PCS2_PARA_NXTPAR_MASK))
-+
-+#define PCU_PCS2_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS2_ST1_STS_OFFSET (28)
-+#define PCU_PCS2_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS2_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS2_ST1_ERR_OFFSET (0)
-+#define PCU_PCS2_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS2_ST1_DEFAULT ((PCU_PCS2_ST1_STS_DEFAULT << PCU_PCS2_ST1_STS_OFFSET )|\
-+ (PCU_PCS2_ST1_ERR_DEFAULT << PCU_PCS2_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS2_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS2_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS2_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS2_ST2_CURPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS2_ST2_CURPAR_OFFSET (0)
-+#define PCU_PCS2_ST2_CURPAR_DEFAULT (0x0)
-+#define PCU_PCS2_ST2_DEFAULT ((PCU_PCS2_ST2_SYNC_DEFAULT << PCU_PCS2_ST2_SYNC_OFFSET )|\
-+ (PCU_PCS2_ST2_CURPAR_DEFAULT << PCU_PCS2_ST2_CURPAR_OFFSET))
-+#define PCU_PCS2_ST2_DFT_MASK ((PCU_PCS2_ST2_SYNC_MASK )|\
-+ (PCU_PCS2_ST2_CURPAR_MASK))
-+
-+// bits field for PCS3 registers
-+#define PCU_PCS3_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS3_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS3_CFG_TYPE_DEFAULT (0x2)
-+#define PCU_PCS3_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS3_CFG_WR_OFFSET (27)
-+#define PCU_PCS3_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS3_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS3_CFG_SR_OFFSET (0)
-+#define PCU_PCS3_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS3_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS3_CFG_LS_OFFSET (20)
-+#define PCU_PCS3_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS3_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS3_CFG_LW_OFFSET (16)
-+#define PCU_PCS3_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS3_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS3_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS3_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS3_CFG_DEFAULT ((PCU_PCS3_CFG_TYPE_DEFAULT << PCU_PCS3_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS3_CFG_WR_DEFAULT << PCU_PCS3_CFG_WR_OFFSET )|\
-+ (PCU_PCS3_CFG_SR_DEFAULT << PCU_PCS3_CFG_SR_OFFSET )|\
-+ (PCU_PCS3_CFG_LS_DEFAULT << PCU_PCS3_CFG_LS_OFFSET )|\
-+ (PCU_PCS3_CFG_LW_DEFAULT << PCU_PCS3_CFG_LW_OFFSET )|\
-+ (PCU_PCS3_CFG_WKEN_DEFAULT << PCU_PCS3_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS3_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS3_PARA_IE_OFFSET (31)
-+#define PCU_PCS3_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS3_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS3_PARA_CMD_OFFSET (28)
-+#define PCU_PCS3_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS3_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS3_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS3_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS3_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS3_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS3_PARA_NXTPAR_DEFAULT (0x0)
-+#define PCU_PCS3_PARA_DEFAULT ((PCU_PCS3_PARA_IE_DEFAULT << PCU_PCS3_PARA_IE_OFFSET )|\
-+ (PCU_PCS3_PARA_CMD_DEFAULT << PCU_PCS3_PARA_CMD_OFFSET )|\
-+ (PCU_PCS3_PARA_SYNC_DEFAULT << PCU_PCS3_PARA_SYNC_OFFSET )|\
-+ (PCU_PCS3_PARA_NXTPAR_DEFAULT << PCU_PCS3_PARA_NXTPAR_OFFSET))
-+#define PCU_PCS3_PARA_DFT_MASK ((PCU_PCS3_PARA_IE_MASK )|\
-+ (PCU_PCS3_PARA_CMD_MASK )|\
-+ (PCU_PCS3_PARA_SYNC_MASK )|\
-+ (PCU_PCS3_PARA_NXTPAR_MASK))
-+
-+#define PCU_PCS3_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS3_ST1_STS_OFFSET (28)
-+#define PCU_PCS3_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS3_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS3_ST1_ERR_OFFSET (0)
-+#define PCU_PCS3_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS3_ST1_DEFAULT ((PCU_PCS3_ST1_STS_DEFAULT << PCU_PCS3_ST1_STS_OFFSET )|\
-+ (PCU_PCS3_ST1_ERR_DEFAULT << PCU_PCS3_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS3_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS3_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS3_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS3_ST2_CURPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS3_ST2_CURPAR_OFFSET (0)
-+#define PCU_PCS3_ST2_CURPAR_DEFAULT (0x0)
-+#define PCU_PCS3_ST2_DEFAULT ((PCU_PCS3_ST2_SYNC_DEFAULT << PCU_PCS3_ST2_SYNC_OFFSET )|\
-+ (PCU_PCS3_ST2_CURPAR_DEFAULT << PCU_PCS3_ST2_CURPAR_OFFSET))
-+#define PCU_PCS3_ST2_DFT_MASK ((PCU_PCS3_ST2_SYNC_MASK )|\
-+ (PCU_PCS3_ST2_CURPAR_MASK))
-+
-+// bits field for PCS4 registers
-+#define PCU_PCS4_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS4_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS4_CFG_TYPE_DEFAULT (0x0)
-+#define PCU_PCS4_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS4_CFG_WR_OFFSET (27)
-+#define PCU_PCS4_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS4_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS4_CFG_SR_OFFSET (0)
-+#define PCU_PCS4_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS4_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS4_CFG_LS_OFFSET (20)
-+#define PCU_PCS4_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS4_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS4_CFG_LW_OFFSET (16)
-+#define PCU_PCS4_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS4_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS4_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS4_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS4_CFG_DEFAULT ((PCU_PCS4_CFG_TYPE_DEFAULT << PCU_PCS4_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS4_CFG_WR_DEFAULT << PCU_PCS4_CFG_WR_OFFSET )|\
-+ (PCU_PCS4_CFG_SR_DEFAULT << PCU_PCS4_CFG_SR_OFFSET )|\
-+ (PCU_PCS4_CFG_LS_DEFAULT << PCU_PCS4_CFG_LS_OFFSET )|\
-+ (PCU_PCS4_CFG_LW_DEFAULT << PCU_PCS4_CFG_LW_OFFSET )|\
-+ (PCU_PCS4_CFG_WKEN_DEFAULT << PCU_PCS4_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS4_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS4_PARA_IE_OFFSET (31)
-+#define PCU_PCS4_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS4_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS4_PARA_CMD_OFFSET (28)
-+#define PCU_PCS4_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS4_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS4_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS4_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS4_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS4_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS4_PARA_NXTPAR_DEFAULT (0x4)
-+#define PCU_PCS4_PARA_PWDN_MASK (ANDES_BIT_MASK(23, 23))
-+#define PCU_PCS4_PARA_PWDN_OFFSET (23)
-+#define PCU_PCS4_PARA_PWDN_DEFAULT (0x0)
-+#define PCU_PCS4_PARA_RANGE_MASK (ANDES_BIT_MASK(17, 16))
-+#define PCU_PCS4_PARA_RANGE_OFFSET (16)
-+#define PCU_PCS4_PARA_RANGE_DEFAULT (0x0)
-+#define PCU_PCS4_PARA_N_FACTOR_MASK (ANDES_BIT_MASK(7, 0))
-+#define PCU_PCS4_PARA_N_FACTOR_OFFSET (0)
-+#define PCU_PCS4_PARA_N_FACTOR_DEFAULT (0x4)
-+#define PCU_PCS4_PARA_DEFAULT ((PCU_PCS4_PARA_IE_DEFAULT << PCU_PCS4_PARA_IE_OFFSET )|\
-+ (PCU_PCS4_PARA_CMD_DEFAULT << PCU_PCS4_PARA_CMD_OFFSET )|\
-+ (PCU_PCS4_PARA_SYNC_DEFAULT << PCU_PCS4_PARA_SYNC_OFFSET)|\
-+ (PCU_PCS4_PARA_PWDN_DEFAULT << PCU_PCS4_PARA_PWDN_OFFSET))
-+#define PCU_PCS4_PARA_DFT_MASK ((PCU_PCS4_PARA_IE_MASK )|\
-+ (PCU_PCS4_PARA_CMD_MASK )|\
-+ (PCU_PCS4_PARA_SYNC_MASK)|\
-+ (PCU_PCS4_PARA_PWDN_MASK))
-+
-+#define PCU_PCS4_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS4_ST1_STS_OFFSET (28)
-+#define PCU_PCS4_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS4_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS4_ST1_ERR_OFFSET (0)
-+#define PCU_PCS4_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS4_ST1_DEFAULT ((PCU_PCS4_ST1_STS_DEFAULT << PCU_PCS4_ST1_STS_OFFSET )|\
-+ (PCU_PCS4_ST1_ERR_DEFAULT << PCU_PCS4_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS4_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS4_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS4_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS4_ST2_CURPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS4_ST2_CURPAR_OFFSET (0)
-+//#define PCU_PCS4_ST2_CURPAR_DEFAULT (0x0)
-+#define PCU_PCS4_ST2_PWDN_MASK PCU_PCS4_PARA_PWDN_MASK
-+#define PCU_PCS4_ST2_PWDN_OFFSET PCU_PCS4_PARA_PWDN_OFFSET
-+#define PCU_PCS4_ST2_PWDN_DEFAULT PCU_PCS4_PARA_PWDN_DEFAULT
-+#define PCU_PCS4_ST2_RANGE_MASK PCU_PCS4_PARA_RANGE_MASK
-+#define PCU_PCS4_ST2_RANGE_OFFSET PCU_PCS4_PARA_RANGE_OFFSET
-+//#define PCU_PCS4_ST2_RANGE_DEFAULT PCU_PCS4_PARA_RANGE_DEFAULT
-+#define PCU_PCS4_ST2_N_FACTOR_MASK PCU_PCS4_PARA_N_FACTOR_MASK
-+#define PCU_PCS4_ST2_N_FACTOR_OFFSET PCU_PCS4_PARA_N_FACTOR_OFFSET
-+//#define PCU_PCS4_ST2_N_FACTOR_DEFAULT PCU_PCS4_PARA_N_FACTOR_DEFAULT
-+#define PCU_PCS4_ST2_DEFAULT ((PCU_PCS4_ST2_SYNC_DEFAULT << PCU_PCS4_ST2_SYNC_OFFSET)|\
-+ (PCU_PCS4_ST2_PWDN_DEFAULT << PCU_PCS4_ST2_PWDN_OFFSET))
-+#define PCU_PCS4_ST2_DFT_MASK ((PCU_PCS4_ST2_SYNC_MASK)|\
-+ (PCU_PCS4_ST2_PWDN_MASK))
-+
-+// bits field for PCS5 registers
-+#define PCU_PCS5_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS5_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS5_CFG_TYPE_DEFAULT (0x0)
-+#define PCU_PCS5_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS5_CFG_WR_OFFSET (27)
-+#define PCU_PCS5_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS5_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS5_CFG_SR_OFFSET (0)
-+#define PCU_PCS5_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS5_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS5_CFG_LS_OFFSET (20)
-+#define PCU_PCS5_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS5_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS5_CFG_LW_OFFSET (16)
-+#define PCU_PCS5_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS5_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS5_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS5_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS5_CFG_DEFAULT ((PCU_PCS5_CFG_TYPE_DEFAULT << PCU_PCS5_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS5_CFG_WR_DEFAULT << PCU_PCS5_CFG_WR_OFFSET )|\
-+ (PCU_PCS5_CFG_SR_DEFAULT << PCU_PCS5_CFG_SR_OFFSET )|\
-+ (PCU_PCS5_CFG_LS_DEFAULT << PCU_PCS5_CFG_LS_OFFSET )|\
-+ (PCU_PCS5_CFG_LW_DEFAULT << PCU_PCS5_CFG_LW_OFFSET )|\
-+ (PCU_PCS5_CFG_WKEN_DEFAULT << PCU_PCS5_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS5_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS5_PARA_IE_OFFSET (31)
-+#define PCU_PCS5_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS5_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS5_PARA_CMD_OFFSET (28)
-+#define PCU_PCS5_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS5_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS5_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS5_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS5_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS5_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS5_PARA_NXTPAR_DEFAULT (0x0)
-+#define PCU_PCS5_PARA_DLL_PWDN_MASK (ANDES_BIT_MASK(23, 23))
-+#define PCU_PCS5_PARA_DLL_PWDN_OFFSET (23)
-+#define PCU_PCS5_PARA_DLL_PWDN_DEFAULT (0x0)
-+#define PCU_PCS5_PARA_PLL_PWDN_MASK (ANDES_BIT_MASK(22, 22))
-+#define PCU_PCS5_PARA_PLL_PWDN_OFFSET (22)
-+#define PCU_PCS5_PARA_PLL_PWDN_DEFAULT (0x0)
-+#define PCU_PCS5_PARA_DLL_BYPASS_MASK (ANDES_BIT_MASK(16, 16))
-+#define PCU_PCS5_PARA_DLL_BYPASS_OFFSET (16)
-+#define PCU_PCS5_PARA_DLL_BYPASS_DEFAULT (0x0)
-+#define PCU_PCS5_PARA_DLL_DELAY_MASK (ANDES_BIT_MASK(15, 12))
-+#define PCU_PCS5_PARA_DLL_DELAY_OFFSET (12)
-+#define PCU_PCS5_PARA_DLL_DELAY_DEFAULT (0x0)
-+#define PCU_PCS5_PARA_66MHZ_MASK (ANDES_BIT_MASK(11, 11))
-+#define PCU_PCS5_PARA_66MHZ_OFFSET (11)
-+//#define PCU_PCS5_PARA_66MHZ_DEFAULT (0x0) /dumper setting
-+#define PCU_PCS5_PARA_DEFAULT ((PCU_PCS5_PARA_IE_DEFAULT << PCU_PCS5_PARA_IE_OFFSET )|\
-+ (PCU_PCS5_PARA_CMD_DEFAULT << PCU_PCS5_PARA_CMD_OFFSET )|\
-+ (PCU_PCS5_PARA_SYNC_DEFAULT << PCU_PCS5_PARA_SYNC_OFFSET )|\
-+ (PCU_PCS5_PARA_PLL_PWDN_DEFAULT << PCU_PCS5_PARA_PLL_PWDN_OFFSET )|\
-+ (PCU_PCS5_PARA_DLL_DELAY_DEFAULT << PCU_PCS5_PARA_DLL_DELAY_OFFSET ))
-+#define PCU_PCS5_PARA_DFT_MASK ((PCU_PCS5_PARA_IE_MASK )|\
-+ (PCU_PCS5_PARA_CMD_MASK )|\
-+ (PCU_PCS5_PARA_SYNC_MASK )|\
-+ (PCU_PCS5_PARA_PLL_PWDN_MASK )|\
-+ (PCU_PCS5_PARA_DLL_DELAY_MASK ))
-+
-+#define PCU_PCS5_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS5_ST1_STS_OFFSET (28)
-+#define PCU_PCS5_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS5_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS5_ST1_ERR_OFFSET (0)
-+#define PCU_PCS5_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS5_ST1_DEFAULT ((PCU_PCS5_ST1_STS_DEFAULT << PCU_PCS5_ST1_STS_OFFSET )|\
-+ (PCU_PCS5_ST1_ERR_DEFAULT << PCU_PCS5_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS5_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS5_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS5_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS5_ST2_CURPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS5_ST2_CURPAR_OFFSET (0)
-+//#define PCU_PCS5_ST2_CURPAR_DEFAULT (0x0) //no default
-+#define PCU_PCS5_ST2_DLL_PWDN_MASK PCU_PCS5_PARA_DLL_PWDN_MASK
-+#define PCU_PCS5_ST2_DLL_PWDN_OFFSET PCU_PCS5_PARA_DLL_PWDN_OFFSET
-+#define PCU_PCS5_ST2_DLL_PWDN_DEFAULT PCU_PCS5_PARA_DLL_PWDN_DEFAULT
-+#define PCU_PCS5_ST2_PLL_PWDN_MASK PCU_PCS5_PARA_PLL_PWDN_MASK
-+#define PCU_PCS5_ST2_PLL_PWDN_OFFSET PCU_PCS5_PARA_PLL_PWDN_OFFSET
-+#define PCU_PCS5_ST2_PLL_PWDN_DEFAULT PCU_PCS5_PARA_PLL_PWDN_DEFAULT
-+#define PCU_PCS5_ST2_DLL_BYPASS_MASK PCU_PCS5_PARA_DLL_BYPASS_MASK
-+#define PCU_PCS5_ST2_DLL_BYPASS_OFFSET PCU_PCS5_PARA_DLL_BYPASS_OFFSET
-+#define PCU_PCS5_ST2_DLL_BYPASS_DEFAULT PCU_PCS5_PARA_DLL_BYPASS_DEFAULT
-+#define PCU_PCS5_ST2_DLL_DELAY_MASK PCU_PCS5_PARA_DLL_DELAY_MASK
-+#define PCU_PCS5_ST2_DLL_DELAY_OFFSET PCU_PCS5_PARA_DLL_DELAY_OFFSET
-+#define PCU_PCS5_ST2_DLL_DELAY_DEFAULT PCU_PCS5_PARA_DLL_DELAY_DEFAULT
-+#define PCU_PCS5_ST2_DEFAULT ((PCU_PCS5_ST2_SYNC_DEFAULT << PCU_PCS5_ST2_SYNC_OFFSET )|\
-+ (PCU_PCS5_ST2_PLL_PWDN_DEFAULT << PCU_PCS5_ST2_PLL_PWDN_OFFSET )|\
-+ (PCU_PCS5_ST2_DLL_DELAY_DEFAULT << PCU_PCS5_ST2_DLL_DELAY_OFFSET ))
-+#define PCU_PCS5_ST2_DFT_MASK ((PCU_PCS5_ST2_SYNC_MASK )|\
-+ (PCU_PCS5_ST2_PLL_PWDN_MASK )|\
-+ (PCU_PCS5_ST2_DLL_DELAY_MASK ))
-+
-+// bits field for PCS6 registers
-+#define PCU_PCS6_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS6_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS6_CFG_TYPE_DEFAULT (0x0)
-+#define PCU_PCS6_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS6_CFG_WR_OFFSET (27)
-+#define PCU_PCS6_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS6_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS6_CFG_SR_OFFSET (0)
-+#define PCU_PCS6_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS6_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS6_CFG_LS_OFFSET (20)
-+#define PCU_PCS6_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS6_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS6_CFG_LW_OFFSET (16)
-+#define PCU_PCS6_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS6_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS6_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS6_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS6_CFG_DEFAULT ((PCU_PCS6_CFG_TYPE_DEFAULT << PCU_PCS6_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS6_CFG_WR_DEFAULT << PCU_PCS6_CFG_WR_OFFSET )|\
-+ (PCU_PCS6_CFG_SR_DEFAULT << PCU_PCS6_CFG_SR_OFFSET )|\
-+ (PCU_PCS6_CFG_LS_DEFAULT << PCU_PCS6_CFG_LS_OFFSET )|\
-+ (PCU_PCS6_CFG_LW_DEFAULT << PCU_PCS6_CFG_LW_OFFSET )|\
-+ (PCU_PCS6_CFG_WKEN_DEFAULT << PCU_PCS6_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS6_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS6_PARA_IE_OFFSET (31)
-+#define PCU_PCS6_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS6_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS6_PARA_CMD_OFFSET (28)
-+#define PCU_PCS6_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS6_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS6_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS6_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS6_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS6_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS6_PARA_NXTPAR_DEFAULT (0x0)
-+#define PCU_PCS6_PARA_PWDN_MASK (ANDES_BIT_MASK(23, 23))
-+#define PCU_PCS6_PARA_PWDN_OFFSET (23)
-+#define PCU_PCS6_PARA_PWDN_DEFAULT (0x0)
-+#define PCU_PCS6_PARA_DEFAULT ((PCU_PCS6_PARA_IE_DEFAULT << PCU_PCS6_PARA_IE_OFFSET )|\
-+ (PCU_PCS6_PARA_CMD_DEFAULT << PCU_PCS6_PARA_CMD_OFFSET )|\
-+ (PCU_PCS6_PARA_SYNC_DEFAULT << PCU_PCS6_PARA_SYNC_OFFSET)|\
-+ (PCU_PCS6_PARA_PWDN_DEFAULT << PCU_PCS6_PARA_PWDN_OFFSET))
-+#define PCU_PCS6_PARA_DFT_MASK ((PCU_PCS6_PARA_IE_MASK )|\
-+ (PCU_PCS6_PARA_CMD_MASK )|\
-+ (PCU_PCS6_PARA_SYNC_MASK)|\
-+ (PCU_PCS6_PARA_PWDN_MASK))
-+
-+#define PCU_PCS6_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS6_ST1_STS_OFFSET (28)
-+#define PCU_PCS6_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS6_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS6_ST1_ERR_OFFSET (0)
-+#define PCU_PCS6_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS6_ST1_DEFAULT ((PCU_PCS6_ST1_STS_DEFAULT << PCU_PCS6_ST1_STS_OFFSET )|\
-+ (PCU_PCS6_ST1_ERR_DEFAULT << PCU_PCS6_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS6_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS6_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS6_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS6_ST2_CURPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS6_ST2_CURPAR_OFFSET (0)
-+//#define PCU_PCS6_ST2_CURPAR_DEFAULT (0x0) //no default
-+#define PCU_PCS6_ST2_PWDN_MASK PCU_PCS6_PARA_PWDN_MASK
-+#define PCU_PCS6_ST2_PWDN_OFFSET PCU_PCS6_PARA_PWDN_OFFSET
-+#define PCU_PCS6_ST2_PWDN_DEFAULT PCU_PCS6_PARA_PWDN_DEFAULT
-+#define PCU_PCS6_ST2_DEFAULT ((PCU_PCS6_ST2_SYNC_DEFAULT << PCU_PCS6_ST2_SYNC_OFFSET)|\
-+ (PCU_PCS6_ST2_PWDN_DEFAULT << PCU_PCS6_ST2_PWDN_OFFSET))
-+#define PCU_PCS6_ST2_DFT_MASK ((PCU_PCS6_ST2_SYNC_MASK)|\
-+ (PCU_PCS6_ST2_PWDN_MASK))
-+
-+// bits field for PCS7 registers
-+#define PCU_PCS7_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS7_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS7_CFG_TYPE_DEFAULT (0x0)
-+#define PCU_PCS7_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS7_CFG_WR_OFFSET (27)
-+#define PCU_PCS7_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS7_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS7_CFG_SR_OFFSET (0)
-+#define PCU_PCS7_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS7_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS7_CFG_LS_OFFSET (20)
-+#define PCU_PCS7_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS7_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS7_CFG_LW_OFFSET (16)
-+#define PCU_PCS7_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS7_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS7_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS7_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS7_CFG_DEFAULT ((PCU_PCS7_CFG_TYPE_DEFAULT << PCU_PCS7_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS7_CFG_WR_DEFAULT << PCU_PCS7_CFG_WR_OFFSET )|\
-+ (PCU_PCS7_CFG_SR_DEFAULT << PCU_PCS7_CFG_SR_OFFSET )|\
-+ (PCU_PCS7_CFG_LS_DEFAULT << PCU_PCS7_CFG_LS_OFFSET )|\
-+ (PCU_PCS7_CFG_LW_DEFAULT << PCU_PCS7_CFG_LW_OFFSET )|\
-+ (PCU_PCS7_CFG_WKEN_DEFAULT << PCU_PCS7_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS7_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS7_PARA_IE_OFFSET (31)
-+#define PCU_PCS7_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS7_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS7_PARA_CMD_OFFSET (28)
-+#define PCU_PCS7_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS7_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS7_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS7_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS7_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS7_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS7_PARA_NXTPAR_DEFAULT (0x0)
-+#define PCU_PCS7_PARA_PWDN_MASK (ANDES_BIT_MASK(23, 23))
-+#define PCU_PCS7_PARA_PWDN_OFFSET (23)
-+#define PCU_PCS7_PARA_PWDN_DEFAULT (0x0)
-+#define PCU_PCS7_PARA_DEFAULT ((PCU_PCS7_PARA_IE_DEFAULT << PCU_PCS7_PARA_IE_OFFSET )|\
-+ (PCU_PCS7_PARA_CMD_DEFAULT << PCU_PCS7_PARA_CMD_OFFSET )|\
-+ (PCU_PCS7_PARA_SYNC_DEFAULT << PCU_PCS7_PARA_SYNC_OFFSET)|\
-+ (PCU_PCS7_PARA_PWDN_DEFAULT << PCU_PCS7_PARA_PWDN_OFFSET))
-+#define PCU_PCS7_PARA_DFT_MASK ((PCU_PCS7_PARA_IE_MASK )|\
-+ (PCU_PCS7_PARA_CMD_MASK )|\
-+ (PCU_PCS7_PARA_SYNC_MASK)|\
-+ (PCU_PCS7_PARA_PWDN_MASK))
-+
-+#define PCU_PCS7_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS7_ST1_STS_OFFSET (28)
-+#define PCU_PCS7_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS7_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS7_ST1_ERR_OFFSET (0)
-+#define PCU_PCS7_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS7_ST1_DEFAULT ((PCU_PCS7_ST1_STS_DEFAULT << PCU_PCS7_ST1_STS_OFFSET )|\
-+ (PCU_PCS7_ST1_ERR_DEFAULT << PCU_PCS7_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS7_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS7_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS7_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS7_ST2_CURPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS7_ST2_CURPAR_OFFSET (0)
-+//#define PCU_PCS7_ST2_CURPAR_DEFAULT (0x0) //no default
-+#define PCU_PCS7_ST2_PWDN_MASK PCU_PCS7_PARA_PWDN_MASK
-+#define PCU_PCS7_ST2_PWDN_OFFSET PCU_PCS7_PARA_PWDN_OFFSET
-+#define PCU_PCS7_ST2_PWDN_DEFAULT PCU_PCS7_PARA_PWDN_DEFAULT
-+#define PCU_PCS7_ST2_DEFAULT ((PCU_PCS7_ST2_SYNC_DEFAULT << PCU_PCS7_ST2_SYNC_OFFSET)|\
-+ (PCU_PCS7_ST2_PWDN_DEFAULT << PCU_PCS7_ST2_PWDN_OFFSET))
-+#define PCU_PCS7_ST2_DFT_MASK ((PCU_PCS7_ST2_SYNC_MASK)|\
-+ (PCU_PCS7_ST2_PWDN_MASK))
-+
-+// bits field for PCS8 registers
-+#define PCU_PCS8_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS8_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS8_CFG_TYPE_DEFAULT (0x4)
-+#define PCU_PCS8_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS8_CFG_WR_OFFSET (27)
-+#define PCU_PCS8_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS8_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS8_CFG_SR_OFFSET (0)
-+#define PCU_PCS8_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS8_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS8_CFG_LS_OFFSET (20)
-+#define PCU_PCS8_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS8_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS8_CFG_LW_OFFSET (16)
-+#define PCU_PCS8_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS8_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS8_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS8_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS8_CFG_DEFAULT ((PCU_PCS8_CFG_TYPE_DEFAULT << PCU_PCS8_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS8_CFG_WR_DEFAULT << PCU_PCS8_CFG_WR_OFFSET )|\
-+ (PCU_PCS8_CFG_SR_DEFAULT << PCU_PCS8_CFG_SR_OFFSET )|\
-+ (PCU_PCS8_CFG_LS_DEFAULT << PCU_PCS8_CFG_LS_OFFSET )|\
-+ (PCU_PCS8_CFG_LW_DEFAULT << PCU_PCS8_CFG_LW_OFFSET )|\
-+ (PCU_PCS8_CFG_WKEN_DEFAULT << PCU_PCS8_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS8_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS8_PARA_IE_OFFSET (31)
-+#define PCU_PCS8_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS8_PARA_CMD_OFFSET (28)
-+#define PCU_PCS8_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS8_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS8_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS8_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS8_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS8_PARA_NXTPAR_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_STOP_MASK (ANDES_BIT_MASK(13, 13))
-+#define PCU_PCS8_PARA_STOP_OFFSET (13)
-+#define PCU_PCS8_PARA_STOP_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_START_MASK (ANDES_BIT_MASK(12, 12))
-+#define PCU_PCS8_PARA_START_OFFSET (12)
-+#define PCU_PCS8_PARA_START_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_BYTES_MASK (ANDES_BIT_MASK(10, 8))
-+#define PCU_PCS8_PARA_BYTES_OFFSET (8)
-+#define PCU_PCS8_PARA_BYTES_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_ADDR_MASK (ANDES_BIT_MASK(7, 1))
-+#define PCU_PCS8_PARA_ADDR_OFFSET (1)
-+#define PCU_PCS8_PARA_ADDR_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_READ_MASK (ANDES_BIT_MASK(0, 0))
-+#define PCU_PCS8_PARA_READ_OFFSET (0)
-+#define PCU_PCS8_PARA_READ_DEFAULT (0x0)
-+#define PCU_PCS8_PARA_DEFAULT ((PCU_PCS8_PARA_IE_DEFAULT << PCU_PCS8_PARA_IE_OFFSET )|\
-+ (PCU_PCS8_PARA_CMD_DEFAULT << PCU_PCS8_PARA_CMD_OFFSET )|\
-+ (PCU_PCS8_PARA_SYNC_DEFAULT << PCU_PCS8_PARA_SYNC_OFFSET )|\
-+ (PCU_PCS8_PARA_NXTPAR_DEFAULT << PCU_PCS8_PARA_NXTPAR_OFFSET))
-+
-+
-+#define PCU_PCS8_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS8_ST1_STS_OFFSET (28)
-+#define PCU_PCS8_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS8_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS8_ST1_ERR_OFFSET (0)
-+#define PCU_PCS8_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS8_ST1_DEFAULT ((PCU_PCS8_ST1_STS_DEFAULT << PCU_PCS8_ST1_STS_OFFSET )|\
-+ (PCU_PCS8_ST1_ERR_DEFAULT << PCU_PCS8_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS8_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS8_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS8_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS8_ST2_CURPAR_MASK PCU_PCS8_PARA_NXTPAR_MASK
-+#define PCU_PCS8_ST2_CURPAR_OFFSET PCU_PCS8_PARA_NXTPAR_OFFSET
-+#define PCU_PCS8_ST2_CURPAR_DEFAULT PCU_PCS8_PARA_NXTPAR_DEFAULT
-+#define PCU_PCS8_ST2_DEFAULT ((PCU_PCS8_ST2_SYNC_DEFAULT << PCU_PCS8_ST2_SYNC_OFFSET )|\
-+ (PCU_PCS8_ST2_CURPAR_DEFAULT << PCU_PCS8_ST2_CURPAR_OFFSET))
-+
-+
-+#define PCU_PCS8_PDD_4TH_BYTE_MASK (ANDES_BIT_MASK(31, 24))
-+#define PCU_PCS8_PDD_4TH_BYTE_OFFSET (24)
-+#define PCU_PCS8_PDD_4TH_BYTE_DEFAULT (0x0)
-+#define PCU_PCS8_PDD_3RD_BYTE_MASK (ANDES_BIT_MASK(23, 16))
-+#define PCU_PCS8_PDD_3RD_BYTE_OFFSET (16)
-+#define PCU_PCS8_PDD_3RD_BYTE_DEFAULT (0x0)
-+#define PCU_PCS8_PDD_2ND_BYTE_MASK (ANDES_BIT_MASK(15, 8))
-+#define PCU_PCS8_PDD_2ND_BYTE_OFFSET (8)
-+#define PCU_PCS8_PDD_2ND_BYTE_DEFAULT (0x0)
-+#define PCU_PCS8_PDD_1ST_BYTE_MASK (ANDES_BIT_MASK(7, 0))
-+#define PCU_PCS8_PDD_1ST_BYTE_OFFSET (0)
-+#define PCU_PCS8_PDD_1ST_BYTE_DEFAULT (0x0)
-+#define PCU_PCS8_PDD_DEFAULT ((PCU_PCS8_PDD_4TH_BYTE_DEFAULT << PCU_PCS8_PDD_4TH_BYTE_OFFSET)|\
-+ (PCU_PCS8_PDD_3RD_BYTE_DEFAULT << PCU_PCS8_PDD_3RD_BYTE_OFFSET)|\
-+ (PCU_PCS8_PDD_2ND_BYTE_DEFAULT << PCU_PCS8_PDD_2ND_BYTE_OFFSET)|\
-+ (PCU_PCS8_PDD_1ST_BYTE_DEFAULT << PCU_PCS8_PDD_1ST_BYTE_OFFSET))
-+
-+// bits field for PCS9 registers
-+#define PCU_PCS9_CFG_TYPE_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS9_CFG_TYPE_OFFSET (28)
-+#define PCU_PCS9_CFG_TYPE_DEFAULT (0x6)
-+#define PCU_PCS9_CFG_WR_MASK (ANDES_BIT_MASK(27, 27))
-+#define PCU_PCS9_CFG_WR_OFFSET (27)
-+#define PCU_PCS9_CFG_WR_DEFAULT (0x0)
-+#define PCU_PCS9_CFG_SR_MASK (ANDES_BIT_MASK(26, 26))
-+#define PCU_PCS9_CFG_SR_OFFSET (0)
-+#define PCU_PCS9_CFG_SR_DEFAULT (0x0)
-+#define PCU_PCS9_CFG_LS_MASK (ANDES_BIT_MASK(23, 20))
-+#define PCU_PCS9_CFG_LS_OFFSET (20)
-+#define PCU_PCS9_CFG_LS_DEFAULT (0x0)
-+#define PCU_PCS9_CFG_LW_MASK (ANDES_BIT_MASK(19, 16))
-+#define PCU_PCS9_CFG_LW_OFFSET (16)
-+#define PCU_PCS9_CFG_LW_DEFAULT (0x0)
-+#define PCU_PCS9_CFG_WKEN_MASK (ANDES_BIT_MASK(15, 0))
-+#define PCU_PCS9_CFG_WKEN_OFFSET (0)
-+#define PCU_PCS9_CFG_WKEN_DEFAULT (0x0)
-+#define PCU_PCS9_CFG_DEFAULT ((PCU_PCS9_CFG_TYPE_DEFAULT << PCU_PCS9_CFG_TYPE_OFFSET)|\
-+ (PCU_PCS9_CFG_WR_DEFAULT << PCU_PCS9_CFG_WR_OFFSET )|\
-+ (PCU_PCS9_CFG_SR_DEFAULT << PCU_PCS9_CFG_SR_OFFSET )|\
-+ (PCU_PCS9_CFG_LS_DEFAULT << PCU_PCS9_CFG_LS_OFFSET )|\
-+ (PCU_PCS9_CFG_LW_DEFAULT << PCU_PCS9_CFG_LW_OFFSET )|\
-+ (PCU_PCS9_CFG_WKEN_DEFAULT << PCU_PCS9_CFG_WKEN_OFFSET))
-+
-+#define PCU_PCS9_PARA_IE_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS9_PARA_IE_OFFSET (31)
-+#define PCU_PCS9_PARA_IE_DEFAULT (0x0)
-+#define PCU_PCS9_PARA_CMD_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS9_PARA_CMD_OFFSET (28)
-+#define PCU_PCS9_PARA_CMD_DEFAULT (0x0)
-+#define PCU_PCS9_PARA_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS9_PARA_SYNC_OFFSET (24)
-+#define PCU_PCS9_PARA_SYNC_DEFAULT (0x3)
-+#define PCU_PCS9_PARA_NXTPAR_MASK (ANDES_BIT_MASK(23, 0))
-+#define PCU_PCS9_PARA_NXTPAR_OFFSET (0)
-+#define PCU_PCS9_PARA_NXTPAR_DEFAULT (0x0)
-+#define PCU_PCS9_PARA_TEST_MASK (PCS_POWER_GPU_AND_DAC |\
-+ PCS_POWER_CPUB )
-+
-+#define PCU_PCS9_PARA_TEST PCU_PCS9_PARA_TEST_MASK
-+
-+#define PCU_PCS9_PARA_DEFAULT ((PCU_PCS9_PARA_IE_DEFAULT << PCU_PCS9_PARA_IE_OFFSET )|\
-+ (PCU_PCS9_PARA_CMD_DEFAULT << PCU_PCS9_PARA_CMD_OFFSET )|\
-+ (PCU_PCS9_PARA_SYNC_DEFAULT << PCU_PCS9_PARA_SYNC_OFFSET )|\
-+ (PCU_PCS9_PARA_NXTPAR_DEFAULT << PCU_PCS9_PARA_NXTPAR_OFFSET))
-+
-+#define PCU_PCS9_ST1_STS_MASK (ANDES_BIT_MASK(30, 28))
-+#define PCU_PCS9_ST1_STS_OFFSET (28)
-+#define PCU_PCS9_ST1_STS_DEFAULT (0x0)
-+#define PCU_PCS9_ST1_ERR_MASK (ANDES_BIT_MASK(3, 0))
-+#define PCU_PCS9_ST1_ERR_OFFSET (0)
-+#define PCU_PCS9_ST1_ERR_DEFAULT (0x0)
-+#define PCU_PCS9_ST1_DEFAULT ((PCU_PCS9_ST1_STS_DEFAULT << PCU_PCS9_ST1_STS_OFFSET )|\
-+ (PCU_PCS9_ST1_ERR_DEFAULT << PCU_PCS9_ST1_ERR_OFFSET ))
-+
-+#define PCU_PCS9_ST2_SYNC_MASK (ANDES_BIT_MASK(27, 24))
-+#define PCU_PCS9_ST2_SYNC_OFFSET (24)
-+#define PCU_PCS9_ST2_SYNC_DEFAULT (0x0)
-+#define PCU_PCS9_ST2_CURPAR_MASK PCU_PCS9_PARA_NXTPAR_MASK
-+#define PCU_PCS9_ST2_CURPAR_OFFSET PCU_PCS9_PARA_NXTPAR_OFFSET
-+#define PCU_PCS9_ST2_CURPAR_DEFAULT (0x1f)
-+#define PCU_PCS9_ST2_DEFAULT ((PCU_PCS9_ST2_SYNC_DEFAULT << PCU_PCS9_ST2_SYNC_OFFSET )|\
-+ (PCU_PCS9_ST2_CURPAR_DEFAULT << PCU_PCS9_ST2_CURPAR_OFFSET))
-+
-+#define PCU_PCS9_PDD_CLR_PWOFF_FLAG_MASK (ANDES_BIT_MASK(31, 31))
-+#define PCU_PCS9_PDD_CLR_PWOFF_FLAG_OFFSET (31)
-+#define PCU_PCS9_PDD_CLR_PWOFF_FLAG_DEFAULT (0x0)
-+#define PCU_PCS9_PDD_SUSP2RAM_MASK (ANDES_BIT_MASK(30, 30))
-+#define PCU_PCS9_PDD_SUSP2RAM_OFFSET (30)
-+#define PCU_PCS9_PDD_SUSP2RAM_DEFAULT (0x0)
-+#define PCU_PCS9_PDD_PWR_OFF_TIME_MASK (ANDES_BIT_MASK(29, 28))
-+#define PCU_PCS9_PDD_PWR_OFF_TIME_OFFSET (28)
-+#define PCU_PCS9_PDD_PWR_OFF_TIME_DEFAULT (0x3)
-+#define PCU_PCS9_PDD_TICK_MASK (ANDES_BIT_MASK(24, 24))
-+#define PCU_PCS9_PDD_TICK_OFFSET (24)
-+#define PCU_PCS9_PDD_TICK_DEFAULT (0x1)
-+#define PCU_PCS9_PDD_TIMER4_MASK (ANDES_BIT_MASK(23, 18))
-+#define PCU_PCS9_PDD_TIMER4_OFFSET (18)
-+#define PCU_PCS9_PDD_TIMER4_DEFAULT (0x20)
-+#define PCU_PCS9_PDD_TIMER3_MASK (ANDES_BIT_MASK(17, 12))
-+#define PCU_PCS9_PDD_TIMER3_OFFSET (12)
-+#define PCU_PCS9_PDD_TIMER3_DEFAULT (0x20)
-+#define PCU_PCS9_PDD_TIMER2_MASK (ANDES_BIT_MASK(11, 6))
-+#define PCU_PCS9_PDD_TIMER2_OFFSET (6)
-+#define PCU_PCS9_PDD_TIMER2_DEFAULT (0x20)
-+#define PCU_PCS9_PDD_TIMER1_MASK (ANDES_BIT_MASK(5, 0))
-+#define PCU_PCS9_PDD_TIMER1_OFFSET (0)
-+#define PCU_PCS9_PDD_TIMER1_DEFAULT (0x20)
-+
-+#define PCU_PCS9_PDD_DEFAULT ((PCU_PCS9_PDD_CLR_PWOFF_FLAG_DEFAULT << PCU_PCS9_PDD_CLR_PWOFF_FLAG_OFFSET)|\
-+ (PCU_PCS9_PDD_SUSP2RAM_DEFAULT << PCU_PCS9_PDD_SUSP2RAM_OFFSET )|\
-+ (PCU_PCS9_PDD_PWR_OFF_TIME_DEFAULT << PCU_PCS9_PDD_PWR_OFF_TIME_OFFSET )|\
-+ (PCU_PCS9_PDD_TICK_DEFAULT << PCU_PCS9_PDD_TICK_OFFSET )|\
-+ (PCU_PCS9_PDD_TIMER4_DEFAULT << PCU_PCS9_PDD_TIMER4_OFFSET )|\
-+ (PCU_PCS9_PDD_TIMER3_DEFAULT << PCU_PCS9_PDD_TIMER3_OFFSET )|\
-+ (PCU_PCS9_PDD_TIMER2_DEFAULT << PCU_PCS9_PDD_TIMER2_OFFSET )|\
-+ (PCU_PCS9_PDD_TIMER1_DEFAULT << PCU_PCS9_PDD_TIMER1_OFFSET ))
-+
-+// ======================================================
-+// PCU definitaion macro
-+// ======================================================
-+#define PCS_TYPE_PLL 0
-+#define PCS_TYPE_DIVIDER 1
-+#define PCS_TYPE_CLK_GATING 2
-+#define PCS_TYPE_I2C 4
-+#define PCS_TYPE_PMBUS 5
-+
-+#define PCS_WKEN0 (0x1<<0)
-+#define PCS_WKEN1 (0x1<<1)
-+#define PCS_WKEN2 (0x1<<2)
-+#define PCS_WKEN3 (0x1<<3)
-+#define PCS_WKEN4 (0x1<<4)
-+#define PCS_WKEN5 (0x1<<5)
-+#define PCS_WKEN6 (0x1<<6)
-+#define PCS_WKEN7 (0x1<<7)
-+#define PCS_WKEN8 (0x1<<8)
-+#define PCS_WKEN9 (0x1<<9)
-+#define PCS_WKEN10 (0x1<<10)
-+#define PCS_WKEN11 (0x1<<11)
-+#define PCS_WKEN12 (0x1<<12)
-+#define PCS_WKEN13 (0x1<<13)
-+#define PCS_WKEN14 (0x1<<14)
-+#define PCS_WKEN15 (0x1<<15)
-+
-+#define PCS_WKEN_GPIO0 PCS_WKEN0
-+#define PCS_WKEN_GPIO1 PCS_WKEN1
-+#define PCS_WKEN_GPIO2 PCS_WKEN2
-+#define PCS_WKEN_GPIO3 PCS_WKEN3
-+#define PCS_WKEN_GPIO4 PCS_WKEN4
-+#define PCS_WKEN_GPIO5 PCS_WKEN5
-+#define PCS_WKEN_WOL PCS_WKEN6
-+#define PCS_WKEN_RTC PCS_WKEN7
-+#define PCS_WKEN_DAY PCS_WKEN8
-+#define PCS_WKEN_DBG PCS_WKEN9
-+#define PCS_WKEN_PCI PCS_WKEN10
-+#define PCS_WKEN_LPC PCS_WKEN11
-+#define PCS_WKEN_SRC_CNT 12 // wakeup source number
-+#define PCS_WKEN_SRC_MASK ((1<<PCS_WKEN_SRC_CNT)-1)
-+
-+#define PCS_CMD_NOP 0x0
-+#define PCS_CMD_SCALING 0x1
-+#define PCS_CMD_PW_DOWN 0x2
-+#define PCS_CMD_DRAM_SF 0x4 // DRAM self-refresh
-+
-+#define PCS_SYNC_CPUA_STBY 0x1
-+#define PCS_SYNC_CPUB_STBY 0x2
-+
-+#if ((!defined(CORE0_IDLE)) && (!defined(CORE1_IDLE)))
-+ #define PCS_SYNC_SRC PCS_SYNC_CPUA_STBY
-+#elif (!defined(CORE0_IDLE))
-+ #define PCS_SYNC_SRC PCS_SYNC_CPUA_STBY
-+#else //(!defined(CORE1_IDLE))
-+ #define PCS_SYNC_SRC PCS_SYNC_CPUB_STBY
-+#endif
-+
-+#define PCS_PLL_DIVIDE1 0
-+#define PCS_PLL_DIVIDE2 1
-+#define PCS_PLL_DIVIDE4 2
-+#define PCS_PLL_DIVIDE8 3
-+
-+#define PCS_RATIO_44221H 0 // h(alf): stands for 0.5,
-+#define PCS_RATIO_4422HQ 1 // q(uarter) stands for 0.25,
-+#define PCS_RATIO_42221H 2 // f(ixed) stands for fixed 400Mhz
-+#define PCS_RATIO_4222HQ 3
-+#define PCS_RATIO_41121H 4
-+#define PCS_RATIO_4112HQ 5
-+#define PCS_RATIO_44421H 6
-+#define PCS_RATIO_4442HQ 7
-+#define PCS_RATIO_442F1H 8
-+#define PCS_RATIO_442FHQ 9
-+#define PCS_RATIO_422F1H 10
-+#define PCS_RATIO_422FHQ 11
-+#define PCS_RATIO_411F1H 12
-+#define PCS_RATIO_411FHQ 13
-+#define PCS_RATIO_111111e 14 // enable pll
-+#define PCS_RATIO_111111d 15 // disable pll
-+#define PCS_RATIO_MAX PCS_RATIO_111111d
-+#define PCS_RATIO_CNT (PCS_RATIO_MAX+1)
-+
-+#define PCS_GATING_DDR2_HCLK (0x1<<2 )
-+#define PCS_GATING_AHB2AHB_HCLK (0x1<<3 )
-+#define PCS_GATING_DMAC_HCLK (0x1<<4 )
-+#define PCS_GATING_L2CC_HCLK (0x1<<5 )
-+#define PCS_GATING_LPC_HCLK (0x1<<6 )
-+#define PCS_GATING_I2C_HCLK (0x1<<7 )
-+#define PCS_GATING_IDE_HCLK (0x1<<8 )
-+#define PCS_GATING_GPU_HCLK (0x1<<9)
-+#define PCS_GATING_GMAC_HCLK (0x1<<10)
-+#define PCS_GATING_USB_HCLK (0x1<<11)
-+#define PCS_GATING_PCI_HCLK (0x1<<12)
-+#define PCS_GATING_HCLK_CNT (16)
-+#define PCS_GATING_HCLK_VALID (PCS_GATING_DDR2_HCLK |\
-+ PCS_GATING_AHB2AHB_HCLK|\
-+ PCS_GATING_DMAC_HCLK |\
-+ PCS_GATING_L2CC_HCLK |\
-+ PCS_GATING_LPC_HCLK |\
-+ PCS_GATING_I2C_HCLK |\
-+ PCS_GATING_IDE_HCLK |\
-+ PCS_GATING_GPU_HCLK |\
-+ PCS_GATING_GMAC_HCLK |\
-+ PCS_GATING_USB_HCLK |\
-+ PCS_GATING_PCI_HCLK )
-+
-+#define PCS_GATING_NO_PCLK (0x0)
-+#define PCS_GATING_SPI_PCLK (0x1<<0 )
-+#define PCS_GATING_CFC_PCLK (0x1<<1 )
-+#define PCS_GATING_SDC_PCLK (0x1<<2 )
-+#define PCS_GATING_WDT_PCLK (0x1<<3 )
-+#define PCS_GATING_TMR_PCLK (0x1<<4 )
-+#define PCS_GATING_GPIO_PCLK (0x1<<5 )
-+#define PCS_GATING_PWM_PCLK (0x1<<6 )
-+#define PCS_GATING_I2C_PCLK (0x1<<7 )
-+#define PCS_GATING_AC97I2S_PCLK (0x1<<8)
-+#define PCS_GATING_UART1_PCLK (0x1<<9)
-+#define PCS_GATING_UART2_PCLK (0x1<<10)
-+#define PCS_GATING_PCLK_CNT (16)
-+
-+#define PCS_MAIN_PLL_FREF (33) // reference frequency in MHz
-+#define PCS_MAIN_PLL_M_FACTOR (1) // fixed M factor of Main PLL
-+#define PCS_MAIN_PLL_50MHZ_H (66)
-+#define PCS_MAIN_PLL_125MHZ_L (99)
-+#define PCS_MAIN_PLL_125MHZ_H (132)
-+#define PCS_MAIN_PLL_250MHZ_L (231)
-+#define PCS_MAIN_PLL_250MHZ_H (264)
-+#define PCS_MAIN_PLL_500MHZ_L (495)
-+#define PCS_MAIN_PLL_500MHZ_H (528)
-+#define PCS_MAIN_PLL_830MHZ_L (825)
-+//#define PCS_MAIN_PLL_800MHZ_H ()
-+//#define PCS_MAIN_PLL_1000MHZ_L ()
-+//#define PCS_MAIN_PLL_1000MHZ_H ()
-+#define PCS_MAIN_PLL_CNT (4)
-+#define PCS_PLL_50to125MHZ (0x0)
-+#define PCS_PLL_125to250MHZ (0x1)
-+#define PCS_PLL_250to500MHZ (0x2)
-+#define PCS_PLL_500to1000MHZ (0x3)
-+
-+#define PCU_PLL_N_FACTOR(seed, F_ref, M_factor, F_low, F_high) \
-+ (((seed)%( 1+ (F_high)*(M_factor)/(F_ref) - (F_low)*(M_factor)/(F_ref))) + ((F_low)*(M_factor)/(F_ref)))
-+#define PCS_MAIN_PLL_N_FACTOR(seed, F_low, F_high) \
-+ PCU_PLL_N_FACTOR(seed, PCS_MAIN_PLL_FREF, PCS_MAIN_PLL_M_FACTOR, F_low, F_high)
-+#define PCS_MAIN_PLL_CLOCK(n_factor) ((n_factor/PCS_MAIN_PLL_M_FACTOR)*PCS_MAIN_PLL_FREF)
-+
-+#define PCS_POWER_GPU_AND_DAC (0x1<<1)
-+#define PCS_POWER_CPUB (0x1<<2)
-+#define PCS_POWER_CNT (5)
-+
-+#define PCS_TICK_OSCH 0x0
-+#define PCS_TICK_OSCL 0x1
-+
-+//
-+#define PCS_STS_NORMAL 0x0
-+#define PCS_STS_READY 0x1
-+#define PCS_STS_SEQUENCE 0x2
-+#define PCS_STS_DONE 0x4
-+#define PCS_STS_WAKEN 0x6
-+
-+#define PCS_ERR_NONE 0x0
-+#define PCS_ERR_ILLEGAL 0x1
-+#define PCS_ERR_SYNC_TIMEOUT 0x2
-+#define PCS_ERR_UPDATE_TIMEOUT 0x3
-+
-+//
-+#define PCS_BSM_IDLE 0x0
-+#define PCS_BSM_SCALING 0x1
-+#define PCS_BSM_DONE 0x3
-+#define PCS_BSM_PWDN 0x4
-+#define PCS_BSM_ERROR 0x7
-+#define PCS_BSM_WAKEN 0x8
-+
-+#define PCS_BSM_VALID_NO_MAX 9
-+
-+//
-+#define PCS_SCALING_WITH_WAIT_DOWN 0
-+#define PCS_SCALING_WITH_WAKE_GRANT 1
-+#define PCS_PW_DOWN_WITH_WAIT_DOWN 2
-+#define PCS_PW_DOWN_WAKE_GRANT 3
-+
-+#define PCS_WAKE_WITH_SCALING_CNT (PCS_SCALING_WITH_WAKE_GRANT+1)
-+#define PCS_WAKE_WITH_PWDnSCL_CNT (PCS_PW_DOWN_WAKE_GRANT+1)
-+
-+// standby mode define macro
-+#define PCU_STBY_NO_WAKE_GRANT 0
-+#define PCU_STBY_WAKE_GRANT 1
-+#define PCU_STBY_WAIT_DONE 2
-+
-+
-+// PCU interrupt service routine signal
-+#define PCU_ISR_SIG_NONE 0x0
-+#define PCU_ISR_SIG_BSM PCU_INTR_BSM_MASK
-+#define PCU_ISR_SIG_PCS1 PCU_INTR_PCS1_MASK
-+#define PCU_ISR_SIG_PCS2 PCU_INTR_PCS2_MASK
-+#define PCU_ISR_SIG_PCS3 PCU_INTR_PCS3_MASK
-+#define PCU_ISR_SIG_PCS4 PCU_INTR_PCS4_MASK
-+#define PCU_ISR_SIG_PCS5 PCU_INTR_PCS5_MASK
-+#define PCU_ISR_SIG_PCS6 PCU_INTR_PCS6_MASK
-+#define PCU_ISR_SIG_PCS7 PCU_INTR_PCS7_MASK
-+#define PCU_ISR_SIG_PCS8 PCU_INTR_PCS8_MASK
-+#define PCU_ISR_SIG_PCS9 PCU_INTR_PCS9_MASK
-+
-+// ======================================================
-+// PCU access macro
-+// ======================================================
-+#define PCU_SET_FIELD(reg, field, value) SET_FIELD(PCU_REG_##reg, PCU_##reg##_##field##_##MASK, PCU_##reg##_##field##_##OFFSET, value)
-+#define PCU_GET_FIELD(reg, field) GET_FIELD(PCU_REG_##reg, PCU_##reg##_##field##_##MASK, PCU_##reg##_##field##_##OFFSET)
-+#define PCU_TEST_FIELD(reg, field) TEST_FIELD(PCU_REG_##reg, PCU_##reg##_##field##_##MASK)
-+
-+#define PCU_SET_REG(reg, value) SET_REG(PCU_REG_##reg, value)
-+#define PCU_GET_REG(reg) GET_REG(PCU_REG_##reg)
-+#define PCU_TEST_BIT(reg, field, value) VAR_TEST_BIT(value, PCU_##reg##_##field##_##MASK)
-+
-+#define PCU_CHECK(reg, field, value) CHECK_FIELD (value, PCU_##reg##_##field##_##MASK)
-+#define PCU_EXTRACT(reg, field, value) EXTRACT_FIELD(value, PCU_##reg##_##field##_##MASK, PCU_##reg##_##field##_##OFFSET )
-+#define PCU_PREPARE(reg, field, value) PREPARE_FIELD(value, PCU_##reg##_##field##_##MASK, PCU_##reg##_##field##_##OFFSET )
-+
-+#define PCU_DEFAULT(reg, field) ( PCU_##reg##_##field##_##DEFAULT )
-+
-+#define PCU_TEST_SIG(var, sig) VAR_TEST_BIT(var, PCU_ISR_SIG_##sig)
-+#define PCU_SET_SIG(var, sig) VAR_SET_BIT(var, PCU_ISR_SIG_##sig)
-+#define PCU_CLR_SIG(var, sig) VAR_CLR_BIT(var, PCU_ISR_SIG_##sig)
-+
-+// ======================================================
-+// PCU access function prototype
-+// ======================================================
-+#if __STDC__ || defined(__cplusplus)
-+#define PROTO_PARAMS(s) s
-+#else
-+#define PROTO_PARAMS(s) ()
-+#endif
-+
-+#endif //__PCU_H
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/pm.c linux-3.4.113/arch/nds32/platforms/ag102/pm.c
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/pm.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/pm.c 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,1614 @@
-+/*
-+ * AG101 Power Management Routines
-+ *
-+ * Copyright (c) 2010 Gavin Guo <gavinguo@andestech.com>
-+ *
-+ * This program is free software; you can redistribute it and/or
-+ * modify it under the terms of the GNU General Public License.
-+ *
-+ * Abstract:
-+ *
-+ * This program is for AG102 power management routines.
-+ *
-+ * Revision History:
-+ *
-+ * Jul.19.2010 Initial code by Gavin.
-+ */
-+#include <linux/init.h>
-+#include <linux/suspend.h>
-+#include <linux/errno.h>
-+#include <linux/time.h>
-+#include <linux/delay.h>
-+/*
-+ * the following include file is for testing device node
-+ */
-+#include <linux/device.h>
-+#include <linux/fs.h>
-+#include <asm/uaccess.h>
-+/*************************/
-+#include <asm/hardware.h>
-+#include <asm/memory.h>
-+#include <asm/system.h>
-+#include <asm/mach/time.h>
-+#include <asm/cacheflush.h>
-+#include <asm/timer.h>
-+#include <asm/io.h>
-+#include <asm/amic.h>
-+
-+#include "pcu.h"
-+#include "gmac.h"
-+
-+#ifdef CONFIG_PLAT_AG102
-+#include <asm/spec-ag102.h>
-+#endif
-+
-+#define ANDES_PCU_STRING "andes_pcu"
-+static int andes_pcu_major;
-+static struct class *andes_pcu_class;
-+extern void ag102_cpu_sleep(void);
-+extern void ag102_cpu_resume(void);
-+extern void ag102_cpu_resume2(void);
-+extern void __SELF_REFRESH_LOCK_START();
-+extern void __SELF_REFRESH_LOCK_END();
-+extern void ftpci_postinit(void /**sysdata*/ );
-+UINT32 mac_dah, mac_dal;
-+
-+// ADD by river 2010.12.07 for WOL
-+
-+UINT32 eth_phy_reg_read(UINT32 phy_addr, UINT32 phy_page, UINT32 phy_reg,
-+ UINT32 * phy_data)
-+{
-+ UINT32 cycthr = GMAC_GET_FIELD(PHYCR, MDC_CYCTHR);
-+ UINT32 wdata;
-+ UINT32 rdata;
-+ //TIMER_P timer;
-+
-+ printk(">>>>> GMAC : Calling eth_phy_reg_read()...\n");
-+
-+ wdata = GMAC_PREPARE(PHYCR, MIIRD, 0x1) |
-+ GMAC_PREPARE(PHYCR, PHYAD, phy_addr) |
-+ GMAC_PREPARE(PHYCR, REGAD, phy_reg) | cycthr;
-+
-+ printk(">>>>> GMAC : wdata = [0x%08x]\n", wdata);
-+
-+ GMAC_SET_REG(PHYCR, wdata);
-+
-+ // wait phy data read
-+ //TIMER_INIT(timer, 10000); // trigger timer & wait until finish of data read
-+ //while ( (!TIMER_IS_TIMEOUT(timer)) && (GMAC_GET_FIELD(PHYCR, MIIRD))) {
-+ // TIMER_TICK(timer);
-+ //}
-+
-+ while (GMAC_GET_FIELD(PHYCR, MIIRD)) {
-+ mdelay(50);
-+ }
-+
-+ if (GMAC_GET_FIELD(PHYCR, MIIRD)) {
-+ printk("ERR: GPHY read reg[%x] timeout!\n", phy_reg);
-+ return 1;
-+ } else {
-+ rdata = GMAC_GET_FIELD(PHYDATA, MIIRDATA);
-+ *phy_data = rdata;
-+ printk("GPHY read [%x] \n", rdata);
-+ return 0;
-+ }
-+}
-+
-+UINT32 eth_phy_reg_write(UINT32 phy_addr, UINT32 phy_page, UINT32 phy_reg,
-+ UINT32 phy_data)
-+{
-+ UINT32 wdata;
-+ //TIMER_P timer;
-+
-+ printk(">>>>> GMAC : Calling eth_phy_reg_write()...\n");
-+
-+ GMAC_SET_FIELD(PHYDATA, MIIWDATA, phy_data);
-+ wdata = GMAC_PREPARE(PHYCR, MIIWR, 0x1) | GMAC_PREPARE(PHYCR, PHYAD, phy_addr) | GMAC_PREPARE(PHYCR, REGAD, phy_reg) | 0x34; //cycthr;
-+ GMAC_SET_REG(PHYCR, wdata);
-+
-+ // wait phy data write
-+ //TIMER_INIT(timer, 10000); // trigger timer & wait until finish of data write
-+ //while ( (!TIMER_IS_TIMEOUT(timer)) && (GMAC_GET_FIELD(PHYCR, MIIWR))) {
-+ // TIMER_TICK(timer);
-+ //}
-+
-+ while (GMAC_GET_FIELD(PHYCR, MIIWR)) {
-+ mdelay(50);
-+ }
-+
-+ if (GMAC_GET_FIELD(PHYCR, MIIWR)) {
-+ printk("ERR: GPHY write reg[%x] = %x timeout!\n", phy_reg,
-+ phy_data);
-+ return 1;
-+ } else {
-+ return 0;
-+ }
-+}
-+
-+INT32 eth_phy_detect(UINT32 * phy_addr, UINT32 * phy_id)
-+{
-+ UINT32 i, find, data1, data2;
-+
-+ printk(">>>>> GMAC : Calling eth_phy_detect()...\n");
-+
-+ for (i = 0, find = 0; i <= 0x1f; i++) {
-+ eth_phy_reg_read(i, 0, 2, &data1);
-+ if ((data1 != 0) && (data1 != 0xffff)) {
-+ find = 1;
-+ break;
-+ }
-+ }
-+
-+ if (find == 0) {
-+ printk("Err: no valid phy found!\n");
-+ *phy_id = 0;
-+ return (-1);
-+ }
-+
-+ eth_phy_reg_read(i, 0, 2, &data1);
-+ eth_phy_reg_read(i, 0, 3, &data2);
-+ *phy_id = (data1 << 16) | (data2 & 0xffff);
-+ *phy_addr = i;
-+ printk("Info: phy id = 0x%08x!\n", *phy_id);
-+ return 0;
-+}
-+
-+void eth_phy_init(UINT32 phy_addr)
-+{
-+ UINT32 data, i;
-+ //TIMER_P timer;
-+ //phy_addr = DVC_PHY_ADDR;
-+
-+ printk(">>>>> GMAC : Calling eth_phy_init()...\n");
-+ // GPHY SW reset
-+ eth_phy_reg_read(phy_addr, 0, DVC_PHY_REG_CTL, &data);
-+ data |=
-+ DVC_PHY_REG_CTL_SW_RST | DVC_PHY_REG_CTL_AN_EN |
-+ DVC_PHY_REG_CTL_AN_RST;
-+ eth_phy_reg_write(phy_addr, 0, DVC_PHY_REG_CTL, data);
-+ for (i = 0; i < 10000; i++) { // must delay enough for phy to get ready
-+ //eth_mdelay(2000);
-+ mdelay(2);
-+ eth_phy_reg_read(phy_addr, 0, DVC_PHY_REG_CTL, &data);
-+ if ((data & 0x8000) == 0)
-+ break;
-+ }
-+ if ((data & 0x8000) != 0) {
-+ printk("Err: phy sw reset timeout!!!\n");
-+ }
-+ eth_phy_reg_read(phy_addr, 0, DVC_PHY_REG_CTL, &data);
-+ printk("phy control = 0x%x\n", data);
-+ eth_phy_reg_read(phy_addr, 0, DVC_PHY_REG_STS, &data);
-+ printk("phy status = 0x%x\n", data);
-+
-+ return;
-+}
-+
-+// initialize MAC setting
-+void eth_mac_init(ETH_PHY_STAT * phy_stat)
-+{
-+ UINT32 i, wdata, rdata;
-+ UINT32 duplex, speed, gmac;
-+ //UINT32 mac_dah, mac_dal;
-+ printk(">>>>> GMAC : Calling eth_mac_init()...\n");
-+
-+ wdata = GMAC_PREPARE(MACCR, SW_RST, 0x1);
-+ GMAC_SET_REG(MACCR, wdata);
-+ for (i = 0; i < 1000; i++) { // must delay enough for phy to get ready
-+ //eth_mdelay(8000); // delay should be enough
-+ mdelay(8);
-+ rdata = GMAC_GET_REG(FEAR);
-+ if ((rdata >> 31) == 0)
-+ break;
-+ }
-+ if ((rdata >> 31) != 0) {
-+ printk("Err: mac sw reset timeout!!!\n");
-+ }
-+ if (phy_stat->speed == 2) { //giga
-+ gmac = 0x1;
-+ speed = 0x1;
-+ } else if (phy_stat->speed == 1) { //100 Mbps
-+ gmac = 0x0;
-+ speed = 0x1;
-+ } else { //10 Mbps
-+ gmac = 0x0;
-+ speed = 0x0;
-+ }
-+ duplex = phy_stat->duplex;
-+ GMAC_SET_REG(ISR, 0xffff); // Interrupt Status, write 1 to clear
-+ GMAC_SET_REG(IME, 0xffff); // Interrupt Enable, enabling all interrupts
-+ GMAC_SET_REG(MAC_MADR, mac_dah);
-+ GMAC_SET_REG(MAC_LADR, mac_dal);
-+ rdata = GMAC_GET_REG(FEAR);
-+ GMAC_SET_FIELD(TPAFCR, TFIFO_SIZE,
-+ GMAC_EXTRACT(FEAR, TFIFO_RSIZE, rdata));
-+ GMAC_SET_FIELD(TPAFCR, RFIFO_SIZE,
-+ GMAC_EXTRACT(FEAR, RFIFO_RSIZE, rdata));
-+
-+ wdata = GMAC_PREPARE(MACCR, RX_MULTIPKT_EN, 0x1) |
-+ GMAC_PREPARE(MACCR, BROADPKT_EN, 0x1) |
-+ GMAC_PREPARE(MACCR, RX_ALLADR, 0x1) |
-+ GMAC_PREPARE(MACCR, CRC_APD, 0x1) |
-+ GMAC_PREPARE(MACCR, FULLDUP, duplex) |
-+ GMAC_PREPARE(MACCR, RX_RUNT, 0x1) |
-+ GMAC_PREPARE(MACCR, SPEED, speed) |
-+ GMAC_PREPARE(MACCR, GMAC_MODE, gmac) |
-+ GMAC_PREPARE(MACCR, RXMAC_EN, 0x1) |
-+ GMAC_PREPARE(MACCR, TXMAC_EN, 0x1) |
-+ GMAC_PREPARE(MACCR, RXDMA_EN, 0x1) |
-+ GMAC_PREPARE(MACCR, TXDMA_EN, 0x1);
-+ GMAC_SET_REG(MACCR, wdata);
-+
-+#ifdef AHBC_NO_REMAP
-+ GMAC_SET_REG(NPTXR_BADR, FTGMAC100_TXR_BASE | 0x40000000);
-+ GMAC_SET_REG(RXR_BADR, FTGMAC100_RXR_BASE | 0x40000000);
-+#else
-+ GMAC_SET_REG(NPTXR_BADR, FTGMAC100_TXR_BASE);
-+ GMAC_SET_REG(RXR_BADR, FTGMAC100_RXR_BASE);
-+#endif
-+ return;
-+}
-+
-+UINT32 eth_phy_stat(UINT32 phy_addr, ETH_PHY_STAT * phy_stat)
-+{
-+
-+ phy_stat->speed = 0x1;
-+ phy_stat->duplex = 0x1;
-+
-+ return 0;
-+}
-+
-+void gmac_set_wol()
-+{
-+ UINT32 wdata;
-+
-+ // Set Rx Wake-up Frame
-+ // write 1 clear register before enable power saving mode
-+ GMAC_SET_REG(WOLSR, 0xffffffff); // clear wol status
-+
-+ // set wakeup_sel and power saving mode enable
-+ wdata = GMAC_PREPARE(WOLCR, MAGICPKT_EN, 0x1) |
-+ GMAC_PREPARE(WOLCR, PWRSAV, 0x1);
-+
-+ GMAC_SET_REG(WOLCR, wdata);
-+
-+ return;
-+}
-+
-+// End ADD by river 2010.12.07 for WOL
-+
-+//////////////////////////////// LPC wake up ///////////////////////////////////////////////////
-+#define CPE_LPCIO_BASE LPC_IO_VA_BASE //VA Base
-+#define CPE_LPCREG_BASE LPC_REG_VA_BASE //VA Base
-+#define CPE_IC_BASE AMIC_VA_BASE
-+
-+#define ITE_ADDR 0x2e
-+#define ITE_DATA 0x2f
-+
-+#define KBC_CMD 0x64
-+#define KBC_STATUS KBC_CMD
-+#define KBC_DATA 0x60
-+
-+#define BIT_OBF 0x01
-+#define BIT_IBF 0x02
-+
-+#define LPC_REG_SCR 0x10
-+#define LPC_REG_SIR 0x14
-+#define LPC_REG_SIMR 0x18
-+
-+#define SIRQ_KB 1
-+#define SIRQ_MS 12
-+
-+//#define outlpc(addr, data) outb(data, CPE_LPCIO_BASE + 4 * addr)
-+//#define inlpc(addr) inb(CPE_LPCIO_BASE + 4 * addr)
-+#define inlpc(addr) REG32(CPE_LPCIO_BASE + 4 * addr)
-+
-+#define IRQ_LPC 29
-+#define LEVEL 0
-+#define H_ACTIVE 0
-+#define L_ACTIVE 1
-+#define IRQ_MASK 0x80
-+#define IRQ_MODE 0x20
-+#define IRQ_LEVEL 0x24
-+
-+UINT32 IRQSources = 0; //define the current irq source for debug
-+
-+static inline void outlpc(unsigned long addr, unsigned long data)
-+{
-+ REG32(CPE_LPCIO_BASE + 4 * addr) = data;
-+}
-+
-+static void kbc_cmd(UINT8 cmd)
-+{
-+ int loop_limit = 1000;
-+ int i;
-+ UINT8 tmpc;
-+
-+ // wait until the input buffer is empty
-+ for (i = 0; i < loop_limit; i++) {
-+ tmpc = inlpc(KBC_STATUS);
-+ if ((tmpc & BIT_IBF) == 0)
-+ break;
-+ }
-+
-+ outlpc(KBC_CMD, cmd);
-+}
-+
-+static void kbc_wdata(UINT8 wdata)
-+{
-+ int loop_limit = 1000;
-+ int i;
-+ UINT8 tmpc;
-+
-+ // wait until the input buffer is empty
-+ for (i = 0; i < loop_limit; i++) {
-+ tmpc = inlpc(KBC_STATUS);
-+ if ((tmpc & BIT_IBF) == 0)
-+ break;
-+ }
-+
-+ outlpc(KBC_DATA, wdata);
-+}
-+
-+static UINT8 kbc_rdata(void)
-+{
-+ int loop_limit = 1000;
-+ int i;
-+ UINT8 rdata;
-+ UINT8 tmpc;
-+
-+ // wait until the output buffer is not empty
-+ for (i = 0; i < loop_limit; i++) {
-+ tmpc = inlpc(KBC_STATUS);
-+ if (tmpc & BIT_OBF)
-+ break;
-+ }
-+
-+ rdata = inlpc(KBC_DATA);
-+ return (rdata);
-+}
-+
-+static void delay_loop(int max_no)
-+{
-+ int i;
-+
-+ for (i = 0; i < max_no; i++) ;
-+}
-+
-+static UINT8 get_response(void)
-+{
-+ UINT8 tmpc;
-+
-+ delay_loop(200000);
-+ tmpc = kbc_rdata();
-+ return (tmpc);
-+}
-+
-+int it8718f_init(void)
-+{
-+ static int initialized = 0;
-+ UINT8 tmpc;
-+ unsigned int chip_id;
-+
-+ if (initialized == 1)
-+ return (0);
-+
-+ // Enter the configuration mode
-+ outlpc(ITE_ADDR, 0x87);
-+ outlpc(ITE_ADDR, 0x01);
-+ outlpc(ITE_ADDR, 0x55);
-+ outlpc(ITE_ADDR, 0x55);
-+
-+ // Check the chip ID
-+ printk("Check IT8718F chip ID => ");
-+ outlpc(ITE_ADDR, 0x20);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id = (tmpc & 0xff) << 8;
-+ outlpc(ITE_ADDR, 0x21);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id |= tmpc & 0xff;
-+
-+ if (chip_id != 0x8718) {
-+ printk("FAILED with chip ID = 0x%C%C.\n", (chip_id >> 8) & 0xff,
-+ chip_id & 0xff);
-+ return (1);
-+ } else
-+ printk("PASSED\n");
-+
-+ // KBC Self Test
-+ printk("KBC self-test => ");
-+ kbc_cmd(0xaa);
-+ tmpc = kbc_rdata();
-+ if (tmpc != 0x55) {
-+ printk("FAILED with code = 0x%C\n", tmpc & 0xff);
-+ return (2);
-+ } else
-+ printk("PASSED\n");
-+
-+ // KBC Interface Test
-+ printk("KBC interface test => ");
-+ kbc_cmd(0xab);
-+ tmpc = kbc_rdata();
-+ switch (tmpc) {
-+ case 0:
-+ printk("PASSED\n");
-+ break;
-+
-+ case 1:
-+ printk("FAILED as the clock is stuck low\n");
-+ return (3);
-+
-+ case 2:
-+ printk("FAILED as the clock is stuck high\n");
-+ return (3);
-+
-+ case 3:
-+ printk("FAILED as the data is stuck low\n");
-+ return (3);
-+
-+ case 4:
-+ printk("FAILED as the data is stuck high\n");
-+ return (3);
-+
-+ default:
-+ printk("FAILED with unknown error\n");
-+ return (3);
-+ break;
-+ }
-+
-+ // Read the KBC mode
-+ kbc_cmd(0xca);
-+ tmpc = kbc_rdata();
-+
-+ // Set KBC to the PS/2 mode
-+ tmpc |= 0x01;
-+ kbc_cmd(0xcb);
-+ kbc_wdata(tmpc);
-+
-+ // Enable keyboard
-+ kbc_wdata(0xf4);
-+ tmpc = get_response();
-+ printk("@@@@@ : Response of enabling keyboard = 0x%x\n", tmpc & 0xff);
-+
-+ // Enable mouse
-+ kbc_cmd(0xd4);
-+ kbc_wdata(0xf4);
-+ tmpc = get_response();
-+ //outmsg("Response of enabling mouse = 0x%C\n", tmpc & 0xff);
-+
-+ // bit 6: translate
-+ // bit 5: mouse enable
-+ // bit 4: keyboard enable
-+ // bit 3: ignore keyboard lock
-+ // bit 2: system flag
-+ // bit 1: mouse interrupt enable
-+ // bit 0: Keyboard interrupt enable
-+ kbc_cmd(0x60);
-+ kbc_wdata(0x47);
-+
-+ // Set repeat rate and delay
-+ kbc_wdata(0xf3);
-+ kbc_wdata(0x00);
-+ tmpc = get_response();
-+
-+ // Set LDN = 5 (Keyboard)
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x05);
-+
-+ // KBC clock = 8MHz, Key lock enabled, interrupt type can be changed
-+ outlpc(ITE_ADDR, 0xf0);
-+ outlpc(ITE_DATA, 0x4e);
-+
-+ // Low-level triggered interrupt
-+ outlpc(ITE_ADDR, 0x71);
-+ outlpc(ITE_DATA, 0x01);
-+
-+ // Set LDN = 6 (Mouse)
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x06);
-+
-+ // Enable mouse
-+ outlpc(ITE_ADDR, 0x30);
-+ outlpc(ITE_DATA, 0x01);
-+
-+ // Interrupt type can be changed
-+ outlpc(ITE_ADDR, 0xf0);
-+ outlpc(ITE_DATA, 0x01);
-+
-+ // Low-level triggered interrupt
-+ outlpc(ITE_ADDR, 0x71);
-+ outlpc(ITE_DATA, 0x01);
-+
-+ // Exit the configuration mode
-+ outlpc(ITE_ADDR, 0x02);
-+ outlpc(ITE_DATA, 0x02);
-+
-+ initialized = 1;
-+ return (0);
-+}
-+
-+//INT for lpc
-+/* Turn the interrupt source on. */
-+void UnmaskIRQ(UINT32 IRQ)
-+{
-+ volatile UINT32 *IRQBase;
-+
-+ IRQBase = (UINT32 *) CPE_IC_BASE;
-+
-+ IRQBase[(IRQ_MASK / sizeof(UINT32))] |= (1 << IRQ);
-+}
-+
-+void EnableIRQ()
-+{
-+
-+ __asm__ volatile ("setgie.d\n\t"
-+ "isb\n\t"
-+ "mfsr $r1, $INT_MASK\n\t"
-+ "ori $r1, $r1, #0x3f\n\t"
-+ "mtsr $r1, $INT_MASK\n\t"
-+ "setgie.e\n\t" "isb\n\t");
-+
-+}
-+
-+void SetIRQmode(UINT32 IRQ, UINT32 edge)
-+{
-+ volatile UINT32 *IRQBase;
-+
-+ IRQBase = (UINT32 *) CPE_IC_BASE;
-+
-+ if (edge)
-+ IRQBase[(IRQ_MODE / sizeof(UINT32))] |= (1 << IRQ);
-+ else
-+ IRQBase[(IRQ_MODE / sizeof(UINT32))] &= ~(1 << IRQ);
-+}
-+
-+void SetIRQlevel(UINT32 IRQ, UINT32 low)
-+{
-+ volatile UINT32 *IRQBase;
-+
-+ IRQBase = (UINT32 *) CPE_IC_BASE;
-+
-+ if (low)
-+ IRQBase[(IRQ_LEVEL / sizeof(UINT32))] |= (1 << IRQ);
-+ else
-+ IRQBase[(IRQ_LEVEL / sizeof(UINT32))] &= ~(1 << IRQ);
-+}
-+
-+BOOL SetIntTrig(UINT32 intNum, int intMode, int intLevel)
-+{
-+ if (intNum >= 32) {
-+ printk("ERROR: The interrupt number %d is incorrect\n", intNum);
-+ return FALSE;
-+ } else {
-+ SetIRQmode(intNum, intMode);
-+ SetIRQlevel(intNum, intLevel);
-+ return TRUE;
-+ }
-+}
-+
-+BOOL EnableInt(UINT32 intNum)
-+{
-+
-+ if (intNum >= 32) {
-+ printk("ERROR: The interrupt number %d is incorrect\n", intNum);
-+ return FALSE;
-+ } else {
-+ IRQSources |= 1 << intNum;
-+ UnmaskIRQ(intNum);
-+ EnableIRQ();
-+ return TRUE;
-+ }
-+}
-+
-+//End INT for lpc
-+
-+void enable_sirq(void)
-+{
-+ UINT32 data;
-+
-+ // Unmask SERIRQs of Keyboard and Mouse
-+ data = inw(CPE_LPCREG_BASE + LPC_REG_SIMR);
-+ data &= ~((1 << SIRQ_KB) | (1 << SIRQ_MS));
-+ outw(CPE_LPCREG_BASE + LPC_REG_SIMR, data);
-+
-+ // Enable SERIRQ
-+ data = inw(CPE_LPCREG_BASE + LPC_REG_SCR);
-+ data |= 0x1;
-+ outw(CPE_LPCREG_BASE + LPC_REG_SCR, data);
-+}
-+
-+void ite_set_pme()
-+{
-+
-+ UINT8 tmpc;
-+ unsigned int chip_id;
-+ // Enter the configuration mode
-+ outlpc(ITE_ADDR, 0x87);
-+ outlpc(ITE_ADDR, 0x01);
-+ outlpc(ITE_ADDR, 0x55);
-+ outlpc(ITE_ADDR, 0x55);
-+
-+ // Check the chip ID
-+ printk("@@@@@ : Check IT8718F chip ID in get_lpc_value => \n");
-+ outlpc(ITE_ADDR, 0x20);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id = (tmpc & 0xff) << 8;
-+ outlpc(ITE_ADDR, 0x21);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id |= tmpc & 0xff;
-+
-+ printk("@@@@@ : chip_id = 0x%08x\n", chip_id);
-+ if (chip_id != 0x8718) {
-+ printk("FAILED with chip ID = 0x%C%C.\n", (chip_id >> 8) & 0xff,
-+ chip_id & 0xff);
-+ return (1);
-+ } else
-+ printk("@@@@@ : PASSED\n");
-+
-+ // Set LDN = 5
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x05);
-+
-+ //Read index 30
-+ outlpc(ITE_ADDR, 0x30);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x30] = 0x%x\n", tmpc);
-+ //Set index 30 bit0 = 0;
-+ outlpc(ITE_ADDR, 0x30);
-+ outlpc(ITE_DATA, tmpc & 0xFE);
-+
-+ // Set LDN = 6
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x06);
-+
-+ //Read index 30
-+ outlpc(ITE_ADDR, 0x30);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x30] = 0x%x\n", tmpc);
-+ //Set index 30 bit0 = 0;
-+ outlpc(ITE_ADDR, 0x30);
-+ outlpc(ITE_DATA, tmpc & 0xFE);
-+
-+ // Set LDN = 4 for PME
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x04);
-+
-+ //Read index F0
-+ outlpc(ITE_ADDR, 0xF0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF0] = 0x%x\n", tmpc);
-+ //Set index F0 BIT[4:3]=1;
-+ outlpc(ITE_ADDR, 0xF0);
-+ outlpc(ITE_DATA, tmpc | 0x18);
-+
-+ //PME output enable
-+ //Read index F2
-+ outlpc(ITE_ADDR, 0xF2);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF2] = 0x%x\n", tmpc);
-+ //Set index F2 bit6=0;
-+ outlpc(ITE_ADDR, 0xF2);
-+ outlpc(ITE_DATA, tmpc & 0xBF);
-+
-+ // Exit the configuration mode
-+ outlpc(ITE_ADDR, 0x02);
-+ outlpc(ITE_DATA, 0x02);
-+}
-+
-+void get_keyboard_status()
-+{
-+
-+ printk("Getting keyboard status....\n");
-+
-+ UINT8 tmpc;
-+ unsigned int chip_id;
-+
-+ // Enter the configuration mode
-+ outlpc(ITE_ADDR, 0x87);
-+ outlpc(ITE_ADDR, 0x01);
-+ outlpc(ITE_ADDR, 0x55);
-+ outlpc(ITE_ADDR, 0x55);
-+
-+ // Check the chip ID
-+ //printk("@@@@@ : Check IT8718F chip ID in get_lpc_value => \n");
-+ outlpc(ITE_ADDR, 0x20);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id = (tmpc & 0xff) << 8;
-+ outlpc(ITE_ADDR, 0x21);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id |= tmpc & 0xff;
-+
-+ //printk("@@@@@ : chip_id = 0x%08x\n", chip_id);
-+ if (chip_id != 0x8718) {
-+ printk("FAILED with chip ID = 0x%C%C.\n", (chip_id >> 8) & 0xff,
-+ chip_id & 0xff);
-+ return (1);
-+ }
-+ // Set LDN = 4 for PME
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x04);
-+
-+ ///////// Dump configuration register
-+ outlpc(ITE_ADDR, 0xf1);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf1] = 0x%x\n", tmpc);
-+
-+ ///////// Dump configuration register
-+ outlpc(ITE_ADDR, 0xf0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf0] = 0x%x\n", tmpc);
-+
-+}
-+
-+void get_lpc_value()
-+{
-+ UINT8 tmpc;
-+ unsigned int chip_id;
-+
-+ // Enter the configuration mode
-+ outlpc(ITE_ADDR, 0x87);
-+ outlpc(ITE_ADDR, 0x01);
-+ outlpc(ITE_ADDR, 0x55);
-+ outlpc(ITE_ADDR, 0x55);
-+
-+ // Check the chip ID
-+ printk("@@@@@ : Check IT8718F chip ID in get_lpc_value => \n");
-+ outlpc(ITE_ADDR, 0x20);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id = (tmpc & 0xff) << 8;
-+ outlpc(ITE_ADDR, 0x21);
-+ tmpc = inlpc(ITE_DATA);
-+ chip_id |= tmpc & 0xff;
-+
-+ printk("@@@@@ : chip_id = 0x%08x\n", chip_id);
-+ if (chip_id != 0x8718) {
-+ printk("FAILED with chip ID = 0x%C%C.\n", (chip_id >> 8) & 0xff,
-+ chip_id & 0xff);
-+ return (1);
-+ } else
-+ printk("@@@@@ : PASSED\n");
-+
-+ printk("=================== Get Values ==================\n");
-+ //////////// Environment Controller configuration register
-+ printk("@@@@@ : Environment Controller configuration register\n");
-+ // Set LDN = 4 for PME
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x04);
-+
-+ printk("@@@@@ : LDN = 4\n");
-+
-+ ///////// Dump configuration register
-+ outlpc(ITE_ADDR, 0x30);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x30] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x60);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x60] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x61);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x61] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x62);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x62] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x63);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x63] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x70);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x70] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf0] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf1);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf1] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf2);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf2] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf3);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf3] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf4);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf4] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf5);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf5] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf6);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf6] = 0x%x\n", tmpc);
-+
-+ //////////// Keyboard configuration register
-+ printk("@@@@@ : Keyboard configuration register\n");
-+ // Set LDN = 5
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x05);
-+
-+ printk("@@@@@ : LDN = 5\n");
-+
-+ outlpc(ITE_ADDR, 0x30);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x30] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x60);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x60] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x61);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x61] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x62);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x62] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x63);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x63] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x70);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x70] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x71);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x71] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xf0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xf0] = 0x%x\n", tmpc);
-+
-+ //////////// GPIO configuration register
-+ printk("@@@@@ : GPIO configuration register\n");
-+ // Set LDN = 7 for GPIO
-+ outlpc(ITE_ADDR, 0x07);
-+ outlpc(ITE_DATA, 0x07);
-+
-+ printk("@@@@@ : LDN = 7\n");
-+
-+ outlpc(ITE_ADDR, 0x60);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x60] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x62);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x62] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x63);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x63] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x64);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x64] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x65);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x65] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x70);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x70] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x71);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x71] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x72);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x72] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x73);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x73] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0x74);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0x74] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xB0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xB0] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xB1);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xB1] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xB2);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xB2] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xB3);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xB3] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xB4);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xB4] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xB5);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xB5] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xB8);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xB8] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xBA);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xBA] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xBB);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xBB] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xBC);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xBC] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xBD);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xBD] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC0] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC1);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC1] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC2);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC2] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC3);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC3] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC4);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC4] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC5);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC5] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC8);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC8] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xC9);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xC9] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xCA);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xCA] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xCB);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xCB] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xCC);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xCC] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xCD);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xCD] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xE0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xE0] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xE1);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xE1] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xE2);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xE2] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xE3);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xE3] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xE4);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xE4] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xE5);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xE5] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xE6);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xE6] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF0);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF0] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF1);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF1] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF2);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF2] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF3);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF3] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF4);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF4] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF5);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF5] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF6);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF6] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF7);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF7] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF8);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF8] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xF9);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xF9] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xFA);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xFA] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xFB);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xFB] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xFC);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xFC] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xFD);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xFD] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xFE);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xFE] = 0x%x\n", tmpc);
-+
-+ outlpc(ITE_ADDR, 0xFF);
-+ tmpc = inlpc(ITE_DATA);
-+ printk("[0xFF] = 0x%x\n", tmpc);
-+
-+ printk("=================== End Get Values ==================\n");
-+
-+}
-+
-+/////////////////////////////// End LPC wake up ///////////////////////////////////////////////
-+
-+/*
-+ * AG102 PMU sleep mode handler.
-+ */
-+void andes_suspend_to_ram()
-+{
-+ int i, k, l, checksum, checksuma;
-+ unsigned int addr, reg;
-+ static int irq_saves[3];
-+ unsigned int tmp;
-+ pgd_t *pgdv;
-+ pud_t *pudv;
-+ pmd_t *pmdv;
-+ pte_t *ptev;
-+ unsigned int resume_addr /*, resume_temp */ ;
-+ //unsigned int *resume_tempaddr;
-+ __asm__ volatile ("mfsr %0, $ir14\n\t":"=&r" (tmp));
-+ //printk("\nag102_cpu_resume:0x%x\n", ag102_cpu_resume);
-+ //printk( KERN_WARNING "\nag102_cpu_resume2:0x%x\n", ag102_cpu_resume2);
-+ pgdv =
-+ (pgd_t *) __va((GET_L1_PPTB() & L1_PPTB_mskBASE)) +
-+ pgd_index((unsigned int)ag102_cpu_resume);
-+ pudv = pud_offset(pgdv, (unsigned int)ag102_cpu_resume);
-+ pmdv = pmd_offset(pudv, (unsigned int)ag102_cpu_resume);
-+ ptev = pte_offset_map(pmdv, (unsigned int)ag102_cpu_resume);
-+ //printk("ag102_cpu_resume pte:0x%x\n", ptev);
-+ resume_addr =
-+ ((*ptev) & TLB_DATA_mskPPN) | ((unsigned int)ag102_cpu_resume &
-+ 0x00000fff);
-+ printk("resume_addr using Page Table :0x%08x\n", resume_addr);
-+
-+ //ADD by river 2010.09.23
-+ printk("@@@@@ resume_addr(VA):0x%08x\n", ag102_cpu_resume);
-+ printk("@@@@@ resume_addr2(VA):0x%08x\n", ag102_cpu_resume2);
-+ printk("@@@@@ resume_addr(PA) using virt_to_phys :0x%08x\n",
-+ virt_to_phys(ag102_cpu_resume));
-+ printk("@@@@@ resume_addr2(PA):0x%08x\n",
-+ virt_to_phys(ag102_cpu_resume2));
-+ printk("@@@@@ AHB Controller for ROM :0x%08x\n",
-+ REG32(AHB_ATFAHBC020S_0_VA_BASE + 0x10));
-+ printk("@@@@@ AHB Controller for RAM :0x%08x\n",
-+ REG32(AHB_ATFAHBC020S_0_VA_BASE + 0x18));
-+ //End ADD by river 2010.09.23
-+
-+ /* trigger mode regs */
-+ irq_saves[0] = REG32(AMIC_VA_BASE + 0x20);
-+ /* trigger level regs */
-+ irq_saves[1] = REG32(AMIC_VA_BASE + 0x24);
-+ /* interrupt enable regs */
-+ irq_saves[2] = REG32(AMIC_VA_BASE + 0x80);
-+ /* save SDRAM settings */
-+
-+ /* set resume return address */
-+ //REG32(PCU_VA_BASE + 0x400) = (resume_addr);
-+ REG32(PCU_VA_BASE + 0x400) = (resume_addr) | 0x80000000;
-+ REG32(PCU_VA_BASE + 0x404) = (u32) ag102_cpu_resume2;
-+ REG32(PCU_VA_BASE + 0x410) = GET_L1_PPTB();
-+ //ADD by river 2010.12.02 for reserve kernel remap
-+ REG32(PCU_VA_BASE + 0x418) = REG32(AHB_ATFAHBC020S_0_VA_BASE + 0x10);
-+ REG32(PCU_VA_BASE + 0x41C) = REG32(AHB_ATFAHBC020S_0_VA_BASE + 0x18);
-+ //End ADD by river 2010.12.02 for reserve kernel remap
-+ printk("L1_PPTB (PA) =0x%08x\n", GET_L1_PPTB());
-+ printk("L1_PPTB (VA) in virtual address =0x%08x\n",
-+ phys_to_virt(GET_L1_PPTB()));
-+
-+ //ADD by river 2010.12.07
-+ UINT32 phy_id, phy_addr;
-+ ETH_PHY_STAT phy_stat;
-+
-+ if (eth_phy_detect(&phy_addr, &phy_id) != 0) {
-+ printk("ERR: fail to detect known PHY!!!\n");
-+ return;
-+ }
-+ //TEST by river 2010.12.10
-+ eth_phy_init(phy_addr);
-+ eth_phy_stat(phy_addr, &phy_stat);
-+ eth_mac_init(&phy_stat);
-+ //End TEST by river 2010.12.10
-+ gmac_set_wol();
-+ //End ADD by river 2010.12.07
-+
-+ /////////// ADD by river 2010.12.20 for LPC wakeup /////////////////////////////
-+ if (it8718f_init() != 0)
-+ return;
-+
-+ //INTC setup
-+ SetIntTrig(IRQ_LPC, LEVEL, H_ACTIVE);
-+ EnableInt(IRQ_LPC); // including INT_MASK and GIE in Core
-+
-+ enable_sirq();
-+
-+ //__asm__ volatile ("1:\n\t");
-+ //__asm__ volatile ("b 1b\n\t");
-+
-+ printk("Calling ite_set_pme() YAYAYA....\n");
-+ ite_set_pme();
-+
-+ printk("Get Value..... YAYAYA....1\n");
-+ get_lpc_value();
-+
-+ /////////// End ADD by river 2010.12.20 for LPC wakeup /////////////////////////////
-+
-+ //set GPIO[2] as suspend2dram power control pin
-+ PCU_SET_FIELD(MFPS1, SUSPEND_GPIO, 0x1);
-+ PCU_SET_FIELD(PCS9_PDD, SUSP2RAM, 0x1);
-+ //ADD by river 2010.12.07
-+ PCU_SET_REG(PCS9_CFG, PCU_PREPARE(PCS9_CFG, WKEN, PCS_WKEN_WOL | PCS_WKEN_LPC | PCS_WKEN_RTC)); // use only gpio0 and wol
-+ //PCU_SET_REG(PCS9_CFG, PCU_PREPARE(PCS9_CFG, WKEN, PCS_WKEN_LPC)); // use lpc
-+
-+ //End ADD by river 2010.12.07
-+
-+ /* set pwoer status */
-+ //int par = PCS_POWER_GPU_AND_DAC|PCS_POWER_CPUB;
-+ int reg_tmp = PCU_PREPARE(PCS9_PARA, IE, 0x1) |
-+ PCU_PREPARE(PCS9_PARA, CMD,
-+ PCS_CMD_PW_DOWN /*PCS_CMD_SCALING|PCS_CMD_DRAM_SF */ ) |
-+ PCU_PREPARE(PCS9_PARA, SYNC, PCS_SYNC_SRC) | PCU_PREPARE(PCS9_PARA, NXTPAR, 0 /*par */ ); // change power status
-+ PCU_SET_REG(PCS9_PARA, reg_tmp);
-+
-+ //PCU_SET_FIELD(MFPS1, SUSPEND_GPIO, 0x1);
-+ /* setup wakeup sources */
-+ /*
-+ k = PCU_PREPARE(WAKEUP_SEN, GPIO0_POL, 0x1) |
-+ PCU_PREPARE(WAKEUP_SEN, GPIO1_POL, 0x1) |
-+ PCU_PREPARE(WAKEUP_SEN, GPIO2_POL, 0x1) |
-+ PCU_PREPARE(WAKEUP_SEN, GPIO3_POL, 0x1) |
-+ PCU_PREPARE(WAKEUP_SEN, GPIO4_POL, 0x1) |
-+ PCU_PREPARE(WAKEUP_SEN, GPIO5_POL, 0x1) |
-+ PCU_PREPARE(WAKEUP_SEN, WOL_POL, 0x1) |
-+ PCU_PREPARE(WAKEUP_SEN, LPC_POL, 0x1);
-+ l = ~k; //set polarity
-+ //l = 0x1c0;
-+ PCU_SET_REG(WAKEUP_SEN, l);
-+ PCU_SET_REG(PCS9_CFG, PCU_PREPARE(PCS9_CFG, WKEN, k));
-+ */
-+ /* Set PDD register and set suspend_to_ram */
-+ //PCU_SET_FIELD(PCS9_PDD, SUSP2RAM, 0x1);
-+
-+ cpu_dcache_wbinval_all();
-+ cpu_icache_inval_all();
-+ SET_CACHE_CTL(GET_CACHE_CTL() & ~CACHE_CTL_mskDC_EN);
-+
-+ /* lock self-refresh code to L1 cache */
-+
-+ addr = (unsigned int)__SELF_REFRESH_LOCK_START;
-+ reg = (((unsigned int)__SELF_REFRESH_LOCK_END - (unsigned int)__SELF_REFRESH_LOCK_START) >> 5) + 1; //
-+
-+ for (i = 0; i < reg; i++) {
-+ __asm__ volatile ("li $p0, 0x0\n\t"
-+ "add $p0, $p0, %0\n\t"
-+ "cctl $p0, L1I_VA_FILLCK\n\t"
-+ "isb\n\t"::"r" (addr));
-+
-+ addr += 32;
-+ }
-+
-+ unsigned char *ptr;
-+ //ADD by river 2010.11.19
-+ printk("The resume address's content is :\n");
-+ ptr = (unsigned char *)ag102_cpu_resume;
-+ for (i = 0; i < 20; i++) {
-+ printk("0x%02x - ", *ptr++);
-+ }
-+
-+ printk("Get Value..... YAYAYA....2\n");
-+ get_lpc_value();
-+
-+ //End ADD by river 2010.11.19
-+ ag102_cpu_sleep();
-+ printk("return success-1..........\n");
-+ /* wakeup and ckeck */
-+ /*
-+ reg_tmp = PCU_GET_REG(PCS9_ST2);// check Status-2
-+ if (PCU_EXTRACT(PCS9_ST2, CURPAR, reg_tmp) != par)
-+ printk("Parameter setup is not the same!\n");
-+
-+ reg_tmp = PCU_GET_REG(PCS9_ST1); // check Status-1
-+ if (PCU_EXTRACT(PCS9_ST1, STS, reg_tmp) != PCS_STS_DONE)
-+ printk("The work is not done?!\n");
-+ if (PCU_EXTRACT(PCS9_ST1, ERR, reg_tmp) != PCS_ERR_NONE)
-+ printk("Some error happened!!\n");
-+ PCU_SET_REG(PCS9_ST1, 0x0); //clear status
-+
-+ */
-+ ftpci_postinit();
-+ SET_CACHE_CTL(GET_CACHE_CTL() | CACHE_CTL_mskDC_EN);
-+ /* trigger mode regs */
-+ REG32(AMIC_VA_BASE + 0x20) = irq_saves[0];
-+ /* trigger level regs */
-+ REG32(AMIC_VA_BASE + 0x24) = irq_saves[1];
-+ /* interrupt enable regs */
-+ REG32(AMIC_VA_BASE + 0x80) = irq_saves[2];
-+ __asm__ volatile ("mtsr %0, $ir14\n\t"::"r" (tmp));
-+
-+ printk("return success-2..........\n");
-+ dump_stack();
-+
-+}
-+
-+static int ag102_pm_valid(suspend_state_t state)
-+{
-+ switch (state) {
-+ case PM_SUSPEND_ON:
-+ case PM_SUSPEND_STANDBY:
-+ case PM_SUSPEND_MEM:
-+ return 1;
-+
-+ default:
-+ return 0;
-+ }
-+}
-+
-+static int ag102_pm_begin(suspend_state_t state)
-+{
-+ /* TBD if we need it */
-+ return 0;
-+}
-+
-+static void andes_suspend_cpu(void)
-+{
-+ unsigned int irq_save;
-+ /* setup GPIO interrupt enable regs to enable GPIO0 */
-+ REG32(GPIO_VA_BASE + 0x20) = 1;
-+ /* save interrupt enable regs */
-+ irq_save = REG32(AMIC_VA_BASE + 0x80);
-+ /* accept all interrupts to wake up except timer interrupt */
-+ REG32(AMIC_VA_BASE + 0x80) &= ~(1 << 19);
-+ /* enable UART0 interrupt */
-+ REG32(AMIC_VA_BASE + 0x80) |= 1 << 13;
-+
-+ /*
-+ * for more IRQ info, please refer to
-+ * arch/nds32/include/asm/spec.h&spec-ag102.h
-+ */
-+
-+ __asm__ volatile ("standby no_wake_grant\n\t");
-+ /* clear GPIO interrupt */
-+ REG32(GPIO_VA_BASE + 0x30) = 1;
-+ /* disable GPIO interrupt */
-+ REG32(GPIO_VA_BASE + 0x20) = 0;
-+ /* restore GPIO enable regs */
-+ REG32(AMIC_VA_BASE + 0x80) = irq_save;
-+}
-+
-+static int ag102_pm_enter(suspend_state_t state)
-+{
-+ switch (state) {
-+ case PM_SUSPEND_STANDBY:
-+ andes_suspend_cpu();
-+ return 0;
-+ case PM_SUSPEND_MEM:
-+ printk("@@@@@@@@@@ : ag102_pm_enter()... from gavin.......\n");
-+ andes_suspend_to_ram();
-+ return 0;
-+ default:
-+ return -EINVAL;
-+ }
-+}
-+
-+/*
-+ * Called after processes are frozen, but before we shutdown devices.
-+ */
-+static int ag102_pm_prepare(void)
-+{
-+ /* TBD if we need it */
-+ return 0;
-+}
-+
-+/*
-+ * Called after devices are wakeuped, but before processes are thawed.
-+ */
-+static void ag102_pm_finish(void)
-+{
-+ /* TBD if we need it */
-+}
-+
-+static void ag102_pm_end(void)
-+{
-+ /* TBD if we need it */
-+#if 0
-+ class_destroy(andes_pcu_class);
-+ unregister_chrdev(andes_pcu_major, ANDES_PCU_STRING);
-+#endif
-+ printk("pm_exit\n");
-+}
-+
-+static int andes_pcu_ioctl(struct inode *inode, struct file *file,
-+ unsigned int cmd, unsigned long arg)
-+{
-+ return 0;
-+}
-+
-+static int andes_pcu_open(struct inode *inode, struct file *file)
-+{
-+ return 0;
-+}
-+
-+static ssize_t andes_pcu_write(struct file *filp, const char *buff,
-+ size_t count, loff_t * ppos)
-+{
-+ char data;
-+ get_user(data, buff);
-+ switch (data) {
-+ case 's':
-+ printk("Just suspend cpu\n");
-+ andes_suspend_cpu();
-+ break;
-+ case 'm':
-+ printk("Suspend to ram\n");
-+ andes_suspend_to_ram();
-+ break;
-+ }
-+ return 0;
-+}
-+
-+static int andes_pcu_release(struct inode *inode, struct file *file)
-+{
-+ return 0;
-+}
-+
-+static struct file_operations andes_pcu_fops = {
-+ .owner = THIS_MODULE,
-+ .ioctl = andes_pcu_ioctl,
-+ .open = andes_pcu_open,
-+ .write = andes_pcu_write,
-+ .release = andes_pcu_release,
-+};
-+
-+static struct platform_suspend_ops ag102_pm_ops = {
-+ .valid = ag102_pm_valid,
-+ .begin = ag102_pm_begin,
-+ .prepare = ag102_pm_prepare,
-+ .enter = ag102_pm_enter,
-+ .finish = ag102_pm_finish,
-+ .end = ag102_pm_end,
-+};
-+
-+//PCU power-off workaround {
-+#undef IRQ_LEVEL
-+#include <linux/interrupt.h>
-+#include <linux/irq.h>
-+
-+//#define PM_DEBUG
-+#ifdef PM_DEBUG
-+#define PRINTK printk
-+#else
-+#define PRINTK(...)
-+#endif
-+
-+static volatile int pcuirq = 0;
-+
-+static inline void poweroff_pcu(void)
-+{
-+ PRINTK(KERN_INFO "[kernel] poweroff_pcu()");
-+ REG32(PCU_VA_BASE + 0x1a4) = (2 << 28) | (1 << 24) | (6 << 0); //power-down, sync CPUA, domain GPU+CPUB
-+ __asm__ volatile ("standby wait_done\n");
-+ REG32(PCU_VA_BASE + 0x1a8) = 0x0; //PCS9 status normal, no error
-+}
-+
-+static inline void clear_pcu_status(void)
-+{
-+ PRINTK(KERN_INFO "[kernel] clear_pcu_status()");
-+ REG32(PCU_VA_BASE + 0x1b0) |= (1 << 31); //clear poweroff flag
-+ asm("msync store\nisb");
-+}
-+
-+static irqreturn_t gpio0_isr(int irq, void *dev_id)
-+{
-+ PRINTK(KERN_INFO "[kernel] gpio0_isr(irq=%d)\n", irq);
-+
-+ // is GPIO0 IRQ
-+ if (REG32(GPIO_VA_BASE + 0x28) & (1 << 0)) {
-+ PRINTK(KERN_INFO "GPIO#0 ASSERT!\n");
-+
-+ pcuirq = 0;
-+
-+ //disable GPIO0 IRQ
-+ REG32(GPIO_VA_BASE + 0x2c) |= (1 << 0); //GPIO0 IRQ mask, level mode AMIC.GPIO#0 also cleared
-+
-+// REG32(AMIC_VA_BASE + 0x84) = (1<<13); //AMIC clear GPIO interrupt
-+
-+ return IRQ_HANDLED;
-+ }
-+
-+ return IRQ_NONE;
-+}
-+
-+#define GPIO_SEC (1<<11)
-+static irqreturn_t pcu_isr(int irq, void *dev_id)
-+{
-+ UINT32 status = REG32(PCU_VA_BASE + 0x94);
-+ PRINTK(KERN_INFO "[kernel] pcu_isr(irq=%d) status=0x%08x\n", irq,
-+ status);
-+ if (0 == (GPIO_SEC & status))
-+ return IRQ_NONE;
-+
-+ PRINTK(KERN_INFO "[kernel] GPIO_SEC\n");
-+ clear_pcu_status(); //clear PCS9 IRQ (level mode => AMIC.PCU also cleared)
-+ pcuirq++;
-+ if (1 == pcuirq) {
-+ //enable GPIO0 IRQ
-+ REG32(GPIO_VA_BASE + 0x30) = (1 << 0); //GPIO0 IRQ cleared
-+// REG32(AMIC_VA_BASE + 0x84) = (1 << 13); //AMIC clear GPIO interrupt
-+// enable_irq(GPIO_FTGPIO010_IRQ);
-+ REG32(AMIC_VA_BASE + 0x80) |= (1 << 13); //AMIC enable GPIO IRQ
-+ REG32(GPIO_VA_BASE + 0x2c) &= ~(1 << 0); //GPIO0 IRQ unmask
-+ } else if (5 == pcuirq) {
-+ poweroff_pcu();
-+ }
-+// REG32(AMIC_VA_BASE + 0x84) = (1 << 8); //PCU IRQ clear
-+
-+ return IRQ_HANDLED;
-+}
-+
-+//PCU power-off workaround }
-+
-+static int __init ag102_pm_init(void)
-+{
-+ int ret = 0;
-+ struct device *temp_class;
-+ printk("PM driver init\n");
-+ suspend_set_ops(&ag102_pm_ops);
-+
-+ andes_pcu_major = register_chrdev(0, ANDES_PCU_STRING, &andes_pcu_fops);
-+
-+ printk("@@@@@ : andes_pcu_major = 0x%08x\n", andes_pcu_major);
-+ if (andes_pcu_major < 0) {
-+ printk("Unable to get a major for andes pcu driver!\n");
-+ return andes_pcu_major;
-+ }
-+
-+ andes_pcu_class = class_create(THIS_MODULE, ANDES_PCU_STRING);
-+
-+ if (IS_ERR(andes_pcu_class)) {
-+ printk(KERN_ERR "Error creating andes pcu class.\n");
-+ ret = PTR_ERR(andes_pcu_class);
-+ goto err_out1;
-+ }
-+
-+ temp_class = device_create(andes_pcu_class, NULL,
-+ MKDEV(andes_pcu_major, 0),
-+ NULL, ANDES_PCU_STRING);
-+
-+ if (IS_ERR(temp_class)) {
-+ printk(KERN_ERR "Error creating andes pcu class device.\n");
-+ ret = PTR_ERR(temp_class);
-+ goto err_out2;
-+ }
-+
-+ mac_dah = GMAC_GET_REG(MAC_MADR);
-+ mac_dal = GMAC_GET_REG(MAC_LADR);
-+
-+ //poweroff workaround
-+ {
-+ if (request_irq
-+ (PCU_IRQ, pcu_isr, IRQF_SHARED, "PCU_POWEROFF", pcu_isr)) {
-+ printk("Failed to request PCU interrupt.\n");
-+ }
-+
-+ if (request_irq
-+ (GPIO_FTGPIO010_IRQ, gpio0_isr, IRQF_SHARED,
-+ "GPIO0_FOR_PCU", gpio0_isr)) {
-+ printk("Failed to request GPIO0 interrupt.\n");
-+ }
-+
-+ REG32(PCU_VA_BASE + 0x1b0) |= (3 << 28); //poweroff in 5s
-+
-+ //AMIC setup
-+ // PCU IRQ default edge trigger, rising edge
-+ // GPIO_FTGPIO010_IRQ default edge trigger, rising edge
-+// REG32(AMIC_VA_BASE + 0x20) &= ~(1 << 8); //PCU IRQ level trigger
-+// REG32(AMIC_VA_BASE + 0x24) &= ~(1 << 8); //PCU IRQ active-high
-+// REG32(AMIC_VA_BASE + 0x20) &= ~(1 << 13); //GPIO IRQ level trigger
-+
-+ //GPIO #0 setup
-+ REG32(GPIO_VA_BASE + 0x08) &= ~(1 << 0); //GPIO0 input
-+ REG32(GPIO_VA_BASE + 0x18) &= ~(1 << 0); //GPIO0 not pulled (external pull-high)
-+ REG32(GPIO_VA_BASE + 0x2c) |= (1 << 0); //GPIO0 IRQ masked
-+ REG32(GPIO_VA_BASE + 0x34) |= (1 << 0); //GPIO0 IRQ level trigger
-+// REG32(GPIO_VA_BASE + 0x38) &= ~(1<<0); //GPIO0 IRQ single edge
-+ REG32(GPIO_VA_BASE + 0x3c) &= ~(1 << 0); //GPIO0 IRQ high-active
-+ REG32(GPIO_VA_BASE + 0x40) |= (1 << 0); //GPIO0 enable bounce
-+ REG32(GPIO_VA_BASE + 0x40) = 0xffff; //GPIO bounce time = x/PCLK
-+// REG32(GPIO_VA_BASE + 0x30) = (1<<0); //GPIO0 IRQ cleared
-+ REG32(GPIO_VA_BASE + 0x20) |= (1 << 0); //GPIO0 IRQ enable
-+
-+// enable_irq(PCU_IRQ);
-+ REG32(AMIC_VA_BASE + 0x80) |= (1 << 8); //IRQ enabled
-+ }
-+
-+ printk("pm_init\n");
-+ return 0;
-+err_out2:
-+ class_destroy(andes_pcu_class);
-+err_out1:
-+ unregister_chrdev(andes_pcu_major, ANDES_PCU_STRING);
-+ return 1;
-+}
-+
-+//static void resume_to_ccode(void)
-+//{
-+// printk("Resume to C code successfully....\n");
-+//}
-+
-+late_initcall(ag102_pm_init);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ag102/sleep.S linux-3.4.113/arch/nds32/platforms/ag102/sleep.S
---- linux-3.4.113.orig/arch/nds32/platforms/ag102/sleep.S 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ag102/sleep.S 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,465 @@
-+#include <asm/spec-ag102.h>
-+.text
-+
-+.globl ag102_cpu_sleep
-+.globl ag102_cpu_resume
-+.globl ag102_cpu_resume2
-+.globl __SELF_REFRESH_LOCK_START
-+.globl __SELF_REFRESH_LOCK_END
-+
-+#! 0x94200000; keep r0, r1, r2
-+ .macro putch ch
-+ li $r0, #0x94200000
-+ move $r2, \ch
-+88:
-+ lwi $r1, [$r0+#0x14]
-+ srli $r1, $r1, #5
-+ andi $r1, $r1, #0x1
-+ beqz $r1, 88b
-+ swi $r2, [$r0]
-+ .endm
-+#! 0x94200000; keep r3, r4
-+ .macro hex2asc val
-+ addi \val, \val, -10
-+ bltz \val, 1f
-+ addi \val, \val, 0x41
-+ j 2f
-+1:
-+ addi \val, \val, 0x3a
-+2:
-+ .endm
-+
-+ .macro print_hex mhex
-+ move $r3, \mhex
-+
-+ srli $r4, $r3, #28
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ srli $r4, $r3, #24
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ srli $r4, $r3, #20
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ srli $r4, $r3, #16
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ srli $r4, $r3, #12
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ srli $r4, $r3, #8
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ srli $r4, $r3, #4
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ move $r4, $r3
-+ andi $r4, $r4, 0xf
-+ hex2asc $r4
-+ putch $r4
-+ .endm
-+
-+ag102_cpu_resume2:
-+/*1:
-+b 1b*/
-+ //MOD by river 2010.10.13
-+ popm $r0, $r19
-+ mtusr $r0, $d0.lo ! $d0 lo byte
-+ mtusr $r1, $d0.hi ! $d0 hi byte
-+ mtusr $r2, $d1.lo ! $d1 lo byte
-+ mtusr $r3, $d1.hi ! $d1 hi byte
-+ mtsr $r4, $mr0
-+ mtsr $r5, $mr1
-+ mtsr $r6, $mr4
-+ mtsr $r7, $mr6
-+ mtsr $r8, $mr7
-+ mtsr $r9, $mr8
-+ mtsr $r10, $ir0
-+ mtsr $r11, $ir1
-+ mtsr $r12, $ir2
-+ mtsr $r13, $ir3
-+ mtsr $r14, $ir9
-+ mtsr $r15, $ir10
-+ mtsr $r16, $ir12
-+ mtsr $r17, $ir13
-+ mtsr $r18, $ir14
-+ mtsr $r19, $ir15
-+ //End MOD by river 2010.10.13
-+ popm $r0, $r30
-+ ret
-+
-+ag102_cpu_sleep:
-+
-+ pushm $r0, $r30
-+ //MOD by river 2010.10.13
-+ mfusr $r0, $d0.lo ! $d0 lo byte
-+ mfusr $r1, $d0.hi ! $d0 hi byte
-+ mfusr $r2, $d1.lo ! $d1 lo byte
-+ mfusr $r3, $d1.hi ! $d1 hi byte
-+ mfsr $r4, $mr0
-+ mfsr $r5, $mr1
-+ mfsr $r6, $mr4
-+ mfsr $r7, $mr6
-+ mfsr $r8, $mr7
-+ mfsr $r9, $mr8
-+ mfsr $r10, $ir0
-+ mfsr $r11, $ir1
-+ mfsr $r12, $ir2
-+ mfsr $r13, $ir3
-+ mfsr $r14, $ir9
-+ mfsr $r15, $ir10
-+ mfsr $r16, $ir12
-+ mfsr $r17, $ir13
-+ mfsr $r18, $ir14
-+ mfsr $r19, $ir15
-+ pushm $r0, $r19
-+ //End MOD by river 2010.10.13
-+
-+ /* store $sp to 0x408 scratch pad */
-+ sethi $r0, hi20(PCU_VA_BASE + 0x408)
-+ ori $r2, $r0, lo12(PCU_VA_BASE + 0x408)
-+ swi $r31, [$r2]
-+
-+ /* set signaure "SUSP" to 0x40c */
-+ li $r0, (PCU_VA_BASE + 0x40c)
-+ li $r1, 0x53555350 ! set signature "SUSP" to scratch pad register offset 0x40c
-+ swi $r1, [$r0]
-+
-+ /*
-+ * store 8 bytes from 16mb to pcu scratch pad resgister
-+ * due to data training process will destroy it
-+ */
-+ li $r0, 0x10000
-+ li $r2, (PCU_VA_BASE + 0x414)
-+ lwi $r1, [$r0]
-+ swi $r1, [$r2]
-+ lwi $r1, [$r0 + 0x4]
-+ swi $r1, [$r2 + 0x4]
-+
-+ /* ADD by river 2010.09.23 */
-+ /* Save PSW in PCU_VA_BASE + 0x420 */
-+ li $r0, (PCU_VA_BASE + 0x420)
-+ mfsr $r1, $ir0
-+ swi $r1, [$r0]
-+ /* Save $mr0 in PCU_VA_BASE + 0x424 */
-+ li $r0, (PCU_VA_BASE + 0x424)
-+ mfsr $r1, $mr0
-+ swi $r1, [$r0]
-+ /* Save $mr1 in PCU_VA_BASE + 0x428 */
-+ li $r0, (PCU_VA_BASE + 0x428)
-+ mfsr $r1, $mr1
-+ swi $r1, [$r0]
-+ /* Save $mr2 in PCU_VA_BASE + 0x42c */
-+ li $r0, (PCU_VA_BASE + 0x42c)
-+ mfsr $r1, $mr2
-+ swi $r1, [$r0]
-+ /* Save $mr3 in PCU_VA_BASE + 0x430 */
-+ li $r0, (PCU_VA_BASE + 0x430)
-+ mfsr $r1, $mr3
-+ swi $r1, [$r0]
-+ /* Save $mr4 in PCU_VA_BASE + 0x434 */
-+ li $r0, (PCU_VA_BASE + 0x434)
-+ mfsr $r1, $mr4
-+ swi $r1, [$r0]
-+ /* Save $mr5 in PCU_VA_BASE + 0x438 */
-+ //li $r0, (PCU_VA_BASE + 0x438)
-+ //mfsr $r1, $mr5
-+ //swi $r1, [$r0]
-+ /* Save $mr6 in PCU_VA_BASE + 0x43c */
-+ li $r0, (PCU_VA_BASE + 0x43c)
-+ mfsr $r1, $mr6
-+ swi $r1, [$r0]
-+ /* Save $mr7 in PCU_VA_BASE + 0x440 */
-+ li $r0, (PCU_VA_BASE + 0x440)
-+ mfsr $r1, $mr7
-+ swi $r1, [$r0]
-+ /* Save $mr8 in PCU_VA_BASE + 0x444 */
-+ li $r0, (PCU_VA_BASE + 0x444)
-+ mfsr $r1, $mr8
-+ swi $r1, [$r0]
-+
-+ /* Save $ir3 in PCU_VA_BASE + 0x450 */
-+ li $r0, (PCU_VA_BASE + 0x450)
-+ mfsr $r1, $ir3
-+ swi $r1, [$r0]
-+
-+ /* Save $ir14 in PCU_VA_BASE + 0x454 */
-+ li $r0, (PCU_VA_BASE + 0x454)
-+ mfsr $r1, $ir14
-+ swi $r1, [$r0]
-+
-+ /* Save $ir15 in PCU_VA_BASE + 0x458 */
-+ li $r0, (PCU_VA_BASE + 0x458)
-+ mfsr $r1, $ir15
-+ swi $r1, [$r0]
-+
-+ tlbop FlushAll
-+ isb
-+ /* End ADD by river 2010.09.23 */
-+
-+ //Trace by river 2010.12.01
-+ /*1:
-+ b 1b*/
-+ //End Trace by river 2010.12.01
-+.p2align 5
-+__SELF_REFRESH_LOCK_START:
-+ /*sethi $r0, hi20(0x900005cc)
-+ ori $r0, $r0, lo12(0x900005cc)
-+ sethi $r1, hi20(DDR2C_VA_BASE)
-+ swi $r0, [$r1+0x4]
-+
-+ msync
-+ isb
-+
-+ standby wake_grant
-+ .p2align 5*/
-+ sethi $r0, hi20(DDR2C_VA_BASE)
-+ lwi $r1, [$r0+0x4]
-+ li $r2, 0x07ffefff
-+ and $r1, $r2, $r1
-+ li $r2, 0x90001000
-+ or $r1, $r2, $r1
-+ swi $r1, [$r0+0x4]
-+
-+ msync
-+ isb
-+
-+ standby wake_grant
-+ .p2align
-+
-+__SELF_REFRESH_LOCK_END:
-+
-+ag102_cpu_resume:
-+ /* TRACE by river 2010.12.02 */
-+ /*1:
-+ b 1b*/
-+ /* End TRACE by river 2010.12.02 */
-+ mfsr $r2, $mr0
-+ ori $r2, $r2, #0x6
-+#ifdef CONFIG_ANDES_PAGE_SIZE_8KB
-+ ori $r2, $r2, #0x1
-+#endif
-+ mtsr $r2, $mr0
-+
-+ /* ADD by river 2010.09.23 */
-+ li $r3, 'C
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'P
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'U
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'R
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'E
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'S
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'U
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'M
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ li $r3, 'E
-+ putch $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ /* ADD by river 2010.09.23 */
-+
-+ /*tlbop FlushAll*/ ! invalidate TLB\n"
-+
-+ /* ADD by river 2010.09.23 */
-+ /* restore PSW */
-+ //sethi $r2, hi20(PCU_PA_BASE + 0x420)
-+ //ori $r2, $r2, lo12(PCU_PA_BASE + 0x420)
-+ //lwi $r3, [$r2]
-+ //mtsr $r3, $ir0
-+ //move $p1, $r3
-+ /* restore $mr0 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x424)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x424)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $mr0
-+ /* restore $mr1 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x428)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x428)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $mr1
-+
-+ /* restore $mr2 */
-+ //sethi $r2, hi20(PCU_PA_BASE + 0x42c)
-+ //ori $r2, $r2, lo12(PCU_PA_BASE + 0x42c)
-+ //lwi $r3, [$r2]
-+ //mtsr $r3, $mr2
-+ /* restore $mr3 */
-+ //sethi $r2, hi20(PCU_PA_BASE + 0x430)
-+ //ori $r2, $r2, lo12(PCU_PA_BASE + 0x430)
-+ //lwi $r3, [$r2]
-+ //mtsr $r3, $mr3
-+ /* restore $mr4 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x434)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x434)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $mr4
-+ /* restore $mr5 */
-+ //sethi $r2, hi20(PCU_PA_BASE + 0x438)
-+ //ori $r2, $r2, lo12(PCU_PA_BASE + 0x438)
-+ //lwi $r3, [$r2]
-+ //mtsr $r3, $mr5
-+ /* restore $mr6 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x43c)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x43c)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $mr6
-+ /* restore $mr7 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x440)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x440)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $mr7
-+ /* restore $mr8 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x444)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x444)
-+ lwi $r3, [$r2]
-+ /* ADD by river 2010.12.02 for ICache Enable */
-+ ori $r3, $r3, #0x1
-+ /* End ADD by river 2010.12.02 for ICache Enable */
-+ mtsr $r3, $mr8
-+
-+ /* restore $ir3 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x450)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x450)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $ir3
-+
-+ move $p1, $r3
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ print_hex $p1
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+
-+
-+ /* restore $ir14 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x454)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x454)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $ir14
-+
-+ /* restore $ir15 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x458)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x458)
-+ lwi $r3, [$r2]
-+ mtsr $r3, $ir15
-+
-+ li $r3, '\r
-+ putch $r3
-+ li $r3, '\n
-+ putch $r3
-+ move $p1, $r3
-+ print_hex $p1
-+
-+ /* End ADD by river 2010.09.23 */
-+
-+ /* in this buggy version(ram locate at 1G) TC01 we don't need to do remap.
-+ * ebios set memory locate at 1G & size = 1G, for more detail info, please
-+ * refer to ebios boot.S.
-+ *
-+ * sethi $r2, hi20(0x90c00000 + 0x88)
-+ * ori $r2, $r2, lo12(0x90c00000 + 0x88)
-+ * movi $r3, #0x1
-+ * swi $r3, [$r2]
-+ **/
-+
-+ /* restore 8 bytes from pcu scratch pad resgister to 16mb */
-+ li $r0, 0x10000
-+ li $r2, (PCU_PA_BASE + 0x414)
-+ lwi $r1, [$r2]
-+ swi $r1, [$r0]
-+ lwi $r1, [$r2 + 0x4]
-+ swi $r1, [$r0 + 0x4]
-+
-+ .p2align 5
-+ resume_lock_start:
-+ /* ADD by river 2010.12.02 for ag102_cpu_resume2 for jral.ton $r4, $r4 */
-+ sethi $r2, hi20(PCU_PA_BASE + 0x404)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x404)
-+ lwi $r4, [$r2]
-+ /* End ADD by river 2010.12.02 for ag102_cpu_resume2 */
-+
-+ /* ADD by river 2010.12.02 for restore kernel ROM map */
-+ sethi $r0, hi20(0x40080000)
-+ ori $r0, $r0, lo12(0x40080000)
-+ sethi $r1, hi20(AHB_ATFAHBC020S_0_PA_BASE + 0x10)
-+ ori $r1, $r1, lo12(AHB_ATFAHBC020S_0_PA_BASE + 0x10)
-+ swi $r0, [$r1]
-+
-+ /* ADD by river 2010.12.02 for restore kernel RAM map */
-+ sethi $r0, hi20(0x000A0000)
-+ ori $r0, $r0, lo12(0x000A0000)
-+ sethi $r1, hi20(AHB_ATFAHBC020S_0_PA_BASE + 0x18)
-+ ori $r1, $r1, lo12(AHB_ATFAHBC020S_0_PA_BASE + 0x18)
-+ swi $r0, [$r1]
-+
-+ /******************* Gavin version ***************************/
-+ //MOD by river 2010.10.13
-+ /*sethi $r2, hi20(PCU_PA_BASE + 0x404)
-+ ori $r2, $r2, lo12(PCU_PA_BASE + 0x404)
-+ lwi $r4, [$r2]
-+ mtsr $r4, $IPC
-+ li $r1, 0xcb
-+ mtsr $r1, $IPSW
-+ iret*/
-+ //End MOD by river 2010.10.13
-+ //End Gavin version////////////////////////////////////////////////////////////
-+
-+ /* End ADD by river 2010.09.23 */
-+ //MOD by river 2010.10.13
-+ //////// jral.ton version ////////////////////////////////////////////////////
-+
-+ jral.ton $r4, $r4
-+ .p2align
-+ resume_lock_end:
-+ //End MOD by river 2010.10.13
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/amic.c linux-3.4.113/arch/nds32/platforms/amic.c
---- linux-3.4.113.orig/arch/nds32/platforms/amic.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/amic.c 2016-12-01 20:59:24.376613676 +0100
-@@ -0,0 +1,203 @@
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/ioport.h>
-+#include <linux/delay.h>
-+
-+#include <asm/io.h>
-+#include <asm/amic.h>
-+
-+#define DEBUG(enabled, tagged, ...) \
-+ do { \
-+ if (enabled) { \
-+ if (tagged) \
-+ printk("[ %30s() ] ", __func__); \
-+ printk(__VA_ARGS__); \
-+ } \
-+ } while (0)
-+
-+static DEFINE_SPINLOCK(amic_irq_lock);
-+
-+static void amic_ack_irq(unsigned int irq)
-+{
-+ unsigned int data;
-+
-+ spin_lock(&amic_irq_lock);
-+ writel(1 << irq, AMIC_BASE + INTSTA);
-+ data = readl(AMIC_BASE + INTSTA);
-+ spin_unlock(&amic_irq_lock);
-+}
-+
-+static void amic_mask_irq(unsigned int irq)
-+{
-+ unsigned int data;
-+
-+ spin_lock(&amic_irq_lock);
-+ data = readl(AMIC_BASE + INTEN);
-+ data &= ~(1 << irq);
-+ writel(data, AMIC_BASE + INTEN);
-+ data = readl(AMIC_BASE + INTEN);
-+ spin_unlock(&amic_irq_lock);
-+}
-+
-+static int amic_set_type(unsigned int irq, unsigned int flow_type)
-+{
-+ unsigned int data;
-+
-+ spin_lock(&amic_irq_lock);
-+ if (flow_type & (IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING)) {
-+ data = readl(AMIC_BASE + INTTRG);
-+ data |= 1 << irq;
-+ writel(data, AMIC_BASE + INTTRG);
-+ }
-+
-+ if (flow_type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) {
-+ data = readl(AMIC_BASE + INTTRG);
-+ data &= ~(1 << irq);
-+ writel(data, AMIC_BASE + INTTRG);
-+ }
-+
-+ if (flow_type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_EDGE_FALLING)) {
-+ data = readl(AMIC_BASE + INTLVL);
-+ data |= 1 << irq;
-+ writel(data, AMIC_BASE + INTLVL);
-+ }
-+
-+ if (flow_type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_EDGE_RISING)) {
-+ data = readl(AMIC_BASE + INTLVL);
-+ data &= ~(1 << irq);
-+ writel(data, AMIC_BASE + INTLVL);
-+ }
-+ spin_unlock(&amic_irq_lock);
-+ return 0;
-+}
-+
-+static void amic_unmask_irq(unsigned int irq)
-+{
-+ unsigned int data;
-+
-+ spin_lock(&amic_irq_lock);
-+ data = readl(AMIC_BASE + INTEN);
-+ data |= 1 << irq;
-+ writel(data, AMIC_BASE + INTEN);
-+ data = readl(AMIC_BASE + INTEN);
-+ spin_unlock(&amic_irq_lock);
-+}
-+
-+static int amic_set_affinity(unsigned int irq, const struct cpumask *dest)
-+{
-+ int cnt = 0;
-+ int cpu;
-+ volatile unsigned int data;
-+ volatile unsigned int dc, amic_irq;
-+
-+ if (num_online_cpus() > 2)
-+ return 0;
-+
-+ spin_lock(&amic_irq_lock);
-+ /* remap irq number for real controller */
-+ /* this may be needed in future */
-+ /* amic_irq = irq_remap(irq); */
-+ amic_irq = irq;
-+
-+ /* change owner */
-+ data = readl(AMIC_BASE + CPUID0 + ((amic_irq >> 4) << 2));
-+ for_each_online_cpu(cpu) {
-+ if (cpumask_test_cpu(cpu, dest)) {
-+ data &= ~(0x3 << ((amic_irq & ~0x10) * 2));
-+ data |= cpu << ((amic_irq & ~0x10) * 2);
-+ cnt++;
-+ }
-+ }
-+ writel(data, AMIC_BASE + CPUID0 + ((amic_irq >> 4) << 2));
-+
-+ dc = readl(AMIC_BASE + CPUDC);
-+ if (cnt == 2) /* set bit */
-+ writel((dc | (1 << amic_irq)), (AMIC_BASE + CPUDC));
-+ else /* clear bit */
-+ writel((dc & ~(1 << amic_irq)), (AMIC_BASE + CPUDC));
-+
-+ spin_unlock(&amic_irq_lock);
-+
-+ DEBUG(0, 1, "en=%08x,status=%08x\n", readl(AMIC_BASE + INTEN),
-+ readl(AMIC_BASE + INTSTA));
-+
-+ return 0;
-+}
-+
-+static struct irq_chip amic_chip = {
-+ .name = "AMIC",
-+ .ack = amic_ack_irq,
-+ .mask = amic_mask_irq,
-+ .unmask = amic_unmask_irq,
-+ .set_affinity = amic_set_affinity,
-+ .set_type = amic_set_type,
-+};
-+
-+void __init amic_init(void)
-+{
-+ int i, edge;
-+ unsigned int temp = smp_processor_id();
-+ temp |= temp << 2;
-+ temp |= temp << 4;
-+ temp |= temp << 8;
-+ temp |= temp << 16;
-+
-+ writel(0x0, AMIC_BASE + INTEN);
-+ writel(0x0, AMIC_BASE + CPUDC);
-+ writel(temp, AMIC_BASE + CPUID0);
-+ writel(temp, AMIC_BASE + CPUID1);
-+ writel(0xffff, AMIC_BASE + IPISTA);
-+ writel(0xffffffff, AMIC_BASE + INTSTA);
-+ writel(0x11111111, AMIC_BASE + PRITY0);
-+ writel(0x11111111, AMIC_BASE + PRITY1);
-+ writel(0x11111111, AMIC_BASE + PRITY2);
-+ writel(0x11111111, AMIC_BASE + PRITY3);
-+ writel(DEFAULT_MODE, AMIC_BASE + INTTRG);
-+ writel(~DEFAULT_LEVEL, AMIC_BASE + INTLVL);
-+ printk("AMIC config %x %x\n", temp, readl(AMIC_BASE + CONFIG));
-+
-+ for (i = IRQ_BASE, edge = 1; i < IRQ_BASE + IRQ_TOTAL; i++, edge <<= 1) {
-+ set_irq_chip(i, &amic_chip);
-+ if (DEFAULT_MODE & edge)
-+ set_irq_handler(i, handle_edge_irq);
-+ else
-+ set_irq_handler(i, handle_level_irq);
-+ }
-+
-+}
-+
-+unsigned int get_IntSrc(void)
-+{
-+ unsigned int irqsta, irq = 31;
-+
-+ spin_lock(&amic_irq_lock);
-+ irqsta = readl(AMIC_BASE + IPISTA);
-+ if (irqsta != 0)
-+ irqsta = 0;
-+ else
-+ irqsta = readl(AMIC_BASE + INTSTA);
-+ spin_unlock(&amic_irq_lock);
-+
-+ if (irqsta == 0)
-+ return 32;
-+ if (irqsta & 0x0000ffff) {
-+ irq -= 16;
-+ irqsta <<= 16;
-+ }
-+ if (irqsta & 0x00ff0000) {
-+ irq -= 8;
-+ irqsta <<= 8;
-+ }
-+ if (irqsta & 0x0f000000) {
-+ irq -= 4;
-+ irqsta <<= 4;
-+ }
-+ if (irqsta & 0x30000000) {
-+ irq -= 2;
-+ irqsta <<= 2;
-+ }
-+ if (irqsta & 0x40000000) {
-+ irq -= 1;
-+ }
-+ return irq;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/dmad.c linux-3.4.113/arch/nds32/platforms/dmad.c
---- linux-3.4.113.orig/arch/nds32/platforms/dmad.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/dmad.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,3601 @@
-+/*****************************************************************************
-+ *
-+ * Copyright Andes Technology Corporation 2007-2008
-+ * All Rights Reserved.
-+ *
-+ * Revision History:
-+ *
-+ * Aug.21.2007 Created.
-+ * Feb.23.2009 Porting to Linux 2.6.
-+*****************************************************************************/
-+
-+#include <linux/module.h>
-+#include <linux/init.h>
-+#include <linux/mm.h>
-+#include <linux/slab.h>
-+#include <linux/spinlock.h>
-+#include <linux/completion.h>
-+#include <linux/errno.h>
-+#include <linux/interrupt.h>
-+#include <linux/ioport.h>
-+#include <asm/sizes.h>
-+#include <asm/types.h>
-+#include <asm/io.h>
-+#include <asm/dmad.h>
-+#include <linux/irq.h>
-+
-+#if (defined(CONFIG_PLATFORM_AHBDMA) || defined(CONFIG_PLATFORM_APBDMA))
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+#define DMAD_AHB_MAX_CHANNELS DMAC_MAX_CHANNELS
-+#else
-+#define DMAD_AHB_MAX_CHANNELS 0
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+#define DMAD_APB_MAX_CHANNELS APBBR_DMA_MAX_CHANNELS
-+#else
-+#define DMAD_APB_MAX_CHANNELS 0
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+#define DMAD_DRB_POOL_SIZE 32 /* 128 */
-+
-+/* reg/io supplementals */
-+static inline void setbl(addr_t bit, addr_t reg)
-+{
-+ outl(inl(reg) | (addr_t) ((addr_t) 1 << bit), reg);
-+}
-+
-+static inline void clrbl(addr_t bit, addr_t reg)
-+{
-+ outl(inl(reg) & (~((addr_t) ((addr_t) 1 << bit))), reg);
-+}
-+
-+static inline addr_t getbl(addr_t bit, addr_t reg)
-+{
-+ return inl(reg) & (addr_t) ((addr_t) 1 << bit);
-+}
-+
-+/******************************************************************************/
-+
-+enum DMAD_DRQ_FLAGS {
-+ DMAD_DRQ_STATE_READY = 0x00000001, /* channel allocation status */
-+ DMAD_DRQ_STATE_ABORT = 0x00000002, /* abort drb alloc block-wait */
-+ DMAD_DRQ_DIR_A1_TO_A0 = 0x00000004, /* Transfer direction */
-+};
-+
-+#define DMAD_DRQ_DIR_MASK DMAD_DRQ_DIR_A1_TO_A0
-+
-+/* DMA request queue, one instance per channel */
-+typedef struct dmad_drq {
-+ u32 state; /* enum DMAD_DRQ_STATE */
-+
-+ addr_t channel_base; /* register base address */
-+ addr_t enable_port; /* enable register */
-+ addr_t src_port; /* source address register */
-+ addr_t dst_port; /* dest address register */
-+ addr_t cyc_port; /* size(cycle) register */
-+
-+ u32 flags; /* enum DMAD_CHREQ_FLAGS */
-+
-+ spinlock_t drb_pool_lock;
-+ dmad_drb *drb_pool; /* drb pool */
-+
-+ u32 fre_head; /* free list head */
-+ u32 fre_tail; /* free list tail */
-+
-+ u32 rdy_head; /* ready list head */
-+ u32 rdy_tail; /* ready list tail */
-+
-+ u32 sbt_head; /* submitted list head */
-+ u32 sbt_tail; /* submitted list tail */
-+
-+ u32 data_width; /* dma transfer data width */
-+
-+ struct completion drb_alloc_sync;
-+
-+ /* client supplied callback function, executed in interrupt context
-+ * client private data to be passed to data argument of completion_cb().
-+ */
-+ void (*completion_cb) (int channel, u16 status, void *data);
-+ void *completion_data;
-+
-+ /* ring-mode fields are valid for DMAD_FLAGS_RING_MODE */
-+ dma_addr_t ring_base; /* ring buffer base address */
-+ dma_addr_t ring_size; /* size (of data width) */
-+ addr_t ring_port; /* for setup/fetch hw_ptr */
-+ dmad_drb *ring_drb;
-+
-+ addr_t dev_addr; /* device data port */
-+
-+ int periods; /* interrupts periods */
-+ dma_addr_t period_size; /* of dma data with */
-+ dma_addr_t period_bytes; /* Period size, in bytes */
-+
-+ /* ring_size - period_size * periods */
-+ dma_addr_t remnant_size;
-+
-+ dma_addr_t sw_ptr; /* sw pointer */
-+ int sw_p_idx; /* current ring_ptr */
-+ dma_addr_t sw_p_off; /* offset to period base */
-+
-+} dmad_drq;
-+
-+/* To shrink code size and improve performance, common channel registers
-+ * are preload in drq struct at channel allocation time. One of the key
-+ * dependency is the enable bit of both DMAC and APBDMA channel command
-+ * registers. Please make sure hw design them at bit 0 of the command register
-+ * in future evolvement.
-+ */
-+#if (DMAC_CSR_CH_EN_BIT != APBBR_DMA_CHEN_BIT)
-+#error "DMAC_CSR_CH_EN_BIT != APBBR_DMA_CHEN_BIT"
-+#endif
-+
-+#define DMAD_PORT_ENABLE_BIT APBBR_DMA_CHEN_BIT
-+
-+static inline void dmad_enable_channel(dmad_drq * drq)
-+{
-+ setbl(DMAD_PORT_ENABLE_BIT, drq->enable_port);
-+}
-+
-+static inline void dmad_disable_channel(dmad_drq * drq)
-+{
-+ clrbl(DMAD_PORT_ENABLE_BIT, drq->enable_port);
-+}
-+
-+static inline addr_t dmad_is_channel_enabled(dmad_drq * drq)
-+{
-+ return (addr_t) getbl(DMAD_PORT_ENABLE_BIT, drq->enable_port);
-+}
-+
-+/* AHB DMAC channel re-route table structure */
-+typedef struct _DMAD_AHB_CH_ROUTE {
-+ u32 dev_reqn; /* device req/gnt number */
-+ addr_t clear_cr; /* routing control register address */
-+ addr_t route_cr; /* routing control register address */
-+} DMAD_AHB_CH_ROUTE;
-+
-+#ifdef CONFIG_PLAT_AG102
-+#if 0
-+/* AHB DMAC channel re-route table. Indexed by AHB DMAC req/ack number. */
-+static DMAD_AHB_CH_ROUTE ahb_ch_route_table[] __attribute__ ((__unused__)) = {
-+ /* all todo ... */
-+
-+ {
-+ 0x00, DMAC_REQN_IDERX, DMAC_REQN_IDERX}, {
-+ 0x01, DMAC_REQN_IDETX, DMAC_REQN_IDETX}, {
-+ 0x02, DMAC_REQN_I2SAC97RX, DMAC_REQN_I2SAC97RX}, {
-+ 0x03, DMAC_REQN_I2SAC97TX, DMAC_REQN_I2SAC97TX}, {
-+ 0x04, DMAC_REQN_UART2RX, DMAC_REQN_UART2RX}, {
-+ 0x05, DMAC_REQN_UART2TX, DMAC_REQN_UART2TX}, {
-+ 0x06, DMAC_REQN_UART1RX, DMAC_REQN_UART1RX}, {
-+ 0x07, DMAC_REQN_UART1TX, DMAC_REQN_UART1TX}, {
-+ 0x08, DMAC_REQN_SDC, DMAC_REQN_SDC}, {
-+ 0x09, DMAC_REQN_CFC, DMAC_REQN_CFC}, {
-+ 0x0a, DMAC_REQN_LPCREQ0, DMAC_REQN_LPCREQ0}, {
-+ 0x0b, DMAC_REQN_LPCREQ1, DMAC_REQN_LPCREQ1}, {
-+ 0x0c, DMAC_REQN_LPCREQ2, DMAC_REQN_LPCREQ2}, {
-+ 0x0d, DMAC_REQN_LPCREQ3, DMAC_REQN_LPCREQ3}, {
-+ 0x0e, 0, 0}, {
-+0x0f, DMAC_REQN_LPCREQ5, DMAC_REQN_LPCREQ5},};
-+#endif
-+#else /* CONFIG_PLAT_AG102 */
-+
-+/* AHB DMAC channel re-route table. Indexed by AHB DMAC req/ack number. */
-+static DMAD_AHB_CH_ROUTE ahb_ch_route_table[] = {
-+ {0x00, 0, 0},
-+ {0x01, PMU_CFC_REQACK_CFG, PMU_CFC_REQACK_CFG},
-+ {0x02, PMU_SSP1_REQACK_CFG, PMU_SSP1_REQACK_CFG},
-+ {0x03, PMU_UART1RX_REQACK_CFG, PMU_UART1TX_REQACK_CFG},
-+ {0x04, PMU_UART1TX_REQACK_CFG, PMU_UART1RX_REQACK_CFG},
-+ {0x05, PMU_UART2RX_REQACK_CFG, PMU_UART2TX_REQACK_CFG},
-+ {0x06, PMU_UART2TX_REQACK_CFG, PMU_UART2RX_REQACK_CFG},
-+ {0x07, PMU_SDC_REQACK_CFG, PMU_SDC_REQACK_CFG},
-+ {0x08, PMU_I2SAC97RX_REQACK_CFG, PMU_I2SAC97TX_REQACK_CFG},
-+ {0x09, 0, 0},
-+ {0x0a, PMU_I2SAC97TX_REQACK_CFG, PMU_I2SAC97RX_REQACK_CFG},
-+ {0x0b, PMU_USB_REQACK_CFG, PMU_USB_REQACK_CFG},
-+ {0x0c, 0, 0},
-+ {0x0d, 0, 0},
-+ {0x0e, PMU_EXT0_REQACK_CFG, PMU_EXT0_REQACK_CFG},
-+ {0x0f, PMU_EXT1_REQACK_CFG, PMU_EXT1_REQACK_CFG},
-+};
-+
-+#endif /* CONFIG_PLAT_AG102 */
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+
-+/* system irq number (per channel, ahb) */
-+static const unsigned int ahb_irqs[DMAD_AHB_MAX_CHANNELS] = {
-+ DMAC_FTDMAC020_0_IRQ0,
-+ DMAC_FTDMAC020_0_IRQ1,
-+ DMAC_FTDMAC020_0_IRQ2,
-+ DMAC_FTDMAC020_0_IRQ3,
-+ DMAC_FTDMAC020_0_IRQ4,
-+ DMAC_FTDMAC020_0_IRQ5,
-+ DMAC_FTDMAC020_0_IRQ6,
-+ DMAC_FTDMAC020_0_IRQ7,
-+};
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+
-+/* APB Bridge DMA request number re-route table */
-+typedef struct _DMAD_APB_REQN_ROUTE {
-+ u32 apb_reqn; /* APB device req/gnt number */
-+ u32 ahb_reqn_tx; /* AHB DMAC req/ack number (tx) */
-+ u32 ahb_reqn_rx; /* AHB DMAC req/ack number (rx) */
-+ u32 bus_sel; /* APBBR_ADDRSEL_APB(0) or APBBR_ADDRSEL_AHB(1) */
-+} DMAD_APB_REQN_ROUTE;
-+
-+#ifdef CONFIG_PLAT_AG102
-+
-+/* APB Bridge DMA request number re-route table. Indexed by APB DMA req/gnt
-+ * number. */
-+static DMAD_APB_REQN_ROUTE apb_reqn_route_table[] = {
-+ {0x00, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x01, DMAC_REQN_CFC, DMAC_REQN_CFC, APBBR_ADDRSEL_APB},
-+ {0x02, 0x00, 0x00, APBBR_ADDRSEL_APB},
-+ {0x03, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x04, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ //MOD by river 2010.10.20
-+ {0x05, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ //End MOD by river 2010.10.20
-+ {0x06, DMAC_REQN_I2SAC97TX, DMAC_REQN_I2SAC97RX, APBBR_ADDRSEL_APB},
-+ {0x07, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ //MOD by river 2010.10.20
-+ {0x08, DMAC_REQN_SDC, DMAC_REQN_SDC, APBBR_ADDRSEL_APB},
-+ //End MOD by river 2010.10.20
-+ {0x09, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0a, DMAC_REQN_UART2TX, DMAC_REQN_UART2RX, APBBR_ADDRSEL_APB},
-+ {0x0b, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0c, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0d, DMAC_REQN_I2SAC97TX, DMAC_REQN_I2SAC97RX, APBBR_ADDRSEL_APB},
-+ {0x0e, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0f, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+};
-+
-+#else /* CONFIG_PLAT_AG102 */
-+
-+/* APB Bridge DMA request number re-route table. Indexed by APB DMA req/gnt
-+ * number. */
-+static DMAD_APB_REQN_ROUTE apb_reqn_route_table[] = {
-+ {0x00, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x01, DMAC_REQN_CFC, DMAC_REQN_CFC, APBBR_ADDRSEL_APB},
-+ {0x02, DMAC_REQN_SSP, DMAC_REQN_SSP, APBBR_ADDRSEL_APB},
-+ {0x03, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x04, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x05, DMAC_REQN_SDC, DMAC_REQN_SDC, APBBR_ADDRSEL_APB},
-+ {0x06, DMAC_REQN_I2SAC97TX, DMAC_REQN_I2SAC97RX, APBBR_ADDRSEL_APB},
-+/* for amerald
-+ { 0x07, 0x00, 0x00, APBBR_ADDRSEL_AHB },*/
-+ {0x07, APBBR_REQN_SDC_AMERALD, APBBR_REQN_SDC_AMERALD,
-+ APBBR_ADDRSEL_AHB},
-+/* for amerald ac97
-+ { 0x08, 0x00, 0x00, APBBR_ADDRSEL_AHB }, */
-+ {0x08, APBBR_REQN_I2SAC97TX_AMERALD, APBBR_REQN_I2SAC97TX_AMERALD,
-+ APBBR_ADDRSEL_APB},
-+ {0x09, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0a, DMAC_REQN_UART2TX, DMAC_REQN_UART2RX, APBBR_ADDRSEL_APB},
-+ {0x0b, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0c, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0d, DMAC_REQN_I2SAC97TX, DMAC_REQN_I2SAC97RX, APBBR_ADDRSEL_APB},
-+ {0x0e, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+ {0x0f, 0x00, 0x00, APBBR_ADDRSEL_AHB},
-+};
-+
-+#endif /* CONFIG_PLAT_AG102 */
-+
-+/* system irq number (per channel, apb) */
-+static const unsigned int apb_irqs[DMAD_APB_MAX_CHANNELS] = {
-+ APBBRG_FTAPBBRG020S_0_IRQ0,
-+ APBBRG_FTAPBBRG020S_0_IRQ1,
-+ APBBRG_FTAPBBRG020S_0_IRQ2,
-+ APBBRG_FTAPBBRG020S_0_IRQ3,
-+};
-+
-+#endif
-+
-+/* Driver data structure, one instance per system */
-+typedef struct DMAD_DATA_STRUCT {
-+ /* Driver data initialization flag */
-+
-+ /* DMA queue pool access control object */
-+ spinlock_t drq_pool_lock;
-+
-+ /* DMA queue base address, to ease alloc/free flow */
-+ dmad_drq *drq_pool;
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ /* DMA queue for AHB DMA channels */
-+ dmad_drq *ahb_drq_pool;
-+#endif
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ /* DMA queue for APB DMA channels */
-+ dmad_drq *apb_drq_pool;
-+#endif
-+
-+} DMAD_DATA;
-+
-+/* Driver data structure instance, one instance per system */
-+static DMAD_DATA dmad __attribute__ ((aligned(4))) = {
-+ .drq_pool_lock = __SPIN_LOCK_UNLOCKED(dmad.drq_pool_lock),
-+// .drq_pool_lock = SPIN_LOCK_UNLOCKED,
-+ .drq_pool = 0,
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ .ahb_drq_pool = 0,
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ .apb_drq_pool = 0,
-+#endif
-+};
-+
-+/**
-+ * dmad_next_drb - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @node : [in] The node number to lookup its next node
-+ * @drb : [out] The drb next to the "node" node number
-+ *
-+ * Lookup next DRB of the specified node number. "drb" is null if reaches end
-+ * of the list.
-+ */
-+static inline void dmad_next_drb(dmad_drb * drb_pool, u32 node, dmad_drb ** drb)
-+{
-+ if (likely(drb_pool[node].next != 0))
-+ *drb = &drb_pool[drb_pool[node].next];
-+ else
-+ *drb = 0;
-+}
-+
-+/**
-+ * dmad_prev_drb - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @node : [in] The node number to lookup its previous node
-+ * @drb : [out] The drb previous to the "node" node number
-+ *
-+ * Lookup previous DRB of the specified node number. "drb" is null if reaches
-+ * head-end of the list.
-+ */
-+static inline void dmad_prev_drb(dmad_drb * drb_pool, u32 node, dmad_drb ** drb)
-+{
-+ if (unlikely(drb_pool[node].prev != 0))
-+ *drb = &drb_pool[drb_pool[node].prev];
-+ else
-+ *drb = 0;
-+}
-+
-+/**
-+ * dmad_detach_node - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @head : [in/out] Reference to the head node number
-+ * @tail : [in/out] Reference to the tail node number
-+ * @node : [in] The node to be dettached from the queue
-+ *
-+ * Detached a DRB specified by the node number from the queue. The head and
-+ * tail records will be updated accordingly.
-+ */
-+static inline void dmad_detach_node(dmad_drb * drb_pool,
-+ u32 * head, u32 * tail, u32 node)
-+{
-+ if (likely(drb_pool[node].prev != 0)) {
-+ /* prev->next = this->next (= 0, if this is a tail) */
-+ drb_pool[drb_pool[node].prev].next = drb_pool[node].next;
-+ } else {
-+ /* this node is head, move head to next node
-+ * (= 0, if this is the only one node) */
-+ *head = drb_pool[node].next;
-+ }
-+
-+ if (unlikely(drb_pool[node].next != 0)) {
-+ /* next->prev = this->prev (= 0, if this is a head) */
-+ drb_pool[drb_pool[node].next].prev = drb_pool[node].prev;
-+ } else {
-+ /* this node is tail, move tail to previous node
-+ * (= 0, if this is the only one node) */
-+ *tail = drb_pool[node].prev;
-+ }
-+
-+ drb_pool[node].prev = drb_pool[node].next = 0;
-+}
-+
-+/**
-+ * dmad_detach_head - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @head : [in/out] Reference to the head node number
-+ * @tail : [in/out] Reference to the tail node number
-+ * @drb : [out] The detached head node; null if the queue is empty
-+ *
-+ * Detached a DRB from the head of the queue. The head and tail records will
-+ * be updated accordingly.
-+ */
-+static inline void dmad_detach_head(dmad_drb * drb_pool,
-+ u32 * head, u32 * tail, dmad_drb ** drb)
-+{
-+ if (unlikely(*head == 0)) {
-+ *drb = NULL;
-+ return;
-+ }
-+
-+ *drb = &drb_pool[*head];
-+
-+ if (likely((*drb)->next != 0)) {
-+ /* next->prev = this->prev (= 0, if this is a head) */
-+ drb_pool[(*drb)->next].prev = 0;
-+
-+ /* prev->next = this->next (do nothing, if this is a head) */
-+
-+ /* head = this->next */
-+ *head = (*drb)->next;
-+ } else {
-+ /* head = tail = 0 */
-+ *head = 0;
-+ *tail = 0;
-+ }
-+
-+ /* this->prev = this->next = 0 (do nothing, if save code size) */
-+ (*drb)->prev = (*drb)->next = 0;
-+}
-+
-+/**
-+ * dmad_get_head - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @head : [in/out] Reference to the head node number
-+ * @tail : [in/out] Reference to the tail node number
-+ * @drb : [out] The head node; null if the queue is empty
-+ *
-+ * Get a DRB from the head of the queue. The head and tail records remain
-+ * unchanged.
-+ */
-+static inline void dmad_get_head(dmad_drb * drb_pool, const u32 * head,
-+ const u32 * tail, dmad_drb ** drb)
-+{
-+ if (unlikely(*head == 0)) {
-+ *drb = NULL;
-+ return;
-+ }
-+
-+ *drb = &drb_pool[*head];
-+}
-+
-+/**
-+ * dmad_detach_tail - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @head : [in/out] Reference to the head node number
-+ * @tail : [in/out] Reference to the tail node number
-+ * @drb : [out] The tail node; null if the queue is empty
-+ *
-+ * Detached a DRB from the head of the queue. The head and tail records will
-+ * be updated accordingly.
-+ */
-+static inline void dmad_detach_tail(dmad_drb * drb_pool,
-+ u32 * head, u32 * tail, dmad_drb ** drb)
-+{
-+ if (unlikely(*tail == 0)) {
-+ *drb = NULL;
-+ return;
-+ }
-+
-+ *drb = &drb_pool[*tail];
-+
-+ if (likely((*drb)->prev != 0)) {
-+ /* prev->next = this->next (= 0, if this is a tail) */
-+ drb_pool[(*drb)->prev].next = 0;
-+
-+ /* next->prev = this->prev (do nothing, if this is a tail) */
-+
-+ /* tail = this->prev */
-+ *tail = (*drb)->prev;
-+ } else {
-+ /* head = tail = 0 */
-+ *head = 0;
-+ *tail = 0;
-+ }
-+
-+ /* this->next = this->prev = 0 (do nothing, if save code size) */
-+ (*drb)->prev = (*drb)->next = 0;
-+}
-+
-+/**
-+ * dmad_get_tail - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @head : [in/out] Reference to the head node number
-+ * @tail : [in/out] Reference to the tail node number
-+ * @drb : [out] The tail node; null if the queue is empty
-+ *
-+ * Get a DRB from the tail of the queue. The head and tail records remain
-+ * unchanged.
-+ */
-+static inline void dmad_get_tail(dmad_drb * drb_pool,
-+ u32 * head, u32 * tail, dmad_drb ** drb)
-+{
-+ if (unlikely(*tail == 0)) {
-+ *drb = NULL;
-+ return;
-+ }
-+
-+ *drb = &drb_pool[*tail];
-+}
-+
-+/**
-+ * dmad_attach_head - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @head : [in/out] Reference to the head node number
-+ * @tail : [in/out] Reference to the tail node number
-+ * @node : [in] The node to be attached
-+ *
-+ * Attach a DRB node to the head of the queue. The head and tail records will
-+ * be updated accordingly.
-+ */
-+static inline void dmad_attach_head(dmad_drb * drb_pool,
-+ u32 * head, u32 * tail, u32 node)
-+{
-+ if (likely(*head != 0)) {
-+ /* head->prev = this */
-+ drb_pool[*head].prev = node;
-+
-+ /* this->next = head */
-+ drb_pool[node].next = *head;
-+ /* this->prev = 0 */
-+ drb_pool[node].prev = 0;
-+
-+ /* head = node */
-+ *head = node;
-+ } else {
-+ /* head = tail = node */
-+ *head = *tail = node;
-+ drb_pool[node].prev = drb_pool[node].next = 0;
-+ }
-+}
-+
-+/**
-+ * dmad_attach_head - static function
-+ * @drb_pool : [in] The raw DRB pool of a DMA channel
-+ * @head : [in/out] Reference to the head node number
-+ * @tail : [in/out] Reference to the tail node number
-+ * @node : [in] The node to be attached
-+ *
-+ * Attach a DRB node to the tail of the queue. The head and tail records will
-+ * be updated accordingly.
-+ */
-+static inline void dmad_attach_tail(dmad_drb * drb_pool,
-+ u32 * head, u32 * tail, u32 node)
-+{
-+ if (likely(*tail != 0)) {
-+ /* tail->next = this */
-+ drb_pool[*tail].next = node;
-+
-+ /* this->prev = tail */
-+ drb_pool[node].prev = *tail;
-+ /* this->next = 0 */
-+ drb_pool[node].next = 0;
-+
-+ /* tail = node */
-+ *tail = node;
-+ } else {
-+ /* head = tail = node */
-+ *head = *tail = node;
-+ drb_pool[node].prev = drb_pool[node].next = 0;
-+ }
-+}
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+
-+/**
-+ * dmad_ahb_isr - AHB DMA interrupt service routine
-+ *
-+ * @irq : [in] The irq number
-+ * @dev_id : [in] The identifier to identify the asserted channel
-+ *
-+ * This is the ISR that services all AHB DMA channels.
-+ */
-+static irqreturn_t dmad_ahb_isr(int irq, void *dev_id)
-+{
-+ dmad_drq *drq;
-+ dmad_drb *drb, *drb_iter;
-+ u32 channel = ((u32) dev_id) - 1;
-+ u8 tc_int = 0;
-+ u8 err_int = 0;
-+ u8 abt_int = 0;
-+ u8 cpl_events = 1;
-+
-+ dmad_dbg("%s() >> channel(%d)\n", __func__, channel);
-+
-+ if (channel >= DMAD_AHB_MAX_CHANNELS) {
-+ dmad_err("%s() invlaid channel number: %d!\n",
-+ __func__, channel);
-+ return IRQ_HANDLED;
-+ }
-+
-+ /* Fetch channel's DRQ struct (DMA Request Queue) */
-+ drq = (dmad_drq *) & dmad.ahb_drq_pool[channel];
-+
-+ /* Check DMA status register to get channel number */
-+ if (likely(getbl(channel, DMAC_INT_TC))) {
-+
-+ /* Mark as TC int */
-+ tc_int = 1;
-+
-+ /* DMAC INT TC status clear */
-+ setbl(channel, DMAC_INT_TC_CLR);
-+
-+ } else if (getbl(channel + DMAC_INT_ERR_SHIFT, DMAC_INT_ERRABT)) {
-+
-+ /* Mark as ERR int */
-+ err_int = 1;
-+
-+ /* DMAC INT ERR status clear */
-+ setbl(channel + DMAC_INT_ERR_CLR_SHIFT, DMAC_INT_ERRABT_CLR);
-+
-+ } else if (getbl(channel + DMAC_INT_ABT_SHIFT, DMAC_INT_ERRABT)) {
-+
-+ /* Mark as ABT int */
-+ abt_int = 1;
-+
-+ /* DMAC INT ABT status clear */
-+ setbl(channel + DMAC_INT_ABT_CLR_SHIFT, DMAC_INT_ERRABT_CLR);
-+
-+ } else {
-+
-+ dmad_err("%s() possible false-fired ahb dma int,"
-+ "channel %d status-reg: tc(0x%08x) arrabt(0x%08x)\n",
-+ __func__, channel,
-+ inl(DMAC_INT_TC), inl(DMAC_INT_ERRABT_CLR));
-+
-+ /* Stop DMA channel (make sure the channel will be stopped) */
-+ clrbl(DMAC_CSR_CH_EN_BIT, drq->channel_base + DMAC_CSR_OFFSET);
-+
-+ return IRQ_HANDLED;
-+ }
-+
-+ /* DMAC
-+ * Stop DMA channel temporarily */
-+ dmad_disable_channel(drq);
-+
-+ spin_lock(&drq->drb_pool_lock);
-+
-+ /* Lookup/detach latest submitted DRB (DMA Request Block) from
-+ * the DRQ (DMA Request Queue), so ISR could kick off next DRB */
-+ dmad_detach_head(drq->drb_pool, &drq->sbt_head, &drq->sbt_tail, &drb);
-+ if (drb == NULL) {
-+ spin_unlock(&drq->drb_pool_lock);
-+ /* submitted list could be empty if client cancel all requests
-+ * of the channel. */
-+ return IRQ_HANDLED;
-+ }
-+
-+ /* release blocking of drb-allocation, if any ... */
-+ if (unlikely((drq->fre_head == 0) &&
-+ (drq->flags & DMAD_FLAGS_SLEEP_BLOCK))) {
-+ complete_all(&drq->drb_alloc_sync);
-+ }
-+
-+ /* Process DRBs according to interrupt reason */
-+ if (tc_int) {
-+
-+ dmad_dbg("dma finish\n");
-+
-+ dmad_dbg("finish drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x)\n",
-+ drb->node, (u32) drb, drb->src_addr,
-+ drb->dst_addr, drb->req_cycle);
-+
-+ if (drb->req_cycle == 0)
-+ cpl_events = 0;
-+
-+ // Mark DRB state as completed
-+ drb->state = DMAD_DRB_STATE_COMPLETED;
-+ if (cpl_events && drb->sync)
-+ complete_all(drb->sync);
-+
-+ dmad_attach_tail(drq->drb_pool, &drq->fre_head,
-+ &drq->fre_tail, drb->node);
-+
-+ // Check whether there are pending requests in the DRQ
-+ if (drq->sbt_head != 0) {
-+
-+ // Lookup next DRB (DMA Request Block)
-+ drb_iter = &drq->drb_pool[drq->sbt_head];
-+
-+ dmad_dbg("exec drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x)\n",
-+ drb_iter->node, (u32) drb_iter,
-+ drb_iter->src_addr, drb_iter->dst_addr,
-+ drb_iter->req_cycle);
-+
-+ // Kick-off DMA for next DRB
-+ // - Source and destination address
-+ if (drq->flags & DMAD_DRQ_DIR_A1_TO_A0) {
-+ outl(drb_iter->addr1, drq->src_port);
-+ outl(drb_iter->addr0, drq->dst_port);
-+ } else {
-+ outl(drb_iter->addr0, drq->src_port);
-+ outl(drb_iter->addr1, drq->dst_port);
-+ }
-+
-+ /* - Transfer size (in units of source width) */
-+ outl(drb_iter->req_cycle, drq->cyc_port);
-+
-+ /* Kick off next request */
-+ dmad_enable_channel(drq);
-+
-+ drb_iter->state = DMAD_DRB_STATE_EXECUTED;
-+
-+ } else {
-+ /* No pending requests, keep the DMA channel stopped */
-+ }
-+
-+ } else {
-+
-+ dmad_err("%s() ahb dma channel %d error!\n", __func__, channel);
-+
-+ /* Zero out src, dst, and size */
-+ outl(0, drq->src_port);
-+ outl(0, drq->dst_port);
-+ outl(0, drq->cyc_port);
-+
-+ /* Remove all pending requests in the queue */
-+ drb_iter = drb;
-+ while (drb_iter) {
-+
-+ dmad_err("abort drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x)\n",
-+ drb_iter->node, (u32) drb_iter,
-+ drb_iter->src_addr, drb_iter->dst_addr,
-+ drb_iter->req_cycle);
-+
-+ if (drb_iter->req_cycle == 0)
-+ cpl_events = 0;
-+
-+ /* Mark DRB state as abort */
-+ drb_iter->state = DMAD_DRB_STATE_ABORT;
-+
-+ if (cpl_events && drb_iter->sync)
-+ complete_all(drb_iter->sync);
-+
-+ dmad_attach_tail(drq->drb_pool, &drq->fre_head,
-+ &drq->fre_tail, drb_iter->node);
-+
-+ /* Detach next submitted DRB (DMA Request Block)
-+ * from the DRQ (DMA Request Queue) */
-+ dmad_detach_head(drq->drb_pool, &drq->sbt_head,
-+ &drq->sbt_tail, &drb_iter);
-+ }
-+ }
-+
-+ spin_unlock(&drq->drb_pool_lock);
-+
-+ /* dispatch interrupt-context level callbacks */
-+ if (cpl_events && drq->completion_cb) {
-+ /* signal DMA driver that new node is available */
-+ drq->completion_cb(channel, tc_int, drq->completion_data);
-+ }
-+
-+ dmad_dbg("%s() <<\n", __func__);
-+
-+ return IRQ_HANDLED;
-+}
-+
-+/**
-+ * dmad_ahb_config_dir - prepare command reg according to tx direction
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @channel_cmds : [out] Reference to array of command words to be prepared with
-+ * @return : none
-+ *
-+ * Prepare command registers according to transfer direction ...
-+ * channel_cmd[0] DMAC_CSR
-+ * channel_cmd[1] DMAC_CFG
-+ *
-+ * This function only serves as local helper. No protection wrappers.
-+ */
-+static void dmad_ahb_config_dir(dmad_chreq * ch_req, addr_t * channel_cmds)
-+{
-+ dmad_drq *drq = (dmad_drq *) ch_req->drq;
-+ dmad_ahb_chreq *ahb_req = (dmad_ahb_chreq *) (&ch_req->ahb_req);
-+/* for amerald */
-+ u32 reqn0, reqn1;
-+ dmad_dbg("%s() channel_cmds(0x%08x, 0x%08x)\n",
-+ __func__, channel_cmds[0], channel_cmds[1]);
-+/* for amerald */
-+ if ((inl(PMU_BASE) & AMERALD_MASK) == AMERALD_PRODUCT_ID) {
-+ reqn0 = ahb_req->addr0_reqn;
-+ reqn1 = ahb_req->addr1_reqn;
-+ } else {
-+ reqn0 = ch_req->channel;
-+ reqn1 = ch_req->channel;
-+ }
-+ channel_cmds[0] &= ~(addr_t)
-+ (DMAC_CSR_SRC_WIDTH_MASK | DMAC_CSR_SRCAD_CTL_MASK |
-+ DMAC_CSR_DST_WIDTH_MASK | DMAC_CSR_DSTAD_CTL_MASK |
-+ DMAC_CSR_MODE_MASK);
-+ channel_cmds[1] &= ~(addr_t)
-+ (DMAC_CFG_INT_SRC_RS_MASK | DMAC_CFG_INT_SRC_HE_MASK |
-+ DMAC_CFG_INT_DST_RS_MASK | DMAC_CFG_INT_DST_HE_MASK);
-+
-+ /* 0 - addr0 to addr1; 1 - addr1 to addr0 */
-+ if (ahb_req->tx_dir == 0) {
-+
-+ dmad_dbg("%s() addr0 --> addr1\n", __func__);
-+
-+ /* - Channel CSR
-+ * DST_SEL : 0 (Master 0)
-+ * SRC_SEL : 0 (Master 0)
-+ * DSTAD_CTL : ahb_req->dst_ctrl
-+ * SRCAD_CTL : ahb_req->src_ctrl
-+ * MODE : 0 (normal)
-+ * DST_WIDTH : ahb_req->dst_width
-+ * SRC_WIDTH : ahb_req->src_width
-+ * SRC_SIZE : 0 (burst size = 1 byte)
-+ */
-+ channel_cmds[0] |=
-+ (((ahb_req->addr0_width << DMAC_CSR_SRC_WIDTH_SHIFT) &
-+ DMAC_CSR_SRC_WIDTH_MASK) |
-+ ((ahb_req->addr0_ctrl << DMAC_CSR_SRCAD_CTL_SHIFT) &
-+ DMAC_CSR_SRCAD_CTL_MASK) |
-+ ((ahb_req->addr1_width << DMAC_CSR_DST_WIDTH_SHIFT) &
-+ DMAC_CSR_DST_WIDTH_MASK) |
-+ ((ahb_req->addr1_ctrl << DMAC_CSR_DSTAD_CTL_SHIFT) &
-+ DMAC_CSR_DSTAD_CTL_MASK));
-+
-+ /* - Channel CFG
-+ * SRC_RS : channel number (not reqn)
-+ * SRC_HE : 0 if memory, 1 if device
-+ * DST_RS : channel number (not reqn)
-+ * DST_HE : 0 if memory, 1 if device
-+ */
-+ if (likely(ahb_req->hw_handshake != 0)) {
-+ /* Channel CSR - Enable HW-handshake mode */
-+ channel_cmds[0] |= DMAC_CSR_MODE_MASK;
-+
-+ /* Channel CFG - Device REQN and HW-handshake mode */
-+#ifdef CONFIG_PLAT_AG102
-+ /* AG102 fixes this bug */
-+ if (ahb_req->addr0_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_SRC_HE_MASK |
-+ ((ahb_req->addr0_reqn <<
-+ DMAC_CFG_INT_SRC_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_SRC_RS_MASK));
-+ }
-+
-+ if (ahb_req->addr1_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_DST_HE_MASK |
-+ ((ahb_req->addr1_reqn <<
-+ DMAC_CFG_INT_DST_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_DST_RS_MASK));
-+ }
-+#else
-+ /* AG101/XC5 bug */
-+/* for amerald */
-+ if (ahb_req->addr0_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_SRC_HE_MASK |
-+ ((reqn0 <<
-+ DMAC_CFG_INT_SRC_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_SRC_RS_MASK));
-+ }
-+
-+ if (ahb_req->addr1_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_DST_HE_MASK |
-+ ((reqn1 <<
-+ DMAC_CFG_INT_DST_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_DST_RS_MASK));
-+ }
-+#endif
-+ }
-+
-+ /* update source data width for faster cycle/byte size conversion */
-+ drq->data_width = ahb_req->addr0_width;
-+
-+ /* remember channel transfer direction */
-+ drq->flags &= ~(addr_t) DMAD_DRQ_DIR_A1_TO_A0;
-+
-+ } else {
-+
-+ dmad_dbg("%s() addr0 <-- addr1\n", __func__);
-+
-+ /* - Channel CSR
-+ * DST_SEL : 0 (Master 0)
-+ * SRC_SEL : 0 (Master 0)
-+ * DSTAD_CTL : ahb_req->dst_ctrl
-+ * SRCAD_CTL : ahb_req->src_ctrl
-+ * MODE : 0 (normal)
-+ * DST_WIDTH : ahb_req->dst_width
-+ * SRC_WIDTH : ahb_req->src_width
-+ * SRC_SIZE : 0 (burst size = 1 byte)
-+ */
-+ channel_cmds[0] |=
-+ (((ahb_req->addr1_width << DMAC_CSR_SRC_WIDTH_SHIFT) &
-+ DMAC_CSR_SRC_WIDTH_MASK) |
-+ ((ahb_req->addr1_ctrl << DMAC_CSR_SRCAD_CTL_SHIFT) &
-+ DMAC_CSR_SRCAD_CTL_MASK) |
-+ ((ahb_req->addr0_width << DMAC_CSR_DST_WIDTH_SHIFT) &
-+ DMAC_CSR_DST_WIDTH_MASK) |
-+ ((ahb_req->addr0_ctrl << DMAC_CSR_DSTAD_CTL_SHIFT) &
-+ DMAC_CSR_DSTAD_CTL_MASK));
-+
-+ /* - Channel CFG
-+ * SRC_RS : channel number (not reqn)
-+ * SRC_HE : 0 if memory, 1 if device
-+ * DST_RS : channel number (not reqn)
-+ * DST_HE : 0 if memory, 1 if device
-+ */
-+ if (likely(ahb_req->hw_handshake != 0)) {
-+ /* Channel CSR - Enable HW-handshake mode */
-+ channel_cmds[0] |= DMAC_CSR_MODE_MASK;
-+
-+ /* Channel CFG - Device REQN and HW-handshake mode */
-+#ifdef CONFIG_PLAT_AG102
-+ /* AG102 fixes this bug */
-+ if (ahb_req->addr1_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_SRC_HE_MASK |
-+ ((ahb_req->addr1_reqn <<
-+ DMAC_CFG_INT_SRC_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_SRC_RS_MASK));
-+ }
-+
-+ if (ahb_req->addr0_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_DST_HE_MASK |
-+ ((ahb_req->addr0_reqn <<
-+ DMAC_CFG_INT_DST_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_DST_RS_MASK));
-+ }
-+#else
-+ /* AG101/XC5 bug */
-+/* for amerald */
-+ if (ahb_req->addr1_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_SRC_HE_MASK |
-+ ((reqn1 <<
-+ DMAC_CFG_INT_SRC_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_SRC_RS_MASK));
-+ }
-+
-+ if (ahb_req->addr0_reqn != DMAC_REQN_NONE) {
-+ channel_cmds[1] |= (DMAC_CFG_INT_DST_HE_MASK |
-+ ((reqn0 <<
-+ DMAC_CFG_INT_DST_RS_SHIFT)
-+ &
-+ DMAC_CFG_INT_DST_RS_MASK));
-+ }
-+#endif
-+ }
-+
-+ /* source data width */
-+ drq->data_width = ahb_req->addr1_width;
-+
-+ /* remember channel transfer direction */
-+ drq->flags |= (addr_t) DMAD_DRQ_DIR_A1_TO_A0;
-+ }
-+
-+ dmad_dbg("%s() channel_cmds(0x%08x, 0x%08x)\n",
-+ __func__, channel_cmds[0], channel_cmds[1]);
-+}
-+
-+/**
-+ * dmad_ahb_init - initialize a ahb dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Register AHB DMA ISR and performs hw initialization for the given DMA
-+ * channel.
-+ */
-+static int dmad_ahb_init(dmad_chreq * ch_req)
-+{
-+ int err = 0;
-+ dmad_drq *drq = (dmad_drq *) ch_req->drq;
-+ dmad_ahb_chreq *ahb_req = (dmad_ahb_chreq *) (&ch_req->ahb_req);
-+ u32 channel = (u32) ch_req->channel;
-+ addr_t channel_base = drq->channel_base;
-+ addr_t channel_cmds[2]; // [0] DMAC_CSR; [1] DMAC_CFG
-+ unsigned long lock_flags;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ /* register interrupt handler */
-+ err = request_irq(ahb_irqs[channel], dmad_ahb_isr, 0,
-+ "AHB_DMA", (void *)(channel + 1));
-+ if (unlikely(err != 0)) {
-+ dmad_err("unable to request IRQ %d for AHB DMA "
-+ "(error %d)\n", ahb_irqs[channel], err);
-+ free_irq(ahb_irqs[channel], (void *)(channel + 1));
-+ return err;
-+ }
-+
-+ spin_lock_irqsave(&dmad.drq_pool_lock, lock_flags);
-+
-+ /**********************************************************
-+ * Following code require _safe_exit return path
-+ */
-+
-+#ifdef CONFIG_PLAT_AG102
-+ /* PCU
-+ *
-+ * Add by Dennis 2011.03.09
-+ * set 0 to dma selection register to using AHB
-+ * DMA.
-+ */
-+ if (ahb_req->dst_reqn == ahb_req->src_reqn) {
-+ dmad_err
-+ ("[dmad] invalid source reqn(%d) or destination reqn(%d)\n",
-+ ahb_req->src_reqn, ahb_req->dst_reqn);
-+ err = -EBADR;
-+ goto _safe_exit;
-+ }
-+ outl(0, PCU_DMA_SEL);
-+#else /* CONFIG_PLAT_AG102 */
-+
-+ /* PMU
-+ *
-+ * Route APB device DMA to an AHB DMAC channel and specify the channel
-+ * number. (connection status could be read back from PMU_AHBDMA_REQACK
-+ * register)
-+ *
-+ * Note: Only one device is routed per AHB DMA channel, the other target
-+ * should be either (1) the same device (same reqn), or (2) the AHB
-+ * device (reqn = 0).
-+ */
-+
-+ if (ahb_req->dst_reqn != DMAC_REQN_NONE) {
-+ // DMA transfer to device
-+ if ((ahb_req->dst_reqn > DMAC_REQN_MAX) ||
-+ (ahb_ch_route_table[ahb_req->dst_reqn].route_cr == 0)) {
-+ dmad_err("Invalid destination reqn(%d) "
-+ "or route_cr(0x%08x)\n", ahb_req->dst_reqn,
-+ (u32) ahb_ch_route_table[ahb_req->dst_reqn].
-+ route_cr);
-+ err = -EBADR;
-+ goto _safe_exit;
-+ }
-+
-+ outl(0, ahb_ch_route_table[ahb_req->dst_reqn].clear_cr);
-+ outl(PMU_DMACUSED_MASK | ((channel << PMU_CHANNEL_SHIFT) &
-+ PMU_CHANNEL_MASK),
-+ ahb_ch_route_table[ahb_req->dst_reqn].route_cr);
-+
-+ } else if (ahb_req->src_reqn != DMAC_REQN_NONE) {
-+
-+ // DMA transfer from device
-+ if ((ahb_req->src_reqn > DMAC_REQN_MAX) ||
-+ (ahb_ch_route_table[ahb_req->src_reqn].route_cr == 0)) {
-+ dmad_err("Invalid source reqn(%d) or "
-+ "route_cr(0x%08x)\n", ahb_req->src_reqn,
-+ (u32) ahb_ch_route_table[ahb_req->src_reqn].
-+ route_cr);
-+ err = -EBADR;
-+ goto _safe_exit;
-+ }
-+
-+ outl(0, ahb_ch_route_table[ahb_req->src_reqn].clear_cr);
-+ outl(PMU_DMACUSED_MASK | ((channel << PMU_CHANNEL_SHIFT) &
-+ PMU_CHANNEL_MASK),
-+ ahb_ch_route_table[ahb_req->src_reqn].route_cr);
-+ }
-+#endif /* CONFIG_PLAT_AG102 */
-+
-+ /* DMAC (Controller Setting) */
-+
-+ /* - INT TC/ERR/ABT status clear */
-+ setbl(channel, DMAC_INT_TC_CLR);
-+ setbl(channel + DMAC_INT_ERR_CLR_SHIFT, DMAC_INT_ERRABT_CLR);
-+ setbl(channel + DMAC_INT_ABT_CLR_SHIFT, DMAC_INT_ERRABT_CLR);
-+
-+ // - CSR (enable DMAC, set M0 & M1 default to little endian)
-+ outl(DMAC_DMACEN_MASK |
-+ ((DMAC_ENDIAN_LITTLE << DMAC_M0ENDIAN_BIT) & DMAC_M0ENDIAN_MASK) |
-+ ((DMAC_ENDIAN_LITTLE << DMAC_M1ENDIAN_BIT) & DMAC_M1ENDIAN_MASK),
-+ DMAC_CSR);
-+
-+ /* DMAC (Channel-Specific Setting) */
-+ /* - SYNC */
-+ if (ahb_req->sync)
-+ setbl(channel, DMAC_SYNC);
-+ else
-+ clrbl(channel, DMAC_SYNC);
-+
-+ /* - Channel CSR
-+ * CH_EN : 0 (disable)
-+ * DST_SEL : 0 (Master 0)
-+ * SRC_SEL : 0 (Master 0)
-+ * DSTAD_CTL : ahb_req->dst_ctrl
-+ * SRCAD_CTL : ahb_req->src_ctrl
-+ * MODE : 0 (normal)
-+ * DST_WIDTH : ahb_req->dst_width
-+ * SRC_WIDTH : ahb_req->src_width
-+ * ABT : 0 (not abort)
-+ * SRC_SIZE : 0 (burst size = 1 byte)
-+ * PROT1 : 0 (user mode)
-+ * PROT2 : 0 (bot bufferable)
-+ * PROT3 : 0 (not cacheable)
-+ * CHPRI : ahb_req->priority
-+ * DMA_FF_TH : 0 (FIA320 only, threshold = 1)
-+ * TC_MSK : 0 (TC counter status enable)
-+ */
-+ channel_cmds[0] = (ahb_req->priority << DMAC_CSR_CHPRI_SHIFT) &
-+ DMAC_CSR_CHPRI_MASK;
-+ channel_cmds[0] |= (ahb_req->burst_size << DMAC_CSR_SRC_SIZE_SHIFT) &
-+ DMAC_CSR_SRC_SIZE_MASK;
-+
-+ // - Channel CFG
-+ // INT_TC_MSK : 0 (enable TC int)
-+ // INT_ERR_MSK : 0 (enable ERR int)
-+ // INT_ABT_MSK : 0 (enable ABT int)
-+ // SRC_RS : 0
-+ // SRC_HE : 0
-+ // BUSY : r/o
-+ // DST_RS : 0
-+ // DST_HE : 0
-+ // LLP_CNT : r/o
-+ channel_cmds[1] = 0;
-+
-+ if (0 ==
-+ (ch_req->flags & (DMAD_FLAGS_RING_MODE | DMAD_FLAGS_BIDIRECTION)))
-+ ahb_req->tx_dir = 0;
-+
-+ dmad_ahb_config_dir(ch_req, channel_cmds);
-+
-+ outl(channel_cmds[0], channel_base + DMAC_CSR_OFFSET);
-+ outl(channel_cmds[1], channel_base + DMAC_CFG_OFFSET);
-+
-+ /* SRCADR and DESADR */
-+ outl(0, (addr_t) drq->src_port);
-+ outl(0, (addr_t) drq->dst_port);
-+
-+ /* CYC (transfer size) */
-+ outl(0, (addr_t) drq->cyc_port);
-+
-+ /* LLP */
-+ outl(0, channel_base + DMAC_LLP_OFFSET);
-+
-+ /* TOT_SIZE - not now */
-+
-+_safe_exit:
-+
-+ spin_unlock_irqrestore(&dmad.drq_pool_lock, lock_flags);
-+
-+ return err;
-+}
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+
-+/**
-+ * dmad_apb_isr - APB DMA interrupt service routine
-+ *
-+ * @irq : [in] The irq number
-+ * @dev_id : [in] The identifier to identify the asserted channel
-+ *
-+ * This is the ISR that services all APB DMA channels.
-+ */
-+static irqreturn_t dmad_apb_isr(int irq, void *dev_id)
-+{
-+ dmad_drq *drq;
-+ dmad_drb *drb, *drb_iter;
-+ u32 channel = ((u32) dev_id) - 1;
-+ u32 status;
-+ u8 finish_int = 0;
-+ u8 err_int = 0;
-+ u8 cpl_events = 1;
-+
-+ dmad_dbg("%s() >> channel(%d)\n", __func__, channel);
-+
-+ if (channel >= DMAD_APB_MAX_CHANNELS) {
-+ dmad_err("%s() invlaid channel number: %d!\n",
-+ __func__, channel);
-+ return IRQ_HANDLED;
-+ }
-+
-+ /* Lookup channel's DRQ (DMA Request Queue) */
-+ drq = (dmad_drq *) & dmad.apb_drq_pool[channel];
-+
-+ /* - Check DMA status register to get channel number */
-+ status = inl((addr_t) drq->channel_base + APBBR_DMA_CMD_OFFSET);
-+
-+ if (likely(status & APBBR_DMA_FINTST_MASK)) {
-+
-+ /*dmad_dbg("apb dma int status: finish (0x%08x)\n", status); */
-+ finish_int = 1;
-+
-+ /* APB DMA finish int status clear */
-+ clrbl(APBBR_DMA_FINTST_BIT,
-+ (addr_t) drq->channel_base + APBBR_DMA_CMD_OFFSET);
-+
-+ } else if (status & APBBR_DMA_ERRINTST_MASK) {
-+
-+ /* Perform DMA error checking if no valid channel was found
-+ * who assert the finish signal. */
-+ dmad_err("apb dma int status: err (0x%08x)\n", status);
-+
-+ /* Mark as error int */
-+ err_int = 1;
-+
-+ /* APB DMA error int status clear */
-+ clrbl(APBBR_DMA_ERRINTST_BIT,
-+ (addr_t) drq->channel_base + APBBR_DMA_CMD_OFFSET);
-+
-+ } else {
-+
-+ dmad_err("%s() possible false-fired apb dma int,"
-+ " channel %d status-reg: 0x%08x\n",
-+ __func__, channel, status);
-+
-+ /* Stop DMA channel (make sure the channel will be stopped) */
-+ clrbl(APBBR_DMA_CHEN_BIT,
-+ (addr_t) drq->channel_base + APBBR_DMA_CMD_OFFSET);
-+
-+ return IRQ_HANDLED;
-+ }
-+
-+ /* Stop DMA channel (make sure the channel will be stopped) */
-+ dmad_disable_channel(drq);
-+
-+ spin_lock(&drq->drb_pool_lock);
-+
-+ /* Lookup/detach latest submitted DRB (DMA Request Block) from */
-+ /* the DRQ (DMA Request Queue), so ISR could kick off next DRB */
-+ dmad_detach_head(drq->drb_pool, &drq->sbt_head, &drq->sbt_tail, &drb);
-+
-+ if (unlikely(drb == NULL)) {
-+ spin_unlock(&drq->drb_pool_lock);
-+ return IRQ_HANDLED;
-+ }
-+
-+ /* release blocking of drb-allocation, if any ... */
-+ if (unlikely((drq->fre_head == 0) &&
-+ (drq->flags & DMAD_FLAGS_SLEEP_BLOCK))) {
-+ complete_all(&drq->drb_alloc_sync);
-+ }
-+
-+ /* Process DRBs according to the cause of this interrupt */
-+ if (likely(finish_int)) {
-+
-+ if (drb->req_cycle == 0)
-+ cpl_events = 0;
-+
-+ /* Mark DRB state as completed */
-+ drb->state = DMAD_DRB_STATE_COMPLETED;
-+ if (cpl_events && drb->sync)
-+ complete_all(drb->sync);
-+
-+ dmad_attach_tail(drq->drb_pool, &drq->fre_head,
-+ &drq->fre_tail, drb->node);
-+
-+ /* Check whether there are pending requests in the DRQ */
-+ if (drq->sbt_head != 0) {
-+
-+ /* Lookup next DRB (DMA Request Block) */
-+ drb_iter = &drq->drb_pool[drq->sbt_head];
-+
-+ dmad_dbg("exec drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x)\n",
-+ drb_iter->node, (u32) drb_iter,
-+ drb_iter->src_addr, drb_iter->dst_addr,
-+ drb_iter->req_cycle);
-+
-+ /* Kick-off DMA for next DRB */
-+ /* - Source and destination address */
-+ if (drq->flags & DMAD_DRQ_DIR_A1_TO_A0) {
-+ outl(drb_iter->addr1, drq->src_port);
-+ outl(drb_iter->addr0, drq->dst_port);
-+ } else {
-+ outl(drb_iter->addr0, drq->src_port);
-+ outl(drb_iter->addr1, drq->dst_port);
-+ }
-+
-+ /* - Transfer size (in units of source width) */
-+ outl(drb_iter->req_cycle, drq->cyc_port);
-+
-+ /* Kick off next request */
-+ dmad_enable_channel(drq);
-+
-+ drb_iter->state = DMAD_DRB_STATE_EXECUTED;
-+
-+ } else {
-+ /* No pending requests, keep the DMA channel stopped */
-+ }
-+
-+ } else if (err_int) {
-+
-+ dmad_err("%s() apb dma channel %d error!\n", __func__, channel);
-+
-+ /* Zero out src, dst, and size */
-+ outl(0, drq->src_port);
-+ outl(0, drq->dst_port);
-+ outl(0, drq->cyc_port);
-+
-+ /* Remove all pending requests in the queue */
-+ drb_iter = drb;
-+ while (drb_iter) {
-+
-+ dmad_err("abort drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x)\n",
-+ drb_iter->node, (u32) drb_iter,
-+ drb_iter->src_addr, drb_iter->dst_addr,
-+ drb_iter->req_cycle);
-+
-+ if (drb_iter->req_cycle == 0)
-+ cpl_events = 0;
-+
-+ /* Mark DRB state as abort */
-+ drb_iter->state = DMAD_DRB_STATE_ABORT;
-+
-+ if (cpl_events && drb_iter->sync)
-+ complete_all(drb_iter->sync);
-+
-+ dmad_attach_tail(drq->drb_pool, &drq->fre_head,
-+ &drq->fre_tail, drb_iter->node);
-+
-+ dmad_detach_head(drq->drb_pool, &drq->sbt_head,
-+ &drq->sbt_tail, &drb_iter);
-+ }
-+ }
-+
-+ spin_unlock(&drq->drb_pool_lock);
-+
-+ /* dispatch interrupt-context level callbacks */
-+ if (cpl_events && drq->completion_cb) {
-+ /* signal DMA driver that new node is available */
-+ drq->completion_cb(channel, status, drq->completion_data);
-+ }
-+
-+ dmad_dbg("%s() <<\n", __func__);
-+
-+ return IRQ_HANDLED;
-+}
-+
-+/**
-+ * dmad_apb_config_dir - prepare command reg according to tx direction
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @channel_cmds : [out] Reference to array of command words to be prepared with
-+ * @return : none
-+ *
-+ * Prepare command registers according to transfer direction ...
-+ * channel_cmd[0] APBBR_DMA_CMD
-+ *
-+ * This function only serves as local helper. No protection wrappers.
-+ */
-+static void dmad_apb_config_dir(dmad_chreq * ch_req, addr_t * channel_cmds)
-+{
-+ dmad_drq *drq = (dmad_drq *) ch_req->drq;
-+ dmad_apb_chreq *apb_req = (dmad_apb_chreq *) (&ch_req->apb_req);
-+
-+ dmad_dbg("%s() channel_cmd(0x%08x)\n", __func__, channel_cmds[0]);
-+
-+ *channel_cmds &= ~(addr_t)
-+ (APBBR_DMA_SRCADDRINC_MASK | APBBR_DMA_DSTADDRINC_MASK |
-+ APBBR_DMA_DSTADDRSEL_MASK | APBBR_DMA_DREQSEL_MASK |
-+ APBBR_DMA_SRCADDRSEL_MASK | APBBR_DMA_SREQSEL_MASK);
-+
-+ /* 0 - addr0 to addr1; 1 - addr1 to addr0 */
-+ if (apb_req->tx_dir == 0) {
-+
-+ dmad_dbg("%s() addr0 --> addr1\n", __func__);
-+
-+ /* APB Bridge DMA (Channel Setting)
-+ * - CMD
-+ * SRCADR : apb_req->src_ctrl
-+ * DESADR : apb_req->dst_ctrl
-+ */
-+ *channel_cmds |=
-+ (((apb_req->addr0_ctrl << APBBR_DMA_SRCADDRINC_SHIFT) &
-+ APBBR_DMA_SRCADDRINC_MASK) |
-+ ((apb_req->addr1_ctrl << APBBR_DMA_DSTADDRINC_SHIFT) &
-+ APBBR_DMA_DSTADDRINC_MASK));
-+
-+ /* - CMD
-+ * DESADRSEL : AHB/APB, driver auto-conf
-+ * DREQSEL
-+ */
-+ *channel_cmds |=
-+ ((addr_t) (APBBR_DMA_DSTADDRSEL_MASK &
-+ (apb_reqn_route_table[apb_req->addr1_reqn].
-+ bus_sel << APBBR_DMA_DSTADDRSEL_BIT)) |
-+ (((addr_t) apb_req->
-+ addr1_reqn << APBBR_DMA_DREQSEL_SHIFT) &
-+ APBBR_DMA_DREQSEL_MASK));
-+
-+ /* - CMD
-+ * SRCADRSEL : AHB/APB, driver auto-conf
-+ * SREQSEL
-+ */
-+ *channel_cmds |=
-+ ((addr_t) (APBBR_DMA_SRCADDRSEL_MASK &
-+ (apb_reqn_route_table[apb_req->addr0_reqn].
-+ bus_sel << APBBR_DMA_SRCADDRSEL_BIT)) |
-+ (((addr_t) apb_req->
-+ addr0_reqn << APBBR_DMA_SREQSEL_SHIFT) &
-+ APBBR_DMA_SREQSEL_MASK));
-+
-+ drq->flags &= ~(addr_t) DMAD_DRQ_DIR_A1_TO_A0;
-+
-+ } else {
-+
-+ dmad_dbg("%s() addr0 <-- addr1\n", __func__);
-+
-+ /* APB Bridge DMA (Channel Setting)
-+ * - CMD
-+ * SRCADR : apb_req->src_ctrl
-+ * DESADR : apb_req->dst_ctrl
-+ */
-+ *channel_cmds |=
-+ (((apb_req->addr1_ctrl << APBBR_DMA_SRCADDRINC_SHIFT) &
-+ APBBR_DMA_SRCADDRINC_MASK) |
-+ ((apb_req->addr0_ctrl << APBBR_DMA_DSTADDRINC_SHIFT) &
-+ APBBR_DMA_DSTADDRINC_MASK));
-+
-+ /* - CMD
-+ * DESADRSEL : AHB/APB, driver auto-conf
-+ * DREQSEL
-+ */
-+ *channel_cmds |= ((addr_t) (APBBR_DMA_DSTADDRSEL_MASK &
-+ (apb_reqn_route_table
-+ [apb_req->addr0_reqn].
-+ bus_sel <<
-+ APBBR_DMA_DSTADDRSEL_BIT)) |
-+ (((addr_t) apb_req->
-+ addr0_reqn << APBBR_DMA_DREQSEL_SHIFT) &
-+ APBBR_DMA_DREQSEL_MASK));
-+
-+ /* - CMD
-+ * SRCADRSEL : AHB/APB, driver auto-conf
-+ * SREQSEL
-+ */
-+ *channel_cmds |= ((addr_t) (APBBR_DMA_SRCADDRSEL_MASK &
-+ (apb_reqn_route_table
-+ [apb_req->addr1_reqn].
-+ bus_sel <<
-+ APBBR_DMA_SRCADDRSEL_BIT)) |
-+ (((addr_t) apb_req->
-+ addr1_reqn << APBBR_DMA_SREQSEL_SHIFT) &
-+ APBBR_DMA_SREQSEL_MASK));
-+
-+ drq->flags |= (addr_t) DMAD_DRQ_DIR_A1_TO_A0;
-+ }
-+
-+ dmad_dbg("%s() channel_cmd(0x%08x)\n", __func__, channel_cmds[0]);
-+}
-+
-+/**
-+ * dmad_apb_init - initialize a apb dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Register APB DMA ISR and performs hw initialization for the given DMA
-+ * channel.
-+ */
-+static int dmad_apb_init(dmad_chreq * ch_req)
-+{
-+ int err = 0;
-+ dmad_drq *drq = (dmad_drq *) ch_req->drq;
-+ dmad_apb_chreq *apb_req = (dmad_apb_chreq *) (&ch_req->apb_req);
-+ u32 channel = (u32) ch_req->channel;
-+ addr_t channel_cmd = 0;
-+ unsigned long lock_flags;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ /* register interrupt handler */
-+ err = request_irq(apb_irqs[channel], dmad_apb_isr, 0,
-+ "APB_DMA", (void *)(channel + 1));
-+ if (unlikely(err != 0)) {
-+ dmad_err("unable to request IRQ %d for APB DMA (error %d)\n",
-+ apb_irqs[channel], err);
-+ free_irq(apb_irqs[channel], (void *)(channel + 1));
-+ return err;
-+ }
-+
-+ spin_lock_irqsave(&dmad.drq_pool_lock, lock_flags);
-+
-+ /**********************************************************
-+ * Following code require _safe_exit return path
-+ */
-+
-+#ifdef CONFIG_PLAT_AG102
-+
-+ /* PCU
-+ *
-+ */
-+ //ADD by river 2010.10.20
-+ if (unlikely((apb_req->src_reqn > APBBR_REQN_MAX) ||
-+ (apb_req->dst_reqn > APBBR_REQN_MAX))) {
-+ dmad_err("Invalid source reqn(%d) or destination reqn(%d)\n",
-+ apb_req->src_reqn, apb_req->dst_reqn);
-+ err = -EBADR;
-+ goto _safe_exit;
-+ }
-+
-+ if (apb_req->src_reqn != APBBR_REQN_NONE) {
-+ u32 ahb_reqn;
-+
-+ if (apb_req->tx_dir == DMAD_DIR_A0_TO_A1)
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->src_reqn].ahb_reqn_tx;
-+ else
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->src_reqn].ahb_reqn_rx;
-+
-+ }
-+
-+ if (apb_req->dst_reqn != APBBR_REQN_NONE) {
-+ u32 ahb_reqn;
-+
-+ if (apb_req->tx_dir == DMAD_DIR_A0_TO_A1)
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->dst_reqn].ahb_reqn_tx;
-+ else
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->dst_reqn].ahb_reqn_rx;
-+
-+ }
-+ //End ADD by river 2010.10.20
-+
-+#else /* CONFIG_PLAT_AG102 */
-+
-+ /* PMU
-+ * - Undo APB device DMA to AHB DMAC channel routing. (connection status
-+ * is obtained from reading back the PMU_AHBDMA_REQACK register)
-+ */
-+ if (unlikely((apb_req->src_reqn > APBBR_REQN_MAX) ||
-+ (apb_req->dst_reqn > APBBR_REQN_MAX))) {
-+ dmad_err("Invalid source reqn(%d) or destination reqn(%d)\n",
-+ apb_req->src_reqn, apb_req->dst_reqn);
-+ err = -EBADR;
-+ goto _safe_exit;
-+ }
-+
-+ if (apb_req->src_reqn != APBBR_REQN_NONE) {
-+ u32 ahb_reqn;
-+
-+ if (apb_req->tx_dir == DMAD_DIR_A0_TO_A1)
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->src_reqn].ahb_reqn_tx;
-+ else
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->src_reqn].ahb_reqn_rx;
-+
-+ outl(0, ahb_ch_route_table[ahb_reqn].clear_cr);
-+ outl(0, ahb_ch_route_table[ahb_reqn].route_cr);
-+ outl(0, ahb_ch_route_table[ahb_reqn].clear_cr);
-+ outl(0, ahb_ch_route_table[ahb_reqn].route_cr);
-+ }
-+
-+ if (apb_req->dst_reqn != APBBR_REQN_NONE) {
-+ u32 ahb_reqn;
-+
-+ if (apb_req->tx_dir == DMAD_DIR_A0_TO_A1)
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->dst_reqn].ahb_reqn_tx;
-+ else
-+ ahb_reqn =
-+ apb_reqn_route_table[apb_req->dst_reqn].ahb_reqn_rx;
-+
-+ outl(0, ahb_ch_route_table[ahb_reqn].clear_cr);
-+ outl(0, ahb_ch_route_table[ahb_reqn].route_cr);
-+ outl(0, ahb_ch_route_table[ahb_reqn].clear_cr);
-+ outl(0, ahb_ch_route_table[ahb_reqn].route_cr);
-+ }
-+#endif /* CONFIG_PLAT_AG102 */
-+
-+ /* APB Bridge DMA (Channel Setting)
-+ * - CMD
-+ * ENBDIS : 0 (disable for now)
-+ * FININTSTS : 0 (clear finishing interrupt status)
-+ * FININTENB : 1 (enable finishing interrupt)
-+ * BURMOD : apb_req->burst_mode
-+ * ERRINTSTS : 0 (clear error interrupt status)
-+ * ERRINTENB : 1 (enable error interrupt)
-+ * SRCADRSEL : AHB/APB, driver auto-conf
-+ * DESADRSEL : AHB/APB, driver auto-conf
-+ * SRCADR : apb_req->src_ctrl
-+ * DESADR : apb_req->dst_ctrl
-+ * REQSEL : apb_req->src_reqn
-+ * DATAWIDTH : apb_req->data_width
-+ */
-+
-+ /* - CMD
-+ * ENBDIS
-+ * FININTSTS
-+ * FININTENB
-+ * BURMOD
-+ * ERRINTSTS
-+ * ERRINTENB
-+ * DATAWIDTH
-+ */
-+ channel_cmd =
-+ ((addr_t) APBBR_DMA_FINTEN_MASK | APBBR_DMA_ERRINTEN_MASK |
-+ ((apb_req->
-+ burst_mode << APBBR_DMA_BURST_BIT) & APBBR_DMA_BURST_MASK) |
-+ ((apb_req->
-+ data_width << APBBR_DMA_DATAWIDTH_SHIFT) &
-+ APBBR_DMA_DATAWIDTH_MASK));
-+
-+ /* - CMD
-+ * SRCADRSEL
-+ * DESADRSEL
-+ * SRCADR
-+ * DESADR
-+ * REQSEL
-+ */
-+ if (0 ==
-+ (ch_req->flags & (DMAD_FLAGS_RING_MODE | DMAD_FLAGS_BIDIRECTION)))
-+ apb_req->tx_dir = 0;
-+ dmad_apb_config_dir(ch_req, &channel_cmd);
-+
-+ /* - CMD outport */
-+ outl(channel_cmd, (addr_t) drq->channel_base + APBBR_DMA_CMD_OFFSET);
-+
-+ /* SRCADR and DESADR */
-+ outl(0, (addr_t) drq->src_port);
-+ outl(0, (addr_t) drq->dst_port);
-+
-+ /* CYC (transfer size) */
-+ outl(0, (addr_t) drq->cyc_port);
-+
-+ /* keep channel data width for faster cycle/byte size conversion */
-+ drq->data_width = apb_req->data_width;
-+
-+_safe_exit:
-+
-+ spin_unlock_irqrestore(&dmad.drq_pool_lock, lock_flags);
-+
-+ return err;
-+}
-+
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+/**
-+ * dmad_channel_init - initialize given dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * This function serves as the abstraction layer of dmad_ahb_init()
-+ * and dmad_apb_init() functions.
-+ */
-+static int dmad_channel_init(dmad_chreq * ch_req)
-+{
-+ int err = 0;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL))
-+ return -EFAULT;
-+
-+ if (unlikely(ch_req->drq == NULL))
-+ return -EBADR;
-+
-+ /* Initialize DMA controller */
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE)
-+ err = dmad_ahb_init(ch_req);
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE)
-+ err = dmad_apb_init(ch_req);
-+#endif
-+
-+ return err;
-+}
-+
-+static inline void dmad_reset_channel(dmad_drq * drq)
-+{
-+ /* disable dma controller */
-+ dmad_disable_channel(drq);
-+
-+ /* Source and destination address */
-+ outl(0, drq->src_port);
-+ outl(0, drq->dst_port);
-+
-+ /* Transfer size (in units of source width) */
-+ outl(0, drq->cyc_port);
-+}
-+
-+/**
-+ * dmad_channel_reset - reset given dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * This function serves as the abstraction layer of dmad_ahb_reset()
-+ * and dmad_apb_reset() functions.
-+ */
-+static int dmad_channel_reset(dmad_chreq * ch_req)
-+{
-+ u32 channel = (u32) ch_req->channel;
-+ unsigned long lock_flags;
-+ int err = 0;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL))
-+ return -EFAULT;
-+
-+ if (unlikely(ch_req->drq == NULL))
-+ return -EBADR;
-+
-+ spin_lock_irqsave(&((dmad_drq *) ch_req->drq)->drb_pool_lock,
-+ lock_flags);
-+
-+ /* stop DMA channel */
-+ dmad_reset_channel((dmad_drq *) ch_req->drq);
-+
-+ spin_unlock_irqrestore(&((dmad_drq *) ch_req->drq)->drb_pool_lock,
-+ lock_flags);
-+
-+ /* unregister interrupt handler */
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE)
-+ free_irq(ahb_irqs[channel], (void *)(channel + 1));
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE)
-+ free_irq(apb_irqs[channel], (void *)(channel + 1));
-+#endif
-+
-+ return err;
-+}
-+
-+/**
-+ * dmad_channel_alloc - allocates and initialize a dma channel
-+ * @ch_req : [in/out] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * This function allocates a DMA channel according to client's request
-+ * parameters. ISR and HW state will also be initialized accordingly.
-+ */
-+int dmad_channel_alloc(dmad_chreq * ch_req)
-+{
-+ dmad_drq *drq_iter = NULL;
-+ dmad_drb *drb_iter;
-+ int err = 0;
-+ u32 i = 0;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (ch_req == NULL) {
-+ printk(KERN_ERR "%s() invalid argument!\n", __func__);
-+ return -EFAULT;
-+ }
-+
-+ spin_lock(&dmad.drq_pool_lock);
-+
-+ /* locate an available DMA channel */
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE) {
-+
-+ drq_iter = dmad.ahb_drq_pool;
-+
-+ if ((ch_req->ahb_req.src_reqn != DMAC_REQN_NONE) ||
-+ (ch_req->ahb_req.dst_reqn != DMAC_REQN_NONE)) {
-+ /* [2007-12-03] It looks current board have problem to
-+ * do dma traffic for APB devices on DMAC channel 0/1.
-+ * Redirect all APB devices to start from channel 2.
-+ */
-+
-+ /* [todo] include USB controller ? */
-+ drq_iter = &dmad.ahb_drq_pool[2];
-+ for (i = 2; i < DMAD_AHB_MAX_CHANNELS; ++i, ++drq_iter) {
-+ if (!(drq_iter->state & DMAD_DRQ_STATE_READY))
-+ break;
-+ }
-+ } else {
-+ /* channel for other devices is free to allocate */
-+ for (i = 0; i < DMAD_AHB_MAX_CHANNELS; ++i, ++drq_iter) {
-+ if (!(drq_iter->state & DMAD_DRQ_STATE_READY))
-+ break;
-+ }
-+ }
-+
-+ if (unlikely(i == DMAD_AHB_MAX_CHANNELS)) {
-+ spin_unlock(&dmad.drq_pool_lock);
-+ dmad_err("out of available channels (AHB DMAC)!\n");
-+ return -ENOSPC;
-+ }
-+
-+ dmad_dbg("allocated channel: %d (AHB DMAC)\n", i);
-+
-+ }
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE) {
-+
-+ drq_iter = dmad.apb_drq_pool;
-+
-+ for (i = 0; i < DMAD_APB_MAX_CHANNELS; ++i, ++drq_iter) {
-+ if ((drq_iter->state & DMAD_DRQ_STATE_READY) == 0)
-+ break;
-+ }
-+
-+ if (unlikely(i == DMAD_APB_MAX_CHANNELS)) {
-+ spin_unlock(&dmad.drq_pool_lock);
-+ dmad_err("out of available channels (APB DMAC)!\n");
-+ return -ENOSPC;
-+ }
-+
-+ dmad_dbg("allocated channel: %d (APB DMAC)\n", i);
-+ }
-+#endif
-+ if (drq_iter == NULL) {
-+ spin_unlock(&dmad.drq_pool_lock);
-+ printk(KERN_ERR "%s() invalid argument!\n", __func__);
-+ return -EFAULT;
-+ }
-+
-+ spin_unlock(&dmad.drq_pool_lock);
-+ memset(drq_iter, 0, sizeof(dmad_drq));
-+
-+ /* Initialize DMA channel's DRB pool as list of free DRBs */
-+ drq_iter->drb_pool =
-+ kmalloc(DMAD_DRB_POOL_SIZE * sizeof(dmad_drb), GFP_ATOMIC);
-+
-+ if (drq_iter->drb_pool == NULL) {
-+ printk(KERN_ERR "%s() failed to allocate drb pool!\n",
-+ __func__);
-+ return -ENOMEM;
-+ }
-+
-+ /* Allocate the DMA channel */
-+ drq_iter->state = DMAD_DRQ_STATE_READY;
-+ drq_iter->flags = ch_req->flags;
-+
-+ /* Initialize synchronization object for DMA queue access control */
-+ spin_lock_init(&drq_iter->drb_pool_lock);
-+
-+ /* Initialize synchronization object for free drb notification */
-+ init_completion(&drq_iter->drb_alloc_sync);
-+
-+ /* Record the channel number in client's struct */
-+ ch_req->channel = i;
-+
-+ /* Record the channel's queue handle in client's struct */
-+ ch_req->drq = drq_iter;
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE) {
-+ drq_iter->channel_base = (addr_t) DMAC_BASE_CH(i);
-+ drq_iter->enable_port =
-+ (addr_t) drq_iter->channel_base + DMAC_CSR_OFFSET;
-+ drq_iter->src_port =
-+ (addr_t) drq_iter->channel_base + DMAC_SRC_ADDR_OFFSET;
-+ drq_iter->dst_port =
-+ (addr_t) drq_iter->channel_base + DMAC_DST_ADDR_OFFSET;
-+ drq_iter->cyc_port =
-+ (addr_t) drq_iter->channel_base + DMAC_SIZE_OFFSET;
-+ }
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE) {
-+ drq_iter->channel_base = (addr_t) APBBR_DMA_BASE_CH(i);
-+ drq_iter->enable_port =
-+ (addr_t) drq_iter->channel_base + APBBR_DMA_CMD_OFFSET;
-+ drq_iter->src_port =
-+ (addr_t) drq_iter->channel_base + APBBR_DMA_SAD_OFFSET;
-+ drq_iter->dst_port =
-+ (addr_t) drq_iter->channel_base + APBBR_DMA_DAD_OFFSET;
-+ drq_iter->cyc_port =
-+ (addr_t) drq_iter->channel_base + APBBR_DMA_CYC_OFFSET;
-+ }
-+#endif
-+ /* drb-0 is an invalid node - for node validation */
-+ drb_iter = &drq_iter->drb_pool[0];
-+ drb_iter->prev = 0;
-+ drb_iter->next = 0;
-+ drb_iter->node = 0;
-+ ++drb_iter;
-+
-+ /* init other drbs - link in order */
-+ for (i = 1; i < DMAD_DRB_POOL_SIZE; ++i, ++drb_iter) {
-+ drb_iter->prev = i - 1;
-+ drb_iter->next = i + 1;
-+ drb_iter->node = i;
-+ }
-+ drq_iter->drb_pool[DMAD_DRB_POOL_SIZE - 1].next = 0;
-+
-+ /* Initialize channel's DRB free-list, ready-list, and submitted-list */
-+ drq_iter->fre_head = 1;
-+ drq_iter->fre_tail = DMAD_DRB_POOL_SIZE - 1;
-+ drq_iter->rdy_head = drq_iter->rdy_tail = 0;
-+ drq_iter->sbt_head = drq_iter->sbt_tail = 0;
-+
-+ /* initialize ring buffer mode resources */
-+ if (ch_req->flags & DMAD_FLAGS_RING_MODE) {
-+
-+ int remnant = (int)ch_req->ring_size -
-+ (int)ch_req->periods * (int)ch_req->period_size;
-+ if (remnant == 0) {
-+ drq_iter->periods = ch_req->periods;
-+ } else if (remnant > 0) {
-+ drq_iter->periods = ch_req->periods; // + 1;
-+ } else {
-+ dmad_err("%s() Error - buffer_size < "
-+ "periods * period_size!\n", __func__);
-+ err = -EFAULT;
-+ goto _err_exit;
-+ }
-+
-+ drq_iter->ring_size = ch_req->ring_size;
-+ drq_iter->period_size = ch_req->period_size;
-+ drq_iter->remnant_size = (dma_addr_t) remnant;
-+
-+ drq_iter->ring_base = (dma_addr_t) ch_req->ring_base;
-+ drq_iter->dev_addr = (dma_addr_t) ch_req->dev_addr;
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE) {
-+ if ((ch_req->ahb_req.ring_ctrl == DMAC_CSR_AD_DEC) ||
-+ (ch_req->ahb_req.dev_ctrl == DMAC_CSR_AD_DEC)) {
-+ dmad_err("%s() Error - decremental"
-+ " addressing DMA is not supported in"
-+ " ring mode currently!\n", __func__);
-+ err = -EFAULT;
-+ goto _err_exit;
-+ }
-+
-+ if (ch_req->ahb_req.ring_ctrl == DMAC_CSR_AD_FIX) {
-+ dmad_err("%s() Error - ring address control is "
-+ "fixed in ring DMA mode!\n", __func__);
-+ err = -EFAULT;
-+ goto _err_exit;
-+ }
-+
-+ drq_iter->period_bytes =
-+ DMAC_CYCLE_TO_BYTES(ch_req->period_size,
-+ ch_req->ahb_req.ring_width);
-+
-+ /* 0 - addr0 to addr1; 1 - addr1 to addr0 */
-+ if (ch_req->ahb_req.tx_dir == 0)
-+ drq_iter->ring_port =
-+ (addr_t) drq_iter->src_port;
-+ else
-+ drq_iter->ring_port =
-+ (addr_t) drq_iter->dst_port;
-+
-+ }
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE) {
-+
-+ if ((ch_req->apb_req.ring_ctrl >= APBBR_ADDRINC_D1) ||
-+ (ch_req->apb_req.dev_ctrl >= APBBR_ADDRINC_D1)) {
-+ dmad_err("%s() Error - decremental"
-+ " addressing DMA is not supported in"
-+ " ring mode currently!\n", __func__);
-+ err = -EFAULT;
-+ goto _err_exit;
-+ }
-+
-+ if (ch_req->apb_req.ring_ctrl == APBBR_ADDRINC_FIXED) {
-+ dmad_err("%s() Error - ring address control is "
-+ "fixed in ring DMA mode!\n", __func__);
-+ err = -EFAULT;
-+ goto _err_exit;
-+ }
-+
-+ drq_iter->period_bytes =
-+ APBBR_DMA_CYCLE_TO_BYTES(ch_req->period_size,
-+ ch_req->apb_req.
-+ data_width);
-+
-+ /* 0 - addr0 to addr1; 1 - addr1 to addr0 */
-+ if (ch_req->apb_req.tx_dir == 0)
-+ drq_iter->ring_port =
-+ (addr_t) drq_iter->src_port;
-+ else
-+ drq_iter->ring_port =
-+ (addr_t) drq_iter->dst_port;
-+ }
-+#endif
-+ dmad_dbg("%s() ring: base(0x%08x) port(0x%08x) periods(0x%08x)"
-+ " period_size(0x%08x) period_bytes(0x%08x)"
-+ " remnant_size(0x%08x)\n",
-+ __func__, drq_iter->ring_base, drq_iter->ring_port,
-+ drq_iter->periods, drq_iter->period_size,
-+ drq_iter->period_bytes, drq_iter->remnant_size);
-+ }
-+
-+ drq_iter->completion_cb = ch_req->completion_cb;
-+ drq_iter->completion_data = ch_req->completion_data;
-+
-+ /* Initialize the channel && register isr */
-+ err = dmad_channel_init(ch_req);
-+
-+_err_exit:
-+
-+ if (err != 0) {
-+ spin_lock(&dmad.drq_pool_lock);
-+
-+ kfree(drq_iter->drb_pool);
-+ memset(drq_iter, 0, sizeof(dmad_drq));
-+
-+ ch_req->channel = -1;
-+ ch_req->drq = (void *)0;
-+
-+ spin_unlock(&dmad.drq_pool_lock);
-+
-+ dmad_err("Failed to initialize APB DMA! "
-+ "Channel allocation aborted!\n");
-+ }
-+
-+ return err;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_channel_alloc);
-+
-+/**
-+ * dmad_channel_free - release a dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * This function releases a DMA channel. The channel is available for future
-+ * allocation after the invokation.
-+ */
-+int dmad_channel_free(dmad_chreq * ch_req)
-+{
-+ dmad_drq *drq;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL)) {
-+ dmad_err("null ch_req!\n");
-+ return -EFAULT;
-+ }
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (unlikely(drq == NULL)) {
-+ dmad_err("null ch_req->drq!\n");
-+ return -EBADR;
-+ }
-+ if (unlikely((ch_req->channel < 0) ||
-+ ((drq->state & DMAD_DRQ_STATE_READY) == 0))) {
-+ dmad_err("try to free a free channel!\n");
-+ return -EBADR;
-+ }
-+
-+ /* Stop/abort channel I/O
-+ * (forced to shutdown and should be protected against isr)
-+ */
-+ dmad_drain_requests(ch_req, 1);
-+ dmad_channel_reset(ch_req);
-+
-+ dmad_dbg("freed channel: %d\n", ch_req->channel);
-+
-+ spin_lock(&dmad.drq_pool_lock);
-+
-+ kfree(drq->drb_pool);
-+ memset(drq, 0, sizeof(dmad_drq));
-+
-+ ch_req->drq = 0;
-+ ch_req->channel = (u32) - 1;
-+
-+ spin_unlock(&dmad.drq_pool_lock);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_channel_free);
-+
-+/**
-+ * dmad_channel_enable - enable/disable a dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @enable : [in] 1 to enable the channel, 0 to disable
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Enable or disable the given DMA channel.
-+ */
-+int dmad_channel_enable(const dmad_chreq * ch_req, u8 enable)
-+{
-+ dmad_drq *drq;
-+ unsigned long lock_flags;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL))
-+ return -EFAULT;
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (unlikely(drq == NULL))
-+ return -EBADR;
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ /* Enable/disable DMA channel */
-+ if (enable)
-+ dmad_enable_channel(drq);
-+ else
-+ dmad_disable_channel(drq);
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_channel_enable);
-+
-+/**
-+ * dmad_config_channel_dir - config dma channel transfer direction
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @dir : [in] DMAD_DRQ_DIR_A0_TO_A1 or DMAD_DRQ_DIR_A1_TO_A0
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Reconfigure the channel transfer direction. This function works only if
-+ * the channel was allocated with the DMAD_FLAGS_BIDIRECTION flags. Note
-+ * that bi-direction mode and ring mode are mutual-exclusive from user's
-+ * perspective.
-+ */
-+int dmad_config_channel_dir(dmad_chreq * ch_req, u8 dir)
-+{
-+ dmad_drq *drq;
-+ addr_t channel_cmds[2];
-+ unsigned long lock_flags;
-+ u8 cur_dir;
-+
-+ if (unlikely(ch_req == NULL))
-+ return -EFAULT;
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (unlikely(drq == NULL))
-+ return -EBADR;
-+
-+ if (unlikely(!(ch_req->flags & DMAD_FLAGS_BIDIRECTION))) {
-+ dmad_err("%s() Channel is not configured as"
-+ " bidirectional!\n", __func__);
-+ return -EFAULT;
-+ }
-+
-+ cur_dir = drq->flags & DMAD_DRQ_DIR_MASK;
-+ if (dir == cur_dir) {
-+ dmad_dbg("%s() cur_dir(%d) == dir(%d) skip reprogramming hw.\n",
-+ __func__, cur_dir, dir);
-+ return 0;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ if (unlikely((drq->sbt_head != 0) /*||dmad_is_channel_enabled(drq) */ )) {
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ dmad_err("%s() Cannot change direction while the "
-+ "channel has pending requests!\n", __func__);
-+ return -EFAULT;
-+ }
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE) {
-+
-+ channel_cmds[0] =
-+ inl((addr_t) drq->channel_base + DMAC_CSR_OFFSET);
-+ channel_cmds[1] =
-+ inl((addr_t) drq->channel_base + DMAC_CFG_OFFSET);
-+
-+ ch_req->ahb_req.tx_dir = dir;
-+ dmad_ahb_config_dir(ch_req, channel_cmds);
-+
-+ outl(channel_cmds[1],
-+ (addr_t) drq->channel_base + DMAC_CFG_OFFSET);
-+ outl(channel_cmds[0],
-+ (addr_t) drq->channel_base + DMAC_CSR_OFFSET);
-+
-+ }
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE) {
-+
-+ channel_cmds[0] =
-+ inl((addr_t) drq->channel_base + APBBR_DMA_CMD_OFFSET);
-+
-+ ch_req->apb_req.tx_dir = dir;
-+ dmad_apb_config_dir(ch_req, channel_cmds);
-+
-+ outl(channel_cmds[0],
-+ (addr_t) drq->channel_base + APBBR_DMA_CMD_OFFSET);
-+ }
-+#endif
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_config_channel_dir);
-+
-+/**
-+ * dmad_max_size_per_drb - return maximum transfer size per drb
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : The maximum transfer size per drb, in bytes.
-+ *
-+ * Calculate the maximum transfer size per drb according to the setting of
-+ * data width during channel initialization.
-+ *
-+ * Return size is aligned to 4-byte boundary; this ensures the alignment
-+ * requirement of dma starting address if the function was used in a loop to
-+ * separate a large size dma transfer.
-+ */
-+u32 dmad_max_size_per_drb(dmad_chreq * ch_req)
-+{
-+ addr_t size = 0;
-+ addr_t data_width = (addr_t) ((dmad_drq *) ch_req->drq)->data_width;
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE) {
-+ size = DMAC_CYCLE_TO_BYTES(DMAC_TOT_SIZE_MASK & ((addr_t) ~ 3),
-+ data_width);
-+ }
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE) {
-+ size =
-+ APBBR_DMA_CYCLE_TO_BYTES(APBBR_DMA_CYC_MASK &
-+ ((addr_t) ~ 3), data_width);
-+ }
-+#endif
-+ dmad_dbg("%s() - 0x%08x bytes\n", __func__, size);
-+
-+ return size;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_max_size_per_drb);
-+
-+/**
-+ * dmad_bytes_to_cycles - calculate drb transfer size, in cycles
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @byte_size : [in] The DMA transfer size to be converted, in bytes
-+ * @return : The drb transfer size, in cycles.
-+ *
-+ * Calculate the drb transfer cycle according to the setting of channel data
-+ * width and burst setting.
-+ *
-+ * AHB DMA : unit is number of "data width".
-+ * APB DMA : unit is number of "data width * burst size"
-+ *
-+ * APB Note: According to specification, decrement addressing seems to regard
-+ * the burst size setting. For code efficiency,
-+ * dmad_make_req_cycles() does not take care of this case and might
-+ * produce wrong result.
-+ */
-+u32 dmad_bytes_to_cycles(dmad_chreq * ch_req, u32 byte_size)
-+{
-+ addr_t cycle = 0;
-+ addr_t data_width = (addr_t) ((dmad_drq *) ch_req->drq)->data_width;
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE) {
-+ cycle = DMAC_BYTES_TO_CYCLE(byte_size, data_width);
-+ }
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE) {
-+ cycle = APBBR_DMA_BYTES_TO_CYCLE(byte_size, data_width);
-+ if (ch_req->apb_req.burst_mode)
-+ cycle = cycle >> 2;
-+ }
-+#endif
-+
-+ dmad_dbg("%s() - 0x%08x bytes --> 0x%08x cycles\n",
-+ __func__, byte_size, cycle);
-+
-+ return cycle;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_bytes_to_cycles);
-+
-+/**
-+ * dmad_alloc_drb_internal - allocate a dma-request-block of a dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @drb : [out] Reference to a drb pointer to receive the allocated drb
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Allocates a DRB (DMA request block) of the given DMA channel. DRB is a
-+ * single dma request which will be pushed into the submission queue of the
-+ * given DMA channel. This is a lightweight internal version of
-+ * dmad_alloc_drb() majorly for use in ring mode. Critical access to the
-+ * drb pool should be protected before entering this function.
-+ */
-+static inline int dmad_alloc_drb_internal(dmad_drq * drq, dmad_drb ** drb)
-+{
-+ /* Initialize drb ptr in case of fail allocation */
-+ *drb = NULL;
-+
-+ if (unlikely(drq->fre_head == 0)) {
-+ return -EAGAIN;
-+ }
-+
-+ dmad_detach_head(drq->drb_pool, &drq->fre_head, &drq->fre_tail, drb);
-+
-+ dmad_attach_tail(drq->drb_pool,
-+ &drq->rdy_head, &drq->rdy_tail, (*drb)->node);
-+
-+ (*drb)->state = DMAD_DRB_STATE_READY;
-+ (*drb)->sync = 0;
-+
-+ dmad_dbg("%s() drb(%d 0x%08x)\n", __func__, (*drb)->node, (u32) (*drb));
-+
-+ return 0;
-+}
-+
-+/**
-+ * dmad_alloc_drb - allocate a dma-request-block of a dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @drb : [out] Reference to a drb pointer to receive the allocated drb
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Allocates a DRB (DMA request block) of the given DMA channel. DRB is a
-+ * single dma request which will be pushed into the submission queue of the
-+ * given DMA channel.
-+ */
-+int dmad_alloc_drb(dmad_chreq * ch_req, dmad_drb ** drb)
-+{
-+ dmad_drq *drq;
-+ unsigned long lock_flags;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL)) {
-+ dmad_err("null ch_req!\n");
-+ return -EFAULT;
-+ }
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (likely(drq == NULL)) {
-+ dmad_err("null ch_req->drq!\n");
-+ return -EBADR;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ /* Initialize drb ptr in case of fail allocation */
-+ *drb = NULL;
-+
-+ if (unlikely(drq->fre_head == 0)) {
-+
-+ drq->state &= (u32) ~ DMAD_DRQ_STATE_ABORT;
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+_wait_for_free_drbs:
-+
-+ /* Wait for free urbs */
-+ if (drq->flags & DMAD_FLAGS_SLEEP_BLOCK) {
-+
-+ int timeout =
-+ wait_for_completion_interruptible_timeout(&drq->
-+ drb_alloc_sync,
-+ msecs_to_jiffies
-+ (6000));
-+
-+ /* reset sync object */
-+ INIT_COMPLETION(drq->drb_alloc_sync);
-+
-+ if (timeout < 0) {
-+ dmad_err("%s() wait for"
-+ " completion error! (%d)\n",
-+ __func__, timeout);
-+ return timeout;
-+ }
-+
-+ } else if (drq->flags & DMAD_FLAGS_SPIN_BLOCK) {
-+
-+ u32 timeout = 0x00ffffff;
-+
-+ while ((drq->fre_head == 0) && (--timeout != 0)) {
-+ }
-+ if (timeout == 0) {
-+ dmad_err("%s() polling wait for "
-+ "completion timeout!\n", __func__);
-+ return -EAGAIN;
-+ }
-+
-+ } else {
-+ return -EAGAIN;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ /* check whether all the requests of the channel has been
-+ * abandoned or not */
-+ if (unlikely(drq->state & DMAD_DRQ_STATE_ABORT)) {
-+ dmad_dbg("%s() drb-allocation aborted due"
-+ " to cancel-request ...\n", __func__);
-+ drq->state &= (u32) ~ DMAD_DRQ_STATE_ABORT;
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return -ECANCELED;
-+ }
-+
-+ /* check again to avoid non-atomic operation between above
-+ * two calls */
-+ if (unlikely(drq->fre_head == 0)) {
-+ dmad_dbg("%s() lost free drbs ... "
-+ "continue waiting ...\n", __func__);
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ goto _wait_for_free_drbs;
-+ }
-+ }
-+
-+ dmad_detach_head(drq->drb_pool, &drq->fre_head, &drq->fre_tail, drb);
-+
-+ dmad_attach_tail(drq->drb_pool,
-+ &drq->rdy_head, &drq->rdy_tail, (*drb)->node);
-+
-+ (*drb)->state = DMAD_DRB_STATE_READY;
-+ (*drb)->sync = 0;
-+
-+ dmad_dbg("%s() drb(%d 0x%08x)\n", __func__, (*drb)->node, (u32) (*drb));
-+
-+ drq->state &= (u32) ~ DMAD_DRQ_STATE_ABORT;
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_alloc_drb);
-+
-+/**
-+ * dmad_free_drb - free a dma-request-block of a dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @drb : [in] Reference to a drb to be freed
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Frees a DRB (DMA request block) of the given DMA channel. DRB is a
-+ * single dma request which will be pushed into the submission queue of the
-+ * given DMA channel.
-+ */
-+int dmad_free_drb(dmad_chreq * ch_req, dmad_drb * drb)
-+{
-+ dmad_drq *drq;
-+ unsigned long lock_flags;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL)) {
-+ dmad_err("null ch_req!\n");
-+ return -EFAULT;
-+ }
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (unlikely(drq == NULL)) {
-+ dmad_err("null ch_req->drq!\n");
-+ return -EBADR;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ /****************************************************
-+ * Following code requires _safe_exit return path
-+ */
-+
-+ if (unlikely((drq->rdy_head == 0) || (drb->node == 0) ||
-+ (drb->state != DMAD_DRB_STATE_READY) ||
-+ (drb->node >= DMAD_DRB_POOL_SIZE))) {
-+ dmad_err("Ready-queue is empty or invalid node!\n");
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return -EBADR;
-+ }
-+
-+ dmad_detach_node(drq->drb_pool,
-+ &drq->rdy_head, &drq->rdy_tail, drb->node);
-+ dmad_attach_tail(drq->drb_pool,
-+ &drq->fre_head, &drq->fre_tail, drb->node);
-+
-+ drb->state = DMAD_DRB_STATE_FREE;
-+ drb->sync = 0;
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_free_drb);
-+
-+/**
-+ * dmad_submit_request_internal - submit a dma-request-block to the dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @drb : [in] Reference to a drb to be submitted
-+ * @keep_fired : [in] non-zero to kickoff dma even the channel has stopped due
-+ * to finishing its previous request
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Submit a DRB (DMA request block) of the given DMA channel to submission
-+ * queue. DRB is a single dma request which will be pushed into the
-+ * submission queue of the given DMA channel. This is a lightweight internal
-+ * version of dmad_alloc_drb() majorly for use in ring mode. Critical access to
-+ * the drb pool should be protected before entering this function.
-+ */
-+static inline int dmad_submit_request_internal(dmad_drq * drq, dmad_drb * drb)
-+{
-+ if (drb->state == DMAD_DRB_STATE_READY) {
-+ /* Detach user node from ready list */
-+ dmad_detach_node(drq->drb_pool,
-+ &drq->rdy_head, &drq->rdy_tail, drb->node);
-+
-+ dmad_attach_tail(drq->drb_pool,
-+ &drq->sbt_head, &drq->sbt_tail, drb->node);
-+
-+ drb->state = DMAD_DRB_STATE_SUBMITTED;
-+
-+ dmad_dbg("%s() submit drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x) state(%d)\n", __func__,
-+ drb->node, (u32) drb, drb->src_addr, drb->dst_addr,
-+ drb->req_cycle, drb->state);
-+ } else {
-+ dmad_dbg("%s() skip drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x)"
-+ " size(0x%08x) state(%d)\n", __func__,
-+ drb->node, (u32) drb, drb->src_addr, drb->dst_addr,
-+ drb->req_cycle, drb->state);
-+ }
-+
-+ return 0;
-+}
-+
-+/**
-+ * dmad_submit_request - submit a dma-request-block to the dma channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @drb : [in] Reference to a drb to be submitted
-+ * @keep_fired : [in] non-zero to kickoff dma even the channel has stopped due
-+ * to finishing its previous request
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Submit a DRB (DMA request block) of the given DMA channel to submission
-+ * queue. DRB is a single dma request which will be pushed into the
-+ * submission queue of the given DMA channel.
-+ */
-+int dmad_submit_request(dmad_chreq * ch_req, dmad_drb * drb, u8 keep_fired)
-+{
-+ dmad_drq *drq;
-+ unsigned long lock_flags;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL)) {
-+ dmad_err("null ch_req!\n");
-+ return -EFAULT;
-+ }
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (unlikely(drq == NULL)) {
-+ dmad_err("null ch_req->drq!\n");
-+ return -EBADR;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ /******************************************************
-+ * Following code require _safe_exit return path
-+ */
-+
-+ if (unlikely((drq->rdy_head == 0) || (drb->node == 0) ||
-+ (drb->node >= DMAD_DRB_POOL_SIZE))) {
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return -EBADR;
-+ }
-+
-+ /* Detach user node from ready list */
-+ dmad_detach_node(drq->drb_pool, &drq->rdy_head, &drq->rdy_tail,
-+ drb->node);
-+
-+ /* Queue DRB to the end of the submitted list */
-+ dmad_dbg("submit drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) sync(0x%08x) fire(%d)\n",
-+ drb->node, (u32) drb, drb->src_addr, drb->dst_addr,
-+ drb->req_cycle, (u32) drb->sync, keep_fired);
-+
-+ /* Check if submission is performed to an empty queue */
-+ if (unlikely(keep_fired && (drq->sbt_head == 0))) {
-+ /* DMA is not running, so kick off transmission */
-+ dmad_dbg("kickoff dma engine.\n");
-+
-+ dmad_attach_tail(drq->drb_pool,
-+ &drq->sbt_head, &drq->sbt_tail, drb->node);
-+
-+ /* Source and destination address */
-+ if (drq->flags & DMAD_DRQ_DIR_A1_TO_A0) {
-+ outl(drb->addr1, (addr_t) drq->src_port);
-+ outl(drb->addr0, (addr_t) drq->dst_port);
-+ } else {
-+ outl(drb->addr0, (addr_t) drq->src_port);
-+ outl(drb->addr1, (addr_t) drq->dst_port);
-+ }
-+
-+ /* Transfer size (in units of source width) */
-+ outl(drb->req_cycle, (addr_t) drq->cyc_port);
-+
-+ /* Enable DMA channel (Kick off transmission when client
-+ * enable it's transfer state) */
-+ dmad_enable_channel(drq);
-+
-+ drb->state = DMAD_DRB_STATE_EXECUTED;
-+
-+ } else {
-+ /* DMA is already running, so only queue DRB to the end of the
-+ * list */
-+ dmad_attach_tail(drq->drb_pool,
-+ &drq->sbt_head, &drq->sbt_tail, drb->node);
-+ drb->state = DMAD_DRB_STATE_SUBMITTED;
-+ }
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_submit_request);
-+
-+/**
-+ * dmad_withdraw_request - cancel a submitted dma-request-block
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @drb : [in] Reference to a drb to be submitted
-+ * @keep_fired : [in] non-zero to kickoff dma even the channel has stopped due
-+ * to finishing its previous request
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Cancel a submitted DRB (DMA request block) of the given DMA channel in its
-+ * submission queue. DRB is a single dma request which will be pushed into the
-+ * submission queue of the given DMA channel. Cancellation fails if the DRB has
-+ * already been kicked off.
-+ */
-+int dmad_withdraw_request(dmad_chreq * ch_req, dmad_drb * drb)
-+{
-+ dmad_drq *drq = 0;
-+ unsigned long lock_flags;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL)) {
-+ dmad_err("null ch_req!\n");
-+ return -EFAULT;
-+ }
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (unlikely(drq == NULL)) {
-+ dmad_err("null ch_req->drq!\n");
-+ return -EBADR;
-+ }
-+
-+ if (unlikely(drq->sbt_head == 0))
-+ return -EBADR;
-+
-+ if (unlikely((drb->node == 0) || (drb->node >= DMAD_DRB_POOL_SIZE)))
-+ return -EBADR;
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ if (unlikely((drq->sbt_head == 0) || (drb->node == 0) ||
-+ (drb->state != DMAD_DRB_STATE_SUBMITTED) ||
-+ (drb->node >= DMAD_DRB_POOL_SIZE))) {
-+ dmad_err("Submitted-queue is empty or invalid node!\n");
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return -EBADR;
-+ }
-+
-+ dmad_dbg("cancel drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) state(%d)\n",
-+ drb->node, (u32) drb, drb->src_addr, drb->dst_addr,
-+ drb->req_cycle, drb->state);
-+
-+ if (unlikely(drb->state == DMAD_DRB_STATE_EXECUTED)) {
-+ dmad_dbg("Already running drb cannot be stopped currently!\n");
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return 0;/*-EBADR; */
-+ }
-+
-+ dmad_detach_node(drq->drb_pool,
-+ &drq->rdy_head, &drq->rdy_tail, drb->node);
-+ dmad_attach_tail(drq->drb_pool,
-+ &drq->fre_head, &drq->fre_tail, drb->node);
-+
-+ drb->state = DMAD_DRB_STATE_FREE;
-+
-+ if (drb->sync)
-+ complete_all(drb->sync);
-+ drb->sync = 0;
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_withdraw_request);
-+
-+/**
-+ * dmad_kickoff_requests_internal - kickoff hw DMA transmission
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Kickoff hw DMA transmission of the given DMA channel. This function is
-+ * valid for both ring & non-ring mode. This is a lightweight internal version
-+ * of dmad_kickoff_requests() majorly for use in ring mode. Critical access to
-+ * the drb pool should be protected before entering this function.
-+ */
-+static inline int dmad_kickoff_requests_internal(dmad_drq * drq)
-+{
-+ dmad_drb *drb;
-+
-+ dmad_get_head(drq->drb_pool, &drq->sbt_head, &drq->sbt_tail, &drb);
-+
-+ if (!drb) {
-+ dmad_err("%s() null drb!\n", __func__);
-+ return -EBADR;
-+ }
-+
-+ dmad_dbg("%s() drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) state(%d)\n", __func__,
-+ drb->node, (u32) drb, drb->src_addr, drb->dst_addr,
-+ drb->req_cycle, drb->state);
-+
-+ if (drb->state == DMAD_DRB_STATE_SUBMITTED) {
-+ /* Transfer size (in units of source width) */
-+ outl(drb->req_cycle, (addr_t) drq->cyc_port);
-+
-+ /* Source and destination address */
-+ if (drq->flags & DMAD_DRQ_DIR_A1_TO_A0) {
-+ outl(drb->addr1, (addr_t) drq->src_port);
-+ outl(drb->addr0, (addr_t) drq->dst_port);
-+ } else {
-+ outl(drb->addr0, (addr_t) drq->src_port);
-+ outl(drb->addr1, (addr_t) drq->dst_port);
-+ }
-+
-+ drb->state = DMAD_DRB_STATE_EXECUTED;
-+ }
-+
-+ /* Enable DMA channel */
-+ if (!dmad_is_channel_enabled(drq)) {
-+ dmad_enable_channel(drq);
-+ }
-+
-+ return 0;
-+}
-+
-+/**
-+ * dmad_kickoff_requests - kickoff hw DMA transmission of the given DMA channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Kickoff hw DMA transmission of the given DMA channel. This function is
-+ * valid for both ring & non-ring mode.
-+ */
-+int dmad_kickoff_requests(dmad_chreq * ch_req)
-+{
-+ dmad_drq *drq = 0;
-+ dmad_drb *drb = 0;
-+ unsigned long lock_flags;
-+ dma_addr_t req_cycle;
-+
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (unlikely(ch_req == NULL)) {
-+ dmad_err("null ch_req!\n");
-+ return -EFAULT;
-+ }
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ if (unlikely(drq == NULL)) {
-+ dmad_err("null ch_req->drq!\n");
-+ return -EBADR;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ dmad_get_head(drq->drb_pool, &drq->sbt_head, &drq->sbt_tail, &drb);
-+
-+ dmad_dbg("drq(0x%08x) channel_base(0x%08x)\n",
-+ (u32) drq, drq->channel_base);
-+ dmad_dbg("kick off drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) state(%d) a1_to_a0(%d)\n",
-+ (u32) drb->node, (u32) drb, drb->addr0, drb->addr1,
-+ drb->req_cycle, drb->state,
-+ drq->flags & DMAD_DRQ_DIR_A1_TO_A0);
-+
-+ /* do nothing if no drbs are in the submission queue */
-+ if (unlikely((drb == 0) || (drb->state != DMAD_DRB_STATE_SUBMITTED))) {
-+ dmad_dbg("%s() invalid drb(%d 0x%08x) or drb-state(%d)!\n",
-+ __func__,
-+ drb->node, (u32) drb, drb ? drb->state : 0xffffffff);
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return 0;
-+ }
-+
-+ req_cycle = drb->req_cycle;
-+
-+ if (unlikely(req_cycle == 0)) {
-+ dmad_dbg("%s() zero transfer size!\n", __func__);
-+ goto _safe_exit;
-+ }
-+
-+ /* Transfer size (in units of source width) */
-+ outl(req_cycle, (addr_t) drq->cyc_port);
-+
-+ /* Source and destination address */
-+ if (drq->flags & DMAD_DRQ_DIR_A1_TO_A0) {
-+ outl(drb->addr1, (addr_t) drq->src_port);
-+ outl(drb->addr0, (addr_t) drq->dst_port);
-+ } else {
-+ outl(drb->addr0, (addr_t) drq->src_port);
-+ outl(drb->addr1, (addr_t) drq->dst_port);
-+ }
-+
-+ drb->state = DMAD_DRB_STATE_EXECUTED;
-+
-+ /* Enable DMA channel */
-+ dmad_enable_channel(drq);
-+
-+_safe_exit:
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_kickoff_requests);
-+
-+/**
-+ * dmad_probe_hw_ptr_src - probe DMA source hw-address of the given channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : physical address of current HW source pointer
-+ *
-+ * Probe DMA source hw-address of the given channel.
-+ */
-+dma_addr_t dmad_probe_hw_ptr_src(dmad_chreq * ch_req)
-+{
-+ return (dma_addr_t) inl(((dmad_drq *) ch_req->drq)->src_port);
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_probe_hw_ptr_src);
-+
-+/**
-+ * dmad_probe_hw_ptr_dst - probe DMA destination hw-address of the given channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : physical address of current HW destination pointer
-+ *
-+ * Probe DMA destination hw-address of the given channel.
-+ */
-+dma_addr_t dmad_probe_hw_ptr_dst(dmad_chreq * ch_req)
-+{
-+ return (dma_addr_t) inl(((dmad_drq *) ch_req->drq)->dst_port);
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_probe_hw_ptr_dst);
-+
-+/**
-+ * dmad_update_ring - update DMA ring buffer base && size of the given channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @size : [in] The new ring buffer size, in unit of data width (cycles)
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Update DMA ring buffer size of the given channel. This function is valid
-+ * only if the channel is initialized as ring buffer mode.
-+ */
-+int dmad_update_ring(dmad_chreq * ch_req)
-+{
-+ unsigned long lock_flags;
-+ dmad_drq *drq = (dmad_drq *) ch_req->drq;
-+ int remnant;
-+
-+ if (unlikely(dmad_is_channel_enabled(drq))) {
-+ dmad_err("%s() Error - dma channel should be "
-+ "disabled before updating ring size!\n", __func__);
-+ return -EFAULT;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ /* todo: range checking */
-+
-+ remnant = (int)ch_req->ring_size -
-+ (int)ch_req->periods * (int)ch_req->period_size;
-+ if (remnant == 0) {
-+ drq->periods = ch_req->periods;
-+ } else if (remnant > 0) {
-+ drq->periods = ch_req->periods; // + 1;
-+ } else {
-+ dmad_err("%s() Error - buffer_size < "
-+ "periods * period_size!\n", __func__);
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return -EFAULT;
-+ }
-+
-+ drq->ring_base = ch_req->ring_base;
-+ drq->ring_size = ch_req->ring_size;
-+ drq->period_size = ch_req->period_size;
-+ drq->remnant_size = (dma_addr_t) remnant;
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE) {
-+ drq->period_bytes =
-+ DMAC_CYCLE_TO_BYTES(drq->period_size, drq->data_width);
-+ }
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE) {
-+ drq->period_bytes =
-+ APBBR_DMA_CYCLE_TO_BYTES(drq->period_size, drq->data_width);
-+ }
-+#endif
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ dmad_dbg("%s() ring: base(0x%08x) port(0x%08x) periods(0x%08x) "
-+ "period_size(0x%08x) period_bytes(0x%08x) "
-+ "remnant_size(0x%08x)\n",
-+ __func__, drq->ring_base, drq->ring_port,
-+ drq->periods, drq->period_size, drq->period_bytes,
-+ drq->remnant_size);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_update_ring);
-+
-+/**
-+ * dmad_update_ring_sw_ptr - update DMA ring buffer sw-pointer
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @sw_ptr : [in] The new sw-pointer for the hw-pointer to chase of
-+ * @keep_fired : [in] non-zero to kickoff dma even the channel has stopped due
-+ * to finishing its previous request
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Update DMA ring buffer sw-pointer of the given channel on the fly. This
-+ * function is valid only if the channel is initialized as ring buffer mode.
-+ * Uint of sw_ptr is in number of dma data width.
-+ */
-+int dmad_update_ring_sw_ptr(dmad_chreq * ch_req,
-+ dma_addr_t sw_ptr, u8 keep_fired)
-+{
-+ dmad_drq *drq;
-+ unsigned long lock_flags;
-+ dma_addr_t hw_off = 0, ring_ptr;
-+ dma_addr_t sw_p_off, ring_p_off, period_size, period_bytes;
-+ dma_addr_t remnant_size;
-+ int sw_p_idx, ring_p_idx, period, periods;
-+ dmad_drb *drb = NULL;
-+
-+ /*if (ch_req == NULL) { */
-+ /* dmad_dbg("%s() null ch_req!\n", __func__); */
-+ /* return -EFAULT; */
-+ /*} */
-+
-+ drq = (dmad_drq *) ch_req->drq;
-+
-+ /*if (drq == NULL) { */
-+ /* dmad_dbg("%s() null ch_req->drq!\n", __func__); */
-+ /* return -EBADR; */
-+ /*} */
-+
-+ if (unlikely(sw_ptr > drq->ring_size)) {
-+ dmad_err("%s() Invalid ring buffer sw-pointer "
-+ "range (0x%08x)! ring_size(0x%08x)\n",
-+ __func__, sw_ptr, drq->ring_size);
-+ return -EBADR;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ periods = drq->periods;
-+ period_size = drq->period_size;
-+ period_bytes = drq->period_bytes;
-+ remnant_size = drq->remnant_size;
-+
-+ ring_ptr = drq->sw_ptr;
-+ ring_p_idx = drq->sw_p_idx;
-+ ring_p_off = drq->sw_p_off;
-+
-+ sw_p_idx = (int)(sw_ptr / period_size);
-+ sw_p_off = sw_ptr % period_size;
-+
-+ if (remnant_size && (sw_p_idx == periods)) {
-+ --sw_p_idx;
-+ sw_p_off += period_size;
-+ }
-+
-+ dmad_dbg("%s() ring_ptr(0x%08x) ring_p_idx(0x%08x) "
-+ "ring_p_off(0x%08x)\n",
-+ __func__, ring_ptr, ring_p_idx, ring_p_off);
-+ dmad_dbg("%s() sw_ptr(0x%08x) sw_p_idx(0x%08x) sw_p_off(0x%08x)\n",
-+ __func__, sw_ptr, sw_p_idx, sw_p_off);
-+
-+ if (drq->ring_drb &&
-+ (drq->ring_drb->state & (DMAD_DRB_STATE_READY |
-+ DMAD_DRB_STATE_SUBMITTED |
-+ DMAD_DRB_STATE_EXECUTED))) {
-+ drb = drq->ring_drb;
-+ } else {
-+ /* alloc new drb if there is none yet at ring_ptr */
-+ if (0 != dmad_alloc_drb_internal(drq, &drb)) {
-+ dmad_err("%s() drb allocation failed!\n", __func__);
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return -ENOSPC;
-+ }
-+ drb->addr0 = ((dma_addr_t) ring_p_idx * period_bytes) +
-+ drq->ring_base;
-+ drb->addr1 = drq->dev_addr;
-+ drb->req_cycle = 0; // redundent, though, no harm to performance
-+
-+ dmad_dbg("init_drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) state(%d)\n",
-+ (u32) drb->node, (u32) drb, drb->src_addr,
-+ drb->dst_addr, drb->req_cycle, drb->state);
-+
-+ drq->ring_drb = drb;
-+ }
-+
-+ /* Following code-path has been optimized. The design flow is expanded
-+ * below for reference.
-+ *
-+ * if (sw_ptr >= ring_ptr)
-+ * if (sw_p_idx == ring_p_idx)
-+ * ring_drb::req_cycle <- sw_p_off
-+ * if (ring_drb::state == executed)
-+ * hw_cycle <- sw_p_idx
-+ * fi
-+ * else
-+ * ring_drb::req_cycle <- period_size
-+ * if (ring_drb::state == executed)
-+ * hw_cycle <- period_size
-+ * fi
-+ * for (i = ring_p_idx+1 ~ sw_p_idx-1)
-+ * new_drb::ring_addr <- i * period_bytes + ring_base
-+ * new_drb::req_cycle <- period_size
-+ * rof
-+ * sw_drb::ring_addr <- sw_p_idx * period_bytes + ring_base
-+ * sw_drb::req_cycle <- sw_p_off
-+ * else
-+ * // sw_ptr < ring_ptr
-+ * ring_drb::req_cycle <- period_size
-+ * if (ring_drb::state == executed)
-+ * hw_cycle <- period_size
-+ * fi
-+ * for (i = ring_p_idx+1 ~ idx_max)
-+ * new_drb::ring_addr <- i * period_bytes + ring_base
-+ * new_drb::req_cycle <- period_size
-+ * rof
-+ * for (i = 0 ~ sw_p_idx-1)
-+ * new_drb::ring_addr <- i * period_bytes + ring_base
-+ * new_drb::req_cycle <- period_size
-+ * rof
-+ * sw_drb::ring_addr <- sw_p_idx * period_bytes + ring_base
-+ * sw_drb::req_cycle <- sw_p_off
-+ * fi
-+ */
-+ if ((sw_ptr >= ring_ptr) && (sw_p_idx == ring_p_idx) && (sw_p_off != 0)) {
-+
-+ dmad_dbg("update ring drb\n");
-+
-+ /* update drb size at ring_ptr */
-+ drb->req_cycle = sw_p_off;
-+
-+ dmad_dbg("ring_drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) state(%d)\n",
-+ (u32) drb->node, (u32) drb, drb->addr0, drb->addr1,
-+ drb->req_cycle, drb->state);
-+
-+ /* update hw dma size of this drb if it has been sent to the
-+ * controller */
-+ if (drb->state == DMAD_DRB_STATE_EXECUTED) {
-+ dmad_disable_channel(drq);
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE)
-+ hw_off = DMAC_BYTES_TO_CYCLE((addr_t)
-+ inl((addr_t) drq->
-+ ring_port) -
-+ (addr_t) drb->
-+ addr0,
-+ drq->data_width);
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE)
-+ hw_off = APBBR_DMA_BYTES_TO_CYCLE((addr_t)
-+ inl((addr_t)
-+ drq->
-+ ring_port)
-+ -
-+ (addr_t) drb->
-+ addr0,
-+ drq->
-+ data_width);
-+#endif
-+ dmad_dbg("hw_off(0x%08x) sw_p_off(0x%08x)\n",
-+ (u32) hw_off, (u32) sw_p_off);
-+
-+ if (sw_p_off < hw_off)
-+ dmad_err("%s() underrun! sw_p_off(0x%08x) <"
-+ " hw_off(0x%08x)\n", __func__,
-+ (u32) sw_p_off, (u32) hw_off);
-+ else
-+ outl(sw_p_off - hw_off, drq->cyc_port);
-+
-+ dmad_enable_channel(drq);
-+
-+ } else {
-+ dmad_submit_request_internal(drq, drb);
-+ }
-+
-+ } else {
-+
-+ dmad_dbg("fulfill ring drb - sw_ptr(0x%08x) ring_ptr(0x%08x)\n",
-+ (u32) sw_ptr, (u32) ring_ptr);
-+
-+ /* fulfill last drb at ring_ptr */
-+ if (ring_p_idx == (periods - 1))
-+ drb->req_cycle = period_size + remnant_size;
-+ else
-+ drb->req_cycle = period_size;
-+
-+ dmad_dbg("ring_drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) state(%d)\n",
-+ (u32) drb->node, (u32) drb, drb->addr0, drb->addr1,
-+ drb->req_cycle, drb->state);
-+
-+ if (drb->state == DMAD_DRB_STATE_EXECUTED) {
-+ dmad_disable_channel(drq);
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE)
-+ hw_off = DMAC_BYTES_TO_CYCLE((addr_t)
-+ inl((addr_t) drq->
-+ ring_port) -
-+ (addr_t) drb->
-+ addr0,
-+ drq->data_width);
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE)
-+ hw_off = APBBR_DMA_BYTES_TO_CYCLE((addr_t)
-+ inl((addr_t)
-+ drq->
-+ ring_port)
-+ -
-+ (addr_t) drb->
-+ addr0,
-+ drq->
-+ data_width);
-+#endif
-+ dmad_dbg("hw_off(0x%08x) period_size(0x%08x)\n",
-+ (u32) hw_off, (u32) period_size);
-+
-+ if (ring_p_idx == (periods - 1)) {
-+ if (period_size < hw_off)
-+ dmad_err("%s() illegal! "
-+ "period_size(0x%08x) + "
-+ "remnant_size(0x%08x) < "
-+ "hw_off(0x%08x)\n", __func__,
-+ (u32) period_size,
-+ (u32) remnant_size,
-+ (u32) hw_off);
-+ else
-+ outl(period_size + remnant_size -
-+ hw_off, drq->cyc_port);
-+ } else {
-+ if (period_size < hw_off)
-+ dmad_err("%s() illegal! "
-+ "period_size(0x%08x) < "
-+ "hw_off(0x%08x)\n", __func__,
-+ (u32) period_size,
-+ (u32) hw_off);
-+ else
-+ outl(period_size - hw_off,
-+ drq->cyc_port);
-+ }
-+
-+ dmad_enable_channel(drq);
-+
-+ } else {
-+ dmad_submit_request_internal(drq, drb);
-+ }
-+
-+ ++ring_p_idx;
-+
-+ /* adjust sw_ptr period index ahead by one ring cycle */
-+ //if (sw_ptr < ring_ptr) {
-+ if (sw_p_idx < ring_p_idx) {
-+ sw_p_idx += periods;
-+ }
-+
-+ /* allocate in-between (ring_ptr+1 to sw_ptr-1)
-+ * full-cycle drbs */
-+ for (period = ring_p_idx; period < sw_p_idx; ++period) {
-+ if (0 != dmad_alloc_drb_internal(drq, &drb)) {
-+ dmad_err("%s() drb allocation failed!\n",
-+ __func__);
-+ spin_unlock_irqrestore(&drq->drb_pool_lock,
-+ lock_flags);
-+ return -ENOSPC;
-+ }
-+
-+ drb->addr0 = (dma_addr_t) (period % periods) *
-+ period_bytes + drq->ring_base;
-+ drb->addr1 = drq->dev_addr;
-+
-+ if (period == (periods - 1)) {
-+ drb->req_cycle = period_size + remnant_size;
-+ } else {
-+ drb->req_cycle = period_size;
-+ }
-+
-+ dmad_dbg("inbtw_drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x) state(%d)\n",
-+ (u32) drb->node, (u32) drb, drb->addr0,
-+ drb->addr1, drb->req_cycle, drb->state);
-+
-+ dmad_submit_request_internal(drq, drb);
-+ }
-+
-+ /* allocate drb right at sw_ptr */
-+ if (0 != dmad_alloc_drb_internal(drq, &drb)) {
-+ dmad_err("%s() drb allocation failed!\n", __func__);
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+ return -ENOSPC;
-+ }
-+ drb->addr0 = (dma_addr_t) (sw_p_idx % periods) *
-+ period_bytes + drq->ring_base;
-+ drb->addr1 = drq->dev_addr;
-+ drb->req_cycle = sw_p_off;
-+
-+ dmad_dbg("swptr_drb(%d 0x%08x) addr0(0x%08x) addr1(0x%08x) "
-+ "size(0x%08x) state(%d)\n",
-+ (u32) drb->node, (u32) drb, drb->addr0, drb->addr1,
-+ drb->req_cycle, drb->state);
-+
-+ drq->ring_drb = drb;
-+
-+ if (sw_p_off > 0)
-+ dmad_submit_request_internal(drq, drb);
-+ }
-+
-+ drq->sw_ptr = sw_ptr % drq->ring_size;
-+ drq->sw_p_idx = sw_p_idx % periods;
-+ drq->sw_p_off = sw_p_off;
-+
-+ if (likely(keep_fired)) {
-+ dmad_kickoff_requests_internal(drq);
-+ }
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ return 0;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_update_ring_sw_ptr);
-+
-+/**
-+ * dmad_probe_ring_hw_ptr - probe DMA ring buffer position of the given channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @return : Ring buffer position of current HW ring buffer pointer
-+ *
-+ * Probe DMA ring buffer position of the given channel. The position is
-+ * relative to the ring buffer base. This function is valid only if the
-+ * channel is initialized as ring buffer mode.
-+ */
-+dma_addr_t dmad_probe_ring_hw_ptr(dmad_chreq * ch_req)
-+{
-+ dmad_drq *drq = (dmad_drq *) ch_req->drq;
-+ dma_addr_t cycles =
-+ (dma_addr_t) inl(drq->ring_port) - (dma_addr_t) drq->ring_base;
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (ch_req->controller == DMAD_DMAC_AHB_CORE)
-+ cycles = DMAC_BYTES_TO_CYCLE(cycles, drq->data_width);
-+#endif
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ if (ch_req->controller == DMAD_DMAC_APB_CORE)
-+ cycles = APBBR_DMA_BYTES_TO_CYCLE(cycles, drq->data_width);
-+#endif
-+ return cycles;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_probe_ring_hw_ptr);
-+
-+/**
-+ * dmad_channel_drain - cancel DMA transmission of the given DMA channel
-+ * @controller : [in] One of the enum value of DMAD_DMAC_CORE
-+ * @drq : [in] Reference to the DMA queue structure (dmad_drq)
-+ * @shutdown : [in] Non-zero to force a immediate channel shutdown
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Stop the DMA transmission and cancel all submitted requests of the given
-+ * DMA channel. This function drains a single channel and is the internal
-+ * implementation of the interface routine dmad_drain_requests() and the
-+ * module_exit function.
-+ */
-+static int dmad_channel_drain(u32 controller, dmad_drq * drq, u8 shutdown)
-+{
-+ dmad_drb *drb = 0;
-+ unsigned long lock_flags;
-+
-+ if (unlikely(drq == NULL)) {
-+ dmad_err("null ch_req->drq!\n");
-+ return -EBADR;
-+ }
-+
-+ spin_lock_irqsave(&drq->drb_pool_lock, lock_flags);
-+
-+ /* Stop DMA channel if forced to shutdown immediately */
-+ if (shutdown) {
-+ /* disable dma controller */
-+ dmad_reset_channel(drq);
-+
-+ /* todo: more settings to stop DMA controller ?? */
-+
-+ /*if (drb->state == DMAD_DRB_STATE_EXECUTED) { */
-+ /*} */
-+ }
-+
-+ /* Detach DRBs in submit queue */
-+ dmad_detach_head(drq->drb_pool, &drq->sbt_head, &drq->sbt_tail, &drb);
-+
-+ while (drb) {
-+ dmad_dbg("cancel sbt drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x) state(%d)\n",
-+ drb->node, (u32) drb, drb->src_addr, drb->dst_addr,
-+ drb->req_cycle, (u32) drb->state);
-+
-+ /* Mark DRB state as abort */
-+ drb->state = DMAD_DRB_STATE_ABORT;
-+
-+ if (drb->sync)
-+ complete_all(drb->sync);
-+
-+ dmad_attach_tail(drq->drb_pool, &drq->fre_head, &drq->fre_tail,
-+ drb->node);
-+
-+ dmad_detach_head(drq->drb_pool, &drq->sbt_head, &drq->sbt_tail,
-+ &drb);
-+ }
-+
-+ /* Detach DRBs in ready queue */
-+ dmad_detach_head(drq->drb_pool, &drq->rdy_head, &drq->rdy_tail, &drb);
-+
-+ while (drb) {
-+ dmad_dbg("cancel rdy drb(%d 0x%08x) addr0(0x%08x) "
-+ "addr1(0x%08x) size(0x%08x) state(%d)\n",
-+ drb->node, (u32) drb, drb->src_addr, drb->dst_addr,
-+ drb->req_cycle, (u32) drb->state);
-+
-+ /* Mark DRB state as abort */
-+ drb->state = DMAD_DRB_STATE_ABORT;
-+
-+ dmad_attach_tail(drq->drb_pool, &drq->fre_head, &drq->fre_tail,
-+ drb->node);
-+
-+ /* Detach next submitted DRB (DMA Request Block) from the
-+ * DRQ (DMA Request Queue) */
-+ dmad_detach_head(drq->drb_pool, &drq->rdy_head, &drq->rdy_tail,
-+ &drb);
-+ }
-+
-+ drq->state |= DMAD_DRQ_STATE_ABORT;
-+
-+ drq->ring_drb = NULL;
-+ drq->sw_ptr = 0;
-+ drq->sw_p_idx = 0;
-+ drq->sw_p_off = 0;
-+
-+ spin_unlock_irqrestore(&drq->drb_pool_lock, lock_flags);
-+
-+ if ( /*(drq->fre_head == 0) && */ (drq->flags & DMAD_FLAGS_SLEEP_BLOCK)) {
-+ complete_all(&drq->drb_alloc_sync);
-+ }
-+
-+ return 0;
-+}
-+
-+/**
-+ * dmad_cancel_requests - cancel DMA transmission of the given DMA channel
-+ * @ch_req : [in] Reference to the DMA request descriptor structure
-+ * @shutdown : [in] Non-zero to force a immediate channel shutdown
-+ * @return : 0 if success, non-zero if any error
-+ *
-+ * Stop the DMA transmission and cancel all submitted requests of the given
-+ * DMA channel.
-+ */
-+int dmad_drain_requests(dmad_chreq * ch_req, u8 shutdown)
-+{
-+ dmad_dbg("%s()\n", __func__);
-+
-+ if (ch_req == NULL) {
-+ dmad_err("null ch_req!\n");
-+ return -EFAULT;
-+ }
-+
-+ return dmad_channel_drain(ch_req->controller, ch_req->drq, shutdown);
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_drain_requests);
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+
-+/**
-+ * dmad_probe_irq_source - probe DMA channel who asserts the shared sw-irq line
-+ * @return : The channel number which asserts the shared sw-irq line
-+ *
-+ * Probe DMA channel who asserts the shared sw-irq line.
-+ */
-+int dmad_probe_irq_source_ahb(void)
-+{
-+ int channel; /* interrupt channel number */
-+
-+ /* todo: spin_lock */
-+
-+ /* - Check DMA status register to get channel number */
-+ for (channel = 0; channel < DMAD_AHB_MAX_CHANNELS; ++channel) {
-+ if (getbl(channel, DMAC_INT_TC))
-+ return channel;
-+ }
-+
-+ /* Perform DMA error checking if no valid channel was found who
-+ * assert the finish signal. */
-+ for (channel = 0; channel < DMAD_AHB_MAX_CHANNELS; ++channel) {
-+ if (getbl(channel, DMAC_INT_ERRABT))
-+ return channel;
-+ if (getbl(channel << DMAC_INT_ABT_SHIFT, DMAC_INT_ERRABT))
-+ return channel;
-+ }
-+
-+ /* todo: spin_unlock */
-+
-+ return -EFAULT;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_probe_irq_source_ahb);
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+
-+int dmad_probe_irq_source_apb(void)
-+{
-+ int channel; /* interrupt channel number */
-+
-+ /* todo: spin_lock */
-+
-+ /* Check DMA status register to get channel number */
-+ for (channel = 0; channel < DMAD_APB_MAX_CHANNELS; ++channel) {
-+ if (getbl(APBBR_DMA_FINTST_BIT, APBBR_DMA_BASE_CH(channel) +
-+ APBBR_DMA_CMD_OFFSET))
-+ return channel;
-+ }
-+
-+ /* Perform DMA error checking if no valid channel was found who
-+ * assert the finish signal. */
-+ for (channel = 0; channel < DMAD_APB_MAX_CHANNELS; ++channel) {
-+ if (getbl(APBBR_DMA_ERRINTST_BIT, APBBR_DMA_BASE_CH(channel) +
-+ APBBR_DMA_CMD_OFFSET))
-+ return channel;
-+ }
-+
-+ /* todo: spin_unlock */
-+
-+ return -EFAULT;
-+}
-+
-+EXPORT_SYMBOL_GPL(dmad_probe_irq_source_apb);
-+
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+/**
-+ * dmad_module_init - dma module-init function
-+ * @return : 0 if success, non-zero if any error
-+ */
-+int __init dmad_module_init(void)
-+{
-+ int err = 0;
-+ dmad_dbg("%s() >>\n", __func__);
-+
-+ /* clear device struct since the module may be load/unload many times */
-+ memset(&dmad, 0, sizeof(dmad));
-+
-+ dmad.drq_pool =
-+ kmalloc((DMAD_AHB_MAX_CHANNELS +
-+ DMAD_APB_MAX_CHANNELS) * sizeof(dmad_drq), GFP_KERNEL);
-+ if (dmad.drq_pool == NULL) {
-+ dmad_err("%s() failed to allocate drb pool!\n", __func__);
-+ return -ENOMEM;
-+ }
-+
-+ memset(dmad.drq_pool, 0,
-+ (DMAD_AHB_MAX_CHANNELS + DMAD_APB_MAX_CHANNELS) *
-+ sizeof(dmad_drq));
-+
-+ spin_lock_init(&dmad.drq_pool_lock);
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ dmad.ahb_drq_pool = dmad.drq_pool;
-+ if (unlikely(!request_region(DMAC_BASE, SZ_1K, "AHB DMAC"))) {
-+ dmad_err("Cannot reserve AHB DMAC I/O region\n");
-+ err = -EBUSY;
-+ }
-+#endif
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ dmad.apb_drq_pool = &dmad.drq_pool[DMAD_AHB_MAX_CHANNELS];
-+ if (unlikely(!request_region(APBBR_BASE, SZ_1K, "APB DMAC"))) {
-+ dmad_err("Cannot reserve APB DMAC I/O region\n");
-+ err = -EBUSY;
-+ }
-+#endif
-+
-+ dmad_dbg("DMA module init result: (%d)\n", err);
-+ dmad_dbg(" AHB channels: %d; APB channels %d; "
-+ "DRBs per channel: %d\n",
-+ DMAC_MAX_CHANNELS, APBBR_DMA_MAX_CHANNELS, DMAD_DRB_POOL_SIZE);
-+
-+ dmad_dbg("%s() return code (%d) <<\n", __func__, err);
-+ return err;
-+}
-+
-+/**
-+ * dmad_module_init - dma module clean up function
-+ */
-+void __exit dmad_module_exit(void)
-+{
-+ dmad_drq *drq;
-+ u32 channel;
-+
-+ dmad_dbg("%s() >>\n", __func__);
-+
-+ spin_lock(&dmad.drq_pool_lock);
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ /* cancel existing requests and unregister interrupt handler */
-+ for (channel = 0; channel < DMAD_AHB_MAX_CHANNELS; ++channel) {
-+
-+ /* shutdown dma requests */
-+ drq = (dmad_drq *) & dmad.ahb_drq_pool[channel];
-+
-+ if ((drq->state & DMAD_DRQ_STATE_READY) != 0)
-+ dmad_channel_drain(DMAD_DMAC_AHB_CORE, drq, 1);
-+
-+ /* free registered irq handlers */
-+ free_irq(ahb_irqs[channel], (void *)(channel + 1));
-+ }
-+#endif
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ /* cancel existing requests and unregister interrupt handler */
-+ for (channel = 0; channel < DMAD_APB_MAX_CHANNELS; ++channel) {
-+
-+ /* shutdown dma requests */
-+ drq = (dmad_drq *) & dmad.apb_drq_pool[channel];
-+
-+ if ((drq->state & DMAD_DRQ_STATE_READY) != 0)
-+ dmad_channel_drain(DMAD_DMAC_APB_CORE, drq, 1);
-+
-+ /* free registered irq handlers */
-+ free_irq(apb_irqs[channel], (void *)(channel + 1));
-+ }
-+#endif
-+ spin_unlock(&dmad.drq_pool_lock);
-+
-+ if (dmad.drq_pool)
-+ kfree(dmad.drq_pool);
-+ memset(&dmad, 0, sizeof(dmad));
-+
-+ /* release I/O space */
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ release_region(DMAC_BASE, SZ_1K);
-+#endif /*CONFIG_PLATFORM_AHBDMA */
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+ release_region(APBBR_BASE, SZ_1K);
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+ dmad_dbg("DMA module unloaded!\n");
-+}
-+
-+#ifndef MODULE
-+arch_initcall(dmad_module_init);
-+#else
-+module_init(dmad_module_init);
-+module_exit(dmad_module_exit);
-+#endif
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA || CONFIG_PLATFORM_APBDMA */
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/dmad_intc.c linux-3.4.113/arch/nds32/platforms/dmad_intc.c
---- linux-3.4.113.orig/arch/nds32/platforms/dmad_intc.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/dmad_intc.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,124 @@
-+/*
-+ * linux/arch/armnommu/mach-faraday/platform-a320/apb_intc.c
-+ *
-+ * Faraday AHB DMA Interrupt Process Driver Implementation
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ *
-+ * ChangeLog
-+ *
-+ * Peter Liao 09/28/2005 Created
-+ */
-+
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/ioport.h>
-+#include <asm/io.h>
-+
-+#include <asm/intc.h>
-+#include <asm/spec.h>
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+extern int dmad_probe_irq_source_ahb(void);
-+
-+void AHBDMA_irq_rounter(unsigned int irq, struct irq_desc *desc)
-+{
-+ int ahb_irq;
-+ struct irq_desc *ahb_desc;
-+ struct irq_data data;
-+ data.irq = irq;
-+
-+ raw_spin_lock(&desc->lock);
-+ desc->irq_data.chip->irq_mask(&data);
-+ desc->irq_data.chip->irq_ack(&data);
-+
-+ ahb_irq = dmad_probe_irq_source_ahb();
-+ if (ahb_irq >= 0) {
-+ ahb_irq += DMAC_FTDMAC020_IRQ0;
-+ ahb_desc = irq_desc + ahb_irq;
-+
-+ raw_spin_unlock(&desc->lock);
-+ ahb_desc->handle_irq(ahb_irq, ahb_desc);
-+ raw_spin_lock(&desc->lock);
-+ }
-+
-+ desc->irq_data.chip->irq_unmask(&data);
-+ raw_spin_unlock(&desc->lock);
-+}
-+
-+int __init intc_ftdmac020_init_irq(void)
-+{
-+ int i;
-+
-+ /* Register all IRQ */
-+ for (i = DMAC_FTDMAC020_IRQ0;
-+ i < DMAC_FTDMAC020_IRQ0 + DMAC_FTDMAC020_IRQ_COUNT; i++) {
-+ // level trigger
-+ irq_set_chip(i, &dummy_irq_chip);
-+ irq_set_handler(i, handle_simple_irq);
-+ }
-+ irq_set_chained_handler(PLATFORM_AHBDMA_IRQ, AHBDMA_irq_rounter);
-+
-+ return 0;
-+}
-+
-+arch_initcall(intc_ftdmac020_init_irq);
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+extern int dmad_probe_irq_source_apb(void);
-+
-+void APBDMA_irq_rounter(unsigned int irq, struct irq_desc *desc)
-+{
-+ int apb_irq;
-+ struct irq_desc *apb_desc;
-+ struct irq_data data;
-+ data.irq = irq;
-+
-+ raw_spin_lock(&desc->lock);
-+
-+ //mask_ack_irq(desc, irq);
-+ desc->irq_data.chip->irq_mask(&data);
-+ desc->irq_data.chip->irq_ack(&data);
-+
-+ apb_irq = dmad_probe_irq_source_apb();
-+ //printk(KERN_INFO "irq (%d) ch(%d)\n", irq, apb_irq);
-+
-+ if (apb_irq >= 0) {
-+ apb_irq += APBBRG_FTAPBBRG020S_0_IRQ0;
-+ apb_desc = irq_desc + apb_irq;
-+
-+ raw_spin_unlock(&desc->lock);
-+ apb_desc->handle_irq(irq, apb_desc);
-+ raw_spin_lock(&desc->lock);
-+ }
-+
-+ desc->irq_data.chip->irq_unmask(&data);
-+ raw_spin_unlock(&desc->lock);
-+}
-+
-+int __init intc_ftapbbrg020s_init_irq(void)
-+{
-+ int i;
-+
-+ /* Register all IRQ */
-+ for (i = APBBRG_FTAPBBRG020S_0_IRQ0;
-+ i < APBBRG_FTAPBBRG020S_0_IRQ0 + APBBRG_FTAPBBRG020S_IRQ_COUNT;
-+ i++) {
-+ // level trigger
-+ irq_set_chip(i, &dummy_irq_chip);
-+ irq_set_handler(i, handle_simple_irq);
-+ }
-+
-+ irq_set_chained_handler(PLATFORM_APBDMA_IRQ, APBDMA_irq_rounter);
-+
-+ return 0;
-+}
-+
-+arch_initcall(intc_ftapbbrg020s_init_irq);
-+#endif /* CONFIG_PLATFORM_APBDMA */
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/ftpci.c linux-3.4.113/arch/nds32/platforms/ftpci.c
---- linux-3.4.113.orig/arch/nds32/platforms/ftpci.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/ftpci.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,497 @@
-+/*
-+ * linux/arch/nds32/platforms/ftpci.c
-+ *
-+ * Faraday FTPCI100 PCI Bridge Controller Device Driver Implementation
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ *
-+ * ChangeLog
-+ *
-+ * Peter Liao 09/28/2005 Created.
-+ */
-+
-+#include <linux/sched.h>
-+#include <linux/kernel.h>
-+#include <linux/pci.h>
-+#include <linux/ptrace.h>
-+#include <linux/slab.h>
-+#include <linux/ioport.h>
-+#include <linux/interrupt.h>
-+#include <linux/spinlock.h>
-+#include <linux/init.h>
-+#include <asm/hardware.h>
-+#include <asm/irq.h>
-+#include <asm/system.h>
-+#include <asm/mach/pci.h>
-+#include <asm/io.h>
-+#include <asm/sizes.h>
-+#include <asm/ftpci.h>
-+#include <asm/spec.h>
-+#include <asm/mach-types.h>
-+
-+#define IPMODULE PCIC
-+#define IPNAME FTPCI100
-+
-+#define DEBUGFPCI
-+#undef DEBUGFPCI
-+
-+#ifdef DEBUGFPCI
-+#define DBGFPCI(x...) printk(x)
-+#else
-+#define DBGFPCI(x...)
-+#endif
-+#define FPCI_VA_BASE IP_VA_BASE(0)
-+#define FTPCI_PCI_BRIDGE_VENID PCI_BRIDGE_VENID
-+#define FPCI_IO_VA_BASE PCIIO_VA_BASE
-+#define FPCI_IO_PA_BASE PCIIO_PA_BASE
-+#define FPCI_IO_VA_END PCIIO_VA_LIMIT
-+#define FPCI_MEM_VA_BASE PCIMEM_VA_BASE
-+#define FPCI_MEM_PA_BASE PCIMEM_PA_BASE
-+#define FPCI_MEM_VA_END PCIMEM_VA_LIMIT
-+#define FPCI_MEM_PA_END (PCIMEM_PA_BASE + SZ_256M)
-+
-+// --------------------------------------------------------------------
-+// AHB Control Register
-+// --------------------------------------------------------------------
-+#define FTPCI_IOSIZE_REG 0x0
-+#define FTPCI_PROT_REG 0x4
-+#define FTPCI_CTRL_REG 0x8
-+#define FTPCI_ERREN_REG 0xc
-+#define FTPCI_SOFTRST_REG 0x10
-+#define FTPCI_EN64_REG 0x14
-+#define FTPCI_ADDRH32_REG 0x18
-+#define FTPCI_CFG_ADR_REG 0x28
-+#define FTPCI_CFG_DATA_REG 0x2c
-+
-+// --------------------------------------------------------------------
-+// FTPCI_IOSIZE_REG's constant definitions
-+// --------------------------------------------------------------------
-+#define FTPCI_BASE_IO_SIZE_1M 0x0
-+#define FTPCI_BASE_IO_SIZE_2M 0x1
-+#define FTPCI_BASE_IO_SIZE_4M 0x2
-+#define FTPCI_BASE_IO_SIZE_8M 0x3
-+#define FTPCI_BASE_IO_SIZE_16M 0x4
-+#define FTPCI_BASE_IO_SIZE_32M 0x5
-+#define FTPCI_BASE_IO_SIZE_64M 0x6
-+#define FTPCI_BASE_IO_SIZE_128M 0x7
-+#define FTPCI_BASE_IO_SIZE_256M 0x8
-+#define FTPCI_BASE_IO_SIZE_512M 0x9
-+#define FTPCI_BASE_IO_SIZE_1G 0xa
-+#define FTPCI_BASE_IO_SIZE_2G 0xb
-+
-+// --------------------------------------------------------------------
-+// PCI Configuration Register
-+// --------------------------------------------------------------------
-+#define PCI_INT_MASK 0x4c
-+#define PCI_MEM_BASE_SIZE1 0x50
-+#define PCI_MEM_BASE_SIZE2 0x54
-+#define PCI_MEM_BASE_SIZE3 0x58
-+
-+// --------------------------------------------------------------------
-+// PCI_INT_MASK's bit definitions
-+// --------------------------------------------------------------------
-+#define PCI_INTA_ENABLE (1U<<22)
-+#define PCI_INTB_ENABLE (1U<<23)
-+#define PCI_INTC_ENABLE (1U<<24)
-+#define PCI_INTD_ENABLE (1U<<25)
-+
-+// --------------------------------------------------------------------
-+// PCI_MEM_BASE_SIZE1's constant definitions
-+// --------------------------------------------------------------------
-+#define FTPCI_BASE_ADR_SIZE_1MB (PHYS_OFFSET | (0x0<<16))
-+#define FTPCI_BASE_ADR_SIZE_2MB (PHYS_OFFSET | (0x1<<16))
-+#define FTPCI_BASE_ADR_SIZE_4MB (PHYS_OFFSET | (0x2<<16))
-+#define FTPCI_BASE_ADR_SIZE_8MB (PHYS_OFFSET | (0x3<<16))
-+#define FTPCI_BASE_ADR_SIZE_16MB (PHYS_OFFSET | (0x4<<16))
-+#define FTPCI_BASE_ADR_SIZE_32MB (PHYS_OFFSET | (0x5<<16))
-+#define FTPCI_BASE_ADR_SIZE_64MB (PHYS_OFFSET | (0x6<<16))
-+#define FTPCI_BASE_ADR_SIZE_128MB (PHYS_OFFSET | (0x7<<16))
-+#define FTPCI_BASE_ADR_SIZE_256MB (PHYS_OFFSET | (0x8<<16))
-+#define FTPCI_BASE_ADR_SIZE_512MB (PHYS_OFFSET | (0x9<<16))
-+#define FTPCI_BASE_ADR_SIZE_1GB (PHYS_OFFSET | (0xa<<16))
-+#define FTPCI_BASE_ADR_SIZE_2GB (PHYS_OFFSET | (0xb<<16))
-+
-+#define CONFIG_CMD(bus, device_fn, where) (0x80000000 | (bus << 16) | (device_fn << 8) | (where & ~3) )
-+
-+struct pci_dev *pci_bridge = NULL;
-+static unsigned int pci_config_addr;
-+static unsigned int pci_config_data;
-+int ftpci_probed = 0;
-+
-+static struct resource pcic_resource = {
-+ .name = "Faradat PCIC",
-+ .start = IP_VA_BASE(0),
-+ .end = IP_VA_LIMIT(0),
-+};
-+
-+// Luke Lee 03/21/2005 mod begin
-+static int ftpci_read_config_byte(struct pci_bus *bus, unsigned int devfn,
-+ int where, u8 * val)
-+{
-+ u32 v;
-+ unsigned int shift;
-+
-+ outl(CONFIG_CMD(bus->number, devfn, where), pci_config_addr);
-+ v = inl(pci_config_data);
-+ shift = (where & 0x3) * 8;
-+ *val = (v >> shift) & 0xff;
-+ return PCIBIOS_SUCCESSFUL;
-+}
-+
-+static int ftpci_read_config_word(struct pci_bus *bus, unsigned int devfn,
-+ int where, u16 * val)
-+{
-+ u32 v;
-+ unsigned int shift;
-+
-+ outl(CONFIG_CMD(bus->number, devfn, where), pci_config_addr);
-+ v = inl(pci_config_data);
-+ shift = (where & 0x3) * 8;
-+ *val = (v >> shift) & 0xffff;
-+ return PCIBIOS_SUCCESSFUL;
-+}
-+
-+static int ftpci_read_config_dword(struct pci_bus *bus, unsigned int devfn,
-+ int where, u32 * val)
-+{
-+ u32 v;
-+
-+ outl(CONFIG_CMD(bus->number, devfn, where), pci_config_addr);
-+ v = inl(pci_config_data);
-+ *val = v;
-+ return PCIBIOS_SUCCESSFUL;
-+}
-+
-+static int ftpci_write_config_byte(struct pci_bus *bus, unsigned int devfn,
-+ int where, u8 val)
-+{
-+ u32 org_val;
-+ unsigned int shift;
-+
-+ shift = (where & 0x3) * 8;
-+ outl(CONFIG_CMD(bus->number, devfn, where), pci_config_addr);
-+ org_val = inl(pci_config_data);
-+ org_val = (org_val & ~(0xff << shift)) | ((u32) val << shift);
-+ outl(org_val, pci_config_data);
-+ return PCIBIOS_SUCCESSFUL;
-+}
-+
-+static int ftpci_write_config_word(struct pci_bus *bus, unsigned int devfn,
-+ int where, u16 val)
-+{
-+ u32 org_val;
-+ unsigned int shift;
-+
-+ shift = (where & 0x3) * 8;
-+ outl(CONFIG_CMD(bus->number, devfn, where), pci_config_addr);
-+ org_val = inl(pci_config_data);
-+ org_val = (org_val & ~(0xffff << shift)) | ((u32) val << shift);
-+ outl(org_val, pci_config_data);
-+ return PCIBIOS_SUCCESSFUL;
-+}
-+
-+static int ftpci_write_config_dword(struct pci_bus *bus, unsigned int devfn,
-+ int where, u32 val)
-+{
-+ outl(CONFIG_CMD(bus->number, devfn, where), pci_config_addr);
-+ outl(val, pci_config_data);
-+ return PCIBIOS_SUCCESSFUL;
-+}
-+
-+// Luke Lee 03/21/2005 mod end
-+
-+// Luke Lee 03/21/2005 ins begin
-+static int ftpci_read_config(struct pci_bus *bus, unsigned int devfn, int where,
-+ int size, u32 * val)
-+{
-+ int r;
-+ switch (size) {
-+ case 1:
-+ r = ftpci_read_config_byte(bus, devfn, where, (u8 *) val); // Luke Lee TOFIX 03/22/2005 : convert to (u8*) -- beware of endian !
-+ break;
-+ case 2:
-+ r = ftpci_read_config_word(bus, devfn, where, (u16 *) val); // Luke Lee TOFIX 03/22/2005 : convert to (u16*) -- beware of endian !
-+ break;
-+
-+ default:
-+ r = ftpci_read_config_dword(bus, devfn, where, val);
-+ break;
-+ }
-+
-+ return r;
-+}
-+
-+static int ftpci_write_config(struct pci_bus *bus, unsigned int devfn,
-+ int where, int size, u32 val)
-+{
-+ int r;
-+ switch (size) {
-+ case 1:
-+ r = ftpci_write_config_byte(bus, devfn, where, val);
-+ break;
-+ case 2:
-+ r = ftpci_write_config_word(bus, devfn, where, val);
-+ break;
-+
-+ case 4:
-+ r = ftpci_write_config_dword(bus, devfn, where, val);
-+ break;
-+ default:
-+ printk("Invalid size for ftpci_write()\n");
-+ r = PCIBIOS_FUNC_NOT_SUPPORTED; // Luke Lee 03/23/2005 ins 1
-+ }
-+
-+ return r;
-+}
-+
-+// Luke Lee 03/21/2005 ins end
-+
-+static struct pci_ops ftpci_ops = {
-+ // Luke Lee 03/21/2005 mod begin
-+ .read = ftpci_read_config,
-+ .write = ftpci_write_config,
-+ // Luke Lee 03/21/2005 mod end
-+};
-+
-+/* using virtual address for pci_resource_start() function*/
-+static struct resource pci_io = {
-+ .name = "Faraday PCI I/O Space",
-+ .start = FPCI_IO_VA_BASE,
-+ .end = FPCI_IO_VA_END,
-+ .flags = IORESOURCE_IO,
-+};
-+
-+/* using physical address for memory resource*/
-+static struct resource pci_mem = {
-+ .name = "Faraday PCI non-prefetchable Memory Space",
-+ .start = FPCI_MEM_PA_BASE,
-+ .end = FPCI_MEM_PA_END,
-+ .flags = IORESOURCE_MEM,
-+};
-+
-+// Luke Lee 03/23/2005 unrem 1 rem 1
-+int __init ftpci_setup_resource(struct resource **resource)
-+{
-+ DBGFPCI("PCI I/O space from %08lX to %08lX\n", pci_io.start,
-+ pci_io.end);
-+ DBGFPCI("PCI Memory space from %08lX to %08lX\n", pci_mem.start,
-+ pci_mem.end);
-+ if (request_resource(&ioport_resource, &pci_io)) {
-+ printk(KERN_ERR "PCI: unable to allocate io region\n");
-+ return -EBUSY; // Luke Lee 03/23/2005 unrem 1
-+ }
-+ if (request_resource(&iomem_resource, &pci_mem)) {
-+ printk(KERN_ERR "PCI: unable to allocate non-prefetchable "
-+ "memory region\n");
-+ return -EBUSY; // Luke Lee 03/23/2005 unrem 1
-+ }
-+
-+ /*
-+ * bus->resource[0] is the IO resource for this bus
-+ * bus->resource[1] is the mem resource for this bus
-+ * bus->resource[2] is the prefetch mem resource for this bus
-+ */
-+
-+ resource[0] = &pci_io;
-+ resource[1] = &pci_mem;
-+ resource[2] = NULL;
-+
-+ return 1; // Luke Lee 03/23/2005 unrem 1
-+}
-+
-+int ftpci_get_irq(void)
-+{
-+ unsigned int status;
-+ ftpci_read_config_dword(pci_bridge->bus, pci_bridge->devfn, 0x4c, &status); // Luke Lee 03/22/2005 mod 1
-+ DBGFPCI("ftpci_get_irq,status=0x%x\n", status);
-+ status = (status >> 28);
-+ if (status & 0x1)
-+ return 0;
-+ if (status & 0x2)
-+ return 1;
-+ if (status & 0x4)
-+ return 2;
-+ if (status & 0x8)
-+ return 3;
-+ return -1;
-+}
-+
-+void ftpci_clear_irq(unsigned int irq)
-+{
-+ //int i;
-+ unsigned int status;
-+ ftpci_read_config_dword(pci_bridge->bus, pci_bridge->devfn, 0x4c, &status); // Luke Lee 03/22/2005 mod 1
-+ if (irq == 0)
-+ status = (status & 0xfffffff) | ((0x1) << 28);
-+ else if (irq == 1)
-+ status = (status & 0xfffffff) | ((0x2) << 28);
-+ else if (irq == 2)
-+ status = (status & 0xfffffff) | ((0x4) << 28);
-+ else if (irq == 3)
-+ status = (status & 0xfffffff) | ((0x8) << 28);
-+ ftpci_write_config_dword(pci_bridge->bus, pci_bridge->devfn, 0x4c, status); // Luke Lee 03/22/2005 mod 1
-+}
-+
-+void ftpci_unmask_irq(unsigned int irq)
-+{
-+ u32 val;
-+ ftpci_read_config_dword(pci_bridge->bus, pci_bridge->devfn,
-+ PCI_INT_MASK, &val);
-+ val |= (PCI_INTA_ENABLE << irq);
-+ ftpci_write_config_dword(pci_bridge->bus, pci_bridge->devfn,
-+ PCI_INT_MASK, val);
-+}
-+
-+void ftpci_mask_irq(unsigned int irq)
-+{
-+ u32 val;
-+ ftpci_read_config_dword(pci_bridge->bus, pci_bridge->devfn,
-+ PCI_INT_MASK, &val);
-+ val &= ~(PCI_INTA_ENABLE << irq);
-+ ftpci_write_config_dword(pci_bridge->bus, pci_bridge->devfn,
-+ PCI_INT_MASK, val);
-+}
-+
-+static int ftpci_probe(unsigned int addr_p)
-+{
-+ unsigned int *addr = (unsigned int *)addr_p;
-+ *(volatile unsigned int *)addr = 0x80000000;
-+ if (*(volatile unsigned int *)addr == 0x80000000) {
-+ DBGFPCI("Faraday FPCI bridge probed ok\n");
-+ ftpci_probed = 1;
-+ } else {
-+ ftpci_probed = 0;
-+ }
-+ *(volatile unsigned int *)addr = 0x0;
-+ return ftpci_probed;
-+}
-+
-+void __init ftpci_preinit(void /**sysdata*/ ) // Luke Lee 03/22/2005 mod 1
-+{
-+ DBGFPCI("ftpci_preinit()\n\r");
-+
-+#ifdef CONFIG_PLAT_AG101
-+ /* Walk around for A321 but remove after leopard pci */
-+ *(volatile unsigned long *)(FPCI_VA_BASE + 0x8) = 0x10;
-+#endif
-+
-+ pci_config_addr = FPCI_VA_BASE + FTPCI_CFG_ADR_REG;
-+ pci_config_data = FPCI_VA_BASE + FTPCI_CFG_DATA_REG;
-+ DBGFPCI("Config addr is %08X, data port is %08X\n",
-+ (int)pci_config_addr, (int)pci_config_data);
-+
-+ if (!ftpci_probe(pci_config_addr))
-+ return;
-+}
-+
-+void ftpci_postinit(void /**sysdata*/ )
-+{
-+ u32 val;
-+ DBGFPCI("ftpci_postinit()\n\r");
-+ pci_bridge = pci_get_device(PCI_BRIDGE_VENID, PCI_BRIDGE_DEVID, NULL);
-+ if (pci_bridge == NULL)
-+ return;
-+ // Enable the Interrupt Mask (INTA/INTB/INTC/INTD)
-+ ftpci_read_config_dword(pci_bridge->bus, pci_bridge->devfn, PCI_INT_MASK, &val); // Luke Lee 03/22/2005 mod 1
-+ val |=
-+ (PCI_INTA_ENABLE | PCI_INTB_ENABLE | PCI_INTC_ENABLE |
-+ PCI_INTD_ENABLE);
-+ ftpci_write_config_dword(pci_bridge->bus, pci_bridge->devfn, PCI_INT_MASK, val); // Luke Lee 03/22/2005 mod 1
-+
-+ // Write DMA Start Address/Size Data to the Bridge configuration space
-+ ftpci_write_config_dword(pci_bridge->bus, pci_bridge->devfn, PCI_MEM_BASE_SIZE1, FTPCI_BASE_ADR_SIZE_1GB); // Luke Lee 03/22/2005 mod 1
-+ DBGFPCI("%s: Post init ok\n", __func__);
-+}
-+
-+/*
-+ * This routine handles multiple bridges.
-+ */
-+static u8 __init fpci_swizzle(struct pci_dev *dev, u8 * pinp)
-+{
-+ // If there are one more bridges on our platfrom, we need to implement this function.
-+ DBGFPCI("a320_swizzle(%X,%X)\n\r", (unsigned)dev, (unsigned)pinp);
-+ return 0;
-+}
-+
-+static int __init fpci_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
-+{
-+ DBGFPCI("a320_map_irq,slot=%d pin=%d\n", PCI_SLOT(dev->devfn), pin);
-+ switch ((PCI_SLOT(dev->devfn) + pin - 8 - 1) % 4) {
-+ case 0:
-+ return IP_IRQ0(0);
-+ case 1:
-+ return IP_IRQ1(0);
-+ case 2:
-+ return IP_IRQ2(0);
-+ case 3:
-+ return IP_IRQ3(0);
-+ default:
-+ printk(KERN_ERR "Not Support Slot %d\n", slot);
-+ break;
-+ }
-+ return -1;
-+}
-+
-+int __init ftpci_setup(int nr, struct pci_sys_data *sys)
-+{
-+ int ret = 0;
-+ if (nr == 0) {
-+ ret = ftpci_setup_resource(sys->resource);
-+// sys->mem_offset = FPCI_MEM_VA_BASE - FPCI_MEM_PA_BASE;
-+ sys->mem_offset = 0;
-+ sys->io_offset = FPCI_IO_VA_BASE - FPCI_IO_PA_BASE;
-+ }
-+ return ret;
-+}
-+
-+static struct pci_bus *__devinit ftpci_scan_bus(int nr,
-+ struct pci_sys_data *sys)
-+{
-+ return pci_scan_bus(sys->busnr, &ftpci_ops, sys);
-+}
-+
-+static struct hw_pci a320_pci __initdata = {
-+ .swizzle = fpci_swizzle,
-+ .map_irq = fpci_map_irq,
-+ .setup = ftpci_setup,
-+ .nr_controllers = 1,
-+ .scan = ftpci_scan_bus,
-+ .preinit = ftpci_preinit, /* The first called init function */
-+ .postinit = ftpci_postinit, /* It is called after hw init and scanned PCI bus */
-+};
-+
-+static int __init fpci_init(void)
-+{
-+#ifdef MODULE
-+ printk(KERN_INFO "Faraday PCI driver Init");
-+#endif
-+ printk(KERN_DEBUG "Init A321 PCI bridge controller\n");
-+ /* Register I/O address range of this PCI Bridge Controller */
-+ DBGFPCI("Name:%s, Base=%lX, End=%lX\n", pcic_resource.name,
-+ pcic_resource.start, pcic_resource.end);
-+ request_resource(&ioport_resource, &pcic_resource);
-+ pci_common_init(&a320_pci);
-+ return 0;
-+}
-+
-+subsys_initcall(fpci_init);
-+
-+EXPORT_SYMBOL(ftpci_probed);
-+EXPORT_SYMBOL(ftpci_clear_irq);
-+EXPORT_SYMBOL(ftpci_get_irq);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/intc.c linux-3.4.113/arch/nds32/platforms/intc.c
---- linux-3.4.113.orig/arch/nds32/platforms/intc.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/intc.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,257 @@
-+/*
-+ * linux/arch/nds32/platforms/intc.c
-+ *
-+ * Faraday FTINTC010 Master Interrupt Controller Device Driver Implementation
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ * Note
-+ *
-+ * This program implements only the master INTC of the platform. Slave INTCs must
-+ * be initialized by themselves.
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/14/2005 Created.
-+ */
-+
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/ioport.h>
-+#include <asm/io.h>
-+
-+#include <asm/intc.h>
-+#include <asm/spec.h>
-+#include <asm/ftpci.h>
-+
-+#define IPMODULE INTC
-+#define IPNAME FTINTC010
-+
-+/*
-+ * Edge trigger IRQ chip methods
-+ */
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+spinlock_t irq_chip_lock;
-+#endif
-+
-+static void intc_ftintc010_ack_irq(struct irq_data *data)
-+{
-+ unsigned int tmp;
-+
-+ // ack and disable
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_lock_irq(&irq_chip_lock);
-+#endif
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_CLEAR_REG) = 1 << data->irq;
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_CLEAR_REG);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MODE_REG);
-+
-+ if (!(tmp & (1UL << data->irq))) { /* level trigger */
-+
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG) &=
-+ ~(1 << data->irq);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG);
-+ }
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_unlock_irq(&irq_chip_lock);
-+#endif
-+}
-+
-+static void intc_ftintc010_mask_irq(struct irq_data *data)
-+{
-+ unsigned int tmp;
-+
-+ // disable
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_lock_irq(&irq_chip_lock);
-+#endif
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG) &=
-+ ~(1 << data->irq);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG);
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_unlock_irq(&irq_chip_lock);
-+#endif
-+}
-+
-+static void intc_ftintc010_mask_ack_irq(struct irq_data *data)
-+{
-+ unsigned int tmp;
-+
-+ // disable
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_lock_irq(&irq_chip_lock);
-+#endif
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG) &=
-+ ~(1 << data->irq);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG);
-+
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_CLEAR_REG) = 1 << data->irq;
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_CLEAR_REG);
-+
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_unlock_irq(&irq_chip_lock);
-+#endif
-+}
-+
-+static void intc_ftintc010_unmask_irq(struct irq_data *data)
-+{
-+ unsigned int tmp;
-+
-+ // enable
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_lock_irq(&irq_chip_lock);
-+#endif
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG) |= 1 << data->irq;
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MASK_REG);
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_unlock_irq(&irq_chip_lock);
-+#endif
-+}
-+
-+static int intc_ftintc010_set_type(struct irq_data *data,
-+ unsigned int flow_type)
-+{
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_lock_irq(&irq_chip_lock);
-+#endif
-+ /*
-+ * IRQ Trigger Mode Register 1: edge
-+ * IRQ Trigger Level Register 1: active high
-+ */
-+
-+ int tmp;
-+
-+ if (flow_type & (IRQF_TRIGGER_FALLING | IRQF_TRIGGER_LOW)) {
-+
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_LEVEL_REG) &=
-+ ~(1UL << data->irq);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_LEVEL_REG);
-+ }
-+
-+ if (flow_type & (IRQF_TRIGGER_RISING | IRQF_TRIGGER_HIGH)) {
-+
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_LEVEL_REG) |=
-+ (1UL << data->irq);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_LEVEL_REG);
-+ }
-+
-+ if (flow_type & (IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING)) {
-+
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MODE_REG) |=
-+ (1UL << data->irq);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MODE_REG);
-+ (irq_desc + data->irq)->handle_irq = handle_edge_irq;
-+ }
-+
-+ if (flow_type & (IRQF_TRIGGER_HIGH | IRQF_TRIGGER_LOW)) {
-+
-+ *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MODE_REG) &=
-+ ~(1UL << data->irq);
-+ tmp = *(volatile unsigned *)(IP_VA_BASE(0) + IRQ_MODE_REG);
-+ (irq_desc + data->irq)->handle_irq = handle_level_irq;
-+ }
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_unlock_irq(&irq_chip_lock);
-+#endif
-+ return 0;
-+}
-+
-+static struct irq_chip intc_ftintc010_chip = {
-+
-+ .irq_ack = intc_ftintc010_ack_irq,
-+ .irq_mask = intc_ftintc010_mask_irq,
-+ .irq_mask_ack = intc_ftintc010_mask_ack_irq,
-+ .irq_unmask = intc_ftintc010_unmask_irq,
-+ .irq_set_type = intc_ftintc010_set_type,
-+};
-+
-+static struct resource intc_resource = {
-+
-+ .name = "Main interrupt controller",
-+ .start = IP_VA_BASE(0),
-+ .end = IP_VA_BASE(0) + IP_VA_SIZE(0),
-+};
-+
-+/*
-+ * Initialization of master interrupt controller, after this INTC is
-+ * enabled, the rest of Linux initialization codes can then be completed.
-+ * For example, timer interrupts and UART interrupts must be enabled during
-+ * the boot process.
-+ */
-+void __init intc_ftintc010_init_irq(void)
-+{
-+ int i, edge;
-+
-+#if defined(CONFIG_SMP) && defined(CONFIG_IRQ_PER_CPU)
-+ spin_lock_init(&irq_chip_lock);
-+#endif
-+ /* Initialize the INTC */
-+ outl(0x00000000, IP_VA_BASE(0) + IRQ_MASK_REG);
-+ outl(0x00000000, IP_VA_BASE(0) + FIQ_MASK_REG);
-+ outl(0xffffffff, IP_VA_BASE(0) + IRQ_CLEAR_REG);
-+ outl(0xffffffff, IP_VA_BASE(0) + FIQ_CLEAR_REG);
-+ outl(PLATFORM_IRQ_TRIGGER_MODE, IP_VA_BASE(0) + IRQ_MODE_REG);
-+ /* FTINTC010: bit 0=active high or rising edge, 1=active low or falling edge. */
-+ outl(PLATFORM_IRQ_TRIGGER_LEVEL, IP_VA_BASE(0) + IRQ_LEVEL_REG);
-+
-+ /* Register all IRQ */
-+ for (i = PLATFORM_IRQ_BASE, edge = 1;
-+ i < PLATFORM_IRQ_BASE + PLATFORM_IRQ_TOTALCOUNT; i++, edge <<= 1) {
-+
-+ irq_set_chip(i, &intc_ftintc010_chip);
-+
-+ if (PLATFORM_IRQ_TRIGGER_MODE & edge) /* edge trigger */
-+ irq_set_handler(i, handle_edge_irq);
-+
-+ else /* level trigger */
-+ irq_set_handler(i, handle_level_irq);
-+ }
-+
-+ /* Register I/O address range of this INTC */
-+ request_resource(&ioport_resource, &intc_resource);
-+
-+}
-+
-+unsigned int get_IntSrc(void)
-+{
-+ unsigned int irq_status, irq = 31;
-+
-+ irq_status = inl(IP_VA_BASE(0) + IRQ_STATUS_REG);
-+ if (irq_status == 0)
-+ return 32;
-+ if (irq_status & 0x0000ffff) {
-+ irq -= 16;
-+ irq_status <<= 16;
-+ }
-+ if (irq_status & 0x00ff0000) {
-+ irq -= 8;
-+ irq_status <<= 8;
-+ }
-+ if (irq_status & 0x0f000000) {
-+ irq -= 4;
-+ irq_status <<= 4;
-+ }
-+ if (irq_status & 0x30000000) {
-+ irq -= 2;
-+ irq_status <<= 2;
-+ }
-+ if (irq_status & 0x40000000) {
-+ irq -= 1;
-+ }
-+ return irq;
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/Kconfig linux-3.4.113/arch/nds32/platforms/Kconfig
---- linux-3.4.113.orig/arch/nds32/platforms/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/Kconfig 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,122 @@
-+choice
-+ prompt "platform type"
-+ default PLAT_AG101P
-+
-+config PLAT_VEP
-+ bool "vep platform"
-+ select CPU_CUSTOM
-+ select PLATFORM_INTC
-+
-+config PLAT_AG101
-+ bool "ag101 platform"
-+ select CPU_N1213
-+ select CPU_N1213_43U1HA0
-+ select PLATFORM_INTC
-+
-+config PLAT_AG102
-+ bool "ag102 platform"
-+ select CPU_N1233F
-+ select PLATFORM_AMIC
-+
-+config PLAT_AG101P
-+ bool "ag101p platform"
-+ select CPU_CUSTOM
-+ select PLATFORM_INTC if !IVIC
-+ select PLATFORM_NOINTC if IVIC
-+
-+config PLAT_QEMU
-+ bool "qemu platform"
-+ select CPU_CUSTOM
-+ select PLATFORM_INTC
-+endchoice
-+
-+config PLATFORM_NOINTC
-+ def_bool n
-+ depends on PLAT_AG101P
-+
-+config PLATFORM_INTC
-+ def_bool n
-+ depends on !PLAT_AG102
-+
-+config PLATFORM_AMIC
-+ def_bool n
-+ depends on PLAT_AG102
-+
-+config ARCH_WANT_OPTIONAL_GPIOLIB
-+ bool "Arch Want Optional GPIOLIB"
-+ default y
-+
-+if PLAT_VEP
-+source "arch/nds32/platforms/vep/Kconfig"
-+endif
-+
-+if PLAT_AG101
-+source "arch/nds32/platforms/ag101/Kconfig"
-+endif
-+
-+if PLAT_AG102
-+source "arch/nds32/platforms/ag102/Kconfig"
-+endif
-+
-+if PLAT_AG101P
-+source "arch/nds32/platforms/ag101p/Kconfig"
-+endif
-+
-+if PLAT_QEMU
-+source "arch/nds32/platforms/qemu/Kconfig"
-+endif
-+
-+menu "Common Platform Options"
-+
-+config PLATFORM_AHBDMA
-+ tristate "AHB DMA Support"
-+ help
-+ AHB DMA service API support for other device drivers
-+
-+config PLATFORM_APBDMA
-+ tristate "APB DMA Support"
-+ help
-+ AHB DMA service API support for other device drivers
-+
-+config SYS_CLK
-+ int "AHB System Clock"
-+ default 67737600
-+ help
-+ Manual setting of AHB clock, must match the jumper setting on
-+ the board, or the system time won't be correctly calculated.
-+ Notice that even when AUTO_SYS_CLK is ON, this value is still
-+ required for adjusting minor time offsets. However, the influence
-+ should be within micro-second to nano-second scale.
-+
-+config UART_CLK
-+ int "UART Clock"
-+ default 18432000
-+ help
-+ Change the UART clock in case of non-3.6864MHz OSC is used as main
-+ clock source, or an external UART clock source is fed from GPIO23.
-+ To support external UART clock from GPIO23, set PMU
-+ "Multi-Function Port Setting Register" bit #8 (UartClkSel) to 1.
-+ This control register can be found at physical address 0x98100028
-+ If this options is changed, please also append "38400" to your
-+ kernel command line, e.g.:
-+ console=uart,shift,2,io,0xF9820000,38400
-+ Note: For A320, the default UART clock is obtained by = 5 * OSC =
-+ 5 * 3.6864MHz = 18.432MHz.
-+
-+menu "Memory configuration"
-+
-+config SDRAM_SIZE
-+ hex "SDRAM Size (hex)"
-+ default 4000000
-+ ---help---
-+ RAM size
-+
-+config MEMORY_START
-+ hex "Physical memory start address"
-+ default "0x00000000"
-+ ---help---
-+ Physical memory start address, you may modify it if it is porting to
-+ a new SoC with different start address.
-+endmenu
-+
-+endmenu
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/Makefile linux-3.4.113/arch/nds32/platforms/Makefile
---- linux-3.4.113.orig/arch/nds32/platforms/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/Makefile 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,25 @@
-+obj-y := timer.o
-+
-+ifdef CONFIG_FUNCTION_TRACER
-+CFLAGS_REMOVE_timer.o = -pg
-+endif
-+
-+obj-$(CONFIG_PLATFORM_NOINTC) += nointc.o
-+obj-$(CONFIG_PLATFORM_INTC) += intc.o
-+obj-$(CONFIG_PLATFORM_AMIC) += amic.o
-+
-+ifeq ("$(CONFIG_PLATFORM_AHBDMA)", "y")
-+ obj-y += dmad_intc.o dmad.o
-+else
-+ ifeq ("$(CONFIG_PLATFORM_APBDMA)", "y")
-+ obj-y += dmad_intc.o dmad.o
-+ endif
-+endif
-+
-+obj-$(CONFIG_PCI) += ftpci.o pci_intc.o
-+
-+obj-$(CONFIG_PLAT_VEP) += vep/
-+obj-$(CONFIG_PLAT_AG101) += ag101/
-+obj-$(CONFIG_PLAT_AG102) += ag102/
-+obj-$(CONFIG_PLAT_AG101P) += ag101p/
-+obj-$(CONFIG_PLAT_QEMU) += qemu/
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/nointc.c linux-3.4.113/arch/nds32/platforms/nointc.c
---- linux-3.4.113.orig/arch/nds32/platforms/nointc.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/nointc.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,134 @@
-+/*
-+ * linux/arch/nds32/platforms/intc.c
-+ *
-+ * Faraday FTINTC010 Master Interrupt Controller Device Driver Implementation
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ */
-+
-+#include <linux/irq.h>
-+
-+static void nointc_ack_irq(struct irq_data *data)
-+{
-+ SET_INT_PEND2(1 << data->irq);
-+#if 0
-+ asm volatile ("mtsr %0, $INT_PEND2\n\t"
-+ "dsb\n\t"::"r" (1 << data->irq));
-+#endif
-+#if 0
-+ asm volatile ("mfsr $r6, $INT_MASK2\n\t"
-+ "and $r6, $r6,%0\n\t"
-+ "mtsr $r6, $INT_MASK2\n\t"
-+ "dsb\n\t"::"r" (~(1 << data->irq)):"$r6");
-+#endif
-+}
-+
-+static void nointc_mask_irq(struct irq_data *data)
-+{
-+ unsigned long int_mask2 = GET_INT_MASK2();
-+ SET_INT_MASK2(int_mask2 & (~(1 << data->irq)));
-+#if 0
-+ asm volatile ("mfsr $r6, $INT_MASK2\n\t"
-+ "and $r6, $r6,%0\n\t"
-+ "mtsr $r6, $INT_MASK2\n\t"
-+ "dsb\n\t"::"r" (~(1 << data->irq)):"$r6");
-+#endif
-+}
-+
-+static void nointc_mask_ack_irq(struct irq_data *data)
-+{
-+ unsigned long int_mask2 = GET_INT_MASK2();
-+ SET_INT_MASK2(int_mask2 & (~(1 << data->irq)));
-+ SET_INT_PEND2(1 << data->irq);
-+#if 0
-+ asm volatile ("not $r7, %0\n\t"
-+ "mfsr $r6, $INT_MASK2\n\t"
-+ "and $r6, $r6, $r7\n\t"
-+ "mtsr $r6, $INT_MASK2\n\t"
-+ "mtsr %0, $INT_PEND2\n\t"
-+ "dsb\n\t"::"r" (1 << data->irq):"$r6", "$r7");
-+#endif
-+
-+}
-+
-+static void nointc_unmask_irq(struct irq_data *data)
-+{
-+ unsigned long int_mask2 = GET_INT_MASK2();
-+ SET_INT_MASK2(int_mask2 | (1 << data->irq));
-+#if 0
-+ asm volatile ("mfsr $r6, $INT_MASK2\n\t"
-+ "or $r6, $r6,%0\n\t"
-+ "mtsr $r6, $INT_MASK2\n\t"
-+ "dsb\n\t"::"r" (1 << data->irq):"$r6");
-+#endif
-+}
-+
-+static int nointc_set_type(struct irq_data *data, unsigned int flow_type)
-+{
-+ printk(KERN_WARNING "interrupt type is not configurable\n");
-+ return 0;
-+}
-+
-+static struct irq_chip nointc_chip = {
-+
-+ .irq_ack = nointc_ack_irq,
-+ .irq_mask = nointc_mask_irq,
-+ .irq_mask_ack = nointc_mask_ack_irq,
-+ .irq_unmask = nointc_unmask_irq,
-+ .irq_set_type = nointc_set_type,
-+};
-+
-+static unsigned int __initdata nivic_map[6] = { 6, 2, 10, 16, 24, 32 };
-+
-+void __init nointc_init_irq(void)
-+{
-+ int i;
-+ unsigned long int_trigger_type, int_vec_base, nivic;
-+
-+ int_vec_base = GET_IVB();
-+
-+#if 0
-+ asm volatile ("mfsr %0, $IVB\n":"=r" (int_vec_base));
-+#endif
-+
-+ if (((int_vec_base & IVB_mskIVIC_VER) >> IVB_offIVIC_VER) == 0) {
-+ panic("Unable to use NOINTC option to boot on this cpu\n");
-+ }
-+
-+ nivic = (int_vec_base & IVB_mskNIVIC) >> IVB_offNIVIC;
-+ if (nivic >= (sizeof nivic_map / sizeof nivic_map[0])) {
-+ panic
-+ ("The number of input for IVIC Controller is not supported on this cpu\n");
-+ }
-+ nivic = nivic_map[nivic];
-+
-+ int_trigger_type = GET_INT_TRIGGER();
-+#if 0
-+ asm volatile ("mfsr %0, $INT_TRIGGER\n":"=r" (int_trigger_type));
-+#endif
-+
-+ for (i = 0; i < nivic; i++) {
-+ irq_set_chip(i, &nointc_chip);
-+ if (int_trigger_type & (1 << i))
-+ /* edge-triggered */
-+ irq_set_handler(i, handle_edge_irq);
-+ else
-+ /* level-triggered */
-+ irq_set_handler(i, handle_level_irq);
-+ }
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/pci_intc.c linux-3.4.113/arch/nds32/platforms/pci_intc.c
---- linux-3.4.113.orig/arch/nds32/platforms/pci_intc.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/pci_intc.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,93 @@
-+/*
-+ * linux/arch/nds32/platforms/pci_intc.c
-+ *
-+ * Faraday PCI Bridge Interrupt Process Driver Implementation
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2008 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ *
-+ * ChangeLog
-+ *
-+ * Luke Lee 09/15/2005 Created.
-+ * Luke Lee 09/27/2005 Fixed for parent chip registration and notification.
-+ * Peter Liao 09/28/2005 Port for PCI IP
-+ */
-+
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/ioport.h>
-+#include <asm/io.h>
-+
-+#include <asm/spec.h>
-+#include <asm/ftpci.h>
-+
-+#define IPMODULE PCIC
-+#define IPNAME FPCI010
-+
-+/*
-+ * Level trigger IRQ chip methods
-+ */
-+
-+static void intc_ftpci100_level_ack_irq(unsigned int irq)
-+{
-+ ftpci_clear_irq(irq - PLATFORM_PCI_IRQ_BASE);
-+}
-+
-+static void intc_ftpci100_level_mask_irq(unsigned int irq)
-+{
-+ ftpci_mask_irq(irq - PLATFORM_PCI_IRQ_BASE);
-+}
-+
-+static void intc_ftpci100_level_unmask_irq(unsigned int irq)
-+{
-+ ftpci_unmask_irq(irq - PLATFORM_PCI_IRQ_BASE);
-+}
-+
-+static struct irq_chip intc_ftpci100_level_chip = {
-+ .ack = intc_ftpci100_level_ack_irq,
-+ .mask = intc_ftpci100_level_mask_irq,
-+ .unmask = intc_ftpci100_level_unmask_irq,
-+};
-+
-+void pci_irq_rounter(unsigned int irq, struct irq_desc *desc)
-+{
-+ int pci_irq;
-+ struct irq_desc *pci_desc;
-+
-+ desc->chip->mask(irq);
-+ desc->chip->ack(irq);
-+
-+ pci_irq = ftpci_get_irq();
-+ if (pci_irq >= 0) {
-+ pci_irq += PCIC_FTPCI100_IRQ0;
-+ pci_desc = irq_desc + pci_irq;
-+ pci_desc->handle_irq(pci_irq, pci_desc);
-+ }
-+
-+ desc->chip->unmask(irq);
-+}
-+
-+int __init intc_ftpci100_init_irq(void)
-+{
-+ int i;
-+
-+ /* Register all IRQ */
-+ for (i = PCIC_FTPCI100_IRQ0;
-+ i < PCIC_FTPCI100_IRQ0 + PCIC_FTPCI100_IRQ_COUNT; i++) {
-+ // level trigger
-+ set_irq_chip(i, &intc_ftpci100_level_chip);
-+ set_irq_handler(i, handle_level_irq);
-+ }
-+#ifndef CONFIG_PLAT_AG101
-+ set_irq_chained_handler(PLATFORM_PCI_IRQ, pci_irq_rounter);
-+#endif
-+
-+ return 0;
-+}
-+
-+subsys_initcall(intc_ftpci100_init_irq);
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/qemu/devices.c linux-3.4.113/arch/nds32/platforms/qemu/devices.c
---- linux-3.4.113.orig/arch/nds32/platforms/qemu/devices.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/qemu/devices.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,124 @@
-+#include <linux/serial_8250.h>
-+#include <asm/mach-types.h>
-+#include <asm/sizes.h>
-+#include <asm/mach/arch.h>
-+#include <asm/mach/map.h>
-+#include <asm/spec.h>
-+#include <asm/intc.h>
-+#include <asm/timer.h>
-+
-+const struct map_desc platform_io_desc[] __initdata = {
-+ {UART0_VA_BASE, UART0_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {UART1_VA_BASE, UART1_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {INTC_FTINTC010_0_VA_BASE, INTC_FTINTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {TIMER_FTTMR010_0_VA_BASE, TIMER_FTTMR010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SSP_FTSSP010_0_VA_BASE, SSP_FTSSP010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {PMU_FTPMU010_0_VA_BASE, PMU_FTPMU010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {MAC_FTMAC100_0_VA_BASE, MAC_FTMAC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SDC_FTSDC010_0_VA_BASE, SDC_FTSDC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {RTC_FTRTC010_0_VA_BASE, RTC_FTRTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {WDT_FTWDT010_0_VA_BASE, WDT_FTWDT010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {GPIO_FTGPIO010_0_VA_BASE, GPIO_FTGPIO010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {CFC_FTCFC010_0_VA_BASE, CFC_FTCFC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {LCD_FTLCDC100_0_VA_BASE, LCD_FTLCDC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {I2C_FTI2C010_0_VA_BASE, I2C_FTI2C010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {DMAC_FTDMAC020_0_VA_BASE, DMAC_FTDMAC020_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {APBBRG_FTAPBBRG020S_0_VA_BASE, APBBRG_FTAPBBRG020S_0_PA_BASE,
-+ PAGE_SIZE, MT_DEVICE_NCB},
-+ {PCIIO_0_VA_BASE, PCIIO_0_PA_BASE, 0x000FF000, MT_DEVICE_NCB},
-+ {PCIC_FTPCI100_0_VA_BASE, PCIC_FTPCI100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {LED_VA_BASE, LED_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {SDMC_FTSDMC021_VA_BASE, SDMC_FTSDMC021_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {L2CC_VA_BASE, L2CC_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB}
-+};
-+
-+static void __init platform_map_io(void)
-+{
-+ iotable_init((struct map_desc *)platform_io_desc,
-+ ARRAY_SIZE(platform_io_desc));
-+}
-+
-+static struct uart_port uart0 = {
-+ .membase = (void __iomem *)UART0_VA_BASE,
-+ .irq = UART0_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 0,
-+ .mapbase = UART0_PA_BASE,
-+};
-+
-+static struct uart_port uart1 = {
-+ .membase = (void __iomem *)UART1_VA_BASE,
-+ .irq = UART1_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 1,
-+ .mapbase = UART1_PA_BASE,
-+};
-+
-+static void __init soc_init(void)
-+{
-+ early_serial_setup(&uart0);
-+ early_serial_setup(&uart1);
-+}
-+
-+static struct resource smc91x_resources[] = {
-+ [0] = {
-+ .name = "smc91x",
-+ .start = 0x92100000,
-+ .end = 0x92110000,
-+ .flags = IORESOURCE_MEM,
-+ },
-+ [1] = {
-+ .start = 25,
-+ .end = 25,
-+ .flags = IORESOURCE_IRQ,
-+ },
-+};
-+
-+static struct platform_device smc91x_device = {
-+ .name = "smc91x",
-+ .id = 0,
-+ .num_resources = ARRAY_SIZE(smc91x_resources),
-+ .resource = smc91x_resources,
-+};
-+
-+static __init int smc_init(void)
-+{
-+ int ret;
-+ ret = platform_device_register(&smc91x_device);
-+ if (ret == 0)
-+ printk("smc is installed now.\n");
-+ else
-+ printk("smc failed.\n");
-+ return 0;
-+}
-+
-+module_init(smc_init);
-+
-+MACHINE_START(FARADAY, PLATFORM_NAME)
-+ .param_offset = BOOT_PARAMETER_PA_BASE,
-+ .map_io = platform_map_io,
-+ .init_irq = platform_init_irq,
-+ .timer = &platform_timer, /* defined in timer.c */
-+ .init_machine = soc_init,
-+MACHINE_END
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/qemu/Kconfig linux-3.4.113/arch/nds32/platforms/qemu/Kconfig
---- linux-3.4.113.orig/arch/nds32/platforms/qemu/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/qemu/Kconfig 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,3 @@
-+menu "QEMU Platform Options"
-+
-+endmenu
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/qemu/Makefile linux-3.4.113/arch/nds32/platforms/qemu/Makefile
---- linux-3.4.113.orig/arch/nds32/platforms/qemu/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/qemu/Makefile 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1 @@
-+obj-y = devices.o
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/timer.c linux-3.4.113/arch/nds32/platforms/timer.c
---- linux-3.4.113.orig/arch/nds32/platforms/timer.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/timer.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,250 @@
-+/*
-+ * linux/arch/nds32/platforms/timer.c
-+ *
-+ * Faraday FTTMR010 Timer Device Driver Implementation
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ * Copyright (C) 2009 Andes Technology Corporation
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License as published by
-+ * the Free Software Foundation; either version 2 of the License, or
-+ * (at your option) any later version.
-+ *
-+ * This program is distributed in the hope that it will be useful,
-+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
-+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-+ * GNU General Public License for more details.
-+ *
-+ * You should have received a copy of the GNU General Public License
-+ * along with this program; if not, write to the Free Software
-+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
-+ *
-+ */
-+
-+#include <linux/irq.h>
-+#include <linux/clocksource.h>
-+#include <linux/clockchips.h>
-+
-+#include <linux/interrupt.h>
-+#include <linux/ioport.h>
-+#include <linux/cpufreq.h>
-+
-+#include <asm/mach/time.h>
-+#include <asm/timer.h>
-+#include <asm/spec.h>
-+
-+#define REG32_TMR(x) *(volatile unsigned long *)(TIMER_FTTMR010_VA_BASE + (x))
-+#define APB_CLK_IN (AHB_CLK_IN / 2)
-+
-+static struct resource timer_resource = {
-+ .name = "Timer 1~3",
-+ .start = TIMER_FTTMR010_VA_BASE,
-+ .end = TIMER_FTTMR010_VA_LIMIT,
-+};
-+
-+static inline cycle_t clocksource_read_cycles(struct clocksource *cs)
-+{
-+ return (cycle_t) REG32_TMR(TIMER3_COUNT);
-+}
-+
-+static void clksrc_fttmr010_resume(struct clocksource *cs)
-+{
-+ REG32_TMR(TIMER_INTRMASK) |= TM3MATCH1 | TM3MATCH2 | TM3OVERFLOW;
-+ REG32_TMR(TIMER_TMCR) |= TM3UPDOWN | TM3ENABLE;
-+}
-+
-+static struct clocksource clksrc_fttmr010 = {
-+ .name = "fttmr010_tm1",
-+ .rating = 300,
-+ .read = clocksource_read_cycles,
-+ .mask = CLOCKSOURCE_MASK(32),
-+ .shift = 21,
-+ .flags = CLOCK_SOURCE_IS_CONTINUOUS,
-+ .resume = clksrc_fttmr010_resume,
-+};
-+
-+static void __init fttmr010_clocksource_init(void)
-+{
-+ clksrc_fttmr010.mult =
-+ clocksource_hz2mult(APB_CLK_IN, clksrc_fttmr010.shift);
-+
-+ REG32_TMR(TIMER3_LOAD) = 0;
-+ REG32_TMR(TIMER_INTRMASK) |= TM3MATCH1 | TM3MATCH2 | TM3OVERFLOW;
-+ REG32_TMR(TIMER_TMCR) |= TM3UPDOWN | TM3ENABLE;
-+ if (clocksource_register(&clksrc_fttmr010))
-+ printk(KERN_ERR "Error: failed to register %s\n",
-+ clksrc_fttmr010.name);
-+}
-+
-+static int fttmr010_set_next_event(unsigned long cycles,
-+ struct clock_event_device *evt)
-+{
-+ REG32_TMR(TIMER1_LOAD) = cycles;
-+ return 0;
-+}
-+
-+static void fttmr010_set_mode(enum clock_event_mode mode,
-+ struct clock_event_device *evt)
-+{
-+ switch (mode) {
-+ case CLOCK_EVT_MODE_ONESHOT:
-+ REG32_TMR(TIMER1_LOAD) = 0xffffffff;
-+ REG32_TMR(TIMER_TMCR) |= TM1ENABLE;
-+ break;
-+
-+ case CLOCK_EVT_MODE_PERIODIC:
-+ REG32_TMR(TIMER1_COUNT) = APB_CLK_IN / HZ - 1;
-+ REG32_TMR(TIMER1_LOAD) = APB_CLK_IN / HZ - 1;
-+ REG32_TMR(TIMER_TMCR) |= TM1ENABLE;
-+ break;
-+ case CLOCK_EVT_MODE_UNUSED:
-+ break;
-+ case CLOCK_EVT_MODE_SHUTDOWN:
-+ REG32_TMR(TIMER_TMCR) &= ~TM1ENABLE;
-+ break;
-+ case CLOCK_EVT_MODE_RESUME:
-+ REG32_TMR(TIMER_INTRMASK) |= TM1MATCH1 | TM1MATCH2;
-+ REG32_TMR(TIMER_TMCR) |= TM1ENABLE | TM1OFENABLE;
-+ break;
-+ }
-+}
-+
-+static struct clock_event_device clockevent_fttmr010 = {
-+ .name = "fttmr010_tm1",
-+ .features = CLOCK_EVT_FEAT_ONESHOT | CLOCK_EVT_FEAT_PERIODIC,
-+ .shift = 32,
-+ .cpumask = cpu_all_mask,
-+ .set_next_event = fttmr010_set_next_event,
-+ .set_mode = fttmr010_set_mode,
-+};
-+
-+static irqreturn_t timer1_interrupt(int irq, void *dev_id)
-+{
-+ struct clock_event_device *evt = dev_id;
-+
-+ REG32_TMR(TIMER_INTRSTATE) = TM1MATCH1 | TM1MATCH2 | TM1OVERFLOW;
-+
-+ evt->event_handler(evt);
-+
-+ return IRQ_HANDLED;
-+}
-+
-+static struct irqaction timer1_irq = {
-+ .name = "Timer Tick",
-+ .flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL,
-+ .handler = timer1_interrupt,
-+ .dev_id = &clockevent_fttmr010
-+};
-+
-+static void __init fttmr010_clockevent_init(void)
-+{
-+ clockevent_fttmr010.mult =
-+ div_sc(APB_CLK_IN, NSEC_PER_SEC, clockevent_fttmr010.shift);
-+ clockevent_fttmr010.max_delta_ns =
-+ clockevent_delta2ns(0xffffffff, &clockevent_fttmr010);
-+ clockevent_fttmr010.min_delta_ns =
-+ clockevent_delta2ns(3, &clockevent_fttmr010);
-+
-+ clockevents_register_device(&clockevent_fttmr010);
-+ setup_irq(TIMER_FTTMR010_IRQ0, &timer1_irq);
-+}
-+
-+static void fttmr010_resume(void)
-+{
-+}
-+
-+#ifdef CONFIG_CPU_FREQ
-+void ag102_calc_ahb_clk(void);
-+static int fttmr010_cpufreq_notifier(struct notifier_block *nb,
-+ unsigned long val, void *data)
-+{
-+ if (val == CPUFREQ_POSTCHANGE) {
-+
-+ unsigned long flags;
-+#ifdef CONFIG_PLAT_AG102
-+ ag102_calc_ahb_clk();
-+#endif
-+ local_irq_save(flags);
-+
-+ clocksource_unregister(&clksrc_fttmr010);
-+
-+ clksrc_fttmr010.mult =
-+ clocksource_hz2mult(APB_CLK_IN, clksrc_fttmr010.shift);
-+#ifdef CONFIG_PLAT_AG101
-+ clksrc_fttmr010.mult_orig =
-+ clocksource_hz2mult(APB_CLK_IN, clksrc_fttmr010.shift);
-+#endif
-+
-+ if (clocksource_register(&clksrc_fttmr010))
-+ printk(KERN_ERR "Error: failed to re-register %s\n",
-+ clksrc_fttmr010.name);
-+ else
-+ printk("Re-register clock source %s\n",
-+ clksrc_fttmr010.name);
-+
-+ local_irq_restore(flags);
-+
-+ clockevent_fttmr010.mult =
-+ div_sc(APB_CLK_IN, NSEC_PER_SEC, clockevent_fttmr010.shift);
-+
-+#ifdef CONFIG_PLAT_AG102
-+ printk("Add timer clock modifier...\n");
-+ fttmr010_set_mode(CLOCK_EVT_MODE_PERIODIC, 0);
-+#endif
-+ }
-+
-+ return 0;
-+}
-+
-+static struct notifier_block fttmr010_cpufreq_notifier_block = {
-+ .notifier_call = fttmr010_cpufreq_notifier
-+};
-+
-+static int __init fttmr010_init_cpufreq(void)
-+{
-+ if (cpufreq_register_notifier(&fttmr010_cpufreq_notifier_block,
-+ CPUFREQ_TRANSITION_NOTIFIER))
-+ printk("fttmr010: Failed to setup cpufreq notifier\n");
-+
-+ return 0;
-+}
-+
-+core_initcall(fttmr010_init_cpufreq);
-+#endif
-+
-+static int clksrc_init;
-+static void __init fttmr010_init(void)
-+{
-+ request_resource(&ioport_resource, &timer_resource);
-+
-+ printk
-+ ("FTTMR010 timer 1 installed on IRQ %d, with clock %d at %d HZ.\r\n",
-+ TIMER_FTTMR010_IRQ0, APB_CLK_IN, HZ);
-+
-+ REG32_TMR(TIMER_TMCR) &=
-+ ~(TM1ENABLE | TM1CLOCK | TM1OFENABLE | TM1UPDOWN);
-+ REG32_TMR(TIMER_INTRMASK) |= TM1MATCH1 | TM1MATCH2;
-+ REG32_TMR(TIMER_TMCR) |= TM1OFENABLE;
-+
-+ fttmr010_clocksource_init();
-+ fttmr010_clockevent_init();
-+ clksrc_init = 1;
-+}
-+
-+struct sys_timer platform_timer = {
-+ .init = fttmr010_init,
-+ .resume = fttmr010_resume,
-+};
-+
-+unsigned long long sched_clock(void)
-+{
-+ if (clksrc_init)
-+ return
-+ clocksource_cyc2ns(clocksource_read_cycles
-+ (&clksrc_fttmr010), clksrc_fttmr010.mult,
-+ clksrc_fttmr010.shift);
-+ else
-+ return (unsigned long long)(jiffies - INITIAL_JIFFIES)
-+ * (NSEC_PER_SEC / HZ);
-+}
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/vep/devices.c linux-3.4.113/arch/nds32/platforms/vep/devices.c
---- linux-3.4.113.orig/arch/nds32/platforms/vep/devices.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/vep/devices.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,83 @@
-+#include <linux/serial_8250.h>
-+#include <asm/mach-types.h>
-+#include <asm/sizes.h>
-+#include <asm/mach/arch.h>
-+#include <asm/mach/map.h>
-+#include <asm/spec.h>
-+#include <asm/intc.h>
-+#include <asm/timer.h>
-+
-+const struct map_desc platform_io_desc[] __initdata = {
-+ {UART0_VA_BASE, UART0_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {UART1_VA_BASE, UART1_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {INTC_FTINTC010_0_VA_BASE, INTC_FTINTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {TIMER_FTTMR010_0_VA_BASE, TIMER_FTTMR010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SSP_FTSSP010_0_VA_BASE, SSP_FTSSP010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {PMU_FTPMU010_0_VA_BASE, PMU_FTPMU010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {MAC_FTMAC100_0_VA_BASE, MAC_FTMAC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {SDC_FTSDC010_0_VA_BASE, SDC_FTSDC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {RTC_FTRTC010_0_VA_BASE, RTC_FTRTC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {WDT_FTWDT010_0_VA_BASE, WDT_FTWDT010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {GPIO_FTGPIO010_0_VA_BASE, GPIO_FTGPIO010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {CFC_FTCFC010_0_VA_BASE, CFC_FTCFC010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {LCD_FTLCDC100_0_VA_BASE, LCD_FTLCDC100_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {I2C_FTI2C010_0_VA_BASE, I2C_FTI2C010_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {DMAC_FTDMAC020_0_VA_BASE, DMAC_FTDMAC020_0_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {APBBRG_FTAPBBRG020S_0_VA_BASE, APBBRG_FTAPBBRG020S_0_PA_BASE,
-+ PAGE_SIZE, MT_DEVICE_NCB},
-+ {LED_VA_BASE, LED_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB},
-+ {SDMC_FTSDMC021_VA_BASE, SDMC_FTSDMC021_PA_BASE, PAGE_SIZE,
-+ MT_DEVICE_NCB},
-+ {L2CC_VA_BASE, L2CC_PA_BASE, PAGE_SIZE, MT_DEVICE_NCB}
-+};
-+
-+static void __init platform_map_io(void)
-+{
-+ iotable_init((struct map_desc *)platform_io_desc,
-+ ARRAY_SIZE(platform_io_desc));
-+}
-+
-+static struct uart_port uart0 = {
-+ .membase = (void __iomem *)UART0_VA_BASE,
-+ .irq = UART0_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 0,
-+ .mapbase = UART0_PA_BASE,
-+};
-+
-+static struct uart_port uart1 = {
-+ .membase = (void __iomem *)UART1_VA_BASE,
-+ .irq = UART1_IRQ,
-+ .uartclk = CONFIG_UART_CLK,
-+ .regshift = 2,
-+ .iotype = UPIO_MEM,
-+ .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
-+ .line = 1,
-+ .mapbase = UART1_PA_BASE,
-+};
-+
-+static void __init soc_init(void)
-+{
-+ early_serial_setup(&uart0);
-+ early_serial_setup(&uart1);
-+}
-+
-+MACHINE_START(FARADAY, PLATFORM_NAME)
-+ .param_offset = BOOT_PARAMETER_PA_BASE,.map_io = platform_map_io,.init_irq = platform_init_irq,.timer = &platform_timer, /* defined in timer.c */
-+ .init_machine = soc_init, MACHINE_END
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/vep/Kconfig linux-3.4.113/arch/nds32/platforms/vep/Kconfig
---- linux-3.4.113.orig/arch/nds32/platforms/vep/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/vep/Kconfig 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,7 @@
-+menu "VEP Platform Options"
-+
-+config CACHE_L2
-+ bool "Support L2 cache"
-+ default n
-+
-+endmenu
-diff -Nur linux-3.4.113.orig/arch/nds32/platforms/vep/Makefile linux-3.4.113/arch/nds32/platforms/vep/Makefile
---- linux-3.4.113.orig/arch/nds32/platforms/vep/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/arch/nds32/platforms/vep/Makefile 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1 @@
-+obj-y = devices.o
-diff -Nur linux-3.4.113.orig/build_linux.sh linux-3.4.113/build_linux.sh
---- linux-3.4.113.orig/build_linux.sh 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/build_linux.sh 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,202 @@
-+#!/bin/sh
-+
-+export ARCH=nds32
-+
-+print_help()
-+{
-+ echo "Usage: <platform> [platform_defconfig] [--bootm] [--ramdisk=<ramdisk absolute path>]"
-+ echo "Stop Building."
-+ exit
-+}
-+
-+BUILDBOOTM=0
-+BUILDBOOTPIMAGE=0
-+BUILDHEADERS=0
-+
-+case "$1" in
-+ qemu)
-+ TARGET=qemu_defconfig
-+ IMAGE=qemu
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ vep-be)
-+ TARGET=vep-be_defconfig
-+ IMAGE=vep-be
-+ export CROSS_COMPILE=nds32be-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ vep-le)
-+ TARGET=vep-le_defconfig
-+ IMAGE=vep-le
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ xc5)
-+ TARGET=xc5_defconfig
-+ IMAGE=xc5
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ xc5_8k)
-+ TARGET=xc5_8k_defconfig
-+ IMAGE=xc5_8k
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ ag101a0)
-+ TARGET=ag101a0_defconfig
-+ IMAGE=ag101a0
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ ag101b0)
-+ TARGET=ag101b0_defconfig
-+ IMAGE=ag101b0
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ ag102)
-+ TARGET=ag102_defconfig
-+ IMAGE=ag102
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ u200)
-+ TARGET=u200_defconfig
-+ IMAGE=u200
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ xc5-qa)
-+ TARGET=xc5-qa_defconfig
-+ IMAGE=xc5-qa
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ ag101-qa)
-+ TARGET=ag101-qa_defconfig
-+ IMAGE=ag101-qa
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+ ;;
-+ *)
-+ if [ $# = 1 ]; then
-+ echo "No defconfig is given."
-+ print_help
-+ fi
-+ if [ ! -e $2 ]; then
-+ echo "Given defconfig is not exist."
-+ print_help
-+ elif [ ! -f $2 ]; then
-+ echo "Given defconfig is not a file."
-+ print_help
-+ elif [ ! -s $2 ]; then
-+ echo "Given defconfig is size 0."
-+ print_help
-+ elif [ ! -r $2 ]; then
-+ echo "Given defconfig has no read attribute."
-+ print_help
-+ fi
-+ TARGET=none
-+ IMAGE=$1
-+ export CROSS_COMPILE=nds32le-linux-
-+ echo "Building $IMAGE kernel."
-+esac
-+
-+ZIMAGE="$IMAGE"_zImage
-+VMLINUZ="$IMAGE"_vmlinuz
-+VMLINUX="$IMAGE"_vmlinux
-+BOOTPIMAGE="$IMAGE"_bootpImage
-+BOOTP="$IMAGE"_bootp
-+BOOTM="$IMAGE"_bootm
-+
-+for ARG in $@; do
-+ if [ $ARG = $1 ]; then
-+ continue
-+ fi
-+
-+ if [ $ARG = $2 ]; then
-+ if [ $TARGET = "none" ]; then
-+ continue
-+ fi
-+ fi
-+
-+ case "$ARG" in
-+
-+ --bootm)
-+ BUILDBOOTM=1
-+ ;;
-+
-+ --ramdisk=*)
-+ BUILDBOOTPIMAGE=1
-+ RAMDISK=${ARG#*=}
-+ if [ ! -e $RAMDISK ]; then
-+ echo "Given ramdisk is not exist."
-+ print_help
-+ elif [ ! -f $RAMDISK ]; then
-+ echo "Given ramdisk is not a file."
-+ print_help
-+ elif [ ! -s $RAMDISK ]; then
-+ echo "Given ramdisk is size 0."
-+ print_help
-+ elif [ ! -r $RAMDISK ]; then
-+ echo "Given ramdisk has no read attribute."
-+ print_help
-+ fi
-+ ;;
-+# --headers)
-+# BUILDHEADERS=1
-+# git apply ../linux-2.6-patch/headers.patch
-+# echo "Exporting kernel headers."
-+# ;;
-+ *)
-+ print_help
-+ esac
-+done
-+
-+if [ "$OSTYPE" = "cygwin" ]; then
-+ HOST_LOADLIBES=-lintl\ -lcurses
-+fi
-+export HOST_LOADLIBES
-+
-+which ${CROSS_COMPILE}gcc &> /dev/null || export CROSS_COMPILE=nds32-elf-
-+
-+make mrproper | tee $IMAGE.log
-+if [ $TARGET != "none" ]; then
-+ make $TARGET| tee -a $IMAGE.log
-+else
-+ cp $2 .config
-+fi
-+
-+if [ $BUILDHEADERS = 1 ]; then
-+ make dep | tee -a $IMAGE.log
-+ make headers_install | tee -a $IMAGE.log
-+else
-+ make | tee -a $IMAGE.log
-+
-+ cp arch/nds32/boot/zImage ./$ZIMAGE | tee -a $IMAGE.log
-+ cp arch/nds32/boot/compressed/vmlinux ./$VMLINUZ | tee -a $IMAGE.log
-+ cp ./vmlinux ./$VMLINUX | tee -a $IMAGE.log
-+
-+ if [ $BUILDBOOTPIMAGE = 1 ]; then
-+ make bootpImage INITRD=$RAMDISK | tee -a $IMAGE.log
-+ cp arch/nds32/boot/bootpImage ./$BOOTPIMAGE | tee -a $IMAGE.log
-+ cp arch/nds32/boot/bootp/bootp ./$BOOTP | tee -a $IMAGE.log
-+ fi
-+
-+ if [ $BUILDBOOTM = 1 ]; then
-+ if [ -e "../u-boot/tools/mkimage" ]; then
-+ ../u-boot/tools/mkimage \
-+ -A nds32 \
-+ -O linux \
-+ -T kernel \
-+ -C none \
-+ -a 0x500000 \
-+ -e 0x500040 \
-+ -d ./arch/nds32/boot/zImage $BOOTM | tee -a $IMAGE.log
-+ else
-+ echo "Error: ../u-boot/tools/mkimage not found" | tee -a $IMAGE.log
-+ fi
-+ fi
-+fi
-diff -Nur linux-3.4.113.orig/drivers/block/ftcfc010.c linux-3.4.113/drivers/block/ftcfc010.c
---- linux-3.4.113.orig/drivers/block/ftcfc010.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/block/ftcfc010.c 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,1299 @@
-+/* drivers/block/CPESD/ftsdc010.c
-+ *******************************************************************************
-+ * Faraday FTSDC010 Device Driver
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ *
-+ * All Rights Reserved
-+ *
-+ * Porting to Linux 2.6 on 20050815
-+ * Author: Chris Lee, I-Jui Sung, Peter Liao (support APB DMA)
-+ * Version: 0.2
-+ * History:
-+ * 0.1 new creation
-+ * 0.2 Porting to meet the style of linux dma
-+ * 0.3 modify dma usage to virtual irq of dma interrupt
-+ * 0.4 (20050701) Improve r/w performance
-+ * 0.5 Porting to Linux 2.6 and replace busy_loop checking with timer's timeout
-+ * Todo:
-+ *******************************************************************************
-+ */
-+
-+#define DEBUG_OFF 0
-+
-+#define DEBUG( enable, tagged, ...) \
-+do{ \
-+ if( enable){ \
-+ if( tagged) \
-+ printk( "[ %30s() ] ", __func__); \
-+ printk( __VA_ARGS__); \
-+ } \
-+} while( 0)
-+
-+#include <linux/interrupt.h>
-+#include <linux/kernel.h>
-+#include <linux/module.h>
-+#include <linux/sched.h>
-+#include <linux/delay.h>
-+#include <linux/init.h>
-+#include <linux/ioport.h>
-+#include <linux/hdreg.h> /* HDIO_GETGEO */
-+#include <linux/fs.h>
-+#include <linux/blkdev.h>
-+#include <linux/buffer_head.h> /* invalidate_bdev */
-+#include <linux/bio.h>
-+#include <linux/pci.h>
-+#include <asm/io.h>
-+#include <asm/uaccess.h>
-+#include <asm/spec.h>
-+#include <asm/dmad.h>
-+
-+#define IPMODULE CFC
-+#define IPNAME FTCFC010
-+
-+#include "ftcfc010.h"
-+
-+static int hardsect_size = 512;
-+module_param( hardsect_size, int, 0);
-+
-+static int cf_major = 0; /* must be declared before including blk.h */
-+#define DEVICE_NAME "Faraday CFC" /* name for messaging */
-+
-+#define FTCFC_VA_BASE IP_VA_BASE( 0)
-+#define FTCFC_PA_BASE IP_PA_BASE( 0)
-+#define FTCFC_IRQ CFC_FTCFC010_IRQ1
-+
-+#undef CF_DEBUG
-+#define CF_DEBUG 0
-+struct block_device_operations cf_fops;
-+
-+typedef struct cf_dev {
-+
-+ int size; /* device size in sectors */
-+ int usage; /* # of users currently */
-+ int media_change; /* Flag: media changed? */
-+ struct gendisk *gd; /* The gendisk structure */
-+ spinlock_t lock; /* For mutual exclusion */
-+ struct request_queue *queue; /* The device request queue */
-+ int card_state;
-+ u32 lba_sec_offset;
-+ dmad_chreq ch_req;
-+
-+} cf_dev_t;
-+
-+static cf_dev_t *cf_devices;
-+static cf_card_t cf_card_info;
-+
-+static dma_addr_t dma_buf;
-+struct completion cf_dma_cmpl;
-+
-+static uint first_run;
-+static uint cf_err_code;
-+
-+static int g_cf_sectors;
-+
-+static void SetTransferSize( u32 Addr, u32 Type, u32 OP_Type, u32 Inc_Addr, u32 Transize)
-+{
-+ u32 ctrl_reg, buf_ctrl_reg;
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ /* set read/write command */
-+ while( cfc->HostStatus & BUF_ACTIVE_BIT)
-+ ;
-+
-+ /* Set Transfer size mode to default */
-+ cfc->TransSzMode2En = 0;
-+
-+ /* set 8/16 bits mode */
-+ ctrl_reg = cfc->ControlReg;
-+
-+ if( Transize == SIZE_1_BYTE)
-+ ctrl_reg = ( ctrl_reg & ~MODE_BIT) | BYTE_MODE;
-+ else
-+ ctrl_reg = ( ctrl_reg & ~MODE_BIT) | WORD_MODE;
-+
-+ DEBUG( CF_DEBUG, 1, "ctrl 1: 0x%08lx\n", ( unsigned long)ctrl_reg);
-+ cfc->ControlReg = ctrl_reg;
-+
-+ /* Write command to buffer */
-+ buf_ctrl_reg = cfc->BuffCtrlReg;
-+ buf_ctrl_reg = ( buf_ctrl_reg & ~ADR_BIT & ~TYPE_BIT & ~RW_BIT & ~INCADR_BIT & ~TRANS_SIZE_CONTROL_BIT)
-+ | Addr | Type | OP_Type | Inc_Addr | ( Transize << TRANS_SIZE_LOC);
-+
-+ cfc->BuffCtrlReg = buf_ctrl_reg;
-+ DEBUG( CF_DEBUG, 1, "buf_ctrl 1: 0x%08lx\n", ( unsigned long)buf_ctrl_reg);
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+}
-+
-+static void SetTransferSizeEx( u32 Addr, u32 Type, u32 OP_Type, u32 Inc_Addr, u32 Transize)
-+{
-+ u32 ctrl_reg, buf_ctrl_reg;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter, SetTransferSizeEx: %d\n", Transize);
-+
-+ /* set read/write command */
-+ while( cfc->HostStatus & BUF_ACTIVE_BIT)
-+ ;
-+
-+ /* Set Transfer size mode to default */
-+ cfc->TransSzMode2En = 1;
-+
-+ /* set 8/16 bits mode */
-+ ctrl_reg = cfc->ControlReg;
-+
-+ if( Transize == SIZE_1_BYTE)
-+ ctrl_reg = ( ctrl_reg & ~MODE_BIT) | BYTE_MODE;
-+ else
-+ ctrl_reg = ( ctrl_reg & ~MODE_BIT) | WORD_MODE;
-+
-+ cfc->ControlReg = ctrl_reg;
-+
-+ /* Set Transfer size mode2 reg in FTCFC */
-+ cfc->TransSzMode2Cnt = Transize - 1;
-+
-+ /* Write command to buffer */
-+ buf_ctrl_reg = cfc->BuffCtrlReg;
-+ buf_ctrl_reg = ( buf_ctrl_reg & ~ADR_BIT & ~TYPE_BIT & ~RW_BIT & ~INCADR_BIT & ~TRANS_SIZE_CONTROL_BIT)
-+ | Addr | Type | OP_Type | Inc_Addr;
-+
-+ cfc->BuffCtrlReg = buf_ctrl_reg;
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+}
-+
-+static void WriteCFCardByte( u32 Addr, u8 Value, u32 Type)
-+{
-+ while( !( cfc->HostStatus & RDY_nIREQ_BIT))
-+ ;
-+
-+ SetTransferSize( Addr, Type, WRITE_OP, NOINCADR, SIZE_1_BYTE);
-+
-+ cfc->BufferData = Value;
-+
-+ while( !( cfc->HostStatus & INTA_BIT))
-+ ;
-+
-+ /* clear command complete status */
-+ cfc->HostStatus = INTA_BIT;
-+}
-+
-+static u8 ReadCFCardByte( u32 Addr, u32 Type)
-+{
-+ u8 ret_data;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ /* wait until ready */
-+ while( !( cfc->HostStatus & RDY_nIREQ_BIT))
-+ ;
-+
-+ SetTransferSize( Addr, Type, READ_OP, NOINCADR, SIZE_1_BYTE);
-+
-+ while( !( cfc->HostStatus & INTA_BIT))
-+ ;
-+
-+ ret_data = cfc->BufferData & 0xff;
-+ DEBUG( CF_DEBUG, 1, "data: 0x%02x\n", ret_data);
-+
-+ while( !( cfc->HostStatus & INTA_BIT))
-+ ;
-+
-+ /* clear command complete status */
-+ cfc->HostStatus = INTA_BIT;
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+ return ret_data;
-+}
-+
-+/* set Head-cylinder-sector on CF */
-+static u32 Translate_Config_HCS( u32 LBA, u32 Sec_count)
-+{
-+ u8 DriveHead = ( u8)( 0xE0 | ( LBA >> 24)); /* 0xE0 set in LBA mode (bit 7&5 must set to 1) */
-+ u8 CylHigh = ( u8)( ( LBA >> 16) & 0xFF);
-+ u8 CylLow = ( u8)( ( LBA >> 8) & 0xFF);
-+ u8 SecNum = ( u8)( LBA & 0xFF);
-+
-+ DEBUG( CF_DEBUG, 1, "LBA:%d, %d %d %d %d, count: %d\n",
-+ LBA, DriveHead, CylHigh, CylLow, SecNum, Sec_count);
-+
-+ /* Set CF-ATA reg for start sector */
-+ WriteCFCardByte( BLKMEM_DRIVE_REG, DriveHead, COMMON_MEM);
-+ WriteCFCardByte( BLKMEM_CYLINDER_HIGH_REG, CylHigh, COMMON_MEM);
-+ WriteCFCardByte( BLKMEM_CYLINDER_LOW_REG, CylLow, COMMON_MEM);
-+ WriteCFCardByte( BLKMEM_SECTOR_NUMBER_REG, SecNum, COMMON_MEM);
-+ WriteCFCardByte( BLKMEM_SECTOR_COUNT_REG, Sec_count, COMMON_MEM);
-+
-+ return 1;
-+}
-+
-+/*
-+ * SetCFCardConfiguration(): ATTRIBUTE MEMORY
-+ * Set CF storgae card configuration option register
-+ * Conf1 Conf0 Disk Card Mode
-+ * ---------------------------------------------------------------
-+ * 0 0 Memory Mapped
-+ * 0 1 I/O Mapped, any 16 byte system decoded
-+ * 1 0 I/O Mapped, 1F0h - 1F7h / 3F6h - 3F7h
-+ * 1 1 I/O Mapped, 170h - 177h / 376h - 377h
-+ */
-+static void SetCFCardMode( u8 Mode)
-+{
-+ u8 Reg;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ Reg = ReadCFCardByte( CONFIG_OPTION_REG, ATTRIBUTE_MEM); /* CONFIG_OPTION_REG = 0x200 */
-+ Reg &= ( LEVLREQ_BIT | SRESET_BIT); /* clear bit0-5 */
-+
-+ WriteCFCardByte( CONFIG_OPTION_REG, Reg | Mode, ATTRIBUTE_MEM);
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+}
-+
-+/* return 0: fail, 1: success */
-+static u32 CF_SendCommand( u16 Cmd)
-+{
-+ u16 Reg;
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ do{
-+ WriteCFCardByte( BLKMEM_COMMAND_REG, Cmd, COMMON_MEM);
-+
-+ /*
-+ * Check status register of Task file register is valid for access
-+ * No other bits in status register are valid when BUSY bit is
-+ * set to a 1
-+ */
-+ while( ( ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM) & BUSY_BIT))
-+ ;
-+
-+ Reg = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ if( Reg & ERR_BIT){
-+
-+ DEBUG( CF_DEBUG, 1, "Exit ( fail)\n");
-+ return 0;
-+ }
-+
-+ } while( !( Reg & RDY_BIT));
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+ return 1;
-+}
-+
-+static void CardReset( void)
-+{
-+ u32 ctrl_reg = cfc->ControlReg;
-+ u8 data;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+ cfc->ControlReg = ctrl_reg | RESET_BIT | SIGNAL_ON | PWR_ON; /* set reset bit, float control, power on */
-+
-+ /* Software must manually clear this bit */
-+ mdelay( 100);
-+
-+ /* clear reset bit */
-+ cfc->ControlReg = ( ctrl_reg &~ RESET_BIT) | SIGNAL_ON | PWR_ON | DATA_CMP_INT_MASK | IO_INT_MASK;
-+
-+ do {
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ } while( data & BUSY_BIT); /* please be careful that is locked here */
-+
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ /* Check if Drive Ready & Drive Seek Complete */
-+ if( data == ( RDY_BIT | DSC_BIT))
-+ DEBUG( CF_DEBUG, 1, "Reset CF OK, data: 0x%02x\n", ( unsigned char)data);
-+ else
-+ DEBUG( CF_DEBUG, 1, "Reset CF fail, data: 0x%02x\n", ( unsigned char)data);
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+}
-+
-+static u32 CFCardInit( void)
-+{
-+ u8 buff[CF_SECTOR_SIZE];
-+ u32 i;
-+ u32 BSA, BSM, BSIO, BSMOW, BSIORW, apb_ns;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ if( !( cfc->HostStatus & CARD_DETECT_BIT)){
-+
-+ DEBUG( CF_DEBUG, 1, "No CF Card In Socket\n");
-+ return -1;
-+ }
-+
-+ CardReset();
-+
-+ /* set timer */
-+
-+ apb_ns = 1000000000 / ( AHB_CLK_IN / 2 ); /* the time of APB clock */
-+ BSA = ( 50 + ( apb_ns - ( 50 % apb_ns))) / apb_ns; /* Based on the item tc( R) of BSA */
-+ BSMOW = 3;
-+ BSIORW = 3;
-+ BSM = ( 30 + ( apb_ns - ( 30 % apb_ns))) / apb_ns; /* Base on the item tw( WE) of BSM */
-+ BSIO = ( 35 + ( apb_ns - ( 35 % apb_ns))) / apb_ns; /* Base on the item tsuA( IORD,IOWR) of BSIO */
-+
-+ cfc->TimeCfgReg = ( ( BSMOW & 0x03) << 12)
-+ | ( ( BSIORW & 0x03) << 14)
-+ | ( ( BSA & 0x0f) << 0)
-+ | ( ( BSM & 0x0f) << 4)
-+ | ( ( BSIO & 0x0f) << 8);
-+
-+ SetCFCardMode( CF_MEM_MAP_MODE); /* set memory mode read write access */
-+
-+ cfc->MultiSector = 0x1; /* enable multi sector read/write */
-+
-+ /* select drive */
-+ WriteCFCardByte( BLKMEM_DRIVE_REG, 0, COMMON_MEM);
-+
-+ /* identify drive device */
-+ if( !CF_SendCommand( ATA_IDENTIFY_DRIVE)){
-+
-+ DEBUG( CF_DEBUG, 1, "Send Identify Drive command fail\n");
-+ return -1;
-+ }
-+
-+ SetTransferSize( BLKMEM_DATA_REG, COMMON_MEM, READ_OP, NOINCADR, SIZE_512_BYTE);
-+
-+ for( i = 0; i < CF_SECTOR_SIZE / 4; i++){
-+
-+ while( !( cfc->HostStatus & BUF_DATA_RDY_BIT))
-+ ;
-+
-+ *( ( u32*)&buff[ i*4]) = cfc->BufferData;
-+ }
-+
-+ /* clear command complete status */
-+ cfc->HostStatus = INTA_BIT;
-+
-+ g_cf_sectors = ( ( u32)buff[ 15] << 24) | ( ( u32)buff[ 14] << 16) | ( ( u32)buff[ 17] << 8) | ( ( u32)buff[ 16]);
-+ DEBUG( CF_DEBUG, 1, "Card identify - capicity: %d sectors, size: %d kbytes \n", g_cf_sectors, g_cf_sectors >> 1);
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+
-+ return 0;
-+}
-+
-+static int cfc_read_block( cf_card_t *info, uint size, uint *buf)
-+{
-+ /*
-+ * Please refer SanDisk SD Manual v1.9 Section 5.1.9.2 ( page 5-76) to set the timeout setting
-+ */
-+ unsigned long timeout = jiffies + CFC_TIMEOUT_BASE *( ( size + 2048 + 511) >> 9);
-+ uint count;
-+ u8 data;
-+ dmad_chreq *ch_req = (dmad_chreq *)info->private;
-+ dmad_drb *drb = 0;
-+ u32 drb_size = 0;
-+ dma_addr_t addr_iter;
-+
-+ if( info->DMAEnable){
-+
-+ DEBUG( CF_DEBUG, 1, "DMA Read - size: %d, buf: 0x%08lx, dma_buf: 0x%08lx\n",
-+ size, ( unsigned long)buf, ( unsigned long)dma_buf);
-+
-+ init_completion(&cf_dma_cmpl);
-+
-+ if (dma_buf)
-+ consistent_sync(__va(dma_buf), size, DMA_FROM_DEVICE);
-+ else
-+ consistent_sync(buf, size, DMA_FROM_DEVICE);
-+
-+ //prepare parameter for add dma entry
-+ dmad_config_channel_dir(ch_req, DMAD_DIR_A0_TO_A1);
-+
-+ drb_size = dmad_max_size_per_drb(ch_req);
-+
-+ if (dma_buf)
-+ addr_iter = dma_buf; // given dest phy addr
-+ else
-+ addr_iter = __pa(buf);
-+
-+ cfc->ControlReg |= ENDMA_BIT;
-+
-+ while (size > 0) {
-+
-+ if (unlikely(0 != dmad_alloc_drb(ch_req, &drb) || (drb == 0))) {
-+ printk(KERN_ERR "%s() Failed to allocate dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+
-+ drb->addr0 = FTCFC_PA_BASE + 0x10;
-+ drb->addr1 = addr_iter;
-+
-+ if (size <= drb_size) {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, size);
-+ drb->sync = &cf_dma_cmpl;
-+ size = 0;
-+ } else {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, drb_size);
-+ drb->sync = 0;
-+ size -= drb_size;
-+ addr_iter += drb_size;
-+ }
-+ //printk(KERN_INFO "%s() size_remain 0x%08x.\n", __func__, size);
-+
-+ if (unlikely(0 != dmad_submit_request(ch_req, drb, 1))) {
-+ printk(KERN_ERR "%s() Failed to submit dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+ }
-+
-+ if (wait_for_completion_timeout(&cf_dma_cmpl, timeout - jiffies) == 0)
-+ printk("%s: read timeout\n", __func__);
-+
-+ DEBUG( CF_DEBUG, 1, "ControlReg: 0x%08x, HostStatus: 0x%08x, BufCtrl: 0x%08x\n",
-+ cfc->ControlReg, cfc->HostStatus, cfc->BuffCtrlReg);
-+
-+ while( !( cfc->HostStatus & INTA_BIT))
-+ ;
-+
-+ cfc->HostStatus = INTA_BIT;
-+
-+ /* Stop DMA */
-+ cfc->ControlReg &= ~ENDMA_BIT;
-+ cfc->ControlReg &= ~MODE_BIT;
-+
-+ do {
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ } while( data & BUSY_BIT);
-+ }
-+ else {
-+ while( size > 0){
-+
-+ /* read data from FIFO */
-+ if( size >= ( CFC_READ_FIFO_LEN << 2))
-+ count = CFC_READ_FIFO_LEN;
-+ else
-+ count = size >> 2;
-+
-+ /* read data from FIFO */
-+ DEBUG( CF_DEBUG, 0, "\n");
-+ size -= ( count << 2);
-+ }
-+ }
-+
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ while( 1){
-+
-+ if( data & ERR_BIT){
-+
-+ DEBUG( CF_DEBUG, 1, "ERROR: ( CFReadSector) CF Read sector error.\n");
-+ return FALSE;
-+ }
-+ else if( data & DWF_BIT){
-+
-+ DEBUG( CF_DEBUG, 1, "ERROR: ( CFReadSector) CF write fault error.\n");
-+ return FALSE;
-+ }
-+ else if( data & ( RDY_BIT | DSC_BIT)){
-+
-+ break;
-+ }
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+ }
-+
-+ return TRUE;
-+}
-+
-+static int cfc_write_block( cf_card_t *info, uint size, uint *buf)
-+{
-+ unsigned long timeout = jiffies + CFC_TIMEOUT_BASE * 3 *( ( size + 511) >> 9);
-+ uint count;
-+ u8 data;
-+ dmad_chreq *ch_req = (dmad_chreq *)info->private;
-+ dmad_drb *drb = 0;
-+ u32 drb_size = 0;
-+ dma_addr_t addr_iter;
-+
-+ if( info->DMAEnable){
-+
-+ DEBUG( CF_DEBUG, 1, "size: %d, buf: %p) - DMA Write\n", size, buf);
-+
-+ init_completion(&cf_dma_cmpl);
-+
-+ if (dma_buf)
-+ consistent_sync(__va(dma_buf), size, DMA_TO_DEVICE);
-+ else
-+ consistent_sync(buf, size, DMA_TO_DEVICE);
-+
-+ //prepare parameter for add dma entry
-+ dmad_config_channel_dir(ch_req, DMAD_DIR_A1_TO_A0);
-+
-+ drb_size = dmad_max_size_per_drb(ch_req);
-+
-+ if (dma_buf)
-+ addr_iter = dma_buf; // given dest phy addr
-+ else
-+ addr_iter = __pa(buf);
-+
-+ cfc->ControlReg |= ENDMA_BIT;
-+
-+ while (size > 0) {
-+
-+ if (unlikely(0 != dmad_alloc_drb(ch_req, &drb) || (drb == 0))) {
-+ printk(KERN_ERR "%s() Failed to allocate dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+
-+ drb->addr0 = FTCFC_PA_BASE + 0x10;
-+ drb->addr1 = addr_iter;
-+
-+ if (size <= drb_size) {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, size);
-+ drb->sync = &cf_dma_cmpl;
-+ size = 0;
-+ } else {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, drb_size);
-+ drb->sync = 0;
-+ size -= drb_size;
-+ addr_iter += drb_size;
-+ }
-+ //printk(KERN_INFO "%s() size_remain 0x%08x.\n", __func__, size);
-+
-+ if (unlikely(0 != dmad_submit_request(ch_req, drb, 1))) {
-+ printk(KERN_ERR "%s() Failed to submit dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+ }
-+
-+ if (wait_for_completion_timeout(&cf_dma_cmpl, timeout - jiffies) == 0)
-+ printk("write timeout\n");
-+
-+ while( !( cfc->HostStatus & INTA_BIT))
-+ ;
-+
-+ cfc->HostStatus = INTA_BIT;
-+ /* Stop DMA */
-+ cfc->ControlReg &= ~ENDMA_BIT;
-+ cfc->ControlReg &= ~MODE_BIT;
-+
-+ do{
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ } while( data & BUSY_BIT);
-+ }
-+ else {
-+ while( size > 0){
-+
-+ /* write data from FIFO */
-+ if( size >= ( CFC_WRITE_FIFO_LEN << 2))
-+ count = CFC_WRITE_FIFO_LEN;
-+ else
-+ count = ( size >> 2);
-+
-+ size -= ( count << 2);
-+ }
-+ }
-+
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ while( 1){
-+
-+ if( data & ERR_BIT){
-+
-+ DEBUG( CF_DEBUG, 1, "ERROR: ( CFReadSector) CF Read sector error.\n");
-+ return FALSE;
-+ }
-+ else if( data & DWF_BIT){
-+
-+ DEBUG( CF_DEBUG, 1, "ERROR: ( CFReadSector) CF write fault error.\n");
-+ return FALSE;
-+ }
-+ else if( data & ( RDY_BIT | DSC_BIT))
-+ break;
-+
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+ }
-+ return TRUE;
-+}
-+
-+static int cf_card_insert( cf_card_t *info)
-+{
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+ CardReset();
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+
-+ return TRUE;
-+}
-+
-+/* Free IRQ and DMA resources */
-+static void cf_free( cf_dev_t *dev)
-+{
-+ release_region( FTCFC_VA_BASE, 0x48); /* return ioport */
-+ free_irq( FTCFC_IRQ, dev); /* return Hotswapping irq */
-+
-+ if (cf_card_info.DMAEnable) {
-+#if (CF_DEBUG)
-+ if (dev->ch_req.controller == DMAD_DMAC_APB_CORE)
-+ printk("%s: free APB dma channel (%d)\n", __func__, dev->ch_req.channel);
-+ else
-+ printk("%s: free AHB dma channel (%d)\n", __func__, dev->ch_req.channel);
-+#endif
-+ dmad_channel_free(&dev->ch_req);
-+ cf_card_info.DMAEnable = FALSE;
-+ }
-+}
-+
-+static int cf_card_remove( cf_card_t *info)
-+{
-+ cf_err_code = ERR_NO_ERROR;
-+
-+ info->ActiveState = FALSE;
-+ info->WriteProtect = FALSE;
-+ info->RCA = 0;
-+
-+ /* reset host interface controller */
-+ cfc->ControlReg |= RESET_BIT;
-+
-+ mdelay( 100);
-+ cfc->ControlReg &= ~RESET_BIT; /* must manually clear reset bit */
-+ return TRUE;
-+}
-+
-+irqreturn_t cf_hotswap_interrupt_handler( int irq, void *dev_id)
-+{
-+ cf_dev_t *dev = dev_id;
-+
-+ DEBUG( CF_DEBUG, 1, "irq: %d\n", irq);
-+
-+ /*
-+ * When the card is inserted or removed, we must delay a short time to make sure
-+ * the SDC_STATUS_REG_CARD_INSERT bit of status register is stable
-+ */
-+
-+ if( cfc->HostStatus & INT_CD_BIT ){
-+
-+ mdelay( 100); /* wait 0.1 sec for card stable */
-+
-+ DEBUG( CF_DEBUG, 1, "Card %s\n", cfc->HostStatus & CARD_DETECT_BIT ? "Insert" : "Remove");
-+ if( cfc->HostStatus & CARD_DETECT_BIT ){
-+
-+ dev->card_state = CF_CARD_INSERT;
-+ cf_card_insert( &cf_card_info);
-+ }
-+ else {
-+ dev->card_state = CF_CARD_REMOVE;
-+ cf_card_remove( &cf_card_info);
-+ }
-+
-+ cfc->HostStatus = INT_CD_BIT;
-+ }
-+ else{
-+ DEBUG( CF_DEBUG, 1, "cfc->HostStatus & INT_CD_BIT == 0\n");
-+ }
-+
-+ DEBUG( CF_DEBUG, 1, "Exit: card state = %d\n", dev->card_state);
-+ return IRQ_HANDLED;
-+}
-+
-+int cf_read_multiple_block( cf_card_t *info, uint addr, uint count, uint size, uint timeout, unchar *buf)
-+{
-+ u8 data;
-+
-+ DEBUG( CF_DEBUG, 1, "read block addr: 0x%x(%d) sectors: %d\n", addr, addr, count);
-+
-+ cf_err_code = ERR_NO_ERROR;
-+ Translate_Config_HCS( addr, count);
-+ CF_SendCommand( ATA_READ_SECTOR);
-+
-+ do{
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+
-+ } while( data & BUSY_BIT);
-+
-+ SetTransferSizeEx( BLKMEM_DATA_REG, COMMON_MEM, READ_OP, NOINCADR, CF_SECTOR_SIZE * count);
-+
-+ if( first_run == 0){
-+
-+ udelay( 100000);
-+
-+ first_run = 1;
-+ }
-+
-+ if( !cfc_read_block( info, CF_SECTOR_SIZE * count, ( uint *)buf))
-+ return FALSE;
-+
-+ if( cf_err_code != ERR_NO_ERROR){
-+
-+ DEBUG( CF_DEBUG, 1, "error = 0x%x\n", cf_err_code);
-+ DEBUG( CF_DEBUG, 1, "r addr %d count %d\n", addr, count);
-+
-+ return FALSE;
-+ }
-+
-+ return TRUE;
-+}
-+
-+int cf_write_multiple_block( cf_card_t *info, uint addr, uint count, uint size, uint timeout, unchar *buf)
-+{
-+ u8 data;
-+
-+ DEBUG( CF_DEBUG, 1, "write block addr: 0x%08lx, sectors: %x, sector: %x\n", ( unsigned long)addr, count, 512);
-+
-+ cf_err_code = ERR_NO_ERROR;
-+ Translate_Config_HCS( addr, count);
-+ CF_SendCommand( ATA_WRITE_SECTOR);
-+ do {
-+ data = ReadCFCardByte( BLKMEM_STATUS_REG, COMMON_MEM);
-+ } while( data & BUSY_BIT);
-+
-+ SetTransferSizeEx( BLKMEM_DATA_REG, COMMON_MEM, WRITE_OP, NOINCADR, CF_SECTOR_SIZE * count);
-+
-+ if( !cfc_write_block( info, CF_SECTOR_SIZE*count, ( uint *) buf))
-+ return FALSE;
-+
-+ if( cf_err_code != ERR_NO_ERROR){
-+
-+ DEBUG( CF_DEBUG, 1, "error: 0x%08lx\n", ( unsigned long)cf_err_code);
-+ DEBUG( CF_DEBUG, 1, "w addr: %d, count: %d\n", addr, count);
-+ return FALSE;
-+ }
-+
-+ return TRUE;
-+}
-+
-+
-+/***************************************************************************
-+ * SD Card Read/Write/Erase Function
-+ ***************************************************************************/
-+int cf_read_sector( cf_card_t *info, uint addr, uint count, unchar *buf)
-+{
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ if( !cf_read_multiple_block( info, addr + cf_devices->lba_sec_offset, count,
-+ info->CSD.ReadBlockLength, info->ReadAccessTimoutCycle, buf)){
-+
-+ DEBUG( CF_DEBUG, 1, "read failed\n");
-+ return FALSE;
-+ }
-+
-+ DEBUG( CF_DEBUG, 1, "read ok\n");
-+
-+ if( cf_devices->lba_sec_offset == 0){
-+
-+ if( !cf_read_multiple_block( info, 0, 1, info->CSD.ReadBlockLength, info->ReadAccessTimoutCycle, buf))
-+ return FALSE;
-+
-+ /* lba ( ??) sector offset */
-+ cf_devices->lba_sec_offset = ( *( buf + 0x1C6))
-+ | ( *( buf + 0x1C7)) << 8
-+ | ( *( buf + 0x1C8)) << 16
-+ | ( *( buf + 0x1C9)) << 24;
-+
-+ /* device total sector number */
-+ g_cf_sectors = ( *( buf + 0x1CA))
-+ | ( *( buf + 0x1CB)) << 8
-+ | ( *( buf + 0x1CC)) << 16
-+ | ( *( buf + 0x1CD)) << 24;
-+
-+ /* only for testing , it only to let format command ok */
-+ if( ( buf[ 0x1be] != 0x0) && ( buf[ 0x1be] != 0x80)) /* partition identify */
-+ cf_devices->lba_sec_offset = 0; /* sector 0 is PBR */
-+ else
-+ cf_devices->lba_sec_offset = ( buf[ 0x1c6])
-+ | ( buf[ 0x1c7] << 8)
-+ | ( buf[ 0x1c8] << 16)
-+ | ( buf[ 0x1c9] << 24);
-+
-+ DEBUG( CF_DEBUG, 1, "lba_sec_offet is %d\n", cf_devices->lba_sec_offset);
-+ DEBUG( CF_DEBUG, 1, "the device( partition) total sector number is %d\n", g_cf_sectors);
-+ }
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+ return TRUE;
-+}
-+
-+int cf_write_sector( cf_card_t *info, uint addr, uint count, unchar *buf)
-+{
-+ if( !cf_write_multiple_block( info, addr+cf_devices->lba_sec_offset, count,
-+ info->CSD.ReadBlockLength, info->ReadAccessTimoutCycle, buf)){
-+
-+ DEBUG( CF_DEBUG, 1, "write failed\n");
-+
-+ return FALSE;
-+ }
-+
-+ DEBUG( CF_DEBUG, 1, "write ok\n");
-+
-+ return TRUE;
-+}
-+
-+/*
-+ * Perform an actual transfer:
-+ * Returns: # of sectors transferred. 0 = error
-+ */
-+int cf_transfer( cf_dev_t *device, const struct request *req)
-+{
-+ int status = 0;
-+ int count = 0;
-+
-+ struct bio *bio = req->bio;
-+ struct bio_vec *bvec;
-+ struct req_iterator iter;
-+
-+ DEBUG( CF_DEBUG, 1, "req sector: %d, phys_seg: %d, buf: 0x%08lx\n",
-+ (int)req->__sector, req->nr_phys_segments,
-+ (unsigned long)bio_data(bio));
-+
-+ spin_unlock_irq( &device->lock);
-+
-+ rq_for_each_segment( bvec, req, iter){
-+
-+ unsigned char *buf = page_address( bvec->bv_page) + bvec->bv_offset;
-+ int sectors = bio_cur_bytes( bio) >> 9;
-+
-+ DEBUG( CF_DEBUG, 1, "bvec[%2d]: sector: %d, count: %d, curr: %d, buf: 0x%08lx\n",
-+ iter.i, ( int)bio->bi_sector, count, ( int)sectors, ( unsigned long)buf);
-+
-+ cf_card_info.private = (void *)&device->ch_req;
-+
-+ if( rq_data_dir( req) == 0) /* Read */
-+ status = cf_read_sector( &cf_card_info, bio->bi_sector, sectors, buf);
-+ else
-+ status = cf_write_sector( &cf_card_info, bio->bi_sector, sectors, buf);
-+
-+ DEBUG( CF_DEBUG, 1, "status: %d\n", status);
-+
-+ if (status <= 0) {
-+ spin_lock_irq( &device->lock);
-+ return count;
-+ }
-+
-+ count += sectors;
-+ bio->bi_sector += sectors;
-+ }
-+
-+ spin_lock_irq( &device->lock);
-+
-+ if( status <= 0)
-+ return 0;
-+ else
-+ return count;
-+}
-+
-+static int cf_card_setup(cf_dev_t *dev)
-+{
-+ int i;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+ first_run = 0;
-+ cf_err_code = ERR_NO_ERROR;
-+
-+ cf_card_info.ActiveState = FALSE;
-+ cf_card_info.WriteProtect = FALSE;
-+ cf_card_info.IOAddr = FTCFC_VA_BASE;
-+ cf_card_info.DMAEnable = TRUE;
-+ cf_card_info.DMAChannel = dev->ch_req.channel;
-+ cf_card_info.SysFrequency = AHB_CLK_IN / 2;
-+ cf_card_info.RCA = 0;
-+
-+ DEBUG( CF_DEBUG, 1, "DMA Enable is %d, Sys frequency = %d\n", cf_card_info.DMAEnable, cf_card_info.SysFrequency);
-+
-+ if( !cf_card_insert( &cf_card_info))
-+ return FALSE;
-+
-+ /* Marketing MB is not 1048576 */
-+ DEBUG( CF_DEBUG, 1, "FTCFC010: CF Card Capacity = %d KBytes\n", g_cf_sectors >> 1);
-+
-+ for( i = 0; i < CF_DEVS; i++)
-+ cf_devices[i].size = g_cf_sectors; /* unit is block, not bytes */
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+
-+ return TRUE;
-+}
-+
-+int cf_ioctl( struct block_device *bdev, fmode_t mode, unsigned int cmd, unsigned long arg)
-+{
-+ int size;
-+ struct hd_geometry geo;
-+ cf_dev_t *device = bdev->bd_disk->private_data;
-+
-+ DEBUG( CF_DEBUG, 1, "ioctl 0x%x 0x%lx\n", cmd, arg);
-+
-+ switch ( cmd){
-+
-+ case BLKGETSIZE:
-+ /*
-+ * Return the device size, expressed in sectors
-+ * FIXME: distinguish between kernel sector size and media sector size
-+ */
-+ size = device->size;
-+ __copy_to_user ( ( long *) arg, &size, sizeof ( long));
-+ return 0;
-+
-+ case HDIO_GETGEO:
-+ /*
-+ * get geometry: we have to fake one... trim the size to a
-+ * multiple of 64 ( 32k): tell we have 16 sectors, 4 heads,
-+ * whatever cylinders. Tell also that data starts at sector. 4.
-+ */
-+ geo.cylinders = ( device->size / 4) / 8; /* ?? only for test */
-+ geo.heads = 4;
-+ geo.sectors = 8;
-+ geo.start = 0;
-+ __copy_to_user ( ( void *) arg, &geo, sizeof ( geo));
-+ return 0;
-+
-+ default:
-+ /* For ioctls we don't understand, let the block layer handle them */
-+ return -ENOTTY;
-+ }
-+
-+ return -ENOTTY; /* unknown command */
-+}
-+
-+static void cf_request( struct request_queue *q)
-+{
-+ cf_dev_t *dev;
-+ int ret = 0;
-+ struct request *req;
-+ static int act = 0;
-+
-+ if( act)
-+ return;
-+
-+ act = 1;
-+
-+ while( ( req = blk_fetch_request( q)) != NULL){
-+
-+ dev = req->rq_disk->private_data;
-+
-+ if( !dev || dev->card_state == CF_CARD_REMOVE){
-+
-+ DEBUG( CF_DEBUG, 1, "CF: locating device error\n");
-+ __blk_end_request_cur( req, -EIO);
-+
-+ act = 0;
-+ return;
-+ }
-+
-+ ret = cf_transfer( dev, req);
-+ __blk_end_request( req, 0, ret << 9);
-+ }
-+
-+ act = 0;
-+}
-+
-+static int cf_dma_ch_alloc(cf_dev_t *dev)
-+{
-+ dmad_chreq *ch_req = &dev->ch_req;
-+
-+ memset(ch_req, 0, sizeof(dmad_chreq));
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+
-+ ch_req->apb_req.addr0_ctrl = APBBR_ADDRINC_FIXED; /* (in) APBBR_ADDRINC_xxx */
-+ ch_req->apb_req.addr0_reqn = APBBR_REQN_CFC; /* (in) APBBR_REQN_xxx (also used to help determine bus selection) */
-+ ch_req->apb_req.addr1_ctrl = APBBR_ADDRINC_I4X; /* (in) APBBR_ADDRINC_xxx */
-+ ch_req->apb_req.addr1_reqn = APBBR_REQN_NONE; /* (in) APBBR_REQN_xxx (also used to help determine bus selection) */
-+ ch_req->apb_req.burst_mode = 0; /* (in) Burst mode (0: no burst 1-, 1: burst 4- data cycles per dma cycle) */
-+ ch_req->apb_req.data_width = APBBR_DATAWIDTH_4; /* (in) APBBR_DATAWIDTH_4(word), APBBR_DATAWIDTH_2(half-word), APBBR_DATAWIDTH_1(byte) */
-+ ch_req->apb_req.tx_dir = DMAD_DIR_A0_TO_A1; /* (in) DMAD_DIR_A0_TO_A1, DMAD_DIR_A1_TO_A0 */
-+
-+ ch_req->controller = DMAD_DMAC_APB_CORE; /* (in) DMAD_DMAC_AHB_CORE, DMAD_DMAC_APB_CORE */
-+ ch_req->flags = DMAD_FLAGS_SLEEP_BLOCK | DMAD_FLAGS_BIDIRECTION;
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ memset(ch_req, 0, sizeof(dmad_chreq));
-+ printk(KERN_INFO "%s: APB dma channel allocation failed\n", __func__);
-+ goto _try_ahb;
-+ }
-+
-+#if (CF_DEBUG)
-+ printk("%s: APB dma channel allocated (ch: %d)\n", __func__, ch_req->channel);
-+#endif
-+
-+ return 0;
-+
-+_try_ahb:
-+
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+
-+ ch_req->ahb_req.sync = 1; /* (in) non-zero if src and dst have different clock domain */
-+ ch_req->ahb_req.priority = DMAC_CSR_CHPRI_1; /* (in) DMAC_CSR_CHPRI_0 (lowest) ~ DMAC_CSR_CHPRI_3 (highest) */
-+ ch_req->ahb_req.hw_handshake = 1; /* (in) non-zero to enable hardware handshake mode */
-+ ch_req->ahb_req.burst_size = DMAC_CSR_SIZE_4; /* (in) DMAC_CSR_SIZE_1 ~ DMAC_CSR_SIZE_256 */
-+ ch_req->ahb_req.addr0_width = DMAC_CSR_WIDTH_32; /* (in) DMAC_CSR_WIDTH_8, DMAC_CSR_WIDTH_16, or DMAC_CSR_WIDTH_32 */
-+ ch_req->ahb_req.addr0_ctrl = DMAC_CSR_AD_FIX; /* (in) DMAC_CSR_AD_INC, DMAC_CSR_AD_DEC, or DMAC_CSR_AD_FIX */
-+ ch_req->ahb_req.addr0_reqn = DMAC_REQN_CFC; /* (in) DMAC_REQN_xxx (also used to help determine channel number) */
-+ ch_req->ahb_req.addr1_width = DMAC_CSR_WIDTH_32; /* (in) DMAC_CSR_WIDTH_8, DMAC_CSR_WIDTH_16, or DMAC_CSR_WIDTH_32 */
-+ ch_req->ahb_req.addr1_ctrl = DMAC_CSR_AD_INC; /* (in) DMAC_CSR_AD_INC, DMAC_CSR_AD_DEC, or DMAC_CSR_AD_FIX */
-+ ch_req->ahb_req.addr1_reqn = DMAC_REQN_NONE; /* (in) DMAC_REQN_xxx (also used to help determine channel number) */
-+ ch_req->ahb_req.tx_dir = DMAD_DIR_A0_TO_A1; /* (in) DMAD_DIR_A0_TO_A1, DMAD_DIR_A1_TO_A0 */
-+
-+ ch_req->controller = DMAD_DMAC_AHB_CORE; /* (in) DMAD_DMAC_AHB_CORE, DMAD_DMAC_APB_CORE */
-+ ch_req->flags = DMAD_FLAGS_SLEEP_BLOCK | DMAD_FLAGS_BIDIRECTION;
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ memset(ch_req, 0, sizeof(dmad_chreq));
-+ printk(KERN_INFO "%s: AHB dma channel allocation failed\n", __func__);
-+ goto _err_exit;
-+ }
-+
-+#if (CF_DEBUG)
-+ printk("%s: AHB dma channel allocated (ch: %d)\n", __func__, ch_req->channel);
-+#endif
-+
-+ return 0;
-+
-+_err_exit:
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+ return -ENODEV;
-+}
-+
-+/*
-+ * Note no locks taken out here. In a worst case scenario, we could drop
-+ * a chunk of system memory. But that should never happen, since validation
-+ * happens at open or mount time, when locks are held.
-+ */
-+static int cf_revalidate( struct gendisk *gd)
-+{
-+ cf_dev_t *dev = gd->private_data;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+ dev->card_state = cfc->HostStatus & CARD_DETECT_BIT ? CF_CARD_INSERT : CF_CARD_REMOVE;
-+
-+ DEBUG( CF_DEBUG, 1, "card state: %s\n",
-+ dev->card_state == CF_CARD_INSERT ? "INSERT" :
-+ dev->card_state == CF_CARD_WORK ? "WORK" : "REMOVE");
-+
-+ if( !dev->usage){
-+
-+ if( cf_card_setup(dev) != TRUE){
-+
-+ DEBUG( CF_DEBUG, 1, "cf_card_setup failed\n");
-+ dev->card_state = CF_CARD_REMOVE;
-+
-+ return -1;
-+ }
-+ else {
-+ DEBUG( CF_DEBUG, 1, "CFC Driver with DMA Mode\n");
-+
-+ if (cf_card_info.DMAEnable) {
-+ /* acquire dma channel */
-+ if (cf_dma_ch_alloc(dev) != 0) {
-+ cf_card_info.DMAEnable = FALSE;
-+ cf_free( dev);
-+ DEBUG( CF_DEBUG, 1, "Request DMA resource failed\n");
-+ return -1;
-+ }
-+ DEBUG( CF_DEBUG, 1, "Request DMA resource success\n");
-+ }
-+
-+ /* SDC interrupt, currently only for HotSwap */
-+ DEBUG( CF_DEBUG, 1, "Request CFC IRQ: %d\n", FTCFC_IRQ);
-+
-+ if( request_irq( FTCFC_IRQ, cf_hotswap_interrupt_handler, IRQF_DISABLED, "CF controller", dev) != 0){
-+
-+ DEBUG( CF_DEBUG, 1, "Unable to allocate CFC IRQ: 0x%x\n", FTCFC_IRQ);
-+ cf_free( dev);
-+ return -1;
-+ }
-+
-+ /* require io port address for sd controller */
-+ if( request_region( FTCFC_VA_BASE, 0x48, "CF Controller") == NULL){
-+
-+ DEBUG( CF_DEBUG, 1, "request io port of sd controller fail\n");
-+ cf_free( dev);
-+ return -1;
-+ }
-+
-+ dev->card_state = CF_CARD_WORK;
-+ }
-+ }
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+
-+ return 0;
-+}
-+
-+/* TODO: forbids open for write when WRITE_PROTECT = 1 */
-+static int cf_open( struct block_device *bdev, fmode_t mode)
-+{
-+ cf_dev_t *dev= bdev->bd_disk->private_data; /* device information */
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ if( ( cfc->HostStatus & CARD_DETECT_BIT) != CARD_DETECT_BIT){
-+
-+ DEBUG( CF_DEBUG, 1, "Error: ( ENOMEDIUM)\n");
-+ return -ENOMEDIUM;
-+ }
-+
-+ if( CFCardInit()){
-+
-+ DEBUG( CF_DEBUG, 1, "root initialize failed\n");
-+ return FALSE;
-+ }
-+
-+ if( !dev->usage){
-+
-+ dev->media_change = 1;
-+ DEBUG( CF_DEBUG, 1, "forced check_disk_change check\n");
-+ check_disk_change( bdev);
-+ }
-+ else{
-+ dev->media_change = 0;
-+ }
-+
-+ DEBUG( CF_DEBUG, 1, "set_capacity() to %d blocks ( %d KBytes)\n", dev->size, dev->size >> 1);
-+ set_capacity( dev->gd, dev->size);
-+ dev->usage++;
-+ cf_devices->lba_sec_offset = 0;
-+ DEBUG( CF_DEBUG, 1, "dev: 0x%08lx, cf_devices: 0x%08lx\n", ( unsigned long)dev, ( unsigned long)cf_devices);
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+
-+ return 0; /* success */
-+}
-+
-+static int cf_release( struct gendisk *gd, fmode_t mode)
-+{
-+ cf_dev_t *dev = gd->private_data;
-+
-+ DEBUG( CF_DEBUG, 1, "Enter\n");
-+
-+ dev->usage--;
-+
-+ if( !dev->usage)
-+ cf_free( dev);
-+
-+ DEBUG( CF_DEBUG, 1, "Exit\n");
-+
-+ return 0;
-+}
-+
-+static void setup_device( struct cf_dev *dev, int which)
-+{
-+ memset ( dev, 0, sizeof ( struct cf_dev));
-+ dev->size = 0;
-+ spin_lock_init( &dev->lock);
-+
-+ dev->queue = blk_init_queue( cf_request, &dev->lock);
-+
-+ if( !dev->queue)
-+ goto out_vfree;
-+
-+ blk_queue_logical_block_size( dev->queue, hardsect_size);
-+ dev->queue->queuedata = dev;
-+
-+ dev->card_state = CF_CARD_REMOVE;
-+
-+ /* And the gendisk structure. */
-+ dev->gd = alloc_disk( CF_MINORS);
-+ if( ! dev->gd){
-+
-+ DEBUG( CF_DEBUG, 1, "alloc_disk failure\n");
-+ goto out_vfree;
-+ }
-+
-+ dev->gd->flags = GENHD_FL_REMOVABLE | GENHD_FL_SUPPRESS_PARTITION_INFO;
-+ dev->gd->major = cf_major;
-+ dev->gd->first_minor = which * CF_MINORS;
-+ dev->gd->minors = CF_MINORS;
-+ dev->gd->fops = &cf_fops;
-+ dev->gd->queue = dev->queue;
-+ dev->gd->private_data = dev;
-+
-+ snprintf ( dev->gd->disk_name, 32, "cpecf%c", which + 'a');
-+ set_capacity( dev->gd, 0);
-+ add_disk( dev->gd);
-+
-+ return;
-+
-+out_vfree:
-+
-+ return;
-+}
-+
-+static int cf_media_changed( struct gendisk *gd)
-+{
-+ struct cf_dev *dev = gd->private_data;
-+
-+ DEBUG( CF_DEBUG, 1, "cf_media_changed = %d\n", dev->media_change);
-+
-+ return dev->media_change;
-+}
-+
-+struct block_device_operations cf_fops = {
-+
-+ .owner = THIS_MODULE,
-+ .open = cf_open,
-+ .release = cf_release,
-+ .ioctl = cf_ioctl,
-+ .revalidate_disk = cf_revalidate,
-+ .media_changed = cf_media_changed,
-+};
-+
-+static int __init cf_module_init( void)
-+{
-+ int result= -ENOMEM, i;
-+
-+ DEBUG( 1, 0, "Faraday CF controller Driver (DMA mode)\n");
-+
-+ cf_major = register_blkdev( cf_major, DEVICE_NAME);
-+
-+ if( cf_major <= 0){
-+
-+ DEBUG( CF_DEBUG, 1, ":unable to get major number\n");
-+ return -EBUSY;
-+ }
-+
-+ DEBUG( 1, 0, "CF: make node with 'mknod /dev/cpecf b %d 0'\n", cf_major);
-+
-+ cf_devices = kzalloc( CF_DEVS * sizeof( cf_dev_t), GFP_KERNEL);
-+
-+ if( !cf_devices)
-+ goto fail_malloc;
-+
-+ for( i = 0; i < CF_DEVS; i++)
-+ setup_device( cf_devices + i, i);
-+
-+ return 0;
-+
-+fail_malloc:
-+
-+ if( cf_devices)
-+ kfree( cf_devices);
-+
-+ unregister_blkdev( cf_major, DEVICE_NAME);
-+
-+ return result;
-+}
-+
-+static void cf_module_cleanup( void)
-+{
-+ int i;
-+
-+ if( cf_devices){
-+
-+ for( i = 0; i < CF_DEVS; i++){
-+
-+ del_gendisk( cf_devices[i].gd);
-+ put_disk( cf_devices[i].gd);
-+
-+ if( cf_devices[i].queue)
-+ blk_cleanup_queue( cf_devices[i].queue);
-+ }
-+
-+ kfree( cf_devices);
-+ }
-+
-+ unregister_blkdev( cf_major, DEVICE_NAME);
-+}
-+
-+module_init( cf_module_init);
-+module_exit( cf_module_cleanup);
-+
-+MODULE_AUTHOR( "Faraday Corp.");
-+MODULE_LICENSE( "GPL");
-diff -Nur linux-3.4.113.orig/drivers/block/ftcfc010.h linux-3.4.113/drivers/block/ftcfc010.h
---- linux-3.4.113.orig/drivers/block/ftcfc010.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/block/ftcfc010.h 2016-12-01 20:59:24.380613830 +0100
-@@ -0,0 +1,438 @@
-+/* drivers/block/CPECF/ftcfc.h
-+ *
-+ * Faraday FTCFC010 Device Driver
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ *
-+ * All Rights Reserved
-+ */
-+
-+#ifndef _FTCFC_H_
-+#define _FTCFC_H_
-+
-+#define CF_DEBUG 1
-+
-+#ifndef TRUE
-+#define TRUE 1
-+#endif
-+
-+#ifndef FALSE
-+#define FALSE 0
-+#endif
-+
-+#define CF_DEVS 1 /* number of disks */
-+#define CF_MINORS 16 /* minors per disk */
-+#define CF_SECTOR_SIZE 512 /* sector size */
-+
-+/* SD Card State */
-+#define CF_CARD_REMOVE 0
-+#define CF_CARD_INSERT 1
-+#define CF_CARD_WORK 2
-+
-+/* data window register */
-+#define CFC_READ_FIFO_LEN 4
-+#define CFC_WRITE_FIFO_LEN 4
-+
-+/* card type, sd or mmc */
-+#define MEMORY_CARD_TYPE_SD 0
-+#define MEMORY_CARD_TYPE_MMC 1
-+
-+/*****************************************************************************
-+ * SYSTEM ERROR_CODE
-+ ****************************************************************************/
-+#define ERR_NO_ERROR 0x00000000
-+
-+/* command error */
-+#define ERR_DATA_CRC_ERROR 0x00000100
-+#define ERR_RSP_CRC_ERROR 0x00000200
-+#define ERR_DATA_TIMEOUT_ERROR 0x00000400
-+#define ERR_RSP_TIMEOUT_ERROR 0x00000800
-+
-+#define ERR_WAIT_OVERRUN_TIMEOUT 0x00001000
-+#define ERR_WAIT_UNDERRUN_TIMEOUT 0x00002000
-+#define ERR_WAIT_DATA_CRC_TIMEOUT 0x00004000
-+#define ERR_WAIT_TRANSFER_END_TIMEOUT 0x00008000
-+
-+#define ERR_SEND_COMMAND_TIMEOUT 0x00010000
-+
-+/* using APB DMA error */
-+#define ERR_APBDMA_RSP_ERROR 0x02000000
-+
-+/*
-+ * Please refer SanDisk SD Manual v1.9 Section 5.1.9.2 (page 5-76) to set the timeout setting
-+ */
-+#if CF_DEBUG
-+#define CFC_TIMEOUT_BASE (HZ/2) /* Unit is 500 ms */
-+#else
-+#define CFC_TIMEOUT_BASE (HZ/3) /* Unit is 333 ms */
-+#endif
-+
-+typedef struct _cf_cid_t
-+{
-+ uint ManufacturerID;
-+ uint ApplicationID;
-+ unchar ProductName[7];
-+ uint ProductRevisionHigh;
-+ uint ProductRevisionLow;
-+ uint ProductSerialNumber;
-+ uint ManufactureMonth;
-+ uint ManufactureYear;
-+} cf_cid_t;
-+
-+typedef struct _cf_ccf_t
-+{
-+ uint CSDStructure;
-+ uint MMCSpecVersion;
-+ uint TAAC_u;
-+ uint NSAC_u;
-+ uint TransferSpeed;
-+ uint CardCmdClass;
-+ uint ReadBlockLength;
-+ uint ReadBlockPartial;
-+ uint WriteBlockMisalign;
-+ uint ReadBlockMisalign;
-+ uint DSRImplemant;
-+ uint BlockNumber;
-+ uint MemorySize;
-+ uint VDDReadMin_u;
-+ uint VDDReadMax_u;
-+ uint VDDWriteMin_u;
-+ uint VDDWriteMax_u;
-+ uint EraseBlkEnable;
-+ uint EraseSectorSize;
-+ uint WriteProtectGroupSize;
-+ uint WriteProtectGroupEnable;
-+ uint WriteSpeedFactor;
-+ uint WriteBlockLength;
-+ unchar WriteBlockPartial;
-+ unchar CopyFlag;
-+ unchar PermanentWriteProtect;
-+ unchar TemporaryWriteProtect;
-+ unchar FileFormat;
-+} cf_ccf_t;
-+
-+/*****************************************************************************
-+ * SD SCR register
-+ ****************************************************************************/
-+typedef struct _cf_scr_t
-+{
-+ uint Reserved:16;
-+ uint SD_BUS_WIDTH:4;
-+ uint SD_SECURITY:3;
-+ uint DATA_STAT_AFTER_ERASE:1;
-+ uint SD_SPEC:4;
-+ uint SCR_STRUCTURE:4;
-+
-+ uint ManufacturerReserved;
-+} cf_scr_t;
-+
-+/*****************************************************************************
-+ * sd card structure
-+ ****************************************************************************/
-+typedef struct _cf_card_t
-+{
-+ /* host interface configuration */
-+ uint IOAddr; /* host controller register base address */
-+ uint DMAEnable;
-+ uint DMAChannel;
-+
-+ uint CardType;
-+
-+ uint CIDWord[4];
-+ cf_cid_t CID;
-+
-+ uint CSDWord[4];
-+ cf_ccf_t CSD;
-+
-+ ushort RCA;
-+ cf_scr_t SCR;
-+
-+ /* access time out */
-+ uint ReadAccessTimoutCycle;
-+ uint WriteAccessTimoutCycle;
-+
-+ /* system configurations */
-+ uint SysFrequency;
-+
-+ /* card status */
-+ int ActiveState;
-+ int WriteProtect;
-+
-+ void *private;
-+} cf_card_t;
-+
-+typedef struct _CF_Dev
-+{
-+ u32 dev_size; /* used same as sect_num */
-+ u32 sect_num; /* sector num */
-+ u8 blksize_bit; /* It's not used */
-+ u32 blksize; /* size of block in file system, 1024 */
-+
-+ u32 phy_blksize; /* Physical size of block on the CF. It's not used */
-+ u32 phy_sectorsize; /* the size of erasable sector. It's not used */
-+ u32 wp_grp_size; /* the size of write protected group. It's not used */
-+
-+ spinlock_t lock; /* synchronization */
-+ struct semaphore sema; /* synchronization */
-+ u32 usage;
-+
-+ u8 busy;
-+
-+ wait_queue_head_t select_wait; /* Kernel thread blocked on it. It's not used */
-+ u8 cmd; /* What command being executed. */
-+ u32 result; /* set by tasklet */
-+ u8 *buff;
-+
-+ u32 lba_sec_offset;
-+
-+ /*APB_DMA */
-+
-+ u8 DMATransDir; /* 0: IDLE, 1:READ, 2:WRITE */
-+} CF_Dev;
-+
-+#define CFC_R_IDLE 0x00
-+#define CFC_R_START_TRANSFER 0x01
-+#define CFC_R_SET_CFCARD_REG 0x02
-+#define CFC_R_SET_CFCARD_READ_CMD 0x03
-+#define CFC_R_CHK_CFCARD_READY 0x04
-+#define CFC_R_SET_DMA_REG 0x05
-+#define CFC_R_DMA_START 0x06
-+#define CFC_R_DMA_INT 0x07
-+#define CFC_R_DMA_FINISH 0x08
-+#define CFC_R_PIO_START 0x09
-+#define CFC_R_PIO_FINISH 0x0A
-+#define CFC_R_CHECK_CFCARD_BUSY 0x0B
-+#define CFC_R_CHECK_CFCARD_READY 0x0C
-+
-+#define CFC_W_IDLE 0x00
-+#define CFC_W_START_TRANSFER 0x10
-+#define CFC_W_SET_CFCARD_REG 0x20
-+#define CFC_W_SET_CFCARD_READ_CMD 0x30
-+#define CFC_W_CHK_CFCARD_READY 0x40
-+#define CFC_W_SET_DMA_REG 0x50
-+#define CFC_W_DMA_START 0x60
-+#define CFC_W_DMA_INT 0x70
-+#define CFC_W_DMA_FINISH 0x80
-+#define CFC_W_PIO_START 0x90
-+#define CFC_W_PIO_FINISH 0xA0
-+#define CFC_W_CHECK_CFCARD_BUSY 0xB0
-+#define CFC_W_CHECK_CFCARD_READY 0xC0
-+
-+#define DMA_IDLE 0x00
-+#define DMA_READ 0x01
-+#define DMA_WRITE 0x02
-+
-+typedef struct CFCTYPE
-+{
-+ u32 HostStatus; /* 0x00 */
-+ u32 ControlReg; /* 0x04 */
-+ u32 TimeCfgReg; /* 0x08 */
-+ u32 BuffCtrlReg; /* 0x0C */
-+ u32 BufferData; /* 0x10 */
-+ u32 MultiSector; /* 0x14 */
-+
-+ /* Enchanced Feature */
-+ u32 TransSzMode2En; /* 0x18 */
-+ u32 TransSzMode2Cnt; /* 0x1C */
-+ u32 Reserved[4]; /* 0x20~0x2F is reserved */
-+ u32 Revision; /* 0x30 */
-+ u32 Feature; /* 0x34 (define buffer size) */
-+
-+} CFCTYPE;
-+
-+#define cfc ((volatile struct CFCTYPE *) (FTCFC_VA_BASE))
-+
-+typedef struct _tag_CFCardInfo
-+{
-+ u32 SectTotal;
-+ u8 ConfigOptionReg;
-+ u8 ConfigAndStatusReg;
-+ u8 PinReplaceReg;
-+ u8 SocketCopyReg;
-+
-+} CF_CARD_INFO;
-+
-+#define CFC_C_Complete 0x00000400
-+#define CFC_B_Ready 0x00000200
-+#define CFC_8bit 0x00000040
-+#define CFC_16bit 0x00000000
-+#define CFC_Reset 0x00000020
-+#define CFC_T_2048 0x000C0000
-+#define CFC_T_1024 0x000B0000
-+#define CFC_T_512 0x000A0000
-+#define CFC_T_256 0x00090000
-+#define CFC_T_128 0x00080000
-+#define CFC_T_64 0x00070000
-+#define CFC_T_32 0x00060000
-+#define CFC_T_16 0x00050000
-+#define CFC_T_8 0x00040000
-+#define CFC_T_4 0x00030000
-+#define CFC_T_2 0x00020000
-+#define CFC_T_1 0x00010000
-+#define CFC_Read 0x00000000
-+#define CFC_Write 0x00008000
-+#define CFC_Increment 0x00004000
-+#define CFC_Attribute 0x00000000
-+#define CFC_Memory 0x00002000
-+#define CFC_IO 0x00003000
-+
-+/* CF status register bit mapping */
-+#define RDY_nIREQ_BIT 0x0001
-+#define CARD_DETECT_BIT 0x0002
-+#define VOL33_SENSE_BIT 0x0004
-+#define VOL40_SENSE_BIT 0x0008
-+#define STATUS_CHANGE_BIT 0x0010
-+#define SPKR_BIT 0x0020
-+#define BUF_ACTIVE_BIT 0x0100
-+#define BUF_DATA_RDY_BIT 0x0200
-+#define INTA_BIT 0x0400
-+#define BUF_SIZE_BITS 0xF000
-+#define INT_CD_BIT 0x10000
-+#define INT_IO_BIT 0x20000
-+
-+/* CF control register bit mapping */
-+#define POWER_CONTROL_BIT 0x000F
-+#define FLOW_CONTROL_BIT 0x0010
-+#define RESET_BIT 0x0020
-+#define MODE_BIT 0x0040
-+#define DMA_BIT 0x0100
-+
-+#define PWR_ON 1
-+#define PWR_OFF 0
-+
-+#define SIGNAL_ON 0x0010
-+#define SIGNAL_OFF 0x0000
-+
-+#define BYTE_MODE 0x0040
-+#define WORD_MODE 0x0000
-+
-+#define ENDMA_BIT 0x0100
-+#define DISDMA_BIT 0x0000
-+
-+#define CARD_DETECT_INT_MASK 0x0200
-+#define DATA_CMP_INT_MASK 0x0400
-+#define IO_INT_MASK 0x0800
-+
-+/* active buffer control register bit mapping */
-+#define ADR_BIT 0x007FF
-+#define TYPE_BIT 0x03000
-+#define INCADR_BIT 0x04000
-+#define RW_BIT 0x08000
-+#define TRANS_SIZE_CONTROL_BIT 0xF0000
-+
-+#define INCADR 0x04000
-+#define NOINCADR 0x00000
-+#define TRANS_SIZE_LOC 16
-+
-+#define SIZE_1_BYTE 0x01
-+#define SIZE_2_BYTE 0x02
-+#define SIZE_4_BYTE 0x03
-+#define SIZE_8_BYTE 0x04
-+#define SIZE_16_BYTE 0x05
-+#define SIZE_32_BYTE 0x06
-+#define SIZE_64_BYTE 0x07
-+#define SIZE_128_BYTE 0x08
-+#define SIZE_256_BYTE 0x09
-+#define SIZE_512_BYTE 0x0a
-+#define SIZE_1024_BYTE 0x0b
-+#define SIZE_2048_BYTE 0x0c
-+
-+#define READ_OP 0x00000
-+#define WRITE_OP 0x08000
-+
-+/* type description */
-+#define ATTRIBUTE_MEM 0x00000
-+#define COMMON_MEM 0x02000
-+
-+/*
-+ * CF card
-+ * memory map register
-+ * IO block register
-+ */
-+#define BLKMEM_DATA_REG 0x000
-+#define BLKMEM_ERROR_REG ( BLKMEM_DATA_REG + 0x01)
-+#define BLKMEM_FEATURE_REG ( BLKMEM_DATA_REG + 0x01)
-+#define BLKMEM_SECTOR_COUNT_REG ( BLKMEM_DATA_REG + 0x02)
-+#define BLKMEM_SECTOR_NUMBER_REG ( BLKMEM_DATA_REG + 0x03)
-+#define BLKMEM_CYLINDER_LOW_REG ( BLKMEM_DATA_REG + 0x04)
-+#define BLKMEM_CYLINDER_HIGH_REG ( BLKMEM_DATA_REG + 0x05)
-+#define BLKMEM_DRIVE_REG ( BLKMEM_DATA_REG + 0x06)
-+#define BLKMEM_STATUS_REG ( BLKMEM_DATA_REG + 0x07)
-+#define BLKMEM_COMMAND_REG ( BLKMEM_DATA_REG + 0x07)
-+
-+#define BLKMEM_EVEN_DATA_REG ( BLKMEM_DATA_REG + 0x08)
-+#define BLKMEM_ODD_DATA_REG ( BLKMEM_DATA_REG + 0x09)
-+#define BLKMEM_DUP_ERROR_REG ( BLKMEM_DATA_REG + 0x0d)
-+#define BLKMEM_DUP_FEATURE_REG ( BLKMEM_DATA_REG + 0x0d)
-+#define BLKMEM_DEV_CONTROL_REG ( BLKMEM_DATA_REG + 0x0e)
-+#define BLKMEM_DRIVE_ADDR_REG ( BLKMEM_DATA_REG + 0x0f)
-+#define BLKMEM_WINDOW_REG ( BLKMEM_DATA_REG + 0x400)
-+#define BLKMEM_MAX_WINDOW_REG ( BLKMEM_DATA_REG + 0x7ff)
-+
-+/* status register */
-+#define BUSY_BIT 0x80
-+#define RDY_BIT 0x40
-+#define DWF_BIT 0x20
-+#define DSC_BIT 0x10
-+#define DRQ_BIT 0x08
-+#define CORR_BIT 0x04
-+#define ERR_BIT 0x01
-+
-+/* CF ATA command */
-+#define ATA_CHECK_POWER_MODE 0xe5
-+#define ATA_EXECUTE_DRIVE_DIAG 0x90
-+#define ATA_ERASE_SECTOR 0xc0
-+#define ATA_FORMAT_TRACK 0x50
-+#define ATA_IDENTIFY_DRIVE 0xec
-+#define ATA_IDLE 0xe3
-+#define ATA_IDLE_IMMEDIATE 0xe1
-+#define ATA_INIT_DRIVE_PARA 0x91
-+#define ATA_READ_BUFFER 0xe4
-+#define ATA_READ_LONG_SECTOR 0x22
-+#define ATA_READ_MULTIPLE 0xc4
-+#define ATA_READ_SECTOR 0x21
-+#define ATA_READ_VERIFY_SECTOR 0x40
-+#define ATA_RECALIBRATE 0x10
-+#define ATA_REQUEST_SENSE 0x03
-+#define ATA_SECURITY_DISABLE_PASSWORD 0xf6
-+#define ATA_SECURITY_EREASE_PREPARE 0xf3
-+#define ATA_SECURITY_ERASE_UNIT 0xf4
-+#define ATA_SECURITY_FREEZE_LOCK 0xf5
-+#define ATA_SECURITY_SET_PASSWORD 0xf1
-+#define ATA_SECURITY_UNLOCK 0xf2
-+#define ATA_SEEK 0x70
-+#define ATA_SET_FEATURE 0xef
-+#define ATA_SET_MULTIPLE_MODE 0xc6
-+#define ATA_SET_SLEEP_MODE 0xe6
-+#define ATA_STANDBY 0xe2
-+#define ATA_STANDBY_IMMEDIATE 0xe0
-+#define ATA_TRANSFER_SECTOR 0x87
-+#define ATA_WEAR_LEVEL 0xf5
-+#define ATA_WRITE_BUFFER 0xe8
-+#define ATA_WRITE_LONG_SECTOR 0x32
-+#define ATA_WRITE_MULTIPLE 0xc5
-+#define ATA_WRITE_MULTIPLE_WO_ERASE 0xcd
-+#define ATA_WRITE_SECTOR 0x30
-+#define ATA_WRITE_SECTOR_WO_ERASE 0x38
-+#define ATA_WRITE_VERIFY 0x3c
-+
-+#define CF_MEM_MAP_MODE 0x0
-+/* attribute memory space register description */
-+#define ATTRIBUTE_MEM_BASE 0
-+#define ATTRIBUTE_MEM_CONFIG_BASE 0x200
-+#define CONFIG_OPTION_REG ( ATTRIBUTE_MEM_CONFIG_BASE + 0x00)
-+#define CARD_CONFIG_STATUS_REG ( ATTRIBUTE_MEM_CONFIG_BASE + 0x02)
-+#define PIN_REPLACE_REG ( ATTRIBUTE_MEM_CONFIG_BASE + 0x04)
-+#define SOCKET_COPY_REG ( ATTRIBUTE_MEM_CONFIG_BASE + 0x06)
-+
-+/* configuration option register */
-+#define CONF0_BIT 0x01
-+#define CONF1_BIT 0x02
-+#define CONF2_BIT 0x04
-+#define CONF3_BIT 0x08
-+#define CONF4_BIT 0x10
-+#define CONF5_BIT 0x20
-+#define LEVLREQ_BIT 0x40
-+#define SRESET_BIT 0x80
-+
-+#endif
-diff -Nur linux-3.4.113.orig/drivers/block/ftsdc010.c linux-3.4.113/drivers/block/ftsdc010.c
---- linux-3.4.113.orig/drivers/block/ftsdc010.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/block/ftsdc010.c 2016-12-01 20:59:24.384613985 +0100
-@@ -0,0 +1,2206 @@
-+/* drivers/block/CPESD/ftsdc010.c
-+ *******************************************************************************
-+ * Faraday FTSDC010 Device Driver
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ *
-+ * All Rights Reserved
-+ *
-+ * Porting to Linux 2.6 on 20050815
-+ * Author: Chris Lee, I-Jui Sung, Peter Liao (support APB DMA)
-+ * Version: 0.2
-+ * History:
-+ * 0.1 new creation
-+ * 0.2 Porting to meet the style of linux dma
-+ * 0.3 modify dma usage to virtual irq of dma interrupt
-+ * 0.4 (20050701) Improve r/w performance
-+ * 0.5 Porting to Linux 2.6 and replace busy_loop checking with timer's timeout
-+ * Todo:
-+ *******************************************************************************
-+ */
-+
-+#include <linux/kernel.h>
-+#include <linux/module.h>
-+#include <linux/sched.h>
-+#include <linux/delay.h>
-+#include <linux/init.h>
-+#include <linux/ioport.h>
-+#include <linux/hdreg.h> /* HDIO_GETGEO */
-+#include <linux/fs.h>
-+#include <linux/blkdev.h>
-+#include <linux/buffer_head.h> /* invalidate_bdev */
-+#include <linux/bio.h>
-+#include <linux/pci.h>
-+#include <linux/mutex.h>
-+#include <asm/io.h>
-+#include <asm/uaccess.h>
-+#include <asm/spec.h>
-+#include <asm/dmad.h>
-+
-+#define IPMODULE SDC
-+#define IPNAME FTSDC010
-+
-+/* Define CONFIG_FTSDC010_USE_TIMER_DELAY if you want to use software timer instead of busy loop checking */
-+#define CONFIG_FTSDC010_USE_TIMER_DELAY
-+#undef CONFIG_FTSDC010_USE_TIMER_DELAY
-+#include "ftsdc010.h"
-+#include <linux/interrupt.h>
-+MODULE_AUTHOR("Faraday Corp.");
-+MODULE_LICENSE("Faraday License");
-+
-+/* options */
-+#define FORCE_PCI_CONSISTENCY 1 /* define it to 1 if met consistency problems */
-+#define KERNEL_SECTOR_SIZE 512 /* Use this when we refer to kernel related sector size */
-+
-+static int hardsect_size = 512;
-+module_param(hardsect_size, int, 0);
-+/*------------------------------------------------------------------------------
-+ * Predefine for block device
-+ */
-+#define MAJOR_NR sd_major /* force definitions on in blk.h */
-+static int sd_major=0;//SD_MAJOR; /* must be declared before including blk.h */
-+#define SD_SHIFT 4 /* max 16 partitions */
-+#define DEVICE_NAME "Faraday SDC" /* name for messaging */
-+#define DEVICE_REQUEST sd_request
-+#define DEVICE_NR(device) (MINOR(device) >> SD_SHIFT)
-+//#define DEVICE_INTR sd_intrptr /* pointer to the bottom half */
-+#define DEVICE_NO_RANDOM /* no entropy to contribute */
-+#define DEVICE_OFF(d) /* do-nothing */
-+
-+/*#include <linux/blk.h>
-+#include <linux/blkpg.h>*/ /* blk_ioctl() */
-+
-+/*------------------------------------------------------------------------------
-+ * Macro definition
-+ */
-+#define FTSDC_VA_BASE IP_VA_BASE(0)
-+#define FTSDC_PA_BASE IP_PA_BASE(0)
-+#define FTSDC_IRQ IP_IRQ(0)
-+#define SDC_W_REG(offset, value) outl(value, IP_VA_BASE(0) + offset)
-+#define SDC_R_REG(offset) inl(IP_VA_BASE(0) + offset)
-+
-+
-+/*------------------------------------------------------------------------------
-+ * Global variable
-+ */
-+
-+/* The following items are obtained through kmalloc() in sd_module_init() */
-+
-+struct block_device_operations sd_fops;
-+/* our device structure */
-+struct sd_dev {
-+ int size; /* device size in sectors */
-+ int usage; /* # of users currently */
-+ int media_change; /* Flag: media changed? */
-+ struct gendisk *gd; /* The gendisk structure */
-+ spinlock_t lock; /* For mutual exclusion */
-+ struct request_queue *queue; /* The device request queue */
-+ int card_state;
-+ dmad_chreq ch_req;
-+ bool dma_enable;
-+};
-+static struct sd_dev *sd_devices = NULL;
-+
-+static sd_card_t sd_card_info;
-+static int sector_offset,Do_onetime;
-+
-+dma_addr_t dma_buf = 0; /* ?? non-zero for for manually debug ?? */
-+struct completion sd_dma_cmpl;
-+
-+static int sync_mode=0;
-+
-+static uint first_run = 0;
-+uint sd_err_code;
-+
-+#define FILE_FORMAT_HARD_DISK_LIKE 0
-+#define FILE_FORMAT_FLOPPY_LIKE 1
-+#define FILE_FORMAT_UNIVERSAL 2
-+#define FILE_FORMAT_UNKNOW 3
-+#define FILE_FORMAT_RESERVED 4
-+
-+#define K 1000
-+
-+uint TAAC_TimeUnitTable[] = { // unit is ns
-+ 1, 10, 100, 1 * K, 10 * K, 100 * K, 1 * K * K, 10 * K * K
-+};
-+
-+uint TRANS_SPEED_RateUintTable[] = {
-+ 100 * K, 1 * K * K, 10 * K * K, 100 * K * K
-+};
-+
-+uint TRANS_SPEED_TimeValueTable_u[] = { // unit=1/10
-+ 0, 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80
-+};
-+
-+uint VDD_CURR_MIN_Table_u[] = { // unit=1/10
-+ 5, 10, 50, 100, 250, 350, 600, 1000
-+};
-+
-+uint VDD_CURR_MAX_Table_u[] = {
-+ 1, 5, 10, 25, 35, 45, 80, 200
-+};
-+
-+uint TAAC_TimeValueTable_u[] = { // unit=1/10
-+ 0, 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80
-+};
-+
-+
-+unsigned int SDC_READ_FIFO_LEN;
-+unsigned int SDC_WRITE_FIFO_LEN;
-+
-+/*------------------------------------------------------------------------------
-+ * Local declaration of function
-+ */
-+static int sd_revalidate(struct gendisk *gd);
-+static int sd_media_changed(struct gendisk *gd);
-+static int sd_card_setup(struct sd_dev *dev);
-+int sd_check_err(uint status);
-+int sd_get_scr(sd_card_t *info, uint *scr);
-+int sd_set_transfer_state(sd_card_t *info);
-+uint sd_block_size_convert(uint size);
-+int sd_read_sector(sd_card_t *info, uint addr, uint count, unchar *buf);
-+void sd_reset_host_controller(void);
-+/*------------------------------------------------------------------------------
-+ * Local function
-+ */
-+
-+/*
-+ * SD host controller operation
-+ */
-+int sdc_send_cmd(uint cmd, uint arg, uint *rsp)
-+{
-+#ifndef CONFIG_FTSDC010_USE_TIMER_DELAY
-+ int count = 0;
-+#else
-+ unsigned long timeout = jiffies + SDC_GET_STATUS_RETRY_TIMEOUT_COUNT;
-+#endif
-+ int i;
-+ uint status;
-+ P_DEBUG("SD Cmd is %d\n",cmd);
-+
-+ /* clear command relative bits of status register */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_RSP_CRC_FAIL | SDC_STATUS_REG_RSP_TIMEOUT | SDC_STATUS_REG_RSP_CRC_OK| SDC_STATUS_REG_CMD_SEND);
-+ /* write argument to arugument register if necessary */
-+ SDC_W_REG(SDC_ARGU_REG, arg);
-+ /* send command */
-+ SDC_W_REG(SDC_CMD_REG, cmd | SDC_CMD_REG_CMD_EN);
-+
-+ /* wait for the CMD_SEND bit of status register is set */
-+#ifndef CONFIG_FTSDC010_USE_TIMER_DELAY
-+ while (count++ < SDC_GET_STATUS_RETRY_COUNT) {
-+#else
-+ while (time_before(jiffies, timeout)) {
-+#endif
-+ status = SDC_R_REG(SDC_STATUS_REG);
-+ if (!(cmd & SDC_CMD_REG_NEED_RSP)) {
-+ /* if this command does not need response, wait command sent flag */
-+ if (status & SDC_STATUS_REG_CMD_SEND) {
-+ /* clear command sent bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_CMD_SEND);
-+ sd_err_code = ERR_NO_ERROR;
-+ return TRUE;
-+ }
-+ } else {
-+ /* if this command needs response */
-+ if (status & SDC_STATUS_REG_RSP_TIMEOUT) {
-+ /* clear response timeout bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_RSP_TIMEOUT);
-+ sd_err_code = ERR_RSP_TIMEOUT_ERROR;
-+ printk("%s() ERR_RSP_TIMEOUT_ERROR\n", __func__);
-+ return FALSE;
-+ } else if (status & SDC_STATUS_REG_RSP_CRC_FAIL) {
-+ /* clear response fail bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_RSP_CRC_FAIL);
-+ sd_err_code = ERR_RSP_CRC_ERROR;
-+ printk("%s() ERR_RSP_CRC_ERROR\n", __func__);
-+ return FALSE;
-+ } else if (status & SDC_STATUS_REG_RSP_CRC_OK) {
-+ /* clear response OK bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_RSP_CRC_OK);
-+ /* if it is long response */
-+ if (cmd & SDC_CMD_REG_LONG_RSP)
-+ for (i = 0; i < 4; i++, rsp++)
-+ *rsp = SDC_R_REG(SDC_RESPONSE0_REG + (i * 4));
-+ else
-+ *rsp = SDC_R_REG(SDC_RESPONSE0_REG);
-+ sd_err_code = ERR_NO_ERROR;
-+ return TRUE;
-+ }
-+ }
-+ }
-+ sd_err_code = ERR_SEND_COMMAND_TIMEOUT;
-+ P_DEBUG("%s() ERR_SEND_COMMAND_TIMEOUT\n", __func__);
-+ return FALSE;
-+}
-+
-+int sdc_check_tx_ready(void)
-+{
-+ uint status;
-+#ifndef CONFIG_FTSDC010_USE_TIMER_DELAY
-+ int count = 0;
-+ while (count++ < SDC_GET_STATUS_RETRY_COUNT) {
-+#else
-+ unsigned long timeout = jiffies + SDC_GET_STATUS_RETRY_TIMEOUT_COUNT;
-+ while (time_before(jiffies, timeout)) {
-+#endif
-+ status = SDC_R_REG(SDC_STATUS_REG);
-+ if (status & SDC_STATUS_REG_FIFO_UNDERRUN) {
-+ /* clear FIFO underrun bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_FIFO_UNDERRUN);
-+ return TRUE;
-+ } else if (status & SDC_STATUS_REG_DATA_TIMEOUT) {
-+ /* clear data timeout bit */
-+ printk("Wait Write FIFO TimeOut\n");
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_DATA_TIMEOUT);
-+ sd_err_code = ERR_DATA_TIMEOUT_ERROR;
-+ return FALSE;
-+ }
-+ }
-+ sd_err_code = ERR_WAIT_UNDERRUN_TIMEOUT;
-+ P_DEBUG("%s() ERR_WAIT_UNDERRUN_TIMEOUT\n", __func__);
-+ return FALSE;
-+}
-+
-+int sdc_check_rx_ready(void)
-+{
-+ uint status;
-+#ifndef CONFIG_FTSDC010_USE_TIMER_DELAY
-+ int count = 0;
-+ while (count++ < SDC_GET_STATUS_RETRY_COUNT) {
-+#else
-+ unsigned long timeout = jiffies + SDC_GET_STATUS_RETRY_TIMEOUT_COUNT;
-+ while (time_before(jiffies, timeout)) {
-+#endif
-+ status = SDC_R_REG(SDC_STATUS_REG);
-+ if (status & SDC_STATUS_REG_FIFO_OVERRUN) {
-+ /* clear FIFO overrun bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_FIFO_OVERRUN);
-+ return TRUE;
-+ } else if (status & SDC_STATUS_REG_DATA_TIMEOUT) {
-+ /* clear data timeout bit */
-+ printk("Wait Read FIFO TimeOut\n");
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_DATA_TIMEOUT);
-+ sd_err_code = ERR_DATA_TIMEOUT_ERROR;
-+ return FALSE;
-+ }
-+ }
-+ sd_err_code = ERR_WAIT_OVERRUN_TIMEOUT;
-+ P_DEBUG("%s() ERR_WAIT_OVERRUN_TIMEOUT\n", __func__);
-+ return FALSE;
-+}
-+
-+int sdc_check_data_crc(void)
-+{
-+ uint status=0;
-+#ifndef CONFIG_FTSDC010_USE_TIMER_DELAY
-+ int count = 0;
-+ while (count++ < SDC_GET_STATUS_RETRY_COUNT) {
-+#else
-+ unsigned long timeout = jiffies + SDC_GET_STATUS_RETRY_TIMEOUT_COUNT;
-+ while (time_before(jiffies, timeout)) {
-+#endif
-+ status = SDC_R_REG(SDC_STATUS_REG);
-+ if (status & SDC_STATUS_REG_DATA_CRC_OK) {
-+ P_DEBUGG("%s : receive data ok, status=0x%x\n", __func__, status);
-+ /* clear data CRC OK bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_DATA_CRC_OK);
-+ return TRUE;
-+ } else if (status & SDC_STATUS_REG_DATA_CRC_FAIL) {
-+ /* clear data CRC fail bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_DATA_CRC_FAIL);
-+ sd_err_code = ERR_DATA_CRC_ERROR;
-+ printk("%s() ERR_DATA_CRC_ERROR\n", __func__);
-+ return FALSE;
-+ } else if (status & SDC_STATUS_REG_DATA_TIMEOUT) {
-+ /* clear data timeout bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_DATA_TIMEOUT);
-+ sd_err_code = ERR_DATA_TIMEOUT_ERROR;
-+ printk("%s() ERR_DATA_TIMEOUT_ERROR\n", __func__);
-+ return FALSE;
-+ }
-+ }
-+ P_DEBUG("%s() ERR_WAIT_DATA_CRC_TIMEOUT, status=0x%x\n", __func__, status);
-+ sd_err_code = ERR_WAIT_DATA_CRC_TIMEOUT;
-+ return FALSE;
-+}
-+
-+static inline int sdc_check_data_end(void)
-+{
-+ uint status;
-+#ifndef CONFIG_FTSDC010_USE_TIMER_DELAY
-+ int count = 0;
-+ while (count++ < SDC_GET_STATUS_RETRY_COUNT) {
-+#else
-+ unsigned long timeout = jiffies + SDC_GET_STATUS_RETRY_TIMEOUT_COUNT;
-+ while (time_before(jiffies, timeout)) {
-+#endif
-+ status = SDC_R_REG(SDC_STATUS_REG);
-+ if (status & SDC_STATUS_REG_DATA_END) {
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_DATA_END);
-+ return TRUE;
-+ } else if (status & SDC_STATUS_REG_DATA_TIMEOUT) {
-+ /* clear data timeout bit */
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_DATA_TIMEOUT);
-+ sd_err_code = ERR_DATA_TIMEOUT_ERROR;
-+ printk("%s() ERR_DATA_TIMEOUT_ERROR\n", __func__);
-+ return FALSE;
-+ }
-+ }
-+ sd_err_code = ERR_WAIT_TRANSFER_END_TIMEOUT;
-+ P_DEBUG("%s() ERR_WAIT_TRANSFER_END_TIMEOUT\n", __func__);
-+ return FALSE;
-+}
-+
-+int sdc_set_bus_width_cmd(sd_card_t *info, uint width)
-+{
-+ uint status;
-+
-+ /* send CMD55 to indicate to the card that the next command is an application specific command */
-+ if (!sdc_send_cmd(SD_APP_CMD | SDC_CMD_REG_NEED_RSP, (((uint)info->RCA) << 16), &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ /* send ACMD6 to set bus width */
-+ if (!sdc_send_cmd(SD_SET_BUS_WIDTH_CMD | SDC_CMD_REG_APP_CMD | SDC_CMD_REG_NEED_RSP, width, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+
-+ return TRUE;
-+}
-+
-+int sdc_set_bus_width(sd_card_t *info)
-+{
-+ uint width;
-+
-+ /* if it is not SD card, it does not support wide bus */
-+ if (info->CardType != MEMORY_CARD_TYPE_SD)
-+ return TRUE;
-+ /* get SCR register */
-+ if (!sd_get_scr(info, (uint *) &info->SCR))
-+ return FALSE;
-+ /* if host controller does not support wide bus, return */
-+ if ((SDC_R_REG(SDC_BUS_WIDTH_REG) & SDC_WIDE_BUS_SUPPORT) != SDC_WIDE_BUS_SUPPORT)
-+ return TRUE;
-+ if (!sd_set_transfer_state(info))
-+ return FALSE;
-+ if (info->SCR.SD_BUS_WIDTH & SD_SCR_4_BIT_BIT)
-+ width = SD_BUS_WIDTH_4_BIT;
-+ else
-+ width = SD_BUS_WIDTH_1_BIT;
-+ if (!sdc_set_bus_width_cmd(info, width))
-+ return FALSE;
-+ if (width == SD_BUS_WIDTH_1_BIT)
-+ SDC_W_REG(SDC_BUS_WIDTH_REG, SDC_BUS_WIDTH_REG_SINGLE_BUS);
-+ else
-+ SDC_W_REG(SDC_BUS_WIDTH_REG, SDC_BUS_WIDTH_REG_WIDE_BUS);
-+
-+ return TRUE;
-+}
-+
-+static inline int sdc_pre_erase_cmd(uint nr_blocks)
-+{
-+ uint status;
-+ sd_card_t *info=&sd_card_info;
-+ /* send CMD55 to indicate to the card that the next command is an application specific command */
-+ if (!sdc_send_cmd(SD_APP_CMD | SDC_CMD_REG_NEED_RSP, (((uint)info->RCA) << 16), &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ /* send ACMD6 to set bus width */
-+ if (!sdc_send_cmd(23 | SDC_CMD_REG_APP_CMD | SDC_CMD_REG_NEED_RSP, nr_blocks, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+
-+ return TRUE;
-+}
-+
-+
-+uint sdc_set_bus_clock(sd_card_t *info, uint clock)
-+{
-+ uint div = 0, reg;
-+
-+ while (clock < (info->SysFrequency / (2 * (div + 1))))
-+ div++;
-+ /* write clock divided */
-+ reg = SDC_R_REG(SDC_CLOCK_CTRL_REG);
-+ reg &= (~SDC_CLOCK_REG_CLK_DIV | 0x80); //ijsung: preserv SD or MMC
-+ reg += div & SDC_CLOCK_REG_CLK_DIV;
-+ SDC_W_REG(SDC_CLOCK_CTRL_REG, reg);
-+ P_DEBUG("%s: SD clock=%d, info->SysFrequency=%d, div=%d\n",__func__,clock, info->SysFrequency, div);
-+ return info->SysFrequency / (2 * (div + 1));
-+}
-+
-+static inline int sdc_set_block_size(uint size)
-+{
-+ uint status;
-+ static uint last_size=0;
-+ if (size == last_size)
-+ return TRUE;
-+ else
-+ last_size=size;
-+
-+ if (!sdc_send_cmd(SD_SET_BLOCKLEN_CMD | SDC_CMD_REG_NEED_RSP, size, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ return TRUE;
-+}
-+
-+void sdc_set_card_type(int type)
-+{
-+ uint reg;
-+
-+ reg = SDC_R_REG(SDC_CLOCK_CTRL_REG);
-+ reg &= ~SDC_CLOCK_REG_CARD_TYPE;
-+
-+ if (type == MEMORY_CARD_TYPE_SD) {
-+ reg |= SDC_CARD_TYPE_SD;
-+ }
-+ else {
-+ reg |= SDC_CARD_TYPE_MMC;
-+ }
-+
-+ SDC_W_REG(SDC_CLOCK_CTRL_REG, reg);
-+}
-+
-+int sdc_read_block(sd_card_t *info, uint size, uint *buf)
-+{
-+ /*
-+ * Please refer SanDisk SD Manual v1.9 Section 5.1.9.2 (page 5-76) to set the timeout setting
-+ */
-+ unsigned long timeout = jiffies + SDC_TIMEOUT_BASE*((size+511)>>9);
-+ uint count, i;
-+ dmad_chreq *ch_req = (dmad_chreq *)info->private;
-+ dmad_drb *drb = 0;
-+ u32 drb_size = 0;
-+ dma_addr_t addr_iter;
-+
-+ //if (info->DMAEnable) {
-+ if ((info->DMAEnable) && ((size & 0xf) == 0)) {
-+ P_DEBUG("%s:size=%d, buf=%p) - DMA Read\n", __func__, size,buf );
-+ P_DEBUG("dma_buf = %d\n", dma_buf);
-+
-+ init_completion(&sd_dma_cmpl);
-+
-+ if (dma_buf)
-+ consistent_sync(__va(dma_buf), size, DMA_FROM_DEVICE);
-+ else
-+ consistent_sync(buf, size, DMA_FROM_DEVICE);
-+
-+ //prepare parameter for add dma entry
-+ dmad_config_channel_dir(ch_req, DMAD_DIR_A0_TO_A1);
-+
-+ drb_size = dmad_max_size_per_drb(ch_req);
-+
-+ if (dma_buf)
-+ addr_iter = dma_buf; // given dest phy addr
-+ else
-+ addr_iter = __pa(buf);
-+
-+ while (size > 0) {
-+
-+ if (unlikely(0 != dmad_alloc_drb(ch_req, &drb) || (drb == 0))) {
-+ printk(KERN_ERR "%s() Failed to allocate dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+
-+ drb->addr0 = FTSDC_PA_BASE + SDC_DATA_WINDOW_REG;
-+ drb->addr1 = addr_iter;
-+
-+ if (size <= drb_size) {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, size);
-+ drb->sync = &sd_dma_cmpl;
-+ size = 0;
-+ } else {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, drb_size);
-+ drb->sync = 0;
-+ size -= drb_size;
-+ addr_iter += drb_size;
-+ }
-+ //printk(KERN_INFO "%s() size_remain 0x%08x.\n", __func__, size);
-+
-+ if (unlikely(0 != dmad_submit_request(ch_req, drb, 1))) {
-+ printk(KERN_ERR "%s() Failed to submit dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+ }
-+
-+ if (wait_for_completion_timeout(&sd_dma_cmpl, timeout - jiffies) == 0)
-+ printk("%s: read timeout\n", __func__);
-+ } else {
-+ while (size > 0) {
-+ if (!sdc_check_rx_ready()) {
-+ printk("error...........\n");
-+ return FALSE;
-+ }
-+ /* read data from FIFO */
-+ if (size >= (SDC_READ_FIFO_LEN << 2))
-+ count = SDC_READ_FIFO_LEN;
-+ else
-+ count = size >> 2;
-+ /* read data from FIFO */
-+ P_DEBUG("\n");
-+ for (i = 1; i <= count; i++, buf++)
-+ {
-+ *buf = SDC_R_REG(SDC_DATA_WINDOW_REG);
-+ P_DEBUG("%.8x ",*buf);
-+ }
-+ size -= (count << 2);
-+ }
-+ }
-+ return sdc_check_data_crc();
-+}
-+
-+int sdc_write_block(sd_card_t *info, uint size, uint *buf)
-+{
-+ unsigned long timeout = jiffies + SDC_TIMEOUT_BASE*3*((size+511)>>9);
-+ uint count, i;
-+ dmad_chreq *ch_req = (dmad_chreq *)info->private;
-+ dmad_drb *drb = 0;
-+ u32 drb_size = 0;
-+ dma_addr_t addr_iter;
-+
-+ //if (info->DMAEnable) {
-+ if ((info->DMAEnable) && ((size & 0xf) == 0)) {
-+ P_DEBUG("%s:size=%d, buf=%p) - DMA Write\n", __func__, size,buf );
-+
-+ init_completion(&sd_dma_cmpl);
-+
-+ if (dma_buf)
-+ consistent_sync(__va(dma_buf), size, DMA_TO_DEVICE);
-+ else
-+ consistent_sync(buf, size, DMA_TO_DEVICE);
-+
-+ //prepare parameter for add dma entry
-+ dmad_config_channel_dir(ch_req, DMAD_DIR_A1_TO_A0);
-+
-+ drb_size = dmad_max_size_per_drb(ch_req);
-+
-+ if (dma_buf)
-+ addr_iter = dma_buf; // given dest phy addr
-+ else
-+ addr_iter = __pa(buf);
-+
-+ while (size > 0) {
-+
-+ if (unlikely(0 != dmad_alloc_drb(ch_req, &drb) || (drb == 0))) {
-+ printk(KERN_ERR "%s() Failed to allocate dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+
-+ drb->addr0 = FTSDC_PA_BASE + SDC_DATA_WINDOW_REG;
-+ drb->addr1 = addr_iter;
-+
-+ if (size <= drb_size) {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, size);
-+ drb->sync = &sd_dma_cmpl;
-+ size = 0;
-+ } else {
-+ drb->req_cycle = dmad_bytes_to_cycles(ch_req, drb_size);
-+ drb->sync = 0;
-+ size -= drb_size;
-+ addr_iter += drb_size;
-+ }
-+ //printk(KERN_INFO "%s() size_remain 0x%08x.\n", __func__, size);
-+
-+ if (unlikely(0 != dmad_submit_request(ch_req, drb, 1))) {
-+ printk(KERN_ERR "%s() Failed to submit dma request block!\n", __func__);
-+ return FALSE;
-+ }
-+ }
-+
-+ if (wait_for_completion_timeout(&sd_dma_cmpl, timeout - jiffies) == 0)
-+ printk("write timeout\n");
-+ } else {
-+ while (size > 0) {
-+ if (!sdc_check_tx_ready())
-+ return FALSE;
-+ /* write data from FIFO */
-+ if (size >= (SDC_WRITE_FIFO_LEN << 2))
-+ count = SDC_WRITE_FIFO_LEN;
-+ else
-+ count = (size >> 2) ;
-+ /* write data from FIFO */
-+ for (i = 0; i < count; i++, buf++)
-+ SDC_W_REG(SDC_DATA_WINDOW_REG, *buf);
-+ size -= (count << 2);
-+ }
-+ }
-+ return sdc_check_data_crc();
-+}
-+
-+void sdc_config_transfer(sd_card_t *SDCard, uint len, uint size, uint rw, uint timeout)
-+{
-+ u32 con;
-+ /* write timeout */
-+ SDC_W_REG(SDC_DATA_TIMER_REG, timeout * 2);
-+ /* set data length */
-+ SDC_W_REG(SDC_DATA_LEN_REG, len);
-+
-+ /* set data block */
-+ if (SDCard->DMAEnable) {
-+ con = sd_block_size_convert(size) | SDC_DATA_CTRL_REG_DMA_EN | rw | SDC_DATA_CTRL_REG_DATA_EN;
-+ con |= SDC_DMA_TYPE_4;
-+ P_DEBUG("%s() transfer DMA mode\n", __func__);
-+ SDC_W_REG(SDC_DATA_CTRL_REG, con);
-+ } else {
-+ P_DEBUG("%s() transfer nonDMA mode\n", __func__);
-+ SDC_W_REG(SDC_DATA_CTRL_REG, sd_block_size_convert(size) | rw | SDC_DATA_CTRL_REG_DATA_EN);
-+ }
-+}
-+
-+/* Note: This funciton may be called by interrupt handler */
-+void sdc_reset(void)
-+{
-+ uint ret;
-+ unsigned long delay = jiffies + (HZ/10)*3; //Delay 300ms
-+
-+ /* reset host interface */
-+ SDC_W_REG(SDC_CMD_REG, SDC_CMD_REG_SDC_RST);
-+
-+ /* loop, until the reset bit is clear */
-+ do {
-+ ret = SDC_R_REG(SDC_CMD_REG);
-+ } while ((ret & SDC_CMD_REG_SDC_RST) != 0);
-+ #if 0
-+ udelay(1000);
-+ #else
-+ while(time_before(jiffies, delay));
-+ #endif
-+}
-+
-+/*
-+ * SD card operation
-+ */
-+void sd_endian_change(uint *dt, int len)
-+{
-+ uint ul;
-+
-+ for(; len > 0; len--, dt++) {
-+ ul = *dt;
-+ ((unchar *)dt)[0] = ((unchar *)&ul)[3];
-+ ((unchar *)dt)[1] = ((unchar *)&ul)[2];
-+ ((unchar *)dt)[2] = ((unchar *)&ul)[1];
-+ ((unchar *)dt)[3] = ((unchar *)&ul)[0];
-+ }
-+}
-+
-+int sd_get_ocr(sd_card_t *info, uint hocr, uint *cocr)
-+{
-+ uint status;
-+ int count = 0;
-+
-+ do {
-+ if (info->CardType == MEMORY_CARD_TYPE_SD) {
-+ /* send CMD55 to indicate to the card that the next command is an application specific command */
-+ if (!sdc_send_cmd(SD_APP_CMD | SDC_CMD_REG_NEED_RSP, ((uint) info->RCA) << 16, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ /* send ACMD41 to get OCR register */
-+ if (!sdc_send_cmd(SD_APP_OP_COND | SDC_CMD_REG_APP_CMD | SDC_CMD_REG_NEED_RSP, (uint) hocr, (uint *) cocr))
-+ return FALSE;
-+ } else {
-+ /* send CMD1 to get OCR register */
-+ if (!sdc_send_cmd(SD_MMC_OP_COND | SDC_CMD_REG_NEED_RSP, (uint) hocr, (uint *) cocr))
-+ return FALSE;
-+ }
-+ if (count++ > SD_CARD_GET_OCR_RETRY_COUNT) {
-+ sd_err_code = ERR_SD_CARD_IS_BUSY;
-+ printk("%s : ERR_SD_CARD_IS_BUSY\n", __func__);
-+ return FALSE;
-+ }
-+ udelay(1000); /* According to spec, at most 1 msec or 74 clock cycles */
-+ } while ((*cocr & SD_OCR_BUSY_BIT) != SD_OCR_BUSY_BIT);
-+
-+ return TRUE;
-+}
-+
-+int sd_get_scr(sd_card_t *info, uint *scr)
-+{
-+ uint status;
-+
-+ if (!sd_set_transfer_state(info))
-+ return FALSE;
-+ if (!sdc_set_block_size(8))
-+ return FALSE;
-+ sdc_config_transfer(info, 8, 8, SDC_DATA_CTRL_REG_DATA_READ, 0xFFFFFFFF);
-+ /* send CMD55 to indicate to the card that the next command is an application specific command */
-+ if (!sdc_send_cmd(SD_APP_CMD | SDC_CMD_REG_NEED_RSP, ((uint) info->RCA) << 16, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ /* send ACMD51 to get SCR */
-+ if (!sdc_send_cmd(SD_SEND_SCR_CMD | SDC_CMD_REG_APP_CMD | SDC_CMD_REG_NEED_RSP, 0, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ if (!sdc_read_block(info, 8, (uint *) scr))
-+ return FALSE;
-+ if (!sdc_check_data_end())
-+ return FALSE;
-+ sd_endian_change(scr, 2);
-+
-+ return TRUE;
-+}
-+
-+int sd_check_err(uint status)
-+{
-+ if (status & SD_STATUS_ERROR_BITS) {
-+ sd_err_code = ERR_SD_CARD_STATUS_ERROR;
-+ printk("%s() ERR_SD_CARD_STATUS_ERROR %X\n", __func__, status);
-+ return FALSE;
-+ }
-+ sd_err_code = ERR_NO_ERROR;
-+ return TRUE;
-+}
-+
-+int sd_get_card_state(sd_card_t *info, uint *ret)
-+{
-+ uint status;
-+
-+ /* send CMD13 to get card status */
-+ if (!sdc_send_cmd(SD_SEND_STATUS_CMD | SDC_CMD_REG_NEED_RSP, ((uint) info->RCA) << 16, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ *ret = (status & SD_STATUS_CURRENT_STATE) >> SD_STATUS_CURRENT_STATE_LOC;
-+ return TRUE;
-+}
-+
-+int sd_operation_complete(sd_card_t *info, uint finish)
-+{
-+ uint state;
-+ int count = 0;
-+ while (count++ < SD_CARD_WAIT_OPERATION_COMPLETE_RETRY_COUNT) {
-+ if (!sd_get_card_state(info, &state))
-+ return FALSE;
-+ if (state == finish)
-+ return TRUE;
-+ }
-+ P_DEBUG("%s() error\n", __func__);
-+ return FALSE;
-+}
-+
-+int sd_stop_transmission(void)
-+{
-+ uint status;
-+
-+ /* send CMD12 to stop transmission */
-+ if (!sdc_send_cmd(SD_STOP_TRANSMISSION_CMD | SDC_CMD_REG_NEED_RSP, 0, &status))
-+ return FALSE;
-+
-+ if (!sd_check_err(status))
-+ return FALSE;
-+
-+ return TRUE;
-+}
-+
-+int sd_set_card_standby(sd_card_t *info)
-+{
-+ uint state;
-+ int count = 0;
-+ while (count++ < SD_CARD_STATE_CHANGE_RETRY_COUNT) {
-+ if (!sd_get_card_state(info, &state))
-+ return FALSE;
-+
-+ switch (state) {
-+ case SD_IDLE_STATE:
-+ case SD_READY_STATE:
-+ case SD_IDENT_STATE:
-+ printk("%s() error\n", __func__);
-+ return FALSE;
-+ case SD_DIS_STATE:
-+ return sd_operation_complete(info, SD_STBY_STATE);
-+ case SD_TRAN_STATE:
-+ if (!sdc_send_cmd(SD_SELECT_CARD_CMD, 0, NULL))
-+ return FALSE;
-+ break;
-+ case SD_DATA_STATE:
-+ if (sd_operation_complete(info, SD_TRAN_STATE))
-+ return TRUE;
-+ if (sd_err_code != ERR_NO_ERROR)
-+ return FALSE;
-+ if (!sd_stop_transmission())
-+ return FALSE;
-+ break;
-+ case SD_RCV_STATE:
-+ if (sd_operation_complete(info, SD_TRAN_STATE))
-+ return TRUE;
-+ if (sd_err_code != ERR_NO_ERROR)
-+ return FALSE;
-+ if (!sd_stop_transmission())
-+ return FALSE;
-+ break;
-+ case SD_PRG_STATE:
-+ if (!sd_operation_complete(info, SD_TRAN_STATE))
-+ return FALSE;
-+ break;
-+ case SD_STBY_STATE:
-+ return TRUE;
-+ }
-+ }
-+ P_DEBUG("%s() error\n", __func__);
-+ return FALSE;
-+}
-+
-+uint two_power(uint n)
-+{
-+ uint pow = 1;
-+
-+ for (; n > 0; n--)
-+ pow <<= 1;
-+ return pow;
-+}
-+
-+int sd_csd_parse(sd_csd_t *csd, uint *csd_word)
-+{
-+ sd_csd_bit_t *csd_bit;
-+ uint mult, blocks, len;
-+
-+ if ((csd_word[0] & 0x00000001) != 1) {
-+ sd_err_code = ERR_CSD_REGISTER_ERROR;
-+ printk("%s() ERR_CSD_REGISTER_ERROR\n", __func__);
-+ return FALSE;
-+ }
-+
-+ csd_bit = (sd_csd_bit_t *) csd_word;
-+ csd->CSDStructure = csd_bit->CSD_STRUCTURE;
-+ csd->MMCSpecVersion = csd_bit->MMC_SPEC_VERS;
-+ csd->TAAC_u = TAAC_TimeValueTable_u[csd_bit->TAAC_TimeValue] * TAAC_TimeUnitTable[csd_bit->TAAC_TimeUnit] / 10;
-+ csd->NSAC_u = csd_bit->NSAC * 100;
-+ csd->TransferSpeed = TRANS_SPEED_RateUintTable[csd_bit->TRAN_SPEED_RateUnit] * TRANS_SPEED_TimeValueTable_u[csd_bit->TRAN_SPEED_TimeValue] / 10;
-+ csd->CardCmdClass = csd_bit->CCC;
-+ csd->ReadBlockLength = two_power(csd_bit->READ_BL_LEN);
-+ csd->ReadBlockPartial = csd_bit->READ_BL_PARTIAL;
-+ csd->WriteBlockMisalign = csd_bit->WRITE_BLK_MISALIGN;
-+ csd->ReadBlockMisalign = csd_bit->READ_BLK_MISALIGN;
-+ csd->DSRImplemant = csd_bit->DSR_IMP;
-+ mult = 1 << (csd_bit->C_SIZE_MULT + 2);
-+ blocks = ((csd_bit->C_SIZE_1 | (csd_bit->C_SIZE_2 << 2)) + 1) * mult;
-+ len = 1 << (csd_bit->READ_BL_LEN);
-+ csd->BlockNumber = blocks;
-+ csd->MemorySize = blocks * len;
-+ csd->VDDReadMin_u = VDD_CURR_MIN_Table_u[csd_bit->VDD_R_CURR_MIN];
-+ csd->VDDReadMax_u = VDD_CURR_MAX_Table_u[csd_bit->VDD_R_CURR_MAX];
-+ csd->VDDWriteMin_u = VDD_CURR_MIN_Table_u[csd_bit->VDD_W_CURR_MIN];
-+ csd->VDDWriteMax_u = VDD_CURR_MAX_Table_u[csd_bit->VDD_W_CURR_MAX];
-+ csd->EraseBlkEnable = csd_bit->ERASE_BLK_ENABLE;
-+ csd->EraseSectorSize = csd_bit->ERASE_SECTOR_SIZE + 1;
-+ csd->WriteProtectGroupSize = csd_bit->WP_GRP_SIZE + 1;
-+ csd->WriteProtectGroupEnable = csd_bit->WP_GRP_ENABLE;
-+ csd->WriteSpeedFactor = two_power(csd_bit->R2W_FACTOR);
-+ csd->WriteBlockLength = two_power(csd_bit->WRITE_BL_LEN);
-+ csd->WriteBlockPartial = csd_bit->WRITE_BL_PARTIAL;
-+ csd->CopyFlag = csd_bit->COPY;
-+ csd->PermanentWriteProtect = csd_bit->PERM_WRITE_PROTECT;
-+ csd->TemporaryWriteProtect = csd_bit->TMP_WRITE_PROTECT;
-+
-+ if (csd_bit->FILE_FORMAT_GRP == 0)
-+ csd->FileFormat = csd_bit->FILE_FORMAT;
-+ else
-+ csd->FileFormat = FILE_FORMAT_RESERVED;
-+
-+ return TRUE;
-+}
-+
-+int sd_cid_parse(sd_cid_t *cid, uint *cid_word)
-+{
-+ unchar *ptr;
-+ int i;
-+
-+ if ((cid_word[0] & 0x00000001) != 1)
-+ {
-+ sd_err_code = ERR_CID_REGISTER_ERROR;
-+ printk("%s() ERR_CID_REGISTER_ERROR\n", __func__);
-+ return FALSE;
-+ }
-+
-+ cid->ManufacturerID = (cid_word[3] & 0xFF000000) >> 24;
-+ cid->ApplicationID = (cid_word[3] & 0x00FFFF00) >> 8;
-+
-+ ptr = (unchar *) cid_word;
-+ ptr += 15 - 3;
-+ for (i = 0; i < 6; i++, ptr--)
-+ cid->ProductName[i] = *ptr;
-+ cid->ProductName[6] = '\0' ;
-+
-+ cid->ProductRevisionLow = (cid_word[1] & 0x00F00000) >> 20;
-+ cid->ProductRevisionHigh = (cid_word[1] & 0x000F0000) >> 16;
-+ cid->ProductSerialNumber = ((cid_word[1] & 0x0000FFFF) << 16) + ((cid_word[0] & 0xFFFF0000) >> 16);
-+ cid->ManufactureMonth = ((cid_word[0] & 0x00000F00) >> 8);
-+ cid->ManufactureYear = ((cid_word[0] & 0x0000F000) >> 12) + SD_DEFAULT_YEAR_CODE;
-+
-+ return TRUE;
-+}
-+
-+uint sd_read_timeout_cycle(uint clock, sd_csd_t *csd)
-+{
-+#if 1 //ivan for 100ms maximux from document "ProdManualIndGradeSDv1.0[1].pdf" chapter A-2
-+ return clock/10; // /10;
-+#else
-+ uint ret, total, per;
-+
-+ per = 1000000000 / clock;
-+ total = (csd->TAAC_u + (csd->NSAC_u * 100 * per)) * 100;
-+
-+ if (total > (100 * 1000 * 1000))
-+ total = 100 * 1000 * 1000;
-+ ret = total / per;
-+
-+ return ret;
-+#endif
-+}
-+
-+uint sd_block_size_convert(uint size)
-+{
-+ uint ret = 0;
-+
-+ while (size >= 2) {
-+ size >>= 1;
-+ ret++;
-+ }
-+ return ret;
-+}
-+
-+int sd_select_card(sd_card_t *info)
-+{
-+ uint status;
-+
-+ /* send CMD7 with valid RCA to select */
-+ if (!sdc_send_cmd(SD_SELECT_CARD_CMD | SDC_CMD_REG_NEED_RSP, ((uint)info->RCA) << 16, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ return TRUE;
-+}
-+
-+int sd_set_transfer_state(sd_card_t *info)
-+{
-+ uint state;
-+ int count = 0;
-+ while (count++ < SD_CARD_STATE_CHANGE_RETRY_COUNT) {
-+ if (!sd_get_card_state(info, &state))
-+ return FALSE;
-+
-+ switch (state) {
-+ case SD_IDLE_STATE:
-+ case SD_READY_STATE:
-+ case SD_IDENT_STATE:
-+ printk("%s() error\n", __func__);
-+ return FALSE;
-+ case SD_DIS_STATE:
-+ if (!sd_operation_complete(info, SD_STBY_STATE))
-+ return FALSE;
-+ break;
-+ case SD_TRAN_STATE:
-+ return TRUE;
-+ case SD_DATA_STATE:
-+ if (sd_operation_complete(info, SD_TRAN_STATE))
-+ return TRUE;
-+ if (sd_err_code != ERR_NO_ERROR)
-+ return FALSE;
-+ if (!sd_stop_transmission())
-+ return FALSE;
-+ break;
-+ case SD_RCV_STATE:
-+ if (sd_operation_complete(info, SD_TRAN_STATE))
-+ return TRUE;
-+ if (sd_err_code != ERR_NO_ERROR)
-+ return FALSE;
-+ if (!sd_stop_transmission())
-+ return FALSE;
-+ break;
-+ case SD_PRG_STATE:
-+ if (!sd_operation_complete(info, SD_TRAN_STATE))
-+ return FALSE;
-+ break;
-+ case SD_STBY_STATE:
-+ if (!sd_select_card(info))
-+ return FALSE;
-+ }
-+ }
-+ P_DEBUG("%s() error\n", __func__);
-+ return FALSE;
-+}
-+
-+uint sd_write_timeout_cycle(uint clock, sd_csd_t *CSD)
-+{
-+#if 1 //ivan for 250ms maximux from document
-+ return clock/4; //ijsung hack
-+#else
-+ uint ret, total, pre;
-+
-+ pre = 1000000000 / clock;
-+ total = CSD->WriteSpeedFactor * 100 * (CSD->TAAC_u + (CSD->NSAC_u * 100 * pre));
-+
-+ if (total > (100 * 1000 * 1000))
-+ total = 100 * 1000 * 1000;
-+ ret = total / pre;
-+
-+ return ret;
-+#endif
-+}
-+
-+int sd_card_identify(sd_card_t *info)
-+{
-+ uint rca, status, cid[4];
-+
-+ /* reset all cards */
-+ if (!sdc_send_cmd(SD_GO_IDLE_STATE_CMD, 0, NULL))
-+ return FALSE;
-+ udelay(1000);
-+ /* Do operating voltage range validation */
-+ /* get OCR register */
-+ if (!sd_get_ocr(info, SDC_OCR, (uint *) &info->OCR))
-+ return FALSE;
-+ /* ckeck the operation conditions */
-+ if ((info->OCR & SDC_OCR) == 0) {
-+ sd_err_code = ERR_OUT_OF_VOLF_RANGE;
-+ return FALSE;
-+ }
-+
-+ /* send CMD2 to get CID register */
-+ if (!sdc_send_cmd(SD_ALL_SEND_CID_CMD | SDC_CMD_REG_NEED_RSP | SDC_CMD_REG_LONG_RSP, 0, cid))
-+ return FALSE;
-+ if (info->CardType == MEMORY_CARD_TYPE_SD) {
-+ /* send CMD3 to get RCA register */
-+ if (!sdc_send_cmd(SD_SEND_RELATIVE_ADDR_CMD | SDC_CMD_REG_NEED_RSP, 0, &rca))
-+ return FALSE;
-+ info->RCA = (ushort) (rca >> 16);
-+ } else {
-+ /* so far, we only support one interface, so we can give RCA any value */
-+ info->RCA = 0x1;
-+ /* send CMD3 to set RCA register */
-+ if (!sdc_send_cmd(SD_SEND_RELATIVE_ADDR_CMD | SDC_CMD_REG_NEED_RSP, (info->RCA << 16), &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+ }
-+
-+ return TRUE;
-+}
-+
-+int sd_card_init(sd_card_t *info)
-+{
-+ uint clock;
-+
-+ P_DEBUG("--> %s\n", __func__);
-+ if ((SDC_R_REG(SDC_STATUS_REG) & SDC_STATUS_REG_CARD_INSERT) != SDC_CARD_INSERT)
-+ return FALSE;
-+ sd_err_code = ERR_NO_ERROR;
-+ /* At first, set card type to SD */
-+ info->CardType = MEMORY_CARD_TYPE_SD;
-+ /* set memory card type */
-+ sdc_set_card_type(info->CardType);
-+ /* start card idenfication process */
-+ if (!sd_card_identify(info)) {
-+ printk("this is not SD card\n");
-+ sd_err_code = ERR_NO_ERROR;
-+ info->CardType = MEMORY_CARD_TYPE_MMC;
-+ /* set memory card type */
-+ sdc_set_card_type(info->CardType);
-+ if (!sd_card_identify(info))
-+ return FALSE;
-+ }
-+
-+ /* get CSD */
-+ if (!sd_set_card_standby(info))
-+ return FALSE;
-+ /* send CMD9 to get CSD register */
-+ if (!sdc_send_cmd(SD_SEND_CSD_CMD | SDC_CMD_REG_NEED_RSP | SDC_CMD_REG_LONG_RSP, ((uint) info->RCA) << 16, info->CSDWord))
-+ return FALSE;
-+ sd_csd_parse(&info->CSD, info->CSDWord);
-+
-+ if (info->CSD.ReadBlockLength != SD_SECTOR_SIZE) {
-+ printk("Sector size is mis-matched (SD CSD report=0x%X,SD_SECTOR_SIZE=0x%X)\n", info->CSD.ReadBlockLength, SD_SECTOR_SIZE);
-+ info->CSD.ReadBlockLength = SD_SECTOR_SIZE;
-+// return FALSE;
-+ }
-+
-+ /* get CID */
-+ /* send CMD10 to get CID register */
-+ if (!sdc_send_cmd(SD_SEND_CID_CMD | SDC_CMD_REG_NEED_RSP | SDC_CMD_REG_LONG_RSP, ((uint) info->RCA) << 16, info->CIDWord))
-+ return FALSE;
-+ sd_cid_parse(&info->CID, info->CIDWord);
-+
-+ /* Set card bus clock. sdc_set_bus_clock() will give the real card bus clock has been set. */
-+ clock = sdc_set_bus_clock(info, info->CSD.TransferSpeed);
-+ info->ReadAccessTimoutCycle = sd_read_timeout_cycle(clock, &(info->CSD));
-+ info->WriteAccessTimoutCycle = sd_write_timeout_cycle(clock, &(info->CSD));
-+ /* set bus width */
-+ if (!sdc_set_bus_width(info))
-+ return FALSE;
-+
-+ /* check write protect */
-+ info->WriteProtect = ((SDC_R_REG(SDC_STATUS_REG) & SDC_STATUS_REG_CARD_LOCK) == SDC_STATUS_REG_CARD_LOCK) ? TRUE : FALSE;
-+ if(info->WriteProtect == TRUE)
-+ printk("SD/MMC Card is Write Protected\n");
-+ info->ActiveState = TRUE;
-+ P_DEBUG("<-- %s\n", __func__);
-+
-+ return TRUE;
-+}
-+
-+int sd_card_insert(sd_card_t *info)
-+{
-+ P_DEBUG("--> %s\n", __func__);
-+ /* reset host interface controller */
-+ sdc_reset();
-+ /* turn on clock using default clock*/
-+ SDC_W_REG(SDC_CLOCK_CTRL_REG, SDC_R_REG(SDC_CLOCK_CTRL_REG)&0xff);
-+
-+ if (!sd_card_init(info)) {
-+ printk("root initialize failed\n");
-+ return FALSE;
-+ }
-+ /* set interrupt mask register */
-+ SDC_W_REG(SDC_INT_MASK_REG, SDC_STATUS_REG_CARD_CHANGE | SDC_STATUS_REG_DATA_TIMEOUT);
-+ P_DEBUG("<-- %s\n", __func__);
-+
-+ return TRUE;
-+}
-+
-+int sd_card_remove(sd_card_t *info)
-+{
-+ sd_err_code = ERR_NO_ERROR;
-+
-+ info->ActiveState = FALSE;
-+ info->WriteProtect = FALSE;
-+ info->RCA = 0;
-+ /* reset host interface controller */
-+ sdc_reset();
-+ /* set interrupt mask register */
-+ SDC_W_REG(SDC_INT_MASK_REG, SDC_STATUS_REG_CARD_CHANGE | SDC_STATUS_REG_DATA_TIMEOUT);
-+ sd_err_code = ERR_CARD_NOT_EXIST;
-+ /* turn off clock */
-+ SDC_W_REG(SDC_CLOCK_CTRL_REG, SDC_R_REG(SDC_CLOCK_CTRL_REG) | 0x100);
-+ return TRUE;
-+}
-+
-+irqreturn_t sd_hotswap_interrupt_handler(int irq, void *dev_id)
-+{
-+ uint status;
-+ struct sd_dev *dev = dev_id;
-+
-+ P_DEBUG("--> %s, irq=%d\n", __func__, irq);
-+ /* When the card is inserted or removed, we must delay a short time to make sure */
-+ /* the SDC_STATUS_REG_CARD_INSERT bit of status register is stable */
-+ udelay(1000);
-+ status = SDC_R_REG(SDC_STATUS_REG);
-+ if ((status & SDC_STATUS_REG_CARD_CHANGE) == SDC_STATUS_REG_CARD_CHANGE) {
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_CARD_CHANGE | SDC_STATUS_REG_DATA_TIMEOUT);
-+ if ((status & SDC_STATUS_REG_CARD_INSERT) == SDC_CARD_INSERT) {
-+ dev->card_state = SD_CARD_INSERT;
-+ printk("Card Insert\n");
-+ sd_card_insert(&sd_card_info);
-+ } else {
-+ dev->card_state = SD_CARD_REMOVE;
-+ printk("Card Remove\n");
-+ sd_card_remove(&sd_card_info);
-+ /* remove all current transfers as I/O error*/
-+#if 0 //ASYNC
-+ spin_lock_irqsave(&io_request_lock, status);
-+ INIT_REQUEST;
-+ while(!QUEUE_EMPTY)
-+ end_request(0);
-+ bh_busy=0;
-+ spin_unlock_irqrestore(&io_request_lock, status);
-+#endif
-+ }
-+ } else if ((status & SDC_STATUS_REG_DATA_TIMEOUT) == SDC_STATUS_REG_DATA_TIMEOUT) {
-+ SDC_W_REG(SDC_CLEAR_REG, SDC_STATUS_REG_CARD_CHANGE | SDC_STATUS_REG_DATA_TIMEOUT);
-+
-+#if 0 //ASYNC
-+ printk("Data timeout. Retry.\n");
-+ sd_clustered_bh(2);
-+#else
-+ printk("Data timeout. Retry.\n");
-+#endif
-+ }
-+ P_DEBUGG("card state=%d\n", dev->card_state);
-+ P_DEBUG("<-- %s\n", __func__);
-+ return IRQ_HANDLED;
-+}
-+
-+/*------------------------------------
-+ * Block-driver specific functions
-+ */
-+/*
-+ * Find the device for this request.
-+ */
-+#if 0
-+static inline struct sd_dev *sd_locate_device(const struct request *req)
-+{
-+ int devno;
-+ struct sd_dev *dev;
-+
-+ P_DEBUG("--> %s\n", __func__);
-+#if 0
-+ /* Check if the minor number is in range */
-+ devno = DEVICE_NR(req->rq_dev);
-+ P_DEBUGG("minor=%d\n", devno);
-+ if (devno >= SD_DEVS) {
-+ static int count = 0;
-+
-+ if (count++ < 5) /* print the message at most five times */
-+ P_DEBUG("request for unknown device\n");
-+ return NULL;
-+ }
-+#endif
-+ dev = sd_devices + devno;
-+ P_DEBUGG("card_state=%d\n", dev->card_state);
-+ P_DEBUG("<-- %s\n", __func__);
-+ return dev;
-+}
-+
-+int sd_card_check_exist(sd_card_t *info)
-+{
-+ /* if card is not exist */
-+ if ((SDC_R_REG(SDC_STATUS_REG) & SDC_STATUS_REG_CARD_INSERT) != SDC_CARD_INSERT) {
-+ sd_card_remove(info);
-+ return FALSE;
-+ }
-+ /* if card is not active */
-+ if (!info->ActiveState)
-+ {
-+ return sd_card_insert(info);
-+ }
-+ return TRUE;
-+}
-+#endif
-+
-+void sd_reset_host_controller(void)
-+{
-+ uint clock, mask, width;
-+
-+ /* read register */
-+ clock = SDC_R_REG(SDC_CLOCK_CTRL_REG);
-+ width = SDC_R_REG(SDC_BUS_WIDTH_REG);
-+ mask = SDC_R_REG(SDC_INT_MASK_REG);
-+ /* reset host interface */
-+ sdc_reset();
-+ /* restore register */
-+ SDC_W_REG(SDC_CLOCK_CTRL_REG, clock);
-+ SDC_W_REG(SDC_BUS_WIDTH_REG, width);
-+ SDC_W_REG(SDC_INT_MASK_REG, mask);
-+}
-+
-+int sd_read_single_block(sd_card_t *info, uint addr, uint size, uint timeout, unchar *buf)
-+{
-+ uint status;
-+
-+ if (!sdc_set_block_size(size))
-+ return FALSE;
-+
-+ sdc_config_transfer(info, size, size, SDC_DATA_CTRL_REG_DATA_READ, timeout);
-+
-+ if (!sdc_send_cmd(SD_READ_SINGLE_BLOCK_CMD | SDC_CMD_REG_NEED_RSP, addr, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+
-+#ifdef DELAY_FOR_DMA_READ
-+ if (first_run==0) {
-+ int i=0;
-+ for(i=0;i<10;i++)
-+ udelay(1000);
-+ first_run=1;
-+ }
-+#endif
-+ if (!sdc_read_block(info, size, (uint *) buf))
-+ return FALSE;
-+
-+ if (sd_err_code != ERR_NO_ERROR) {
-+ printk("%s() error=0x%X\n", __func__, sd_err_code);
-+ sd_reset_host_controller();
-+ return FALSE;
-+ } else {
-+ if (!sdc_check_data_end()) {
-+ sd_stop_transmission();
-+ printk("%s()2 error=0x%X\n", __func__, sd_err_code);
-+ return FALSE;
-+ }
-+ }
-+
-+ return TRUE;
-+}
-+
-+int sd_write_single_block(sd_card_t *info, uint addr, uint size, uint timeout, unchar *buf)
-+{
-+ uint status;
-+
-+ if (!sdc_set_block_size(size))
-+ return FALSE;
-+
-+ sdc_config_transfer(info, size, size, SDC_DATA_CTRL_REG_DATA_WRITE, timeout);
-+
-+ if (!sdc_send_cmd(SD_WRITE_SINGLE_BLOCK_CMD | SDC_CMD_REG_NEED_RSP, addr, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+
-+ if (!sdc_write_block(info, size, (uint *) buf))
-+ return FALSE;
-+ if (sd_err_code != ERR_NO_ERROR) {
-+ printk("%s() error=0x%X\n", __func__, sd_err_code);
-+ sd_reset_host_controller();
-+ return FALSE;
-+ } else {
-+ if (!sdc_check_data_end()) {
-+ sd_stop_transmission();
-+ printk("%s()2 error=0x%X\n", __func__, sd_err_code);
-+ return FALSE;
-+ }
-+ }
-+
-+ return TRUE;
-+}
-+
-+int sd_read_multiple_block(sd_card_t *info, uint addr, uint count, uint size, uint timeout, unchar *buf)
-+{
-+ uint err, status;
-+
-+ if (!sdc_set_block_size(size))
-+ return FALSE;
-+
-+ sdc_config_transfer(info, count * size, size, SDC_DATA_CTRL_REG_DATA_READ, timeout);
-+
-+ if (!sdc_send_cmd(SD_READ_MULTIPLE_BLOCK_CMD | SDC_CMD_REG_NEED_RSP, addr, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+
-+#ifdef DELAY_FOR_DMA_READ
-+ if (first_run==0) {
-+ int i=0;
-+ for(i=0;i<10;i++)
-+ udelay(1000);
-+ first_run=1;
-+ }
-+#endif
-+#if 0 //ijsung: Sometimes this will cause IRQ lost, and is slower. Use method below
-+ while (count > 0) {
-+ if (!sdc_read_block(info, size, (uint *) buf))
-+ return FALSE;
-+ count--;
-+ buf += size;
-+ }
-+#else //ijsung: DMA at once.
-+ if (!sdc_read_block(info, size*count, (uint *) buf))
-+ return FALSE;
-+#endif
-+ if (sd_err_code != ERR_NO_ERROR) {
-+ err = sd_err_code;
-+ sd_stop_transmission();
-+ sd_reset_host_controller();
-+ sd_err_code |= err;
-+ printk("%s() error=0x%X\n", __func__, sd_err_code);
-+ return FALSE;
-+ } else {
-+ if (!sdc_check_data_end()) {
-+ err = sd_err_code;
-+ sd_stop_transmission();
-+ sd_err_code |= err;
-+ printk("%s()2 error=0x%X\n", __func__, sd_err_code);
-+ return FALSE;
-+ }
-+ if (!sd_stop_transmission())
-+ return FALSE;
-+ }
-+
-+ return TRUE;
-+}
-+
-+int sd_write_multiple_block(sd_card_t *info, uint addr, uint count, uint size, uint timeout, unchar *buf)
-+{
-+ uint ErrorCode, status;
-+
-+ if(!sdc_set_block_size(size))
-+ return FALSE;
-+
-+ sdc_config_transfer(info, count * size, size, SDC_DATA_CTRL_REG_DATA_WRITE, timeout);
-+ sdc_pre_erase_cmd(count); //ijsung: pre-erase
-+ if (!sdc_send_cmd(SD_WRITE_MULTIPLE_BLOCK_CMD | SDC_CMD_REG_NEED_RSP, addr, &status))
-+ return FALSE;
-+ if (!sd_check_err(status))
-+ return FALSE;
-+#if 0 //ijsung: Sometimes this will cause IRQ lost, and is slower. Use method below
-+ while (count > 0) {
-+ if (!sdc_write_block(info, size, (uint *) buf))
-+ return FALSE;
-+ count--;
-+ buf += size;
-+ }
-+#else //ijsung: DMA at once.
-+ if (!sdc_write_block(info, size*count, (uint *) buf))
-+ return FALSE;
-+#endif
-+
-+ if (sd_err_code != ERR_NO_ERROR)
-+ {
-+ ErrorCode = sd_err_code;
-+ sd_stop_transmission();
-+ sd_reset_host_controller();
-+ sd_err_code |= ErrorCode;
-+ printk("%s() error=0x%X\n", __func__, sd_err_code);
-+ return FALSE;
-+ } else {
-+ if (!sdc_check_data_end()) {
-+ ErrorCode = sd_err_code;
-+ sd_stop_transmission();
-+ sd_err_code |= ErrorCode;
-+ printk("%s()2 error=0x%X\n", __func__, sd_err_code);
-+ return FALSE;
-+ }
-+ if (!sd_stop_transmission())
-+ return FALSE;
-+ }
-+
-+ return TRUE;
-+}
-+
-+int sd_wait_transfer_state(sd_card_t *info)
-+{
-+ uint state;
-+ int count = 0;
-+ while (count++ < SD_CARD_WAIT_TRANSFER_STATE_RETRY_COUNT) {
-+ if (!sd_get_card_state(info, &state))
-+ return FALSE;
-+
-+ switch (state) {
-+ case SD_IDLE_STATE:
-+ case SD_READY_STATE:
-+ case SD_IDENT_STATE:
-+ case SD_DIS_STATE:
-+ case SD_STBY_STATE:
-+ printk("%s() error\n", __func__);
-+ return FALSE;
-+ case SD_TRAN_STATE:
-+ return TRUE;
-+ case SD_DATA_STATE:
-+ case SD_RCV_STATE:
-+ case SD_PRG_STATE:
-+ break;
-+ }
-+ }
-+ sd_err_code = ERR_SD_CARD_IS_BUSY;
-+ P_DEBUG("%s() ERR_SD_CARD_IS_BUSY\n", __func__);
-+ return FALSE;
-+}
-+
-+/***************************************************************************
-+SD Card Read/Write/Erase Function
-+***************************************************************************/
-+int sd_read_sector(sd_card_t *info, uint addr, uint count, unchar *buf)
-+{
-+ int cnt;
-+ uint start;
-+ sync_mode=1;
-+ P_DEBUG("%s : sector = %d,count = %d\n",__func__,addr,count);
-+ if (count > MAX_READ_SECTOR_NR) {
-+ P_DEBUG("Readable Block Number Per Commands is 0x%X\n",MAX_READ_SECTOR_NR);
-+ return FALSE;
-+ }
-+
-+ sd_err_code = ERR_NO_ERROR;
-+
-+ if (!info->ActiveState) {
-+ P_DEBUG("%s : SD card not active!!\n", __func__);
-+ return FALSE;
-+ }
-+
-+ if (!sd_set_transfer_state(info))
-+ return FALSE;
-+
-+ start = addr * info->CSD.ReadBlockLength;
-+ cnt = (int) count;
-+
-+ while (cnt > 0) {
-+ if (cnt > 1) {
-+ if (!sd_read_multiple_block(info, start, (cnt > MAX_MULTI_BLOCK_NUM) ? MAX_MULTI_BLOCK_NUM : cnt,
-+ info->CSD.ReadBlockLength, info->ReadAccessTimoutCycle, buf))
-+ return FALSE;
-+ } else {
-+ if (!sd_read_single_block(info, start, info->CSD.ReadBlockLength, info->ReadAccessTimoutCycle, buf))
-+ return FALSE;
-+ return TRUE;
-+ }
-+
-+ if (!sd_wait_transfer_state(info))
-+ return FALSE;
-+
-+ cnt -= MAX_MULTI_BLOCK_NUM;
-+ start += MAX_MULTI_BLOCK_NUM * info->CSD.ReadBlockLength;
-+ buf += MAX_MULTI_BLOCK_NUM * info->CSD.ReadBlockLength;
-+ }
-+
-+ return TRUE;
-+}
-+
-+int sd_write_sector(sd_card_t *info, uint addr, uint count, unchar *buf)
-+{
-+ int cnt;
-+ uint start;
-+
-+ if (count > MAX_WRITE_SECTOR_NR) {
-+ P_DEBUG("Writable Block Number Per Commands is 0x%X\n",MAX_WRITE_SECTOR_NR);
-+ return FALSE;
-+ }
-+
-+ sd_err_code = ERR_NO_ERROR;
-+
-+ if (!info->ActiveState) {
-+ P_DEBUG("%s : SD card not active!!\n", __func__);
-+ return FALSE;
-+ }
-+
-+ if (info->WriteProtect == TRUE) {
-+ sd_err_code = ERR_SD_CARD_IS_LOCK;
-+ printk("Write Protected!!\n");
-+ return FALSE;
-+ }
-+ if (!sd_set_transfer_state(info))
-+ return FALSE;
-+
-+ start = addr * info->CSD.ReadBlockLength;
-+ cnt = (int) count;
-+
-+ while (cnt > 0) {
-+ if (cnt > 1) {
-+ if (!sd_write_multiple_block(info, start, (cnt > MAX_MULTI_BLOCK_NUM) ? MAX_MULTI_BLOCK_NUM : cnt,
-+ info->CSD.ReadBlockLength, info->WriteAccessTimoutCycle, buf))
-+ return FALSE;
-+ } else {
-+ if (!sd_write_single_block(info, start, info->CSD.ReadBlockLength, info->WriteAccessTimoutCycle, buf))
-+ return FALSE;
-+ return TRUE;
-+ }
-+
-+ if (!sd_wait_transfer_state(info))
-+ return FALSE;
-+
-+ cnt -= MAX_MULTI_BLOCK_NUM;
-+ start += MAX_MULTI_BLOCK_NUM * info->CSD.ReadBlockLength;
-+ buf += MAX_MULTI_BLOCK_NUM * info->CSD.ReadBlockLength;
-+ }
-+
-+ return TRUE;
-+}
-+/*----------------------------------------------
-+ * Perform an actual transfer:
-+ * Returns: # of sectors transferred. 0 = error
-+ */
-+static int sd_transfer(struct sd_dev *device, const struct request *req)
-+{
-+ int status = 0;
-+ int count = 0;
-+
-+ struct bio *bio = req->bio;
-+ struct bio_vec *bvec;
-+ struct req_iterator iter;
-+
-+ spin_unlock_irq( &device->lock);
-+
-+#if 0
-+ P_DEBUG("\nreq sector: %d, nr_sectors: %d, hard_cur_sectors: %d phys_seg: %d, buf: 0x%08lx\n",
-+ (int)req->sector, (int)req->nr_sectors, (int)req->hard_cur_sectors,
-+ (int)req->nr_phys_segments, (ulong)bio_data( bio));
-+#endif
-+
-+ rq_for_each_segment( bvec, req, iter) {
-+
-+ unsigned char *buf = page_address( bvec->bv_page) + bvec->bv_offset;
-+ int sectors = bio_cur_bytes(bio) >> 9;
-+
-+ P_DEBUG("bvec[%2d]: sector: %d, count: %d, curr: %d, buf: 0x%08lx, ",
-+ iter.i, (int)bio->bi_sector, count, (int)sectors, (unsigned long)buf);
-+
-+ sd_card_info.private = (void *)&device->ch_req;
-+
-+ if( rq_data_dir(req) == 0) /* Read */
-+ status = sd_read_sector( &sd_card_info, sector_offset + bio->bi_sector, sectors, buf);
-+ else
-+ status = sd_write_sector( &sd_card_info, sector_offset + bio->bi_sector, sectors, buf);
-+
-+ P_DEBUG("status: %d\n", status);
-+
-+ if (status <= 0) {
-+ spin_lock_irq( &device->lock);
-+ return count;
-+ }
-+
-+ count += sectors;
-+ bio->bi_sector += sectors;
-+ }
-+
-+ if( ( req->__sector == 0) && !Do_onetime){
-+
-+ unsigned char *buf = bio_data( bio);
-+
-+ if( ( buf[ 0x1be] != 0x0) && ( buf[ 0x1be] != 0x80)) /* partition identify */
-+ sector_offset = 0; //sector 0 is PBR
-+ else
-+ sector_offset = ( buf[ 0x1c6]) | ( buf[ 0x1c7] << 8) | ( buf[ 0x1c8] <<16) |( buf[ 0x1c9] << 24);
-+
-+ P_DEBUG( "sector_offset = %d\n", sector_offset);
-+ Do_onetime = 1;
-+ }
-+
-+ spin_lock_irq( &device->lock);
-+
-+ if( status <= 0)
-+ return 0;
-+ else
-+ return count;
-+}
-+
-+#ifdef SD_DEBUG
-+uint sd_dev_info(void)
-+{
-+ sd_csd_t *CSD;
-+ sd_cid_t *CID;
-+
-+ P_DEBUG("============SDCard=====================================\n");
-+#if 0
-+ if (!sd_card_check_exist(&sd_card_info))
-+ {
-+ P_DEBUG("SD Card does not exist!!!");
-+ return FALSE;
-+ }
-+#else
-+ if (!sd_card_info.ActiveState) {
-+ P_DEBUG("%s : SD card not active!!\n", __func__);
-+ return FALSE;
-+ }
-+#endif
-+
-+ /* print OCR, RCA register */
-+ P_DEBUG("OCR>> 0x%08X RCA>> 0x%04X\n", (uint) sd_card_info.OCR, sd_card_info.RCA);
-+ /* print CID register */
-+ P_DEBUG("CID>> 0x%08X 0x%08X 0x%08X 0x%08X\n", sd_card_info.CIDWord[0], sd_card_info.CIDWord[1], sd_card_info.CIDWord[2], sd_card_info.CIDWord[3]);
-+ CID = &(sd_card_info.CID);
-+ P_DEBUG(" MID:0x%02X OID:0x%04X PNM:%s PRV:%d.%d PSN:0x%08X\n", CID->ManufacturerID, CID->ApplicationID, CID->ProductName,
-+ CID->ProductRevisionHigh, CID->ProductRevisionLow, CID->ProductSerialNumber);
-+ P_DEBUG(" MDT:%d/%d\n", CID->ManufactureMonth, CID->ManufactureYear);
-+ /* print CSD register */
-+ P_DEBUG("CSD>> 0x%08X 0x%08X 0x%08X 0x%08X\n", sd_card_info.CSDWord[0], sd_card_info.CSDWord[1], sd_card_info.CSDWord[2], sd_card_info.CSDWord[3]);
-+ CSD = &(sd_card_info.CSD);
-+ P_DEBUG(" CSDStructure:%d Spec.Version:%d\n", CSD->CSDStructure, CSD->MMCSpecVersion);
-+ P_DEBUG(" TAAC:%dns NSAC:%d clock cycles\n", CSD->TAAC_u, CSD->NSAC_u);
-+ P_DEBUG(" TransferSpeed:%d bit/s CardCommandClass:0x%03X\n", CSD->TransferSpeed, CSD->CardCmdClass);
-+ P_DEBUG(" ReadBlLen:%d ReadBlPartial:%X WriteBlkMisalign:%X ReadBlkMisalign:%X\n", CSD->ReadBlockLength, CSD->ReadBlockPartial, CSD->WriteBlockMisalign, CSD->ReadBlockMisalign);
-+ P_DEBUG(" DSP:%X BlockNumber:%d MemorySize:%d \n", CSD->DSRImplemant, CSD->BlockNumber, CSD->MemorySize);
-+ P_DEBUG(" VDD_R_MIN:%d/10mA VDD_R_MAX:%dmA\n", (uint) CSD->VDDReadMin_u, (uint) CSD->VDDReadMax_u);
-+ P_DEBUG(" VDD_W_MIN:%d/10mA VDD_W_MAX:%dmA\n", (uint) CSD->VDDWriteMin_u, (uint) CSD->VDDWriteMax_u);
-+ P_DEBUG(" EraseBlkEnable:%d EraseSectorSize:%d WpGrpSize:%d WpGrpEnable:%X\n", CSD->EraseBlkEnable, CSD->EraseSectorSize, CSD->WriteProtectGroupSize, CSD->WriteProtectGroupEnable);
-+ P_DEBUG(" WriteSpeedFactor:%d WriteBlLen:%d WriteBlPartial:%X\n", CSD->WriteSpeedFactor, CSD->WriteBlockLength, CSD->WriteBlockPartial);
-+ P_DEBUG(" Copy:%X PermWrProtect:%X TmpWrProtect:%X FileFormat:%X\n", CSD->CopyFlag, CSD->PermanentWriteProtect, CSD->TemporaryWriteProtect, CSD->FileFormat);
-+ P_DEBUG(" ReadTimoutCycle:0x%08X WriteTimoutCycle:0x%08X\n", sd_card_info.ReadAccessTimoutCycle, sd_card_info.WriteAccessTimoutCycle);
-+ /* print SCR register */
-+ P_DEBUG("SCR>> 0x%08X 0x%08X \n", *(((uint *) &sd_card_info.SCR)), *(((uint *) &sd_card_info.SCR) + 1));
-+ P_DEBUG(" SCR_STRUCTURE:%d, SD_SPEC:%d, Data_status_after_erase:%d\n", sd_card_info.SCR.SCR_STRUCTURE, sd_card_info.SCR.SD_SPEC, sd_card_info.SCR.DATA_STAT_AFTER_ERASE);
-+ P_DEBUG(" sd_security:%d, SD_BUS_WIDTH:%X\n", sd_card_info.SCR.SD_SECURITY, sd_card_info.SCR.SD_BUS_WIDTH);
-+
-+ return TRUE;
-+}
-+#endif
-+
-+static int sd_card_setup(struct sd_dev *dev)
-+{
-+ uint sd_card_size;
-+ int i;
-+
-+ P_DEBUG("--> %s\n", __func__);
-+ first_run = 0;
-+ sd_err_code = ERR_NO_ERROR;
-+
-+ sd_card_info.ActiveState = FALSE;
-+ sd_card_info.WriteProtect = FALSE;
-+ sd_card_info.IOAddr = FTSDC_VA_BASE;
-+ sd_card_info.DMAEnable = FALSE;
-+
-+ sd_card_info.SysFrequency = AHB_CLK_IN/2;
-+ P_DEBUG("DMA Enable is %d, Sys frequency = %d\n", sd_card_info.DMAEnable, sd_card_info.SysFrequency);
-+ sd_card_info.RCA = 0;
-+ sd_card_info.Drive = 'S';
-+
-+ if (!sd_card_insert(&sd_card_info))
-+ return FALSE;
-+#ifdef SD_DEBUG
-+ if (!sd_dev_info())
-+ return FALSE;
-+#endif
-+ sd_card_size = sd_card_info.CSD.MemorySize;
-+ printk(KERN_NOTICE "FTSDC010: SD Card Capacity=%d MB\n", sd_card_size/1000000); /* Marketing MB is not 1048576 */
-+
-+ for (i = 0; i < SD_DEVS; i++) {
-+ sd_devices[i].size = sd_card_size / SD_SECTOR_SIZE; //unit is block, not bytes
-+
-+#if 0
-+ sd_partitions[i << SD_SHIFT].nr_sects =sd_size * (SD_BLKSIZE / SD_SECTOR_SIZE);
-+ P_DEBUG ("%s() %d-th device, size=%d blks(blks=%d),nr_sects=%ld\n", __func__, i, sd_size, SD_BLKSIZE, sd_partitions[i << SD_SHIFT].nr_sects);
-+#endif
-+ //sd_devices[i].card_state = SD_CARD_WORK;
-+ //sema_init(&(sd_devices[i].sema), 1); // add by Charles Tsai*/
-+ }
-+
-+ sd_card_info.DMAEnable = dev->dma_enable;
-+
-+ P_DEBUG("<-- %s\n", __func__);
-+ return TRUE;
-+}
-+
-+/*
-+ * Driver stuff
-+ */
-+/*------------------------------------
-+ * The ioctl implementation
-+ */
-+int sd_ioctl(struct block_device *bdev, fmode_t mode, unsigned int cmd, unsigned long arg)
-+{
-+ int size;
-+ struct hd_geometry geo;
-+ struct sd_dev *device=bdev->bd_disk->private_data;
-+ P_DEBUG ("ioctl 0x%x 0x%lx\n", cmd, arg);
-+ switch (cmd) {
-+ case BLKGETSIZE:
-+ /* Return the device size, expressed in sectors */
-+ /* FIXME: distinguish between kernel sector size and media sector size */
-+ size = device->size;
-+ __copy_to_user ((long *) arg, &size, sizeof (long));
-+ return 0;
-+#if 0
-+ case BLKFLSBUF: /* flush */
-+ return blk_ioctl(inode->i_rdev, cmd, arg);
-+ case BLKRAGET: /* return the readahead value */
-+ return blk_ioctl(inode->i_rdev, cmd, arg);
-+ case BLKRASET: /* set the readahead value */
-+ if (!capable (CAP_SYS_RAWIO))
-+ return -EACCES;
-+ if (arg > 0xff)
-+ return -EINVAL; /* limit it */
-+ return 0;
-+// case BLKRRPART: /* re-read partition table */
-+// return sd_revalidate (inode->i_rdev);
-+#endif
-+ case HDIO_GETGEO:
-+ /*
-+ * get geometry: we have to fake one... trim the size to a
-+ * multiple of 64 (32k): tell we have 16 sectors, 4 heads,
-+ * whatever cylinders. Tell also that data starts at sector. 4.
-+ */
-+ geo.cylinders = (device->size/4)/8; /* ?? only for test */
-+ geo.heads = 4;
-+ geo.sectors = 8;
-+ geo.start = 0;
-+ __copy_to_user ((void *) arg, &geo, sizeof (geo));
-+ return 0;
-+ default:
-+ /*
-+ * For ioctls we don't understand, let the block layer handle them.
-+ */
-+ return -ENOTTY;//blk_ioctl (inode->i_rdev, cmd, arg);
-+ }
-+
-+ return -ENOTTY; /* unknown command */
-+}
-+
-+static void sd_request(struct request_queue *q)
-+{
-+ struct sd_dev *dev;
-+ static int active;
-+#ifndef A320_SD_USE_ASYNC_DMA
-+ int ret;
-+ struct request *req;
-+#else
-+ if(bh_busy)
-+ return;
-+#endif
-+ if(active)
-+ return;
-+ active = 1;
-+ P_DEBUG("--> %s\n", __func__);
-+repeat:
-+ /* Locate the device */
-+ if((req=blk_fetch_request(q))==NULL) {
-+ active = 0;
-+ return;
-+ }
-+ dev = req->rq_disk->private_data;
-+ if (!dev||dev->card_state == SD_CARD_REMOVE) {
-+ if(!dev)
-+ printk(KERN_NOTICE"SD: locating device error\n");
-+ __blk_end_request_cur(req, -EIO);
-+ goto repeat;
-+ }
-+#ifndef A320_SD_USE_ASYNC_DMA
-+ sync_mode=1;
-+ //spin_unlock_irq(&io_request_lock);
-+ ret = sd_transfer(dev, req);
-+ __blk_end_request(req, 0, ret << 9);
-+ //spin_lock_irq(&io_request_lock);
-+ goto repeat;
-+
-+#else
-+ sync_mode=0; //Use new async DMA machanism
-+ //printk("%s: set up initial DMA, from sector %d to buffer 0x%X\n", __func__, CURRENT->sector+sector_offset, CURRENT->buffer);
-+ //sd_init_async_dma();
-+ sd_clustered_bh(1);
-+ //bh_busy=1;
-+#endif
-+ P_DEBUG("<-- %s\n", __func__);
-+}
-+
-+#if 0
-+/*-----------------------------------------
-+ * Support for removable devices
-+ */
-+int sd_check_change(kdev_t i_rdev)
-+{
-+ int minor = DEVICE_NR(i_rdev);
-+ struct sd_dev *dev = sd_devices + minor;
-+
-+ P_DEBUG("--> %s\n", __func__);
-+ P_DEBUG("minor=%d\n", minor);
-+ if (minor >= SD_DEVS) /* paranoid */
-+ return 0;
-+ P_DEBUG("check change for dev %d\n", minor);
-+ if (dev->usage) {
-+ P_DEBUG("disk not change\n");
-+ P_DEBUG("<-- %s\n", __func__);
-+ return 0; /* still valid */
-+ }
-+ P_DEBUG("disk changed\n");
-+ P_DEBUG("<-- %s\n", __func__);
-+ return 1; /* expired */
-+}
-+#endif
-+
-+static int sd_dma_ch_alloc(struct sd_dev *dev)
-+{
-+ dmad_chreq *ch_req = &dev->ch_req;
-+
-+ memset(ch_req, 0, sizeof(dmad_chreq));
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+
-+ ch_req->apb_req.addr0_ctrl = APBBR_ADDRINC_FIXED; /* (in) APBBR_ADDRINC_xxx */
-+/* for amerald */
-+ if((inl(PMU_BASE) & AMERALD_MASK) == AMERALD_PRODUCT_ID){
-+ ch_req->apb_req.addr0_reqn = APBBR_REQN_SDC_AMERALD;
-+ }else
-+ ch_req->apb_req.addr0_reqn = APBBR_REQN_SDC; /* (in) APBBR_REQN_xxx (also used to help determine bus selection) */
-+ ch_req->apb_req.addr1_ctrl = APBBR_ADDRINC_I4X; /* (in) APBBR_ADDRINC_xxx */
-+ ch_req->apb_req.addr1_reqn = APBBR_REQN_NONE; /* (in) APBBR_REQN_xxx (also used to help determine bus selection) */
-+ ch_req->apb_req.burst_mode = 1; /* (in) Burst mode (0: no burst 1-, 1: burst 4- data cycles per dma cycle) */
-+ ch_req->apb_req.data_width = APBBR_DATAWIDTH_4; /* (in) APBBR_DATAWIDTH_4(word), APBBR_DATAWIDTH_2(half-word), APBBR_DATAWIDTH_1(byte) */
-+ ch_req->apb_req.tx_dir = DMAD_DIR_A0_TO_A1; /* (in) DMAD_DIR_A0_TO_A1, DMAD_DIR_A1_TO_A0 */
-+
-+ ch_req->controller = DMAD_DMAC_APB_CORE; /* (in) DMAD_DMAC_AHB_CORE, DMAD_DMAC_APB_CORE */
-+ ch_req->flags = DMAD_FLAGS_SLEEP_BLOCK | DMAD_FLAGS_BIDIRECTION;
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ memset(ch_req, 0, sizeof(dmad_chreq));
-+ printk(KERN_INFO "%s: APB dma channel allocation failed\n", __func__);
-+ goto _try_ahb;
-+ }
-+
-+ P_DEBUG("%s: APB dma channel allocated (ch: %d)\n", __func__, ch_req->channel);
-+ //printk("%s: APB dma channel allocated (ch: %d)\n", __func__, ch_req->channel);
-+
-+ return 0;
-+
-+_try_ahb:
-+
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+
-+ ch_req->ahb_req.sync = 1; /* (in) non-zero if src and dst have different clock domain */
-+ ch_req->ahb_req.priority = DMAC_CSR_CHPRI_1; /* (in) DMAC_CSR_CHPRI_0 (lowest) ~ DMAC_CSR_CHPRI_3 (highest) */
-+ ch_req->ahb_req.hw_handshake = 1; /* (in) non-zero to enable hardware handshake mode */
-+ ch_req->ahb_req.burst_size = DMAC_CSR_SIZE_4; /* (in) DMAC_CSR_SIZE_1 ~ DMAC_CSR_SIZE_256 */
-+ ch_req->ahb_req.addr0_width = DMAC_CSR_WIDTH_32; /* (in) DMAC_CSR_WIDTH_8, DMAC_CSR_WIDTH_16, or DMAC_CSR_WIDTH_32 */
-+ ch_req->ahb_req.addr0_ctrl = DMAC_CSR_AD_FIX; /* (in) DMAC_CSR_AD_INC, DMAC_CSR_AD_DEC, or DMAC_CSR_AD_FIX */
-+ ch_req->ahb_req.addr0_reqn = DMAC_REQN_SDC; /* (in) DMAC_REQN_xxx (also used to help determine channel number) */
-+ ch_req->ahb_req.addr1_width = DMAC_CSR_WIDTH_32; /* (in) DMAC_CSR_WIDTH_8, DMAC_CSR_WIDTH_16, or DMAC_CSR_WIDTH_32 */
-+ ch_req->ahb_req.addr1_ctrl = DMAC_CSR_AD_INC; /* (in) DMAC_CSR_AD_INC, DMAC_CSR_AD_DEC, or DMAC_CSR_AD_FIX */
-+ ch_req->ahb_req.addr1_reqn = DMAC_REQN_NONE; /* (in) DMAC_REQN_xxx (also used to help determine channel number) */
-+ ch_req->ahb_req.tx_dir = DMAD_DIR_A0_TO_A1; /* (in) DMAD_DIR_A0_TO_A1, DMAD_DIR_A1_TO_A0 */
-+
-+ ch_req->controller = DMAD_DMAC_AHB_CORE; /* (in) DMAD_DMAC_AHB_CORE, DMAD_DMAC_APB_CORE */
-+ ch_req->flags = DMAD_FLAGS_SLEEP_BLOCK | DMAD_FLAGS_BIDIRECTION;
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ memset(ch_req, 0, sizeof(dmad_chreq));
-+ printk(KERN_INFO "%s: AHB dma channel allocation failed\n", __func__);
-+ goto _err_exit;
-+ }
-+
-+ P_DEBUG("%s: AHB dma channel allocated (ch: %d)\n", __func__, ch_req->channel);
-+ //printk("%s: AHB dma channel allocated (ch: %d)\n", __func__, ch_req->channel);
-+
-+ return 0;
-+
-+_err_exit:
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+ return -ENODEV;
-+}
-+
-+/*--------------------------------
-+ * Note no locks taken out here. In a worst case scenario, we could drop
-+ * a chunk of system memory. But that should never happen, since validation
-+ * happens at open or mount time, when locks are held.
-+ */
-+static int sd_revalidate(struct gendisk *gd)
-+{
-+ struct sd_dev *dev = gd->private_data;
-+
-+ P_DEBUG("--> %s\n", __func__);
-+ P_DEBUG("card state=%s\n", dev->card_state == SD_CARD_INSERT ? "INSERT" : dev->card_state == SD_CARD_WORK ? "WORK" : "REMOVE");
-+
-+ if (dev->usage == 0) {
-+ if (sd_card_setup(dev) != TRUE) {
-+ dev->card_state = SD_CARD_REMOVE;
-+ return -1;
-+ } else {
-+ enable_irq(FTSDC_IRQ);
-+ dev->card_state = SD_CARD_WORK;
-+ }
-+ }
-+ P_DEBUG("<-- %s\n", __func__);
-+
-+ return 0;
-+}
-+
-+/*
-+ * Device open and close
-+ * TODO: forbids open for write when WRITE_PROTECT=1
-+ */
-+int sd_open(struct block_device *bdev, fmode_t mode)
-+{
-+ struct sd_dev *dev= bdev->bd_disk->private_data; /* device information */
-+ P_DEBUG("--> %s\n", __func__);
-+ /* Early return if there's nothing in the card slot */
-+ if ((SDC_R_REG(SDC_STATUS_REG) & SDC_STATUS_REG_CARD_INSERT) != SDC_CARD_INSERT) {
-+ P_DEBUG("<-- %s (ENOMEDIUM)\n", __func__);
-+ return -ENOMEDIUM;
-+ }
-+ //spin_lock(&dev->lock);
-+ if (!dev->usage) {
-+ dev->media_change=1;
-+ P_DEBUG("%s: forced check_disk_change check\n", __func__);
-+ check_disk_change(bdev);
-+ sector_offset=0;
-+ Do_onetime=0;
-+ } else
-+ dev->media_change=0;
-+
-+ /* Set size HERE:
-+ * must rely on sd_revalidate to set correct size
-+ * (seems on check_disk_change()) */
-+ P_DEBUG("%s: set_capacity() to %d blocks (%d bytes)\n",__func__, dev->size, dev->size*SD_SECTOR_SIZE);
-+ set_capacity(dev->gd, dev->size);
-+ dev->usage++;
-+ P_DEBUG("<-- %s\n", __func__);
-+
-+ return 0; /* success */
-+}
-+
-+int sd_release(struct gendisk *gd, fmode_t mode)
-+{
-+ struct sd_dev *dev = gd->private_data;
-+
-+ disable_irq(FTSDC_IRQ);
-+ printk(" + sd_release : umount SD\n");
-+
-+ P_DEBUG("--> %s\n", __func__);
-+ dev->usage--;
-+ P_DEBUG("<-- %s\n", __func__);
-+
-+ return 0;
-+}
-+
-+/*--------------------------------------
-+ * The file operations
-+ */
-+struct block_device_operations sd_fops = {
-+ owner: THIS_MODULE,
-+ open: sd_open,
-+ release: sd_release,
-+ ioctl: sd_ioctl,
-+ revalidate_disk: sd_revalidate,
-+ media_changed: sd_media_changed,
-+};
-+
-+void init_sd_pmu(void)
-+{
-+
-+#ifdef CONFIG_FIE8100_PLATFORM
-+ unsigned int u32temp;
-+ u32temp = *(volatile unsigned int *)(A320_PMU_VA_BASE + 0x14);
-+ u32temp &= ~0x3000;
-+ u32temp |= 0x2000;
-+ *(volatile unsigned int *)(A320_PMU_VA_BASE + 0x14)=u32temp;
-+#endif
-+
-+#ifdef CONFIG_FIE7000_PLATFORM
-+ *(volatile unsigned int *)(A320_PMU_VA_BASE + 0x114) = (*(volatile unsigned int *)(A320_PMU_VA_BASE + 0x114) & 0xFFFF0FFF) | 0x00002000;
-+#endif
-+}
-+
-+/*
-+ * Set up our internal device.
-+ */
-+static int setup_device(struct sd_dev *dev)
-+{
-+ /*
-+ * Get some memory.
-+ */
-+ memset (dev, 0, sizeof (struct sd_dev));
-+ dev->size = 0;//SD_DUMMY_SIZE/SD_SECTOR_SIZE; /* We'll fill this with correct size later*/
-+ spin_lock_init(&dev->lock);
-+ /* Request Queue */
-+ dev->queue = blk_init_queue(sd_request, &dev->lock);
-+ if (dev->queue == NULL)
-+ return -EFAULT;
-+
-+ blk_queue_logical_block_size(dev->queue, hardsect_size);
-+ dev->queue->queuedata = dev;
-+
-+ dev->card_state = SD_CARD_REMOVE;
-+
-+ /*
-+ * And the gendisk structure.
-+ */
-+ dev->gd = alloc_disk(SD_MINORS);
-+ if (! dev->gd) {
-+ printk (KERN_NOTICE "alloc_disk failure\n");
-+ return -EFAULT;
-+ }
-+
-+ dev->gd->flags = GENHD_FL_REMOVABLE|GENHD_FL_SUPPRESS_PARTITION_INFO;
-+ dev->gd->major = sd_major;
-+ dev->gd->first_minor = 0;
-+ dev->gd->minors = SD_MINORS;
-+ dev->gd->fops = &sd_fops;
-+ dev->gd->queue = dev->queue;
-+ dev->gd->private_data = dev;
-+ snprintf (dev->gd->disk_name, 32, "cpesd%c", 'a');
-+ set_capacity(dev->gd, 0); //SD_DUMMY_SIZE/SD_SECTOR_SIZE*(hardsect_size/KERNEL_SECTOR_SIZE));
-+ add_disk(dev->gd);
-+
-+ /*
-+ * dma alloc
-+ */
-+ if (sd_dma_ch_alloc(dev) == 0) {
-+ printk(KERN_NOTICE "Faraday SD controller Driver (DMA mode)\n");
-+ dev->dma_enable = true;
-+ } else {
-+ printk(KERN_NOTICE "Faraday SD controller Driver (PIO mode)\n");
-+ }
-+
-+ return 0;
-+}
-+/*
-+ * Look for a media change.
-+ */
-+static int sd_media_changed(struct gendisk *gd)
-+{
-+ struct sd_dev *dev = gd->private_data;
-+ return dev->media_change;
-+}
-+
-+/*
-+ * module stuff
-+ */
-+static int __init sd_module_init(void)
-+{
-+ int result=-ENOMEM;
-+ spinlock_t complete_lock;
-+ unsigned long iflags;
-+ spin_lock_init(&complete_lock);
-+
-+#ifdef CONFIG_PLAT_QEMU
-+ SDC_READ_FIFO_LEN = SDC_WRITE_FIFO_LEN = SDC_R_REG(0x44) & 0xff;
-+#else
-+ if(SDC_R_REG(0xa0) == 0x00030101)
-+ SDC_READ_FIFO_LEN = SDC_WRITE_FIFO_LEN = SDC_R_REG(0x9c) & 0xff;
-+ else
-+ SDC_READ_FIFO_LEN = SDC_WRITE_FIFO_LEN = SDC_R_REG(SDC_FEATURE_REG) & 0xff;
-+#endif
-+ /* Register SD driver */
-+ sd_major = register_blkdev(sd_major, DEVICE_NAME);
-+ if (sd_major <= 0) {
-+ printk(KERN_WARNING DEVICE_NAME ":unable to get major number\n");
-+ return -EBUSY;
-+ }
-+ init_sd_pmu(); /* Power on SDC */
-+ P_DEBUG("SD Major Number = %d\n", sd_major);
-+ printk(KERN_ALERT "SD: make node with 'mknod /dev/cpesd b %d 0'\n", sd_major);
-+
-+ sd_devices = kmalloc(sizeof(struct sd_dev), GFP_KERNEL);
-+ if (!sd_devices)
-+ goto fail_malloc;
-+ memset(sd_devices, 0, sizeof(struct sd_dev));
-+
-+ if (setup_device(sd_devices))
-+ goto fail_malloc;
-+
-+ P_DEBUG("Request SDC IRQ=%d\n", FTSDC_IRQ);
-+ spin_lock_irqsave(&complete_lock, iflags);
-+ if (request_irq(FTSDC_IRQ, sd_hotswap_interrupt_handler, IRQF_DISABLED, "SD controller", sd_devices) != 0) {
-+ printk(KERN_ERR "Unable to allocate SDC IRQ=0x%X\n", FTSDC_IRQ);
-+ goto fail_malloc;
-+ }
-+ disable_irq(FTSDC_IRQ);
-+ spin_unlock_irqrestore(&complete_lock, iflags);
-+ if (request_region(FTSDC_VA_BASE, 0x48, "SD Controller") == NULL) {
-+ printk(KERN_ERR "request io port of sd controller fail\n");
-+ goto fail_mem;
-+ }
-+
-+ return 0; /* succeed */
-+
-+fail_mem:
-+ free_irq(FTSDC_IRQ, sd_devices);
-+
-+fail_malloc:
-+ if (sd_devices)
-+ kfree(sd_devices);
-+ unregister_blkdev(sd_major, DEVICE_NAME);
-+ return result;
-+}
-+
-+static void sd_module_cleanup(void)
-+{
-+ P_DEBUG("--> %s\n", __func__);
-+
-+ /* unregister the device now to avoid further operations during cleanup */
-+
-+ if (sd_devices) {
-+ del_gendisk(sd_devices->gd);
-+ put_disk(sd_devices->gd);
-+ if(sd_devices->queue)
-+ blk_cleanup_queue(sd_devices->queue);
-+
-+ if (sd_devices->dma_enable)
-+ dmad_channel_free(&sd_devices->ch_req);
-+
-+ kfree(sd_devices);
-+ }
-+
-+ release_region(FTSDC_VA_BASE, 0x48);
-+ free_irq(FTSDC_IRQ, sd_devices);
-+
-+ unregister_blkdev(sd_major, DEVICE_NAME);
-+ P_DEBUG("<-- %s\n", __func__);
-+}
-+
-+module_init(sd_module_init);
-+module_exit(sd_module_cleanup);
-diff -Nur linux-3.4.113.orig/drivers/block/ftsdc010.h linux-3.4.113/drivers/block/ftsdc010.h
---- linux-3.4.113.orig/drivers/block/ftsdc010.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/block/ftsdc010.h 2016-12-01 20:59:24.384613985 +0100
-@@ -0,0 +1,477 @@
-+/* drivers/block/CPESD/ftsdc010.h
-+ *
-+ * Faraday FTSDC010 Device Driver
-+ *
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ *
-+ * All Rights Reserved
-+ */
-+
-+#ifndef _FTSDC010_H_
-+#define _FTSDC010_H_
-+
-+#ifndef TRUE
-+#define TRUE 1
-+#endif
-+
-+#ifndef FALSE
-+#define FALSE 0
-+#endif
-+
-+//#define SD_DEBUG
-+#define DELAY_FOR_DMA_READ
-+
-+#ifdef SD_DEBUG
-+ #define P_DEBUG(fmt, args...) printk(KERN_ALERT "SD: " fmt, ## args)
-+#else
-+ #define P_DEBUG(a...)
-+#endif
-+#define P_DEBUGG(a...)
-+
-+#define MAX_READ_SECTOR_NR 96 //16
-+#define MAX_WRITE_SECTOR_NR MAX_READ_SECTOR_NR
-+
-+#define SD_MAJOR 6 /* default major number, if zero, it means dynamic allocate */
-+#define SD_DEVS 1 /* number of disks */
-+#define SD_MINORS 16 /* minors per disk */
-+#define SD_RAHEAD 2 /* number of sectors */
-+#define SD_BLKSIZE 1024 /* block size */
-+#define SD_SECTOR_SIZE 512 /* sector size */
-+#define SD_DUMMY_SIZE (256*1024*1024) // for sake of hotswap/hotplug
-+#if 0
-+typedef struct _sd_dev_t {
-+ int size;
-+ int usage;
-+ //struct timer_list timer;
-+ spinlock_t lock;
-+ struct semaphore sema; // synchronization
-+ int card_state;
-+} sd_dev_t;
-+#endif
-+//---------SD Card State
-+#define SD_CARD_REMOVE 0
-+#define SD_CARD_INSERT 1
-+#define SD_CARD_WORK 2
-+
-+/* so far, SD controller support 3.2-3.3 VDD */
-+#define SDC_OCR 0x00FF8000
-+
-+/* sd controller register */
-+#define SDC_CMD_REG 0x00000000
-+#define SDC_ARGU_REG 0x00000004
-+#define SDC_RESPONSE0_REG 0x00000008
-+#define SDC_RESPONSE1_REG 0x0000000C
-+#define SDC_RESPONSE2_REG 0x00000010
-+#define SDC_RESPONSE3_REG 0x00000014
-+#define SDC_RSP_CMD_REG 0x00000018
-+#define SDC_DATA_CTRL_REG 0x0000001C
-+#define SDC_DATA_TIMER_REG 0x00000020
-+#define SDC_DATA_LEN_REG 0x00000024
-+#define SDC_STATUS_REG 0x00000028
-+#define SDC_CLEAR_REG 0x0000002C
-+#define SDC_INT_MASK_REG 0x00000030
-+#define SDC_POWER_CTRL_REG 0x00000034
-+#define SDC_CLOCK_CTRL_REG 0x00000038
-+#define SDC_BUS_WIDTH_REG 0x0000003C
-+#define SDC_DATA_WINDOW_REG 0x00000040
-+#ifdef A320D_BUILDIN_SDC
-+#define SDC_FEATURE_REG 0x00000044
-+#define SDC_REVISION_REG 0x00000048
-+#else
-+#define SDC_MMC_INT_RSP_REG 0x00000044
-+#define SDC_GP_OUTPUT_REG 0x00000048
-+#define SDC_FEATURE_REG 0x0000009C
-+#define SDC_REVISION_REG 0x000000A0
-+#endif
-+
-+/* bit mapping of command register */
-+#define SDC_CMD_REG_INDEX 0x0000003F
-+#define SDC_CMD_REG_NEED_RSP 0x00000040
-+#define SDC_CMD_REG_LONG_RSP 0x00000080
-+#define SDC_CMD_REG_APP_CMD 0x00000100
-+#define SDC_CMD_REG_CMD_EN 0x00000200
-+#define SDC_CMD_REG_SDC_RST 0x00000400
-+
-+/* bit mapping of response command register */
-+#define SDC_RSP_CMD_REG_INDEX 0x0000003F
-+#define SDC_RSP_CMD_REG_APP 0x00000040
-+
-+/* bit mapping of data control register */
-+#define SDC_DATA_CTRL_REG_BLK_SIZE 0x0000000F
-+#define SDC_DATA_CTRL_REG_DATA_WRITE 0x00000010
-+#define SDC_DATA_CTRL_REG_DATA_READ 0x00000000
-+#define SDC_DATA_CTRL_REG_DMA_EN 0x00000020
-+#define SDC_DATA_CTRL_REG_DATA_EN 0x00000040
-+
-+#define SDC_DMA_TYPE_1 0x00000000
-+#define SDC_DMA_TYPE_4 0x00000100
-+#define SDC_DMA_TYPE_8 0x00000200
-+
-+/* bit mapping of status/clear/mask register */
-+#define SDC_STATUS_REG_RSP_CRC_FAIL 0x00000001
-+#define SDC_STATUS_REG_DATA_CRC_FAIL 0x00000002
-+#define SDC_STATUS_REG_RSP_TIMEOUT 0x00000004
-+#define SDC_STATUS_REG_DATA_TIMEOUT 0x00000008
-+#define SDC_STATUS_REG_RSP_CRC_OK 0x00000010
-+#define SDC_STATUS_REG_DATA_CRC_OK 0x00000020
-+#define SDC_STATUS_REG_CMD_SEND 0x00000040
-+#define SDC_STATUS_REG_DATA_END 0x00000080
-+#define SDC_STATUS_REG_FIFO_UNDERRUN 0x00000100
-+#define SDC_STATUS_REG_FIFO_OVERRUN 0x00000200
-+#define SDC_STATUS_REG_CARD_CHANGE 0x00000400
-+#define SDC_STATUS_REG_CARD_INSERT 0x00000800
-+#define SDC_STATUS_REG_CARD_LOCK 0x00001000
-+
-+#define SDC_CARD_INSERT 0x0
-+#define SDC_CARD_REMOVE SDC_STATUS_REG_CARD_INSERT
-+
-+/* bit mapping of power control register */
-+#define SDC_POWER_REG_POWER_ON 0x00000010
-+#define SDC_POWER_REG_POWER_BITS 0x0000000F
-+
-+/* bit mapping of clock control register */
-+#define SDC_CLOCK_REG_CARD_TYPE 0x00000080
-+#define SDC_CLOCK_REG_CLK_DIV 0x0000007F
-+
-+/* card type */
-+#define SDC_CARD_TYPE_SD SDC_CLOCK_REG_CARD_TYPE
-+#define SDC_CARD_TYPE_MMC 0x0
-+
-+/* bit mapping of bus width register */
-+#define SDC_BUS_WIDTH_REG_SINGLE_BUS 0x00000001
-+#define SDC_BUS_WIDTH_REG_WIDE_BUS 0x00000004
-+#define SDC_WIDE_BUS_SUPPORT 0x00000008
-+
-+/* data window register */
-+//#define SDC_READ_FIFO_LEN 4
-+//#define SDC_WRITE_FIFO_LEN 4
-+
-+/* card type, sd or mmc */
-+#define MEMORY_CARD_TYPE_SD 0
-+#define MEMORY_CARD_TYPE_MMC 1
-+
-+/********************************************************************/
-+/* SYSTEM ERROR_CODE */
-+/********************************************************************/
-+#define ERR_NO_ERROR 0x00000000
-+
-+/* general error */
-+#define ERR_CARD_NOT_EXIST 0x00000001
-+#define ERR_OUT_OF_VOLF_RANGE 0x00000002
-+#define ERR_SD_PARTITIAL_READ_ERROR 0x00000004
-+#define ERR_SD_PARTITIAL_WRITE_ERROR 0x00000008
-+
-+#define ERR_SD_CARD_IS_LOCK 0x00000010
-+
-+/* command error */
-+#define ERR_DATA_CRC_ERROR 0x00000100
-+#define ERR_RSP_CRC_ERROR 0x00000200
-+#define ERR_DATA_TIMEOUT_ERROR 0x00000400
-+#define ERR_RSP_TIMEOUT_ERROR 0x00000800
-+
-+#define ERR_WAIT_OVERRUN_TIMEOUT 0x00001000
-+#define ERR_WAIT_UNDERRUN_TIMEOUT 0x00002000
-+#define ERR_WAIT_DATA_CRC_TIMEOUT 0x00004000
-+#define ERR_WAIT_TRANSFER_END_TIMEOUT 0x00008000
-+
-+#define ERR_SEND_COMMAND_TIMEOUT 0x00010000
-+
-+/* sd error */
-+#define ERR_SD_CARD_IS_BUSY 0x00100000
-+#define ERR_CID_REGISTER_ERROR 0x00200000
-+#define ERR_CSD_REGISTER_ERROR 0x00400000
-+
-+/* sd card status error */
-+#define ERR_SD_CARD_STATUS_ERROR 0x01000000
-+/* SDC using APB DMA error */
-+#define ERR_DMA_RSP_ERROR 0x02000000
-+
-+#define SD_SCR_1_BIT_BIT 0x0001
-+#define SD_SCR_4_BIT_BIT 0x0004
-+
-+/********************************************************************/
-+/* The bit mapping of SD Status register */
-+/********************************************************************/
-+#define SD_STATUS_OUT_OF_RANGE 0x80000000
-+#define SD_STATUS_ADDRESS_ERROR 0x40000000
-+#define SD_STATUS_BLOCK_LEN_ERROR 0x20000000
-+#define SD_STATUS_ERASE_SEQ_ERROR 0x10000000
-+#define SD_STATUS_ERASE_PARAM 0x08000000
-+#define SD_STATUS_WP_VIOLATION 0x04000000
-+#define SD_STATUS_CARD_IS_LOCK 0x02000000
-+#define SD_STATUS_LOCK_UNLOCK_FILED 0x01000000
-+#define SD_STATUS_COM_CRC_ERROR 0x00800000
-+#define SD_STATUS_ILLEGAL_COMMAND 0x00400000
-+#define SD_STATUS_CARD_ECC_FAILED 0x00200000
-+#define SD_STATUS_CC_ERROR 0x00100000
-+#define SD_STATUS_ERROR 0x00080000
-+#define SD_STATUS_UNDERRUN 0x00040000
-+#define SD_STATUS_OVERRUN 0x00020000
-+#define SD_STATUS_CID_CSD_OVERWRITE 0x00010000
-+#define SD_STATUS_WP_ERASE_SKIP 0x00008000
-+#define SD_STATUS_CARD_ECC_DISABLE 0x00004000
-+#define SD_STATUS_ERASE_RESET 0x00002000
-+#define SD_STATUS_CURRENT_STATE 0x00001E00
-+#define SD_STATUS_READY_FOR_DATA 0x00000100
-+#define SD_STATUS_APP_CMD 0x00000020
-+#define SD_STATUS_AKE_SEQ_ERROR 0x00000008
-+#define SD_STATUS_ERROR_BITS (SD_STATUS_ADDRESS_ERROR | SD_STATUS_BLOCK_LEN_ERROR | SD_STATUS_ERASE_SEQ_ERROR | SD_STATUS_ERASE_PARAM | SD_STATUS_WP_VIOLATION | SD_STATUS_LOCK_UNLOCK_FILED | SD_STATUS_CARD_ECC_FAILED | SD_STATUS_CC_ERROR | SD_STATUS_ERROR | SD_STATUS_UNDERRUN | SD_STATUS_OVERRUN | SD_STATUS_CID_CSD_OVERWRITE | SD_STATUS_WP_ERASE_SKIP | SD_STATUS_AKE_SEQ_ERROR)
-+#define SD_STATUS_CURRENT_STATE_LOC 9
-+
-+/********************************************************************/
-+/* SD command response type */
-+/********************************************************************/
-+#define SD_NO_RESPONSE 0
-+#define SD_RESPONSE_R1 1
-+#define SD_RESPONSE_R1b 2
-+#define SD_RESPONSE_R2 3
-+#define SD_RESPONSE_R3 4
-+#define SD_RESPONSE_R6 5
-+
-+/********************************************************************/
-+/* SD command */
-+/********************************************************************/
-+#define SD_GO_IDLE_STATE_CMD 0
-+#define SD_MMC_OP_COND 1
-+#define SD_ALL_SEND_CID_CMD 2
-+#define SD_SEND_RELATIVE_ADDR_CMD 3
-+#define SD_SET_DSR_CMD 4
-+#define SD_SET_BUS_WIDTH_CMD 6
-+#define SD_SELECT_CARD_CMD 7
-+#define SD_SEND_CSD_CMD 9
-+#define SD_SEND_CID_CMD 10
-+#define SD_STOP_TRANSMISSION_CMD 12
-+#define SD_SEND_STATUS_CMD 13
-+#define SD_GO_INACTIVE_STATE_CMD 15
-+#define SD_SET_BLOCKLEN_CMD 16
-+#define SD_READ_SINGLE_BLOCK_CMD 17
-+#define SD_READ_MULTIPLE_BLOCK_CMD 18
-+#define SD_WRITE_SINGLE_BLOCK_CMD 24
-+#define SD_WRITE_MULTIPLE_BLOCK_CMD 25
-+#define SD_PROGRAM_CSD_CMD 27
-+#define SD_ERASE_SECTOR_START_CMD 32
-+#define SD_ERASE_SECTOR_END_CMD 33
-+#define SD_ERASE_CMD 38
-+#define SD_APP_OP_COND 41
-+#define SD_LOCK_UNLOCK_CMD 42
-+#define SD_SEND_SCR_CMD 51
-+#define SD_APP_CMD 55
-+#define SD_GET_CMD 56
-+
-+/* retry count */
-+#ifndef CONFIG_FTSDC010_USE_TIMER_DELAY
-+#define SD_CARD_GET_OCR_RETRY_COUNT 0x1000
-+#define SD_CARD_WAIT_OPERATION_COMPLETE_RETRY_COUNT 8000
-+#define SD_CARD_STATE_CHANGE_RETRY_COUNT 30000
-+#define SD_CARD_WAIT_TRANSFER_STATE_RETRY_COUNT 30000
-+#define SDC_GET_STATUS_RETRY_COUNT 0x300000
-+#else
-+#define SD_CARD_GET_OCR_RETRY_COUNT 0x1000
-+#define SD_CARD_WAIT_OPERATION_COMPLETE_RETRY_COUNT 8000
-+#define SD_CARD_STATE_CHANGE_RETRY_COUNT 10000
-+#define SD_CARD_WAIT_TRANSFER_STATE_RETRY_COUNT 10000
-+#endif
-+
-+/*
-+ * Please refer SanDisk SD Manual v1.9 Section 5.1.9.2 (page 5-76) to set the timeout setting
-+ */
-+#ifdef SD_DEBUG
-+#define SDC_TIMEOUT_BASE (HZ/2) // Unit is 500 ms
-+#else
-+#define SDC_TIMEOUT_BASE (HZ/3) // Unit is 333 ms
-+#endif
-+#define SDC_GET_STATUS_RETRY_TIMEOUT_COUNT (HZ*4)
-+
-+/* sd card standby state */
-+#define SD_IDLE_STATE 0
-+#define SD_READY_STATE 1
-+#define SD_IDENT_STATE 2
-+#define SD_STBY_STATE 3
-+#define SD_TRAN_STATE 4
-+#define SD_DATA_STATE 5
-+#define SD_RCV_STATE 6
-+#define SD_PRG_STATE 7
-+#define SD_DIS_STATE 8
-+
-+#define SD_BUS_WIDTH_1_BIT 0
-+#define SD_BUS_WIDTH_4_BIT 2
-+
-+/********************************************************************/
-+/* SD card OCR register */
-+/********************************************************************/
-+#define SD_OCR_BUSY_BIT 0x80000000
-+
-+/********************************************************************/
-+/* SD CID register */
-+/********************************************************************/
-+#define SD_DEFAULT_MONTH_CODE 1
-+#define SD_DEFAULT_YEAR_CODE 2000
-+#define MAX_MULTI_BLOCK_NUM 126
-+
-+typedef struct _sd_cid_t
-+{
-+ uint ManufacturerID;
-+ uint ApplicationID;
-+ unchar ProductName[7];
-+ uint ProductRevisionHigh;
-+ uint ProductRevisionLow;
-+ uint ProductSerialNumber;
-+ uint ManufactureMonth;
-+ uint ManufactureYear;
-+} sd_cid_t;
-+
-+/********************************************************************/
-+/* SD CSD register */
-+/********************************************************************/
-+#define SD_CSD_STRUCTURE_1_0 0
-+#define SD_CSD_STRUCTURE_1_1 1
-+
-+#define SD_CSD_SPEC_VERS_1_0_1_2 0
-+#define SD_CSD_SPEC_VERS_1_4 1
-+#define SD_CSD_SPEC_VERS_2_1 2
-+
-+#define SD_TAAC_TIME_UINT_BITS 0x07
-+#define SD_TAAC_TIME_VALUE_BITS 0x78
-+
-+typedef struct _sd_csd_t
-+{
-+ uint CSDStructure;
-+ uint MMCSpecVersion;
-+ uint TAAC_u;
-+ uint NSAC_u;
-+ uint TransferSpeed;
-+ uint CardCmdClass;
-+ uint ReadBlockLength;
-+ uint ReadBlockPartial;
-+ uint WriteBlockMisalign;
-+ uint ReadBlockMisalign;
-+ uint DSRImplemant;
-+ uint BlockNumber;
-+ uint MemorySize;
-+ uint VDDReadMin_u;
-+ uint VDDReadMax_u;
-+ uint VDDWriteMin_u;
-+ uint VDDWriteMax_u;
-+ uint EraseBlkEnable;
-+ uint EraseSectorSize;
-+ uint WriteProtectGroupSize;
-+ uint WriteProtectGroupEnable;
-+ uint WriteSpeedFactor;
-+ uint WriteBlockLength;
-+ unchar WriteBlockPartial;
-+ unchar CopyFlag;
-+ unchar PermanentWriteProtect;
-+ unchar TemporaryWriteProtect;
-+ unchar FileFormat;
-+} sd_csd_t;
-+
-+typedef struct _sd_csd_bit_t
-+{
-+ uint NotUsed:1;
-+ uint CRC:7;
-+ uint MMCardReserved1:2;
-+ uint FILE_FORMAT:2;
-+ uint TMP_WRITE_PROTECT:1;
-+ uint PERM_WRITE_PROTECT:1;
-+ uint COPY:1;
-+ uint FILE_FORMAT_GRP:1;
-+
-+ uint Reserved2:5;
-+ uint WRITE_BL_PARTIAL:1;
-+ uint WRITE_BL_LEN:4;
-+ uint R2W_FACTOR:3;
-+ uint MMCardReserved0:2;
-+ uint WP_GRP_ENABLE:1;
-+
-+ uint WP_GRP_SIZE:7;
-+ uint ERASE_SECTOR_SIZE:7;
-+ uint ERASE_BLK_ENABLE:1;
-+ uint C_SIZE_MULT:3;
-+ uint VDD_W_CURR_MAX:3;
-+ uint VDD_W_CURR_MIN:3;
-+ uint VDD_R_CURR_MAX:3;
-+ uint VDD_R_CURR_MIN:3;
-+
-+ uint C_SIZE_1:2;
-+ uint C_SIZE_2:10; // divide its into 2, 10bits
-+
-+ uint Reserved1:2;
-+ uint DSR_IMP:1;
-+ uint READ_BLK_MISALIGN:1;
-+ uint WRITE_BLK_MISALIGN:1;
-+ uint READ_BL_PARTIAL:1;
-+
-+ uint READ_BL_LEN:4;
-+ uint CCC:12;
-+
-+ uint TRAN_SPEED_RateUnit:3;
-+ uint TRAN_SPEED_TimeValue:4;
-+ uint TRAN_SPEED_Reserved:1;
-+
-+ uint NSAC:8;
-+
-+ uint TAAC_TimeUnit:3;
-+ uint TAAC_TimeValue:4;
-+ uint TAAC_Reserved:1;
-+
-+ uint Reserved0:2;
-+ uint MMC_SPEC_VERS:4;
-+ uint CSD_STRUCTURE:2;
-+} sd_csd_bit_t;
-+
-+/********************************************************************/
-+/* SD SCR register */
-+/********************************************************************/
-+typedef struct _sd_scr_t
-+{
-+ uint Reserved:16;
-+ uint SD_BUS_WIDTH:4;
-+ uint SD_SECURITY:3;
-+ uint DATA_STAT_AFTER_ERASE:1;
-+ uint SD_SPEC:4;
-+ uint SCR_STRUCTURE:4;
-+
-+ uint ManufacturerReserved;
-+} sd_scr_t;
-+
-+/********************************************************************/
-+/* sd card structure */
-+/********************************************************************/
-+typedef struct _sd_card_t
-+{
-+ /* host interface configuration */
-+ uint IOAddr; /* host controller register base address */
-+ uint DMAEnable;
-+
-+ uint CardType;
-+
-+ /* card register */
-+ uint OCR;
-+
-+ uint CIDWord[4];
-+ sd_cid_t CID;
-+
-+ uint CSDWord[4];
-+ sd_csd_t CSD;
-+
-+ ushort RCA;
-+ sd_scr_t SCR;
-+
-+ /* access time out */
-+ uint ReadAccessTimoutCycle;
-+ uint WriteAccessTimoutCycle;
-+
-+ /* Drive Name */
-+ uint Drive;
-+
-+ /* system configurations */
-+ uint SysFrequency;
-+
-+ /* card status */
-+ int ActiveState;
-+ int WriteProtect;
-+
-+ void *private;
-+} sd_card_t;
-+
-+#endif
-diff -Nur linux-3.4.113.orig/drivers/block/Kconfig linux-3.4.113/drivers/block/Kconfig
---- linux-3.4.113.orig/drivers/block/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/block/Kconfig 2016-12-01 20:59:24.384613985 +0100
-@@ -498,6 +498,14 @@
- block device driver. It communicates with a back-end driver
- in another domain which drives the actual block device.
-
-+config FTSDC010
-+ tristate "Faraday FTSDC010 driver"
-+ depends on NDS32
-+
-+config FTCFC010
-+ tristate "Faraday FTCFC010 driver"
-+ depends on NDS32
-+
- config XEN_BLKDEV_BACKEND
- tristate "Xen block-device backend driver"
- depends on XEN_BACKEND
-diff -Nur linux-3.4.113.orig/drivers/block/Makefile linux-3.4.113/drivers/block/Makefile
---- linux-3.4.113.orig/drivers/block/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/block/Makefile 2016-12-01 20:59:24.384613985 +0100
-@@ -43,3 +43,5 @@
- obj-$(CONFIG_BLK_DEV_PCIESSD_MTIP32XX) += mtip32xx/
-
- swim_mod-y := swim.o swim_asm.o
-+obj-$(CONFIG_FTSDC010) += ftsdc010.o
-+obj-$(CONFIG_FTCFC010) += ftcfc010.o
-diff -Nur linux-3.4.113.orig/drivers/gpio/gpio-ftgpio010.c linux-3.4.113/drivers/gpio/gpio-ftgpio010.c
---- linux-3.4.113.orig/drivers/gpio/gpio-ftgpio010.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/gpio/gpio-ftgpio010.c 2016-12-01 20:59:24.384613985 +0100
-@@ -0,0 +1,218 @@
-+#include <linux/module.h>
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/io.h>
-+#include <linux/gpio.h>
-+
-+#define GPIO_DATA_OUT 0x00
-+#define GPIO_DATA_IN 0x04
-+#define PIN_DIR 0x08
-+#define PIN_BYPASS 0x0C
-+#define GPIO_DATA_SET 0x10
-+#define GPIO_DATA_CLEAR 0x14
-+#define PIN_PULL_ENABLE 0x18
-+#define PIN_PULL_TYPE 0x1C
-+#define INT_ENABLE 0x20
-+#define INT_RAW_STATE 0x24
-+#define INT_MASKED_STATE 0x28
-+#define INT_MASK 0x2C
-+#define INT_CLEAR 0x30
-+#define INT_TRIGGER 0x34
-+#define INT_BOTH 0x38
-+#define INT_RISE_NEG 0x3C
-+#define BOUNCE_ENABLE 0x40
-+#define BOUNCE_PRE_SCALE 0x44
-+
-+#define GPIO_READL(offset) \
-+ readl(GPIO_FTGPIO010_VA_BASE + (offset))
-+
-+#define GPIO_WRITEL(val, offset) \
-+ writel((val), GPIO_FTGPIO010_VA_BASE + (offset))
-+
-+#define FTGPIO010_VIRTUAL_IRQ_BASE 100
-+
-+static int irq_to_gpio(unsigned int irq)
-+{
-+ return irq - FTGPIO010_VIRTUAL_IRQ_BASE;
-+}
-+
-+static int ftgpio_to_irq(struct gpio_chip *gc, unsigned int offset)
-+{
-+ return FTGPIO010_VIRTUAL_IRQ_BASE + offset;
-+}
-+
-+static int ftgpio_get(struct gpio_chip *gc, unsigned int gpio)
-+{
-+ return (GPIO_READL(GPIO_DATA_IN) >> gpio & 1);
-+}
-+
-+static void ftgpio_set(struct gpio_chip *gc, unsigned int gpio, int data)
-+{
-+ unsigned long val;
-+
-+ if (data)
-+ val = GPIO_READL(GPIO_DATA_OUT) | (0x1UL << gpio);
-+ else
-+ val = GPIO_READL(GPIO_DATA_OUT) & ~(0x1UL << gpio);
-+
-+ GPIO_WRITEL(val, GPIO_DATA_OUT);
-+}
-+
-+static int ftgpio_dir_in(struct gpio_chip *gc, unsigned int gpio)
-+{
-+ unsigned long val;
-+
-+ val = GPIO_READL(PIN_DIR) & ~(0x1UL << gpio);
-+ GPIO_WRITEL(val, PIN_DIR);
-+
-+ return 0;
-+}
-+
-+static int ftgpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int data)
-+{
-+ unsigned long val;
-+
-+ val = GPIO_READL(PIN_DIR) | (0x1UL << gpio);
-+ GPIO_WRITEL(val, PIN_DIR);
-+
-+ gc->set(gc, gpio, data);
-+
-+ return 0;
-+}
-+
-+static struct gpio_chip ftgpio_chip = {
-+
-+ .label = "FTGPIO010",
-+ .base = 0,
-+ .ngpio = 16,
-+ .direction_input = ftgpio_dir_in,
-+ .direction_output = ftgpio_dir_out,
-+ .get = ftgpio_get,
-+ .set = ftgpio_set,
-+ .to_irq = ftgpio_to_irq,
-+};
-+
-+static void ftgpio_irq_ack(struct irq_data *data)
-+{
-+ GPIO_WRITEL(0x1UL << irq_to_gpio(data->irq), INT_CLEAR);
-+}
-+
-+static void ftgpio_irq_mask(struct irq_data *data)
-+{
-+ unsigned long val;
-+
-+ val = GPIO_READL(INT_MASK) | (0x1UL << irq_to_gpio(data->irq));
-+ GPIO_WRITEL(val, INT_MASK);
-+}
-+
-+static void ftgpio_irq_unmask(struct irq_data *data)
-+{
-+ unsigned long val;
-+ val = GPIO_READL(INT_MASK) & ~(0x1UL << irq_to_gpio(data->irq));
-+ GPIO_WRITEL(val, INT_MASK);
-+}
-+
-+static int ftgpio_irq_set_type(struct irq_data *data, unsigned int flow_type)
-+{
-+ unsigned long bit = 0x1UL << irq_to_gpio(data->irq);
-+ unsigned long val;
-+ val = GPIO_READL(INT_BOTH);
-+
-+ if (flow_type & IRQF_TRIGGER_RISING && flow_type & IRQF_TRIGGER_FALLING)
-+ GPIO_WRITEL(val | bit, INT_BOTH);
-+ else
-+ GPIO_WRITEL(val & ~bit, INT_BOTH);
-+
-+ val = GPIO_READL(INT_RISE_NEG);
-+
-+ if (flow_type & IRQF_TRIGGER_FALLING)
-+ GPIO_WRITEL(val | bit, INT_RISE_NEG);
-+ else if (flow_type & IRQF_TRIGGER_RISING)
-+ GPIO_WRITEL(val & ~bit, INT_RISE_NEG);
-+
-+ return 0;
-+}
-+
-+static struct irq_chip ftgpio_irq_chip = {
-+
-+ .name = "FTGPIO010_irq",
-+ .irq_ack = ftgpio_irq_ack,
-+ .irq_mask = ftgpio_irq_mask,
-+ .irq_unmask = ftgpio_irq_unmask,
-+ .irq_set_type = ftgpio_irq_set_type,
-+};
-+
-+static void gpio_irq_router(unsigned int irq, struct irq_desc *desc)
-+{
-+ unsigned long status;
-+ int i = 0;
-+
-+ status = GPIO_READL(INT_RAW_STATE);
-+ status &= ~((1 << 22) | (1 << 25) | (1 << 26));
-+
-+ while (status) {
-+
-+ if (status & 0x1UL)
-+ generic_handle_irq(gpio_to_irq(i));
-+
-+ status >>= 1;
-+ i++;
-+ }
-+}
-+
-+static int gpio_init(void)
-+{
-+ int i;
-+
-+ /* disable interrupt */
-+ GPIO_WRITEL(0x00000000UL, INT_ENABLE);
-+
-+ /* mask interrupt */
-+ GPIO_WRITEL(0x0000FFFFUL, INT_MASK);
-+
-+ /* triggered interrupt on both edge */
-+ GPIO_WRITEL(0x0000FFFFUL, INT_BOTH);
-+
-+ /* clear interrupt */
-+ GPIO_WRITEL(0x0000FFFFUL, INT_CLEAR);
-+
-+ /* enable de-bouncing */
-+ GPIO_WRITEL(0x0000FFFFUL, BOUNCE_ENABLE);
-+
-+ /* enable interrupt */
-+ GPIO_WRITEL(0x0000FFFFUL, INT_ENABLE);
-+
-+ gpiochip_add(&ftgpio_chip);
-+
-+ for (i = 0; i < ftgpio_chip.ngpio; i++) {
-+
-+ irq_set_chip(gpio_to_irq(i), &ftgpio_irq_chip);
-+ irq_set_handler(gpio_to_irq(i), handle_level_irq);
-+ }
-+
-+ irq_set_chained_handler(GPIO_FTGPIO010_IRQ, gpio_irq_router);
-+
-+ pr_info("GPIO module inserted\n");
-+
-+ return 0;
-+}
-+
-+static void __exit gpio_exit(void)
-+{
-+ int i=0;
-+ /* disable interrupt */
-+ GPIO_WRITEL(0x00000000UL, INT_ENABLE);
-+ while(i<ftgpio_chip.ngpio)
-+ gpio_free(i++);
-+
-+ if (gpiochip_remove(&ftgpio_chip))
-+ pr_info("failed to remove gpiochip\n");
-+
-+ pr_info("GPIO module removed\n");
-+}
-+
-+MODULE_DESCRIPTION("FTGPIO010");
-+MODULE_LICENSE("GPL");
-+
-+module_init(gpio_init);
-+module_exit(gpio_exit);
-diff -Nur linux-3.4.113.orig/drivers/gpio/Kconfig linux-3.4.113/drivers/gpio/Kconfig
---- linux-3.4.113.orig/drivers/gpio/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/gpio/Kconfig 2016-12-01 20:59:24.384613985 +0100
-@@ -492,6 +492,10 @@
- This enables support for the Philips UCB1400 GPIO pins.
- The UCB1400 is an AC97 audio codec.
-
-+config GPIO_FTGPIO010
-+ tristate "Farady FTGPIO010 GPIO support"
-+ depends on NDS32 && GENERIC_GPIO && ARCH_WANT_OPTIONAL_GPIOLIB
-+
- comment "MODULbus GPIO expanders:"
-
- config GPIO_JANZ_TTL
-diff -Nur linux-3.4.113.orig/drivers/gpio/Makefile linux-3.4.113/drivers/gpio/Makefile
---- linux-3.4.113.orig/drivers/gpio/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/gpio/Makefile 2016-12-01 20:59:24.384613985 +0100
-@@ -64,3 +64,4 @@
- obj-$(CONFIG_GPIO_WM8350) += gpio-wm8350.o
- obj-$(CONFIG_GPIO_WM8994) += gpio-wm8994.o
- obj-$(CONFIG_GPIO_XILINX) += gpio-xilinx.o
-+obj-$(CONFIG_GPIO_FTGPIO010) += gpio-ftgpio010.o
-\ No newline at end of file
-diff -Nur linux-3.4.113.orig/drivers/input/touchscreen/cpe_ts/cpe_ts.c linux-3.4.113/drivers/input/touchscreen/cpe_ts/cpe_ts.c
---- linux-3.4.113.orig/drivers/input/touchscreen/cpe_ts/cpe_ts.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/input/touchscreen/cpe_ts/cpe_ts.c 2016-12-01 20:59:24.384613985 +0100
-@@ -0,0 +1,376 @@
-+#include <linux/input.h>
-+#include <linux/interrupt.h>
-+#include <linux/platform_device.h>
-+#include <linux/io.h>
-+
-+#include <asm/irq.h>
-+#include "cpe_ts.h"
-+
-+
-+#include <linux/module.h>
-+
-+#include <linux/irqnr.h>
-+#include <linux/irq.h>
-+
-+#define TOUCHSCREEN_IRQ 28
-+
-+#define ads_dbg( enabled, tagged, ...) \
-+ do{ \
-+ if( enabled){ \
-+ if( tagged) \
-+ printk( "[ %30s() ] ", __func__); \
-+ printk( __VA_ARGS__); \
-+ } \
-+ } while( 0)
-+
-+#define TS_POLL_DELAY ( 1 * 1000000) /* ns delay before the first sample */
-+#define TS_POLL_PERIOD ( delay * 1000000) /* ns delay between samples */
-+
-+static int debug = 0;
-+static int delay = 25;
-+
-+module_param(debug, int, 0);
-+module_param(delay, int, 0);
-+
-+struct ads7846
-+{
-+ void __iomem * regs;
-+ struct input_dev *input;
-+ char phys[32];
-+ struct hrtimer timer;
-+ int irq;
-+ spinlock_t lock;
-+ bool disabled;
-+};
-+
-+struct ts_event
-+{
-+ int x;
-+ int y;
-+ int z1, z2;
-+ int Rt;
-+};
-+
-+struct ads7846 touchscreen;
-+
-+#define ADS_START ( 0x1UL << 7)
-+#define ADS_A2A1A0_d_y ( 0x1UL << 4) /* differential */
-+#define ADS_A2A1A0_d_z1 ( 0x3UL << 4) /* differential */
-+#define ADS_A2A1A0_d_z2 ( 0x4UL << 4) /* differential */
-+#define ADS_A2A1A0_d_x ( 0x5UL << 4) /* differential */
-+#define ADS_12_BIT ( 0x0UL << 3)
-+#define ADS_SER ( 0x1UL << 2) /* non-differential */
-+#define ADS_DFR ( 0x0UL << 2) /* differential */
-+#define ADS_PD10_PDOWN ( 0x0UL << 0) /* lowpower mode + penirq */
-+#define ADS_PD10_ADC_ON ( 0x1UL << 0) /* ADC on */
-+#define ADS_PD10_REF_ON ( 0x2UL << 0) /* vREF on + penirq */
-+#define ADS_PD10_ALL_ON ( 0x3UL << 0) /* ADC + vREF on */
-+
-+#define MAX_12BIT ( ( 0x1UL << 12) - 1)
-+
-+#define READ_X ( ADS_A2A1A0_d_x | ADS_12_BIT | ADS_DFR)
-+#define READ_Y ( ADS_A2A1A0_d_y | ADS_12_BIT | ADS_DFR)
-+#define READ_Z1 ( ADS_A2A1A0_d_z1 | ADS_12_BIT | ADS_DFR)
-+#define READ_Z2 ( ADS_A2A1A0_d_z2 | ADS_12_BIT | ADS_DFR)
-+
-+static int
-+read_val(struct ads7846 *ts, unsigned long cmd)
-+{
-+ unsigned long data = 0;
-+ int repeat = 5;
-+ int i;
-+
-+ ads_dbg(0, 1, "Queuing data: 0x%08lx\n", cmd << 16);
-+
-+ for (i = 0; i < repeat; i++)
-+ {
-+ while (!(REG32(ts->regs + SSP_REG_SR) & SSP_SR_mskTFNF));
-+ REG32(ts->regs + SSP_REG_DR) = (ADS_START | cmd | ADS_PD10_ALL_ON) << 16;
-+ }
-+
-+ for (i = 0; i < repeat; i++)
-+ {
-+ while (!(REG32(ts->regs + SSP_REG_SR) & SSP_SR_mskRFVE));
-+ data = (REG32(ts->regs + SSP_REG_DR) >> 3) & 0xFFF;
-+ }
-+
-+ while (!(REG32(ts->regs + SSP_REG_SR) & SSP_SR_mskTFNF));
-+ REG32(ts->regs + SSP_REG_DR) = (ADS_START | cmd) << 16;
-+
-+ while (!(REG32(ts->regs + SSP_REG_SR) & SSP_SR_mskRFVE));
-+
-+ data = (REG32(ts->regs + SSP_REG_DR) >> 3) & 0xFFF;
-+ ads_dbg(0, 1, "CMD <%02lx> data: 0x%08lx( %ld)\n", cmd, data, data);
-+
-+ return data;
-+}
-+
-+static int pendown(struct ads7846 *ts)
-+{
-+ return read_val(ts, READ_Z1) > 40;
-+}
-+
-+static void report(struct ads7846 *ts, struct ts_event *e)
-+{
-+ e->x = read_val(ts, READ_X);
-+ e->y = read_val(ts, READ_Y);
-+ e->z1 = read_val(ts, READ_Z1);
-+ e->z2 = read_val(ts, READ_Z2);
-+
-+ ads_dbg(debug, 1, "x: %4d, y: %4d, z1: %4d, z2: %4d\n", e->x, e->y, e->z1, e->z2);
-+}
-+
-+#define FILTER_LIMIT 35
-+
-+static enum hrtimer_restart ads7846_timer(struct hrtimer *handle)
-+{
-+ struct ads7846 *ts = container_of(handle, struct ads7846, timer);
-+ struct ts_event e;
-+ struct irq_desc *desc = (struct irq_desc *)irq_get_irq_data((unsigned int)ts->irq);
-+ static int xp = 0, yp = 0;
-+
-+ if (ts->disabled)
-+ return HRTIMER_NORESTART;
-+
-+ if (!pendown(ts))
-+ {
-+ ads_dbg(debug, 1, "Release\n");
-+
-+ input_report_key(ts->input, BTN_TOUCH, 0);
-+ input_report_abs(ts->input, ABS_PRESSURE, 0);
-+ input_sync(ts->input);
-+
-+ if(desc->irq_data.chip->irq_ack)
-+ desc->irq_data.chip->irq_ack(&desc->irq_data);
-+ enable_irq(ts->irq);
-+ return HRTIMER_NORESTART;
-+ }
-+ report(ts, &e);
-+
-+#ifdef CONFIG_TOUCHSCREEN_CPE_TS_DEJITTER
-+ if (abs(xp - e.x) > FILTER_LIMIT || abs(yp - e.y) > FILTER_LIMIT)
-+ {
-+#endif
-+ input_report_key(ts->input, BTN_TOUCH, 1);
-+ input_report_abs(ts->input, ABS_X, e.x);
-+ input_report_abs(ts->input, ABS_Y, e.y);
-+ input_report_abs(ts->input, ABS_PRESSURE, 50);
-+ xp = e.x;
-+ yp = e.y;
-+#ifdef CONFIG_TOUCHSCREEN_CPE_TS_DEJITTER
-+ }
-+#endif
-+ input_sync(ts->input);
-+ hrtimer_start(&ts->timer, ktime_set(0, TS_POLL_PERIOD), HRTIMER_MODE_REL);
-+ ads_dbg(0, 1, "Leave\n");
-+ return HRTIMER_NORESTART;
-+}
-+
-+static irqreturn_t ads7846_irq(int irq, void *handle)
-+{
-+ struct ads7846 *ts = handle;
-+
-+ if (ts->disabled)
-+ return IRQ_HANDLED;
-+
-+ disable_irq_nosync(irq);
-+ hrtimer_start(&ts->timer, ktime_set(0, TS_POLL_DELAY), HRTIMER_MODE_REL);
-+
-+ return IRQ_HANDLED;
-+}
-+
-+static int xspi_init_hw(void __iomem *regs_base)
-+{
-+ int rev = REG32(regs_base + SSP_REG_REV);
-+ int reva = REG32(regs_base + SSP_REG_REV-0x20);
-+
-+ if ((((rev & SSP_REV_mskMAJOR_REV) >> SSP_REV_offMAJOR_REV) != 1)&&
-+ (((reva & SSP_REV_mskMAJOR_REV) >> SSP_REV_offMAJOR_REV) != 1))
-+ {
-+ ads_dbg(1, 0, "ADS7846 Touchscreen controller initialized failed:\n"
-+ "\tcannot detect Faraday SSP Controller\n");
-+ return -ENXIO;
-+ }
-+ REG32(regs_base + SSP_REG_CR2) |= (1UL << SSP_CR2_offSSPRST);
-+
-+ REG32(regs_base + SSP_REG_CR1) =
-+ (0UL << SSP_CR1_offPDL) | /* Padding Data Length */
-+ (23UL << SSP_CR1_offSDL) | /* Serial Data Length */
-+ (5UL << SSP_CR1_offSCLKDIV); /* SCLK Divider */
-+
-+ REG32(regs_base + SSP_REG_CR0) =
-+ (1UL << SSP_CR0_offFFMT) | /* Frame Format */
-+ (3UL << SSP_CR0_offOPM) | /* Operation Mode */
-+ (0UL << SSP_CR0_offSCLKPO) | /* SCLK Polarity */
-+ (0UL << SSP_CR0_offSCLKPH); /* SCLK Phase */
-+
-+ REG32(regs_base + SSP_REG_CR2) |= (1UL << SSP_CR2_offTXFCLR) | (1UL << SSP_CR2_offRXFCLR);
-+ REG32(regs_base + SSP_REG_CR2) |= (1UL << SSP_CR2_offSSPEN) | (1UL << SSP_CR2_offTXDOE);
-+ return 0;
-+}
-+
-+static int ads7846_probe(struct platform_device *pdev)
-+{
-+ struct ads7846 *ts = &touchscreen;
-+ struct input_dev *input_dev;
-+ int err = 0;
-+ platform_set_drvdata(pdev, ts);
-+
-+ ts->regs = ioremap(0x98b00000, 44);
-+ err = xspi_init_hw(ts->regs);
-+ if (err)
-+ goto err_unmap;
-+ input_dev = input_allocate_device();
-+ if (!input_dev)
-+ {
-+ err = -ENOMEM;
-+ goto err_free_mem;
-+ }
-+
-+ ts->input = input_dev;
-+
-+ hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
-+ ts->timer.function = ads7846_timer;
-+
-+ input_dev->name = "ADS7846 Touchscreen";
-+ input_dev->phys = ts->phys;
-+
-+ input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
-+ input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
-+ input_set_abs_params(input_dev, ABS_X, 0, MAX_12BIT, 0, 0);
-+ input_set_abs_params(input_dev, ABS_Y, 0, MAX_12BIT, 0, 0);
-+ input_set_abs_params(input_dev, ABS_PRESSURE, 0, MAX_12BIT, 0, 0);
-+
-+ ts->irq = TOUCHSCREEN_IRQ;
-+
-+ if (request_irq(ts->irq, ads7846_irq, IRQF_TRIGGER_RISING, "touch screen", ts))
-+ goto err_free_mem;
-+
-+ err = input_register_device(input_dev);
-+ if (err)
-+ goto err_free_irq;
-+
-+ spin_lock_init(&ts->lock);
-+ return 0;
-+err_free_irq:
-+ free_irq(ts->irq, ts);
-+err_free_mem:
-+ input_free_device(input_dev);
-+err_unmap:
-+ iounmap(ts->regs);
-+
-+ return err;
-+}
-+
-+static int __devexit ads7846_remove(struct platform_device *pdev)
-+{
-+ struct ads7846 *ts = platform_get_drvdata(pdev);
-+
-+ disable_irq(ts->irq);
-+ free_irq(ts->irq, ts);
-+ iounmap(ts->regs);
-+ input_unregister_device(ts->input);
-+
-+ return 0;
-+}
-+
-+#ifdef CONFIG_PM
-+static int ads7846_suspend( struct platform_device *pdev, pm_message_t message)
-+{
-+ struct ads7846 *ts = platform_get_drvdata(pdev);
-+
-+ spin_lock_irq(&ts->lock);
-+ ts->disabled = true;
-+ disable_irq(ts->irq);
-+ spin_unlock_irq(&ts->lock);
-+
-+ return 0;
-+}
-+
-+static int ads7846_resume( struct platform_device *pdev)
-+{
-+ struct ads7846 *ts = platform_get_drvdata(pdev);
-+
-+ spin_lock_irq(&ts->lock);
-+
-+ enable_irq(ts->irq);
-+ ts->disabled = false;
-+
-+ spin_unlock_irq(&ts->lock);
-+
-+ return 0;
-+}
-+#else
-+#define ads7846_suspend NULL
-+#define ads7846_resume NULL
-+#endif
-+
-+static void platform_device_release(struct device *dev){
-+}
-+
-+static struct resource ads7846_resources[] =
-+{
-+ [0] = {
-+ .start = SSP_FTSSP010_PA_BASE,
-+ .end = SSP_FTSSP010_PA_LIMIT,
-+ .flags = IORESOURCE_MEM,
-+ },
-+ [1] = {
-+ .start = TOUCHSCREEN_IRQ, //feed me! SSP_FTSSP010_IRQ in spec.h
-+ .end = TOUCHSCREEN_IRQ,
-+ .flags = IORESOURCE_IRQ,
-+ },
-+};
-+
-+static struct platform_device ads7846_device =
-+{
-+ .name = "ads7846",
-+ .id = -1,
-+ .resource = ads7846_resources,
-+ .num_resources = ARRAY_SIZE(ads7846_resources),
-+ .dev = {
-+ .release = platform_device_release,
-+ },
-+};
-+
-+#if 0
-+static struct platform_driver ads7846_driver =
-+{
-+ .driver = {
-+ .name = "ads7846",
-+ .owner = THIS_MODULE,
-+ },
-+ .probe = ads7846_probe,
-+ .remove = __devexit_p(ads7846_remove),
-+ .suspend = ads7846_suspend,
-+ .resume = ads7846_resume,
-+};
-+#else
-+static struct platform_driver ads7846_driver =
-+{
-+ .driver = {
-+ .name = "ads7846",
-+ },
-+ .probe = ads7846_probe,
-+ .remove = __devexit_p(ads7846_remove),
-+ .suspend = ads7846_suspend,
-+ .resume = ads7846_resume,
-+};
-+#endif
-+
-+static int __init ads7846_init(void)
-+{
-+ platform_device_register(&ads7846_device);
-+ return platform_driver_register(&ads7846_driver);
-+}
-+
-+static void __exit ads7846_exit(void)
-+{
-+ platform_device_unregister(&ads7846_device);
-+ platform_driver_unregister(&ads7846_driver);
-+}
-+
-+module_init(ads7846_init);
-+module_exit(ads7846_exit);
-+MODULE_DESCRIPTION("ADS7846 TouchScreen Driver");
-+MODULE_LICENSE("GPL");
-diff -Nur linux-3.4.113.orig/drivers/input/touchscreen/cpe_ts/cpe_ts.h linux-3.4.113/drivers/input/touchscreen/cpe_ts/cpe_ts.h
---- linux-3.4.113.orig/drivers/input/touchscreen/cpe_ts/cpe_ts.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/input/touchscreen/cpe_ts/cpe_ts.h 2016-12-01 20:59:24.384613985 +0100
-@@ -0,0 +1,218 @@
-+#ifndef SSP_FARADAY_H
-+#define SSP_FARADAY_H
-+
-+#define XILINX_SPI_NAME "faraday-spi"
-+
-+/*
-+ * Register definitions as per "OPB Serial Peripheral Interface ( SPI) ( v1.00e)
-+ * Product Specification", DS464
-+ */
-+#define XSPI_CR_OFFSET 0x62 /* 16-bit Control Register */
-+
-+#define XSPI_CR_ENABLE 0x02
-+#define XSPI_CR_MASTER_MODE 0x04
-+#define XSPI_CR_CPOL 0x08
-+#define XSPI_CR_CPHA 0x10
-+#define XSPI_CR_MODE_MASK ( XSPI_CR_CPHA | XSPI_CR_CPOL)
-+#define XSPI_CR_TXFIFO_RESET 0x20
-+#define XSPI_CR_RXFIFO_RESET 0x40
-+#define XSPI_CR_MANUAL_SSELECT 0x80
-+#define XSPI_CR_TRANS_INHIBIT 0x100
-+
-+#define XSPI_SR_OFFSET 0x67 /* 8-bit Status Register */
-+
-+#define XSPI_SR_RX_EMPTY_MASK 0x01 /* Receive FIFO is empty */
-+#define XSPI_SR_RX_FULL_MASK 0x02 /* Receive FIFO is full */
-+#define XSPI_SR_TX_EMPTY_MASK 0x04 /* Transmit FIFO is empty */
-+#define XSPI_SR_TX_FULL_MASK 0x08 /* Transmit FIFO is full */
-+#define XSPI_SR_MODE_FAULT_MASK 0x10 /* Mode fault error */
-+
-+#define XSPI_TXD_OFFSET 0x6b /* 8-bit Data Transmit Register */
-+#define XSPI_RXD_OFFSET 0x6f /* 8-bit Data Receive Register */
-+
-+#define XSPI_SSR_OFFSET 0x70 /* 32-bit Slave Select Register */
-+
-+/* Register definitions as per "OPB IPIF ( v3.01c) Product Specification", DS414
-+ * IPIF registers are 32 bit
-+ */
-+#define XIPIF_V123B_DGIER_OFFSET 0x1c /* IPIF global int enable reg */
-+#define XIPIF_V123B_GINTR_ENABLE 0x80000000
-+
-+#define XIPIF_V123B_IISR_OFFSET 0x20 /* IPIF interrupt status reg */
-+#define XIPIF_V123B_IIER_OFFSET 0x28 /* IPIF interrupt enable reg */
-+
-+#define XSPI_INTR_MODE_FAULT 0x01 /* Mode fault error */
-+#define XSPI_INTR_SLAVE_MODE_FAULT 0x02 /* Selected as slave while disabled */
-+#define XSPI_INTR_TX_EMPTY 0x04 /* TxFIFO is empty */
-+#define XSPI_INTR_TX_UNDERRUN 0x08 /* TxFIFO was underrun */
-+#define XSPI_INTR_RX_FULL 0x10 /* RxFIFO is full */
-+#define XSPI_INTR_RX_OVERRUN 0x20 /* RxFIFO was overrun */
-+
-+#define XIPIF_V123B_RESETR_OFFSET 0x40 /* IPIF reset register */
-+#define XIPIF_V123B_RESET_MASK 0x0a /* the value to write */
-+
-+/*************************************************************************/
-+#if 0
-+#define SSP_REG_CR0 ( SSP_FTSSP010_VA_BASE + 0x00) /* SSP Control Register 0 */
-+#define SSP_REG_CR1 ( SSP_FTSSP010_VA_BASE + 0x04) /* SSP Control Register 1 */
-+#define SSP_REG_CR2 ( SSP_FTSSP010_VA_BASE + 0x08) /* SSP Control Register 2 */
-+#define SSP_REG_SR ( SSP_FTSSP010_VA_BASE + 0x0c) /* SSP Status Register */
-+#define SSP_REG_ICR ( SSP_FTSSP010_VA_BASE + 0x10) /* SSP Interrupt Control Register */
-+#define SSP_REG_ISR ( SSP_FTSSP010_VA_BASE + 0x14) /* SSP Interrupt Status Register */
-+#define SSP_REG_DR ( SSP_FTSSP010_VA_BASE + 0x18) /* SSP Data Register */
-+#define SSP_REG_ACL ( SSP_FTSSP010_VA_BASE + 0x20) /* AC-Link Slot Valid Register */
-+#define SSP_REG_REV ( SSP_FTSSP010_VA_BASE + 0x40) /* SSP Revision Register */
-+#define SSP_REG_FEA ( SSP_FTSSP010_VA_BASE + 0x44) /* SSP Feature Register */
-+#endif
-+#define SSP_REG_CR0 0x00 /* SSP Control Register 0 */
-+#define SSP_REG_CR1 0x04 /* SSP Control Register 1 */
-+#define SSP_REG_CR2 0x08 /* SSP Control Register 2 */
-+#define SSP_REG_SR 0x0C /* SSP Status Register */
-+#define SSP_REG_ICR 0x10 /* SSP Interrupt Control Register */
-+#define SSP_REG_ISR 0x14 /* SSP Interrupt Status Register */
-+#define SSP_REG_DR 0x18 /* SSP Data Register */
-+#define SSP_REG_ACL 0x20 /* AC-Link Slot Valid Register */
-+#define SSP_REG_REV 0x60 /* SSP Revision Register */
-+#define SSP_REG_FEA 0x64 /* SSP Feature Register */
-+
-+#define SSP_CR0_offFFMT 12 /* Frame Format */
-+#define SSP_CR0_offFSDIST 8 /* Frame/Sync and Data Distance */
-+#define SSP_CR0_offLBM 7 /* Loopback Mode */
-+#define SSP_CR0_offLSB 6 /* Bit Sequence Indicator */
-+#define SSP_CR0_offFSPO 5 /* Frame/Sync Polarity */
-+#define SSP_CR0_offFSJSFY 4 /* Data Justify */
-+#define SSP_CR0_offOPM 2 /* Operation Mode */
-+#define SSP_CR0_offSCLKPO 1 /* SCLK Polarity */
-+#define SSP_CR0_offSCLKPH 0 /* SCLK Phase */
-+
-+#define SSP_CR0_mskFFMT ( 0x07UL << SSP_CR0_offFFMT)
-+#define SSP_CR0_mskFSDIST ( 0x03UL << SSP_CR0_offFSDIST)
-+#define SSP_CR0_mskLBM ( 0x01UL << SSP_CR0_offLBM)
-+#define SSP_CR0_mskLSB ( 0x01UL << SSP_CR0_offLSB)
-+#define SSP_CR0_mskFSPO ( 0x01UL << SSP_CR0_offFSPO)
-+#define SSP_CR0_mskFSJSFY ( 0x01UL << SSP_CR0_offFSJSFY)
-+#define SSP_CR0_mskOPM ( 0x03UL << SSP_CR0_offOPM)
-+#define SSP_CR0_mskSCLKPO ( 0x01UL << SSP_CR0_offSCLKPO)
-+#define SSP_CR0_mskSCLKPH ( 0x01UL << SSP_CR0_offSCLKPH)
-+
-+#define SSP_CR1_offPDL 24 /* Padding Data Length */
-+#define SSP_CR1_offSDL 16 /* Serial Data Length */
-+#define SSP_CR1_offSCLKDIV 0 /* SCLK Divider */
-+
-+#define SSP_CR1_mskPDL ( 0xFFUL << SSP_CR1_offPDL)
-+#define SSP_CR1_mskSDL ( 0x1FUL << SSP_CR1_offSDL)
-+#define SSP_CR1_mskSCLKDIV ( 0xFFUL << SSP_CR1_offSCLKDIV)
-+
-+#define SSP_CR2_offSSPRST 6 /* SSP Reset */
-+#define SSP_CR2_offACCRST 5 /* AC-Link Cold Reset Enable */
-+#define SSP_CR2_offACWRST 4 /* AC-Link Warm Reset Enable */
-+#define SSP_CR2_offTXFCLR 3 /* Transmit FIFO Clear */
-+#define SSP_CR2_offRXFCLR 2 /* Recieve FIFO clear */
-+#define SSP_CR2_offTXDOE 1 /* Transmit Data Output Enable */
-+#define SSP_CR2_offSSPEN 0 /* The SSP Enable */
-+
-+#define SSP_CR2_mskSSPRST ( 0x01UL << SSP_CR2_offSSPRST)
-+#define SSP_CR2_mskACCRST ( 0x01UL << SSP_CR2_offACCRST)
-+#define SSP_CR2_mskACWRST ( 0x01UL << SSP_CR2_offACWRST)
-+#define SSP_CR2_mskTXFCLR ( 0x01UL << SSP_CR2_offTXFCLR)
-+#define SSP_CR2_mskRXFCLR ( 0x01UL << SSP_CR2_offRXFCLR)
-+#define SSP_CR2_mskTXDOE ( 0x01UL << SSP_CR2_offTXDOE)
-+#define SSP_CR2_mskSSPEN ( 0x01UL << SSP_CR2_offSSPEN)
-+
-+#define SSP_SR_offTFVE 12 /* Transmit FIFO Valid Entries */
-+#define SSP_SR_offRFVE 4 /* Recieve FIFO Valid Entries */
-+#define SSP_SR_offBUSY 2 /* Busy Indicator */
-+#define SSP_SR_offTFNF 1 /* Transmit FIFO not full */
-+#define SSP_SR_offRFF 0 /* Recieve FIFO full */
-+
-+#define SSP_SR_mskTFVE ( 0x1FUL << SSP_SR_offTFVE)
-+#define SSP_SR_mskRFVE ( 0x1FUL << SSP_SR_offRFVE)
-+#define SSP_SR_mskBUSY ( 0x01UL << SSP_SR_offBUSY)
-+#define SSP_SR_mskTFNF ( 0x01UL << SSP_SR_offTFNF)
-+#define SSP_SR_mskRFF ( 0x01UL << SSP_SR_offRFF)
-+
-+#define SSP_ICR_offTFTHOD 12 /* Transmit FIFO Threshold */
-+#define SSP_ICR_offRFTHOD 8 /* Recieve FIFO Threshold */
-+#define SSP_ICR_offAC97FCEN 6 /* AC97 Frame Complete */
-+#define SSP_ICR_offTFDMAEN 5 /* Transmit DMA Request Enable */
-+#define SSP_ICR_offRFDMAEN 4 /* Recieve DMA Request Enable */
-+#define SSP_ICR_offTFTHIEN 3 /* Transmit FIFO Threshold Interrupt */
-+#define SSP_ICR_offRFTHIEN 2 /* Recieve FIFO Threshold Interrupt */
-+#define SSP_ICR_offTFURIEN 1 /* Transmit FIFO Underrun Interrupt Enable */
-+#define SSP_ICR_offRFORIEN 0 /* Recieve FIFO Overrun Interrupt Enable */
-+
-+#define SSP_ICR_mskTFTHOD ( 0x0FUL << SSP_ICR_offTFTHOD)
-+#define SSP_ICR_mskRFTHOD ( 0x0FUL << SSP_ICR_offRFTHOD)
-+#define SSP_ICR_mskAC97FCEN ( 0x01UL << SSP_ICR_offAC97FCEN)
-+#define SSP_ICR_mskTFDMAEN ( 0x01UL << SSP_ICR_offTFDMAEN)
-+#define SSP_ICR_mskRFDMAEN ( 0x01UL << SSP_ICR_offRFDMAEN)
-+#define SSP_ICR_mskTFTHIEN ( 0x01UL << SSP_ICR_offTFTHIEN)
-+#define SSP_ICR_mskRFTHIEN ( 0x01UL << SSP_ICR_offRFTHIEN)
-+#define SSP_ICR_mskTFURIEN ( 0x01UL << SSP_ICR_offTFURIEN)
-+#define SSP_ICR_mskRFORIEN ( 0x01UL << SSP_ICR_offRFORIEN)
-+
-+#define SSP_ISR_offAC97FCI 4 /* AC97 Frame Complete Interrupt */
-+#define SSP_ISR_offTFTHI 3 /* Transmit FIFO Threshold Interrupt */
-+#define SSP_ISR_offRFTHI 2 /* Recieve FIFO Threshold Interrupt */
-+#define SSP_ISR_offTFURI 1 /* Transmit FIFO underrun Interrupt */
-+#define SSP_ISR_offRFORI 0 /* Recieve FIFO Overun Interrupt */
-+
-+#define SSP_ISR_mskAC97FCI ( 0x01UL << SSP_ISR_offAC97FCI)
-+#define SSP_ISR_mskTFTHI ( 0x01UL << SSP_ISR_offTFTHI)
-+#define SSP_ISR_mskRFTHI ( 0x01UL << SSP_ISR_offRFTHI)
-+#define SSP_ISR_mskTFURI ( 0x01UL << SSP_ISR_offTFURI)
-+#define SSP_ISR_mskRFORI ( 0x01UL << SSP_ISR_offRFORI)
-+
-+#define SSP_ACL_offSLOT1V 14 /* The 1st Slot is Valid */
-+#define SSP_ACL_offSLOT2V 13 /* The 2nd Slot is Valid */
-+#define SSP_ACL_offSLOT3V 12 /* The 3th Slot is Valid */
-+#define SSP_ACL_offSLOT4V 11 /* The 4th Slot is Valid */
-+#define SSP_ACL_offSLOT5V 10 /* The 5th Slot is Valid */
-+#define SSP_ACL_offSLOT6V 9 /* The 6th Slot is Valid */
-+#define SSP_ACL_offSLOT7V 8 /* The 7th Slot is Valid */
-+#define SSP_ACL_offSLOT8V 7 /* The 8th Slot is Valid */
-+#define SSP_ACL_offSLOT9V 6 /* The 9th Slot is Valid */
-+#define SSP_ACL_offSLOT10V 5 /* The 10th Slot is Valid */
-+#define SSP_ACL_offSLOT11V 4 /* The 11th Slot is Valid */
-+#define SSP_ACL_offSLOT12V 3 /* The 12th Slot is Valid */
-+#define SSP_ACL_offCODECID 0 /* Codec ID, which will be shifted out as tag slot */
-+
-+#define SSP_ACL_mskSLOT1V ( 0x01UL << SSP_ACL_offSLOT1V)
-+#define SSP_ACL_mskSLOT2V ( 0x01UL << SSP_ACL_offSLOT2V)
-+#define SSP_ACL_mskSLOT3V ( 0x01UL << SSP_ACL_offSLOT3V)
-+#define SSP_ACL_mskSLOT4V ( 0x01UL << SSP_ACL_offSLOT4V)
-+#define SSP_ACL_mskSLOT5V ( 0x01UL << SSP_ACL_offSLOT5V)
-+#define SSP_ACL_mskSLOT6V ( 0x01UL << SSP_ACL_offSLOT6V)
-+#define SSP_ACL_mskSLOT7V ( 0x01UL << SSP_ACL_offSLOT7V)
-+#define SSP_ACL_mskSLOT8V ( 0x01UL << SSP_ACL_offSLOT8V)
-+#define SSP_ACL_mskSLOT9V ( 0x01UL << SSP_ACL_offSLOT9V)
-+#define SSP_ACL_mskSLOT10V ( 0x01UL << SSP_ACL_offSLOT10V)
-+#define SSP_ACL_mskSLOT11V ( 0x01UL << SSP_ACL_offSLOT11V)
-+#define SSP_ACL_mskSLOT12V ( 0x01UL << SSP_ACL_offSLOT12V)
-+#define SSP_ACL_mskCODECID ( 0x03UL << SSP_ACL_offCODECID)
-+
-+#define SSP_REV_offMAJOR_REV 16 /* Major Revision Number */
-+#define SSP_REV_offMINOR_REV 8 /* Minor Revision Number */
-+#define SSP_REV_offREL_REV 0 /* Release Number */
-+
-+#define SSP_REV_mskMAJOR_REV ( 0xFFUL << SSP_REV_offMAJOR_REV)
-+#define SSP_REV_mskMINOR_REV ( 0xFFUL << SSP_REV_offMINOR_REV)
-+#define SSP_REV_mskREL_REV ( 0xFFUL << SSP_REV_offREL_REV)
-+
-+#define SSP_FEA_offSSP_FCFG 27 /* The SSP Functional Configurations */
-+#define SSP_FEA_offSPIMWR_FCFG 26 /* Motorola's SPI and National Semiconductor's Microwire Configurations */
-+#define SSP_FEA_offI2S_FCFG 25 /* Philips's I2S Functional Configurations */
-+#define SSP_FEA_offAC97_FCFG 24 /* Intel's AC-Link Functional Configurations */
-+#define SSP_FEA_offTXFIFO_WIDTH 16 /* Transmit FIFO Size Configurations */
-+#define SSP_FEA_offRXFIFO_WIDTH 8 /* Recieve FIFO Size Configuration */
-+#define SSP_FEA_offFIFO_WIDTH 0 /* Transmit/Recieve FIFO Width */
-+
-+#define SSP_FEA_mskSSP_FCFG ( 0x01UL << SSP_FEA_offSSP_FCFG)
-+#define SSP_FEA_mskSPIMWR_FCFG ( 0x01UL << SSP_FEA_offSPIMWR_FCFG)
-+#define SSP_FEA_mskI2S_FCFG ( 0x01UL << SSP_FEA_offI2S_FCFG)
-+#define SSP_FEA_mskAC97_FCFG ( 0x01UL << SSP_FEA_offAC97_FCFG)
-+#define SSP_FEA_mskTXFIFO_WIDTH ( 0xFFUL << SSP_FEA_offTXFIFO_WIDTH)
-+#define SSP_FEA_mskRXFIFO_WIDTH ( 0xFFUL << SSP_FEA_offRXFIFO_WIDTH)
-+#define SSP_FEA_mskFIFO_WIDTH ( 0xFFUL << SSP_FEA_offFIFO_WIDTH)
-+
-+#endif /* SSP_FARADAY */
-diff -Nur linux-3.4.113.orig/drivers/input/touchscreen/cpe_ts/Makefile linux-3.4.113/drivers/input/touchscreen/cpe_ts/Makefile
---- linux-3.4.113.orig/drivers/input/touchscreen/cpe_ts/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/input/touchscreen/cpe_ts/Makefile 2016-12-01 20:59:24.384613985 +0100
-@@ -0,0 +1 @@
-+obj-$(CONFIG_TOUCHSCREEN_CPE_TS) += cpe_ts.o
-diff -Nur linux-3.4.113.orig/drivers/input/touchscreen/Kconfig linux-3.4.113/drivers/input/touchscreen/Kconfig
---- linux-3.4.113.orig/drivers/input/touchscreen/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/input/touchscreen/Kconfig 2016-12-01 20:59:24.384613985 +0100
-@@ -86,6 +86,26 @@
- To compile this driver as a module, choose M here: the
- module will be called ad7879-spi.
-
-+config TOUCHSCREEN_CPE_TS
-+ tristate "Touchscreen Driver for AG101/XC5"
-+ help
-+ This driver directly accesses SPI controller to communicate with
-+ the ads7846 chip.
-+
-+ Once we have a SPI controller driver
-+ , we can adopt to the SPI
-+ framework that kernel provides.
-+
-+config TOUCHSCREEN_CPE_TS_DEJITTER
-+ bool "Dejitter Detection"
-+ depends on TOUCHSCREEN_CPE_TS
-+ default y
-+ help
-+ Say Y here to enable dejitter detection in AG101/Leopard Touchscreen Driver.
-+
-+ If unsure, say y.
-+
-+
- config TOUCHSCREEN_ATMEL_MXT
- tristate "Atmel mXT I2C Touchscreen"
- depends on I2C
-diff -Nur linux-3.4.113.orig/drivers/input/touchscreen/Makefile linux-3.4.113/drivers/input/touchscreen/Makefile
---- linux-3.4.113.orig/drivers/input/touchscreen/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/input/touchscreen/Makefile 2016-12-01 20:59:24.384613985 +0100
-@@ -69,3 +69,4 @@
- obj-$(CONFIG_TOUCHSCREEN_WM97XX_ZYLONITE) += zylonite-wm97xx.o
- obj-$(CONFIG_TOUCHSCREEN_W90X900) += w90p910_ts.o
- obj-$(CONFIG_TOUCHSCREEN_TPS6507X) += tps6507x-ts.o
-+obj-$(CONFIG_TOUCHSCREEN_CPE_TS) += cpe_ts/
-diff -Nur linux-3.4.113.orig/drivers/mmc/core/bus.c linux-3.4.113/drivers/mmc/core/bus.c
---- linux-3.4.113.orig/drivers/mmc/core/bus.c 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/mmc/core/bus.c 2016-12-01 20:59:24.384613985 +0100
-@@ -26,7 +26,9 @@
- #include "bus.h"
-
- #define to_mmc_driver(d) container_of(d, struct mmc_driver, drv)
--
-+#ifdef CONFIG_MMC_TEST
-+static struct mmc_driver *mmc_test_drv;
-+#endif
- static ssize_t mmc_type_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
-@@ -109,6 +111,11 @@
- struct mmc_driver *drv = to_mmc_driver(dev->driver);
- struct mmc_card *card = mmc_dev_to_card(dev);
-
-+ #ifdef CONFIG_MMC_TEST
-+ mmc_test_drv->probe(card);
-+ printk("debug mmc_bus_probe\n");
-+ #endif
-+
- return drv->probe(card);
- }
-
-@@ -200,6 +207,11 @@
- int mmc_register_driver(struct mmc_driver *drv)
- {
- drv->drv.bus = &mmc_bus_type;
-+ #ifdef CONFIG_MMC_TEST
-+ printk("debug defined config_mmc_test in mmc_register_driver\n");
-+ if(!strcmp(drv->drv.name,"mmc_test"))
-+ mmc_test_drv = drv;
-+ #endif
- return driver_register(&drv->drv);
- }
-
-diff -Nur linux-3.4.113.orig/drivers/mmc/host/ftsdc010.c linux-3.4.113/drivers/mmc/host/ftsdc010.c
---- linux-3.4.113.orig/drivers/mmc/host/ftsdc010.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/mmc/host/ftsdc010.c 2016-12-01 20:59:24.388614139 +0100
-@@ -0,0 +1,1586 @@
-+/* drivers/mmc/host/ftsdc010.c
-+ * Copyright (C) 2010 Andestech
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/dma-mapping.h>
-+#include <linux/clk.h>
-+#include <linux/mmc/host.h>
-+#include <linux/mmc/mmc.h>
-+#include <linux/mmc/card.h>
-+#include <linux/platform_device.h>
-+#include <linux/debugfs.h>
-+#include <linux/seq_file.h>
-+#include <linux/irq.h>
-+#include <linux/interrupt.h>
-+#include <linux/delay.h>
-+#include <linux/slab.h>
-+
-+#include <asm/io.h>
-+#include <asm/spec.h>
-+#include <asm/dmad.h>
-+
-+#include "ftsdc010.h"
-+
-+#define DRIVER_NAME "ftsdc010"
-+
-+#define REG_READ(addr) readl((host->base + addr))
-+#define REG_WRITE(data, addr) writel((data), (host->base + addr))
-+
-+#define APB_CLK_IN (AHB_CLK_IN / 2)
-+
-+enum dbg_channels {
-+ dbg_err = (1 << 0),
-+ dbg_debug = (1 << 1),
-+ dbg_info = (1 << 2),
-+ dbg_irq = (1 << 3),
-+ dbg_sg = (1 << 4),
-+ dbg_dma = (1 << 5),
-+ dbg_pio = (1 << 6),
-+ dbg_fail = (1 << 7),
-+ dbg_conf = (1 << 8),
-+};
-+
-+static struct workqueue_struct *mywq;
-+
-+static const int dbgmap_err = dbg_fail;
-+static const int dbgmap_info = dbg_info | dbg_conf;
-+static const int dbgmap_debug = dbg_err | dbg_debug | dbg_info | dbg_conf;
-+#if 1
-+#define dbg(host, channels, args...) \
-+ do { \
-+ if (dbgmap_err & channels) \
-+ dev_err(&host->pdev->dev, args); \
-+ else if (dbgmap_info & channels) \
-+ dev_info(&host->pdev->dev, args); \
-+ else if (dbgmap_debug & channels) \
-+ dev_dbg(&host->pdev->dev, args); \
-+ } while (0)
-+#endif
-+#if 0
-+#define dbg(host, channels, args...) \
-+ do { \
-+ printk(KERN_INFO "%s: ", "ftsdc");\
-+ printk(args); \
-+ } while(0)
-+#endif
-+
-+static void finalize_request(struct ftsdc_host *host);
-+static void ftsdc_send_request(struct mmc_host *mmc);
-+
-+#ifdef CONFIG_MMC_DEBUG
-+
-+static void dbg_dumpregs(struct ftsdc_host *host, char *prefix)
-+{
-+ u32 con, cmdarg, r0, r1, r2, r3, rcmd, dcon, dtimer,
-+ dlen, sta, clr, imask, pcon, ccon, bwidth, scon1,
-+ scon2, ssta, fea;
-+
-+ con = REG_READ(SDC_CMD_REG);
-+ cmdarg = REG_READ(SDC_ARGU_REG);
-+ r0 = REG_READ(SDC_RESPONSE0_REG);
-+ r1 = REG_READ(SDC_RESPONSE1_REG);
-+ r2 = REG_READ(SDC_RESPONSE2_REG);
-+ r3 = REG_READ(SDC_RESPONSE3_REG);
-+ rcmd = REG_READ(SDC_RSP_CMD_REG);
-+ dcon = REG_READ(SDC_DATA_CTRL_REG);
-+ dtimer = REG_READ(SDC_DATA_TIMER_REG);
-+ dlen = REG_READ(SDC_DATA_LEN_REG);
-+ sta = REG_READ(SDC_STATUS_REG);
-+ clr = REG_READ(SDC_CLEAR_REG);
-+ imask = REG_READ(SDC_INT_MASK_REG);
-+ pcon = REG_READ(SDC_POWER_CTRL_REG);
-+ ccon = REG_READ(SDC_CLOCK_CTRL_REG);
-+ bwidth = REG_READ(SDC_BUS_WIDTH_REG);
-+ scon1 = REG_READ(SDC_SDIO_CTRL1_REG);
-+ scon2 = REG_READ(SDC_SDIO_CTRL2_REG);
-+ ssta = REG_READ(SDC_SDIO_STATUS_REG);
-+ fea = REG_READ(SDC_FEATURE_REG);
-+
-+ dbg(host, dbg_debug, "%s CON:[%08x] STA:[%08x] INT:[%08x], PWR:[%08x], CLK:[%08x]\n",
-+ prefix, con, sta, imask, pcon, ccon);
-+
-+ dbg(host, dbg_debug, "%s DCON:[%08x] DTIME:[%08x]"
-+ " DLEN:[%08x] DWIDTH:[%08x]\n",
-+ prefix, dcon, dtimer, dlen, bwidth);
-+
-+ dbg(host, dbg_debug, "%s R0:[%08x] R1:[%08x]"
-+ " R2:[%08x] R3:[%08x]\n",
-+ prefix, r0, r1, r2, r3);
-+
-+ dbg(host, dbg_debug, "%s SCON1:[%08x] SCON2:[%08x]"
-+ " SSTA:[%08x] FEA:[%08x]\n",
-+ prefix, scon1, scon2, ssta, fea);
-+}
-+
-+static void prepare_dbgmsg(struct ftsdc_host *host, struct mmc_command *cmd,
-+ int stop)
-+{
-+ snprintf(host->dbgmsg_cmd, 300,
-+ "#%u%s op:%i arg:0x%08x flags:0x08%x retries:%u",
-+ host->ccnt, (stop ? " (STOP)" : ""),
-+ cmd->opcode, cmd->arg, cmd->flags, cmd->retries);
-+
-+ if (cmd->data) {
-+ snprintf(host->dbgmsg_dat, 300,
-+ "#%u bsize:%u blocks:%u bytes:%u",
-+ host->dcnt, cmd->data->blksz,
-+ cmd->data->blocks,
-+ cmd->data->blocks * cmd->data->blksz);
-+ } else {
-+ host->dbgmsg_dat[0] = '\0';
-+ }
-+}
-+
-+static void dbg_dumpcmd(struct ftsdc_host *host, struct mmc_command *cmd,
-+ int fail)
-+{
-+ unsigned int dbglvl = fail ? dbg_fail : dbg_debug;
-+
-+ if (!cmd)
-+ return;
-+
-+ if (cmd->error == 0) {
-+ dbg(host, dbglvl, "CMD[OK] %s R0:0x%08x\n",
-+ host->dbgmsg_cmd, cmd->resp[0]);
-+ } else {
-+ dbg(host, dbglvl, "CMD[ERR %i] %s Status:%s\n",
-+ cmd->error, host->dbgmsg_cmd, host->status);
-+ }
-+
-+ if (!cmd->data)
-+ return;
-+
-+ if (cmd->data->error == 0) {
-+ dbg(host, dbglvl, "DAT[OK] %s\n", host->dbgmsg_dat);
-+ } else {
-+ dbg(host, dbglvl, "DAT[ERR %i] %s DCNT:0x%08x\n",
-+ cmd->data->error, host->dbgmsg_dat,
-+ REG_READ(SDC_DATA_LEN_REG));
-+ }
-+}
-+#else
-+static void dbg_dumpcmd(struct ftsdc_host *host,
-+ struct mmc_command *cmd, int fail) { }
-+
-+static void prepare_dbgmsg(struct ftsdc_host *host, struct mmc_command *cmd,
-+ int stop) { }
-+
-+static void dbg_dumpregs(struct ftsdc_host *host, char *prefix) { }
-+
-+#endif /* CONFIG_MMC_DEBUG */
-+
-+static inline bool ftsdc_dmaexist(struct ftsdc_host *host)
-+{
-+ return (host->dma_req != NULL);
-+}
-+
-+static inline u32 enable_imask(struct ftsdc_host *host, u32 imask)
-+{
-+ u32 newmask;
-+
-+#ifdef CONFIG_MMC_DEBUG
-+ if (imask & SDC_STATUS_REG_SDIO_INTR) printk("\n*** E ***\n");
-+#endif
-+ newmask = REG_READ(SDC_INT_MASK_REG);
-+ newmask |= imask;
-+
-+ REG_WRITE(newmask, SDC_INT_MASK_REG);
-+
-+ return newmask;
-+}
-+
-+static inline u32 disable_imask(struct ftsdc_host *host, u32 imask)
-+{
-+ u32 newmask;
-+
-+#ifdef CONFIG_MMC_DEBUG
-+ if (imask & SDC_STATUS_REG_SDIO_INTR) printk("\n*** D ***\n");
-+#endif
-+ newmask = REG_READ(SDC_INT_MASK_REG);
-+ newmask &= ~imask;
-+
-+ REG_WRITE(newmask, SDC_INT_MASK_REG);
-+
-+ return newmask;
-+}
-+
-+static inline void clear_imask(struct ftsdc_host *host)
-+{
-+ u32 mask = REG_READ(SDC_INT_MASK_REG);
-+
-+ /* preserve the SDIO IRQ mask state */
-+ mask &= (SDC_INT_MASK_REG_SDIO_INTR | SDC_INT_MASK_REG_CARD_CHANGE);
-+ REG_WRITE(mask, SDC_INT_MASK_REG);
-+}
-+
-+//static void ftsdc_check_sdio_irq(struct ftsdc_host *host)
-+//{
-+// if (host->sdio_irqen) {
-+// u32 con = REG_READ(SDC_STATUS_REG);
-+// if (con & SDC_STATUS_REG_SDIO_INTR) {
-+// printk(KERN_DEBUG "%s: signalling irq\n", __func__);
-+// mmc_signal_sdio_irq(host->mmc);
-+// }
-+// }
-+//}
-+
-+static inline void get_data_buffer(struct ftsdc_host *host)
-+{
-+ struct scatterlist *sg;
-+
-+ BUG_ON(host->buf_sgptr >= host->mrq->data->sg_len);
-+
-+ sg = &host->mrq->data->sg[host->buf_sgptr];
-+
-+ host->buf_bytes = sg->length;
-+ host->buf_ptr = host->dodma ? (u32 *)sg->dma_address : sg_virt(sg);
-+ host->buf_sgptr++;
-+}
-+
-+static inline u32 cal_blksz(unsigned int blksz)
-+{
-+ u32 blksztwo = 0;
-+
-+ while (blksz >>= 1)
-+ blksztwo++;
-+
-+ return blksztwo;
-+}
-+
-+/**
-+ * ftsdc_enable_irq - enable IRQ, after having disabled it.
-+ * @host: The device state.
-+ * @more: True if more IRQs are expected from transfer.
-+ *
-+ * Enable the main IRQ if needed after it has been disabled.
-+ *
-+ * The IRQ can be one of the following states:
-+ * - enable after data read/write
-+ * - disable when handle data read/write
-+ */
-+static void ftsdc_enable_irq(struct ftsdc_host *host, bool enable)
-+{
-+ unsigned long flags;
-+ local_irq_save(flags);
-+
-+ host->irq_enabled = enable;
-+
-+ if (enable)
-+ enable_irq(host->irq);
-+ else
-+ disable_irq(host->irq);
-+
-+ local_irq_restore(flags);
-+}
-+
-+static void do_pio_read(struct ftsdc_host *host)
-+{
-+ u32 fifo;
-+ u32 fifo_words;
-+ u32 *ptr;
-+ u32 status;
-+ u32 retry = 0;
-+
-+
-+ BUG_ON(host->buf_bytes != 0);
-+
-+ while (host->buf_sgptr < host->mrq->data->sg_len) {
-+ get_data_buffer(host);
-+
-+ dbg(host, dbg_pio,
-+ "pio_read(): new target: [%i]@[%p]\n",
-+ host->buf_bytes, host->buf_ptr);
-+
-+ while (host->buf_bytes) {
-+ status = REG_READ(SDC_STATUS_REG);
-+
-+ if (status & SDC_STATUS_REG_FIFO_OVERRUN) {
-+ fifo = host->fifo_len > host->buf_bytes ?
-+ host->buf_bytes : host->fifo_len;
-+
-+#if 1
-+ dbg(host, dbg_pio,
-+ "pio_read(): fifo:[%02i] buffer:[%03i] dcnt:[%08X]\n",
-+ fifo, host->buf_bytes,
-+ REG_READ(SDC_DATA_LEN_REG));
-+#endif
-+
-+ host->buf_bytes -= fifo;
-+ host->buf_count += fifo;
-+
-+ fifo_words = fifo >> 2;
-+ ptr = host->buf_ptr;
-+ while (fifo_words--)
-+ *ptr++ = REG_READ(SDC_DATA_WINDOW_REG);
-+
-+ host->buf_ptr = ptr;
-+ //ADD by river 2010.10.26 for adding some delays for SD card to put data into FIFO again
-+ //mdelay(1);
-+ udelay(800);
-+ //End ADD by river 2010.10.26 for adding some delays for SD card to put data into FIFO again
-+
-+ /* sdio allow non-power-of-2 blksz */
-+ if (fifo & 3) {
-+ u32 n = fifo & 3;
-+ u32 data = REG_READ(SDC_DATA_WINDOW_REG);
-+ u8 *p = (u8 *)host->buf_ptr;
-+
-+ while (n--) {
-+ *p++ = data;
-+ data >>= 8;
-+ }
-+ }
-+ } else {
-+ udelay(1);
-+ if (++retry >= SDC_PIO_RETRY) {
-+ host->mrq->data->error = -EIO;
-+ goto err;
-+ }
-+ }
-+ }
-+ }
-+
-+err:
-+
-+ host->buf_active = XFER_NONE;
-+ host->complete_what = COMPLETION_FINALIZE;
-+}
-+
-+static void do_pio_write(struct ftsdc_host *host)
-+{
-+ u32 fifo;
-+ u32 *ptr;
-+ u32 status;
-+ u32 retry = 0;
-+
-+ BUG_ON(host->buf_bytes != 0);
-+
-+ while (host->buf_sgptr < host->mrq->data->sg_len) {
-+ get_data_buffer(host);
-+
-+ dbg(host, dbg_pio,
-+ "pio_write(): new source: [%i]@[%p]\n",
-+ host->buf_bytes, host->buf_ptr);
-+
-+ while (host->buf_bytes) {
-+ status = REG_READ(SDC_STATUS_REG);
-+ if (status & SDC_STATUS_REG_FIFO_UNDERRUN) {
-+ fifo = host->fifo_len > host->buf_bytes ?
-+ host->buf_bytes : host->fifo_len;
-+
-+ dbg(host, dbg_pio,
-+ "pio_write(): fifo:[%02i] buffer:[%03i] dcnt:[%08X]\n",
-+ fifo, host->buf_bytes,
-+ REG_READ(SDC_DATA_LEN_REG));
-+
-+ host->buf_bytes -= fifo;
-+ host->buf_count += fifo;
-+
-+ fifo = (fifo + 3) >> 2;
-+ ptr = host->buf_ptr;
-+ while (fifo--) {
-+ REG_WRITE(*ptr, SDC_DATA_WINDOW_REG);
-+ ptr++;
-+ }
-+ host->buf_ptr = ptr;
-+ } else {
-+ udelay(1);
-+ if (++retry >= SDC_PIO_RETRY) {
-+ host->mrq->data->error = -EIO;
-+ goto err;
-+ }
-+ }
-+ }
-+ }
-+
-+err:
-+ host->buf_active = XFER_NONE;
-+ host->complete_what = COMPLETION_FINALIZE;
-+}
-+
-+static void do_dma_access(struct ftsdc_host *host)
-+{
-+ int res;
-+ unsigned long timeout;
-+ dmad_chreq *req = host->dma_req;
-+ dmad_drb *drb = 0;
-+
-+ while (host->buf_sgptr < host->mrq->data->sg_len) {
-+
-+ INIT_COMPLETION(host->dma_complete);
-+ get_data_buffer(host);
-+
-+ dbg(host, dbg_dma,
-+ "dma_%s(): new target: [%i]@[%p]\n",
-+ host->buf_active == XFER_READ ? "read" : "write",
-+ host->buf_bytes, host->buf_ptr);
-+
-+ res = dmad_alloc_drb(req, &drb);
-+ if (res != 0 || (drb == 0)) {
-+ dbg(host, dbg_err, "%s() Failed to allocate dma request block!\n", __func__);
-+ host->mrq->data->error = -ENODEV;
-+ goto err;
-+ }
-+
-+ drb->addr0 = SDC_FTSDC010_0_PA_BASE + SDC_DATA_WINDOW_REG;
-+ drb->addr1 = (dma_addr_t)host->buf_ptr;
-+ drb->req_cycle = dmad_bytes_to_cycles(req, host->buf_bytes);
-+ drb->sync = &host->dma_complete;
-+
-+ timeout = SDC_TIMEOUT_BASE*((host->buf_bytes+511)>>9);
-+
-+ res = dmad_submit_request(req, drb, 1);
-+ if (res != 0) {
-+ dbg(host, dbg_err, "%s() Failed to submit dma request block!\n", __func__);
-+ host->mrq->data->error = -ENODEV;
-+ goto err;
-+ }
-+
-+ dbg(host, dbg_err, "reach here!\n");
-+ if (wait_for_completion_timeout(&host->dma_complete, timeout) == 0) {
-+ dbg(host, dbg_err, "%s: read timeout\n", __func__);
-+ host->mrq->data->error = -ETIMEDOUT;
-+ goto err;
-+ }
-+ }
-+
-+ host->dma_finish = true;
-+err:
-+ host->buf_active = XFER_NONE;
-+ host->complete_what = COMPLETION_FINALIZE;
-+}
-+
-+static void ftsdc_work(struct work_struct *work)
-+{
-+ struct ftsdc_host *host =
-+ container_of(work, struct ftsdc_host, work);
-+
-+ ftsdc_enable_irq(host, false);
-+
-+ if (host->dodma) {
-+ do_dma_access(host);
-+ } else {
-+ if (host->buf_active == XFER_WRITE)
-+ do_pio_write(host);
-+
-+ if (host->buf_active == XFER_READ)
-+ do_pio_read(host);
-+ }
-+
-+ tasklet_schedule(&host->pio_tasklet);
-+ ftsdc_enable_irq(host, true);
-+}
-+
-+
-+static void pio_tasklet(unsigned long data)
-+{
-+ struct ftsdc_host *host = (struct ftsdc_host *) data;
-+
-+ if (host->complete_what == COMPLETION_XFER_PROGRESS) {
-+ queue_work(mywq, (struct work_struct *)&host->work);
-+ return;
-+ }
-+
-+ if (host->complete_what == COMPLETION_FINALIZE) {
-+ clear_imask(host);
-+ if (host->buf_active != XFER_NONE) {
-+ dbg(host, dbg_err, "unfinished %s "
-+ "- buf_count:[%u] buf_bytes:[%u]\n",
-+ (host->buf_active == XFER_READ) ? "read" : "write",
-+ host->buf_count, host->buf_bytes);
-+
-+ if (host->mrq->data)
-+ host->mrq->data->error = -EINVAL;
-+ }
-+
-+ finalize_request(host);
-+ }
-+}
-+
-+
-+static void finalize_request(struct ftsdc_host *host)
-+{
-+ struct mmc_request *mrq = host->mrq;
-+ struct mmc_command *cmd;
-+ u32 con;
-+ int debug_as_failure = 0;
-+
-+ if (host->complete_what != COMPLETION_FINALIZE)
-+ return;
-+
-+ if (!mrq)
-+ return;
-+
-+ cmd = host->cmd_is_stop ? mrq->stop : mrq->cmd;
-+
-+ if (cmd->data && (cmd->error == 0) &&
-+ (cmd->data->error == 0)) {
-+ if (host->dodma && (!host->dma_finish)) {
-+ dbg(host, dbg_dma, "DMA Missing (%d)!\n",
-+ host->dma_finish);
-+ return;
-+ }
-+ host->dodma = false;
-+ }
-+
-+ /* Read response from controller. */
-+ if (cmd->flags & MMC_RSP_136) {
-+ cmd->resp[3] = REG_READ(SDC_RESPONSE0_REG);
-+ cmd->resp[2] = REG_READ(SDC_RESPONSE1_REG);
-+ cmd->resp[1] = REG_READ(SDC_RESPONSE2_REG);
-+ cmd->resp[0] = REG_READ(SDC_RESPONSE3_REG);
-+ } else if (cmd->flags & MMC_RSP_PRESENT) {
-+ cmd->resp[0] = REG_READ(SDC_RESPONSE0_REG);
-+ }
-+
-+ if (cmd->error)
-+ debug_as_failure = 1;
-+
-+ if (cmd->data && cmd->data->error)
-+ debug_as_failure = 1;
-+
-+ dbg_dumpcmd(host, cmd, debug_as_failure);
-+
-+ clear_imask(host);
-+ con = REG_READ(SDC_STATUS_REG);
-+ con &= ~SDC_CLEAR_REG_SDIO_INTR;
-+ REG_WRITE(con, SDC_CLEAR_REG);
-+
-+ if (cmd->data && cmd->error)
-+ cmd->data->error = cmd->error;
-+
-+ if (cmd->data && cmd->data->stop && (!host->cmd_is_stop)) {
-+ host->cmd_is_stop = 1;
-+ ftsdc_send_request(host->mmc);
-+ return;
-+ }
-+
-+ /* If we have no data transfer we are finished here */
-+ if (!mrq->data)
-+ goto request_done;
-+
-+ /* Calulate the amout of bytes transfer if there was no error */
-+ if (mrq->data->error == 0) {
-+ mrq->data->bytes_xfered =
-+ (mrq->data->blocks * mrq->data->blksz);
-+ } else {
-+ mrq->data->bytes_xfered = 0;
-+ }
-+
-+request_done:
-+ host->complete_what = COMPLETION_NONE;
-+ host->mrq = NULL;
-+
-+ host->last_opcode = mrq->cmd->opcode;
-+ mmc_request_done(host->mmc, mrq);
-+}
-+
-+static void ftsdc_send_command(struct ftsdc_host *host,
-+ struct mmc_command *cmd)
-+{
-+ u32 ccon = 0;
-+ u32 newmask = 0;
-+ u32 scon;
-+
-+ if (cmd->data) {
-+ host->complete_what = COMPLETION_XFER_PROGRESS;
-+ newmask |= SDC_INT_MASK_REG_RSP_TIMEOUT;
-+ } else if (cmd->flags & MMC_RSP_PRESENT) {
-+ host->complete_what = COMPLETION_RSPFIN;
-+ newmask |= SDC_INT_MASK_REG_RSP_TIMEOUT;
-+ } else {
-+ host->complete_what = COMPLETION_CMDSENT;
-+ newmask |= SDC_INT_MASK_REG_CMD_SEND;
-+ }
-+
-+ ccon |= cmd->opcode & SDC_CMD_REG_INDEX;
-+ ccon |= SDC_CMD_REG_CMD_EN;
-+
-+ if (cmd->flags & MMC_RSP_PRESENT) {
-+ ccon |= SDC_CMD_REG_NEED_RSP;
-+ newmask |= SDC_INT_MASK_REG_RSP_CRC_OK |
-+ SDC_INT_MASK_REG_RSP_CRC_FAIL;
-+ }
-+
-+ if (cmd->flags & MMC_RSP_136)
-+ ccon |= SDC_CMD_REG_LONG_RSP;
-+
-+ /* applicatiion specific cmd must follow an MMC_APP_CMD. The
-+ * value will be updated in finalize_request function */
-+ if (host->last_opcode == MMC_APP_CMD)
-+ ccon |= SDC_CMD_REG_APP_CMD;
-+
-+ enable_imask(host, newmask);
-+ REG_WRITE(cmd->arg, SDC_ARGU_REG);
-+
-+ scon = REG_READ(SDC_SDIO_CTRL1_REG);
-+ if (host->mmc->card != NULL && mmc_card_sdio(host->mmc->card))
-+ scon |= SDC_SDIO_CTRL1_REG_SDIO_ENABLE;
-+ else
-+ scon &= ~SDC_SDIO_CTRL1_REG_SDIO_ENABLE;
-+ REG_WRITE(scon, SDC_SDIO_CTRL1_REG);
-+
-+ dbg_dumpregs(host, "");
-+ dbg(host, dbg_debug, "CON[%x]\n", ccon);
-+
-+ REG_WRITE(ccon, SDC_CMD_REG);
-+}
-+
-+static int ftsdc_setup_data(struct ftsdc_host *host, struct mmc_data *data)
-+{
-+ u32 dcon, newmask = 0;
-+
-+ /* configure data transfer paramter */
-+
-+ if (!data)
-+ return 0;
-+ if(host->mmc->card && host->mmc->card->type==(unsigned int)MMC_TYPE_SD){
-+ if (((data->blksz - 1) & data->blksz) != 0) {
-+ pr_warning("%s: can't do non-power-of 2 sized block transfers (blksz %d)\n", __func__, data->blksz);
-+ return -EINVAL;
-+ }
-+ }
-+
-+ if (data->blksz <= 2) {
-+ /* We cannot deal with unaligned blocks with more than
-+ * one block being transfered. */
-+
-+ if (data->blocks > 1) {
-+ pr_warning("%s: can't do non-word sized block transfers (blksz %d)\n", __func__, data->blksz);
-+ return -EINVAL;
-+ }
-+ }
-+
-+ /* data length */
-+ dcon = data->blksz * data->blocks;
-+ REG_WRITE(dcon, SDC_DATA_LEN_REG);
-+
-+ /* write data control */
-+ dcon = 0;
-+ dcon = cal_blksz(data->blksz);
-+
-+ /* enable UNDERFUN will trigger interrupt immediatedly
-+ * So setup it when rsp is received successfully
-+ */
-+ if (data->flags & MMC_DATA_WRITE) {
-+ dcon |= SDC_DATA_CTRL_REG_DATA_WRITE;
-+ } else {
-+ dcon &= ~SDC_DATA_CTRL_REG_DATA_WRITE;
-+ newmask |= SDC_INT_MASK_REG_FIFO_OVERRUN;
-+ }
-+
-+ /* always reset fifo since last transfer may fail */
-+ dcon |= SDC_DATA_CTRL_REG_FIFO_RST;
-+
-+ /* enable data transfer which will be pended until cmd is send */
-+ dcon |= SDC_DATA_CTRL_REG_DATA_EN;
-+
-+ if (ftsdc_dmaexist(host) &&
-+ ((data->blksz * data->blocks) & 0xf) == 0) {
-+ newmask &= ~SDC_INT_MASK_REG_FIFO_OVERRUN;
-+ dcon |= SDC_DATA_CTRL_REG_DMA_EN;
-+ dcon |= SDC_DMA_TYPE_4;
-+ host->dodma = true;
-+
-+ }
-+
-+ REG_WRITE(dcon, SDC_DATA_CTRL_REG);
-+
-+ /* add to IMASK register */
-+ newmask |= SDC_INT_MASK_REG_DATA_CRC_FAIL |
-+ SDC_INT_MASK_REG_DATA_TIMEOUT;
-+
-+ enable_imask(host, newmask);
-+
-+ /* handle sdio */
-+ dcon = SDC_SDIO_CTRL1_REG_READ_WAIT_ENABLE & REG_READ(SDC_SDIO_CTRL1_REG);
-+ dcon |= data->blksz | data->blocks << 15;
-+ if (1 < data->blocks)
-+ dcon |= SDC_SDIO_CTRL1_REG_SDIO_BLK_MODE;
-+ REG_WRITE(dcon, SDC_SDIO_CTRL1_REG);
-+
-+ return 0;
-+}
-+
-+#define BOTH_DIR (MMC_DATA_WRITE | MMC_DATA_READ)
-+
-+static int ftsdc_prepare_buffer(struct ftsdc_host *host, struct mmc_data *data)
-+{
-+ int rw = (data->flags & MMC_DATA_WRITE) ? 1 : 0;
-+
-+ if ((!host->mrq) || (!host->mrq->data))
-+ return -EINVAL;
-+
-+ BUG_ON((data->flags & BOTH_DIR) == BOTH_DIR);
-+
-+ host->buf_sgptr = 0;
-+ host->buf_bytes = 0;
-+ host->buf_count = 0;
-+ host->buf_active = rw ? XFER_WRITE : XFER_READ;
-+
-+ if (host->dodma) {
-+ u32 dma_len;
-+ u32 drb_size;
-+ dma_len = dma_map_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
-+ rw ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
-+ if (dma_len == 0)
-+ return -ENOMEM;
-+
-+
-+ dmad_config_channel_dir(host->dma_req,
-+ rw ? DMAD_DIR_A1_TO_A0 : DMAD_DIR_A0_TO_A1);
-+
-+ drb_size = dmad_max_size_per_drb(host->dma_req);
-+ if (drb_size < (data->blksz & data->blocks))
-+ return -ENODEV;
-+
-+ host->dma_finish = false;
-+ }
-+
-+ return 0;
-+}
-+
-+static irqreturn_t ftsdc_irq(int irq, void *dev_id)
-+{
-+ struct ftsdc_host *host = dev_id;
-+ struct mmc_command *cmd;
-+ u32 mci_status;
-+ u32 mci_clear;
-+ u32 mci_imsk;
-+ unsigned long iflags;
-+
-+ mci_status = REG_READ(SDC_STATUS_REG);
-+ mci_imsk = REG_READ(SDC_INT_MASK_REG);
-+
-+ dbg(host, dbg_debug, "irq: status:0x%08x, mask : %08x\n", mci_status, mci_imsk);
-+
-+ if (mci_status & SDC_STATUS_REG_SDIO_INTR) {
-+ if (mci_imsk & SDC_INT_MASK_REG_SDIO_INTR) {
-+ mci_clear = SDC_CLEAR_REG_SDIO_INTR;
-+ REG_WRITE(mci_clear, SDC_CLEAR_REG);
-+
-+ mmc_signal_sdio_irq(host->mmc);
-+ return IRQ_HANDLED;
-+ }
-+ }
-+
-+ spin_lock_irqsave(&host->complete_lock, iflags);
-+
-+ mci_status = REG_READ(SDC_STATUS_REG);
-+ mci_clear = 0;
-+
-+ if (mci_status & SDC_STATUS_REG_CARD_CHANGE) {
-+ if ((mci_status & SDC_STATUS_REG_CARD_DETECT)
-+ == SDC_CARD_INSERT) {
-+ host->status = "card insert";
-+ mmc_detect_change(host->mmc, msecs_to_jiffies(500));
-+ } else {
-+ host->status = "card remove";
-+ }
-+
-+ mci_clear |= SDC_CLEAR_REG_CARD_CHANGE;
-+ dbg(host, dbg_irq, "%s\n", host->status);
-+
-+ if (host->complete_what != COMPLETION_NONE) {
-+ host->mrq->cmd->error = -EIO;
-+ goto close_transfer;
-+ }
-+
-+ goto irq_out;
-+ }
-+
-+ if ((host->complete_what == COMPLETION_NONE) ||
-+ (host->complete_what == COMPLETION_FINALIZE)) {
-+ host->status = "nothing to complete";
-+ mci_clear = -1u;
-+ goto irq_out;
-+ }
-+
-+ if (!host->mrq) {
-+ host->status = "no active mrq";
-+ clear_imask(host);
-+ goto irq_out;
-+ }
-+
-+ cmd = host->cmd_is_stop ? host->mrq->stop : host->mrq->cmd;
-+
-+ if (!cmd) {
-+ host->status = "no active cmd";
-+ clear_imask(host);
-+ goto irq_out;
-+ }
-+
-+ if (mci_status & SDC_STATUS_REG_CMD_SEND) {
-+ mci_clear |= SDC_CLEAR_REG_CMD_SEND;
-+
-+ if (host->complete_what == COMPLETION_CMDSENT) {
-+ host->status = "ok: command sent";
-+ goto close_transfer;
-+ } else {
-+ host->status = "error: command sent(status not match)";
-+ cmd->error = -EINVAL;
-+ goto fail_transfer;
-+ }
-+ }
-+
-+ /* handle error status */
-+ if (mci_status & SDC_STATUS_REG_RSP_TIMEOUT) {
-+ dbg(host, dbg_err, "CMDSTAT: error RSP TIMEOUT\n");
-+ mci_clear |= SDC_CLEAR_REG_RSP_TIMEOUT;
-+ cmd->error = -ETIMEDOUT;
-+ host->status = "error: response timeout";
-+ goto fail_transfer;
-+ }
-+
-+ if (mci_status & SDC_STATUS_REG_RSP_CRC_FAIL) {
-+ mci_clear |= SDC_CLEAR_REG_RSP_CRC_FAIL;
-+ /* This is wierd hack */
-+ if (cmd->flags & MMC_RSP_CRC) {
-+ dbg(host, dbg_err, "CMDSTAT: error RSP CRC\n");
-+ cmd->error = -EILSEQ;
-+ host->status = "error: RSP CRC failed";
-+ goto fail_transfer;
-+ } else {
-+ host->status = "R3 or R4 type command";
-+ goto close_transfer;
-+ }
-+ }
-+
-+ if (mci_status & SDC_STATUS_REG_RSP_CRC_OK) {
-+ mci_clear |= SDC_CLEAR_REG_RSP_CRC_OK;
-+
-+ if (host->complete_what == COMPLETION_XFER_PROGRESS) {
-+ REG_WRITE(mci_clear, SDC_CLEAR_REG);
-+
-+ host->status = "RSP recv OK";
-+ if (!cmd->data)
-+ goto close_transfer;
-+
-+ if (host->dodma) {
-+ tasklet_schedule(&host->pio_tasklet);
-+ host->status = "dma access";
-+ goto irq_out;
-+ }
-+
-+ if (host->buf_active == XFER_WRITE)
-+ enable_imask(host, SDC_INT_MASK_REG_FIFO_UNDERRUN);
-+ } else if (host->complete_what == COMPLETION_RSPFIN) {
-+ goto close_transfer;
-+ }
-+ }
-+
-+ /* handler data transfer */
-+ if (mci_status & SDC_STATUS_REG_DATA_TIMEOUT) {
-+ dbg(host, dbg_err, "CMDSTAT: error DATA TIMEOUT\n");
-+ mci_clear |= SDC_CLEAR_REG_DATA_TIMEOUT;
-+ cmd->error = -ETIMEDOUT;
-+ host->status = "error: data timeout";
-+ goto fail_transfer;
-+ }
-+
-+ if (mci_status & SDC_STATUS_REG_DATA_CRC_FAIL) {
-+ dbg(host, dbg_err, "CMDSTAT: error DATA CRC\n");
-+ mci_clear |= SDC_CLEAR_REG_DATA_CRC_FAIL;
-+ cmd->error = -EILSEQ;
-+ host->status = "error: data CRC fail";
-+ goto fail_transfer;
-+ }
-+
-+ if ((mci_status & SDC_STATUS_REG_FIFO_UNDERRUN) ||
-+ mci_status & SDC_STATUS_REG_FIFO_OVERRUN) {
-+
-+ disable_imask(host, SDC_INT_MASK_REG_FIFO_OVERRUN |
-+ SDC_INT_MASK_REG_FIFO_UNDERRUN);
-+
-+ if (!host->dodma) {
-+ if (host->buf_active == XFER_WRITE) {
-+ tasklet_schedule(&host->pio_tasklet);
-+ host->status = "pio tx";
-+ } else if (host->buf_active == XFER_READ) {
-+
-+ tasklet_schedule(&host->pio_tasklet);
-+ host->status = "pio rx";
-+ }
-+ }
-+ }
-+
-+ goto irq_out;
-+
-+fail_transfer:
-+ host->buf_active = XFER_NONE;
-+
-+close_transfer:
-+ host->complete_what = COMPLETION_FINALIZE;
-+
-+ clear_imask(host);
-+ tasklet_schedule(&host->pio_tasklet);
-+
-+irq_out:
-+ REG_WRITE(mci_clear, SDC_CLEAR_REG);
-+
-+ dbg(host, dbg_debug, "irq: %s\n", host->status);
-+ spin_unlock_irqrestore(&host->complete_lock, iflags);
-+ return IRQ_HANDLED;
-+}
-+
-+static void ftsdc_send_request(struct mmc_host *mmc)
-+{
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+ struct mmc_request *mrq = host->mrq;
-+ struct mmc_command *cmd = host->cmd_is_stop ? mrq->stop : mrq->cmd;
-+
-+ host->ccnt++;
-+ prepare_dbgmsg(host, cmd, host->cmd_is_stop);
-+ dbg(host, dbg_debug, "%s\n", host->dbgmsg_cmd);
-+
-+ if (cmd->data) {
-+ int res = ftsdc_setup_data(host, cmd->data);
-+
-+ host->dcnt++;
-+
-+ if (res) {
-+ dbg(host, dbg_err, "setup data error %d\n", res);
-+ cmd->error = res;
-+ cmd->data->error = res;
-+
-+ mmc_request_done(mmc, mrq);
-+ return;
-+ }
-+
-+ res = ftsdc_prepare_buffer(host, cmd->data);
-+
-+ if (res) {
-+ dbg(host, dbg_err, "data prepare error %d\n", res);
-+ cmd->error = res;
-+ cmd->data->error = res;
-+
-+ mmc_request_done(mmc, mrq);
-+ return;
-+ }
-+ }
-+
-+ /* Send command */
-+ ftsdc_send_command(host, cmd);
-+}
-+
-+static int ftsdc_get_cd(struct mmc_host *mmc)
-+{
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+
-+ u32 con = REG_READ(SDC_STATUS_REG);
-+ dbg(host, dbg_debug, "get_cd status:%.8x\n\n", con);
-+
-+ return (con & SDC_STATUS_REG_CARD_DETECT) ? 0 : 1;
-+}
-+
-+static void ftsdc_request(struct mmc_host *mmc, struct mmc_request *mrq)
-+{
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+
-+/* work_around_for_amerald(mrq);*/
-+ host->status = "mmc request";
-+ host->cmd_is_stop = 0;
-+ host->mrq = mrq;
-+ if (ftsdc_get_cd(mmc) == 0) {
-+ dbg(host, dbg_err, "%s: no medium present\n", __func__);
-+ host->mrq->cmd->error = -ENOMEDIUM;
-+ mmc_request_done(mmc, mrq);
-+ } else {
-+ ftsdc_send_request(mmc);
-+ }
-+
-+ dbg(host, dbg_debug, "send request \n");
-+}
-+
-+static void ftsdc_set_clk(struct ftsdc_host *host, struct mmc_ios *ios)
-+{
-+ u32 clk_div = 0;
-+ u32 con;
-+
-+ dbg(host, dbg_debug, "request clk : %u \n", ios->clock);
-+ con = REG_READ(SDC_CLOCK_CTRL_REG);
-+ if (ios->clock == 0) {
-+ host->real_rate = 0;
-+ con |= SDC_CLOCK_CTRL_REG_CLK_DIS;
-+ } else {
-+ clk_div = (APB_CLK_IN / (ios->clock << 1)) - 1;
-+ host->real_rate = APB_CLK_IN / ((clk_div+1)<<1);
-+ if (host->real_rate > ios->clock) {
-+ ++clk_div;
-+ host->real_rate = APB_CLK_IN / ((clk_div+1)<<1);
-+ }
-+ if (clk_div > 127)
-+ dbg(host, dbg_err, "%s: no match clock rate, %u\n", __func__, ios->clock);
-+
-+ con = (con & ~SDC_CLOCK_CTRL_REG_CLK_DIV) | (clk_div & SDC_CLOCK_CTRL_REG_CLK_DIV);
-+ con &= ~SDC_CLOCK_CTRL_REG_CLK_DIS;
-+ }
-+
-+ REG_WRITE(con, SDC_CLOCK_CTRL_REG);
-+}
-+
-+static void ftsdc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
-+{
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+ u32 con;
-+
-+ con = REG_READ(SDC_POWER_CTRL_REG);
-+ switch (ios->power_mode) {
-+ case MMC_POWER_ON:
-+ case MMC_POWER_UP:
-+ con |= SDC_POWER_CTRL_REG_POWER_ON;
-+ break;
-+ case MMC_POWER_OFF:
-+ default:
-+ con &= ~SDC_POWER_CTRL_REG_POWER_ON;
-+ break;
-+ }
-+
-+ REG_WRITE(con, SDC_POWER_CTRL_REG);
-+
-+ ftsdc_set_clk(host, ios);
-+
-+ if ((ios->power_mode == MMC_POWER_ON) ||
-+ (ios->power_mode == MMC_POWER_UP)) {
-+ dbg(host, dbg_debug, "running at %ukHz (requested: %ukHz).\n",
-+ host->real_rate/1000, ios->clock/1000);
-+ } else {
-+ dbg(host, dbg_debug, "powered down.\n");
-+ }
-+
-+ host->bus_width = ios->bus_width;
-+ /* write bus configure */
-+ con = REG_READ(SDC_BUS_WIDTH_REG);
-+
-+ con &= ~(SDC_BUS_WIDTH_REG_SINGLE_BUS |
-+ SDC_BUS_WIDTH_REG_WIDE_4_BUS |
-+ SDC_BUS_WIDTH_REG_WIDE_8_BUS);
-+ if (host->bus_width == MMC_BUS_WIDTH_1)
-+ con |= SDC_BUS_WIDTH_REG_SINGLE_BUS;
-+ else if (host->bus_width == MMC_BUS_WIDTH_4)
-+ con |= SDC_BUS_WIDTH_REG_WIDE_4_BUS;
-+ else if (host->bus_width == MMC_BUS_WIDTH_8)
-+ con |= SDC_BUS_WIDTH_REG_WIDE_8_BUS;
-+ else {
-+ dbg(host, dbg_err, "set_ios: can't support bus mode");
-+ }
-+ REG_WRITE(con, SDC_BUS_WIDTH_REG);
-+
-+ /*set rsp and data timeout */
-+ con = -1;
-+ REG_WRITE(con, SDC_DATA_TIMER_REG);
-+}
-+
-+static int ftsdc_get_ro(struct mmc_host *mmc)
-+{
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+ u32 con = REG_READ(SDC_STATUS_REG);
-+ dbg(host, dbg_debug, "get_ro status:%.8x\n", con);
-+
-+ return (con & SDC_STATUS_REG_CARD_LOCK) ? 1 : 0;
-+}
-+
-+
-+static void ftsdc_enable_sdio_irq(struct mmc_host *mmc, int enable)
-+{
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+ unsigned long flags;
-+ u32 con;
-+#ifdef CONFIG_MMC_DEBUG
-+ u32 ena;
-+#endif
-+
-+ local_irq_save(flags);
-+
-+ con = REG_READ(SDC_INT_MASK_REG);
-+#ifdef CONFIG_MMC_DEBUG
-+ ena = (con & SDC_STATUS_REG_SDIO_INTR) ? 1:0;
-+ if (ena == enable)
-+ printk("\n*** XXX ***\n");
-+#endif
-+
-+ con = enable ? (con | SDC_STATUS_REG_SDIO_INTR) : (con & ~SDC_STATUS_REG_SDIO_INTR);
-+ REG_WRITE(con, SDC_INT_MASK_REG);
-+
-+#ifdef CONFIG_MMC_DEBUG
-+ //check and ensure data out to SD host controller
-+ ena = (REG_READ(SDC_INT_MASK_REG) & SDC_STATUS_REG_SDIO_INTR) ? 1:0;
-+ if (ena != enable) {
-+ printk("\n*** YYY ***\n");
-+ }
-+#endif
-+
-+ local_irq_restore(flags);
-+}
-+
-+static struct mmc_host_ops ftsdc_ops = {
-+ .request = ftsdc_request,
-+ .set_ios = ftsdc_set_ios,
-+ .get_ro = ftsdc_get_ro,
-+ .get_cd = ftsdc_get_cd,
-+ .enable_sdio_irq = ftsdc_enable_sdio_irq,
-+};
-+
-+#ifdef CONFIG_DEBUG_FS
-+
-+static int ftsdc_state_show(struct seq_file *seq, void *v)
-+{
-+ struct ftsdc_host *host = seq->private;
-+
-+ seq_printf(seq, "Register base = 0x%08x\n", (u32)host->base);
-+ seq_printf(seq, "Clock rate = %u\n", host->real_rate);
-+ seq_printf(seq, "host status = %s\n", host->status);
-+ seq_printf(seq, "IRQ = %d\n", host->irq);
-+ seq_printf(seq, "IRQ enabled = %d\n", host->irq_enabled);
-+ seq_printf(seq, "complete what = %d\n", host->complete_what);
-+ seq_printf(seq, "dma support = %d\n", ftsdc_dmaexist(host));
-+ seq_printf(seq, "use dma = %d\n", host->dodma);
-+
-+ return 0;
-+}
-+
-+static int ftsdc_state_open(struct inode *inode, struct file *file)
-+{
-+ return single_open(file, ftsdc_state_show, inode->i_private);
-+}
-+
-+static const struct file_operations ftsdc_fops_state = {
-+ .owner = THIS_MODULE,
-+ .open = ftsdc_state_open,
-+ .read = seq_read,
-+ .llseek = seq_lseek,
-+ .release = single_release,
-+};
-+
-+#define DBG_REG(_r) { .addr = SDC_## _r ## _REG, .name = #_r }
-+
-+struct ftsdc_reg {
-+ unsigned short addr;
-+ unsigned char *name;
-+} debug_regs[] = {
-+ DBG_REG(CMD),
-+ DBG_REG(ARGU),
-+ DBG_REG(RESPONSE0),
-+ DBG_REG(RESPONSE1),
-+ DBG_REG(RESPONSE2),
-+ DBG_REG(RESPONSE3),
-+ DBG_REG(RSP_CMD),
-+ DBG_REG(DATA_CTRL),
-+ DBG_REG(DATA_TIMER),
-+ DBG_REG(DATA_LEN),
-+ DBG_REG(STATUS),
-+ DBG_REG(CLEAR),
-+ DBG_REG(INT_MASK),
-+ DBG_REG(POWER_CTRL),
-+ DBG_REG(CLOCK_CTRL),
-+ DBG_REG(BUS_WIDTH),
-+ DBG_REG(SDIO_CTRL1),
-+ DBG_REG(SDIO_CTRL2),
-+ DBG_REG(SDIO_STATUS),
-+ DBG_REG(FEATURE),
-+ DBG_REG(REVISION),
-+ {}
-+};
-+
-+static int ftsdc_regs_show(struct seq_file *seq, void *v)
-+{
-+ struct ftsdc_host *host = seq->private;
-+ struct ftsdc_reg *rptr = debug_regs;
-+
-+ for (; rptr->name; rptr++)
-+ seq_printf(seq, "SDI%s\t=0x%08x\n", rptr->name,
-+ REG_READ(rptr->addr));
-+
-+ return 0;
-+}
-+
-+static int ftsdc_regs_open(struct inode *inode, struct file *file)
-+{
-+ return single_open(file, ftsdc_regs_show, inode->i_private);
-+}
-+
-+static const struct file_operations ftsdc_fops_regs = {
-+ .owner = THIS_MODULE,
-+ .open = ftsdc_regs_open,
-+ .read = seq_read,
-+ .llseek = seq_lseek,
-+ .release = single_release,
-+};
-+
-+static void ftsdc_debugfs_attach(struct ftsdc_host *host)
-+{
-+ struct device *dev = &host->pdev->dev;
-+
-+ host->debug_root = debugfs_create_dir(dev_name(dev), NULL);
-+ if (IS_ERR(host->debug_root)) {
-+ dev_err(dev, "failed to create debugfs root\n");
-+ return;
-+ }
-+
-+ host->debug_state = debugfs_create_file("state", 0444,
-+ host->debug_root, host,
-+ &ftsdc_fops_state);
-+
-+ if (IS_ERR(host->debug_state))
-+ dev_err(dev, "failed to create debug state file\n");
-+
-+ host->debug_regs = debugfs_create_file("regs", 0444,
-+ host->debug_root, host,
-+ &ftsdc_fops_regs);
-+
-+ if (IS_ERR(host->debug_regs))
-+ dev_err(dev, "failed to create debug regs file\n");
-+}
-+
-+static void ftsdc_debugfs_remove(struct ftsdc_host *host)
-+{
-+ debugfs_remove(host->debug_regs);
-+ debugfs_remove(host->debug_state);
-+ debugfs_remove(host->debug_root);
-+}
-+
-+#else
-+static inline void ftsdc_debugfs_attach(struct ftsdc_host *host) { }
-+static inline void ftsdc_debugfs_remove(struct ftsdc_host *host) { }
-+
-+#endif /* CONFIG_DEBUG_FS */
-+
-+#if (defined(CONFIG_PLATFORM_AHBDMA) || defined(CONFIG_PLATFORM_APBDMA))
-+static int ftsdc_alloc_dma(struct ftsdc_host *host)
-+{
-+ dmad_chreq *req = host->dma_req;
-+
-+ req = kzalloc(sizeof(dmad_chreq), GFP_KERNEL);
-+#ifdef CONFIG_PLATFORM_APBDMA
-+#ifdef CONFIG_PLAT_AG102
-+ //ADD by river 2010.10.20
-+ outl(inl(PCU_VA_BASE + 0x38) | 0x00000300, PCU_VA_BASE + 0x38);
-+ //End ADD by river 2010.10.20
-+#endif
-+ req->apb_req.addr0_ctrl = APBBR_ADDRINC_FIXED; /* (in) APBBR_ADDRINC_xxx */
-+/* for amerald */
-+ if((inl(PMU_BASE) & AMERALD_MASK) == AMERALD_PRODUCT_ID){
-+ req->apb_req.addr0_reqn = APBBR_REQN_SDC_AMERALD;
-+ }else
-+ {
-+ req->apb_req.addr0_reqn = APBBR_REQN_SDC; /* (in) APBBR_REQN_xxx (also used to help determine bus selection) */
-+ }
-+ req->apb_req.addr1_ctrl = APBBR_ADDRINC_I4X; /* (in) APBBR_ADDRINC_xxx */
-+ req->apb_req.addr1_reqn = APBBR_REQN_NONE; /* (in) APBBR_REQN_xxx (also used to help determine bus selection) */
-+ req->apb_req.burst_mode = 1; /* (in) Burst mode (0: no burst 1-, 1: burst 4- data cycles per dma cycle) */
-+ req->apb_req.data_width = APBBR_DATAWIDTH_4; /* (in) APBBR_DATAWIDTH_4(word), APBBR_DATAWIDTH_2(half-word), APBBR_DATAWIDTH_1(byte) */
-+ req->apb_req.tx_dir = DMAD_DIR_A0_TO_A1; /* (in) DMAD_DIR_A0_TO_A1, DMAD_DIR_A1_TO_A0 */
-+ req->controller = DMAD_DMAC_APB_CORE; /* (in) DMAD_DMAC_AHB_CORE, DMAD_DMAC_APB_CORE */
-+ req->flags = DMAD_FLAGS_SLEEP_BLOCK | DMAD_FLAGS_BIDIRECTION;
-+
-+ if (dmad_channel_alloc(req) == 0) {
-+ dbg(host, dbg_debug, "%s: APB dma channel allocated (ch: %d)\n", __func__, req->channel);
-+ host->dma_req = req;
-+ return 0;
-+ }
-+
-+ memset(req, 0, sizeof(dmad_chreq));
-+ dbg(host, dbg_info, "%s: APB dma channel allocation failed\n", __func__);
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ req->ahb_req.sync = 1; /* (in) non-zero if src and dst have different clock domain */
-+ req->ahb_req.priority = DMAC_CSR_CHPRI_1; /* (in) DMAC_CSR_CHPRI_0 (lowest) ~ DMAC_CSR_CHPRI_3 (highest) */
-+ req->ahb_req.hw_handshake = 1; /* (in) non-zero to enable hardware handshake mode */
-+ req->ahb_req.burst_size = DMAC_CSR_SIZE_4; /* (in) DMAC_CSR_SIZE_1 ~ DMAC_CSR_SIZE_256 */
-+ req->ahb_req.addr0_width = DMAC_CSR_WIDTH_32; /* (in) DMAC_CSR_WIDTH_8, DMAC_CSR_WIDTH_16, or DMAC_CSR_WIDTH_32 */
-+ req->ahb_req.addr0_ctrl = DMAC_CSR_AD_FIX; /* (in) DMAC_CSR_AD_INC, DMAC_CSR_AD_DEC, or DMAC_CSR_AD_FIX */
-+ req->ahb_req.addr0_reqn = DMAC_REQN_SDC; /* (in) DMAC_REQN_xxx (also used to help determine channel number) */
-+ req->ahb_req.addr1_width = DMAC_CSR_WIDTH_32; /* (in) DMAC_CSR_WIDTH_8, DMAC_CSR_WIDTH_16, or DMAC_CSR_WIDTH_32 */
-+ req->ahb_req.addr1_ctrl = DMAC_CSR_AD_INC; /* (in) DMAC_CSR_AD_INC, DMAC_CSR_AD_DEC, or DMAC_CSR_AD_FIX */
-+ req->ahb_req.addr1_reqn = DMAC_REQN_NONE; /* (in) DMAC_REQN_xxx (also used to help determine channel number) */
-+ req->ahb_req.tx_dir = DMAD_DIR_A0_TO_A1; /* (in) DMAD_DIR_A0_TO_A1, DMAD_DIR_A1_TO_A0 */
-+
-+ req->controller = DMAD_DMAC_AHB_CORE; /* (in) DMAD_DMAC_AHB_CORE, DMAD_DMAC_APB_CORE */
-+ req->flags = DMAD_FLAGS_SLEEP_BLOCK | DMAD_FLAGS_BIDIRECTION;
-+
-+ if (dmad_channel_alloc(req) == 0) {
-+ dbg(host, dbg_debug, "%s: AHB dma channel allocated (ch: %d)\n", __func__, req->channel);
-+ host->dma_req = req;
-+ return 0;
-+ }
-+
-+ dbg(host, dbg_info, "%s: AHB dma channel allocation failed\n", __func__);
-+#endif
-+
-+ kfree(req);
-+ return -ENODEV;
-+
-+}
-+#endif
-+
-+static int __devinit ftsdc_probe(struct platform_device *pdev)
-+{
-+ struct ftsdc_host *host;
-+ struct mmc_host *mmc;
-+ int ret = -ENOMEM;
-+ u32 con;
-+
-+ mmc = mmc_alloc_host(sizeof(struct ftsdc_host), &pdev->dev);
-+ if (!mmc) {
-+// ret = -ENOMEM;
-+ goto probe_out;
-+ }
-+
-+ host = mmc_priv(mmc);
-+ host->mmc = mmc;
-+ host->pdev = pdev;
-+
-+ mywq = create_workqueue("atcsdc_queue");
-+ if (NULL == mywq)
-+ goto probe_free_host;
-+
-+ spin_lock_init(&host->complete_lock);
-+ tasklet_init(&host->pio_tasklet, pio_tasklet, (unsigned long) host);
-+ init_completion(&host->dma_complete);
-+ INIT_WORK(&host->work, ftsdc_work);
-+
-+ host->complete_what = COMPLETION_NONE;
-+ host->buf_active = XFER_NONE;
-+
-+#if (defined(CONFIG_PLATFORM_AHBDMA) || defined(CONFIG_PLATFORM_APBDMA))
-+ ftsdc_alloc_dma(host);
-+#endif
-+
-+ host->mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
-+ if (!host->mem) {
-+ dev_err(&pdev->dev,
-+ "failed to get io memory region resouce.\n");
-+
-+ ret = -ENOENT;
-+ goto probe_free_host;
-+ }
-+
-+ host->mem = request_mem_region(host->mem->start,
-+ resource_size(host->mem), pdev->name);
-+
-+ if (!host->mem) {
-+ dev_err(&pdev->dev, "failed to request io memory region.\n");
-+ ret = -ENOENT;
-+ goto probe_free_wq;
-+ }
-+
-+ host->base = (void __iomem *) SDC_FTSDC010_0_VA_BASE;
-+ host->irq = SDC_FTSDC010_IRQ;
-+ if (request_irq(host->irq, ftsdc_irq, IRQF_DISABLED, DRIVER_NAME, host)) {
-+ dev_err(&pdev->dev, "failed to request mci interrupt.\n");
-+ ret = -ENOENT;
-+ goto probe_free_mem_region;
-+ }
-+ host->irq_enabled = true;
-+
-+ /* enable card change interruption */
-+ con = REG_READ(SDC_INT_MASK_REG);
-+ con |= SDC_INT_MASK_REG_CARD_CHANGE;
-+ REG_WRITE(con, SDC_INT_MASK_REG);
-+
-+ con = REG_READ(SDC_BUS_WIDTH_REG);
-+
-+ mmc->ops = &ftsdc_ops;
-+ mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
-+
-+ if (con & SDC_WIDE_4_BUS_SUPPORT)
-+ mmc->caps |= MMC_CAP_4_BIT_DATA;
-+ else if (con & SDC_WIDE_8_BUS_SUPPORT)
-+ mmc->caps |= MMC_CAP_8_BIT_DATA;
-+
-+#ifndef A320D_BUILDIN_SDC
-+ mmc->caps |= MMC_CAP_SDIO_IRQ;
-+#endif
-+
-+ mmc->f_min = APB_CLK_IN / (2 * 128);
-+ mmc->f_max = APB_CLK_IN / 2;
-+
-+ /* limit SDIO mode max size */
-+ mmc->max_req_size = 128 * 1024 * 1024 - 1;
-+ mmc->max_blk_size = 2047;
-+ mmc->max_req_size = (mmc->max_req_size + 1) / (mmc->max_blk_size + 1);
-+ mmc->max_seg_size = mmc->max_req_size;
-+ mmc->max_blk_count = (1<<17)-1;
-+
-+ /* kernel default value. see Doc/block/biodocs.txt */
-+ /*
-+ 'struct mmc_host' has no member named 'max_phys_segs'
-+ 'struct mmc_host' has no member named 'max_hw_segs'
-+ */
-+// mmc->max_phys_segs = 128;
-+// mmc->max_hw_segs = 128;
-+
-+ /* set fifo lenght and default threshold half */
-+ con = REG_READ(SDC_FEATURE_REG);
-+ host->fifo_len = (con & SDC_FEATURE_REG_FIFO_DEPTH) * sizeof(u32);
-+
-+ dbg(host, dbg_debug,
-+ "probe: mapped mci_base:%p irq:%u.\n",
-+ host->base, host->irq);
-+
-+ dbg_dumpregs(host, "");
-+
-+ ret = mmc_add_host(mmc);
-+ if (ret) {
-+ dev_err(&pdev->dev, "failed to add mmc host.\n");
-+ goto probe_free_irq;
-+ }
-+
-+ ftsdc_debugfs_attach(host);
-+
-+ platform_set_drvdata(pdev, mmc);
-+ dev_info(&pdev->dev, "%s - using %s SDIO IRQ\n", mmc_hostname(mmc),
-+ mmc->caps & MMC_CAP_SDIO_IRQ ? "hw" : "sw");
-+
-+ return 0;
-+
-+ probe_free_irq:
-+ free_irq(host->irq, host);
-+
-+ probe_free_mem_region:
-+ release_mem_region(host->mem->start, resource_size(host->mem));
-+
-+probe_free_wq:
-+ destroy_workqueue(mywq);
-+
-+ probe_free_host:
-+ mmc_free_host(mmc);
-+
-+ probe_out:
-+ return ret;
-+}
-+
-+static void ftsdc_shutdown(struct platform_device *pdev)
-+{
-+ struct mmc_host *mmc = platform_get_drvdata(pdev);
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+
-+ flush_workqueue(mywq);
-+ destroy_workqueue(mywq);
-+
-+ ftsdc_debugfs_remove(host);
-+ mmc_remove_host(mmc);
-+}
-+
-+static int __devexit ftsdc_remove(struct platform_device *pdev)
-+{
-+ struct mmc_host *mmc = platform_get_drvdata(pdev);
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+
-+ ftsdc_shutdown(pdev);
-+
-+ tasklet_disable(&host->pio_tasklet);
-+
-+ if (ftsdc_dmaexist(host))
-+ kfree(host->dma_req);
-+
-+ free_irq(host->irq, host);
-+
-+ release_mem_region(host->mem->start, resource_size(host->mem));
-+
-+ mmc_free_host(mmc);
-+ return 0;
-+}
-+
-+
-+#ifdef CONFIG_PM
-+static int ftsdc_free_dma(struct ftsdc_host *host)
-+{
-+ dmad_channel_free(host->dma_req);
-+ return 0;
-+}
-+
-+static int ftsdc_suspend(struct platform_device *pdev, pm_message_t state)
-+{
-+ struct mmc_host *mmc = platform_get_drvdata(pdev);
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+ int ret = 0;
-+ if (mmc) {
-+ ftsdc_free_dma(host);
-+ ret = mmc_suspend_host(mmc);
-+ }
-+ return ret;
-+
-+}
-+
-+static int ftsdc_resume(struct platform_device *pdev)
-+{
-+ struct mmc_host *mmc = platform_get_drvdata(pdev);
-+ int ret = 0;
-+ struct ftsdc_host *host = mmc_priv(mmc);
-+ if (mmc) {
-+#if (defined(CONFIG_PLATFORM_AHBDMA) || defined(CONFIG_PLATFORM_APBDMA))
-+ ftsdc_alloc_dma(host);
-+#endif
-+ ret = mmc_resume_host(mmc);
-+ }
-+ return ret;
-+}
-+
-+static void platform_device_release(struct device *dev){
-+}
-+
-+
-+#else
-+#define ftsdc_suspend NULL
-+#define ftsdc_resume NULL
-+#endif
-+
-+
-+static struct platform_driver ftsdc_driver = {
-+ .driver = {
-+ .name = "ftsdc010",
-+ .owner = THIS_MODULE,
-+ },
-+ .probe = ftsdc_probe,
-+ .remove = __devexit_p(ftsdc_remove),
-+ .shutdown = ftsdc_shutdown,
-+ .suspend = ftsdc_suspend,
-+ .resume = ftsdc_resume,
-+};
-+
-+static struct resource sdc_resource[] = {
-+ [0] = {
-+ .start = SDC_FTSDC010_0_VA_BASE,
-+ .end = SDC_FTSDC010_0_VA_BASE + 0x1000 - 1,
-+ .flags = IORESOURCE_MEM,
-+ },
-+ [1] = {
-+ .start = SDC_FTSDC010_0_IRQ,
-+ .flags = IORESOURCE_IRQ,
-+ }
-+
-+};
-+
-+struct platform_device sdc_device = {
-+ .name = "ftsdc010",
-+ .id = 0,
-+ .num_resources = ARRAY_SIZE(sdc_resource),
-+ .resource = sdc_resource,
-+ .dev = {
-+ .release = platform_device_release,
-+ },
-+};
-+
-+static int __init ftsdc_init(void)
-+{
-+ platform_device_register(&sdc_device);
-+ return platform_driver_register(&ftsdc_driver);
-+}
-+
-+static void __exit ftsdc_exit(void)
-+{
-+ platform_driver_unregister(&ftsdc_driver);
-+ platform_device_unregister(&sdc_device);
-+}
-+module_init(ftsdc_init);
-+module_exit(ftsdc_exit);
-+
-+MODULE_DESCRIPTION("Andestech Leopard MMC/SD Card Interface driver");
-+MODULE_LICENSE("GPL v2");
-diff -Nur linux-3.4.113.orig/drivers/mmc/host/ftsdc010.h linux-3.4.113/drivers/mmc/host/ftsdc010.h
---- linux-3.4.113.orig/drivers/mmc/host/ftsdc010.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/mmc/host/ftsdc010.h 2016-12-01 20:59:24.388614139 +0100
-@@ -0,0 +1,240 @@
-+/*
-+ * linux/driver/mmc/ftsdc010.h - Andestech MMC/SD driver
-+ * Andestech FTSDC010 Device Driver
-+ *
-+ * Andestech (C) 2005 Faraday Corp. (http://www.Andestech.com)
-+ *
-+ * All Rights Reserved
-+ */
-+
-+#ifndef _FTSDC010_H_
-+#define _FTSDC010_H_
-+
-+//#define SD_DEBUG
-+#define DELAY_FOR_DMA_READ
-+
-+#ifdef SD_DEBUG
-+ #define P_DEBUG(fmt, args...) printk(KERN_ALERT "SD: " fmt, ## args)
-+#else
-+ #define P_DEBUG(a...)
-+#endif
-+#define P_DEBUGG(a...)
-+
-+/* used for dma timeout */
-+#define SDC_TIMEOUT_BASE (HZ/2) // Unit is 500 ms
-+
-+/* used for pio retry times */
-+#define SDC_PIO_RETRY 0x300000
-+
-+/* sd controller register */
-+#define SDC_CMD_REG 0x00000000
-+#define SDC_ARGU_REG 0x00000004
-+#define SDC_RESPONSE0_REG 0x00000008
-+#define SDC_RESPONSE1_REG 0x0000000C
-+#define SDC_RESPONSE2_REG 0x00000010
-+#define SDC_RESPONSE3_REG 0x00000014
-+#define SDC_RSP_CMD_REG 0x00000018
-+#define SDC_DATA_CTRL_REG 0x0000001C
-+#define SDC_DATA_TIMER_REG 0x00000020
-+#define SDC_DATA_LEN_REG 0x00000024
-+#define SDC_STATUS_REG 0x00000028
-+#define SDC_CLEAR_REG 0x0000002C
-+#define SDC_INT_MASK_REG 0x00000030
-+#define SDC_POWER_CTRL_REG 0x00000034
-+#define SDC_CLOCK_CTRL_REG 0x00000038
-+#define SDC_BUS_WIDTH_REG 0x0000003C
-+#define SDC_DATA_WINDOW_REG 0x00000040
-+
-+#ifdef A320D_BUILDIN_SDC
-+#define SDC_FEATURE_REG 0x00000044
-+#define SDC_REVISION_REG 0x00000048
-+#else
-+#define SDC_MMC_INT_RSP_REG 0x00000044
-+#define SDC_GP_OUTPUT_REG 0x00000048
-+#define SDC_FEATURE_REG 0x0000009C
-+#define SDC_REVISION_REG 0x000000A0
-+#endif
-+
-+#define SDC_SDIO_CTRL1_REG 0x0000006C
-+#define SDC_SDIO_CTRL2_REG 0x00000070
-+#define SDC_SDIO_STATUS_REG 0x00000074
-+
-+/* bit mapping of command register */
-+#define SDC_CMD_REG_INDEX 0x0000003F
-+#define SDC_CMD_REG_NEED_RSP 0x00000040
-+#define SDC_CMD_REG_LONG_RSP 0x00000080
-+#define SDC_CMD_REG_APP_CMD 0x00000100
-+#define SDC_CMD_REG_CMD_EN 0x00000200
-+#define SDC_CMD_REG_SDC_RST 0x00000400
-+#define SDC_CMD_MMC_INT_STOP 0x00000800
-+
-+/* bit mapping of response command register */
-+#define SDC_RSP_CMD_REG_INDEX 0x0000003F
-+#define SDC_RSP_CMD_REG_APP 0x00000040
-+
-+/* bit mapping of data control register */
-+#define SDC_DATA_CTRL_REG_BLK_SIZE 0x0000000F
-+#define SDC_DATA_CTRL_REG_DATA_WRITE 0x00000010
-+#define SDC_DATA_CTRL_REG_DMA_EN 0x00000020
-+#define SDC_DATA_CTRL_REG_DATA_EN 0x00000040
-+#define SDC_DATA_CTRL_REG_FIFOTH 0x00000080
-+#define SDC_DATA_CTRL_REG_DMA_TYPE 0x00000300
-+#define SDC_DATA_CTRL_REG_FIFO_RST 0x00000400
-+#define SDC_CPRM_DATA_CHANGE_ENDIAN_EN 0x00000800
-+#define SDC_CPRM_DATA_SWAP_HL_EN 0x00001000
-+
-+#define SDC_DMA_TYPE_1 0x00000000
-+#define SDC_DMA_TYPE_4 0x00000100
-+#define SDC_DMA_TYPE_8 0x00000200
-+
-+/* bit mapping of status register */
-+#define SDC_STATUS_REG_RSP_CRC_FAIL 0x00000001
-+#define SDC_STATUS_REG_DATA_CRC_FAIL 0x00000002
-+#define SDC_STATUS_REG_RSP_TIMEOUT 0x00000004
-+#define SDC_STATUS_REG_DATA_TIMEOUT 0x00000008
-+#define SDC_STATUS_REG_RSP_CRC_OK 0x00000010
-+#define SDC_STATUS_REG_DATA_CRC_OK 0x00000020
-+#define SDC_STATUS_REG_CMD_SEND 0x00000040
-+#define SDC_STATUS_REG_DATA_END 0x00000080
-+#define SDC_STATUS_REG_FIFO_UNDERRUN 0x00000100
-+#define SDC_STATUS_REG_FIFO_OVERRUN 0x00000200
-+#define SDC_STATUS_REG_CARD_CHANGE 0x00000400
-+#define SDC_STATUS_REG_CARD_DETECT 0x00000800
-+#define SDC_STATUS_REG_CARD_LOCK 0x00001000
-+#define SDC_STATUS_REG_CP_READY 0x00002000
-+#define SDC_STATUS_REG_CP_BUF_READY 0x00004000
-+#define SDC_STATUS_REG_PLAIN_TEXT_READY 0x00008000
-+#define SDC_STATUS_REG_SDIO_INTR 0x00010000
-+
-+/* bit mapping of clear register */
-+#define SDC_CLEAR_REG_RSP_CRC_FAIL 0x00000001
-+#define SDC_CLEAR_REG_DATA_CRC_FAIL 0x00000002
-+#define SDC_CLEAR_REG_RSP_TIMEOUT 0x00000004
-+#define SDC_CLEAR_REG_DATA_TIMEOUT 0x00000008
-+#define SDC_CLEAR_REG_RSP_CRC_OK 0x00000010
-+#define SDC_CLEAR_REG_DATA_CRC_OK 0x00000020
-+#define SDC_CLEAR_REG_CMD_SEND 0x00000040
-+#define SDC_CLEAR_REG_DATA_END 0x00000080
-+#define SDC_CLEAR_REG_CARD_CHANGE 0x00000400
-+#define SDC_CLEAR_REG_SDIO_INTR 0x00010000
-+
-+/* bit mapping of int_mask register */
-+#define SDC_INT_MASK_REG_RSP_CRC_FAIL 0x00000001
-+#define SDC_INT_MASK_REG_DATA_CRC_FAIL 0x00000002
-+#define SDC_INT_MASK_REG_RSP_TIMEOUT 0x00000004
-+#define SDC_INT_MASK_REG_DATA_TIMEOUT 0x00000008
-+#define SDC_INT_MASK_REG_RSP_CRC_OK 0x00000010
-+#define SDC_INT_MASK_REG_DATA_CRC_OK 0x00000020
-+#define SDC_INT_MASK_REG_CMD_SEND 0x00000040
-+#define SDC_INT_MASK_REG_DATA_END 0x00000080
-+#define SDC_INT_MASK_REG_FIFO_UNDERRUN 0x00000100
-+#define SDC_INT_MASK_REG_FIFO_OVERRUN 0x00000200
-+#define SDC_INT_MASK_REG_CARD_CHANGE 0x00000400
-+#define SDC_INT_MASK_REG_CARD_LOCK 0x00001000
-+#define SDC_INT_MASK_REG_CP_READY 0x00002000
-+#define SDC_INT_MASK_REG_CP_BUF_READY 0x00004000
-+#define SDC_INT_MASK_REG_PLAIN_TEXT_READY 0x00008000
-+#define SDC_INT_MASK_REG_SDIO_INTR 0x00010000
-+
-+
-+#define SDC_CARD_INSERT 0x0
-+#define SDC_CARD_REMOVE SDC_STATUS_REG_CARD_DETECT
-+
-+/* bit mapping of power control register */
-+#define SDC_POWER_CTRL_REG_POWER_ON 0x00000010
-+#define SDC_POWER_CTRL_REG_POWER_BITS 0x0000000F
-+
-+/* bit mapping of clock control register */
-+#define SDC_CLOCK_CTRL_REG_CLK_DIV 0x0000007F
-+#define SDC_CLOCK_CTRL_REG_CARD_TYPE 0x00000080
-+#define SDC_CLOCK_CTRL_REG_CLK_DIS 0x00000100
-+
-+/* card type */
-+#define SDC_CARD_TYPE_SD SDC_CLOCK_REG_CARD_TYPE
-+#define SDC_CARD_TYPE_MMC 0x0
-+
-+/* bit mapping of bus width register */
-+#define SDC_BUS_WIDTH_REG_SINGLE_BUS 0x00000001
-+#define SDC_BUS_WIDTH_REG_WIDE_8_BUS 0x00000002
-+#define SDC_BUS_WIDTH_REG_WIDE_4_BUS 0x00000004
-+#define SDC_BUS_WIDTH_REG_WIDE_BUS_SUPPORT 0x00000018
-+#define SDC_BUS_WIDTH_REG_CARD_DETECT 0x00000020
-+
-+#define SDC_WIDE_4_BUS_SUPPORT 0x00000008
-+#define SDC_WIDE_8_BUS_SUPPORT 0x00000010
-+
-+/* bit mapping of feature register */
-+#define SDC_FEATURE_REG_FIFO_DEPTH 0x000000FF
-+#define SDC_FEATURE_REG_CPRM_FUNCTION 0x00000100
-+
-+/* bit mapping of sdio control register */
-+#define SDC_SDIO_CTRL1_REG_SDIO_BLK_NO 0xFFFF8000
-+#define SDC_SDIO_CTRL1_REG_SDIO_ENABLE 0x00004000
-+#define SDC_SDIO_CTRL1_REG_READ_WAIT_ENABLE 0x00002000
-+#define SDC_SDIO_CTRL1_REG_SDIO_BLK_MODE 0x00001000
-+#define SDC_SDIO_CTRL1_REG_SDIO_BLK_SIZE 0x00000FFF
-+
-+/* bit mapping of sdio status register */
-+#define SDC_SDIO_SDIO_STATUS_REG_FIFO_REMAIN_NO 0x00FE0000
-+#define SDC_SDIO_SDIO_STATUS_REG_SDIO_BLK_CNT 0x0001FFFF
-+
-+enum ftsdc_waitfor {
-+ COMPLETION_NONE,
-+ COMPLETION_FINALIZE,
-+ COMPLETION_CMDSENT,
-+ COMPLETION_RSPFIN,
-+ COMPLETION_XFER_PROGRESS,
-+};
-+
-+struct ftsdc_host {
-+ struct platform_device *pdev;
-+ struct mmc_host *mmc;
-+ struct resource *mem;
-+ struct clk *clk;
-+ void __iomem *base;
-+ int irq;
-+
-+ unsigned int real_rate;
-+ bool irq_enabled;
-+ unsigned int fifo_len; /* bytes */
-+ unsigned int last_opcode; /* keep last successful cmd to judge application specific command */
-+
-+ struct mmc_request *mrq;
-+ int cmd_is_stop;
-+
-+ spinlock_t complete_lock;
-+ enum ftsdc_waitfor complete_what;
-+
-+ struct completion dma_complete;
-+ dmad_chreq *dma_req;
-+ bool dodma;
-+ bool dma_finish;
-+
-+
-+ u32 buf_sgptr; /* keep next scallterlist buffer index */
-+ u32 buf_bytes; /* keep current total scallterlist buffer length */
-+ u32 buf_count; /* keep real data size rw from sd */
-+ u32 *buf_ptr; /* keep current scallterlist buffer address */
-+#define XFER_NONE 0
-+#define XFER_READ 1
-+#define XFER_WRITE 2
-+ u32 buf_active; /* keep current transfer mode */
-+
-+ int bus_width;
-+
-+ char dbgmsg_cmd[301];
-+ char dbgmsg_dat[301];
-+ char *status;
-+
-+ unsigned int ccnt, dcnt;
-+ struct tasklet_struct pio_tasklet;
-+ struct work_struct work;
-+
-+#ifdef CONFIG_DEBUG_FS
-+ struct dentry *debug_root;
-+ struct dentry *debug_state;
-+ struct dentry *debug_regs;
-+#endif
-+};
-+
-+#endif
-diff -Nur linux-3.4.113.orig/drivers/mmc/host/Kconfig linux-3.4.113/drivers/mmc/host/Kconfig
---- linux-3.4.113.orig/drivers/mmc/host/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/mmc/host/Kconfig 2016-12-01 20:59:24.388614139 +0100
-@@ -609,3 +609,8 @@
-
- Note: These controllers only support SDIO cards and do not
- support MMC or SD memory cards.
-+
-+config MMC_FTSDC010
-+ tristate "Andestech MMC/SD function support"
-+ depends on NDS32 && !FTSDC010
-+
-diff -Nur linux-3.4.113.orig/drivers/mmc/host/Makefile linux-3.4.113/drivers/mmc/host/Makefile
---- linux-3.4.113.orig/drivers/mmc/host/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/mmc/host/Makefile 2016-12-01 20:59:24.388614139 +0100
-@@ -45,6 +45,7 @@
- obj-$(CONFIG_MMC_JZ4740) += jz4740_mmc.o
- obj-$(CONFIG_MMC_VUB300) += vub300.o
- obj-$(CONFIG_MMC_USHC) += ushc.o
-+obj-$(CONFIG_MMC_FTSDC010) += ftsdc010.o
-
- obj-$(CONFIG_MMC_SDHCI_PLTFM) += sdhci-pltfm.o
- obj-$(CONFIG_MMC_SDHCI_CNS3XXX) += sdhci-cns3xxx.o
-diff -Nur linux-3.4.113.orig/drivers/net/ethernet/faraday/ftmac100.c linux-3.4.113/drivers/net/ethernet/faraday/ftmac100.c
---- linux-3.4.113.orig/drivers/net/ethernet/faraday/ftmac100.c 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/net/ethernet/faraday/ftmac100.c 2016-12-01 20:59:24.388614139 +0100
-@@ -1,1202 +1,1210 @@
- /*
-- * Faraday FTMAC100 10/100 Ethernet
-+ * drivers/net/ftmac100.c
- *
-- * (C) Copyright 2009-2011 Faraday Technology
-- * Po-Yu Chuang <ratbert@faraday-tech.com>
-+ * Faraday FTMAC100 Device Driver
- *
-- * This program is free software; you can redistribute it and/or modify
-- * it under the terms of the GNU General Public License as published by
-- * the Free Software Foundation; either version 2 of the License, or
-- * (at your option) any later version.
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ *
-+ * All Rights Reserved
- *
-- * This program is distributed in the hope that it will be useful,
-- * but WITHOUT ANY WARRANTY; without even the implied warranty of
-- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-- * GNU General Public License for more details.
-- *
-- * You should have received a copy of the GNU General Public License
-- * along with this program; if not, write to the Free Software
-- * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
- */
-
--#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
--
--#include <linux/dma-mapping.h>
--#include <linux/etherdevice.h>
--#include <linux/ethtool.h>
-+#include <linux/module.h>
- #include <linux/init.h>
-+#include <linux/moduleparam.h>
-+
-+#include <linux/sched.h>
-+#include <linux/kernel.h> /* printk() */
-+#include <linux/slab.h> /* kmalloc() */
-+#include <linux/errno.h> /* error codes */
-+#include <linux/types.h> /* size_t */
- #include <linux/interrupt.h>
--#include <linux/io.h>
--#include <linux/mii.h>
--#include <linux/module.h>
--#include <linux/netdevice.h>
-+
-+#include <linux/in.h>
- #include <linux/platform_device.h>
-+#include <linux/netdevice.h> /* struct device, and other headers */
-+#include <linux/etherdevice.h> /* eth_type_trans */
-+#include <linux/ip.h> /* struct iphdr */
-+#include <linux/tcp.h> /* struct tcphdr */
-+#include <linux/skbuff.h>
-+
-+#include <linux/in6.h>
-+#include <asm/checksum.h>
-+
-+
-+#include <linux/version.h>
-+#include <linux/kernel.h>
-+#include <linux/fcntl.h>
-+#include <linux/ptrace.h>
-+#include <linux/ioport.h>
-+#include <linux/slab.h>
-+#include <linux/string.h>
-+#include <linux/proc_fs.h>
-+#include <asm/bitops.h>
-+#include <asm/io.h>
-+#include <asm/hardware.h>
-+#include <linux/pci.h>
-+#include <linux/delay.h>
-+#include <linux/netdevice.h>
-+#include <linux/etherdevice.h>
-+#include <linux/skbuff.h>
-
-+#include <asm/cacheflush.h> // dma_clean_range
-+#include <asm/spec.h>
- #include "ftmac100.h"
-
--#define DRV_NAME "ftmac100"
--#define DRV_VERSION "0.2"
--
--#define RX_QUEUE_ENTRIES 128 /* must be power of 2 */
--#define TX_QUEUE_ENTRIES 16 /* must be power of 2 */
-+#define IPMODULE MAC
-+#define IPNAME FTMAC100
-
--#define MAX_PKT_SIZE 1518
--#define RX_BUF_SIZE 2044 /* must be smaller than 0x7ff */
-+#define ENABLE_BOTTOM_HALF 0
-+#define ZERO_COPY 1
-
--#if MAX_PKT_SIZE > 0x7ff
--#error invalid MAX_PKT_SIZE
--#endif
--
--#if RX_BUF_SIZE > 0x7ff || RX_BUF_SIZE > PAGE_SIZE
--#error invalid RX_BUF_SIZE
--#endif
--
--/******************************************************************************
-- * private data
-- *****************************************************************************/
--struct ftmac100_descs {
-- struct ftmac100_rxdes rxdes[RX_QUEUE_ENTRIES];
-- struct ftmac100_txdes txdes[TX_QUEUE_ENTRIES];
--};
--
--struct ftmac100 {
-- struct resource *res;
-- void __iomem *base;
-- int irq;
--
-- struct ftmac100_descs *descs;
-- dma_addr_t descs_dma_addr;
--
-- unsigned int rx_pointer;
-- unsigned int tx_clean_pointer;
-- unsigned int tx_pointer;
-- unsigned int tx_pending;
--
-- spinlock_t tx_lock;
--
-- struct net_device *netdev;
-- struct device *dev;
-- struct napi_struct napi;
-+#define FTMAC100_DEBUG 0
-+#define CARDNAME "FTMAC100"
-
-- struct mii_if_info mii;
--};
--
--static int ftmac100_alloc_rx_page(struct ftmac100 *priv,
-- struct ftmac100_rxdes *rxdes, gfp_t gfp);
--
--/******************************************************************************
-- * internal functions (hardware register access)
-- *****************************************************************************/
--#define INT_MASK_ALL_ENABLED (FTMAC100_INT_RPKT_FINISH | \
-- FTMAC100_INT_NORXBUF | \
-- FTMAC100_INT_XPKT_OK | \
-- FTMAC100_INT_XPKT_LOST | \
-- FTMAC100_INT_RPKT_LOST | \
-- FTMAC100_INT_AHB_ERR | \
-- FTMAC100_INT_PHYSTS_CHG)
-+MODULE_AUTHOR("Faraday Corp.");
-+MODULE_LICENSE("GPL");
-
--#define INT_MASK_ALL_DISABLED 0
-+static const char version[] = "Faraday FTMAC100 Driver (Linux 2.6) 09/28/05 - (C) 2005 Faraday Corp.\n";
-+static volatile int trans_busy = 0;
-+static const char mac_string[] = "Faraday MAC";
-
--static void ftmac100_enable_all_int(struct ftmac100 *priv)
--{
-- iowrite32(INT_MASK_ALL_ENABLED, priv->base + FTMAC100_OFFSET_IMR);
--}
-+#if FTMAC100_DEBUG > 2
-+static void print_packet( unsigned char * buf, int length );
-+#endif
-
--static void ftmac100_disable_all_int(struct ftmac100 *priv)
--{
-- iowrite32(INT_MASK_ALL_DISABLED, priv->base + FTMAC100_OFFSET_IMR);
--}
-+#if FTMAC100_DEBUG > 0
-+#define PRINTK printk
-+#else
-+#define PRINTK(x...)
-+#endif
-
--static void ftmac100_set_rx_ring_base(struct ftmac100 *priv, dma_addr_t addr)
--{
-- iowrite32(addr, priv->base + FTMAC100_OFFSET_RXR_BADR);
-+static int ftmac100_open(struct net_device *dev);
-+static void ftmac100_timeout (struct net_device *dev);
-+static int ftmac100_close(struct net_device *dev);
-+static struct net_device_stats * ftmac100_query_statistics( struct net_device *dev);
-+#ifdef HAVE_MULTICAST
-+static void ftmac100_set_multicast_list(struct net_device *dev);
-+#endif
-+static void ftmac100_phy_configure(struct net_device* dev) {};
-+static irqreturn_t ftmac100_interrupt(int irq, void * dev_id);
-+static void ftmac100_rcv(void *dev);
-+static int ftmac100_setup(struct net_device *dev);
-+static int ftmac100_reset( struct net_device* dev );
-+static void ftmac100_enable( struct net_device *dev );
-+
-+static void put_mac(int base, unsigned char *mac_addr)
-+{
-+ int val;
-+
-+ val = ((u32)mac_addr[0])<<8 | (u32)mac_addr[1];
-+ outl(val, base);
-+ val = ((((u32)mac_addr[2])<<24)&0xff000000) |
-+ ((((u32)mac_addr[3])<<16)&0xff0000) |
-+ ((((u32)mac_addr[4])<<8)&0xff00) |
-+ ((((u32)mac_addr[5])<<0)&0xff);
-+ outl(val, base+4);
-+}
-+
-+static void get_mac(int base, unsigned char *mac_addr)
-+{
-+ int val;
-+
-+ //printk("+get_mac\n");
-+
-+ val = inl(base);
-+ mac_addr[0] = (val>>8)&0xff;
-+ mac_addr[1] = val&0xff;
-+ val = inl(base+4); //john add +4
-+ mac_addr[2] = (val>>24)&0xff;
-+ mac_addr[3] = (val>>16)&0xff;
-+ mac_addr[4] = (val>>8)&0xff;
-+ mac_addr[5] = val&0xff;
-+}
-+
-+static void auto_get_mac(int id,unsigned char *mac_addr)
-+{
-+ get_mac(MAC_FTMAC100_0_VA_BASE + MAC_MADR_REG, mac_addr);
-+
-+ if (memcmp(mac_addr, "\0\0\0\0\0\0", 6) == 0) {
-+ mac_addr[0]=0;
-+ mac_addr[1]=0x23;
-+ mac_addr[2]=0x96;
-+ mac_addr[3]=0x00;
-+ mac_addr[4]=0xff;
-+ mac_addr[5]=0x00;
-+ }
- }
-
--static void ftmac100_set_tx_ring_base(struct ftmac100 *priv, dma_addr_t addr)
-+/*
-+ * Print the Ethernet address
-+ */
-+static void ft_print_mac(unsigned char *mac_addr)
- {
-- iowrite32(addr, priv->base + FTMAC100_OFFSET_TXR_BADR);
-+ printk("ADDR: %pM\n", mac_addr);
- }
-
--static void ftmac100_txdma_start_polling(struct ftmac100 *priv)
--{
-- iowrite32(1, priv->base + FTMAC100_OFFSET_TXPD);
--}
-
--static int ftmac100_reset(struct ftmac100 *priv)
-+#ifdef HAVE_MULTICAST
-+/*
-+ * Finds the CRC32 of a set of bytes.
-+ * Again, from Peter Cammaert's code.
-+ */
-+static int crc32( char * s, int length )
- {
-- struct net_device *netdev = priv->netdev;
-- int i;
--
-- /* NOTE: reset clears all registers */
-- iowrite32(FTMAC100_MACCR_SW_RST, priv->base + FTMAC100_OFFSET_MACCR);
--
-- for (i = 0; i < 5; i++) {
-- unsigned int maccr;
--
-- maccr = ioread32(priv->base + FTMAC100_OFFSET_MACCR);
-- if (!(maccr & FTMAC100_MACCR_SW_RST)) {
-- /*
-- * FTMAC100_MACCR_SW_RST cleared does not indicate
-- * that hardware reset completed (what the f*ck).
-- * We still need to wait for a while.
-- */
-- udelay(500);
-- return 0;
-+ /* indices */
-+ int perByte;
-+ int perBit;
-+ /* crc polynomial for Ethernet */
-+ const unsigned long poly = 0xedb88320;
-+ /* crc value - preinitialized to all 1's */
-+ unsigned long crc_value = 0xffffffff;
-+
-+ //printk("+crc32\n");
-+
-+ for ( perByte = 0; perByte < length; perByte ++ ) {
-+ unsigned char c;
-+
-+ c = *(s++);
-+ for ( perBit = 0; perBit < 8; perBit++ ) {
-+ crc_value = (crc_value>>1)^
-+ (((crc_value^c)&0x01)?poly:0);
-+ c >>= 1;
- }
--
-- udelay(1000);
- }
--
-- netdev_err(netdev, "software reset failed\n");
-- return -EIO;
--}
--
--static void ftmac100_set_mac(struct ftmac100 *priv, const unsigned char *mac)
--{
-- unsigned int maddr = mac[0] << 8 | mac[1];
-- unsigned int laddr = mac[2] << 24 | mac[3] << 16 | mac[4] << 8 | mac[5];
--
-- iowrite32(maddr, priv->base + FTMAC100_OFFSET_MAC_MADR);
-- iowrite32(laddr, priv->base + FTMAC100_OFFSET_MAC_LADR);
-+ return crc_value;
- }
-+#endif
-
--#define MACCR_ENABLE_ALL (FTMAC100_MACCR_XMT_EN | \
-- FTMAC100_MACCR_RCV_EN | \
-- FTMAC100_MACCR_XDMA_EN | \
-- FTMAC100_MACCR_RDMA_EN | \
-- FTMAC100_MACCR_CRC_APD | \
-- FTMAC100_MACCR_FULLDUP | \
-- FTMAC100_MACCR_RX_RUNT | \
-- FTMAC100_MACCR_RX_BROADPKT)
--
--static int ftmac100_start_hw(struct ftmac100 *priv)
-+static int ftmac100_reset( struct net_device* dev )
- {
-- struct net_device *netdev = priv->netdev;
-+ unsigned ioaddr = dev->base_addr;
-+ int rcount;
-
-- if (ftmac100_reset(priv))
-- return -EIO;
-+ PRINTK("+ftmac100_reset:I/O addr=%X\n", ioaddr);
-
-- /* setup ring buffer base registers */
-- ftmac100_set_rx_ring_base(priv,
-- priv->descs_dma_addr +
-- offsetof(struct ftmac100_descs, rxdes));
-- ftmac100_set_tx_ring_base(priv,
-- priv->descs_dma_addr +
-- offsetof(struct ftmac100_descs, txdes));
-+ outl( SW_RST_bit, ioaddr + MACCR_REG );
-
-- iowrite32(FTMAC100_APTC_RXPOLL_CNT(1), priv->base + FTMAC100_OFFSET_APTC);
-+ /* this should pause enough for the chip to be happy */
-+ for (rcount = 0; (inl( ioaddr + MACCR_REG ) & SW_RST_bit) != 0; rcount++) {
-+ //mdelay(10);
-+ msleep_interruptible(10);
-+ if (rcount > 5) // Retry 5 times
-+ return -ENODEV;
-+ }
-
-- ftmac100_set_mac(priv, netdev->dev_addr);
-+ outl( 0, ioaddr + IMR_REG ); /* Disable all interrupts */
-+ if (inl(ioaddr+IMR_REG)!=0)
-+ return -ENODEV;
-
-- iowrite32(MACCR_ENABLE_ALL, priv->base + FTMAC100_OFFSET_MACCR);
-- return 0;
-+ return 0;
- }
-
--static void ftmac100_stop_hw(struct ftmac100 *priv)
--{
-- iowrite32(0, priv->base + FTMAC100_OFFSET_MACCR);
--}
-
--/******************************************************************************
-- * internal functions (receive descriptor)
-- *****************************************************************************/
--static bool ftmac100_rxdes_first_segment(struct ftmac100_rxdes *rxdes)
--{
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_FRS);
--}
--
--static bool ftmac100_rxdes_last_segment(struct ftmac100_rxdes *rxdes)
-+/*
-+ . Function: ftmac100_enable
-+ . Purpose: let the chip talk to the outside work
-+ . Method:
-+ . 1. Enable the transmitter
-+ . 2. Enable the receiver
-+ . 3. Enable interrupts
-+*/
-+static void ftmac100_enable( struct net_device *dev )
- {
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_LRS);
--}
-+ unsigned int ioaddr = dev->base_addr;
-+ int i;
-+ struct ftmac100_local *priv = (struct ftmac100_local *)netdev_priv(dev);
-+ char mac_addr[6];
-
--static bool ftmac100_rxdes_owned_by_dma(struct ftmac100_rxdes *rxdes)
--{
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_RXDMA_OWN);
--}
-+ //printk("+ftmac100_enable\n");
-+ PRINTK("%s:ftmac100_enable ioaddr=%X\n", dev->name, ioaddr);
-
--static void ftmac100_rxdes_set_dma_own(struct ftmac100_rxdes *rxdes)
--{
-- /* clear status bits */
-- rxdes->rxdes0 = cpu_to_le32(FTMAC100_RXDES0_RXDMA_OWN);
-+ for (i=0; i<RXDES_NUM; ++i) {
-+ priv->rx_descs[i].RXDMA_OWN = OWNBY_FTMAC100; // owned by FTMAC100
-+ }
-+ priv->rx_idx = 0;
-+
-+ for (i=0; i<TXDES_NUM; ++i) {
-+ priv->tx_descs[i].TXDMA_OWN = OWNBY_SOFTWARE; // owned by software
-+ }
-+ priv->tx_idx = 0;
-+
-+
-+ /* set the MAC address */
-+ put_mac(ioaddr + MAC_MADR_REG, dev->dev_addr);
-+
-+ //john add
-+ get_mac(ioaddr + MAC_MADR_REG, mac_addr);
-+ ft_print_mac(mac_addr);
-+
-+ outl( priv->rx_descs_dma, ioaddr + RXR_BADR_REG);
-+ outl( priv->tx_descs_dma, ioaddr + TXR_BADR_REG);
-+ outl( 0x00001010, ioaddr + ITC_REG); // TODO: threshold too small
-+ outl( (0UL<<TXPOLL_CNT)|(0x1<<RXPOLL_CNT), ioaddr + APTC_REG); // TODO: bandwidth overhead maybe too big, polling too often ?!
-+ outl( 0x1d8, ioaddr + DBLAC_REG ); //Luke Lee: 1 110 010 111 (0x397)
-+
-+ /* now, enable interrupts */
-+ outl( PHYSTS_CHG_bit
-+ | AHB_ERR_bit
-+ | RPKT_LOST_bit
-+ | RPKT_SAV_bit
-+ | XPKT_LOST_bit
-+ | XPKT_OK_bit
-+ | NOTXBUF_bit
-+ | XPKT_FINISH_bit
-+ | NORXBUF_bit
-+ | RPKT_FINISH_bit
-+ , ioaddr + IMR_REG);
-+
-+ /// enable trans/recv,...
-+ outl( priv->maccr_val, ioaddr + MACCR_REG );
-+ PRINTK("%s:ftmac100_enable DONE\n", dev->name);
- }
-
--static bool ftmac100_rxdes_rx_error(struct ftmac100_rxdes *rxdes)
-+/*
-+ . Function: ftmac100_shutdown
-+ . Purpose: closes down the SMC91xxx chip.
-+ . Method:
-+ . 1. zero the interrupt mask
-+ . 2. clear the enable receive flag
-+ . 3. clear the enable xmit flags
-+ .
-+ . TODO:
-+ . (1) maybe utilize power down mode.
-+ . Why not yet? Because while the chip will go into power down mode,
-+ . the manual says that it will wake up in response to any I/O requests
-+ . in the register space. Empirical results do not show this working.
-+*/
-+static void ftmac100_shutdown( unsigned int ioaddr )
- {
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_RX_ERR);
--}
-+ //printk("+ftmac100_shutdown\n");
-
--static bool ftmac100_rxdes_crc_error(struct ftmac100_rxdes *rxdes)
--{
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_CRC_ERR);
-+ outl( 0, ioaddr + IMR_REG );
-+ outl( 0, ioaddr + MACCR_REG );
- }
-
--static bool ftmac100_rxdes_frame_too_long(struct ftmac100_rxdes *rxdes)
-+/*
-+ * Function: ftmac100_wait_to_send_packet( struct sk_buff * skb, struct device * )
-+ * Purpose:
-+ * Attempt to allocate memory for a packet, if chip-memory is not
-+ * available, then tell the card to generate an interrupt when it
-+ * is available*
-+ *
-+ * Algorithm:
-+ *
-+ * o if the saved_skb is not currently null, then drop this packet
-+ * on the floor. This should never happen, because of TBUSY.
-+ * o if the saved_skb is null, then replace it with the current packet,
-+ * o See if I can sending it now.
-+ * o (NO): Enable interrupts and let the interrupt handler deal with it.
-+ * o (YES):Send it now.
-+ */
-+static int ftmac100_wait_to_send_packet( struct sk_buff * skb, struct net_device * dev )
- {
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_FTL);
--}
-+ struct ftmac100_local *priv=(struct ftmac100_local *)netdev_priv(dev);
-+ unsigned int ioaddr=dev->base_addr;
-+ volatile TX_DESC *cur_desc;
-+ int length;
-+ unsigned long flags;
-+
-+ //printk("+ftmac100_wait_to_send_packet\n");
-+
-+ spin_lock_irqsave(&priv->lock, flags);
-+ if (skb==NULL) {
-+ printk("%s(%d): NULL skb???\n", __FILE__,__LINE__);
-+ spin_unlock_irqrestore(&priv->lock, flags);
-+ return 0;
-+ }
-+
-+ cur_desc = &priv->tx_descs[priv->tx_idx];
-+#if ZERO_COPY
-+ /* Record buffer address to be freed later */
-+ priv->tx_skbuff[priv->tx_idx] = skb;
-+#endif
-+
-+#ifdef not_complete_yet
-+ if (cur_desc->TXDMA_OWN != TX_OWNBY_SOFTWARE) /// no empty transmit descriptor
-+ {
-+ DO_PRINT("no empty transmit descriptor\n");
-+ DO_PRINT("jiffies = %d\n", jiffies);
-+ lp->stats.tx_dropped++;
-+ netif_stop_queue(dev); /// waiting to do:
-+ spin_unlock_irqrestore(&lp->lock, flags);
-+
-+ return 1;
-+ }
-+#endif /* end_of_not */
-+
-+ for (; cur_desc->TXDMA_OWN != OWNBY_SOFTWARE; ) {
-+ PRINTK( KERN_WARNING "NO empty TX\n"); //printk("no empty TX descriptor:0x%x:0x%x\n",(unsigned)cur_desc,(unsigned)cur_desc[0]);
-+ udelay(1);
-+ }
-+ length = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
-+ length = min(length, TX_BUF_SIZE); // truncate jumbo packets
-+
-+#if FTMAC100_DEBUG > 2
-+ printk("Transmitting Packet at 0x%x\n",(unsigned int)cur_desc->VIR_TXBUF_BADR);
-+ print_packet( skb->data, length );
-+#endif
-
--static bool ftmac100_rxdes_runt(struct ftmac100_rxdes *rxdes)
--{
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_RUNT);
--}
-+#if ZERO_COPY
-+ cur_desc->VIR_TXBUF_BADR = (unsigned)skb->data;
-+ cur_desc->TXBUF_BADR = virt_to_phys(skb->data);
-+ cpu_dma_wb_range((unsigned)skb->data, ((unsigned)(skb->data) + length + CACHE_LINE_SIZE( DCACHE) - 1 )&(~(CACHE_LINE_SIZE( DCACHE)-1)) );
-
--static bool ftmac100_rxdes_odd_nibble(struct ftmac100_rxdes *rxdes)
--{
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_RX_ODD_NB);
--}
-+#else
-+ memcpy((char *)cur_desc->VIR_TXBUF_BADR, skb->data, length);
-+#endif
-
--static unsigned int ftmac100_rxdes_frame_length(struct ftmac100_rxdes *rxdes)
--{
-- return le32_to_cpu(rxdes->rxdes0) & FTMAC100_RXDES0_RFL;
-+ cur_desc->TXBUF_Size = length;
-+ cur_desc->LTS = 1;
-+ cur_desc->FTS = 1;
-+
-+ cur_desc->TX2FIC = 0;
-+ cur_desc->TXIC = 0;
-+
-+ cur_desc->TXDMA_OWN = OWNBY_FTMAC100;
-+
-+ outl( 0xffffffff, ioaddr + TXPD_REG );
-+
-+ priv->tx_idx = (priv->tx_idx + 1) & (TXDES_NUM-1);
-+ priv->stats.tx_packets++;
-+ priv->stats.tx_bytes += skb->len;
-+#if !ZERO_COPY
-+ dev_kfree_skb_any (skb);
-+#endif
-+ dev->trans_start = jiffies;
-+ spin_unlock_irqrestore(&priv->lock, flags);
-+ return 0;
- }
-
--static bool ftmac100_rxdes_multicast(struct ftmac100_rxdes *rxdes)
--{
-- return rxdes->rxdes0 & cpu_to_le32(FTMAC100_RXDES0_MULTICAST);
--}
-+//#define dma_allocate(x,y,z,w) dma_alloc_coherent((x),(y),(dma_addr_t*)(z),(w))
-+#define dma_allocate(x,y,z,w) dma_alloc_writecombine((x),(y),(dma_addr_t*)(z),(w))
-
--static void ftmac100_rxdes_set_buffer_size(struct ftmac100_rxdes *rxdes,
-- unsigned int size)
-+static int ftmac100_ringbuf_alloc(struct net_device *dev,struct ftmac100_local *priv)
- {
-- rxdes->rxdes1 &= cpu_to_le32(FTMAC100_RXDES1_EDORR);
-- rxdes->rxdes1 |= cpu_to_le32(FTMAC100_RXDES1_RXBUF_SIZE(size));
--}
-+ int i;
-
--static void ftmac100_rxdes_set_end_of_ring(struct ftmac100_rxdes *rxdes)
--{
-- rxdes->rxdes1 |= cpu_to_le32(FTMAC100_RXDES1_EDORR);
--}
-+ //printk("+ftmac100_ringbuf_alloc\n");
-
--static void ftmac100_rxdes_set_dma_addr(struct ftmac100_rxdes *rxdes,
-- dma_addr_t addr)
--{
-- rxdes->rxdes2 = cpu_to_le32(addr);
--}
-+ priv->rx_descs = dma_allocate( NULL, sizeof(RX_DESC)*RXDES_NUM, &(priv->rx_descs_dma), GFP_KERNEL );
-+ if (priv->rx_descs == NULL || (( (u32)priv->rx_descs & 0xf)!=0)) {
-+ printk("Receive Ring Buffer allocation error\n");
-+ return -ENOMEM;
-+ }
-+#if FTMAC100_DEBUG > 2
-+ else
-+ printk( KERN_INFO "* Allocated RX descs=%X, bus addr=%X, size=%d*%d=%d\n",
-+ (unsigned)priv->rx_descs, (unsigned)priv->rx_descs_dma,
-+ sizeof(RX_DESC),RXDES_NUM,sizeof(RX_DESC)*RXDES_NUM );
-+#endif
-+ memset((unsigned int *)priv->rx_descs, 0, sizeof(RX_DESC)*RXDES_NUM);
-
--static dma_addr_t ftmac100_rxdes_get_dma_addr(struct ftmac100_rxdes *rxdes)
--{
-- return le32_to_cpu(rxdes->rxdes2);
-+ priv->rx_buf = dma_allocate( NULL, RX_BUF_SIZE*RXDES_NUM, &(priv->rx_buf_dma), GFP_KERNEL );
-+ if (priv->rx_buf == NULL || (( (u32)priv->rx_buf & 3)!=0)) {
-+ printk("Receive Ring Buffer allocation error\n");
-+ return -ENOMEM;
-+ }
-+#if FTMAC100_DEBUG > 2
-+ else
-+ printk( KERN_INFO "* Allocated RX buf=%X, bus addr=%X, size=%d*%d=%d\n",
-+ (unsigned)priv->rx_buf, (unsigned)priv->rx_buf_dma,
-+ RX_BUF_SIZE, RXDES_NUM, RX_BUF_SIZE*RXDES_NUM );
-+#endif
-+
-+ memset((void *)priv->rx_buf,0,sizeof(RX_BUF_SIZE)*RXDES_NUM);
-+
-+ for (i=0; i<RXDES_NUM; ++i) {
-+ priv->rx_descs[i].RXBUF_Size = RX_BUF_SIZE;
-+ priv->rx_descs[i].EDOTR = 0; // not last descriptor
-+ priv->rx_descs[i].RXBUF_BADR = priv->rx_buf_dma+RX_BUF_SIZE*i;
-+ priv->rx_descs[i].VIR_RXBUF_BADR=(unsigned int)priv->rx_buf+RX_BUF_SIZE*i;
-+ }
-+ priv->rx_descs[RXDES_NUM-1].EDOTR = 1; // is last descriptor
-+
-+ priv->tx_descs = dma_allocate( NULL, sizeof(TX_DESC)*TXDES_NUM, &(priv->tx_descs_dma), GFP_KERNEL );
-+ if (priv->tx_descs == NULL || (( (u32)priv->tx_descs & 0xf)!=0)) {
-+ printk("Transmit Ring Buffer allocation error\n");
-+ return -ENOMEM;
-+ }
-+#if FTMAC100_DEBUG > 2
-+ else
-+ printk( KERN_INFO "* Allocated TX descs=%X, bus addr=%X, size=%d*%d=%d\n",
-+ (unsigned)priv->tx_descs, (unsigned)priv->tx_descs_dma, sizeof(TX_DESC),TXDES_NUM,sizeof(TX_DESC)*TXDES_NUM);
-+#endif
-+ memset((void *)priv->tx_descs,0,sizeof(TX_DESC)*TXDES_NUM);
-+
-+ priv->tx_buf = dma_allocate( NULL, TX_BUF_SIZE*TXDES_NUM, &(priv->tx_buf_dma), GFP_KERNEL );
-+ if (priv->tx_buf == NULL || (( (u32)priv->tx_buf & 0x3)!=0)) {
-+ printk("Transmit Ring Buffer allocation error\n");
-+ return -ENOMEM;
-+ }
-+#if FTMAC100_DEBUG > 2
-+ else
-+ printk( KERN_INFO "* Allocated TX buf=%X, bus addr=%X, size=%d*%d=%d\n",
-+ (unsigned)priv->tx_buf, (unsigned)priv->tx_buf_dma,
-+ TX_BUF_SIZE, TXDES_NUM, TX_BUF_SIZE*TXDES_NUM );
-+#endif
-+
-+ memset((void *)priv->tx_buf,0,sizeof(TX_BUF_SIZE)*TXDES_NUM);
-+
-+ for (i=0; i<TXDES_NUM; ++i) {
-+ priv->tx_descs[i].EDOTR = 0; // not last descriptor
-+ priv->tx_descs[i].TXBUF_BADR=priv->tx_buf_dma+TX_BUF_SIZE*i;
-+ priv->tx_descs[i].VIR_TXBUF_BADR=(unsigned int)priv->tx_buf+TX_BUF_SIZE*i;
-+ }
-+ priv->tx_descs[TXDES_NUM-1].EDOTR = 1; // is last descriptor
-+ return 0;
- }
-
- /*
-- * rxdes3 is not used by hardware. We use it to keep track of page.
-- * Since hardware does not touch it, we can skip cpu_to_le32()/le32_to_cpu().
-+ * Function: ftmac100_poll( struct net_device *dev )
-+ *
-+ * Purpose:
-+ * poll interface callback function.
- */
--static void ftmac100_rxdes_set_page(struct ftmac100_rxdes *rxdes, struct page *page)
-+void ftmac100_poll(struct net_device *dev)
- {
-- rxdes->rxdes3 = (unsigned int)page;
-+ disable_irq(dev->irq);
-+ ftmac100_interrupt(dev->irq, dev);
-+ enable_irq(dev->irq);
- }
-
--static struct page *ftmac100_rxdes_get_page(struct ftmac100_rxdes *rxdes)
--{
-- return (struct page *)rxdes->rxdes3;
--}
--
--/******************************************************************************
-- * internal functions (receive)
-- *****************************************************************************/
--static int ftmac100_next_rx_pointer(int pointer)
-+/*
-+ * Function: ftmac100_setup( struct net_device *dev )
-+ *
-+ * Purpose:
-+ * Tests to see if the device 'dev' points to an ftmac100 chip.
-+ * Returns a 0 on success
-+ */
-+static const struct net_device_ops ftmac100_ops = {
-+ .ndo_init = ftmac100_setup,
-+ .ndo_open = ftmac100_open,
-+ .ndo_stop = ftmac100_close,
-+ .ndo_start_xmit = ftmac100_wait_to_send_packet,
-+ .ndo_get_stats = ftmac100_query_statistics,
-+ .ndo_tx_timeout = ftmac100_timeout,
-+#ifdef HAVE_MULTICAST
-+ .ndo_set_multicast_list = ftmac100_set_multicast_list,
-+#endif
-+ .ndo_set_mac_address = eth_mac_addr,
-+#ifdef CONFIG_NET_POLL_CONTROLLER
-+ .ndo_poll_controller = ftmac100_poll,
-+#endif
-+};
-+static int ftmac100_setup(struct net_device *dev)
- {
-- return (pointer + 1) & (RX_QUEUE_ENTRIES - 1);
--}
-+ int retval;
-+ static unsigned version_printed = 0;
-+ struct ftmac100_local *priv;
-+
-+ if (version_printed++ == 0)
-+ printk(KERN_INFO "%s", version);
-+
-+ /* Now, print out the card info, in a short format.. */
-+ printk(KERN_INFO "%s: device at %#3x IRQ:%d NOWAIT:%d\n",dev->name,
-+ (unsigned)dev->base_addr, dev->irq, dev->dma);
-+
-+ /* Initialize priviate data */
-+ priv = (struct ftmac100_local *)netdev_priv(dev);
-+ memset(priv, 0, sizeof(struct ftmac100_local));
-+ spin_lock_init(&priv->lock);
-+ priv->maccr_val = FULLDUP_bit
-+ | CRC_APD_bit
-+ | MDC_SEL_bit
-+ | RCV_EN_bit
-+ | XMT_EN_bit
-+ | RDMA_EN_bit
-+ | XDMA_EN_bit ;
-+ retval = ftmac100_ringbuf_alloc(dev,priv);
-+ if (retval)
-+ goto err_out;
-+
-+ /* now, reset the chip, and put it into a known state */
-+ retval = ftmac100_reset( dev );
-+ if (retval) {
-+ printk( "%s: unable to reset.\n", dev->name );
-+ goto err_out;
-+ }
-+
-+ /* Fill in the fields of the device structure with ethernet values. */
-+ ether_setup(dev);
-+
-+ /* Grab the IRQ */
-+ retval = request_irq(dev->irq, &ftmac100_interrupt, IRQF_DISABLED, dev->name, dev);
-+ if (retval) {
-+ printk("%s: unable to get IRQ %d (irqval=%d).\n", dev->name, dev->irq, retval);
-+ goto err_out;
-+ }
-+
-+#if 0
-+ if ((proc_ftmac100 = create_proc_entry( "ftmac100", 0, 0 ))) {
-+ proc_ftmac100->read_proc = ftmac100_read_proc;
-+ proc_ftmac100->data = dev;
-+ proc_ftmac100->owner = THIS_MODULE;
-+ }
-+#endif
-
--static void ftmac100_rx_pointer_advance(struct ftmac100 *priv)
--{
-- priv->rx_pointer = ftmac100_next_rx_pointer(priv->rx_pointer);
--}
-+ return 0;
-
--static struct ftmac100_rxdes *ftmac100_current_rxdes(struct ftmac100 *priv)
--{
-- return &priv->descs->rxdes[priv->rx_pointer];
-+err_out:
-+ dma_free_coherent( NULL, sizeof(RX_DESC)*RXDES_NUM, (void*)priv->rx_descs, (dma_addr_t)priv->rx_descs_dma );
-+ dma_free_coherent( NULL, RX_BUF_SIZE*RXDES_NUM, (void*)priv->rx_buf, (dma_addr_t)priv->rx_buf_dma );
-+ dma_free_coherent( NULL, sizeof(TX_DESC)*TXDES_NUM, (void*)priv->tx_descs, (dma_addr_t)priv->tx_descs_dma );
-+ dma_free_coherent( NULL, TX_BUF_SIZE*TXDES_NUM, (void*)priv->tx_buf, (dma_addr_t)priv->tx_buf_dma );
-+ priv->rx_descs = NULL; priv->rx_descs_dma = 0;
-+ priv->rx_buf = NULL; priv->rx_buf_dma = 0;
-+ priv->tx_descs = NULL; priv->tx_descs_dma = 0;
-+ priv->tx_buf = NULL; priv->tx_buf_dma = 0;
-+ return retval;
- }
-
--static struct ftmac100_rxdes *
--ftmac100_rx_locate_first_segment(struct ftmac100 *priv)
--{
-- struct ftmac100_rxdes *rxdes = ftmac100_current_rxdes(priv);
-
-- while (!ftmac100_rxdes_owned_by_dma(rxdes)) {
-- if (ftmac100_rxdes_first_segment(rxdes))
-- return rxdes;
-+#if FTMAC100_DEBUG > 2
-+static void print_packet( unsigned char * buf, int length )
-+{
-+#if FTMAC100_DEBUG > 3
-+ int i;
-+ int remainder;
-+ int lines;
-+#endif
-
-- ftmac100_rxdes_set_dma_own(rxdes);
-- ftmac100_rx_pointer_advance(priv);
-- rxdes = ftmac100_current_rxdes(priv);
-- }
-+// printk("Packet of length %d \n", length );
-
-- return NULL;
-+#if FTMAC100_DEBUG > 3
-+ lines = length >> 4;
-+ remainder = length & 15;
-+
-+ for ( i = 0; i < lines ; i ++ ) {
-+ int cur;
-+ for ( cur = 0; cur < 8; cur ++ ) {
-+ unsigned char a, b;
-+ a = *(buf ++ );
-+ b = *(buf ++ );
-+ printk("%02x%02x ", a, b );
-+ }
-+ printk("\n");
-+ }
-+ for ( i = 0; i < remainder/2 ; i++ ) {
-+ unsigned char a, b;
-+
-+ a = *(buf ++ );
-+ b = *(buf ++ );
-+ printk("%02x%02x ", a, b );
-+ }
-+ printk("\n");
-+#endif
- }
-+#endif
-
--static bool ftmac100_rx_packet_error(struct ftmac100 *priv,
-- struct ftmac100_rxdes *rxdes)
--{
-- struct net_device *netdev = priv->netdev;
-- bool error = false;
--
-- if (unlikely(ftmac100_rxdes_rx_error(rxdes))) {
-- if (net_ratelimit())
-- netdev_info(netdev, "rx err\n");
--
-- netdev->stats.rx_errors++;
-- error = true;
-- }
--
-- if (unlikely(ftmac100_rxdes_crc_error(rxdes))) {
-- if (net_ratelimit())
-- netdev_info(netdev, "rx crc err\n");
--
-- netdev->stats.rx_crc_errors++;
-- error = true;
-- }
--
-- if (unlikely(ftmac100_rxdes_frame_too_long(rxdes))) {
-- if (net_ratelimit())
-- netdev_info(netdev, "rx frame too long\n");
--
-- netdev->stats.rx_length_errors++;
-- error = true;
-- } else if (unlikely(ftmac100_rxdes_runt(rxdes))) {
-- if (net_ratelimit())
-- netdev_info(netdev, "rx runt\n");
--
-- netdev->stats.rx_length_errors++;
-- error = true;
-- } else if (unlikely(ftmac100_rxdes_odd_nibble(rxdes))) {
-- if (net_ratelimit())
-- netdev_info(netdev, "rx odd nibble\n");
--
-- netdev->stats.rx_length_errors++;
-- error = true;
-- }
--
-- return error;
--}
-
--static void ftmac100_rx_drop_packet(struct ftmac100 *priv)
-+/*
-+ * Open and Initialize the board
-+ *
-+ * Set up everything, reset the card, etc ..
-+ *
-+ */
-+static int ftmac100_open(struct net_device *dev)
- {
-- struct net_device *netdev = priv->netdev;
-- struct ftmac100_rxdes *rxdes = ftmac100_current_rxdes(priv);
-- bool done = false;
--
-- if (net_ratelimit())
-- netdev_dbg(netdev, "drop packet %p\n", rxdes);
-+ int retval = 0;
-+ PRINTK("+%s:ftmac100_open\n", dev->name);
-
-- do {
-- if (ftmac100_rxdes_last_segment(rxdes))
-- done = true;
-+ //netif_start_queue(dev);
-
-- ftmac100_rxdes_set_dma_own(rxdes);
-- ftmac100_rx_pointer_advance(priv);
-- rxdes = ftmac100_current_rxdes(priv);
-- } while (!done && !ftmac100_rxdes_owned_by_dma(rxdes));
--
-- netdev->stats.rx_dropped++;
-+ /* reset the hardware */
-+ ftmac100_reset( dev );
-+ retval = ftmac100_reset( dev );
-+ if (retval) {
-+ printk( "%s: unable to reset.\n", dev->name );
-+ retval = -ENODEV;
-+ } else {
-+ ftmac100_enable( dev );
-+
-+ /* Configure the PHY */
-+ ftmac100_phy_configure(dev);
-+
-+ netif_start_queue(dev);
-+
-+ PRINTK("+%s:ftmac100_open DONE\n", dev->name);
-+ }
-+
-+ return retval;
- }
-
--static bool ftmac100_rx_packet(struct ftmac100 *priv, int *processed)
--{
-- struct net_device *netdev = priv->netdev;
-- struct ftmac100_rxdes *rxdes;
-- struct sk_buff *skb;
-- struct page *page;
-- dma_addr_t map;
-- int length;
-
-- rxdes = ftmac100_rx_locate_first_segment(priv);
-- if (!rxdes)
-- return false;
--
-- if (unlikely(ftmac100_rx_packet_error(priv, rxdes))) {
-- ftmac100_rx_drop_packet(priv);
-- return true;
-- }
--
-- /*
-- * It is impossible to get multi-segment packets
-- * because we always provide big enough receive buffers.
-- */
-- if (unlikely(!ftmac100_rxdes_last_segment(rxdes)))
-- BUG();
--
-- /* start processing */
-- skb = netdev_alloc_skb_ip_align(netdev, 128);
-- if (unlikely(!skb)) {
-- if (net_ratelimit())
-- netdev_err(netdev, "rx skb alloc failed\n");
--
-- ftmac100_rx_drop_packet(priv);
-- return true;
-- }
--
-- if (unlikely(ftmac100_rxdes_multicast(rxdes)))
-- netdev->stats.multicast++;
--
-- map = ftmac100_rxdes_get_dma_addr(rxdes);
-- dma_unmap_page(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
--
-- length = ftmac100_rxdes_frame_length(rxdes);
-- page = ftmac100_rxdes_get_page(rxdes);
-- skb_fill_page_desc(skb, 0, page, 0, length);
-- skb->len += length;
-- skb->data_len += length;
--
-- /* page might be freed in __pskb_pull_tail() */
-- if (length > 64)
-- skb->truesize += PAGE_SIZE;
-- __pskb_pull_tail(skb, min(length, 64));
--
-- ftmac100_alloc_rx_page(priv, rxdes, GFP_ATOMIC);
--
-- ftmac100_rx_pointer_advance(priv);
--
-- skb->protocol = eth_type_trans(skb, netdev);
--
-- netdev->stats.rx_packets++;
-- netdev->stats.rx_bytes += skb->len;
-+/*
-+ * Called by the kernel to send a packet out into the void
-+ * of the net. This routine is largely based on
-+ * skeleton.c, from Becker.
-+ *
-+ */
-+static void ftmac100_timeout (struct net_device *dev)
-+{
-+ /* If we get here, some higher level has decided we are broken.
-+ There should really be a "kick me" function call instead. */
-+ printk(KERN_WARNING "%s: transmit timed out?\n",dev->name);
-
-- /* push packet to protocol stack */
-- netif_receive_skb(skb);
-+ //printk("+ftmac100_timeout\n");
-
-- (*processed)++;
-- return true;
-+ ftmac100_reset( dev );
-+ ftmac100_enable( dev );
-+ ftmac100_phy_configure(dev);
-+ netif_wake_queue(dev);
-+ dev->trans_start = jiffies;
- }
-
--/******************************************************************************
-- * internal functions (transmit descriptor)
-- *****************************************************************************/
--static void ftmac100_txdes_reset(struct ftmac100_txdes *txdes)
-+#if ZERO_COPY
-+/*
-+ * Free transmitted skb buffer when it's safe.
-+ */
-+static void ftmac100_free_tx (struct net_device *dev, int irq)
- {
-- /* clear all except end of ring bit */
-- txdes->txdes0 = 0;
-- txdes->txdes1 &= cpu_to_le32(FTMAC100_TXDES1_EDOTR);
-- txdes->txdes2 = 0;
-- txdes->txdes3 = 0;
--}
-+ struct ftmac100_local *priv = (struct ftmac100_local *)netdev_priv(dev);
-+ //volatile TX_DESC *cur_desc;
-+ int entry = priv->old_tx & (TXDES_NUM-1);
-+
-+ //enter spinlock
-+ if (!irq)
-+ spin_lock(&priv->lock);
-+
-+ /* Free used tx skbuffs */
-+ while (entry != priv->tx_idx) {
-+ struct sk_buff *skb;
-+
-+ skb = priv->tx_skbuff[entry];
-+ if(skb) {
-+ dev_kfree_skb_any (skb);
-+ priv->tx_skbuff[entry] = 0;
-+ }
-
--static bool ftmac100_txdes_owned_by_dma(struct ftmac100_txdes *txdes)
--{
-- return txdes->txdes0 & cpu_to_le32(FTMAC100_TXDES0_TXDMA_OWN);
--}
-+ entry = (entry + 1) & (TXDES_NUM-1);
-+ }
-
--static void ftmac100_txdes_set_dma_own(struct ftmac100_txdes *txdes)
--{
-- /*
-- * Make sure dma own bit will not be set before any other
-- * descriptor fields.
-- */
-- wmb();
-- txdes->txdes0 |= cpu_to_le32(FTMAC100_TXDES0_TXDMA_OWN);
--}
-+ if (!irq)
-+ spin_unlock(&priv->lock);
-+ //exit spinloc
-
--static bool ftmac100_txdes_excessive_collision(struct ftmac100_txdes *txdes)
--{
-- return txdes->txdes0 & cpu_to_le32(FTMAC100_TXDES0_TXPKT_EXSCOL);
-+ priv->old_tx = entry;
-+ netif_wake_queue (dev);
- }
-+#endif
-
--static bool ftmac100_txdes_late_collision(struct ftmac100_txdes *txdes)
--{
-- return txdes->txdes0 & cpu_to_le32(FTMAC100_TXDES0_TXPKT_LATECOL);
--}
-+/*
-+ .
-+ . This is the main routine of the driver, to handle the net_device when
-+ . it needs some attention.
-+ .
-+ . So:
-+ . first, save state of the chipset
-+ . branch off into routines to handle each case, and acknowledge
-+ . each to the interrupt register
-+ . and finally restore state.
-+ .
-+ */
-
--static void ftmac100_txdes_set_end_of_ring(struct ftmac100_txdes *txdes)
--{
-- txdes->txdes1 |= cpu_to_le32(FTMAC100_TXDES1_EDOTR);
--}
-+#if FTMAC100_DEBUG > 2
-
--static void ftmac100_txdes_set_first_segment(struct ftmac100_txdes *txdes)
-+static void dump_intc(void)
- {
-- txdes->txdes1 |= cpu_to_le32(FTMAC100_TXDES1_FTS);
-+ printk( " INTC[0] IRQSRC=%08X,MASK=%08X,MOD=%08X,LEV=%08X,STAT=%08X\n",
-+ *((volatile unsigned*)(INTC_FTINTC010_VA_BASE+0)),
-+ *((volatile unsigned*)(INTC_FTINTC010_VA_BASE+0x4)),
-+ *((volatile unsigned*)(INTC_FTINTC010_VA_BASE+0xc)),
-+ *((volatile unsigned*)(INTC_FTINTC010_VA_BASE+0x10)),
-+ *((volatile unsigned*)(INTC_FTINTC010_VA_BASE+0x14)) );
-+ printk( " INTC[1] IRQSRC=%08X,MASK=%08X,MOD=%08X,LEV=%08X,STAT=%08X\n",
-+ *((volatile unsigned*)(INTC_FTINTC010_1_VA_BASE+0)),
-+ *((volatile unsigned*)(INTC_FTINTC010_1_VA_BASE+0x4)),
-+ *((volatile unsigned*)(INTC_FTINTC010_1_VA_BASE+0xc)),
-+ *((volatile unsigned*)(INTC_FTINTC010_1_VA_BASE+0x10)),
-+ *((volatile unsigned*)(INTC_FTINTC010_1_VA_BASE+0x14)) );
- }
-+#else
-+#define dump_intc()
-+#endif
-
--static void ftmac100_txdes_set_last_segment(struct ftmac100_txdes *txdes)
-+#if FTMAC100_DEBUG > 2
-+static void show_intstatus(unsigned char status)
- {
-- txdes->txdes1 |= cpu_to_le32(FTMAC100_TXDES1_LTS);
-+ static int count = 0;
-+ if (status & PHYSTS_CHG_bit)
-+ printk( "[%d]%s ", count, "PHYSTS_CHG" );
-+ if (status & AHB_ERR_bit)
-+ printk( "[%d]%s ", count, "AHB_ERR" );
-+ if (status & RPKT_LOST_bit)
-+ printk( "[%d]%s ", count, "RPKT_LOST" );
-+ if (status & RPKT_SAV_bit)
-+ printk( "[%d]%s ", count, "RPKT_SAV" );
-+ if (status & XPKT_LOST_bit)
-+ printk( "[%d]%s ", count, "XPKT_LOST" );
-+ if (status & XPKT_OK_bit)
-+ printk( "[%d]%s ", count, "XPKT_OK" );
-+ if (status & NOTXBUF_bit)
-+ printk( "[%d]%s ", count, "NOTXBUF" );
-+ if (status & XPKT_FINISH_bit)
-+ printk( "[%d]%s ", count, "XPKT_FINISH" );
-+ if (status & NORXBUF_bit)
-+ printk( "[%d]%s ", count, "NORXBUF" );
-+ if (status & RPKT_FINISH_bit)
-+ printk( "[%d]%s ", count, "RPKT_FINISH" );
-+ if (status & ~(PHYSTS_CHG_bit | AHB_ERR_bit | RPKT_LOST_bit | RPKT_SAV_bit
-+ | XPKT_LOST_bit | XPKT_OK_bit | NOTXBUF_bit | XPKT_FINISH_bit
-+ | NORXBUF_bit | RPKT_FINISH_bit))
-+ printk( "[%d]%s ", count, "<Unknown>" );
-+ count++;
- }
-+#else
-+#define show_intstatus(x)
-+#endif
-+
-
--static void ftmac100_txdes_set_txint(struct ftmac100_txdes *txdes)
-+/*
-+ * The interrupt handler
-+ */
-+static irqreturn_t ftmac100_interrupt(int irq, void * dev_id)
- {
-- txdes->txdes1 |= cpu_to_le32(FTMAC100_TXDES1_TXIC);
--}
-+ struct net_device *dev = dev_id;
-+ unsigned int ioaddr = dev->base_addr;
-+ unsigned status; // interrupt status
-+ unsigned char mask; // interrupt mask
-+ struct ftmac100_local *priv = (struct ftmac100_local *)netdev_priv(dev);
-+ unsigned long flags;
-+
-+ spin_lock_irqsave(&priv->lock,flags); // Luke 08/18/2005 ins
-+ PRINTK(KERN_INFO "+ftmac100_interrupt\n");
-+ dump_intc();
-+
-+ if (dev == NULL||priv == NULL) {
-+ printk(KERN_WARNING "%s: irq %d for unknown device.\n", "ftmac100_interrupt", irq);
-+ return IRQ_HANDLED;
-+ }
-+
-+ /* read the interrupt status register */
-+ mask = inl( ioaddr + IMR_REG );
-+
-+ /* read the status flag, and mask it */
-+ status = inl( ioaddr + ISR_REG ) & mask;
-+
-+ show_intstatus(status);
-+
-+ if ( status & RPKT_FINISH_bit )
-+ ftmac100_rcv(dev);
-+
-+ if (status & NORXBUF_bit) {
-+ //printk("<0x%x:NORXBUF>",status);
-+ outl( mask & ~NORXBUF_bit, ioaddr + IMR_REG);
-+ trans_busy = 1;
-+
-+#if ENABLE_BOTTOM_HALF
-+ priv->rcv_tq.sync = 0;
-+ priv->rcv_tq.routine=ftmac100_rcv;
-+ priv->rcv_tq.data = dev;
-+ queue_task(&priv->rcv_tq, &tq_timer);
-+ //queue_task(&priv->rcv_tq, &tq_immediate);
-+#else
-+ ftmac100_rcv( dev );
-+#endif
-+ }
-+
-+ if (status & AHB_ERR_bit)
-+ printk("<0x%x:AHB_ERR>",status);
-+
-+ if (status & XPKT_FINISH_bit)
-+ printk( "[XPKT_FINISH]" );
-+
-+ /*
-+ if (status & PHYSTS_CHG_bit) {
-+ }
-+ */
-+ if (status & XPKT_OK_bit) {
-+#if ZERO_COPY
-+ ftmac100_free_tx(dev,1);
-+#endif
-+ }
-+ /*
-+ if (status & NOTXBUF_bit) {
-+ }
-+ */
-+
-+ if (status & RPKT_LOST_bit)
-+ priv->stats.rx_errors++;
-+
-+ if (status & XPKT_LOST_bit) {
-+#if ZERO_COPY
-+ ftmac100_free_tx(dev,1);
-+#endif
-+ priv->stats.tx_errors++;
-+ }
-+
-+ PRINTK(KERN_INFO "+ftmac100_interrupt DONE\n");
-+ dump_intc();
-+ PRINTK(KERN_INFO "\n");
-+ spin_unlock_irqrestore(&priv->lock,flags); // Luke 08/18/2005 ins
-
--static void ftmac100_txdes_set_buffer_size(struct ftmac100_txdes *txdes,
-- unsigned int len)
--{
-- txdes->txdes1 |= cpu_to_le32(FTMAC100_TXDES1_TXBUF_SIZE(len));
-+ return IRQ_HANDLED;
- }
-
--static void ftmac100_txdes_set_dma_addr(struct ftmac100_txdes *txdes,
-- dma_addr_t addr)
--{
-- txdes->txdes2 = cpu_to_le32(addr);
--}
-
--static dma_addr_t ftmac100_txdes_get_dma_addr(struct ftmac100_txdes *txdes)
--{
-- return le32_to_cpu(txdes->txdes2);
--}
-
- /*
-- * txdes3 is not used by hardware. We use it to keep track of socket buffer.
-- * Since hardware does not touch it, we can skip cpu_to_le32()/le32_to_cpu().
-+ . ftmac100_rcv - receive a packet from the card
-+ .
-+ . There is ( at least ) a packet waiting to be read from
-+ . chip-memory.
-+ .
-+ . o Read the status
-+ . o If an error, record it
-+ . o otherwise, read in the packet
- */
--static void ftmac100_txdes_set_skb(struct ftmac100_txdes *txdes, struct sk_buff *skb)
--{
-- txdes->txdes3 = (unsigned int)skb;
--}
-
--static struct sk_buff *ftmac100_txdes_get_skb(struct ftmac100_txdes *txdes)
-+static void ftmac100_rcv(void *devp)
- {
-- return (struct sk_buff *)txdes->txdes3;
-+ struct net_device *dev=(struct net_device *)devp;
-+ struct ftmac100_local *priv = (struct ftmac100_local *)netdev_priv(dev);
-+ unsigned int ioaddr=dev->base_addr;
-+ int packet_length;
-+ int rcv_cnt;
-+ volatile RX_DESC *cur_desc;
-+ int cpy_length;
-+ int cur_idx;
-+ int seg_length;
-+ int have_package;
-+ int have_frs;
-+ int start_idx;
-+
-+ struct sk_buff * skb;
-+ unsigned char * data;
-+
-+ PRINTK("+ ftmac100_rcv\n");
-+
-+ start_idx = priv->rx_idx;
-+
-+ for (rcv_cnt=0; rcv_cnt<8 ; ++rcv_cnt) {
-+ packet_length = 0;
-+ cur_idx = priv->rx_idx;
-+
-+ have_package = 0;
-+ have_frs = 0;
-+ for (; (cur_desc = &priv->rx_descs[priv->rx_idx])->RXDMA_OWN==0; ) {
-+ have_package = 1;
-+ priv->rx_idx = (priv->rx_idx+1) & (RXDES_NUM-1);
-+ if (cur_desc->FRS) {
-+ have_frs = 1;
-+ if (cur_desc->RX_ERR || cur_desc->CRC_ERR || cur_desc->FTL
-+ || cur_desc->RUNT || cur_desc->RX_ODD_NB) {
-+ priv->stats.rx_errors++; // error frame....
-+ break;
-+ }
-+ if (cur_desc->MULTICAST)
-+ priv->stats.multicast++;
-+ packet_length = cur_desc->ReceiveFrameLength; // normal frame
-+ }
-+ if ( cur_desc->LRS ) // packet's last frame
-+ break;
-+ }
-+ if (have_package==0)
-+ goto done;
-+ if (have_frs == 0)
-+ priv->stats.rx_over_errors++;
-+
-+ if (packet_length>0) {
-+ // Allocate enough memory for entire receive frame, to be safe
-+ skb = dev_alloc_skb( packet_length + 2 );
-+
-+ if ( skb == NULL ) {
-+ printk(KERN_NOTICE "%s: Low memory, packet dropped.\n", dev->name);
-+ priv->stats.rx_dropped++;
-+ goto done;
-+ }
-+
-+ skb_reserve( skb, 2 ); /* 16 bit alignment */
-+ skb->dev = dev;
-+
-+ data = skb_put( skb, packet_length );
-+ cpy_length = 0;
-+ for (; cur_idx!=priv->rx_idx; cur_idx = (cur_idx+1) & (RXDES_NUM-1)) {
-+ seg_length = min(packet_length - cpy_length, RX_BUF_SIZE);
-+ memcpy(data+cpy_length, (char *)priv->rx_descs[cur_idx].VIR_RXBUF_BADR, seg_length);
-+ cpy_length += seg_length;
-+ }
-+
-+ skb->protocol = eth_type_trans(skb, dev);
-+ netif_rx(skb);
-+ dev->last_rx = jiffies;
-+ priv->stats.rx_packets++;
-+ priv->stats.rx_bytes += skb->len;
-+ }
-+ }
-+
-+done:
-+ if (start_idx != priv->rx_idx) {
-+ for (cur_idx = (start_idx+1)%RXDES_NUM; cur_idx != priv->rx_idx; cur_idx = (cur_idx+1)%RXDES_NUM) {
-+ priv->rx_descs[cur_idx].RXDMA_OWN = 1;
-+ }
-+ priv->rx_descs[start_idx].RXDMA_OWN = 1;
-+ }
-+ if (trans_busy == 1) {
-+ outl( priv->maccr_val, ioaddr + MACCR_REG );
-+ outl( inl(ioaddr + IMR_REG) | NORXBUF_bit, ioaddr + IMR_REG);
-+ }
-+
-+ PRINTK("+ ftmac100_rcv DONE\n");
-+
-+ return;
- }
-
--/******************************************************************************
-- * internal functions (transmit)
-- *****************************************************************************/
--static int ftmac100_next_tx_pointer(int pointer)
-+/*
-+ . ftmac100_close
-+ .
-+ . this makes the board clean up everything that it can
-+ . and not talk to the outside world. Caused by
-+ . an 'ifconfig ethX down'
-+ .
-+ */
-+static int ftmac100_close(struct net_device *dev)
- {
-- return (pointer + 1) & (TX_QUEUE_ENTRIES - 1);
--}
-+ //printk("+ftmac100_close\n");
-
--static void ftmac100_tx_pointer_advance(struct ftmac100 *priv)
--{
-- priv->tx_pointer = ftmac100_next_tx_pointer(priv->tx_pointer);
-+ netif_stop_queue(dev);
-+
-+ ftmac100_shutdown( dev->base_addr );
-+#if ZERO_COPY
-+ ftmac100_free_tx(dev,0);
-+#endif
-+ return 0;
- }
-
--static void ftmac100_tx_clean_pointer_advance(struct ftmac100 *priv)
-+/*
-+ . Get the current statistics.
-+ . This may be called with the card open or closed.
-+ */
-+static struct net_device_stats* ftmac100_query_statistics(struct net_device *dev)
- {
-- priv->tx_clean_pointer = ftmac100_next_tx_pointer(priv->tx_clean_pointer);
--}
-+ struct ftmac100_local *priv = (struct ftmac100_local *)netdev_priv(dev);
-
--static struct ftmac100_txdes *ftmac100_current_txdes(struct ftmac100 *priv)
--{
-- return &priv->descs->txdes[priv->tx_pointer];
--}
-+ PRINTK("+ftmac100_query_statistics\n");
-
--static struct ftmac100_txdes *ftmac100_current_clean_txdes(struct ftmac100 *priv)
--{
-- return &priv->descs->txdes[priv->tx_clean_pointer];
-+ return &priv->stats;
- }
-
--static bool ftmac100_tx_complete_packet(struct ftmac100 *priv)
--{
-- struct net_device *netdev = priv->netdev;
-- struct ftmac100_txdes *txdes;
-- struct sk_buff *skb;
-- dma_addr_t map;
--
-- if (priv->tx_pending == 0)
-- return false;
-
-- txdes = ftmac100_current_clean_txdes(priv);
--
-- if (ftmac100_txdes_owned_by_dma(txdes))
-- return false;
--
-- skb = ftmac100_txdes_get_skb(txdes);
-- map = ftmac100_txdes_get_dma_addr(txdes);
--
-- if (unlikely(ftmac100_txdes_excessive_collision(txdes) ||
-- ftmac100_txdes_late_collision(txdes))) {
-- /*
-- * packet transmitted to ethernet lost due to late collision
-- * or excessive collision
-- */
-- netdev->stats.tx_aborted_errors++;
-- } else {
-- netdev->stats.tx_packets++;
-- netdev->stats.tx_bytes += skb->len;
-- }
-+#ifdef HAVE_MULTICAST
-
-- dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
-- dev_kfree_skb(skb);
--
-- ftmac100_txdes_reset(txdes);
--
-- ftmac100_tx_clean_pointer_advance(priv);
--
-- spin_lock(&priv->tx_lock);
-- priv->tx_pending--;
-- spin_unlock(&priv->tx_lock);
-- netif_wake_queue(netdev);
--
-- return true;
--}
-+/*
-+ . Function: ftmac100_setmulticast( unsigned int ioaddr, int count, dev_mc_list * adds )
-+ . Purpose:
-+ . This sets the internal hardware table to filter out unwanted multicast
-+ . packets before they take up memory.
-+ */
-
--static void ftmac100_tx_complete(struct ftmac100 *priv)
-+static void ftmac100_setmulticast( unsigned int ioaddr, int count, struct dev_mc_list * addrs )
- {
-- while (ftmac100_tx_complete_packet(priv))
-- ;
-+ struct dev_mc_list * cur_addr;
-+ int crc_val;
-+
-+ //printk("+ftmac100_setmulticast\n");
-+
-+ for (cur_addr = addrs ; cur_addr!=NULL ; cur_addr = cur_addr->next ) {
-+ if ( !( *cur_addr->dmi_addr & 1 ) )
-+ continue;
-+ crc_val = crc32( cur_addr->dmi_addr, 6 );
-+ crc_val = (crc_val>>26)&0x3f; // ¨ú MSB 6 bit
-+ if (crc_val >= 32)
-+ outl(inl(ioaddr+MAHT1_REG) | (1UL<<(crc_val-32)), ioaddr+MAHT1_REG);
-+ else
-+ outl(inl(ioaddr+MAHT0_REG) | (1UL<<crc_val), ioaddr+MAHT0_REG);
-+ }
- }
-
--static int ftmac100_xmit(struct ftmac100 *priv, struct sk_buff *skb,
-- dma_addr_t map)
--{
-- struct net_device *netdev = priv->netdev;
-- struct ftmac100_txdes *txdes;
-- unsigned int len = (skb->len < ETH_ZLEN) ? ETH_ZLEN : skb->len;
--
-- txdes = ftmac100_current_txdes(priv);
-- ftmac100_tx_pointer_advance(priv);
--
-- /* setup TX descriptor */
-- ftmac100_txdes_set_skb(txdes, skb);
-- ftmac100_txdes_set_dma_addr(txdes, map);
--
-- ftmac100_txdes_set_first_segment(txdes);
-- ftmac100_txdes_set_last_segment(txdes);
-- ftmac100_txdes_set_txint(txdes);
-- ftmac100_txdes_set_buffer_size(txdes, len);
-
-- spin_lock(&priv->tx_lock);
-- priv->tx_pending++;
-- if (priv->tx_pending == TX_QUEUE_ENTRIES)
-- netif_stop_queue(netdev);
--
-- /* start transmit */
-- ftmac100_txdes_set_dma_own(txdes);
-- spin_unlock(&priv->tx_lock);
-+/*
-+ . ftmac100_set_multicast_list
-+ .
-+ . This routine will, depending on the values passed to it,
-+ . either make it accept multicast packets, go into
-+ . promiscuous mode ( for TCPDUMP and cousins ) or accept
-+ . a select set of multicast packets
-+*/
-+static void ftmac100_set_multicast_list(struct net_device *dev)
-+{
-+ unsigned int ioaddr = dev->base_addr;
-+ struct ftmac100_local *priv = (struct ftmac100_local *)netdev_priv(dev);
-+
-+ //printk("+ftmac100_set_multicast_list\n");
-+
-+ if (dev->flags & IFF_PROMISC)
-+ priv->maccr_val |= RCV_ALL_bit;
-+ else
-+ priv->maccr_val &= ~RCV_ALL_bit;
-+
-+ if ( !(dev->flags & IFF_ALLMULTI) )
-+ priv->maccr_val |= RX_MULTIPKT_bit;
-+ else
-+ priv->maccr_val &= ~RX_MULTIPKT_bit;
-+
-+ if (dev->mc_count) {
-+ priv->maccr_val |= HT_MULTI_EN_bit;
-+ ftmac100_setmulticast( ioaddr, dev->mc_count, dev->mc_list );
-+ }
-+ else
-+ priv->maccr_val &= ~HT_MULTI_EN_bit;
-
-- ftmac100_txdma_start_polling(priv);
-- return NETDEV_TX_OK;
-+ outl( priv->maccr_val, ioaddr + MACCR_REG );
- }
-+#endif
-
--/******************************************************************************
-- * internal functions (buffer)
-- *****************************************************************************/
--static int ftmac100_alloc_rx_page(struct ftmac100 *priv,
-- struct ftmac100_rxdes *rxdes, gfp_t gfp)
--{
-- struct net_device *netdev = priv->netdev;
-- struct page *page;
-- dma_addr_t map;
--
-- page = alloc_page(gfp);
-- if (!page) {
-- if (net_ratelimit())
-- netdev_err(netdev, "failed to allocate rx page\n");
-- return -ENOMEM;
-- }
--
-- map = dma_map_page(priv->dev, page, 0, RX_BUF_SIZE, DMA_FROM_DEVICE);
-- if (unlikely(dma_mapping_error(priv->dev, map))) {
-- if (net_ratelimit())
-- netdev_err(netdev, "failed to map rx page\n");
-- __free_page(page);
-- return -ENOMEM;
-- }
--
-- ftmac100_rxdes_set_page(rxdes, page);
-- ftmac100_rxdes_set_dma_addr(rxdes, map);
-- ftmac100_rxdes_set_buffer_size(rxdes, RX_BUF_SIZE);
-- ftmac100_rxdes_set_dma_own(rxdes);
-- return 0;
--}
-+/*
-+ * Module initialization function
-+ */
-
--static void ftmac100_free_buffers(struct ftmac100 *priv)
-+static int ftmac100_probe(struct platform_device *pdev)
- {
-- int i;
-+ int result,thisresult;
-+ struct net_device *dev;
-+ struct resource *iores;
-
-- for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
-- struct ftmac100_rxdes *rxdes = &priv->descs->rxdes[i];
-- struct page *page = ftmac100_rxdes_get_page(rxdes);
-- dma_addr_t map = ftmac100_rxdes_get_dma_addr(rxdes);
-+ PRINTK("+init_module\n");
-
-- if (!page)
-- continue;
-+ result = -ENODEV;
-
-- dma_unmap_page(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
-- __free_page(page);
-+ dev = alloc_etherdev(sizeof(struct ftmac100_local));
-+ if (!dev) {
-+ printk(KERN_ERR "Fail allocating ethernet device");
-+ return -ENODEV;
- }
--
-- for (i = 0; i < TX_QUEUE_ENTRIES; i++) {
-- struct ftmac100_txdes *txdes = &priv->descs->txdes[i];
-- struct sk_buff *skb = ftmac100_txdes_get_skb(txdes);
-- dma_addr_t map = ftmac100_txdes_get_dma_addr(txdes);
--
-- if (!skb)
-- continue;
--
-- dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
-- dev_kfree_skb(skb);
-+ iores = platform_get_resource(pdev, IORESOURCE_IO, 0);
-+ /* Copy the parameters from the platform specification */
-+ dev->base_addr = iores->start;
-+ dev->irq = platform_get_irq(pdev, 0);
-+ dev->netdev_ops = &ftmac100_ops;
-+
-+ //dev->dma = nowait; // Use DMA field for nowait
-+ /* Setup initial mac address */
-+ auto_get_mac(pdev->id,dev->dev_addr);
-+
-+ if ((thisresult = register_netdev(dev)) != 0) {
-+ free_irq( dev->irq, dev );
-+ free_netdev(dev);
-+ } else {
-+ platform_set_drvdata(pdev, dev);
- }
-+ if (thisresult == 0) // any of the devices initialized, run
-+ result = 0;
-
-- dma_free_coherent(priv->dev, sizeof(struct ftmac100_descs),
-- priv->descs, priv->descs_dma_addr);
-+ return result;
- }
-
--static int ftmac100_alloc_buffers(struct ftmac100 *priv)
--{
-- int i;
--
-- priv->descs = dma_alloc_coherent(priv->dev, sizeof(struct ftmac100_descs),
-- &priv->descs_dma_addr, GFP_KERNEL);
-- if (!priv->descs)
-- return -ENOMEM;
--
-- memset(priv->descs, 0, sizeof(struct ftmac100_descs));
--
-- /* initialize RX ring */
-- ftmac100_rxdes_set_end_of_ring(&priv->descs->rxdes[RX_QUEUE_ENTRIES - 1]);
--
-- for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
-- struct ftmac100_rxdes *rxdes = &priv->descs->rxdes[i];
--
-- if (ftmac100_alloc_rx_page(priv, rxdes, GFP_KERNEL))
-- goto err;
-- }
--
-- /* initialize TX ring */
-- ftmac100_txdes_set_end_of_ring(&priv->descs->txdes[TX_QUEUE_ENTRIES - 1]);
-- return 0;
--
--err:
-- ftmac100_free_buffers(priv);
-- return -ENOMEM;
--}
-
--/******************************************************************************
-- * struct mii_if_info functions
-- *****************************************************************************/
--static int ftmac100_mdio_read(struct net_device *netdev, int phy_id, int reg)
-+/*
-+ * Cleanup when module is removed with rmmod
-+ */
-+
-+static int ftmac100_remove(struct platform_device *pdev)
- {
-- struct ftmac100 *priv = netdev_priv(netdev);
-- unsigned int phycr;
-- int i;
--
-- phycr = FTMAC100_PHYCR_PHYAD(phy_id) |
-- FTMAC100_PHYCR_REGAD(reg) |
-- FTMAC100_PHYCR_MIIRD;
--
-- iowrite32(phycr, priv->base + FTMAC100_OFFSET_PHYCR);
--
-- for (i = 0; i < 10; i++) {
-- phycr = ioread32(priv->base + FTMAC100_OFFSET_PHYCR);
--
-- if ((phycr & FTMAC100_PHYCR_MIIRD) == 0)
-- return phycr & FTMAC100_PHYCR_MIIRDATA;
--
-- udelay(100);
-- }
--
-- netdev_err(netdev, "mdio read timed out\n");
-+ struct net_device *dev;
-+ struct ftmac100_local *priv;
-+ PRINTK("+cleanup_module\n");
-+
-+ dev = platform_get_drvdata(pdev);
-+
-+ priv = (struct ftmac100_local *)netdev_priv(dev);
-+ if (priv->rx_descs)
-+ dma_free_coherent( NULL, sizeof(RX_DESC)*RXDES_NUM, (void*)priv->rx_descs, (dma_addr_t)priv->rx_descs_dma );
-+ if (priv->rx_buf)
-+ dma_free_coherent( NULL, RX_BUF_SIZE*RXDES_NUM, (void*)priv->rx_buf, (dma_addr_t)priv->rx_buf_dma );
-+ if (priv->tx_descs)
-+ dma_free_coherent( NULL, sizeof(TX_DESC)*TXDES_NUM, (void*)priv->tx_descs, (dma_addr_t)priv->tx_descs_dma );
-+ if (priv->tx_buf)
-+ dma_free_coherent( NULL, TX_BUF_SIZE*TXDES_NUM, (void*)priv->tx_buf, (dma_addr_t)priv->tx_buf_dma );
-+ priv->rx_descs = NULL; priv->rx_descs_dma = 0;
-+ priv->rx_buf = NULL; priv->rx_buf_dma = 0;
-+ priv->tx_descs = NULL; priv->tx_descs_dma = 0;
-+ priv->tx_buf = NULL; priv->tx_buf_dma = 0;
-+
-+ /* No need to check MOD_IN_USE, as sys_delete_module() checks. */
-+ unregister_netdev(dev);
-+
-+ free_irq(dev->irq, dev);
-+ //TODO: where is the request_region ?
-+ //release_region(devFMAC.base_addr, SMC_IO_EXTENT);
-+ free_netdev(dev);
- return 0;
- }
-
--static void ftmac100_mdio_write(struct net_device *netdev, int phy_id, int reg,
-- int data)
--{
-- struct ftmac100 *priv = netdev_priv(netdev);
-- unsigned int phycr;
-- int i;
--
-- phycr = FTMAC100_PHYCR_PHYAD(phy_id) |
-- FTMAC100_PHYCR_REGAD(reg) |
-- FTMAC100_PHYCR_MIIWR;
--
-- data = FTMAC100_PHYWDATA_MIIWDATA(data);
--
-- iowrite32(data, priv->base + FTMAC100_OFFSET_PHYWDATA);
-- iowrite32(phycr, priv->base + FTMAC100_OFFSET_PHYCR);
--
-- for (i = 0; i < 10; i++) {
-- phycr = ioread32(priv->base + FTMAC100_OFFSET_PHYCR);
--
-- if ((phycr & FTMAC100_PHYCR_MIIWR) == 0)
-- return;
--
-- udelay(100);
-- }
--
-- netdev_err(netdev, "mdio write timed out\n");
--}
--
--/******************************************************************************
-- * struct ethtool_ops functions
-- *****************************************************************************/
--static void ftmac100_get_drvinfo(struct net_device *netdev,
-- struct ethtool_drvinfo *info)
--{
-- strcpy(info->driver, DRV_NAME);
-- strcpy(info->version, DRV_VERSION);
-- strcpy(info->bus_info, dev_name(&netdev->dev));
--}
--
--static int ftmac100_get_settings(struct net_device *netdev, struct ethtool_cmd *cmd)
--{
-- struct ftmac100 *priv = netdev_priv(netdev);
-- return mii_ethtool_gset(&priv->mii, cmd);
--}
--
--static int ftmac100_set_settings(struct net_device *netdev, struct ethtool_cmd *cmd)
--{
-- struct ftmac100 *priv = netdev_priv(netdev);
-- return mii_ethtool_sset(&priv->mii, cmd);
--}
--
--static int ftmac100_nway_reset(struct net_device *netdev)
-+static int ftmac100_suspend(struct platform_device *pdev, pm_message_t state)
- {
-- struct ftmac100 *priv = netdev_priv(netdev);
-- return mii_nway_restart(&priv->mii);
--}
--
--static u32 ftmac100_get_link(struct net_device *netdev)
--{
-- struct ftmac100 *priv = netdev_priv(netdev);
-- return mii_link_ok(&priv->mii);
--}
--
--static const struct ethtool_ops ftmac100_ethtool_ops = {
-- .set_settings = ftmac100_set_settings,
-- .get_settings = ftmac100_get_settings,
-- .get_drvinfo = ftmac100_get_drvinfo,
-- .nway_reset = ftmac100_nway_reset,
-- .get_link = ftmac100_get_link,
--};
--
--/******************************************************************************
-- * interrupt handler
-- *****************************************************************************/
--static irqreturn_t ftmac100_interrupt(int irq, void *dev_id)
--{
-- struct net_device *netdev = dev_id;
-- struct ftmac100 *priv = netdev_priv(netdev);
--
-- if (likely(netif_running(netdev))) {
-- /* Disable interrupts for polling */
-- ftmac100_disable_all_int(priv);
-- napi_schedule(&priv->napi);
-- }
--
-- return IRQ_HANDLED;
--}
--
--/******************************************************************************
-- * struct napi_struct functions
-- *****************************************************************************/
--static int ftmac100_poll(struct napi_struct *napi, int budget)
--{
-- struct ftmac100 *priv = container_of(napi, struct ftmac100, napi);
-- struct net_device *netdev = priv->netdev;
-- unsigned int status;
-- bool completed = true;
-- int rx = 0;
--
-- status = ioread32(priv->base + FTMAC100_OFFSET_ISR);
--
-- if (status & (FTMAC100_INT_RPKT_FINISH | FTMAC100_INT_NORXBUF)) {
-- /*
-- * FTMAC100_INT_RPKT_FINISH:
-- * RX DMA has received packets into RX buffer successfully
-- *
-- * FTMAC100_INT_NORXBUF:
-- * RX buffer unavailable
-- */
-- bool retry;
--
-- do {
-- retry = ftmac100_rx_packet(priv, &rx);
-- } while (retry && rx < budget);
-+ struct net_device *ndev = platform_get_drvdata(pdev);
-
-- if (retry && rx == budget)
-- completed = false;
-- }
--
-- if (status & (FTMAC100_INT_XPKT_OK | FTMAC100_INT_XPKT_LOST)) {
-- /*
-- * FTMAC100_INT_XPKT_OK:
-- * packet transmitted to ethernet successfully
-- *
-- * FTMAC100_INT_XPKT_LOST:
-- * packet transmitted to ethernet lost due to late
-- * collision or excessive collision
-- */
-- ftmac100_tx_complete(priv);
-- }
--
-- if (status & (FTMAC100_INT_NORXBUF | FTMAC100_INT_RPKT_LOST |
-- FTMAC100_INT_AHB_ERR | FTMAC100_INT_PHYSTS_CHG)) {
-- if (net_ratelimit())
-- netdev_info(netdev, "[ISR] = 0x%x: %s%s%s%s\n", status,
-- status & FTMAC100_INT_NORXBUF ? "NORXBUF " : "",
-- status & FTMAC100_INT_RPKT_LOST ? "RPKT_LOST " : "",
-- status & FTMAC100_INT_AHB_ERR ? "AHB_ERR " : "",
-- status & FTMAC100_INT_PHYSTS_CHG ? "PHYSTS_CHG" : "");
--
-- if (status & FTMAC100_INT_NORXBUF) {
-- /* RX buffer unavailable */
-- netdev->stats.rx_over_errors++;
-- }
--
-- if (status & FTMAC100_INT_RPKT_LOST) {
-- /* received packet lost due to RX FIFO full */
-- netdev->stats.rx_fifo_errors++;
-- }
--
-- if (status & FTMAC100_INT_PHYSTS_CHG) {
-- /* PHY link status change */
-- mii_check_link(&priv->mii);
-+ if (ndev) {
-+ if (netif_running(ndev)) {
-+ netif_device_detach(ndev);
-+ ftmac100_shutdown(ndev->base_addr);
- }
- }
--
-- if (completed) {
-- /* stop polling */
-- napi_complete(napi);
-- ftmac100_enable_all_int(priv);
-- }
--
-- return rx;
--}
--
--/******************************************************************************
-- * struct net_device_ops functions
-- *****************************************************************************/
--static int ftmac100_open(struct net_device *netdev)
--{
-- struct ftmac100 *priv = netdev_priv(netdev);
-- int err;
--
-- err = ftmac100_alloc_buffers(priv);
-- if (err) {
-- netdev_err(netdev, "failed to allocate buffers\n");
-- goto err_alloc;
-- }
--
-- err = request_irq(priv->irq, ftmac100_interrupt, 0, netdev->name, netdev);
-- if (err) {
-- netdev_err(netdev, "failed to request irq %d\n", priv->irq);
-- goto err_irq;
-- }
--
-- priv->rx_pointer = 0;
-- priv->tx_clean_pointer = 0;
-- priv->tx_pointer = 0;
-- priv->tx_pending = 0;
--
-- err = ftmac100_start_hw(priv);
-- if (err)
-- goto err_hw;
--
-- napi_enable(&priv->napi);
-- netif_start_queue(netdev);
--
-- ftmac100_enable_all_int(priv);
--
-- return 0;
--
--err_hw:
-- free_irq(priv->irq, netdev);
--err_irq:
-- ftmac100_free_buffers(priv);
--err_alloc:
-- return err;
--}
--
--static int ftmac100_stop(struct net_device *netdev)
--{
-- struct ftmac100 *priv = netdev_priv(netdev);
--
-- ftmac100_disable_all_int(priv);
-- netif_stop_queue(netdev);
-- napi_disable(&priv->napi);
-- ftmac100_stop_hw(priv);
-- free_irq(priv->irq, netdev);
-- ftmac100_free_buffers(priv);
--
- return 0;
- }
-
--static int ftmac100_hard_start_xmit(struct sk_buff *skb, struct net_device *netdev)
-+static int ftmac100_resume(struct platform_device *pdev)
- {
-- struct ftmac100 *priv = netdev_priv(netdev);
-- dma_addr_t map;
--
-- if (unlikely(skb->len > MAX_PKT_SIZE)) {
-- if (net_ratelimit())
-- netdev_dbg(netdev, "tx packet too big\n");
--
-- netdev->stats.tx_dropped++;
-- dev_kfree_skb(skb);
-- return NETDEV_TX_OK;
-- }
-+ struct net_device *ndev = platform_get_drvdata(pdev);
-
-- map = dma_map_single(priv->dev, skb->data, skb_headlen(skb), DMA_TO_DEVICE);
-- if (unlikely(dma_mapping_error(priv->dev, map))) {
-- /* drop packet */
-- if (net_ratelimit())
-- netdev_err(netdev, "map socket buffer failed\n");
--
-- netdev->stats.tx_dropped++;
-- dev_kfree_skb(skb);
-- return NETDEV_TX_OK;
-+ if (ndev) {
-+ if (netif_running(ndev)) {
-+ ftmac100_reset(ndev);
-+ ftmac100_enable(ndev);
-+ netif_device_attach(ndev);
-+ }
- }
--
-- return ftmac100_xmit(priv, skb, map);
-+ return 0;
- }
-
--/* optional */
--static int ftmac100_do_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
--{
-- struct ftmac100 *priv = netdev_priv(netdev);
-- struct mii_ioctl_data *data = if_mii(ifr);
--
-- return generic_mii_ioctl(&priv->mii, data, cmd, NULL);
-+static void platform_device_release(struct device *dev){
- }
-
--static const struct net_device_ops ftmac100_netdev_ops = {
-- .ndo_open = ftmac100_open,
-- .ndo_stop = ftmac100_stop,
-- .ndo_start_xmit = ftmac100_hard_start_xmit,
-- .ndo_set_mac_address = eth_mac_addr,
-- .ndo_validate_addr = eth_validate_addr,
-- .ndo_do_ioctl = ftmac100_do_ioctl,
-+static struct platform_driver ftmac100_driver = {
-+ .probe = ftmac100_probe,
-+ .remove = ftmac100_remove,
-+ .suspend = ftmac100_suspend,
-+ .resume = ftmac100_resume,
-+ .driver = {
-+ .name = "ftmac100",
-+ },
- };
-
--/******************************************************************************
-- * struct platform_driver functions
-- *****************************************************************************/
--static int ftmac100_probe(struct platform_device *pdev)
--{
-- struct resource *res;
-- int irq;
-- struct net_device *netdev;
-- struct ftmac100 *priv;
-- int err;
--
-- if (!pdev)
-- return -ENODEV;
--
-- res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
-- if (!res)
-- return -ENXIO;
--
-- irq = platform_get_irq(pdev, 0);
-- if (irq < 0)
-- return irq;
--
-- /* setup net_device */
-- netdev = alloc_etherdev(sizeof(*priv));
-- if (!netdev) {
-- err = -ENOMEM;
-- goto err_alloc_etherdev;
-- }
--
-- SET_NETDEV_DEV(netdev, &pdev->dev);
-- SET_ETHTOOL_OPS(netdev, &ftmac100_ethtool_ops);
-- netdev->netdev_ops = &ftmac100_netdev_ops;
--
-- platform_set_drvdata(pdev, netdev);
--
-- /* setup private data */
-- priv = netdev_priv(netdev);
-- priv->netdev = netdev;
-- priv->dev = &pdev->dev;
--
-- spin_lock_init(&priv->tx_lock);
--
-- /* initialize NAPI */
-- netif_napi_add(netdev, &priv->napi, ftmac100_poll, 64);
--
-- /* map io memory */
-- priv->res = request_mem_region(res->start, resource_size(res),
-- dev_name(&pdev->dev));
-- if (!priv->res) {
-- dev_err(&pdev->dev, "Could not reserve memory region\n");
-- err = -ENOMEM;
-- goto err_req_mem;
-- }
--
-- priv->base = ioremap(res->start, resource_size(res));
-- if (!priv->base) {
-- dev_err(&pdev->dev, "Failed to ioremap ethernet registers\n");
-- err = -EIO;
-- goto err_ioremap;
-- }
--
-- priv->irq = irq;
--
-- /* initialize struct mii_if_info */
-- priv->mii.phy_id = 0;
-- priv->mii.phy_id_mask = 0x1f;
-- priv->mii.reg_num_mask = 0x1f;
-- priv->mii.dev = netdev;
-- priv->mii.mdio_read = ftmac100_mdio_read;
-- priv->mii.mdio_write = ftmac100_mdio_write;
--
-- /* register network device */
-- err = register_netdev(netdev);
-- if (err) {
-- dev_err(&pdev->dev, "Failed to register netdev\n");
-- goto err_register_netdev;
-- }
--
-- netdev_info(netdev, "irq %d, mapped at %p\n", priv->irq, priv->base);
--
-- if (!is_valid_ether_addr(netdev->dev_addr)) {
-- eth_hw_addr_random(netdev);
-- netdev_info(netdev, "generated random MAC address %pM\n",
-- netdev->dev_addr);
-- }
--
-- return 0;
--
--err_register_netdev:
-- iounmap(priv->base);
--err_ioremap:
-- release_resource(priv->res);
--err_req_mem:
-- netif_napi_del(&priv->napi);
-- platform_set_drvdata(pdev, NULL);
-- free_netdev(netdev);
--err_alloc_etherdev:
-- return err;
--}
--
--static int __exit ftmac100_remove(struct platform_device *pdev)
--{
-- struct net_device *netdev;
-- struct ftmac100 *priv;
--
-- netdev = platform_get_drvdata(pdev);
-- priv = netdev_priv(netdev);
--
-- unregister_netdev(netdev);
--
-- iounmap(priv->base);
-- release_resource(priv->res);
--
-- netif_napi_del(&priv->napi);
-- platform_set_drvdata(pdev, NULL);
-- free_netdev(netdev);
-- return 0;
--}
-+static struct resource ftmac100_resources_a320[] = {
-+ [0] = {
-+ .start = MAC_FTMAC100_0_VA_BASE,
-+ .end = MAC_FTMAC100_0_VA_LIMIT,
-+ .flags = IORESOURCE_IO,
-+ },
-+ [1] = {
-+ .start = MAC_FTMAC100_0_IRQ,
-+ .flags = IORESOURCE_IRQ,
-+ },
-+};
-
--static struct platform_driver ftmac100_driver = {
-- .probe = ftmac100_probe,
-- .remove = __exit_p(ftmac100_remove),
-- .driver = {
-- .name = DRV_NAME,
-- .owner = THIS_MODULE,
-+static struct platform_device ftmac100_device_a320 = {
-+ .name = "ftmac100",
-+ .id = 0,
-+ .num_resources = ARRAY_SIZE(ftmac100_resources_a320),
-+ .resource = ftmac100_resources_a320,
-+ .dev = {
-+ .release = platform_device_release,
- },
- };
-
--/******************************************************************************
-- * initialization / finalization
-- *****************************************************************************/
-+
- static int __init ftmac100_init(void)
- {
-- pr_info("Loading version " DRV_VERSION " ...\n");
-+ platform_device_register(&ftmac100_device_a320);
- return platform_driver_register(&ftmac100_driver);
- }
-
- static void __exit ftmac100_exit(void)
- {
- platform_driver_unregister(&ftmac100_driver);
-+ platform_device_unregister(&ftmac100_device_a320);
- }
-
- module_init(ftmac100_init);
- module_exit(ftmac100_exit);
--
--MODULE_AUTHOR("Po-Yu Chuang <ratbert@faraday-tech.com>");
--MODULE_DESCRIPTION("FTMAC100 driver");
--MODULE_LICENSE("GPL");
-diff -Nur linux-3.4.113.orig/drivers/net/ethernet/faraday/ftmac100.h linux-3.4.113/drivers/net/ethernet/faraday/ftmac100.h
---- linux-3.4.113.orig/drivers/net/ethernet/faraday/ftmac100.h 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/net/ethernet/faraday/ftmac100.h 2016-12-01 20:59:24.388614139 +0100
-@@ -1,180 +1,267 @@
- /*
-- * Faraday FTMAC100 10/100 Ethernet
-+ * drivers/net/ftmac100.h
- *
-- * (C) Copyright 2009-2011 Faraday Technology
-- * Po-Yu Chuang <ratbert@faraday-tech.com>
-+ * Faraday FTMAC100 Device Driver
- *
-- * This program is free software; you can redistribute it and/or modify
-- * it under the terms of the GNU General Public License as published by
-- * the Free Software Foundation; either version 2 of the License, or
-- * (at your option) any later version.
-+ * Copyright (C) 2005 Faraday Corp. (http://www.faraday-tech.com)
-+ *
-+ * All Rights Reserved
- *
-- * This program is distributed in the hope that it will be useful,
-- * but WITHOUT ANY WARRANTY; without even the implied warranty of
-- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
-- * GNU General Public License for more details.
-- *
-- * You should have received a copy of the GNU General Public License
-- * along with this program; if not, write to the Free Software
-- * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
-- */
--
--#ifndef __FTMAC100_H
--#define __FTMAC100_H
--
--#define FTMAC100_OFFSET_ISR 0x00
--#define FTMAC100_OFFSET_IMR 0x04
--#define FTMAC100_OFFSET_MAC_MADR 0x08
--#define FTMAC100_OFFSET_MAC_LADR 0x0c
--#define FTMAC100_OFFSET_MAHT0 0x10
--#define FTMAC100_OFFSET_MAHT1 0x14
--#define FTMAC100_OFFSET_TXPD 0x18
--#define FTMAC100_OFFSET_RXPD 0x1c
--#define FTMAC100_OFFSET_TXR_BADR 0x20
--#define FTMAC100_OFFSET_RXR_BADR 0x24
--#define FTMAC100_OFFSET_ITC 0x28
--#define FTMAC100_OFFSET_APTC 0x2c
--#define FTMAC100_OFFSET_DBLAC 0x30
--#define FTMAC100_OFFSET_MACCR 0x88
--#define FTMAC100_OFFSET_MACSR 0x8c
--#define FTMAC100_OFFSET_PHYCR 0x90
--#define FTMAC100_OFFSET_PHYWDATA 0x94
--#define FTMAC100_OFFSET_FCR 0x98
--#define FTMAC100_OFFSET_BPR 0x9c
--#define FTMAC100_OFFSET_TS 0xc4
--#define FTMAC100_OFFSET_DMAFIFOS 0xc8
--#define FTMAC100_OFFSET_TM 0xcc
--#define FTMAC100_OFFSET_TX_MCOL_SCOL 0xd4
--#define FTMAC100_OFFSET_RPF_AEP 0xd8
--#define FTMAC100_OFFSET_XM_PG 0xdc
--#define FTMAC100_OFFSET_RUNT_TLCC 0xe0
--#define FTMAC100_OFFSET_CRCER_FTL 0xe4
--#define FTMAC100_OFFSET_RLC_RCC 0xe8
--#define FTMAC100_OFFSET_BROC 0xec
--#define FTMAC100_OFFSET_MULCA 0xf0
--#define FTMAC100_OFFSET_RP 0xf4
--#define FTMAC100_OFFSET_XP 0xf8
--
--/*
-- * Interrupt status register & interrupt mask register
-- */
--#define FTMAC100_INT_RPKT_FINISH (1 << 0)
--#define FTMAC100_INT_NORXBUF (1 << 1)
--#define FTMAC100_INT_XPKT_FINISH (1 << 2)
--#define FTMAC100_INT_NOTXBUF (1 << 3)
--#define FTMAC100_INT_XPKT_OK (1 << 4)
--#define FTMAC100_INT_XPKT_LOST (1 << 5)
--#define FTMAC100_INT_RPKT_SAV (1 << 6)
--#define FTMAC100_INT_RPKT_LOST (1 << 7)
--#define FTMAC100_INT_AHB_ERR (1 << 8)
--#define FTMAC100_INT_PHYSTS_CHG (1 << 9)
--
--/*
-- * Interrupt timer control register
- */
--#define FTMAC100_ITC_RXINT_CNT(x) (((x) & 0xf) << 0)
--#define FTMAC100_ITC_RXINT_THR(x) (((x) & 0x7) << 4)
--#define FTMAC100_ITC_RXINT_TIME_SEL (1 << 7)
--#define FTMAC100_ITC_TXINT_CNT(x) (((x) & 0xf) << 8)
--#define FTMAC100_ITC_TXINT_THR(x) (((x) & 0x7) << 12)
--#define FTMAC100_ITC_TXINT_TIME_SEL (1 << 15)
-
--/*
-- * Automatic polling timer control register
-- */
--#define FTMAC100_APTC_RXPOLL_CNT(x) (((x) & 0xf) << 0)
--#define FTMAC100_APTC_RXPOLL_TIME_SEL (1 << 4)
--#define FTMAC100_APTC_TXPOLL_CNT(x) (((x) & 0xf) << 8)
--#define FTMAC100_APTC_TXPOLL_TIME_SEL (1 << 12)
-+#ifndef _FTMAC100_H_
-+#define _FTMAC100_H_
-
--/*
-- * DMA burst length and arbitration control register
-- */
--#define FTMAC100_DBLAC_INCR4_EN (1 << 0)
--#define FTMAC100_DBLAC_INCR8_EN (1 << 1)
--#define FTMAC100_DBLAC_INCR16_EN (1 << 2)
--#define FTMAC100_DBLAC_RXFIFO_LTHR(x) (((x) & 0x7) << 3)
--#define FTMAC100_DBLAC_RXFIFO_HTHR(x) (((x) & 0x7) << 6)
--#define FTMAC100_DBLAC_RX_THR_EN (1 << 9)
-+#define ISR_REG 0x00 // interrups status register
-+#define IMR_REG 0x04 // interrupt maks register
-+#define MAC_MADR_REG 0x08 // MAC address (Most significant)
-+#define MAC_LADR_REG 0x0c // MAC address (Least significant)
-+
-+#define MAHT0_REG 0x10 // Multicast Address Hash Table 0 register
-+#define MAHT1_REG 0x14 // Multicast Address Hash Table 1 register
-+#define TXPD_REG 0x18 // Transmit Poll Demand register
-+#define RXPD_REG 0x1c // Receive Poll Demand register
-+#define TXR_BADR_REG 0x20 // Transmit Ring Base Address register
-+#define RXR_BADR_REG 0x24 // Receive Ring Base Address register
-+#define ITC_REG 0x28 // interrupt timer control register
-+#define APTC_REG 0x2c // Automatic Polling Timer control register
-+#define DBLAC_REG 0x30 // DMA Burst Length and Arbitration control register
-+
-+
-+
-+#define MACCR_REG 0x88 // MAC control register
-+#define MACSR_REG 0x8c // MAC status register
-+#define PHYCR_REG 0x90 // PHY control register
-+#define PHYWDATA_REG 0x94 // PHY Write Data register
-+#define FCR_REG 0x98 // Flow Control register
-+#define BPR_REG 0x9c // back pressure register
-+#define WOLCR_REG 0xa0 // Wake-On-Lan control register
-+#define WOLSR_REG 0xa4 // Wake-On-Lan status register
-+#define WFCRC_REG 0xa8 // Wake-up Frame CRC register
-+#define WFBM1_REG 0xb0 // wake-up frame byte mask 1st double word register
-+#define WFBM2_REG 0xb4 // wake-up frame byte mask 2nd double word register
-+#define WFBM3_REG 0xb8 // wake-up frame byte mask 3rd double word register
-+#define WFBM4_REG 0xbc // wake-up frame byte mask 4th double word register
-+#define TM_REG 0xcc // test mode register
-+
-+#define PHYSTS_CHG_bit (1UL<<9)
-+#define AHB_ERR_bit (1UL<<8)
-+#define RPKT_LOST_bit (1UL<<7)
-+#define RPKT_SAV_bit (1UL<<6)
-+#define XPKT_LOST_bit (1UL<<5)
-+#define XPKT_OK_bit (1UL<<4)
-+#define NOTXBUF_bit (1UL<<3)
-+#define XPKT_FINISH_bit (1UL<<2)
-+#define NORXBUF_bit (1UL<<1)
-+#define RPKT_FINISH_bit (1UL<<0)
-+
-+
-+#ifdef __NDS32_EB__
-+typedef struct
-+{
-+ unsigned int Reserved2:19;
-+ unsigned int TXPOLL_TIME_SEL:1;
-+ unsigned int TXPOLL_CNT:4;
-+ unsigned int Reserved1:3;
-+ unsigned int RXPOLL_TIME_SEL:1;
-+ unsigned int RXPOLL_CNT:4;
-+}FTMAC100_APTCR_Status;
-+#else
-+typedef struct
-+{
-+ unsigned int RXPOLL_CNT:4;
-+ unsigned int RXPOLL_TIME_SEL:1;
-+ unsigned int Reserved1:3;
-+ unsigned int TXPOLL_CNT:4;
-+ unsigned int TXPOLL_TIME_SEL:1;
-+ unsigned int Reserved2:19;
-+} FTMAC100_APTCR_Status;
-+#endif
-+
-+#define RX_BROADPKT_bit (1UL<<17) // Receiving broadcast packet
-+#define RX_MULTIPKT_bit (1UL<<16) // receiving multicast packet
-+#define FULLDUP_bit (1UL<<15) // full duplex
-+#define CRC_APD_bit (1UL<<14) // append crc to transmit packet
-+#define MDC_SEL_bit (1UL<<13) // set MDC as TX_CK/10
-+#define RCV_ALL_bit (1UL<<12) // not check incoming packet's destination address
-+#define RX_FTL_bit (1UL<<11) // Store incoming packet even its length is great than 1518 byte
-+#define RX_RUNT_bit (1UL<<10) // Store incoming packet even its length is les than 64 byte
-+#define HT_MULTI_EN_bit (1UL<<9)
-+#define RCV_EN_bit (1UL<<8) // receiver enable
-+#define XMT_EN_bit (1UL<<5) // transmitter enable
-+#define CRC_DIS_bit (1UL<<4)
-+#define LOOP_EN_bit (1UL<<3) // Internal loop-back
-+#define SW_RST_bit (1UL<<2) // software reset/
-+#define RDMA_EN_bit (1UL<<1) // enable DMA receiving channel
-+#define XDMA_EN_bit (1UL<<0) // enable DMA transmitting channel
-+
-+
-+// --------------------------------------------------------------------
-+// Receive Ring descriptor structure
-+// --------------------------------------------------------------------
-+#ifdef __NDS32_EB__
-+typedef struct
-+{
-+ // RXDES0
-+ unsigned int RXDMA_OWN:1; // 1 ==> owned by FTMAC100, 0 ==> owned by software
-+ unsigned int Reserved3:1;
-+ unsigned int FRS:1;
-+ unsigned int LRS:1;
-+ unsigned int Reserved2:5;
-+ unsigned int RX_ODD_NB:1;
-+ unsigned int RUNT:1;
-+ unsigned int FTL:1;
-+ unsigned int CRC_ERR:1; //19
-+ unsigned int RX_ERR:1; //18
-+ unsigned int BROARDCAST:1; //17
-+ unsigned int MULTICAST:1; //16
-+ unsigned int Reserved1:5; //11~15
-+ unsigned int ReceiveFrameLength:11;//0~10
-+
-+ // RXDES1
-+ unsigned int EDOTR:1;
-+ unsigned int Reserved:20;
-+ unsigned int RXBUF_Size:11;
-+
-+ // RXDES2
-+ unsigned int RXBUF_BADR;
-+
-+ unsigned int VIR_RXBUF_BADR; // not defined, §Ú­Ì®³¨Ó©ñ receive buffer ªº virtual address
-+
-+}RX_DESC;
-+
-+
-+typedef struct
-+{
-+ // TXDES0
-+ unsigned int TXDMA_OWN:1;
-+ unsigned int Reserved1:29;
-+ unsigned int TXPKT_EXSCOL:1;
-+ unsigned int TXPKT_LATECOL:1;
-+
-+ // TXDES1
-+ unsigned int EDOTR:1;
-+ unsigned int TXIC:1;
-+ unsigned int TX2FIC:1;
-+ unsigned int FTS:1;
-+ unsigned int LTS:1;
-+ unsigned int Reserved2:16;
-+ unsigned int TXBUF_Size:11;
-+
-+ // RXDES2
-+ unsigned int TXBUF_BADR;
-+ unsigned int VIR_TXBUF_BADR;
-+}TX_DESC;
-+#else
-+typedef struct
-+{
-+ // RXDES0
-+ unsigned int ReceiveFrameLength:11;//0~10
-+ unsigned int Reserved1:5; //11~15
-+ unsigned int MULTICAST:1; //16
-+ unsigned int BROARDCAST:1; //17
-+ unsigned int RX_ERR:1; //18
-+ unsigned int CRC_ERR:1; //19
-+ unsigned int FTL:1;
-+ unsigned int RUNT:1;
-+ unsigned int RX_ODD_NB:1;
-+ unsigned int Reserved2:5;
-+ unsigned int LRS:1;
-+ unsigned int FRS:1;
-+ unsigned int Reserved3:1;
-+ unsigned int RXDMA_OWN:1; // 1 ==> owned by FTMAC100, 0 ==> owned by software
-+
-+ // RXDES1
-+ unsigned int RXBUF_Size:11;
-+ unsigned int Reserved:20;
-+ unsigned int EDOTR:1;
-+
-+ // RXDES2
-+ unsigned int RXBUF_BADR;
-+
-+ unsigned int VIR_RXBUF_BADR; // not defined, §Ú­Ì®³¨Ó©ñ receive buffer ªº virtual address
-+
-+} RX_DESC;
-+
-+
-+typedef struct
-+{
-+ // TXDES0
-+ unsigned int TXPKT_LATECOL:1;
-+ unsigned int TXPKT_EXSCOL:1;
-+ unsigned int Reserved1:29;
-+ unsigned int TXDMA_OWN:1;
-+
-+ // TXDES1
-+ unsigned int TXBUF_Size:11;
-+ unsigned int Reserved2:16;
-+ unsigned int LTS:1;
-+ unsigned int FTS:1;
-+ unsigned int TX2FIC:1;
-+ unsigned int TXIC:1;
-+ unsigned int EDOTR:1;
-+
-+ // RXDES2
-+ unsigned int TXBUF_BADR;
-+ unsigned int VIR_TXBUF_BADR;
-+} TX_DESC;
-+#endif
-+
-+// waiting to do:
-+#define TXPOLL_CNT 8
-+#define RXPOLL_CNT 0
-+
-+#define OWNBY_SOFTWARE 0
-+#define OWNBY_FTMAC100 1
-+
-+// --------------------------------------------------------------------
-+// driver related definition
-+// --------------------------------------------------------------------
-+#define RXDES_NUM 256 // must be 2's power
-+#define RX_BUF_SIZE 1536
-+#define TXDES_NUM 64 // must be 2's power
-+#define TX_BUF_SIZE 1536 // Luke Lee : Just bigger than 1518
-+
-+
-+struct ftmac100_local
-+{
-+ // these are things that the kernel wants me to keep, so users
-+ // can find out semi-useless statistics of how well the card is
-+ // performing
-+ struct net_device_stats stats;
-+
-+ // Set to true during the auto-negotiation sequence
-+ int autoneg_active;
-+
-+ // Address of our PHY port
-+ unsigned int phyaddr;
-+
-+ // Type of PHY
-+ unsigned int phytype;
-+
-+ // Last contents of PHY Register 18
-+ unsigned int lastPhy18;
-+
-+ spinlock_t lock;
-+
-+ volatile RX_DESC *rx_descs; // receive ring base address
-+ unsigned int rx_descs_dma; // receive ring physical base address
-+ char *rx_buf; // receive buffer cpu address
-+ int rx_buf_dma; // receive buffer physical address
-+ int rx_idx; // receive descriptor
-+ //struct sk_buff *rx_skbuff[RXDES_NUM];
-+
-+ volatile TX_DESC *tx_descs;
-+ unsigned int tx_descs_dma;
-+ char *tx_buf;
-+ int tx_buf_dma;
-+ int tx_idx;
-+ int old_tx;
-+ struct sk_buff *tx_skbuff[RXDES_NUM];
-+
-+ int maccr_val;
-+};
-
--/*
-- * MAC control register
-- */
--#define FTMAC100_MACCR_XDMA_EN (1 << 0)
--#define FTMAC100_MACCR_RDMA_EN (1 << 1)
--#define FTMAC100_MACCR_SW_RST (1 << 2)
--#define FTMAC100_MACCR_LOOP_EN (1 << 3)
--#define FTMAC100_MACCR_CRC_DIS (1 << 4)
--#define FTMAC100_MACCR_XMT_EN (1 << 5)
--#define FTMAC100_MACCR_ENRX_IN_HALFTX (1 << 6)
--#define FTMAC100_MACCR_RCV_EN (1 << 8)
--#define FTMAC100_MACCR_HT_MULTI_EN (1 << 9)
--#define FTMAC100_MACCR_RX_RUNT (1 << 10)
--#define FTMAC100_MACCR_RX_FTL (1 << 11)
--#define FTMAC100_MACCR_RCV_ALL (1 << 12)
--#define FTMAC100_MACCR_CRC_APD (1 << 14)
--#define FTMAC100_MACCR_FULLDUP (1 << 15)
--#define FTMAC100_MACCR_RX_MULTIPKT (1 << 16)
--#define FTMAC100_MACCR_RX_BROADPKT (1 << 17)
--
--/*
-- * PHY control register
-- */
--#define FTMAC100_PHYCR_MIIRDATA 0xffff
--#define FTMAC100_PHYCR_PHYAD(x) (((x) & 0x1f) << 16)
--#define FTMAC100_PHYCR_REGAD(x) (((x) & 0x1f) << 21)
--#define FTMAC100_PHYCR_MIIRD (1 << 26)
--#define FTMAC100_PHYCR_MIIWR (1 << 27)
--
--/*
-- * PHY write data register
-- */
--#define FTMAC100_PHYWDATA_MIIWDATA(x) ((x) & 0xffff)
--
--/*
-- * Transmit descriptor, aligned to 16 bytes
-- */
--struct ftmac100_txdes {
-- unsigned int txdes0;
-- unsigned int txdes1;
-- unsigned int txdes2; /* TXBUF_BADR */
-- unsigned int txdes3; /* not used by HW */
--} __attribute__ ((aligned(16)));
--
--#define FTMAC100_TXDES0_TXPKT_LATECOL (1 << 0)
--#define FTMAC100_TXDES0_TXPKT_EXSCOL (1 << 1)
--#define FTMAC100_TXDES0_TXDMA_OWN (1 << 31)
--
--#define FTMAC100_TXDES1_TXBUF_SIZE(x) ((x) & 0x7ff)
--#define FTMAC100_TXDES1_LTS (1 << 27)
--#define FTMAC100_TXDES1_FTS (1 << 28)
--#define FTMAC100_TXDES1_TX2FIC (1 << 29)
--#define FTMAC100_TXDES1_TXIC (1 << 30)
--#define FTMAC100_TXDES1_EDOTR (1 << 31)
--
--/*
-- * Receive descriptor, aligned to 16 bytes
-- */
--struct ftmac100_rxdes {
-- unsigned int rxdes0;
-- unsigned int rxdes1;
-- unsigned int rxdes2; /* RXBUF_BADR */
-- unsigned int rxdes3; /* not used by HW */
--} __attribute__ ((aligned(16)));
--
--#define FTMAC100_RXDES0_RFL 0x7ff
--#define FTMAC100_RXDES0_MULTICAST (1 << 16)
--#define FTMAC100_RXDES0_BROADCAST (1 << 17)
--#define FTMAC100_RXDES0_RX_ERR (1 << 18)
--#define FTMAC100_RXDES0_CRC_ERR (1 << 19)
--#define FTMAC100_RXDES0_FTL (1 << 20)
--#define FTMAC100_RXDES0_RUNT (1 << 21)
--#define FTMAC100_RXDES0_RX_ODD_NB (1 << 22)
--#define FTMAC100_RXDES0_LRS (1 << 28)
--#define FTMAC100_RXDES0_FRS (1 << 29)
--#define FTMAC100_RXDES0_RXDMA_OWN (1 << 31)
-+#endif
-
--#define FTMAC100_RXDES1_RXBUF_SIZE(x) ((x) & 0x7ff)
--#define FTMAC100_RXDES1_EDORR (1 << 31)
-
--#endif /* __FTMAC100_H */
-diff -Nur linux-3.4.113.orig/drivers/net/ethernet/faraday/Kconfig linux-3.4.113/drivers/net/ethernet/faraday/Kconfig
---- linux-3.4.113.orig/drivers/net/ethernet/faraday/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/net/ethernet/faraday/Kconfig 2016-12-01 20:59:24.388614139 +0100
-@@ -5,7 +5,7 @@
- config NET_VENDOR_FARADAY
- bool "Faraday devices"
- default y
-- depends on ARM
-+ depends on ARM || NDS32
- ---help---
- If you have a network (Ethernet) card belonging to this class, say Y
- and read the Ethernet-HOWTO, available from
-@@ -20,7 +20,7 @@
-
- config FTMAC100
- tristate "Faraday FTMAC100 10/100 Ethernet support"
-- depends on ARM
-+ depends on ARM || NDS32
- select NET_CORE
- select MII
- ---help---
-diff -Nur linux-3.4.113.orig/drivers/pci/Makefile linux-3.4.113/drivers/pci/Makefile
---- linux-3.4.113.orig/drivers/pci/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/pci/Makefile 2016-12-01 20:59:24.388614139 +0100
-@@ -49,6 +49,7 @@
- obj-$(CONFIG_MICROBLAZE) += setup-bus.o
- obj-$(CONFIG_TILE) += setup-bus.o setup-irq.o
- obj-$(CONFIG_SPARC_LEON) += setup-bus.o setup-irq.o
-+obj-$(CONFIG_NDS32) += setup-bus.o setup-irq.o
-
- #
- # ACPI Related PCI FW Functions
-diff -Nur linux-3.4.113.orig/drivers/rtc/Kconfig linux-3.4.113/drivers/rtc/Kconfig
---- linux-3.4.113.orig/drivers/rtc/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/rtc/Kconfig 2016-12-01 20:59:24.388614139 +0100
-@@ -779,6 +779,16 @@
- This driver can also be built as a module. If so, the module
- will be called rtc-ep93xx.
-
-+config RTC_DRV_FTRTC010
-+ tristate "Faraday Real Time Clock"
-+ depends on NDS32
-+ help
-+ If you say Y here you will get access to the real time clock
-+ built into your AG101 CPU.
-+
-+ To compile this driver as a module, choose M here: the
-+ module will be called rtc-ftrtc010.
-+
- config RTC_DRV_SA1100
- tristate "SA11x0/PXA2xx/PXA910"
- depends on ARCH_SA1100 || ARCH_PXA || ARCH_MMP
-diff -Nur linux-3.4.113.orig/drivers/rtc/Makefile linux-3.4.113/drivers/rtc/Makefile
---- linux-3.4.113.orig/drivers/rtc/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/rtc/Makefile 2016-12-01 20:59:24.388614139 +0100
-@@ -50,6 +50,7 @@
- obj-$(CONFIG_RTC_DRV_FM3130) += rtc-fm3130.o
- obj-$(CONFIG_RTC_DRV_GENERIC) += rtc-generic.o
- obj-$(CONFIG_RTC_DRV_IMXDI) += rtc-imxdi.o
-+obj-$(CONFIG_RTC_DRV_FTRTC010) += rtc-ftrtc010.o
- obj-$(CONFIG_RTC_DRV_ISL1208) += rtc-isl1208.o
- obj-$(CONFIG_RTC_DRV_ISL12022) += rtc-isl12022.o
- obj-$(CONFIG_RTC_DRV_JZ4740) += rtc-jz4740.o
-diff -Nur linux-3.4.113.orig/drivers/rtc/rtc-ftrtc010.c linux-3.4.113/drivers/rtc/rtc-ftrtc010.c
---- linux-3.4.113.orig/drivers/rtc/rtc-ftrtc010.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/rtc/rtc-ftrtc010.c 2016-12-01 20:59:24.388614139 +0100
-@@ -0,0 +1,371 @@
-+/*
-+ * Faraday RTC Support
-+ *
-+ * Copyright (C) 2006, 2007, 2008 Paul Mundt
-+ * Copyright (C) 2006 Jamie Lenehan
-+ * Copyright (C) 2008 Angelo Castello
-+ * Copyright (C) 2008 Roy Lee
-+ *
-+ * Based on the old arch/sh/kernel/cpu/rtc.c by:
-+ *
-+ * Copyright (C) 2000 Philipp Rumpf <prumpf@tux.org>
-+ * Copyright (C) 1999 Tetsuya Okada & Niibe Yutaka
-+ *
-+ * This file is subject to the terms and conditions of the GNU General Public
-+ * License. See the file "COPYING" in the main directory of this archive
-+ * for more details.
-+ */
-+#include <linux/module.h>
-+#include <linux/kernel.h>
-+#include <linux/rtc.h>
-+#include <linux/delay.h>
-+#include <linux/init.h>
-+#include <linux/platform_device.h>
-+#include <linux/seq_file.h>
-+#include <linux/interrupt.h>
-+#include <linux/io.h>
-+
-+#define PCLK ( AHB_CLK_IN / 2)
-+
-+#define DRV_NAME "faraday-rtc"
-+
-+#define RTC_REG( off) ( *( volatile unsigned long *)( rtc->regbase + ( off)))
-+
-+#define RTC_CR RTC_REG( 0x20) /* Control */
-+#define RTC_CR_IE ( 0x1UL << 0)
-+#define RTC_CR_IES ( 0x1UL << 1)
-+#define RTC_CR_IEM ( 0x1UL << 2)
-+#define RTC_CR_IEH ( 0x1UL << 3)
-+#define RTC_CR_IED ( 0x1UL << 4)
-+#define RTC_CR_ALRM ( 0x1UL << 5)
-+#define RTC_CR_LOAD ( 0x1UL << 6)
-+
-+#define RTC_RR RTC_REG( 0x1C) /* RTC Record Register */
-+#define RTC_DIV RTC_REG( 0x38) /* RTC Divede Register */
-+#define RTC_REV RTC_REG( 0x3C) /* RTC Divede Register */
-+
-+#define RTC_IR RTC_REG( 0x34) /* RTC interrupt state */
-+#define RTC_IR_IES ( 0x1UL << 0) /* RTC interrupt state */
-+#define RTC_IR_IEM ( 0x1UL << 1) /* RTC interrupt state */
-+#define RTC_IR_IEH ( 0x1UL << 2) /* RTC interrupt state */
-+#define RTC_IR_IED ( 0x1UL << 3) /* RTC interrupt state */
-+#define RTC_IR_ALRM ( 0x1UL << 4) /* RTC interrupt state */
-+
-+#define RTC_SECOND RTC_REG( 0x00) /* RTC sec */
-+#define RTC_MINUTE RTC_REG( 0x04) /* RTC min */
-+#define RTC_HOUR RTC_REG( 0x08) /* RTC hour */
-+#define RTC_DAYS RTC_REG( 0x0C) /* RTC day */
-+
-+#define RTC_ALRM_SECOND RTC_REG( 0x10) /* RTC alarm sec */
-+#define RTC_ALRM_MINUTE RTC_REG( 0x14) /* RTC alarm min */
-+#define RTC_ALRM_HOUR RTC_REG( 0x18) /* RTC alarm hour */
-+
-+#define RTC_WRITE_SECOND RTC_REG( 0x24) /* RTC write port for sec */
-+#define RTC_WRITE_MINUTE RTC_REG( 0x28) /* RTC write port for min */
-+#define RTC_WRITE_HOUR RTC_REG( 0x2C) /* RTC write port for hour */
-+#define RTC_WRITE_DAYS RTC_REG( 0x30) /* RTC write port for day */
-+
-+struct ft_rtc{
-+
-+ void __iomem *regbase;
-+ struct resource *res;
-+ unsigned int alarm_irq;
-+ unsigned int interrupt_irq;
-+ struct rtc_device *rtc_dev;
-+ spinlock_t lock; /* Protects this structure */
-+};
-+
-+struct ft_rtc rtc_platform_data;
-+
-+static irqreturn_t ft_rtc_interrupt( int irq, void *dev_id){
-+
-+ struct ft_rtc *rtc = dev_id;
-+ if( RTC_IR & RTC_IR_IES){
-+
-+ RTC_IR &= ~RTC_IR_IES;
-+ rtc_update_irq( rtc->rtc_dev, 1, RTC_UF | RTC_IRQF);
-+
-+ return IRQ_HANDLED;
-+ }
-+
-+ return IRQ_NONE;
-+}
-+
-+static irqreturn_t ft_rtc_alarm( int irq, void *dev_id){
-+
-+ struct ft_rtc *rtc = dev_id;
-+ if( RTC_IR & RTC_IR_ALRM){
-+
-+ RTC_CR &= ~RTC_CR_ALRM;
-+ RTC_IR &= ~RTC_IR_ALRM;
-+ rtc_update_irq( rtc->rtc_dev, 1, RTC_AF | RTC_IRQF);
-+
-+ return IRQ_HANDLED;
-+ }
-+
-+ return IRQ_NONE;
-+}
-+
-+static void ft_rtc_release( struct device *dev){
-+
-+ struct ft_rtc *rtc = dev_get_drvdata( dev);
-+
-+ RTC_CR &= ~RTC_CR_IES;
-+ RTC_CR &= ~RTC_CR_ALRM;
-+}
-+
-+/* rick add */
-+static int ft_alarm_irq_enable(struct device *dev, unsigned int enabled)
-+{
-+// printk("\n\nft_alarm_irq_enable\n\n");
-+
-+ struct ft_rtc *rtc = dev_get_drvdata( dev);
-+ spin_lock_irq(&rtc->lock);
-+ if (enabled)
-+ RTC_CR |= RTC_CR_ALRM;
-+ else
-+ RTC_CR &= ~RTC_CR_ALRM;
-+ spin_unlock_irq(&rtc->lock);
-+ return 0;
-+}
-+
-+static int ft_rtc_read_time( struct device *dev, struct rtc_time *tm){
-+ struct ft_rtc *rtc = dev_get_drvdata( dev);
-+ unsigned long time = RTC_DAYS * 86400 + RTC_HOUR * 3600 + RTC_MINUTE * 60 + RTC_SECOND;
-+ rtc_time_to_tm( time, tm);
-+ if( rtc_valid_tm( tm) < 0) {
-+ dev_err( dev, "invalid date\n");
-+ rtc_time_to_tm( 0, tm);
-+ }
-+ return 0;
-+}
-+
-+static int ft_rtc_set_time( struct device *dev, struct rtc_time *tm){
-+
-+ struct ft_rtc *rtc = dev_get_drvdata( dev);
-+ unsigned long time = 0;
-+
-+ rtc_tm_to_time( tm, &time);
-+
-+ RTC_WRITE_DAYS = time / 86400;
-+ time %= 86400;
-+
-+ RTC_WRITE_HOUR = time / 3600;
-+ time %= 3600;
-+
-+ RTC_WRITE_MINUTE = time / 60;
-+ time %= 60;
-+
-+ RTC_WRITE_SECOND = time;
-+
-+ RTC_CR |= RTC_CR_LOAD;
-+
-+ return 0;
-+}
-+
-+static int ft_rtc_read_alarm( struct device *dev, struct rtc_wkalrm *wkalrm){
-+
-+ struct ft_rtc *rtc = dev_get_drvdata( dev);
-+ struct rtc_time *tm = &wkalrm->time;
-+
-+ tm->tm_sec = RTC_ALRM_SECOND;
-+ tm->tm_min = RTC_ALRM_MINUTE;
-+ tm->tm_hour = RTC_ALRM_HOUR;
-+
-+ wkalrm->enabled = ( RTC_CR & RTC_CR_ALRM) ? 1 : 0;
-+
-+ return 0;
-+}
-+
-+static int ft_rtc_set_alarm( struct device *dev, struct rtc_wkalrm *wkalrm){
-+
-+ struct ft_rtc *rtc = dev_get_drvdata( dev);
-+ struct rtc_time *tm = &wkalrm->time;
-+ int err = rtc_valid_tm( tm);
-+ if( err < 0){
-+
-+ dev_err( dev, "invalid alarm value\n");
-+ return err;
-+ }
-+
-+ /* disable alarm interrupt and clear the alarm flag */
-+ RTC_CR &= ~RTC_CR_ALRM;
-+
-+ /* set alarm time */
-+ RTC_ALRM_SECOND = tm->tm_sec;
-+ RTC_ALRM_MINUTE = tm->tm_min;
-+ RTC_ALRM_HOUR = tm->tm_hour;
-+
-+ if( wkalrm->enabled)
-+ RTC_CR |= RTC_CR_ALRM;
-+
-+ return 0;
-+}
-+
-+/*
-+static int ft_rtc_irq_set_state( struct device *dev, int enabled){
-+ struct ft_rtc *rtc = dev_get_drvdata( dev);
-+ if( enabled)
-+ RTC_CR |= RTC_CR_IES;
-+ else
-+ RTC_CR &= ~RTC_CR_IES;
-+
-+ return 0;
-+}
-+
-+*/
-+
-+static struct rtc_class_ops ft_rtc_ops = {
-+
-+ .release = ft_rtc_release,
-+ .alarm_irq_enable = ft_alarm_irq_enable,
-+
-+ .read_time = ft_rtc_read_time,
-+ .set_time = ft_rtc_set_time,
-+ .read_alarm = ft_rtc_read_alarm,
-+ .set_alarm = ft_rtc_set_alarm,
-+};
-+
-+static int __devinit ft_rtc_probe( struct platform_device *pdev){
-+
-+ struct ft_rtc *rtc = &rtc_platform_data;
-+ int ret = -ENOENT;
-+ spin_lock_init(&rtc->lock);
-+
-+ if( ( rtc->alarm_irq = platform_get_irq( pdev, 0)) < 0)
-+ goto err_exit;
-+
-+ if( ( rtc->interrupt_irq = platform_get_irq( pdev, 1)) < 0)
-+ goto err_exit;
-+
-+ if( !( rtc->res = platform_get_resource( pdev, IORESOURCE_MEM, 0)))
-+ goto err_exit;
-+
-+ if( ( ret = request_irq( rtc->alarm_irq , ft_rtc_alarm, 0, "RTC Alarm : ftrtc010", rtc)))
-+ goto err_exit;
-+
-+ if( ( ret = request_irq( rtc->interrupt_irq , ft_rtc_interrupt, 0, "RTC Interrupt : ftrtc010", rtc)))
-+ goto err_interrupt_irq;
-+
-+ ret = -EBUSY;
-+
-+ if( !( rtc->res = request_mem_region( rtc->res->start, rtc->res->end - rtc->res->start + 1, pdev->name)))
-+ goto err_request_region;
-+
-+ ret = -EINVAL;
-+
-+ if( !( rtc->regbase = ioremap_nocache( rtc->res->start, rtc->res->end - rtc->res->start + 1)))
-+ goto err_ioremap1;
-+
-+
-+ //RTC_DIV = ( 0x1UL << 31) | 2; /* AG101 */
-+ RTC_CR |= RTC_CR_IE;
-+ platform_set_drvdata( pdev, rtc);
-+ device_init_wakeup(&pdev->dev, true);
-+
-+ rtc->rtc_dev = rtc_device_register( DRV_NAME, &pdev->dev, &ft_rtc_ops, THIS_MODULE);
-+
-+ if( IS_ERR( rtc->rtc_dev)) {
-+
-+ ret = PTR_ERR( rtc->rtc_dev);
-+ goto err_unmap;
-+ }
-+
-+ rtc->rtc_dev->max_user_freq = 256;
-+ rtc->rtc_dev->irq_freq = 1;
-+ return 0;
-+
-+err_unmap:
-+ iounmap( rtc->regbase);
-+err_ioremap1:
-+ release_resource( rtc->res);
-+err_request_region:
-+ free_irq( rtc->interrupt_irq, rtc);
-+err_interrupt_irq:
-+ free_irq( rtc->alarm_irq, rtc);
-+err_exit:
-+ return ret;
-+}
-+
-+static int __devexit ft_rtc_remove( struct platform_device *pdev){
-+
-+ struct ft_rtc *rtc = platform_get_drvdata( pdev);
-+
-+ rtc_device_unregister( rtc->rtc_dev);
-+
-+ RTC_CR &= ~RTC_CR_ALRM;
-+
-+ free_irq( rtc->alarm_irq, rtc);
-+ free_irq( rtc->interrupt_irq, rtc);
-+
-+ iounmap( rtc->regbase);
-+
-+ platform_set_drvdata( pdev, NULL);
-+
-+ return 0;
-+}
-+
-+static void platform_device_release(struct device *dev){
-+}
-+
-+static struct resource rtc_resources[] = {
-+ {
-+ .start = RTC_FTRTC010_PA_BASE,
-+ .end = RTC_FTRTC010_PA_LIMIT,
-+ .flags = IORESOURCE_MEM,
-+ },
-+ {
-+ .start = RTC_FTRTC010_IRQ0,
-+ .end = RTC_FTRTC010_IRQ0,
-+ .flags = IORESOURCE_IRQ,
-+ },
-+ {
-+ .start = RTC_FTRTC010_IRQ1,
-+ .end = RTC_FTRTC010_IRQ1,
-+ .flags = IORESOURCE_IRQ,
-+ },
-+};
-+
-+static struct platform_driver ft_rtc_platform_driver = {
-+
-+ .driver = {
-+ .name = DRV_NAME,
-+ .owner = THIS_MODULE,
-+ },
-+ .probe = ft_rtc_probe,
-+ .remove = __devexit_p( ft_rtc_remove),
-+};
-+
-+static struct platform_device rtc_device = {
-+
-+ .name = DRV_NAME,
-+ .id = 0,
-+ .resource = rtc_resources,
-+ .num_resources = ARRAY_SIZE( rtc_resources),
-+ .dev = {
-+ .platform_data = &rtc_platform_data,
-+ .release = platform_device_release,
-+ },
-+};
-+
-+static int __init ft_rtc_init( void){
-+ platform_device_register( &rtc_device);
-+ return platform_driver_register( &ft_rtc_platform_driver);
-+}
-+
-+static void __exit ft_rtc_exit( void){
-+
-+ platform_driver_unregister( &ft_rtc_platform_driver);
-+ platform_device_unregister( &rtc_device);
-+}
-+
-+module_init( ft_rtc_init);
-+module_exit( ft_rtc_exit);
-+
-+MODULE_DESCRIPTION( "SuperH on-chip RTC driver");
-+MODULE_AUTHOR( "Paul Mundt <lethal@linux-sh.org>, "
-+ "Jamie Lenehan <lenehan@twibble.org>, "
-+ "Angelo Castello <angelo.castello@st.com>, "
-+ "Roy Lee <roylee@andestech.com>");
-+MODULE_LICENSE( "GPL");
-+MODULE_ALIAS( "platform:" DRV_NAME);
-diff -Nur linux-3.4.113.orig/drivers/tty/serial/8250/8250.c linux-3.4.113/drivers/tty/serial/8250/8250.c
---- linux-3.4.113.orig/drivers/tty/serial/8250/8250.c 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/tty/serial/8250/8250.c 2016-12-01 20:59:24.392614293 +0100
-@@ -570,6 +570,7 @@
- serial_out(up, UART_ICR, value);
- }
-
-+#ifndef CONFIG_NDS32
- static unsigned int serial_icr_read(struct uart_8250_port *up, int offset)
- {
- unsigned int value;
-@@ -581,6 +582,7 @@
-
- return value;
- }
-+#endif
-
- /*
- * FIFO support.
-@@ -722,6 +724,7 @@
- return count;
- }
-
-+#ifndef CONFIG_NDS32
- /*
- * Read UART ID using the divisor method - set DLL and DLM to zero
- * and the revision will be in DLL and device type in DLM. We
-@@ -749,7 +752,9 @@
-
- return id;
- }
-+#endif
-
-+#ifndef CONFIG_NDS32
- /*
- * This is a helper routine to autodetect StarTech/Exar/Oxsemi UART's.
- * When this function is called we know it is at least a StarTech
-@@ -842,6 +847,7 @@
- else
- up->port.type = PORT_16650V2;
- }
-+#endif
-
- /*
- * We detected a chip without a FIFO. Only two fall into
-@@ -865,6 +871,7 @@
- up->port.type = PORT_16450;
- }
-
-+#ifndef CONFIG_NDS32
- static int broken_efr(struct uart_8250_port *up)
- {
- /*
-@@ -877,6 +884,7 @@
-
- return 0;
- }
-+#endif
-
- static inline int ns16550a_goto_highspeed(struct uart_8250_port *up)
- {
-@@ -908,7 +916,7 @@
-
- up->port.type = PORT_16550A;
- up->capabilities |= UART_CAP_FIFO;
--
-+#ifndef CONFIG_NDS32
- /*
- * Check for presence of the EFR when DLAB is set.
- * Only ST16C650V1 UARTs pass this test.
-@@ -937,6 +945,7 @@
- autoconfig_has_efr(up);
- return;
- }
-+#endif
-
- /*
- * Check for a National Semiconductor SuperIO chip.
-@@ -1156,10 +1165,11 @@
- * We also initialise the EFR (if any) to zero for later. The
- * EFR occupies the same register location as the FCR and IIR.
- */
-+#ifndef CONFIG_NDS32
- serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
- serial_out(up, UART_EFR, 0);
- serial_out(up, UART_LCR, 0);
--
-+#endif
- serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO);
- scratch = serial_in(up, UART_IIR) >> 6;
-
-diff -Nur linux-3.4.113.orig/drivers/video/FTLCDC100/faradayfb.h linux-3.4.113/drivers/video/FTLCDC100/faradayfb.h
---- linux-3.4.113.orig/drivers/video/FTLCDC100/faradayfb.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/video/FTLCDC100/faradayfb.h 2016-12-01 20:59:24.392614293 +0100
-@@ -0,0 +1,215 @@
-+#ifndef __FARADAYFB_H
-+#define __FARADAYFB_H
-+
-+#define FARADAYFB_MODULE_NAME "faradayfb"
-+#define DEBUG(enabled, tagged, ...) \
-+ do { \
-+ if (enabled) { \
-+ if (tagged) \
-+ printk("[ %30s() ] ", __func__); \
-+ printk(__VA_ARGS__); \
-+ } \
-+ } while (0)
-+
-+#if defined(CONFIG_FFB_MODE_RGB)
-+# define DEFAULT_COLOR FFB_MODE_RGB
-+#elif defined(CONFIG_FFB_MODE_YUV422)
-+# define DEFAULT_COLOR FFB_MODE_YUV422
-+#elif defined(CONFIG_FFB_MODE_YUV420)
-+# define DEFAULT_COLOR FFB_MODE_YUV420
-+#endif
-+
-+#if defined(CONFIG_FFB_MODE_8BPP)
-+# define DEFAULT_BPP FFB_MODE_8BPP
-+#elif defined(CONFIG_FFB_MODE_16BPP)
-+# define DEFAULT_BPP FFB_MODE_16BPP
-+#elif defined(CONFIG_FFB_MODE_24BPP)
-+# define DEFAULT_BPP FFB_MODE_24BPP
-+#endif
-+
-+#define FFB_DEFAULT_MODE (DEFAULT_COLOR | DEFAULT_BPP)
-+
-+struct lcd_param {
-+
-+ unsigned long value;
-+ unsigned long flags;
-+};
-+
-+inline struct lcd_param* get_lcd_time(struct lcd_param* array, unsigned long num_array, unsigned long type)
-+{
-+ int i;
-+
-+ for (i = 0; i < num_array; i++) {
-+
-+ struct lcd_param *r = &array[i];
-+
-+ if (r->flags & type & 0xff)
-+ return r;
-+ }
-+
-+ return NULL;
-+}
-+
-+inline struct lcd_param* get_lcd_ctrl(struct lcd_param* array, unsigned long num_array, unsigned long type)
-+{
-+ int i;
-+
-+ for (i = 0; i < num_array; i++) {
-+
-+ struct lcd_param *r = &array[i];
-+
-+ if ((r->flags & type & 0xff) && (r->flags & type & 0xff00))
-+ return r;
-+ }
-+
-+ return NULL;
-+}
-+
-+enum { RGB_8, RGB_16, RGB_24, NR_RGB};
-+
-+struct faradayfb_rgb {
-+
-+ struct fb_bitfield red;
-+ struct fb_bitfield green;
-+ struct fb_bitfield blue;
-+ struct fb_bitfield transp;
-+};
-+
-+/* This structure describes the machine which we are running on. */
-+struct faradayfb_mach_info {
-+
-+ unsigned long num_time0;
-+ struct lcd_param * time0;
-+
-+ unsigned long num_time1;
-+ struct lcd_param * time1;
-+
-+ unsigned long num_time2;
-+ struct lcd_param * time2;
-+
-+ unsigned long num_control;
-+ struct lcd_param * control;
-+
-+ unsigned long pixclock;
-+
-+ unsigned long xres;
-+ unsigned long yres;
-+
-+ unsigned int max_bpp;
-+ unsigned int sync;
-+
-+ unsigned int cmap_greyscale:1,
-+ cmap_inverse:1,
-+ cmap_static:1,
-+ unused:29;
-+};
-+
-+struct faradayfb_info {
-+
-+ struct fb_info *info;
-+ struct faradayfb_rgb *rgb[NR_RGB];
-+
-+ unsigned int xres;
-+ unsigned int yres;
-+ unsigned int max_bpp;
-+
-+ /*
-+ * These are the addresses we mapped
-+ * the framebuffer memory region to.
-+ */
-+ dma_addr_t map_dma;
-+ unsigned char * map_cpu;
-+ unsigned int map_size;
-+
-+ unsigned char * screen_cpu;
-+ dma_addr_t screen_dma;
-+ u32 * palette_cpu;
-+ dma_addr_t palette_dma;
-+ unsigned int palette_size;
-+
-+ unsigned int cmap_inverse:1,
-+ cmap_static:1,
-+ unused:30;
-+
-+ unsigned long time0;
-+ unsigned long time1;
-+ unsigned long time2;
-+ unsigned long control;
-+ unsigned long int_mask;
-+ unsigned long io_base;
-+
-+ unsigned int state;
-+ unsigned int task_state;
-+ struct semaphore ctrlr_sem;
-+ wait_queue_head_t ctrlr_wait;
-+ struct work_struct task;
-+
-+ unsigned long smode;
-+ unsigned long frame420_size;
-+};
-+
-+/*
-+ * These are the actions for set_ctrlr_state
-+ */
-+#define C_DISABLE 0
-+#define C_ENABLE 1
-+#define C_DISABLE_CLKCHANGE 2
-+#define C_ENABLE_CLKCHANGE 3
-+#define C_REENABLE 4
-+#define C_DISABLE_PM 5
-+#define C_ENABLE_PM 6
-+#define C_STARTUP 7
-+
-+#define FARADAY_LCDTIME0_GET_HBP(x) ((((x) >> 24) & 0xFF) + 1)
-+#define FARADAY_LCDTIME0_GET_HFP(x) ((((x) >> 16) & 0xFF) + 1)
-+#define FARADAY_LCDTIME0_GET_HW(x) ((((x) >> 8) & 0xFF) + 1)
-+#define FARADAY_LCDTIME1_GET_VBP(x) ((((x) >> 24) & 0xFF) )
-+#define FARADAY_LCDTIME1_GET_VFP(x) ((((x) >> 16) & 0xFF) )
-+#define FARADAY_LCDTIME1_GET_VW(x) ((((x) >> 8) & 0xFF) + 1)
-+
-+#define FARADAY_LCDTIME0_HBP(x) ((((x) - 1) & 0xFF) << 24)
-+#define FARADAY_LCDTIME0_HFP(x) ((((x) - 1) & 0xFF) << 16)
-+#define FARADAY_LCDTIME0_HW(x) ((((x) - 1) & 0xFF) << 8)
-+#define FARADAY_LCDTIME0_PL(x) (((((x) >> 4) - 1) & 0x3F) << 2)
-+#define FARADAY_LCDTIME1_VBP(x) ((((x) ) & 0xFF) << 24)
-+#define FARADAY_LCDTIME1_VFP(x) ((((x) ) & 0xFF) << 16)
-+#define FARADAY_LCDTIME1_VW(x) ((((x) - 1) & 0xFF) << 8)
-+#define FARADAY_LCDTIME1_LF(x) ((((x) - 1) & 0x3FF) )
-+
-+#define FFB_MODE_RGB 0x00000001
-+#define FFB_MODE_YUV420 0x00000002
-+#define FFB_MODE_YUV422 0x00000004
-+
-+#define FFB_MODE_8BPP 0x00000100
-+#define FFB_MODE_16BPP 0x00000200
-+#define FFB_MODE_24BPP 0x00000400
-+
-+/* Minimum X and Y resolutions */
-+#define MIN_XRES 64
-+#define MIN_YRES 64
-+
-+typedef struct LCDTag {
-+
-+ u32 Timing0; /* 0x00 */
-+ u32 Timing1; /* 0x04 */
-+ u32 Timing2; /* 0x08 */
-+ u32 Timing3; /* 0x0C */
-+ u32 UPBase; /* 0x10 */
-+ u32 LPBase; /* 0x14 */
-+ u32 INTREnable; /* 0x18 */
-+ u32 Control; /* 0x1C */
-+ u32 Status; /* 0x20 */
-+ u32 Interrupt; /* 0x24 */
-+ u32 UPCurr; /* 0x28 */
-+ u32 LPCurr; /* 0x2C */
-+ u32 Reserved1[5]; /* 0x30~0x40 */
-+ u32 GPIO; /* 0x44 */
-+ u32 Reserved2[0x74 - 6]; /* 0x48~0x1FC */
-+
-+ u32 Palette[0x80]; /* 0x200~0x3FC */
-+ u32 TestReg[0x100]; /* 0x400~0x7FC */
-+
-+} LCD_Register;
-+
-+#endif /* __FARADAYFB_H */
-+
-diff -Nur linux-3.4.113.orig/drivers/video/FTLCDC100/faradayfb-main.c linux-3.4.113/drivers/video/FTLCDC100/faradayfb-main.c
---- linux-3.4.113.orig/drivers/video/FTLCDC100/faradayfb-main.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/video/FTLCDC100/faradayfb-main.c 2016-12-01 20:59:24.392614293 +0100
-@@ -0,0 +1,911 @@
-+#include <linux/module.h>
-+#include <linux/fb.h>
-+#include <linux/delay.h>
-+#include <linux/device.h>
-+#include <linux/dma-mapping.h>
-+#include <linux/interrupt.h>
-+#include <linux/platform_device.h>
-+
-+#include <asm/uaccess.h>
-+#include <asm/atomic.h>
-+#include <asm/mach-types.h>
-+
-+#include "faradayfb.h"
-+#include "lcd-info.c"
-+#include "pingpong-module.c"
-+
-+static u32 faradayfb_pseudo_palette[32];
-+static inline void faradayfb_lcd_power(struct fb_info *info, int on)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+
-+ if (on)
-+ fbi->control |= (1UL << 11);
-+ else
-+ fbi->control &= ~(1UL << 11);
-+
-+ plcd->Control = fbi->control;
-+}
-+
-+static void faradayfb_setup_gpio(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+
-+ plcd->GPIO = 0x010000;
-+}
-+
-+static inline void faradayfb_pmu_on(void)
-+{
-+ REG32(PMU_FTPMU010_VA_BASE + 0x44) |= 0x00700000;
-+}
-+
-+static inline void faradayfb_pmu_off(void)
-+{
-+ REG32(PMU_FTPMU010_VA_BASE + 0x44) &= ~0x00700000;
-+}
-+
-+static void faradayfb_enable_controller(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+
-+ plcd->Timing0 = fbi->time0;
-+ plcd->Timing1 = fbi->time1;
-+ plcd->Timing2 = fbi->time2;
-+ plcd->Control = fbi->control & ~0x01;
-+
-+ plcd->UPBase = fbi->screen_dma | fbi->frame420_size;
-+
-+ faradayfb_pmu_on();
-+ plcd->Control |= 0x01;
-+
-+ DEBUG(0, 1, "Time0 = 0x%08x\n", plcd->Timing0);
-+ DEBUG(0, 1, "Time1 = 0x%08x\n", plcd->Timing1);
-+ DEBUG(0, 1, "Time2 = 0x%08x\n", plcd->Timing2);
-+ DEBUG(0, 1, "Control = 0x%08x\n", plcd->Control);
-+ DEBUG(0, 1, "UPBase = 0x%08x\n", plcd->UPBase);
-+}
-+
-+static void faradayfb_disable_controller(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+ DECLARE_WAITQUEUE(wait, current);
-+
-+ set_current_state(TASK_UNINTERRUPTIBLE);
-+ add_wait_queue(&fbi->ctrlr_wait, &wait);
-+
-+ fbi->control &= ~0x0001;
-+ plcd->Control = fbi->control;
-+ faradayfb_pmu_off();
-+
-+ schedule_timeout(20 * HZ / 1000);
-+ remove_wait_queue(&fbi->ctrlr_wait, &wait);
-+}
-+
-+static void faradayfb_enable_int(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+
-+ plcd->INTREnable = fbi->int_mask;
-+}
-+
-+static void faradayfb_disable_int(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+
-+ fbi->int_mask = plcd->INTREnable;
-+ plcd->INTREnable = 0;
-+ plcd->Status = 0x1e;
-+}
-+
-+static struct faradayfb_rgb def_rgb_8 = {
-+
-+ .red = { .offset = 0, .length = 4 },
-+ .green = { .offset = 0, .length = 4 },
-+ .blue = { .offset = 0, .length = 4 },
-+ .transp = { .offset = 0, .length = 0 },
-+};
-+
-+static struct faradayfb_rgb def_rgb_16 = {
-+
-+ .red = { .offset = 11, .length = 5, .msb_right = 0 },
-+ .green = { .offset = 5, .length = 6, .msb_right = 0 },
-+ .blue = { .offset = 0, .length = 5, .msb_right = 0 },
-+ .transp = { .offset = 15, .length = 0, .msb_right = 0 },
-+};
-+
-+static struct faradayfb_rgb def_rgb_24 = {
-+
-+ .red = { .offset = 16, .length = 8, .msb_right = 0 },
-+ .green = { .offset = 8, .length = 8, .msb_right = 0 },
-+ .blue = { .offset = 0, .length = 8, .msb_right = 0 },
-+ .transp = { .offset = 0, .length = 0, .msb_right = 0 },
-+};
-+
-+static inline void faradayfb_schedule_work(struct fb_info *info, unsigned int state)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ unsigned long flags;
-+
-+ local_irq_save(flags);
-+
-+ /*
-+ * We need to handle two requests being made at the same time.
-+ * There are two important cases:
-+ * 1. When we are changing VT (C_REENABLE) while unblanking (C_ENABLE)
-+ * We must perform the unblanking, which will do our REENABLE for us.
-+ * 2. When we are blanking, but immediately unblank before we have
-+ * blanked. We do the "REENABLE" thing here as well, just to be sure.
-+ */
-+ if (fbi->task_state == C_ENABLE && state == C_REENABLE)
-+ state = (unsigned int) - 1;
-+
-+ if (fbi->task_state == C_DISABLE && state == C_ENABLE)
-+ state = C_REENABLE;
-+
-+ if (state != (unsigned int) - 1) {
-+
-+ fbi->task_state = state;
-+ schedule_work(&fbi->task);
-+ }
-+
-+ local_irq_restore(flags);
-+}
-+
-+static int faradayfb_setpalettereg(unsigned int regno, unsigned int red,
-+ unsigned int green, unsigned int blue, unsigned int trans,
-+ struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+
-+ if (regno < fbi->palette_size) {
-+
-+ fbi->palette_cpu[regno] = ((red >> 0) & (0x1fUL << 11)) |
-+ ((green >> 5) & (0x3F << 5)) |
-+ ((blue >> 11) & (0x1f << 0));
-+
-+ return 0;
-+ }
-+
-+ return 1;
-+}
-+
-+static int faradayfb_setcolreg(unsigned int regno, unsigned int red, unsigned int green,
-+ unsigned int blue, unsigned int trans, struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ int ret = 1;
-+ /*
-+ * If inverse mode was selected, invert all the colours
-+ * rather than the register number. The register number
-+ * is what you poke into the framebuffer to produce the
-+ * colour you requested.
-+ */
-+ if (fbi->cmap_inverse) {
-+
-+ red = 0xffff - red;
-+ green = 0xffff - green;
-+ blue = 0xffff - blue;
-+ }
-+
-+ /*
-+ * If greyscale is true, then we convert the RGB value
-+ * to greyscale no mater what visual we are using.
-+ */
-+ if (info->var.grayscale)
-+ red = green = blue = (19595 * red + 38470 * green + 7471 * blue) >> 16;
-+
-+ switch(info->fix.visual) {
-+
-+ case FB_VISUAL_TRUECOLOR:
-+ /*
-+ * 12 or 16-bit True Colour. We encode the RGB value
-+ * according to the RGB bitfield information.
-+ */
-+ if (regno < 16) {
-+
-+ u32 col;
-+ red >>= (16 - info->var.red.length);
-+ green >>= (16 - info->var.green.length);
-+ blue >>= (16 - info->var.blue.length);
-+ col = (red << info->var.red.offset) |
-+ (green << info->var.green.offset) |
-+ (blue << info->var.blue.offset) ;
-+
-+ switch(info->var.bits_per_pixel) {
-+
-+ /* is the following code correct?? */
-+ case 16:
-+ case 32:
-+ ((u32 *)(info->pseudo_palette))[regno] = col;
-+ ret=0;
-+ break;
-+ }
-+ }
-+ break;
-+
-+ case FB_VISUAL_STATIC_PSEUDOCOLOR:
-+ case FB_VISUAL_PSEUDOCOLOR:
-+ if (fbi->smode == FFB_MODE_RGB)
-+ ret = faradayfb_setpalettereg(regno, red, green, blue, trans, info);
-+ break;
-+ }
-+
-+ return ret;
-+}
-+
-+/*
-+ * Round up in the following order: bits_per_pixel, xres,
-+ * yres, xres_virtual, yres_virtual, xoffset, yoffset, grayscale,
-+ * bitfields, horizontal timing, vertical timing.
-+ */
-+static int faradayfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ int rgbidx;
-+
-+ var->xres = min(var->xres, (unsigned int)MIN_XRES);
-+ var->yres = min(var->yres, (unsigned int)MIN_YRES);
-+ var->xres = max(var->xres, fbi->xres);
-+ var->yres = max(var->yres, fbi->yres);
-+ var->xres_virtual = max(var->xres_virtual, var->xres);
-+ var->yres_virtual = max(var->yres_virtual, var->yres);
-+
-+ DEBUG(0, 1, "var->bits_per_pixel = %d\n", var->bits_per_pixel);
-+
-+ switch (var->bits_per_pixel) {
-+
-+ case 1: case 2: case 4: case 8:
-+ rgbidx = RGB_8;
-+ break;
-+
-+ case 16:
-+ rgbidx = RGB_16;
-+ break;
-+
-+ case 32:
-+ rgbidx = RGB_24;
-+ break;
-+
-+ default:
-+ return -EINVAL;
-+ }
-+
-+ /*
-+ * Copy the RGB parameters for this display
-+ * from the machine specific parameters.
-+ */
-+ var->red = fbi->rgb[ rgbidx]->red;
-+ var->green = fbi->rgb[ rgbidx]->green;
-+ var->blue = fbi->rgb[ rgbidx]->blue;
-+ var->transp = fbi->rgb[ rgbidx]->transp;
-+
-+ DEBUG(0, 1, "RGBT length = %d:%d:%d:%d\n",
-+ var->red.length, var->green.length, var->blue.length, var->transp.length);
-+
-+ DEBUG(0, 1, "RGBT offset = %d:%d:%d:%d\n",
-+ var->red.offset, var->green.offset, var->blue.offset, var->transp.offset);
-+
-+ DEBUG(0, 1, "Leave\n");
-+
-+ return 0;
-+}
-+
-+/*
-+ * Configures LCD Controller based on entries in var parameter. Settings are
-+ * only written to the controller if changes were made.
-+ */
-+static int faradayfb_activate_var(struct fb_var_screeninfo *var, struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+
-+ DEBUG(0, 1, "var: xres=%d hslen=%d lm=%d rm=%d\n", var->xres, var->hsync_len, var->left_margin, var->right_margin);
-+ DEBUG(0, 1, "var: yres=%d vslen=%d um=%d bm=%d\n", var->yres, var->vsync_len, var->upper_margin, var->lower_margin);
-+
-+ fbi->time0 = FARADAY_LCDTIME0_HFP(var->left_margin)
-+ | FARADAY_LCDTIME0_HBP(var->right_margin)
-+ | FARADAY_LCDTIME0_HW(var->hsync_len)
-+ | FARADAY_LCDTIME0_PL(var->xres);
-+
-+ fbi->time1 = FARADAY_LCDTIME1_VBP(var->upper_margin)
-+ | FARADAY_LCDTIME1_VFP(var->lower_margin)
-+ | FARADAY_LCDTIME1_VW(var->vsync_len)
-+ | FARADAY_LCDTIME1_LF(var->yres);
-+
-+ if ((plcd->Timing0 != fbi->time0)
-+ || (plcd->Timing1 != fbi->time1)
-+ || (plcd->Timing2 != fbi->time2)
-+ || (plcd->Control != fbi->control)) {
-+
-+ faradayfb_schedule_work(info, C_REENABLE);
-+ }
-+
-+ return 0;
-+}
-+
-+/* Set the user defined part of the display for the specified console */
-+static int faradayfb_set_par(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ struct fb_var_screeninfo *var = &info->var;
-+ unsigned long palette_mem_size;
-+
-+ if (var->bits_per_pixel == 16 || var->bits_per_pixel == 32)
-+ info->fix.visual = FB_VISUAL_TRUECOLOR;
-+ else if (!fbi->cmap_static)
-+ info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
-+ else {
-+ /*
-+ * Some people have weird ideas about wanting static
-+ * pseudocolor maps. I suspect their user space
-+ * applications are broken.
-+ */
-+ info->fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR;
-+ }
-+
-+ info->fix.line_length = var->xres_virtual * var->bits_per_pixel / 8;
-+
-+ fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16;
-+
-+ palette_mem_size = fbi->palette_size * sizeof(u32);
-+
-+ DEBUG(0, 1, "info->fix.line_length = %d\n", info->fix.line_length);
-+ DEBUG(0, 1, "palette_mem_size = 0x%08lx\n", (unsigned long) palette_mem_size);
-+
-+ fbi->palette_cpu = (u32 *)(fbi->map_cpu + PAGE_SIZE - palette_mem_size);
-+
-+ fbi->palette_dma = fbi->map_dma + PAGE_SIZE - palette_mem_size;
-+
-+ /* Set (any) board control register to handle new color depth */
-+ faradayfb_activate_var(var, info);
-+
-+ DEBUG(0, 1, "Leave\n");
-+
-+ return 0;
-+}
-+
-+static irqreturn_t faradayfb_handle_irq(int irq, void *dev_id)
-+{
-+#if 0
-+ struct fb_info *info = (struct fb_info*)dev_id;
-+ struct faradayfb_info *fbi = info->par;
-+ volatile LCD_Register *plcd = (LCD_Register *)fbi->io_base;
-+ u32 status = plcd->Interrupt;
-+#endif
-+ return IRQ_HANDLED;
-+}
-+
-+/*
-+ * This function must be called from task context only, since it will
-+ * sleep when disabling the LCD controller, or if we get two contending
-+ * processes trying to alter state.
-+ */
-+static void set_ctrlr_state(struct fb_info *info, unsigned int state)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ unsigned int old_state;
-+
-+ down(&fbi->ctrlr_sem);
-+
-+ old_state = fbi->state;
-+
-+ /* Hack around fbcon initialisation. */
-+ if (old_state == C_STARTUP && state == C_REENABLE)
-+ state = C_ENABLE;
-+
-+ switch (state) {
-+ case C_DISABLE_PM:
-+ case C_DISABLE:
-+
-+ /* Disable controller */
-+ if (old_state != C_DISABLE) {
-+
-+ fbi->state = state;
-+ faradayfb_disable_int(info);
-+ faradayfb_lcd_power(info, 0);
-+ // faradayfb_disable_controller(info);
-+ }
-+ break;
-+
-+ case C_REENABLE:
-+ /*
-+ * Re-enable the controller only if it was already
-+ * enabled. This is so we reprogram the control
-+ * registers.
-+ */
-+ if (old_state == C_ENABLE) {
-+
-+ faradayfb_disable_int(info);
-+ faradayfb_lcd_power(info, 0);
-+ faradayfb_disable_controller(info);
-+
-+ faradayfb_setup_gpio(info);
-+ faradayfb_lcd_power(info, 1);
-+ faradayfb_enable_controller(info);
-+ faradayfb_enable_int(info);
-+ }
-+ break;
-+
-+ case C_ENABLE_PM:
-+ /*
-+ * Re-enable the controller after PM. This is not
-+ * perfect - think about the case where we were doing
-+ * a clock change, and we suspended half-way through.
-+ */
-+ if (old_state != C_DISABLE_PM)
-+ break;
-+ /* fall through */
-+
-+ case C_ENABLE:
-+ /*
-+ * Power up the LCD screen, enable controller, and
-+ * turn on the backlight.
-+ */
-+ if (old_state != C_ENABLE) {
-+
-+ fbi->state = C_ENABLE;
-+ faradayfb_setup_gpio(info);
-+ faradayfb_lcd_power(info, 1);
-+ faradayfb_enable_controller(info);
-+ faradayfb_enable_int(info);
-+ }
-+ break;
-+ }
-+ up(&fbi->ctrlr_sem);
-+}
-+
-+/*
-+ * Blank the display by setting all palette values to zero. Note, the
-+ * 12 and 16 bpp modes don't really use the palette, so this will not
-+ * blank the display in all modes.
-+ */
-+static int faradayfb_blank(int blank, struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ int i;
-+
-+ switch (blank) {
-+ case FB_BLANK_POWERDOWN:
-+ case FB_BLANK_VSYNC_SUSPEND:
-+ case FB_BLANK_HSYNC_SUSPEND:
-+ case FB_BLANK_NORMAL:
-+
-+ if (info->fix.visual == FB_VISUAL_PSEUDOCOLOR ||
-+ info->fix.visual == FB_VISUAL_STATIC_PSEUDOCOLOR) {
-+
-+ for (i = 0; i < fbi->palette_size; i++)
-+ faradayfb_setpalettereg(i, 0, 0, 0, 0, info);
-+ }
-+
-+ faradayfb_schedule_work(info, C_DISABLE);
-+
-+ break;
-+
-+ case FB_BLANK_UNBLANK:
-+
-+ if (info->fix.visual == FB_VISUAL_PSEUDOCOLOR ||
-+ info->fix.visual == FB_VISUAL_STATIC_PSEUDOCOLOR)
-+ fb_set_cmap(&info->cmap, info);
-+
-+ faradayfb_schedule_work(info, C_ENABLE);
-+
-+ break;
-+ }
-+
-+ return 0;
-+}
-+
-+/*
-+ * Our LCD controller task (which is called when we blank or unblank)
-+ * via keventd.
-+ */
-+static void faradayfb_task(struct work_struct *dummy)
-+{
-+ struct faradayfb_info *fbi = container_of(dummy, struct faradayfb_info, task);
-+ struct fb_info *info = fbi->info;
-+ unsigned int state;
-+
-+ state = xchg(&fbi->task_state, -1);
-+ set_ctrlr_state(info, state);
-+}
-+
-+/* Fake monspecs to fill in fbinfo structure */
-+static struct fb_monspecs monspecs = {
-+
-+ .hfmin = 30000,
-+ .hfmax = 70000,
-+ .vfmin = 50,
-+ .vfmax = 65,
-+};
-+
-+static int ffb_get_mach_param(struct faradayfb_mach_info *inf, struct fb_info *info, unsigned long smode)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ struct lcd_param *tparam;
-+ unsigned long bpp_mode;
-+
-+ if (!(tparam = get_lcd_time(inf->time0, inf->num_time0, smode)))
-+ return -1;
-+
-+ fbi->time0 = tparam->value;
-+
-+ if (!(tparam = get_lcd_time(inf->time1, inf->num_time1, smode)))
-+ return -1;
-+
-+ fbi->time1 = tparam->value;
-+
-+ if (!(tparam = get_lcd_time(inf->time2, inf->num_time2, smode)))
-+ return -1;
-+
-+ fbi->time2 = tparam->value;
-+
-+ switch(info->var.bits_per_pixel) {
-+
-+ case 1: case 2: case 4: case 8:
-+ bpp_mode = FFB_MODE_8BPP;
-+ break;
-+
-+ case 16:
-+ bpp_mode = FFB_MODE_16BPP;
-+ break;
-+
-+ case 32:
-+ bpp_mode = FFB_MODE_24BPP;
-+ break;
-+
-+ default:
-+ DEBUG(1, 1, "Unsupported BPP, set default BPP to 16\n");
-+ bpp_mode = FFB_MODE_16BPP;
-+ break;
-+ }
-+
-+ if (!(tparam = get_lcd_ctrl(inf->control, inf->num_control, smode | bpp_mode)))
-+ return -1;
-+
-+ fbi->control = tparam->value;
-+
-+ fbi->xres = inf->xres;
-+ fbi->yres = inf->yres;
-+
-+ return 0;
-+}
-+
-+static int faradayfb_set_var(struct fb_info *info, struct faradayfb_mach_info *inf, unsigned long type)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ unsigned long t_smode = 0;
-+
-+ if (!type)
-+ t_smode = fbi->smode;
-+ else
-+ t_smode = type;
-+
-+ if (ffb_get_mach_param(inf, info, t_smode)) {
-+
-+ DEBUG(1, 1, "Not support mode(%lx)\n", t_smode);
-+ return -1;
-+ }
-+
-+ info->var.xres = fbi->xres;
-+ info->var.xres_virtual = fbi->xres;
-+ info->var.yres = fbi->yres;
-+ info->var.yres_virtual = fbi->yres;
-+
-+ info->var.upper_margin = FARADAY_LCDTIME1_GET_VBP(fbi->time1);
-+ info->var.lower_margin = FARADAY_LCDTIME1_GET_VFP(fbi->time1);
-+ info->var.vsync_len = FARADAY_LCDTIME1_GET_VW(fbi->time1);
-+ info->var.left_margin = FARADAY_LCDTIME0_GET_HFP(fbi->time0);
-+ info->var.right_margin = FARADAY_LCDTIME0_GET_HBP(fbi->time0);
-+ info->var.hsync_len = FARADAY_LCDTIME0_GET_HW(fbi->time0);
-+
-+ fbi->int_mask = 0;
-+
-+ if (t_smode & FFB_MODE_YUV420)
-+ fbi->frame420_size = (((info->var.xres * info->var.yres + 0xffff) & 0xffff0000) >> 16) << 2;
-+ else
-+ fbi->frame420_size = 0;
-+
-+ return 0;
-+}
-+
-+static struct fb_ops faradayfb_ops = {
-+
-+ .owner = THIS_MODULE,
-+ .fb_check_var = faradayfb_check_var,
-+ .fb_set_par = faradayfb_set_par,
-+ .fb_setcolreg = faradayfb_setcolreg,
-+ .fb_fillrect = cfb_fillrect,
-+ .fb_copyarea = cfb_copyarea,
-+ .fb_imageblit = cfb_imageblit,
-+ .fb_blank = faradayfb_blank,
-+ .fb_mmap = faradayfb_mmap,
-+ .fb_ioctl = faradayfb_ioctl,
-+};
-+
-+static struct fb_info * __init faradayfb_init_fbinfo(struct device *dev)
-+{
-+ struct faradayfb_mach_info *inf;
-+ struct fb_info *info;
-+ struct faradayfb_info *fbi;
-+
-+ if (!(info = framebuffer_alloc(sizeof(struct faradayfb_info), dev)))
-+ return NULL;
-+
-+ fbi = info->par;
-+ fbi->info = info;
-+
-+ fbi->io_base = LCD_FTLCDC100_0_VA_BASE;
-+ strcpy(info->fix.id, FARADAYFB_MODULE_NAME);
-+
-+ info->fix.type = FB_TYPE_PACKED_PIXELS;
-+ info->fix.type_aux = 0;
-+ info->fix.xpanstep = 0;
-+ info->fix.ypanstep = 0;
-+ info->fix.ywrapstep = 0;
-+ info->fix.accel = FB_ACCEL_NONE;
-+
-+ info->var.nonstd = 0;
-+ info->var.activate = FB_ACTIVATE_NOW;
-+ info->var.height = -1;
-+ info->var.width = -1;
-+ info->var.accel_flags = 0;
-+ info->var.vmode = FB_VMODE_NONINTERLACED;
-+
-+ info->fbops = &faradayfb_ops;
-+ info->flags = FBINFO_DEFAULT;
-+ info->monspecs = monspecs;
-+ info->pseudo_palette = &faradayfb_pseudo_palette;
-+
-+ fbi->rgb[RGB_8] = &def_rgb_8;
-+ fbi->rgb[RGB_16] = &def_rgb_16;
-+ fbi->rgb[RGB_24] = &def_rgb_24;
-+
-+ inf = (struct faradayfb_mach_info*)dev->platform_data;
-+
-+ /*
-+ * People just don't seem to get this. We don't support
-+ * anything but correct entries now, so panic if someone
-+ * does something stupid.
-+ */
-+
-+ fbi->xres = inf->xres;
-+ fbi->yres = inf->yres;
-+ fbi->max_bpp = 32;
-+#if defined(CONFIG_FFB_MODE_8BPP)
-+ info->var.bits_per_pixel = min((u32)8, inf->max_bpp);
-+#elif defined(CONFIG_FFB_MODE_16BPP)
-+ info->var.bits_per_pixel = min((u32)16, inf->max_bpp);
-+#elif defined(CONFIG_FFB_MODE_24BPP)
-+ info->var.bits_per_pixel = min((u32)32, inf->max_bpp);
-+ info->var.bits_per_pixel = 32;
-+#endif
-+
-+ info->var.pixclock = inf->pixclock;
-+ info->var.sync = inf->sync;
-+ info->var.grayscale = inf->cmap_greyscale;
-+ fbi->cmap_inverse = inf->cmap_inverse;
-+ fbi->cmap_static = inf->cmap_static;
-+
-+ fbi->smode = FFB_DEFAULT_MODE;
-+
-+ if (faradayfb_set_var(info, inf, 0))
-+ goto err;
-+
-+ fbi->state = C_STARTUP;
-+ fbi->task_state = (unsigned char) - 1;
-+ info->fix.smem_len = faradayfb_cal_frame_buf_size(fbi);
-+
-+ init_waitqueue_head(&fbi->ctrlr_wait);
-+ INIT_WORK(&fbi->task, faradayfb_task);
-+ init_MUTEX(&fbi->ctrlr_sem);
-+
-+ return info;
-+err:
-+ kfree(fbi);
-+ kfree(info);
-+
-+ return NULL;
-+}
-+
-+static int faradayfb_probe(struct platform_device *pdev)
-+{
-+ struct fb_info *info;
-+ struct faradayfb_info *fbi;
-+ int irq;
-+ int ret = 0;
-+
-+ ret = -ENOMEM;
-+
-+ if (!(info = faradayfb_init_fbinfo(&pdev->dev))) {
-+
-+ DEBUG(1, 1, "unable to allocate memory for device info\n");
-+ goto err_exit;
-+ }
-+
-+ fbi = info->par;
-+
-+ /* Initialize video memory */
-+ if ((ret = faradayfb_map_video_memory(info)) < 0)
-+ goto err_free_mem;
-+
-+ ret = -EINVAL;
-+
-+ if ((irq = platform_get_irq(pdev, 0)) <= 0)
-+ goto err_free_map;
-+
-+ if (request_irq(irq, faradayfb_handle_irq, IRQF_DISABLED, "LCD", info)) {
-+
-+ DEBUG(1, 1, "request_irq failed: %d\n", ret);
-+ goto err_free_map;
-+ }
-+
-+ /*
-+ * This makes sure that our colour bitfield
-+ * descriptors are correctly initialised.
-+ */
-+ faradayfb_check_var(&info->var, info);
-+ faradayfb_set_par(info);
-+
-+ dev_set_drvdata(&pdev->dev, info);
-+
-+// <============================================
-+ if ((ret = register_framebuffer(info)) < 0) {
-+
-+ DEBUG(1, 1, "register_framebuffer failed\n");
-+ goto err_free_irq;
-+ }
-+// <============================================
-+
-+ faradayfb_clean_screen(info);
-+
-+ return 0;
-+
-+err_free_irq:
-+ dev_set_drvdata(&pdev->dev, NULL);
-+ free_irq(irq, info);
-+err_free_map:
-+ faradayfb_unmap_video_memory(info);
-+err_free_mem:
-+ kfree(info->par);
-+ kfree(info);
-+err_exit:
-+ return ret;
-+}
-+
-+/* Called when the device is being detached from the driver */
-+static int faradayfb_remove(struct platform_device *pdev)
-+{
-+ struct fb_info *info = platform_get_drvdata(pdev);
-+ int irq;
-+
-+ set_ctrlr_state(info, C_DISABLE);
-+
-+ irq = platform_get_irq(pdev, 0);
-+ free_irq(irq, info);
-+
-+ unregister_framebuffer(info);
-+ faradayfb_unmap_video_memory(info);
-+ dev_set_drvdata(&pdev->dev, NULL);
-+ kfree(info->par);
-+ kfree(info);
-+
-+ return 0;
-+}
-+
-+#ifdef CONFIG_PM
-+
-+/* suspend and resume support for the lcd controller */
-+static int faradayfb_suspend(struct platform_device *pdev, pm_message_t mesg)
-+{
-+ struct fb_info *info = platform_get_drvdata(pdev);
-+
-+ // if (level == SUSPEND_DISABLE || level == SUSPEND_POWER_DOWN)
-+ if (mesg.event == PM_EVENT_PRETHAW || mesg.event & PM_EVENT_SLEEP)
-+ set_ctrlr_state(info, C_DISABLE_PM);
-+
-+ return 0;
-+}
-+
-+static int faradayfb_resume(struct platform_device *pdev)
-+{
-+ struct fb_info *info = platform_get_drvdata(pdev);
-+
-+ // need modify
-+ // if (level == RESUME_ENABLE)
-+ set_ctrlr_state(info, C_ENABLE_PM);
-+
-+ return 0;
-+}
-+
-+#else
-+#define faradayfb_suspend NULL
-+#define faradayfb_resume NULL
-+#endif
-+
-+static struct resource faradayfb_resource[] = {
-+
-+ {
-+ .start = LCD_FTLCDC100_0_PA_BASE,
-+ .end = LCD_FTLCDC100_0_PA_LIMIT,
-+ .flags = IORESOURCE_MEM,
-+ },
-+ {
-+ .start = LCD_FTLCDC100_0_IRQ,
-+ .end = LCD_FTLCDC100_0_IRQ,
-+ .flags = IORESOURCE_IRQ,
-+ }
-+};
-+
-+static u64 faradayfb_dmamask = ~(u32)0;
-+
-+static struct platform_device faradayfb_device = {
-+
-+ .name = "faraday-lcd",
-+ .id = -1,
-+ .num_resources = ARRAY_SIZE(faradayfb_resource),
-+ .resource = faradayfb_resource,
-+ .dev = {
-+
-+ .platform_data = &ffb_mach_info,
-+ .dma_mask = &faradayfb_dmamask,
-+ .coherent_dma_mask = 0xffffffff,
-+ }
-+};
-+
-+static struct platform_driver faradayfb_driver = {
-+ .probe = faradayfb_probe,
-+ .remove = faradayfb_remove,
-+ .suspend = faradayfb_suspend,
-+ .resume = faradayfb_resume,
-+ .driver = {
-+ .name = "faraday-lcd",
-+ },
-+};
-+
-+/*
-+rick note faraday driver
-+*/
-+
-+/* Register both the driver and the device */
-+int __init faradayfb_init(void)
-+{
-+ int ret = 0;
-+ /* Register the device with LDM */
-+
-+#if 1
-+ if (platform_device_register(&faradayfb_device)) {
-+
-+ DEBUG(1, 1, "failed to register faradayfb device\n");
-+ ret = -ENODEV;
-+ goto exit;
-+ }
-+#endif
-+ /* Register the driver with LDM */
-+ if (platform_driver_register(&faradayfb_driver)) {
-+
-+ DEBUG(1, 1, "failed to register faradayfb driver\n");
-+ platform_device_unregister(&faradayfb_device);
-+ ret = -ENODEV;
-+ goto exit;
-+ }
-+exit:
-+ return ret;
-+}
-+
-+static void __exit faradayfb_cleanup(void)
-+{
-+ platform_driver_unregister(&faradayfb_driver);
-+ platform_device_unregister(&faradayfb_device);
-+}
-+
-+module_init(faradayfb_init);
-+module_exit(faradayfb_cleanup);
-+MODULE_DESCRIPTION("Faraday LCD driver");
-+MODULE_AUTHOR("Francis Huang <francish@faraday-tech.com>");
-+MODULE_LICENSE("GPL");
-diff -Nur linux-3.4.113.orig/drivers/video/FTLCDC100/Kconfig linux-3.4.113/drivers/video/FTLCDC100/Kconfig
---- linux-3.4.113.orig/drivers/video/FTLCDC100/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/video/FTLCDC100/Kconfig 2016-12-01 20:59:24.392614293 +0100
-@@ -0,0 +1,74 @@
-+config FB_FTLCDC100
-+ tristate "Faraday FTLCDC100 driver"
-+ depends on FB && NDS32
-+ select FB_CFB_FILLRECT
-+ select FB_CFB_COPYAREA
-+ select FB_CFB_IMAGEBLIT
-+
-+ choice
-+ prompt "Default LCD Panel"
-+ depends on FB_FTLCDC100
-+ default PANEL_AUA036QN01
-+ help
-+ This option select a default panel setting for the LCD controller
-+
-+ config PANEL_AUA036QN01
-+ bool "AU 3.5 inch LCD Panel"
-+
-+ config PANEL_CH7013A
-+ bool "Chrontel Digital PC to TV Encoder"
-+ select I2C
-+ select I2C_FARADAY
-+ select CH7013A
-+
-+ config PANEL_AUA070VW04
-+ bool "AU 7.0 inch LCD Panel"
-+
-+ config PANEL_LW500AC9601
-+ bool "CHIMEI 5.0 inch LCD panel"
-+
-+ endchoice
-+
-+ # config FTLCD_OSD
-+ # bool "Enable OSD (On Screen Display)"
-+ # depends on FB_FTLCDC100
-+ # default n
-+ # ---help---
-+ # This enables access to the OSD (On Screen Display) for Faraday
-+ # FTLCDC100 LCD control. Disabling OSD will reduce the size of
-+ # the kernel by approximately 6kb.
-+ #
-+
-+ choice
-+ prompt "Default Color Mode"
-+ depends on FB_FTLCDC100
-+ default FFB_MODE_RGB
-+ help
-+ This option select default color mode
-+
-+ config FFB_MODE_RGB
-+ bool "RGB Mode"
-+ config FFB_MODE_YUV422
-+ bool "YUV422 Mode"
-+ config FFB_MODE_YUV420
-+ bool "YUV420 Mode"
-+ endchoice
-+
-+ choice
-+ prompt "Default BPP"
-+ depends on FB_FTLCDC100
-+ default FFB_MODE_16BPP
-+ help
-+ This option select default BPP (bits-per-pixel)
-+
-+ config FFB_MODE_8BPP
-+ depends on FFB_MODE_RGB || FFB_MODE_YUV420
-+ bool "8 bits-per-pixel"
-+ config FFB_MODE_16BPP
-+ depends on FFB_MODE_RGB || FFB_MODE_YUV422
-+ bool "16 bits-per-pixel"
-+ config FFB_MODE_24BPP
-+ depends on FFB_MODE_RGB
-+ bool "24 bits-per-pixel"
-+ endchoice
-+
-diff -Nur linux-3.4.113.orig/drivers/video/FTLCDC100/lcd-info.c linux-3.4.113/drivers/video/FTLCDC100/lcd-info.c
---- linux-3.4.113.orig/drivers/video/FTLCDC100/lcd-info.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/video/FTLCDC100/lcd-info.c 2016-12-01 20:59:24.392614293 +0100
-@@ -0,0 +1,264 @@
-+/*
-+ * HBP : Horizontal Back Porch
-+ * HFP : Horizontal Front Porch
-+ * HSPW: Horizontal Sync. Pulse Width
-+ * PPL : Pixels-per-line = 16(PPL+1)
-+ */
-+#define ENC_PARAM_TIME0(HBP, HFP, HSPW, PPL) \
-+ ((((HBP) - 1) << 24) | \
-+ (((HFP) - 1) << 16) | \
-+ (((HSPW) - 1) << 8 ) | \
-+ ((((PPL) >> 4) - 1) << 2 ))
-+
-+/*
-+ * HBP : Vertical Back Porch
-+ * HFP : Vertical Front Porch
-+ * HSPW: Vertical Sync. Pulse Width
-+ * LPP : Lines-per-panel = LPP + 1
-+ */
-+#define ENC_PARAM_TIME1(VBP, VFP, VSPW, LPP) \
-+ ((((VBP) ) << 24) | \
-+ (((VFP) ) << 16) | \
-+ (((VSPW) - 1) << 10) | \
-+ (((LPP) - 1) ))
-+
-+/*
-+ * PRA : Pixel Rate Adaptive
-+ * IOE : Invert Panel Output Enable
-+ * IPC : Invert Panel Clock (Test Chip Testing)
-+ * IHS : Invert Horisontal Sync.
-+ * IVS : Invert Versical Sync.
-+ * PCD : Panel Clock Divisor
-+ */
-+#define ENC_PARAM_TIME2(PRA, IOE, IPC, IHS, IVS, PCD) \
-+ (((PRA) << 15) | \
-+ ((IOE) << 14) | \
-+ ((IPC) << 13) | \
-+ ((IHS) << 12) | \
-+ ((IVS) << 11) | \
-+ (((PCD) - 1) ))
-+
-+/*
-+ * Enable YCbCr
-+ * Enable YCbCr420
-+ * FIFO threadhold
-+ * Panel type, 0-6bit, 1-8bit
-+ * LcdVComp, when to generate interrupt, 1: start of back_porch
-+ * Power Enable
-+ * Big Endian Pixel/Byte Ordering
-+ * BGR
-+ * TFT
-+ * LCD bits per pixel
-+ * Controller Enable
-+ */
-+
-+#define ENC_PARAM_CTRL(ENYUV, ENYUV420, FIFOTH, PTYPE, VCOMP, LCD_ON, ENDIAN, BGR, TFT, BPP, LCD_EN) \
-+ ((ENYUV << 18) | \
-+ (ENYUV420 << 17) | \
-+ (FIFOTH << 16) | \
-+ (PTYPE << 15) | \
-+ (VCOMP << 12) | \
-+ (LCD_ON << 11) | \
-+ (ENDIAN << 9) | \
-+ (BGR << 8) | \
-+ (TFT << 5) | \
-+ (BPP << 1) | \
-+ (LCD_EN))
-+
-+static struct lcd_param control[] = {
-+
-+ {
-+ .value = ENC_PARAM_CTRL(0, 0, 1, 1, 0x3, 1, 0x0, 1, 1, 0x3, 1),
-+ .flags = FFB_MODE_RGB | FFB_MODE_8BPP,
-+ },
-+ {
-+ .value = ENC_PARAM_CTRL(1, 1, 1, 1, 0x3, 1, 0x0, 0, 1, 0x3, 1),
-+ .flags = FFB_MODE_YUV420 | FFB_MODE_8BPP,
-+ },
-+ {
-+ .value = ENC_PARAM_CTRL(1, 0, 1, 1, 0x3, 1, 0x0, 0, 1, 0x4, 1),
-+ .flags = FFB_MODE_YUV422 | FFB_MODE_16BPP,
-+ },
-+ {
-+ .value = ENC_PARAM_CTRL(0, 0, 1, 1, 0x3, 1, 0x0, 1, 1, 0x4, 1),
-+ .flags = FFB_MODE_RGB | FFB_MODE_16BPP,
-+ },
-+ {
-+ .value = ENC_PARAM_CTRL(0, 0, 1, 1, 0x3, 1, 0x0, 1, 1, 0x5, 1),
-+ .flags = FFB_MODE_RGB | FFB_MODE_24BPP,
-+ },
-+};
-+
-+#ifdef CONFIG_PANEL_AUA036QN01
-+
-+static struct lcd_param time0[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME0(7, 6, 1, 320),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct lcd_param time1[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME1(1, 1, 1, 240),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct lcd_param time2[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME2(0, 0, 1, 1, 1, 0x7),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct faradayfb_mach_info ffb_mach_info = {
-+
-+ .pixclock = 171521,
-+ .xres = 320,
-+ .yres = 240,
-+ .max_bpp = 24,
-+ .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
-+ .num_time0 = ARRAY_SIZE(time0),
-+ .time0 = time0,
-+ .num_time1 = ARRAY_SIZE(time1),
-+ .time1 = time1,
-+ .num_time2 = ARRAY_SIZE(time2),
-+ .time2 = time2,
-+ .num_control = ARRAY_SIZE(control),
-+ .control = control,
-+};
-+#endif
-+
-+#ifdef CONFIG_PANEL_AUA070VW04
-+static struct lcd_param time0[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME0(88, 40, 128, 800),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct lcd_param time1[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME1(21, 1, 3, 480),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct lcd_param time2[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME2(0, 1, 1, 1, 1, 0x5),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct faradayfb_mach_info ffb_mach_info = {
-+
-+ .pixclock = 171521,
-+ .xres = 800,
-+ .yres = 480,
-+ .max_bpp = 24,
-+ .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
-+ .num_time0 = ARRAY_SIZE(time0),
-+ .time0 = time0,
-+ .num_time1 = ARRAY_SIZE(time1),
-+ .time1 = time1,
-+ .num_time2 = ARRAY_SIZE(time2),
-+ .time2 = time2,
-+ .num_control = ARRAY_SIZE(control),
-+ .control = control,
-+};
-+
-+#endif
-+
-+#ifdef CONFIG_PANEL_LW500AC9601
-+static struct lcd_param time0[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME0(88, 40, 128, 800),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct lcd_param time1[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME1(21, 1, 3, 480),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct lcd_param time2[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME2( 0, 0, 1, 1, 1, 0x3),
-+ .flags = FFB_MODE_RGB | FFB_MODE_YUV420 | FFB_MODE_YUV422,
-+ },
-+};
-+
-+static struct faradayfb_mach_info ffb_mach_info = {
-+
-+ .pixclock = 171521,
-+ .xres = 800,
-+ .yres = 480,
-+ .max_bpp = 24,
-+ .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
-+ .num_time0 = ARRAY_SIZE(time0),
-+ .time0 = time0,
-+ .num_time1 = ARRAY_SIZE(time1),
-+ .time1 = time1,
-+ .num_time2 = ARRAY_SIZE(time2),
-+ .time2 = time2,
-+ .num_control = ARRAY_SIZE(control),
-+ .control = control,
-+};
-+#endif
-+
-+#ifdef CONFIG_CH7013A
-+static struct lcd_param time0[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME0(42, 10, 96, 640),
-+ .flags = FFB_MODE_RGB,
-+ },
-+};
-+
-+static struct lcd_param time1[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME1(28, 5, 2, 480),
-+ .flags = FFB_MODE_RGB,
-+ },
-+};
-+static struct lcd_param time2[] = {
-+
-+ {
-+ .value = ENC_PARAM_TIME2(0, 1, 1, 0, 0, 0x3),
-+ .flags = FFB_MODE_RGB,
-+ },
-+};
-+
-+static struct faradayfb_mach_info ffb_mach_info = {
-+
-+ .pixclock = 37910,
-+ .xres = 640,
-+ .yres = 480,
-+ .max_bpp = 24,
-+ .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
-+ .num_time0 = ARRAY_SIZE(time0),
-+ .time0 = time0,
-+ .num_time1 = ARRAY_SIZE(time1),
-+ .time1 = time1,
-+ .num_time2 = ARRAY_SIZE(time2),
-+ .time2 = time2,
-+ .num_control = ARRAY_SIZE(control),
-+ .control = control,
-+};
-+
-+#endif /* CONFIG_CH7013A */
-diff -Nur linux-3.4.113.orig/drivers/video/FTLCDC100/Makefile linux-3.4.113/drivers/video/FTLCDC100/Makefile
---- linux-3.4.113.orig/drivers/video/FTLCDC100/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/video/FTLCDC100/Makefile 2016-12-01 20:59:24.392614293 +0100
-@@ -0,0 +1 @@
-+obj-$(CONFIG_FB_FTLCDC100) += faradayfb-main.o
-diff -Nur linux-3.4.113.orig/drivers/video/FTLCDC100/pingpong-module.c linux-3.4.113/drivers/video/FTLCDC100/pingpong-module.c
---- linux-3.4.113.orig/drivers/video/FTLCDC100/pingpong-module.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/video/FTLCDC100/pingpong-module.c 2016-12-01 20:59:24.392614293 +0100
-@@ -0,0 +1,592 @@
-+void *fmem_alloc(size_t size, dma_addr_t *dma_handle, unsigned long flags)
-+{
-+ struct page *page;
-+ void *cpu_addr = NULL;
-+
-+ size = PAGE_ALIGN(size);
-+
-+ if (!(page = alloc_pages(GFP_DMA, get_order(size)))) {
-+
-+ DEBUG(1, 1, "alloc_pages fail! (requested %#x)", size);
-+ goto no_page;
-+ }
-+
-+ *dma_handle = page_to_phys(page);
-+
-+ if ((cpu_addr = __ioremap(*dma_handle, size, flags, 1))) {
-+
-+ do {
-+ SetPageReserved(page);
-+ page++;
-+ } while (size -= PAGE_SIZE);
-+ }
-+ else {
-+ __free_pages(page, get_order(size));
-+ DEBUG(1, 1, "__ioremap fail! (phy %#x)", *dma_handle);
-+ }
-+no_page:
-+ return cpu_addr;
-+}
-+
-+void fmem_free(size_t size, void *cpu_addr, dma_addr_t handle)
-+{
-+ struct page *page = pfn_to_page(handle >> PAGE_SHIFT);
-+
-+ __iounmap(cpu_addr);
-+ size = PAGE_ALIGN(size);
-+
-+ do {
-+ ClearPageReserved(page);
-+ __free_page(page);
-+ page++;
-+
-+ } while (size -= PAGE_SIZE);
-+}
-+
-+static int faradayfb_mmap(struct fb_info *info, struct vm_area_struct *vma)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ unsigned long off = vma->vm_pgoff << PAGE_SHIFT;
-+ int ret = -EINVAL;
-+
-+ DEBUG(0, 1, "Enter\n");
-+
-+ if (off < info->fix.smem_len) {
-+
-+ off += fbi->screen_dma & PAGE_MASK;
-+ vma->vm_pgoff = off >> PAGE_SHIFT;
-+ vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
-+ vma->vm_flags |= VM_RESERVED;
-+ ret = remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff,
-+ vma->vm_end - vma->vm_start, vma->vm_page_prot);
-+ }
-+ else {
-+ DEBUG(1, 1, "buffer mapping error !!\n");
-+ }
-+
-+ DEBUG(0, 1, "Leave\n");
-+
-+ return ret;
-+}
-+
-+/*
-+ * Allocates the DRAM memory for the frame buffer. This buffer is
-+ * remapped into a non-cached, non-buffered, memory region to
-+ * allow palette and pixel writes to occur without flushing the
-+ * cache. Once this area is remapped, all virtual memory
-+ * access to the video memory should occur at the new region.
-+ */
-+static int __init faradayfb_map_video_memory(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+
-+ /*
-+ * We reserve one page for the palette, plus the size
-+ * of the framebuffer.
-+ */
-+ fbi->map_size = PAGE_ALIGN(info->fix.smem_len + PAGE_SIZE);
-+
-+ fbi->map_cpu = fmem_alloc(fbi->map_size, &fbi->map_dma, pgprot_writecombine(PAGE_KERNEL));
-+ // fbi->map_cpu = dma_alloc_writecombine(fbi->info->dev, fbi->map_size, &fbi->map_dma, GFP_KERNEL);
-+
-+ if (fbi->map_cpu) {
-+
-+ memset(fbi->map_cpu, 0x1d, fbi->map_size);
-+ info->screen_base = fbi->map_cpu + PAGE_SIZE;
-+ fbi->screen_dma = fbi->map_dma + PAGE_SIZE;
-+ info->fix.smem_start = fbi->screen_dma;
-+ }
-+
-+ return fbi->map_cpu ? 0 : -ENOMEM;
-+}
-+
-+static inline void faradayfb_clean_screen(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ int size = info->var.xres * info->var.yres;
-+
-+ if (fbi->smode & FFB_MODE_YUV422) {
-+
-+ memset(fbi->map_cpu, 16, size * info->var.bits_per_pixel / 8);
-+ }
-+ else if (fbi->smode & FFB_MODE_YUV420) {
-+
-+ memset(fbi->map_cpu, 16, size);
-+ memset(fbi->map_cpu + PAGE_SIZE + ((size + 0xffff) & 0xffff0000), 128, size / 4);
-+ memset(fbi->map_cpu + PAGE_SIZE + ((size + 0xffff) & 0xffff0000) * 5 / 4, 128, size / 4);
-+ }
-+}
-+
-+static inline void faradayfb_unmap_video_memory(struct fb_info *info)
-+{
-+ struct faradayfb_info *fbi = info->par;
-+ fmem_free(fbi->map_size, fbi->map_cpu, fbi->map_dma);
-+}
-+
-+#define FRAME_SIZE_RGB(xres, yres, mbpp) ((xres) * (yres) * (mbpp) / 8)
-+#define FRAME_SIZE_YUV422(xres, yres, mbpp) (((xres) * (yres) * (mbpp) / 8) * 2)
-+#define FRAME_SIZE_YUV420(xres, yres, mbpp) (((((xres) * (yres) * (mbpp) / 8) + 0xffff) & 0xffff0000) * 3 / 2)
-+
-+static inline u32 faradayfb_cal_frame_buf_size(struct faradayfb_info *fbi)
-+{
-+ u32 size_rgb = FRAME_SIZE_RGB(fbi->xres, fbi->yres, fbi->max_bpp);
-+ u32 size_yuv422 = FRAME_SIZE_YUV422(fbi->xres, fbi->yres, 8);
-+ u32 size_yuv420 = FRAME_SIZE_YUV420(fbi->xres, fbi->yres, 8);
-+
-+ return max(size_rgb, max(size_yuv422, size_yuv420));
-+}
-+
-+#ifdef CONFIG_FTLCD_OSD
-+/************************************
-+ * OSD
-+ ***********************************/
-+#define FOSD_SETPOS 0x46e1
-+#define FOSD_SETDIM 0x46e2
-+#define FOSD_SETSCAL 0x46e3
-+#define FLCD_SET_TRANSPARENT 0x46e4
-+#define FLCD_SET_STRING 0x46e5
-+#define FOSD_ON 0x46e6
-+#define FOSD_OFF 0x46e7
-+#define FRREG 0x46e8
-+#define FWREG 0x46e9
-+
-+#define dig_alpha (16 * 10) + (16 * 26) + (16 * 3)
-+
-+struct fosd_string {
-+
-+ unsigned int Str_row;
-+ unsigned int display_mode;
-+ unsigned int fg_color;
-+ unsigned int bg_color;
-+ unsigned char Str_OSD[30];
-+};
-+
-+struct fosd_data {
-+
-+ unsigned int HPos;
-+ unsigned int VPos;
-+ unsigned int HDim;
-+ unsigned int VDim;
-+ unsigned int transparent_level;
-+ unsigned int HScal;
-+ unsigned int VScal;
-+ struct fosd_string Str_Data[10];
-+};
-+
-+unsigned int OSD_Font[] = {
-+
-+ /* 0 */
-+ 0x00, 0x00, 0x00, 0x3e, 0x63, 0x67, 0x6f, 0x7b,
-+ 0x73, 0x63, 0x63, 0x3e, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 1 */
-+ 0x00, 0x00, 0x00, 0x0c, 0x1c, 0x3c, 0x0c, 0x0c,
-+ 0x0c, 0x0c, 0x0c, 0x3f, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 2 */
-+ 0x00, 0x00, 0x00, 0x3e, 0x63, 0x03, 0x06, 0x0c,
-+ 0x18, 0x30, 0x63, 0x7f, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 3 */
-+ 0x00, 0x00, 0x00, 0x3E, 0x63, 0x03, 0x03, 0x1e,
-+ 0x03, 0x03, 0x63, 0x3E, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 4 */
-+ 0x00, 0x00, 0x00, 0x06, 0x0e, 0x1e, 0x36, 0x66,
-+ 0x7f, 0x06, 0x06, 0x0f, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 5 */
-+ 0x00, 0x00, 0x00, 0x7f, 0x60, 0x60, 0x60, 0x7e,
-+ 0x03, 0x03, 0x63, 0x3e, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 6 */
-+ 0x00, 0x00, 0x00, 0x1c, 0x30, 0x60, 0x60, 0x7e,
-+ 0x63, 0x63, 0x63, 0x3e, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 7 */
-+ 0x00, 0x00, 0x00, 0x7f, 0x63, 0x03, 0x06, 0x0c,
-+ 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 8 */
-+ 0x00, 0x00, 0x00, 0x3e, 0x63, 0x63, 0x63, 0x3e,
-+ 0x63, 0x63, 0x63, 0x3e, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* 9 */
-+ 0x00, 0x00, 0x00, 0x3e, 0x63, 0x63, 0x63, 0x3f,
-+ 0x03, 0x03, 0x06, 0x3c, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* A */
-+ 0x00, 0x00, 0x00, 0x08, 0x1c, 0x36, 0x63, 0x63,
-+ 0x7f, 0x63, 0x63, 0x63, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* B */
-+ 0x00, 0x00, 0x00, 0x7E, 0x33, 0x33, 0x33, 0x3E,
-+ 0x33, 0x33, 0x33, 0x7E, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* C */
-+ 0x00, 0x00, 0x00, 0x1E, 0x33, 0x61, 0x60, 0x60,
-+ 0x60, 0x61, 0x33, 0x1E, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* D */
-+ 0x00, 0x00, 0x00, 0x7c, 0x36, 0x33, 0x33, 0x33,
-+ 0x33, 0x33, 0x36, 0x7C, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* E */
-+ 0x00, 0x00, 0x00, 0x7f, 0x33, 0x31, 0x34, 0x3c,
-+ 0x34, 0x31, 0x33, 0x7f, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* F */
-+ 0x00, 0x00, 0x00, 0x7f, 0x33, 0x31, 0x34, 0x3c,
-+ 0x34, 0x30, 0x30, 0x78, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* G */
-+ 0x00, 0x00, 0x00, 0x1E, 0x33, 0x61, 0x60, 0x60,
-+ 0x6F, 0x63, 0x36, 0x7C, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* H */
-+ 0x00, 0x00, 0x00, 0x63, 0x63, 0x63, 0x64, 0x7f,
-+ 0x63, 0x63, 0x63, 0x63, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* I */
-+ 0x00, 0x00, 0x00, 0x3c, 0x18, 0x18, 0x18, 0x18,
-+ 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* J */
-+ 0x00, 0x00, 0x00, 0x0f, 0x06, 0x06, 0x06, 0x06,
-+ 0x06, 0x66, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* K */
-+ 0x00, 0x00, 0x00, 0x73, 0x33, 0x36, 0x36, 0x3c,
-+ 0x36, 0x36, 0x33, 0x73, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* L */
-+ 0x00, 0x00, 0x00, 0x78, 0x30, 0x30, 0x30, 0x30,
-+ 0x30, 0x31, 0x33, 0x7f, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* M */
-+ 0x00, 0x00, 0x00, 0x63, 0x77, 0x7f, 0x6b, 0x63,
-+ 0x63, 0x63, 0x63, 0x63, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* N */
-+ 0x00, 0x00, 0x00, 0x63, 0x73, 0x7b, 0x7f, 0x6f,
-+ 0x67, 0x63, 0x63, 0x63, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* O */
-+ 0x00, 0x00, 0x00, 0x1c, 0x36, 0x63, 0x63, 0x63,
-+ 0x63, 0x63, 0x36, 0x1c, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* P */
-+ 0x00, 0x00, 0x00, 0x7e, 0x33, 0x33, 0x33, 0x3e,
-+ 0x30, 0x30, 0x30, 0x78, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* Q */
-+ 0x00, 0x00, 0x00, 0x3e, 0x63, 0x63, 0x63, 0x63,
-+ 0x6b, 0x6f, 0x3e, 0x06, 0x07, 0x00, 0x00, 0x00,
-+
-+ /* R */
-+ 0x00, 0x00, 0x00, 0x7e, 0x33, 0x33, 0x33, 0x3e,
-+ 0x36, 0x33, 0x33, 0x73, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* S */
-+ 0x00, 0x00, 0x00, 0x3e, 0x63, 0x63, 0x30, 0x1c,
-+ 0x06, 0x63, 0x63, 0x3e, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* T */
-+ 0x00, 0x00, 0x00, 0xFF, 0x99, 0x18, 0x18, 0x18,
-+ 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* U */
-+ 0x00, 0x00, 0x00, 0x63, 0x63, 0x63, 0x63, 0x63,
-+ 0x63, 0x63, 0x63, 0x3e, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* V */
-+ 0x00, 0x00, 0x00, 0x63, 0x63, 0x63, 0x63, 0x63,
-+ 0x63, 0x36, 0x1c, 0x08, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* W */
-+ 0x00, 0x00, 0x00, 0x63, 0x63, 0x63, 0x63, 0x63,
-+ 0x6b, 0x7f, 0x77, 0x63, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* X */
-+ 0x00, 0x00, 0x00, 0x63, 0x63, 0x63, 0x36, 0x1c,
-+ 0x36, 0x63, 0x63, 0x63, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* Y */
-+ 0x00, 0x00, 0x00, 0x63, 0x63, 0x63, 0x36, 0x1c,
-+ 0x1c, 0x1c, 0x1c, 0x3e, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* Z */
-+ 0x00, 0x00, 0x00, 0x7f, 0x63, 0x46, 0x0c, 0x18,
-+ 0x30, 0x61, 0x63, 0x7f, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* space */
-+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
-+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* = */
-+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7E, 0x00,
-+ 0x00, 0x7E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
-+
-+ /* , */
-+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
-+ 0x00, 0x18, 0x18, 0x18, 0x30, 0x00, 0x00, 0x00,
-+};
-+
-+void OSD_On(struct faradayfb_info *fbi)
-+{
-+ REG32(fbi->io_base + 0x34) &= 0xfffffffe;
-+ REG32(fbi->io_base + 0x34) |= 1;
-+}
-+
-+void OSD_Off(struct faradayfb_info *fbi)
-+{
-+ REG32(fbi->io_base + 0x34) &= 0xfffffffe;
-+}
-+
-+void OSD_Pos(struct faradayfb_info *fbi, int HPos, int VPos)
-+{
-+ REG32(fbi->io_base + 0x38) = (HPos << 10) | VPos;
-+}
-+
-+void OSD_Dim(struct faradayfb_info *fbi, int HDim, int VDim)
-+{
-+ REG32(fbi->io_base + 0x34) &= 0x0000001f;
-+ REG32(fbi->io_base + 0x34) |= ((HDim << 10) | (VDim << 5));
-+}
-+
-+void OSD_transparent(struct faradayfb_info *fbi, int level)
-+{
-+ REG32(fbi->io_base + 0x40) &= 0xffffff00;
-+ REG32(fbi->io_base + 0x40) |= (level << 6);
-+}
-+
-+void OSD_fg_color(struct faradayfb_info *fbi, int pal0, int pal1, int pal2, int pal3)
-+{
-+ REG32(fbi->io_base + 0x3c) = (pal0) | (pal1 << 8) | (pal2 << 16) | (pal3<< 24);
-+}
-+
-+void OSD_bg_color(struct faradayfb_info *fbi, int pal1, int pal2, int pal3)
-+{
-+ REG32(fbi->io_base + 0x40) &= 0x000000ff;
-+ REG32(fbi->io_base + 0x40) |= (pal1 << 8) | (pal2 << 16) | (pal3 << 24);
-+}
-+
-+void OSD_Scal(struct faradayfb_info *fbi, int HScal, int VScal)
-+{
-+ REG32(fbi->io_base + 0x34) &= 0xffffffe1;
-+ REG32(fbi->io_base + 0x34) |= (HScal << 3) | (VScal << 1);
-+}
-+
-+void OSD_putc(struct faradayfb_info *fbi, char c, int position, unsigned int value)
-+{
-+ if (c >= '0' && c <= '9')
-+ REG32(fbi->io_base + 0xc000 + position * 4) = ((c -'0') << 4) | value;
-+
-+ else if (c>= 'A' && c <= 'Z')
-+ REG32(fbi->io_base + 0xc000 + position * 4) = ((c - 'A' + 10) << 4) | value;
-+
-+ if (c == ' ')
-+ REG32(fbi->io_base + 0xc000 + position * 4) = (('Z' - 'A' + 10 + 1) << 4) | value;
-+
-+ if (c == '=')
-+ REG32(fbi->io_base + 0xc000 + position * 4) = (('Z' - 'A' + 10 + 2) << 4) | value;
-+
-+ if (c == ',')
-+ REG32(fbi->io_base + 0xc000 + position * 4) = (('Z' - 'A' + 10 + 3) << 4) | value;
-+}
-+
-+void OSD_puts(struct faradayfb_info *fbi, char *str, int position, unsigned int value)
-+{
-+ int i;
-+
-+ for (i = 0; i < strlen(str); i++)
-+ OSD_putc(fbi, *(str + i), position + i, value);
-+}
-+
-+void OSD_String(struct faradayfb_info *fbi, int row, int mode, char *str, int fg_color, int bg_color)
-+{
-+ int i, j, x, y;
-+ unsigned int value = fg_color | bg_color;
-+
-+ /* 10 digit & 26 alphabet & ' ' & '=' & ',' */
-+ for (i = 0; i < dig_alpha; i++) {
-+
-+ x = 0;
-+ y = OSD_Font[i];
-+
-+ for (j = 0; j < 12; j ++) { /* reorder */
-+ if (y & 1)
-+ x |= 1;
-+ y >>= 1;
-+ x <<= 1;
-+ }
-+
-+ x >>= 1;
-+ REG32(fbi->io_base + 0x8000 + i * 4) = x;
-+ }
-+
-+ OSD_puts(fbi, str, row, value);
-+
-+ if (mode == 2) { /* YCbCr */
-+
-+ OSD_fg_color(fbi, 0x57, 0x88, 0x3B, 0xFF);
-+ OSD_bg_color(fbi, 0x57, 0x88, 0x3B);
-+ }
-+ else {
-+ OSD_fg_color(fbi, 0x07, 0x38, 0xC0, 0xFF);
-+ OSD_bg_color(fbi, 0x07, 0x38, 0xc0);
-+ }
-+}
-+#endif /* CONFIG_FTLCD_OSD */
-+
-+struct andesIO {
-+
-+ unsigned long Regaddr;
-+ unsigned long Regoffset;
-+ unsigned long Regvalue;
-+};
-+
-+static int faradayfb_ioctl(struct fb_info *info, unsigned int cmd, unsigned long arg)
-+{
-+ int ret = 0;
-+#ifdef CONFIG_FTLCD_OSD
-+ struct faradayfb_info *fbi = info->par;
-+ int i;
-+ struct fosd_data fosd;
-+
-+ struct andesIO IOAccess;
-+ unsigned long *Regaccess;
-+#endif
-+
-+ DEBUG(0, 1, "Enter\n");
-+
-+ switch (cmd) {
-+#ifdef CONFIG_FTLCD_OSD
-+ case FRREG:
-+
-+ if (copy_from_user(&IOAccess, (struct andesIO *)arg, sizeof(struct andesIO))) {
-+
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ Regaccess = (unsigned long *)(((IOAccess.Regaddr >> 4) | (unsigned long)0xF0000000) + IOAccess.Regoffset);
-+
-+ IOAccess.Regvalue = *(Regaccess);
-+
-+ if (copy_to_user((struct andesIO *)arg, &IOAccess, sizeof(struct andesIO))) {
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ break;
-+
-+ case FWREG:
-+
-+ if (copy_from_user(&IOAccess, (struct andesIO *)arg, sizeof(struct andesIO))) {
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ Regaccess = (unsigned long *)(((IOAccess.Regaddr >> 4) | (unsigned long)0xF0000000) + IOAccess.Regoffset);
-+ *(Regaccess) = IOAccess.Regvalue;
-+
-+ break;
-+
-+ case FOSD_ON:
-+
-+ DEBUG(1, 1, "FOSD_ON:\n");
-+ OSD_On(fbi);
-+ break;
-+
-+ case FOSD_OFF:
-+
-+ DEBUG(1, 1, "FOSD_OFF:\n");
-+ OSD_Off(fbi);
-+ break;
-+
-+ case FOSD_SETPOS:
-+
-+ DEBUG(1, 1, "FOSD_SETPOS:\n");
-+
-+ if (copy_from_user(&fosd, (unsigned int *)arg, 2 * sizeof(unsigned int))) {
-+
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ OSD_Pos(fbi, fosd.HPos, fosd.VPos);
-+ DEBUG(1, 1, "OSD_Pos = %d %d\n", fosd.HPos, fosd.VPos);
-+ break;
-+
-+ case FOSD_SETDIM:
-+
-+ DEBUG(1, 1, "FOSD_SETDIM:\n");
-+
-+ if (copy_from_user(&fosd, (unsigned int *)arg, 4 * sizeof(unsigned int))) {
-+
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ OSD_Dim(fbi, fosd.HDim, fosd.VDim);
-+ DEBUG(1, 1, "OSD_Dim = %d %d\n", fosd.HDim, fosd.VDim);
-+ break;
-+
-+ case FOSD_SETSCAL:
-+
-+ DEBUG(1, 1, "FOSD_SETSCAL:\n");
-+
-+ if (copy_from_user(&fosd, (unsigned int *)arg, 7 * sizeof(unsigned int))) {
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ OSD_Scal(fbi, fosd.HScal, fosd.VScal);
-+ break;
-+
-+ case FLCD_SET_TRANSPARENT:
-+
-+ DEBUG(1, 1, "FLCD_SET_TRANSPARENT:\n");
-+
-+ if (copy_from_user(&fosd, (unsigned int *)arg, 5 * sizeof(unsigned int))) {
-+
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ OSD_transparent(fbi, fosd.transparent_level);
-+ DEBUG(1, 1, "OSD_transparent = %d\n", fosd.transparent_level);
-+ break;
-+
-+ case FLCD_SET_STRING:
-+
-+ DEBUG(1, 1, "FLCD_SET_STRING:\n");
-+
-+ if (copy_from_user(&fosd, (unsigned int *)arg, sizeof(struct fosd_data))) {
-+
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ for (i = 0; i < fosd.VDim; i++)
-+
-+ OSD_String(fbi, fosd.Str_Data[i].Str_row,
-+ fosd.Str_Data[i].display_mode,
-+ fosd.Str_Data[i].Str_OSD,
-+ fosd.Str_Data[i].fg_color,
-+ fosd.Str_Data[i].bg_color);
-+ break;
-+#endif /* CONFIG_FTLCD_OSD */
-+
-+ default:
-+
-+ DEBUG(1, 1, "IOCTL CMD(0x%08u) no define!\n", cmd);
-+ ret = -EFAULT;
-+ break;
-+ }
-+
-+ DEBUG(0, 1, "Leave\n");
-+ return ret;
-+}
-+
-diff -Nur linux-3.4.113.orig/drivers/video/Kconfig linux-3.4.113/drivers/video/Kconfig
---- linux-3.4.113.orig/drivers/video/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/video/Kconfig 2016-12-01 20:59:24.392614293 +0100
-@@ -2166,6 +2166,8 @@
- ---help---
- Say Y here to enable support for PNX4008 RGB Framebuffer
-
-+source "drivers/video/FTLCDC100/Kconfig"
-+
- config FB_IBM_GXT4500
- tristate "Framebuffer support for IBM GXT4500P adaptor"
- depends on FB && PPC
-diff -Nur linux-3.4.113.orig/drivers/video/Makefile linux-3.4.113/drivers/video/Makefile
---- linux-3.4.113.orig/drivers/video/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/video/Makefile 2016-12-01 20:59:24.392614293 +0100
-@@ -143,6 +143,7 @@
- obj-$(CONFIG_FB_CARMINE) += carminefb.o
- obj-$(CONFIG_FB_MB862XX) += mb862xx/
- obj-$(CONFIG_FB_MSM) += msm/
-+obj-$(CONFIG_FB_FTLCDC100) += FTLCDC100/
- obj-$(CONFIG_FB_NUC900) += nuc900fb.o
- obj-$(CONFIG_FB_JZ4740) += jz4740_fb.o
- obj-$(CONFIG_FB_PUV3_UNIGFX) += fb-puv3.o
-diff -Nur linux-3.4.113.orig/drivers/watchdog/ftwdt010_wdt.c linux-3.4.113/drivers/watchdog/ftwdt010_wdt.c
---- linux-3.4.113.orig/drivers/watchdog/ftwdt010_wdt.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/drivers/watchdog/ftwdt010_wdt.c 2016-12-01 20:59:24.392614293 +0100
-@@ -0,0 +1,127 @@
-+/*
-+ * Watchdog driver for the FTWDT010 Watch Dog Driver
-+ *
-+ * (c) Copyright 2004 Faraday Technology Corp. (www.faraday-tech.com)
-+ * Based on sa1100_wdt.c by Oleg Drokin <green@crimea.edu>
-+ * Based on SoftDog driver by Alan Cox <alan@redhat.com>
-+ *
-+ * This program is free software; you can redistribute it and/or
-+ * modify it under the terms of the GNU General Public License
-+ * as published by the Free Software Foundation; either version
-+ * 2 of the License, or (at your option) any later version.
-+ *
-+ * 27/11/2004 Initial release
-+ */
-+#include <linux/module.h>
-+#include <linux/fs.h>
-+#include <linux/miscdevice.h>
-+#include <linux/watchdog.h>
-+#include <linux/delay.h>
-+#include <asm/uaccess.h>
-+
-+#define DEBUG( str, ...) \
-+ do{ \
-+ if( debug) \
-+ printk( str, ##__VA_ARGS__); \
-+ } while(0)
-+
-+#define wdcounter (*( volatile unsigned long *)( WDT_FTWDT010_VA_BASE + 0x00))
-+#define wdload (*( volatile unsigned long *)( WDT_FTWDT010_VA_BASE + 0x04))
-+#define wdrestart (*( volatile unsigned long *)( WDT_FTWDT010_VA_BASE + 0x08))
-+#define wdcr (*( volatile unsigned long *)( WDT_FTWDT010_VA_BASE + 0x0C))
-+#define wdstatus (*( volatile unsigned long *)( WDT_FTWDT010_VA_BASE + 0x10))
-+#define wdclear (*( volatile unsigned long *)( WDT_FTWDT010_VA_BASE + 0x14))
-+#define wdintrcter (*( volatile unsigned long *)( WDT_FTWDT010_VA_BASE + 0x18))
-+
-+#define TIMER_MARGIN 60 /* (secs) Default is 1 minute */
-+#define RESTART_MAGIC 0x5AB9
-+#define PCLK (AHB_CLK_IN / 2)
-+
-+static int debug = 0;
-+static int timeout = TIMER_MARGIN; /* in seconds */
-+
-+module_param(debug, int, 0);
-+module_param(timeout, int, 0);
-+
-+static int ftwdt010_dog_open(struct inode *inode, struct file *file){
-+
-+#if 0
-+ /* Allow only one person to hold it open */
-+ if( test_and_set_bit( 1, &ftwdt010_wdt_users))
-+ return -EBUSY;
-+
-+ ftwdt010_wdt_users = 1;
-+#endif
-+ DEBUG("Activating WDT..\n");
-+
-+ wdcr = 0;
-+ wdload = PCLK * timeout;
-+ wdrestart = RESTART_MAGIC; /* Magic number */
-+ wdcr = 0x03; /* Enable WDT */
-+
-+ return 0;
-+}
-+
-+static int ftwdt010_dog_release(struct inode *inode, struct file *file){
-+
-+#ifndef CONFIG_WATCHDOG_NOWAYOUT
-+ /*
-+ * Shut off the timer.
-+ * Lock it in if it's a module and we defined ...NOWAYOUT
-+ */
-+ wdcr = 0;
-+ DEBUG( "Deactivating WDT..\n");
-+#endif
-+ return 0;
-+}
-+
-+static ssize_t ftwdt010_dog_write(struct file *file, const char *data, size_t len, loff_t *ppos){
-+
-+ if(len){
-+
-+ wdrestart = RESTART_MAGIC;
-+ return 1;
-+ }
-+
-+ return 0;
-+}
-+
-+static struct file_operations ftwdt010_dog_fops = {
-+
-+ .owner = THIS_MODULE,
-+ .llseek = no_llseek,
-+ .write = ftwdt010_dog_write,
-+ .open = ftwdt010_dog_open,
-+ .release = ftwdt010_dog_release,
-+};
-+
-+static struct miscdevice ftwdt010_dog_miscdev = {
-+
-+ WATCHDOG_MINOR,
-+ "FTWDT010 watchdog",
-+ &ftwdt010_dog_fops
-+};
-+
-+static int __init ftwdt010_dog_init( void){
-+
-+ int ret;
-+
-+ ret = misc_register(&ftwdt010_dog_miscdev);
-+
-+ if( ret)
-+ return ret;
-+
-+ DEBUG("FTWDT010 watchdog timer: timer timeout %d sec\n", timeout);
-+
-+ return 0;
-+}
-+
-+static void __exit ftwdt010_dog_exit( void){
-+
-+ misc_deregister(&ftwdt010_dog_miscdev);
-+}
-+
-+module_init(ftwdt010_dog_init);
-+module_exit(ftwdt010_dog_exit);
-+MODULE_AUTHOR("Faraday Corp.");
-+MODULE_LICENSE("GPL");
-diff -Nur linux-3.4.113.orig/drivers/watchdog/Kconfig linux-3.4.113/drivers/watchdog/Kconfig
---- linux-3.4.113.orig/drivers/watchdog/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/watchdog/Kconfig 2016-12-01 20:59:24.392614293 +0100
-@@ -64,6 +64,12 @@
- To compile this driver as a module, choose M here: the
- module will be called softdog.
-
-+config FTWDT010_WATCHDOG
-+ tristate "FTWDT010_WATCHDOG"
-+ help
-+ Support for Faraday ftwdt010 watchdog. When the watchdog triigers the
-+ system will be reset.
-+
- config WM831X_WATCHDOG
- tristate "WM831x watchdog"
- depends on MFD_WM831X
-diff -Nur linux-3.4.113.orig/drivers/watchdog/Makefile linux-3.4.113/drivers/watchdog/Makefile
---- linux-3.4.113.orig/drivers/watchdog/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/drivers/watchdog/Makefile 2016-12-01 20:59:24.392614293 +0100
-@@ -163,6 +163,7 @@
- obj-$(CONFIG_XEN_WDT) += xen_wdt.o
-
- # Architecture Independent
-+obj-$(CONFIG_FTWDT010_WATCHDOG) += ftwdt010_wdt.o
- obj-$(CONFIG_WM831X_WATCHDOG) += wm831x_wdt.o
- obj-$(CONFIG_WM8350_WATCHDOG) += wm8350_wdt.o
- obj-$(CONFIG_MAX63XX_WATCHDOG) += max63xx_wdt.o
-diff -Nur linux-3.4.113.orig/include/linux/mm.h linux-3.4.113/include/linux/mm.h
---- linux-3.4.113.orig/include/linux/mm.h 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/include/linux/mm.h 2016-12-01 20:59:24.392614293 +0100
-@@ -157,6 +157,7 @@
- #define FAULT_FLAG_ALLOW_RETRY 0x08 /* Retry fault if blocking */
- #define FAULT_FLAG_RETRY_NOWAIT 0x10 /* Don't drop mmap_sem and wait when retrying */
- #define FAULT_FLAG_KILLABLE 0x20 /* The fault task is in SIGKILL killable region */
-+#define FAULT_FLAG_TRIED 0x40 /* second try */
-
- /*
- * This interface is used by x86 PAT code to identify a pfn mapping that is
-diff -Nur linux-3.4.113.orig/include/linux/semaphore.h linux-3.4.113/include/linux/semaphore.h
---- linux-3.4.113.orig/include/linux/semaphore.h 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/include/linux/semaphore.h 2016-12-01 20:59:24.392614293 +0100
-@@ -36,6 +36,9 @@
- lockdep_init_map(&sem->lock.dep_map, "semaphore->lock", &__key, 0);
- }
-
-+#define init_MUTEX(sem) sema_init(sem, 1)
-+#define init_MUTEX_LOCKED(sem) sema_init(sem, 0)
-+
- extern void down(struct semaphore *sem);
- extern int __must_check down_interruptible(struct semaphore *sem);
- extern int __must_check down_killable(struct semaphore *sem);
-diff -Nur linux-3.4.113.orig/init/Kconfig linux-3.4.113/init/Kconfig
---- linux-3.4.113.orig/init/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/init/Kconfig 2016-12-01 20:59:24.392614293 +0100
-@@ -966,7 +966,7 @@
-
- config UID16
- bool "Enable 16-bit UID system calls" if EXPERT
-- depends on ARM || BLACKFIN || CRIS || FRV || H8300 || X86_32 || M68K || (S390 && !64BIT) || SUPERH || SPARC32 || (SPARC64 && COMPAT) || UML || (X86_64 && IA32_EMULATION)
-+ depends on ARM || BLACKFIN || CRIS || FRV || H8300 || X86_32 || M68K || NDS32 || (S390 && !64BIT) || SUPERH || SPARC32 || (SPARC64 && COMPAT) || UML || (X86_64 && IA32_EMULATION)
- default y
- help
- This enables the legacy 16-bit UID syscall wrappers.
-diff -Nur linux-3.4.113.orig/kernel/Makefile linux-3.4.113/kernel/Makefile
---- linux-3.4.113.orig/kernel/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/kernel/Makefile 2016-12-01 20:59:24.396614447 +0100
-@@ -20,6 +20,7 @@
- CFLAGS_REMOVE_rtmutex-debug.o = -pg
- CFLAGS_REMOVE_cgroup-debug.o = -pg
- CFLAGS_REMOVE_irq_work.o = -pg
-+CFLAGS_REMOVE_kallsyms.o = -pg
- endif
-
- obj-y += sched/
-diff -Nur linux-3.4.113.orig/kernel/trace/Kconfig linux-3.4.113/kernel/trace/Kconfig
---- linux-3.4.113.orig/kernel/trace/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/kernel/trace/Kconfig 2016-12-01 20:59:24.396614447 +0100
-@@ -141,7 +141,7 @@
- config FUNCTION_TRACER
- bool "Kernel Function Tracer"
- depends on HAVE_FUNCTION_TRACER
-- select FRAME_POINTER if !ARM_UNWIND && !PPC && !S390 && !MICROBLAZE
-+ select FRAME_POINTER if !ARM_UNWIND && !PPC && !S390 && !MICROBLAZE && !NDS32
- select KALLSYMS
- select GENERIC_TRACER
- select CONTEXT_SWITCH_TRACER
-diff -Nur linux-3.4.113.orig/lib/Kconfig.debug linux-3.4.113/lib/Kconfig.debug
---- linux-3.4.113.orig/lib/Kconfig.debug 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/lib/Kconfig.debug 2016-12-01 20:59:24.396614447 +0100
-@@ -615,7 +615,7 @@
- bool
- depends on DEBUG_KERNEL && TRACE_IRQFLAGS_SUPPORT && STACKTRACE_SUPPORT && LOCKDEP_SUPPORT
- select STACKTRACE
-- select FRAME_POINTER if !MIPS && !PPC && !ARM_UNWIND && !S390 && !MICROBLAZE
-+ select FRAME_POINTER if !MIPS && !PPC && !ARM_UNWIND && !S390 && !MICROBLAZE && !NDS32
- select KALLSYMS
- select KALLSYMS_ALL
-
-@@ -1122,7 +1122,7 @@
- depends on FAULT_INJECTION_DEBUG_FS && STACKTRACE_SUPPORT
- depends on !X86_64
- select STACKTRACE
-- select FRAME_POINTER if !PPC && !S390 && !MICROBLAZE && !ARM_UNWIND
-+ select FRAME_POINTER if !PPC && !S390 && !MICROBLAZE && !ARM_UNWIND && !NDS32
- help
- Provide stacktrace filter for fault-injection capabilities
-
-@@ -1132,7 +1132,7 @@
- depends on DEBUG_KERNEL
- depends on STACKTRACE_SUPPORT
- depends on PROC_FS
-- select FRAME_POINTER if !MIPS && !PPC && !S390 && !MICROBLAZE && !ARM_UNWIND
-+ select FRAME_POINTER if !MIPS && !PPC && !S390 && !MICROBLAZE && !ARM_UNWIND && !NDS32
- select KALLSYMS
- select KALLSYMS_ALL
- select STACKTRACE
-diff -Nur linux-3.4.113.orig/sound/Kconfig linux-3.4.113/sound/Kconfig
---- linux-3.4.113.orig/sound/Kconfig 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/sound/Kconfig 2016-12-01 20:59:24.396614447 +0100
-@@ -93,6 +93,8 @@
-
- source "sound/sh/Kconfig"
-
-+source "sound/nds32/Kconfig"
-+
- # the following will depend on the order of config.
- # here assuming USB is defined before ALSA
- source "sound/usb/Kconfig"
-diff -Nur linux-3.4.113.orig/sound/Makefile linux-3.4.113/sound/Makefile
---- linux-3.4.113.orig/sound/Makefile 2016-10-26 17:15:47.000000000 +0200
-+++ linux-3.4.113/sound/Makefile 2016-12-01 20:59:24.396614447 +0100
-@@ -6,7 +6,7 @@
- obj-$(CONFIG_SOUND_PRIME) += oss/
- obj-$(CONFIG_DMASOUND) += oss/
- obj-$(CONFIG_SND) += core/ i2c/ drivers/ isa/ pci/ ppc/ arm/ sh/ synth/ usb/ \
-- firewire/ sparc/ spi/ parisc/ pcmcia/ mips/ soc/ atmel/
-+ firewire/ sparc/ spi/ parisc/ pcmcia/ mips/ soc/ atmel/ nds32/
- obj-$(CONFIG_SND_AOA) += aoa/
-
- # This one must be compilable even if sound is configured out
-diff -Nur linux-3.4.113.orig/sound/nds32/FTSSP010_ALSA.c linux-3.4.113/sound/nds32/FTSSP010_ALSA.c
---- linux-3.4.113.orig/sound/nds32/FTSSP010_ALSA.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/FTSSP010_ALSA.c 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,2020 @@
-+/* FTSSP010 - UDA1345TS module:
-+ *
-+ * $log$
-+ *
-+ * 2006/02/23: I-Jui Sung: OSS emulation half-duplex
-+ * playback/capture at 48K, 44.1K, 8K
-+ * with mono/stereo 16bit/8bit
-+ *
-+ * 2006/02/22: I-Jui Sung: OSS emulation playback at 44.1KHz
-+ * 16-bit mono completed. Relying ALSA to
-+ * resample
-+ * 2009/02/24: dma upgrade checking list:
-+ * - ac97 mode playback ................. ok
-+ * - ac97 mode capture .................. ok
-+ * - i2s mode playback .................. ok
-+ * - i2s mode capture ................... ok
-+ * - mixer support (snd_ctl_add, ...) ... todo
-+ * - debug /proc entry .................. ok
-+ */
-+
-+
-+#include <linux/init.h>
-+#include <linux/module.h>
-+#include <asm/io.h>
-+#include <linux/delay.h>
-+//#include <asm/spec.h>
-+#include <asm/dmad.h>
-+#include <linux/dma-mapping.h>
-+#include <sound/core.h>
-+#include <sound/pcm.h>
-+#include <sound/initval.h>
-+#include <sound/asound.h>
-+#include <linux/i2c.h>
-+#include <sound/control.h>
-+#include <linux/interrupt.h>
-+
-+#include <asm/hardware.h>
-+#include <asm/irq.h>
-+#include <asm/io.h>
-+#include <asm/spec.h>
-+
-+#include "FTSSP010_UDA1345TS.h"
-+
-+//ADD by river 2011.06.02
-+struct alc5630_data;
-+//End ADD by river 2011.06.02
-+
-+void init_hw(unsigned int cardno,unsigned int ac97, struct i2c_client *client);
-+
-+#if (!defined(CONFIG_PLATFORM_AHBDMA) && !defined(CONFIG_PLATFORM_APBDMA))
-+#warning needs ahb/apb dma to wrok
-+#endif
-+
-+/* ---------------------------------------------------------------------------
-+ * Define the debug level of FTSSP_DEBUG
-+ */
-+#define FTSSP_DEBUG 0
-+#define FTSSP_DEBUG_VERBOSE 0
-+#define FTSSP_PROC_FS 0
-+
-+#undef VVDBG
-+#if (FTSSP_DEBUG_VERBOSE)
-+#define VVDBG(vvar...) (void)0
-+//#define VVDBG(vvar...) printk(KERN_INFO vvar)
-+#else
-+#define VVDBG(vvar...) (void)0
-+#endif
-+
-+#undef ERR
-+#define ERR(vvar...) printk(KERN_ERR vvar)
-+
-+#undef INFO
-+#define INFO(vvar...) printk(KERN_INFO vvar)
-+
-+#if (FTSSP_DEBUG)
-+#undef DBG
-+#define DBG(vvar...) printk(KERN_INFO vvar)
-+#else
-+#define DBG(vvar...) (void)0
-+#endif
-+
-+#if (FTSSP_DEBUG_VERBOSE)
-+#undef VDBG
-+#define VDBG(vvar...) printk(KERN_INFO vvar)
-+#else
-+#define VDBG(vvar...) (void)0
-+#endif
-+
-+#ifdef CONFIG_SND_FTSSP010_I2S
-+//ADD by river 2011.02.11
-+static struct i2c_client *g_i2c_client;
-+
-+////////// ADD by river 2011.01.26
-+// Each client has this additional data
-+struct alc5630_data {
-+ struct i2c_client *client;
-+ struct delayed_work work;
-+ unsigned long gpio2_value;
-+ struct mutex mtx;
-+};
-+
-+static int alc5630_i2c_attach(struct i2c_adapter *adapter);
-+static int alc5630_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id);
-+static int alc5630_i2c_suspend(struct i2c_client *i2c_client, pm_message_t mesg);
-+static int alc5630_i2c_resume(struct i2c_client *i2c_client);
-+
-+static int alc5630_i2c_remove(struct i2c_client *client);
-+static int ftssp_alsa_init(struct i2c_client *client);
-+
-+
-+static int i2s_alc5630_read(unsigned int raddr, char *data, struct i2c_client *client)
-+{
-+ struct i2c_adapter *adap = client->adapter;
-+ struct i2c_msg msg;
-+ int ret, i2c_value;
-+
-+ //Reading ALC5630 register
-+ msg.addr = raddr;
-+ msg.flags = (client->flags & I2C_M_TEN) | I2C_M_RD;
-+ msg.len = 1;
-+ msg.buf = (char *)data;
-+
-+ //ret = i2c_transfer(adap, &msg, 1);
-+ #ifndef CONFIG_SND_FTSSP010_AC97
-+ ret = i2c_transfer(adap, &msg, 1);
-+ #endif
-+
-+ if (ret != 0) {
-+ printk("i2c read failed\n");
-+ return -1;
-+ }
-+ else
-+ {
-+ i2c_value = (data[0]&0xff) << 8 | (data[1]&0xff);
-+ return i2c_value;
-+ }
-+
-+}
-+
-+static void i2s_alc5630_write(unsigned int addr, unsigned int data, struct i2c_client *client)
-+{
-+
-+ struct i2c_adapter *adap = client->adapter;
-+ struct i2c_msg msg;
-+ int ret, i2c_value;
-+ char buf[3];
-+
-+ //Writing ALC5630 register
-+ i2c_value = 0x0;
-+ msg.addr = addr;
-+ msg.flags = (client->flags & I2C_M_TEN) | ~I2C_M_RD;
-+ msg.len = 1;
-+
-+ buf[0] = (data >> 8) & 0xff;
-+ buf[1] = data & 0xff;
-+ msg.buf = (char *)buf;
-+
-+ //ret = i2c_transfer(adap, &msg, 1);
-+ #ifndef CONFIG_SND_FTSSP010_AC97
-+ ret = i2c_transfer(adap, &msg, 1);
-+ #endif
-+
-+ if (ret != 0) {
-+ printk("i2c write failed\n");
-+ }
-+
-+}
-+
-+static void i2s_alc5630_read_test(struct i2c_client *client)
-+{
-+ char data[3];
-+ //printk(">>>>> : i2s_alc5630_read_test().....\n");
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0, i2s_alc5630_read(0x0, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x02, i2s_alc5630_read(0x02, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x04, i2s_alc5630_read(0x04, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x06, i2s_alc5630_read(0x06, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x08, i2s_alc5630_read(0x08, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0a, i2s_alc5630_read(0x0a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0c, i2s_alc5630_read(0x0c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0e, i2s_alc5630_read(0x0e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x10, i2s_alc5630_read(0x10, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x12, i2s_alc5630_read(0x12, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x14, i2s_alc5630_read(0x14, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x16, i2s_alc5630_read(0x16, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x18, i2s_alc5630_read(0x18, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x1a, i2s_alc5630_read(0x1a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x1c, i2s_alc5630_read(0x1c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x1e, i2s_alc5630_read(0x1e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x20, i2s_alc5630_read(0x20, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x22, i2s_alc5630_read(0x22, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x24, i2s_alc5630_read(0x24, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x26, i2s_alc5630_read(0x26, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x28, i2s_alc5630_read(0x28, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x2a, i2s_alc5630_read(0x2a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x2c, i2s_alc5630_read(0x2c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x2e, i2s_alc5630_read(0x2e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x30, i2s_alc5630_read(0x30, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x32, i2s_alc5630_read(0x32, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x34, i2s_alc5630_read(0x34, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x36, i2s_alc5630_read(0x36, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x38, i2s_alc5630_read(0x38, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x3a, i2s_alc5630_read(0x3a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x3c, i2s_alc5630_read(0x3c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x3e, i2s_alc5630_read(0x3e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x40, i2s_alc5630_read(0x40, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x42, i2s_alc5630_read(0x42, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x44, i2s_alc5630_read(0x44, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x46, i2s_alc5630_read(0x46, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x48, i2s_alc5630_read(0x48, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x4a, i2s_alc5630_read(0x4a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x4c, i2s_alc5630_read(0x4c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x4e, i2s_alc5630_read(0x4e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x50, i2s_alc5630_read(0x50, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x52, i2s_alc5630_read(0x52, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x54, i2s_alc5630_read(0x54, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x56, i2s_alc5630_read(0x56, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x58, i2s_alc5630_read(0x58, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x5a, i2s_alc5630_read(0x5a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x5c, i2s_alc5630_read(0x5c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x5e, i2s_alc5630_read(0x5e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x60, i2s_alc5630_read(0x60, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x62, i2s_alc5630_read(0x62, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x64, i2s_alc5630_read(0x64, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x66, i2s_alc5630_read(0x66, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x68, i2s_alc5630_read(0x68, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x6a, i2s_alc5630_read(0x6a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x6c, i2s_alc5630_read(0x6c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x6e, i2s_alc5630_read(0x6e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x70, i2s_alc5630_read(0x70, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x72, i2s_alc5630_read(0x72, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x74, i2s_alc5630_read(0x74, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x76, i2s_alc5630_read(0x76, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x78, i2s_alc5630_read(0x78, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x7a, i2s_alc5630_read(0x7a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x7c, i2s_alc5630_read(0x7c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x7e, i2s_alc5630_read(0x7e, data,client));
-+
-+}
-+
-+static int alc5630_i2c_attach(struct i2c_adapter *adapter){
-+
-+ struct i2c_board_info info;
-+ struct i2c_client *client;
-+
-+ int ret=0;
-+
-+ //i2c_dbg( 1, "alc5630_i2c_attach() is called.\n");
-+ //printk(">>>>>>>>>> (2) alc5630_i2c_attach() is called.\n");
-+
-+ //ret = i2c_probe(adapter, &addr_data, alc5630_detect);
-+ memset(&info, 0, sizeof(struct i2c_board_info));
-+ strlcpy(info.type, "alc5630_codec", I2C_NAME_SIZE);
-+ //info.addr = 0x3e;
-+ info.addr = 0x66;
-+ //info.platform_data = node;
-+
-+ //client = i2c_new_device(adapter, &info);
-+ #ifndef CONFIG_SND_FTSSP010_AC97
-+ client = i2c_new_device(adapter, &info);
-+ #endif
-+ if (!client) {
-+ printk("$$$$$????? : i2c_new_device() failed.....\n");
-+ return -ENODEV;
-+ }
-+ /*
-+ * We know the driver is already loaded, so the device should be
-+ * already bound. If not it means binding failed, and then there
-+ * is no point in keeping the device instantiated.
-+ */
-+ if (!client->driver) {
-+ //i2c_unregister_device(client);
-+ #ifndef CONFIG_SND_FTSSP010_AC97
-+ i2c_unregister_device(client);
-+ #endif
-+ return -ENODEV;
-+ }
-+
-+ /*
-+ * Let i2c-core delete that device on driver removal.
-+ * This is safe because i2c-core holds the core_lock mutex for us.
-+ */
-+ list_add_tail(&client->detected, &client->driver->clients);
-+
-+ return ret;
-+}
-+
-+static irqreturn_t gpio2_irq(int irq, void *dev_id)
-+{
-+
-+ struct i2c_client *client = (struct i2c_client *)dev_id;
-+ struct alc5630_data *alc5630 = i2c_get_clientdata(client);
-+
-+ unsigned long org_mask, org_dir;
-+ //printk("@@@@@#####$$$$$!!!!! : gpio2_irq is detected ???....\n");
-+
-+ //Mask GPIO interrupt
-+ //REG32(AMIC_VA_BASE + 0x80) = REG32(AMIC_VA_BASE + 0x80) & ~(1 << 13); //GPIO interrupt disable
-+
-+ //Dump AMIC contents and ir~
-+ unsigned long ir0,ir1,ir2, ir3, ir4, ir5;
-+ unsigned long ir6, ir7, ir8, ir9, ir10;
-+ unsigned long ir11, ir12, ir13, ir14, ir15;
-+ unsigned long gpio2_value, value;
-+ char data[3];
-+
-+
-+ //__asm__ volatile ("setgie.d\n\t");
-+ //REG32(AMIC_VA_BASE + 0x80) = 0;
-+
-+
-+ //Get original gpio direction
-+ org_dir = REG32(GPIO_VA_BASE + 0x08);
-+
-+ //Get original gpio interrupt mask
-+ org_mask = REG32(GPIO_VA_BASE + 0x2c);
-+
-+ //Mask all gpio interrupt
-+ REG32(GPIO_VA_BASE + 0x2c) = 0x0000FFFF;
-+ //Clear all gpio interrupt
-+ REG32(GPIO_VA_BASE + 0x30) = 0x0000FFFF;
-+
-+ //Get gpio pin value
-+ REG32(GPIO_VA_BASE + 0x08) = REG32(GPIO_VA_BASE + 0x08) & ~(0x1UL << 2); //Set gpio2 direction => input
-+ gpio2_value = (REG32(GPIO_VA_BASE + 0x04) >> 2 & 1);
-+ //printk("The gpio2 value is 0x%08x\n",gpio2_value);
-+
-+
-+ alc5630->gpio2_value = gpio2_value;
-+ schedule_delayed_work(&alc5630->work, 1);
-+
-+ /*if (gpio3_value==0x1) {
-+ i2s_alc5630_write(0x02, 0x0000, g_i2c_client);
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,g_i2c_client)|0x0040 , g_i2c_client);
-+ printk("External speaker is plugged in... and Try to mute internal speaker......\n");
-+ }
-+ else {
-+ i2s_alc5630_write(0x02, 0x5F5F, g_i2c_client);
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,g_i2c_client)|0x0440 , g_i2c_client);
-+ printk("External speaker is pulled ... and Try to unmute internal speaker......\n");
-+ }*/
-+
-+
-+ //Set gpio3 pin value to 0
-+ //REG32(GPIO_VA_BASE + 0x08) = REG32(GPIO_VA_BASE + 0x08) | (0x1UL << 3); //Set gpio3 direction => output
-+ //value = REG32(GPIO_VA_BASE + 0x00) & ~(0x1UL << 3);
-+ //REG32(GPIO_VA_BASE + 0x00) = value;
-+
-+ //Get gpio pin value again
-+ //REG32(GPIO_VA_BASE + 0x08) = REG32(GPIO_VA_BASE + 0x08) & ~(0x1UL << 3); //Set gpio3 direction => input
-+ //gpio3_value = (REG32(GPIO_VA_BASE + 0x04) >> 3 & 1);
-+ //printk("The gpio3 value is 0x%08x\n",gpio3_value);
-+
-+ //restore original gpio interrupt mask
-+ REG32(GPIO_VA_BASE + 0x2c) = org_mask;
-+
-+ //restore original gpio direction
-+ REG32(GPIO_VA_BASE + 0x08) = org_dir;
-+
-+ //unmask GPIO interrupt
-+ //REG32(AMIC_VA_BASE + 0x80) = REG32(AMIC_VA_BASE + 0x80) | (1 << 13); //GPIO interrupt enable
-+ REG32(AMIC_VA_BASE + 0x84) = REG32(AMIC_VA_BASE + 0x84) | (1 << 13); //Clear GPIO interrupt
-+ REG32(GPIO_VA_BASE + 0x30) = 0x0000FFFF; //Clear all gpio interrupt
-+
-+ //printk("@@@@@#####$$$$$!!!!! : gpio2_irq() is exited....\n");
-+
-+ return IRQ_HANDLED;
-+}
-+
-+static void iic_work(struct work_struct *work)
-+{
-+ char data[3];
-+ struct alc5630_data *alc5630 =
-+ container_of(to_delayed_work(work), struct alc5630_data, work);
-+
-+
-+ if (alc5630->gpio2_value==0x0) {
-+ //i2s_alc5630_write(0x02, 0x0000, alc5630->client);
-+ i2s_alc5630_write(0x02, 0x5F5F, alc5630->client);
-+ i2s_alc5630_write(0x3A, (i2s_alc5630_read(0x3A, data,alc5630->client) & 0xFBFF) | 0x0040 , alc5630->client);
-+ //printk("External speaker is plugged in... and Try to mute internal speaker......\n");
-+ //i2s_alc5630_read_test(alc5630->client);
-+ }
-+ else {
-+ //i2s_alc5630_write(0x02, 0x5F5F, alc5630->client);
-+ i2s_alc5630_write(0x02, 0x0000, alc5630->client);
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,alc5630->client)|0x0440 , alc5630->client);
-+ //printk("External speaker is pulled ... and Try to unmute internal speaker......\n");
-+ //i2s_alc5630_read_test(alc5630->client);
-+ }
-+ //ftsdc_enable_irq(host, false);
-+
-+
-+ //ftsdc_enable_irq(host, true);
-+}
-+
-+static int alc5630_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id)
-+{
-+
-+ struct alc5630_data *alc5630;
-+ struct i2c_adapter *adap = client->adapter;
-+ //unsigned char ret1, ret2;
-+ struct i2c_msg msg;
-+ char rbuf[3], wbuf[3];
-+ int ret, i2c_rvalue, i2c_wvalue;
-+ unsigned int gpio2_value;
-+ char data[3];
-+
-+ //i2c_dbg( 1, "alc5630_i2c_probe() is called.\n");
-+ //printk(">>>>>>>>>> (3) alc5630_i2c_probe() is called.\n");
-+
-+ alc5630 = kzalloc(sizeof(struct alc5630_data), GFP_KERNEL);
-+
-+ if (!alc5630)
-+ return -ENOMEM;
-+
-+ mutex_init(&alc5630->mtx);
-+ client-> flags = 0;
-+ alc5630->client = client;
-+ i2c_set_clientdata(client, alc5630);
-+
-+ //ADD by river 2011.05.18 for GPIO2 interrupt => edge trigger and rising edge
-+ REG32(GPIO_VA_BASE + 0x20) = 0x00000000;
-+ REG32(GPIO_VA_BASE + 0x2c) = 0x00000000;
-+ REG32(GPIO_VA_BASE + 0x2c) = 0x00000000;
-+ REG32(GPIO_VA_BASE + 0x30) = 0x0000FFFF;
-+ REG32(GPIO_VA_BASE + 0x38) = 0x0000FFFF;
-+ REG32(GPIO_VA_BASE + 0x40) = 0x0000FFFF;
-+
-+
-+ REG32(GPIO_VA_BASE + 0x08) = REG32(GPIO_VA_BASE + 0x08) & ~(1 << 2); //GPIO2 as input
-+ REG32(GPIO_VA_BASE + 0x34) = REG32(GPIO_VA_BASE + 0x34) & ~(1 << 2); //GPIO2 edge trigger
-+ //REG32(GPIO_VA_BASE + 0x38) = REG32(GPIO_VA_BASE + 0x38) & ~(1 << 2); //GPIO2 single edge
-+ REG32(GPIO_VA_BASE + 0x38) = REG32(GPIO_VA_BASE + 0x38) | (1 << 2); //GPIO2 both edge
-+ REG32(GPIO_VA_BASE + 0x3c) = REG32(GPIO_VA_BASE + 0x3c) & ~(1 << 2); //GPIO2 rising edge
-+ REG32(GPIO_VA_BASE + 0x20) = REG32(GPIO_VA_BASE + 0x20) | (1 << 2); //GPIO2 pin interrupt enable
-+
-+ REG32(AMIC_VA_BASE + 0x20) = REG32(AMIC_VA_BASE + 0x20) | (1 << 13); //Interrupt Trigger Mode (edge trigger)
-+ REG32(AMIC_VA_BASE + 0x24) = REG32(AMIC_VA_BASE + 0x24) & ~(1 << 13); //Interrupt Trigger edge(rising edge)
-+ REG32(AMIC_VA_BASE + 0x80) = REG32(AMIC_VA_BASE + 0x80) | (1 << 13); //GPIO interrupt enabled
-+ //REG32(AMIC_VA_BASE + 0x80) = 0; //GPIO interrupt enabled
-+
-+ if (request_irq(GPIO_FTGPIO010_IRQ, gpio2_irq, IRQF_SHARED, "gpio2", client)) {
-+ printk("Failed to request GPIO2 interrupt.\n");
-+ goto fail;
-+ }
-+
-+ //ADD by river 2011.07.11
-+ //REG32(GPIO_VA_BASE + 0x08) = REG32(GPIO_VA_BASE + 0x08) & ~(0x1UL << 3); //Set gpio3 direction => input
-+ gpio2_value = (REG32(GPIO_VA_BASE + 0x04) >> 2 & 1);
-+ //printk("The gpio2 value is 0x%08x\n",gpio2_value);
-+ alc5630->gpio2_value = gpio2_value;
-+
-+ if (gpio2_value==0x0) {
-+ i2s_alc5630_write(0x02, 0x5F5F, alc5630->client);
-+ i2s_alc5630_write(0x3A, (i2s_alc5630_read(0x3A, data,alc5630->client) & 0xFBFF) | 0x0040 , alc5630->client);
-+ //printk("@@@@@ alc5630_i2c_probe : External speaker is plugged in... and Try to mute internal speaker......\n");
-+ //i2s_alc5630_read_test(alc5630->client);
-+ }
-+ else {
-+ i2s_alc5630_write(0x02, 0x0000, alc5630->client);
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,alc5630->client)|0x0440 , alc5630->client);
-+ //printk("@@@@@ alc5630_i2c_probe : External speaker is pulled ... and Try to unmute internal speaker......\n");
-+ //i2s_alc5630_read_test(alc5630->client);
-+ }
-+
-+ //End ADD by river 2011.07.11
-+
-+ //ADD by river 2011.06.02
-+ INIT_DELAYED_WORK(&alc5630->work, iic_work);
-+ //End ADD by river 2011.06.02
-+ //End ADD by river 2011.05.18
-+
-+ ftssp_alsa_init(client);
-+
-+ return 0;
-+ fail:
-+ mutex_destroy(&alc5630->mtx);
-+ kfree(alc5630);
-+ return -EINVAL;
-+
-+}
-+
-+////////End ADD by river 2011.01.26
-+#endif
-+
-+/* ---------------------------------------------------------------------------
-+ * Preserved size of memory space for audio DMA ring
-+ */
-+#define FTSSP_HW_DMA_SIZE (512 * 1024)
-+
-+/* Buffer sizes reported to ALSA layer - AC97 mode */
-+
-+/* ring size, exported to application */
-+#define AC97_HW_BUFFER_BYTES_MAX (42 * 1024)
-+/* should not exceed AC97_HW_PERIOD_BYTES_MAX */
-+#define AC97_HW_PERIOD_BYTES_MIN (2 * 1024)
-+/* AC97_HW_PERIOD_BYTES_MAX * AC97_HW_PERIODS_MAX <= AC97_HW_BUFFER_SIZE */
-+#define AC97_HW_PERIOD_BYTES_MAX (8 * 1024)
-+/* 3 <= AC97_HW_PERIODS_MIN <= AC97_HW_PERIODS_MAX */
-+#define AC97_HW_PERIODS_MIN 3
-+/* AC97_HW_PERIOD_BYTES_MAX * AC97_HW_PERIODS_MAX <= AC97_HW_BUFFER_SIZE */
-+#define AC97_HW_PERIODS_MAX 5
-+
-+/* Driver internal dma buffer size, x2 for S16_LE(16-bits) to AC97 (20-bits),
-+ * x6 for sampling rate converion from minimum 8k to AC97 48k.
-+ *
-+ * Note that AC97 mode cannot do playback and recording simultaneouly. So we
-+ * use up all FTSSP_HW_DMA_SIZE of memory.
-+ */
-+#define AC97_HW_DMA_SIZE (AC97_HW_BUFFER_BYTES_MAX * 2 * 6)
-+
-+/* Buffer sizes reported to ALSA layer - I2S mode */
-+
-+/* ring size, exported to application */
-+#define I2S_HW_BUFFER_BYTES_MAX (256 * 1024)
-+/* should not exceed I2S_HW_PERIOD_BYTES_MAX */
-+#define I2S_HW_PERIOD_BYTES_MIN (2 * 1024)
-+/* I2S_HW_PERIOD_BYTES_MAX * I2S_HW_PERIODS_MAX <= I2S_HW_BUFFER_SIZE */
-+#define I2S_HW_PERIOD_BYTES_MAX (32 * 1024)
-+/* 3 <= I2S_HW_PERIODS_MIN <= I2S_HW_PERIODS_MAX */
-+#define I2S_HW_PERIODS_MIN 3
-+/* I2S_HW_PERIOD_BYTES_MAX * I2S_HW_PERIODS_MAX <= I2S_HW_BUFFER_SIZE */
-+#define I2S_HW_PERIODS_MAX 8
-+
-+/* Page-in size for playback and capture each. Note that I2S mode can do
-+ * playback and recording simultaneouly, so this size should be less than or
-+ * equal to FTSSP_HW_DMA_SIZE/2
-+ */
-+#define I2S_HW_DMA_SIZE (I2S_HW_BUFFER_BYTES_MAX)
-+
-+/* ---------------------------------------------------------------------------
-+ * Audio formats
-+ */
-+#define AC97_CODEC_FORMATS (SNDRV_PCM_FMTBIT_S16_LE)
-+#define AC97_CODEC_SAMPLE_RATES (SNDRV_PCM_RATE_48000 | \
-+ SNDRV_PCM_RATE_16000 | \
-+ SNDRV_PCM_RATE_8000)
-+#define AC97_CODEC_SAMPLE_RATE_MIN (8000)
-+#define AC97_CODEC_SAMPLE_RATE_MAX (48000)
-+
-+#define I2S_CODEC_FORMATS (SNDRV_PCM_FMTBIT_S16_LE)
-+#define I2S_CODEC_SAMPLE_RATES (SNDRV_PCM_RATE_48000 | \
-+ SNDRV_PCM_RATE_44100 | \
-+ SNDRV_PCM_RATE_32000 | \
-+ SNDRV_PCM_RATE_22050 | \
-+ SNDRV_PCM_RATE_16000 | \
-+ SNDRV_PCM_RATE_11025 | \
-+ SNDRV_PCM_RATE_8000)
-+#define I2S_CODEC_SAMPLE_RATE_MIN (8000)
-+#define I2S_CODEC_SAMPLE_RATE_MAX (48000)
-+
-+
-+/* ---------------------------------------------------------------------------
-+ * Configuration
-+ */
-+#if (CONFIG_PROC_FS == 0)
-+#undef FTSSP_PROC_FS
-+#define FTSSP_PROC_FS 0
-+#else
-+#if (FTSSP_PROC_FS)
-+#include <sound/info.h>
-+#endif /* FTSSP_PROC_FS */
-+#endif /* CONFIG_PROC_FS */
-+
-+#define FTSSP_CARD_ID "ftssp010"
-+#define FTSSP_DRIVER_NAME "ftssp"
-+
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("Faraday Technology Corp.");
-+MODULE_DESCRIPTION("FTSSP010 Linux 2.6 Driver");
-+
-+static int cardno = 0;
-+//static const unsigned int SSP_FTSSP010_pa_base[SSP_FTSSP010_IRQ_COUNT] =
-+// { SSP_FTSSP010_PA_BASE };
-+
-+/* Driver mode */
-+#ifdef CONFIG_SND_FTSSP010_AC97
-+static int ac97 = 1;
-+#else
-+static int ac97 = 0;
-+#endif
-+
-+// ----------------------------------------------
-+module_param(cardno, int, 0);
-+MODULE_PARM_DESC(cardno, "FTSSP No.");
-+
-+module_param(ac97, int, 0);
-+MODULE_PARM_DESC(ac97, "AC97 mode");
-+// ----------------------------------------------
-+
-+/* ---------------------------------------------------------------------------
-+ * Structures
-+ */
-+
-+/* private data for card */
-+typedef struct {
-+ struct snd_card *card;
-+ struct snd_pcm *pcm;
-+ struct snd_pcm_substream *substream_tx;
-+ struct snd_pcm_substream *substream_rx;
-+#if (FTSSP_PROC_FS)
-+ struct snd_info_entry *info_buf_max;
-+ struct snd_info_entry *info_period_min;
-+ struct snd_info_entry *info_period_max;
-+ struct snd_info_entry *info_periods_min;
-+ struct snd_info_entry *info_periods_max;
-+#endif
-+} ftssp_chip;
-+
-+/* dma request descriptors */
-+dmad_chreq dma_chreq_tx = {
-+ .channel = -1,
-+ .drq = NULL,
-+};
-+
-+dmad_chreq dma_chreq_rx = {
-+ .channel = -1,
-+ .drq = NULL,
-+};
-+
-+/* Holds ALSA card instance pointers */
-+struct snd_card *ftssp_cards[SSP_FTSSP010_COUNT];
-+
-+/* snd_pcm_hardware */
-+static struct snd_pcm_hardware snd_ftssp_pcm_hw =
-+{
-+ .info = SNDRV_PCM_INFO_INTERLEAVED,
-+ .formats = I2S_CODEC_FORMATS,
-+ .rates = I2S_CODEC_SAMPLE_RATES,
-+ .rate_min = I2S_CODEC_SAMPLE_RATE_MIN,
-+ .rate_max = I2S_CODEC_SAMPLE_RATE_MAX,
-+ .channels_min = 1,
-+ .channels_max = 2,
-+ .buffer_bytes_max = I2S_HW_BUFFER_BYTES_MAX,
-+ .period_bytes_min = I2S_HW_PERIOD_BYTES_MIN,
-+ .period_bytes_max = I2S_HW_PERIOD_BYTES_MAX,
-+ .periods_min = I2S_HW_PERIODS_MIN,
-+ .periods_max = I2S_HW_PERIODS_MAX,
-+};
-+
-+/* private data for a substream (playback or capture) */
-+/* function pointer for set up AHBDMA for this substream */
-+typedef void (*start_t)(int cardno, unsigned use_dma);
-+typedef void (*pmu_set_clocking_t)(unsigned int);
-+typedef void (*ftssp010_config_t)(int cardno, unsigned is_stereo,
-+ unsigned speed, int use8bit);
-+
-+typedef struct {
-+ u32 busy;
-+ spinlock_t dma_lock;
-+ unsigned dma_area_va;
-+ int dma_width;
-+ unsigned int tx_period;
-+ unsigned int rx_period;
-+
-+ start_t start;
-+ pmu_set_clocking_t pmu_set_clocking;
-+ ftssp010_config_t hw_config;
-+} ftssp_substream;
-+
-+static ftssp_substream ftssp010_substreams[2] = {
-+ /* Playback substream */
-+ {
-+ busy : 0,
-+ start : ftssp010_start_tx,
-+ pmu_set_clocking : pmu_set_i2s_clocking,
-+ hw_config : ftssp010_config_tx,
-+ },
-+ /* Capture substream */
-+ {
-+ busy : 0,
-+ start : ftssp010_start_rx,
-+ pmu_set_clocking : pmu_set_i2s_clocking,
-+ hw_config : ftssp010_config_rx,
-+ }
-+};
-+
-+/* (AC97 only) Convert 16 bits PCM data in user buffer to/from 20 bits PCM data
-+ * (32 bits actaully in dma buffer) for AC97 codec.
-+ */
-+static int snd_ftssp_playback_copy(struct snd_pcm_substream *substream,
-+ int channel, snd_pcm_uframes_t pos, void *usr_buf,
-+ snd_pcm_uframes_t count)
-+{
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *) runtime->private_data;
-+
-+
-+ //printk("~~~~~ : snd_ftssp_playback_copy() is invoked....\n");
-+ u32 *dma_va = NULL;
-+ u16 *usr_va = usr_buf;
-+ int copy_words;
-+ int pcm_data;
-+
-+ dmad_chreq *dma_chreq;
-+
-+ /* frames_to_bytes(runtime, pos + count) * 2(bytes/per pcm) /
-+ * 4(bytes per dma unit) */
-+ u32 sw_ptr = (u32)frames_to_bytes(runtime, pos + count) >> 1;
-+
-+ switch (runtime->rate) {
-+ case 8000:
-+ sw_ptr *= 6;
-+
-+ dma_va = (unsigned *)(ftssp010_substream->dma_area_va +
-+ frames_to_bytes(runtime, pos * 6) * 2);
-+
-+ VVDBG("%s: pos(0x%08x) count(0x%08x) next_pos(0x%08x)\n",
-+ __func__, (u32)pos, (u32)count, (u32)(pos + count));
-+ VVDBG("%s: va base(0x%08x) range (0x%08x ~ 0x%08x)\n",
-+ __func__, (u32)ftssp010_substream->dma_area_va,
-+ (u32)dma_va,
-+ (u32)dma_va +
-+ (u32)2 * frames_to_bytes(runtime, count * 6));
-+
-+ if (runtime->channels == 1) {
-+ while (count--) {
-+ dma_va[0] = (u32)(*usr_va++) << 4;
-+ dma_va[1] = dma_va[2] = dma_va[3] =
-+ dma_va[4] = dma_va[5] = dma_va[0];
-+ //memcpy(&dma_va[1], &dma_va[0], 5 * 4 * 1);
-+ dma_va += 6;
-+ }
-+ } else { // assume 2 channels
-+ while (count--) {
-+ dma_va[0] = (u32)(*usr_va++) << 4;
-+ dma_va[1] = (u32)(*usr_va++) << 4;
-+ dma_va[2] = dma_va[4] = dma_va[6] =
-+ dma_va[8] = dma_va[10] = dma_va[0];
-+ dma_va[3] = dma_va[5] = dma_va[7] =
-+ dma_va[9] = dma_va[11] = dma_va[0];
-+ //memcpy(&dma_va[2], &dma_va[0], 5 * 4 * 2);
-+ dma_va += 12;
-+ }
-+ }
-+ break;
-+ case 16000:
-+ sw_ptr *= 3;
-+
-+ dma_va = (unsigned *)(ftssp010_substream->dma_area_va +
-+ frames_to_bytes(runtime, pos * 3) * 2);
-+
-+ VVDBG("%s: pos(0x%08x) count(0x%08x) next_pos(0x%08x)\n",
-+ __func__, (u32)pos, (u32)count, (u32)(pos + count));
-+ VVDBG("%s: va base(0x%08x) range (0x%08x ~ 0x%08x)\n",
-+ __func__, (u32)ftssp010_substream->dma_area_va,
-+ (u32)dma_va,
-+ (u32)dma_va +
-+ (u32)2 * frames_to_bytes(runtime, count * 3));
-+
-+ if (runtime->channels == 1) {
-+ while (count--) {
-+ dma_va[0] = (u32)(*usr_va++) << 4;
-+ dma_va[1] = dma_va[2] = dma_va[0];
-+ //memcpy(&dma_va[1], &dma_va[0], 2 * 4 * 1);
-+ dma_va += 3;
-+ }
-+ } else { // assume 2 channels
-+ while (count--) {
-+ dma_va[0] = (u32)(*usr_va++) << 4;
-+ dma_va[1] = (u32)(*usr_va++) << 4;
-+ dma_va[2] = dma_va[4] = dma_va[0];
-+ dma_va[3] = dma_va[5] = dma_va[1];
-+ //memcpy(&dma_va[2], &dma_va[0], 2 * 4 * 2);
-+ dma_va += 6;
-+ }
-+ }
-+ break;
-+ case 48000:
-+ default:
-+ dma_va = (unsigned *)(ftssp010_substream->dma_area_va +
-+ frames_to_bytes(runtime, pos) * 2);
-+ copy_words = 2 * frames_to_bytes(runtime, count) / sizeof(u32);
-+
-+ VVDBG("%s: pos(0x%08x) count(0x%08x) next_pos(0x%08x)\n",
-+ __func__, (u32)pos, (u32)count, (u32)(pos + count));
-+ VVDBG("%s: va base(0x%08x) range (0x%08x ~ 0x%08x)\n",
-+ __func__, (u32)ftssp010_substream->dma_area_va,
-+ (u32)dma_va,
-+ (u32)dma_va + (u32)copy_words*4);
-+
-+ while (copy_words--) {
-+ pcm_data = (*usr_va++);
-+ *dma_va++= pcm_data << 4;
-+ }
-+ break;
-+ }
-+
-+ dma_chreq = &dma_chreq_tx;
-+
-+ if (dmad_update_ring_sw_ptr(dma_chreq, sw_ptr,
-+ (runtime->status->state == SNDRV_PCM_STATE_RUNNING) ? 1:0) != 0)
-+ {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ return -ENODEV;
-+ }
-+
-+ return 0;
-+}
-+
-+static int snd_ftssp_capture_copy(struct snd_pcm_substream *substream,
-+ int channel, snd_pcm_uframes_t pos, void *usr_buf,
-+ snd_pcm_uframes_t count)
-+{
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *) runtime->private_data;
-+
-+ //printk("~~~~~ : snd_ftssp_capture_copy() is invoked....\n");
-+ //printk(">>>>>>>>>> : snd_ftssp_capture_copy() for recording....\n");
-+ u32 *dma_va = NULL;
-+ u16 *usr_va = usr_buf;
-+
-+ switch (runtime->rate) {
-+ case 8000:
-+ dma_va = (unsigned *)(ftssp010_substream->dma_area_va +
-+ frames_to_bytes(runtime, pos * 6) * 2);
-+
-+ VVDBG("%s: pos(0x%08x) count(0x%08x) next_pos(0x%08x)\n",
-+ __func__, (u32)pos, (u32)count, (u32)(pos + count));
-+ VVDBG("%s: va base(0x%08x) range (0x%08x ~ 0x%08x)\n",
-+ __func__, (u32)ftssp010_substream->dma_area_va,
-+ (u32)dma_va,
-+ (u32)dma_va +
-+ (u32)2 * frames_to_bytes(runtime, count * 6));
-+
-+ if (runtime->channels == 1) {
-+ while (count--) {
-+ *usr_va++ = (u16)(dma_va[0] >> 4);
-+ dma_va += 6;
-+ }
-+ } else {
-+ while (count--) {
-+ usr_va[0] = (u16)(dma_va[0] >> 4);
-+
-+ /* [hw-limit] only slot-3 has valid data in
-+ * recording mode -- check TAG_DATA_MONO
-+ * defined in "FTSSP010_lib.c". Mask out
-+ * one channel to avoid hi-freq noise.
-+ */
-+ usr_va[1] = usr_va[0];
-+ usr_va += 2;
-+ dma_va += 12;
-+ }
-+ }
-+ break;
-+ case 16000:
-+ dma_va = (unsigned *)(ftssp010_substream->dma_area_va +
-+ frames_to_bytes(runtime, pos * 3) * 2);
-+
-+ VVDBG("%s: pos(0x%08x) count(0x%08x) next_pos(0x%08x)\n",
-+ __func__, (u32)pos, (u32)count, (u32)(pos + count));
-+ VVDBG("%s: va base(0x%08x) range (0x%08x ~ 0x%08x)\n",
-+ __func__, (u32)ftssp010_substream->dma_area_va,
-+ (u32)dma_va,
-+ (u32)dma_va +
-+ (u32)2 * frames_to_bytes(runtime, count * 3));
-+
-+ if (runtime->channels == 1) {
-+ while (count--) {
-+ *usr_va++ = (u16)(dma_va[0] >> 4);
-+ dma_va += 3;
-+ }
-+ } else {
-+ while (count--) {
-+ usr_va[0] = (u16)(dma_va[0] >> 4);
-+
-+ /* [hw-limit] only slot-3 has valid data in
-+ * recording mode -- check TAG_DATA_MONO
-+ * defined in "FTSSP010_lib.c". Mask out
-+ * one channel to avoid hi-freq noise.
-+ */
-+ usr_va[1] = usr_va[0];
-+ usr_va += 2;
-+ dma_va += 6;
-+ }
-+ }
-+ break;
-+ case 48000:
-+ default:
-+ dma_va = (unsigned *)(ftssp010_substream->dma_area_va +
-+ frames_to_bytes(runtime, pos) * 2);
-+
-+ VVDBG("%s: pos(0x%08x) count(0x%08x) next_pos(0x%08x)\n",
-+ __func__, (u32)pos, (u32)count, (u32)(pos + count));
-+ VVDBG("%s: va base(0x%08x) range (0x%08x ~ 0x%08x)\n",
-+ __func__, (u32)ftssp010_substream->dma_area_va,
-+ (u32)dma_va,
-+ (u32)dma_va +
-+ (u32)2 * frames_to_bytes(runtime, count));
-+
-+ if (runtime->channels == 1) {
-+ while (count--) {
-+ *usr_va++ = (u16)(*dma_va++ >> 4);
-+ }
-+ } else {
-+ while (count--) {
-+ usr_va[0] = (u16)(dma_va[0] >> 4);
-+
-+ /* [hw-limit] only slot-3 has valid data in
-+ * recording mode -- check TAG_DATA_MONO
-+ * defined in "FTSSP010_lib.c". Mask out
-+ * one channel to avoid hi-freq noise.
-+ */
-+ usr_va[1] = usr_va[0];
-+ usr_va += 2;
-+ dma_va += 2;
-+ }
-+ }
-+ break;
-+ }
-+
-+ return 0;
-+}
-+
-+/**
-+ * These dma callbacks are called in interrupt context.
-+ * @data: pointer to the chip-wide structure.
-+ * TODO: use stream-specifc data
-+ */
-+__attribute__((__unused__))
-+static void ftssp_dma_callback_tx(int ch, u16 int_status, void *data)
-+{
-+ ftssp_chip *chip = (ftssp_chip *)data;
-+
-+ //printk("~~~~~ : ftssp_dma_callback_tx() is invoked....\n");
-+ if (!ac97) {
-+ /* in i2s mode, no indication to driver for user data length.
-+ * For simplicity, just go ahead by one period */
-+
-+ struct snd_pcm_runtime *runtime = chip->substream_tx->runtime;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)runtime->private_data;
-+ u32 sw_ptr;
-+ u32 tx_period = ftssp010_substream->tx_period + 1;
-+
-+ if (tx_period == runtime->periods)
-+ sw_ptr = runtime->buffer_size;
-+ else
-+ sw_ptr = tx_period * runtime->period_size;
-+
-+ sw_ptr = (u32)frames_to_bytes(runtime, sw_ptr) >> 1;
-+
-+ if (dmad_update_ring_sw_ptr(&dma_chreq_tx, (u32)sw_ptr, 0)) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ }
-+
-+ ftssp010_substream->tx_period = tx_period % runtime->periods;
-+ }
-+
-+ snd_pcm_period_elapsed(chip->substream_tx);
-+}
-+
-+__attribute__((__unused__))
-+static void ftssp_dma_callback_rx(int ch, u16 int_status, void *data)
-+{
-+ ftssp_chip *chip = (ftssp_chip *)data;
-+ struct snd_pcm_runtime *runtime = chip->substream_rx->runtime;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)runtime->private_data;
-+
-+ //printk("~~~~~ : ftssp_dma_callback_rx() is invoked....\n");
-+ //printk(">>>>>>>>>> : ftssp_dma_callback_rx() for recording....\n");
-+
-+ u32 sw_ptr;
-+ u32 rx_period = ftssp010_substream->rx_period + 1;
-+
-+ if (rx_period == runtime->periods)
-+ sw_ptr = runtime->buffer_size;
-+ else
-+ sw_ptr = rx_period * runtime->period_size;
-+
-+ if (ac97) {
-+ switch (runtime->rate) {
-+ case 8000:
-+ sw_ptr = sw_ptr * 6;
-+ break;
-+ case 16000:
-+ sw_ptr = sw_ptr * 3;
-+ break;
-+ case 48000:
-+ default:
-+ break;
-+ }
-+ }
-+ sw_ptr = (u32)frames_to_bytes(runtime, sw_ptr) >> 1;
-+
-+ if (dmad_update_ring_sw_ptr(&dma_chreq_rx, (u32)sw_ptr, 0) != 0) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ }
-+
-+ ftssp010_substream->rx_period = rx_period % runtime->periods;
-+
-+ snd_pcm_period_elapsed(chip->substream_rx);
-+}
-+
-+static inline int snd_ftssp_dma_ch_alloc(struct snd_pcm_substream *substream)
-+{
-+ dmad_chreq *ch_req __attribute__((__unused__)) = 0;
-+
-+ //printk("~~~~~ WATCH : snd_ftssp_dma_ch_alloc() is invoked....\n");
-+#ifdef CONFIG_PLATFORM_APBDMA
-+
-+ if (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ch_req = &dma_chreq_tx;
-+ ch_req->completion_cb = ftssp_dma_callback_tx;
-+ ch_req->apb_req.tx_dir = DMAD_DIR_A0_TO_A1;
-+ /*for amerald ac97 ssp2 */
-+ if((inl(PMU_BASE) & AMERALD_MASK) == AMERALD_PRODUCT_ID)
-+ {
-+ ch_req->apb_req.dev_reqn = APBBR_REQN_I2SAC97TX_AMERALD;
-+ }
-+ else
-+ ch_req->apb_req.dev_reqn = APBBR_REQN_I2SAC97TX;
-+ } else {
-+ ch_req = &dma_chreq_rx;
-+ ch_req->completion_cb = ftssp_dma_callback_rx;
-+ ch_req->apb_req.tx_dir = DMAD_DIR_A1_TO_A0;
-+ /*for amerald ac97 ssp2 */
-+ if((inl(PMU_BASE) & AMERALD_MASK) == AMERALD_PRODUCT_ID)
-+ {
-+ ch_req->apb_req.dev_reqn = APBBR_REQN_I2SAC97RX_AMERALD;
-+ }
-+ else
-+ ch_req->apb_req.dev_reqn = APBBR_REQN_I2SAC97RX;
-+ }
-+
-+ ch_req->controller = DMAD_DMAC_APB_CORE;
-+ ch_req->flags = DMAD_FLAGS_RING_MODE;
-+ ch_req->ring_base = 0;
-+ ch_req->dev_addr = (dma_addr_t)FTSSP010_DATA_PA(cardno);
-+ ch_req->periods = 0;
-+ ch_req->period_size = 0;
-+
-+ if (ac97) {
-+ ch_req->apb_req.ring_ctrl = APBBR_ADDRINC_I4X;
-+ ch_req->apb_req.ring_reqn = APBBR_REQN_NONE;
-+ ch_req->apb_req.dev_ctrl = APBBR_ADDRINC_FIXED;
-+ ch_req->apb_req.burst_mode = 0;
-+ ch_req->apb_req.data_width = APBBR_DATAWIDTH_4;
-+ } else {
-+ ch_req->apb_req.ring_ctrl = APBBR_ADDRINC_I2X;
-+ ch_req->apb_req.ring_reqn = APBBR_REQN_NONE;
-+ ch_req->apb_req.dev_ctrl = APBBR_ADDRINC_FIXED;
-+ ch_req->apb_req.burst_mode = 0;
-+ ch_req->apb_req.data_width = APBBR_DATAWIDTH_2;
-+ }
-+
-+ ch_req->completion_data = (void *)snd_pcm_substream_chip(substream);
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ ERR("%s: APBDMA channel allocation failed\n",__func__);
-+ goto _try_ahb;
-+ }
-+
-+ DBG("%s: APBDMA channel allocated (ch: %d) ring_mode\n",
-+ __func__, ch_req->channel);
-+
-+ return 0;
-+
-+_try_ahb:
-+
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+ if (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ch_req = &dma_chreq_tx;
-+ ch_req->completion_cb = ftssp_dma_callback_tx;
-+ ch_req->ahb_req.tx_dir = DMAD_DIR_A0_TO_A1;
-+ if((inl(PMU_BASE) & AMERALD_MASK) == AMERALD_PRODUCT_ID)
-+ {
-+ ch_req->ahb_req.dev_reqn = DMAC_REQN_I2SAC97TX_AMERALD;
-+ }
-+ else
-+ ch_req->ahb_req.dev_reqn = DMAC_REQN_I2SAC97TX;
-+ } else {
-+ ch_req = &dma_chreq_rx;
-+ ch_req->completion_cb = ftssp_dma_callback_rx;
-+ ch_req->ahb_req.tx_dir = DMAD_DIR_A1_TO_A0;
-+ if((inl(PMU_BASE) & AMERALD_MASK) == AMERALD_PRODUCT_ID)
-+ {
-+ ch_req->ahb_req.dev_reqn = DMAC_REQN_I2SAC97RX_AMERALD;
-+ }
-+ else
-+ ch_req->ahb_req.dev_reqn = DMAC_REQN_I2SAC97RX;
-+ }
-+
-+ ch_req->controller = DMAD_DMAC_AHB_CORE;
-+ ch_req->flags = DMAD_FLAGS_RING_MODE;
-+ ch_req->ring_base = 0;
-+ ch_req->dev_addr = (dma_addr_t)FTSSP010_DATA_PA(cardno);
-+ ch_req->periods = 0;
-+ ch_req->period_size = 0;
-+
-+ ch_req->ahb_req.sync = 1;
-+ ch_req->ahb_req.priority = DMAC_CSR_CHPRI_2;
-+ ch_req->ahb_req.hw_handshake = 1;
-+ ch_req->ahb_req.burst_size = DMAC_CSR_SIZE_1;
-+
-+ if (ac97) {
-+ ch_req->ahb_req.ring_width = DMAC_CSR_WIDTH_32;
-+ ch_req->ahb_req.ring_ctrl = DMAC_CSR_AD_INC;
-+ ch_req->ahb_req.ring_reqn = DMAC_REQN_NONE;
-+ ch_req->ahb_req.dev_width = DMAC_CSR_WIDTH_32;
-+ ch_req->ahb_req.dev_ctrl = DMAC_CSR_AD_FIX;
-+ } else {
-+ ch_req->ahb_req.ring_width = DMAC_CSR_WIDTH_16;
-+ ch_req->ahb_req.ring_ctrl = DMAC_CSR_AD_INC;
-+ ch_req->ahb_req.ring_reqn = DMAC_REQN_NONE;
-+ ch_req->ahb_req.dev_width = DMAC_CSR_WIDTH_16;
-+ ch_req->ahb_req.dev_ctrl = DMAC_CSR_AD_FIX;
-+ }
-+
-+ ch_req->completion_data = (void *)snd_pcm_substream_chip(substream);
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ ERR("%s: AHBDMA channel allocation failed\n", __func__);
-+ goto _err_exit;
-+ }
-+
-+ DBG("%s: AHBDMA channel allocated (ch: %d) ring_mode\n",
-+ __func__, ch_req->channel);
-+
-+ return 0;
-+
-+_err_exit:
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+ return -ENODEV;
-+}
-+
-+static inline ftssp_substream *ftssp010_substream_new(int stream_id)
-+{
-+ ftssp_substream *s = NULL;
-+
-+ //printk("~~~~~ : ftssp010_substream_new() is invoked....\n");
-+
-+ switch (stream_id) {
-+ case SNDRV_PCM_STREAM_PLAYBACK:
-+ s = &ftssp010_substreams[0];
-+ break;
-+ case SNDRV_PCM_STREAM_CAPTURE:
-+ s = &ftssp010_substreams[1];
-+ break;
-+ default:
-+ ERR("%s: wrong stream type (%d)\n", __func__, stream_id);
-+ return NULL;
-+ }
-+
-+ if (s->busy) {
-+ ERR("%s: device busy!\n", __func__);
-+ return NULL;
-+ }
-+ s->busy = 1;
-+
-+ spin_lock_init(&s->dma_lock);
-+
-+ return s;
-+}
-+
-+static int snd_ftssp_pcm_open(struct snd_pcm_substream *substream)
-+{
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ int stream_id = substream->pstr->stream;
-+
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+
-+ //printk("~~~~~ : snd_ftssp_pcm_open() is invoked....\n");
-+
-+ /* Both playback and capture share a hardware description */
-+ runtime->hw = snd_ftssp_pcm_hw;
-+
-+ /* Allocate & Initialize stream-specific data */
-+ runtime->private_data = ftssp010_substream_new(stream_id);
-+
-+ if (runtime->private_data) {
-+ //printk("~~~~~ YAYAYA @@@@@ : Calling snd_ftssp_dma_ch_alloc().\n");
-+ return snd_ftssp_dma_ch_alloc(substream);
-+ }
-+ else
-+ return -EBUSY;
-+}
-+
-+static int snd_ftssp_pcm_close(struct snd_pcm_substream *substream)
-+{
-+ int stream_id = substream->pstr->stream;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)substream->runtime->private_data;
-+
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+
-+ //printk("~~~~~ : snd_ftssp_pcm_close() is invoked....\n");
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK)
-+ dmad_channel_free(&dma_chreq_tx);
-+ else
-+ dmad_channel_free(&dma_chreq_rx);
-+
-+ ftssp010_substream->busy = 0;
-+ return 0;
-+}
-+
-+static int snd_ftssp_pcm_hw_params(struct snd_pcm_substream *substream,
-+ struct snd_pcm_hw_params *hw_params)
-+{
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+
-+ //printk("~~~~~ : snd_ftssp_pcm_hw_params() is invoked....\n");
-+
-+ if (ac97)
-+ return snd_pcm_lib_malloc_pages(substream, AC97_HW_DMA_SIZE);
-+ else
-+ return snd_pcm_lib_malloc_pages(substream, I2S_HW_DMA_SIZE);
-+}
-+
-+static int snd_ftssp_pcm_hw_free(struct snd_pcm_substream *substream)
-+{
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+ //printk("~~~~~ : snd_ftssp_pcm_hw_free() is invoked....\n");
-+
-+ if (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK)
-+ dmad_drain_requests(&dma_chreq_tx, 1);
-+ else
-+ dmad_drain_requests(&dma_chreq_rx, 1);
-+
-+ return snd_pcm_lib_free_pages(substream);
-+}
-+
-+/* Prepare FTSSP010 AHBDMA for playback & capture */
-+static int snd_ftssp_pcm_prepare(struct snd_pcm_substream *substream)
-+{
-+ ftssp_chip *chip = snd_pcm_substream_chip(substream);
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+
-+ //printk("~~~~~ : snd_ftssp_pcm_prepare() is invoked....\n");
-+ //printk("@@@@@ >>>>> : snd_ftssp_pcm_prepare() is called.\n");
-+
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)runtime->private_data;
-+
-+ int stream_id = substream->pstr->stream;
-+ dmad_chreq *dma_chreq;
-+ unsigned period_size, buffer_size;
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK)
-+ dma_chreq = &dma_chreq_tx;
-+ else
-+ dma_chreq = &dma_chreq_rx;
-+
-+ period_size = frames_to_bytes(runtime, runtime->period_size);
-+ buffer_size = frames_to_bytes(runtime, runtime->buffer_size);
-+
-+ if (runtime->format != SNDRV_PCM_FORMAT_S16_LE)
-+ return -ENODEV;
-+
-+ if (ac97) {
-+ switch (runtime->rate) {
-+ case 8000:
-+ period_size *= 12;
-+ buffer_size *= 12;
-+ break;
-+ case 16000:
-+ period_size *= 6;
-+ buffer_size *= 6;
-+ break;
-+ case 48000:
-+ default:
-+ period_size *= 2;
-+ buffer_size *= 2;
-+ break;
-+ }
-+
-+ ftssp010_substream->dma_width = 4;
-+ } else {
-+ ftssp010_substream->dma_width = 2;
-+ }
-+
-+ dmad_drain_requests(dma_chreq, 1);
-+
-+ dma_chreq->ring_base = (dma_addr_t)runtime->dma_addr;
-+ dma_chreq->periods = (dma_addr_t)runtime->periods;
-+ if (ac97) {
-+ dma_chreq->period_size = (dma_addr_t)(period_size >> 2);
-+ dma_chreq->ring_size = (dma_addr_t)(buffer_size >> 2);
-+ } else {
-+ dma_chreq->period_size = (dma_addr_t)(period_size >> 1);
-+ dma_chreq->ring_size = (dma_addr_t)(buffer_size >> 1);
-+ }
-+ dmad_update_ring(dma_chreq);
-+
-+ /* Set PMU, FTSSP010, and DMA */
-+ spin_lock(&ftssp010_substream->dma_lock);
-+
-+ /* keep DMA buffer VA for copy() callback */
-+ // todo: support playback/capture simultaneously
-+ ftssp010_substream->dma_area_va = (u32)runtime->dma_area;
-+
-+ if (ac97) {
-+ ftssp010_substream->pmu_set_clocking(48000);
-+ ftssp010_substream->hw_config(cardno,
-+ runtime->channels > 1 ? 1 : 0, /* 1: stereo, 0: mono */
-+ 48000, ftssp010_substream->dma_width);
-+ } else {
-+
-+ ftssp010_substream->pmu_set_clocking(runtime->rate);
-+ ftssp010_substream->hw_config(cardno,
-+ runtime->channels > 1 ? 1 : 0, /* 1: stereo, 0: mono */
-+ runtime->rate, ftssp010_substream->dma_width);
-+ }
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ftssp010_substream->tx_period = 0;
-+ chip->substream_tx = substream;
-+ } else {
-+ ftssp010_substream->rx_period = 0;
-+ chip->substream_rx = substream;
-+ }
-+
-+ spin_unlock(&ftssp010_substream->dma_lock);
-+
-+ VVDBG("%s <<\n", __func__);
-+
-+ return 0;
-+}
-+
-+static inline int snd_ftssp_start_play(ftssp_substream *ftssp010_substream,
-+ struct snd_pcm_runtime *runtime)
-+{
-+ int err = 0;
-+
-+ //printk("~~~~~ : snd_ftssp_start_play() is invoked....\n");
-+
-+ if (ac97) {
-+ /* in ac97 mode, user data was fed to dma buffer through
-+ * driver-provided copy callback */
-+ err = dmad_kickoff_requests(&dma_chreq_tx);
-+ if (err != 0) {
-+ ERR("%s: failed to kickoff dma!\n", __func__);
-+ return err;
-+ }
-+ } else {
-+ /* in i2s mode, no indication to driver for user data length
-+ * (except start threshold). For simplicity at start, just go
-+ * ahead by one cycle */
-+
-+ u32 sw_ptr =
-+ (u32)frames_to_bytes(runtime, runtime->buffer_size) >>1;
-+
-+ err = dmad_update_ring_sw_ptr(&dma_chreq_tx, sw_ptr, 0);
-+ if (err != 0) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ return err;
-+ }
-+
-+ err = dmad_kickoff_requests(&dma_chreq_tx);
-+ if (err != 0) {
-+ ERR("%s: failed to kickoff dma!\n", __func__);
-+ return err;
-+ }
-+ }
-+
-+ ftssp010_substream->start(cardno, 1);
-+
-+ //ADD by river 2011.03.08
-+ //i2s_alc5630_write(0x02, 0x0000, g_i2c_client);
-+ //i2s_alc5630_write(0x04, 0x0000, g_i2c_client);
-+ //i2s_alc5630_write(0x0c, 0x1010, g_i2c_client);
-+ //i2s_alc5630_write(0x10, 0xff03, g_i2c_client);
-+ //End ADD by river 2011.03.08
-+
-+ return 0;
-+}
-+
-+static inline int snd_ftssp_start_record(ftssp_substream *ftssp010_substream,
-+ struct snd_pcm_runtime *runtime)
-+{
-+ int err = 0;
-+
-+ //printk("~~~~~ : snd_ftssp_start_record() is invoked....\n");
-+
-+ u32 sw_ptr = (u32)frames_to_bytes(runtime, runtime->buffer_size);
-+
-+ if (ac97) {
-+ switch (runtime->rate) {
-+ case 8000:
-+ sw_ptr = (sw_ptr * 3);
-+ break;
-+ case 16000:
-+ sw_ptr = (sw_ptr * 3) >> 1;
-+ break;
-+ case 48000:
-+ default:
-+ sw_ptr = sw_ptr >> 1;
-+ break;
-+ }
-+ } else {
-+
-+ //printk(">>>>>>>>>> : snd_ftssp_start_record() for recording....\n");
-+ sw_ptr = sw_ptr >> 1;
-+ }
-+
-+ err = dmad_update_ring_sw_ptr(&dma_chreq_rx, sw_ptr, 0);
-+ if (err != 0) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ return err;
-+ }
-+
-+ err = dmad_kickoff_requests(&dma_chreq_rx);
-+ if (err != 0) {
-+ ERR("%s: failed to kickoff dma!\n", __func__);
-+ return err;
-+ }
-+
-+ ftssp010_substream->start(cardno, 1);
-+
-+ return 0;
-+}
-+
-+/* Triggers AHBDMA for playback & capture */
-+static int snd_ftssp_pcm_trigger(struct snd_pcm_substream * substream, int cmd)
-+{
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)substream->runtime->private_data;
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ int err = 0;
-+ int stream_id = substream->pstr->stream;
-+
-+ //printk("~~~~~ : snd_ftssp_pcm_trigger() is invoked....\n");
-+
-+ /* note local interrupts are already disabled in the midlevel code */
-+ spin_lock(&ftssp010_substream->dma_lock);
-+
-+ switch (cmd) {
-+ case SNDRV_PCM_TRIGGER_START:
-+
-+ VDBG("%s: SNDRV_PCM_TRIGGER_START state(0x%08x)\n",
-+ __func__, (u32)runtime->status->state);
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ err = snd_ftssp_start_play(ftssp010_substream, runtime);
-+ } else {
-+ err = snd_ftssp_start_record(ftssp010_substream,
-+ runtime);
-+ }
-+ break;
-+
-+ case SNDRV_PCM_TRIGGER_STOP:
-+
-+ VDBG("%s: SNDRV_PCM_TRIGGER_STOP state(0x%08x)\n",
-+ __func__, (u32)substream->runtime->status->state);
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ftssp010_stop_tx(cardno);
-+ dmad_drain_requests(&dma_chreq_tx, 1);
-+ } else {
-+ ftssp010_stop_rx(cardno);
-+ dmad_drain_requests(&dma_chreq_rx, 1);
-+ }
-+ break;
-+ default:
-+ err = -EINVAL;
-+ break;
-+ }
-+
-+ spin_unlock(&ftssp010_substream->dma_lock);
-+ return err;
-+}
-+
-+// pcm middle-layer call this function within irq (snd_pcm_period_elapsed) or
-+// with local irq disabled (snd_pcm_lib_write1)
-+static snd_pcm_uframes_t snd_ftssp_pcm_pointer(
-+ struct snd_pcm_substream *substream)
-+{
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ u32 hw_ptr;
-+ snd_pcm_uframes_t ret;
-+ int stream_id = substream->pstr->stream;
-+
-+ //printk("~~~~~ : snd_ftssp_pcm_pointer() is invoked....\n");
-+
-+
-+ /* Fetch DMA pointer, with spin lock */
-+ //spin_lock_irqsave(&ftssp010_substream->dma_lock, flags);
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ hw_ptr = dmad_probe_ring_hw_ptr(&dma_chreq_tx);
-+ } else {
-+ hw_ptr = dmad_probe_ring_hw_ptr(&dma_chreq_rx);
-+ }
-+
-+ //spin_unlock_irqrestore(&ftssp010_substream->dma_lock, flags);
-+
-+ if (ac97) {
-+ ret = bytes_to_frames(runtime, hw_ptr << 1);
-+
-+ switch (runtime->rate) {
-+ case 8000:
-+ ret = ret / 6;
-+ break;
-+ case 16000:
-+ ret = ret / 3;
-+ break;
-+ case 48000:
-+ default:
-+ break;
-+ }
-+ } else {
-+ ret = bytes_to_frames(runtime, hw_ptr << 1);
-+ }
-+
-+
-+ VVDBG("%s: hw_ptr(0x%08x) ret(0x%08x)\n",
-+ (stream_id == SNDRV_PCM_STREAM_PLAYBACK) ? "p" : "c",
-+ (u32)hw_ptr, (u32)ret);
-+
-+ /* ALSA requires return value 0 <= ret < buffer_size */
-+ if (ret >= runtime->buffer_size)
-+ return 0;
-+ return ret;
-+}
-+
-+/* For FTSSP010 driver, operations are shared among playback & capture */
-+static struct snd_pcm_ops snd_ftssp_playback_ops = {
-+ .open = snd_ftssp_pcm_open,
-+ .close = snd_ftssp_pcm_close,
-+ .ioctl = snd_pcm_lib_ioctl,
-+ .hw_params = snd_ftssp_pcm_hw_params,
-+ .hw_free = snd_ftssp_pcm_hw_free,
-+ .prepare = snd_ftssp_pcm_prepare,
-+ .trigger = snd_ftssp_pcm_trigger,
-+ .pointer = snd_ftssp_pcm_pointer,
-+ .copy = NULL,
-+};
-+
-+static struct snd_pcm_ops snd_ftssp_capture_ops = {
-+ .open = snd_ftssp_pcm_open,
-+ .close = snd_ftssp_pcm_close,
-+ .ioctl = snd_pcm_lib_ioctl,
-+ .hw_params = snd_ftssp_pcm_hw_params,
-+ .hw_free = snd_ftssp_pcm_hw_free,
-+ .prepare = snd_ftssp_pcm_prepare,
-+ .trigger = snd_ftssp_pcm_trigger,
-+ .pointer = snd_ftssp_pcm_pointer,
-+ .copy = NULL,
-+};
-+
-+/* ALSA PCM constructor */
-+static int snd_ftssp_new_pcm(ftssp_chip *chip)
-+{
-+ struct snd_pcm *pcm;
-+ int err;
-+
-+ //printk("~~~~~ : snd_ftssp_new_pcm() is invoked....\n");
-+
-+ /* PCM device #0 with 1 playback and 1 capture */
-+ if ((err = snd_pcm_new(chip->card, "ftssp_pcm", 0, 1, 1, &pcm)) < 0)
-+ return err;
-+
-+ pcm->private_data = chip;
-+ strcpy(pcm->name, "ftssp_pcm device");
-+ chip->pcm = pcm;
-+
-+ /* set operators for playback and capture*/
-+ snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
-+ &snd_ftssp_playback_ops);
-+
-+ snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
-+ &snd_ftssp_capture_ops);
-+
-+ /* Pre-allocate buffer, as suggested by ALSA driver document */
-+ // todo: support playback/capture simultaneously
-+ snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
-+ NULL, FTSSP_HW_DMA_SIZE, FTSSP_HW_DMA_SIZE);
-+
-+ /* Force half-duplex (on A320D, or AC97 mode) */
-+ if (ac97)
-+ pcm->info_flags |= SNDRV_PCM_INFO_HALF_DUPLEX;
-+
-+ return 0;
-+}
-+
-+#if (FTSSP_PROC_FS)
-+static void snd_ftssp_buf_max_read(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ snd_iprintf(buffer, "%d\n", snd_ftssp_pcm_hw.buffer_bytes_max);
-+}
-+
-+static void snd_ftssp_buf_max_write(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ char tmp[128];
-+ char *ptr_e;
-+ u32 val;
-+
-+ if (buffer->size == 0)
-+ return;
-+
-+ memset(tmp, 0, 128);
-+ snd_info_get_str(tmp, buffer->buffer, 127);
-+
-+ val = simple_strtoul(tmp, &ptr_e, 10);
-+ if (*ptr_e == 'k')
-+ val *= 1024;
-+ else if (*ptr_e == 'm')
-+ val *= 1024 * 1024;
-+
-+ if (ac97) {
-+ if (val > AC97_HW_BUFFER_BYTES_MAX)
-+ val = AC97_HW_BUFFER_BYTES_MAX;
-+ } else {
-+ if (val > I2S_HW_BUFFER_BYTES_MAX)
-+ val = I2S_HW_BUFFER_BYTES_MAX;
-+ }
-+
-+ snd_ftssp_pcm_hw.buffer_bytes_max = (size_t)val;
-+}
-+
-+static void snd_ftssp_period_min_read(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ snd_iprintf(buffer, "%d\n", snd_ftssp_pcm_hw.period_bytes_min);
-+}
-+
-+static void snd_ftssp_period_min_write(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ char tmp[128];
-+ char *ptr_e;
-+ u32 val;
-+
-+ if (buffer->size == 0)
-+ return;
-+
-+ memset(tmp, 0, 128);
-+ snd_info_get_str(tmp, buffer->buffer, 127);
-+
-+ val = simple_strtoul(tmp, &ptr_e, 10);
-+ if (*ptr_e == 'k')
-+ val *= 1024;
-+ else if (*ptr_e == 'm')
-+ val *= 1024 * 1024;
-+
-+ snd_ftssp_pcm_hw.period_bytes_min = (size_t)val;
-+
-+ if ((val * snd_ftssp_pcm_hw.periods_max) >
-+ snd_ftssp_pcm_hw.buffer_bytes_max) {
-+ INFO("\nWarning: period_bytes(%d) * periods(%d) exceeds "
-+ "hw_buffer_size(%d).\n",
-+ snd_ftssp_pcm_hw.period_bytes_min,
-+ snd_ftssp_pcm_hw.periods_max,
-+ snd_ftssp_pcm_hw.buffer_bytes_max);
-+ INFO(" Unexpected access violation may occur!\n");
-+ }
-+}
-+
-+static void snd_ftssp_period_max_read(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ snd_iprintf(buffer, "%d\n", snd_ftssp_pcm_hw.period_bytes_max);
-+}
-+
-+static void snd_ftssp_period_max_write(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ char tmp[128];
-+ char *ptr_e;
-+ u32 val;
-+
-+ if (buffer->size == 0)
-+ return;
-+
-+ memset(tmp, 0, 128);
-+ snd_info_get_str(tmp, buffer->buffer, 127);
-+
-+ val = simple_strtoul(tmp, &ptr_e, 10);
-+ if (*ptr_e == 'k')
-+ val *= 1024;
-+ else if (*ptr_e == 'm')
-+ val *= 1024 * 1024;
-+
-+ snd_ftssp_pcm_hw.period_bytes_max = (size_t)val;
-+
-+ if ((val * snd_ftssp_pcm_hw.periods_max) >
-+ snd_ftssp_pcm_hw.buffer_bytes_max) {
-+ INFO("\nWarning: period_bytes(%d) * periods(%d) exceeds "
-+ "hw_buffer_size(%d).\n",
-+ snd_ftssp_pcm_hw.period_bytes_max,
-+ snd_ftssp_pcm_hw.periods_max,
-+ snd_ftssp_pcm_hw.buffer_bytes_max);
-+ INFO(" Unexpected access violation may occur!\n");
-+ }
-+}
-+
-+static void snd_ftssp_periods_min_read(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ snd_iprintf(buffer, "%d\n", snd_ftssp_pcm_hw.periods_min);
-+}
-+
-+static void snd_ftssp_periods_min_write(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ char tmp[128];
-+ char *ptr_e;
-+ u32 val;
-+
-+ if (buffer->size == 0)
-+ return;
-+
-+ memset(tmp, 0, 128);
-+ snd_info_get_str(tmp, buffer->buffer, 127);
-+
-+ val = simple_strtoul(tmp, &ptr_e, 10);
-+ if (*ptr_e == 'k')
-+ val *= 1024;
-+ else if (*ptr_e == 'm')
-+ val *= 1024 * 1024;
-+
-+ snd_ftssp_pcm_hw.periods_min = (size_t)val;
-+
-+ if ((val * snd_ftssp_pcm_hw.period_bytes_max) >
-+ snd_ftssp_pcm_hw.buffer_bytes_max) {
-+ INFO("\nWarning: period_bytes(%d) * periods(%d) exceeds "
-+ "hw_buffer_size(%d).\n",
-+ snd_ftssp_pcm_hw.period_bytes_max,
-+ snd_ftssp_pcm_hw.periods_min,
-+ snd_ftssp_pcm_hw.buffer_bytes_max);
-+ INFO(" Unexpected access violation may occur!\n");
-+ }
-+}
-+
-+static void snd_ftssp_periods_max_read(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ snd_iprintf(buffer, "%d\n", snd_ftssp_pcm_hw.periods_max);
-+}
-+
-+static void snd_ftssp_periods_max_write(struct snd_info_entry *entry,
-+ struct snd_info_buffer *buffer)
-+{
-+ char tmp[128];
-+ char *ptr_e;
-+ u32 val;
-+
-+ if (buffer->size == 0)
-+ return;
-+
-+ memset(tmp, 0, 128);
-+ snd_info_get_str(tmp, buffer->buffer, 127);
-+
-+ val = simple_strtoul(tmp, &ptr_e, 10);
-+ if (*ptr_e == 'k')
-+ val *= 1024;
-+ else if (*ptr_e == 'm')
-+ val *= 1024 * 1024;
-+
-+ snd_ftssp_pcm_hw.periods_max = (size_t)val;
-+
-+ if ((val * snd_ftssp_pcm_hw.period_bytes_max) >
-+ snd_ftssp_pcm_hw.buffer_bytes_max) {
-+ INFO("\nWarning: period_bytes(%d) * periods(%d) exceeds "
-+ "hw_buffer_size(%d).\n",
-+ snd_ftssp_pcm_hw.period_bytes_max,
-+ snd_ftssp_pcm_hw.periods_max,
-+ snd_ftssp_pcm_hw.buffer_bytes_max);
-+ INFO(" Unexpected access violation may occur!\n");
-+ }
-+}
-+#endif //FTSSP_PROC_FS
-+
-+static inline void ftssp_ac97_init(void)
-+{
-+ //driver_name = AC97_DRIVER_NAME;
-+ //codec_info = AC97_CODEC_NAME;
-+
-+ /* Change codec-dependent callbacks to AC97 */
-+ ftssp010_substreams[0].pmu_set_clocking = pmu_set_ac97_clocking;
-+ ftssp010_substreams[0].hw_config = ftssp010_config_ac97_play;
-+ ftssp010_substreams[1].pmu_set_clocking = pmu_set_ac97_clocking;
-+ ftssp010_substreams[1].hw_config = ftssp010_config_ac97_rec;
-+
-+ snd_ftssp_playback_ops.copy = snd_ftssp_playback_copy;
-+ snd_ftssp_capture_ops.copy = snd_ftssp_capture_copy;
-+
-+ snd_ftssp_pcm_hw.rates = AC97_CODEC_SAMPLE_RATES;
-+ snd_ftssp_pcm_hw.rate_min = AC97_CODEC_SAMPLE_RATE_MIN;
-+ snd_ftssp_pcm_hw.rate_max = AC97_CODEC_SAMPLE_RATE_MAX;
-+ snd_ftssp_pcm_hw.formats = AC97_CODEC_FORMATS;
-+ snd_ftssp_pcm_hw.buffer_bytes_max = AC97_HW_BUFFER_BYTES_MAX;
-+ snd_ftssp_pcm_hw.period_bytes_min = AC97_HW_PERIOD_BYTES_MIN;
-+ snd_ftssp_pcm_hw.period_bytes_max = AC97_HW_PERIOD_BYTES_MAX;
-+ snd_ftssp_pcm_hw.periods_min = AC97_HW_PERIODS_MIN;
-+ snd_ftssp_pcm_hw.periods_max = AC97_HW_PERIODS_MAX;
-+}
-+
-+static int ftssp_alsa_init(struct i2c_client *client)
-+{
-+ ftssp_chip *chip;
-+ int err;
-+
-+ //ADD by river 2011.03.08
-+ //g_i2c_client = client;
-+ //End ADD by river 2011.03.08
-+ //printk(">>>>>>>>> (4) ftssp_alsa_init().\n");
-+ init_hw(cardno, ac97, client);
-+
-+ if (ac97)
-+ ftssp_ac97_init();
-+
-+ DBG("%s: FTSSP010 #%d (Physical Addr=0x%08X), mode: %s\n",
-+ __func__,
-+ cardno, SSP_FTSSP010_pa_base[cardno],
-+ ac97 ? "ac97" : "i2s");
-+
-+ err = snd_card_create(cardno, FTSSP_CARD_ID, THIS_MODULE,
-+ sizeof(ftssp_chip), &ftssp_cards[cardno]);
-+ if (err < 0)
-+ return err;
-+
-+ if (ac97) {
-+ sprintf(ftssp_cards[cardno]->driver, FTSSP_DRIVER_NAME);
-+ sprintf(ftssp_cards[cardno]->shortname,
-+ FTSSP_DRIVER_NAME "_ac97");
-+ sprintf(ftssp_cards[cardno]->longname,
-+ FTSSP_DRIVER_NAME "_ac97 controller");
-+ } else {
-+ sprintf(ftssp_cards[cardno]->driver, FTSSP_DRIVER_NAME);
-+ sprintf(ftssp_cards[cardno]->shortname,
-+ FTSSP_DRIVER_NAME "_i2s");
-+ sprintf(ftssp_cards[cardno]->longname,
-+ FTSSP_DRIVER_NAME "_i2s controller");
-+ }
-+
-+ // PCM
-+ chip = (ftssp_chip *)(ftssp_cards[cardno]->private_data);
-+ chip->card = ftssp_cards[cardno];
-+
-+ if ((err = snd_ftssp_new_pcm(chip))) {
-+ ERR("%s, Can't new PCM devices\n",__func__);
-+ return -ENODEV;
-+ }
-+
-+#if (FTSSP_PROC_FS)
-+ // new a proc entries subordinate to card->proc_root for debugging
-+ // /proc/card#/buf_max
-+ snd_card_proc_new(chip->card, "buf_max", &chip->info_buf_max);
-+ if (chip->info_buf_max) {
-+ chip->info_buf_max->c.text.read = snd_ftssp_buf_max_read;
-+ chip->info_buf_max->c.text.write = snd_ftssp_buf_max_write;
-+ }
-+ // /proc/card#/period_min
-+ snd_card_proc_new(chip->card, "period_size_min",
-+ &chip->info_period_min);
-+ if (chip->info_period_min) {
-+ chip->info_period_min->c.text.read = snd_ftssp_period_min_read;
-+ chip->info_period_min->c.text.write =
-+ snd_ftssp_period_min_write;
-+ }
-+ // /proc/card#/period_max
-+ snd_card_proc_new(chip->card, "period_size_max",
-+ &chip->info_period_max);
-+ if (chip->info_period_max) {
-+ chip->info_period_max->c.text.read = snd_ftssp_period_max_read;
-+ chip->info_period_max->c.text.write =
-+ snd_ftssp_period_max_write;
-+ }
-+ // /proc/card#/periods_min
-+ snd_card_proc_new(chip->card, "periods_min", &chip->info_periods_min);
-+ if (chip->info_periods_min) {
-+ chip->info_periods_min->c.text.read =
-+ snd_ftssp_periods_min_read;
-+ chip->info_periods_min->c.text.write =
-+ snd_ftssp_periods_min_write;
-+ }
-+ // /proc/card#/periods_max
-+ snd_card_proc_new(chip->card, "periods_max", &chip->info_periods_max);
-+ if (chip->info_periods_max) {
-+ chip->info_periods_max->c.text.read =
-+ snd_ftssp_periods_max_read;
-+ chip->info_periods_max->c.text.write =
-+ snd_ftssp_periods_max_write;
-+ }
-+#endif
-+
-+ // Register the card to ALSA
-+ if ((err = snd_card_register(chip->card)) == 0) {
-+ INFO("%s card registered!\n", FTSSP_CARD_ID);
-+ }
-+
-+ return 0;
-+}
-+
-+#ifdef CONFIG_SND_FTSSP010_I2S
-+//ADD by river 2011.01.26
-+static int alc5630_i2c_remove(struct i2c_client *client)
-+{
-+ struct alc5630_data *alc5630 = i2c_get_clientdata(client);
-+
-+ // power down codec chip
-+ //tas_write_reg(tas, TAS_REG_ACR, 1, &tmp);
-+
-+ mutex_destroy(&alc5630->mtx);
-+ kfree(alc5630);
-+ return 0;
-+}
-+
-+static const struct i2c_device_id alc5630_i2c_id[] = {
-+ { "alc5630_codec", 0 },
-+ { }
-+};
-+
-+// This is the driver that will be inserted
-+static struct i2c_driver alc5630_driver = {
-+ .driver = {
-+ .name = "alc5630_codec",
-+ .owner = THIS_MODULE,
-+ },
-+ .attach_adapter = alc5630_i2c_attach,
-+ .probe = alc5630_i2c_probe,
-+ .remove = alc5630_i2c_remove,
-+ .suspend = alc5630_i2c_suspend,
-+ .resume = alc5630_i2c_resume,
-+ .id_table = alc5630_i2c_id,
-+};
-+
-+static int alc5630_i2c_suspend(struct i2c_client *i2c_client, pm_message_t mesg)
-+{
-+ //printk("@@@@@ TRACE by river 2011.05.10 : alc5630_i2c_suspend() is invoked.\n");
-+
-+ //i2c_del_driver(&alc5630_driver);
-+ //#ifndef CONFIG_SND_FTSSP010_AC97
-+ // i2c_del_driver(&alc5630_driver);
-+ //#endif
-+ //printk("@@@@@ TRACE by river 2011.05.10 : alc5630_i2c_suspend() -2 is invoked.\n");
-+ dmad_channel_free(&dma_chreq_tx);
-+ dmad_channel_free(&dma_chreq_rx);
-+ //printk("@@@@@ TRACE by river 2011.05.10 : alc5630_i2c_suspend() -3 is invoked.\n");
-+ //snd_card_free(ftssp_cards[cardno]);
-+
-+ return 0;
-+
-+}
-+
-+static int alc5630_i2c_resume(struct i2c_client *i2c_client)
-+{
-+
-+ //printk("@@@@@ TRACE by river 2011.05.10 : alc5630_i2c_resume() is invoked.\n");
-+ //#ifdef CONFIG_SND_FTSSP010_AC97
-+ // ftssp_alsa_init(NULL);
-+ //#else
-+ // return i2c_add_driver(&alc5630_driver);
-+ //#endif
-+
-+ return 0;
-+
-+}
-+#endif
-+
-+static __init int ftssp_alsa_i2c_i2s_init(void)
-+{
-+
-+ //printk(">>>>>>>>>> (1) ftssp_alsa_i2c_i2s_init().\n");
-+ //return i2c_add_driver(&alc5630_driver);
-+ #ifdef CONFIG_SND_FTSSP010_AC97
-+ return ftssp_alsa_init(NULL);
-+ #else
-+ return i2c_add_driver(&alc5630_driver);
-+ #endif
-+}
-+//End ADD by river 2011.01.26
-+
-+static __exit void ftssp_alsa_i2c_i2s_exit(void)
-+{
-+ DBG("%s, cleaning up\n",__func__);
-+
-+ //i2c_del_driver(&alc5630_driver);
-+ #ifndef CONFIG_SND_FTSSP010_AC97
-+ i2c_del_driver(&alc5630_driver);
-+ #endif
-+
-+ dmad_channel_free(&dma_chreq_tx);
-+ dmad_channel_free(&dma_chreq_rx);
-+
-+ snd_card_free(ftssp_cards[cardno]);
-+}
-+
-+/*static __exit void ftssp_alsa_exit(void)
-+{
-+ DBG("%s, cleaning up\n",__func__);
-+
-+ dmad_channel_free(&dma_chreq_tx);
-+ dmad_channel_free(&dma_chreq_rx);
-+
-+ snd_card_free(ftssp_cards[cardno]);
-+}*/
-+
-+//MOD by river 2011.01.26
-+//module_init(ftssp_alsa_init);
-+//module_exit(ftssp_alsa_exit);
-+module_init(ftssp_alsa_i2c_i2s_init);
-+module_exit(ftssp_alsa_i2c_i2s_exit);
-+//End MOD by river 2011.01.26
-diff -Nur linux-3.4.113.orig/sound/nds32/FTSSP010_HDA.c linux-3.4.113/sound/nds32/FTSSP010_HDA.c
---- linux-3.4.113.orig/sound/nds32/FTSSP010_HDA.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/FTSSP010_HDA.c 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,745 @@
-+/* FTSSP010 - UDA1345TS module:
-+ *
-+ * $log$
-+ *
-+ * 2006/02/23: I-Jui Sung: OSS emulation half-duplex
-+ * playback/capture at 48K, 44.1K, 8K
-+ * with mono/stereo 16bit/8bit
-+ *
-+ * 2006/02/22: I-Jui Sung: OSS emulation playback at 44.1KHz
-+ * 16-bit mono completed. Relying ALSA to
-+ * resample
-+ * 2009/02/24: dma upgrade checking list:
-+ * - ac97 mode playback ................. ok
-+ * - ac97 mode capture .................. ok
-+ * - i2s mode playback .................. ok
-+ * - i2s mode capture ................... ok
-+ * - mixer support (snd_ctl_add, ...) ... todo
-+ * - debug /proc entry .................. ok
-+ */
-+
-+
-+#include <linux/init.h>
-+#include <linux/module.h>
-+#include <asm/io.h>
-+#include <linux/delay.h>
-+#include <asm/spec.h>
-+#include <asm/dmad.h>
-+#include <linux/dma-mapping.h>
-+#include <sound/core.h>
-+#include <sound/pcm.h>
-+#include <sound/initval.h>
-+#include <sound/asound.h>
-+#include <sound/control.h>
-+#include "FTSSP010_HDA.h"
-+void init_hw(unsigned int cardno);
-+
-+#if (!defined(CONFIG_PLATFORM_AHBDMA) && !defined(CONFIG_PLATFORM_APBDMA))
-+#warning needs ahb/apb dma to wrok
-+#endif
-+
-+/* ---------------------------------------------------------------------------
-+ * Define the debug level of FTSSP_DEBUG
-+ */
-+#define FTSSP_DEBUG 0
-+#define FTSSP_DEBUG_VERBOSE 0
-+#define FTSSP_PROC_FS 1
-+
-+#undef VVDBG
-+#if (FTSSP_DEBUG_VERBOSE)
-+//#define VVDBG(vvar...) (void)0
-+#define VVDBG(vvar...) printk(KERN_INFO vvar)
-+#else
-+#define VVDBG(vvar...) (void)0
-+#endif
-+
-+#undef ERR
-+#define ERR(vvar...) printk(KERN_ERR vvar)
-+
-+#undef INFO
-+#define INFO(vvar...) printk(KERN_INFO vvar)
-+
-+#if (FTSSP_DEBUG)
-+#undef DBG
-+#define DBG(vvar...) printk(KERN_INFO vvar)
-+#else
-+#define DBG(vvar...) (void)0
-+#endif
-+
-+#if (FTSSP_DEBUG_VERBOSE)
-+#undef VDBG
-+#define VDBG(vvar...) printk(KERN_INFO vvar)
-+#else
-+#define VDBG(vvar...) (void)0
-+#endif
-+
-+/* ---------------------------------------------------------------------------
-+ * Preserved size of memory space for audio DMA ring
-+ */
-+#define FTSSP_HW_DMA_SIZE (512 * 1024)
-+
-+
-+/* HDA HW configuration*/
-+/* ring size, exported to application */
-+#define HDA_HW_BUFFER_BYTES_MAX (256 * 1024)
-+#define HDA_HW_PERIOD_BYTES_MIN (2 * 1024)
-+#define HDA_HW_PERIOD_BYTES_MAX (32 * 1024)
-+#define HDA_HW_PERIODS_MIN 3
-+#define HDA_HW_PERIODS_MAX 8
-+
-+#define HDA_HW_DMA_SIZE (HDA_HW_BUFFER_BYTES_MAX)
-+
-+
-+/* ---------------------------------------------------------------------------
-+ * Audio formats
-+ */
-+
-+/* HDA formats */
-+#define HDA_CODEC_FORMATS (SNDRV_PCM_FMTBIT_S16_LE)
-+#define HDA_CODEC_SAMPLE_RATES (SNDRV_PCM_RATE_192000 | \
-+ SNDRV_PCM_RATE_176400| \
-+ SNDRV_PCM_RATE_96000 | \
-+ SNDRV_PCM_RATE_88200 | \
-+ SNDRV_PCM_RATE_48000 | \
-+ SNDRV_PCM_RATE_44100 | \
-+ SNDRV_PCM_RATE_32000 | \
-+ SNDRV_PCM_RATE_22050 | \
-+ SNDRV_PCM_RATE_16000 | \
-+ SNDRV_PCM_RATE_11025 | \
-+ SNDRV_PCM_RATE_8000)
-+#define HDA_CODEC_SAMPLE_RATE_MIN (8000)
-+#define HDA_CODEC_SAMPLE_RATE_MAX (192000)
-+
-+/* ---------------------------------------------------------------------------
-+ * Configuration
-+ */
-+#if (CONFIG_PROC_FS == 0)
-+#undef FTSSP_PROC_FS
-+#define FTSSP_PROC_FS 0
-+#else
-+#if (FTSSP_PROC_FS)
-+#include <sound/info.h>
-+#endif /* FTSSP_PROC_FS */
-+#endif /* CONFIG_PROC_FS */
-+
-+#define FTSSP_CARD_ID "ftssp010"
-+#define FTSSP_DRIVER_NAME "ftssp"
-+
-+MODULE_LICENSE("Faraday License");
-+MODULE_AUTHOR("Faraday Technology Corp.");
-+MODULE_DESCRIPTION("FTSSP010 Linux 2.6 Driver");
-+
-+static int cardno = 0;
-+static const unsigned int SSP_FTSSP010_pa_base[SSP_FTSSP010_IRQ_COUNT] =
-+ { SSP_FTSSP010_PA_BASE };
-+
-+/* Driver mode */
-+
-+// ----------------------------------------------
-+module_param(cardno, int, 0);
-+MODULE_PARM_DESC(cardno, "FTSSP No.");
-+
-+// ----------------------------------------------
-+
-+/* ---------------------------------------------------------------------------
-+ * Structures
-+ */
-+
-+/* private data for card */
-+typedef struct {
-+ struct snd_card *card;
-+ struct snd_pcm *pcm;
-+ struct snd_pcm_substream *substream_tx;
-+ struct snd_pcm_substream *substream_rx;
-+} ftssp_chip;
-+
-+/* dma request descriptors */
-+dmad_chreq dma_chreq_tx = {
-+ .channel = -1,
-+ .drq = NULL,
-+};
-+
-+dmad_chreq dma_chreq_rx = {
-+ .channel = -1,
-+ .drq = NULL,
-+};
-+
-+/* Holds ALSA card instance pointers */
-+struct snd_card *ftssp_cards[SSP_FTSSP010_COUNT];
-+
-+/* snd_pcm_hardware */
-+static struct snd_pcm_hardware snd_ftssp_pcm_hw =
-+{
-+ .info = SNDRV_PCM_INFO_INTERLEAVED,
-+ .formats = HDA_CODEC_FORMATS,
-+ .rates = HDA_CODEC_SAMPLE_RATES,
-+ .rate_min = HDA_CODEC_SAMPLE_RATE_MIN,
-+ .rate_max = HDA_CODEC_SAMPLE_RATE_MAX,
-+ .channels_min = 1,
-+ .channels_max = 2,
-+ .buffer_bytes_max = HDA_HW_BUFFER_BYTES_MAX,
-+ .period_bytes_min = HDA_HW_PERIOD_BYTES_MIN,
-+ .period_bytes_max = HDA_HW_PERIOD_BYTES_MAX,
-+ .periods_min = HDA_HW_PERIODS_MIN,
-+ .periods_max = HDA_HW_PERIODS_MAX,
-+};
-+
-+/* private data for a substream (playback or capture) */
-+/* function pointer for set up AHBDMA for this substream */
-+typedef void (*start_t)(int cardno, unsigned use_dma);
-+typedef void (*ftssp010_config_t)(int cardno, unsigned is_stereo,
-+ unsigned speed, int use8bit);
-+
-+typedef struct {
-+ u32 busy;
-+ spinlock_t dma_lock;
-+ unsigned dma_area_va;
-+ int dma_width;
-+ unsigned int tx_period;
-+ unsigned int rx_period;
-+
-+ start_t start;
-+ ftssp010_config_t hw_config;
-+} ftssp_substream;
-+
-+static ftssp_substream ftssp010_substreams[2] = {
-+ /* Playback substream */
-+ {
-+ busy : 0,
-+ hw_config : ftssp010_config_hda_play,
-+ },
-+ /* Capture substream */
-+ {
-+ busy : 0,
-+ hw_config : ftssp010_config_hda_rec,
-+ }
-+};
-+
-+
-+/**
-+ * These dma callbacks are called in interrupt context.
-+ * @data: pointer to the chip-wide structure.
-+ * TODO: use stream-specifc data
-+ */
-+__attribute__((__unused__))
-+static void ftssp_dma_callback_tx(int ch, u16 int_status, void *data)
-+{
-+ ftssp_chip *chip = (ftssp_chip *)data;
-+ struct snd_pcm_runtime *runtime = chip->substream_tx->runtime;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)runtime->private_data;
-+ u32 sw_ptr;
-+ u32 tx_period = ftssp010_substream->tx_period + 1;
-+
-+ if (tx_period == runtime->periods)
-+ sw_ptr = runtime->buffer_size;
-+ else
-+ sw_ptr = tx_period * runtime->period_size;
-+
-+ sw_ptr = (u32)frames_to_bytes(runtime, sw_ptr) >> 1;
-+
-+ if (dmad_update_ring_sw_ptr(&dma_chreq_tx, (u32)sw_ptr, 0)) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ }
-+
-+ ftssp010_substream->tx_period = tx_period % runtime->periods;
-+ snd_pcm_period_elapsed(chip->substream_tx);
-+}
-+
-+__attribute__((__unused__))
-+static void ftssp_dma_callback_rx(int ch, u16 int_status, void *data)
-+{
-+ ftssp_chip *chip = (ftssp_chip *)data;
-+ struct snd_pcm_runtime *runtime = chip->substream_rx->runtime;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)runtime->private_data;
-+ u32 sw_ptr;
-+ u32 rx_period = ftssp010_substream->rx_period + 1;
-+
-+ if (rx_period == runtime->periods)
-+ sw_ptr = runtime->buffer_size;
-+ else
-+ sw_ptr = rx_period * runtime->period_size;
-+ sw_ptr = (u32)frames_to_bytes(runtime, sw_ptr) >> 1;
-+
-+ if (dmad_update_ring_sw_ptr(&dma_chreq_rx, (u32)sw_ptr, 0) != 0) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ }
-+
-+ ftssp010_substream->rx_period = rx_period % runtime->periods;
-+
-+ snd_pcm_period_elapsed(chip->substream_rx);
-+}
-+
-+static inline int snd_ftssp_dma_ch_alloc(struct snd_pcm_substream *substream)
-+{
-+ dmad_chreq *ch_req __attribute__((__unused__)) = 0;
-+
-+#ifdef CONFIG_PLATFORM_APBDMA
-+
-+ if (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ch_req = &dma_chreq_tx;
-+ ch_req->completion_cb = ftssp_dma_callback_tx;
-+ ch_req->apb_req.tx_dir = DMAD_DIR_A0_TO_A1;
-+ ch_req->apb_req.dev_reqn = APBBR_REQN_I2SAC97TX;
-+ } else {
-+ ch_req = &dma_chreq_rx;
-+ ch_req->completion_cb = ftssp_dma_callback_rx;
-+ ch_req->apb_req.tx_dir = DMAD_DIR_A1_TO_A0;
-+ ch_req->apb_req.dev_reqn = APBBR_REQN_I2SAC97RX;
-+ }
-+
-+ ch_req->controller = DMAD_DMAC_APB_CORE;
-+ ch_req->flags = DMAD_FLAGS_RING_MODE;
-+ ch_req->ring_base = 0;
-+ ch_req->dev_addr = (dma_addr_t)FTSSP010_DATA_PA(cardno);
-+ ch_req->periods = 0;
-+ ch_req->period_size = 0;
-+
-+ ch_req->apb_req.ring_ctrl = APBBR_ADDRINC_I2X;
-+ ch_req->apb_req.ring_reqn = APBBR_REQN_NONE;
-+ ch_req->apb_req.dev_ctrl = APBBR_ADDRINC_FIXED;
-+ ch_req->apb_req.burst_mode = 0;
-+ ch_req->apb_req.data_width = APBBR_DATAWIDTH_2;
-+ ch_req->completion_data = (void *)snd_pcm_substream_chip(substream);
-+
-+ ch_req->completion_data = (void *)snd_pcm_substream_chip(substream);
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ ERR("%s: APBDMA channel allocation failed\n",__func__);
-+ goto _try_ahb;
-+ }
-+
-+ DBG("%s: APBDMA channel allocated (ch: %d) ring_mode\n",
-+ __func__, ch_req->channel);
-+
-+ return 0;
-+
-+_try_ahb:
-+
-+#endif /* CONFIG_PLATFORM_APBDMA */
-+
-+#ifdef CONFIG_PLATFORM_AHBDMA
-+
-+ if (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ch_req = &dma_chreq_tx;
-+ ch_req->completion_cb = ftssp_dma_callback_tx;
-+ ch_req->ahb_req.tx_dir = DMAD_DIR_A0_TO_A1;
-+ ch_req->ahb_req.dev_reqn = DMAC_REQN_I2SAC97TX;
-+ } else {
-+ ch_req = &dma_chreq_rx;
-+ ch_req->completion_cb = ftssp_dma_callback_rx;
-+ ch_req->ahb_req.tx_dir = DMAD_DIR_A1_TO_A0;
-+ ch_req->ahb_req.dev_reqn = DMAC_REQN_I2SAC97RX;
-+ }
-+
-+ ch_req->controller = DMAD_DMAC_AHB_CORE;
-+ ch_req->flags = DMAD_FLAGS_RING_MODE;
-+ ch_req->ring_base = 0;
-+ ch_req->dev_addr = (dma_addr_t)FTSSP010_DATA_PA(cardno);
-+ ch_req->periods = 0;
-+ ch_req->period_size = 0;
-+
-+ ch_req->ahb_req.sync = 1;
-+ ch_req->ahb_req.priority = DMAC_CSR_CHPRI_2;
-+ ch_req->ahb_req.hw_handshake = 1;
-+ ch_req->ahb_req.burst_size = DMAC_CSR_SIZE_1;
-+
-+ ch_req->ahb_req.ring_width = DMAC_CSR_WIDTH_32;
-+ ch_req->ahb_req.ring_ctrl = DMAC_CSR_AD_INC;
-+ ch_req->ahb_req.ring_reqn = DMAC_REQN_NONE;
-+ ch_req->ahb_req.dev_width = DMAC_CSR_WIDTH_32;
-+ ch_req->ahb_req.dev_ctrl = DMAC_CSR_AD_FIX;
-+
-+ ch_req->completion_data = (void *)snd_pcm_substream_chip(substream);
-+
-+ if (dmad_channel_alloc(ch_req) != 0) {
-+ ERR("%s: AHBDMA channel allocation failed\n", __func__);
-+ goto _err_exit;
-+ }
-+
-+ DBG("%s: AHBDMA channel allocated (ch: %d) ring_mode\n",
-+ __func__, ch_req->channel);
-+
-+ return 0;
-+
-+_err_exit:
-+
-+#endif /* CONFIG_PLATFORM_AHBDMA */
-+
-+ return -ENODEV;
-+}
-+
-+static inline ftssp_substream *ftssp010_substream_new(int stream_id)
-+{
-+ ftssp_substream *s = NULL;
-+
-+ switch (stream_id) {
-+ case SNDRV_PCM_STREAM_PLAYBACK:
-+ s = &ftssp010_substreams[0];
-+ break;
-+ case SNDRV_PCM_STREAM_CAPTURE:
-+ s = &ftssp010_substreams[1];
-+ break;
-+ default:
-+ ERR("%s: wrong stream type (%d)\n", __func__, stream_id);
-+ return NULL;
-+ }
-+
-+ if (s->busy) {
-+ ERR("%s: device busy!\n", __func__);
-+ return NULL;
-+ }
-+ s->busy = 1;
-+
-+ spin_lock_init(&s->dma_lock);
-+
-+ return s;
-+}
-+
-+static int snd_ftssp_pcm_open(struct snd_pcm_substream *substream)
-+{
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ int stream_id = substream->pstr->stream;
-+
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+
-+ /* Both playback and capture share a hardware description */
-+ runtime->hw = snd_ftssp_pcm_hw;
-+
-+ /* Allocate & Initialize stream-specific data */
-+ runtime->private_data = ftssp010_substream_new(stream_id);
-+
-+ if (runtime->private_data)
-+ return snd_ftssp_dma_ch_alloc(substream);
-+ else
-+ return -EBUSY;
-+}
-+
-+static int snd_ftssp_pcm_close(struct snd_pcm_substream *substream)
-+{
-+ int stream_id = substream->pstr->stream;
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)substream->runtime->private_data;
-+
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK)
-+ dmad_channel_free(&dma_chreq_tx);
-+ else
-+ dmad_channel_free(&dma_chreq_rx);
-+
-+ ftssp010_substream->busy = 0;
-+ return 0;
-+}
-+
-+static int snd_ftssp_pcm_hw_params(struct snd_pcm_substream *substream,
-+ struct snd_pcm_hw_params *hw_params)
-+{
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+
-+ return snd_pcm_lib_malloc_pages(substream, HDA_HW_DMA_SIZE);
-+}
-+
-+static int snd_ftssp_pcm_hw_free(struct snd_pcm_substream *substream)
-+{
-+ VDBG("%s, %s\n", __func__,
-+ (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
-+ "playback" : "capture");
-+
-+ if (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK)
-+ dmad_drain_requests(&dma_chreq_tx, 1);
-+ else
-+ dmad_drain_requests(&dma_chreq_rx, 1);
-+
-+ return snd_pcm_lib_free_pages(substream);
-+}
-+
-+/* Prepare FTSSP010 AHBDMA for playback & capture */
-+static int snd_ftssp_pcm_prepare(struct snd_pcm_substream *substream)
-+{
-+ ftssp_chip *chip = snd_pcm_substream_chip(substream);
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)runtime->private_data;
-+
-+ int stream_id = substream->pstr->stream;
-+ dmad_chreq *dma_chreq;
-+ unsigned period_size, buffer_size;
-+ VVDBG("%s before spin_lock<<\n", __func__);
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK)
-+ dma_chreq = &dma_chreq_tx;
-+ else
-+ dma_chreq = &dma_chreq_rx;
-+
-+ period_size = frames_to_bytes(runtime, runtime->period_size);
-+ buffer_size = frames_to_bytes(runtime, runtime->buffer_size);
-+
-+ if (runtime->format != SNDRV_PCM_FORMAT_S16_LE)
-+ return -ENODEV;
-+
-+ ftssp010_substream->dma_width = 4;
-+
-+ dmad_drain_requests(dma_chreq, 1);
-+
-+ dma_chreq->ring_base = (dma_addr_t)runtime->dma_addr;
-+ dma_chreq->periods = (dma_addr_t)runtime->periods;
-+ dma_chreq->period_size = (dma_addr_t)(period_size >> 1);
-+ dma_chreq->ring_size = (dma_addr_t)(buffer_size >> 1);
-+ dmad_update_ring(dma_chreq);
-+
-+ /* Set PMU, FTSSP010, and DMA */
-+ spin_lock(&ftssp010_substream->dma_lock);
-+
-+ /* keep DMA buffer VA for copy() callback */
-+ // todo: support playback/capture simultaneously
-+ ftssp010_substream->dma_area_va = (u32)runtime->dma_area;
-+ VVDBG("%s before hw_config<<\n", __func__);
-+ ftssp010_substream->hw_config(cardno,
-+ runtime->channels > 1 ? 1 : 0, /* 1: stereo, 0: mono */
-+ runtime->rate, ftssp010_substream->dma_width);
-+ VVDBG("%s after hw_config<<\n", __func__);
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ftssp010_substream->tx_period = 0;
-+ chip->substream_tx = substream;
-+ } else {
-+ ftssp010_substream->rx_period = 0;
-+ chip->substream_rx = substream;
-+ }
-+
-+ spin_unlock(&ftssp010_substream->dma_lock);
-+ VVDBG("%s after spin_unlock <<\n", __func__);
-+
-+ return 0;
-+}
-+
-+static inline int snd_ftssp_start_play(ftssp_substream *ftssp010_substream,
-+ struct snd_pcm_runtime *runtime)
-+{
-+ int err = 0;
-+ u32 sw_ptr =
-+ (u32)frames_to_bytes(runtime, runtime->buffer_size) >> 1;
-+
-+ err = dmad_update_ring_sw_ptr(&dma_chreq_tx, sw_ptr, 0);
-+ if (err != 0) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ return err;
-+ }
-+ err = dmad_kickoff_requests(&dma_chreq_tx);
-+ if (err != 0) {
-+ ERR("%s: failed to kickoff dma!\n", __func__);
-+ return err;
-+ }
-+
-+ return 0;
-+}
-+
-+static inline int snd_ftssp_start_record(ftssp_substream *ftssp010_substream,
-+ struct snd_pcm_runtime *runtime)
-+{
-+ int err = 0;
-+ u32 sw_ptr = (u32)frames_to_bytes(runtime, runtime->buffer_size);
-+
-+ sw_ptr = sw_ptr >> 1;
-+ printk(">>>>>>>>>> : snd_ftssp_start_record() for recording....\n");
-+ err = dmad_update_ring_sw_ptr(&dma_chreq_rx, sw_ptr, 0);
-+ if (err != 0) {
-+ ERR("%s: failed to update sw-pointer!\n", __func__);
-+ return err;
-+ }
-+
-+ err = dmad_kickoff_requests(&dma_chreq_rx);
-+ if (err != 0) {
-+ ERR("%s: failed to kickoff dma!\n", __func__);
-+ return err;
-+ }
-+
-+
-+ return 0;
-+}
-+
-+/* Triggers AHBDMA for playback & capture */
-+static int snd_ftssp_pcm_trigger(struct snd_pcm_substream * substream, int cmd)
-+{
-+ ftssp_substream *ftssp010_substream =
-+ (ftssp_substream *)substream->runtime->private_data;
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ int err = 0;
-+ int stream_id = substream->pstr->stream;
-+
-+ /* note local interrupts are already disabled in the midlevel code */
-+ spin_lock(&ftssp010_substream->dma_lock);
-+
-+ switch (cmd) {
-+ case SNDRV_PCM_TRIGGER_START:
-+
-+ VDBG("%s: SNDRV_PCM_TRIGGER_START state(0x%08x)\n",
-+ __func__, (u32)runtime->status->state);
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ err = snd_ftssp_start_play(ftssp010_substream, runtime);
-+ } else {
-+ err = snd_ftssp_start_record(ftssp010_substream,
-+ runtime);
-+ }
-+ break;
-+
-+ case SNDRV_PCM_TRIGGER_STOP:
-+
-+ VDBG("%s: SNDRV_PCM_TRIGGER_STOP state(0x%08x)\n",
-+ __func__, (u32)substream->runtime->status->state);
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ ftssp010_stop_tx(cardno);
-+ dmad_drain_requests(&dma_chreq_tx, 1);
-+ } else {
-+ ftssp010_stop_rx(cardno);
-+ dmad_drain_requests(&dma_chreq_rx, 1);
-+ }
-+ break;
-+ default:
-+ err = -EINVAL;
-+ break;
-+ }
-+
-+ spin_unlock(&ftssp010_substream->dma_lock);
-+ return err;
-+}
-+
-+// pcm middle-layer call this function within irq (snd_pcm_period_elapsed) or
-+// with local irq disabled (snd_pcm_lib_write1)
-+static snd_pcm_uframes_t snd_ftssp_pcm_pointer(
-+ struct snd_pcm_substream *substream)
-+{
-+ struct snd_pcm_runtime *runtime = substream->runtime;
-+ u32 hw_ptr;
-+ snd_pcm_uframes_t ret;
-+ int stream_id = substream->pstr->stream;
-+
-+ /* Fetch DMA pointer, with spin lock */
-+ //spin_lock_irqsave(&ftssp010_substream->dma_lock, flags);
-+
-+ if (stream_id == SNDRV_PCM_STREAM_PLAYBACK) {
-+ hw_ptr = dmad_probe_ring_hw_ptr(&dma_chreq_tx);
-+ } else {
-+ hw_ptr = dmad_probe_ring_hw_ptr(&dma_chreq_rx);
-+ }
-+ ret = bytes_to_frames(runtime, hw_ptr << 1);
-+ //spin_unlock_irqrestore(&ftssp010_substream->dma_lock, flags);
-+ VVDBG("%s: hw_ptr(0x%08x) ret(0x%08x)\n",
-+ (stream_id == SNDRV_PCM_STREAM_PLAYBACK) ? "p" : "c",
-+ (u32)hw_ptr, (u32)ret);
-+
-+ /* ALSA requires return value 0 <= ret < buffer_size */
-+ if (ret >= runtime->buffer_size)
-+ return 0;
-+ return ret;
-+}
-+
-+/* For FTSSP010 driver, operations are shared among playback & capture */
-+static struct snd_pcm_ops snd_ftssp_playback_ops = {
-+ .open = snd_ftssp_pcm_open,
-+ .close = snd_ftssp_pcm_close,
-+ .ioctl = snd_pcm_lib_ioctl,
-+ .hw_params = snd_ftssp_pcm_hw_params,
-+ .hw_free = snd_ftssp_pcm_hw_free,
-+ .prepare = snd_ftssp_pcm_prepare,
-+ .trigger = snd_ftssp_pcm_trigger,
-+ .pointer = snd_ftssp_pcm_pointer,
-+ .copy = NULL,
-+};
-+
-+static struct snd_pcm_ops snd_ftssp_capture_ops = {
-+ .open = snd_ftssp_pcm_open,
-+ .close = snd_ftssp_pcm_close,
-+ .ioctl = snd_pcm_lib_ioctl,
-+ .hw_params = snd_ftssp_pcm_hw_params,
-+ .hw_free = snd_ftssp_pcm_hw_free,
-+ .prepare = snd_ftssp_pcm_prepare,
-+ .trigger = snd_ftssp_pcm_trigger,
-+ .pointer = snd_ftssp_pcm_pointer,
-+ .copy = NULL,
-+};
-+
-+/* ALSA PCM constructor */
-+static int snd_ftssp_new_pcm(ftssp_chip *chip)
-+{
-+ struct snd_pcm *pcm;
-+ int err;
-+
-+ /* PCM device #0 with 1 playback and 1 capture */
-+ if ((err = snd_pcm_new(chip->card, "ftssp_pcm", 0, 1, 1, &pcm)) < 0)
-+ return err;
-+
-+ pcm->private_data = chip;
-+ strcpy(pcm->name, "ftssp_pcm device");
-+ chip->pcm = pcm;
-+
-+ /* set operators for playback and capture*/
-+ snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
-+ &snd_ftssp_playback_ops);
-+
-+ snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
-+ &snd_ftssp_capture_ops);
-+
-+ /* Pre-allocate buffer, as suggested by ALSA driver document */
-+ // todo: support playback/capture simultaneously
-+ snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
-+ NULL, FTSSP_HW_DMA_SIZE, FTSSP_HW_DMA_SIZE);
-+
-+ return 0;
-+}
-+
-+static __init int ftssp_alsa_init(void)
-+{
-+ ftssp_chip *chip;
-+ int err;
-+ init_hw(cardno);
-+ INFO("After init_hw!\n");
-+ err = snd_card_create(cardno, FTSSP_CARD_ID, THIS_MODULE,
-+ sizeof(ftssp_chip), &ftssp_cards[cardno]);
-+ INFO("After snd_card_create!\n");
-+ if (err < 0)
-+ return err;
-+ sprintf(ftssp_cards[cardno]->driver, FTSSP_DRIVER_NAME);
-+ sprintf(ftssp_cards[cardno]->shortname,
-+ FTSSP_DRIVER_NAME "_HDA");
-+ sprintf(ftssp_cards[cardno]->longname,
-+ FTSSP_DRIVER_NAME "_HDA controller");
-+ /* PCM */
-+ chip = (ftssp_chip *)(ftssp_cards[cardno]->private_data);
-+ chip->card = ftssp_cards[cardno];
-+
-+ if ((err = snd_ftssp_new_pcm(chip))) {
-+ ERR("%s, Can't new PCM devices\n",__func__);
-+ return -ENODEV;
-+ }
-+
-+
-+ /* Register the card to ALSA */
-+ if ((err = snd_card_register(chip->card)) == 0) {
-+ INFO("%s card registered!\n", FTSSP_CARD_ID);
-+ }
-+
-+ return 0;
-+}
-+
-+static __exit void ftssp_alsa_exit(void)
-+{
-+ DBG("%s, cleaning up\n",__func__);
-+
-+ dmad_channel_free(&dma_chreq_tx);
-+ dmad_channel_free(&dma_chreq_rx);
-+
-+ snd_card_free(ftssp_cards[cardno]);
-+}
-+
-+module_init(ftssp_alsa_init);
-+module_exit(ftssp_alsa_exit);
-diff -Nur linux-3.4.113.orig/sound/nds32/FTSSP010_HDA.h linux-3.4.113/sound/nds32/FTSSP010_HDA.h
---- linux-3.4.113.orig/sound/nds32/FTSSP010_HDA.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/FTSSP010_HDA.h 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,34 @@
-+/* FTSSP010 - HDA supporting library header */
-+/*
-+ *
-+ * $log$
-+ *
-+ */
-+#include <linux/init.h>
-+#include <linux/module.h>
-+#include <asm/io.h>
-+#include <linux/delay.h>
-+#include <asm/spec.h>
-+#include <linux/dma-mapping.h>
-+
-+
-+#define FTSSP010_DATA(x) (SSP_FTSSP010_va_base[(x)]+0x18)
-+#define FTSSP010_DATA_PA(x) (SSP_FTSSP010_pa_base[(x)]+0x18)
-+
-+
-+/* Returns FTSSP010 status */
-+extern void ftssp010_set_int_control(int cardno, unsigned val);
-+extern int ftssp010_get_status(int cardno);
-+extern unsigned ftssp010_get_int_status(int cardno);
-+/* Polls FIFO full register */
-+extern int ftssp010_tx_fifo_not_full(int cardno);
-+
-+/* Configure FTSSP010 to a given sampling rate and channel number */
-+extern void ftssp010_config_hda_play(int cardno, unsigned is_stereo, unsigned speed, int use8bit);
-+
-+extern void ftssp010_config_hda_rec(int cardno, unsigned is_stereo, unsigned speed, int use8bit);
-+
-+extern void ftssp010_stop_tx(int cardno);
-+extern void ftssp010_stop_rx(int cardno);
-+
-+
-diff -Nur linux-3.4.113.orig/sound/nds32/FTSSP010_HDA_lib.c linux-3.4.113/sound/nds32/FTSSP010_HDA_lib.c
---- linux-3.4.113.orig/sound/nds32/FTSSP010_HDA_lib.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/FTSSP010_HDA_lib.c 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,477 @@
-+/* FTSSP010 - UDA1345TS module
-+ *
-+ * $log$
-+ */
-+
-+#include <linux/init.h>
-+#include <linux/module.h>
-+#include <asm/io.h>
-+#include <linux/delay.h>
-+#include <asm/spec.h>
-+#include <asm/dmad.h>
-+#include <linux/dma-mapping.h>
-+#include "hda.h"
-+
-+#if 0
-+MODULE_LICENSE("Faraday License");
-+MODULE_AUTHOR("Faraday Technology Corp.");
-+MODULE_DESCRIPTION("FTSSP010 - UDA1345TS Linux 2.6 Library");
-+#endif
-+#undef ERR
-+#define ERR(vvar...) printk(KERN_ERR vvar)
-+#define DBG(vvar...) printk(KERN_INFO vvar)
-+
-+#define SSP_TXFCLR 0x8
-+#define SSP_RXFCLR 0x4
-+#define SSP_RFIEN 0x4
-+#define SSP_TFIEN 0x8
-+#define SSP_SSPEN 0x1
-+#define SSP_TXDOE 0x2
-+#define SSP_RXDMAEN 0x10
-+#define SSP_TXDMAEN 0x20
-+#define SSP_RFURIEN 0x1
-+#define SSP_TFURIEN 0x2
-+#define HDA_STRNUM_RX 1
-+#define HDA_STRNUM_TX 2
-+#define HDA_CHANUM 0
-+#define HDA_CRST_MASK 0x20
-+/* Initialize FTSSP010 to output to UDA1345TS via I2S */
-+#define FTSSP010_CONTROL0(x) (SSP_FTSSP010_va_base[(x)]+0x0)
-+#define FTSSP010_CONTROL0_OPM_STEREO 0xC
-+#define FTSSP010_CONTROL0_OPM_MONO 0x8
-+
-+#define FTSSP010_CONTROL1(x) (SSP_FTSSP010_va_base[(x)]+0x4)
-+#define FTSSP010_CONTROL2(x) (SSP_FTSSP010_va_base[(x)]+0x8)
-+
-+#define FTSSP010_INT_CONTROL(x) (SSP_FTSSP010_va_base[(x)]+0x10)
-+#define FTSSP010_STATUS(x) (SSP_FTSSP010_va_base[(x)]+0xC)
-+#define FTSSP010_INT_STATUS(x) (SSP_FTSSP010_va_base[(x)]+0x14)
-+#define FTSSP010_DATA(x) (SSP_FTSSP010_va_base[(x)]+0x18)
-+#define FTSSP010_INFO(x) (SSP_FTSSP010_va_base[(x)]+0x1C)
-+#define FTSSP010_AC_COMMAND(x) (SSP_FTSSP010_va_base[(x)]+0x28)
-+#define FTSSP010_IRSPR(x) (SSP_FTSSP010_va_base[(x)]+0x2C)
-+#define FTSSP010_ICMDST(x) (SSP_FTSSP010_va_base[(x)]+0x30)
-+#define HDA_REG_OSDC(x) (SSP_FTSSP010_va_base[(x)]+0x50)
-+#define HDA_REG_ISDC(x) (SSP_FTSSP010_va_base[(x)]+0x54)
-+
-+static const unsigned int SSP_FTSSP010_va_base[SSP_FTSSP010_IRQ_COUNT] = { SSP_FTSSP010_VA_BASE };
-+static const unsigned int SSP_FTSSP010_pa_base[SSP_FTSSP010_IRQ_COUNT] = { SSP_FTSSP010_PA_BASE };
-+
-+void SetSSP_Enable(int cardno, int enable)
-+{
-+ volatile unsigned int ctrl = 0;
-+
-+ ctrl = inl(FTSSP010_CONTROL2(cardno));
-+ if(enable)
-+ ctrl |= SSP_SSPEN + SSP_TXDOE;
-+ else
-+ ctrl &= ~(SSP_SSPEN + SSP_TXDOE);
-+
-+ outl(ctrl, FTSSP010_CONTROL2(cardno));
-+}
-+void SetSSP_Enable_rx(int cardno, int enable)
-+{
-+ volatile unsigned int ctrl = 0;
-+
-+ ctrl = inl(FTSSP010_CONTROL2(cardno));
-+ if(enable)
-+ ctrl |= SSP_SSPEN ;
-+ else
-+ ctrl &= ~(SSP_SSPEN);
-+
-+ outl(ctrl, FTSSP010_CONTROL2(cardno));
-+}
-+
-+void SetSSP_FIFO_Threshold(int cardno, unsigned int trans_len,unsigned int rec_len)
-+{
-+ volatile unsigned int ctrl = 0;
-+ ctrl = inl(FTSSP010_INT_CONTROL(cardno));
-+
-+ ctrl &= ~0x0000FF00;
-+ ctrl |= ((trans_len << 12) + (rec_len << 8)) & 0x0000FF00;
-+
-+ outl(ctrl, FTSSP010_INT_CONTROL(cardno));
-+}
-+void SetSSP_IntMask(int cardno,int Mask)
-+{
-+ volatile unsigned int ctrl = 0;
-+ ctrl = inl(FTSSP010_INT_CONTROL(cardno));
-+ ctrl &= ~0x3F;
-+ ctrl |= Mask;
-+ outw(ctrl, FTSSP010_INT_CONTROL(cardno));
-+}
-+void SetSSP_TXFIFO(int cardno, unsigned int threshold,unsigned int underrun)
-+{
-+ volatile unsigned int data = 0;
-+
-+ data = inl(FTSSP010_INT_CONTROL(cardno));
-+
-+ if (threshold)
-+ data |= SSP_TFIEN;
-+ else
-+ data &= ~SSP_TFIEN; //Howard@2007-4-13
-+
-+ if (underrun)
-+ data |= SSP_TFURIEN;
-+ else
-+ data &= ~SSP_TFURIEN; //Howard@2007-4-13
-+
-+ outl(data, FTSSP010_INT_CONTROL(cardno));
-+}
-+void SetSSP_RXFIFO(int cardno,unsigned int threshold,unsigned int underrun)
-+{
-+ volatile unsigned int data = 0;
-+
-+ data = inl(FTSSP010_INT_CONTROL(cardno));
-+
-+ if (threshold)
-+ data |= SSP_RFIEN;
-+ else
-+ data &= ~SSP_RFIEN; //Howard@2007-4-13
-+
-+ if (underrun)
-+ data |= SSP_RFURIEN;
-+ else
-+ data &= ~SSP_RFURIEN; //Howard@2007-4-13
-+
-+ outl(data, FTSSP010_INT_CONTROL(cardno));
-+}
-+void SetSSP_DMA(int cardno, unsigned int trans,unsigned int rec)
-+{
-+ volatile unsigned int data = 0;
-+
-+ data = inl(FTSSP010_INT_CONTROL(cardno));
-+
-+ if (trans)
-+ data |= SSP_TXDMAEN;
-+ else
-+ data &= ~SSP_TXDMAEN;
-+
-+ if (rec)
-+ data |= SSP_RXDMAEN;
-+ else
-+ data &= ~SSP_RXDMAEN;
-+
-+ outl(data, FTSSP010_INT_CONTROL(cardno));
-+}
-+void SSPClearTxFIFO(int cardno)
-+{
-+ volatile unsigned int data = 0;
-+
-+ data = inl(FTSSP010_CONTROL2(cardno));
-+ data |= SSP_TXFCLR;
-+ outl(data, FTSSP010_CONTROL2(cardno));
-+}
-+
-+
-+void SSPClearRxFIFO(int cardno)
-+{
-+ volatile unsigned int data = 0;
-+
-+ data = inl(FTSSP010_CONTROL2(cardno));
-+ data |= SSP_RXFCLR;
-+ outl(data, FTSSP010_CONTROL2(cardno));
-+}
-+
-+void ftssp010_set_int_control(int cardno, unsigned val)
-+{
-+ outl(val, FTSSP010_INT_CONTROL(cardno));
-+}
-+
-+unsigned ftssp010_get_int_status(int cardno)
-+{
-+ return (inl(FTSSP010_INT_STATUS(cardno)));
-+}
-+
-+int ftssp010_get_status(int cardno)
-+{
-+ return (inl(FTSSP010_STATUS(cardno)));
-+}
-+
-+int ftssp010_tx_fifo_not_full(int cardno)
-+{
-+ return (inl(FTSSP010_STATUS(cardno))&0x2)==0x2;
-+}
-+
-+int ftssp010_tx_fifo_vaild_entries(int cardno)
-+{
-+ return (inl(FTSSP010_STATUS(cardno))>>12) & 0x1f;
-+}
-+
-+/* Configure FTSSP010 to a given sampling rate and channel number
-+ * for HDA mode in playback mode
-+ */
-+void init_hw(unsigned int cardno)
-+{
-+ /* Step 1: Set HDA Mode & HDA Format */
-+ outl(HDA_MODE | 0x4000, FTSSP010_CONTROL0(cardno)); /* set FTSSP010 to HDA mode */
-+ mdelay(50);
-+ outl(HDA_CRST_CLR | (5 << HDA_RST_FCNT_OFS), FTSSP010_CONTROL2(cardno)); /* Cold Reset AC-Link */
-+ mdelay(50);
-+ while((inl(FTSSP010_CONTROL2(cardno)) & HDA_CRST_MASK) != HDA_CRST_CLR);
-+ SetSSP_IntMask(cardno, 0);
-+
-+}
-+void SSPClearFIFO(int cardno, unsigned int tx, unsigned int rx)
-+{
-+ unsigned int data;
-+
-+ if (tx == 1) {
-+ //clear TX
-+ data = inl(FTSSP010_CONTROL2(cardno));
-+ //data = REG32(SSP_REG_CTRL2);
-+ data |= SSP_TXFCLR;
-+ outl(data, FTSSP010_CONTROL2(cardno));
-+ //REG32(SSP_REG_CTRL2) = data;
-+ }
-+
-+ if (rx == 1) {
-+ //clear RX
-+ data = inl(FTSSP010_CONTROL2(cardno));
-+ //data = REG32(SSP_REG_CTRL2);
-+ data |= SSP_RXFCLR;
-+ //REG32(SSP_REG_CTRL2) = data;
-+ outl(data, FTSSP010_CONTROL2(cardno));
-+ }
-+}
-+void hda_cmd_rsp(int cardno, unsigned int node_num, unsigned int verb_num, unsigned int func_num)
-+{
-+ //unsigned int HDA_REG_ICMDST;
-+ volatile unsigned int hda_cmd = HDA_COD_DEVADDR | (node_num << 20) | (verb_num << 8) | func_num;
-+ //Wait CMD Bus Not Busy
-+ while((inl(FTSSP010_ICMDST(cardno)) & HDA_ICB_MASK) != 0);
-+ //Write CMD into ICW
-+ outl(hda_cmd, FTSSP010_AC_COMMAND(cardno));
-+ mdelay(50);
-+ //Wait new resp is latched into IRR
-+ while((inl(FTSSP010_ICMDST(cardno)) & HDA_IRV_MASK) == 0);
-+ //Get Resp From IRR & Compare with Expected Resp
-+ //clear IRV
-+ outl(inl(FTSSP010_ICMDST(cardno)) | (1 << HDA_IRV_OFFSET), FTSSP010_ICMDST(cardno));
-+ mdelay(50);
-+}
-+void hda_cmdrsp_proc(int cardno, unsigned int node_num, unsigned int issue_cmd, unsigned int expect_rsp)
-+{
-+ unsigned int hda_cmd = HDA_COD_DEVADDR | node_num | issue_cmd;
-+ unsigned int HDA_REG_ICMDST;
-+ //Wait CMD Bus Not Busy
-+ while((inl(FTSSP010_ICMDST(cardno)) & HDA_ICB_MASK) != 0);
-+
-+ //Write CMD into ICW
-+ //REG32(HDA_REG_ICMDW) = hda_cmd;
-+ outl(hda_cmd, FTSSP010_AC_COMMAND(cardno));
-+ mdelay(50);
-+ //Wait new resp is latched into IRR
-+ while((inl(FTSSP010_ICMDST(cardno)) & HDA_IRV_MASK) == 0);
-+ //Get Resp From IRR & Compare with Expected Resp
-+ if (inl(FTSSP010_IRSPR(cardno)) != expect_rsp) {
-+ ERR("%s: unexpected rsp!",__func__);
-+ }
-+ else {
-+ //clear IRV
-+ outl(inl(FTSSP010_ICMDST(cardno)) | (1 << HDA_IRV_OFFSET), FTSSP010_ICMDST(cardno));
-+ }
-+}
-+unsigned int hda_covfmt_setup(unsigned int type, unsigned int base, unsigned int mult, unsigned int div, unsigned int bits, unsigned int chnum)
-+{
-+ unsigned int hda_fmt = type << HDA_FMT_TYPE_OFS |
-+ base << HDA_FMT_BASE_OFS |
-+ mult << HDA_FMT_MULT_OFS |
-+ div << HDA_FMT_DIV_OFS |
-+ bits << HDA_FMT_BITS_OFS |
-+ chnum << HDA_FMT_CHNUM_OFS;
-+ return hda_fmt;
-+}
-+unsigned int hda_covstr_setup(unsigned int stream, unsigned int channel)
-+{
-+ unsigned int hda_str = stream << HDA_STR_STR_OFS |
-+ channel << HDA_STR_CHA_OFS ;
-+ return hda_str;
-+}
-+unsigned int hda_converter_setup(int cardno, unsigned int mode, unsigned int type, unsigned int base, unsigned mult, unsigned int div, unsigned int bits, unsigned int chnum, unsigned int stream, unsigned int channel)
-+{
-+ unsigned int hda_fmt = 0;
-+ unsigned int hda_str = 0;
-+ unsigned int exp_rsp = 0;
-+ unsigned int node_num = 0;
-+
-+ if (mode == HDA_OUT_STR) {
-+ node_num = HDA_OUTCOV_NODE;
-+ }
-+ else {
-+ node_num = HDA_INCOV_NODE;
-+ }
-+ //a: Set Converter Format to Converter
-+ hda_fmt = hda_covfmt_setup(type, base, mult, div, bits, chnum);
-+ exp_rsp = HDA_RESP_ZERO_VAL;
-+ hda_cmdrsp_proc(cardno, node_num, (HDA_CMD_SETCVTFMT | hda_fmt), exp_rsp);
-+ //b: Get Converter Format from Converter
-+ exp_rsp = hda_fmt;
-+ hda_cmdrsp_proc(cardno, node_num, HDA_CMD_GETCVTFMT, exp_rsp);
-+ //c: Set Converter Stream to Converter
-+ hda_str = hda_covstr_setup(stream, channel);
-+ exp_rsp = HDA_RESP_ZERO_VAL;
-+ hda_cmdrsp_proc(cardno, node_num, (HDA_CMD_SETCVTSTR | hda_str), exp_rsp);
-+ //d: Get Converter Stream from Converter
-+ exp_rsp = hda_str;
-+ hda_cmdrsp_proc(cardno, node_num, HDA_CMD_GETCVTSTR, exp_rsp);
-+
-+ return hda_fmt;
-+}
-+void hda_iosdc_setup(int cardno, unsigned int io_sel, unsigned int ctrl, unsigned int stream_num, unsigned int hda_fmt)
-+{
-+ unsigned int hda_reg_base = (io_sel == 1)? HDA_REG_OSDC(cardno) : HDA_REG_ISDC(cardno);
-+ if (ctrl == 1) {//run
-+ outl((stream_num << HDA_SDC_STNUM_OFFSET) | hda_fmt, hda_reg_base);
-+ outl((inl(hda_reg_base) | (1 << HDA_SDC_SRUN_OFFSET)),hda_reg_base);
-+ }
-+
-+}
-+static void _ftssp010_config_hda(int cardno, unsigned is_stereo, unsigned speed, int is_rec)
-+{
-+ unsigned int hda_fmt = 0;
-+ unsigned int div = 0,mult = 0, base = 0;
-+ switch (speed) {
-+ case 44100:
-+ base = 1;
-+ div = 0;
-+ break;
-+ case 48000:
-+ div = 0;
-+ break;
-+ case 96000:
-+ mult = 1;
-+ break;
-+ case 192000:
-+ mult = 3;
-+ break;
-+ }
-+
-+ if (is_rec) { /* Recording */
-+ /* ------------------------------------------------ */
-+ /* Codec initialization */
-+ /* ------------------------------------------------ */
-+ /* Step 3: Codec Evaluation */
-+ /* root_node -> node 1(Audio Func Group) */
-+ /* -> node 2(Output Converter) */
-+ /* -> node 3(Input Converter) */
-+ /* ------------------------------------------------ */
-+ //input
-+ hda_cmd_rsp(cardno, 0x1a, 0x707, 0x20); //pin complex => input enable, port-c LINE1
-+ hda_cmd_rsp(cardno, 0x08, 0x3f0, 0x3f);//pin amp => max LINE ADC amplifier gain
-+ hda_cmd_rsp(cardno, 0x1a, 0x3f0, 0x00);//pin complex => no mute
-+ hda_cmd_rsp(cardno, 0x23, 0x3f2, 0x3f);//pin complex => no mute
-+ /* ------------------------------ */
-+ /* Step 4: Output Converter Setup */
-+ /* ------------------------------ */
-+ /* Set Converter Format & Stream to Node 2(Output Converter) */
-+ /* type = PCM, base = 48K, mult = xN, div = /M, bits = 8~32bits/sample, chnum = 1 */
-+ /* stream = 1, lowest channel = 0 */
-+
-+ hda_fmt = hda_converter_setup(cardno, HDA_IN_STR, //MODE
-+ 0, base, mult, div, 1, 1, //FORMAT
-+ HDA_STRNUM_RX, HDA_CHANUM); //STREAM
-+ /* ---------------------------- */
-+ /* Step 5: Enable Output Stream */
-+ /* ---------------------------- */
-+ hda_iosdc_setup(cardno, HDA_IN_STR, HDA_STR_RUN, HDA_STRNUM_RX, hda_fmt);
-+ SetSSP_Enable_rx(cardno, 1);
-+ SetSSP_RXFIFO(cardno, 0, 0);
-+ SetSSP_TXFIFO(cardno, 0, 0);
-+ SetSSP_FIFO_Threshold(cardno,12,12);
-+ SetSSP_DMA(cardno, 0, 1);
-+
-+ SSPClearTxFIFO(cardno);
-+ SSPClearRxFIFO(cardno);
-+
-+ //SetSSP_Enable_rx(cardno, 0);
-+
-+ } else { /* Playback */
-+ /* ------------------------------------------------ */
-+ /* Codec initialization */
-+ /* ------------------------------------------------ */
-+ /* Step 3: Codec Evaluation */
-+ /* root_node -> node 1(Audio Func Group) */
-+ /* -> node 2(Output Converter) */
-+ /* -> node 3(Input Converter) */
-+ /* ------------------------------------------------ */
-+ //DBG("%s before_cmd_rsp<<",__func__);
-+ hda_cmd_rsp(cardno, 0x14, 0x707, 0x40);//pin complex => output
-+ //DBG("%s after hda_cmd_rsp<<pin complex => output>>",__func__);
-+ hda_cmd_rsp(cardno, 0x0c, 0x3f0, 0x3f);//pin amp => 0x3f
-+ hda_cmd_rsp(cardno, 0x14, 0x3f0, 0x00);//pin complex => no mute
-+ //DBG("%s after hda_cmd_rsp",__func__);
-+ //msleep_interruptible(10);
-+ /* ------------------------------ */
-+ /* Step 4: Output Converter Setup */
-+ /* ------------------------------ */
-+ /* Set Converter Format & Stream to Node 2(Output Converter) */
-+ /* type = PCM, base = 48K, mult = xN, div = /M, bits = 8~32bits/sample, chnum = 1 */
-+ /* stream = 1, lowest channel = 0 */
-+ hda_fmt = hda_converter_setup(cardno, HDA_OUT_STR, //MODE
-+ 0, base, mult, div, 1, 1, //FORMAT
-+ HDA_STRNUM_TX, HDA_CHANUM); //STREAM
-+ //DBG("%s after hda_converter_setup",__func__);
-+ /* ---------------------------- */
-+ /* Step 5: Enable Output Stream */
-+ /* ---------------------------- */
-+ hda_iosdc_setup(cardno, HDA_OUT_STR, HDA_STR_RUN, HDA_STRNUM_TX, hda_fmt);
-+ SetSSP_Enable(cardno, 1);
-+ SetSSP_RXFIFO(cardno, 0, 0);
-+ SetSSP_TXFIFO(cardno, 0, 0);
-+ //outl(0xC, FTSSP010_CONTROL2(cardno)); /* Disable FTSSP010, clear RX/TX Fifo. */
-+ SetSSP_FIFO_Threshold(cardno,12,12);
-+ SetSSP_DMA(cardno,1,0);
-+
-+ SSPClearTxFIFO(cardno);
-+ SSPClearRxFIFO(cardno);
-+ }
-+
-+ while(inl(FTSSP010_INT_STATUS(cardno))&0x3);
-+}
-+/* for HDA */
-+void ftssp010_config_hda_play(int cardno, unsigned is_stereo, unsigned speed, int use8bit)
-+{
-+ _ftssp010_config_hda(cardno, is_stereo, speed, 0);
-+}
-+
-+void ftssp010_config_hda_rec(int cardno, unsigned is_stereo, unsigned speed, int use8bit)
-+{
-+ _ftssp010_config_hda(cardno, is_stereo, speed, 1);
-+}
-+
-+
-+
-+void ftssp010_stop_tx(int cardno)
-+{
-+ unsigned int hda_reg_base = HDA_REG_OSDC(cardno);
-+ SetSSP_Enable(cardno,0);
-+ SetSSP_DMA(cardno,0,0);
-+
-+ /* turn off output node */
-+ hda_cmd_rsp(cardno,0x14, 0x707, 0); //pin complex => input enable, port-c LINE1
-+ hda_cmd_rsp(cardno,0x0c, 0x3f0, 0x80); //pin amp => max LINE ADC amplifier gain
-+ hda_cmd_rsp(cardno,0x14, 0x3f0, 0x80); //pin complex => no mute
-+
-+ outl(0, hda_reg_base);
-+ SSPClearFIFO(cardno, 1, 0);
-+ //outl(inl(FTSSP010_INT_CONTROL(cardno)) & (~0x22), FTSSP010_INT_CONTROL(cardno));
-+}
-+
-+void ftssp010_stop_rx(int cardno)
-+{
-+ unsigned int hda_reg_base = HDA_REG_ISDC(cardno);
-+ SetSSP_Enable_rx(cardno, 0);
-+ SetSSP_DMA(cardno, 0, 0);
-+
-+ /* turn off output node */
-+ hda_cmd_rsp(cardno,0x1a, 0x707, 0); //pin complex => input enable, port-c LINE1
-+ hda_cmd_rsp(cardno,0x08, 0x3f0, 0x80);//pin amp => LINE ADC amplifier gain
-+ hda_cmd_rsp(cardno,0x1a, 0x3f0, 0x80);//pin complex => mute
-+ hda_cmd_rsp(cardno,0x23, 0x3f2, 0x80);//pin complex => no mute
-+
-+ outl(0, hda_reg_base);
-+ SSPClearFIFO(cardno, 0, 1);
-+ //outl(inl(FTSSP010_INT_CONTROL(cardno)) & (~0x11), FTSSP010_INT_CONTROL(cardno));
-+}
-+
-diff -Nur linux-3.4.113.orig/sound/nds32/FTSSP010_lib.c linux-3.4.113/sound/nds32/FTSSP010_lib.c
---- linux-3.4.113.orig/sound/nds32/FTSSP010_lib.c 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/FTSSP010_lib.c 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,795 @@
-+/* FTSSP010 - UDA1345TS module
-+ *
-+ * $log$
-+ */
-+
-+#include <linux/init.h>
-+#include <linux/module.h>
-+#include <asm/io.h>
-+#include <linux/delay.h>
-+#include <linux/i2c.h>
-+#include <asm/spec.h>
-+#include <asm/dmad.h>
-+#include <linux/dma-mapping.h>
-+#include "FTSSP010_UDA1345TS.h"
-+
-+#if 0
-+MODULE_LICENSE("Faraday License");
-+MODULE_AUTHOR("Faraday Technology Corp.");
-+MODULE_DESCRIPTION("FTSSP010 - UDA1345TS Linux 2.6 Library");
-+#endif
-+
-+#define PMU_PDLLCR1 (PMU_FTPMU010_VA_BASE+0x34)
-+#define PMU_MFPSR (PMU_FTPMU010_VA_BASE+0x28)
-+#define PMU_I2SAC97_REQACKCFG (PMU_FTPMU010_VA_BASE+0xbc)
-+#define PMU_C4 (PMU_FTPMU010_VA_BASE+0xc4)
-+
-+#define SSPCLK_TO_SCLKDIV(sspclk_div2,bps) ((sspclk_div2)/(bps)-1)
-+
-+// Each client has this additional data
-+struct alc5630_data {
-+ struct i2c_client *client;
-+ struct delayed_work work;
-+ unsigned long gpio2_value;
-+ struct mutex mtx;
-+};
-+
-+//ADD by river 2011.01.26
-+static int i2s_alc5630_read(unsigned int raddr, char *data, struct i2c_client *client)
-+{
-+#ifndef CONFIG_SND_FTSSP010_AC97
-+ struct i2c_adapter *adap = client->adapter;
-+ int ret;
-+#endif
-+ struct i2c_msg msg;
-+ int i2c_value;
-+
-+ //Reading ALC5630 register
-+ msg.addr = raddr;
-+ msg.flags = (client->flags & I2C_M_TEN) | I2C_M_RD;
-+ msg.len = 1;
-+ msg.buf = (char *)data;
-+
-+ //ret = i2c_transfer(adap, &msg, 1);
-+#ifndef CONFIG_SND_FTSSP010_AC97
-+ ret = i2c_transfer(adap, &msg, 1);
-+ if (ret != 0) {
-+ printk("i2c read failed\n");
-+ return -1;
-+ }
-+ else
-+#endif
-+ {
-+ i2c_value = (data[0]&0xff) << 8 | (data[1]&0xff);
-+ return i2c_value;
-+ }
-+}
-+
-+static void i2s_alc5630_write(unsigned int raddr, unsigned int data, struct i2c_client *client)
-+{
-+#ifndef CONFIG_SND_FTSSP010_AC97
-+ struct i2c_adapter *adap = client->adapter;
-+ int ret;
-+#endif
-+ struct i2c_msg msg;
-+ char buf[3];
-+
-+ //Writing ALC5630 register
-+ msg.addr = raddr;
-+ msg.flags = (client->flags & I2C_M_TEN) | ~I2C_M_RD;
-+ msg.len = 1;
-+
-+ buf[0] = (data >> 8) & 0xff;
-+ buf[1] = data & 0xff;
-+ msg.buf = (char *)buf;
-+
-+ //ret = i2c_transfer(adap, &msg, 1);
-+#ifndef CONFIG_SND_FTSSP010_AC97
-+ ret = i2c_transfer(adap, &msg, 1);
-+ if (ret != 0)
-+ {
-+ printk("i2c write failed\n");
-+ }
-+#endif
-+}
-+
-+/*
-+static void i2s_alc5630_master_stereo_mode(struct i2c_client *client)
-+{
-+ //printk(">>>>>>>>> (7) i2s_alc5630_master_stereo_mode() is called.\n");
-+ i2s_alc5630_write(0x02, 0x5f5f, client);
-+ mdelay(50);
-+ i2s_alc5630_write(0x04, 0x5f5f, client);
-+ mdelay(50);
-+ i2s_alc5630_write(0x26, 0x000f, client);
-+ mdelay(50);
-+ i2s_alc5630_write(0x34, 0x0000, client); // codec master mode
-+ //i2s_alc5630_write(0x34, 0x8000, client); // codec slave mode
-+ mdelay(50);
-+ i2s_alc5630_write(0x3a, 0x0801, client);
-+ mdelay(50);
-+ i2s_alc5630_write(0x3c, 0xffff, client);
-+ mdelay(50);
-+ i2s_alc5630_write(0x3e, 0xffff, client);
-+ mdelay(50);
-+ i2s_alc5630_write(0x60, 0x3075, client); // codec master mode. divider.
-+ mdelay(50);
-+ i2s_alc5630_write(0x62, 0x1010, client); // codec master mode. divider.
-+
-+}
-+*/
-+
-+/*
-+static void i2s_alc5630_read_test(struct i2c_client *client)
-+{
-+ char data[3];
-+ printk(">>>>> : i2s_alc5630_read_test().....\n");
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0, i2s_alc5630_read(0x0, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x02, i2s_alc5630_read(0x02, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x04, i2s_alc5630_read(0x04, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x06, i2s_alc5630_read(0x06, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x08, i2s_alc5630_read(0x08, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0a, i2s_alc5630_read(0x0a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0c, i2s_alc5630_read(0x0c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x0e, i2s_alc5630_read(0x0e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x10, i2s_alc5630_read(0x10, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x12, i2s_alc5630_read(0x12, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x14, i2s_alc5630_read(0x14, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x16, i2s_alc5630_read(0x16, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x18, i2s_alc5630_read(0x18, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x1a, i2s_alc5630_read(0x1a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x1c, i2s_alc5630_read(0x1c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x1e, i2s_alc5630_read(0x1e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x20, i2s_alc5630_read(0x20, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x22, i2s_alc5630_read(0x22, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x24, i2s_alc5630_read(0x24, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x26, i2s_alc5630_read(0x26, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x28, i2s_alc5630_read(0x28, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x2a, i2s_alc5630_read(0x2a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x2c, i2s_alc5630_read(0x2c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x2e, i2s_alc5630_read(0x2e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x30, i2s_alc5630_read(0x30, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x32, i2s_alc5630_read(0x32, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x34, i2s_alc5630_read(0x34, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x36, i2s_alc5630_read(0x36, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x38, i2s_alc5630_read(0x38, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x3a, i2s_alc5630_read(0x3a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x3c, i2s_alc5630_read(0x3c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x3e, i2s_alc5630_read(0x3e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x40, i2s_alc5630_read(0x40, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x42, i2s_alc5630_read(0x42, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x44, i2s_alc5630_read(0x44, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x46, i2s_alc5630_read(0x46, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x48, i2s_alc5630_read(0x48, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x4a, i2s_alc5630_read(0x4a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x4c, i2s_alc5630_read(0x4c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x4e, i2s_alc5630_read(0x4e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x50, i2s_alc5630_read(0x50, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x52, i2s_alc5630_read(0x52, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x54, i2s_alc5630_read(0x54, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x56, i2s_alc5630_read(0x56, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x58, i2s_alc5630_read(0x58, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x5a, i2s_alc5630_read(0x5a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x5c, i2s_alc5630_read(0x5c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x5e, i2s_alc5630_read(0x5e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x60, i2s_alc5630_read(0x60, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x62, i2s_alc5630_read(0x62, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x64, i2s_alc5630_read(0x64, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x66, i2s_alc5630_read(0x66, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x68, i2s_alc5630_read(0x68, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x6a, i2s_alc5630_read(0x6a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x6c, i2s_alc5630_read(0x6c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x6e, i2s_alc5630_read(0x6e, data,client));
-+
-+ printk("Reg 0x%02x = 0x%08x\n", 0x70, i2s_alc5630_read(0x70, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x72, i2s_alc5630_read(0x72, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x74, i2s_alc5630_read(0x74, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x76, i2s_alc5630_read(0x76, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x78, i2s_alc5630_read(0x78, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x7a, i2s_alc5630_read(0x7a, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x7c, i2s_alc5630_read(0x7c, data,client));
-+ printk("Reg 0x%02x = 0x%08x\n", 0x7e, i2s_alc5630_read(0x7e, data,client));
-+
-+}
-+*/
-+
-+static void i2s_al5630_slave_stereo_mode(struct i2c_client *client)
-+{
-+
-+
-+ i2s_alc5630_write(0x34, 0x8000, client); // codec slave mode
-+ i2s_alc5630_write(0x0c, 0x1010, client);
-+ i2s_alc5630_write(0x10, 0xee03, client);
-+ i2s_alc5630_write(0x1c, 0x0748, client);
-+ //i2s_alc5630_write(0x02, 0x8080, client);
-+ //i2s_alc5630_write(0x04, 0x8888, client);
-+ i2s_alc5630_write(0x62, 0x0000, client);
-+
-+}
-+
-+//End ADD by river 2011.01.26
-+
-+
-+/* Drive PMU to generate I2S main clocking signal. Also configures PMU to set correct DMA REQ/ACK pair */
-+void pmu_set_i2s_clocking(unsigned int speed)
-+{
-+ unsigned int pmu_pdllcr1; /* PLL/DLL Control Register 1 */
-+ /* Configure PMU to generate I2S main clock */
-+ #ifdef CONFIG_PLAT_AG101
-+ pmu_pdllcr1 = inl(PMU_PDLLCR1)&0xfff0ffff; /* Bit 19-16 are relevent */
-+ #endif
-+
-+ switch (speed) {
-+ case 8000:
-+ pmu_pdllcr1 |= 0x00000000; /* 2.048MHz x2 */
-+ break;
-+ case 11025:
-+ pmu_pdllcr1 |= 0x00010000; /* 2.8224MHz x2 */
-+ break;
-+ case 16000:
-+ pmu_pdllcr1 |= 0x00020000; /* 4.096MHz x2 */
-+ break;
-+ case 22050:
-+ pmu_pdllcr1 |= 0x00030000; /* 5.6448MHz x2 */
-+ break;
-+ case 32000:
-+ pmu_pdllcr1 |= 0x00040000; /* 8.192MHz x2 */
-+ break;
-+ case 44100:
-+ pmu_pdllcr1 |= 0x00050000; /* 11.2896Mhz x2 */
-+ break;
-+ case 48000:
-+ pmu_pdllcr1 |= 0x00060000; /* 12.2880MHz x2 */
-+ break;
-+ default:
-+ printk("%s: Unknown i2s speed %d\n",__func__,speed);
-+ };
-+
-+ #ifdef CONFIG_PLAT_AG101
-+ outl(pmu_pdllcr1, PMU_PDLLCR1);
-+ /* Configure PMU to select I2S output (instead of AC97) */
-+ outl(inl(PMU_MFPSR)&(~(1<<3)), PMU_MFPSR); /* clear bit 3 of MFPSR*/
-+ #endif
-+}
-+
-+/* Drive PMU to generate AC97 main clocking signal. Also configures PMU to set correct DMA REQ/ACK pair */
-+void pmu_set_ac97_clocking(unsigned int speed)
-+{
-+ /* Configure PMU to select AC97 output (instead of I2S) */
-+ /* Set GPIO[26] to AC97 clock, use 49.152MHz main clock (AC97 CLK1) */
-+ //outl(inl(PMU_MFPSR)|((1<<13)|(1<<3)), PMU_MFPSR); /* Set bit 13 & 3 of MFPSR*/
-+ #ifndef CONFIG_PLAT_AG102
-+ outl(inl(PMU_MFPSR)|((1<<13)|(1<<3)), PMU_MFPSR); /* Set bit 13 & 3 of MFPSR*/
-+ #endif
-+}
-+
-+/* Programs PMU to set I2S/AC97 DMA Channel, ch=0-7 */
-+void pmu_set_i2s_dma_channel(unsigned ch)
-+{
-+ #ifdef CONFIG_PLAT_AG101
-+ ch&=0x7;
-+ //outl((inl(PMU_I2SAC97_REQACKCFG)&(~0x7))|ch, PMU_I2SAC97_REQACKCFG);
-+ outl(0xa, PMU_I2SAC97_REQACKCFG);
-+ outl(0xb, PMU_C4);
-+ #endif
-+}
-+
-+/* Initialize FTSSP010 to output to UDA1345TS via I2S */
-+#define FTSSP010_CONTROL0(x) (SSP_FTSSP010_va_base[(x)]+0x0)
-+#define FTSSP010_CONTROL0_OPM_STEREO 0xC
-+#define FTSSP010_CONTROL0_OPM_MONO 0x8
-+
-+#define FTSSP010_CONTROL1(x) (SSP_FTSSP010_va_base[(x)]+0x4)
-+#define FTSSP010_CONTROL2(x) (SSP_FTSSP010_va_base[(x)]+0x8)
-+
-+#define FTSSP010_INT_CONTROL(x) (SSP_FTSSP010_va_base[(x)]+0x10)
-+#define FTSSP010_STATUS(x) (SSP_FTSSP010_va_base[(x)]+0xC)
-+#define FTSSP010_INT_STATUS(x) (SSP_FTSSP010_va_base[(x)]+0x14)
-+#define FTSSP010_DATA(x) (SSP_FTSSP010_va_base[(x)]+0x18)
-+#define FTSSP010_INFO(x) (SSP_FTSSP010_va_base[(x)]+0x1C)
-+
-+//static const unsigned int SSP_FTSSP010_va_base[SSP_FTSSP010_IRQ_COUNT] = { SSP_FTSSP010_VA_BASE };
-+//static const unsigned int SSP_FTSSP010_pa_base[SSP_FTSSP010_IRQ_COUNT] = { SSP_FTSSP010_PA_BASE };
-+
-+//ADD by river 2011.02.11
-+static struct i2c_client *g_i2c_client;
-+
-+
-+#define FTSSP010_ACLINK_SLOT_VALID(x) (SSP_FTSSP010_va_base[(x)]+0x20)
-+
-+void ftssp010_set_int_control(int cardno, unsigned val)
-+{
-+ outl(val, FTSSP010_INT_CONTROL(cardno));
-+}
-+
-+unsigned ftssp010_get_int_status(int cardno)
-+{
-+ return (inl(FTSSP010_INT_STATUS(cardno)));
-+}
-+
-+int ftssp010_get_status(int cardno)
-+{
-+ return (inl(FTSSP010_STATUS(cardno)));
-+}
-+
-+int ftssp010_tx_fifo_not_full(int cardno)
-+{
-+ return (inl(FTSSP010_STATUS(cardno))&0x2)==0x2;
-+}
-+
-+int ftssp010_tx_fifo_vaild_entries(int cardno)
-+{
-+ return (inl(FTSSP010_STATUS(cardno))>>12) & 0x1f;
-+}
-+
-+#include "FTSSP010_W83972D.h"
-+
-+// AC97 codec tags
-+#define TAG_COMMAND 0xe000
-+#define TAG_DATA 0x9800 /* Slot 3/4 */
-+#define TAG_DATA_MONO 0x9000 /* Slot 3 */
-+//#define TAG_DATA_LINE_IN 0x9000 /* Slot 3 */
-+
-+void ftssp010_ac97_write_codec_start(unsigned int cardno)
-+{
-+ outl(0x0, FTSSP010_INT_CONTROL(cardno));/*Disable interrupts & DMA req */
-+ outl(0xC, FTSSP010_CONTROL2(cardno)); /* Disable FTSSP010, clear RX/TX Fifo. */
-+ outl(TAG_COMMAND, FTSSP010_ACLINK_SLOT_VALID(cardno));
-+}
-+
-+void ftssp010_ac97_write_codec(unsigned int cardno,unsigned int reg,unsigned int data)
-+{
-+ outl(reg << 12, FTSSP010_DATA(cardno));
-+ mdelay(50);
-+ outl(data << 4, FTSSP010_DATA(cardno));
-+ mdelay(50);
-+}
-+
-+void ftssp010_ac97_write_codec_commit(unsigned int cardno)
-+{
-+ while((inl(FTSSP010_CONTROL2(cardno))&0x1)==0) {
-+ outl(0x3 , FTSSP010_CONTROL2(cardno)); /* SSPEN + TXDOE */
-+ }
-+ while(ftssp010_tx_fifo_vaild_entries(cardno))
-+ ;
-+ /* Wait for frame completion */
-+ while((inl(FTSSP010_INT_STATUS(cardno))&0x10)==0)
-+ ;
-+ outl(0x0, FTSSP010_CONTROL2(cardno));
-+}
-+
-+/* Configure FTSSP010 to a given sampling rate and channel number
-+ * for AC97 mode in playback mode
-+ */
-+void init_hw(unsigned int cardno,unsigned int ac97, struct i2c_client *client)
-+{
-+
-+ //printk(">>>>>>>>>> (5) init_hw() is called.\n");
-+ g_i2c_client = client;
-+
-+ if(ac97)
-+ {
-+ //pmu_set_ac97_clocking(48000);
-+ #ifndef CONFIG_PLAT_AG102
-+ pmu_set_ac97_clocking(48000);
-+ #endif
-+ outl(0x400c, FTSSP010_CONTROL0(cardno)); /* set FTSSP010 to AC97 mode */
-+ mdelay(50);
-+ outl(0xc400, FTSSP010_INT_CONTROL(cardno));
-+ mdelay(50);
-+ outl(0x20, FTSSP010_CONTROL2(cardno)); /* Cold Reset AC-Link */
-+ mdelay(50);
-+ while(inl(FTSSP010_CONTROL2(cardno)))
-+ mdelay(50);
-+ outl(0x40, FTSSP010_CONTROL2(cardno)); /* Reset AC-Link */
-+ mdelay(1500);
-+ }
-+ else
-+ {
-+
-+ //printk(">>>>>>>>> (6) I2S mode selected....YAYAYA......\n");
-+ #ifdef CONFIG_PLAT_AG101
-+ outl(inl(PMU_MFPSR)&(~(1<<3)), PMU_MFPSR); /* clear bit 3 of MFPSR*/
-+ outl(0xa, PMU_I2SAC97_REQACKCFG);
-+ outl(0xb, PMU_C4);
-+ #endif
-+
-+ //MOD by river 2011.01.26
-+ //i2s_alc5630_master_stereo_mode(client);
-+ i2s_al5630_slave_stereo_mode(client);
-+ //ssp_slave_stereo_mode();
-+ //End MOD by river 2011.01.26
-+ outl(0x311c, FTSSP010_CONTROL0(cardno)); /* I2S Master */
-+ outl(0, FTSSP010_CONTROL1(cardno)); /* I2S Master */
-+ outl(0xc400, FTSSP010_INT_CONTROL(cardno)); /* I2S Master */
-+ outl(0x40, FTSSP010_CONTROL2(cardno)); /* Reset AC-Link */
-+
-+ //i2s_alc5630_read_test(client);
-+ }
-+}
-+static void _ftssp010_config_ac97(int cardno, unsigned is_stereo, unsigned speed, int is_rec)
-+{
-+ /* Codec initialization */
-+ ftssp010_ac97_write_codec_start(cardno);
-+ ftssp010_ac97_write_codec(cardno, W83972D_RESET, 0);
-+ ftssp010_ac97_write_codec_commit(cardno);
-+
-+ msleep_interruptible(10);
-+ ftssp010_ac97_write_codec_start(cardno);
-+
-+ if (is_rec) { /* Recording */
-+ /* Mute output */
-+ //ftssp010_ac97_write_codec(cardno, W83972D_STEREO_OUTPUT_CONTROL, 0x8000);
-+ /* Mute PCM */
-+ //ftssp010_ac97_write_codec(cardno, W83972D_PCM_OUTPUT_CONTROL, 0x8000);
-+
-+ /* Register 0x10, Line-In/Mic Gain */
-+ ftssp010_ac97_write_codec(cardno, W83972D_LINE_IN_VOLUME, 0x808);
-+ //ftssp010_ac97_write_codec(cardno, W83972D_AUX_INPUT_CONTROL, 0x808);
-+ ftssp010_ac97_write_codec(cardno, W83972D_MIC_VOLUME, 0x8);
-+ /* FIXME: REC from line-in only */
-+
-+ /* Register 0x1A, Record Select=StereoMix */
-+ ftssp010_ac97_write_codec(cardno, W83972D_RECORD_SELECT, 0x505 /*404*/);
-+ /* Register 0x1C, Record Gain=0db */
-+ ftssp010_ac97_write_codec(cardno, W83972D_RECORD_GAIN, 0x808);
-+ ftssp010_ac97_write_codec(cardno, W83972D_RECORD_GAIN_MIC, 0x8);
-+ } else { /* Playback */
-+ /* Register 0x10, Mute Line-In/Mic Gain */
-+ ftssp010_ac97_write_codec(cardno, W83972D_LINE_IN_VOLUME, 0x8000);
-+ ftssp010_ac97_write_codec(cardno, W83972D_MIC_VOLUME, 0x8000);
-+
-+ /* Register 0x1A, Mute Record Gains */
-+ ftssp010_ac97_write_codec(cardno, W83972D_RECORD_GAIN, 0x8000);
-+ ftssp010_ac97_write_codec(cardno, W83972D_RECORD_GAIN_MIC, 0x8000);
-+
-+ /* Output */
-+ ftssp010_ac97_write_codec(cardno, W83972D_STEREO_OUTPUT_CONTROL, 0);
-+ ftssp010_ac97_write_codec(cardno, W83972D_PCM_OUTPUT_CONTROL, 0x808);
-+ }
-+
-+#if 0
-+ ftssp010_ac97_write_codec(cardno, W83972D_EXT_AUDIO_CONTROL, 0x1);
-+ ftssp010_ac97_write_codec(cardno, W83972D_DAC_SAMPLE_RATE_CONTROL, speed);
-+#endif
-+
-+ ftssp010_ac97_write_codec_commit(cardno);
-+ msleep_interruptible(10);
-+
-+ /* Start data transfer */
-+// if(is_rec) {
-+// outl(TAG_DATA_LINE_IN, FTSSP010_ACLINK_SLOT_VALID(cardno));
-+// } else {
-+ if(is_stereo)
-+ outl(TAG_DATA, FTSSP010_ACLINK_SLOT_VALID(cardno));
-+ else
-+ outl(TAG_DATA_MONO, FTSSP010_ACLINK_SLOT_VALID(cardno));
-+// }
-+ while(inl(FTSSP010_INT_STATUS(cardno))&0x3);
-+// msleep_interruptible(10);
-+}
-+
-+void ftssp010_config_ac97_play(int cardno, unsigned is_stereo, unsigned speed, int use8bit)
-+{
-+ _ftssp010_config_ac97(cardno, is_stereo, speed, 0);
-+}
-+
-+void ftssp010_config_ac97_rec(int cardno, unsigned is_stereo, unsigned speed, int use8bit)
-+{
-+ _ftssp010_config_ac97(cardno, is_stereo, speed, 1);
-+}
-+/*
-+ * Configure FTSSP010 to a given sampling rate and channel number
-+ * for I2S mode
-+ */
-+void ftssp010_config(int cardno, unsigned is_stereo, unsigned speed, int width, int is_rec)
-+{
-+ int use8bit = (width == 1 ? 1 : 0);
-+ unsigned opm, bps = 2 * (use8bit ? 8 : 16); /* bits per 1 second audio data. */
-+ unsigned fpclkdiv = 0;
-+
-+ //ADD by river 2011.06.02
-+ struct alc5630_data *alc5630;
-+ char data[3];
-+ opm = is_stereo ? FTSSP010_CONTROL0_OPM_STEREO : FTSSP010_CONTROL0_OPM_MONO;
-+ //MOD by river 2011.01.27
-+ outl(0x3100 | opm, FTSSP010_CONTROL0(cardno)); /* I2S Master */
-+ //End MOD by river 2011.01.27
-+
-+#if 0
-+ printk("%s: use %dHz %d-bit %s \n",__func__,
-+ speed,
-+ use8bit?8:16,
-+ is_stereo?"stereo":"mono"
-+ );
-+#endif
-+
-+ /* configures CONTROL1 to use suitable clock divider.
-+ the I2S clock is generated from PMU. */
-+ bps *= speed;
-+ switch(speed) {
-+ case 8000: /* SCLK : 256KHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client); //?
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ //i2s_alc5630_write(0x44, 0x6a0, g_i2c_client); //?
-+ //i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ //i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ fpclkdiv = 0xBB;
-+
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(2048000, bps);
-+ break;
-+ case 11025: /* SCLK : 352.8KHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client); //?
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ fpclkdiv = 0x88;
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(2822400, bps);
-+ break;
-+ case 16000: /* SCLK : 512KHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client); //?
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ fpclkdiv = 0x5f;
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(4096000, bps);
-+ break;
-+ case 22050: /* SCLK : 705.6KHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client);
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ fpclkdiv = 0x45;
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(5644800, bps);
-+ break;
-+ case 24000: /* SCLK : 768KHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client);
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ fpclkdiv = 0x3e;
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(5644800, bps);
-+ break;
-+ case 32000: /* SCLK : 1024KHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client);
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ //fpclkdiv = 0x2e;
-+ fpclkdiv = 0x2f;
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(8192000, bps);
-+ break;
-+ case 44100: /* SCLK : 1.4112 MHZ */ /* 96 MHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client);
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ fpclkdiv = 0x22;
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(11289600, bps);
-+ break;
-+ case 48000: /* SCLK : 1.536 MHZ */
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client);
-+ i2s_alc5630_write(0x60, 0x3174, g_i2c_client);
-+ i2s_alc5630_write(0x62, 0x1010, g_i2c_client);
-+ fpclkdiv = 0x1f;
-+ //fpclkdiv=SSPCLK_TO_SCLKDIV(12288000, bps);
-+
-+ break;
-+ default:
-+ printk("%s: unsupported speed %d\n", __func__,speed);
-+ return;
-+ };
-+
-+
-+ if(!use8bit) {
-+ outl(0xf0000|fpclkdiv, FTSSP010_CONTROL1(cardno)); /* 16bits */
-+ //outl(0xf0000|0x10, FTSSP010_CONTROL1(cardno)); /* 16bits */
-+ //outl(0xf0000|0x22, FTSSP010_CONTROL1(cardno)); /* 16bits */
-+ } else {
-+ outl(0x70000|fpclkdiv, FTSSP010_CONTROL1(cardno)); /* 8bits */
-+ }
-+
-+ //printk("#####$$$$$ : bps = %d\n", bps);
-+ //printk("#####$$$$$ : speed = %d\n", speed);
-+ //printk("#####$$$$$ : fpclkdiv = 0x%08x\n", fpclkdiv);
-+ //printk("#####$$$$$ : FTSSP010_CONTROL1(cardno) = 0x%08x\n", inl(FTSSP010_CONTROL1(cardno)));
-+
-+ if(is_rec)
-+ outl(inl(FTSSP010_INT_CONTROL(cardno))&(~0x0f15), FTSSP010_INT_CONTROL(cardno)); /* Disable all interrupts */
-+ else
-+ outl(inl(FTSSP010_INT_CONTROL(cardno))&(~0xf02a) , FTSSP010_INT_CONTROL(cardno)); /* Disable all interrupts */
-+
-+ outl(0xc, FTSSP010_CONTROL2(cardno)); /* clear FIFOs */
-+
-+ //ADD by river 2011.06.02
-+ alc5630 = i2c_get_clientdata(g_i2c_client);
-+ //End
-+
-+ if(is_rec) {
-+ printk("ftssp010_config() for I2S mode in record.\n");
-+ //ADD by river 2011.03.21
-+ //TEST by river 2011.03.22 for recording => workable
-+ //i2s_alc5630_write(0x0e, 0x8888, g_i2c_client);
-+ i2s_alc5630_write(0x0e, 0x0808, g_i2c_client);
-+ i2s_alc5630_write(0x10, 0xee03, g_i2c_client);
-+ i2s_alc5630_write(0x22, 0x0500, g_i2c_client);
-+ i2s_alc5630_write(0x1c, 0x0748, g_i2c_client);
-+ i2s_alc5630_write(0x14, 0x1f1f, g_i2c_client);
-+ i2s_alc5630_write(0x12, 0xdfdf, g_i2c_client);
-+
-+ i2s_alc5630_write(0x26, 0x000f, g_i2c_client);
-+ i2s_alc5630_write(0x3a, 0xffff, g_i2c_client);
-+ i2s_alc5630_write(0x3c, 0xffff, g_i2c_client);
-+ //i2s_alc5630_write(0x3e, 0xffff, g_i2c_client);
-+ i2s_alc5630_write(0x3e, 0x80cf, g_i2c_client);
-+
-+ i2s_alc5630_write(0x44, 0x3ea0, g_i2c_client);
-+ i2s_alc5630_write(0x42, 0x2000, g_i2c_client);
-+ i2s_alc5630_write(0x40, 0x8c0a, g_i2c_client);
-+
-+ //i2s_alc5630_write(0x02, 0x0000, g_i2c_client);
-+ i2s_alc5630_write(0x02, 0x8080, g_i2c_client);
-+ i2s_alc5630_write(0x04, 0x0000, g_i2c_client);
-+ //End TEST by river 2011.03.22
-+
-+ //printk("ftssp010_config() for I2S mode (Recording) ===> Dump register.\n");
-+ //i2s_alc5630_read_test(g_i2c_client);
-+
-+ }
-+ else {
-+ //printk("ftssp010_config() for I2S mode in playback.\n");
-+ //ADD by river 2011.03.24 for record and playback case
-+ i2s_alc5630_write(0x0e, 0x0808, g_i2c_client);
-+ i2s_alc5630_write(0x12, 0xcbcb, g_i2c_client);
-+ i2s_alc5630_write(0x14, 0x7f7f, g_i2c_client);
-+ i2s_alc5630_write(0x22, 0x0000, g_i2c_client);
-+ i2s_alc5630_write(0x3e, 0x8000, g_i2c_client);
-+ i2s_alc5630_write(0x40, 0x0c0a, g_i2c_client);
-+ i2s_alc5630_write(0x42, 0x0000, g_i2c_client);
-+ //End ADD by river 2011.03.24 for record and playback case
-+
-+ //TEST by river 2011.03.23
-+ i2s_alc5630_write(0x26, 0x0000, g_i2c_client);
-+ i2s_alc5630_write(0x3c, 0x2000, g_i2c_client);
-+ i2s_alc5630_write(0x3a, 0x0002, g_i2c_client);
-+ i2s_alc5630_write(0x3c, 0xa330, g_i2c_client);
-+ i2s_alc5630_write(0x3a, 0xc843, g_i2c_client);
-+ //End TEST by river 2011.03.23
-+
-+ //ADD by river 2011.03.23 for HP Out De-pop
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,g_i2c_client)|0x0002 , g_i2c_client);
-+ i2s_alc5630_write(0x04, i2s_alc5630_read(0x04, data,g_i2c_client)|0x8080 , g_i2c_client);
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,g_i2c_client)|0x0040 , g_i2c_client);
-+ i2s_alc5630_write(0x3c, i2s_alc5630_read(0x3C, data,g_i2c_client)|0x2000 , g_i2c_client);
-+ i2s_alc5630_write(0x3E, i2s_alc5630_read(0x3E, data,g_i2c_client)|0xfC00 , g_i2c_client);
-+ i2s_alc5630_write(0x5E, i2s_alc5630_read(0x5E, data,g_i2c_client)|0x0100 , g_i2c_client);
-+ mdelay(500);
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,g_i2c_client)|0x0200 , g_i2c_client);
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,g_i2c_client)|0x0100 , g_i2c_client);
-+ i2s_alc5630_write(0x5E, i2s_alc5630_read(0x5E, data,g_i2c_client)& 0xfeff ,g_i2c_client);
-+ //End ADD by river 2011.03.23 for HP Out De-pop
-+
-+
-+ //TEST by river 2011.03.22
-+ i2s_alc5630_write(0x1c, 0x0748, g_i2c_client);
-+ //End TEST by river 2011.03.22
-+
-+
-+ //TEST by river 2011.03.16
-+ //i2s_alc5630_write(0x02, 0x8080, g_i2c_client);
-+ i2s_alc5630_write(0x26, 0x000f, g_i2c_client);
-+ //End TEST by river 2011.03.16
-+
-+ //ADD by river 2011.03.23
-+ if (alc5630->gpio2_value==0x0)
-+ i2s_alc5630_write(0x3A, (i2s_alc5630_read(0x3A, data,g_i2c_client) & 0xFBFF)|0x0040 , g_i2c_client);
-+ else
-+ i2s_alc5630_write(0x3A, i2s_alc5630_read(0x3A, data,g_i2c_client)|0x0440 , g_i2c_client);
-+
-+
-+ i2s_alc5630_write(0x5E, i2s_alc5630_read(0x5E, data,g_i2c_client)|0x0020 , g_i2c_client);
-+ i2s_alc5630_write(0x5E, i2s_alc5630_read(0x5E, data,g_i2c_client)|0x00c0 , g_i2c_client);
-+ i2s_alc5630_write(0x04, i2s_alc5630_read(0x04, data,g_i2c_client)& 0x7f7f , g_i2c_client);
-+ mdelay(30);
-+
-+ if (alc5630->gpio2_value==0x0) {
-+ //printk(">>>>>>>>>>>> Turn off internal speaker.....\n");
-+ i2s_alc5630_write(0x02, 0x5F5F, g_i2c_client);
-+ //i2s_alc5630_write(0x02, 0x0000, g_i2c_client);
-+ }
-+ else {
-+ //printk(">>>>>>>>>>>> Turn on internal speaker.....\n");
-+ i2s_alc5630_write(0x02, 0x0000, g_i2c_client);
-+ //i2s_alc5630_write(0x02, 0x5F5F, g_i2c_client);
-+ }
-+ //End ADD by river 2011.03.23
-+
-+
-+ //printk("ftssp010_config() for I2S mode (Playback) ===> Dump register.\n");
-+ //i2s_alc5630_read_test(g_i2c_client);
-+ }
-+
-+#if 0
-+ /* Stuff TX fifo */
-+ while(ftssp010_tx_fifo_not_full(cardno)) {
-+ outl(0x0, FTSSP010_DATA(cardno));
-+ }
-+#endif
-+}
-+
-+void ftssp010_config_tx(int cardno, unsigned is_stereo, unsigned speed, int width)
-+{
-+ return ftssp010_config(cardno, is_stereo, speed, width, 0);
-+}
-+
-+void ftssp010_config_rx(int cardno, unsigned is_stereo, unsigned speed, int width)
-+{
-+ return ftssp010_config(cardno, is_stereo, speed, width, 1);
-+}
-+
-+/* Configures FTSSP010 to start TX. If use_dma being nonzero,
-+ * FTSSP010 will use hardware handshake for DMA */
-+void ftssp010_start_tx(int cardno, unsigned use_dma)
-+{
-+ unsigned bogus=0x800*3;
-+ if(use_dma) {
-+ /* Enable H/W DMA Request and set TX DMA threshold to 12*/
-+// outl(0xC022, FTSSP010_INT_CONTROL(cardno));
-+ outl(inl(FTSSP010_INT_CONTROL(cardno)) | 0xc422, FTSSP010_INT_CONTROL(cardno));
-+#if 0
-+ printk("%s: enable DMA request\n", __func__);
-+#endif
-+ }
-+// outl(0x3, FTSSP010_CONTROL2(cardno));
-+ outl(inl(FTSSP010_CONTROL2(cardno)) | 0x3, FTSSP010_CONTROL2(cardno));
-+// printk("%s\n",__func__);
-+// printk("int_control 0x%x\n",inl(FTSSP010_INT_CONTROL(cardno)));
-+// printk("control2 0x%x\n",inl(FTSSP010_CONTROL2(cardno)));
-+ if(!use_dma) {
-+ while(bogus>0) {
-+ while(!ftssp010_tx_fifo_not_full(cardno))
-+ udelay(50);
-+ outl(0, FTSSP010_DATA(cardno));
-+ bogus--;
-+ }
-+ }
-+}
-+
-+/* Configures FTSSP010 to start RX. If use_dma being nonzero,
-+ * FTSSP010 will use hardware handshake for DMA */
-+void ftssp010_start_rx(int cardno, unsigned use_dma)
-+{
-+ if(use_dma) {
-+ /* Enable H/W DMA Request and set RX DMA threshold to 2*/
-+// outl(0x0111, FTSSP010_INT_CONTROL(cardno));
-+ outl(inl(FTSSP010_INT_CONTROL(cardno)) | 0xc411, FTSSP010_INT_CONTROL(cardno));
-+#if 0
-+ printk("%s: enable DMA request\n", __func__);
-+#endif
-+ }
-+// outl(0x3, FTSSP010_CONTROL2(cardno));
-+ outl(inl(FTSSP010_CONTROL2(cardno)) | 0x3, FTSSP010_CONTROL2(cardno));
-+// printk("%s\n",__func__);
-+// printk("int_control 0x%x\n",inl(FTSSP010_INT_CONTROL(cardno)));
-+// printk("control2 0x%x\n",inl(FTSSP010_CONTROL2(cardno)));
-+}
-+
-+void ftssp010_stop_tx(int cardno)
-+{
-+// outl(0, FTSSP010_CONTROL2(cardno));
-+ outl(inl(FTSSP010_INT_CONTROL(cardno)) & (~0x22), FTSSP010_INT_CONTROL(cardno));
-+// printk("%s\n",__func__);
-+// printk("int_control 0x%x\n",inl(FTSSP010_INT_CONTROL(cardno)));
-+// printk("control2 0x%x\n",inl(FTSSP010_CONTROL2(cardno)));
-+}
-+
-+void ftssp010_stop_rx(int cardno)
-+{
-+ //outl(0, FTSSP010_CONTROL2(cardno));
-+ outl(inl(FTSSP010_INT_CONTROL(cardno)) & (~0x11), FTSSP010_INT_CONTROL(cardno));
-+ //printk("%s\n",__func__);
-+ //printk("int_control 0x%x\n",inl(FTSSP010_INT_CONTROL(cardno)));
-+ //printk("control2 0x%x\n",inl(FTSSP010_CONTROL2(cardno)));
-+}
-+
-diff -Nur linux-3.4.113.orig/sound/nds32/FTSSP010_UDA1345TS.h linux-3.4.113/sound/nds32/FTSSP010_UDA1345TS.h
---- linux-3.4.113.orig/sound/nds32/FTSSP010_UDA1345TS.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/FTSSP010_UDA1345TS.h 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,81 @@
-+/* FTSSP010 - UDA1345TS supporting library header */
-+/*
-+ *
-+ * $log$
-+ *
-+ */
-+#include <linux/init.h>
-+#include <linux/module.h>
-+#include <asm/io.h>
-+#include <linux/delay.h>
-+#include <asm/spec.h>
-+#include <linux/dma-mapping.h>
-+
-+/* Programming sequence:
-+ * Suppose your playback format is 44.1KHz, 16 bit stereo
-+ * PIO mode:
-+ * pmu_set_i2s_clocking(44100);
-+ * ftssp010_config(1, 44100, 0);
-+ * ftssp010_start_tx(0);
-+ * while(ftssp010_tx_fifo_not_full()) {
-+ * Poke_your_PCM_data_to_FTSSP_data_port
-+ *
-+ * DMA mode:
-+ * pmu_set_i2s_clocking(44100);
-+ * ftssp010_config(1, 44100);
-+ * <setup DMA controller, acquire DMA channel>
-+ * pmu_set_i2s_dma_channel(ch);
-+ * ftssp010_start_tx(1);
-+ * <wait DMA to complete..>
-+ * ftssp010_stop_tx();
-+ */
-+#define FTSSP010_DATA(x) (SSP_FTSSP010_va_base[(x)]+0x18)
-+#define FTSSP010_DATA_PA(x) (SSP_FTSSP010_pa_base[(x)]+0x18)
-+
-+/* Initialize FTSSP010 to output to UDA1345TS via I2S */
-+#define FTSSP010_CONTROL0(x) (SSP_FTSSP010_va_base[(x)]+0x0)
-+#define FTSSP010_CONTROL0_OPM_STEREO 0xC
-+#define FTSSP010_CONTROL0_OPM_MONO 0x8
-+
-+#define FTSSP010_CONTROL1(x) (SSP_FTSSP010_va_base[(x)]+0x4)
-+#define FTSSP010_CONTROL2(x) (SSP_FTSSP010_va_base[(x)]+0x8)
-+
-+#define FTSSP010_INT_CONTROL(x) (SSP_FTSSP010_va_base[(x)]+0x10)
-+#define FTSSP010_STATUS(x) (SSP_FTSSP010_va_base[(x)]+0xC)
-+#define FTSSP010_INT_STATUS(x) (SSP_FTSSP010_va_base[(x)]+0x14)
-+#define FTSSP010_DATA(x) (SSP_FTSSP010_va_base[(x)]+0x18)
-+#define FTSSP010_INFO(x) (SSP_FTSSP010_va_base[(x)]+0x1C)
-+
-+static const unsigned int SSP_FTSSP010_va_base[SSP_FTSSP010_IRQ_COUNT] = { SSP_FTSSP010_VA_BASE };
-+static const unsigned int SSP_FTSSP010_pa_base[SSP_FTSSP010_IRQ_COUNT] = { SSP_FTSSP010_PA_BASE };
-+
-+/* Drive PMU to generate I2S main clocking signal. Also configures PMU to set correct DMA REQ/ACK pair */
-+extern void pmu_set_i2s_clocking(unsigned int speed);
-+/* Programs PMU to set I2S/AC97 DMA Channel, ch=0-7 */
-+extern void pmu_set_i2s_dma_channel(unsigned ch);
-+
-+/* Drive PMU to generate AC97 main clocking signal. Also configures PMU to set correct DMA REQ/ACK pair */
-+extern void pmu_set_ac97_clocking(unsigned int speed);
-+
-+/* Returns FTSSP010 status */
-+extern void ftssp010_set_int_control(int cardno, unsigned val);
-+extern int ftssp010_get_status(int cardno);
-+extern unsigned ftssp010_get_int_status(int cardno);
-+/* Polls FIFO full register */
-+extern int ftssp010_tx_fifo_not_full(int cardno);
-+/* Configure FTSSP010 to a given sampling rate and channel number */
-+extern void ftssp010_config_tx(int cardno, unsigned is_stereo, unsigned speed, int use8bit);
-+extern void ftssp010_config_rx(int cardno, unsigned is_stereo, unsigned speed, int use8bit);
-+
-+/* Configure FTSSP010 to a given sampling rate and channel number */
-+extern void ftssp010_config_ac97_play(int cardno, unsigned is_stereo, unsigned speed, int use8bit);
-+
-+extern void ftssp010_config_ac97_rec(int cardno, unsigned is_stereo, unsigned speed, int use8bit);
-+
-+/* Initialize FTSSP010 to output to UDA1345TS via I2S */
-+extern void ftssp010_start_tx(int cardno, unsigned use_dma);
-+extern void ftssp010_start_rx(int cardno, unsigned use_dma);
-+extern void ftssp010_stop_tx(int cardno);
-+extern void ftssp010_stop_rx(int cardno);
-+
-+
-diff -Nur linux-3.4.113.orig/sound/nds32/FTSSP010_W83972D.h linux-3.4.113/sound/nds32/FTSSP010_W83972D.h
---- linux-3.4.113.orig/sound/nds32/FTSSP010_W83972D.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/FTSSP010_W83972D.h 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,17 @@
-+/* AC97 Codec related */
-+
-+
-+/* Register Index for Winbond W83972D AC97 Codec */
-+#define W83972D_RESET 0x0
-+#define W83972D_STEREO_OUTPUT_CONTROL 0x2
-+#define W83972D_MIC_VOLUME 0xE
-+#define W83972D_LINE_IN_VOLUME 0x10
-+#define W83972D_AUX_INPUT_CONTROL 0x16
-+#define W83972D_PCM_OUTPUT_CONTROL 0x18
-+#define W83972D_RECORD_SELECT 0x1A
-+#define W83972D_RECORD_GAIN 0x1C
-+#define W83972D_RECORD_GAIN_MIC 0x1E
-+#define W83972D_EXT_AUDIO_CONTROL 0x2A
-+#define W83972D_DAC_SAMPLE_RATE_CONTROL 0x2C
-+#define W83972D_VER1 0x7C
-+#define W83972D_VER2 0x7E
-diff -Nur linux-3.4.113.orig/sound/nds32/hda.h linux-3.4.113/sound/nds32/hda.h
---- linux-3.4.113.orig/sound/nds32/hda.h 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/hda.h 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,106 @@
-+// HDA Mode definition
-+ #define HDA_MODE 0x80000000
-+
-+ // HDA CTRL definition
-+ #define HDA_CRST_SET 0x00
-+ #define HDA_CRST_CLR 0x20
-+ #define HDA_CRST_MASK 0x20
-+ #define HDA_RST_FCNT_OFS 8
-+
-+ // HDA LNKST definition
-+ #define HDA_COD_ALIVE 0x20000000
-+
-+ // HDA INTC definition
-+ #define HDA_INTC_USOLEN 0x40000
-+ #define HDA_INTC_SDIWEN 0x20000
-+ #define HDA_INTC_CRINTE 0x10000
-+
-+ // HDA INTST definition
-+ #define HDA_INTST_USOLEN 0x80
-+ #define HDA_INTST_SDIWEN 0x40
-+ #define HDA_INTST_CRINTE 0x20
-+
-+ // HDA ICMDST mask & offset
-+ #define HDA_IRRADD_MASK 0xf0
-+ #define HDA_IRRUNSOL_MASK 0x08
-+ #define HDA_IRV_MASK 0x02
-+ #define HDA_ICB_MASK 0x01
-+ #define HDA_IRRADD_OFFSET 4
-+ #define HDA_IRRUNSOL_OFFSET 3
-+ #define HDA_IRV_OFFSET 1
-+ #define HDA_ICB_OFFSET 0
-+ //HDA OSDC/ISDC bit offset
-+ #define HDA_SDC_STNUM_OFFSET 28
-+ #define HDA_SDC_SRUN_OFFSET 15
-+ #define HDA_SDC_BASE_OFFSET 14
-+ #define HDA_SDC_MULT_OFFSET 11
-+ #define HDA_SDC_DIV_OFFSET 8
-+ #define HDA_SDC_BITS_OFFSET 4
-+ #define HDA_SDC_CHAN_OFFSET 0
-+
-+ // HDA Codec CMD
-+ #define HDA_COD_DEVADDR 0x00000000
-+ #define HDA_ROOT_NODE 0x00000000
-+ #define HDA_AUDIO_NODE 0x00100000
-+ #define HDA_OUTCOV_NODE 0x00200000
-+ //#define HDA_INCOV_NODE 0x0FF00000
-+ #define HDA_INCOV_NODE 0x00800000 //kane, for real CODEC node mapping
-+ #define HDA_CMD_FGRST 0x0007FF00
-+ #define HDA_CMD_GETVID 0x000F0000
-+ #define HDA_CMD_SUBNCNT 0x000F0004
-+ #define HDA_CMD_FGTYPE 0x000F0005
-+ #define HDA_CMD_AUDIOWCAP 0x000F0009
-+ #define HDA_CMD_SETCVTSTR 0x00070600
-+ #define HDA_CMD_GETCVTSTR 0x000F0600
-+ #define HDA_CMD_SETCVTFMT 0x00020000
-+ #define HDA_CMD_GETCVTFMT 0x000A0000
-+ #define HDA_CMD_SETPROCST 0x00070300
-+ #define HDA_CMD_TRIGUNSOL 0x00070400
-+ //HDA Codec Resp
-+ #define HDA_RESP_ZERO_VAL 0x00000000
-+ #define HDA_RESP_EXP_VID 0x10ec0888
-+ #define HDA_RSP_NODNUM_MSK 0xff0000
-+ #define HDA_RSP_NODCNT_MSK 0x0000ff
-+ #define HDA_RSP_NODNUM_OFS 16
-+ #define HDA_RSP_NODCNT_OFS 0
-+ #define HDA_RSP_FGNTYPE_MSK 0xff
-+ #define HDA_RSP_FGNUSCAP_MSK 0x100
-+ #define HDA_RSP_FGNTYPE_OFS 0
-+ #define HDA_RSP_FGNUSCAP_OFS 8
-+ #define HDA_RSP_AWCTYPE_MSK 0xf00000
-+ #define HDA_RSP_AWCUSCAP_MSK 0x000080
-+ #define HDA_RSP_AWCSTE_MSK 0x000001
-+ #define HDA_RSP_AWCTYPE_OFS 20
-+ #define HDA_RSP_AWCUSCAP_OFS 7
-+ #define HDA_RSP_AWCSTE_OFS 0
-+ #define HDA_RSP_CVTCHA_MSK 0x00
-+ #define HDA_RSP_CVTSTR_MSK 0xf0
-+ #define HDA_RSP_FMTTYPE_MSK 0x8000
-+ #define HDA_RSP_FMTBASE_MSK 0x4000
-+ #define HDA_RSP_FMTMULT_MSK 0x3800
-+ #define HDA_RSP_FMTDIV_MSK 0x0700
-+ #define HDA_RSP_FMTBITS_MSK 0x0070
-+ #define HDA_RSP_FMTCHNUM_MSK 0x000f
-+ //HDA Func Group definition
-+ #define HDA_FG_AUDIO 0x1
-+ // HDA Audio Widiget definition
-+ #define HDA_AWC_INPUT 0x1
-+ #define HDA_AWC_OUTPUT 0x0
-+ #define HDA_AWC_MONO 0x0
-+ #define HDA_AWC_STEREO 0x1
-+ // HDA Converter Format definition
-+ #define HDA_FMT_TYPE_OFS 15
-+ #define HDA_FMT_BASE_OFS 14
-+ #define HDA_FMT_MULT_OFS 11
-+ #define HDA_FMT_DIV_OFS 8
-+ #define HDA_FMT_BITS_OFS 4
-+ #define HDA_FMT_CHNUM_OFS 0
-+ // HDA Coverter Stream definition
-+ #define HDA_STR_STR_OFS 4
-+ #define HDA_STR_CHA_OFS 0
-+ // HDA IOSDC definition
-+ #define HDA_IN_STR 0
-+ #define HDA_OUT_STR 1
-+ #define HDA_STR_STOP 0
-+ #define HDA_STR_RUN 1
-+
-diff -Nur linux-3.4.113.orig/sound/nds32/Kconfig linux-3.4.113/sound/nds32/Kconfig
---- linux-3.4.113.orig/sound/nds32/Kconfig 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/Kconfig 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,22 @@
-+menu "ALSA NDS32 devices"
-+ depends on SND!=n && NDS32
-+
-+config SND_FTSSP010
-+ tristate "Faraday FTSSP010 audio Driver"
-+ depends on SND && NDS32
-+ select SND_PCM
-+# select SND_AC97_CODEC
-+
-+choice
-+ prompt "AC97/I2S/HDA selection"
-+ depends on SND_FTSSP010
-+ default SND_FTSSP010_AC97
-+config SND_FTSSP010_AC97
-+ bool "AC97"
-+config SND_FTSSP010_I2S
-+ bool "I2S"
-+config SND_FTSSP010_HDA
-+ bool "HDA"
-+endchoice
-+endmenu
-+
-diff -Nur linux-3.4.113.orig/sound/nds32/Makefile linux-3.4.113/sound/nds32/Makefile
---- linux-3.4.113.orig/sound/nds32/Makefile 1970-01-01 01:00:00.000000000 +0100
-+++ linux-3.4.113/sound/nds32/Makefile 2016-12-01 20:59:24.396614447 +0100
-@@ -0,0 +1,10 @@
-+ifeq ($(CONFIG_SND_FTSSP010_AC97),y)
-+snd-ftssp010-objs := FTSSP010_ALSA.o FTSSP010_lib.o
-+endif
-+ifeq ($(CONFIG_SND_FTSSP010_I2S),y)
-+snd-ftssp010-objs := FTSSP010_ALSA.o FTSSP010_lib.o
-+endif
-+ifeq ($(CONFIG_SND_FTSSP010_HDA),y)
-+snd-ftssp010-objs := FTSSP010_HDA.o FTSSP010_HDA_lib.o
-+endif
-+obj-$(CONFIG_SND_FTSSP010) += snd-ftssp010.o
-diff -Nur linux-3.4.113.orig/arch/nds32/include/asm/sigcontext.h linux-3.4.113/arch/nds32/include/asm/sigcontext.h
---- linux-3.4.113.orig/arch/nds32/include/asm/sigcontext.h 2016-12-04 19:56:12.061027027 +0100
-+++ linux-3.4.113/arch/nds32/include/asm/sigcontext.h 2016-12-04 19:56:45.122305938 +0100
-@@ -59,7 +59,7 @@
- unsigned long nds32_r25;
- unsigned long nds32_fp; /* $r28 */
- unsigned long nds32_gp; /* $r29 */
-- unsigned long nds32_lr; /* $r30 */
-+ unsigned long nds32_lp; /* $r30 */
- unsigned long nds32_sp; /* $r31 */
- unsigned long nds32_ipc;
- unsigned long fault_address;