7e788b4289
Now we use a memory address to store the debug port info, So we need to read/write this address when we choose DEBUG_LL. When MMU isn't enable(I.E. the begining part of init stage of the linux kernel boot), we need to access physical address instead of virtual address, otherwise the kernel will crash. Signed-off-by: Jason Wang <jason77.wang@gmail.com> Signed-off-by: Tony Lindgren <tony@atomide.com>
103 lines
2.8 KiB
ArmAsm
103 lines
2.8 KiB
ArmAsm
/* arch/arm/mach-omap1/include/mach/debug-macro.S
|
|
*
|
|
* 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.
|
|
*
|
|
*/
|
|
|
|
#include <linux/serial_reg.h>
|
|
|
|
#include <asm/memory.h>
|
|
|
|
#include <plat/serial.h>
|
|
|
|
.pushsection .data
|
|
omap_uart_phys: .word 0x0
|
|
omap_uart_virt: .word 0x0
|
|
.popsection
|
|
|
|
/*
|
|
* Note that this code won't work if the bootloader passes
|
|
* a wrong machine ID number in r1. To debug, just hardcode
|
|
* the desired UART phys and virt addresses temporarily into
|
|
* the omap_uart_phys and omap_uart_virt above.
|
|
*/
|
|
.macro addruart, rx, tmp
|
|
|
|
/* Use omap_uart_phys/virt if already configured */
|
|
9: mrc p15, 0, \rx, c1, c0
|
|
tst \rx, #1 @ MMU enabled?
|
|
ldreq \rx, =__virt_to_phys(omap_uart_phys) @ physical base address
|
|
ldrne \rx, =omap_uart_virt @ virtual base
|
|
ldr \rx, [\rx, #0]
|
|
cmp \rx, #0 @ is port configured?
|
|
bne 99f @ already configured
|
|
|
|
/* Check the debug UART configuration set in uncompress.h */
|
|
mrc p15, 0, \rx, c1, c0
|
|
tst \rx, #1 @ MMU enabled?
|
|
ldreq \rx, =OMAP_UART_INFO
|
|
ldrne \rx, =__phys_to_virt(OMAP_UART_INFO)
|
|
ldr \rx, [\rx, #0]
|
|
|
|
/* Select the UART to use based on the UART1 scratchpad value */
|
|
10: cmp \rx, #0 @ no port configured?
|
|
beq 11f @ if none, try to use UART1
|
|
cmp \rx, #OMAP1UART1
|
|
beq 11f @ configure OMAP1UART1
|
|
cmp \rx, #OMAP1UART2
|
|
beq 12f @ configure OMAP1UART2
|
|
cmp \rx, #OMAP1UART3
|
|
beq 13f @ configure OMAP2UART3
|
|
|
|
/* Configure the UART offset from the phys/virt base */
|
|
11: mov \rx, #0x00fb0000 @ OMAP1UART1
|
|
b 98f
|
|
12: mov \rx, #0x00fb0000 @ OMAP1UART1
|
|
orr \rx, \rx, #0x00000800 @ OMAP1UART2
|
|
b 98f
|
|
13: mov \rx, #0x00fb0000 @ OMAP1UART1
|
|
orr \rx, \rx, #0x00000800 @ OMAP1UART2
|
|
orr \rx, \rx, #0x00009000 @ OMAP1UART3
|
|
|
|
/* Store both phys and virt address for the uart */
|
|
98: add \rx, \rx, #0xff000000 @ phys base
|
|
mrc p15, 0, \tmp, c1, c0
|
|
tst \tmp, #1 @ MMU enabled?
|
|
ldreq \tmp, =__virt_to_phys(omap_uart_phys)
|
|
ldrne \tmp, =omap_uart_phys
|
|
str \rx, [\tmp, #0]
|
|
sub \rx, \rx, #0xff000000 @ phys base
|
|
add \rx, \rx, #0xfe000000 @ virt base
|
|
ldreq \tmp, =__virt_to_phys(omap_uart_virt)
|
|
ldrne \tmp, =omap_uart_virt
|
|
str \rx, [\tmp, #0]
|
|
b 9b
|
|
99:
|
|
.endm
|
|
|
|
.macro senduart,rd,rx
|
|
strb \rd, [\rx]
|
|
.endm
|
|
|
|
.macro busyuart,rd,rx
|
|
1001: ldrb \rd, [\rx, #(UART_LSR << OMAP_PORT_SHIFT)]
|
|
and \rd, \rd, #(UART_LSR_TEMT | UART_LSR_THRE)
|
|
teq \rd, #(UART_LSR_TEMT | UART_LSR_THRE)
|
|
beq 1002f
|
|
ldrb \rd, [\rx, #(UART_LSR << OMAP7XX_PORT_SHIFT)]
|
|
and \rd, \rd, #(UART_LSR_TEMT | UART_LSR_THRE)
|
|
teq \rd, #(UART_LSR_TEMT | UART_LSR_THRE)
|
|
bne 1001b
|
|
1002:
|
|
.endm
|
|
|
|
.macro waituart,rd,rx
|
|
.endm
|