drivers/renesas/rcar/scif/scif.S - filogic/atf - Gitiles

 /*
  * Copyright (c) 2015-2019, Renesas Electronics Corporation. All rights reserved.
  *
  * SPDX-License-Identifier: BSD-3-Clause
  */

 #include <arch.h>
 #include <asm_macros.S>
 #include <console_macros.S>
 #include <drivers/renesas/rcar/console/console.h>

 #define	SCIF_INTERNAL_CLK	0
 #define	SCIF_EXTARNAL_CLK	1
 #define	SCIF_CLK		SCIF_INTERNAL_CLK

 /* product register */
 #define	PRR			(0xFFF00044)
 #define	PRR_PRODUCT_MASK	(0x00007F00)
 #define	PRR_CUT_MASK		(0x000000FF)
 #define	PRR_PRODUCT_H3_VER_10	(0x00004F00)
 #define	PRR_PRODUCT_E3		(0x00005700)
 #define	PRR_PRODUCT_D3		(0x00005800)

 /* module stop */
 #define	CPG_BASE		(0xE6150000)
 #define	CPG_SMSTPCR2		(0x0138)
 #define	CPG_SMSTPCR3		(0x013C)
 #define CPG_MSTPSR2		(0x0040)
 #define	CPG_MSTPSR3		(0x0048)
 #define	MSTP207			(1 << 7)
 #define	MSTP310			(1 << 10)
 #define	CPG_CPGWPR		(0x0900)

 /* scif */
 #define	SCIF0_BASE		(0xE6E60000)
 #define	SCIF2_BASE		(0xE6E88000)
 #define	SCIF_SCSMR		(0x00)
 #define	SCIF_SCBRR		(0x04)
 #define	SCIF_SCSCR		(0x08)
 #define	SCIF_SCFTDR		(0x0C)
 #define	SCIF_SCFSR		(0x10)
 #define	SCIF_SCFRDR		(0x14)
 #define	SCIF_SCFCR		(0x18)
 #define	SCIF_SCFDR		(0x1C)
 #define	SCIF_SCSPTR		(0x20)
 #define	SCIF_SCLSR		(0x24)
 #define	SCIF_DL			(0x30)
 #define	SCIF_CKS		(0x34)

 #if RCAR_LSI == RCAR_V3M
 #define SCIF_BASE		SCIF0_BASE
 #define CPG_SMSTPCR		CPG_SMSTPCR2
 #define CPG_MSTPSR		CPG_MSTPSR2
 #define MSTP			MSTP207
 #else
 #define SCIF_BASE		SCIF2_BASE
 #define CPG_SMSTPCR		CPG_SMSTPCR3
 #define CPG_MSTPSR		CPG_MSTPSR3
 #define MSTP			MSTP310
 #endif

 /* mode pin */
 #define	RST_MODEMR		(0xE6160060)
 #define	MODEMR_MD12		(0x00001000)

 #define	SCSMR_CA_MASK		(1 << 7)
 #define	SCSMR_CA_ASYNC		(0x0000)
 #define	SCSMR_CHR_MASK		(1 << 6)
 #define	SCSMR_CHR_8		(0x0000)
 #define	SCSMR_PE_MASK		(1 << 5)
 #define	SCSMR_PE_DIS		(0x0000)
 #define	SCSMR_STOP_MASK		(1 << 3)
 #define	SCSMR_STOP_1		(0x0000)
 #define	SCSMR_CKS_MASK		(3 << 0)
 #define	SCSMR_CKS_DIV1		(0x0000)
 #define	SCSMR_INIT_DATA		(SCSMR_CA_ASYNC +	\
 					 SCSMR_CHR_8 +		\
 					 SCSMR_PE_DIS +		\
 					 SCSMR_STOP_1 +		\
 					 SCSMR_CKS_DIV1)
 #define	SCBRR_115200BPS		(17)
 #define	SCBRR_115200BPSON	(16)
 #define	SCBRR_115200BPS_E3_SSCG	(15)
 #define	SCBRR_230400BPS		(8)

 #define	SCSCR_TE_MASK		(1 << 5)
 #define	SCSCR_TE_DIS		(0x0000)
 #define	SCSCR_TE_EN		(0x0020)
 #define	SCSCR_RE_MASK		(1 << 4)
 #define	SCSCR_RE_DIS		(0x0000)
 #define	SCSCR_RE_EN		(0x0010)
 #define	SCSCR_CKE_MASK		(3 << 0)
 #define	SCSCR_CKE_INT		(0x0000)
 #define 	SCSCR_CKE_BRG		(0x0002)
 #if SCIF_CLK == SCIF_EXTARNAL_CLK
 #define	SCSCR_CKE_INT_CLK	(SCSCR_CKE_BRG)
 #else
 #define	SCFSR_TEND_MASK		(1 << 6)
 #define	SCFSR_TEND_TRANS_END	(0x0040)
 #define	SCSCR_CKE_INT_CLK	(SCSCR_CKE_INT)
 #endif
 #define	SCFSR_INIT_DATA		(0x0000)
 #define	SCFCR_TTRG_MASK		(3 << 4)
 #define	SCFCR_TTRG_8		(0x0000)
 #define	SCFCR_TTRG_0		(0x0030)
 #define	SCFCR_TFRST_MASK	(1 << 2)
 #define	SCFCR_TFRST_DIS		(0x0000)
 #define	SCFCR_TFRST_EN		(0x0004)
 #define	SCFCR_RFRS_MASK		(1 << 1)
 #define	SCFCR_RFRS_DIS		(0x0000)
 #define	SCFCR_RFRS_EN		(0x0002)
 #define	SCFCR_INIT_DATA		(SCFCR_TTRG_8)
 #define	SCFDR_T_MASK		(0x1f << 8)
 #define	DL_INIT_DATA		(8)
 #define	CKS_CKS_DIV_MASK	(1 << 15)
 #define	CKS_CKS_DIV_CLK		(0x0000)
 #define	CKS_XIN_MASK		(1 << 14)
 #define	CKS_XIN_SCIF_CLK	(0x0000)
 #define	CKS_INIT_DATA		(CKS_CKS_DIV_CLK + CKS_XIN_SCIF_CLK)

 	.globl	console_rcar_register
 	.globl	console_rcar_init
 	.globl	console_rcar_putc
 	.globl	console_rcar_flush

 	/* -----------------------------------------------
 	 * int console_rcar_register(
 	 *      uintptr_t base, uint32_t clk, uint32_t baud,
 	 *      console_t *console)
 	 * Function to initialize and register a new rcar
 	 * console. Storage passed in for the console struct
 	 * *must* be persistent (i.e. not from the stack).
 	 * In: x0 - UART register base address
 	 *     w1 - UART clock in Hz
 	 *     w2 - Baud rate
 	 *     x3 - pointer to empty console_t struct
 	 * Out: return 1 on success, 0 on error
 	 * Clobber list : x0, x1, x2, x6, x7, x14
 	 * -----------------------------------------------
 	 */
 func console_rcar_register
 	mov	x7, x30
 	mov	x6, x3
 	cbz	x6, register_fail
 	str	x0, [x6, #CONSOLE_T_BASE]

 	bl	console_rcar_init

 	mov	x0, x6
 	mov	x30, x7
 	finish_console_register rcar, putc=1, getc=0, flush=1

 register_fail:
 	ret	x7
 endfunc console_rcar_register

 	/* -----------------------------------------------
 	 * int console_rcar_init(unsigned long base_addr,
 	 * unsigned int uart_clk, unsigned int baud_rate)
 	 * Function to initialize the console without a
 	 * C Runtime to print debug information. This
 	 * function will be accessed by console_rcar_register
 	 * and crash reporting.
 	 * In: x0 - console base address
 	 *     w1 - Uart clock in Hz
 	 *     w2 - Baud rate
 	 * Out: return 1 on success
 	 * Clobber list : x1, x2
 	 * -----------------------------------------------
 	 */
 func console_rcar_init
 	ldr	x0, =CPG_BASE
 	ldr	w1, [x0, #CPG_SMSTPCR]
 	and	w1, w1, #~MSTP
 	mvn	w2, w1
 	str	w2, [x0, #CPG_CPGWPR]
 	str	w1, [x0, #CPG_SMSTPCR]
 5:
 	ldr w1, [x0, #CPG_MSTPSR]
 	and w1, w1, #MSTP
 	cbnz w1, 5b

 	ldr	x0, =SCIF_BASE
 	/* Clear bits TE and RE in SCSCR to 0 */
 	mov	w1, #(SCSCR_TE_DIS + SCSCR_RE_DIS)
 	strh	w1, [x0, #SCIF_SCSCR]
 	/* Set bits TFRST and RFRST in SCFCR to 1 */
 	ldrh	w1, [x0, #SCIF_SCFCR]
 	orr	w1, w1, #(SCFCR_TFRST_EN + SCFCR_RFRS_EN)
 	strh	w1, [x0, #SCIF_SCFCR]
 	/* Read flags of ER, DR, BRK, and RDF in SCFSR and those of TO and ORER
 	   in SCLSR, then clear them to 0 */
 	mov	w1, #SCFSR_INIT_DATA
 	strh	w1, [x0, #SCIF_SCFSR]
 	mov	w1, #0
 	strh	w1, [x0, #SCIF_SCLSR]
 	/* Set bits CKE[1:0] in SCSCR */
 	ldrh	w1, [x0, #SCIF_SCSCR]
 	and	w1, w1, #~SCSCR_CKE_MASK
 	mov	w2, #SCSCR_CKE_INT_CLK
 	orr	w1, w1, w2
 	strh	w1, [x0, #SCIF_SCSCR]
 	/* Set data transfer format in SCSMR */
 	mov	w1, #SCSMR_INIT_DATA
 	strh	w1, [x0, #SCIF_SCSMR]
 	/* Set value in SCBRR */
 #if SCIF_CLK == SCIF_INTERNAL_CLK
 	ldr	x1, =PRR
 	ldr	w1, [x1]
 	and	w1, w1, #(PRR_PRODUCT_MASK | PRR_CUT_MASK)
 	mov	w2, #PRR_PRODUCT_H3_VER_10
 	cmp	w1, w2
 	beq	3f
 	and	w1, w1, #PRR_PRODUCT_MASK
 	mov	w2, #PRR_PRODUCT_D3
 	cmp	w1, w2
 	beq	4f
 	and	w1, w1, #PRR_PRODUCT_MASK
 	mov	w2, #PRR_PRODUCT_E3
 	cmp	w1, w2
 	bne	5f

 	ldr	x1, =RST_MODEMR
 	ldr	w1, [x1]
 	and	w1, w1, #MODEMR_MD12
 	mov	w2, #MODEMR_MD12
 	cmp	w1, w2
 	bne	5f

 	mov	w1, #SCBRR_115200BPS_E3_SSCG
 	b	2f
 5:
 	mov	w1, #SCBRR_115200BPS
 	b	2f
 4:
 	mov	w1, #SCBRR_115200BPSON
 	b	2f
 3:
 	mov	w1, #SCBRR_230400BPS
 2:
 	strb	w1, [x0, SCIF_SCBRR]
 #else
 	mov	w1, #DL_INIT_DATA
 	strh	w1, [x0, #SCIF_DL]
 	mov	w1, #CKS_INIT_DATA
 	strh	w1, [x0, #SCIF_CKS]
 #endif
 	/* 1-bit interval elapsed */
 	mov	w1, #100
 1:
 	subs	w1, w1, #1
 	cbnz	w1, 1b
 	/*
 	 * Set bits RTRG[1:0], TTRG[1:0], and MCE in SCFCR
 	 * Clear bits FRST and RFRST to 0
 	 */
 	mov	w1, #SCFCR_INIT_DATA
 	strh	w1, [x0, #SCIF_SCFCR]
 	/* Set bits TE and RE in SCSCR to 1 */
 	ldrh	w1, [x0, #SCIF_SCSCR]
 	orr	w1, w1, #(SCSCR_TE_EN + SCSCR_RE_EN)
 	strh	w1, [x0, #SCIF_SCSCR]
 	mov	x0, #1

 	ret
 endfunc console_rcar_init

 	/* --------------------------------------------------------
 	 * int console_rcar_putc(int c, unsigned int base_addr)
 	 * Function to output a character over the console. It
 	 * returns the character printed on success or -1 on error.
 	 * In : w0 - character to be printed
 	 *      x1 - pointer to console_t structure
 	 * Out : return -1 on error else return character.
 	 * Clobber list : x2
 	 * --------------------------------------------------------
 	 */
 func console_rcar_putc
 	ldr	x1, =SCIF_BASE
 	cmp	w0, #0xA
 	/* Prepend '\r' to '\n' */
 	bne	2f
 1:
 	/* Check if the transmit FIFO is full */
 	ldrh	w2, [x1, #SCIF_SCFDR]
 	ubfx	w2, w2, #8, #5
 	cmp	w2, #16
 	bcs	1b
 	mov	w2, #0x0D
 	strb	w2, [x1, #SCIF_SCFTDR]
 2:
 	/* Check if the transmit FIFO is full */
 	ldrh	w2, [x1, #SCIF_SCFDR]
 	ubfx	w2, w2, #8, #5
 	cmp	w2, #16
 	bcs	2b
 	strb	w0, [x1, #SCIF_SCFTDR]

 	/* Clear TEND flag */
 	ldrh	w2, [x1, #SCIF_SCFSR]
 	and	w2, w2, #~SCFSR_TEND_MASK
 	strh	w2, [x1, #SCIF_SCFSR]

 	ret
 endfunc console_rcar_putc

 	/* ---------------------------------------------
 	 * void console_rcar_flush(void)
 	 * Function to force a write of all buffered
 	 * data that hasn't been output. It returns void
 	 * Clobber list : x0, x1
 	 * ---------------------------------------------
 	 */
 func console_rcar_flush
 	ldr	x0, =SCIF_BASE
 1:
 	/* Check TEND flag */
 	ldrh	w1, [x0, #SCIF_SCFSR]
 	and	w1, w1, #SCFSR_TEND_MASK
 	cmp	w1, #SCFSR_TEND_TRANS_END
 	bne	1b

 	ldr	x0, =SCIF_BASE
 	ldrh	w1, [x0, #SCIF_SCSCR]
 	and	w1, w1, #~(SCSCR_TE_EN + SCSCR_RE_EN)
 	strh	w1, [x0, #SCIF_SCSCR]

 	ret
 endfunc console_rcar_flush
	/*
	* Copyright (c) 2015-2019, Renesas Electronics Corporation. All rights reserved.
	*
	* SPDX-License-Identifier: BSD-3-Clause
	*/

	#include <arch.h>
	#include <asm_macros.S>
	#include <console_macros.S>
	#include <drivers/renesas/rcar/console/console.h>

	#define SCIF_INTERNAL_CLK 0
	#define SCIF_EXTARNAL_CLK 1
	#define SCIF_CLK SCIF_INTERNAL_CLK

	/* product register */
	#define PRR (0xFFF00044)
	#define PRR_PRODUCT_MASK (0x00007F00)
	#define PRR_CUT_MASK (0x000000FF)
	#define PRR_PRODUCT_H3_VER_10 (0x00004F00)
	#define PRR_PRODUCT_E3 (0x00005700)
	#define PRR_PRODUCT_D3 (0x00005800)

	/* module stop */
	#define CPG_BASE (0xE6150000)
	#define CPG_SMSTPCR2 (0x0138)
	#define CPG_SMSTPCR3 (0x013C)
	#define CPG_MSTPSR2 (0x0040)
	#define CPG_MSTPSR3 (0x0048)
	#define MSTP207 (1 << 7)
	#define MSTP310 (1 << 10)
	#define CPG_CPGWPR (0x0900)

	/* scif */
	#define SCIF0_BASE (0xE6E60000)
	#define SCIF2_BASE (0xE6E88000)
	#define SCIF_SCSMR (0x00)
	#define SCIF_SCBRR (0x04)
	#define SCIF_SCSCR (0x08)
	#define SCIF_SCFTDR (0x0C)
	#define SCIF_SCFSR (0x10)
	#define SCIF_SCFRDR (0x14)
	#define SCIF_SCFCR (0x18)
	#define SCIF_SCFDR (0x1C)
	#define SCIF_SCSPTR (0x20)
	#define SCIF_SCLSR (0x24)
	#define SCIF_DL (0x30)
	#define SCIF_CKS (0x34)

	#if RCAR_LSI == RCAR_V3M
	#define SCIF_BASE SCIF0_BASE
	#define CPG_SMSTPCR CPG_SMSTPCR2
	#define CPG_MSTPSR CPG_MSTPSR2
	#define MSTP MSTP207
	#else
	#define SCIF_BASE SCIF2_BASE
	#define CPG_SMSTPCR CPG_SMSTPCR3
	#define CPG_MSTPSR CPG_MSTPSR3
	#define MSTP MSTP310
	#endif

	/* mode pin */
	#define RST_MODEMR (0xE6160060)
	#define MODEMR_MD12 (0x00001000)

	#define SCSMR_CA_MASK (1 << 7)
	#define SCSMR_CA_ASYNC (0x0000)
	#define SCSMR_CHR_MASK (1 << 6)
	#define SCSMR_CHR_8 (0x0000)
	#define SCSMR_PE_MASK (1 << 5)
	#define SCSMR_PE_DIS (0x0000)
	#define SCSMR_STOP_MASK (1 << 3)
	#define SCSMR_STOP_1 (0x0000)
	#define SCSMR_CKS_MASK (3 << 0)
	#define SCSMR_CKS_DIV1 (0x0000)
	#define SCSMR_INIT_DATA (SCSMR_CA_ASYNC + \
	SCSMR_CHR_8 + \
	SCSMR_PE_DIS + \
	SCSMR_STOP_1 + \
	SCSMR_CKS_DIV1)
	#define SCBRR_115200BPS (17)
	#define SCBRR_115200BPSON (16)
	#define SCBRR_115200BPS_E3_SSCG (15)
	#define SCBRR_230400BPS (8)

	#define SCSCR_TE_MASK (1 << 5)
	#define SCSCR_TE_DIS (0x0000)
	#define SCSCR_TE_EN (0x0020)
	#define SCSCR_RE_MASK (1 << 4)
	#define SCSCR_RE_DIS (0x0000)
	#define SCSCR_RE_EN (0x0010)
	#define SCSCR_CKE_MASK (3 << 0)
	#define SCSCR_CKE_INT (0x0000)
	#define SCSCR_CKE_BRG (0x0002)
	#if SCIF_CLK == SCIF_EXTARNAL_CLK
	#define SCSCR_CKE_INT_CLK (SCSCR_CKE_BRG)
	#else
	#define SCFSR_TEND_MASK (1 << 6)
	#define SCFSR_TEND_TRANS_END (0x0040)
	#define SCSCR_CKE_INT_CLK (SCSCR_CKE_INT)
	#endif
	#define SCFSR_INIT_DATA (0x0000)
	#define SCFCR_TTRG_MASK (3 << 4)
	#define SCFCR_TTRG_8 (0x0000)
	#define SCFCR_TTRG_0 (0x0030)
	#define SCFCR_TFRST_MASK (1 << 2)
	#define SCFCR_TFRST_DIS (0x0000)
	#define SCFCR_TFRST_EN (0x0004)
	#define SCFCR_RFRS_MASK (1 << 1)
	#define SCFCR_RFRS_DIS (0x0000)
	#define SCFCR_RFRS_EN (0x0002)
	#define SCFCR_INIT_DATA (SCFCR_TTRG_8)
	#define SCFDR_T_MASK (0x1f << 8)
	#define DL_INIT_DATA (8)
	#define CKS_CKS_DIV_MASK (1 << 15)
	#define CKS_CKS_DIV_CLK (0x0000)
	#define CKS_XIN_MASK (1 << 14)
	#define CKS_XIN_SCIF_CLK (0x0000)
	#define CKS_INIT_DATA (CKS_CKS_DIV_CLK + CKS_XIN_SCIF_CLK)

	.globl console_rcar_register
	.globl console_rcar_init
	.globl console_rcar_putc
	.globl console_rcar_flush

	/* -----------------------------------------------
	* int console_rcar_register(
	* uintptr_t base, uint32_t clk, uint32_t baud,
	* console_t *console)
	* Function to initialize and register a new rcar
	* console. Storage passed in for the console struct
	* must be persistent (i.e. not from the stack).
	* In: x0 - UART register base address
	* w1 - UART clock in Hz
	* w2 - Baud rate
	* x3 - pointer to empty console_t struct
	* Out: return 1 on success, 0 on error
	* Clobber list : x0, x1, x2, x6, x7, x14
	* -----------------------------------------------
	*/
	func console_rcar_register
	mov x7, x30
	mov x6, x3
	cbz x6, register_fail
	str x0, [x6, #CONSOLE_T_BASE]

	bl console_rcar_init

	mov x0, x6
	mov x30, x7
	finish_console_register rcar, putc=1, getc=0, flush=1

	register_fail:
	ret x7
	endfunc console_rcar_register

	/* -----------------------------------------------
	* int console_rcar_init(unsigned long base_addr,
	* unsigned int uart_clk, unsigned int baud_rate)
	* Function to initialize the console without a
	* C Runtime to print debug information. This
	* function will be accessed by console_rcar_register
	* and crash reporting.
	* In: x0 - console base address
	* w1 - Uart clock in Hz
	* w2 - Baud rate
	* Out: return 1 on success
	* Clobber list : x1, x2
	* -----------------------------------------------
	*/
	func console_rcar_init
	ldr x0, =CPG_BASE
	ldr w1, [x0, #CPG_SMSTPCR]
	and w1, w1, #~MSTP
	mvn w2, w1
	str w2, [x0, #CPG_CPGWPR]
	str w1, [x0, #CPG_SMSTPCR]
	5:
	ldr w1, [x0, #CPG_MSTPSR]
	and w1, w1, #MSTP
	cbnz w1, 5b

	ldr x0, =SCIF_BASE
	/* Clear bits TE and RE in SCSCR to 0 */
	mov w1, #(SCSCR_TE_DIS + SCSCR_RE_DIS)
	strh w1, [x0, #SCIF_SCSCR]
	/* Set bits TFRST and RFRST in SCFCR to 1 */
	ldrh w1, [x0, #SCIF_SCFCR]
	orr w1, w1, #(SCFCR_TFRST_EN + SCFCR_RFRS_EN)
	strh w1, [x0, #SCIF_SCFCR]
	/* Read flags of ER, DR, BRK, and RDF in SCFSR and those of TO and ORER
	in SCLSR, then clear them to 0 */
	mov w1, #SCFSR_INIT_DATA
	strh w1, [x0, #SCIF_SCFSR]
	mov w1, #0
	strh w1, [x0, #SCIF_SCLSR]
	/* Set bits CKE[1:0] in SCSCR */
	ldrh w1, [x0, #SCIF_SCSCR]
	and w1, w1, #~SCSCR_CKE_MASK
	mov w2, #SCSCR_CKE_INT_CLK
	orr w1, w1, w2
	strh w1, [x0, #SCIF_SCSCR]
	/* Set data transfer format in SCSMR */
	mov w1, #SCSMR_INIT_DATA
	strh w1, [x0, #SCIF_SCSMR]
	/* Set value in SCBRR */
	#if SCIF_CLK == SCIF_INTERNAL_CLK
	ldr x1, =PRR
	ldr w1, [x1]
	and w1, w1, #(PRR_PRODUCT_MASK \| PRR_CUT_MASK)
	mov w2, #PRR_PRODUCT_H3_VER_10
	cmp w1, w2
	beq 3f
	and w1, w1, #PRR_PRODUCT_MASK
	mov w2, #PRR_PRODUCT_D3
	cmp w1, w2
	beq 4f
	and w1, w1, #PRR_PRODUCT_MASK
	mov w2, #PRR_PRODUCT_E3
	cmp w1, w2
	bne 5f

	ldr x1, =RST_MODEMR
	ldr w1, [x1]
	and w1, w1, #MODEMR_MD12
	mov w2, #MODEMR_MD12
	cmp w1, w2
	bne 5f

	mov w1, #SCBRR_115200BPS_E3_SSCG
	b 2f
	5:
	mov w1, #SCBRR_115200BPS
	b 2f
	4:
	mov w1, #SCBRR_115200BPSON
	b 2f
	3:
	mov w1, #SCBRR_230400BPS
	2:
	strb w1, [x0, SCIF_SCBRR]
	#else
	mov w1, #DL_INIT_DATA
	strh w1, [x0, #SCIF_DL]
	mov w1, #CKS_INIT_DATA
	strh w1, [x0, #SCIF_CKS]
	#endif
	/* 1-bit interval elapsed */
	mov w1, #100
	1:
	subs w1, w1, #1
	cbnz w1, 1b
	/*
	* Set bits RTRG[1:0], TTRG[1:0], and MCE in SCFCR
	* Clear bits FRST and RFRST to 0
	*/
	mov w1, #SCFCR_INIT_DATA
	strh w1, [x0, #SCIF_SCFCR]
	/* Set bits TE and RE in SCSCR to 1 */
	ldrh w1, [x0, #SCIF_SCSCR]
	orr w1, w1, #(SCSCR_TE_EN + SCSCR_RE_EN)
	strh w1, [x0, #SCIF_SCSCR]
	mov x0, #1

	ret
	endfunc console_rcar_init

	/* --------------------------------------------------------
	* int console_rcar_putc(int c, unsigned int base_addr)
	* Function to output a character over the console. It
	* returns the character printed on success or -1 on error.
	* In : w0 - character to be printed
	* x1 - pointer to console_t structure
	* Out : return -1 on error else return character.
	* Clobber list : x2
	* --------------------------------------------------------
	*/
	func console_rcar_putc
	ldr x1, =SCIF_BASE
	cmp w0, #0xA
	/* Prepend '\r' to '\n' */
	bne 2f
	1:
	/* Check if the transmit FIFO is full */
	ldrh w2, [x1, #SCIF_SCFDR]
	ubfx w2, w2, #8, #5
	cmp w2, #16
	bcs 1b
	mov w2, #0x0D
	strb w2, [x1, #SCIF_SCFTDR]
	2:
	/* Check if the transmit FIFO is full */
	ldrh w2, [x1, #SCIF_SCFDR]
	ubfx w2, w2, #8, #5
	cmp w2, #16
	bcs 2b
	strb w0, [x1, #SCIF_SCFTDR]

	/* Clear TEND flag */
	ldrh w2, [x1, #SCIF_SCFSR]
	and w2, w2, #~SCFSR_TEND_MASK
	strh w2, [x1, #SCIF_SCFSR]

	ret
	endfunc console_rcar_putc

	/* ---------------------------------------------
	* void console_rcar_flush(void)
	* Function to force a write of all buffered
	* data that hasn't been output. It returns void
	* Clobber list : x0, x1
	* ---------------------------------------------
	*/
	func console_rcar_flush
	ldr x0, =SCIF_BASE
	1:
	/* Check TEND flag */
	ldrh w1, [x0, #SCIF_SCFSR]
	and w1, w1, #SCFSR_TEND_MASK
	cmp w1, #SCFSR_TEND_TRANS_END
	bne 1b

	ldr x0, =SCIF_BASE
	ldrh w1, [x0, #SCIF_SCSCR]
	and w1, w1, #~(SCSCR_TE_EN + SCSCR_RE_EN)
	strh w1, [x0, #SCIF_SCSCR]

	ret
	endfunc console_rcar_flush