drivers/net/jazzsonic.c - fp2-dev/kernel/msm - Gitiles

 /*
  * 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);
	/*
	* 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);