mirror of
https://github.com/smaeul/u-boot.git
synced 2025-10-26 17:48:26 +00:00
03de305ec4
As part of bringing the master branch back in to next, we need to allow for all of these changes to exist here. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
163 lines
3.3 KiB
C
163 lines
3.3 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (c) 2015 Google, Inc
|
|
* Written by Simon Glass <sjg@chromium.org>
|
|
*/
|
|
|
|
#include <debug_uart.h>
|
|
#include <dm.h>
|
|
#include <efi.h>
|
|
#include <efi_api.h>
|
|
#include <errno.h>
|
|
#include <fdtdec.h>
|
|
#include <log.h>
|
|
#include <linux/compiler.h>
|
|
#include <asm/io.h>
|
|
#include <serial.h>
|
|
|
|
/* Information about the efi console */
|
|
struct serial_efi_priv {
|
|
struct efi_simple_text_input_protocol *con_in;
|
|
struct efi_simple_text_output_protocol *con_out;
|
|
struct efi_input_key key;
|
|
bool have_key;
|
|
};
|
|
|
|
/* Convert a lower-case character to its ctrl-char equivalent */
|
|
#define CTL_CH(c) ((c) - 'a' + 1)
|
|
|
|
int serial_efi_setbrg(struct udevice *dev, int baudrate)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int serial_efi_get_key(struct serial_efi_priv *priv)
|
|
{
|
|
int ret;
|
|
|
|
if (priv->have_key)
|
|
return 0;
|
|
ret = priv->con_in->read_key_stroke(priv->con_in, &priv->key);
|
|
if (ret == EFI_NOT_READY)
|
|
return -EAGAIN;
|
|
else if (ret != EFI_SUCCESS)
|
|
return -EIO;
|
|
|
|
priv->have_key = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int serial_efi_getc(struct udevice *dev)
|
|
{
|
|
struct serial_efi_priv *priv = dev_get_priv(dev);
|
|
char conv_scan[10] = {0, 'p', 'n', 'f', 'b', 'a', 'e', 0, 8};
|
|
int ret, ch;
|
|
|
|
ret = serial_efi_get_key(priv);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv->have_key = false;
|
|
ch = priv->key.unicode_char;
|
|
|
|
/*
|
|
* Unicode char 8 (for backspace) is never returned. Instead we get a
|
|
* key scan code of 8. Handle this so that backspace works correctly
|
|
* in the U-Boot command line.
|
|
*/
|
|
if (!ch && priv->key.scan_code < sizeof(conv_scan)) {
|
|
ch = conv_scan[priv->key.scan_code];
|
|
if (ch >= 'a')
|
|
ch -= 'a' - 1;
|
|
}
|
|
debug(" [%x %x %x] ", ch, priv->key.unicode_char, priv->key.scan_code);
|
|
|
|
return ch;
|
|
}
|
|
|
|
static int serial_efi_putc(struct udevice *dev, const char ch)
|
|
{
|
|
struct serial_efi_priv *priv = dev_get_priv(dev);
|
|
uint16_t ucode[2];
|
|
int ret;
|
|
|
|
ucode[0] = ch;
|
|
ucode[1] = '\0';
|
|
ret = priv->con_out->output_string(priv->con_out, ucode);
|
|
if (ret)
|
|
return -EIO;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int serial_efi_pending(struct udevice *dev, bool input)
|
|
{
|
|
struct serial_efi_priv *priv = dev_get_priv(dev);
|
|
int ret;
|
|
|
|
/* We assume that EFI will stall if its output buffer fills up */
|
|
if (!input)
|
|
return 0;
|
|
|
|
ret = serial_efi_get_key(priv);
|
|
if (ret == -EAGAIN)
|
|
return 0;
|
|
else if (ret)
|
|
return ret;
|
|
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
* There is nothing to init here since the EFI console is already running by
|
|
* the time we enter U-Boot.
|
|
*/
|
|
static inline void _debug_uart_init(void)
|
|
{
|
|
}
|
|
|
|
static inline void _debug_uart_putc(int ch)
|
|
{
|
|
struct efi_system_table *sys_table = efi_get_sys_table();
|
|
uint16_t ucode[2];
|
|
|
|
ucode[0] = ch;
|
|
ucode[1] = '\0';
|
|
sys_table->con_out->output_string(sys_table->con_out, ucode);
|
|
}
|
|
|
|
DEBUG_UART_FUNCS
|
|
|
|
static int serial_efi_probe(struct udevice *dev)
|
|
{
|
|
struct efi_system_table *table = efi_get_sys_table();
|
|
struct serial_efi_priv *priv = dev_get_priv(dev);
|
|
|
|
priv->con_in = table->con_in;
|
|
priv->con_out = table->con_out;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dm_serial_ops serial_efi_ops = {
|
|
.putc = serial_efi_putc,
|
|
.getc = serial_efi_getc,
|
|
.pending = serial_efi_pending,
|
|
.setbrg = serial_efi_setbrg,
|
|
};
|
|
|
|
static const struct udevice_id serial_efi_ids[] = {
|
|
{ .compatible = "efi,uart" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(serial_efi) = {
|
|
.name = "serial_efi",
|
|
.id = UCLASS_SERIAL,
|
|
.of_match = serial_efi_ids,
|
|
.priv_auto = sizeof(struct serial_efi_priv),
|
|
.probe = serial_efi_probe,
|
|
.ops = &serial_efi_ops,
|
|
};
|