firmware/system.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2002 by Alan Korr
  11  *
  12  * All files in this archive are subject to the GNU General Public License.
  13  * See the file COPYING in the source tree root for full license agreement.
  14  *
  15  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  16  * KIND, either express or implied.
  17  *
  18  ****************************************************************************/
  19 #include <stdio.h>
  20 #include "config.h"
  21
  22 #include <lcd.h>
  23 #include "led.h"
  24 #include "system.h"
  25
  26 #define default_interrupt(name,number) \
  27   extern __attribute__((weak,alias("UIE" #number))) void name (void); void UIE##number (void)
  28 #define reserve_interrupt(number) \
  29   void UIE##number (void)
  30
  31 extern void reset_pc (void);
  32 extern void reset_sp (void);
  33
  34 static const char* irqname[] = {
  35     "", "", "", "", "IllInstr", "", "IllSltIn","","",
  36     "CPUAdrEr", "DMAAdrEr", "NMI", "UserBrk",
  37     "","","","","","","","","","","","","","","","","","","",
  38     "Trap32","Trap33","Trap34","Trap35","Trap36","Trap37","Trap38","Trap39",
  39     "Trap40","Trap41","Trap42","Trap43","Trap44","Trap45","Trap46","Trap47",
  40     "Trap48","Trap49","Trap50","Trap51","Trap52","Trap53","Trap54","Trap55",
  41     "Trap56","Trap57","Trap58","Trap59","Trap60","Trap61","Trap62","Trap63",
  42     "Irq0","Irq1","Irq2","Irq3","Irq4","Irq5","Irq6","Irq7",
  43     "Dma0","","Dma1","","Dma2","","Dma3","",
  44     "IMIA0","IMIB0","OVI0","", "IMIA1","IMIB1","OVI1","",
  45     "IMIA2","IMIB2","OVI2","", "IMIA3","IMIB3","OVI3","",
  46     "IMIA4","IMIB4","OVI4","",
  47     "Ser0Err","Ser0Rx","Ser0Tx","Ser0TE",
  48     "Ser1Err","Ser1Rx","Ser1Tx","Ser1TE",
  49     "ParityEr","A/D conv","","","Watchdog","DRAMRefr"
  50 };
  51
  52 reserve_interrupt (          0);
  53 reserve_interrupt (          1);
  54 reserve_interrupt (          2);
  55 reserve_interrupt (          3);
  56 default_interrupt (GII,      4);
  57 reserve_interrupt (          5);
  58 default_interrupt (ISI,      6);
  59 reserve_interrupt (          7);
  60 reserve_interrupt (          8);
  61 default_interrupt (CPUAE,    9);
  62 default_interrupt (DMAAE,   10);
  63 default_interrupt (NMI,     11);
  64 default_interrupt (UB,      12);
  65 reserve_interrupt (         13);
  66 reserve_interrupt (         14);
  67 reserve_interrupt (         15);
  68 reserve_interrupt (         16); // TCB #0
  69 reserve_interrupt (         17); // TCB #1
  70 reserve_interrupt (         18); // TCB #2
  71 reserve_interrupt (         19); // TCB #3
  72 reserve_interrupt (         20); // TCB #4
  73 reserve_interrupt (         21); // TCB #5
  74 reserve_interrupt (         22); // TCB #6
  75 reserve_interrupt (         23); // TCB #7
  76 reserve_interrupt (         24); // TCB #8
  77 reserve_interrupt (         25); // TCB #9
  78 reserve_interrupt (         26); // TCB #10
  79 reserve_interrupt (         27); // TCB #11
  80 reserve_interrupt (         28); // TCB #12
  81 reserve_interrupt (         29); // TCB #13
  82 reserve_interrupt (         30); // TCB #14
  83 reserve_interrupt (         31); // TCB #15
  84 default_interrupt (TRAPA32, 32);
  85 default_interrupt (TRAPA33, 33);
  86 default_interrupt (TRAPA34, 34);
  87 default_interrupt (TRAPA35, 35);
  88 default_interrupt (TRAPA36, 36);
  89 default_interrupt (TRAPA37, 37);
  90 default_interrupt (TRAPA38, 38);
  91 default_interrupt (TRAPA39, 39);
  92 default_interrupt (TRAPA40, 40);
  93 default_interrupt (TRAPA41, 41);
  94 default_interrupt (TRAPA42, 42);
  95 default_interrupt (TRAPA43, 43);
  96 default_interrupt (TRAPA44, 44);
  97 default_interrupt (TRAPA45, 45);
  98 default_interrupt (TRAPA46, 46);
  99 default_interrupt (TRAPA47, 47);
 100 default_interrupt (TRAPA48, 48);
 101 default_interrupt (TRAPA49, 49);
 102 default_interrupt (TRAPA50, 50);
 103 default_interrupt (TRAPA51, 51);
 104 default_interrupt (TRAPA52, 52);
 105 default_interrupt (TRAPA53, 53);
 106 default_interrupt (TRAPA54, 54);
 107 default_interrupt (TRAPA55, 55);
 108 default_interrupt (TRAPA56, 56);
 109 default_interrupt (TRAPA57, 57);
 110 default_interrupt (TRAPA58, 58);
 111 default_interrupt (TRAPA59, 59);
 112 default_interrupt (TRAPA60, 60);
 113 default_interrupt (TRAPA61, 61);
 114 default_interrupt (TRAPA62, 62);
 115 default_interrupt (TRAPA63, 63);
 116 default_interrupt (IRQ0,    64);
 117 default_interrupt (IRQ1,    65);
 118 default_interrupt (IRQ2,    66);
 119 default_interrupt (IRQ3,    67);
 120 default_interrupt (IRQ4,    68);
 121 default_interrupt (IRQ5,    69);
 122 default_interrupt (IRQ6,    70);
 123 default_interrupt (IRQ7,    71);
 124 default_interrupt (DEI0,    72);
 125 reserve_interrupt (         73);
 126 default_interrupt (DEI1,    74);
 127 reserve_interrupt (         75);
 128 default_interrupt (DEI2,    76);
 129 reserve_interrupt (         77);
 130 default_interrupt (DEI3,    78);
 131 reserve_interrupt (         79);
 132 default_interrupt (IMIA0,   80);
 133 default_interrupt (IMIB0,   81);
 134 default_interrupt (OVI0,    82);
 135 reserve_interrupt (         83);
 136 default_interrupt (IMIA1,   84);
 137 default_interrupt (IMIB1,   85);
 138 default_interrupt (OVI1,    86);
 139 reserve_interrupt (         87);
 140 default_interrupt (IMIA2,   88);
 141 default_interrupt (IMIB2,   89);
 142 default_interrupt (OVI2,    90);
 143 reserve_interrupt (         91);
 144 default_interrupt (IMIA3,   92);
 145 default_interrupt (IMIB3,   93);
 146 default_interrupt (OVI3,    94);
 147 reserve_interrupt (         95);
 148 default_interrupt (IMIA4,   96);
 149 default_interrupt (IMIB4,   97);
 150 default_interrupt (OVI4,    98);
 151 reserve_interrupt (         99);
 152 default_interrupt (REI0,   100);
 153 default_interrupt (RXI0,   101);
 154 default_interrupt (TXI0,   102);
 155 default_interrupt (TEI0,   103);
 156 default_interrupt (REI1,   104);
 157 default_interrupt (RXI1,   105);
 158 default_interrupt (TXI1,   106);
 159 default_interrupt (TEI1,   107);
 160 reserve_interrupt (        108);
 161 default_interrupt (ADITI,  109);
 162
 163 /* reset vectors are handled in crt0.S */
 164 void (*vbr[]) (void) __attribute__ ((section (".vectors"))) =
 165 {
 166     /*** 4 General Illegal Instruction ***/
 167
 168     GII,
 169
 170     /*** 5 Reserved ***/
 171
 172     UIE5,
 173
 174     /*** 6 Illegal Slot Instruction ***/
 175
 176     ISI,
 177
 178     /*** 7-8 Reserved ***/
 179
 180     UIE7,UIE8,
 181
 182     /*** 9 CPU Address Error ***/
 183
 184     CPUAE,
 185
 186     /*** 10 DMA Address Error ***/
 187
 188     DMAAE,
 189
 190     /*** 11 NMI ***/
 191
 192     NMI,
 193
 194     /*** 12 User Break ***/
 195
 196     UB,
 197
 198     /*** 13-31 Reserved ***/
 199
 200     UIE13,UIE14,UIE15,UIE16,UIE17,UIE18,UIE19,UIE20,UIE21,UIE22,UIE23,UIE24,UIE25,UIE26,UIE27,UIE28,UIE29,UIE30,UIE31,
 201
 202     /*** 32-63 TRAPA #20...#3F ***/
 203
 204     TRAPA32,TRAPA33,TRAPA34,TRAPA35,TRAPA36,TRAPA37,TRAPA38,TRAPA39,TRAPA40,TRAPA41,TRAPA42,TRAPA43,TRAPA44,TRAPA45,TRAPA46,TRAPA47,TRAPA48,TRAPA49,TRAPA50,TRAPA51,TRAPA52,TRAPA53,TRAPA54,TRAPA55,TRAPA56,TRAPA57,TRAPA58,TRAPA59,TRAPA60,TRAPA61,TRAPA62,TRAPA63,
 205
 206     /*** 64-71 IRQ0-7 ***/
 207
 208     IRQ0,IRQ1,IRQ2,IRQ3,IRQ4,IRQ5,IRQ6,IRQ7,
 209
 210     /*** 72 DMAC0 ***/
 211
 212     DEI0,
 213
 214     /*** 73 Reserved ***/
 215
 216     UIE73,
 217
 218     /*** 74 DMAC1 ***/
 219
 220     DEI1,
 221
 222     /*** 75 Reserved ***/
 223
 224     UIE75,
 225
 226     /*** 76 DMAC2 ***/
 227
 228     DEI2,
 229
 230     /*** 77 Reserved ***/
 231
 232     UIE77,
 233
 234     /*** 78 DMAC3 ***/
 235
 236     DEI3,
 237
 238     /*** 79 Reserved ***/
 239
 240     UIE79,
 241
 242     /*** 80-82 ITU0 ***/
 243
 244     IMIA0,IMIB0,OVI0,
 245
 246     /*** 83 Reserved ***/
 247
 248     UIE83,
 249
 250     /*** 84-86 ITU1 ***/
 251
 252     IMIA1,IMIB1,OVI1,
 253
 254     /*** 87 Reserved ***/
 255
 256     UIE87,
 257
 258     /*** 88-90 ITU2 ***/
 259
 260     IMIA2,IMIB2,OVI2,
 261
 262     /*** 91 Reserved ***/
 263
 264     UIE91,
 265
 266     /*** 92-94 ITU3 ***/
 267
 268     IMIA3,IMIB3,OVI3,
 269
 270     /*** 95 Reserved ***/
 271
 272     UIE95,
 273
 274     /*** 96-98 ITU4 ***/
 275
 276     IMIA4,IMIB4,OVI4,
 277
 278     /*** 99 Reserved ***/
 279
 280     UIE99,
 281
 282     /*** 100-103 SCI0 ***/
 283
 284     REI0,RXI0,TXI0,TEI0,
 285
 286     /*** 104-107 SCI1 ***/
 287
 288     REI1,RXI1,TXI1,TEI1,
 289
 290     /*** 108 Parity Control Unit ***/
 291
 292     UIE108,
 293
 294     /*** 109 AD Converter ***/
 295
 296     ADITI
 297
 298 };
 299
 300
 301 void system_reboot (void)
 302 {
 303     cli ();
 304
 305     asm volatile ("ldc\t%0,vbr" : : "r"(0));
 306
 307     IPRA = 0;
 308     IPRB = 0;
 309     IPRC = 0;
 310     IPRD = 0;
 311     IPRE = 0;
 312     ICR = 0;
 313
 314     asm volatile ("jmp @%0; mov.l @%1,r15" : :
 315                   "r"(*(int*)0),"r"(4));
 316 }
 317
 318 void UIE (unsigned int pc) /* Unexpected Interrupt or Exception */
 319 {
 320     bool state = true;
 321     unsigned int n;
 322     char str[32];
 323
 324     asm volatile ("sts\tpr,%0" : "=r"(n));
 325
 326     /* clear screen */
 327     lcd_clear_display ();
 328     /* output exception */
 329     n = (n - (unsigned)UIE0 - 4)>>2; // get exception or interrupt number
 330     snprintf(str,sizeof(str),"I%02x:%s",n,irqname[n]);
 331     lcd_puts(0,0,str);
 332     snprintf(str,sizeof(str),"at %08x",pc);
 333     lcd_puts(0,1,str);
 334
 335 #ifdef HAVE_LCD_BITMAP
 336     lcd_update ();
 337 #endif
 338
 339     while (1)
 340     {
 341         volatile int i;
 342         led (state);
 343         state = state?false:true;
 344
 345         for (i = 0; i < 240000; ++i);
 346     }
 347 }
 348
 349 asm (
 350     "_UIE0:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 351     "_UIE1:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 352     "_UIE2:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 353     "_UIE3:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 354     "_UIE4:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 355     "_UIE5:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 356     "_UIE6:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 357     "_UIE7:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 358     "_UIE8:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 359     "_UIE9:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 360     "_UIE10:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 361     "_UIE11:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 362     "_UIE12:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 363     "_UIE13:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 364     "_UIE14:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 365     "_UIE15:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 366     "_UIE16:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 367     "_UIE17:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 368     "_UIE18:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 369     "_UIE19:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 370     "_UIE20:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 371     "_UIE21:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 372     "_UIE22:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 373     "_UIE23:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 374     "_UIE24:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 375     "_UIE25:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 376     "_UIE26:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 377     "_UIE27:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 378     "_UIE28:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 379     "_UIE29:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 380     "_UIE30:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 381     "_UIE31:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 382     "_UIE32:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 383     "_UIE33:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 384     "_UIE34:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 385     "_UIE35:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 386     "_UIE36:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 387     "_UIE37:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 388     "_UIE38:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 389     "_UIE39:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 390     "_UIE40:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 391     "_UIE41:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 392     "_UIE42:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 393     "_UIE43:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 394     "_UIE44:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 395     "_UIE45:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 396     "_UIE46:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 397     "_UIE47:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 398     "_UIE48:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 399     "_UIE49:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 400     "_UIE50:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 401     "_UIE51:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 402     "_UIE52:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 403     "_UIE53:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 404     "_UIE54:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 405     "_UIE55:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 406     "_UIE56:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 407     "_UIE57:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 408     "_UIE58:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 409     "_UIE59:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 410     "_UIE60:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 411     "_UIE61:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 412     "_UIE62:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 413     "_UIE63:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 414     "_UIE64:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 415     "_UIE65:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 416     "_UIE66:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 417     "_UIE67:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 418     "_UIE68:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 419     "_UIE69:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 420     "_UIE70:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 421     "_UIE71:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 422     "_UIE72:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 423     "_UIE73:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 424     "_UIE74:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 425     "_UIE75:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 426     "_UIE76:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 427     "_UIE77:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 428     "_UIE78:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 429     "_UIE79:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 430     "_UIE80:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 431     "_UIE81:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 432     "_UIE82:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 433     "_UIE83:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 434     "_UIE84:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 435     "_UIE85:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 436     "_UIE86:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 437     "_UIE87:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 438     "_UIE88:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 439     "_UIE89:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 440     "_UIE90:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 441     "_UIE91:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 442     "_UIE92:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 443     "_UIE93:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 444     "_UIE94:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 445     "_UIE95:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 446     "_UIE96:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 447     "_UIE97:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 448     "_UIE98:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 449     "_UIE99:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 450     "_UIE100:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 451     "_UIE101:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 452     "_UIE102:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 453     "_UIE103:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 454     "_UIE104:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 455     "_UIE105:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 456     "_UIE106:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 457     "_UIE107:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 458     "_UIE108:\tbsr\t_UIE\n\tmov.l\t@r15+,r4\t\n"
 459     "_UIE109:\tbsr\t_UIE\n\tmov.l\t@r15+,r4");
 460
 461 void system_init(void)
 462 {
 463     /* Disable all interrupts */
 464     IPRA = 0;
 465     IPRB = 0;
 466     IPRC = 0;
 467     IPRD = 0;
 468     IPRE = 0;
 469
 470     /* NMI level low, falling edge on all interrupts */
 471     ICR = 0;
 472 }