brintos

brintos / linux-shallow public Read only

0
0
Text · 4.5 KiB · 813403c Raw
191 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * sni_82596.c -- driver for intel 82596 ethernet controller, as4 *  		  used in older SNI RM machines5 */6 7#include <linux/module.h>8#include <linux/kernel.h>9#include <linux/string.h>10#include <linux/errno.h>11#include <linux/ioport.h>12#include <linux/interrupt.h>13#include <linux/delay.h>14#include <linux/netdevice.h>15#include <linux/etherdevice.h>16#include <linux/skbuff.h>17#include <linux/types.h>18#include <linux/bitops.h>19#include <linux/platform_device.h>20#include <linux/io.h>21#include <linux/irq.h>22 23#define SNI_82596_DRIVER_VERSION "SNI RM 82596 driver - Revision: 0.01"24 25static const char sni_82596_string[] = "snirm_82596";26 27#define SYSBUS      0x0000440028 29/* big endian CPU, 82596 little endian */30#define SWAP32(x)   cpu_to_le32((u32)(x))31#define SWAP16(x)   cpu_to_le16((u16)(x))32 33#define OPT_MPU_16BIT    0x0134 35#include "lib82596.c"36 37MODULE_AUTHOR("Thomas Bogendoerfer");38MODULE_DESCRIPTION("i82596 driver");39MODULE_LICENSE("GPL");40MODULE_ALIAS("platform:snirm_82596");41module_param(i596_debug, int, 0);42MODULE_PARM_DESC(i596_debug, "82596 debug mask");43 44static inline void ca(struct net_device *dev)45{46	struct i596_private *lp = netdev_priv(dev);47 48	writel(0, lp->ca);49}50 51 52static void mpu_port(struct net_device *dev, int c, dma_addr_t x)53{54	struct i596_private *lp = netdev_priv(dev);55 56	u32 v = (u32) (c) | (u32) (x);57 58	if (lp->options & OPT_MPU_16BIT) {59		writew(v & 0xffff, lp->mpu_port);60		wmb();  /* order writes to MPU port */61		udelay(1);62		writew(v >> 16, lp->mpu_port);63	} else {64		writel(v, lp->mpu_port);65		wmb();  /* order writes to MPU port */66		udelay(1);67		writel(v, lp->mpu_port);68	}69}70 71 72static int sni_82596_probe(struct platform_device *dev)73{74	struct	net_device *netdevice;75	struct i596_private *lp;76	struct  resource *res, *ca, *idprom, *options;77	int	retval = -ENOMEM;78	void __iomem *mpu_addr;79	void __iomem *ca_addr;80	u8 __iomem *eth_addr;81	u8 mac[ETH_ALEN];82 83	res = platform_get_resource(dev, IORESOURCE_MEM, 0);84	ca = platform_get_resource(dev, IORESOURCE_MEM, 1);85	options = platform_get_resource(dev, 0, 0);86	idprom = platform_get_resource(dev, IORESOURCE_MEM, 2);87	if (!res || !ca || !options || !idprom)88		return -ENODEV;89	mpu_addr = ioremap(res->start, 4);90	if (!mpu_addr)91		return -ENOMEM;92	ca_addr = ioremap(ca->start, 4);93	if (!ca_addr)94		goto probe_failed_free_mpu;95 96	printk(KERN_INFO "Found i82596 at 0x%x\n", res->start);97 98	netdevice = alloc_etherdev(sizeof(struct i596_private));99	if (!netdevice)100		goto probe_failed_free_ca;101 102	SET_NETDEV_DEV(netdevice, &dev->dev);103	platform_set_drvdata (dev, netdevice);104 105	netdevice->base_addr = res->start;106	netdevice->irq = platform_get_irq(dev, 0);107 108	eth_addr = ioremap(idprom->start, 0x10);109	if (!eth_addr)110		goto probe_failed;111 112	/* someone seems to like messed up stuff */113	mac[0] = readb(eth_addr + 0x0b);114	mac[1] = readb(eth_addr + 0x0a);115	mac[2] = readb(eth_addr + 0x09);116	mac[3] = readb(eth_addr + 0x08);117	mac[4] = readb(eth_addr + 0x07);118	mac[5] = readb(eth_addr + 0x06);119	eth_hw_addr_set(netdevice, mac);120	iounmap(eth_addr);121 122	if (netdevice->irq < 0) {123		printk(KERN_ERR "%s: IRQ not found for i82596 at 0x%lx\n",124			__FILE__, netdevice->base_addr);125		retval = netdevice->irq;126		goto probe_failed;127	}128 129	lp = netdev_priv(netdevice);130	lp->options = options->flags & IORESOURCE_BITS;131	lp->ca = ca_addr;132	lp->mpu_port = mpu_addr;133 134	lp->dma = dma_alloc_coherent(&dev->dev, sizeof(struct i596_dma),135				     &lp->dma_addr, GFP_KERNEL);136	if (!lp->dma)137		goto probe_failed;138 139	retval = i82596_probe(netdevice);140	if (retval)141		goto probe_failed_free_dma;142	return 0;143 144probe_failed_free_dma:145	dma_free_coherent(&dev->dev, sizeof(struct i596_dma), lp->dma,146			  lp->dma_addr);147probe_failed:148	free_netdev(netdevice);149probe_failed_free_ca:150	iounmap(ca_addr);151probe_failed_free_mpu:152	iounmap(mpu_addr);153	return retval;154}155 156static void sni_82596_driver_remove(struct platform_device *pdev)157{158	struct net_device *dev = platform_get_drvdata(pdev);159	struct i596_private *lp = netdev_priv(dev);160 161	unregister_netdev(dev);162	dma_free_coherent(&pdev->dev, sizeof(struct i596_private), lp->dma,163			  lp->dma_addr);164	iounmap(lp->ca);165	iounmap(lp->mpu_port);166	free_netdev (dev);167}168 169static struct platform_driver sni_82596_driver = {170	.probe	= sni_82596_probe,171	.remove_new = sni_82596_driver_remove,172	.driver	= {173		.name	= sni_82596_string,174	},175};176 177static int sni_82596_init(void)178{179	printk(KERN_INFO SNI_82596_DRIVER_VERSION "\n");180	return platform_driver_register(&sni_82596_driver);181}182 183 184static void __exit sni_82596_exit(void)185{186	platform_driver_unregister(&sni_82596_driver);187}188 189module_init(sni_82596_init);190module_exit(sni_82596_exit);191