forked from Minki/linux
382 lines
8.7 KiB
C
382 lines
8.7 KiB
C
|
/*
|
||
|
* sonic.c
|
||
|
*
|
||
|
* (C) 1996,1998 by Thomas Bogendoerfer (tsbogend@alpha.franken.de)
|
||
|
*
|
||
|
* This driver is based on work from Andreas Busse, but most of
|
||
|
* the code is rewritten.
|
||
|
*
|
||
|
* (C) 1995 by Andreas Busse (andy@waldorf-gmbh.de)
|
||
|
*
|
||
|
* A driver for the onboard Sonic ethernet controller on Mips Jazz
|
||
|
* systems (Acer Pica-61, Mips Magnum 4000, Olivetti M700 and
|
||
|
* perhaps others, too)
|
||
|
*/
|
||
|
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/types.h>
|
||
|
#include <linux/fcntl.h>
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/ioport.h>
|
||
|
#include <linux/in.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/string.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/errno.h>
|
||
|
#include <linux/netdevice.h>
|
||
|
#include <linux/etherdevice.h>
|
||
|
#include <linux/skbuff.h>
|
||
|
#include <linux/bitops.h>
|
||
|
#include <linux/device.h>
|
||
|
|
||
|
#include <asm/bootinfo.h>
|
||
|
#include <asm/system.h>
|
||
|
#include <asm/pgtable.h>
|
||
|
#include <asm/io.h>
|
||
|
#include <asm/dma.h>
|
||
|
#include <asm/jazz.h>
|
||
|
#include <asm/jazzdma.h>
|
||
|
|
||
|
static char jazz_sonic_string[] = "jazzsonic";
|
||
|
static struct platform_device *jazz_sonic_device;
|
||
|
|
||
|
#define SONIC_MEM_SIZE 0x100
|
||
|
|
||
|
#define SREGS_PAD(n) u16 n;
|
||
|
|
||
|
#include "sonic.h"
|
||
|
|
||
|
/*
|
||
|
* Macros to access SONIC registers
|
||
|
*/
|
||
|
#define SONIC_READ(reg) (*((volatile unsigned int *)base_addr+reg))
|
||
|
|
||
|
#define SONIC_WRITE(reg,val) \
|
||
|
do { \
|
||
|
*((volatile unsigned int *)base_addr+(reg)) = (val); \
|
||
|
} while (0)
|
||
|
|
||
|
|
||
|
/* use 0 for production, 1 for verification, >2 for debug */
|
||
|
#ifdef SONIC_DEBUG
|
||
|
static unsigned int sonic_debug = SONIC_DEBUG;
|
||
|
#else
|
||
|
static unsigned int sonic_debug = 1;
|
||
|
#endif
|
||
|
|
||
|
/*
|
||
|
* Base address and interrupt of the SONIC controller on JAZZ boards
|
||
|
*/
|
||
|
static struct {
|
||
|
unsigned int port;
|
||
|
unsigned int irq;
|
||
|
} sonic_portlist[] = { {JAZZ_ETHERNET_BASE, JAZZ_ETHERNET_IRQ}, {0, 0}};
|
||
|
|
||
|
/*
|
||
|
* We cannot use station (ethernet) address prefixes to detect the
|
||
|
* sonic controller since these are board manufacturer depended.
|
||
|
* So we check for known Silicon Revision IDs instead.
|
||
|
*/
|
||
|
static unsigned short known_revisions[] =
|
||
|
{
|
||
|
0x04, /* Mips Magnum 4000 */
|
||
|
0xffff /* end of list */
|
||
|
};
|
||
|
|
||
|
static int __init sonic_probe1(struct net_device *dev, unsigned long base_addr,
|
||
|
unsigned int irq)
|
||
|
{
|
||
|
static unsigned version_printed;
|
||
|
unsigned int silicon_revision;
|
||
|
unsigned int val;
|
||
|
struct sonic_local *lp;
|
||
|
int err = -ENODEV;
|
||
|
int i;
|
||
|
|
||
|
if (!request_mem_region(base_addr, SONIC_MEM_SIZE, jazz_sonic_string))
|
||
|
return -EBUSY;
|
||
|
/*
|
||
|
* get the Silicon Revision ID. If this is one of the known
|
||
|
* one assume that we found a SONIC ethernet controller at
|
||
|
* the expected location.
|
||
|
*/
|
||
|
silicon_revision = SONIC_READ(SONIC_SR);
|
||
|
if (sonic_debug > 1)
|
||
|
printk("SONIC Silicon Revision = 0x%04x\n",silicon_revision);
|
||
|
|
||
|
i = 0;
|
||
|
while (known_revisions[i] != 0xffff
|
||
|
&& known_revisions[i] != silicon_revision)
|
||
|
i++;
|
||
|
|
||
|
if (known_revisions[i] == 0xffff) {
|
||
|
printk("SONIC ethernet controller not found (0x%4x)\n",
|
||
|
silicon_revision);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
if (sonic_debug && version_printed++ == 0)
|
||
|
printk(version);
|
||
|
|
||
|
printk("%s: Sonic ethernet found at 0x%08lx, ", dev->name, base_addr);
|
||
|
|
||
|
/* Fill in the 'dev' fields. */
|
||
|
dev->base_addr = base_addr;
|
||
|
dev->irq = irq;
|
||
|
|
||
|
/*
|
||
|
* Put the sonic into software reset, then
|
||
|
* retrieve and print the ethernet address.
|
||
|
*/
|
||
|
SONIC_WRITE(SONIC_CMD,SONIC_CR_RST);
|
||
|
SONIC_WRITE(SONIC_CEP,0);
|
||
|
for (i=0; i<3; i++) {
|
||
|
val = SONIC_READ(SONIC_CAP0-i);
|
||
|
dev->dev_addr[i*2] = val;
|
||
|
dev->dev_addr[i*2+1] = val >> 8;
|
||
|
}
|
||
|
|
||
|
printk("HW Address ");
|
||
|
for (i = 0; i < 6; i++) {
|
||
|
printk("%2.2x", dev->dev_addr[i]);
|
||
|
if (i<5)
|
||
|
printk(":");
|
||
|
}
|
||
|
|
||
|
printk(" IRQ %d\n", irq);
|
||
|
|
||
|
err = -ENOMEM;
|
||
|
|
||
|
/* Initialize the device structure. */
|
||
|
if (dev->priv == NULL) {
|
||
|
/*
|
||
|
* the memory be located in the same 64kb segment
|
||
|
*/
|
||
|
lp = NULL;
|
||
|
i = 0;
|
||
|
do {
|
||
|
lp = kmalloc(sizeof(*lp), GFP_KERNEL);
|
||
|
if ((unsigned long) lp >> 16
|
||
|
!= ((unsigned long)lp + sizeof(*lp) ) >> 16) {
|
||
|
/* FIXME, free the memory later */
|
||
|
kfree(lp);
|
||
|
lp = NULL;
|
||
|
}
|
||
|
} while (lp == NULL && i++ < 20);
|
||
|
|
||
|
if (lp == NULL) {
|
||
|
printk("%s: couldn't allocate memory for descriptors\n",
|
||
|
dev->name);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
memset(lp, 0, sizeof(struct sonic_local));
|
||
|
|
||
|
/* get the virtual dma address */
|
||
|
lp->cda_laddr = vdma_alloc(CPHYSADDR(lp),sizeof(*lp));
|
||
|
if (lp->cda_laddr == ~0UL) {
|
||
|
printk("%s: couldn't get DMA page entry for "
|
||
|
"descriptors\n", dev->name);
|
||
|
goto out1;
|
||
|
}
|
||
|
|
||
|
lp->tda_laddr = lp->cda_laddr + sizeof (lp->cda);
|
||
|
lp->rra_laddr = lp->tda_laddr + sizeof (lp->tda);
|
||
|
lp->rda_laddr = lp->rra_laddr + sizeof (lp->rra);
|
||
|
|
||
|
/* allocate receive buffer area */
|
||
|
/* FIXME, maybe we should use skbs */
|
||
|
lp->rba = kmalloc(SONIC_NUM_RRS * SONIC_RBSIZE, GFP_KERNEL);
|
||
|
if (!lp->rba) {
|
||
|
printk("%s: couldn't allocate receive buffers\n",
|
||
|
dev->name);
|
||
|
goto out2;
|
||
|
}
|
||
|
|
||
|
/* get virtual dma address */
|
||
|
lp->rba_laddr = vdma_alloc(CPHYSADDR(lp->rba),
|
||
|
SONIC_NUM_RRS * SONIC_RBSIZE);
|
||
|
if (lp->rba_laddr == ~0UL) {
|
||
|
printk("%s: couldn't get DMA page entry for receive "
|
||
|
"buffers\n",dev->name);
|
||
|
goto out3;
|
||
|
}
|
||
|
|
||
|
/* now convert pointer to KSEG1 pointer */
|
||
|
lp->rba = (char *)KSEG1ADDR(lp->rba);
|
||
|
flush_cache_all();
|
||
|
dev->priv = (struct sonic_local *)KSEG1ADDR(lp);
|
||
|
}
|
||
|
|
||
|
lp = (struct sonic_local *)dev->priv;
|
||
|
dev->open = sonic_open;
|
||
|
dev->stop = sonic_close;
|
||
|
dev->hard_start_xmit = sonic_send_packet;
|
||
|
dev->get_stats = sonic_get_stats;
|
||
|
dev->set_multicast_list = &sonic_multicast_list;
|
||
|
dev->watchdog_timeo = TX_TIMEOUT;
|
||
|
|
||
|
/*
|
||
|
* clear tally counter
|
||
|
*/
|
||
|
SONIC_WRITE(SONIC_CRCT,0xffff);
|
||
|
SONIC_WRITE(SONIC_FAET,0xffff);
|
||
|
SONIC_WRITE(SONIC_MPT,0xffff);
|
||
|
|
||
|
return 0;
|
||
|
out3:
|
||
|
kfree(lp->rba);
|
||
|
out2:
|
||
|
vdma_free(lp->cda_laddr);
|
||
|
out1:
|
||
|
kfree(lp);
|
||
|
out:
|
||
|
release_region(base_addr, SONIC_MEM_SIZE);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Probe for a SONIC ethernet controller on a Mips Jazz board.
|
||
|
* Actually probing is superfluous but we're paranoid.
|
||
|
*/
|
||
|
static int __init jazz_sonic_probe(struct device *device)
|
||
|
{
|
||
|
struct net_device *dev;
|
||
|
struct sonic_local *lp;
|
||
|
unsigned long base_addr;
|
||
|
int err = 0;
|
||
|
int i;
|
||
|
|
||
|
/*
|
||
|
* Don't probe if we're not running on a Jazz board.
|
||
|
*/
|
||
|
if (mips_machgroup != MACH_GROUP_JAZZ)
|
||
|
return -ENODEV;
|
||
|
|
||
|
dev = alloc_etherdev(0);
|
||
|
if (!dev)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
netdev_boot_setup_check(dev);
|
||
|
base_addr = dev->base_addr;
|
||
|
|
||
|
if (base_addr >= KSEG0) { /* Check a single specified location. */
|
||
|
err = sonic_probe1(dev, base_addr, dev->irq);
|
||
|
} else if (base_addr != 0) { /* Don't probe at all. */
|
||
|
err = -ENXIO;
|
||
|
} else {
|
||
|
for (i = 0; sonic_portlist[i].port; i++) {
|
||
|
int io = sonic_portlist[i].port;
|
||
|
if (sonic_probe1(dev, io, sonic_portlist[i].irq) == 0)
|
||
|
break;
|
||
|
}
|
||
|
if (!sonic_portlist[i].port)
|
||
|
err = -ENODEV;
|
||
|
}
|
||
|
if (err)
|
||
|
goto out;
|
||
|
err = register_netdev(dev);
|
||
|
if (err)
|
||
|
goto out1;
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
out1:
|
||
|
lp = dev->priv;
|
||
|
vdma_free(lp->rba_laddr);
|
||
|
kfree(lp->rba);
|
||
|
vdma_free(lp->cda_laddr);
|
||
|
kfree(lp);
|
||
|
release_region(dev->base_addr, SONIC_MEM_SIZE);
|
||
|
out:
|
||
|
free_netdev(dev);
|
||
|
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* SONIC uses a normal IRQ
|
||
|
*/
|
||
|
#define sonic_request_irq request_irq
|
||
|
#define sonic_free_irq free_irq
|
||
|
|
||
|
#define sonic_chiptomem(x) KSEG1ADDR(vdma_log2phys(x))
|
||
|
|
||
|
#include "sonic.c"
|
||
|
|
||
|
static int __devexit jazz_sonic_device_remove (struct device *device)
|
||
|
{
|
||
|
struct net_device *dev = device->driver_data;
|
||
|
|
||
|
unregister_netdev (dev);
|
||
|
release_region (dev->base_addr, SONIC_MEM_SIZE);
|
||
|
free_netdev (dev);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static struct device_driver jazz_sonic_driver = {
|
||
|
.name = jazz_sonic_string,
|
||
|
.bus = &platform_bus_type,
|
||
|
.probe = jazz_sonic_probe,
|
||
|
.remove = __devexit_p(jazz_sonic_device_remove),
|
||
|
};
|
||
|
|
||
|
static void jazz_sonic_platform_release (struct device *device)
|
||
|
{
|
||
|
struct platform_device *pldev;
|
||
|
|
||
|
/* free device */
|
||
|
pldev = to_platform_device (device);
|
||
|
kfree (pldev);
|
||
|
}
|
||
|
|
||
|
static int __init jazz_sonic_init_module(void)
|
||
|
{
|
||
|
struct platform_device *pldev;
|
||
|
|
||
|
if (driver_register(&jazz_sonic_driver)) {
|
||
|
printk(KERN_ERR "Driver registration failed\n");
|
||
|
return -ENOMEM;
|
||
|
}
|
||
|
|
||
|
jazz_sonic_device = NULL;
|
||
|
|
||
|
if (!(pldev = kmalloc (sizeof (*pldev), GFP_KERNEL))) {
|
||
|
goto out_unregister;
|
||
|
}
|
||
|
|
||
|
memset(pldev, 0, sizeof (*pldev));
|
||
|
pldev->name = jazz_sonic_string;
|
||
|
pldev->id = 0;
|
||
|
pldev->dev.release = jazz_sonic_platform_release;
|
||
|
jazz_sonic_device = pldev;
|
||
|
|
||
|
if (platform_device_register (pldev)) {
|
||
|
kfree(pldev);
|
||
|
jazz_sonic_device = NULL;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
out_unregister:
|
||
|
platform_device_unregister(pldev);
|
||
|
|
||
|
return -ENOMEM;
|
||
|
}
|
||
|
|
||
|
static void __exit jazz_sonic_cleanup_module(void)
|
||
|
{
|
||
|
driver_unregister(&jazz_sonic_driver);
|
||
|
|
||
|
if (jazz_sonic_device) {
|
||
|
platform_device_unregister(jazz_sonic_device);
|
||
|
jazz_sonic_device = NULL;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
module_init(jazz_sonic_init_module);
|
||
|
module_exit(jazz_sonic_cleanup_module);
|