[U-Boot] [PATCH] sh: Add support watchdog for SH4A core

18 Sep 2008

Add support watchdog for SH4A core (SH7763, SH7780 and SH7785).
And fix some compile warning.
Signed-off-by: Nobuhiro Iwamatsu iwamatsu@nigauri.org
---
 cpu/sh4/watchdog.c |   48 ++++++++++++++++++++--------
 lib_sh/board.c     |   89 +++++++++++++++++++++++++++++++---------------------
 2 files changed, 87 insertions(+), 50 deletions(-)

diff --git a/cpu/sh4/watchdog.c b/cpu/sh4/watchdog.c
index 346e217..6fbb069 100644
--- a/cpu/sh4/watchdog.c
+++ b/cpu/sh4/watchdog.c
@@ -17,32 +17,52 @@
#include <common.h>
 #include <asm/processor.h>
+#include <asm/io.h>
#define WDT_BASE	WTCNT
-static unsigned char cnt_read (void){
-	return *((volatile unsigned char *)(WDT_BASE + 0x00));
+#define WDT_WD		(1 << 6)
+#define WDT_RST_P	(0)
+#define WDT_RST_M	(1 << 5)
+#define WDT_ENABLE	(1 << 7)
+
+#if defined(CONFIG_WATCHDOG)
+static unsigned char csr_read (void)
+{
+	return inb(WDT_BASE + 0x04);
 }
-static unsigned char csr_read (void){
-	return *((volatile unsigned char *)(WDT_BASE + 0x04));
+static void cnt_write (unsigned char value)
+{
+	outl((unsigned short)value | 0x5A00, WDT_BASE + 0x00);
 }
-static void cnt_write (unsigned char value){
-	while (csr_read() & (1 << 5)) {
-		/* delay */
-	}
-	*((volatile unsigned short *)(WDT_BASE + 0x00))
-		= ((unsigned short) value) | 0x5A00;
+static void csr_write (unsigned char value)
+{
+	outl((unsigned short)value | 0xA500, WDT_BASE + 0x04);
 }
-static void csr_write (unsigned char value){
-	*((volatile unsigned short *)(WDT_BASE + 0x04))
-		= ((unsigned short) value) | 0xA500;
+void watchdog_reset(void)
+{
+	outl(0x55000000, WDT_BASE + 0x08);
 }
+int watchdog_init (void)
+{
+	/* Set overflow time*/
+	cnt_write(0);
+	/* Power on reset */
+	csr_write(WDT_WD|WDT_RST_P|WDT_ENABLE);
+
+	return 0;
+}
-int watchdog_init (void){ return 0; }
+int watchdog_disable (void)
+{
+	csr_write(csr_read() & ~WDT_ENABLE);
+	return 0;
+}
+#endif
void reset_cpu (unsigned long ignored)
 {
diff --git a/lib_sh/board.c b/lib_sh/board.c
index eb81bd9..c678120 100644
--- a/lib_sh/board.c
+++ b/lib_sh/board.c
@@ -23,6 +23,7 @@
 #include <malloc.h>
 #include <devices.h>
 #include <version.h>
+#include <watchdog.h>
 #include <net.h>
 #include <environment.h>
@@ -30,7 +31,6 @@ extern void malloc_bin_reloc (void);
 extern int cpu_init(void);
 extern int board_init(void);
 extern int dram_init(void);
-extern int watchdog_init(void);
 extern int timer_init(void);
const char version_string[] = U_BOOT_VERSION" (" __DATE__ " - " __TIME__ ")";
@@ -70,37 +70,45 @@ static int sh_flash_init(void)
    DECLARE_GLOBAL_DATA_PTR;
gd->bd->bi_flashsize = flash_init();
-	printf("FLASH: %dMB\n", gd->bd->bi_flashsize / (1024*1024));
+	printf("FLASH: %ldMB\n", gd->bd->bi_flashsize / (1024*1024));
return 0;
 }
#if defined(CONFIG_CMD_NAND)
-#include <nand.h>
-static int sh_nand_init(void)
-{
-	printf("NAND: ");
-	nand_init();	/* go init the NAND */
-	return 0;
-}
+# include <nand.h>
+# define INIT_FUNC_NAND_INIT nand_init,
+#else
+# define INIT_FUNC_NAND_INIT
 #endif /* CONFIG_CMD_NAND */
+#if defined(CONFIG_WATCHDOG)
+extern int watchdog_init(void);
+extern int watchdog_disable(void);
+# define INIT_FUNC_WATCHDOG_INIT	watchdog_init,
+# define WATCHDOG_DISABLE       	watchdog_disable
+#else
+# define INIT_FUNC_WATCHDOG_INIT
+# define WATCHDOG_DISABLE
+#endif /* CONFIG_WATCHDOG */
+
 #if defined(CONFIG_CMD_IDE)
-#include <ide.h>
-static int sh_marubun_init(void)
-{
-	puts ("IDE:   ");
-	ide_init();
-	return 0;
-}
-#endif /* (CONFIG_CMD_IDE) */
+# include <ide.h>
+# define INIT_FUNC_IDE_INIT	ide_init,
+#else
+# define INIT_FUNC_IDE_INIT
+#endif /* CONFIG_CMD_IDE */
#if defined(CONFIG_PCI)
+#include <pci.h>
 static int sh_pci_init(void)
 {
    pci_init();
    return 0;
 }
+# define INIT_FUNC_PCI_INIT sh_pci_init,
+#else
+# define INIT_FUNC_PCI_INIT
 #endif /* CONFIG_PCI */
static int sh_mem_env_init(void)
@@ -136,24 +144,20 @@ init_fnc_t *init_sequence[] =
 {
    cpu_init,		/* basic cpu dependent setup */
    board_init,		/* basic board dependent setup */
-	interrupt_init,		/* set up exceptions */
+	interrupt_init,	/* set up exceptions */
    env_init,		/* event init */
-	serial_init,		/* SCIF init */
-	watchdog_init,		/* watchdog init */
+	serial_init,	/* SCIF init */
+	INIT_FUNC_WATCHDOG_INIT	/* watchdog init */
    console_init_f,
    display_options,
    checkcpu,
    checkboard,		/* Check support board */
    dram_init,		/* SDRAM init */
    timer_init,		/* SuperH Timer (TCNT0 only) init */
-	sh_flash_init,		/* Flash memory(NOR) init*/
+	sh_flash_init,	/* Flash memory(NOR) init*/
    sh_mem_env_init,
-#if defined(CONFIG_CMD_NAND)
-	sh_nand_init,		/* Flash memory (NAND) init */
-#endif
-#if defined(CONFIG_PCI)
-	sh_pci_init,		/* PCI Init */
-#endif
+	INIT_FUNC_NAND_INIT/* Flash memory (NAND) init */
+	INIT_FUNC_PCI_INIT	/* PCI init */
    devices_init,
    console_init_r,
    interrupt_init,
@@ -172,8 +176,6 @@ void sh_generic_init (void)
bd_t *bd;
    init_fnc_t **init_fnc_ptr;
-	int i;
-	char *s;
memset (gd, 0, CFG_GBL_DATA_SIZE);
@@ -194,22 +196,37 @@ void sh_generic_init (void)
 #endif
    bd->bi_baudrate	= CONFIG_BAUDRATE;
-	for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr , i++) {
-		if ((*init_fnc_ptr) () != 0) {
+	for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
+		WATCHDOG_RESET();
+		if ((*init_fnc_ptr) () != 0)
    		hang();
-		}
    }
+#ifdef CONFIG_WATCHDOG
+	/* disable watchdog if environment is set */
+	{
+		char *s;
+		if ((s = getenv ("watchdog")) != NULL)
+			if (strncmp (s, "off", 3) == 0)
+				WATCHDOG_DISABLE ();
+	}
+#endif /* CONFIG_WATCHDOG*/
+
+
 #if defined(CONFIG_CMD_NET)
-	puts ("Net:   ");
-	eth_initialize(gd->bd);
+	{
+		char *s;
+		puts ("Net:   ");
+		eth_initialize(gd->bd);
-	if ((s = getenv ("bootfile")) != NULL) {
-		copy_filename (BootFile, s, sizeof (BootFile));
+		if ((s = getenv ("bootfile")) != NULL) {
+			copy_filename (BootFile, s, sizeof (BootFile));
+		}
    }
 #endif /* CONFIG_CMD_NET */
while (1) {
+		WATCHDOG_RESET();
    	main_loop();
    }
 }
-- 
1.5.6.3

    