Blame view

kernel/linux-imx6_3.14.28/drivers/ide/ide-generic.c 3.87 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
  /*
   * generic/default IDE host driver
   *
   * Copyright (C) 2004, 2008-2009 Bartlomiej Zolnierkiewicz
   * This code was split off from ide.c.  See it for original copyrights.
   *
   * May be copied or modified under the terms of the GNU General Public License.
   */
  
  #include <linux/kernel.h>
  #include <linux/init.h>
  #include <linux/module.h>
  #include <linux/ide.h>
  #include <linux/pci_ids.h>
  
  /* FIXME: convert arm and m32r to use ide_platform host driver */
  #ifdef CONFIG_ARM
  #include <asm/irq.h>
  #endif
  #ifdef CONFIG_M32R
  #include <asm/m32r.h>
  #endif
  
  #define DRV_NAME	"ide_generic"
  
  static int probe_mask;
  module_param(probe_mask, int, 0);
  MODULE_PARM_DESC(probe_mask, "probe mask for legacy ISA IDE ports");
  
  static const struct ide_port_info ide_generic_port_info = {
  	.host_flags		= IDE_HFLAG_NO_DMA,
  	.chipset		= ide_generic,
  };
  
  #ifdef CONFIG_ARM
  static const u16 legacy_bases[] = { 0x1f0 };
  static const int legacy_irqs[]  = { IRQ_HARDDISK };
  #elif defined(CONFIG_PLAT_M32700UT) || defined(CONFIG_PLAT_MAPPI2) || \
        defined(CONFIG_PLAT_OPSPUT)
  static const u16 legacy_bases[] = { 0x1f0 };
  static const int legacy_irqs[]  = { PLD_IRQ_CFIREQ };
  #elif defined(CONFIG_PLAT_MAPPI3)
  static const u16 legacy_bases[] = { 0x1f0, 0x170 };
  static const int legacy_irqs[]  = { PLD_IRQ_CFIREQ, PLD_IRQ_IDEIREQ };
  #elif defined(CONFIG_ALPHA)
  static const u16 legacy_bases[] = { 0x1f0, 0x170, 0x1e8, 0x168 };
  static const int legacy_irqs[]  = { 14, 15, 11, 10 };
  #else
  static const u16 legacy_bases[] = { 0x1f0, 0x170, 0x1e8, 0x168, 0x1e0, 0x160 };
  static const int legacy_irqs[]  = { 14, 15, 11, 10, 8, 12 };
  #endif
  
  static void ide_generic_check_pci_legacy_iobases(int *primary, int *secondary)
  {
  #ifdef CONFIG_PCI
  	struct pci_dev *p = NULL;
  	u16 val;
  
  	for_each_pci_dev(p) {
  		if (pci_resource_start(p, 0) == 0x1f0)
  			*primary = 1;
  		if (pci_resource_start(p, 2) == 0x170)
  			*secondary = 1;
  
  		/* Cyrix CS55{1,2}0 pre SFF MWDMA ATA on the bridge */
  		if (p->vendor == PCI_VENDOR_ID_CYRIX &&
  		    (p->device == PCI_DEVICE_ID_CYRIX_5510 ||
  		     p->device == PCI_DEVICE_ID_CYRIX_5520))
  			*primary = *secondary = 1;
  
  		/* Intel MPIIX - PIO ATA on non PCI side of bridge */
  		if (p->vendor == PCI_VENDOR_ID_INTEL &&
  		    p->device == PCI_DEVICE_ID_INTEL_82371MX) {
  			pci_read_config_word(p, 0x6C, &val);
  			if (val & 0x8000) {
  				/* ATA port enabled */
  				if (val & 0x4000)
  					*secondary = 1;
  				else
  					*primary = 1;
  			}
  		}
  	}
  #endif
  }
  
  static int __init ide_generic_init(void)
  {
  	struct ide_hw hw, *hws[] = { &hw };
  	unsigned long io_addr;
  	int i, rc = 0, primary = 0, secondary = 0;
  
  	ide_generic_check_pci_legacy_iobases(&primary, &secondary);
  
  	if (!probe_mask) {
  		printk(KERN_INFO DRV_NAME ": please use \"probe_mask=0x3f\" "
  		     "module parameter for probing all legacy ISA IDE ports
  ");
  
  		if (primary == 0)
  			probe_mask |= 0x1;
  
  		if (secondary == 0)
  			probe_mask |= 0x2;
  	} else
  		printk(KERN_INFO DRV_NAME ": enforcing probing of I/O ports "
  			"upon user request
  ");
  
  	for (i = 0; i < ARRAY_SIZE(legacy_bases); i++) {
  		io_addr = legacy_bases[i];
  
  		if ((probe_mask & (1 << i)) && io_addr) {
  			if (!request_region(io_addr, 8, DRV_NAME)) {
  				printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX "
  						"not free.
  ",
  						DRV_NAME, io_addr, io_addr + 7);
  				rc = -EBUSY;
  				continue;
  			}
  
  			if (!request_region(io_addr + 0x206, 1, DRV_NAME)) {
  				printk(KERN_ERR "%s: I/O resource 0x%lX "
  						"not free.
  ",
  						DRV_NAME, io_addr + 0x206);
  				release_region(io_addr, 8);
  				rc = -EBUSY;
  				continue;
  			}
  
  			memset(&hw, 0, sizeof(hw));
  			ide_std_init_ports(&hw, io_addr, io_addr + 0x206);
  #ifdef CONFIG_IA64
  			hw.irq = isa_irq_to_vector(legacy_irqs[i]);
  #else
  			hw.irq = legacy_irqs[i];
  #endif
  			rc = ide_host_add(&ide_generic_port_info, hws, 1, NULL);
  			if (rc) {
  				release_region(io_addr + 0x206, 1);
  				release_region(io_addr, 8);
  			}
  		}
  	}
  
  	return rc;
  }
  
  module_init(ide_generic_init);
  
  MODULE_LICENSE("GPL");