In the presence of self-relocating payloads, it's safer to keep physical addresses in `libsysinfo`. Change-Id: Icd30e95c6b8115d16dd793914fb01a1a9da1854f Signed-off-by: Nico Huber <nico.h@gmx.de> Reviewed-on: https://review.coreboot.org/c/coreboot/+/43577 Tested-by: build bot (Jenkins) <no-reply@coreboot.org> Reviewed-by: Angel Pons <th3fanbus@gmail.com> Reviewed-by: Julius Werner <jwerner@chromium.org>
		
			
				
	
	
		
			110 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			110 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Copyright 2013 Google Inc.
 | 
						|
 *
 | 
						|
 * Redistribution and use in source and binary forms, with or without
 | 
						|
 * modification, are permitted provided that the following conditions
 | 
						|
 * are met:
 | 
						|
 * 1. Redistributions of source code must retain the above copyright
 | 
						|
 *    notice, this list of conditions and the following disclaimer.
 | 
						|
 * 2. Redistributions in binary form must reproduce the above copyright
 | 
						|
 *    notice, this list of conditions and the following disclaimer in the
 | 
						|
 *    documentation and/or other materials provided with the distribution.
 | 
						|
 * 3. The name of the author may not be used to endorse or promote products
 | 
						|
 *    derived from this software without specific prior written permission.
 | 
						|
 *
 | 
						|
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 | 
						|
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 | 
						|
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 | 
						|
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
 | 
						|
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 | 
						|
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 | 
						|
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 | 
						|
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 | 
						|
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 | 
						|
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 | 
						|
 * SUCH DAMAGE.
 | 
						|
 */
 | 
						|
 | 
						|
#include <libpayload.h>
 | 
						|
#include <stdint.h>
 | 
						|
 | 
						|
struct s5p_uart
 | 
						|
{
 | 
						|
	uint32_t ulcon;		// line control
 | 
						|
	uint32_t ucon;		// control
 | 
						|
	uint32_t ufcon;		// FIFO control
 | 
						|
	uint32_t umcon;		// modem control
 | 
						|
	uint32_t utrstat;	// Tx/Rx status
 | 
						|
	uint32_t uerstat;	// Rx error status
 | 
						|
	uint32_t ufstat;	// FIFO status
 | 
						|
	uint32_t umstat;	// modem status
 | 
						|
	uint32_t utxh;		// transmit buffer
 | 
						|
	uint32_t urxh;		// receive buffer
 | 
						|
	uint32_t ubrdiv;	// baud rate divisor
 | 
						|
	uint32_t ufracval;	// divisor fractional value
 | 
						|
	uint32_t uintp;		// interrupt pending
 | 
						|
	uint32_t uints;		// interrupt source
 | 
						|
	uint32_t uintm;		// interrupt mask
 | 
						|
};
 | 
						|
 | 
						|
static struct s5p_uart *uart_regs;
 | 
						|
 | 
						|
void serial_putchar(unsigned int c)
 | 
						|
{
 | 
						|
	const uint32_t TxFifoFullBit = (0x1 << 24);
 | 
						|
 | 
						|
	while (readl(&uart_regs->ufstat) & TxFifoFullBit)
 | 
						|
	{;}
 | 
						|
 | 
						|
	writeb(c, &uart_regs->utxh);
 | 
						|
	if (c == '\n')
 | 
						|
		serial_putchar('\r');
 | 
						|
}
 | 
						|
 | 
						|
int serial_havechar(void)
 | 
						|
{
 | 
						|
	const uint32_t DataReadyMask = (0xf << 0) | (0x1 << 8);
 | 
						|
 | 
						|
	return (readl(&uart_regs->ufstat) & DataReadyMask) != 0;
 | 
						|
}
 | 
						|
 | 
						|
int serial_getchar(void)
 | 
						|
{
 | 
						|
	while (!serial_havechar())
 | 
						|
	{;}
 | 
						|
 | 
						|
	return readb(&uart_regs->urxh);
 | 
						|
}
 | 
						|
 | 
						|
static struct console_output_driver s5p_serial_output =
 | 
						|
{
 | 
						|
	.putchar = &serial_putchar
 | 
						|
};
 | 
						|
 | 
						|
static struct console_input_driver s5p_serial_input =
 | 
						|
{
 | 
						|
	.havekey = &serial_havechar,
 | 
						|
	.getchar = &serial_getchar,
 | 
						|
	.input_type = CONSOLE_INPUT_TYPE_UART,
 | 
						|
};
 | 
						|
 | 
						|
void serial_init(void)
 | 
						|
{
 | 
						|
	const struct cb_serial *const serial = phys_to_virt(lib_sysinfo.cb_serial);
 | 
						|
 | 
						|
	if (!lib_sysinfo.cb_serial || !serial->baseaddr)
 | 
						|
		return;
 | 
						|
 | 
						|
	uart_regs = (struct s5p_uart *)serial->baseaddr;
 | 
						|
}
 | 
						|
 | 
						|
void serial_console_init(void)
 | 
						|
{
 | 
						|
	serial_init();
 | 
						|
 | 
						|
	if (uart_regs) {
 | 
						|
		console_add_output_driver(&s5p_serial_output);
 | 
						|
		console_add_input_driver(&s5p_serial_input);
 | 
						|
	}
 | 
						|
}
 |