543 lines
13 KiB
Diff
543 lines
13 KiB
Diff
Subject: [PATCH] m68k: Atari ARAnyM support
|
|
|
|
From: Michael Schmitz <schmitz@opal.biophys.uni-duesseldorf.de>
|
|
|
|
This isn't really my kettle of fish, but I post it anyway unless Petr
|
|
complains :-)
|
|
|
|
This is what makes it possible for me to test 2.6 builds on the
|
|
emulator...
|
|
|
|
Should be signed off by Petr, really.
|
|
|
|
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
|
|
---
|
|
arch/m68k/Kconfig | 15 ++
|
|
arch/m68k/Makefile | 1
|
|
arch/m68k/emu/Makefile | 7 +
|
|
arch/m68k/emu/natfeat.c | 113 +++++++++++++++++
|
|
arch/m68k/emu/nfeth.c | 292 +++++++++++++++++++++++++++++++++++++++++++++
|
|
arch/m68k/kernel/setup.c | 5
|
|
drivers/net/Kconfig | 8 +
|
|
include/asm-m68k/natfeat.h | 22 +++
|
|
8 files changed, 463 insertions(+)
|
|
|
|
--- linux-m68k-2.6.21.orig/arch/m68k/Kconfig
|
|
+++ linux-m68k-2.6.21/arch/m68k/Kconfig
|
|
@@ -260,6 +260,21 @@ config Q40
|
|
Q60. Select your CPU below. For 68LC060 don't forget to enable FPU
|
|
emulation.
|
|
|
|
+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. Useful with the ARANYM option.
|
|
+
|
|
+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
|
|
--- linux-m68k-2.6.21.orig/arch/m68k/Makefile
|
|
+++ linux-m68k-2.6.21/arch/m68k/Makefile
|
|
@@ -75,6 +75,7 @@ core-$(CONFIG_MVME16x) += arch/m68k/mvm
|
|
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/
|
|
--- /dev/null
|
|
+++ linux-m68k-2.6.21/arch/m68k/emu/Makefile
|
|
@@ -0,0 +1,7 @@
|
|
+#
|
|
+# Makefile for Linux arch/m68k/emu source directory
|
|
+#
|
|
+
|
|
+obj-y += natfeat.o
|
|
+
|
|
+obj-$(CONFIG_NFETH) += nfeth.o
|
|
--- /dev/null
|
|
+++ linux-m68k-2.6.21/arch/m68k/emu/natfeat.c
|
|
@@ -0,0 +1,113 @@
|
|
+/*
|
|
+ * 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 <asm/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");
|
|
+
|
|
+static int stderr_id;
|
|
+
|
|
+static void nf_write(struct console *co, 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);
|
|
+}
|
|
+
|
|
+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 struct console nf_console_driver = {
|
|
+ .name = "debug",
|
|
+ .write = nf_write,
|
|
+ .flags = CON_PRINTBUFFER,
|
|
+ .index = -1,
|
|
+};
|
|
+
|
|
+static int __init nf_debug_setup(char *arg)
|
|
+{
|
|
+ if (strcmp(arg, "emu"))
|
|
+ return 0;
|
|
+
|
|
+ stderr_id = nf_get_id("NF_STDERR");
|
|
+ if (stderr_id)
|
|
+ register_console(&nf_console_driver);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+early_param("debug", nf_debug_setup);
|
|
+
|
|
+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;
|
|
+
|
|
+ printk("NatFeats found (%s, %lu.%lu)\n", buf,
|
|
+ version >> 16, version & 0xffff);
|
|
+
|
|
+ mach_power_off = nf_poweroff;
|
|
+}
|
|
--- /dev/null
|
|
+++ linux-m68k-2.6.21/arch/m68k/emu/nfeth.c
|
|
@@ -0,0 +1,292 @@
|
|
+/*
|
|
+ * 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.
|
|
+ */
|
|
+
|
|
+#include <linux/netdevice.h>
|
|
+#include <linux/etherdevice.h>
|
|
+#include <linux/module.h>
|
|
+#include <net/ieee80211.h>
|
|
+#include <asm/natfeat.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 DRV_NAME "nfeth"
|
|
+#define DRV_VERSION "0.3"
|
|
+#define DRV_RELDATE "10/12/2005"
|
|
+
|
|
+#define MAX_UNIT 8
|
|
+
|
|
+/* These identify the driver base version and may not be removed. */
|
|
+static char version[] __devinitdata =
|
|
+KERN_INFO DRV_NAME ".c:v" DRV_VERSION " " DRV_RELDATE " S.Opichal, M.Jurik, P.Stehlik\n"
|
|
+KERN_INFO " http://aranym.atari.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)");
|
|
+*/
|
|
+
|
|
+#undef DEBUG
|
|
+
|
|
+static long nfEtherID;
|
|
+static int nfEtherIRQ;
|
|
+
|
|
+struct nfeth_private {
|
|
+ int ethX;
|
|
+ struct net_device_stats stats;
|
|
+ spinlock_t lock;
|
|
+};
|
|
+
|
|
+static struct net_device *nfeth_dev[MAX_UNIT];
|
|
+
|
|
+int nfeth_open(struct net_device *dev);
|
|
+int nfeth_stop(struct net_device *dev);
|
|
+irqreturn_t nfeth_interrupt(int irq, void *dev_id);
|
|
+int nfeth_xmit(struct sk_buff *skb, struct net_device *dev);
|
|
+
|
|
+int nfeth_open(struct net_device *dev)
|
|
+{
|
|
+ struct nfeth_private *priv = netdev_priv(dev);
|
|
+ int res;
|
|
+
|
|
+ res = nf_call(nfEtherID + XIF_START, priv->ethX);
|
|
+
|
|
+ /* Clean statistics */
|
|
+ memset(&priv->stats, 0, sizeof(struct net_device_stats));
|
|
+ spin_lock_init(&priv->lock);
|
|
+
|
|
+#ifdef DEBUG
|
|
+ printk(DRV_NAME ": open %d\n", res);
|
|
+#endif
|
|
+
|
|
+ /* Ready for data */
|
|
+ netif_start_queue(dev);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+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);
|
|
+ int handled = 0;
|
|
+ unsigned short pktlen;
|
|
+ struct sk_buff *skb;
|
|
+
|
|
+ /* read packet length (excluding 32 bit crc) */
|
|
+ pktlen = nf_call(nfEtherID + XIF_READLENGTH, priv->ethX);
|
|
+
|
|
+#ifdef DEBUG
|
|
+ printk(DRV_NAME ": recv_packet: %i\n", pktlen);
|
|
+#endif
|
|
+
|
|
+ if (!pktlen) {
|
|
+#ifdef DEBUG
|
|
+ printk(DRV_NAME ": recv_packet: pktlen == 0\n");
|
|
+#endif
|
|
+ priv->stats.rx_errors++;
|
|
+ return;
|
|
+ }
|
|
+
|
|
+ skb = dev_alloc_skb(pktlen + 2);
|
|
+ if (!skb) {
|
|
+#ifdef DEBUG
|
|
+ printk(DRV_NAME ": recv_packet: out of mem (buf_alloc failed)\n");
|
|
+#endif
|
|
+ priv->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;
|
|
+ priv->stats.rx_packets++;
|
|
+ priv->stats.rx_bytes += pktlen;
|
|
+
|
|
+ /* and enqueue packet */
|
|
+ handled = 1;
|
|
+ return;
|
|
+}
|
|
+
|
|
+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;
|
|
+}
|
|
+
|
|
+int nfeth_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
+{
|
|
+ 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;
|
|
+ }
|
|
+
|
|
+ dev->trans_start = jiffies;
|
|
+
|
|
+#ifdef DEBUG
|
|
+ printk(DRV_NAME ": send %d bytes\n", len);
|
|
+#endif
|
|
+ nf_call(nfEtherID + XIF_WRITEBLOCK, priv->ethX, virt_to_phys(data), len);
|
|
+
|
|
+ priv->stats.tx_packets++;
|
|
+ priv->stats.tx_bytes += len;
|
|
+
|
|
+ dev_kfree_skb(skb);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static void nfeth_tx_timeout(struct net_device *dev)
|
|
+{
|
|
+ struct nfeth_private *priv = netdev_priv(dev);
|
|
+ priv->stats.tx_errors++;
|
|
+ netif_wake_queue(dev);
|
|
+}
|
|
+
|
|
+static struct net_device_stats *nfeth_get_stats(struct net_device *dev)
|
|
+{
|
|
+ struct nfeth_private *priv = netdev_priv(dev);
|
|
+ return &priv->stats;
|
|
+}
|
|
+
|
|
+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;
|
|
+
|
|
+ SET_MODULE_OWNER(dev);
|
|
+ dev->irq = nfEtherIRQ;
|
|
+ dev->open = nfeth_open;
|
|
+ dev->stop = nfeth_stop;
|
|
+ dev->hard_start_xmit = nfeth_xmit;
|
|
+ dev->tx_timeout = nfeth_tx_timeout;
|
|
+ dev->get_stats = nfeth_get_stats;
|
|
+ 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));
|
|
+
|
|
+ printk(KERN_INFO "%s: nfeth addr:%s (%s) HWaddr:" MAC_FMT "\n",
|
|
+ dev->name, host_ip, local_ip, MAC_ARG(mac));
|
|
+
|
|
+ return dev;
|
|
+}
|
|
+
|
|
+int __init nfeth_init(void)
|
|
+{
|
|
+ long ver;
|
|
+ int i;
|
|
+
|
|
+ nfEtherID = nf_get_id("ETHERNET");
|
|
+ if (!nfEtherID)
|
|
+ return -ENODEV;
|
|
+
|
|
+ ver = nf_call(nfEtherID + GET_VERSION);
|
|
+ printk("nfeth API %lu\n", ver);
|
|
+
|
|
+ nfEtherIRQ = nf_call(nfEtherID + XIF_INTLEVEL);
|
|
+ if (request_irq(nfEtherIRQ, nfeth_interrupt, IRQF_SHARED,
|
|
+ "eth emu", nfeth_interrupt)) {
|
|
+ printk("nfeth: request for irq %d failed", nfEtherIRQ);
|
|
+ return -ENODEV;
|
|
+ }
|
|
+
|
|
+ for (i = 0; i < MAX_UNIT; i++)
|
|
+ nfeth_dev[i] = nfeth_probe(i);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+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);
|
|
--- linux-m68k-2.6.21.orig/arch/m68k/kernel/setup.c
|
|
+++ linux-m68k-2.6.21/arch/m68k/kernel/setup.c
|
|
@@ -39,6 +39,7 @@
|
|
#ifdef CONFIG_SUN3X
|
|
#include <asm/dvma.h>
|
|
#endif
|
|
+#include <asm/natfeat.h>
|
|
|
|
unsigned long m68k_machtype;
|
|
unsigned long m68k_cputype;
|
|
@@ -313,6 +314,10 @@ void __init setup_arch(char **cmdline_p)
|
|
panic("No configuration setup");
|
|
}
|
|
|
|
+#ifdef CONFIG_NATFEAT
|
|
+ nf_init();
|
|
+#endif
|
|
+
|
|
paging_init();
|
|
|
|
#ifndef CONFIG_SUN3
|
|
--- linux-m68k-2.6.21.orig/drivers/net/Kconfig
|
|
+++ linux-m68k-2.6.21/drivers/net/Kconfig
|
|
@@ -398,6 +398,14 @@ config ATARI_PAMSNET
|
|
ACSI port ("ACSI node"). The driver works (has to work...) with a
|
|
polled I/O scheme, so it's rather slow :-(
|
|
|
|
+config ATARI_ETHERNEC
|
|
+ tristate "Atari EtherNEC Ethernet support"
|
|
+ depends on NET_ETHERNET && ATARI && ATARI_ROM_ISA
|
|
+ help
|
|
+ Say Y to include support for the EtherNEC network adapter for the
|
|
+ ROM port. The driver works by polling instead of interrupts, so it
|
|
+ is quite slow.
|
|
+
|
|
config SUN3LANCE
|
|
tristate "Sun3/Sun3x on-board LANCE support"
|
|
depends on NET_ETHERNET && (SUN3 || SUN3X)
|
|
--- /dev/null
|
|
+++ linux-m68k-2.6.21/include/asm-m68k/natfeat.h
|
|
@@ -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 */
|