drivers/misc/cbmem_console.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (C) 2011 The ChromiumOS Authors.  All rights reserved.
   4  */
   5
   6 #include <common.h>
   7 #include <console.h>
   8 #ifndef CONFIG_SYS_COREBOOT
   9 #error This driver requires coreboot
  10 #endif
  11
  12 #include <asm/arch/sysinfo.h>
  13
  14 struct cbmem_console {
  15         u32 buffer_size;
  16         u32 buffer_cursor;
  17         u8  buffer_body[0];
  18 }  __attribute__ ((__packed__));
  19
  20 static struct cbmem_console *cbmem_console_p;
  21
  22 void cbmemc_putc(struct stdio_dev *dev, char data)
  23 {
  24         int cursor;
  25
  26         cursor = cbmem_console_p->buffer_cursor++;
  27         if (cursor < cbmem_console_p->buffer_size)
  28                 cbmem_console_p->buffer_body[cursor] = data;
  29 }
  30
  31 void cbmemc_puts(struct stdio_dev *dev, const char *str)
  32 {
  33         char c;
  34
  35         while ((c = *str++) != 0)
  36                 cbmemc_putc(dev, c);
  37 }
  38
  39 int cbmemc_init(void)
  40 {
  41         int rc;
  42         struct stdio_dev cons_dev;
  43         cbmem_console_p = lib_sysinfo.cbmem_cons;
  44
  45         memset(&cons_dev, 0, sizeof(cons_dev));
  46
  47         strcpy(cons_dev.name, "cbmem");
  48         cons_dev.flags = DEV_FLAGS_OUTPUT; /* Output only */
  49         cons_dev.putc  = cbmemc_putc;
  50         cons_dev.puts  = cbmemc_puts;
  51
  52         rc = stdio_register(&cons_dev);
  53
  54         return (rc == 0) ? 1 : rc;
  55 }