Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/geert/linux...
authorLinus Torvalds <torvalds@linux-foundation.org>
Thu, 17 Mar 2011 02:08:03 +0000 (19:08 -0700)
committerLinus Torvalds <torvalds@linux-foundation.org>
Thu, 17 Mar 2011 02:08:03 +0000 (19:08 -0700)
* 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/geert/linux-m68k:
  m68k/block: amiflop - Remove superfluous amiga_chip_alloc() cast
  m68k/atari: ARAnyM - Add support for network access
  m68k/atari: ARAnyM - Add support for console access
  m68k/atari: ARAnyM - Add support for block access
  m68k/atari: Initial ARAnyM support
  m68k: Kconfig - Remove unneeded "default n"
  m68k: Makefiles - Change to new flags variables
  m68k/amiga: Reclaim Chip RAM for PPC exception handlers
  m68k: Allow all kernel traps to be handled via exception fixups
  m68k: Use base_trap_init() to initialize vectors
  m68k: Add helper function handle_kernel_fault()

16 files changed:
arch/m68k/Kconfig
arch/m68k/Makefile
arch/m68k/amiga/chipram.c
arch/m68k/emu/Makefile [new file with mode: 0644]
arch/m68k/emu/natfeat.c [new file with mode: 0644]
arch/m68k/emu/nfblock.c [new file with mode: 0644]
arch/m68k/emu/nfcon.c [new file with mode: 0644]
arch/m68k/emu/nfeth.c [new file with mode: 0644]
arch/m68k/include/asm/natfeat.h [new file with mode: 0644]
arch/m68k/include/asm/processor.h
arch/m68k/kernel/setup.c
arch/m68k/kernel/signal.c
arch/m68k/kernel/traps.c
arch/m68k/math-emu/Makefile
arch/m68k/mm/fault.c
drivers/block/amiflop.c

index a85e251c411f4ac3bd43d68867dc56ec2e30592a..525174d4167953cd7b14a770f2fc6ba0fbd3775a 100644 (file)
@@ -18,11 +18,9 @@ config RWSEM_XCHGADD_ALGORITHM
 
 config ARCH_HAS_ILOG2_U32
        bool
-       default n
 
 config ARCH_HAS_ILOG2_U64
        bool
-       default n
 
 config GENERIC_HWEIGHT
        bool
@@ -242,6 +240,37 @@ config SUN3
 
          If you don't want to compile a kernel exclusively for a Sun 3, say N.
 
+config NATFEAT
+       bool "ARAnyM emulator support"
+       depends on ATARI
+       help
+         This option enables support for ARAnyM native features, such as
+         access to a disk image as /dev/hda.
+
+config NFBLOCK
+       tristate "NatFeat block device support"
+       depends on BLOCK && NATFEAT
+       help
+         Say Y to include support for the ARAnyM NatFeat block device
+         which allows direct access to the hard drives without using
+         the hardware emulation.
+
+config NFCON
+       tristate "NatFeat console driver"
+       depends on NATFEAT
+       help
+         Say Y to include support for the ARAnyM NatFeat console driver
+         which allows the console output to be redirected to the stderr
+         output of ARAnyM.
+
+config NFETH
+       tristate "NatFeat Ethernet support"
+       depends on NET_ETHERNET && NATFEAT
+       help
+         Say Y to include support for the ARAnyM NatFeat network device
+         which will emulate a regular ethernet device while presenting an
+         ethertap device to the host system.
+
 comment "Processor type"
 
 config M68020
index b06a7e3cbcd6491de55c409e9516a1d68d6ed527..b793163abc610212618f38a2c1680d6048b41322 100644 (file)
@@ -76,6 +76,7 @@ core-$(CONFIG_MVME16x)                += arch/m68k/mvme16x/
 core-$(CONFIG_BVME6000)                += arch/m68k/bvme6000/
 core-$(CONFIG_SUN3X)           += arch/m68k/sun3x/     arch/m68k/sun3/
 core-$(CONFIG_SUN3)            += arch/m68k/sun3/      arch/m68k/sun3/prom/
+core-$(CONFIG_NATFEAT)         += arch/m68k/emu/
 core-$(CONFIG_M68040)          += arch/m68k/fpsp040/
 core-$(CONFIG_M68060)          += arch/m68k/ifpsp060/
 core-$(CONFIG_M68KFPU_EMU)     += arch/m68k/math-emu/
index 61df1d33c0500c514cb520cb3cbef58f5f3622d9..dd0447db1c90517b33d855a614b28b3cfc2d2d44 100644 (file)
@@ -33,10 +33,6 @@ void __init amiga_chip_init(void)
     if (!AMIGAHW_PRESENT(CHIP_RAM))
        return;
 
