 25f8f54f6e
			
		
	
	
	25f8f54f6e
	
	
	
		
			
			Saves about 50KB of data. Old/new size of all objects: text data bss dec hex filename 563015 80096 130684 773795 bcea3 (TOTALS) 610916 32256 130632 773804 bceac (TOTALS) Signed-off-by: Joe Perches <joe@perches.com> Acked-by: Kurt Van Dijck <kurt.van.dijck@eia.be> (for drivers/net/can/softing/softing_cs.c) Signed-off-by: Dominik Brodowski <linux@dominikbrodowski.net>
		
			
				
	
	
		
			364 lines
		
	
	
	
		
			12 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			364 lines
		
	
	
	
		
			12 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*======================================================================
 | |
| 
 | |
|     A driver for PCMCIA IDE/ATA disk cards
 | |
| 
 | |
|     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.
 | |
| 
 | |
|     The initial developer of the original code is David A. Hinds
 | |
|     <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
 | |
|     are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
 | |
| 
 | |
|     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.
 | |
| 
 | |
| ======================================================================*/
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/ptrace.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/string.h>
 | |
| #include <linux/timer.h>
 | |
| #include <linux/ioport.h>
 | |
| #include <linux/ide.h>
 | |
| #include <linux/major.h>
 | |
| #include <linux/delay.h>
 | |
| #include <asm/io.h>
 | |
| #include <asm/system.h>
 | |
| 
 | |
| #include <pcmcia/cistpl.h>
 | |
| #include <pcmcia/ds.h>
 | |
| #include <pcmcia/cisreg.h>
 | |
| #include <pcmcia/ciscode.h>
 | |
| 
 | |
| #define DRV_NAME "ide-cs"
 | |
| 
 | |
| /*====================================================================*/
 | |
| 
 | |
| /* Module parameters */
 | |
| 
 | |
| MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
 | |
| MODULE_DESCRIPTION("PCMCIA ATA/IDE card driver");
 | |
| MODULE_LICENSE("Dual MPL/GPL");
 | |
| 
 | |
| /*====================================================================*/
 | |
| 
 | |
| typedef struct ide_info_t {
 | |
| 	struct pcmcia_device	*p_dev;
 | |
| 	struct ide_host		*host;
 | |
| 	int			ndev;
 | |
| } ide_info_t;
 | |
| 
 | |
| static void ide_release(struct pcmcia_device *);
 | |
| static int ide_config(struct pcmcia_device *);
 | |
| 
 | |
| static void ide_detach(struct pcmcia_device *p_dev);
 | |
| 
 | |
| static int ide_probe(struct pcmcia_device *link)
 | |
| {
 | |
|     ide_info_t *info;
 | |
| 
 | |
|     dev_dbg(&link->dev, "ide_attach()\n");
 | |
| 
 | |
|     /* Create new ide device */
 | |
|     info = kzalloc(sizeof(*info), GFP_KERNEL);
 | |
|     if (!info)
 | |
| 	return -ENOMEM;
 | |
| 
 | |
|     info->p_dev = link;
 | |
|     link->priv = info;
 | |
| 
 | |
|     link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO |
 | |
| 	    CONF_AUTO_SET_VPP | CONF_AUTO_CHECK_VCC;
 | |
| 
 | |
|     return ide_config(link);
 | |
| } /* ide_attach */
 | |
| 
 | |
| static void ide_detach(struct pcmcia_device *link)
 | |
| {
 | |
|     ide_info_t *info = link->priv;
 | |
| 
 | |
|     dev_dbg(&link->dev, "ide_detach(0x%p)\n", link);
 | |
| 
 | |
|     ide_release(link);
 | |
| 
 | |
|     kfree(info);
 | |
| } /* ide_detach */
 | |
| 
 | |
| static const struct ide_port_ops idecs_port_ops = {
 | |
| 	.quirkproc		= ide_undecoded_slave,
 | |
| };
 | |
| 
 | |
| static const struct ide_port_info idecs_port_info = {
 | |
| 	.port_ops		= &idecs_port_ops,
 | |
| 	.host_flags		= IDE_HFLAG_NO_DMA,
 | |
| 	.irq_flags		= IRQF_SHARED,
 | |
| 	.chipset		= ide_pci,
 | |
| };
 | |
| 
 | |
| static struct ide_host *idecs_register(unsigned long io, unsigned long ctl,
 | |
| 				unsigned long irq, struct pcmcia_device *handle)
 | |
