mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-31 09:36:25 +00:00 
			
		
		
		
	 299176206b
			
		
	
	
		299176206b
		
	
	
	
	
		
			
			From: Michal Piotrowski <michal.k.k.piotrowski@gmail.com> Signed-off-by: Michal Piotrowski <michal.k.k.piotrowski@gmail.com> Signed-off-by: Jeff Garzik <jeff@garzik.org>
		
			
				
	
	
		
			325 lines
		
	
	
		
			8.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			325 lines
		
	
	
		
			8.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* orinoco_nortel.c
 | |
|  *
 | |
|  * Driver for Prism II devices which would usually be driven by orinoco_cs,
 | |
|  * but are connected to the PCI bus by a PCI-to-PCMCIA adapter used in
 | |
|  * Nortel emobility, Symbol LA-4113 and Symbol LA-4123.
 | |
|  *
 | |
|  * Copyright (C) 2002 Tobias Hoffmann
 | |
|  *           (C) 2003 Christoph Jungegger <disdos@traum404.de>
 | |
|  *
 | |
|  * Some of this code is borrowed from orinoco_plx.c
 | |
|  *	Copyright (C) 2001 Daniel Barlow
 | |
|  * Some of this code is borrowed from orinoco_pci.c 
 | |
|  *  Copyright (C) 2001 Jean Tourrilhes
 | |
|  * Some of this code is "inspired" by linux-wlan-ng-0.1.10, but nothing
 | |
|  * has been copied from it. linux-wlan-ng-0.1.10 is originally :
 | |
|  *	Copyright (C) 1999 AbsoluteValue Systems, Inc.  All Rights Reserved.
 | |
|  * 
 | |
|  * The contents of this file are subject to the Mozilla Public License
 | |
|  * Version 1.1 (the "License"); you may not use this file except in
 | |
|  * compliance with the License. You may obtain a copy of the License
 | |
|  * at http://www.mozilla.org/MPL/
 | |
|  *
 | |
|  * Software distributed under the License is distributed on an "AS IS"
 | |
|  * basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See
 | |
|  * the License for the specific language governing rights and
 | |
|  * limitations under the License.
 | |
|  *
 | |
|  * Alternatively, the contents of this file may be used under the
 | |
|  * terms of the GNU General Public License version 2 (the "GPL"), in
 | |
|  * which case the provisions of the GPL are applicable instead of the
 | |
|  * above.  If you wish to allow the use of your version of this file
 | |
|  * only under the terms of the GPL and not to allow others to use your
 | |
|  * version of this file under the MPL, indicate your decision by
 | |
|  * deleting the provisions above and replace them with the notice and
 | |
|  * other provisions required by the GPL.  If you do not delete the
 | |
|  * provisions above, a recipient may use your version of this file
 | |
|  * under either the MPL or the GPL.
 | |
|  */
 | |
| 
 | |
| #define DRIVER_NAME "orinoco_nortel"
 | |
| #define PFX DRIVER_NAME ": "
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/pci.h>
 | |
| #include <pcmcia/cisreg.h>
 | |
| 
 | |
| #include "orinoco.h"
 | |
| #include "orinoco_pci.h"
 | |
| 
 | |
| #define COR_OFFSET    (0xe0)	/* COR attribute offset of Prism2 PC card */
 | |
| #define COR_VALUE     (COR_LEVEL_REQ | COR_FUNC_ENA)	/* Enable PC card with interrupt in level trigger */
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * Do a soft reset of the card using the Configuration Option Register
 | |
|  * We need this to get going...
 | |
|  * This is the part of the code that is strongly inspired from wlan-ng
 | |
|  *
 | |
|  * Note bis : Don't try to access HERMES_CMD during the reset phase.
 | |
|  * It just won't work !
 | |
|  */
 | |
| static int orinoco_nortel_cor_reset(struct orinoco_private *priv)
 | |