-    /*
-     *  Remove the first 4 pages where PPC exception handlers will be located
-     */
-    amiga_chip_size -= 0x4000;
     chipram_res.end = amiga_chip_size-1;
     request_resource(&iomem_resource, &chipram_res);
 
diff --git a/arch/m68k/emu/Makefile b/arch/m68k/emu/Makefile
new file mode 100644 (file)
index 0000000..7dc2010
--- /dev/null
@@ -0,0 +1,9 @@
+#
+# Makefile for Linux arch/m68k/emu source directory
+#
+
+obj-y                  += natfeat.o
+
+obj-$(CONFIG_NFBLOCK)  += nfblock.o
+obj-$(CONFIG_NFCON)    += nfcon.o
+obj-$(CONFIG_NFETH)    += nfeth.o
diff --git a/arch/m68k/emu/natfeat.c b/arch/m68k/emu/natfeat.c
new file mode 100644 (file)
index 0000000..2291a7d
--- /dev/null
@@ -0,0 +1,78 @@
+/*
+ * natfeat.c - ARAnyM hardware support via Native Features (natfeats)
+ *
+ * Copyright (c) 2005 Petr Stehlik of ARAnyM dev team
+ *
+ * Reworked for Linux by Roman Zippel <zippel@linux-m68k.org>
+ *
+ * This software may be used and distributed according to the terms of
+ * the GNU General Public License (GPL), incorporated herein by reference.
+ */
+
+#include <linux/types.h>
+#include <linux/console.h>
+#include <linux/string.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/io.h>
+#include <asm/machdep.h>
+#include <asm/natfeat.h>
+
+asm("\n"
+"      .global nf_get_id,nf_call\n"
+"nf_get_id:\n"
+"      .short  0x7300\n"
+"      rts\n"
+"nf_call:\n"
+"      .short  0x7301\n"
+"      rts\n"
+"1:    moveq.l #0,%d0\n"
+"      rts\n"
+"      .section __ex_table,\"a\"\n"
+"      .long   nf_get_id,1b\n"
+"      .long   nf_call,1b\n"
+"      .previous");
+EXPORT_SYMBOL_GPL(nf_get_id);
+EXPORT_SYMBOL_GPL(nf_call);
+
+void nfprint(const char *fmt, ...)
+{
+       static char buf[256];
+       va_list ap;
+       int n;
+
+       va_start(ap, fmt);
+       n = vsnprintf(buf, 256, fmt, ap);
+       nf_call(nf_get_id("NF_STDERR"), buf);
+       va_end(ap);
+}
+
+static void nf_poweroff(void)
+{
+       long id = nf_get_id("NF_SHUTDOWN");
+
+       if (id)
+               nf_call(id);
+}
+
+void nf_init(void)
+{
+       unsigned long id, version;
+       char buf[256];
+
+       id = nf_get_id("NF_VERSION");
+       if (!id)
+               return;
+       version = nf_call(id);
+
+       id = nf_get_id("NF_NAME");
+       if (!id)
+               return;
+       nf_call(id, buf, 256);
+       buf[255] = 0;
+
+       pr_info("NatFeats found (%s, %lu.%lu)\n", buf, version >> 16,
+               version & 0xffff);
+
+       mach_power_off = nf_poweroff;
+}
diff --git a/arch/m68k/emu/nfblock.c b/arch/m68k/emu/nfblock.c
new file mode 100644 (file)
index 0000000..48e50f8
--- /dev/null
@@ -0,0 +1,195 @@
+/*
+ * ARAnyM block device driver
+ *
+ * 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/moduleparam.h>
+#include <linux/init.h>
+
+#include <linux/kernel.h>
+#include <linux/errno.h>
+#include <linux/types.h>
+#include <linux/genhd.h>
+#include <linux/blkdev.h>
+#include <linux/hdreg.h>
+#include <linux/slab.h>
+
+#include <asm/natfeat.h>
+
+static long nfhd_id;
+
+enum {
+       /* emulation entry points */
+       NFHD_READ_WRITE = 10,
+       NFHD_GET_CAPACITY = 14,
+
+       /* skip ACSI devices */
+       NFHD_DEV_OFFSET = 8,
+};
+
+static inline s32 nfhd_read_write(u32 major, u32 minor, u32 rwflag, u32 recno,
+                                 u32 count, u32 buf)
+{
+       return nf_call(nfhd_id + NFHD_READ_WRITE, major, minor, rwflag, recno,
+                      count, buf);
+}
+
+static inline s32 nfhd_get_capacity(u32 major, u32 minor, u32 *blocks,
+                                   u32 *blocksize)
+{
+       return nf_call(nfhd_id + NFHD_GET_CAPACITY, major, minor, blocks,
+                      blocksize);
+}
+
+static LIST_HEAD(nfhd_list);
+
+static int major_num;
+module_param(major_num, int, 0);
+
+struct nfhd_device {
+       struct list_head list;
+       int id;
+       u32 blocks, bsize;
+       int bshift;
+       struct request_queue *queue;
+       struct gendisk *disk;
+};
+
+static int nfhd_make_request(struct request_queue *queue, struct bio *bio)
+{
+       struct nfhd_device *dev = queue->queuedata;
+       struct bio_vec *bvec;
+       int i, dir, len, shift;
+       sector_t sec = bio->bi_sector;
+
+       dir = bio_data_dir(bio);
+       shift = dev->bshift;
+       bio_for_each_segment(bvec, bio, i) {
+               len = bvec->bv_len;
+               len >>= 9;
+               nfhd_read_write(dev->id, 0, dir, sec >> shift, len >> shift,
+                               bvec_to_phys(bvec));
+               sec += len;
+       }
+       bio_endio(bio, 0);
+       return 0;
+}
+
+static int nfhd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
+{
+       struct nfhd_device *dev = bdev->bd_disk->private_data;
+
+       geo->cylinders = dev->blocks >> (6 - dev->bshift);
+       geo->heads = 4;
+       geo->sectors = 16;
+
+       return 0;
+}
+
+static const struct block_device_operations nfhd_ops = {
+       .owner  = THIS_MODULE,
+       .getgeo = nfhd_getgeo,
+};
+
+static int __init nfhd_init_one(int id, u32 blocks, u32 bsize)
+{
+       struct nfhd_device *dev;
+       int dev_id = id - NFHD_DEV_OFFSET;
+
+       pr_info("nfhd%u: found device with %u blocks (%u bytes)\n", dev_id,
+               blocks, bsize);
+
+       if (bsize < 512 || (bsize & (bsize - 1))) {
+               pr_warn("nfhd%u: invalid block size\n", dev_id);
+               return -EINVAL;
+       }
+
+       dev = kmalloc(sizeof(struct nfhd_device), GFP_KERNEL);
+       if (!dev)
+               goto out;
+
+       dev->id = id;
+       dev->blocks = blocks;
+       dev->bsize = bsize;
+       dev->bshift = ffs(bsize) - 10;
+
+       dev->queue = blk_alloc_queue(GFP_KERNEL);
+       if (dev->queue == NULL)
+               goto free_dev;
+
+       dev->queue->queuedata = dev;
+       blk_queue_make_request(dev->queue, nfhd_make_request);
+       blk_queue_logical_block_size(dev->queue, bsize);
+
+       dev->disk = alloc_disk(16);
+       if (!dev->disk)
+               goto free_queue;
+
+       dev->disk->major = major_num;
+       dev->disk->first_minor = dev_id * 16;
+       dev->disk->fops = &nfhd_ops;
+       dev->disk->private_data = dev;
+       sprintf(dev->disk->disk_name, "nfhd%u", dev_id);
+       set_capacity(dev->disk, (sector_t)blocks * (bsize / 512));
+       dev->disk->queue = dev->queue;
+
+       add_disk(dev->disk);
+
+       list_add_tail(&dev->list, &nfhd_list);
+
+       return 0;
+
+free_queue:
+       blk_cleanup_queue(dev->queue);
+free_dev:
+       kfree(dev);
+out:
+       return -ENOMEM;
+}
+
+static int __init nfhd_init(void)
+{
+       u32 blocks, bsize;
+       int i;
+
+       nfhd_id = nf_get_id("XHDI");
+       if (!nfhd_id)
+               return -ENODEV;
+
+       major_num = register_blkdev(major_num, "nfhd");
+       if (major_num <= 0) {
+               pr_warn("nfhd: unable to get major number\n");
+               return major_num;
+       }
+
+       for (i = NFHD_DEV_OFFSET; i < 24; i++) {
+               if (nfhd_get_capacity(i, 0, &blocks, &bsize))
+                       continue;
+               nfhd_init_one(i, blocks, bsize);
+       }
+
+       return 0;
+}
+
+static void __exit nfhd_exit(void)
+{
+       struct nfhd_device *dev, *next;
+
+       list_for_each_entry_safe(dev, next, &nfhd_list, list) {
+               list_del(&dev->list);
+               del_gendisk(dev->disk);
+               put_disk(dev->disk);
+               blk_cleanup_queue(dev->queue);
+               kfree(dev);
+       }
+       unregister_blkdev(major_num, "nfhd");
+}
+
+module_init(nfhd_init);
+module_exit(nfhd_exit);
+
+MODULE_LICENSE("GPL");
diff --git a/arch/m68k/emu/nfcon.c b/arch/m68k/emu/nfcon.c
new file mode 100644 (file)
index 0000000..ab20dc0
--- /dev/null
@@ -0,0 +1,162 @@
+/*
+ * ARAnyM console driver
+ *
+ * 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/init.h>
+#include <linux/console.h>
+#include <linux/tty.h>
+#include <linux/tty_driver.h>
+#include <linux/tty_flip.h>
+#include <linux/slab.h>
+#include <linux/err.h>
+#include <linux/uaccess.h>
+
+#include <asm/natfeat.h>
+
+static int stderr_id;
+static struct tty_driver *nfcon_tty_driver;
+
+static void nfputs(const char *str, unsigned int count)
+{
+       char buf[68];
+
+       buf[64] = 0;
+       while (count > 64) {
+               memcpy(buf, str, 64);
+               nf_call(stderr_id, buf);
+               str += 64;
+               count -= 64;
+       }
+       memcpy(buf, str, count);
+       buf[count] = 0;
+       nf_call(stderr_id, buf);
+}
+
+static void nfcon_write(struct console *con, const char *str,
+                       unsigned int count)
+{
+       nfputs(str, count);
+}
+
+static struct tty_driver *nfcon_device(struct console *con, int *index)
+{
+       *index = 0;
+       return (con->flags & CON_ENABLED) ? nfcon_tty_driver : NULL;
+}
+
+static struct console nf_console = {
+       .name   = "nfcon",
+       .write  = nfcon_write,
+       .device = nfcon_device,
+       .flags  = CON_PRINTBUFFER,
+       .index  = -1,
+};
+
+
+static int nfcon_tty_open(struct tty_struct *tty, struct file *filp)
+{
+       return 0;
+}
+
+static void nfcon_tty_close(struct tty_struct *tty, struct file *filp)
+{
+}
+
+static int nfcon_tty_write(struct tty_struct *tty, const unsigned char *buf,
+                          int count)
+{
+       nfputs(buf, count);
+       return count;
+}
+
+static int nfcon_tty_put_char(struct tty_struct *tty, unsigned char ch)
+{
+       char temp[2] = { ch, 0 };
+
+       nf_call(stderr_id, temp);
+       return 1;
+}
+
+static int nfcon_tty_write_room(struct tty_struct *tty)
+{
+       return 64;
+}
+
+static const struct tty_operations nfcon_tty_ops = {
+       .open           = nfcon_tty_open,
+       .close          = nfcon_tty_close,
+       .write          = nfcon_tty_write,
+       .put_char       = nfcon_tty_put_char,
+       .write_room     = nfcon_tty_write_room,
+};
+
+#ifndef MODULE
+
+static int __init nf_debug_setup(char *arg)
+{
+       if (strcmp(arg, "nfcon"))
+               return 0;
+
+       stderr_id = nf_get_id("NF_STDERR");
+       if (stderr_id) {
+               nf_console.flags |= CON_ENABLED;
+               register_console(&nf_console);
+       }
+
+       return 0;
+}
+
+early_param("debug", nf_debug_setup);
+
+#endif /* !MODULE */
+
+static int __init nfcon_init(void)
+{
+       int res;
+
+       stderr_id = nf_get_id("NF_STDERR");
+       if (!stderr_id)
+               return -ENODEV;
+
+       nfcon_tty_driver = alloc_tty_driver(1);
+       if (!nfcon_tty_driver)
+               return -ENOMEM;
+
+       nfcon_tty_driver->owner = THIS_MODULE;
+       nfcon_tty_driver->driver_name = "nfcon";
+       nfcon_tty_driver->name = "nfcon";
+       nfcon_tty_driver->type = TTY_DRIVER_TYPE_SYSTEM;
+       nfcon_tty_driver->subtype = SYSTEM_TYPE_TTY;
+       nfcon_tty_driver->init_termios = tty_std_termios;
+       nfcon_tty_driver->flags = TTY_DRIVER_REAL_RAW;
+
+       tty_set_operations(nfcon_tty_driver, &nfcon_tty_ops);
+       res = tty_register_driver(nfcon_tty_driver);
+       if (res) {
+               pr_err("failed to register nfcon tty driver\n");
+               put_tty_driver(nfcon_tty_driver);
+               return res;
+       }
+
+       if (!(nf_console.flags & CON_ENABLED))
+               register_console(&nf_console);
+
+       return 0;
+}
+
+static void __exit nfcon_exit(void)
+{
+       unregister_console(&nf_console);
+       tty_unregister_driver(nfcon_tty_driver);
+       put_tty_driver(nfcon_tty_driver);
+}
+
+module_init(nfcon_init);
+module_exit(nfcon_exit);
+
+MODULE_LICENSE("GPL");
diff --git a/arch/m68k/emu/nfeth.c b/arch/m68k/emu/nfeth.c
new file mode 100644 (file)
index 0000000..8b6e201
--- /dev/null
@@ -0,0 +1,270 @@
+/*
+ * atari_nfeth.c - ARAnyM ethernet card driver for GNU/Linux
+ *
+ * Copyright (c) 2005 Milan Jurik, Petr Stehlik of ARAnyM dev team
+ *
+ * Based on ARAnyM driver for FreeMiNT written by Standa Opichal
+ *
+ * This software may be used and distributed according to the terms of
+ * the GNU General Public License (GPL), incorporated herein by reference.
+ */
+
+#define DRV_VERSION    "0.3"
+#define DRV_RELDATE    "10/12/2005"
+
+#define pr_fmt(fmt)    KBUILD_MODNAME ": " fmt
+
+#include <linux/netdevice.h>
+#include <linux/etherdevice.h>
+#include <linux/module.h>
+#include <asm/natfeat.h>
+#include <asm/virtconvert.h>
+
+enum {
+       GET_VERSION = 0,/* no parameters, return NFAPI_VERSION in d0 */
+       XIF_INTLEVEL,   /* no parameters, return Interrupt Level in d0 */
+       XIF_IRQ,        /* acknowledge interrupt from host */
+       XIF_START,      /* (ethX), called on 'ifup', start receiver thread */
+       XIF_STOP,       /* (ethX), called on 'ifdown', stop the thread */
+       XIF_READLENGTH, /* (ethX), return size of network data block to read */
+       XIF_READBLOCK,  /* (ethX, buffer, size), read block of network data */
+       XIF_WRITEBLOCK, /* (ethX, buffer, size), write block of network data */
+       XIF_GET_MAC,    /* (ethX, buffer, size), return MAC HW addr in buffer */
+       XIF_GET_IPHOST, /* (ethX, buffer, size), return IP address of host */
+       XIF_GET_IPATARI,/* (ethX, buffer, size), return IP address of atari */
+       XIF_GET_NETMASK /* (ethX, buffer, size), return IP netmask */
+};
+
+#define MAX_UNIT       8
+
+/* These identify the driver base version and may not be removed. */
+static const char version[] __devinitdata =
+       KERN_INFO KBUILD_MODNAME ".c:v" DRV_VERSION " " DRV_RELDATE
+       " S.Opichal, M.Jurik, P.Stehlik\n"
+       KERN_INFO " http://aranym.org/\n";
+
+MODULE_AUTHOR("Milan Jurik");
+MODULE_DESCRIPTION("Atari NFeth driver");
+MODULE_LICENSE("GPL");
+/*
+MODULE_PARM(nfeth_debug, "i");
+MODULE_PARM_DESC(nfeth_debug, "nfeth_debug level (1-2)");
+*/
+
+
+static long nfEtherID;
+static int nfEtherIRQ;
+
+struct nfeth_private {
+       int ethX;
+};
+
+static struct net_device *nfeth_dev[MAX_UNIT];
+
+static int nfeth_open(struct net_device *dev)
+{
+       struct nfeth_private *priv = netdev_priv(dev);
+       int res;
+
+       res = nf_call(nfEtherID + XIF_START, priv->ethX);
+       netdev_dbg(dev, "%s: %d\n", __func__, res);
+
+       /* Ready for data */
+       netif_start_queue(dev);
+
+       return 0;
+}
+
+static int nfeth_stop(struct net_device *dev)
+{
+       struct nfeth_private *priv = netdev_priv(dev);
+
+       /* No more data */
+       netif_stop_queue(dev);
+
+       nf_call(nfEtherID + XIF_STOP, priv->ethX);
+
+       return 0;
+}
+
+/*
+ * Read a packet out of the adapter and pass it to the upper layers
+ */
+static inline void recv_packet(struct net_device *dev)
+{
+       struct nfeth_private *priv = netdev_priv(dev);
+       unsigned short pktlen;
+       struct sk_buff *skb;
+
+       /* read packet length (excluding 32 bit crc) */
+       pktlen = nf_call(nfEtherID + XIF_READLENGTH, priv->ethX);
+
+       netdev_dbg(dev, "%s: %u\n", __func__, pktlen);
+
+       if (!pktlen) {
+               netdev_dbg(dev, "%s: pktlen == 0\n", __func__);
+               dev->stats.rx_errors++;
+               return;
+       }
+
+       skb = dev_alloc_skb(pktlen + 2);
+       if (!skb) {
+               netdev_dbg(dev, "%s: out of mem (buf_alloc failed)\n",
+                          __func__);
+               dev->stats.rx_dropped++;
+               return;
+       }
+
+       skb->dev = dev;
+       skb_reserve(skb, 2);            /* 16 Byte align  */
+       skb_put(skb, pktlen);           /* make room */
+       nf_call(nfEtherID + XIF_READBLOCK, priv->ethX, virt_to_phys(skb->data),
+               pktlen);
+
+       skb->protocol = eth_type_trans(skb, dev);
+       netif_rx(skb);
+       dev->last_rx = jiffies;
+       dev->stats.rx_packets++;
+       dev->stats.rx_bytes += pktlen;
+
+       /* and enqueue packet */
+       return;
+}
+
+static irqreturn_t nfeth_interrupt(int irq, void *dev_id)
+{
+       int i, m, mask;
+
+       mask = nf_call(nfEtherID + XIF_IRQ, 0);
+       for (i = 0, m = 1; i < MAX_UNIT; m <<= 1, i++) {
+               if (mask & m && nfeth_dev[i]) {
+                       recv_packet(nfeth_dev[i]);
+                       nf_call(nfEtherID + XIF_IRQ, m);
+               }
+       }
+       return IRQ_HANDLED;
+}
+
+static int nfeth_xmit(struct sk_buff *skb, struct net_device *dev)
+{
+       unsigned int len;
+       char *data, shortpkt[ETH_ZLEN];
+       struct nfeth_private *priv = netdev_priv(dev);
+
+       data = skb->data;
+       len = skb->len;
+       if (len < ETH_ZLEN) {
+               memset(shortpkt, 0, ETH_ZLEN);
+               memcpy(shortpkt, data, len);
+               data = shortpkt;
+               len = ETH_ZLEN;
+       }
+
+       netdev_dbg(dev, "%s: send %u bytes\n", __func__, len);
+       nf_call(nfEtherID + XIF_WRITEBLOCK, priv->ethX, virt_to_phys(data),
+               len);
+
+       dev->stats.tx_packets++;
+       dev->stats.tx_bytes += len;
+
+       dev_kfree_skb(skb);
+       return 0;
+}
+
+static void nfeth_tx_timeout(struct net_device *dev)
+{
+       dev->stats.tx_errors++;
+       netif_wake_queue(dev);
+}
+
+static const struct net_device_ops nfeth_netdev_ops = {
+       .ndo_open               = nfeth_open,
+       .ndo_stop               = nfeth_stop,
+       .ndo_start_xmit         = nfeth_xmit,
+       .ndo_tx_timeout         = nfeth_tx_timeout,
+       .ndo_validate_addr      = eth_validate_addr,
+       .ndo_change_mtu         = eth_change_mtu,
+       .ndo_set_mac_address    = eth_mac_addr,
+};
+
+static struct net_device * __init nfeth_probe(int unit)
+{
+       struct net_device *dev;
+       struct nfeth_private *priv;
+       char mac[ETH_ALEN], host_ip[32], local_ip[32];
+       int err;
+
+       if (!nf_call(nfEtherID + XIF_GET_MAC, unit, mac, ETH_ALEN))
+               return NULL;
+
+       dev = alloc_etherdev(sizeof(struct nfeth_private));
+       if (!dev)
+               return NULL;
+
+       dev->irq = nfEtherIRQ;
+       dev->netdev_ops = &nfeth_netdev_ops;
+
+       dev->flags |= NETIF_F_NO_CSUM;
+       memcpy(dev->dev_addr, mac, ETH_ALEN);
+
+       priv = netdev_priv(dev);
+       priv->ethX = unit;
+
+       err = register_netdev(dev);
+       if (err) {
+               free_netdev(dev);
+               return NULL;
+       }
+
+       nf_call(nfEtherID + XIF_GET_IPHOST, unit,
+               host_ip, sizeof(host_ip));
+       nf_call(nfEtherID + XIF_GET_IPATARI, unit,
+               local_ip, sizeof(local_ip));
+
+       netdev_info(dev, KBUILD_MODNAME " addr:%s (%s) HWaddr:%pM\n", host_ip,
+                   local_ip, mac);
+
+       return dev;
+}
+
+static int __init nfeth_init(void)
+{
+       long ver;
+       int error, i;
+
+       nfEtherID = nf_get_id("ETHERNET");
+       if (!nfEtherID)
+               return -ENODEV;
+
+       ver = nf_call(nfEtherID + GET_VERSION);
+       pr_info("API %lu\n", ver);
+
+       nfEtherIRQ = nf_call(nfEtherID + XIF_INTLEVEL);
+       error = request_irq(nfEtherIRQ, nfeth_interrupt, IRQF_SHARED,
+                           "eth emu", nfeth_interrupt);
+       if (error) {
+               pr_err("request for irq %d failed %d", nfEtherIRQ, error);
+               return error;
+       }
+
+       for (i = 0; i < MAX_UNIT; i++)
+               nfeth_dev[i] = nfeth_probe(i);
+
+       return 0;
+}
+
+static void __exit nfeth_cleanup(void)
+{
+       int i;
+
+       for (i = 0; i < MAX_UNIT; i++) {
+               if (nfeth_dev[i]) {
+                       unregister_netdev(nfeth_dev[0]);
+                       free_netdev(nfeth_dev[0]);
+               }
+       }
+       free_irq(nfEtherIRQ, nfeth_interrupt);
+}
+
+module_init(nfeth_init);
+module_exit(nfeth_cleanup);
diff --git a/arch/m68k/include/asm/natfeat.h b/arch/m68k/include/asm/natfeat.h
new file mode 100644 (file)
index 0000000..a3521b8
--- /dev/null
@@ -0,0 +1,22 @@
+/*
+ * ARAnyM hardware support via Native Features (natfeats)
+ *
+ * Copyright (c) 2005 Petr Stehlik of ARAnyM dev team
+ *
+ * This software may be used and distributed according to the terms of
+ * the GNU General Public License (GPL), incorporated herein by reference.
+ */
+
+#ifndef _NATFEAT_H
+#define _NATFEAT_H
+
+long nf_get_id(const char *feature_name);
+long nf_call(long id, ...);
+
+void nf_init(void);
+void nf_shutdown(void);
+
+void nfprint(const char *fmt, ...)
+       __attribute__ ((format (printf, 1, 2)));
+
+# endif /* _NATFEAT_H */
index 278c69bad57a8369a542851df92571cdcf988447..f111b02b704fd6aa12341a8e39216923e291ee58 100644 (file)
@@ -113,6 +113,8 @@ static inline void start_thread(struct pt_regs * regs, unsigned long pc,
        wrusp(usp);
 }
 
