mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-24 10:58:52 +09:00
![Kumar Gala](/assets/img/avatar_default.png)
Make it so we keep track of which LAWs have allocated and provide a function (set_next_law) which can allocate a LAW for us if one is free. In the future we will move to doing more "dynamic" LAW allocation since the majority of users dont really care about what LAW number they are at. Also, add CONFIG_MPC8540 or CONFIG_MPC8560 to those boards which needed them Signed-off-by: Kumar Gala <galak@kernel.crashing.org> Signed-off-by: Andy Fleming <afleming@freescale.com>
1312 lines
31 KiB
C
1312 lines
31 KiB
C
/*
|
|
* (C) Copyright 2000-2006
|
|
* 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 <watchdog.h>
|
|
#include <command.h>
|
|
#include <malloc.h>
|
|
#include <devices.h>
|
|
#ifdef CONFIG_8xx
|
|
#include <mpc8xx.h>
|
|
#endif
|
|
#ifdef CONFIG_5xx
|
|
#include <mpc5xx.h>
|
|
#endif
|
|
#ifdef CONFIG_MPC5xxx
|
|
#include <mpc5xxx.h>
|
|
#endif
|
|
#if defined(CONFIG_CMD_IDE)
|
|
#include <ide.h>
|
|
#endif
|
|
#if defined(CONFIG_CMD_SATA)
|
|
#include <sata.h>
|
|
#endif
|
|
#if defined(CONFIG_CMD_SCSI)
|
|
#include <scsi.h>
|
|
#endif
|
|
#if defined(CONFIG_CMD_KGDB)
|
|
#include <kgdb.h>
|
|
#endif
|
|
#ifdef CONFIG_STATUS_LED
|
|
#include <status_led.h>
|
|
#endif
|
|
#include <net.h>
|
|
#include <serial.h>
|
|
#ifdef CFG_ALLOC_DPRAM
|
|
#if !defined(CONFIG_CPM2)
|
|
#include <commproc.h>
|
|
#endif
|
|
#endif
|
|
#include <version.h>
|
|
#if defined(CONFIG_BAB7xx)
|
|
#include <w83c553f.h>
|
|
#endif
|
|
#include <dtt.h>
|
|
#if defined(CONFIG_POST)
|
|
#include <post.h>
|
|
#endif
|
|
#if defined(CONFIG_LOGBUFFER)
|
|
#include <logbuff.h>
|
|
#endif
|
|
#if defined(CFG_INIT_RAM_LOCK) && defined(CONFIG_E500)
|
|
#include <asm/cache.h>
|
|
#endif
|
|
#ifdef CONFIG_PS2KBD
|
|
#include <keyboard.h>
|
|
#endif
|
|
|
|
#ifdef CFG_UPDATE_FLASH_SIZE
|
|
extern int update_flash_size (int flash_size);
|
|
#endif
|
|
|
|
#if defined(CONFIG_SC3)
|
|
extern void sc3_read_eeprom(void);
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_DOC)
|
|
void doc_init (void);
|
|
#endif
|
|
#if defined(CONFIG_HARD_I2C) || \
|
|
defined(CONFIG_SOFT_I2C)
|
|
#include <i2c.h>
|
|
#endif
|
|
#if defined(CONFIG_HARD_SPI)
|
|
#include <spi.h>
|
|
#endif
|
|
#include <nand.h>
|
|
|
|
static char *failed = "*** failed ***\n";
|
|
|
|
#if defined(CONFIG_OXC) || defined(CONFIG_PCU_E) || defined(CONFIG_RMU)
|
|
extern flash_info_t flash_info[];
|
|
#endif
|
|
|
|
#if defined(CONFIG_START_IDE)
|
|
extern int board_start_ide(void);
|
|
#endif
|
|
#include <environment.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
#if defined(CFG_ENV_IS_EMBEDDED)
|
|
#define TOTAL_MALLOC_LEN CFG_MALLOC_LEN
|
|
#elif ( ((CFG_ENV_ADDR+CFG_ENV_SIZE) < CFG_MONITOR_BASE) || \
|
|
(CFG_ENV_ADDR >= (CFG_MONITOR_BASE + CFG_MONITOR_LEN)) ) || \
|
|
defined(CFG_ENV_IS_IN_NVRAM)
|
|
#define TOTAL_MALLOC_LEN (CFG_MALLOC_LEN + CFG_ENV_SIZE)
|
|
#else
|
|
#define TOTAL_MALLOC_LEN CFG_MALLOC_LEN
|
|
#endif
|
|
|
|
#if !defined(CFG_MEM_TOP_HIDE)
|
|
#define CFG_MEM_TOP_HIDE 0
|
|
#endif
|
|
|
|
extern ulong __init_end;
|
|
extern ulong _end;
|
|
ulong monitor_flash_len;
|
|
|
|
#if defined(CONFIG_CMD_BEDBUG)
|
|
#include <bedbug/type.h>
|
|
#endif
|
|
|
|
/*
|
|
* 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;
|
|
|
|
/************************************************************************
|
|
* Utilities *
|
|
************************************************************************
|
|
*/
|
|
|
|
/*
|
|
* The Malloc area is immediately below the monitor copy in DRAM
|
|
*/
|
|
static void mem_malloc_init (void)
|
|
{
|
|
#if !defined(CONFIG_RELOC_FIXUP_WORKS)
|
|
mem_malloc_end = CFG_MONITOR_BASE + gd->reloc_off;
|
|
#endif
|
|
mem_malloc_start = mem_malloc_end - TOTAL_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);
|
|
}
|
|
|
|
char *strmhz (char *buf, long hz)
|
|
{
|
|
long l, n;
|
|
long m;
|
|
|
|
n = hz / 1000000L;
|
|
l = sprintf (buf, "%ld", n);
|
|
m = (hz % 1000000L) / 1000L;
|
|
if (m != 0)
|
|
sprintf (buf + l, ".%03ld", m);
|
|
return (buf);
|
|
}
|
|
|
|
/*
|
|
* 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".
|
|
*/
|
|
typedef int (init_fnc_t) (void);
|
|
|
|
/************************************************************************
|
|
* Init Utilities *
|
|
************************************************************************
|
|
* Some of this code should be moved into the core functions,
|
|
* but let's get it working (again) first...
|
|
*/
|
|
|
|
static int init_baudrate (void)
|
|
{
|
|
char tmp[64]; /* long enough for environment variables */
|
|
int i = getenv_r ("baudrate", tmp, sizeof (tmp));
|
|
|
|
gd->baudrate = (i > 0)
|
|
? (int) simple_strtoul (tmp, NULL, 10)
|
|
: CONFIG_BAUDRATE;
|
|
return (0);
|
|
}
|
|
|
|
/***********************************************************************/
|
|
|
|
void __board_add_ram_info(int use_default)
|
|
{
|
|
/* please define platform specific board_add_ram_info() */
|
|
}
|
|
void board_add_ram_info(int) __attribute__((weak, alias("__board_add_ram_info")));
|
|
|
|
|
|
static int init_func_ram (void)
|
|
{
|
|
#ifdef CONFIG_BOARD_TYPES
|
|
int board_type = gd->board_type;
|
|
#else
|
|
int board_type = 0; /* use dummy arg */
|
|
#endif
|
|
puts ("DRAM: ");
|
|
|
|
if ((gd->ram_size = initdram (board_type)) > 0) {
|
|
print_size (gd->ram_size, "");
|
|
board_add_ram_info(0);
|
|
putc('\n');
|
|
return (0);
|
|
}
|
|
puts (failed);
|
|
return (1);
|
|
}
|
|
|
|
/***********************************************************************/
|
|
|
|
#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
|
|
static int init_func_i2c (void)
|
|
{
|
|
puts ("I2C: ");
|
|
i2c_init (CFG_I2C_SPEED, CFG_I2C_SLAVE);
|
|
puts ("ready\n");
|
|
return (0);
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_HARD_SPI)
|
|
static int init_func_spi (void)
|
|
{
|
|
puts ("SPI: ");
|
|
spi_init ();
|
|
puts ("ready\n");
|
|
return (0);
|
|
}
|
|
#endif
|
|
|
|
/***********************************************************************/
|
|
|
|
#if defined(CONFIG_WATCHDOG)
|
|
static int init_func_watchdog_init (void)
|
|
{
|
|
puts (" Watchdog enabled\n");
|
|
WATCHDOG_RESET ();
|
|
return (0);
|
|
}
|
|
# define INIT_FUNC_WATCHDOG_INIT init_func_watchdog_init,
|
|
|
|
static int init_func_watchdog_reset (void)
|
|
{
|
|
WATCHDOG_RESET ();
|
|
return (0);
|
|
}
|
|
# define INIT_FUNC_WATCHDOG_RESET init_func_watchdog_reset,
|
|
#else
|
|
# define INIT_FUNC_WATCHDOG_INIT /* undef */
|
|
# define INIT_FUNC_WATCHDOG_RESET /* undef */
|
|
#endif /* CONFIG_WATCHDOG */
|
|
|
|
/************************************************************************
|
|
* Initialization sequence *
|
|
************************************************************************
|
|
*/
|
|
|
|
init_fnc_t *init_sequence[] = {
|
|
|
|
#if defined(CONFIG_BOARD_EARLY_INIT_F)
|
|
board_early_init_f,
|
|
#endif
|
|
|
|
#if !defined(CONFIG_8xx_CPUCLK_DEFAULT)
|
|
get_clocks, /* get CPU and bus clocks (etc.) */
|
|
#if defined(CONFIG_TQM8xxL) && !defined(CONFIG_TQM866M) \
|
|
&& !defined(CONFIG_TQM885D)
|
|
adjust_sdram_tbs_8xx,
|
|
#endif
|
|
init_timebase,
|
|
#endif
|
|
#ifdef CFG_ALLOC_DPRAM
|
|
#if !defined(CONFIG_CPM2)
|
|
dpram_init,
|
|
#endif
|
|
#endif
|
|
#if defined(CONFIG_BOARD_POSTCLK_INIT)
|
|
board_postclk_init,
|
|
#endif
|
|
env_init,
|
|
#if defined(CONFIG_8xx_CPUCLK_DEFAULT)
|
|
get_clocks_866, /* get CPU and bus clocks according to the environment variable */
|
|
sdram_adjust_866, /* adjust sdram refresh rate according to the new clock */
|
|
init_timebase,
|
|
#endif
|
|
init_baudrate,
|
|
serial_init,
|
|
console_init_f,
|
|
display_options,
|
|
#if defined(CONFIG_8260)
|
|
prt_8260_rsr,
|
|
prt_8260_clks,
|
|
#endif /* CONFIG_8260 */
|
|
#if defined(CONFIG_MPC83XX)
|
|
prt_83xx_rsr,
|
|
#endif
|
|
checkcpu,
|
|
#if defined(CONFIG_MPC5xxx)
|
|
prt_mpc5xxx_clks,
|
|
#endif /* CONFIG_MPC5xxx */
|
|
#if defined(CONFIG_MPC8220)
|
|
prt_mpc8220_clks,
|
|
#endif
|
|
checkboard,
|
|
INIT_FUNC_WATCHDOG_INIT
|
|
#if defined(CONFIG_MISC_INIT_F)
|
|
misc_init_f,
|
|
#endif
|
|
INIT_FUNC_WATCHDOG_RESET
|
|
#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
|
|
init_func_i2c,
|
|
#endif
|
|
#if defined(CONFIG_HARD_SPI)
|
|
init_func_spi,
|
|
#endif
|
|
#if defined(CONFIG_DTT) /* Digital Thermometers and Thermostats */
|
|
dtt_init,
|
|
#endif
|
|
#ifdef CONFIG_POST
|
|
post_init_f,
|
|
#endif
|
|
INIT_FUNC_WATCHDOG_RESET
|
|
init_func_ram,
|
|
#if defined(CFG_DRAM_TEST)
|
|
testdram,
|
|
#endif /* CFG_DRAM_TEST */
|
|
INIT_FUNC_WATCHDOG_RESET
|
|
|
|
NULL, /* Terminate this list */
|
|
};
|
|
|
|
#ifndef CONFIG_MAX_MEM_MAPPED
|
|
#define CONFIG_MAX_MEM_MAPPED (256 << 20)
|
|
#endif
|
|
ulong get_effective_memsize(void)
|
|
{
|
|
#ifndef CONFIG_VERY_BIG_RAM
|
|
return gd->ram_size;
|
|
#else
|
|
/* limit stack to what we can reasonable map */
|
|
return ((gd->ram_size > CONFIG_MAX_MEM_MAPPED) ?
|
|
CONFIG_MAX_MEM_MAPPED : gd->ram_size);
|
|
#endif
|
|
}
|
|
|
|
/************************************************************************
|
|
*
|
|
* This is the first part of the initialization sequence that is
|
|
* implemented in C, but still running from ROM.
|
|
*
|
|
* The main purpose is to provide a (serial) console interface as
|
|
* soon as possible (so we can see any error messages), and to
|
|
* initialize the RAM so that we can relocate the monitor code to
|
|
* RAM.
|
|
*
|
|
* Be aware of the restrictions: global data is read-only, BSS is not
|
|
* initialized, and stack space is limited to a few kB.
|
|
*
|
|
************************************************************************
|
|
*/
|
|
|
|
#ifdef CONFIG_LOGBUFFER
|
|
unsigned long logbuffer_base(void)
|
|
{
|
|
return CFG_SDRAM_BASE + get_effective_memsize() - LOGBUFF_LEN;
|
|
}
|
|
#endif
|
|
|
|
void board_init_f (ulong bootflag)
|
|
{
|
|
bd_t *bd;
|
|
ulong len, addr, addr_sp;
|
|
ulong *s;
|
|
gd_t *id;
|
|
init_fnc_t **init_fnc_ptr;
|
|
#ifdef CONFIG_PRAM
|
|
int i;
|
|
ulong reg;
|
|
uchar tmp[64]; /* long enough for environment variables */
|
|
#endif
|
|
|
|
/* Pointer is writable since we allocated a register for it */
|
|
gd = (gd_t *) (CFG_INIT_RAM_ADDR + CFG_GBL_DATA_OFFSET);
|
|
/* compiler optimization barrier needed for GCC >= 3.4 */
|
|
__asm__ __volatile__("": : :"memory");
|
|
|
|
#if !defined(CONFIG_CPM2) && !defined(CONFIG_MPC83XX) && \
|
|
!defined(CONFIG_MPC85xx) && !defined(CONFIG_MPC86xx)
|
|
/* Clear initial global data */
|
|
memset ((void *) gd, 0, sizeof (gd_t));
|
|
#endif
|
|
|
|
for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
|
|
if ((*init_fnc_ptr) () != 0) {
|
|
hang ();
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Now that we have DRAM mapped and working, we can
|
|
* relocate the code and continue running from DRAM.
|
|
*
|
|
* Reserve memory at end of RAM for (top down in that order):
|
|
* - area that won't get touched by U-Boot and Linux (optional)
|
|
* - kernel log buffer
|
|
* - protected RAM
|
|
* - LCD framebuffer
|
|
* - monitor code
|
|
* - board info struct
|
|
*/
|
|
len = (ulong)&_end - CFG_MONITOR_BASE;
|
|
|
|
/*
|
|
* Subtract specified amount of memory to hide so that it won't
|
|
* get "touched" at all by U-Boot. By fixing up gd->ram_size
|
|
* the Linux kernel should now get passed the now "corrected"
|
|
* memory size and won't touch it either. This should work
|
|
* for arch/ppc and arch/powerpc. Only Linux board ports in
|
|
* arch/powerpc with bootwrapper support, that recalculate the
|
|
* memory size from the SDRAM controller setup will have to
|
|
* get fixed.
|
|
*/
|
|
gd->ram_size -= CFG_MEM_TOP_HIDE;
|
|
|
|
addr = CFG_SDRAM_BASE + get_effective_memsize();
|
|
|
|
#ifdef CONFIG_LOGBUFFER
|
|
#ifndef CONFIG_ALT_LB_ADDR
|
|
/* reserve kernel log buffer */
|
|
addr -= (LOGBUFF_RESERVE);
|
|
debug ("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN, addr);
|
|
#endif
|
|
#endif
|
|
|
|
#ifdef CONFIG_PRAM
|
|
/*
|
|
* reserve protected RAM
|
|
*/
|
|
i = getenv_r ("pram", (char *)tmp, sizeof (tmp));
|
|
reg = (i > 0) ? simple_strtoul ((const char *)tmp, NULL, 10) : CONFIG_PRAM;
|
|
addr -= (reg << 10); /* size is in kB */
|
|
debug ("Reserving %ldk for protected RAM at %08lx\n", reg, addr);
|
|
#endif /* CONFIG_PRAM */
|
|
|
|
/* round down to next 4 kB limit */
|
|
addr &= ~(4096 - 1);
|
|
debug ("Top of RAM usable for U-Boot at: %08lx\n", addr);
|
|
|
|
#ifdef CONFIG_LCD
|
|
/* reserve memory for LCD display (always full pages) */
|
|
addr = lcd_setmem (addr);
|
|
gd->fb_base = addr;
|
|
#endif /* CONFIG_LCD */
|
|
|
|
#if defined(CONFIG_VIDEO) && defined(CONFIG_8xx)
|
|
/* reserve memory for video display (always full pages) */
|
|
addr = video_setmem (addr);
|
|
gd->fb_base = addr;
|
|
#endif /* CONFIG_VIDEO */
|
|
|
|
/*
|
|
* reserve memory for U-Boot code, data & bss
|
|
* round down to next 4 kB limit
|
|
*/
|
|
addr -= len;
|
|
addr &= ~(4096 - 1);
|
|
#ifdef CONFIG_E500
|
|
/* round down to next 64 kB limit so that IVPR stays aligned */
|
|
addr &= ~(65536 - 1);
|
|
#endif
|
|
|
|
debug ("Reserving %ldk for U-Boot at: %08lx\n", len >> 10, addr);
|
|
|
|
#ifdef CONFIG_AMIGAONEG3SE
|
|
gd->relocaddr = addr;
|
|
#endif
|
|
|
|
/*
|
|
* reserve memory for malloc() arena
|
|
*/
|
|
addr_sp = addr - TOTAL_MALLOC_LEN;
|
|
debug ("Reserving %dk for malloc() at: %08lx\n",
|
|
TOTAL_MALLOC_LEN >> 10, addr_sp);
|
|
|
|
/*
|
|
* (permanently) allocate a Board Info struct
|
|
* and a permanent copy of the "global" data
|
|
*/
|
|
addr_sp -= sizeof (bd_t);
|
|
bd = (bd_t *) addr_sp;
|
|
gd->bd = bd;
|
|
debug ("Reserving %d Bytes for Board Info at: %08lx\n",
|
|
sizeof (bd_t), addr_sp);
|
|
addr_sp -= sizeof (gd_t);
|
|
id = (gd_t *) addr_sp;
|
|
debug ("Reserving %d Bytes for Global Data at: %08lx\n",
|
|
sizeof (gd_t), addr_sp);
|
|
|
|
/*
|
|
* Finally, we set up a new (bigger) stack.
|
|
*
|
|
* Leave some safety gap for SP, force alignment on 16 byte boundary
|
|
* Clear initial stack frame
|
|
*/
|
|
addr_sp -= 16;
|
|
addr_sp &= ~0xF;
|
|
s = (ulong *)addr_sp;
|
|
*s-- = 0;
|
|
*s-- = 0;
|
|
addr_sp = (ulong)s;
|
|
debug ("Stack Pointer at: %08lx\n", addr_sp);
|
|
|
|
/*
|
|
* Save local variables to board info struct
|
|
*/
|
|
|
|
bd->bi_memstart = CFG_SDRAM_BASE; /* start of DRAM memory */
|
|
bd->bi_memsize = gd->ram_size; /* size of DRAM memory in bytes */
|
|
|
|
#ifdef CONFIG_IP860
|
|
bd->bi_sramstart = SRAM_BASE; /* start of SRAM memory */
|
|
bd->bi_sramsize = SRAM_SIZE; /* size of SRAM memory */
|
|
#elif defined CONFIG_MPC8220
|
|
bd->bi_sramstart = CFG_SRAM_BASE; /* start of SRAM memory */
|
|
bd->bi_sramsize = CFG_SRAM_SIZE; /* size of SRAM memory */
|
|
#else
|
|
bd->bi_sramstart = 0; /* FIXME */ /* start of SRAM memory */
|
|
bd->bi_sramsize = 0; /* FIXME */ /* size of SRAM memory */
|
|
#endif
|
|
|
|
#if defined(CONFIG_8xx) || defined(CONFIG_8260) || defined(CONFIG_5xx) || \
|
|
defined(CONFIG_E500) || defined(CONFIG_MPC86xx)
|
|
bd->bi_immr_base = CFG_IMMR; /* base of IMMR register */
|
|
#endif
|
|
#if defined(CONFIG_MPC5xxx)
|
|
bd->bi_mbar_base = CFG_MBAR; /* base of internal registers */
|
|
#endif
|
|
#if defined(CONFIG_MPC83XX)
|
|
bd->bi_immrbar = CFG_IMMR;
|
|
#endif
|
|
#if defined(CONFIG_MPC8220)
|
|
bd->bi_mbar_base = CFG_MBAR; /* base of internal registers */
|
|
bd->bi_inpfreq = gd->inp_clk;
|
|
bd->bi_pcifreq = gd->pci_clk;
|
|
bd->bi_vcofreq = gd->vco_clk;
|
|
bd->bi_pevfreq = gd->pev_clk;
|
|
bd->bi_flbfreq = gd->flb_clk;
|
|
|
|
/* store bootparam to sram (backward compatible), here? */
|
|
{
|
|
u32 *sram = (u32 *)CFG_SRAM_BASE;
|
|
*sram++ = gd->ram_size;
|
|
*sram++ = gd->bus_clk;
|
|
*sram++ = gd->inp_clk;
|
|
*sram++ = gd->cpu_clk;
|
|
*sram++ = gd->vco_clk;
|
|
*sram++ = gd->flb_clk;
|
|
*sram++ = 0xb8c3ba11; /* boot signature */
|
|
}
|
|
#endif
|
|
|
|
bd->bi_bootflags = bootflag; /* boot / reboot flag (for LynxOS) */
|
|
|
|
WATCHDOG_RESET ();
|
|
bd->bi_intfreq = gd->cpu_clk; /* Internal Freq, in Hz */
|
|
bd->bi_busfreq = gd->bus_clk; /* Bus Freq, in Hz */
|
|
#if defined(CONFIG_CPM2)
|
|
bd->bi_cpmfreq = gd->cpm_clk;
|
|
bd->bi_brgfreq = gd->brg_clk;
|
|
bd->bi_sccfreq = gd->scc_clk;
|
|
bd->bi_vco = gd->vco_out;
|
|
#endif /* CONFIG_CPM2 */
|
|
#if defined(CONFIG_MPC512X)
|
|
bd->bi_ipsfreq = gd->ips_clk;
|
|
#endif /* CONFIG_MPC512X */
|
|
#if defined(CONFIG_MPC5xxx)
|
|
bd->bi_ipbfreq = gd->ipb_clk;
|
|
bd->bi_pcifreq = gd->pci_clk;
|
|
#endif /* CONFIG_MPC5xxx */
|
|
bd->bi_baudrate = gd->baudrate; /* Console Baudrate */
|
|
|
|
#ifdef CFG_EXTBDINFO
|
|
strncpy ((char *)bd->bi_s_version, "1.2", sizeof (bd->bi_s_version));
|
|
strncpy ((char *)bd->bi_r_version, U_BOOT_VERSION, sizeof (bd->bi_r_version));
|
|
|
|
bd->bi_procfreq = gd->cpu_clk; /* Processor Speed, In Hz */
|
|
bd->bi_plb_busfreq = gd->bus_clk;
|
|
#if defined(CONFIG_405GP) || defined(CONFIG_405EP) || \
|
|
defined(CONFIG_440EP) || defined(CONFIG_440GR) || \
|
|
defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
|
|
bd->bi_pci_busfreq = get_PCI_freq ();
|
|
bd->bi_opbfreq = get_OPB_freq ();
|
|
#elif defined(CONFIG_XILINX_ML300)
|
|
bd->bi_pci_busfreq = get_PCI_freq ();
|
|
#endif
|
|
#endif
|
|
|
|
debug ("New Stack Pointer is: %08lx\n", addr_sp);
|
|
|
|
WATCHDOG_RESET ();
|
|
|
|
#ifdef CONFIG_POST
|
|
post_bootmode_init();
|
|
post_run (NULL, POST_ROM | post_bootmode_get(0));
|
|
#endif
|
|
|
|
WATCHDOG_RESET();
|
|
|
|
memcpy (id, (void *)gd, sizeof (gd_t));
|
|
|
|
relocate_code (addr_sp, id, addr);
|
|
|
|
/* NOTREACHED - relocate_code() does not return */
|
|
}
|
|
|
|
/************************************************************************
|
|
*
|
|
* This is the next part if the initialization sequence: we are now
|
|
* running from RAM and have a "normal" C environment, i. e. global
|
|
* data can be written, BSS has been cleared, the stack size in not
|
|
* that critical any more, etc.
|
|
*
|
|
************************************************************************
|
|
*/
|
|
void board_init_r (gd_t *id, ulong dest_addr)
|
|
{
|
|
cmd_tbl_t *cmdtp;
|
|
char *s, *e;
|
|
bd_t *bd;
|
|
int i;
|
|
extern void malloc_bin_reloc (void);
|
|
#ifndef CFG_ENV_IS_NOWHERE
|
|
extern char * env_name_spec;
|
|
#endif
|
|
|
|
#ifndef CFG_NO_FLASH
|
|
ulong flash_size;
|
|
#endif
|
|
|
|
gd = id; /* initialize RAM version of global data */
|
|
bd = gd->bd;
|
|
|
|
gd->flags |= GD_FLG_RELOC; /* tell others: relocation done */
|
|
|
|
#if defined(CONFIG_RELOC_FIXUP_WORKS)
|
|
gd->reloc_off = 0;
|
|
mem_malloc_end = dest_addr;
|
|
#else
|
|
gd->reloc_off = dest_addr - CFG_MONITOR_BASE;
|
|
#endif
|
|
|
|
#ifdef CONFIG_SERIAL_MULTI
|
|
serial_initialize();
|
|
#endif
|
|
|
|
debug ("Now running in RAM - U-Boot at: %08lx\n", dest_addr);
|
|
|
|
WATCHDOG_RESET ();
|
|
|
|
#if defined(CONFIG_BOARD_EARLY_INIT_R)
|
|
board_early_init_r ();
|
|
#endif
|
|
|
|
monitor_flash_len = (ulong)&__init_end - dest_addr;
|
|
|
|
/*
|
|
* We have to relocate the command table manually
|
|
*/
|
|
for (cmdtp = &__u_boot_cmd_start; cmdtp != &__u_boot_cmd_end; cmdtp++) {
|
|
ulong addr;
|
|
addr = (ulong) (cmdtp->cmd) + gd->reloc_off;
|
|
#if 0
|
|
printf ("Command \"%s\": 0x%08lx => 0x%08lx\n",
|
|
cmdtp->name, (ulong) (cmdtp->cmd), addr);
|
|
#endif
|
|
cmdtp->cmd =
|
|
(int (*)(struct cmd_tbl_s *, int, int, char *[]))addr;
|
|
|
|
addr = (ulong)(cmdtp->name) + gd->reloc_off;
|
|
cmdtp->name = (char *)addr;
|
|
|
|
if (cmdtp->usage) {
|
|
addr = (ulong)(cmdtp->usage) + gd->reloc_off;
|
|
cmdtp->usage = (char *)addr;
|
|
}
|
|
#ifdef CFG_LONGHELP
|
|
if (cmdtp->help) {
|
|
addr = (ulong)(cmdtp->help) + gd->reloc_off;
|
|
cmdtp->help = (char *)addr;
|
|
}
|
|
#endif
|
|
}
|
|
/* there are some other pointer constants we must deal with */
|
|
#ifndef CFG_ENV_IS_NOWHERE
|
|
env_name_spec += gd->reloc_off;
|
|
#endif
|
|
|
|
WATCHDOG_RESET ();
|
|
|
|
#ifdef CONFIG_LOGBUFFER
|
|
logbuff_init_ptrs ();
|
|
#endif
|
|
#ifdef CONFIG_POST
|
|
post_output_backlog ();
|
|
post_reloc ();
|
|
#endif
|
|
|
|
WATCHDOG_RESET();
|
|
|
|
#if defined(CONFIG_IP860) || defined(CONFIG_PCU_E) || \
|
|
defined (CONFIG_FLAGADM) || defined(CONFIG_MPC83XX)
|
|
icache_enable (); /* it's time to enable the instruction cache */
|
|
#endif
|
|
|
|
#if defined(CFG_INIT_RAM_LOCK) && defined(CONFIG_E500)
|
|
unlock_ram_in_cache(); /* it's time to unlock D-cache in e500 */
|
|
#endif
|
|
|
|
#if defined(CONFIG_BAB7xx) || defined(CONFIG_CPC45)
|
|
/*
|
|
* Do PCI configuration on BAB7xx and CPC45 _before_ the flash
|
|
* gets initialised, because we need the ISA resp. PCI_to_LOCAL bus
|
|
* bridge there.
|
|
*/
|
|
pci_init ();
|
|
#endif
|
|
#if defined(CONFIG_BAB7xx)
|
|
/*
|
|
* Initialise the ISA bridge
|
|
*/
|
|
initialise_w83c553f ();
|
|
#endif
|
|
|
|
asm ("sync ; isync");
|
|
|
|
/*
|
|
* Setup trap handlers
|
|
*/
|
|
trap_init (dest_addr);
|
|
|
|
#if !defined(CFG_NO_FLASH)
|
|
puts ("FLASH: ");
|
|
|
|
if ((flash_size = flash_init ()) > 0) {
|
|
# ifdef CFG_FLASH_CHECKSUM
|
|
print_size (flash_size, "");
|
|
/*
|
|
* Compute and print flash CRC if flashchecksum is set to 'y'
|
|
*
|
|
* NOTE: Maybe we should add some WATCHDOG_RESET()? XXX
|
|
*/
|
|
s = getenv ("flashchecksum");
|
|
if (s && (*s == 'y')) {
|
|
printf (" CRC: %08lX",
|
|
crc32 (0, (const unsigned char *) CFG_FLASH_BASE, flash_size)
|
|
);
|
|
}
|
|
putc ('\n');
|
|
# else /* !CFG_FLASH_CHECKSUM */
|
|
print_size (flash_size, "\n");
|
|
# endif /* CFG_FLASH_CHECKSUM */
|
|
} else {
|
|
puts (failed);
|
|
hang ();
|
|
}
|
|
|
|
bd->bi_flashstart = CFG_FLASH_BASE; /* update start of FLASH memory */
|
|
bd->bi_flashsize = flash_size; /* size of FLASH memory (final value) */
|
|
|
|
#if defined(CFG_UPDATE_FLASH_SIZE)
|
|
/* Make a update of the Memctrl. */
|
|
update_flash_size (flash_size);
|
|
#endif
|
|
|
|
|
|
# if defined(CONFIG_PCU_E) || defined(CONFIG_OXC) || defined(CONFIG_RMU)
|
|
/* flash mapped at end of memory map */
|
|
bd->bi_flashoffset = TEXT_BASE + flash_size;
|
|
# elif CFG_MONITOR_BASE == CFG_FLASH_BASE
|
|
bd->bi_flashoffset = monitor_flash_len; /* reserved area for startup monitor */
|
|
# else
|
|
bd->bi_flashoffset = 0;
|
|
# endif
|
|
#else /* CFG_NO_FLASH */
|
|
|
|
bd->bi_flashsize = 0;
|
|
bd->bi_flashstart = 0;
|
|
bd->bi_flashoffset = 0;
|
|
#endif /* !CFG_NO_FLASH */
|
|
|
|
WATCHDOG_RESET ();
|
|
|
|
/* initialize higher level parts of CPU like time base and timers */
|
|
cpu_init_r ();
|
|
|
|
WATCHDOG_RESET ();
|
|
|
|
/* initialize malloc() area */
|
|
mem_malloc_init ();
|
|
malloc_bin_reloc ();
|
|
|
|
#ifdef CONFIG_SPI
|
|
# if !defined(CFG_ENV_IS_IN_EEPROM)
|
|
spi_init_f ();
|
|
# endif
|
|
spi_init_r ();
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_NAND)
|
|
WATCHDOG_RESET ();
|
|
puts ("NAND: ");
|
|
nand_init(); /* go init the NAND */
|
|
#endif
|
|
|
|
/* relocate environment function pointers etc. */
|
|
env_relocate ();
|
|
|
|
/*
|
|
* Fill in missing fields of bd_info.
|
|
* We do this here, where we have "normal" access to the
|
|
* environment; we used to do this still running from ROM,
|
|
* where had to use getenv_r(), which can be pretty slow when
|
|
* the environment is in EEPROM.
|
|
*/
|
|
|
|
#if defined(CFG_EXTBDINFO)
|
|
#if defined(CONFIG_405GP) || defined(CONFIG_405EP)
|
|
#if defined(CONFIG_I2CFAST)
|
|
/*
|
|
* set bi_iic_fast for linux taking environment variable
|
|
* "i2cfast" into account
|
|
*/
|
|
{
|
|
char *s = getenv ("i2cfast");
|
|
if (s && ((*s == 'y') || (*s == 'Y'))) {
|
|
bd->bi_iic_fast[0] = 1;
|
|
bd->bi_iic_fast[1] = 1;
|
|
} else {
|
|
bd->bi_iic_fast[0] = 0;
|
|
bd->bi_iic_fast[1] = 0;
|
|
}
|
|
}
|
|
#else
|
|
bd->bi_iic_fast[0] = 0;
|
|
bd->bi_iic_fast[1] = 0;
|
|
#endif /* CONFIG_I2CFAST */
|
|
#endif /* CONFIG_405GP, CONFIG_405EP */
|
|
#endif /* CFG_EXTBDINFO */
|
|
|
|
#if defined(CONFIG_SC3)
|
|
sc3_read_eeprom();
|
|
#endif
|
|
|
|
#if defined (CFG_ID_EEPROM) || defined (CFG_I2C_MAC_OFFSET)
|
|
mac_read_from_eeprom();
|
|
#endif
|
|
|
|
s = getenv ("ethaddr");
|
|
#if defined (CONFIG_MBX) || \
|
|
defined (CONFIG_RPXCLASSIC) || \
|
|
defined(CONFIG_IAD210) || \
|
|
defined(CONFIG_V38B)
|
|
if (s == NULL)
|
|
board_get_enetaddr (bd->bi_enetaddr);
|
|
else
|
|
#endif
|
|
for (i = 0; i < 6; ++i) {
|
|
bd->bi_enetaddr[i] = s ? simple_strtoul (s, &e, 16) : 0;
|
|
if (s)
|
|
s = (*e) ? e + 1 : e;
|
|
}
|
|
#ifdef CONFIG_HERMES
|
|
if ((gd->board_type >> 16) == 2)
|
|
bd->bi_ethspeed = gd->board_type & 0xFFFF;
|
|
else
|
|
bd->bi_ethspeed = 0xFFFF;
|
|
#endif
|
|
|
|
#ifdef CONFIG_NX823
|
|
load_sernum_ethaddr ();
|
|
#endif
|
|
|
|
#ifdef CONFIG_HAS_ETH1
|
|
/* handle the 2nd ethernet address */
|
|
|
|
s = getenv ("eth1addr");
|
|
|
|
for (i = 0; i < 6; ++i) {
|
|
bd->bi_enet1addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
|
|
if (s)
|
|
s = (*e) ? e + 1 : e;
|
|
}
|
|
#endif
|
|
#ifdef CONFIG_HAS_ETH2
|
|
/* handle the 3rd ethernet address */
|
|
|
|
s = getenv ("eth2addr");
|
|
#if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
|
|
if (s == NULL)
|
|
board_get_enetaddr(bd->bi_enet2addr);
|
|
else
|
|
#endif
|
|
for (i = 0; i < 6; ++i) {
|
|
bd->bi_enet2addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
|
|
if (s)
|
|
s = (*e) ? e + 1 : e;
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_HAS_ETH3
|
|
/* handle 4th ethernet address */
|
|
s = getenv("eth3addr");
|
|
#if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
|
|
if (s == NULL)
|
|
board_get_enetaddr(bd->bi_enet3addr);
|
|
else
|
|
#endif
|
|
for (i = 0; i < 6; ++i) {
|
|
bd->bi_enet3addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
|
|
if (s)
|
|
s = (*e) ? e + 1 : e;
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_TQM8xxL) || defined(CONFIG_TQM8260) || \
|
|
defined(CONFIG_TQM8272) || \
|
|
defined(CONFIG_CCM) || defined(CONFIG_KUP4K) || \
|
|
defined(CONFIG_KUP4X) || defined(CONFIG_PCS440EP)
|
|
load_sernum_ethaddr ();
|
|
#endif
|
|
/* IP Address */
|
|
bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
|
|
|
|
WATCHDOG_RESET ();
|
|
|
|
#if defined(CONFIG_PCI) && !defined(CONFIG_BAB7xx) && !defined(CONFIG_CPC45)
|
|
/*
|
|
* Do pci configuration
|
|
*/
|
|
pci_init ();
|
|
#endif
|
|
|
|
/** leave this here (after malloc(), environment and PCI are working) **/
|
|
/* Initialize devices */
|
|
devices_init ();
|
|
|
|
/* Initialize the jump table for applications */
|
|
jumptable_init ();
|
|
|
|
#if defined(CONFIG_API)
|
|
/* Initialize API */
|
|
api_init ();
|
|
#endif
|
|
|
|
/* Initialize the console (after the relocation and devices init) */
|
|
console_init_r ();
|
|
|
|
#if defined(CONFIG_CCM) || \
|
|
defined(CONFIG_COGENT) || \
|
|
defined(CONFIG_CPCI405) || \
|
|
defined(CONFIG_EVB64260) || \
|
|
defined(CONFIG_KUP4K) || \
|
|
defined(CONFIG_KUP4X) || \
|
|
defined(CONFIG_LWMON) || \
|
|
defined(CONFIG_PCU_E) || \
|
|
defined(CONFIG_SC3) || \
|
|
defined(CONFIG_W7O) || \
|
|
defined(CONFIG_MISC_INIT_R)
|
|
/* miscellaneous platform dependent initialisations */
|
|
misc_init_r ();
|
|
#endif
|
|
|
|
#ifdef CONFIG_HERMES
|
|
if (bd->bi_ethspeed != 0xFFFF)
|
|
hermes_start_lxt980 ((int) bd->bi_ethspeed);
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_KGDB)
|
|
WATCHDOG_RESET ();
|
|
puts ("KGDB: ");
|
|
kgdb_init ();
|
|
#endif
|
|
|
|
debug ("U-Boot relocated to %08lx\n", dest_addr);
|
|
|
|
/*
|
|
* Enable Interrupts
|
|
*/
|
|
interrupt_init ();
|
|
|
|
/* Must happen after interrupts are initialized since
|
|
* an irq handler gets installed
|
|
*/
|
|
#ifdef CONFIG_SERIAL_SOFTWARE_FIFO
|
|
serial_buffered_init();
|
|
#endif
|
|
|
|
#if defined(CONFIG_STATUS_LED) && defined(STATUS_LED_BOOT)
|
|
status_led_set (STATUS_LED_BOOT, STATUS_LED_BLINKING);
|
|
#endif
|
|
|
|
udelay (20);
|
|
|
|
set_timer (0);
|
|
|
|
/* Initialize from environment */
|
|
if ((s = getenv ("loadaddr")) != NULL) {
|
|
load_addr = simple_strtoul (s, NULL, 16);
|
|
}
|
|
#if defined(CONFIG_CMD_NET)
|
|
if ((s = getenv ("bootfile")) != NULL) {
|
|
copy_filename (BootFile, s, sizeof (BootFile));
|
|
}
|
|
#endif
|
|
|
|
WATCHDOG_RESET ();
|
|
|
|
#if defined(CONFIG_CMD_SCSI)
|
|
WATCHDOG_RESET ();
|
|
puts ("SCSI: ");
|
|
scsi_init ();
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_DOC)
|
|
WATCHDOG_RESET ();
|
|
puts ("DOC: ");
|
|
doc_init ();
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_NET)
|
|
#if defined(CONFIG_NET_MULTI)
|
|
WATCHDOG_RESET ();
|
|
puts ("Net: ");
|
|
#endif
|
|
eth_initialize (bd);
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_NET) && ( \
|
|
defined(CONFIG_CCM) || \
|
|
defined(CONFIG_ELPT860) || \
|
|
defined(CONFIG_EP8260) || \
|
|
defined(CONFIG_IP860) || \
|
|
defined(CONFIG_IVML24) || \
|
|
defined(CONFIG_IVMS8) || \
|
|
defined(CONFIG_MPC8260ADS) || \
|
|
defined(CONFIG_MPC8266ADS) || \
|
|
defined(CONFIG_MPC8560ADS) || \
|
|
defined(CONFIG_PCU_E) || \
|
|
defined(CONFIG_RPXSUPER) || \
|
|
defined(CONFIG_STXGP3) || \
|
|
defined(CONFIG_SPD823TS) || \
|
|
defined(CONFIG_RESET_PHY_R) )
|
|
|
|
WATCHDOG_RESET ();
|
|
debug ("Reset Ethernet PHY\n");
|
|
reset_phy ();
|
|
#endif
|
|
|
|
#ifdef CONFIG_POST
|
|
post_run (NULL, POST_RAM | post_bootmode_get(0));
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_PCMCIA) \
|
|
&& !defined(CONFIG_CMD_IDE)
|
|
WATCHDOG_RESET ();
|
|
puts ("PCMCIA:");
|
|
pcmcia_init ();
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_IDE)
|
|
WATCHDOG_RESET ();
|
|
# ifdef CONFIG_IDE_8xx_PCCARD
|
|
puts ("PCMCIA:");
|
|
# else
|
|
puts ("IDE: ");
|
|
#endif
|
|
#if defined(CONFIG_START_IDE)
|
|
if (board_start_ide())
|
|
ide_init ();
|
|
#else
|
|
ide_init ();
|
|
#endif
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_SATA)
|
|
puts ("SATA: ");
|
|
sata_initialize ();
|
|
#endif
|
|
|
|
#ifdef CONFIG_LAST_STAGE_INIT
|
|
WATCHDOG_RESET ();
|
|
/*
|
|
* Some parts can be only initialized if all others (like
|
|
* Interrupts) are up and running (i.e. the PC-style ISA
|
|
* keyboard).
|
|
*/
|
|
last_stage_init ();
|
|
#endif
|
|
|
|
#if defined(CONFIG_CMD_BEDBUG)
|
|
WATCHDOG_RESET ();
|
|
bedbug_init ();
|
|
#endif
|
|
|
|
#if defined(CONFIG_PRAM) || defined(CONFIG_LOGBUFFER)
|
|
/*
|
|
* Export available size of memory for Linux,
|
|
* taking into account the protected RAM at top of memory
|
|
*/
|
|
{
|
|
ulong pram;
|
|
uchar memsz[32];
|
|
#ifdef CONFIG_PRAM
|
|
char *s;
|
|
|
|
if ((s = getenv ("pram")) != NULL) {
|
|
pram = simple_strtoul (s, NULL, 10);
|
|
} else {
|
|
pram = CONFIG_PRAM;
|
|
}
|
|
#else
|
|
pram=0;
|
|
#endif
|
|
#ifdef CONFIG_LOGBUFFER
|
|
#ifndef CONFIG_ALT_LB_ADDR
|
|
/* Also take the logbuffer into account (pram is in kB) */
|
|
pram += (LOGBUFF_LEN+LOGBUFF_OVERHEAD)/1024;
|
|
#endif
|
|
#endif
|
|
sprintf ((char *)memsz, "%ldk", (bd->bi_memsize / 1024) - pram);
|
|
setenv ("mem", (char *)memsz);
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_PS2KBD
|
|
puts ("PS/2: ");
|
|
kbd_init();
|
|
#endif
|
|
|
|
#ifdef CONFIG_MODEM_SUPPORT
|
|
{
|
|
extern int do_mdm_init;
|
|
do_mdm_init = gd->do_mdm_init;
|
|
}
|
|
#endif
|
|
|
|
/* Initialization complete - start the monitor */
|
|
|
|
/* main_loop() can return to retry autoboot, if so just run it again. */
|
|
for (;;) {
|
|
WATCHDOG_RESET ();
|
|
main_loop ();
|
|
}
|
|
|
|
/* NOTREACHED - no way out of command loop except booting */
|
|
}
|
|
|
|
void hang (void)
|
|
{
|
|
puts ("### ERROR ### Please RESET the board ###\n");
|
|
show_boot_progress(-30);
|
|
for (;;);
|
|
}
|
|
|
|
#ifdef CONFIG_MODEM_SUPPORT
|
|
/* called from main loop (common/main.c) */
|
|
/* 'inline' - We have to do it fast */
|
|
static inline void mdm_readline(char *buf, int bufsiz)
|
|
{
|
|
char c;
|
|
char *p;
|
|
int n;
|
|
|
|
n = 0;
|
|
p = buf;
|
|
for(;;) {
|
|
c = serial_getc();
|
|
|
|
/* dbg("(%c)", c); */
|
|
|
|
switch(c) {
|
|
case '\r':
|
|
break;
|
|
case '\n':
|
|
*p = '\0';
|
|
return;
|
|
|
|
default:
|
|
if(n++ > bufsiz) {
|
|
*p = '\0';
|
|
return; /* sanity check */
|
|
}
|
|
*p = c;
|
|
p++;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
extern void dbg(const char *fmt, ...);
|
|
int mdm_init (void)
|
|
{
|
|
char env_str[16];
|
|
char *init_str;
|
|
int i;
|
|
extern char console_buffer[];
|
|
extern void enable_putc(void);
|
|
extern int hwflow_onoff(int);
|
|
|
|
enable_putc(); /* enable serial_putc() */
|
|
|
|
#ifdef CONFIG_HWFLOW
|
|
init_str = getenv("mdm_flow_control");
|
|
if (init_str && (strcmp(init_str, "rts/cts") == 0))
|
|
hwflow_onoff (1);
|
|
else
|
|
hwflow_onoff(-1);
|
|
#endif
|
|
|
|
for (i = 1;;i++) {
|
|
sprintf(env_str, "mdm_init%d", i);
|
|
if ((init_str = getenv(env_str)) != NULL) {
|
|
serial_puts(init_str);
|
|
serial_puts("\n");
|
|
for(;;) {
|
|
mdm_readline(console_buffer, CFG_CBSIZE);
|
|
dbg("ini%d: [%s]", i, console_buffer);
|
|
|
|
if ((strcmp(console_buffer, "OK") == 0) ||
|
|
(strcmp(console_buffer, "ERROR") == 0)) {
|
|
dbg("ini%d: cmd done", i);
|
|
break;
|
|
} else /* in case we are originating call ... */
|
|
if (strncmp(console_buffer, "CONNECT", 7) == 0) {
|
|
dbg("ini%d: connect", i);
|
|
return 0;
|
|
}
|
|
}
|
|
} else
|
|
break; /* no init string - stop modem init */
|
|
|
|
udelay(100000);
|
|
}
|
|
|
|
udelay(100000);
|
|
|
|
/* final stage - wait for connect */
|
|
for(;i > 1;) { /* if 'i' > 1 - wait for connection
|
|
message from modem */
|
|
mdm_readline(console_buffer, CFG_CBSIZE);
|
|
dbg("ini_f: [%s]", console_buffer);
|
|
if (strncmp(console_buffer, "CONNECT", 7) == 0) {
|
|
dbg("ini_f: connected");
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#endif
|
|
|
|
#if 0 /* We could use plain global data, but the resulting code is bigger */
|
|
/*
|
|
* Pointer to initial global data area
|
|
*
|
|
* Here we initialize it.
|
|
*/
|
|
#undef XTRN_DECLARE_GLOBAL_DATA_PTR
|
|
#define XTRN_DECLARE_GLOBAL_DATA_PTR /* empty = allocate here */
|
|
DECLARE_GLOBAL_DATA_PTR = (gd_t *) (CFG_INIT_RAM_ADDR + CFG_GBL_DATA_OFFSET);
|
|
#endif /* 0 */
|
|
|
|
/************************************************************************/
|