| {
 | |
| 	struct orinoco_pci_card *card = priv->card;
 | |
| 
 | |
| 	/* Assert the reset until the card notices */
 | |
| 	iowrite16(8, card->bridge_io + 2);
 | |
| 	ioread16(card->attr_io + COR_OFFSET);
 | |
| 	iowrite16(0x80, card->attr_io + COR_OFFSET);
 | |
| 	mdelay(1);
 | |
| 
 | |
| 	/* Give time for the card to recover from this hard effort */
 | |
| 	iowrite16(0, card->attr_io + COR_OFFSET);
 | |
| 	iowrite16(0, card->attr_io + COR_OFFSET);
 | |
| 	mdelay(1);
 | |
| 
 | |
| 	/* Set COR as usual */
 | |
| 	iowrite16(COR_VALUE, card->attr_io + COR_OFFSET);
 | |
| 	iowrite16(COR_VALUE, card->attr_io + COR_OFFSET);
 | |
| 	mdelay(1);
 | |
| 
 | |
| 	iowrite16(0x228, card->bridge_io + 2);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int orinoco_nortel_hw_init(struct orinoco_pci_card *card)
 | |
| {
 | |
| 	int i;
 | |
| 	u32 reg;
 | |
| 
 | |
| 	/* Setup bridge */
 | |
| 	if (ioread16(card->bridge_io) & 1) {
 | |
| 		printk(KERN_ERR PFX "brg1 answer1 wrong\n");
 | |
| 		return -EBUSY;
 | |
| 	}
 | |
| 	iowrite16(0x118, card->bridge_io + 2);
 | |
| 	iowrite16(0x108, card->bridge_io + 2);
 | |
| 	mdelay(30);
 | |
| 	iowrite16(0x8, card->bridge_io + 2);
 | |
| 	for (i = 0; i < 30; i++) {
 | |
| 		mdelay(30);
 | |
| 		if (ioread16(card->bridge_io) & 0x10) {
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 	if (i == 30) {
 | |
| 		printk(KERN_ERR PFX "brg1 timed out\n");
 | |
| 		return -EBUSY;
 | |
| 	}
 | |
| 	if (ioread16(card->attr_io + COR_OFFSET) & 1) {
 | |
| 		printk(KERN_ERR PFX "brg2 answer1 wrong\n");
 | |
| 		return -EBUSY;
 | |
| 	}
 | |
| 	if (ioread16(card->attr_io + COR_OFFSET + 2) & 1) {
 | |
| 		printk(KERN_ERR PFX "brg2 answer2 wrong\n");
 | |
| 		return -EBUSY;
 | |
| 	}
 | |
| 	if (ioread16(card->attr_io + COR_OFFSET + 4) & 1) {
 | |
| 		printk(KERN_ERR PFX "brg2 answer3 wrong\n");
 | |
| 		return -EBUSY;
 | |
| 	}
 | |
| 
 | |
| 	/* Set the PCMCIA COR register */
 | |
| 	iowrite16(COR_VALUE, card->attr_io + COR_OFFSET);
 | |
| 	mdelay(1);
 | |
| 	reg = ioread16(card->attr_io + COR_OFFSET);
 | |
| 	if (reg != COR_VALUE) {
 | |
| 		printk(KERN_ERR PFX "Error setting COR value (reg=%x)\n",
 | |
| 		       reg);
 | |
| 		return -EBUSY;
 | |
| 	}
 | |
| 
 | |
| 	/* Set LEDs */
 | |
| 	iowrite16(1, card->bridge_io + 10);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int orinoco_nortel_init_one(struct pci_dev *pdev,
 | |
| 				   const struct pci_device_id *ent)
 | |
| {
 | |
| 	int err;
 | |
| 	struct orinoco_private *priv;
 | |
| 	struct orinoco_pci_card *card;
 | |
| 	struct net_device *dev;
 | |
| 	void __iomem *hermes_io, *bridge_io, *attr_io;
 | |
| 
 | |
| 	err = pci_enable_device(pdev);
 | |
| 	if (err) {
 | |
| 		printk(KERN_ERR PFX "Cannot enable PCI device\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	err = pci_request_regions(pdev, DRIVER_NAME);
 | |
| 	if (err) {
 | |
| 		printk(KERN_ERR PFX "Cannot obtain PCI resources\n");
 | |
| 		goto fail_resources;
 | |
| 	}
 | |
| 
 | |
| 	bridge_io = pci_iomap(pdev, 0, 0);
 | |
| 	if (!bridge_io) {
 | |
| 		printk(KERN_ERR PFX "Cannot map bridge registers\n");
 | |
| 		err = -EIO;
 | |
| 		goto fail_map_bridge;
 | |
| 	}
 | |
| 
 | |
| 	attr_io = pci_iomap(pdev, 1, 0);
 | |
| 	if (!attr_io) {
 | |
| 		printk(KERN_ERR PFX "Cannot map PCMCIA attributes\n");
 | |
| 		err = -EIO;
 | |
| 		goto fail_map_attr;
 | |
| 	}
 | |
| 
 | |
| 	hermes_io = pci_iomap(pdev, 2, 0);
 | |
| 	if (!hermes_io) {
 | |
| 		printk(KERN_ERR PFX "Cannot map chipset registers\n");
 | |
| 		err = -EIO;
 | |
| 		goto fail_map_hermes;
 | |
| 	}
 | |
| 
 | |
| 	/* Allocate network device */
 | |
| 	dev = alloc_orinocodev(sizeof(*card), orinoco_nortel_cor_reset);
 | |
| 	if (!dev) {
 | |
| 		printk(KERN_ERR PFX "Cannot allocate network device\n");
 | |
| 		err = -ENOMEM;
 | |
| 		goto fail_alloc;
 | |
| 	}
 | |
| 
 | |
| 	priv = netdev_priv(dev);
 | |
| 	card = priv->card;
 | |
| 	card->bridge_io = bridge_io;
 | |
| 	card->attr_io = attr_io;
 | |
| 	SET_MODULE_OWNER(dev);
 | |
| 	SET_NETDEV_DEV(dev, &pdev->dev);
 | |
| 
 | |
| 	hermes_struct_init(&priv->hw, hermes_io, HERMES_16BIT_REGSPACING);
 | |
| 
 | |
| 	err = request_irq(pdev->irq, orinoco_interrupt, IRQF_SHARED,
 | |
| 			  dev->name, dev);
 | |
| 	if (err) {
 | |
| 		printk(KERN_ERR PFX "Cannot allocate IRQ %d\n", pdev->irq);
 | |
| 		err = -EBUSY;
 | |
| 		goto fail_irq;
 | |
| 	}
 | |
| 
 | |
| 	err = orinoco_nortel_hw_init(card);
 | |
| 	if (err) {
 | |
| 		printk(KERN_ERR PFX "Hardware initialization failed\n");
 | |
| 		goto fail;
 | |
| 	}
 | |
| 
 | |
| 	err = orinoco_nortel_cor_reset(priv);
 | |
| 	if (err) {
 | |
| 		printk(KERN_ERR PFX "Initial reset failed\n");
 | |
| 		goto fail;
 | |
| 	}
 | |
| 
 | |
| 	err = register_netdev(dev);
 | |
| 	if (err) {
 | |
| 		printk(KERN_ERR PFX "Cannot register network device\n");
 | |
| 		goto fail;
 | |
| 	}
 | |
| 
 | |
| 	pci_set_drvdata(pdev, dev);
 | |
| 	printk(KERN_DEBUG "%s: " DRIVER_NAME " at %s\n", dev->name,
 | |
| 	       pci_name(pdev));
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
|  fail:
 | |
| 	free_irq(pdev->irq, dev);
 | |
| 
 | |
|  fail_irq:
 | |
| 	pci_set_drvdata(pdev, NULL);
 | |
| 	free_orinocodev(dev);
 | |
| 
 | |
|  fail_alloc:
 | |
| 	pci_iounmap(pdev, hermes_io);
 | |
| 
 | |
|  fail_map_hermes:
 | |
| 	pci_iounmap(pdev, attr_io);
 | |
| 
 | |
|  fail_map_attr:
 | |
| 	pci_iounmap(pdev, bridge_io);
 | |
| 
 | |
|  fail_map_bridge:
 | |
| 	pci_release_regions(pdev);
 | |
| 
 | |
|  fail_resources:
 | |
| 	pci_disable_device(pdev);
 | |
| 
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void __devexit orinoco_nortel_remove_one(struct pci_dev *pdev)
 | |
| {
 | |
| 	struct net_device *dev = pci_get_drvdata(pdev);
 | |
| 	struct orinoco_private *priv = netdev_priv(dev);
 | |
| 	struct orinoco_pci_card *card = priv->card;
 | |
| 
 | |
| 	/* Clear LEDs */
 | |
| 	iowrite16(0, card->bridge_io + 10);
 | |
| 
 | |
| 	unregister_netdev(dev);
 | |
| 	free_irq(pdev->irq, dev);
 | |
| 	pci_set_drvdata(pdev, NULL);
 | |
| 	free_orinocodev(dev);
 | |
| 	pci_iounmap(pdev, priv->hw.iobase);
 | |
| 	pci_iounmap(pdev, card->attr_io);
 | |
| 	pci_iounmap(pdev, card->bridge_io);
 | |
| 	pci_release_regions(pdev);
 | |
| 	pci_disable_device(pdev);
 | |
| }
 | |
| 
 | |
| static struct pci_device_id orinoco_nortel_id_table[] = {
 | |
| 	/* Nortel emobility PCI */
 | |
| 	{0x126c, 0x8030, PCI_ANY_ID, PCI_ANY_ID,},
 | |
| 	/* Symbol LA-4123 PCI */
 | |
| 	{0x1562, 0x0001, PCI_ANY_ID, PCI_ANY_ID,},
 | |
| 	{0,},
 | |
| };
 | |
| 
 | |
| MODULE_DEVICE_TABLE(pci, orinoco_nortel_id_table);
 | |
| 
 | |
| static struct pci_driver orinoco_nortel_driver = {
 | |
| 	.name		= DRIVER_NAME,
 | |
| 	.id_table	= orinoco_nortel_id_table,
 | |
| 	.probe		= orinoco_nortel_init_one,
 | |
| 	.remove		= __devexit_p(orinoco_nortel_remove_one),
 | |
| 	.suspend	= orinoco_pci_suspend,
 | |
| 	.resume		= orinoco_pci_resume,
 | |
| };
 | |
| 
 | |
| static char version[] __initdata = DRIVER_NAME " " DRIVER_VERSION
 | |
| 	" (Tobias Hoffmann & Christoph Jungegger <disdos@traum404.de>)";
 | |
| MODULE_AUTHOR("Christoph Jungegger <disdos@traum404.de>");
 | |
| MODULE_DESCRIPTION
 | |
|     ("Driver for wireless LAN cards using the Nortel PCI bridge");
 | |
| MODULE_LICENSE("Dual MPL/GPL");
 | |
| 
 | |
| static int __init orinoco_nortel_init(void)
 | |
| {
 | |
| 	printk(KERN_DEBUG "%s\n", version);
 | |
| 	return pci_register_driver(&orinoco_nortel_driver);
 | |
| }
 | |
| 
 | |
| static void __exit orinoco_nortel_exit(void)
 | |
| {
 | |
| 	pci_unregister_driver(&orinoco_nortel_driver);
 | |
| }
 | |
| 
 | |
| module_init(orinoco_nortel_init);
 | |
| module_exit(orinoco_nortel_exit);
 | |
| 
 | |
| /*
 | |
|  * Local variables:
 | |
|  *  c-indent-level: 8
 | |
|  *  c-basic-offset: 8
 | |
|  *  tab-width: 8
 | |
|  * End:
 | |
|  */
 |