+extern int handle_kernel_fault(struct pt_regs *regs);
+
 #else
 
 /*
index b3963ab3d1493fb7a443e2834744f1b9281ac37e..334d83640376762b058a7a4010e2878fffe21439 100644 (file)
@@ -42,6 +42,7 @@
 #ifdef CONFIG_SUN3X
 #include <asm/dvma.h>
 #endif
+#include <asm/natfeat.h>
 
 #if !FPSTATESIZE || !NR_IRQS
 #warning No CPU/platform type selected, your kernel will not work!
@@ -324,6 +325,10 @@ void __init setup_arch(char **cmdline_p)
                panic("No configuration setup");
        }
 
+#ifdef CONFIG_NATFEAT
+       nf_init();
+#endif
+
        paging_init();
 
 #ifndef CONFIG_SUN3
index d12c3b0d9e4f59efa6c3f043c36242ca5f1851c3..a0afc239304eb9eb40fcbcbffdf21c005cced264 100644 (file)
@@ -42,6 +42,7 @@
 #include <linux/personality.h>
 #include <linux/tty.h>
 #include <linux/binfmts.h>
+#include <linux/module.h>
 
 #include <asm/setup.h>
 #include <asm/uaccess.h>
@@ -51,7 +52,7 @@
 
 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
 
-const int frame_extra_sizes[16] = {
+static const int frame_extra_sizes[16] = {
   [1]  = -1, /* sizeof(((struct frame *)0)->un.fmt1), */
   [2]  = sizeof(((struct frame *)0)->un.fmt2),
   [3]  = sizeof(((struct frame *)0)->un.fmt3),
