dm: treewide: Rename ofdata_to_platdata() to of_to_plat()
[platform/kernel/u-boot.git] / drivers / serial / sandbox.c
index 58f882b..2deb14d 100644 (file)
@@ -1,7 +1,6 @@
+// SPDX-License-Identifier: GPL-2.0+
 /*
  * Copyright (c) 2011 The Chromium OS Authors.
- *
- * SPDX-License-Identifier:    GPL-2.0+
  */
 
 /*
@@ -11,8 +10,8 @@
  */
 
 #include <common.h>
+#include <console.h>
 #include <dm.h>
-#include <fdtdec.h>
 #include <lcd.h>
 #include <os.h>
 #include <serial.h>
 
 DECLARE_GLOBAL_DATA_PTR;
 
-/*
- *
- *   serial_buf: A buffer that holds keyboard characters for the
- *              Sandbox U-Boot.
- *
- * invariants:
- *   serial_buf_write           == serial_buf_read -> empty buffer
- *   (serial_buf_write + 1) % 16 == serial_buf_read -> full buffer
- */
-static char serial_buf[16];
-static unsigned int serial_buf_write;
-static unsigned int serial_buf_read;
-
 struct sandbox_serial_platdata {
        int colour;     /* Text colour to use for output, -1 for none */
 };
 
+/**
+ * struct sandbox_serial_priv - Private data for this driver
+ *
+ * @buf: holds input characters available to be read by this driver
+ */
 struct sandbox_serial_priv {
+       struct membuff buf;
+       char serial_buf[16];
        bool start_of_line;
 };
 
@@ -70,12 +63,16 @@ static int sandbox_serial_probe(struct udevice *dev)
                os_tty_raw(0, state->term_raw == STATE_TERM_RAW_WITH_SIGS);
        priv->start_of_line = 0;
 
