[people/ms/u-boot.git] / lib_nios / board.c

/*
 * (C) Copyright 2003, Psyent Corporation <www.psyent.com>
 * Scott McNutt <smcnutt@psyent.com>
 *
 * (C) Copyright 2000-2002
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * 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.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

#include <common.h>
#include <devices.h>
#include <watchdog.h>
#include <net.h>
#ifdef CONFIG_STATUS_LED
#include <status_led.h>
#endif

DECLARE_GLOBAL_DATA_PTR;

/*
 * All attempts to come up with a "common" initialization sequence
 * that works for all boards and architectures failed: some of the
 * requirements are just _too_ different. To get rid of the resulting
 * mess of board dependend #ifdef'ed code we now make the whole
 * initialization sequence configurable to the user.
 *
 * The requirements for any new initalization function is simple: it
 * receives a pointer to the "global data" structure as it's only
 * argument, and returns an integer return code, where 0 means
 * "continue" and != 0 means "fatal error, hang the system".
 */


extern void malloc_bin_reloc (void);
typedef int (init_fnc_t) (void);

/*
 * Begin and End of memory area for malloc(), and current "brk"
 */
static	ulong	mem_malloc_start = 0;
static	ulong	mem_malloc_end	 = 0;
static	ulong	mem_malloc_brk	 = 0;

/*
 * The Malloc area is immediately below the monitor copy in RAM
 */
static void mem_malloc_init (void)
{
	mem_malloc_start = CONFIG_SYS_MALLOC_BASE;
	mem_malloc_end = mem_malloc_start + CONFIG_SYS_MALLOC_LEN;
	mem_malloc_brk = mem_malloc_start;
	memset ((void *) mem_malloc_start,
		0,
		mem_malloc_end - mem_malloc_start);
}

void *sbrk (ptrdiff_t increment)
{
	ulong old = mem_malloc_brk;
	ulong new = old + increment;

	if ((new < mem_malloc_start) || (new > mem_malloc_end)) {
		return (NULL);
	}
	mem_malloc_brk = new;
	return ((void *) old);
}


/************************************************************************
 * Initialization sequence						*
 ***********************************************************************/

init_fnc_t *init_sequence[] = {

#if defined(CONFIG_BOARD_EARLY_INIT_F)
	board_early_init_f,	/* Call board-specific init code early.*/
#endif

	env_init,
	serial_init,
	console_init_f,
	display_options,
	checkcpu,
	checkboard,
	NULL,			/* Terminate this list */
};


/***********************************************************************/
void board_init (void)
{
	bd_t *bd;
	init_fnc_t **init_fnc_ptr;
	char *s, *e;
	int i;

	/* Pointer is writable since we allocated a register for it.
	 * Nios treats CONFIG_SYS_GBL_DATA_OFFSET as an address.
	 */
	gd = (gd_t *)CONFIG_SYS_GBL_DATA_OFFSET;
	/* compiler optimization barrier needed for GCC >= 3.4 */
	__asm__ __volatile__("": : :"memory");

	memset( gd, 0, CONFIG_SYS_GBL_DATA_SIZE );

	gd->bd = (bd_t *)(gd+1);	/* At end of global data */
	gd->baudrate = CONFIG_BAUDRATE;
	gd->cpu_clk = CONFIG_SYS_CLK_FREQ;

	bd = gd->bd;
	bd->bi_memstart	= CONFIG_SYS_SDRAM_BASE;
	bd->bi_memsize = CONFIG_SYS_SDRAM_SIZE;
	bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;
#if	defined(CONFIG_SYS_SRAM_BASE) && defined(CONFIG_SYS_SRAM_SIZE)
	bd->bi_sramstart= CONFIG_SYS_SRAM_BASE;
	bd->bi_sramsize	= CONFIG_SYS_SRAM_SIZE;
#endif
	bd->bi_baudrate	= CONFIG_BAUDRATE;

	for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
		WATCHDOG_RESET ();
		if ((*init_fnc_ptr) () != 0) {
			hang ();
		}
	}

	WATCHDOG_RESET ();
	bd->bi_flashsize = flash_init();

	WATCHDOG_RESET ();
	mem_malloc_init();
	malloc_bin_reloc();
	env_relocate();

	bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
	s = getenv ("ethaddr");
	for (i = 0; i < 6; ++i) {
		bd->bi_enetaddr[i] = s ? simple_strtoul (s, &e, 16) : 0;
		if (s) s = (*e) ? e + 1 : e;
	}

	WATCHDOG_RESET ();
	devices_init();
	jumptable_init();
	console_init_r();
	/*
	 */

	WATCHDOG_RESET ();
	interrupt_init ();

