arch/m68k/lib/board.c

   1 /*
   2  * (C) Copyright 2003
   3  * Josef Baumgartner <josef.baumgartner@telex.de>
   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 <watchdog.h>
  29 #include <command.h>
  30 #include <malloc.h>
  31 #include <stdio_dev.h>
  32
  33 #include <asm/immap.h>
  34
  35 #if defined(CONFIG_CMD_IDE)
  36 #include <ide.h>
  37 #endif
  38 #if defined(CONFIG_CMD_SCSI)
  39 #include <scsi.h>
  40 #endif
  41 #if defined(CONFIG_CMD_KGDB)
  42 #include <kgdb.h>
  43 #endif
  44 #ifdef CONFIG_STATUS_LED
  45 #include <status_led.h>
  46 #endif
  47 #include <net.h>
  48 #include <serial.h>
  49 #if defined(CONFIG_CMD_BEDBUG)
  50 #include <cmd_bedbug.h>
  51 #endif
  52 #ifdef CONFIG_SYS_ALLOC_DPRAM
  53 #include <commproc.h>
  54 #endif
  55 #include <version.h>
  56
  57 #if defined(CONFIG_HARD_I2C) || \
  58     defined(CONFIG_SOFT_I2C)
  59 #include <i2c.h>
  60 #endif
  61
  62 #ifdef CONFIG_CMD_SPI
  63 #include <spi.h>
  64 #endif
  65
  66 #ifdef CONFIG_BITBANGMII
  67 #include <miiphy.h>
  68 #endif
  69
  70 #include <nand.h>
  71
  72 DECLARE_GLOBAL_DATA_PTR;
  73
  74 static char *failed = "*** failed ***\n";
  75
  76 #include <environment.h>
  77
  78 extern ulong __init_end;
  79 extern ulong __bss_end__;
  80
  81 #if defined(CONFIG_WATCHDOG)
  82 # define INIT_FUNC_WATCHDOG_INIT        watchdog_init,
  83 # define WATCHDOG_DISABLE               watchdog_disable
  84
  85 extern int watchdog_init(void);
  86 extern int watchdog_disable(void);
  87 #else
  88 # define INIT_FUNC_WATCHDOG_INIT        /* undef */
  89 # define WATCHDOG_DISABLE               /* undef */
  90 #endif /* CONFIG_WATCHDOG */
  91
  92 ulong monitor_flash_len;
  93
  94 /************************************************************************
  95  * Utilities                                                            *
  96  ************************************************************************
  97  */
  98
  99 /*
 100  * All attempts to come up with a "common" initialization sequence
 101  * that works for all boards and architectures failed: some of the
 102  * requirements are just _too_ different. To get rid of the resulting
 103  * mess of board dependend #ifdef'ed code we now make the whole
 104  * initialization sequence configurable to the user.
 105  *
 106  * The requirements for any new initalization function is simple: it
 107  * receives a pointer to the "global data" structure as it's only
 108  * argument, and returns an integer return code, where 0 means
 109  * "continue" and != 0 means "fatal error, hang the system".
 110  */
 111 typedef int (init_fnc_t) (void);
 112
 113 /************************************************************************
 114  * Init Utilities
 115  ************************************************************************
 116  * Some of this code should be moved into the core functions,
 117  * but let's get it working (again) first...
 118  */
 119
 120 static int init_baudrate (void)
 121 {
 122         gd->baudrate = getenv_ulong("baudrate", 10, CONFIG_BAUDRATE);
 123         return 0;
 124 }
 125
 126 /***********************************************************************/
 127
 128 static int init_func_ram (void)
 129 {
 130         int board_type = 0;     /* use dummy arg */
 131         puts ("DRAM:  ");
 132
 133         if ((gd->ram_size = initdram (board_type)) > 0) {
 134                 print_size (gd->ram_size, "\n");
 135                 return (0);
 136         }
 137         puts (failed);
 138         return (1);
 139 }
 140
 141 /***********************************************************************/
 142
 143 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
 144 static int init_func_i2c (void)
 145 {
 146         puts ("I2C:   ");
 147         i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
 148         puts ("ready\n");
 149         return (0);
 150 }
 151 #endif
 152
 153 #if defined(CONFIG_HARD_SPI)
 154 static int init_func_spi (void)
 155 {
 156         puts ("SPI:   ");
 157         spi_init ();
 158         puts ("ready\n");
 159         return (0);
 160 }
 161 #endif
 162
 163 /***********************************************************************/
 164
 165 /************************************************************************
 166  * Initialization sequence                                              *
 167  ************************************************************************
 168  */
 169
 170 init_fnc_t *init_sequence[] = {
 171         get_clocks,
 172         env_init,
 173         init_baudrate,
 174         serial_init,
 175         console_init_f,
 176         display_options,
 177         checkcpu,
 178         checkboard,
 179 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
 180         init_func_i2c,
 181 #endif
 182 #if defined(CONFIG_HARD_SPI)
 183         init_func_spi,
 184 #endif
 185         init_func_ram,
 186 #if defined(CONFIG_SYS_DRAM_TEST)
 187         testdram,
 188 #endif /* CONFIG_SYS_DRAM_TEST */
 189         INIT_FUNC_WATCHDOG_INIT
 190         NULL,                   /* Terminate this list */
 191 };
 192
 193
 194 /************************************************************************
 195  *
 196  * This is the first part of the initialization sequence that is
 197  * implemented in C, but still running from ROM.
 198  *
 199  * The main purpose is to provide a (serial) console interface as
 200  * soon as possible (so we can see any error messages), and to
 201  * initialize the RAM so that we can relocate the monitor code to
 202  * RAM.
 203  *
 204  * Be aware of the restrictions: global data is read-only, BSS is not
 205  * initialized, and stack space is limited to a few kB.
 206  *
 207  ************************************************************************
 208  */
 209
 210 void
 211 board_init_f (ulong bootflag)
 212 {
 213         bd_t *bd;
 214         ulong len, addr, addr_sp;
 215         ulong *paddr;
 216         gd_t *id;
 217         init_fnc_t **init_fnc_ptr;
 218 #ifdef CONFIG_PRAM
 219         ulong reg;
 220 #endif
 221
 222         /* Pointer is writable since we allocated a register for it */
 223         gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
 224         /* compiler optimization barrier needed for GCC >= 3.4 */
 225         __asm__ __volatile__("": : :"memory");
 226
 227         /* Clear initial global data */
 228         memset ((void *) gd, 0, sizeof (gd_t));
 229
 230         for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) {
 231                 if ((*init_fnc_ptr)() != 0) {
 232                         hang ();
 233                 }
 234         }
 235
 236         /*
 237          * Now that we have DRAM mapped and working, we can
 238          * relocate the code and continue running from DRAM.
 239          *
 240          * Reserve memory at end of RAM for (top down in that order):
 241          *      - protected RAM
 242          *      - LCD framebuffer
 243          *      - monitor code
 244          *      - board info struct
 245          */
 246         len = (ulong)&__bss_end__ - CONFIG_SYS_MONITOR_BASE;
 247
 248         addr = CONFIG_SYS_SDRAM_BASE + gd->ram_size;
 249
 250 #ifdef CONFIG_LOGBUFFER
 251         /* reserve kernel log buffer */
 252         addr -= (LOGBUFF_RESERVE);
 253         debug ("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN, addr);
 254 #endif
 255
 256 #ifdef CONFIG_PRAM
 257         /*
 258          * reserve protected RAM
 259          */
 260         reg = getenv_ulong("pram", 10, CONFIG_PRAM);
 261         addr -= (reg << 10);            /* size is in kB */
 262         debug ("Reserving %ldk for protected RAM at %08lx\n", reg, addr);
 263 #endif /* CONFIG_PRAM */
 264
 265         /* round down to next 4 kB limit */
 266         addr &= ~(4096 - 1);
 267         debug ("Top of RAM usable for U-Boot at: %08lx\n", addr);
 268
 269 #ifdef CONFIG_LCD
 270 #ifdef CONFIG_FB_ADDR
 271         gd->fb_base = CONFIG_FB_ADDR;
 272 #else
 273         /* reserve memory for LCD display (always full pages) */
 274         addr = lcd_setmem (addr);
 275         gd->fb_base = addr;
 276 #endif /* CONFIG_FB_ADDR */
 277 #endif /* CONFIG_LCD */
 278
 279         /*
 280          * reserve memory for U-Boot code, data & bss
 281          * round down to next 4 kB limit
 282          */
 283         addr -= len;
 284         addr &= ~(4096 - 1);
 285
 286         debug ("Reserving %ldk for U-Boot at: %08lx\n", len >> 10, addr);
 287
 288         /*
 289          * reserve memory for malloc() arena
 290          */
 291         addr_sp = addr - TOTAL_MALLOC_LEN;
 292         debug ("Reserving %dk for malloc() at: %08lx\n",
 293                         TOTAL_MALLOC_LEN >> 10, addr_sp);
 294
 295         /*
 296          * (permanently) allocate a Board Info struct
 297          * and a permanent copy of the "global" data
 298          */
 299         addr_sp -= sizeof (bd_t);
 300         bd = (bd_t *) addr_sp;
 301         gd->bd = bd;
 302         debug ("Reserving %zu Bytes for Board Info at: %08lx\n",
 303                         sizeof (bd_t), addr_sp);
 304         addr_sp -= sizeof (gd_t);
 305         id = (gd_t *) addr_sp;
 306         debug ("Reserving %zu Bytes for Global Data at: %08lx\n",
 307                         sizeof (gd_t), addr_sp);
 308
 309         /* Reserve memory for boot params. */
 310         addr_sp -= CONFIG_SYS_BOOTPARAMS_LEN;
 311         bd->bi_boot_params = addr_sp;
 312         debug ("Reserving %dk for boot parameters at: %08lx\n",
 313                         CONFIG_SYS_BOOTPARAMS_LEN >> 10, addr_sp);
 314
 315         /*
 316          * Finally, we set up a new (bigger) stack.
 317          *
 318          * Leave some safety gap for SP, force alignment on 16 byte boundary
 319          * Clear initial stack frame
 320          */
 321         addr_sp -= 16;
 322         addr_sp &= ~0xF;
 323
 324         paddr = (ulong *)addr_sp;
 325         *paddr-- = 0;
 326         *paddr-- = 0;
 327         addr_sp = (ulong)paddr;
 328
 329         debug ("Stack Pointer at: %08lx\n", addr_sp);
 330
 331         /*
 332          * Save local variables to board info struct
 333          */
 334         bd->bi_memstart  = CONFIG_SYS_SDRAM_BASE;       /* start of  DRAM memory      */
 335         bd->bi_memsize   = gd->ram_size;        /* size  of  DRAM memory in bytes */
 336 #ifdef CONFIG_SYS_INIT_RAM_ADDR
 337         bd->bi_sramstart = CONFIG_SYS_INIT_RAM_ADDR;    /* start of  SRAM memory        */
 338         bd->bi_sramsize  = CONFIG_SYS_INIT_RAM_SIZE;    /* size  of  SRAM memory        */
 339 #endif
 340         bd->bi_mbar_base = CONFIG_SYS_MBAR;             /* base of internal registers */
 341
 342         bd->bi_bootflags = bootflag;            /* boot / reboot flag (for LynxOS)    */
 343
 344         WATCHDOG_RESET ();
 345         bd->bi_intfreq = gd->cpu_clk;   /* Internal Freq, in Hz */
 346         bd->bi_busfreq = gd->bus_clk;   /* Bus Freq,      in Hz */
 347 #ifdef CONFIG_PCI
 348         bd->bi_pcifreq = gd->pci_clk;           /* PCI Freq in Hz */
 349 #endif
 350 #ifdef CONFIG_EXTRA_CLOCK
 351         bd->bi_inpfreq = gd->inp_clk;           /* input Freq in Hz */
 352         bd->bi_vcofreq = gd->vco_clk;           /* vco Freq in Hz */
 353         bd->bi_flbfreq = gd->flb_clk;           /* flexbus Freq in Hz */
 354 #endif
 355         bd->bi_baudrate = gd->baudrate; /* Console Baudrate     */
 356
 357 #ifdef CONFIG_SYS_EXTBDINFO
 358         strncpy (bd->bi_s_version, "1.2", sizeof (bd->bi_s_version));
 359         strncpy (bd->bi_r_version, U_BOOT_VERSION, sizeof (bd->bi_r_version));
 360 #endif
 361
 362         WATCHDOG_RESET ();
 363
 364 #ifdef CONFIG_POST
 365         post_bootmode_init();
 366         post_run (NULL, POST_ROM | post_bootmode_get(0));
 367 #endif
 368
 369         WATCHDOG_RESET();
 370
 371         memcpy (id, (void *)gd, sizeof (gd_t));
 372
 373         debug ("Start relocate of code from %08x to %08lx\n", CONFIG_SYS_MONITOR_BASE, addr);
 374         relocate_code (addr_sp, id, addr);
 375
 376         /* NOTREACHED - jump_to_ram() does not return */
 377 }
 378
 379 /************************************************************************
 380  *
 381  * This is the next part if the initialization sequence: we are now
 382  * running from RAM and have a "normal" C environment, i. e. global
 383  * data can be written, BSS has been cleared, the stack size in not
 384  * that critical any more, etc.
 385  *
 386  ************************************************************************
 387  */
 388 void board_init_r (gd_t *id, ulong dest_addr)
 389 {
 390         char *s;
 391         bd_t *bd;
 392         extern void malloc_bin_reloc (void);
 393
 394 #ifndef CONFIG_ENV_IS_NOWHERE
 395         extern char * env_name_spec;
 396 #endif
 397 #ifndef CONFIG_SYS_NO_FLASH
 398         ulong flash_size;
 399 #endif
 400         gd = id;                /* initialize RAM version of global data */
 401         bd = gd->bd;
 402
 403         gd->flags |= GD_FLG_RELOC;      /* tell others: relocation done */
 404
 405 #ifdef CONFIG_SERIAL_MULTI
 406         serial_initialize();
 407 #endif
 408
 409         debug ("Now running in RAM - U-Boot at: %08lx\n", dest_addr);
 410
 411         WATCHDOG_RESET ();
 412
 413         gd->reloc_off =  dest_addr - CONFIG_SYS_MONITOR_BASE;
 414
 415         monitor_flash_len = (ulong)&__init_end - dest_addr;
 416
 417 #if defined(CONFIG_NEEDS_MANUAL_RELOC)
 418         /*
 419          * We have to relocate the command table manually
 420          */
 421         fixup_cmdtable(&__u_boot_cmd_start,
 422                 (ulong)(&__u_boot_cmd_end - &__u_boot_cmd_start));
 423 #endif /* defined(CONFIG_NEEDS_MANUAL_RELOC) */
 424
 425         /* there are some other pointer constants we must deal with */
 426 #ifndef CONFIG_ENV_IS_NOWHERE
 427         env_name_spec += gd->reloc_off;
 428 #endif
 429
 430         WATCHDOG_RESET ();
 431
 432 #ifdef CONFIG_LOGBUFFER
 433         logbuff_init_ptrs ();
 434 #endif
 435 #ifdef CONFIG_POST
 436         post_output_backlog ();
 437         post_reloc ();
 438 #endif
 439         WATCHDOG_RESET();
 440
 441 #if 0
 442         /* instruction cache enabled in cpu_init_f() for faster relocation */
 443         icache_enable ();       /* it's time to enable the instruction cache */
 444 #endif
 445
 446         /*
 447          * Setup trap handlers
 448          */
 449         trap_init (CONFIG_SYS_SDRAM_BASE);
 450
 451         /* The Malloc area is immediately below the monitor copy in DRAM */
 452         mem_malloc_init (CONFIG_SYS_MONITOR_BASE + gd->reloc_off -
 453                         TOTAL_MALLOC_LEN, TOTAL_MALLOC_LEN);
 454         malloc_bin_reloc ();
 455
 456 #if !defined(CONFIG_SYS_NO_FLASH)
 457         puts ("Flash: ");
 458
 459         if ((flash_size = flash_init ()) > 0) {
 460 # ifdef CONFIG_SYS_FLASH_CHECKSUM
 461                 print_size (flash_size, "");
 462                 /*
 463                  * Compute and print flash CRC if flashchecksum is set to 'y'
 464                  *
 465                  * NOTE: Maybe we should add some WATCHDOG_RESET()? XXX
 466                  */
 467                 s = getenv ("flashchecksum");
 468                 if (s && (*s == 'y')) {
 469                         printf ("  CRC: %08X",
 470                                         crc32 (0,
 471                                                    (const unsigned char *) CONFIG_SYS_FLASH_BASE,
 472                                                    flash_size)
 473                                         );
 474                 }
 475                 putc ('\n');
 476 # else  /* !CONFIG_SYS_FLASH_CHECKSUM */
 477                 print_size (flash_size, "\n");
 478 # endif /* CONFIG_SYS_FLASH_CHECKSUM */
 479         } else {
 480                 puts (failed);
 481                 hang ();
 482         }
 483
 484         bd->bi_flashstart = CONFIG_SYS_FLASH_BASE;      /* update start of FLASH memory    */
 485         bd->bi_flashsize = flash_size;  /* size of FLASH memory (final value) */
 486         bd->bi_flashoffset = 0;
 487 #else   /* CONFIG_SYS_NO_FLASH */
 488         bd->bi_flashsize = 0;
 489         bd->bi_flashstart = 0;
 490         bd->bi_flashoffset = 0;
 491 #endif /* !CONFIG_SYS_NO_FLASH */
 492
 493         WATCHDOG_RESET ();
 494
 495         /* initialize higher level parts of CPU like time base and timers */
 496         cpu_init_r ();
 497
 498         WATCHDOG_RESET ();
 499
 500 #ifdef CONFIG_SPI
 501 # if !defined(CONFIG_ENV_IS_IN_EEPROM)
 502         spi_init_f ();
 503 # endif
 504         spi_init_r ();
 505 #endif
 506
 507         /* relocate environment function pointers etc. */
 508         env_relocate ();
 509
 510         WATCHDOG_RESET ();
 511
 512 #if defined(CONFIG_PCI)
 513         /*
 514          * Do pci configuration
 515          */
 516         pci_init ();
 517 #endif
 518
 519         /** leave this here (after malloc(), environment and PCI are working) **/
 520         /* Initialize stdio devices */
 521         stdio_init ();
 522
 523         /* Initialize the jump table for applications */
 524         jumptable_init ();
 525
 526         /* Initialize the console (after the relocation and devices init) */
 527         console_init_r ();
 528
 529 #if defined(CONFIG_MISC_INIT_R)
 530         /* miscellaneous platform dependent initialisations */
 531         misc_init_r ();
 532 #endif
 533
 534 #if defined(CONFIG_CMD_KGDB)
 535         WATCHDOG_RESET ();
 536         puts ("KGDB:  ");
 537         kgdb_init ();
 538 #endif
 539
 540         debug ("U-Boot relocated to %08lx\n", dest_addr);
 541
 542         /*
 543          * Enable Interrupts
 544          */
 545         interrupt_init ();
 546
 547         /* Must happen after interrupts are initialized since
 548          * an irq handler gets installed
 549          */
 550         timer_init();
 551
 552 #ifdef CONFIG_STATUS_LED
 553         status_led_set (STATUS_LED_BOOT, STATUS_LED_BLINKING);
 554 #endif
 555
 556         udelay (20);
 557
 558         /* Insert function pointers now that we have relocated the code */
 559
 560         /* Initialize from environment */
 561         load_addr = getenv_ulong("loadaddr", 16, load_addr);
 562 #if defined(CONFIG_CMD_NET)
 563         if ((s = getenv ("bootfile")) != NULL) {
 564                 copy_filename (BootFile, s, sizeof (BootFile));
 565         }
 566 #endif
 567
 568         WATCHDOG_RESET ();
 569
 570 #if defined(CONFIG_CMD_DOC)
 571         WATCHDOG_RESET ();
 572         puts ("DOC:   ");
 573         doc_init ();
 574 #endif
 575
 576 #if defined(CONFIG_CMD_NAND)
 577         WATCHDOG_RESET ();
 578         puts ("NAND:  ");
 579         nand_init();            /* go init the NAND */
 580 #endif
 581
 582 #ifdef CONFIG_BITBANGMII
 583         bb_miiphy_init();
 584 #endif
 585 #if defined(CONFIG_CMD_NET)
 586         WATCHDOG_RESET();
 587 #if defined(FEC_ENET)
 588         eth_init(bd);
 589 #endif
 590         puts ("Net:   ");
 591         eth_initialize (bd);
 592 #endif
 593
 594 #ifdef CONFIG_POST
 595         post_run (NULL, POST_RAM | post_bootmode_get(0));
 596 #endif
 597
 598 #if defined(CONFIG_CMD_PCMCIA) \
 599     && !defined(CONFIG_CMD_IDE)
 600         WATCHDOG_RESET ();
 601         puts ("PCMCIA:");
 602         pcmcia_init ();
 603 #endif
 604
 605 #if defined(CONFIG_CMD_IDE)
 606         WATCHDOG_RESET ();
 607         puts ("IDE:   ");
 608         ide_init ();
 609 #endif
 610
 611 #ifdef CONFIG_LAST_STAGE_INIT
 612         WATCHDOG_RESET ();
 613         /*
 614          * Some parts can be only initialized if all others (like
 615          * Interrupts) are up and running (i.e. the PC-style ISA
 616          * keyboard).
 617          */
 618         last_stage_init ();
 619 #endif
 620
 621 #if defined(CONFIG_CMD_BEDBUG)
 622         WATCHDOG_RESET ();
 623         bedbug_init ();
 624 #endif
 625
 626 #if defined(CONFIG_PRAM) || defined(CONFIG_LOGBUFFER)
 627         /*
 628          * Export available size of memory for Linux,
 629          * taking into account the protected RAM at top of memory
 630          */
 631         {
 632                 ulong pram = 0;
 633                 char memsz[32];
 634
 635 #ifdef CONFIG_PRAM
 636                 pram = getenv_ulong("pram", 10, CONFIG_PRAM);
 637 #endif
 638 #ifdef CONFIG_LOGBUFFER
 639                 /* Also take the logbuffer into account (pram is in kB) */
 640                 pram += (LOGBUFF_LEN+LOGBUFF_OVERHEAD)/1024;
 641 #endif
 642                 sprintf (memsz, "%ldk", (bd->bi_memsize / 1024) - pram);
 643                 setenv ("mem", memsz);
 644         }
 645 #endif
 646
 647 #ifdef CONFIG_MODEM_SUPPORT
 648  {
 649          extern int do_mdm_init;
 650          do_mdm_init = gd->do_mdm_init;
 651  }
 652 #endif
 653
 654 #ifdef CONFIG_WATCHDOG
 655         /* disable watchdog if environment is set */
 656         if ((s = getenv ("watchdog")) != NULL) {
 657                 if (strncmp (s, "off", 3) == 0) {
 658                         WATCHDOG_DISABLE ();
 659                 }
 660         }
 661 #endif /* CONFIG_WATCHDOG*/
 662
 663
 664         /* Initialization complete - start the monitor */
 665
 666         /* main_loop() can return to retry autoboot, if so just run it again. */
 667         for (;;) {
 668                 WATCHDOG_RESET ();
 669                 main_loop ();
 670         }
 671
 672         /* NOTREACHED - no way out of command loop except booting */
 673 }
 674
 675
 676 void hang(void)
 677 {
 678         puts ("### ERROR ### Please RESET the board ###\n");
 679         for (;;);
 680 }