| {
 | |
|     struct ide_host *host;
 | |
|     ide_hwif_t *hwif;
 | |
|     int i, rc;
 | |
|     struct ide_hw hw, *hws[] = { &hw };
 | |
| 
 | |
|     if (!request_region(io, 8, DRV_NAME)) {
 | |
| 	printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX not free.\n",
 | |
| 			DRV_NAME, io, io + 7);
 | |
| 	return NULL;
 | |
|     }
 | |
| 
 | |
|     if (!request_region(ctl, 1, DRV_NAME)) {
 | |
| 	printk(KERN_ERR "%s: I/O resource 0x%lX not free.\n",
 | |
| 			DRV_NAME, ctl);
 | |
| 	release_region(io, 8);
 | |
| 	return NULL;
 | |
|     }
 | |
| 
 | |
|     memset(&hw, 0, sizeof(hw));
 | |
|     ide_std_init_ports(&hw, io, ctl);
 | |
|     hw.irq = irq;
 | |
|     hw.dev = &handle->dev;
 | |
| 
 | |
|     rc = ide_host_add(&idecs_port_info, hws, 1, &host);
 | |
|     if (rc)
 | |
| 	goto out_release;
 | |
| 
 | |
|     hwif = host->ports[0];
 | |
| 
 | |
|     if (hwif->present)
 | |
| 	return host;
 | |
| 
 | |
|     /* retry registration in case device is still spinning up */
 | |
|     for (i = 0; i < 10; i++) {
 | |
| 	msleep(100);
 | |
| 	ide_port_scan(hwif);
 | |
| 	if (hwif->present)
 | |
| 	    return host;
 | |
|     }
 | |
| 
 | |
|     return host;
 | |
| 
 | |
| out_release:
 | |
|     release_region(ctl, 1);
 | |
|     release_region(io, 8);
 | |
|     return NULL;
 | |
| }
 | |
| 
 | |
| static int pcmcia_check_one_config(struct pcmcia_device *pdev, void *priv_data)
 | |