#ifdef CONFIG_STATUS_LED
	status_led_set(STATUS_LED_BOOT, STATUS_LED_BLINKING);
#endif

	/* main_loop */
	for (;;) {
		WATCHDOG_RESET ();
		main_loop ();
	}
}


/***********************************************************************/

void hang (void)
{
#ifdef CONFIG_STATUS_LED
	status_led_set(STATUS_LED_BOOT, STATUS_LED_OFF);
	status_led_set(STATUS_LED_RED, STATUS_LED_BLINKING);
#endif
	puts("### ERROR ### Please reset board ###\n");
	for (;;);
}

unsigned long do_go_exec (ulong (*entry)(int, char *[]), int argc, char *argv[])
{
	/*
	 * x86 does not use a dedicated register to pass the pointer
	 * to the global_data
	 */
	argv[-1] = (char *)gd;
	return entry (argc, argv);
}
Commit	Line	Data
4a551709 WD	1	/*
	2	* (C) Copyright 2003, Psyent Corporation <www.psyent.com>
	3	* Scott McNutt <smcnutt@psyent.com>
	4	*
	5	* (C) Copyright 2000-2002
	6	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	7	*
	8	* See file CREDITS for list of people who contributed to this
	9	* project.
	10	*
	11	* This program is free software; you can redistribute it and/or
	12	* modify it under the terms of the GNU General Public License as
	13	* published by the Free Software Foundation; either version 2 of
	14	* the License, or (at your option) any later version.
	15	*
	16	* This program is distributed in the hope that it will be useful,
	17	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	18	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	19	* GNU General Public License for more details.
	20	*
	21	* You should have received a copy of the GNU General Public License
	22	* along with this program; if not, write to the Free Software
	23	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	24	* MA 02111-1307 USA
	25	*/
	26
	27	#include <common.h>
	28	#include <devices.h>
	29	#include <watchdog.h>
a3ad8e26	30	#include <net.h>
c935d3bd WD	31	#ifdef CONFIG_STATUS_LED
	32	#include <status_led.h>
	33	#endif
4a551709	34
d87080b7	35	DECLARE_GLOBAL_DATA_PTR;
4a551709 WD	36
	37	/*
	38	* All attempts to come up with a "common" initialization sequence
	39	* that works for all boards and architectures failed: some of the
	40	* requirements are just _too_ different. To get rid of the resulting
	41	* mess of board dependend #ifdef'ed code we now make the whole
	42	* initialization sequence configurable to the user.
	43	*
	44	* The requirements for any new initalization function is simple: it
	45	* receives a pointer to the "global data" structure as it's only
	46	* argument, and returns an integer return code, where 0 means
	47	* "continue" and != 0 means "fatal error, hang the system".
	48	*/
	49
	50
	51	extern void malloc_bin_reloc (void);
	52	typedef int (init_fnc_t) (void);
