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