2015-09-21 15:27:37 +00:00
|
|
|
/*
|
|
|
|
* On-chip UART initializaion for low-level debugging
|
|
|
|
*
|
|
|
|
* Copyright (C) 2014-2015 Masahiro Yamada <yamada.masahiro@socionext.com>
|
|
|
|
*
|
|
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/serial_reg.h>
|
|
|
|
#include <linux/linkage.h>
|
2016-01-08 16:51:13 +00:00
|
|
|
|
2016-02-26 09:59:44 +00:00
|
|
|
#include "../bcu/bcu-regs.h"
|
|
|
|
#include "../sc-regs.h"
|
|
|
|
#include "../sg-regs.h"
|
2015-09-21 15:27:37 +00:00
|
|
|
|
|
|
|
#if !defined(CONFIG_DEBUG_SEMIHOSTING)
|
|
|
|
#include CONFIG_DEBUG_LL_INCLUDE
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#define BAUDRATE 115200
|
|
|
|
#define DIV_ROUND(x, d) (((x) + ((d) / 2)) / (d))
|
|
|
|
|
|
|
|
ENTRY(debug_ll_init)
|
|
|
|
ldr r0, =SG_REVISION
|
|
|
|
ldr r1, [r0]
|
|
|
|
and r1, r1, #SG_REVISION_TYPE_MASK
|
|
|
|
mov r1, r1, lsr #SG_REVISION_TYPE_SHIFT
|
|
|
|
|
|
|
|
#if defined(CONFIG_ARCH_UNIPHIER_PH1_SLD3)
|
|
|
|
#define PH1_SLD3_UART_CLK 36864000
|
|
|
|
cmp r1, #0x25
|
|
|
|
bne ph1_sld3_end
|
|
|
|
|
|
|
|
sg_set_pinsel 64, 1, 4, 4, r0, r1 @ TXD0 -> TXD0
|
|
|
|
|
|
|
|
ldr r0, =BCSCR5
|
|
|
|
ldr r1, =0x24440000
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r0, =SC_CLKCTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #SC_CLKCTRL_CEN_PERI
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r3, =DIV_ROUND(PH1_SLD3_UART_CLK, 16 * BAUDRATE)
|
|
|
|
|
|
|
|
b init_uart
|
|
|
|
ph1_sld3_end:
|
|
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_UNIPHIER_PH1_LD4)
|
|
|
|
#define PH1_LD4_UART_CLK 36864000
|
|
|
|
cmp r1, #0x26
|
|
|
|
bne ph1_ld4_end
|
|
|
|
|
|
|
|
ldr r0, =SG_IECTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #1
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
sg_set_pinsel 88, 1, 8, 4, r0, r1 @ HSDOUT6 -> TXD0
|
|
|
|
|
|
|
|
ldr r3, =DIV_ROUND(PH1_LD4_UART_CLK, 16 * BAUDRATE)
|
|
|
|
|
|
|
|
b init_uart
|
|
|
|
ph1_ld4_end:
|
|
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_UNIPHIER_PH1_PRO4)
|
|
|
|
#define PH1_PRO4_UART_CLK 73728000
|
|
|
|
cmp r1, #0x28
|
|
|
|
bne ph1_pro4_end
|
|
|
|
|
|
|
|
sg_set_pinsel 128, 0, 4, 8, r0, r1 @ TXD0 -> TXD0
|
|
|
|
|
|
|
|
ldr r0, =SG_LOADPINCTRL
|
|
|
|
mov r1, #1
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r0, =SC_CLKCTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #SC_CLKCTRL_CEN_PERI
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r3, =DIV_ROUND(PH1_PRO4_UART_CLK, 16 * BAUDRATE)
|
|
|
|
|
|
|
|
b init_uart
|
|
|
|
ph1_pro4_end:
|
|
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_UNIPHIER_PH1_SLD8)
|
|
|
|
#define PH1_SLD8_UART_CLK 80000000
|
|
|
|
cmp r1, #0x29
|
|
|
|
bne ph1_sld8_end
|
|
|
|
|
|
|
|
ldr r0, =SG_IECTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #1
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
sg_set_pinsel 70, 3, 8, 4, r0, r1 @ HSDOUT0 -> TXD0
|
|
|
|
|
|
|
|
ldr r3, =DIV_ROUND(PH1_SLD8_UART_CLK, 16 * BAUDRATE)
|
|
|
|
|
|
|
|
b init_uart
|
|
|
|
ph1_sld8_end:
|
|
|
|
#endif
|
2015-09-21 15:27:40 +00:00
|
|
|
#if defined(CONFIG_ARCH_UNIPHIER_PH1_PRO5)
|
|
|
|
#define PH1_PRO5_UART_CLK 73728000
|
|
|
|
cmp r1, #0x2A
|
|
|
|
bne ph1_pro5_end
|
|
|
|
|
|
|
|
sg_set_pinsel 47, 0, 4, 8, r0, r1 @ TXD0 -> TXD0
|
|
|
|
sg_set_pinsel 49, 0, 4, 8, r0, r1 @ TXD1 -> TXD1
|
|
|
|
sg_set_pinsel 51, 0, 4, 8, r0, r1 @ TXD2 -> TXD2
|
|
|
|
sg_set_pinsel 53, 0, 4, 8, r0, r1 @ TXD3 -> TXD3
|
|
|
|
|
|
|
|
ldr r0, =SG_LOADPINCTRL
|
|
|
|
mov r1, #1
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r0, =SC_CLKCTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #SC_CLKCTRL_CEN_PERI
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r3, =DIV_ROUND(PH1_PRO5_UART_CLK, 16 * BAUDRATE)
|
|
|
|
|
|
|
|
b init_uart
|
|
|
|
ph1_pro5_end:
|
|
|
|
#endif
|
2015-09-21 15:27:41 +00:00
|
|
|
#if defined(CONFIG_ARCH_UNIPHIER_PROXSTREAM2)
|
|
|
|
#define PROXSTREAM2_UART_CLK 88900000
|
|
|
|
cmp r1, #0x2E
|
|
|
|
bne proxstream2_end
|
|
|
|
|
|
|
|
ldr r0, =SG_IECTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #1
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
sg_set_pinsel 217, 8, 8, 4, r0, r1 @ TXD0 -> TXD0
|
|
|
|
sg_set_pinsel 115, 8, 8, 4, r0, r1 @ TXD1 -> TXD1
|
|
|
|
sg_set_pinsel 113, 8, 8, 4, r0, r1 @ TXD2 -> TXD2
|
|
|
|
sg_set_pinsel 219, 8, 8, 4, r0, r1 @ TXD3 -> TXD3
|
|
|
|
|
|
|
|
ldr r0, =SC_CLKCTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #SC_CLKCTRL_CEN_PERI
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r3, =DIV_ROUND(PROXSTREAM2_UART_CLK, 16 * BAUDRATE)
|
|
|
|
|
|
|
|
b init_uart
|
|
|
|
proxstream2_end:
|
|
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_UNIPHIER_PH1_LD6B)
|
|
|
|
#define PH1_LD6B_UART_CLK 88900000
|
|
|
|
cmp r1, #0x2F
|
|
|
|
bne ph1_ld6b_end
|
|
|
|
|
|
|
|
ldr r0, =SG_IECTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #1
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
sg_set_pinsel 135, 3, 8, 4, r0, r1 @ PORT10 -> TXD0
|
|
|
|
sg_set_pinsel 115, 0, 8, 4, r0, r1 @ TXD1 -> TXD1
|
|
|
|
sg_set_pinsel 113, 2, 8, 4, r0, r1 @ SBO0 -> TXD2
|
|
|
|
|
|
|
|
ldr r0, =SC_CLKCTRL
|
|
|
|
ldr r1, [r0]
|
|
|
|
orr r1, r1, #SC_CLKCTRL_CEN_PERI
|
|
|
|
str r1, [r0]
|
|
|
|
|
|
|
|
ldr r3, =DIV_ROUND(PH1_LD6B_UART_CLK, 16 * BAUDRATE)
|
|
|
|
|
|
|
|
b init_uart
|
|
|
|
ph1_ld6b_end:
|
|
|
|
#endif
|
2016-03-07 11:29:41 +00:00
|
|
|
mov pc, lr
|
2015-09-21 15:27:37 +00:00
|
|
|
|
|
|
|
init_uart:
|
|
|
|
addruart r0, r1, r2
|
|
|
|
mov r1, #UART_LCR_WLEN8 << 8
|
|
|
|
str r1, [r0, #0x10]
|
|
|
|
str r3, [r0, #0x24]
|
|
|
|
|
|
|
|
mov pc, lr
|
|
|
|
ENDPROC(debug_ll_init)
|