Initial commit with upstream sources
[platform/core/security/tef-optee_os.git] / core / arch / arm / plat-ti / console.c
1 /*
2  * Copyright (c) 2016, Linaro Limited
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions are met:
7  *
8  * 1. Redistributions of source code must retain the above copyright notice,
9  * this list of conditions and the following disclaimer.
10  *
11  * 2. Redistributions in binary form must reproduce the above copyright notice,
12  * this list of conditions and the following disclaimer in the documentation
13  * and/or other materials provided with the distribution.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
16  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
19  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
20  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
21  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
22  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
23  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
24  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25  * POSSIBILITY OF SUCH DAMAGE.
26  */
27
28 #include <console.h>
29 #include <drivers/serial8250_uart.h>
30 #include <mm/core_memprot.h>
31 #include <platform_config.h>
32
33 register_phys_mem(MEM_AREA_IO_NSEC,
34                   CONSOLE_UART_BASE,
35                   SERIAL8250_UART_REG_SIZE);
36
37 static vaddr_t console_base(void)
38 {
39         static void *va __early_bss;
40
41         if (cpu_mmu_enabled()) {
42                 if (!va)
43                         va = phys_to_virt(CONSOLE_UART_BASE, MEM_AREA_IO_NSEC);
44                 return (vaddr_t)va;
45         }
46         return CONSOLE_UART_BASE;
47 }
48
49 void console_init(void)
50 {
51         serial8250_uart_init(console_base(), CONSOLE_UART_CLK_IN_HZ,
52                              CONSOLE_BAUDRATE);
53 }
54
55 void console_putc(int ch)
56 {
57         vaddr_t base = console_base();
58
59         if (ch == '\n')
60                 serial8250_uart_putc('\r', base);
61         serial8250_uart_putc(ch, base);
62 }
63
64 void console_flush(void)
65 {
66         serial8250_uart_flush_tx_fifo(console_base());
67 }