From 483ec41e6f3947b8e11ed67f7efcfdc3ef035612 Mon Sep 17 00:00:00 2001 From: Sven Schnelle Date: Tue, 10 Jan 2012 14:44:12 +0100 Subject: X60: fix docking Fix ordering of power/reset/undock procedure to prevent crashes seen with the old code. Also call dlpc_init() only once. Change-Id: I27d1f42e845fcccde40e6ca5af4a7762edab5d36 Signed-off-by: Sven Schnelle Reviewed-on: http://review.coreboot.org/597 Tested-by: build bot (Jenkins) --- src/mainboard/lenovo/x60/dock.c | 33 +++++++++++++++++++++------------ 1 file changed, 21 insertions(+), 12 deletions(-) (limited to 'src/mainboard/lenovo/x60/dock.c') diff --git a/src/mainboard/lenovo/x60/dock.c b/src/mainboard/lenovo/x60/dock.c index eed00a1a26..37d5b7652f 100644 --- a/src/mainboard/lenovo/x60/dock.c +++ b/src/mainboard/lenovo/x60/dock.c @@ -107,6 +107,15 @@ int dlpc_init(void) /* Activate DLPC */ dlpc_write_register(0x30, 0x01); + dlpc_gpio_init(); + + return 0; +} + +int dock_connect(void) +{ + int timeout = 1000; + outb(0x07, 0x164c); timeout = 1000; @@ -121,26 +130,18 @@ int dlpc_init(void) return 1; } - dlpc_gpio_init(); - - return 0; -} - -int dock_connect(void) -{ - int timeout = 1000; - /* Assert D_PLTRST# */ outb(0xfe, 0x1680); udelay(100000); /* Deassert D_PLTRST# */ outb(0xff, 0x1680); - udelay(1000); + udelay(100000); /* startup 14.318MHz Clock */ dock_write_register(0x29, 0x06); /* wait until clock is settled */ + timeout = 1000; while(!(dock_read_register(0x29) & 0x08) && timeout--) udelay(1000); @@ -243,12 +244,20 @@ int dock_connect(void) void dock_disconnect(void) { - /* disable Ultrabay and USB Power */ - outb(0x00, 0x1628); + printk(BIOS_DEBUG, "%s enter\n", __func__); /* disconnect LPC bus */ outb(0x00, 0x164c); + udelay(10000); + /* Assert PLTRST and DLPCPD */ outb(0xfc, 0x1680); + udelay(10000); + + /* disable Ultrabay and USB Power */ + outb(0x00, 0x1628); + udelay(10000); + + printk(BIOS_DEBUG, "%s finish\n", __func__); } int dock_present(void) -- cgit v1.2.3