| /* mac8390.c: New driver for 8390-based Nubus (or Nubus-alike) |
| Ethernet cards on Linux */ |
| /* Based on the former daynaport.c driver, by Alan Cox. Some code |
| taken from or inspired by skeleton.c by Donald Becker, acenic.c by |
| Jes Sorensen, and ne2k-pci.c by Donald Becker and Paul Gortmaker. |
| |
| This software may be used and distributed according to the terms of |
| the GNU Public License, incorporated herein by reference. */ |
| |
| /* 2000-02-28: support added for Dayna and Kinetics cards by |
| A.G.deWijn@phys.uu.nl */ |
| /* 2000-04-04: support added for Dayna2 by bart@etpmod.phys.tue.nl */ |
| /* 2001-04-18: support for DaynaPort E/LC-M by rayk@knightsmanor.org */ |
| /* 2001-05-15: support for Cabletron ported from old daynaport driver |
| * and fixed access to Sonic Sys card which masquerades as a Farallon |
| * by rayk@knightsmanor.org */ |
| /* 2002-12-30: Try to support more cards, some clues from NetBSD driver */ |
| /* 2003-12-26: Make sure Asante cards always work. */ |
| |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/types.h> |
| #include <linux/fcntl.h> |
| #include <linux/interrupt.h> |
| #include <linux/ptrace.h> |
| #include <linux/ioport.h> |
| #include <linux/nubus.h> |
| #include <linux/in.h> |
| #include <linux/string.h> |
| #include <linux/errno.h> |
| #include <linux/init.h> |
| #include <linux/netdevice.h> |
| #include <linux/etherdevice.h> |
| #include <linux/skbuff.h> |
| #include <linux/bitops.h> |
| #include <linux/io.h> |
| |
| #include <asm/dma.h> |
| #include <asm/hwtest.h> |
| #include <asm/macints.h> |
| |
| static char version[] = |
| "v0.4 2001-05-15 David Huggins-Daines <dhd@debian.org> and others\n"; |
| |
| #define EI_SHIFT(x) (ei_local->reg_offset[x]) |
| #define ei_inb(port) in_8(port) |
| #define ei_outb(val, port) out_8(port, val) |
| #define ei_inb_p(port) in_8(port) |
| #define ei_outb_p(val, port) out_8(port, val) |
| |
| #include "lib8390.c" |
| |
| #define WD_START_PG 0x00 /* First page of TX buffer */ |
| #define CABLETRON_RX_START_PG 0x00 /* First page of RX buffer */ |
| #define CABLETRON_RX_STOP_PG 0x30 /* Last page +1 of RX ring */ |
| #define CABLETRON_TX_START_PG CABLETRON_RX_STOP_PG |
| /* First page of TX buffer */ |
| |
| /* |
| * Unfortunately it seems we have to hardcode these for the moment |
| * Shouldn't the card know about this? |
| * Does anyone know where to read it off the card? |
| * Do we trust the data provided by the card? |
| */ |
| |
| #define DAYNA_8390_BASE 0x80000 |
| #define DAYNA_8390_MEM 0x00000 |
| |
| #define CABLETRON_8390_BASE 0x90000 |
| #define CABLETRON_8390_MEM 0x00000 |
| |
| #define INTERLAN_8390_BASE 0xE0000 |
| #define INTERLAN_8390_MEM 0xD0000 |
| |
| enum mac8390_type { |
| MAC8390_NONE = -1, |
| MAC8390_APPLE, |
| MAC8390_ASANTE, |
| MAC8390_FARALLON, |
| MAC8390_CABLETRON, |
| MAC8390_DAYNA, |
| MAC8390_INTERLAN, |
| MAC8390_KINETICS, |
| }; |
| |
| static const char *cardname[] = { |
| "apple", |
| "asante", |
| "farallon", |
| "cabletron", |
| "dayna", |
| "interlan", |
| "kinetics", |
| }; |
| |
| static const int word16[] = { |
| 1, /* apple */ |
| 1, /* asante */ |
| 1, /* farallon */ |
| 1, /* cabletron */ |
| 0, /* dayna */ |
| 1, /* interlan */ |
| 0, /* kinetics */ |
| }; |
| |
| /* on which cards do we use NuBus resources? */ |
| static const int useresources[] = { |
| 1, /* apple */ |
| 1, /* asante */ |
| 1, /* farallon */ |
| 0, /* cabletron */ |
| 0, /* dayna */ |
| 0, /* interlan */ |
| 0, /* kinetics */ |
| }; |
| |
| enum mac8390_access { |
| ACCESS_UNKNOWN = 0, |
| ACCESS_32, |
| ACCESS_16, |
| }; |
| |
| extern int mac8390_memtest(struct net_device *dev); |
| static int mac8390_initdev(struct net_device *dev, struct nubus_board *board, |
| enum mac8390_type type); |
| |
| static int mac8390_open(struct net_device *dev); |
| static int mac8390_close(struct net_device *dev); |
| static void mac8390_no_reset(struct net_device *dev); |
| static void interlan_reset(struct net_device *dev); |
| |
| /* Sane (32-bit chunk memory read/write) - Some Farallon and Apple do this*/ |
| static void sane_get_8390_hdr(struct net_device *dev, |
| struct e8390_pkt_hdr *hdr, int ring_page); |
| static void sane_block_input(struct net_device *dev, int count, |
| struct sk_buff *skb, int ring_offset); |
| static void sane_block_output(struct net_device *dev, int count, |
| const unsigned char *buf, const int start_page); |
| |
| /* dayna_memcpy to and from card */ |
| static void dayna_memcpy_fromcard(struct net_device *dev, void *to, |
| int from, int count); |
| static void dayna_memcpy_tocard(struct net_device *dev, int to, |
| const void *from, int count); |
| |
| /* Dayna - Dayna/Kinetics use this */ |
| static void dayna_get_8390_hdr(struct net_device *dev, |
| struct e8390_pkt_hdr *hdr, int ring_page); |
| static void dayna_block_input(struct net_device *dev, int count, |
| struct sk_buff *skb, int ring_offset); |
| static void dayna_block_output(struct net_device *dev, int count, |
| const unsigned char *buf, int start_page); |
| |
| /* Slow Sane (16-bit chunk memory read/write) Cabletron uses this */ |
| static void slow_sane_get_8390_hdr(struct net_device *dev, |
| struct e8390_pkt_hdr *hdr, int ring_page); |
| static void slow_sane_block_input(struct net_device *dev, int count, |
| struct sk_buff *skb, int ring_offset); |
| static void slow_sane_block_output(struct net_device *dev, int count, |
| const unsigned char *buf, int start_page); |
| static void word_memcpy_tocard(unsigned long tp, const void *fp, int count); |
| static void word_memcpy_fromcard(void *tp, unsigned long fp, int count); |
| |
| static enum mac8390_type mac8390_ident(struct nubus_rsrc *fres) |
| { |
| switch (fres->dr_sw) { |
| case NUBUS_DRSW_3COM: |
| switch (fres->dr_hw) { |
| case NUBUS_DRHW_APPLE_SONIC_NB: |
| case NUBUS_DRHW_APPLE_SONIC_LC: |
| case NUBUS_DRHW_SONNET: |
| return MAC8390_NONE; |
| default: |
| return MAC8390_APPLE; |
| } |
| |
| case NUBUS_DRSW_APPLE: |
| switch (fres->dr_hw) { |
| case NUBUS_DRHW_ASANTE_LC: |
| return MAC8390_NONE; |
| case NUBUS_DRHW_CABLETRON: |
| return MAC8390_CABLETRON; |
| default: |
| return MAC8390_APPLE; |
| } |
| |
| case NUBUS_DRSW_ASANTE: |
| return MAC8390_ASANTE; |
| |
| case NUBUS_DRSW_TECHWORKS: |
| case NUBUS_DRSW_DAYNA2: |
| case NUBUS_DRSW_DAYNA_LC: |
| if (fres->dr_hw == NUBUS_DRHW_CABLETRON) |
| return MAC8390_CABLETRON; |
| else |
| return MAC8390_APPLE; |
| |
| case NUBUS_DRSW_FARALLON: |
| return MAC8390_FARALLON; |
| |
| case NUBUS_DRSW_KINETICS: |
| switch (fres->dr_hw) { |
| case NUBUS_DRHW_INTERLAN: |
| return MAC8390_INTERLAN; |
| default: |
| return MAC8390_KINETICS; |
| } |
| |
| case NUBUS_DRSW_DAYNA: |
| /* |
| * These correspond to Dayna Sonic cards |
| * which use the macsonic driver |
| */ |
| if (fres->dr_hw == NUBUS_DRHW_SMC9194 || |
| fres->dr_hw == NUBUS_DRHW_INTERLAN) |
| return MAC8390_NONE; |
| else |
| return MAC8390_DAYNA; |
| } |
| return MAC8390_NONE; |
| } |
| |
| static enum mac8390_access mac8390_testio(unsigned long membase) |
| { |
| u32 outdata = 0xA5A0B5B0; |
| u32 indata = 0; |
| |
| /* Try writing 32 bits */ |
| nubus_writel(outdata, membase); |
| /* Now read it back */ |
| indata = nubus_readl(membase); |
| if (outdata == indata) |
| return ACCESS_32; |
| |
| outdata = 0xC5C0D5D0; |
| indata = 0; |
| |
| /* Write 16 bit output */ |
| word_memcpy_tocard(membase, &outdata, 4); |
| /* Now read it back */ |
| word_memcpy_fromcard(&indata, membase, 4); |
| if (outdata == indata) |
| return ACCESS_16; |
| |
| return ACCESS_UNKNOWN; |
| } |
| |
| static int mac8390_memsize(unsigned long membase) |
| { |
| unsigned long flags; |
| int i, j; |
| |
| local_irq_save(flags); |
| /* Check up to 32K in 4K increments */ |
| for (i = 0; i < 8; i++) { |
| volatile unsigned short *m = (unsigned short *)(membase + (i * 0x1000)); |
| |
| /* Unwriteable - we have a fully decoded card and the |
| RAM end located */ |
| if (hwreg_present(m) == 0) |
| break; |
| |
| /* write a distinctive byte */ |
| *m = 0xA5A0 | i; |
| /* check that we read back what we wrote */ |
| if (*m != (0xA5A0 | i)) |
| break; |
| |
| /* check for partial decode and wrap */ |
| for (j = 0; j < i; j++) { |
| volatile unsigned short *p = (unsigned short *)(membase + (j * 0x1000)); |
| if (*p != (0xA5A0 | j)) |
| break; |
| } |
| } |
| local_irq_restore(flags); |
| /* |
| * in any case, we stopped once we tried one block too many, |
| * or once we reached 32K |
| */ |
| return i * 0x1000; |
| } |
| |
| static bool mac8390_rsrc_init(struct net_device *dev, |
| struct nubus_rsrc *fres, |
| enum mac8390_type cardtype) |
| { |
| struct nubus_board *board = fres->board; |
| struct nubus_dir dir; |
| struct nubus_dirent ent; |
| int offset; |
| volatile unsigned short *i; |
| |
| dev->irq = SLOT2IRQ(board->slot); |
| /* This is getting to be a habit */ |
| dev->base_addr = board->slot_addr | ((board->slot & 0xf) << 20); |
| |
| /* |
| * Get some Nubus info - we will trust the card's idea |
| * of where its memory and registers are. |
| */ |
| |
| if (nubus_get_func_dir(fres, &dir) == -1) { |
| dev_err(&board->dev, |
| "Unable to get Nubus functional directory\n"); |
| return false; |
| } |
| |
| /* Get the MAC address */ |
| if (nubus_find_rsrc(&dir, NUBUS_RESID_MAC_ADDRESS, &ent) == -1) { |
| dev_info(&board->dev, "MAC address resource not found\n"); |
| return false; |
| } |
| |
| nubus_get_rsrc_mem(dev->dev_addr, &ent, 6); |
| |
| if (useresources[cardtype] == 1) { |
| nubus_rewinddir(&dir); |
| if (nubus_find_rsrc(&dir, NUBUS_RESID_MINOR_BASEOS, |
| &ent) == -1) { |
| dev_err(&board->dev, |
| "Memory offset resource not found\n"); |
| return false; |
| } |
| nubus_get_rsrc_mem(&offset, &ent, 4); |
| dev->mem_start = dev->base_addr + offset; |
| /* yes, this is how the Apple driver does it */ |
| dev->base_addr = dev->mem_start + 0x10000; |
| nubus_rewinddir(&dir); |
| if (nubus_find_rsrc(&dir, NUBUS_RESID_MINOR_LENGTH, |
| &ent) == -1) { |
| dev_info(&board->dev, |
| "Memory length resource not found, probing\n"); |
| offset = mac8390_memsize(dev->mem_start); |
| } else { |
| nubus_get_rsrc_mem(&offset, &ent, 4); |
| } |
| dev->mem_end = dev->mem_start + offset; |
| } else { |
| switch (cardtype) { |
| case MAC8390_KINETICS: |
| case MAC8390_DAYNA: /* it's the same */ |
| dev->base_addr = (int)(board->slot_addr + |
| DAYNA_8390_BASE); |
| dev->mem_start = (int)(board->slot_addr + |
| DAYNA_8390_MEM); |
| dev->mem_end = dev->mem_start + |
| mac8390_memsize(dev->mem_start); |
| break; |
| case MAC8390_INTERLAN: |
| dev->base_addr = (int)(board->slot_addr + |
| INTERLAN_8390_BASE); |
| dev->mem_start = (int)(board->slot_addr + |
| INTERLAN_8390_MEM); |
| dev->mem_end = dev->mem_start + |
| mac8390_memsize(dev->mem_start); |
| break; |
| case MAC8390_CABLETRON: |
| dev->base_addr = (int)(board->slot_addr + |
| CABLETRON_8390_BASE); |
| dev->mem_start = (int)(board->slot_addr + |
| CABLETRON_8390_MEM); |
| /* The base address is unreadable if 0x00 |
| * has been written to the command register |
| * Reset the chip by writing E8390_NODMA + |
| * E8390_PAGE0 + E8390_STOP just to be |
| * sure |
| */ |
| i = (void *)dev->base_addr; |
| *i = 0x21; |
| dev->mem_end = dev->mem_start + |
| mac8390_memsize(dev->mem_start); |
| break; |
| |
| default: |
| dev_err(&board->dev, |
| "No known base address for card type\n"); |
| return false; |
| } |
| } |
| |
| return true; |
| } |
| |
| static int mac8390_device_probe(struct nubus_board *board) |
| { |
| struct net_device *dev; |
| int err = -ENODEV; |
| struct nubus_rsrc *fres; |
| enum mac8390_type cardtype = MAC8390_NONE; |
| |
| dev = ____alloc_ei_netdev(0); |
| if (!dev) |
| return -ENOMEM; |
| |
| SET_NETDEV_DEV(dev, &board->dev); |
| |
| for_each_board_func_rsrc(board, fres) { |
| if (fres->category != NUBUS_CAT_NETWORK || |
| fres->type != NUBUS_TYPE_ETHERNET) |
| continue; |
| |
| cardtype = mac8390_ident(fres); |
| if (cardtype == MAC8390_NONE) |
| continue; |
| |
| if (mac8390_rsrc_init(dev, fres, cardtype)) |
| break; |
| } |
| if (!fres) |
| goto out; |
| |
| err = mac8390_initdev(dev, board, cardtype); |
| if (err) |
| goto out; |
| |
| err = register_netdev(dev); |
| if (err) |
| goto out; |
| |
| nubus_set_drvdata(board, dev); |
| return 0; |
| |
| out: |
| free_netdev(dev); |
| return err; |
| } |
| |
| static void mac8390_device_remove(struct nubus_board *board) |
| { |
| struct net_device *dev = nubus_get_drvdata(board); |
| |
| unregister_netdev(dev); |
| free_netdev(dev); |
| } |
| |
| static struct nubus_driver mac8390_driver = { |
| .probe = mac8390_device_probe, |
| .remove = mac8390_device_remove, |
| .driver = { |
| .name = KBUILD_MODNAME, |
| .owner = THIS_MODULE, |
| } |
| }; |
| |
| MODULE_AUTHOR("David Huggins-Daines <dhd@debian.org> and others"); |
| MODULE_DESCRIPTION("Macintosh NS8390-based Nubus Ethernet driver"); |
| MODULE_LICENSE("GPL"); |
| |
| static int __init mac8390_init(void) |
| { |
| return nubus_driver_register(&mac8390_driver); |
| } |
| module_init(mac8390_init); |
| |
| static void __exit mac8390_exit(void) |
| { |
| nubus_driver_unregister(&mac8390_driver); |
| } |
| module_exit(mac8390_exit); |
| |
| static const struct net_device_ops mac8390_netdev_ops = { |
| .ndo_open = mac8390_open, |
| .ndo_stop = mac8390_close, |
| .ndo_start_xmit = __ei_start_xmit, |
| .ndo_tx_timeout = __ei_tx_timeout, |
| .ndo_get_stats = __ei_get_stats, |
| .ndo_set_rx_mode = __ei_set_multicast_list, |
| .ndo_validate_addr = eth_validate_addr, |
| .ndo_set_mac_address = eth_mac_addr, |
| #ifdef CONFIG_NET_POLL_CONTROLLER |
| .ndo_poll_controller = __ei_poll, |
| #endif |
| }; |
| |
| static int mac8390_initdev(struct net_device *dev, struct nubus_board *board, |
| enum mac8390_type type) |
| { |
| static u32 fwrd4_offsets[16] = { |
| 0, 4, 8, 12, |
| 16, 20, 24, 28, |
| 32, 36, 40, 44, |
| 48, 52, 56, 60 |
| }; |
| static u32 back4_offsets[16] = { |
| 60, 56, 52, 48, |
| 44, 40, 36, 32, |
| 28, 24, 20, 16, |
| 12, 8, 4, 0 |
| }; |
| static u32 fwrd2_offsets[16] = { |
| 0, 2, 4, 6, |
| 8, 10, 12, 14, |
| 16, 18, 20, 22, |
| 24, 26, 28, 30 |
| }; |
| |
| int access_bitmode = 0; |
| |
| /* Now fill in our stuff */ |
| dev->netdev_ops = &mac8390_netdev_ops; |
| |
| /* GAR, ei_status is actually a macro even though it looks global */ |
| ei_status.name = cardname[type]; |
| ei_status.word16 = word16[type]; |
| |
| /* Cabletron's TX/RX buffers are backwards */ |
| if (type == MAC8390_CABLETRON) { |
| ei_status.tx_start_page = CABLETRON_TX_START_PG; |
| ei_status.rx_start_page = CABLETRON_RX_START_PG; |
| ei_status.stop_page = CABLETRON_RX_STOP_PG; |
| ei_status.rmem_start = dev->mem_start; |
| ei_status.rmem_end = dev->mem_start + CABLETRON_RX_STOP_PG*256; |
| } else { |
| ei_status.tx_start_page = WD_START_PG; |
| ei_status.rx_start_page = WD_START_PG + TX_PAGES; |
| ei_status.stop_page = (dev->mem_end - dev->mem_start)/256; |
| ei_status.rmem_start = dev->mem_start + TX_PAGES*256; |
| ei_status.rmem_end = dev->mem_end; |
| } |
| |
| /* Fill in model-specific information and functions */ |
| switch (type) { |
| case MAC8390_FARALLON: |
| case MAC8390_APPLE: |
| switch (mac8390_testio(dev->mem_start)) { |
| case ACCESS_UNKNOWN: |
| dev_err(&board->dev, |
| "Don't know how to access card memory\n"); |
| return -ENODEV; |
| |
| case ACCESS_16: |
| /* 16 bit card, register map is reversed */ |
| ei_status.reset_8390 = mac8390_no_reset; |
| ei_status.block_input = slow_sane_block_input; |
| ei_status.block_output = slow_sane_block_output; |
| ei_status.get_8390_hdr = slow_sane_get_8390_hdr; |
| ei_status.reg_offset = back4_offsets; |
| break; |
| |
| case ACCESS_32: |
| /* 32 bit card, register map is reversed */ |
| ei_status.reset_8390 = mac8390_no_reset; |
| ei_status.block_input = sane_block_input; |
| ei_status.block_output = sane_block_output; |
| ei_status.get_8390_hdr = sane_get_8390_hdr; |
| ei_status.reg_offset = back4_offsets; |
| access_bitmode = 1; |
| break; |
| } |
| break; |
| |
| case MAC8390_ASANTE: |
| /* Some Asante cards pass the 32 bit test |
| * but overwrite system memory when run at 32 bit. |
| * so we run them all at 16 bit. |
| */ |
| ei_status.reset_8390 = mac8390_no_reset; |
| ei_status.block_input = slow_sane_block_input; |
| ei_status.block_output = slow_sane_block_output; |
| ei_status.get_8390_hdr = slow_sane_get_8390_hdr; |
| ei_status.reg_offset = back4_offsets; |
| break; |
| |
| case MAC8390_CABLETRON: |
| /* 16 bit card, register map is short forward */ |
| ei_status.reset_8390 = mac8390_no_reset; |
| ei_status.block_input = slow_sane_block_input; |
| ei_status.block_output = slow_sane_block_output; |
| ei_status.get_8390_hdr = slow_sane_get_8390_hdr; |
| ei_status.reg_offset = fwrd2_offsets; |
| break; |
| |
| case MAC8390_DAYNA: |
| case MAC8390_KINETICS: |
| /* 16 bit memory, register map is forward */ |
| /* dayna and similar */ |
| ei_status.reset_8390 = mac8390_no_reset; |
| ei_status.block_input = dayna_block_input; |
| ei_status.block_output = dayna_block_output; |
| ei_status.get_8390_hdr = dayna_get_8390_hdr; |
| ei_status.reg_offset = fwrd4_offsets; |
| break; |
| |
| case MAC8390_INTERLAN: |
| /* 16 bit memory, register map is forward */ |
| ei_status.reset_8390 = interlan_reset; |
| ei_status.block_input = slow_sane_block_input; |
| ei_status.block_output = slow_sane_block_output; |
| ei_status.get_8390_hdr = slow_sane_get_8390_hdr; |
| ei_status.reg_offset = fwrd4_offsets; |
| break; |
| |
| default: |
| dev_err(&board->dev, "Unsupported card type\n"); |
| return -ENODEV; |
| } |
| |
| __NS8390_init(dev, 0); |
| |
| /* Good, done, now spit out some messages */ |
| dev_info(&board->dev, "%s (type %s)\n", board->name, cardname[type]); |
| dev_info(&board->dev, "MAC %pM, IRQ %d, %d KB shared memory at %#lx, %d-bit access.\n", |
| dev->dev_addr, dev->irq, |
| (unsigned int)(dev->mem_end - dev->mem_start) >> 10, |
| dev->mem_start, access_bitmode ? 32 : 16); |
| return 0; |
| } |
| |
| static int mac8390_open(struct net_device *dev) |
| { |
| int err; |
| |
| __ei_open(dev); |
| err = request_irq(dev->irq, __ei_interrupt, 0, "8390 Ethernet", dev); |
| if (err) |
| pr_err("%s: unable to get IRQ %d\n", dev->name, dev->irq); |
| return err; |
| } |
| |
| static int mac8390_close(struct net_device *dev) |
| { |
| free_irq(dev->irq, dev); |
| __ei_close(dev); |
| return 0; |
| } |
| |
| static void mac8390_no_reset(struct net_device *dev) |
| { |
| struct ei_device *ei_local = netdev_priv(dev); |
| |
| ei_status.txing = 0; |
| netif_info(ei_local, hw, dev, "reset not supported\n"); |
| } |
| |
| static void interlan_reset(struct net_device *dev) |
| { |
| unsigned char *target = nubus_slot_addr(IRQ2SLOT(dev->irq)); |
| struct ei_device *ei_local = netdev_priv(dev); |
| |
| netif_info(ei_local, hw, dev, "Need to reset the NS8390 t=%lu...", |
| jiffies); |
| ei_status.txing = 0; |
| target[0xC0000] = 0; |
| if (netif_msg_hw(ei_local)) |
| pr_cont("reset complete\n"); |
| } |
| |
| /* dayna_memcpy_fromio/dayna_memcpy_toio */ |
| /* directly from daynaport.c by Alan Cox */ |
| static void dayna_memcpy_fromcard(struct net_device *dev, void *to, int from, |
| int count) |
| { |
| volatile unsigned char *ptr; |
| unsigned char *target = to; |
| from <<= 1; /* word, skip overhead */ |
| ptr = (unsigned char *)(dev->mem_start+from); |
| /* Leading byte? */ |
| if (from & 2) { |
| *target++ = ptr[-1]; |
| ptr += 2; |
| count--; |
| } |
| while (count >= 2) { |
| *(unsigned short *)target = *(unsigned short volatile *)ptr; |
| ptr += 4; /* skip cruft */ |
| target += 2; |
| count -= 2; |
| } |
| /* Trailing byte? */ |
| if (count) |
| *target = *ptr; |
| } |
| |
| static void dayna_memcpy_tocard(struct net_device *dev, int to, |
| const void *from, int count) |
| { |
| volatile unsigned short *ptr; |
| const unsigned char *src = from; |
| to <<= 1; /* word, skip overhead */ |
| ptr = (unsigned short *)(dev->mem_start+to); |
| /* Leading byte? */ |
| if (to & 2) { /* avoid a byte write (stomps on other data) */ |
| ptr[-1] = (ptr[-1]&0xFF00)|*src++; |
| ptr++; |
| count--; |
| } |
| while (count >= 2) { |
| *ptr++ = *(unsigned short *)src; /* Copy and */ |
| ptr++; /* skip cruft */ |
| src += 2; |
| count -= 2; |
| } |
| /* Trailing byte? */ |
| if (count) { |
| /* card doesn't like byte writes */ |
| *ptr = (*ptr & 0x00FF) | (*src << 8); |
| } |
| } |
| |
| /* sane block input/output */ |
| static void sane_get_8390_hdr(struct net_device *dev, |
| struct e8390_pkt_hdr *hdr, int ring_page) |
| { |
| unsigned long hdr_start = (ring_page - WD_START_PG)<<8; |
| memcpy_fromio(hdr, (void __iomem *)dev->mem_start + hdr_start, 4); |
| /* Fix endianness */ |
| hdr->count = swab16(hdr->count); |
| } |
| |
| static void sane_block_input(struct net_device *dev, int count, |
| struct sk_buff *skb, int ring_offset) |
| { |
| unsigned long xfer_base = ring_offset - (WD_START_PG<<8); |
| unsigned long xfer_start = xfer_base + dev->mem_start; |
| |
| if (xfer_start + count > ei_status.rmem_end) { |
| /* We must wrap the input move. */ |
| int semi_count = ei_status.rmem_end - xfer_start; |
| memcpy_fromio(skb->data, |
| (void __iomem *)dev->mem_start + xfer_base, |
| semi_count); |
| count -= semi_count; |
| memcpy_fromio(skb->data + semi_count, |
| (void __iomem *)ei_status.rmem_start, count); |
| } else { |
| memcpy_fromio(skb->data, |
| (void __iomem *)dev->mem_start + xfer_base, |
| count); |
| } |
| } |
| |
| static void sane_block_output(struct net_device *dev, int count, |
| const unsigned char *buf, int start_page) |
| { |
| long shmem = (start_page - WD_START_PG)<<8; |
| |
| memcpy_toio((void __iomem *)dev->mem_start + shmem, buf, count); |
| } |
| |
| /* dayna block input/output */ |
| static void dayna_get_8390_hdr(struct net_device *dev, |
| struct e8390_pkt_hdr *hdr, int ring_page) |
| { |
| unsigned long hdr_start = (ring_page - WD_START_PG)<<8; |
| |
| dayna_memcpy_fromcard(dev, hdr, hdr_start, 4); |
| /* Fix endianness */ |
| hdr->count = (hdr->count & 0xFF) << 8 | (hdr->count >> 8); |
| } |
| |
| static void dayna_block_input(struct net_device *dev, int count, |
| struct sk_buff *skb, int ring_offset) |
| { |
| unsigned long xfer_base = ring_offset - (WD_START_PG<<8); |
| unsigned long xfer_start = xfer_base+dev->mem_start; |
| |
| /* Note the offset math is done in card memory space which is word |
| per long onto our space. */ |
| |
| if (xfer_start + count > ei_status.rmem_end) { |
| /* We must wrap the input move. */ |
| int semi_count = ei_status.rmem_end - xfer_start; |
| dayna_memcpy_fromcard(dev, skb->data, xfer_base, semi_count); |
| count -= semi_count; |
| dayna_memcpy_fromcard(dev, skb->data + semi_count, |
| ei_status.rmem_start - dev->mem_start, |
| count); |
| } else { |
| dayna_memcpy_fromcard(dev, skb->data, xfer_base, count); |
| } |
| } |
| |
| static void dayna_block_output(struct net_device *dev, int count, |
| const unsigned char *buf, |
| int start_page) |
| { |
| long shmem = (start_page - WD_START_PG)<<8; |
| |
| dayna_memcpy_tocard(dev, shmem, buf, count); |
| } |
| |
| /* Cabletron block I/O */ |
| static void slow_sane_get_8390_hdr(struct net_device *dev, |
| struct e8390_pkt_hdr *hdr, |
| int ring_page) |
| { |
| unsigned long hdr_start = (ring_page - WD_START_PG)<<8; |
| word_memcpy_fromcard(hdr, dev->mem_start + hdr_start, 4); |
| /* Register endianism - fix here rather than 8390.c */ |
| hdr->count = (hdr->count&0xFF)<<8|(hdr->count>>8); |
| } |
| |
| static void slow_sane_block_input(struct net_device *dev, int count, |
| struct sk_buff *skb, int ring_offset) |
| { |
| unsigned long xfer_base = ring_offset - (WD_START_PG<<8); |
| unsigned long xfer_start = xfer_base+dev->mem_start; |
| |
| if (xfer_start + count > ei_status.rmem_end) { |
| /* We must wrap the input move. */ |
| int semi_count = ei_status.rmem_end - xfer_start; |
| word_memcpy_fromcard(skb->data, dev->mem_start + xfer_base, |
| semi_count); |
| count -= semi_count; |
| word_memcpy_fromcard(skb->data + semi_count, |
| ei_status.rmem_start, count); |
| } else { |
| word_memcpy_fromcard(skb->data, dev->mem_start + xfer_base, |
| count); |
| } |
| } |
| |
| static void slow_sane_block_output(struct net_device *dev, int count, |
| const unsigned char *buf, int start_page) |
| { |
| long shmem = (start_page - WD_START_PG)<<8; |
| |
| word_memcpy_tocard(dev->mem_start + shmem, buf, count); |
| } |
| |
| static void word_memcpy_tocard(unsigned long tp, const void *fp, int count) |
| { |
| volatile unsigned short *to = (void *)tp; |
| const unsigned short *from = fp; |
| |
| count++; |
| count /= 2; |
| |
| while (count--) |
| *to++ = *from++; |
| } |
| |
| static void word_memcpy_fromcard(void *tp, unsigned long fp, int count) |
| { |
| unsigned short *to = tp; |
| const volatile unsigned short *from = (const void *)fp; |
| |
| count++; |
| count /= 2; |
| |
| while (count--) |
| *to++ = *from++; |
| } |
| |
| |