+       if (state->term_raw != STATE_TERM_RAW)
+               disable_ctrlc(1);
+       membuff_init(&priv->buf, priv->serial_buf, sizeof(priv->serial_buf));
+
        return 0;
 }
 
 static int sandbox_serial_remove(struct udevice *dev)
 {
-       struct sandbox_serial_platdata *plat = dev->platdata;
+       struct sandbox_serial_platdata *plat = dev->plat;
 
        if (plat->colour != -1)
                output_ansi_reset();
@@ -86,9 +83,11 @@ static int sandbox_serial_remove(struct udevice *dev)
 static int sandbox_serial_putc(struct udevice *dev, const char ch)
 {
        struct sandbox_serial_priv *priv = dev_get_priv(dev);
-       struct sandbox_serial_platdata *plat = dev->platdata;
+       struct sandbox_serial_platdata *plat = dev->plat;
 
-       if (priv->start_of_line && plat->colour != -1) {
+       /* With of-platdata we don't real the colour correctly, so disable it */
+       if (!CONFIG_IS_ENABLED(OF_PLATDATA) && priv->start_of_line &&
+           plat->colour != -1) {
                priv->start_of_line = false;
                output_ansi_colour(plat->colour);
        }
@@ -100,42 +99,101 @@ static int sandbox_serial_putc(struct udevice *dev, const char ch)
        return 0;
 }
 
-static unsigned int increment_buffer_index(unsigned int index)
-{
-       return (index + 1) % ARRAY_SIZE(serial_buf);
-}
-
 static int sandbox_serial_pending(struct udevice *dev, bool input)
 {
-       const unsigned int next_index =
-               increment_buffer_index(serial_buf_write);
+       struct sandbox_serial_priv *priv = dev_get_priv(dev);
        ssize_t count;
+       char *data;
+       int avail;
 
        if (!input)
                return 0;
 
        os_usleep(100);
-       video_sync_all();
-       if (next_index == serial_buf_read)
+       if (!IS_ENABLED(CONFIG_SPL_BUILD))
+               video_sync_all();
+       avail = membuff_putraw(&priv->buf, 100, false, &data);
+       if (!avail)
                return 1;       /* buffer full */
 
-       count = os_read_no_block(0, &serial_buf[serial_buf_write], 1);
-       if (count == 1)
-               serial_buf_write = next_index;
+       count = os_read(0, data, avail);
+       if (count > 0)
+               membuff_putraw(&priv->buf, count, true, &data);
 
-       return serial_buf_write != serial_buf_read;
+       return membuff_avail(&priv->buf);
 }
 
 static int sandbox_serial_getc(struct udevice *dev)
 {
-       int result;
+       struct sandbox_serial_priv *priv = dev_get_priv(dev);
 
        if (!sandbox_serial_pending(dev, true))
                return -EAGAIN; /* buffer empty */
 
-       result = serial_buf[serial_buf_read];
-       serial_buf_read = increment_buffer_index(serial_buf_read);
-       return result;
+       return membuff_getbyte(&priv->buf);
+}
+
+#ifdef CONFIG_DEBUG_UART_SANDBOX
+
+#include <debug_uart.h>
+
+static inline void _debug_uart_init(void)
+{
+}
+
+static inline void _debug_uart_putc(int ch)
+{
+       os_putc(ch);
+}
+
+DEBUG_UART_FUNCS
+
+#endif /* CONFIG_DEBUG_UART_SANDBOX */
+
+static int sandbox_serial_getconfig(struct udevice *dev, uint *serial_config)
+{
+       uint config = SERIAL_DEFAULT_CONFIG;
+
+       if (!serial_config)
+               return -EINVAL;
+
+       *serial_config = config;
+
+       return 0;
+}
+
+static int sandbox_serial_setconfig(struct udevice *dev, uint serial_config)
+{
+       u8 parity = SERIAL_GET_PARITY(serial_config);
+       u8 bits = SERIAL_GET_BITS(serial_config);
+       u8 stop = SERIAL_GET_STOP(serial_config);
+
+       if (bits != SERIAL_8_BITS || stop != SERIAL_ONE_STOP ||
+           parity != SERIAL_PAR_NONE)
+               return -ENOTSUPP; /* not supported in driver*/
+
+       return 0;
+}
+
+static int sandbox_serial_getinfo(struct udevice *dev,
+                                 struct serial_device_info *serial_info)
+{
+       struct serial_device_info info = {
+               .type = SERIAL_CHIP_UNKNOWN,
+               .addr_space = SERIAL_ADDRESS_SPACE_IO,
+               .addr = SERIAL_DEFAULT_ADDRESS,
+               .reg_width = 1,
+               .reg_offset = 0,
+               .reg_shift = 0,
+               .clock = SERIAL_DEFAULT_CLOCK,
+       };
+
+       if (!serial_info)
+               return -EINVAL;
+
+       *serial_info = info;
+
+       return 0;
 }
 
 static const char * const ansi_colour[] = {
@@ -143,15 +201,16 @@ static const char * const ansi_colour[] = {
        "white",
 };
 
-static int sandbox_serial_ofdata_to_platdata(struct udevice *dev)
+static int sandbox_serial_of_to_plat(struct udevice *dev)
 {
-       struct sandbox_serial_platdata *plat = dev->platdata;
+       struct sandbox_serial_platdata *plat = dev->plat;
        const char *colour;
        int i;
 
+       if (CONFIG_IS_ENABLED(OF_PLATDATA))
+               return 0;
        plat->colour = -1;
-       colour = fdt_getprop(gd->fdt_blob, dev->of_offset,
-                            "sandbox,text-colour", NULL);
+       colour = dev_read_string(dev, "sandbox,text-colour");
        if (colour) {
                for (i = 0; i < ARRAY_SIZE(ansi_colour); i++) {
                        if (!strcmp(colour, ansi_colour[i])) {
@@ -168,6 +227,9 @@ static const struct dm_serial_ops sandbox_serial_ops = {
        .putc = sandbox_serial_putc,
        .pending = sandbox_serial_pending,
        .getc = sandbox_serial_getc,
+       .getconfig = sandbox_serial_getconfig,
+       .setconfig = sandbox_serial_setconfig,
+       .getinfo = sandbox_serial_getinfo,
 };
 
 static const struct udevice_id sandbox_serial_ids[] = {
@@ -175,24 +237,26 @@ static const struct udevice_id sandbox_serial_ids[] = {
        { }
 };
 
-U_BOOT_DRIVER(serial_sandbox) = {
-       .name   = "serial_sandbox",
+U_BOOT_DRIVER(sandbox_serial) = {
+       .name   = "sandbox_serial",
        .id     = UCLASS_SERIAL,
        .of_match = sandbox_serial_ids,
-       .ofdata_to_platdata = sandbox_serial_ofdata_to_platdata,
-       .platdata_auto_alloc_size = sizeof(struct sandbox_serial_platdata),
-       .priv_auto_alloc_size = sizeof(struct sandbox_serial_priv),
+       .of_to_plat = sandbox_serial_of_to_plat,
+       .plat_auto      = sizeof(struct sandbox_serial_platdata),
+       .priv_auto      = sizeof(struct sandbox_serial_priv),
        .probe = sandbox_serial_probe,
        .remove = sandbox_serial_remove,
        .ops    = &sandbox_serial_ops,
        .flags = DM_FLAG_PRE_RELOC,
 };
 
+#if !CONFIG_IS_ENABLED(OF_PLATDATA)
 static const struct sandbox_serial_platdata platdata_non_fdt = {
        .colour = -1,
 };
 
 U_BOOT_DEVICE(serial_sandbox_non_fdt) = {
-       .name = "serial_sandbox",
-       .platdata = &platdata_non_fdt,
+       .name = "sandbox_serial",
+       .plat = &platdata_non_fdt,
 };
+#endif