arch/m68k-amiga/boot/debug.c

   1 /*
   2  * Copyright (C) 2011, The AROS Development Team.  All rights reserved.
   3  * Author: Jason S. McMullan <jason.mcmullan@gmail.com>
   4  *
   5  * Licensed under the AROS PUBLIC LICENSE (APL) Version 1.1
   6  */
   7
   8 #include <hardware/intbits.h>
   9
  10 #include "amiga_hwreg.h"
  11 #include "debug.h"
  12
  13 void DebugInit(void)
  14 {
  15         /* Set DTR, RTS, etc */
  16         volatile UBYTE *ciab_pra = (APTR)0xBFD000;
  17         volatile UBYTE *ciab_ddra = (APTR)0xBFD200;
  18         *ciab_ddra = 0xc0;  /* Only DTR and RTS are driven as outputs */
  19         *ciab_pra = 0;      /* Turn on DTR and RTS */
  20
  21         /* Set the debug UART to 115200 */
  22         reg_w(SERPER, SERPER_BAUD(SERPER_BASE_PAL, 115200));
  23 }
  24
  25 int DebugPutChar(register int chr)
  26 {
  27         if (chr == '\n')
  28                 DebugPutChar('\r');
  29
  30         while ((reg_r(SERDATR) & SERDATR_TBE) == 0);
  31         reg_w(INTREQ, INTF_TBE);
  32
  33         /* Output a char to the debug UART */
  34         reg_w(SERDAT, SERDAT_STP8 | SERDAT_DB8(chr));
  35
  36         return 1;
  37 }
  38
  39 int DebugMayGetChar(void)
  40 {
  41         int c;
  42
  43         if ((reg_r(SERDATR) & SERDATR_RBF) == 0)
  44             return -1;
  45
  46         c = SERDATR_DB8_of(reg_r(SERDATR));
  47
  48         /* Clear RBF */
  49         reg_w(INTREQ, INTF_RBF);
  50
  51         return c;
  52 }
  53
  54 #if AROS_SERIAL_DEBUG
  55
  56 void DebugPutStr(register const char *buff)
  57 {
  58         for (; *buff != 0; buff++)
  59                 DebugPutChar(*buff);
  60 }
  61
  62 void DebugPutDec(const char *what, ULONG val)
  63 {
  64         int i, num;
  65         DebugPutStr(what);
  66         DebugPutStr(": ");
  67         if (val == 0) {
  68             DebugPutChar('0');
  69             DebugPutChar('\n');
  70             return;
  71         }
  72
  73         for (i = 1000000000; i > 0; i /= 10) {
  74             if (val == 0) {
  75                 DebugPutChar('0');
  76                 continue;
  77             }
  78
  79             num = val / i;
  80             if (num == 0)
  81                 continue;
  82
  83             DebugPutChar("0123456789"[num]);
  84             val -= num * i;
  85         }
  86         DebugPutChar('\n');
  87 }
  88
  89 void DebugPutHex(const char *what, ULONG val)
  90 {
  91         int i;
  92         DebugPutStr(what);
  93         DebugPutStr(": ");
  94         for (i = 0; i < 8; i ++) {
  95                 DebugPutChar("0123456789abcdef"[(val >> (28 - (i * 4))) & 0xf]);
  96         }
  97         DebugPutChar('\n');
  98 }
  99
 100 void DebugPutHexVal(ULONG val)
 101 {
 102         int i;
 103         for (i = 0; i < 8; i ++) {
 104                 DebugPutChar("0123456789abcdef"[(val >> (28 - (i * 4))) & 0xf]);
 105         }
 106         DebugPutChar(' ');
 107 }
 108
 109 #endif
 110
 111