arch/arm-native/kernel/kernel_debug.c

   1 /*
   2     Copyright © 2013-2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <aros/kernel.h>
   7 #include <inttypes.h>
   8
   9 #include <kernel_base.h>
  10 #include <kernel_debug.h>
  11 #include <kernel_intern.h>
  12 #include <hardware/pl011uart.h>
  13
  14 void (*_KrnPutC)(char) = NULL;
  15
  16 inline void krnWaitSerOut()
  17 {
  18     while(1)
  19     {
  20        if ((*(volatile uint32_t *)(PL011_0_BASE + PL011_FR) & PL011_FR_TXFF) == 0) break;
  21     }
  22 }
  23
  24
  25 inline void krnSerPutC(uint8_t chr)
  26 {
  27     krnWaitSerOut();
  28
  29     if (chr == '\n')
  30     {
  31         *(volatile uint32_t *)(PL011_0_BASE + PL011_DR) = '\r';
  32         krnWaitSerOut();
  33     }
  34     *(volatile uint32_t *)(PL011_0_BASE + PL011_DR) = chr;
  35 }
  36
  37 int krnPutC(int chr, struct KernelBase *KernelBase)
  38 {
  39     if (chr == 0x03)
  40         _KrnPutC = NULL;
  41     else
  42     {
  43         if (_KrnPutC)
  44             _KrnPutC(chr);
  45
  46         krnSerPutC(chr);
  47     }
  48 }