blob: 4ed0cebc7b1379b7ab1b5cfdff5f77a990751a62 [file] [log] [blame]
Soby Mathewc389d772014-06-24 12:28:41 +01001/*
Dan Handleyc863fa42015-04-01 16:51:20 +01002 * Copyright (c) 2013-2015, ARM Limited and Contributors. All rights reserved.
Soby Mathewc389d772014-06-24 12:28:41 +01003 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 *
7 * Redistributions of source code must retain the above copyright notice, this
8 * list of conditions and the following disclaimer.
9 *
10 * Redistributions in binary form must reproduce the above copyright notice,
11 * this list of conditions and the following disclaimer in the documentation
12 * and/or other materials provided with the distribution.
13 *
14 * Neither the name of ARM nor the names of its contributors may be used
15 * to endorse or promote products derived from this software without specific
16 * prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 * POSSIBILITY OF SUCH DAMAGE.
29 */
30#include <arch.h>
31#include <asm_macros.S>
32#include <pl011.h>
33
Dan Handleyc863fa42015-04-01 16:51:20 +010034/*
35 * Pull in generic functions to provide backwards compatibility for
36 * platform makefiles
37 */
38#include "../../console/console.S"
39
40
Soby Mathewc389d772014-06-24 12:28:41 +010041 .globl console_core_init
42 .globl console_core_putc
Dan Handleyc863fa42015-04-01 16:51:20 +010043 .globl console_core_getc
Soby Mathewc389d772014-06-24 12:28:41 +010044
Soby Mathewc389d772014-06-24 12:28:41 +010045
Soby Mathew69817f72014-07-14 15:43:21 +010046 /* -----------------------------------------------
47 * int console_core_init(unsigned long base_addr,
48 * unsigned int uart_clk, unsigned int baud_rate)
Soby Mathewc389d772014-06-24 12:28:41 +010049 * Function to initialize the console without a
50 * C Runtime to print debug information. This
51 * function will be accessed by console_init and
52 * crash reporting.
53 * In: x0 - console base address
Soby Mathew69817f72014-07-14 15:43:21 +010054 * w1 - Uart clock in Hz
55 * w2 - Baud rate
Dan Handleyc863fa42015-04-01 16:51:20 +010056 * Out: return 1 on success else 0 on error
Soby Mathewc389d772014-06-24 12:28:41 +010057 * Clobber list : x1, x2
Soby Mathew69817f72014-07-14 15:43:21 +010058 * -----------------------------------------------
Soby Mathewc389d772014-06-24 12:28:41 +010059 */
60func console_core_init
61 /* Check the input base address */
Dan Handleyc863fa42015-04-01 16:51:20 +010062 cbz x0, core_init_fail
Soby Mathew69817f72014-07-14 15:43:21 +010063 /* Check baud rate and uart clock for sanity */
Dan Handleyc863fa42015-04-01 16:51:20 +010064 cbz w1, core_init_fail
65 cbz w2, core_init_fail
Soby Mathewc389d772014-06-24 12:28:41 +010066 /* Program the baudrate */
Soby Mathew69817f72014-07-14 15:43:21 +010067 /* Divisor = (Uart clock * 4) / baudrate */
68 lsl w1, w1, #2
69 udiv w2, w1, w2
70 /* IBRD = Divisor >> 6 */
71 lsr w1, w2, #6
Soby Mathewc389d772014-06-24 12:28:41 +010072 /* Write the IBRD */
Soby Mathewc389d772014-06-24 12:28:41 +010073 str w1, [x0, #UARTIBRD]
Soby Mathew69817f72014-07-14 15:43:21 +010074 /* FBRD = Divisor & 0x3F */
75 and w1, w2, #0x3f
Soby Mathewc389d772014-06-24 12:28:41 +010076 /* Write the FBRD */
Soby Mathewc389d772014-06-24 12:28:41 +010077 str w1, [x0, #UARTFBRD]
Soby Mathewc389d772014-06-24 12:28:41 +010078 mov w1, #PL011_LINE_CONTROL
79 str w1, [x0, #UARTLCR_H]
80 /* Clear any pending errors */
81 str wzr, [x0, #UARTECR]
82 /* Enable tx, rx, and uart overall */
83 mov w1, #(PL011_UARTCR_RXE | PL011_UARTCR_TXE | PL011_UARTCR_UARTEN)
84 str w1, [x0, #UARTCR]
85 mov w0, #1
Dan Handleyc863fa42015-04-01 16:51:20 +010086 ret
87core_init_fail:
88 mov w0, wzr
Soby Mathewc389d772014-06-24 12:28:41 +010089 ret
Kévin Petita877c252015-03-24 14:03:57 +000090endfunc console_core_init
Soby Mathewc389d772014-06-24 12:28:41 +010091
Soby Mathewc389d772014-06-24 12:28:41 +010092 /* --------------------------------------------------------
Dan Handleyc863fa42015-04-01 16:51:20 +010093 * int console_core_putc(int c, unsigned long base_addr)
Soby Mathewc389d772014-06-24 12:28:41 +010094 * Function to output a character over the console. It
95 * returns the character printed on success or -1 on error.
Soby Mathew69817f72014-07-14 15:43:21 +010096 * In : w0 - character to be printed
Soby Mathewc389d772014-06-24 12:28:41 +010097 * x1 - console base address
98 * Out : return -1 on error else return character.
99 * Clobber list : x2
100 * --------------------------------------------------------
101 */
102func console_core_putc
103 /* Check the input parameter */
104 cbz x1, putc_error
105 /* Prepend '\r' to '\n' */
Soby Mathew69817f72014-07-14 15:43:21 +0100106 cmp w0, #0xA
Soby Mathewc389d772014-06-24 12:28:41 +0100107 b.ne 2f
1081:
109 /* Check if the transmit FIFO is full */
110 ldr w2, [x1, #UARTFR]
111 tbnz w2, #PL011_UARTFR_TXFF_BIT, 1b
112 mov w2, #0xD
113 str w2, [x1, #UARTDR]
1142:
115 /* Check if the transmit FIFO is full */
116 ldr w2, [x1, #UARTFR]
117 tbnz w2, #PL011_UARTFR_TXFF_BIT, 2b
118 str w0, [x1, #UARTDR]
119 ret
120putc_error:
121 mov w0, #-1
122 ret
Kévin Petita877c252015-03-24 14:03:57 +0000123endfunc console_core_putc
Soby Mathewc389d772014-06-24 12:28:41 +0100124
125 /* ---------------------------------------------
Dan Handleyc863fa42015-04-01 16:51:20 +0100126 * int console_core_getc(unsigned long base_addr)
Soby Mathewc389d772014-06-24 12:28:41 +0100127 * Function to get a character from the console.
128 * It returns the character grabbed on success
129 * or -1 on error.
Dan Handleyc863fa42015-04-01 16:51:20 +0100130 * In : x0 - console base address
Soby Mathewc389d772014-06-24 12:28:41 +0100131 * Clobber list : x0, x1
132 * ---------------------------------------------
133 */
Dan Handleyc863fa42015-04-01 16:51:20 +0100134func console_core_getc
135 cbz x0, getc_error
Soby Mathewc389d772014-06-24 12:28:41 +01001361:
137 /* Check if the receive FIFO is empty */
Dan Handleyc863fa42015-04-01 16:51:20 +0100138 ldr w1, [x0, #UARTFR]
139 tbnz w1, #PL011_UARTFR_RXFE_BIT, 1b
140 ldr w1, [x0, #UARTDR]
141 mov w0, w1
Soby Mathewc389d772014-06-24 12:28:41 +0100142 ret
143getc_error:
144 mov w0, #-1
145 ret
Dan Handleyc863fa42015-04-01 16:51:20 +0100146endfunc console_core_getc