1e2469d82SVarun Wadekar/* 2e2469d82SVarun Wadekar * Copyright (c) 2017-2019, ARM Limited and Contributors. All rights reserved. 3e2469d82SVarun Wadekar * Copyright (c) 2020, NVIDIA Corporation. All rights reserved. 4e2469d82SVarun Wadekar * 5e2469d82SVarun Wadekar * SPDX-License-Identifier: BSD-3-Clause 6e2469d82SVarun Wadekar */ 7e2469d82SVarun Wadekar#include <asm_macros.S> 8e2469d82SVarun Wadekar#include <console_macros.S> 9e2469d82SVarun Wadekar 10e2469d82SVarun Wadekar#define CONSOLE_NUM_BYTES_SHIFT 24 11e2469d82SVarun Wadekar#define CONSOLE_FLUSH_DATA_TO_PORT (1 << 26) 12e2469d82SVarun Wadekar#define CONSOLE_RING_DOORBELL (1 << 31) 13e2469d82SVarun Wadekar#define CONSOLE_IS_BUSY (1 << 31) 14*64b2a237SVarun Wadekar#define CONSOLE_TIMEOUT 0xC000 /* 50 ms */ 15e2469d82SVarun Wadekar 16e2469d82SVarun Wadekar /* 17e2469d82SVarun Wadekar * This file contains a driver implementation to make use of the 18e2469d82SVarun Wadekar * real console implementation provided by the SPE firmware running 19e2469d82SVarun Wadekar * SoCs after Tegra186. 20e2469d82SVarun Wadekar * 21e2469d82SVarun Wadekar * This console is shared by multiple components and the SPE firmware 22e2469d82SVarun Wadekar * finally displays everything on the UART port. 23e2469d82SVarun Wadekar */ 24e2469d82SVarun Wadekar 25e2469d82SVarun Wadekar .globl console_spe_core_init 26e2469d82SVarun Wadekar .globl console_spe_core_putc 27e2469d82SVarun Wadekar .globl console_spe_core_getc 28e2469d82SVarun Wadekar .globl console_spe_core_flush 29e2469d82SVarun Wadekar .globl console_spe_putc 30e2469d82SVarun Wadekar .globl console_spe_getc 31e2469d82SVarun Wadekar .globl console_spe_flush 32e2469d82SVarun Wadekar .globl console_spe_register 33e2469d82SVarun Wadekar 34e2469d82SVarun Wadekar.macro check_if_console_is_ready base, tmp1, tmp2, label 35e2469d82SVarun Wadekar /* wait until spe is ready or timeout expires */ 36e2469d82SVarun Wadekar mrs \tmp2, cntps_tval_el1 37e2469d82SVarun Wadekar1: ldr \tmp1, [\base] 38e2469d82SVarun Wadekar and \tmp1, \tmp1, #CONSOLE_IS_BUSY 39e2469d82SVarun Wadekar cbz \tmp1, 2f 40e2469d82SVarun Wadekar mrs \tmp1, cntps_tval_el1 41e2469d82SVarun Wadekar sub \tmp1, \tmp2, \tmp1 42e2469d82SVarun Wadekar cmp \tmp1, #CONSOLE_TIMEOUT 43e2469d82SVarun Wadekar b.lt 1b 44e2469d82SVarun Wadekar b \label 45e2469d82SVarun Wadekar2: 46e2469d82SVarun Wadekar.endm 47e2469d82SVarun Wadekar 48e2469d82SVarun Wadekar /* ------------------------------------------------- 49e2469d82SVarun Wadekar * int console_spe_register(uintptr_t baseaddr, 50e2469d82SVarun Wadekar * uint32_t clock, uint32_t baud, 51e2469d82SVarun Wadekar * console_t *console); 52e2469d82SVarun Wadekar * Function to initialize and register a new spe 53e2469d82SVarun Wadekar * console. Storage passed in for the console struct 54e2469d82SVarun Wadekar * *must* be persistent (i.e. not from the stack). 55e2469d82SVarun Wadekar * In: x0 - UART register base address 56e2469d82SVarun Wadekar * w1 - UART clock in Hz 57e2469d82SVarun Wadekar * w2 - Baud rate 58e2469d82SVarun Wadekar * x3 - pointer to empty console_t struct 59e2469d82SVarun Wadekar * Out: return 1 on success, 0 on error 60e2469d82SVarun Wadekar * Clobber list : x0, x1, x2, x6, x7, x14 61e2469d82SVarun Wadekar * ------------------------------------------------- 62e2469d82SVarun Wadekar */ 63e2469d82SVarun Wadekarfunc console_spe_register 64e2469d82SVarun Wadekar /* Check the input base address */ 65e2469d82SVarun Wadekar cbz x0, register_fail 66e2469d82SVarun Wadekar 67e2469d82SVarun Wadekar /* Dont use clock or baud rate, so ok to overwrite them */ 68e2469d82SVarun Wadekar check_if_console_is_ready x0, x1, x2, register_fail 69e2469d82SVarun Wadekar 70e2469d82SVarun Wadekar cbz x3, register_fail 71e2469d82SVarun Wadekar str x0, [x3, #CONSOLE_T_BASE] 72e2469d82SVarun Wadekar mov x0, x3 73e2469d82SVarun Wadekar finish_console_register spe putc=1, getc=1, flush=1 74e2469d82SVarun Wadekar 75e2469d82SVarun Wadekarregister_fail: 76e2469d82SVarun Wadekar mov w0, wzr 77e2469d82SVarun Wadekar ret 78e2469d82SVarun Wadekarendfunc console_spe_register 79e2469d82SVarun Wadekar 80e2469d82SVarun Wadekar /* -------------------------------------------------------- 81e2469d82SVarun Wadekar * int console_spe_core_putc(int c, uintptr_t base_addr) 82e2469d82SVarun Wadekar * Function to output a character over the console. It 83e2469d82SVarun Wadekar * returns the character printed on success or -1 on error. 84e2469d82SVarun Wadekar * In : w0 - character to be printed 85e2469d82SVarun Wadekar * x1 - console base address 86e2469d82SVarun Wadekar * Out : return -1 on error else return character. 87e2469d82SVarun Wadekar * Clobber list : x2, x3 88e2469d82SVarun Wadekar * -------------------------------------------------------- 89e2469d82SVarun Wadekar */ 90e2469d82SVarun Wadekarfunc console_spe_core_putc 91e2469d82SVarun Wadekar /* Check the input parameter */ 92e2469d82SVarun Wadekar cbz x1, putc_error 93e2469d82SVarun Wadekar 94e2469d82SVarun Wadekar /* Prepend '\r' to '\n' */ 95e2469d82SVarun Wadekar cmp w0, #0xA 96e2469d82SVarun Wadekar b.ne not_eol 97e2469d82SVarun Wadekar 98e2469d82SVarun Wadekar check_if_console_is_ready x1, x2, x3, putc_error 99e2469d82SVarun Wadekar 100e2469d82SVarun Wadekar /* spe is ready */ 101e2469d82SVarun Wadekar mov w2, #0xD /* '\r' */ 102e2469d82SVarun Wadekar and w2, w2, #0xFF 103*64b2a237SVarun Wadekar mov w3, #(CONSOLE_RING_DOORBELL | (1 << CONSOLE_NUM_BYTES_SHIFT)) 104e2469d82SVarun Wadekar orr w2, w2, w3 105e2469d82SVarun Wadekar str w2, [x1] 106e2469d82SVarun Wadekar 107e2469d82SVarun Wadekarnot_eol: 108e2469d82SVarun Wadekar check_if_console_is_ready x1, x2, x3, putc_error 109e2469d82SVarun Wadekar 110e2469d82SVarun Wadekar /* spe is ready */ 111e2469d82SVarun Wadekar mov w2, w0 112e2469d82SVarun Wadekar and w2, w2, #0xFF 113*64b2a237SVarun Wadekar mov w3, #(CONSOLE_RING_DOORBELL | (1 << CONSOLE_NUM_BYTES_SHIFT)) 114e2469d82SVarun Wadekar orr w2, w2, w3 115e2469d82SVarun Wadekar str w2, [x1] 116e2469d82SVarun Wadekar 117e2469d82SVarun Wadekar ret 118e2469d82SVarun Wadekarputc_error: 119e2469d82SVarun Wadekar mov w0, #-1 120e2469d82SVarun Wadekar ret 121e2469d82SVarun Wadekarendfunc console_spe_core_putc 122e2469d82SVarun Wadekar 123e2469d82SVarun Wadekar /* -------------------------------------------------------- 124e2469d82SVarun Wadekar * int console_spe_putc(int c, console_t *console) 125e2469d82SVarun Wadekar * Function to output a character over the console. It 126e2469d82SVarun Wadekar * returns the character printed on success or -1 on error. 127e2469d82SVarun Wadekar * In : w0 - character to be printed 128e2469d82SVarun Wadekar * x1 - pointer to console_t structure 129e2469d82SVarun Wadekar * Out : return -1 on error else return character. 130e2469d82SVarun Wadekar * Clobber list : x2 131e2469d82SVarun Wadekar * -------------------------------------------------------- 132e2469d82SVarun Wadekar */ 133e2469d82SVarun Wadekarfunc console_spe_putc 134e2469d82SVarun Wadekar ldr x1, [x1, #CONSOLE_T_BASE] 135e2469d82SVarun Wadekar b console_spe_core_putc 136e2469d82SVarun Wadekarendfunc console_spe_putc 137e2469d82SVarun Wadekar 138e2469d82SVarun Wadekar /* --------------------------------------------- 139e2469d82SVarun Wadekar * int console_spe_getc(console_t *console) 140e2469d82SVarun Wadekar * Function to get a character from the console. 141e2469d82SVarun Wadekar * It returns the character grabbed on success 142e2469d82SVarun Wadekar * or -1 if no character is available. 143e2469d82SVarun Wadekar * In : x0 - pointer to console_t structure 144e2469d82SVarun Wadekar * Out: w0 - character if available, else -1 145e2469d82SVarun Wadekar * Clobber list : x0, x1 146e2469d82SVarun Wadekar * --------------------------------------------- 147e2469d82SVarun Wadekar */ 148e2469d82SVarun Wadekarfunc console_spe_getc 149e2469d82SVarun Wadekar mov w0, #-1 150e2469d82SVarun Wadekar ret 151e2469d82SVarun Wadekarendfunc console_spe_getc 152e2469d82SVarun Wadekar 153e2469d82SVarun Wadekar /* ------------------------------------------------- 154e2469d82SVarun Wadekar * int console_spe_core_flush(uintptr_t base_addr) 155e2469d82SVarun Wadekar * Function to force a write of all buffered 156e2469d82SVarun Wadekar * data that hasn't been output. 157e2469d82SVarun Wadekar * In : x0 - console base address 158e2469d82SVarun Wadekar * Out : return -1 on error else return 0. 159e2469d82SVarun Wadekar * Clobber list : x0, x1 160e2469d82SVarun Wadekar * ------------------------------------------------- 161e2469d82SVarun Wadekar */ 162e2469d82SVarun Wadekarfunc console_spe_core_flush 163e2469d82SVarun Wadekar cbz x0, flush_error 164e2469d82SVarun Wadekar 165e2469d82SVarun Wadekar /* flush console */ 166*64b2a237SVarun Wadekar mov w1, #(CONSOLE_RING_DOORBELL | CONSOLE_FLUSH_DATA_TO_PORT) 167e2469d82SVarun Wadekar str w1, [x0] 168e2469d82SVarun Wadekar mov w0, #0 169e2469d82SVarun Wadekar ret 170e2469d82SVarun Wadekarflush_error: 171e2469d82SVarun Wadekar mov w0, #-1 172e2469d82SVarun Wadekar ret 173e2469d82SVarun Wadekarendfunc console_spe_core_flush 174e2469d82SVarun Wadekar 175e2469d82SVarun Wadekar /* --------------------------------------------- 176e2469d82SVarun Wadekar * int console_spe_flush(console_t *console) 177e2469d82SVarun Wadekar * Function to force a write of all buffered 178e2469d82SVarun Wadekar * data that hasn't been output. 179e2469d82SVarun Wadekar * In : x0 - pointer to console_t structure 180e2469d82SVarun Wadekar * Out : return -1 on error else return 0. 181e2469d82SVarun Wadekar * Clobber list : x0, x1 182e2469d82SVarun Wadekar * --------------------------------------------- 183e2469d82SVarun Wadekar */ 184e2469d82SVarun Wadekarfunc console_spe_flush 185e2469d82SVarun Wadekar ldr x0, [x0, #CONSOLE_T_BASE] 186e2469d82SVarun Wadekar b console_spe_core_flush 187e2469d82SVarun Wadekarendfunc console_spe_flush 188