drm/tests: hdmi: Fix memory leaks in drm_display_mode_from_cea_vic()
[drm/drm-misc.git] / drivers / scsi / aic7xxx / aic7xxx_osm_pci.c
blob198440dc0918a32e92e7dfb5d07cc80d19483071
1 /*
2 * Linux driver attachment glue for PCI based controllers.
4 * Copyright (c) 2000-2001 Adaptec Inc.
5 * All rights reserved.
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions, and the following disclaimer,
12 * without modification.
13 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
14 * substantially similar to the "NO WARRANTY" disclaimer below
15 * ("Disclaimer") and any redistribution must be conditioned upon
16 * including a substantially similar Disclaimer requirement for further
17 * binary redistribution.
18 * 3. Neither the names of the above-listed copyright holders nor the names
19 * of any contributors may be used to endorse or promote products derived
20 * from this software without specific prior written permission.
22 * Alternatively, this software may be distributed under the terms of the
23 * GNU General Public License ("GPL") version 2 as published by the Free
24 * Software Foundation.
26 * NO WARRANTY
27 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
28 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
29 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
30 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
31 * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
32 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
33 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
34 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
35 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
36 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 * POSSIBILITY OF SUCH DAMAGES.
39 * $Id: //depot/aic7xxx/linux/drivers/scsi/aic7xxx/aic7xxx_osm_pci.c#47 $
42 #include "aic7xxx_osm.h"
43 #include "aic7xxx_pci.h"
45 /* Define the macro locally since it's different for different class of chips.
47 #define ID(x) ID_C(x, PCI_CLASS_STORAGE_SCSI)
49 static const struct pci_device_id ahc_linux_pci_id_table[] = {
50 /* aic7850 based controllers */
51 ID(ID_AHA_2902_04_10_15_20C_30C),
52 /* aic7860 based controllers */
53 ID(ID_AHA_2930CU),
54 ID(ID_AHA_1480A & ID_DEV_VENDOR_MASK),
55 ID(ID_AHA_2940AU_0 & ID_DEV_VENDOR_MASK),
56 ID(ID_AHA_2940AU_CN & ID_DEV_VENDOR_MASK),
57 ID(ID_AHA_2930C_VAR & ID_DEV_VENDOR_MASK),
58 /* aic7870 based controllers */
59 ID(ID_AHA_2940),
60 ID(ID_AHA_3940),
61 ID(ID_AHA_398X),
62 ID(ID_AHA_2944),
63 ID(ID_AHA_3944),
64 ID(ID_AHA_4944),
65 /* aic7880 based controllers */
66 ID(ID_AHA_2940U & ID_DEV_VENDOR_MASK),
67 ID(ID_AHA_3940U & ID_DEV_VENDOR_MASK),
68 ID(ID_AHA_2944U & ID_DEV_VENDOR_MASK),
69 ID(ID_AHA_3944U & ID_DEV_VENDOR_MASK),
70 ID(ID_AHA_398XU & ID_DEV_VENDOR_MASK),
71 ID(ID_AHA_4944U & ID_DEV_VENDOR_MASK),
72 ID(ID_AHA_2930U & ID_DEV_VENDOR_MASK),
73 ID(ID_AHA_2940U_PRO & ID_DEV_VENDOR_MASK),
74 ID(ID_AHA_2940U_CN & ID_DEV_VENDOR_MASK),
75 /* aic7890 based controllers */
76 ID(ID_AHA_2930U2),
77 ID(ID_AHA_2940U2B),
78 ID(ID_AHA_2940U2_OEM),
79 ID(ID_AHA_2940U2),
80 ID(ID_AHA_2950U2B),
81 ID16(ID_AIC7890_ARO & ID_AIC7895_ARO_MASK),
82 ID(ID_AAA_131U2),
83 /* aic7890 based controllers */
84 ID(ID_AHA_29160),
85 ID(ID_AHA_29160_CPQ),
86 ID(ID_AHA_29160N),
87 ID(ID_AHA_29160C),
88 ID(ID_AHA_29160B),
89 ID(ID_AHA_19160B),
90 ID(ID_AIC7892_ARO),
91 /* aic7892 based controllers */
92 ID(ID_AHA_2940U_DUAL),
93 ID(ID_AHA_3940AU),
94 ID(ID_AHA_3944AU),
95 ID(ID_AIC7895_ARO),
96 ID(ID_AHA_3950U2B_0),
97 ID(ID_AHA_3950U2B_1),
98 ID(ID_AHA_3950U2D_0),
99 ID(ID_AHA_3950U2D_1),
100 ID(ID_AIC7896_ARO),
101 /* aic7899 based controllers */
102 ID(ID_AHA_3960D),
103 ID(ID_AHA_3960D_CPQ),
104 ID(ID_AIC7899_ARO),
105 /* Generic chip probes for devices we don't know exactly. */
106 ID(ID_AIC7850 & ID_DEV_VENDOR_MASK),
107 ID(ID_AIC7855 & ID_DEV_VENDOR_MASK),
108 ID(ID_AIC7859 & ID_DEV_VENDOR_MASK),
109 ID(ID_AIC7860 & ID_DEV_VENDOR_MASK),
110 ID(ID_AIC7870 & ID_DEV_VENDOR_MASK),
111 ID(ID_AIC7880 & ID_DEV_VENDOR_MASK),
112 ID16(ID_AIC7890 & ID_9005_GENERIC_MASK),
113 ID16(ID_AIC7892 & ID_9005_GENERIC_MASK),
114 ID(ID_AIC7895 & ID_DEV_VENDOR_MASK),
115 ID16(ID_AIC7896 & ID_9005_GENERIC_MASK),
116 ID16(ID_AIC7899 & ID_9005_GENERIC_MASK),
117 ID(ID_AIC7810 & ID_DEV_VENDOR_MASK),
118 ID(ID_AIC7815 & ID_DEV_VENDOR_MASK),
119 { 0 }
122 MODULE_DEVICE_TABLE(pci, ahc_linux_pci_id_table);
124 static int __maybe_unused
125 ahc_linux_pci_dev_suspend(struct device *dev)
127 struct ahc_softc *ahc = dev_get_drvdata(dev);
129 return ahc_suspend(ahc);
132 static int __maybe_unused
133 ahc_linux_pci_dev_resume(struct device *dev)
135 struct ahc_softc *ahc = dev_get_drvdata(dev);
137 ahc_pci_resume(ahc);
139 return (ahc_resume(ahc));
142 static void
143 ahc_linux_pci_dev_remove(struct pci_dev *pdev)
145 struct ahc_softc *ahc = pci_get_drvdata(pdev);
146 u_long s;
148 if (ahc->platform_data && ahc->platform_data->host)
149 scsi_remove_host(ahc->platform_data->host);
151 ahc_lock(ahc, &s);
152 ahc_intr_enable(ahc, FALSE);
153 ahc_unlock(ahc, &s);
154 ahc_free(ahc);
157 static void
158 ahc_linux_pci_inherit_flags(struct ahc_softc *ahc)
160 struct pci_dev *pdev = ahc->dev_softc, *master_pdev;
161 unsigned int master_devfn = PCI_DEVFN(PCI_SLOT(pdev->devfn), 0);
163 master_pdev = pci_get_slot(pdev->bus, master_devfn);
164 if (master_pdev) {
165 struct ahc_softc *master = pci_get_drvdata(master_pdev);
166 if (master) {
167 ahc->flags &= ~AHC_BIOS_ENABLED;
168 ahc->flags |= master->flags & AHC_BIOS_ENABLED;
170 ahc->flags &= ~AHC_PRIMARY_CHANNEL;
171 ahc->flags |= master->flags & AHC_PRIMARY_CHANNEL;
172 } else
173 printk(KERN_ERR "aic7xxx: no multichannel peer found!\n");
174 pci_dev_put(master_pdev);
178 static int
179 ahc_linux_pci_dev_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
181 char buf[80];
182 const uint64_t mask_39bit = 0x7FFFFFFFFFULL;
183 struct ahc_softc *ahc;
184 ahc_dev_softc_t pci;
185 const struct ahc_pci_identity *entry;
186 char *name;
187 int error;
188 struct device *dev = &pdev->dev;
190 pci = pdev;
191 entry = ahc_find_pci_device(pci);
192 if (entry == NULL)
193 return (-ENODEV);
196 * Allocate a softc for this card and
197 * set it up for attachment by our
198 * common detect routine.
200 sprintf(buf, "ahc_pci:%d:%d:%d",
201 ahc_get_pci_bus(pci),
202 ahc_get_pci_slot(pci),
203 ahc_get_pci_function(pci));
204 name = kstrdup(buf, GFP_ATOMIC);
205 if (name == NULL)
206 return (-ENOMEM);
207 ahc = ahc_alloc(NULL, name);
208 if (ahc == NULL)
209 return (-ENOMEM);
210 if (pci_enable_device(pdev)) {
211 ahc_free(ahc);
212 return (-ENODEV);
214 pci_set_master(pdev);
216 if (sizeof(dma_addr_t) > 4
217 && ahc->features & AHC_LARGE_SCBS
218 && dma_set_mask(dev, mask_39bit) == 0
219 && dma_get_required_mask(dev) > DMA_BIT_MASK(32)) {
220 ahc->flags |= AHC_39BIT_ADDRESSING;
221 } else {
222 if (dma_set_mask(dev, DMA_BIT_MASK(32))) {
223 ahc_free(ahc);
224 printk(KERN_WARNING "aic7xxx: No suitable DMA available.\n");
225 return (-ENODEV);
228 ahc->dev_softc = pci;
229 ahc->dev = &pci->dev;
230 error = ahc_pci_config(ahc, entry);
231 if (error != 0) {
232 ahc_free(ahc);
233 return (-error);
237 * Second Function PCI devices need to inherit some
238 * settings from function 0.
240 if ((ahc->features & AHC_MULTI_FUNC) && PCI_FUNC(pdev->devfn) != 0)
241 ahc_linux_pci_inherit_flags(ahc);
243 pci_set_drvdata(pdev, ahc);
244 return ahc_linux_register_host(ahc, &aic7xxx_driver_template);
247 /******************************* PCI Routines *********************************/
248 uint32_t
249 ahc_pci_read_config(ahc_dev_softc_t pci, int reg, int width)
251 switch (width) {
252 case 1:
254 uint8_t retval;
256 pci_read_config_byte(pci, reg, &retval);
257 return (retval);
259 case 2:
261 uint16_t retval;
262 pci_read_config_word(pci, reg, &retval);
263 return (retval);
265 case 4:
267 uint32_t retval;
268 pci_read_config_dword(pci, reg, &retval);
269 return (retval);
271 default:
272 panic("ahc_pci_read_config: Read size too big");
273 /* NOTREACHED */
274 return (0);
278 void
279 ahc_pci_write_config(ahc_dev_softc_t pci, int reg, uint32_t value, int width)
281 switch (width) {
282 case 1:
283 pci_write_config_byte(pci, reg, value);
284 break;
285 case 2:
286 pci_write_config_word(pci, reg, value);
287 break;
288 case 4:
289 pci_write_config_dword(pci, reg, value);
290 break;
291 default:
292 panic("ahc_pci_write_config: Write size too big");
293 /* NOTREACHED */
297 static SIMPLE_DEV_PM_OPS(ahc_linux_pci_dev_pm_ops,
298 ahc_linux_pci_dev_suspend,
299 ahc_linux_pci_dev_resume);
301 static struct pci_driver aic7xxx_pci_driver = {
302 .name = "aic7xxx",
303 .probe = ahc_linux_pci_dev_probe,
304 .driver.pm = &ahc_linux_pci_dev_pm_ops,
305 .remove = ahc_linux_pci_dev_remove,
306 .id_table = ahc_linux_pci_id_table
310 ahc_linux_pci_init(void)
312 return pci_register_driver(&aic7xxx_pci_driver);
315 void
316 ahc_linux_pci_exit(void)
318 pci_unregister_driver(&aic7xxx_pci_driver);
321 static int
322 ahc_linux_pci_reserve_io_region(struct ahc_softc *ahc, resource_size_t *base)
324 if (aic7xxx_allow_memio == 0)
325 return (ENOMEM);
327 *base = pci_resource_start(ahc->dev_softc, 0);
328 if (*base == 0)
329 return (ENOMEM);
330 if (!request_region(*base, 256, "aic7xxx"))
331 return (ENOMEM);
332 return (0);
335 static int
336 ahc_linux_pci_reserve_mem_region(struct ahc_softc *ahc,
337 resource_size_t *bus_addr,
338 uint8_t __iomem **maddr)
340 resource_size_t start;
341 int error;
343 error = 0;
344 start = pci_resource_start(ahc->dev_softc, 1);
345 if (start != 0) {
346 *bus_addr = start;
347 if (!request_mem_region(start, 0x1000, "aic7xxx"))
348 error = ENOMEM;
349 if (error == 0) {
350 *maddr = ioremap(start, 256);
351 if (*maddr == NULL) {
352 error = ENOMEM;
353 release_mem_region(start, 0x1000);
356 } else
357 error = ENOMEM;
358 return (error);
362 ahc_pci_map_registers(struct ahc_softc *ahc)
364 uint32_t command;
365 resource_size_t base;
366 uint8_t __iomem *maddr;
367 int error;
370 * If its allowed, we prefer memory mapped access.
372 command = ahc_pci_read_config(ahc->dev_softc, PCIR_COMMAND, 4);
373 command &= ~(PCIM_CMD_PORTEN|PCIM_CMD_MEMEN);
374 base = 0;
375 maddr = NULL;
376 error = ahc_linux_pci_reserve_mem_region(ahc, &base, &maddr);
377 if (error == 0) {
378 ahc->platform_data->mem_busaddr = base;
379 ahc->tag = BUS_SPACE_MEMIO;
380 ahc->bsh.maddr = maddr;
381 ahc_pci_write_config(ahc->dev_softc, PCIR_COMMAND,
382 command | PCIM_CMD_MEMEN, 4);
385 * Do a quick test to see if memory mapped
386 * I/O is functioning correctly.
388 if (ahc_pci_test_register_access(ahc) != 0) {
390 printk("aic7xxx: PCI Device %d:%d:%d "
391 "failed memory mapped test. Using PIO.\n",
392 ahc_get_pci_bus(ahc->dev_softc),
393 ahc_get_pci_slot(ahc->dev_softc),
394 ahc_get_pci_function(ahc->dev_softc));
395 iounmap(maddr);
396 release_mem_region(ahc->platform_data->mem_busaddr,
397 0x1000);
398 ahc->bsh.maddr = NULL;
399 maddr = NULL;
400 } else
401 command |= PCIM_CMD_MEMEN;
402 } else {
403 printk("aic7xxx: PCI%d:%d:%d MEM region 0x%llx "
404 "unavailable. Cannot memory map device.\n",
405 ahc_get_pci_bus(ahc->dev_softc),
406 ahc_get_pci_slot(ahc->dev_softc),
407 ahc_get_pci_function(ahc->dev_softc),
408 (unsigned long long)base);
412 * We always prefer memory mapped access.
414 if (maddr == NULL) {
416 error = ahc_linux_pci_reserve_io_region(ahc, &base);
417 if (error == 0) {
418 ahc->tag = BUS_SPACE_PIO;
419 ahc->bsh.ioport = (u_long)base;
420 command |= PCIM_CMD_PORTEN;
421 } else {
422 printk("aic7xxx: PCI%d:%d:%d IO region 0x%llx[0..255] "
423 "unavailable. Cannot map device.\n",
424 ahc_get_pci_bus(ahc->dev_softc),
425 ahc_get_pci_slot(ahc->dev_softc),
426 ahc_get_pci_function(ahc->dev_softc),
427 (unsigned long long)base);
430 ahc_pci_write_config(ahc->dev_softc, PCIR_COMMAND, command, 4);
431 return (error);
435 ahc_pci_map_int(struct ahc_softc *ahc)
437 int error;
439 error = request_irq(ahc->dev_softc->irq, ahc_linux_isr,
440 IRQF_SHARED, "aic7xxx", ahc);
441 if (error == 0)
442 ahc->platform_data->irq = ahc->dev_softc->irq;
444 return (-error);