2008-08-05 23:14:15 +08:00
|
|
|
/* arch/arm/mach-sa1100/include/mach/debug-macro.S
|
2005-04-17 06:20:36 +08:00
|
|
|
*
|
|
|
|
* Debugging macro include header
|
|
|
|
*
|
|
|
|
* Copyright (C) 1994-1999 Russell King
|
|
|
|
* Moved from linux/arch/arm/kernel/debug.S by Ben Dooks
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
*/
|
2008-08-05 23:14:15 +08:00
|
|
|
#include <mach/hardware.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-09-01 10:55:46 +08:00
|
|
|
.macro addruart, rp, rv, tmp
|
2010-07-06 18:30:06 +08:00
|
|
|
mrc p15, 0, \rp, c1, c0
|
|
|
|
tst \rp, #1 @ MMU enabled?
|
|
|
|
moveq \rp, #0x80000000 @ physical base address
|
|
|
|
movne \rp, #0xf8000000 @ virtual address
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
@ We probe for the active serial port here, coherently with
|
2008-08-05 23:14:15 +08:00
|
|
|
@ the comment in arch/arm/mach-sa1100/include/mach/uncompress.h.
|
2005-04-17 06:20:36 +08:00
|
|
|
@ We assume r1 can be clobbered.
|
|
|
|
|
|
|
|
@ see if Ser3 is active
|
2010-07-06 18:30:06 +08:00
|
|
|
add \rp, \rp, #0x00050000
|
|
|
|
ldr \rv, [\rp, #UTCR3]
|
|
|
|
tst \rv, #UTCR3_TXE
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
@ if Ser3 is inactive, then try Ser1
|
2010-07-06 18:30:06 +08:00
|
|
|
addeq \rp, \rp, #(0x00010000 - 0x00050000)
|
|
|
|
ldreq \rv, [\rp, #UTCR3]
|
|
|
|
tsteq \rv, #UTCR3_TXE
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
@ if Ser1 is inactive, then try Ser2
|
2010-07-06 18:30:06 +08:00
|
|
|
addeq \rp, \rp, #(0x00030000 - 0x00010000)
|
|
|
|
ldreq \rv, [\rp, #UTCR3]
|
|
|
|
tsteq \rv, #UTCR3_TXE
|
|
|
|
|
|
|
|
@ clear top bits, and generate both phys and virt addresses
|
|
|
|
lsl \rp, \rp, #8
|
|
|
|
lsr \rp, \rp, #8
|
|
|
|
orr \rv, \rp, #0xf8000000 @ virtual
|
|
|
|
orr \rp, \rp, #0x80000000 @ physical
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro senduart,rd,rx
|
|
|
|
str \rd, [\rx, #UTDR]
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro waituart,rd,rx
|
|
|
|
1001: ldr \rd, [\rx, #UTSR1]
|
|
|
|
tst \rd, #UTSR1_TNF
|
|
|
|
beq 1001b
|
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro busyuart,rd,rx
|
|
|
|
1001: ldr \rd, [\rx, #UTSR1]
|
|
|
|
tst \rd, #UTSR1_TBY
|
|
|
|
bne 1001b
|
|
|
|
.endm
|