add support for reading ip1000 gpios.
Signed-off-by: Stefan Reinauer <stepan@coresystems.de>
Acked-by: Ronald G. Minnich <rminnich@gmail.com>
git-svn-id: svn://svn.coreboot.org/coreboot/trunk@5405 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
diff --git a/src/mainboard/thomson/ip1000/mainboard.c b/src/mainboard/thomson/ip1000/mainboard.c
index ae951d3..f8f775a 100644
--- a/src/mainboard/thomson/ip1000/mainboard.c
+++ b/src/mainboard/thomson/ip1000/mainboard.c
@@ -2,11 +2,11 @@
* This file is part of the coreboot project.
*
* Copyright (C) 2008-2010 Joseph Smith <joe@settoplinux.org>
+ * Copyright (C) 2010 Stefan Reinauer <stepan@openbios.org>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
+ * the Free Software Foundation; version 2 of the License.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
@@ -18,9 +18,12 @@
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*/
+#include <console/console.h>
#include <device/device.h>
#include <boot/tables.h>
+#include <delay.h>
#include <arch/coreboot_tables.h>
+#include <arch/io.h>
#include "chip.h"
int add_mainboard_resources(struct lb_memory *mem)
@@ -28,14 +31,85 @@
return add_northbridge_resources(mem);
}
+// setting the bit disables the led.
+#define PARPORT_GPIO_LED_GREEN (1 << 0)
+#define PARPORT_GPIO_LED_ORANGE (1 << 1)
+#define PARPORT_GPIO_LED_RED (1 << 2)
+#define PARPORT_GPIO_IR_PORT (1 << 6)
+
+static u8 get_parport_gpio(void)
+{
+ return inb(0x378);
+}
+
+static void set_parport_gpio(u8 gpios)
+{
+ outb(gpios, 0x378);
+}
+
+static void parport_gpios(void)
+{
+ u8 pp_gpios = get_parport_gpio();
+
+ /* disable red led */
+ pp_gpios |= PARPORT_GPIO_LED_RED;
+ set_parport_gpio(pp_gpios);
+
+ pp_gpios = get_parport_gpio();
+
+ printk(BIOS_DEBUG, "IP1000 GPIOs:\n");
+ printk(BIOS_DEBUG, " GPIO mask: %02x\n", pp_gpios);
+ printk(BIOS_DEBUG, " green led: %s\n",
+ (pp_gpios & PARPORT_GPIO_LED_GREEN) ? "off" : "on");
+ printk(BIOS_DEBUG, " orange led: %s\n",
+ (pp_gpios & PARPORT_GPIO_LED_ORANGE) ? "off" : "on");
+ printk(BIOS_DEBUG, " red led: %s\n",
+ (pp_gpios & PARPORT_GPIO_LED_RED) ? "off" : "on");
+ printk(BIOS_DEBUG, " IR port: %s\n",
+ (pp_gpios & PARPORT_GPIO_IR_PORT) ? "off" : "on");
+}
+
+static void flash_gpios(void)
+{
+ u32 flash_base = 0xfff80000;
+ u8 manufacturer_id, device_id;
+
+ // reset mode
+ write8(flash_base, 0xff);
+ udelay(10);
+ // read id
+ write8(flash_base, 0x90);
+ udelay(10);
+ manufacturer_id = read8(flash_base);
+ device_id = read8(flash_base + 1);
+ // reset mode
+ write8(flash_base, 0xff);
+ udelay(10);
+
+ if ((manufacturer_id == 0x20) &&
+ ((device_id == 0x2c) || (device_id == 0x2d))) {
+ printk(BIOS_DEBUG, "Detected ST M50FW0%c0 flash:\n",
+ (device_id==0x2c)?'4':'8');
+ u8 fgpi = read8(0xffbc0100);
+ printk(BIOS_DEBUG, " FGPI0 [%c] FGPI1 [%c] FGPI2 [%c] FGPI3 [%c] FGPI4 [%c]",
+ (fgpi & (1 << 0)) ? 'X' : ' ',
+ (fgpi & (1 << 1)) ? 'X' : ' ',
+ (fgpi & (1 << 2)) ? 'X' : ' ',
+ (fgpi & (1 << 3)) ? 'X' : ' ',
+ (fgpi & (1 << 4)) ? 'X' : ' ');
+ } else {
+ printk(BIOS_DEBUG, "No ST M50FW040/M50FW080 flash, don't read FGPI.\n");
+ }
+}
+
static void mainboard_init(device_t dev)
{
- // TODO Switch parport LEDs again
+ parport_gpios();
+ flash_gpios();
}
static void mainboard_enable(device_t dev)
{
- // TODO Switch parport LEDs
dev->ops->init = mainboard_init;
}