board.c 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332
  1. /*
  2. * (C) Copyright 2000-2006
  3. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  4. *
  5. * See file CREDITS for list of people who contributed to this
  6. * project.
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License as
  10. * published by the Free Software Foundation; either version 2 of
  11. * the License, or (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21. * MA 02111-1307 USA
  22. */
  23. #include <common.h>
  24. #include <watchdog.h>
  25. #include <command.h>
  26. #include <malloc.h>
  27. #include <devices.h>
  28. #ifdef CONFIG_8xx
  29. #include <mpc8xx.h>
  30. #endif
  31. #ifdef CONFIG_5xx
  32. #include <mpc5xx.h>
  33. #endif
  34. #ifdef CONFIG_MPC5xxx
  35. #include <mpc5xxx.h>
  36. #endif
  37. #if defined(CONFIG_CMD_IDE)
  38. #include <ide.h>
  39. #endif
  40. #if defined(CONFIG_CMD_SCSI)
  41. #include <scsi.h>
  42. #endif
  43. #if defined(CONFIG_CMD_KGDB)
  44. #include <kgdb.h>
  45. #endif
  46. #ifdef CONFIG_STATUS_LED
  47. #include <status_led.h>
  48. #endif
  49. #include <net.h>
  50. #ifdef CONFIG_GENERIC_MMC
  51. #include <mmc.h>
  52. #endif
  53. #include <serial.h>
  54. #ifdef CONFIG_SYS_ALLOC_DPRAM
  55. #if !defined(CONFIG_CPM2)
  56. #include <commproc.h>
  57. #endif
  58. #endif
  59. #include <version.h>
  60. #if defined(CONFIG_BAB7xx)
  61. #include <w83c553f.h>
  62. #endif
  63. #include <dtt.h>
  64. #if defined(CONFIG_POST)
  65. #include <post.h>
  66. #endif
  67. #if defined(CONFIG_LOGBUFFER)
  68. #include <logbuff.h>
  69. #endif
  70. #if defined(CONFIG_SYS_INIT_RAM_LOCK) && defined(CONFIG_E500)
  71. #include <asm/cache.h>
  72. #endif
  73. #ifdef CONFIG_PS2KBD
  74. #include <keyboard.h>
  75. #endif
  76. #ifdef CONFIG_ADDR_MAP
  77. #include <asm/mmu.h>
  78. #endif
  79. #ifdef CONFIG_SYS_UPDATE_FLASH_SIZE
  80. extern int update_flash_size (int flash_size);
  81. #endif
  82. #if defined(CONFIG_SC3)
  83. extern void sc3_read_eeprom(void);
  84. #endif
  85. #if defined(CONFIG_CMD_DOC)
  86. void doc_init (void);
  87. #endif
  88. #if defined(CONFIG_HARD_I2C) || \
  89. defined(CONFIG_SOFT_I2C)
  90. #include <i2c.h>
  91. #endif
  92. #include <spi.h>
  93. #include <nand.h>
  94. static char *failed = "*** failed ***\n";
  95. #if defined(CONFIG_OXC) || defined(CONFIG_PCU_E) || defined(CONFIG_RMU)
  96. extern flash_info_t flash_info[];
  97. #endif
  98. #if defined(CONFIG_START_IDE)
  99. extern int board_start_ide(void);
  100. #endif
  101. #include <environment.h>
  102. DECLARE_GLOBAL_DATA_PTR;
  103. #if defined(CONFIG_ENV_IS_EMBEDDED)
  104. #define TOTAL_MALLOC_LEN CONFIG_SYS_MALLOC_LEN
  105. #elif ( ((CONFIG_ENV_ADDR+CONFIG_ENV_SIZE) < CONFIG_SYS_MONITOR_BASE) || \
  106. (CONFIG_ENV_ADDR >= (CONFIG_SYS_MONITOR_BASE + CONFIG_SYS_MONITOR_LEN)) ) || \
  107. defined(CONFIG_ENV_IS_IN_NVRAM)
  108. #define TOTAL_MALLOC_LEN (CONFIG_SYS_MALLOC_LEN + CONFIG_ENV_SIZE)
  109. #else
  110. #define TOTAL_MALLOC_LEN CONFIG_SYS_MALLOC_LEN
  111. #endif
  112. #if !defined(CONFIG_SYS_MEM_TOP_HIDE)
  113. #define CONFIG_SYS_MEM_TOP_HIDE 0
  114. #endif
  115. extern ulong __init_end;
  116. extern ulong _end;
  117. ulong monitor_flash_len;
  118. #if defined(CONFIG_CMD_BEDBUG)
  119. #include <bedbug/type.h>
  120. #endif
  121. /*
  122. * Begin and End of memory area for malloc(), and current "brk"
  123. */
  124. static ulong mem_malloc_start = 0;
  125. static ulong mem_malloc_end = 0;
  126. static ulong mem_malloc_brk = 0;
  127. /************************************************************************
  128. * Utilities *
  129. ************************************************************************
  130. */
  131. /*
  132. * The Malloc area is immediately below the monitor copy in DRAM
  133. */
  134. static void mem_malloc_init (void)
  135. {
  136. #if !defined(CONFIG_RELOC_FIXUP_WORKS)
  137. mem_malloc_end = CONFIG_SYS_MONITOR_BASE + gd->reloc_off;
  138. #endif
  139. mem_malloc_start = mem_malloc_end - TOTAL_MALLOC_LEN;
  140. mem_malloc_brk = mem_malloc_start;
  141. memset ((void *) mem_malloc_start,
  142. 0,
  143. mem_malloc_end - mem_malloc_start);
  144. }
  145. void *sbrk (ptrdiff_t increment)
  146. {
  147. ulong old = mem_malloc_brk;
  148. ulong new = old + increment;
  149. if ((new < mem_malloc_start) || (new > mem_malloc_end)) {
  150. return (NULL);
  151. }
  152. mem_malloc_brk = new;
  153. return ((void *) old);
  154. }
  155. /*
  156. * All attempts to come up with a "common" initialization sequence
  157. * that works for all boards and architectures failed: some of the
  158. * requirements are just _too_ different. To get rid of the resulting
  159. * mess of board dependend #ifdef'ed code we now make the whole
  160. * initialization sequence configurable to the user.
  161. *
  162. * The requirements for any new initalization function is simple: it
  163. * receives a pointer to the "global data" structure as it's only
  164. * argument, and returns an integer return code, where 0 means
  165. * "continue" and != 0 means "fatal error, hang the system".
  166. */
  167. typedef int (init_fnc_t) (void);
  168. /************************************************************************
  169. * Init Utilities *
  170. ************************************************************************
  171. * Some of this code should be moved into the core functions,
  172. * but let's get it working (again) first...
  173. */
  174. static int init_baudrate (void)
  175. {
  176. char tmp[64]; /* long enough for environment variables */
  177. int i = getenv_r ("baudrate", tmp, sizeof (tmp));
  178. gd->baudrate = (i > 0)
  179. ? (int) simple_strtoul (tmp, NULL, 10)
  180. : CONFIG_BAUDRATE;
  181. return (0);
  182. }
  183. /***********************************************************************/
  184. void __board_add_ram_info(int use_default)
  185. {
  186. /* please define platform specific board_add_ram_info() */
  187. }
  188. void board_add_ram_info(int) __attribute__((weak, alias("__board_add_ram_info")));
  189. static int init_func_ram (void)
  190. {
  191. #ifdef CONFIG_BOARD_TYPES
  192. int board_type = gd->board_type;
  193. #else
  194. int board_type = 0; /* use dummy arg */
  195. #endif
  196. puts ("DRAM: ");
  197. if ((gd->ram_size = initdram (board_type)) > 0) {
  198. print_size (gd->ram_size, "");
  199. board_add_ram_info(0);
  200. putc('\n');
  201. return (0);
  202. }
  203. puts (failed);
  204. return (1);
  205. }
  206. /***********************************************************************/
  207. #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
  208. static int init_func_i2c (void)
  209. {
  210. puts ("I2C: ");
  211. i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
  212. puts ("ready\n");
  213. return (0);
  214. }
  215. #endif
  216. #if defined(CONFIG_HARD_SPI)
  217. static int init_func_spi (void)
  218. {
  219. puts ("SPI: ");
  220. spi_init ();
  221. puts ("ready\n");
  222. return (0);
  223. }
  224. #endif
  225. /***********************************************************************/
  226. #if defined(CONFIG_WATCHDOG)
  227. static int init_func_watchdog_init (void)
  228. {
  229. puts (" Watchdog enabled\n");
  230. WATCHDOG_RESET ();
  231. return (0);
  232. }
  233. # define INIT_FUNC_WATCHDOG_INIT init_func_watchdog_init,
  234. static int init_func_watchdog_reset (void)
  235. {
  236. WATCHDOG_RESET ();
  237. return (0);
  238. }
  239. # define INIT_FUNC_WATCHDOG_RESET init_func_watchdog_reset,
  240. #else
  241. # define INIT_FUNC_WATCHDOG_INIT /* undef */
  242. # define INIT_FUNC_WATCHDOG_RESET /* undef */
  243. #endif /* CONFIG_WATCHDOG */
  244. /************************************************************************
  245. * Initialization sequence *
  246. ************************************************************************
  247. */
  248. init_fnc_t *init_sequence[] = {
  249. #if defined(CONFIG_BOARD_EARLY_INIT_F)
  250. board_early_init_f,
  251. #endif
  252. #if !defined(CONFIG_8xx_CPUCLK_DEFAULT)
  253. get_clocks, /* get CPU and bus clocks (etc.) */
  254. #if defined(CONFIG_TQM8xxL) && !defined(CONFIG_TQM866M) \
  255. && !defined(CONFIG_TQM885D)
  256. adjust_sdram_tbs_8xx,
  257. #endif
  258. init_timebase,
  259. #endif
  260. #ifdef CONFIG_SYS_ALLOC_DPRAM
  261. #if !defined(CONFIG_CPM2)
  262. dpram_init,
  263. #endif
  264. #endif
  265. #if defined(CONFIG_BOARD_POSTCLK_INIT)
  266. board_postclk_init,
  267. #endif
  268. env_init,
  269. #if defined(CONFIG_8xx_CPUCLK_DEFAULT)
  270. get_clocks_866, /* get CPU and bus clocks according to the environment variable */
  271. sdram_adjust_866, /* adjust sdram refresh rate according to the new clock */
  272. init_timebase,
  273. #endif
  274. init_baudrate,
  275. serial_init,
  276. console_init_f,
  277. display_options,
  278. #if defined(CONFIG_8260)
  279. prt_8260_rsr,
  280. prt_8260_clks,
  281. #endif /* CONFIG_8260 */
  282. #if defined(CONFIG_MPC83XX)
  283. prt_83xx_rsr,
  284. #endif
  285. checkcpu,
  286. #if defined(CONFIG_MPC5xxx)
  287. prt_mpc5xxx_clks,
  288. #endif /* CONFIG_MPC5xxx */
  289. #if defined(CONFIG_MPC8220)
  290. prt_mpc8220_clks,
  291. #endif
  292. checkboard,
  293. INIT_FUNC_WATCHDOG_INIT
  294. #if defined(CONFIG_MISC_INIT_F)
  295. misc_init_f,
  296. #endif
  297. INIT_FUNC_WATCHDOG_RESET
  298. #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
  299. init_func_i2c,
  300. #endif
  301. #if defined(CONFIG_HARD_SPI)
  302. init_func_spi,
  303. #endif
  304. #if defined(CONFIG_DTT) /* Digital Thermometers and Thermostats */
  305. dtt_init,
  306. #endif
  307. #ifdef CONFIG_POST
  308. post_init_f,
  309. #endif
  310. INIT_FUNC_WATCHDOG_RESET
  311. init_func_ram,
  312. #if defined(CONFIG_SYS_DRAM_TEST)
  313. testdram,
  314. #endif /* CONFIG_SYS_DRAM_TEST */
  315. INIT_FUNC_WATCHDOG_RESET
  316. NULL, /* Terminate this list */
  317. };
  318. ulong get_effective_memsize(void)
  319. {
  320. #ifndef CONFIG_VERY_BIG_RAM
  321. return gd->ram_size;
  322. #else
  323. /* limit stack to what we can reasonable map */
  324. return ((gd->ram_size > CONFIG_MAX_MEM_MAPPED) ?
  325. CONFIG_MAX_MEM_MAPPED : gd->ram_size);
  326. #endif
  327. }
  328. /************************************************************************
  329. *
  330. * This is the first part of the initialization sequence that is
  331. * implemented in C, but still running from ROM.
  332. *
  333. * The main purpose is to provide a (serial) console interface as
  334. * soon as possible (so we can see any error messages), and to
  335. * initialize the RAM so that we can relocate the monitor code to
  336. * RAM.
  337. *
  338. * Be aware of the restrictions: global data is read-only, BSS is not
  339. * initialized, and stack space is limited to a few kB.
  340. *
  341. ************************************************************************
  342. */
  343. #ifdef CONFIG_LOGBUFFER
  344. unsigned long logbuffer_base(void)
  345. {
  346. return CONFIG_SYS_SDRAM_BASE + get_effective_memsize() - LOGBUFF_LEN;
  347. }
  348. #endif
  349. void board_init_f (ulong bootflag)
  350. {
  351. bd_t *bd;
  352. ulong len, addr, addr_sp;
  353. ulong *s;
  354. gd_t *id;
  355. init_fnc_t **init_fnc_ptr;
  356. #ifdef CONFIG_PRAM
  357. int i;
  358. ulong reg;
  359. uchar tmp[64]; /* long enough for environment variables */
  360. #endif
  361. /* Pointer is writable since we allocated a register for it */
  362. gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
  363. /* compiler optimization barrier needed for GCC >= 3.4 */
  364. __asm__ __volatile__("": : :"memory");
  365. #if !defined(CONFIG_CPM2) && !defined(CONFIG_MPC83XX) && \
  366. !defined(CONFIG_MPC85xx) && !defined(CONFIG_MPC86xx)
  367. /* Clear initial global data */
  368. memset ((void *) gd, 0, sizeof (gd_t));
  369. #endif
  370. for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
  371. if ((*init_fnc_ptr) () != 0) {
  372. hang ();
  373. }
  374. }
  375. /*
  376. * Now that we have DRAM mapped and working, we can
  377. * relocate the code and continue running from DRAM.
  378. *
  379. * Reserve memory at end of RAM for (top down in that order):
  380. * - area that won't get touched by U-Boot and Linux (optional)
  381. * - kernel log buffer
  382. * - protected RAM
  383. * - LCD framebuffer
  384. * - monitor code
  385. * - board info struct
  386. */
  387. len = (ulong)&_end - CONFIG_SYS_MONITOR_BASE;
  388. /*
  389. * Subtract specified amount of memory to hide so that it won't
  390. * get "touched" at all by U-Boot. By fixing up gd->ram_size
  391. * the Linux kernel should now get passed the now "corrected"
  392. * memory size and won't touch it either. This should work
  393. * for arch/ppc and arch/powerpc. Only Linux board ports in
  394. * arch/powerpc with bootwrapper support, that recalculate the
  395. * memory size from the SDRAM controller setup will have to
  396. * get fixed.
  397. */
  398. gd->ram_size -= CONFIG_SYS_MEM_TOP_HIDE;
  399. addr = CONFIG_SYS_SDRAM_BASE + get_effective_memsize();
  400. #ifdef CONFIG_LOGBUFFER
  401. #ifndef CONFIG_ALT_LB_ADDR
  402. /* reserve kernel log buffer */
  403. addr -= (LOGBUFF_RESERVE);
  404. debug ("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN, addr);
  405. #endif
  406. #endif
  407. #ifdef CONFIG_PRAM
  408. /*
  409. * reserve protected RAM
  410. */
  411. i = getenv_r ("pram", (char *)tmp, sizeof (tmp));
  412. reg = (i > 0) ? simple_strtoul ((const char *)tmp, NULL, 10) : CONFIG_PRAM;
  413. addr -= (reg << 10); /* size is in kB */
  414. debug ("Reserving %ldk for protected RAM at %08lx\n", reg, addr);
  415. #endif /* CONFIG_PRAM */
  416. /* round down to next 4 kB limit */
  417. addr &= ~(4096 - 1);
  418. debug ("Top of RAM usable for U-Boot at: %08lx\n", addr);
  419. #ifdef CONFIG_LCD
  420. /* reserve memory for LCD display (always full pages) */
  421. addr = lcd_setmem (addr);
  422. gd->fb_base = addr;
  423. #endif /* CONFIG_LCD */
  424. #if defined(CONFIG_VIDEO) && defined(CONFIG_8xx)
  425. /* reserve memory for video display (always full pages) */
  426. addr = video_setmem (addr);
  427. gd->fb_base = addr;
  428. #endif /* CONFIG_VIDEO */
  429. /*
  430. * reserve memory for U-Boot code, data & bss
  431. * round down to next 4 kB limit
  432. */
  433. addr -= len;
  434. addr &= ~(4096 - 1);
  435. #ifdef CONFIG_E500
  436. /* round down to next 64 kB limit so that IVPR stays aligned */
  437. addr &= ~(65536 - 1);
  438. #endif
  439. debug ("Reserving %ldk for U-Boot at: %08lx\n", len >> 10, addr);
  440. #ifdef CONFIG_AMIGAONEG3SE
  441. gd->relocaddr = addr;
  442. #endif
  443. /*
  444. * reserve memory for malloc() arena
  445. */
  446. addr_sp = addr - TOTAL_MALLOC_LEN;
  447. debug ("Reserving %dk for malloc() at: %08lx\n",
  448. TOTAL_MALLOC_LEN >> 10, addr_sp);
  449. /*
  450. * (permanently) allocate a Board Info struct
  451. * and a permanent copy of the "global" data
  452. */
  453. addr_sp -= sizeof (bd_t);
  454. bd = (bd_t *) addr_sp;
  455. gd->bd = bd;
  456. debug ("Reserving %zu Bytes for Board Info at: %08lx\n",
  457. sizeof (bd_t), addr_sp);
  458. addr_sp -= sizeof (gd_t);
  459. id = (gd_t *) addr_sp;
  460. debug ("Reserving %zu Bytes for Global Data at: %08lx\n",
  461. sizeof (gd_t), addr_sp);
  462. /*
  463. * Finally, we set up a new (bigger) stack.
  464. *
  465. * Leave some safety gap for SP, force alignment on 16 byte boundary
  466. * Clear initial stack frame
  467. */
  468. addr_sp -= 16;
  469. addr_sp &= ~0xF;
  470. s = (ulong *)addr_sp;
  471. *s-- = 0;
  472. *s-- = 0;
  473. addr_sp = (ulong)s;
  474. debug ("Stack Pointer at: %08lx\n", addr_sp);
  475. /*
  476. * Save local variables to board info struct
  477. */
  478. bd->bi_memstart = CONFIG_SYS_SDRAM_BASE; /* start of DRAM memory */
  479. bd->bi_memsize = gd->ram_size; /* size of DRAM memory in bytes */
  480. #ifdef CONFIG_IP860
  481. bd->bi_sramstart = SRAM_BASE; /* start of SRAM memory */
  482. bd->bi_sramsize = SRAM_SIZE; /* size of SRAM memory */
  483. #elif defined CONFIG_MPC8220
  484. bd->bi_sramstart = CONFIG_SYS_SRAM_BASE; /* start of SRAM memory */
  485. bd->bi_sramsize = CONFIG_SYS_SRAM_SIZE; /* size of SRAM memory */
  486. #else
  487. bd->bi_sramstart = 0; /* FIXME */ /* start of SRAM memory */
  488. bd->bi_sramsize = 0; /* FIXME */ /* size of SRAM memory */
  489. #endif
  490. #if defined(CONFIG_8xx) || defined(CONFIG_8260) || defined(CONFIG_5xx) || \
  491. defined(CONFIG_E500) || defined(CONFIG_MPC86xx)
  492. bd->bi_immr_base = CONFIG_SYS_IMMR; /* base of IMMR register */
  493. #endif
  494. #if defined(CONFIG_MPC5xxx)
  495. bd->bi_mbar_base = CONFIG_SYS_MBAR; /* base of internal registers */
  496. #endif
  497. #if defined(CONFIG_MPC83XX)
  498. bd->bi_immrbar = CONFIG_SYS_IMMR;
  499. #endif
  500. #if defined(CONFIG_MPC8220)
  501. bd->bi_mbar_base = CONFIG_SYS_MBAR; /* base of internal registers */
  502. bd->bi_inpfreq = gd->inp_clk;
  503. bd->bi_pcifreq = gd->pci_clk;
  504. bd->bi_vcofreq = gd->vco_clk;
  505. bd->bi_pevfreq = gd->pev_clk;
  506. bd->bi_flbfreq = gd->flb_clk;
  507. /* store bootparam to sram (backward compatible), here? */
  508. {
  509. u32 *sram = (u32 *)CONFIG_SYS_SRAM_BASE;
  510. *sram++ = gd->ram_size;
  511. *sram++ = gd->bus_clk;
  512. *sram++ = gd->inp_clk;
  513. *sram++ = gd->cpu_clk;
  514. *sram++ = gd->vco_clk;
  515. *sram++ = gd->flb_clk;
  516. *sram++ = 0xb8c3ba11; /* boot signature */
  517. }
  518. #endif
  519. bd->bi_bootflags = bootflag; /* boot / reboot flag (for LynxOS) */
  520. WATCHDOG_RESET ();
  521. bd->bi_intfreq = gd->cpu_clk; /* Internal Freq, in Hz */
  522. bd->bi_busfreq = gd->bus_clk; /* Bus Freq, in Hz */
  523. #if defined(CONFIG_CPM2)
  524. bd->bi_cpmfreq = gd->cpm_clk;
  525. bd->bi_brgfreq = gd->brg_clk;
  526. bd->bi_sccfreq = gd->scc_clk;
  527. bd->bi_vco = gd->vco_out;
  528. #endif /* CONFIG_CPM2 */
  529. #if defined(CONFIG_MPC512X)
  530. bd->bi_ipsfreq = gd->ips_clk;
  531. #endif /* CONFIG_MPC512X */
  532. #if defined(CONFIG_MPC5xxx)
  533. bd->bi_ipbfreq = gd->ipb_clk;
  534. bd->bi_pcifreq = gd->pci_clk;
  535. #endif /* CONFIG_MPC5xxx */
  536. bd->bi_baudrate = gd->baudrate; /* Console Baudrate */
  537. #ifdef CONFIG_SYS_EXTBDINFO
  538. strncpy ((char *)bd->bi_s_version, "1.2", sizeof (bd->bi_s_version));
  539. strncpy ((char *)bd->bi_r_version, U_BOOT_VERSION, sizeof (bd->bi_r_version));
  540. bd->bi_procfreq = gd->cpu_clk; /* Processor Speed, In Hz */
  541. bd->bi_plb_busfreq = gd->bus_clk;
  542. #if defined(CONFIG_405GP) || defined(CONFIG_405EP) || \
  543. defined(CONFIG_440EP) || defined(CONFIG_440GR) || \
  544. defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
  545. bd->bi_pci_busfreq = get_PCI_freq ();
  546. bd->bi_opbfreq = get_OPB_freq ();
  547. #elif defined(CONFIG_XILINX_405)
  548. bd->bi_pci_busfreq = get_PCI_freq ();
  549. #endif
  550. #endif
  551. debug ("New Stack Pointer is: %08lx\n", addr_sp);
  552. WATCHDOG_RESET ();
  553. #ifdef CONFIG_POST
  554. post_bootmode_init();
  555. post_run (NULL, POST_ROM | post_bootmode_get(0));
  556. #endif
  557. WATCHDOG_RESET();
  558. memcpy (id, (void *)gd, sizeof (gd_t));
  559. relocate_code (addr_sp, id, addr);
  560. /* NOTREACHED - relocate_code() does not return */
  561. }
  562. /************************************************************************
  563. *
  564. * This is the next part if the initialization sequence: we are now
  565. * running from RAM and have a "normal" C environment, i. e. global
  566. * data can be written, BSS has been cleared, the stack size in not
  567. * that critical any more, etc.
  568. *
  569. ************************************************************************
  570. */
  571. void board_init_r (gd_t *id, ulong dest_addr)
  572. {
  573. cmd_tbl_t *cmdtp;
  574. char *s, *e;
  575. bd_t *bd;
  576. int i;
  577. extern void malloc_bin_reloc (void);
  578. #ifndef CONFIG_ENV_IS_NOWHERE
  579. extern char * env_name_spec;
  580. #endif
  581. #ifndef CONFIG_SYS_NO_FLASH
  582. ulong flash_size;
  583. #endif
  584. gd = id; /* initialize RAM version of global data */
  585. bd = gd->bd;
  586. gd->flags |= GD_FLG_RELOC; /* tell others: relocation done */
  587. #if defined(CONFIG_RELOC_FIXUP_WORKS)
  588. gd->reloc_off = 0;
  589. mem_malloc_end = dest_addr;
  590. #else
  591. gd->reloc_off = dest_addr - CONFIG_SYS_MONITOR_BASE;
  592. #endif
  593. #ifdef CONFIG_SERIAL_MULTI
  594. serial_initialize();
  595. #endif
  596. debug ("Now running in RAM - U-Boot at: %08lx\n", dest_addr);
  597. WATCHDOG_RESET ();
  598. /*
  599. * Setup trap handlers
  600. */
  601. trap_init (dest_addr);
  602. #ifdef CONFIG_ADDR_MAP
  603. init_addr_map();
  604. #endif
  605. #if defined(CONFIG_BOARD_EARLY_INIT_R)
  606. board_early_init_r ();
  607. #endif
  608. monitor_flash_len = (ulong)&__init_end - dest_addr;
  609. /*
  610. * We have to relocate the command table manually
  611. */
  612. for (cmdtp = &__u_boot_cmd_start; cmdtp != &__u_boot_cmd_end; cmdtp++) {
  613. ulong addr;
  614. addr = (ulong) (cmdtp->cmd) + gd->reloc_off;
  615. #if 0
  616. printf ("Command \"%s\": 0x%08lx => 0x%08lx\n",
  617. cmdtp->name, (ulong) (cmdtp->cmd), addr);
  618. #endif
  619. cmdtp->cmd =
  620. (int (*)(struct cmd_tbl_s *, int, int, char *[]))addr;
  621. addr = (ulong)(cmdtp->name) + gd->reloc_off;
  622. cmdtp->name = (char *)addr;
  623. if (cmdtp->usage) {
  624. addr = (ulong)(cmdtp->usage) + gd->reloc_off;
  625. cmdtp->usage = (char *)addr;
  626. }
  627. #ifdef CONFIG_SYS_LONGHELP
  628. if (cmdtp->help) {
  629. addr = (ulong)(cmdtp->help) + gd->reloc_off;
  630. cmdtp->help = (char *)addr;
  631. }
  632. #endif
  633. }
  634. /* there are some other pointer constants we must deal with */
  635. #ifndef CONFIG_ENV_IS_NOWHERE
  636. env_name_spec += gd->reloc_off;
  637. #endif
  638. WATCHDOG_RESET ();
  639. #ifdef CONFIG_LOGBUFFER
  640. logbuff_init_ptrs ();
  641. #endif
  642. #ifdef CONFIG_POST
  643. post_output_backlog ();
  644. post_reloc ();
  645. #endif
  646. WATCHDOG_RESET();
  647. #if defined(CONFIG_IP860) || defined(CONFIG_PCU_E) || \
  648. defined (CONFIG_FLAGADM) || defined(CONFIG_MPC83XX)
  649. icache_enable (); /* it's time to enable the instruction cache */
  650. #endif
  651. #if defined(CONFIG_SYS_INIT_RAM_LOCK) && defined(CONFIG_E500)
  652. unlock_ram_in_cache(); /* it's time to unlock D-cache in e500 */
  653. #endif
  654. #if defined(CONFIG_BAB7xx) || defined(CONFIG_CPC45)
  655. /*
  656. * Do PCI configuration on BAB7xx and CPC45 _before_ the flash
  657. * gets initialised, because we need the ISA resp. PCI_to_LOCAL bus
  658. * bridge there.
  659. */
  660. pci_init ();
  661. #endif
  662. #if defined(CONFIG_BAB7xx)
  663. /*
  664. * Initialise the ISA bridge
  665. */
  666. initialise_w83c553f ();
  667. #endif
  668. asm ("sync ; isync");
  669. #if !defined(CONFIG_SYS_NO_FLASH)
  670. puts ("FLASH: ");
  671. if ((flash_size = flash_init ()) > 0) {
  672. # ifdef CONFIG_SYS_FLASH_CHECKSUM
  673. print_size (flash_size, "");
  674. /*
  675. * Compute and print flash CRC if flashchecksum is set to 'y'
  676. *
  677. * NOTE: Maybe we should add some WATCHDOG_RESET()? XXX
  678. */
  679. s = getenv ("flashchecksum");
  680. if (s && (*s == 'y')) {
  681. printf (" CRC: %08X",
  682. crc32 (0, (const unsigned char *) CONFIG_SYS_FLASH_BASE, flash_size)
  683. );
  684. }
  685. putc ('\n');
  686. # else /* !CONFIG_SYS_FLASH_CHECKSUM */
  687. print_size (flash_size, "\n");
  688. # endif /* CONFIG_SYS_FLASH_CHECKSUM */
  689. } else {
  690. puts (failed);
  691. hang ();
  692. }
  693. bd->bi_flashstart = CONFIG_SYS_FLASH_BASE; /* update start of FLASH memory */
  694. bd->bi_flashsize = flash_size; /* size of FLASH memory (final value) */
  695. #if defined(CONFIG_SYS_UPDATE_FLASH_SIZE)
  696. /* Make a update of the Memctrl. */
  697. update_flash_size (flash_size);
  698. #endif
  699. # if defined(CONFIG_PCU_E) || defined(CONFIG_OXC) || defined(CONFIG_RMU)
  700. /* flash mapped at end of memory map */
  701. bd->bi_flashoffset = TEXT_BASE + flash_size;
  702. # elif CONFIG_SYS_MONITOR_BASE == CONFIG_SYS_FLASH_BASE
  703. bd->bi_flashoffset = monitor_flash_len; /* reserved area for startup monitor */
  704. # else
  705. bd->bi_flashoffset = 0;
  706. # endif
  707. #else /* CONFIG_SYS_NO_FLASH */
  708. bd->bi_flashsize = 0;
  709. bd->bi_flashstart = 0;
  710. bd->bi_flashoffset = 0;
  711. #endif /* !CONFIG_SYS_NO_FLASH */
  712. WATCHDOG_RESET ();
  713. /* initialize higher level parts of CPU like time base and timers */
  714. cpu_init_r ();
  715. WATCHDOG_RESET ();
  716. /* initialize malloc() area */
  717. mem_malloc_init ();
  718. malloc_bin_reloc ();
  719. #ifdef CONFIG_SPI
  720. # if !defined(CONFIG_ENV_IS_IN_EEPROM)
  721. spi_init_f ();
  722. # endif
  723. spi_init_r ();
  724. #endif
  725. #if defined(CONFIG_CMD_NAND)
  726. WATCHDOG_RESET ();
  727. puts ("NAND: ");
  728. nand_init(); /* go init the NAND */
  729. #endif
  730. /* relocate environment function pointers etc. */
  731. env_relocate ();
  732. /*
  733. * Fill in missing fields of bd_info.
  734. * We do this here, where we have "normal" access to the
  735. * environment; we used to do this still running from ROM,
  736. * where had to use getenv_r(), which can be pretty slow when
  737. * the environment is in EEPROM.
  738. */
  739. #if defined(CONFIG_SYS_EXTBDINFO)
  740. #if defined(CONFIG_405GP) || defined(CONFIG_405EP)
  741. #if defined(CONFIG_I2CFAST)
  742. /*
  743. * set bi_iic_fast for linux taking environment variable
  744. * "i2cfast" into account
  745. */
  746. {
  747. char *s = getenv ("i2cfast");
  748. if (s && ((*s == 'y') || (*s == 'Y'))) {
  749. bd->bi_iic_fast[0] = 1;
  750. bd->bi_iic_fast[1] = 1;
  751. } else {
  752. bd->bi_iic_fast[0] = 0;
  753. bd->bi_iic_fast[1] = 0;
  754. }
  755. }
  756. #else
  757. bd->bi_iic_fast[0] = 0;
  758. bd->bi_iic_fast[1] = 0;
  759. #endif /* CONFIG_I2CFAST */
  760. #endif /* CONFIG_405GP, CONFIG_405EP */
  761. #endif /* CONFIG_SYS_EXTBDINFO */
  762. #if defined(CONFIG_SC3)
  763. sc3_read_eeprom();
  764. #endif
  765. #if defined (CONFIG_ID_EEPROM) || defined (CONFIG_SYS_I2C_MAC_OFFSET)
  766. mac_read_from_eeprom();
  767. #endif
  768. s = getenv ("ethaddr");
  769. #if defined (CONFIG_MBX) || \
  770. defined (CONFIG_RPXCLASSIC) || \
  771. defined(CONFIG_IAD210) || \
  772. defined(CONFIG_V38B)
  773. if (s == NULL)
  774. board_get_enetaddr (bd->bi_enetaddr);
  775. else
  776. #endif
  777. for (i = 0; i < 6; ++i) {
  778. bd->bi_enetaddr[i] = s ? simple_strtoul (s, &e, 16) : 0;
  779. if (s)
  780. s = (*e) ? e + 1 : e;
  781. }
  782. #ifdef CONFIG_HERMES
  783. if ((gd->board_type >> 16) == 2)
  784. bd->bi_ethspeed = gd->board_type & 0xFFFF;
  785. else
  786. bd->bi_ethspeed = 0xFFFF;
  787. #endif
  788. #ifdef CONFIG_NX823
  789. load_sernum_ethaddr ();
  790. #endif
  791. #ifdef CONFIG_HAS_ETH1
  792. /* handle the 2nd ethernet address */
  793. s = getenv ("eth1addr");
  794. for (i = 0; i < 6; ++i) {
  795. bd->bi_enet1addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
  796. if (s)
  797. s = (*e) ? e + 1 : e;
  798. }
  799. #endif
  800. #ifdef CONFIG_HAS_ETH2
  801. /* handle the 3rd ethernet address */
  802. s = getenv ("eth2addr");
  803. #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
  804. if (s == NULL)
  805. board_get_enetaddr(bd->bi_enet2addr);
  806. else
  807. #endif
  808. for (i = 0; i < 6; ++i) {
  809. bd->bi_enet2addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
  810. if (s)
  811. s = (*e) ? e + 1 : e;
  812. }
  813. #endif
  814. #ifdef CONFIG_HAS_ETH3
  815. /* handle 4th ethernet address */
  816. s = getenv("eth3addr");
  817. #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
  818. if (s == NULL)
  819. board_get_enetaddr(bd->bi_enet3addr);
  820. else
  821. #endif
  822. for (i = 0; i < 6; ++i) {
  823. bd->bi_enet3addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
  824. if (s)
  825. s = (*e) ? e + 1 : e;
  826. }
  827. #endif
  828. #ifdef CONFIG_HAS_ETH4
  829. /* handle 5th ethernet address */
  830. s = getenv("eth4addr");
  831. #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
  832. if (s == NULL)
  833. board_get_enetaddr(bd->bi_enet4addr);
  834. else
  835. #endif
  836. for (i = 0; i < 6; ++i) {
  837. bd->bi_enet4addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
  838. if (s)
  839. s = (*e) ? e + 1 : e;
  840. }
  841. #endif
  842. #ifdef CONFIG_HAS_ETH5
  843. /* handle 6th ethernet address */
  844. s = getenv("eth5addr");
  845. #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF)
  846. if (s == NULL)
  847. board_get_enetaddr(bd->bi_enet5addr);
  848. else
  849. #endif
  850. for (i = 0; i < 6; ++i) {
  851. bd->bi_enet5addr[i] = s ? simple_strtoul (s, &e, 16) : 0;
  852. if (s)
  853. s = (*e) ? e + 1 : e;
  854. }
  855. #endif
  856. #if defined(CONFIG_TQM8xxL) || defined(CONFIG_TQM8260) || \
  857. defined(CONFIG_TQM8272) || \
  858. defined(CONFIG_CCM) || defined(CONFIG_KUP4K) || \
  859. defined(CONFIG_KUP4X) || defined(CONFIG_PCS440EP)
  860. load_sernum_ethaddr ();
  861. #endif
  862. /* IP Address */
  863. bd->bi_ip_addr = getenv_IPaddr ("ipaddr");
  864. WATCHDOG_RESET ();
  865. #if defined(CONFIG_PCI) && !defined(CONFIG_BAB7xx) && !defined(CONFIG_CPC45)
  866. /*
  867. * Do pci configuration
  868. */
  869. pci_init ();
  870. #endif
  871. /** leave this here (after malloc(), environment and PCI are working) **/
  872. /* Initialize devices */
  873. devices_init ();
  874. /* Initialize the jump table for applications */
  875. jumptable_init ();
  876. #if defined(CONFIG_API)
  877. /* Initialize API */
  878. api_init ();
  879. #endif
  880. /* Initialize the console (after the relocation and devices init) */
  881. console_init_r ();
  882. #if defined(CONFIG_CCM) || \
  883. defined(CONFIG_COGENT) || \
  884. defined(CONFIG_CPCI405) || \
  885. defined(CONFIG_EVB64260) || \
  886. defined(CONFIG_KUP4K) || \
  887. defined(CONFIG_KUP4X) || \
  888. defined(CONFIG_LWMON) || \
  889. defined(CONFIG_PCU_E) || \
  890. defined(CONFIG_SC3) || \
  891. defined(CONFIG_W7O) || \
  892. defined(CONFIG_MISC_INIT_R)
  893. /* miscellaneous platform dependent initialisations */
  894. misc_init_r ();
  895. #endif
  896. #ifdef CONFIG_HERMES
  897. if (bd->bi_ethspeed != 0xFFFF)
  898. hermes_start_lxt980 ((int) bd->bi_ethspeed);
  899. #endif
  900. #if defined(CONFIG_CMD_KGDB)
  901. WATCHDOG_RESET ();
  902. puts ("KGDB: ");
  903. kgdb_init ();
  904. #endif
  905. debug ("U-Boot relocated to %08lx\n", dest_addr);
  906. /*
  907. * Enable Interrupts
  908. */
  909. interrupt_init ();
  910. /* Must happen after interrupts are initialized since
  911. * an irq handler gets installed
  912. */
  913. #ifdef CONFIG_SERIAL_SOFTWARE_FIFO
  914. serial_buffered_init();
  915. #endif
  916. #if defined(CONFIG_STATUS_LED) && defined(STATUS_LED_BOOT)
  917. status_led_set (STATUS_LED_BOOT, STATUS_LED_BLINKING);
  918. #endif
  919. udelay (20);
  920. set_timer (0);
  921. /* Initialize from environment */
  922. if ((s = getenv ("loadaddr")) != NULL) {
  923. load_addr = simple_strtoul (s, NULL, 16);
  924. }
  925. #if defined(CONFIG_CMD_NET)
  926. if ((s = getenv ("bootfile")) != NULL) {
  927. copy_filename (BootFile, s, sizeof (BootFile));
  928. }
  929. #endif
  930. WATCHDOG_RESET ();
  931. #if defined(CONFIG_CMD_SCSI)
  932. WATCHDOG_RESET ();
  933. puts ("SCSI: ");
  934. scsi_init ();
  935. #endif
  936. #ifdef CONFIG_GENERIC_MMC
  937. WATCHDOG_RESET ();
  938. puts ("MMC: ");
  939. mmc_initialize (bd);
  940. #endif
  941. #if defined(CONFIG_CMD_DOC)
  942. WATCHDOG_RESET ();
  943. puts ("DOC: ");
  944. doc_init ();
  945. #endif
  946. #if defined(CONFIG_CMD_NET)
  947. #if defined(CONFIG_NET_MULTI)
  948. WATCHDOG_RESET ();
  949. puts ("Net: ");
  950. #endif
  951. eth_initialize (bd);
  952. #endif
  953. #if defined(CONFIG_CMD_NET) && ( \
  954. defined(CONFIG_CCM) || \
  955. defined(CONFIG_ELPT860) || \
  956. defined(CONFIG_EP8260) || \
  957. defined(CONFIG_IP860) || \
  958. defined(CONFIG_IVML24) || \
  959. defined(CONFIG_IVMS8) || \
  960. defined(CONFIG_MPC8260ADS) || \
  961. defined(CONFIG_MPC8266ADS) || \
  962. defined(CONFIG_MPC8560ADS) || \
  963. defined(CONFIG_PCU_E) || \
  964. defined(CONFIG_RPXSUPER) || \
  965. defined(CONFIG_STXGP3) || \
  966. defined(CONFIG_SPD823TS) || \
  967. defined(CONFIG_RESET_PHY_R) )
  968. WATCHDOG_RESET ();
  969. debug ("Reset Ethernet PHY\n");
  970. reset_phy ();
  971. #endif
  972. #ifdef CONFIG_POST
  973. post_run (NULL, POST_RAM | post_bootmode_get(0));
  974. #endif
  975. #if defined(CONFIG_CMD_PCMCIA) \
  976. && !defined(CONFIG_CMD_IDE)
  977. WATCHDOG_RESET ();
  978. puts ("PCMCIA:");
  979. pcmcia_init ();
  980. #endif
  981. #if defined(CONFIG_CMD_IDE)
  982. WATCHDOG_RESET ();
  983. # ifdef CONFIG_IDE_8xx_PCCARD
  984. puts ("PCMCIA:");
  985. # else
  986. puts ("IDE: ");
  987. #endif
  988. #if defined(CONFIG_START_IDE)
  989. if (board_start_ide())
  990. ide_init ();
  991. #else
  992. ide_init ();
  993. #endif
  994. #endif
  995. #ifdef CONFIG_LAST_STAGE_INIT
  996. WATCHDOG_RESET ();
  997. /*
  998. * Some parts can be only initialized if all others (like
  999. * Interrupts) are up and running (i.e. the PC-style ISA
  1000. * keyboard).
  1001. */
  1002. last_stage_init ();
  1003. #endif
  1004. #if defined(CONFIG_CMD_BEDBUG)
  1005. WATCHDOG_RESET ();
  1006. bedbug_init ();
  1007. #endif
  1008. #if defined(CONFIG_PRAM) || defined(CONFIG_LOGBUFFER)
  1009. /*
  1010. * Export available size of memory for Linux,
  1011. * taking into account the protected RAM at top of memory
  1012. */
  1013. {
  1014. ulong pram;
  1015. uchar memsz[32];
  1016. #ifdef CONFIG_PRAM
  1017. char *s;
  1018. if ((s = getenv ("pram")) != NULL) {
  1019. pram = simple_strtoul (s, NULL, 10);
  1020. } else {
  1021. pram = CONFIG_PRAM;
  1022. }
  1023. #else
  1024. pram=0;
  1025. #endif
  1026. #ifdef CONFIG_LOGBUFFER
  1027. #ifndef CONFIG_ALT_LB_ADDR
  1028. /* Also take the logbuffer into account (pram is in kB) */
  1029. pram += (LOGBUFF_LEN+LOGBUFF_OVERHEAD)/1024;
  1030. #endif
  1031. #endif
  1032. sprintf ((char *)memsz, "%ldk", (bd->bi_memsize / 1024) - pram);
  1033. setenv ("mem", (char *)memsz);
  1034. }
  1035. #endif
  1036. #ifdef CONFIG_PS2KBD
  1037. puts ("PS/2: ");
  1038. kbd_init();
  1039. #endif
  1040. #ifdef CONFIG_MODEM_SUPPORT
  1041. {
  1042. extern int do_mdm_init;
  1043. do_mdm_init = gd->do_mdm_init;
  1044. }
  1045. #endif
  1046. /* Initialization complete - start the monitor */
  1047. /* main_loop() can return to retry autoboot, if so just run it again. */
  1048. for (;;) {
  1049. WATCHDOG_RESET ();
  1050. main_loop ();
  1051. }
  1052. /* NOTREACHED - no way out of command loop except booting */
  1053. }
  1054. void hang (void)
  1055. {
  1056. puts ("### ERROR ### Please RESET the board ###\n");
  1057. show_boot_progress(-30);
  1058. for (;;);
  1059. }
  1060. #ifdef CONFIG_MODEM_SUPPORT
  1061. /* called from main loop (common/main.c) */
  1062. /* 'inline' - We have to do it fast */
  1063. static inline void mdm_readline(char *buf, int bufsiz)
  1064. {
  1065. char c;
  1066. char *p;
  1067. int n;
  1068. n = 0;
  1069. p = buf;
  1070. for(;;) {
  1071. c = serial_getc();
  1072. /* dbg("(%c)", c); */
  1073. switch(c) {
  1074. case '\r':
  1075. break;
  1076. case '\n':
  1077. *p = '\0';
  1078. return;
  1079. default:
  1080. if(n++ > bufsiz) {
  1081. *p = '\0';
  1082. return; /* sanity check */
  1083. }
  1084. *p = c;
  1085. p++;
  1086. break;
  1087. }
  1088. }
  1089. }
  1090. extern void dbg(const char *fmt, ...);
  1091. int mdm_init (void)
  1092. {
  1093. char env_str[16];
  1094. char *init_str;
  1095. int i;
  1096. extern char console_buffer[];
  1097. extern void enable_putc(void);
  1098. extern int hwflow_onoff(int);
  1099. enable_putc(); /* enable serial_putc() */
  1100. #ifdef CONFIG_HWFLOW
  1101. init_str = getenv("mdm_flow_control");
  1102. if (init_str && (strcmp(init_str, "rts/cts") == 0))
  1103. hwflow_onoff (1);
  1104. else
  1105. hwflow_onoff(-1);
  1106. #endif
  1107. for (i = 1;;i++) {
  1108. sprintf(env_str, "mdm_init%d", i);
  1109. if ((init_str = getenv(env_str)) != NULL) {
  1110. serial_puts(init_str);
  1111. serial_puts("\n");
  1112. for(;;) {
  1113. mdm_readline(console_buffer, CONFIG_SYS_CBSIZE);
  1114. dbg("ini%d: [%s]", i, console_buffer);
  1115. if ((strcmp(console_buffer, "OK") == 0) ||
  1116. (strcmp(console_buffer, "ERROR") == 0)) {
  1117. dbg("ini%d: cmd done", i);
  1118. break;
  1119. } else /* in case we are originating call ... */
  1120. if (strncmp(console_buffer, "CONNECT", 7) == 0) {
  1121. dbg("ini%d: connect", i);
  1122. return 0;
  1123. }
  1124. }
  1125. } else
  1126. break; /* no init string - stop modem init */
  1127. udelay(100000);
  1128. }
  1129. udelay(100000);
  1130. /* final stage - wait for connect */
  1131. for(;i > 1;) { /* if 'i' > 1 - wait for connection
  1132. message from modem */
  1133. mdm_readline(console_buffer, CONFIG_SYS_CBSIZE);
  1134. dbg("ini_f: [%s]", console_buffer);
  1135. if (strncmp(console_buffer, "CONNECT", 7) == 0) {
  1136. dbg("ini_f: connected");
  1137. return 0;
  1138. }
  1139. }
  1140. return 0;
  1141. }
  1142. #endif
  1143. #if 0 /* We could use plain global data, but the resulting code is bigger */
  1144. /*
  1145. * Pointer to initial global data area
  1146. *
  1147. * Here we initialize it.
  1148. */
  1149. #undef XTRN_DECLARE_GLOBAL_DATA_PTR
  1150. #define XTRN_DECLARE_GLOBAL_DATA_PTR /* empty = allocate here */
  1151. DECLARE_GLOBAL_DATA_PTR = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
  1152. #endif /* 0 */
  1153. /************************************************************************/