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 #undef ARM_PERIIOBASE
  16 extern uint32_t __arm_periiobase;
  17 #define ARM_PERIIOBASE (__arm_periiobase)
  18
  19 void (*_KrnPutC)(char) = NULL;
  20
  21 inline void krnWaitSerOut()
  22 {
  23     while(1)
  24     {
  25        if ((*(volatile uint32_t *)(PL011_0_BASE + PL011_FR) & PL011_FR_TXFF) == 0) break;
  26     }
  27 }
  28
  29
  30 inline void krnSerPutC(uint8_t chr)
  31 {
  32     krnWaitSerOut();
  33
  34     if (chr == '\n')
  35     {
  36         *(volatile uint32_t *)(PL011_0_BASE + PL011_DR) = '\r';
  37         krnWaitSerOut();
  38     }
  39     *(volatile uint32_t *)(PL011_0_BASE + PL011_DR) = chr;
  40 }
  41
  42 int krnPutC(int chr, struct KernelBase *KernelBase)
  43 {
  44     if (chr == 0x03)
  45         _KrnPutC = NULL;
  46     else
  47     {
  48         if (_KrnPutC)
  49             _KrnPutC(chr);
  50
  51         krnSerPutC(chr);
  52     }
  53 }