| {
 | |
| 	int *is_kme = priv_data;
 | |
| 
 | |
| 	if (!(pdev->resource[0]->flags & IO_DATA_PATH_WIDTH_8)) {
 | |
| 		pdev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
 | |
| 		pdev->resource[0]->flags |= IO_DATA_PATH_WIDTH_AUTO;
 | |
| 	}
 | |
| 	pdev->resource[1]->flags &= ~IO_DATA_PATH_WIDTH;
 | |
| 	pdev->resource[1]->flags |= IO_DATA_PATH_WIDTH_8;
 | |
| 
 | |
| 	if (pdev->resource[1]->end) {
 | |
| 		pdev->resource[0]->end = 8;
 | |
| 		pdev->resource[1]->end = (*is_kme) ? 2 : 1;
 | |
| 	} else {
 | |
| 		if (pdev->resource[0]->end < 16)
 | |
| 			return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	return pcmcia_request_io(pdev);
 | |
| }
 | |
| 
 | |
| static int ide_config(struct pcmcia_device *link)
 | |
| {
 | |
|     ide_info_t *info = link->priv;
 | |
|     int ret = 0, is_kme = 0;
 | |
|     unsigned long io_base, ctl_base;
 | |
|     struct ide_host *host;
 | |
| 
 | |
|     dev_dbg(&link->dev, "ide_config(0x%p)\n", link);
 | |
| 
 | |
|     is_kme = ((link->manf_id == MANFID_KME) &&
 | |
| 	      ((link->card_id == PRODID_KME_KXLC005_A) ||
 | |
| 	       (link->card_id == PRODID_KME_KXLC005_B)));
 | |
| 
 | |
|     if (pcmcia_loop_config(link, pcmcia_check_one_config, &is_kme)) {
 | |
| 	    link->config_flags &= ~CONF_AUTO_CHECK_VCC;
 | |
| 	    if (pcmcia_loop_config(link, pcmcia_check_one_config, &is_kme))
 | |
| 		    goto failed; /* No suitable config found */
 | |
|     }
 | |
|     io_base = link->resource[0]->start;
 | |
|     if (link->resource[1]->end)
 | |
| 	    ctl_base = link->resource[1]->start;
 | |
|     else
 | |
| 	    ctl_base = link->resource[0]->start + 0x0e;
 | |
| 
 | |
|     if (!link->irq)
 | |
| 	    goto failed;
 | |
| 
 | |
|     ret = pcmcia_enable_device(link);
 | |
|     if (ret)
 | |
| 	    goto failed;
 | |
| 
 | |
|     /* disable drive interrupts during IDE probe */
 | |
|     outb(0x02, ctl_base);
 | |
| 
 | |
|     /* special setup for KXLC005 card */
 | |
|     if (is_kme)
 | |
| 	outb(0x81, ctl_base+1);
 | |
| 
 | |
|      host = idecs_register(io_base, ctl_base, link->irq, link);
 | |
|      if (host == NULL && resource_size(link->resource[0]) == 0x20) {
 | |
| 	    outb(0x02, ctl_base + 0x10);
 | |
| 	    host = idecs_register(io_base + 0x10, ctl_base + 0x10,
 | |
| 				  link->irq, link);
 | |
|     }
 | |
| 
 | |
|     if (host == NULL)
 | |
| 	goto failed;
 | |
| 
 | |
|     info->ndev = 1;
 | |
|     info->host = host;
 | |
|     dev_info(&link->dev, "ide-cs: hd%c: Vpp = %d.%d\n",
 | |
| 	    'a' + host->ports[0]->index * 2,
 | |
| 	    link->vpp / 10, link->vpp % 10);
 | |
| 
 | |
|     return 0;
 | |
| 
 | |
| failed:
 | |
|     ide_release(link);
 | |
|     return -ENODEV;
 | |
| } /* ide_config */
 | |
| 
 | |
| static void ide_release(struct pcmcia_device *link)
 | |
| {
 | |
|     ide_info_t *info = link->priv;
 | |
|     struct ide_host *host = info->host;
 | |
| 
 | |
|     dev_dbg(&link->dev, "ide_release(0x%p)\n", link);
 | |
| 
 | |
|     if (info->ndev) {
 | |
| 	ide_hwif_t *hwif = host->ports[0];
 | |
| 	unsigned long data_addr, ctl_addr;
 | |
| 
 | |
| 	data_addr = hwif->io_ports.data_addr;
 | |
| 	ctl_addr = hwif->io_ports.ctl_addr;
 | |
| 
 | |
| 	ide_host_remove(host);
 | |
| 	info->ndev = 0;
 | |
| 
 | |
| 	release_region(ctl_addr, 1);
 | |
| 	release_region(data_addr, 8);
 | |
|     }
 | |
| 
 | |
|     pcmcia_disable_device(link);
 | |
| } /* ide_release */
 | |
| 
 | |
| 
 | |
| static const struct pcmcia_device_id ide_ids[] = {
 | |
| 	PCMCIA_DEVICE_FUNC_ID(4),
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0000, 0x0000),	/* Corsair */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0007, 0x0000),	/* Hitachi */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x000a, 0x0000),	/* I-O Data CFA */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x001c, 0x0001),	/* Mitsubishi CFA */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0032, 0x0704),
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0032, 0x2904),
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0045, 0x0401),	/* SanDisk CFA */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x004f, 0x0000),	/* Kingston */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0097, 0x1620), 	/* TI emulated */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0098, 0x0000),	/* Toshiba */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x00a4, 0x002d),
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x00ce, 0x0000),	/* Samsung */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x0319, 0x0000),	/* Hitachi */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x2080, 0x0001),
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x4e01, 0x0100),	/* Viking CFA */
 | |
| 	PCMCIA_DEVICE_MANF_CARD(0x4e01, 0x0200),	/* Lexar, Viking CFA */
 | |
| 	PCMCIA_DEVICE_PROD_ID123("Caravelle", "PSC-IDE ", "PSC000", 0x8c36137c, 0xd0693ab8, 0x2768a9f0),
 | |
| 	PCMCIA_DEVICE_PROD_ID123("CDROM", "IDE", "MCD-601p", 0x1b9179ca, 0xede88951, 0x0d902f74),
 | |