@@ -69,6 +70,27 @@ const int frame_extra_sizes[16] = {
   [15] = -1, /* sizeof(((struct frame *)0)->un.fmtf), */
 };
 
+int handle_kernel_fault(struct pt_regs *regs)
+{
+       const struct exception_table_entry *fixup;
+       struct pt_regs *tregs;
+
+       /* Are we prepared to handle this kernel fault? */
+       fixup = search_exception_tables(regs->pc);
+       if (!fixup)
+               return 0;
+
+       /* Create a new four word stack frame, discarding the old one. */
+       regs->stkadj = frame_extra_sizes[regs->format];
+       tregs = (struct pt_regs *)((long)regs + regs->stkadj);
+       tregs->vector = regs->vector;
+       tregs->format = 0;
+       tregs->pc = fixup->fixup;
+       tregs->sr = regs->sr;
+
+       return 1;
+}
+
 /*
  * Atomically swap in the new signal mask, and wait for a signal.
  */
index ada4f4cca811b6ea14e0406619d8d7181ae60b77..4022bbc288782357fa339c17e2254d6462ca6327 100644 (file)
@@ -48,10 +48,7 @@ asmlinkage void nmihandler(void);
 asmlinkage void fpu_emu(void);
 #endif
 
-e_vector vectors[256] = {
-       [VEC_BUSERR]    = buserr,
-       [VEC_SYS]       = system_call,
-};
+e_vector vectors[256];
 
 /* nmi handler for the Amiga */
 asm(".text\n"
@@ -61,10 +58,11 @@ asm(".text\n"
 /*
  * this must be called very early as the kernel might
  * use some instruction that are emulated on the 060
+ * and so we're prepared for early probe attempts (e.g. nf_init).
  */
 void __init base_trap_init(void)
 {
-       if(MACH_IS_SUN3X) {
+       if (MACH_IS_SUN3X) {
                extern e_vector *sun3x_prom_vbr;
 
                __asm__ volatile ("movec %%vbr, %0" : "=r" (sun3x_prom_vbr));
@@ -79,6 +77,10 @@ void __init base_trap_init(void)
 
                vectors[VEC_UNIMPII] = unimp_vec;
        }
+
+       vectors[VEC_BUSERR] = buserr;
+       vectors[VEC_ILLEGAL] = trap;
+       vectors[VEC_SYS] = system_call;
 }
 
 void __init trap_init (void)
@@ -1055,9 +1057,11 @@ asmlinkage void trap_c(struct frame *fp)
        siginfo_t info;
 
        if (fp->ptregs.sr & PS_S) {
-               if ((fp->ptregs.vector >> 2) == VEC_TRACE) {
-                       /* traced a trapping instruction */
-               } else
+               if (fp->ptregs.vector == VEC_TRACE << 2) {
+                       /* traced a trapping instruction on a 68020/30,
+                        * real exception will be executed afterwards.
+                        */
+               } else if (!handle_kernel_fault(&fp->ptregs))
                        bad_super_trap(fp);
                return;
        }
index a0935bf98362854fae6c6c702ba6b4b1c6a17aad..547c23c6e40e0102bbc8b7484f8c7e528534c7aa 100644 (file)
@@ -2,8 +2,8 @@
 # Makefile for the linux kernel.
 #
 
-#EXTRA_AFLAGS += -DFPU_EMU_DEBUG
-#EXTRA_CFLAGS += -DFPU_EMU_DEBUG
+#asflags-y := -DFPU_EMU_DEBUG
+#ccflags-y := -DFPU_EMU_DEBUG
 
 obj-y          := fp_entry.o fp_scan.o fp_util.o fp_move.o fp_movem.o \
                        fp_cond.o fp_arith.o fp_log.o fp_trig.o
index a96394a0333d3d3c82cd70fbd4beb4764b02f018..2db6099784ba33d9254772417dcce05a7ac5eb36 100644 (file)
@@ -18,7 +18,6 @@
 #include <asm/pgalloc.h>
 
 extern void die_if_kernel(char *, struct pt_regs *, long);
-extern const int frame_extra_sizes[]; /* in m68k/kernel/signal.c */
 
 int send_fault_sig(struct pt_regs *regs)
 {
@@ -35,21 +34,8 @@ int send_fault_sig(struct pt_regs *regs)
                force_sig_info(siginfo.si_signo,
                               &siginfo, current);
        } else {
-               const struct exception_table_entry *fixup;
-
-               /* Are we prepared to handle this kernel fault? */
-               if ((fixup = search_exception_tables(regs->pc))) {
-                       struct pt_regs *tregs;
-                       /* Create a new four word stack frame, discarding the old
-                          one.  */
-                       regs->stkadj = frame_extra_sizes[regs->format];
-                       tregs = (struct pt_regs *)((ulong)regs + regs->stkadj);
-                       tregs->vector = regs->vector;
-                       tregs->format = 0;
-                       tregs->pc = fixup->fixup;
-                       tregs->sr = regs->sr;
+               if (handle_kernel_fault(regs))
                        return -1;
-               }
 
                //if (siginfo.si_signo == SIGBUS)
                //      force_sig_info(siginfo.si_signo,
index 7888501ad9ee1af078b47695a00c8074011797c3..363855ca376e6792f9684e44a4eea3b1c2abcb2d 100644 (file)
@@ -1768,8 +1768,8 @@ static int __init amiga_floppy_probe(struct platform_device *pdev)
                return -EBUSY;
 
        ret = -ENOMEM;
-       if ((raw_buf = (char *)amiga_chip_alloc (RAW_BUF_SIZE, "Floppy")) ==
-           NULL) {
+       raw_buf = amiga_chip_alloc(RAW_BUF_SIZE, "Floppy");
+       if (!raw_buf) {
                printk("fd: cannot get chip mem buffer\n");
                goto out_blkdev;
        }
This page took 0.045403 seconds and 5 git commands to generate.