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