| 	PCMCIA_DEVICE_PROD_ID123("PCMCIA", "IDE CARD", "F1", 0x281f1c5d, 0x1907960c, 0xf7fde8b9),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("ARGOSY", "CD-ROM", 0x78f308dc, 0x66536591),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("ARGOSY", "PnPIDE", 0x78f308dc, 0x0c694728),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("CNF   ", "CD-ROM", 0x46d7db81, 0x66536591),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("CNF CD-M", "CD-ROM", 0x7d93b852, 0x66536591),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("Creative Technology Ltd.", "PCMCIA CD-ROM Interface Card", 0xff8c8a45, 0xfe8020c4),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("Digital Equipment Corporation.", "Digital Mobile Media CD-ROM", 0x17692a66, 0xef1dcbde),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("EXP", "CD+GAME", 0x6f58c983, 0x63c13aaf),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("EXP   ", "CD-ROM", 0x0a5c52fd, 0x66536591),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("EXP   ", "PnPIDE", 0x0a5c52fd, 0x0c694728),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("FREECOM", "PCCARD-IDE", 0x5714cbf7, 0x48e0ab8e),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("HITACHI", "FLASH", 0xf4f43949, 0x9eb86aae),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("HITACHI", "microdrive", 0xf4f43949, 0xa6d76178),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("Hyperstone", "Model1", 0x3d5b9ef5, 0xca6ab420),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("IBM", "microdrive", 0xb569a6e5, 0xa6d76178),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("IBM", "IBM17JSSFP20", 0xb569a6e5, 0xf2508753),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("KINGSTON", "CF CARD 1GB", 0x2e6d1829, 0x55d5bffb),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("KINGSTON", "CF CARD 4GB", 0x2e6d1829, 0x531e7d10),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("KINGSTON", "CF8GB", 0x2e6d1829, 0xacbe682e),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("IO DATA", "CBIDE2      ", 0x547e66dc, 0x8671043b),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("IO DATA", "PCIDE", 0x547e66dc, 0x5c5ab149),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("IO DATA", "PCIDEII", 0x547e66dc, 0xb3662674),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("LOOKMEET", "CBIDE2      ", 0xe37be2b5, 0x8671043b),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("M-Systems", "CF300", 0x7ed2ad87, 0x7e9e78ee),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("M-Systems", "CF500", 0x7ed2ad87, 0x7a13045c),
 | |
| 	PCMCIA_DEVICE_PROD_ID2("NinjaATA-", 0xebe0bd79),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("PCMCIA", "CD-ROM", 0x281f1c5d, 0x66536591),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("PCMCIA", "PnPIDE", 0x281f1c5d, 0x0c694728),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("SHUTTLE TECHNOLOGY LTD.", "PCCARD-IDE/ATAPI Adapter", 0x4a3f0ba0, 0x322560e1),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("SEAGATE", "ST1", 0x87c1b330, 0xe1f30883),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("SAMSUNG", "04/05/06", 0x43d74cb4, 0x6a22777d),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("SMI VENDOR", "SMI PRODUCT", 0x30896c92, 0x703cc5f6),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("TOSHIBA", "MK2001MPL", 0xb4585a1a, 0x3489e003),
 | |
| 	PCMCIA_DEVICE_PROD_ID1("TRANSCEND    512M   ", 0xd0909443),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("TRANSCEND", "TS1GCF45", 0x709b1bf1, 0xf68b6f32),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("TRANSCEND", "TS1GCF80", 0x709b1bf1, 0x2a54d4b1),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("TRANSCEND", "TS2GCF120", 0x709b1bf1, 0x969aa4f2),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("TRANSCEND", "TS4GCF120", 0x709b1bf1, 0xf54a91c8),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("TRANSCEND", "TS4GCF133", 0x709b1bf1, 0x7558f133),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("TRANSCEND", "TS8GCF133", 0x709b1bf1, 0xb2f89b47),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("WIT", "IDE16", 0x244e5994, 0x3e232852),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("WEIDA", "TWTTI", 0xcc7cf69c, 0x212bb918),
 | |
| 	PCMCIA_DEVICE_PROD_ID1("STI Flash", 0xe4a13209),
 | |
| 	PCMCIA_DEVICE_PROD_ID12("STI", "Flash 5.0", 0xbf2df18d, 0x8cb57a0e),
 | |
| 	PCMCIA_MFC_DEVICE_PROD_ID12(1, "SanDisk", "ConnectPlus", 0x7a954bd9, 0x74be00c6),
 | |
| 	PCMCIA_DEVICE_PROD_ID2("Flash Card", 0x5a362506),
 | |
| 	PCMCIA_DEVICE_NULL,
 | |
| };
 | |
| MODULE_DEVICE_TABLE(pcmcia, ide_ids);
 | |
| 
 | |
| static struct pcmcia_driver ide_cs_driver = {
 | |
| 	.owner		= THIS_MODULE,
 | |
| 	.name		= "ide-cs",
 | |
| 	.probe		= ide_probe,
 | |
| 	.remove		= ide_detach,
 | |
| 	.id_table       = ide_ids,
 | |
| };
 | |
| 
 | |
| static int __init init_ide_cs(void)
 | |
| {
 | |
| 	return pcmcia_register_driver(&ide_cs_driver);
 | |
| }
 | |
| 
 | |
| static void __exit exit_ide_cs(void)
 | |
| {
 | |
| 	pcmcia_unregister_driver(&ide_cs_driver);
 | |
| }
 | |
| 
 | |
| late_initcall(init_ide_cs);
 | |
| module_exit(exit_ide_cs);
 |