| Bartlomiej Zolnierkiewicz | 7f92b11 | 2008-12-29 20:27:37 +0100 | [diff] [blame] | 1 | #include <linux/kernel.h> | 
| Paul Gortmaker | 38789fd | 2011-07-17 15:33:58 -0400 | [diff] [blame] | 2 | #include <linux/export.h> | 
| Bartlomiej Zolnierkiewicz | 7f92b11 | 2008-12-29 20:27:37 +0100 | [diff] [blame] | 3 | #include <linux/ide.h> | 
|  | 4 |  | 
| Bartlomiej Zolnierkiewicz | 9f36d31 | 2009-05-17 19:12:25 +0200 | [diff] [blame] | 5 | static void ide_legacy_init_one(struct ide_hw **hws, struct ide_hw *hw, | 
| Bartlomiej Zolnierkiewicz | 7f92b11 | 2008-12-29 20:27:37 +0100 | [diff] [blame] | 6 | u8 port_no, const struct ide_port_info *d, | 
|  | 7 | unsigned long config) | 
|  | 8 | { | 
|  | 9 | unsigned long base, ctl; | 
|  | 10 | int irq; | 
|  | 11 |  | 
|  | 12 | if (port_no == 0) { | 
|  | 13 | base = 0x1f0; | 
|  | 14 | ctl  = 0x3f6; | 
|  | 15 | irq  = 14; | 
|  | 16 | } else { | 
|  | 17 | base = 0x170; | 
|  | 18 | ctl  = 0x376; | 
|  | 19 | irq  = 15; | 
|  | 20 | } | 
|  | 21 |  | 
|  | 22 | if (!request_region(base, 8, d->name)) { | 
|  | 23 | printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX not free.\n", | 
|  | 24 | d->name, base, base + 7); | 
|  | 25 | return; | 
|  | 26 | } | 
|  | 27 |  | 
|  | 28 | if (!request_region(ctl, 1, d->name)) { | 
|  | 29 | printk(KERN_ERR "%s: I/O resource 0x%lX not free.\n", | 
|  | 30 | d->name, ctl); | 
|  | 31 | release_region(base, 8); | 
|  | 32 | return; | 
|  | 33 | } | 
|  | 34 |  | 
|  | 35 | ide_std_init_ports(hw, base, ctl); | 
|  | 36 | hw->irq = irq; | 
| Bartlomiej Zolnierkiewicz | 7f92b11 | 2008-12-29 20:27:37 +0100 | [diff] [blame] | 37 | hw->config = config; | 
|  | 38 |  | 
|  | 39 | hws[port_no] = hw; | 
|  | 40 | } | 
|  | 41 |  | 
|  | 42 | int ide_legacy_device_add(const struct ide_port_info *d, unsigned long config) | 
|  | 43 | { | 
| Bartlomiej Zolnierkiewicz | 9f36d31 | 2009-05-17 19:12:25 +0200 | [diff] [blame] | 44 | struct ide_hw hw[2], *hws[] = { NULL, NULL }; | 
| Bartlomiej Zolnierkiewicz | 7f92b11 | 2008-12-29 20:27:37 +0100 | [diff] [blame] | 45 |  | 
|  | 46 | memset(&hw, 0, sizeof(hw)); | 
|  | 47 |  | 
|  | 48 | if ((d->host_flags & IDE_HFLAG_QD_2ND_PORT) == 0) | 
|  | 49 | ide_legacy_init_one(hws, &hw[0], 0, d, config); | 
|  | 50 | ide_legacy_init_one(hws, &hw[1], 1, d, config); | 
|  | 51 |  | 
|  | 52 | if (hws[0] == NULL && hws[1] == NULL && | 
|  | 53 | (d->host_flags & IDE_HFLAG_SINGLE)) | 
|  | 54 | return -ENOENT; | 
|  | 55 |  | 
| Bartlomiej Zolnierkiewicz | dca3983 | 2009-05-17 19:12:24 +0200 | [diff] [blame] | 56 | return ide_host_add(d, hws, 2, NULL); | 
| Bartlomiej Zolnierkiewicz | 7f92b11 | 2008-12-29 20:27:37 +0100 | [diff] [blame] | 57 | } | 
|  | 58 | EXPORT_SYMBOL_GPL(ide_legacy_device_add); |