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