arch/arm/mach-at91/include/mach/debug-macro.S

   1 /*
   2  * arch/arm/mach-at91/include/mach/debug-macro.S
   3  *
   4  *  Copyright (C) 2003-2005 SAN People
   5  *
   6  * Debugging macro include header
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  *
  12 */
  13
  14 #include <mach/hardware.h>
  15 #include <mach/at91_dbgu.h>
  16
  17         .macro  addruart, rx, tmp
  18         mrc     p15, 0, \rx, c1, c0
  19         tst     \rx, #1                                         @ MMU enabled?
  20         ldreq   \rx, =(AT91_BASE_SYS + AT91_DBGU)               @ System peripherals (phys address)
  21         ldrne   \rx, =(AT91_VA_BASE_SYS + AT91_DBGU)            @ System peripherals (virt address)
  22         .endm
  23
  24         .macro  senduart,rd,rx
  25         strb    \rd, [\rx, #(AT91_DBGU_THR - AT91_DBGU)]        @ Write to Transmitter Holding Register
  26         .endm
  27
  28         .macro  waituart,rd,rx
  29 1001:   ldr     \rd, [\rx, #(AT91_DBGU_SR - AT91_DBGU)]         @ Read Status Register
  30         tst     \rd, #AT91_DBGU_TXRDY                           @ DBGU_TXRDY = 1 when ready to transmit
  31         beq     1001b
  32         .endm
  33
  34         .macro  busyuart,rd,rx
  35 1001:   ldr     \rd, [\rx, #(AT91_DBGU_SR - AT91_DBGU)]         @ Read Status Register
  36         tst     \rd, #AT91_DBGU_TXEMPTY                         @ DBGU_TXEMPTY = 1 when transmission complete
  37         beq     1001b
  38         .endm
  39