arch/arm-raspi/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 <hardware/bcm283x.h>
  10 #include <hardware/pl011uart.h>
  11
  12 #include <kernel_base.h>
  13 #include <kernel_debug.h>
  14
  15 void (*_KrnPutC)(char) = NULL;
  16
  17 inline void krnWaitSerOut()
  18 {
  19     while(1)
  20     {
  21        if ((*(volatile uint32_t *)(PL011_0_BASE + PL011_FR) & PL011_FR_TXFF) == 0) break;
  22     }
  23 }
  24
  25
  26 inline void krnSerPutC(uint8_t chr)
  27 {
  28     krnWaitSerOut();
  29
  30     if (chr == '\n')
  31         *(volatile uint32_t *)(PL011_0_BASE + PL011_DR) = '\r';
  32     *(volatile uint32_t *)(PL011_0_BASE + PL011_DR) = chr;
  33 }
  34
  35 int krnPutC(int chr, struct KernelBase *KernelBase)
  36 {
  37     if (chr == 0x03)
  38         _KrnPutC = NULL;
  39     else
  40     {
  41         if (_KrnPutC)
  42             _KrnPutC(chr);
  43
  44         krnSerPutC(chr);
  45     }
  46 }