cmd640: use ide_find_port()

Signed-off-by: NBartlomiej Zolnierkiewicz <bzolnier@gmail.com>
上级 9523076a
...@@ -744,18 +744,19 @@ static int __init cmd640x_init(void) ...@@ -744,18 +744,19 @@ static int __init cmd640x_init(void)
printk(KERN_INFO "cmd640: buggy cmd640%c interface on %s, config=0x%02x" printk(KERN_INFO "cmd640: buggy cmd640%c interface on %s, config=0x%02x"
"\n", 'a' + cmd640_chip_version - 1, bus_type, cfr); "\n", 'a' + cmd640_chip_version - 1, bus_type, cfr);
cmd_hwif0 = &ide_hwifs[0]; cmd_hwif0 = ide_find_port();
cmd_hwif1 = &ide_hwifs[1];
/* /*
* Initialize data for primary port * Initialize data for primary port
*/ */
ide_init_port_hw(cmd_hwif0, &hw[0]); if (cmd_hwif0) {
ide_init_port_hw(cmd_hwif0, &hw[0]);
#ifdef CONFIG_BLK_DEV_CMD640_ENHANCED #ifdef CONFIG_BLK_DEV_CMD640_ENHANCED
cmd_hwif0->set_pio_mode = &cmd640_set_pio_mode; cmd_hwif0->set_pio_mode = &cmd640_set_pio_mode;
#endif /* CONFIG_BLK_DEV_CMD640_ENHANCED */ #endif /* CONFIG_BLK_DEV_CMD640_ENHANCED */
idx[0] = cmd_hwif0->index; idx[0] = cmd_hwif0->index;
}
/* /*
* Ensure compatibility by always using the slowest timings * Ensure compatibility by always using the slowest timings
...@@ -767,10 +768,13 @@ static int __init cmd640x_init(void) ...@@ -767,10 +768,13 @@ static int __init cmd640x_init(void)
put_cmd640_reg(CMDTIM, 0); put_cmd640_reg(CMDTIM, 0);
put_cmd640_reg(BRST, 0x40); put_cmd640_reg(BRST, 0x40);
cmd_hwif1 = ide_find_port();
/* /*
* Try to enable the secondary interface, if not already enabled * Try to enable the secondary interface, if not already enabled
*/ */
if (cmd_hwif1->drives[0].noprobe && cmd_hwif1->drives[1].noprobe) { if (cmd_hwif1 &&
cmd_hwif1->drives[0].noprobe && cmd_hwif1->drives[1].noprobe) {
port2 = "not probed"; port2 = "not probed";
} else { } else {
b = get_cmd640_reg(CNTRL); b = get_cmd640_reg(CNTRL);
...@@ -801,7 +805,7 @@ static int __init cmd640x_init(void) ...@@ -801,7 +805,7 @@ static int __init cmd640x_init(void)
/* /*
* Initialize data for secondary cmd640 port, if enabled * Initialize data for secondary cmd640 port, if enabled
*/ */
if (second_port_cmd640) { if (second_port_cmd640 && cmd_hwif1) {
ide_init_port_hw(cmd_hwif1, &hw[1]); ide_init_port_hw(cmd_hwif1, &hw[1]);
#ifdef CONFIG_BLK_DEV_CMD640_ENHANCED #ifdef CONFIG_BLK_DEV_CMD640_ENHANCED
cmd_hwif1->set_pio_mode = &cmd640_set_pio_mode; cmd_hwif1->set_pio_mode = &cmd640_set_pio_mode;
...@@ -809,7 +813,7 @@ static int __init cmd640x_init(void) ...@@ -809,7 +813,7 @@ static int __init cmd640x_init(void)
idx[1] = cmd_hwif1->index; idx[1] = cmd_hwif1->index;
} }
printk(KERN_INFO "%s: %sserialized, secondary interface %s\n", cmd_hwif1->name, printk(KERN_INFO "cmd640: %sserialized, secondary interface %s\n",
second_port_cmd640 ? "" : "not ", port2); second_port_cmd640 ? "" : "not ", port2);
/* /*
...@@ -819,10 +823,15 @@ static int __init cmd640x_init(void) ...@@ -819,10 +823,15 @@ static int __init cmd640x_init(void)
for (index = 0; index < (2 + (second_port_cmd640 << 1)); index++) { for (index = 0; index < (2 + (second_port_cmd640 << 1)); index++) {
ide_drive_t *drive; ide_drive_t *drive;
if (index > 1) if (index > 1) {
if (cmd_hwif1 == NULL)
continue;
drive = &cmd_hwif1->drives[index & 1]; drive = &cmd_hwif1->drives[index & 1];
else } else {
if (cmd_hwif0 == NULL)
continue;
drive = &cmd_hwif0->drives[index & 1]; drive = &cmd_hwif0->drives[index & 1];
}
#ifdef CONFIG_BLK_DEV_CMD640_ENHANCED #ifdef CONFIG_BLK_DEV_CMD640_ENHANCED
if (drive->autotune || ((index > 1) && second_port_toggled)) { if (drive->autotune || ((index > 1) && second_port_toggled)) {
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册