4a551709 WD	53
	54	/*
	55	* Begin and End of memory area for malloc(), and current "brk"
	56	*/
	57	static ulong mem_malloc_start = 0;
	58	static ulong mem_malloc_end = 0;
	59	static ulong mem_malloc_brk = 0;
	60
	61	/*
	62	* The Malloc area is immediately below the monitor copy in RAM
	63	*/
	64	static void mem_malloc_init (void)
	65	{
6d0f6bcf JCPV	66	mem_malloc_start = CONFIG_SYS_MALLOC_BASE;
6d0f6bcf JCPV	67	mem_malloc_end = mem_malloc_start + CONFIG_SYS_MALLOC_LEN;
4a551709 WD	68	mem_malloc_brk = mem_malloc_start;
	69	memset ((void *) mem_malloc_start,
	70	0,
	71	mem_malloc_end - mem_malloc_start);
	72	}
	73
	74	void *sbrk (ptrdiff_t increment)
	75	{
	76	ulong old = mem_malloc_brk;
	77	ulong new = old + increment;
	78
	79	if ((new < mem_malloc_start) \|\| (new > mem_malloc_end)) {
	80	return (NULL);
	81	}
	82	mem_malloc_brk = new;
	83	return ((void *) old);
	84	}
	85
	86
	87	/************************************************************************
	88	* Initialization sequence *
	89	***********************************************************************/
	90
	91	init_fnc_t *init_sequence[] = {
	92
c837dcb1 WD	93	#if defined(CONFIG_BOARD_EARLY_INIT_F)
c837dcb1 WD	94	board_early_init_f, /* Call board-specific init code early.*/
4a551709 WD	95	#endif
	96
	97	env_init,
	98	serial_init,
	99	console_init_f,
	100	display_options,
	101	checkcpu,
	102	checkboard,
	103	NULL, /* Terminate this list */
	104	};
	105
	106
	107	/***********************************************************************/
	108	void board_init (void)
	109	{
4a551709 WD	110	bd_t *bd;
4a551709 WD	111	init_fnc_t **init_fnc_ptr;
a3ad8e26 WD	112	char s, e;
a3ad8e26 WD	113	int i;
4a551709 WD	114
4a551709 WD	115	/* Pointer is writable since we allocated a register for it.
6d0f6bcf	116	* Nios treats CONFIG_SYS_GBL_DATA_OFFSET as an address.
4a551709	117	*/
6d0f6bcf	118	gd = (gd_t *)CONFIG_SYS_GBL_DATA_OFFSET;
93f6a677 WD	119	/* compiler optimization barrier needed for GCC >= 3.4 */
	120	__asm__ __volatile__("": : :"memory");
	121
6d0f6bcf	122	memset( gd, 0, CONFIG_SYS_GBL_DATA_SIZE );
4a551709	123
4a551709 WD	124	gd->bd = (bd_t )(gd+1); / At end of global data */
	125	gd->baudrate = CONFIG_BAUDRATE;
	126	gd->cpu_clk = CONFIG_SYS_CLK_FREQ;
	127
	128	bd = gd->bd;
6d0f6bcf JCPV	129	bd->bi_memstart = CONFIG_SYS_SDRAM_BASE;
	130	bd->bi_memsize = CONFIG_SYS_SDRAM_SIZE;
	131	bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;
	132	#if defined(CONFIG_SYS_SRAM_BASE) && defined(CONFIG_SYS_SRAM_SIZE)
	133	bd->bi_sramstart= CONFIG_SYS_SRAM_BASE;
	134	bd->bi_sramsize = CONFIG_SYS_SRAM_SIZE;
ec4c544b	135	#endif
4a551709 WD	136	bd->bi_baudrate = CONFIG_BAUDRATE;
	137
	138	for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
028ab6b5	139	WATCHDOG_RESET ();
4a551709 WD	140	if ((*init_fnc_ptr) () != 0) {
	141	hang ();
	142	}
	143	}
	144
028ab6b5	145	WATCHDOG_RESET ();
4a551709 WD	146	bd->bi_flashsize = flash_init();
4a551709 WD	147
028ab6b5	148	WATCHDOG_RESET ();
4a551709 WD	149	mem_malloc_init();
	150	malloc_bin_reloc();
	151	env_relocate();
	152
a0f2fe52 WD	153	bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
	154	s = getenv ("ethaddr");
	155	for (i = 0; i < 6; ++i) {
	156	bd->bi_enetaddr[i] = s ? simple_strtoul (s, &e, 16) : 0;
	157	if (s) s = (*e) ? e + 1 : e;
	158	}
	159
028ab6b5	160	WATCHDOG_RESET ();
4a551709 WD	161	devices_init();
	162	jumptable_init();
	163	console_init_r();
	164	/*
	165	*/
	166
028ab6b5	167	WATCHDOG_RESET ();
4a551709	168	interrupt_init ();
c935d3bd WD	169
	170	#ifdef CONFIG_STATUS_LED
	171	status_led_set(STATUS_LED_BOOT, STATUS_LED_BLINKING);
	172	#endif
	173
4a551709 WD	174	/* main_loop */
	175	for (;;) {
	176	WATCHDOG_RESET ();
	177	main_loop ();
	178	}
	179	}
	180
	181
	182	/***********************************************************************/
	183
	184	void hang (void)
	185	{
c935d3bd WD	186	#ifdef CONFIG_STATUS_LED
	187	status_led_set(STATUS_LED_BOOT, STATUS_LED_OFF);
	188	status_led_set(STATUS_LED_RED, STATUS_LED_BLINKING);
	189	#endif
4a551709 WD	190	puts("### ERROR ### Please reset board ###\n");
	191	for (;;);
	192	}
a4986459 MF	193
	194	unsigned long do_go_exec (ulong (entry)(int, char []), int argc, char *argv[])
	195	{
	196	/*
	197	* x86 does not use a dedicated register to pass the pointer
	198	* to the global_data
	199	*/
	200	argv[-1] = (char *)gd;
	201	return entry (argc, argv);
	202	}