debug-macro.S 1.1 KB
Newer Older
1
/*
2
 * arch/arm/mach-at91/include/mach/debug-macro.S
3 4 5 6 7 8 9 10 11 12 13
 *
 *  Copyright (C) 2003-2005 SAN People
 *
 * Debugging macro include header
 *
 * 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.
 *
*/

14 15
#include <mach/hardware.h>
#include <mach/at91_dbgu.h>
16

17
	.macro	addruart, rx, tmp
18
	mrc	p15, 0, \rx, c1, c0
19 20 21
	tst	\rx, #1						@ MMU enabled?
	ldreq	\rx, =(AT91_BASE_SYS + AT91_DBGU)		@ System peripherals (phys address)
	ldrne	\rx, =(AT91_VA_BASE_SYS	+ AT91_DBGU)		@ System peripherals (virt address)
22 23 24
	.endm

	.macro	senduart,rd,rx
25
	strb	\rd, [\rx, #(AT91_DBGU_THR - AT91_DBGU)]	@ Write to Transmitter Holding Register
26 27 28
	.endm

	.macro	waituart,rd,rx
29 30
1001:	ldr	\rd, [\rx, #(AT91_DBGU_SR - AT91_DBGU)]		@ Read Status Register
	tst	\rd, #AT91_DBGU_TXRDY				@ DBGU_TXRDY = 1 when ready to transmit
31 32 33 34
	beq	1001b
	.endm

	.macro	busyuart,rd,rx
35 36
1001:	ldr	\rd, [\rx, #(AT91_DBGU_SR - AT91_DBGU)]		@ Read Status Register
	tst	\rd, #AT91_DBGU_TXEMPTY				@ DBGU_TXEMPTY = 1 when transmission complete
37 38 39
	beq	1001b
	.endm