From f6145c3c15789123f6b4a9ce64a517048e753762 Mon Sep 17 00:00:00 2001 From: Jordan Crouse Date: Wed, 19 Mar 2008 23:56:58 +0000 Subject: libpayload: The initial chunk of code writen by AMD This is the initial chunk of code written by me and copyrighted by AMD. Includes everything but a few files that we pulled from outside sources. Signed-off-by: Jordan Crouse Acked-by: Uwe Hermann git-svn-id: svn://svn.coreboot.org/coreboot/trunk@3170 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1 --- payloads/libpayload/Config.in | 81 +++ payloads/libpayload/Makefile | 107 ++++ payloads/libpayload/README | 7 + payloads/libpayload/curses/Makefile.inc | 33 ++ payloads/libpayload/curses/colors.c | 59 +++ payloads/libpayload/curses/keyboard.c | 303 ++++++++++++ payloads/libpayload/curses/local.h | 94 ++++ payloads/libpayload/curses/tinycurses.c | 688 ++++++++++++++++++++++++++ payloads/libpayload/drivers/Makefile.inc | 33 ++ payloads/libpayload/drivers/keyboard.c | 126 +++++ payloads/libpayload/drivers/serial.c | 78 +++ payloads/libpayload/drivers/vga.c | 216 ++++++++ payloads/libpayload/i386/Makefile.inc | 31 ++ payloads/libpayload/i386/coreboot.c | 147 ++++++ payloads/libpayload/i386/head.S | 85 ++++ payloads/libpayload/i386/main.c | 79 +++ payloads/libpayload/i386/sysinfo.c | 70 +++ payloads/libpayload/i386/timer.c | 92 ++++ payloads/libpayload/i386/util.S | 38 ++ payloads/libpayload/include/arch/io.h | 77 +++ payloads/libpayload/include/arch/rdtsc.h | 40 ++ payloads/libpayload/include/arch/types.h | 57 +++ payloads/libpayload/include/coreboot_tables.h | 151 ++++++ payloads/libpayload/include/libpayload.h | 99 ++++ payloads/libpayload/include/sysinfo.h | 53 ++ payloads/libpayload/libc/Makefile.inc | 32 ++ payloads/libpayload/libc/console.c | 104 ++++ payloads/libpayload/libc/ctype.c | 60 +++ payloads/libpayload/libc/malloc.c | 262 ++++++++++ payloads/libpayload/libc/string.c | 195 ++++++++ payloads/libpayload/libpayload.ldscript | 90 ++++ payloads/libpayload/sample/Makefile | 51 ++ payloads/libpayload/sample/hello.c | 39 ++ 33 files changed, 3677 insertions(+) create mode 100644 payloads/libpayload/Config.in create mode 100644 payloads/libpayload/Makefile create mode 100644 payloads/libpayload/README create mode 100644 payloads/libpayload/curses/Makefile.inc create mode 100644 payloads/libpayload/curses/colors.c create mode 100644 payloads/libpayload/curses/keyboard.c create mode 100644 payloads/libpayload/curses/local.h create mode 100644 payloads/libpayload/curses/tinycurses.c create mode 100644 payloads/libpayload/drivers/Makefile.inc create mode 100644 payloads/libpayload/drivers/keyboard.c create mode 100644 payloads/libpayload/drivers/serial.c create mode 100644 payloads/libpayload/drivers/vga.c create mode 100644 payloads/libpayload/i386/Makefile.inc create mode 100644 payloads/libpayload/i386/coreboot.c create mode 100644 payloads/libpayload/i386/head.S create mode 100644 payloads/libpayload/i386/main.c create mode 100644 payloads/libpayload/i386/sysinfo.c create mode 100644 payloads/libpayload/i386/timer.c create mode 100644 payloads/libpayload/i386/util.S create mode 100644 payloads/libpayload/include/arch/io.h create mode 100644 payloads/libpayload/include/arch/rdtsc.h create mode 100644 payloads/libpayload/include/arch/types.h create mode 100644 payloads/libpayload/include/coreboot_tables.h create mode 100644 payloads/libpayload/include/libpayload.h create mode 100644 payloads/libpayload/include/sysinfo.h create mode 100644 payloads/libpayload/libc/Makefile.inc create mode 100644 payloads/libpayload/libc/console.c create mode 100644 payloads/libpayload/libc/ctype.c create mode 100644 payloads/libpayload/libc/malloc.c create mode 100644 payloads/libpayload/libc/string.c create mode 100644 payloads/libpayload/libpayload.ldscript create mode 100644 payloads/libpayload/sample/Makefile create mode 100644 payloads/libpayload/sample/hello.c (limited to 'payloads') diff --git a/payloads/libpayload/Config.in b/payloads/libpayload/Config.in new file mode 100644 index 0000000000..ffd40b73bf --- /dev/null +++ b/payloads/libpayload/Config.in @@ -0,0 +1,81 @@ +# +# This file is part of the libpayload project. +# +# Copyright (C) 2008 Advanced Micro Devices, Inc. +# +# Redistribution and use in source and binary forms, with or without +# modification, are permitted provided that the following conditions +# are met: +# 1. Redistributions of source code must retain the above copyright +# notice, this list of conditions and the following disclaimer. +# 2. Redistributions in binary form must reproduce the above copyright +# notice, this list of conditions and the following disclaimer in the +# documentation and/or other materials provided with the distribution. +# 3. The name of the author may not be used to endorse or promote products +# derived from this software without specific prior written permission. +# +# THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND +# ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +# IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +# ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE +# FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +# DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +# OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +# HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +# OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +# SUCH DAMAGE. +# + +mainmenu "Libpayload Configuration" + +config HAVE_DOT_CONFIG + bool + default y + +# When (if) we support multiple architectures, +# then this will become an option + +config TARGET_I386 + bool + default y + +menu "Output Options" + +config SERIAL_CONSOLE + bool "See output on the serial port console" + default y + +config SERIAL_IOBASE + hex "I/O base for the serial port (default 0x3f8)" + depends SERIAL_CONSOLE + default 0x3f8 + +config SERIAL_SET_SPEED + bool "Override the serial console baud rate" + default n + depends SERIAL_CONSOLE + +config SERIAL_BAUD_RATE + int "Serial console baud rate (default 115200)" + depends SERIAL_SET_SPEED + default 115200 + +config VGA_CONSOLE + bool "See output on a VGA console" + default y + +config PC_KEYBOARD + bool "Allow input from a PC keyboard" + depends VGA_CONSOLE + default y + +endmenu + +menu "Build Options" + +config TINYCURSES + bool "Enable tinycurses support" + default y + +endmenu diff --git a/payloads/libpayload/Makefile b/payloads/libpayload/Makefile new file mode 100644 index 0000000000..f2f87abc53 --- /dev/null +++ b/payloads/libpayload/Makefile @@ -0,0 +1,107 @@ +## +## This file is part of the libpayload project. +## +## Copyright (C) 2008 Advanced Micro Devices, Inc. +## +## Redistribution and use in source and binary forms, with or without +## modification, are permitted provided that the following conditions +## are met: +## 1. Redistributions of source code must retain the above copyright +## notice, this list of conditions and the following disclaimer. +## 2. Redistributions in binary form must reproduce the above copyright +## notice, this list of conditions and the following disclaimer in the +## documentation and/or other materials provided with the distribution. +## 3. The name of the author may not be used to endorse or promote products +## derived from this software without specific prior written permission. +## +## THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND +## ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +## IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +## ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE +## FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +## DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +## OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +## HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +## LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +## OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +## SUCH DAMAGE. +## + +BASE_DIR=$(shell pwd) +KCONFIG_DIR=util/kconfig + +ifeq (.config, $(wildcard .config)) +dot-config := 1 +else +dot-config := 0 +config-targets := 1 +endif + +ifneq ($(filter textconfig oldconfig defconfig menuconfig,$(MAKECMDGOALS)),) +config-targets := 1 +dot-config := 0 +endif + +ifeq ($(dot-config),0) +all: .config + +.config: oldconfig + @echo "Configuration completed - type make to build libpayload" +else +-include .config +endif + +PLATFORM-$(CONFIG_TARGET_I386) += i386/Makefile.inc +TARGETS-y := + +BUILD-y := libc/Makefile.inc drivers/Makefile.inc +BUILD-$(CONFIG_TINYCURSES) += curses/Makefile.inc + +include $(PLATFORM-y) $(BUILD-y) + +INCLUDES := -I./include +INCLUDES += -I$(shell $(CC) -print-search-dirs | head -n 1 | cut -d' ' -f2)include +CFLAGS := -Werror -fno-stack-protector -nostdinc $(INCLUDES) + +libpayload.a: $(TARGETS-y) + $(AR) rc $@ $(TARGETS-y) + +%.o: %.c + $(CC) -m32 $(CFLAGS) -c -o $@ $< + +%.o: %.S + $(AS) --32 -o $@ $< + +clean: + @ rm -f $(TARGETS-y) + @ rm -f libpayload.a + +distclean: clean + @ make -C $(KCONFIG_DIR) clean + @ rm -f $(KCONFIG_DIR)/lxdialog/lxdialog + @ rm -f .config .kconfig.d include/autoconf.h + +ifeq ($(config-targets),1) + +$(KCONFIG_DIR)/conf: + make -C $(KCONFIG_DIR) conf + +$(KCONFIG_DIR)/mconf: + make -C $(KCONFIG_DIR) mconf + +$(KCONFIG_DIR)/lxdialog/lxdialog: + make -C $(KCONFIG_DIR)/lxdialog lxdialog + +textconfig: $(KCONFIG_DIR)/conf + @$(KCONFIG_DIR)/conf $(BASE_DIR)/Config.in + +oldconfig: $(KCONFIG_DIR)/conf + @$(KCONFIG_DIR)/conf -o $(BASE_DIR)/Config.in + +defconfig: $(KCONFIG_DIR)/conf + @$(KCONFIG_DIR)/conf -d $(BASE_DIR)/Config.in + +menuconfig: $(KCONFIG_DIR)/lxdialog/lxdialog $(KCONFIG_DIR)/mconf + @$(KCONFIG_DIR)/mconf $(BASE_DIR)/Config.in + +endif diff --git a/payloads/libpayload/README b/payloads/libpayload/README new file mode 100644 index 0000000000..7f35fc4e07 --- /dev/null +++ b/payloads/libpayload/README @@ -0,0 +1,7 @@ +This is libpayload, a minimal library to support standalone payloads +that can be booted with firmware like coreboot. It handles the setup +code, and provides common C library symbols such as malloc() and +printf(). + +Please see the sample/ directory for an example of the payload in +action. diff --git a/payloads/libpayload/curses/Makefile.inc b/payloads/libpayload/curses/Makefile.inc new file mode 100644 index 0000000000..29c7801755 --- /dev/null +++ b/payloads/libpayload/curses/Makefile.inc @@ -0,0 +1,33 @@ +# +# This file is part of the libpayload project. +# +# Copyright (C) 2008 Advanced Micro Devices, Inc. +# +# Redistribution and use in source and binary forms, with or without +# modification, are permitted provided that the following conditions +# are met: +# 1. Redistributions of source code must retain the above copyright +# notice, this list of conditions and the following disclaimer. +# 2. Redistributions in binary form must reproduce the above copyright +# notice, this list of conditions and the following disclaimer in the +# documentation and/or other materials provided with the distribution. +# 3. The name of the author may not be used to endorse or promote products +# derived from this software without specific prior written permission. +# +# THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND +# ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +# IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +# ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE +# FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +# DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +# OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +# HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +# OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +# SUCH DAMAGE. +# + +TARGETS-$(CONFIG_TINYCURSES) += curses/keyboard.o +TARGETS-$(CONFIG_TINYCURSES) += curses/tinycurses.o +TARGETS-$(CONFIG_TINYCURSES) += curses/speaker.o +TARGETS-$(CONFIG_TINYCURSES) += curses/colors.o diff --git a/payloads/libpayload/curses/colors.c b/payloads/libpayload/curses/colors.c new file mode 100644 index 0000000000..045df83ba3 --- /dev/null +++ b/payloads/libpayload/curses/colors.c @@ -0,0 +1,59 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2007 Uwe Hermann + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +/* Color pair management */ + +#include "local.h" + +unsigned char color_pairs[256] = { + [0] = 0x07, +}; + +int start_color(void) { + return 0; +} + +int init_pair(short index, short fg, short bg) +{ + if (index == 0 || index > 255) + return ERR; + + color_pairs[index] = ((bg & 0xF) << 4) | (fg & 0xF); + return 0; +} + +int pair_content(short index, short *fg, short *bg) +{ + if (index < 0 || index > 255) + return ERR; + + *bg = (color_pairs[index] >> 4) & 0xF; + *fg = color_pairs[index] & 0xF; +} diff --git a/payloads/libpayload/curses/keyboard.c b/payloads/libpayload/curses/keyboard.c new file mode 100644 index 0000000000..6ab5dd0cf7 --- /dev/null +++ b/payloads/libpayload/curses/keyboard.c @@ -0,0 +1,303 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2007 Uwe Hermann + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +/* + * This file handles reading keystrokes from serial and the console + * and "cooking" them so that they are correct for curses. + * Also, implement key related functions (mainly wgetch) + * + * TODO: + * Actually cook the serial (handle special keys) + */ + +#include "local.h" + +/* ============== Serial ==================== */ + +/* FIXME: Cook the serial correctly */ + +static int cook_serial(unsigned char ch) +{ + return (int) ch; +} + +/* ================ Keyboard ================ */ + +/* Scancode macros */ + +#define DOWN(_c) (0x80 | (_c)) +#define UP(_c) (_c) + +#define ISDOWN(_c) ((_c) & 0x80) +#define ISUP(_c) (!ISDOWN((_c))) + +#define SCANCODE(_c) ((_c) & ~0x80) + +/* Scancode definitions for the modifiers */ + +#define SCANCODE_RSHIFT 0x36 +#define SCANCODE_LSHIFT 0x2a +#define SCANCODE_CAPSLOCK 0x3a +#define SCANCODE_LALT 0x38 +#define SCANCODE_LCTRL 0x1d + +/* Modifier flags */ + +#define SHIFT_MODIFIER 0x1 +#define CAPSLOCK_MODIFIER 0x2 +#define ALT_MODIFIER 0x4 +#define CTRL_MODIFIER 0x8 + +#define CTRL(_c) (_c & 0x1f) + +struct { + int normal; + int shift; +} scancode_map[] = { + { }, + { CTRL('['), CTRL('[')}, + { '1', '!' }, + { '2', '@' }, + { '3', '#' }, + { '4', '$' }, + { '5', '%' }, + { '6', '^' }, + { '7', '&' }, + { '8', '*' }, + { '9', '(' }, + { '0', ')' }, + { '-', '_' }, + { '=', '+' }, + { KEY_BACKSPACE, KEY_BACKSPACE}, + { CTRL('I' ), KEY_BTAB }, /* 0x0F */ + { 'q', 'Q' }, + { 'w', 'W' }, + { 'e', 'E' }, + { 'r', 'R' }, + { 't', 'T' }, + { 'y', 'Y' }, + { 'u', 'U' }, + { 'i', 'I' }, + { 'o', 'O' }, + { 'p', 'P' }, + { '[', '{' }, + { ']', '{' }, + { KEY_ENTER, KEY_ENTER }, + { 0 , 0 }, + { 'a', 'A' }, + { 's', 'S' }, /* 0x1F */ + { 'd', 'D' }, + { 'f', 'F' }, + { 'g', 'G' }, + { 'h', 'H' }, + { 'j', 'J' }, + { 'k', 'K' }, + { 'l', 'L' }, + { ';', ':' }, + { '\'', '\"' }, + { '`', '~', }, + { 0, 0 }, + { '\\', '|' }, + { 'z', 'Z' }, + { 'x', 'X' }, + { 'c', 'C' }, + { 'v', 'V' }, /* 0x2F */ + { 'b', 'B' }, + { 'n', 'N' }, + { 'm', 'M' }, + { ',', '<'}, + { '.', '>' }, + { '/', '?' }, + { 0, 0 }, /* RSHIFT */ + { '*', '*' }, + { 0, 0 }, /* LALT */ + { ' ', ' ' }, /* Space */ + { 0, 0 }, /* Capslock */ + { KEY_F(1), KEY_F(1) }, + { KEY_F(2), KEY_F(2) }, + { KEY_F(3), KEY_F(3) }, + { KEY_F(4), KEY_F(4) }, + { KEY_F(5), KEY_F(5) }, /* 0x3F */ + { KEY_F(6), KEY_F(6) }, + { KEY_F(7), KEY_F(7) }, + { KEY_F(8), KEY_F(8) }, + { KEY_F(9), KEY_F(9) }, + { KEY_F(10), KEY_F(10) }, + { 0, 0 }, /* Numlock */ + { 0, 0 }, /* Scroll lock */ + { KEY_HOME, KEY_HOME }, + { KEY_UP, KEY_UP }, + { KEY_PPAGE, KEY_PPAGE }, + { '-', '-' }, + { KEY_LEFT, KEY_LEFT }, + { 0, 0 }, + { KEY_RIGHT, KEY_RIGHT }, + { '-', '-' }, + { KEY_END, KEY_END }, /* 0x4F */ + { KEY_DOWN, KEY_DOWN }, + { KEY_NPAGE, KEY_NPAGE }, + { KEY_IC, KEY_IC }, + { KEY_DC, KEY_DC }, + { 0, 0 }, /* sysreq */ + { 0, 0 }, + { KEY_F(11), KEY_F(11) }, + { KEY_F(12), KEY_F(12) }, +}; + +static int cook_scancodes(unsigned char code) +{ + static int modifiers = 0; + int ch = 0, sc, shift; + + switch(code) { + case DOWN(SCANCODE_RSHIFT): + case DOWN(SCANCODE_LSHIFT): + modifiers |= SHIFT_MODIFIER; + return 0; + + case UP(SCANCODE_RSHIFT): + case UP(SCANCODE_LSHIFT): + modifiers &= ~SHIFT_MODIFIER; + return 0; + + case UP(SCANCODE_CAPSLOCK): + if (modifiers & CAPSLOCK_MODIFIER) + modifiers &= ~CAPSLOCK_MODIFIER; + else + modifiers |= CAPSLOCK_MODIFIER; + return 0; + + case DOWN(SCANCODE_LALT): + modifiers |= ALT_MODIFIER; + return 0; + + case UP(SCANCODE_LALT): + modifiers &= ~ALT_MODIFIER; + return 0; + + case DOWN(SCANCODE_LCTRL): + modifiers |= CTRL_MODIFIER; + return 0; + + case UP(SCANCODE_LCTRL): + modifiers &= ~CTRL_MODIFIER; + return 0; + } + + /* Only process keys on an upstroke */ + + if (!ISUP(code)) + return 0; + + sc = SCANCODE(code); + + if (sc == 0 || sc > 0x59) + return ERR; + + shift = (modifiers & SHIFT_MODIFIER) ^ (modifiers & CAPSLOCK_MODIFIER); + + ch = shift ? scancode_map[sc].shift : scancode_map[sc].normal; + + if (modifiers & CTRL_MODIFIER) + ch = (ch >= 0x3F && ch <= 0x5F) ? CTRL(ch) : 0; + + return ch; +} + +static int curses_getchar(int delay) { + + unsigned char c = 0; + int ret; + + do { + if (curses_flags & F_ENABLE_CONSOLE) + c = inb(0x64); + + if ((c & 1) == 0) { + + if ((curses_flags & F_ENABLE_SERIAL) && + serial_havechar()) { + c = serial_getchar(); + return cook_serial(c); + } + + if (!delay) + break; + } + + c = inb(0x60); + + ret = cook_scancodes(c); + + if (ret != 0) { + return ret; + } + + } while(1); + + return ERR; +} + +/* === Public functions === */ + +int wgetch(WINDOW *win) +{ + return curses_getchar(win->_delay); +} + +int nodelay(WINDOW *win, NCURSES_BOOL flag) +{ + win->_delay = flag ? 0 : -1; +} + +#ifdef CONFIG_VGA_CONSOLE +void curses_enable_vga(int state) +{ + if (state) + curses_flags |= F_ENABLE_CONSOLE; + else + curses_flags &= ~F_ENABLE_CONSOLE; +} +#else +void curses_enable_vga(int state) { } +#endif + +#ifdef CONFIG_SERIAL_CONSOLE +void curses_enable_serial(int state) +{ + if (state) + curses_flags |= F_ENABLE_SERIAL; + else + curses_flags &= ~F_ENABLE_SERIAL; +} +#else +void curses_enable_serial(int state) { } +#endif + diff --git a/payloads/libpayload/curses/local.h b/payloads/libpayload/curses/local.h new file mode 100644 index 0000000000..577fcd4000 --- /dev/null +++ b/payloads/libpayload/curses/local.h @@ -0,0 +1,94 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2007 Uwe Hermann + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef TINYCURSES_H +#define TINYCURSES_H + +/* For curses.priv.h: */ +#define USE_RCS_IDS 0 +#define DECL_ERRNO 0 +#define HAVE_LIBGPM 0 +#define NCURSES_EXT_FUNCS 0 +#define USE_OK_BCOPY 0 +#define USE_MY_MEMMOVE 0 +#define USE_SCROLL_HINTS 0 +#define USE_HASHMAP 0 +#define USE_WIDEC_SUPPORT 0 /* We do _not_ want wide character support. */ +// #define NCURSES_EXT_COLORS 1 +#define NCURSES_EXT_COLORS 0 +#define USE_SYSMOUSE 0 +#define NCURSES_NO_PADDING 0 +#define USE_HARD_TABS 0 +#define HAVE_FCNTL_H 0 +#define USE_XMC_SUPPORT 0 +#define NCURSES_EXPANDED 0 +#define HAVE_GETCWD 0 +#define USE_XMC_SUPPORT 0 +#define HAVE_STRSTR 0 +#define NO_LEAKS 0 +#define HAVE_RESIZETERM 0 +#define HAVE_VSSCANF 0 +#define BROKEN_LINKER 0 + +#undef USE_TERMLIB + +#include +#include +#include +#include +#include + +#define SCREEN_X 80 +#define SCREEN_Y 25 + +/* Flags used to determine what output methods are available */ + +#ifdef CONFIG_VGA_CONSOLE +#define F_ENABLE_CONSOLE 0x01 +#else +#define F_ENABLE_CONSOLE 0x00 +#endif + +#ifdef CONFIG_SERIAL_CONSOLE +#define F_ENABLE_SERIAL 0x02 +#else +#define F_ENABLE_SERIAL 0x00 +#endif + +extern int curses_flags; + +/* Share the color table for easy lookup */ +extern unsigned char color_pairs[256]; + +/* speaker.c */ +void speaker_enable(u16 freq); +void speaker_disable(void); +void speaker_tone(u16 freq, unsigned int duration); + +#endif /* TINYCURSES_H */ diff --git a/payloads/libpayload/curses/tinycurses.c b/payloads/libpayload/curses/tinycurses.c new file mode 100644 index 0000000000..dc6b77818b --- /dev/null +++ b/payloads/libpayload/curses/tinycurses.c @@ -0,0 +1,688 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2007 Uwe Hermann + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +/* + * This is a tiny implementation of the (n)curses library intended to be + * used in embedded/firmware/BIOS code where no libc or operating system + * environment is available and code size is very important. + * + * Design goals: + * - Small object code. + * - Self-contained. + * - Doesn't require a libc (no glibc/uclibc/dietlibc/klibc/newlib). + * - Works without any other external libraries or header files. + * - Works without an underlying operating system. + * - Doesn't use files, signals, syscalls, ttys, library calls, etc. + * - Doesn't do any dynamic memory allocation (no malloc() and friends). + * - All data structures are statically allocated. + * - Supports standard VGA console (80x25) and serial port console. + * - This includes character output and keyboard input over serial. + * - Supports beep() through a minimal PC speaker driver. + * + * Limitations: + * - Only implements a small subset of the (n)curses functions. + * - Only implements very few sanity checks (for smaller code). + * - Thus: Don't do obviously stupid things in your code. + * - Doesn't implement the 'form', 'panel', and 'menu' extentions. + * - Only implements C bindings (no C++, Ada95, or others). + * - Doesn't include wide character support. + */ + +#include "local.h" + +#undef _XOPEN_SOURCE_EXTENDED +#define _XOPEN_SOURCE_EXTENDED 1 + +#define MAX_WINDOWS 3 + +/* Statically allocate all structures (no malloc())! */ +static WINDOW window_list[MAX_WINDOWS]; +static int window_count = 1; + +// struct ldat foo; +static struct ldat ldat_list[3]; +static int ldat_count = 0; + +/* One item bigger than SCREEN_X to reverse place for a NUL byte. */ +static NCURSES_CH_T linebuf_list[SCREEN_Y * MAX_WINDOWS][SCREEN_X + 1]; +static int linebuf_count = 0; + +/* Globals */ +int COLORS; /* Currently unused? */ +int COLOR_PAIRS; +WINDOW *stdscr; +WINDOW *curscr; +WINDOW *newscr; +int LINES; +int COLS; +int TABSIZE; +int ESCDELAY; +// char ttytype[]; +// cchar_t *_nc_wacs; +SCREEN *SP; +chtype acs_map[128]; + +// FIXME: Ugly (and insecure!) hack! +char sprintf_tmp[1024]; + + +int curses_flags = (F_ENABLE_CONSOLE | F_ENABLE_SERIAL); + +/* Return bit mask for clearing color pair number if given ch has color */ +#define COLOR_MASK(ch) (~(attr_t)((ch) & A_COLOR ? A_COLOR : 0)) + +/* Compute a rendition of the given char correct for the current context. */ +static inline NCURSES_CH_T render_char(WINDOW *win, NCURSES_CH_T ch) +{ + /* TODO. */ + return ch; +} + +/* Make render_char() visible while still allowing us to inline it below. */ +NCURSES_CH_T _nc_render(WINDOW *win, NCURSES_CH_T ch) +{ + return render_char(win, ch); +} + +/* + * Implementations of most functions marked 'implemented' in tinycurses.h: + */ + +// int baudrate(void) {} +int beep(void) +{ + /* TODO: Flash the screen if beeping fails? */ + speaker_tone(1760, 500); /* 1760 == note A6 */ + return OK; +} +// bool can_change_color(void) {} +int cbreak(void) { /* TODO */ return 0; } +/* D */ int clearok(WINDOW *win, bool flag) { win->_clear = flag; return OK; } +// int color_content(short color, short *r, short *g, short *b) {} +// int curs_set(int) {} +// int def_prog_mode(void) {} +// int def_shell_mode(void) {} +// int delay_output(int) {} +// void delscreen(SCREEN *) {} +int delwin(WINDOW *win) +{ + /* TODO: Don't try to delete stdscr. */ + /* TODO: Don't delete parent windows before subwindows. */ + + // if (win->_flags & _SUBWIN) + // touchwin(win->_parent); + // else if (curscr != 0) + // touchwin(curscr); + + // return _nc_freewin(win); + return OK; +} +WINDOW *derwin(WINDOW *orig, int num_lines, int num_columns, int begy, int begx) +{ + WINDOW *win; + int i; + int flags = _SUBWIN; + + /* Make sure window fits inside the original one. */ + if (begy < 0 || begx < 0 || orig == 0 || num_lines < 0 || num_columns < 0) + return NULL; + if (begy + num_lines > orig->_maxy + 1 + || begx + num_columns > orig->_maxx + 1) + return NULL; + + if (num_lines == 0) + num_lines = orig->_maxy + 1 - begy; + + if (num_columns == 0) + num_columns = orig->_maxx + 1 - begx; + + if (orig->_flags & _ISPAD) + flags |= _ISPAD; + + //// if ((win = _nc_makenew(num_lines, num_columns, orig->_begy + begy, + //// orig->_begx + begx, flags)) == 0) + //// return NULL; + + win->_pary = begy; + win->_parx = begx; + WINDOW_ATTRS(win) = WINDOW_ATTRS(orig); + win->_nc_bkgd = orig->_nc_bkgd; + + for (i = 0; i < num_lines; i++) + win->_line[i].text = &orig->_line[begy++].text[begx]; + + win->_parent = orig; + + return win; +} +int doupdate(void) { /* TODO */ return(*(int *)0); } +// WINDOW * dupwin (WINDOW *) {} +/* D */ int echo(void) { SP->_echo = TRUE; return OK; } +int endwin(void) +{ + if (!SP) + return ERR; + + SP->_endwin = TRUE; + SP->_mouse_wrap(SP); + // _nc_screen_wrap(); + // _nc_mvcur_wrap(); /* wrap up cursor addressing */ + // return reset_shell_mode(); + return OK; // FIXME +} +// char erasechar (void) {} +// void filter (void) {} +// int flash(void) {} +// int flushinp (void) {} +// WINDOW *getwin (FILE *) {} + +bool has_colors (void) { /* TODO */ return(*(bool *)0); } +// bool has_ic (void) {} +// bool has_il (void) {} +// void idcok (WINDOW *, bool) {} +// int idlok (WINDOW *, bool) {} +void immedok(WINDOW *win, bool flag) { win->_immed = flag; } +/** Note: Must _not_ be called twice! */ +WINDOW *initscr(void) +{ + int x, y; + + // newterm(name, stdout, stdin); + // def_prog_mode(); + + if (curses_flags & F_ENABLE_CONSOLE) { + + /* Clear the screen and kill the cursor */ + + vga_clear(); + vga_cursor_enable(0); + } + + // Speaker init? + + stdscr = newwin(SCREEN_Y, SCREEN_X + 1, 0, 0); + // TODO: curscr, newscr? + + for (y = 0; y < stdscr->_maxy; y++) { + for (x = 0; x < stdscr->_maxx; x++) { + stdscr->_line[y].text[x].chars[0] = ' '; + stdscr->_line[y].text[x].attr = A_NORMAL; + } + } + + return stdscr; +} + +// int intrflush (WINDOW *,bool) {} +/* D */ bool isendwin(void) { return ((SP == NULL) ? FALSE : SP->_endwin); } +// bool is_linetouched (WINDOW *,int) {} +// bool is_wintouched (WINDOW *) {} +// NCURSES_CONST char * keyname (int) {} +int keypad (WINDOW *win, bool flag) { /* TODO */ return 0; } +// char killchar (void) {} +/* D */ int leaveok(WINDOW *win, bool flag) { win->_leaveok = flag; return OK; } +// char *longname (void) {} +// int meta (WINDOW *,bool) {} +// int mvcur (int,int,int,int) {} +// int mvderwin (WINDOW *, int, int) {} +int mvprintw(int y, int x, const char *fmt, ...) +{ + va_list argp; + int code; + + if (move(y, x) == ERR) + return ERR; + + va_start(argp, fmt); + code = vwprintw(stdscr, fmt, argp); + va_end(argp); + + return code; +} +// int mvscanw (int,int, NCURSES_CONST char *,...) {} +// int mvwin (WINDOW *,int,int) {} +int mvwprintw(WINDOW *win, int y, int x, const char *fmt, ...) +{ + va_list argp; + int code; + + if (wmove(win, y, x) == ERR) + return ERR; + + va_start(argp, fmt); + code = vwprintw(win, fmt, argp); + va_end(argp); + + return code; +} +// int mvwscanw (WINDOW *,int,int, NCURSES_CONST char *,...) {} +// int napms (int) {} +// WINDOW *newpad (int,int) {} +// SCREEN *newterm (NCURSES_CONST char *,FILE *,FILE *) {} +WINDOW *newwin(int num_lines, int num_columns, int begy, int begx) +{ + int i; + + /* Use next statically allocated window. */ + // TODO: Error handling. + // TODO: WINDOWLIST? + WINDOW *win = &window_list[window_count++]; + + // bool is_pad = (flags & _ISPAD); + + // TODO: Checks. + + win->_cury = 0; + win->_curx = 0; + win->_maxy = num_lines - 1; + win->_maxx = num_columns - 1; + win->_begy = begy; + win->_begx = begx; + // win->_yoffset = SP->_topstolen; + + win->_line = &ldat_list[ldat_count++]; + + /* FIXME: Is this right? Should the window attributes be normal? */ + win->_color - PAIR_NUMBER(0); + win->_attrs = A_NORMAL; + + for (i = 0; i < num_lines; i++) + win->_line[i].text = (NCURSES_CH_T *)&linebuf_list[linebuf_count++]; + + return win; +} +/* D */ int nl(void) { SP->_nl = TRUE; return OK; } +int nocbreak(void) { /* TODO */ return(*(int *)0); } + +/* D */ int noecho(void) { SP->_echo = FALSE; return OK; } +/* D */ int nonl(void) { SP->_nl = FALSE; return OK; } +// void noqiflush (void) {} +// int noraw (void) {} +// int notimeout (WINDOW *,bool) {} +// int overlay (const WINDOW*,WINDOW *) {} +// int overwrite (const WINDOW*,WINDOW *) {} +// int pair_content (short,short*,short*) {} +// int pechochar (WINDOW *, const chtype) {} +// int pnoutrefresh (WINDOW*,int,int,int,int,int,int) {} +// int prefresh (WINDOW *,int,int,int,int,int,int) {} +int printw(const char *fmt, ...) +{ + va_list argp; + int code; + + va_start(argp, fmt); + code = vwprintw(stdscr, fmt, argp); + va_end(argp); + + return code; +} +// int putwin (WINDOW *, FILE *) {} +// void qiflush (void) {} +// int raw (void) {} +// int resetty (void) {} +// int reset_prog_mode (void) {} +// int reset_shell_mode (void) {} +// int ripoffline (int, int (*)(WINDOW *, int)) {} +// int savetty (void) {} +// int scanw (NCURSES_CONST char *,...) {} +// int scr_dump (const char *) {} +// int scr_init (const char *) {} +/* D */ int scrollok(WINDOW *win, bool flag) { win->_scroll = flag; return OK; } +// int scr_restore (const char *) {} +// int scr_set (const char *) {} +// SCREEN *set_term (SCREEN *) {} +// int slk_attroff (const chtype) {} +// int slk_attron (const chtype) {} +// int slk_attrset (const chtype) {} +// attr_t slk_attr (void) {} +// int slk_attr_set (const attr_t,short,void*) {} +// int slk_clear (void) {} +// int slk_color (short) {} +// int slk_init (int) {} +/* D */ char *slk_label(int n) +{ + // TODO: Needed? + // if (SP == NULL || SP->_slk == NULL || n < 1 || n > SP->_slk->labcnt) + // return NULL; + return SP->_slk->ent[n - 1].ent_text; +} +// int slk_noutrefresh (void) {} +// int slk_refresh (void) {} +// int slk_restore (void) {} +// int slk_set (int,const char *,int) {} +// int slk_touch (void) {} + +// WINDOW *subpad (WINDOW *, int, int, int, int) {} +WINDOW *subwin(WINDOW *w, int l, int c, int y, int x) +{ + return derwin(w, l, c, y - w->_begy, x - w->_begx); +} +// int syncok (WINDOW *, bool) {} +// chtype termattrs (void) {} +// char *termname (void) {} +// int typeahead (int) {} +int ungetch(int ch) { /* TODO */ return ERR; } +// void use_env (bool) {} +// int vidattr (chtype) {} +// int vidputs (chtype, int (*)(int)) {} +int vwprintw(WINDOW *win, const char *fmt, va_list argp) +{ + vsprintf((char *)&sprintf_tmp, fmt, argp); + + /* TODO: Error handling? */ + return waddstr(win, (char *)&sprintf_tmp); +} +// int vwscanw (WINDOW *, NCURSES_CONST char *,va_list) {} +// int waddch (WINDOW *, const chtype) {} +int waddch(WINDOW *win, const chtype ch) +{ + int code = ERR; + // NCURSES_CH_T wch; + // SetChar2(wch, ch); + + win->_line[win->_cury].text[win->_curx].chars[0] = ch; + + /* Use the window attributes - perhaps we also pull attributes from + the ch itself, I don't know */ + + win->_line[win->_cury].text[win->_curx].attr = WINDOW_ATTRS(win); + win->_curx++; // FIXME + + // if (win && (waddch_nosync(win, wch) != ERR)) { + // _nc_synchook(win); + // code = OK; + // } + + return code; +} +// int waddchnstr (WINDOW *,const chtype *,int) {} +int waddnstr(WINDOW *win, const char *astr, int n) +{ + int code = OK; + const char *str = astr; + + if (!str) + return ERR; + + if (n < 0) + n = strlen(astr); + + while ((n-- > 0) && (*str != '\0')) { + // while (*str != '\0') { + win->_line[win->_cury].text[win->_curx].chars[0] = *str++; + win->_line[win->_cury].text[win->_curx].attr = WINDOW_ATTRS(win) +; + win->_curx++; // FIXME + + // NCURSES_CH_T ch; + // SetChar(ch, UChar(*str++), A_NORMAL); + // if (_nc_waddch_nosync(win, ch) == ERR) { + // code = ERR; + // break; + // } + } + return code; +} +int wattr_on(WINDOW *win, attr_t at, void *opts GCC_UNUSED) +{ + if (at & A_COLOR) + win->_color = PAIR_NUMBER(at); + // toggle_attr_on(WINDOW_ATTRS(win), at); + return OK; +} +int wattr_off(WINDOW *win, attr_t at, void *opts GCC_UNUSED) +{ + if (at & A_COLOR) + win->_color = 0; + // toggle_attr_off(WINDOW_ATTRS(win), at); + return 0; +} +// int wbkgd (WINDOW *, chtype) {} +void wbkgdset(WINDOW *win, chtype ch) { /* TODO */ } +// int wborder (WINDOW *,chtype,chtype,chtype,chtype,chtype,chtype,chtype,chtype) {} +// int wchgat (WINDOW *, int, attr_t, short, const void *) {} +/* D */ int wclear(WINDOW *win) +{ + if (werase(win) == ERR) + return ERR; + win->_clear = TRUE; + return OK; +} +// int wclrtobot (WINDOW *) {} +int wclrtoeol(WINDOW *win) { /* TODO */ return(*(int *)0); } +int wcolor_set(WINDOW *win, short color_pair_number, void *opts) +{ + if (!opts && (color_pair_number >= 0) + && (color_pair_number < COLOR_PAIRS)) { + SET_WINDOW_PAIR(win, color_pair_number); + if_EXT_COLORS(win->_color = color_pair_number); + return OK; + } + return ERR; +} +// void wcursyncup (WINDOW *) {} +// int wdelch (WINDOW *) {} +// int wechochar (WINDOW *, const chtype) {} +int werase(WINDOW *win) +{ + int x, y; + for (y = 0; y < win->_maxy; y++) { + for (x = 0; x < win->_maxx; x++) { + win->_line[y].text[x].chars[0] = ' '; + win->_line[y].text[x].attr = WINDOW_ATTRS(win); + } + } + return OK; +} + +// int wgetnstr (WINDOW *,char *,int) {} +int whline(WINDOW *win, chtype ch, int n) +{ + NCURSES_SIZE_T start, end; + struct ldat *line = &(win->_line[win->_cury]); + NCURSES_CH_T wch; + + start = win->_curx; + end = start + n - 1; + if (end > win->_maxx) + end = win->_maxx; + + CHANGED_RANGE(line, start, end); + + //// TODO: + //// if (ch == 0) + //// SetChar2(wch, ACS_HLINE); + //// else + //// SetChar2(wch, ch); + // Ugly hack: + wch.chars[0] = ((ch) & (chtype)A_CHARTEXT); + wch.attr = ((ch) & (chtype)A_ATTRIBUTES); + wch = _nc_render(win, wch); + + while (end >= start) { + line->text[end] = wch; + end--; + } + + //// _nc_synchook(win); + + return OK; +} +/* D */ chtype winch(WINDOW *win) +{ + //// TODO + // return (CharOf(win->_line[win->_cury].text[win->_curx]) | + // AttrOf(win->_line[win->_cury].text[win->_curx])); + return OK; // FIXME +} +// int winchnstr (WINDOW *, chtype *, int) {} +// int winnstr (WINDOW *, char *, int) {} +// int winsch (WINDOW *, chtype) {} +// int winsdelln (WINDOW *,int) {} +// int winsnstr (WINDOW *, const char *,int) {} +/* D */ int wmove(WINDOW *win, int y, int x) +{ + if (!LEGALYX(win, y, x)) + return ERR; + win->_curx = (NCURSES_SIZE_T) x; + win->_cury = (NCURSES_SIZE_T) y; + win->_flags &= ~_WRAPPED; + win->_flags |= _HASMOVED; + return OK; +} + + +int wnoutrefresh(WINDOW *win) +{ + // FIXME. + int x, y; + + for (y = 0; y < win->_maxy; y++) { + for (x = 0; x < win->_maxx; x++) { + if (curses_flags & F_ENABLE_SERIAL) + serial_putchar(win->_line[y].text[x].chars[0]); + + if (curses_flags & F_ENABLE_CONSOLE) { + attr_t attr = win->_line[y].text[x].attr; + unsigned int c = ((int) color_pairs[PAIR_NUMBER(attr)]) << 8; + + /* Handle some of the attributes */ + + if (attr & A_BOLD) { + c |= 0x0800; + } + if (attr & A_DIM) { + c &= ~0x800; + } + if (attr & A_REVERSE) { + unsigned char tmp = (c >> 8) & 0xF; + c = (c >> 4) & 0xF00; + c |= tmp << 12; + } + + c |= win->_line[y].text[x].chars[0]; + + + vga_putc(y, x, c); + } + } + } + + return OK; +} + +int wprintw(WINDOW *win, const char *fmt, ...) +{ + va_list argp; + int code; + + va_start(argp, fmt); + code = vwprintw(win, fmt, argp); + va_end(argp); + + return code; +} +// int wredrawln (WINDOW *,int,int) {} +int wrefresh(WINDOW *win) +{ + // FIXME + return wnoutrefresh(win); + + // XXX + int code; + + if (win == curscr) { + curscr->_clear = TRUE; + // code = doupdate(); + } else if ((code = wnoutrefresh(win)) == OK) { + if (win->_clear) + newscr->_clear = TRUE; + // code = doupdate(); + /* + * Reset the clearok() flag in case it was set for the special + * case in hardscroll.c (if we don't reset it here, we'll get 2 + * refreshes because the flag is copied from stdscr to newscr). + * Resetting the flag shouldn't do any harm, anyway. + */ + win->_clear = FALSE; + } + + return code; +} +// int wscanw (WINDOW *, NCURSES_CONST char *,...) {} +int wscrl(WINDOW *win, int n) +{ + if (!win->_scroll) + return ERR; + + if (n != 0) { + // _nc_scroll_window(win, n, win->_regtop, win->_regbottom, win->_nc_bkgd); + // _nc_synchook(win); + } + return OK; +} +int wsetscrreg(WINDOW *win, int top, int bottom) +{ + if (top >= 0 && top <= win->_maxy && bottom >= 0 && + bottom <= win->_maxy && bottom > top) { + win->_regtop = (NCURSES_SIZE_T) top; + win->_regbottom = (NCURSES_SIZE_T) bottom; + return OK; + } + return ERR; +} +// void wsyncdown (WINDOW *) {} +// void wsyncup (WINDOW *) {} +// void wtimeout (WINDOW *,int) {} +/* D */ int wtouchln(WINDOW *win, int y, int n, int changed) +{ + int i; + + // if ((n < 0) || (y < 0) || (y > win->_maxy)) + // return ERR; + + for (i = y; i < y + n; i++) { + if (i > win->_maxy) + break; + win->_line[i].firstchar = changed ? 0 : _NOCHANGE; + win->_line[i].lastchar = changed ? win->_maxx : _NOCHANGE; + } + return OK; +} +// int wvline (WINDOW *,chtype,int) {} +// int tigetflag (NCURSES_CONST char *) {} +// int tigetnum (NCURSES_CONST char *) {} +// char *tigetstr (NCURSES_CONST char *) {} +// int putp (const char *) {} +// #if NCURSES_TPARM_VARARGS +// char *tparm (NCURSES_CONST char *, ...) {} +// #else +// char *tparm (NCURSES_CONST char *, long,long,long,long,long,long,long,long,long) {} +// char *tparm_varargs (NCURSES_CONST char *, ...) {} +// #endif diff --git a/payloads/libpayload/drivers/Makefile.inc b/payloads/libpayload/drivers/Makefile.inc new file mode 100644 index 0000000000..809e2e211e --- /dev/null +++ b/payloads/libpayload/drivers/Makefile.inc @@ -0,0 +1,33 @@ +# +# This file is part of the libpayload project. +# +# Copyright (C) 2007 Uwe Hermann +# Copyright (C) 2008 Advanced Micro Devices, Inc. +# +# Redistribution and use in source and binary forms, with or without +# modification, are permitted provided that the following conditions +# are met: +# 1. Redistributions of source code must retain the above copyright +# notice, this list of conditions and the following disclaimer. +# 2. Redistributions in binary form must reproduce the above copyright +# notice, this list of conditions and the following disclaimer in the +# documentation and/or other materials provided with the distribution. +# 3. The name of the author may not be used to endorse or promote products +# derived from this software without specific prior written permission. +# +# THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND +# ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +# IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +# ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE +# FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +# DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +# OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +# HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +# OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +# SUCH DAMAGE. +# + +TARGETS-$(CONFIG_SERIAL_CONSOLE) += drivers/serial.o +TARGETS-$(CONFIG_VGA_CONSOLE) += drivers/vga.o +TARGETS-$(CONFIG_PC_KEYBOARD) += drivers/keyboard.o diff --git a/payloads/libpayload/drivers/keyboard.c b/payloads/libpayload/drivers/keyboard.c new file mode 100644 index 0000000000..0dc93713b8 --- /dev/null +++ b/payloads/libpayload/drivers/keyboard.c @@ -0,0 +1,126 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +#include + +unsigned char map[2][0x57] = { + { + 0x00, 0x1B, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, + 0x37, 0x38, 0x39, 0x30, 0x2D, 0x3D, 0x08, 0x09, + 0x71, 0x77, 0x65, 0x72, 0x74, 0x79, 0x75, 0x69, + 0x6F, 0x70, 0x5B, 0x5D, 0x0A, 0x00, 0x61, 0x73, + 0x64, 0x66, 0x67, 0x68, 0x6A, 0x6B, 0x6C, 0x3B, + 0x27, 0x60, 0x00, 0x5C, 0x7A, 0x78, 0x63, 0x76, + 0x62, 0x6E, 0x6D, 0x2C, 0x2E, 0x2F, 0x00, 0x2A, + 0x00, 0x20, + }, + { + 0x00, 0x1B, 0x21, 0x40, 0x23, 0x24, 0x25, 0x5E, + 0x26, 0x2A, 0x28, 0x29, 0x5F, 0x2B, 0x08, 0x00, + 0x51, 0x57, 0x45, 0x52, 0x54, 0x59, 0x55, 0x49, + 0x4F, 0x50, 0x7B, 0x7D, 0x0A, 0x00, 0x41, 0x53, + 0x44, 0x46, 0x47, 0x48, 0x4A, 0x4B, 0x4C, 0x3A, + 0x22, 0x7E, 0x00, 0x7C, 0x5A, 0x58, 0x43, 0x56, + 0x42, 0x4E, 0x4D, 0x3C, 0x3E, 0x3F, 0x00, 0x2A, + 0x00, 0x20, + } +}; + +#define MOD_SHIFT 1 +#define MOD_CTRL 2 +#define MOD_CAPSLOCK 4 + +int keyboard_havechar(void) +{ + unsigned char c = inb(0x64); + return c & 1; +} + +unsigned char keyboard_get_scancode(void) +{ + unsigned char ch = 0; + + if (keyboard_havechar()) + ch = inb(0x60); + + return ch; +} + +int keyboard_getchar(void) +{ + static int modifier; + unsigned char ch; + int shift; + + int ret = 0; + + while(!keyboard_havechar()) + ; + + ch = keyboard_get_scancode(); + + switch(ch) { + case 0x36: + case 0x2a: + modifier &= ~MOD_SHIFT; + break; + + case 0x80 | 0x36: + case 0x80 | 0x2a: + modifier |= MOD_SHIFT; + + case 0x1d: + modifier &= ~MOD_CTRL; + break; + + case 0x80 | 0x1d: + modifier |= MOD_CTRL; + break; + + case 0x3a: + if (modifier & MOD_CAPSLOCK) + modifier &= ~MOD_CAPSLOCK; + else + modifier |= MOD_CAPSLOCK; + break; + } + + if (!(ch & 0x80) && ch < 0x57) { + shift = (modifier & MOD_SHIFT) ^ (modifier & MOD_CAPSLOCK) ? 1 : 0; + ret = map[shift][ch]; + + if (modifier & MOD_CTRL) + ret = (ret >= 0x3F && ret <= 0x5F) ? ret & 0x1f : 0; + + return ret; + } + + return ret; +} diff --git a/payloads/libpayload/drivers/serial.c b/payloads/libpayload/drivers/serial.c new file mode 100644 index 0000000000..bcf60df614 --- /dev/null +++ b/payloads/libpayload/drivers/serial.c @@ -0,0 +1,78 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +#include + +#define IOBASE lib_sysinfo.ser_ioport + +#ifdef CONFIG_SERIAL_SET_SPEED +#define DIVISOR (115200 / CONFIG_SERIAL_BAUD_RATE) +#endif + +void serial_init(void) +{ +#ifdef CONFIG_SERIAL_SET_SPEED + unsigned char reg; + + /* Disable interrupts */ + outb(0, IOBASE + 0x01); + + /* Assert RTS and DTR */ + outb(3, IOBASE + 0x04); + + /* Set the divisor latch */ + reg = inb(IOBASE + 0x03); + outb(reg | 0x80, IOBASE + 0x03); + + /* Write the divisor */ + outb(DIVISOR & 0xFF, IOBASE); + outb(DIVISOR >> 8 & 0xFF, IOBASE + 1); + + /* Restore the previous value of the divisor */ + outb(reg &= ~0x80, IOBASE + 0x03); +#endif +} + +void serial_putchar(unsigned char c) +{ + while((inb(IOBASE + 0x05) & 0x20) == 0); + outb(c, IOBASE); +} + +int serial_havechar(void) +{ + return inb(IOBASE + 0x05) & 0x01; +} + +int serial_getchar(void) +{ + while (!serial_havechar()); + return (int) inb(IOBASE); +} diff --git a/payloads/libpayload/drivers/vga.c b/payloads/libpayload/drivers/vga.c new file mode 100644 index 0000000000..5e0e406f27 --- /dev/null +++ b/payloads/libpayload/drivers/vga.c @@ -0,0 +1,216 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +#include + +#define WIDTH 80 +#define HEIGHT 25 + +#define VGA_COLOR_WHITE 7 + +#define CRTC_INDEX 0x3d4 +#define CRTC_DATA 0x3d5 + +#define VIDEO(_r, _c)\ + ((uint16_t *) (0xB8000 + ((_r) * (WIDTH * 2)) + ((_c) * 2))) + +static int cursor_enabled; +static int cursorx; +static int cursory; + +static void vga_scroll_up(void); + +static inline uint8_t crtc_read(uint8_t index) +{ + outb(index, CRTC_INDEX); + return inb(CRTC_DATA); +} + +static inline void crtc_write(uint8_t data, uint8_t index) +{ + outb(index, CRTC_INDEX); + outb(data, CRTC_DATA); +} + +static void vga_get_cursor_pos(void) +{ + unsigned int addr; + addr = ((unsigned int) crtc_read(0x0E)) << 8; + addr += crtc_read(0x0E); + + cursorx = addr % WIDTH; + cursory = addr / WIDTH; +} + +static void vga_fixup_cursor(void) +{ + unsigned int addr; + + if (!cursor_enabled) + return; + + if (cursorx < 0) + cursorx = 0; + + if (cursory < 0) + cursory = 0; + + if (cursorx >= WIDTH) { + cursorx = 0; + cursory++; + } + + while(cursory >= HEIGHT) + vga_scroll_up(); + + addr = cursorx + (WIDTH * cursory); + crtc_write(addr >> 8, 0x0E); + crtc_write(addr, 0x0E); +} + +void vga_cursor_enable(int state) +{ + unsigned char tmp = crtc_read(0x0a); + + if (state == 0) { + tmp |= (1 << 5); + cursor_enabled = 0; + } + else { + tmp &= ~(1 << 5); + cursor_enabled = 1; + vga_fixup_cursor(); + } + + crtc_write(tmp, 0x0a); +} + +void vga_clear_line(uint8_t row, uint8_t ch, uint8_t attr) +{ + int col; + uint16_t *ptr = VIDEO(0, row); + + for(col = 0; col < WIDTH; col++) + ptr[col] = ((attr & 0xFF) << 8) | (ch & 0xFF); +} + +static void vga_scroll_up(void) +{ + uint16_t *src = VIDEO(0,1); + uint16_t *dst = VIDEO(0,0); + int i; + + for(i = 0; i < (HEIGHT - 1) * WIDTH; i++) + *dst++ = *src++; + + vga_clear_line(HEIGHT - 1, ' ', VGA_COLOR_WHITE); + cursory--; +} + +void vga_fill(uint8_t ch, uint8_t attr) +{ + uint8_t row; + for(row = 0; row < HEIGHT; row++) + vga_clear_line(row, ch, attr); +} + +void vga_clear(void) +{ + vga_fill(' ', VGA_COLOR_WHITE); + vga_move_cursor(0, 0); +} + +void vga_putc(uint8_t row, uint8_t col, unsigned int c) +{ + uint16_t *ptr = VIDEO(row, col); + *ptr = (uint16_t) (c & 0xFFFF); +} + +void vga_putchar(unsigned int ch) { + + uint16_t *ptr; + + switch(ch & 0xFF) { + case '\r': + cursorx = 0; + break; + case '\n': + cursory++; + break; + case '\b': + cursorx--; + ptr = VIDEO(cursory, cursorx); + *ptr = (*ptr & 0xFF00) | ' '; + break; + case '\t': + cursorx = (cursorx + 8) & ~7; + break; + + default: + ptr = VIDEO(cursory, cursorx); + *ptr = (uint16_t) (ch & 0xFFFF); + cursorx++; + break; + } + + vga_fixup_cursor(); +} + +int vga_move_cursor(int x, int y) +{ + cursorx = x; + cursory = y; + + vga_fixup_cursor(); +} + +void vga_init(void) +{ + /* Get the position of the cursor */ + vga_get_cursor_pos(); + + /* See if it us currently enabled or not */ + cursor_enabled = !(crtc_read(0x0A) & (1 << 5)); + + /* If the cursor is enabled, get us to a sane point */ + + if (cursor_enabled) { + + /* Go to the next line */ + + if (cursorx) { + cursorx = 0; + cursory++; + } + + vga_fixup_cursor(); + } +} + diff --git a/payloads/libpayload/i386/Makefile.inc b/payloads/libpayload/i386/Makefile.inc new file mode 100644 index 0000000000..75b0749973 --- /dev/null +++ b/payloads/libpayload/i386/Makefile.inc @@ -0,0 +1,31 @@ +# +# This file is part of the libpayload project. +# +# Copyright (C) 2008 Advanced Micro Devices, Inc. +# +# Redistribution and use in source and binary forms, with or without +# modification, are permitted provided that the following conditions +# are met: +# 1. Redistributions of source code must retain the above copyright +# notice, this list of conditions and the following disclaimer. +# 2. Redistributions in binary form must reproduce the above copyright +# notice, this list of conditions and the following disclaimer in the +# documentation and/or other materials provided with the distribution. +# 3. The name of the author may not be used to endorse or promote products +# derived from this software without specific prior written permission. +# +# THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND +# ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +# IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +# ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE +# FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +# DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +# OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +# HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +# OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +# SUCH DAMAGE. +# + +TARGETS-y += i386/head.o i386/main.o i386/sysinfo.o +TARGETS-y += i386/timer.o i386/coreboot.o i386/util.o diff --git a/payloads/libpayload/i386/coreboot.c b/payloads/libpayload/i386/coreboot.c new file mode 100644 index 0000000000..6d310d0325 --- /dev/null +++ b/payloads/libpayload/i386/coreboot.c @@ -0,0 +1,147 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +#include +#include +#include + +/* Some of this is x86 specific, and the rest of it + is generic. Right now, since we only support x86, + we'll avoid trying to make lots of infrastructure + we don't need. If in the future, we want to use + coreboot on some other architecture, then take out + the generic parsing code and move it elsewhere +*/ + +/* === Parsing code === */ +/* This is the generic parsing code */ + +static void cb_parse_memory(unsigned char *ptr, struct sysinfo_t *info) +{ + struct cb_memory *mem = (struct cb_memory *) ptr; + int count = MEM_RANGE_COUNT(mem); + int i; + + if (count > SYSINFO_MAX_MEM_RANGES) + count = SYSINFO_MAX_MEM_RANGES; + + info->n_memranges = 0; + + for(i = 0; i < count; i++) { + struct cb_memory_range *range = + (struct cb_memory_range *) MEM_RANGE_PTR(mem, i); + + if (range->type != CB_MEM_RAM) + continue; + + info->memrange[info->n_memranges].base = + UNPACK_CB64(range->start); + + info->memrange[info->n_memranges].size = + UNPACK_CB64(range->size); + + info->n_memranges++; + } +} + +static void cb_parse_serial(unsigned char *ptr, struct sysinfo_t *info) +{ + struct cb_serial *ser = (struct cb_serial *) ptr; + info->ser_ioport = ser->ioport; +} + +static int cb_parse_header(void *addr, int len, struct sysinfo_t *info) +{ + struct cb_header *header; + unsigned char *ptr = (unsigned char *) addr; + int i; + + for (i = 0; i < len; i += 16, ptr += 16) { + header = (struct cb_header *) ptr; + + if (!strncmp(header->signature, "LBIO", 4)) + break; + } + + /* We walked the entire space and didn't find anything */ + + if (i >= len) + return -1; + + if (!header->table_bytes) + return 0; + + /* Make sure the checksums match */ + + if (ipchksum((uint16_t *) header, sizeof(*header)) != 0) + return -1; + + if (ipchksum((uint16_t *) (ptr + sizeof(*header)), + header->table_bytes) != header->table_checksum) + return -1; + + /* Now, walk the tables */ + ptr += header->header_bytes; + + for(i = 0; i < header->table_entries; i++) { + struct cb_record *rec = (struct cb_record *) ptr; + + /* We only care about a few tags here - maybe + more will be interesting later + */ + + switch(rec->tag) { + case CB_TAG_MEMORY: + cb_parse_memory(ptr, info); + break; + + case CB_TAG_SERIAL: + cb_parse_serial(ptr, info); + break; + } + + ptr += rec->size; + } + + return 1; +} + +/* == Architecture specific ==*/ +/* This is the x86 specific stuff */ + +int get_coreboot_info(struct sysinfo_t *info) +{ + int ret = cb_parse_header((void *) 0x0, 0x1000, info); + + if (ret != 1) + ret = cb_parse_header((void *) 0xf0000, 0x1000, info); + + return (ret == 1) ? 0 : -1; +} diff --git a/payloads/libpayload/i386/head.S b/payloads/libpayload/i386/head.S new file mode 100644 index 0000000000..1278bdf4ed --- /dev/null +++ b/payloads/libpayload/i386/head.S @@ -0,0 +1,85 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + + .global _entry, _leave + .text + .align 4 + +/* Our entry point - assume that the CPU is in + * 32 bit protected mode and all segments are in a + * flat model. Thats our operating mode, so we won't + * change anything + */ + +_entry: + call _init + + /* We're back - go back to the bootloader */ + ret + +/* This function saves off the previous stack and + switches us to our own execution enviornment +*/ + +_init: + /* No interrupts, please */ + cli + + /* Get the current stack pointer */ + movl %esp, %esi + + movl _istack, %ebx + + /* lret needs %cs in the stack, so copy it over */ + movw %cs, 4(%ebx) + + /* Exchange the current stack pointer for the one in + the initial stack (which happens to be the new + stack pointer) */ + + xchgl %esi, 16(%ebx) + + /* Set the new stack pointer */ + movl %esi, %esp + + /* Return into the main entry function + and go + */ + + lret + +_leave: + movl _istack, %ebx + + /* Restore the stack pointer from the storage area */ + movl 16(%ebx), %esp + + /* Return to the original context */ + lret + diff --git a/payloads/libpayload/i386/main.c b/payloads/libpayload/i386/main.c new file mode 100644 index 0000000000..846d46a426 --- /dev/null +++ b/payloads/libpayload/i386/main.c @@ -0,0 +1,79 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include + +/* This structure seeds the stack. We provide + the return address of our main function, and + further down, the address of the function + that we call when we leave and try to restore + the original stack. At the very bottom of the + stack we store the orignal stack pointer + from the calling application +*/ + +static void start_main(void); +extern void _leave(void); + +static struct { + uint32_t eip[2]; + uint32_t raddr[2]; + uint32_t esp; +} initial_stack __attribute__((section (".istack"))) = { + { (uint32_t) start_main, 0 }, + { (uint32_t) _leave, 0 }, + (uint32_t) &initial_stack, +}; + +void * _istack = &initial_stack; + +/* This is our C entry function - set up the system + and jump into the payload entry point */ + +static void start_main(void) +{ + extern int main(void); + + /* Set up the consoles */ + console_init(); + + /* Gather system information */ + lib_get_sysinfo(); + + /* Any other system init that has to happen before the + user gets control goes here. */ + + /* Go to the entry point */ + + /* in the future we may care about the return value */ + (void) main(); + + /* Returning here will go to the _leave function to return + us to the original context */ +} diff --git a/payloads/libpayload/i386/sysinfo.c b/payloads/libpayload/i386/sysinfo.c new file mode 100644 index 0000000000..1fdf3fc419 --- /dev/null +++ b/payloads/libpayload/i386/sysinfo.c @@ -0,0 +1,70 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +#include + +/* This is a global structure that is used through the + library - we set it up initially with some dummy + values - hopefully they will be overridden +*/ + +struct sysinfo_t lib_sysinfo = { + . cpu_khz = 200, + . ser_ioport = CONFIG_SERIAL_IOBASE, +}; + +void lib_get_sysinfo(void) +{ + /* Get the CPU speed (for delays) */ + lib_sysinfo.cpu_khz = get_cpu_speed(); + + /* Get the memory information */ + + get_coreboot_info(&lib_sysinfo); + + if (!lib_sysinfo.n_memranges) { + + /* If we couldn't get a good memory range, + then use a hard coded default */ + + lib_sysinfo.n_memranges = 2; + + lib_sysinfo.memrange[0].base = 0; + lib_sysinfo.memrange[0].size = 640 * 1024; + lib_sysinfo.memrange[1].base = 1024 * 1024; + lib_sysinfo.memrange[1].size = 31 * 1024 * 1024; + } +} + + + + + + diff --git a/payloads/libpayload/i386/timer.c b/payloads/libpayload/i386/timer.c new file mode 100644 index 0000000000..72a3ee8f48 --- /dev/null +++ b/payloads/libpayload/i386/timer.c @@ -0,0 +1,92 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +#include + +static unsigned int cpu_khz; + +/* Calculate the speed of the processor for use in delays */ + +void get_cpu_speed(void) +{ + unsigned long long start, end; + + /* Set up the PPC port - disable the speaker, + * enable the T2 gate */ + + outb((inb(0x61) & ~0x02) | 0x01, 0x61); + + /* Set the PIT to Mode 0, counter 2, word access */ + outb(0xB0, 0x43); + + /* Load the counter with 0xFFFF */ + + outb(0xFF, 0x42); + outb(0xFF, 0x42); + + /* Read the number of ticks during the period */ + + start = rdtsc(); + while(!(inb(0x61) & 0x20)); + end = rdtsc(); + + /* The clock rate is 1193180 Hz + * the number of miliseconds for a period + * of 0xFFFF is 1193180 / (0xFFFF * 1000) + * or .0182. Multiply that by the number of + * measured clocks to get the khz value + */ + + cpu_khz = + (unsigned int ) ((end - start) * 1193180U / (1000 * 0xFFFF)); +} + +/* Global delay functions */ + +static inline void _delay(unsigned int delta) +{ + unsigned long long timeout = rdtsc() + delta; + while (rdtsc() < timeout); +} + +void ndelay(unsigned int n) +{ + _delay(n * cpu_khz / 1000000); +} + +void mdelay(unsigned int m) +{ + _delay(m * cpu_khz); +} + +void delay(unsigned int s) +{ + _delay(s * cpu_khz * 1000); +} diff --git a/payloads/libpayload/i386/util.S b/payloads/libpayload/i386/util.S new file mode 100644 index 0000000000..a0b1b0980d --- /dev/null +++ b/payloads/libpayload/i386/util.S @@ -0,0 +1,38 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + .global halt + .text + .align 4 + +/* This function puts the system into a halt. */ + +halt: + cli + hlt + jmp halt diff --git a/payloads/libpayload/include/arch/io.h b/payloads/libpayload/include/arch/io.h new file mode 100644 index 0000000000..dcf5bd97ea --- /dev/null +++ b/payloads/libpayload/include/arch/io.h @@ -0,0 +1,77 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef _X86_ARCH_IO_H_ +#define _X86_ARCH_IO_H_ + +#define readb(_a) (*(volatile unsigned char *) (_a)) +#define readw(_a) (*(volatile unsigned short *) (_a)) +#define readl(_a) (*(volatile unsigned long *) (_a)) + +#define writeb(_v, _a) (*(volatile unsigned char *) (_a) = (_v)) +#define writew(_v, _a) (*(volatile unsigned short *) (_a) = (_v)) +#define writel(_v, _a) (*(volatile unsigned long *) (_a) = (_v)) + +static inline unsigned long inl(int port) +{ + unsigned long val; + __asm__ __volatile__("inl %w1, %0" : "=a"(val) : "Nd"(port)); + return val; +} + +static inline unsigned short inw(int port) +{ + unsigned short val; + __asm__ __volatile__("inw %w1, %w0" : "=a"(val) : "Nd"(port)); + return val; +} + +static inline unsigned char inb(int port) +{ + unsigned char val; + __asm__ __volatile__("inb %w1, %b0" : "=a"(val) : "Nd"(port)); + return val; +} + +static inline void outl(unsigned long val, int port) +{ + __asm__ __volatile__("outl %0, %w1" : : "a"(val), "Nd"(port)); +} + +static inline void outw(unsigned short val, int port) +{ + __asm__ __volatile__("outw %w0, %w1" : : "a"(val), "Nd"(port)); +} + +static inline void outb(unsigned char val, int port) +{ + __asm__ __volatile__("outb %b0, %w1" : : "a"(val), "Nd"(port)); +} + +#endif diff --git a/payloads/libpayload/include/arch/rdtsc.h b/payloads/libpayload/include/arch/rdtsc.h new file mode 100644 index 0000000000..1addedafc8 --- /dev/null +++ b/payloads/libpayload/include/arch/rdtsc.h @@ -0,0 +1,40 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef _RDTSC_H_ +#define _RDTSC_H_ + +static inline unsigned long long rdtsc(void) +{ + unsigned long long val; + __asm__ __volatile__ ("rdtsc" : "=A" (val)); + return val; +} + +#endif diff --git a/payloads/libpayload/include/arch/types.h b/payloads/libpayload/include/arch/types.h new file mode 100644 index 0000000000..d1f3acda5b --- /dev/null +++ b/payloads/libpayload/include/arch/types.h @@ -0,0 +1,57 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2007 Uwe Hermann + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef _ARCH_X86_TYPES_H +#define _ARCH_X86_TYPES_H + +typedef unsigned char uint8_t; +typedef unsigned char u8; +typedef signed char int8_t; +typedef signed char s8; + +typedef unsigned short uint16_t; +typedef unsigned short u16; +typedef signed short int16_t; +typedef signed short s16; + +typedef unsigned int uint32_t; +typedef unsigned int u32; +typedef signed int int32_t; +typedef signed int s32; + +typedef unsigned long long uint64_t; +typedef unsigned long long u64; +typedef signed long long int64_t; +typedef signed long long s64; + +#ifndef NULL +#define NULL ((void *)0) +#endif + +#endif diff --git a/payloads/libpayload/include/coreboot_tables.h b/payloads/libpayload/include/coreboot_tables.h new file mode 100644 index 0000000000..1542157ca7 --- /dev/null +++ b/payloads/libpayload/include/coreboot_tables.h @@ -0,0 +1,151 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef _COREBOOT_TABLES_H_ +#define _COREBOOT_TABLES_H_ + +#include + +struct cbuint64 { + uint32_t lo; + uint32_t hi; +}; + +struct cb_header { + uint8_t signature[4]; + uint32_t header_bytes; + uint32_t header_checksum; + uint32_t table_bytes; + uint32_t table_checksum; + uint32_t table_entries; +}; + +struct cb_record { + uint32_t tag; + uint32_t size; +}; + +#define CB_TAG_UNUSED 0x0000 +#define CB_TAG_MEMORY 0x0001 + +struct cb_memory_range { + struct cbuint64 start; + struct cbuint64 size; + uint32_t type; +}; + +#define CB_MEM_RAM 1 +#define CB_MEM_RESERVED 2 +#define CB_MEM_TABLE 16 + +struct cb_memory { + uint32_t tag; + uint32_t size; + struct cb_memory_range map[0]; +}; + +#define CB_TAG_HWRPB 0x0002 + +struct cb_hwrpb { + uint32_t tag; + uint32_t size; + uint64_t hwrpb; +}; + +#define CB_TAG_MAINBOARD 0x0003 + +struct cb_mainboard { + uint32_t tag; + uint32_t size; + uint8_t vendor_idx; + uint8_t part_number_idx; + uint8_t strings[0]; +}; + +#define CB_TAG_VERSION 0x0004 +#define CB_TAG_EXTRA_VERSION 0x0005 +#define CB_TAG_BUILD 0x0006 +#define CB_TAG_COMPILE_TIME 0x0007 +#define CB_TAG_COMPILE_BY 0x0008 +#define CB_TAG_COMPILE_HOST 0x0009 +#define CB_TAG_COMPILE_DOMAIN 0x000a +#define CB_TAG_COMPILER 0x000b +#define CB_TAG_LINKER 0x000c +#define CB_TAG_ASSEMBLER 0x000d + +struct cb_string { + uint32_t tag; + uint32_t size; + uint8_t string[0]; +}; + +#define CB_TAG_SERIAL 0x000f + +struct cb_serial { + uint32_t tag; + uint32_t size; + uint16_t ioport; +}; + +#define CB_TAG_CONSOLE 0x00010 + +struct cb_console { + uint32_t tag; + uint32_t size; + uint16_t type; +}; + +#define CB_TAG_CONSOLE_SERIAL8250 0 +#define CB_TAG_CONSOLE_VGA 1 +#define CB_TAG_CONSOLE_BTEXT 2 +#define CB_TAG_CONSOLE_LOGBUF 3 +#define CB_TAG_CONSOLE_SROM 4 +#define CB_TAG_CONSOLE_EHCI 5 + +/* Still to come: CMOS information */ + +/* Helpful macros */ + +#define MEM_RANGE_COUNT(_rec) \ + (((_rec)->size - sizeof(*(_rec))) / sizeof((_rec)->map[0])) + +#define MEM_RANGE_PTR(_rec, _idx) \ + (((uint8_t *) (_rec)) + sizeof(*(_rec)) \ + + (sizeof((_rec)->map[0]) * (_idx))) + +#define MB_VENDOR_STRING(_mb) \ + (((unsigned char *) ((_mb)->strings)) + (_mb)->vendor_idx) + +#define MB_PART_STRING(_mb) \ + (((unsigned char *) ((_mb)->strings)) + (_mb)->part_number_idx) + +#define UNPACK_CB64(_in) \ + ( (((uint64_t) _in.hi) << 32) | _in.lo ) + +#endif diff --git a/payloads/libpayload/include/libpayload.h b/payloads/libpayload/include/libpayload.h new file mode 100644 index 0000000000..84518563d6 --- /dev/null +++ b/payloads/libpayload/include/libpayload.h @@ -0,0 +1,99 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef LIBPAYLOAD_H_ +#define LIBPAYLOAD_H_ + +#include +#include +#include +#include +#include + +#define MIN(a,b) ((a) < (b) ? (a) : (b)) +#define MAX(a,b) ((a) > (b) ? (a) : (b)) +#define ARRAY_SIZE(a) (sizeof(a) / sizeof((a)[0])) + +/* serial.c */ +void serial_putchar(unsigned char c); + +/* console.c */ +int putchar(int c); +extern int last_putchar; + +#define havechar havekey + +/* ctype.c */ +int isspace(int c); +int isdigit(int c); +int tolower(int c); + +/* malloc.c */ +void *malloc(size_t size); +void free(void *ptr); +void *calloc(size_t nmemb, size_t size); +void *realloc(void *ptr, size_t size); + +/* memory.c */ +int memcmp(const char *s1, const char *s2, size_t len); +void *memcpy(void *dst, const void *src, size_t n); +void *memset(void *s, int c, size_t n); +void *memmove(void *dst, const void *src, size_t n); + +/* printf.c */ +int sprintf(char *str, const char *fmt, ...); +int vsnprintf(char *str, size_t size, const char *fmt, va_list ap); +int vsprintf(char *str, const char *fmt, va_list ap); +int printf(const char *fmt, ...); +int vprintf(const char *fmt, va_list ap); + +/* string.c */ +size_t strnlen(const char *src, size_t max); +size_t strlen(const char *src); +int strcmp(const char *s1, const char *s2); +char *strdup(const char *s); +char *strchr(const char *s, int c); +char *strncpy(char *to, const char *from, int count); +char * strcpy (char *dest, const char *src); +char * strstr (const char *s1, const char *s2); + +/* ipchchecksum.c */ +unsigned short ipchksum(const unsigned short *ptr, unsigned long nbytes); + +/* util.S */ +#define abort() halt() +void halt(void) __attribute__ ((noreturn)); + +/* Timer functions - defined by each arcitecture */ + +void ndelay(unsigned int); +void mdelay(unsigned int); +void delay(unsigned int); + +#endif diff --git a/payloads/libpayload/include/sysinfo.h b/payloads/libpayload/include/sysinfo.h new file mode 100644 index 0000000000..ff39765b76 --- /dev/null +++ b/payloads/libpayload/include/sysinfo.h @@ -0,0 +1,53 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#ifndef _SYSINFO_H_ +#define _SYSINFO_H_ + +/* Allow a maximum of 16 memory range definitions */ + +#define SYSINFO_MAX_MEM_RANGES 16 + +struct sysinfo_t { + unsigned int cpu_khz; + unsigned short ser_ioport; + + int n_memranges; + + struct { + unsigned long long base; + unsigned long long size; + } memrange[SYSINFO_MAX_MEM_RANGES]; +}; + +extern struct sysinfo_t lib_sysinfo; +void lib_get_sysinfo(void); + +#endif + diff --git a/payloads/libpayload/libc/Makefile.inc b/payloads/libpayload/libc/Makefile.inc new file mode 100644 index 0000000000..f42f836174 --- /dev/null +++ b/payloads/libpayload/libc/Makefile.inc @@ -0,0 +1,32 @@ +# +# This file is part of the libpayload project. +# +# Copyright (C) 2008 Advanced Micro Devices, Inc. +# +# Redistribution and use in source and binary forms, with or without +# modification, are permitted provided that the following conditions +# are met: +# 1. Redistributions of source code must retain the above copyright +# notice, this list of conditions and the following disclaimer. +# 2. Redistributions in binary form must reproduce the above copyright +# notice, this list of conditions and the following disclaimer in the +# documentation and/or other materials provided with the distribution. +# 3. The name of the author may not be used to endorse or promote products +# derived from this software without specific prior written permission. +# +# THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND +# ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +# IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +# ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE +# FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +# DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +# OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +# HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +# OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +# SUCH DAMAGE. +# + +TARGETS-y += libc/malloc.o libc/printf.o libc/console.o libc/string.o +TARGETS-y += libc/memory.o libc/ctype.o +TARGETS-y += libc/ipchecksum.o diff --git a/payloads/libpayload/libc/console.c b/payloads/libpayload/libc/console.c new file mode 100644 index 0000000000..bb7dec1f94 --- /dev/null +++ b/payloads/libpayload/libc/console.c @@ -0,0 +1,104 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include + +void console_init(void) +{ +#ifdef CONFIG_VGA_CONSOLE + vga_init(); +#endif +#ifdef CONFIG_SERIAL_CONSOLE + serial_init(); +#endif +} + +static void device_putchar(unsigned char c) +{ +#ifdef CONFIG_VGA_CONSOLE + vga_putchar(0x700| c); +#endif +#ifdef CONFIG_SERIAL_CONSOLE + serial_putchar(c); +#endif +} + +int putchar(int c) +{ + c &= 0xff; + if (c == '\n') + device_putchar('\r'); + device_putchar(c); + return c; +} + +int puts(const char *s) +{ + int n = 0; + + while (*s) { + putchar(*s++); + n++; + } + + putchar('\n'); + return n+1; +} + +int havekey(void) +{ +#ifdef CONFIG_SERIAL_CONSOLE + if (serial_havechar()) + return 1; +#endif +#ifdef CONFIG_PC_KEYBOARD + if (keyboard_havechar()) + return 1; +#endif + return 0; +} + +/* This returns an ascii value - the two getchar functions + cook the respective input from the device +*/ + +int getchar(void) +{ + while (1) { +#ifdef CONFIG_SERIAL_CONSOLE + if (serial_havechar()) + return serial_getchar(); +#endif +#ifdef CONFIG_PC_KEYBOARD + if (keyboard_havechar()) + return keyboard_getchar(); +#endif + } +} + diff --git a/payloads/libpayload/libc/ctype.c b/payloads/libpayload/libc/ctype.c new file mode 100644 index 0000000000..c2f42a52d2 --- /dev/null +++ b/payloads/libpayload/libc/ctype.c @@ -0,0 +1,60 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +/* Basic ctype functions */ + +#include + +int isspace(int c) +{ + switch (c) { + case ' ': case '\f': case '\n': + case '\r': case '\t': case '\v': + return 1; + default: + return 0; + } +} + +int isdigit(int c) +{ + switch (c) { + case '0'...'9': + return 1; + default: + return 0; + } +} + +int tolower(int c) +{ + if (c >= 'A' && c <= 'Z') + return c - 'A' + 'a'; + return c; +} diff --git a/payloads/libpayload/libc/malloc.c b/payloads/libpayload/libc/malloc.c new file mode 100644 index 0000000000..a4877e67d9 --- /dev/null +++ b/payloads/libpayload/libc/malloc.c @@ -0,0 +1,262 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +/* This is a classically weak malloc() implmentation. + We have a relatively small and static heap, so we take + the easy route with an O(N) loop through the tree for + every malloc() and free(). Obviously, this doesn't scale + past a few hundred K (if that). + + We're also susecptable to the usual buffer overun poisoning, + though the risk is within acceptable ranges for this + implementation (don't overrun your buffers, kids!) +*/ + +#include + +/* Defined in the ldscript */ +extern char _heap, _eheap; + +static void *hstart = (void *) &_heap; +static void *hend = (void *) &_eheap; + +typedef unsigned int hdrtype_t; + +#define MAGIC (0x2a << 26) +#define FLAG_FREE (1 << 25) +#define FLAG_USED (1 << 24) + +#define SIZE(_h) ((_h) & 0xFFFFFF) + +#define _HEADER(_s, _f) ((hdrtype_t) (MAGIC | (_f) | ((_s) & 0xFFFFFF))) + +#define FREE_BLOCK(_s) _HEADER(_s, FLAG_FREE) +#define USED_BLOCK(_s) _HEADER(_s, FLAG_USED) + +#define HDRSIZE (sizeof(hdrtype_t)) + +#define IS_FREE(_h) (((_h) & (MAGIC | FLAG_FREE)) == (MAGIC | FLAG_FREE)) +#define HAS_MAGIC(_h) (((_h) & MAGIC) == MAGIC) + +void print_malloc_map(void); + +static void setup(void) +{ + int size = (unsigned int) (_heap - _eheap) - HDRSIZE; + *((hdrtype_t *) hstart) = FREE_BLOCK(size); +} + +static void *alloc(int len) +{ + hdrtype_t header; + void *ptr = hstart; + + /* align the size */ + len = (len + 3) & ~3; + + if (!len || len > 0xFFFFFF) + return (void *) NULL; + + /* Make sure the region is setup correctly */ + if (!HAS_MAGIC(*((hdrtype_t *) ptr))) + setup(); + + /* Find some free space */ + + do { + header = *((hdrtype_t *) ptr); + int size = SIZE(header); + + if (header & FLAG_FREE) { + + if (len <= size) { + void *nptr = ptr + HDRSIZE + len; + int nsize = size - (len + 8); + + /* Mark the block as used */ + *((hdrtype_t *) ptr) = USED_BLOCK(len); + + /* If there is still room in this block, + * then mark it as such */ + + if (nsize > 0) + *((hdrtype_t *) nptr) = + FREE_BLOCK(nsize - 4); + + return (void *) (ptr + HDRSIZE); + } + } + + ptr += HDRSIZE + size; + + } while(ptr < hend); + + /* Nothing available */ + return (void *) NULL; +} + +static void _consolidate(void) +{ + void *ptr = hstart; + + while(ptr < hend) { + void *nptr; + hdrtype_t hdr = *((hdrtype_t *) ptr); + unsigned int size = 0; + + if (!IS_FREE(hdr)) { + ptr += HDRSIZE + SIZE(hdr); + continue; + } + + size = SIZE(hdr); + nptr = ptr + HDRSIZE + SIZE(hdr); + + while (nptr < hend) { + hdrtype_t nhdr = *((hdrtype_t *) nptr); + + if (!(IS_FREE(nhdr))) + break; + + size += SIZE(nhdr) + HDRSIZE; + + *((hdrtype_t *) nptr) = 0; + + nptr += (HDRSIZE + SIZE(nhdr)); + } + + *((hdrtype_t *) ptr) = FREE_BLOCK(size); + ptr = nptr; + } +} + +void free(void *ptr) +{ + hdrtype_t hdr; + + ptr -= HDRSIZE; + + /* Sanity check */ + if (ptr < hstart || ptr >= hend) + return; + + hdr = *((hdrtype_t *) ptr); + + /* Not our header (we're probably poisoned) */ + if (!HAS_MAGIC(hdr)) + return; + + /* Double free */ + if (hdr & FLAG_FREE) + return; + + *((hdrtype_t *) ptr) = FREE_BLOCK(SIZE(hdr)); + _consolidate(); +} + +void *malloc(size_t size) +{ + return alloc(size); +} + +void *calloc(size_t nmemb, size_t size) +{ + unsigned int total = (nmemb * size); + void *ptr = alloc(size); + + if (ptr) + memset(ptr, 0, total); + + return ptr; +} + +void *realloc(void *ptr, size_t size) +{ + void *ret; + void *pptr; + unsigned int osize; + + if (ptr == NULL) + return alloc(size); + + pptr = ptr - HDRSIZE; + + if (!HAS_MAGIC(*((hdrtype_t *) pptr))) + return NULL; + + /* Get the original size of the block */ + osize = SIZE(*((hdrtype_t *) pptr)); + + /* Free the memory to update the tables - this + won't touch the actual memory, so we can still + use it for the copy after we have reallocated + the new space + */ + + free(ptr); + ret = alloc(size); + + /* if ret == NULL, then doh - failure. + if ret == ptr then woo-hoo! no copy needed */ + + if (ret == NULL || ret == ptr) + return ret; + + /* Copy the memory to the new location */ + memcpy(ret, ptr, osize > size ? size : osize); + return ret; +} + +/* This is for debugging purposes */ +#ifdef TEST + +void print_malloc_map(void) +{ + void *ptr = hstart; + + while(ptr < hend) { + hdrtype_t hdr = *((hdrtype_t *) ptr); + + if (!HAS_MAGIC(hdr)) { + printf("Poisoned magic - we're toast\n"); + break; + } + + /* FIXME: Verify the size of the block */ + + printf("%x: %s (%x bytes)\n", + (unsigned int) (ptr - hstart), + hdr & FLAG_FREE ? "FREE" : "USED", + SIZE(hdr)); + + ptr += HDRSIZE + SIZE(hdr); + } +} + +#endif diff --git a/payloads/libpayload/libc/string.c b/payloads/libpayload/libc/string.c new file mode 100644 index 0000000000..c9f0603387 --- /dev/null +++ b/payloads/libpayload/libc/string.c @@ -0,0 +1,195 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2007 Uwe Hermann + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +#include + +/** + * Calculate the length of a fixed-size string. + * + * @param str The input string. + * @param maxlen Return at most maxlen characters as length of the string. + * @return The length of the string, not including the final NUL character. + * The maximum length returned is maxlen. + */ +size_t strnlen(const char *str, size_t maxlen) +{ + size_t len = 0; + + /* NULL and empty strings have length 0. */ + if (!str) + return 0; + + /* Loop until we find a NUL character, or maxlen is reached. */ + while ((*str++ != '\0') && (len < maxlen)) + len++; + + return len; +} + +/** + * Calculate the length of a string. + * + * @param str The input string. + * @return The length of the string, not including the final NUL character. + */ +size_t strlen(const char *str) +{ + size_t len = 0; + + /* NULL and empty strings have length 0. */ + if (!str) + return 0; + + /* Loop until we find a NUL character. */ + while (*str++ != '\0') + len++; + + return len; +} + +/** + * Compare two strings. + * + * @param s1 The first string. + * @param s2 The second string. + * @return Returns a value less than zero, if s1 is shorter than s2. Returns + * zero, if s1 equals s2. Returns a value greater than zero, if + * s1 is longer than s2. + */ +int strcmp(const char *s1, const char *s2) +{ + char c1, c2; + + /* Set c1 == c2, so that we can enter the while loop. */ + c1 = 0; + c2 = 0; + + /* Compare characters until they differ, or one of the strings ends. */ + while (c1 == c2) { + /* Read the next character from each string. */ + c1 = *s1++; + c2 = *s2++; + + /* Return something negative (if s1 is shorter than s2), or + zero (if s1 equals s2). */ + if (c1 == '\0') + return c1 - c2; + } + + /* Return someting positive (if s1 is longer than s2), or zero (if s1 + and s2 are equal). */ + return c1 - c2; +} + +/** + * Compare two strings with fixed length. + * + * @param s1 The first string. + * @param s2 The second string. + * @param maxlen Return at most maxlen characters as length of the string. + * @return A non-zero value if s1 and s2 differ, or zero if s1 equals s2. + */ +int strncmp(const char *s1, const char *s2, int maxlen) +{ + int i; + + for (i = 0; i < maxlen; i++) { + if (s1[i] != s2[i]) + return s1[i] - s2[i]; + } + + return 0; +} + +char *strncpy(char *d, const char *s, int n) +{ + /* use +1 to get the null terminator */ + + int max = n > strlen(s) + 1 ? strlen(s) + 1 : n; + int i; + + for(i = 0; i < max; i++) + d[i] = (char) s[i]; + + return d; +} + +char *strncat(char *d, const char *s, int n) +{ + char *p = d + strlen(d); + int max = n > strlen(s) ? strlen(s) : n; + int i; + + for(i = 0; i < max; i++) + p[i] = s[i]; + + p[i] = '\0'; + return d; +} + +char * strchr(const char *s, int c) +{ + char *p = (char *) s; + + for( ; *p != 0; p++) { + if (*p == c) + return p; + } + + return NULL; +} + + +char *strdup(const char *s) +{ + int n = strlen(s); + char *p = malloc(n); + + if (p != NULL) + strncpy(p, s, n); + + return p; +} + +char *strstr(const char *h, const char *n) +{ + int hn = strlen(h); + int nn = strlen(n); + int i; + + for(i = 0; i <= hn - nn; i++) + if (!strcmp(&h[i], n)) + return (char *) &h[i]; + + return NULL; +} + + diff --git a/payloads/libpayload/libpayload.ldscript b/payloads/libpayload/libpayload.ldscript new file mode 100644 index 0000000000..81ad105842 --- /dev/null +++ b/payloads/libpayload/libpayload.ldscript @@ -0,0 +1,90 @@ +/* + This file is part of the libpayload project. + + Copyright (C) 2008 Advanced Micro Devices, Inc. + + Redistribution and use in source and binary forms, with or without + modification, are permitted provided that the following conditions + are met: + 1. Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. + 2. Redistributions in binary form must reproduce the above copyright + notice, this list of conditions and the following disclaimer in the + documentation and/or other materials provided with the distribution. + 3. The name of the author may not be used to endorse or promote products + derived from this software without specific prior written permission. + + THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + SUCH DAMAGE. +*/ + +BASE_ADDRESS = 0x100000; + +OUTPUT_FORMAT(elf32-i386) +OUTPUT_ARCH(i386) + +ENTRY(_entry) + +HEAP_SIZE = 16384; +STACK_SIZE = 16384; + +SECTIONS +{ + . = BASE_ADDRESS; + + . = ALIGN(16); + _start = .; + + .text : { + *(.text._entry) + *(.text) + *(.text.*) + } + + .rodata : { + *(.rodata) + *(.rodata.*) + } + + .data : { + *(.data) + *(.data.*) + } + + .bss : { + *(.bss) + *(.bss.*) + *(COMMON) + + /* Stack and heap */ + + . = ALIGN(16); + _heap = .; + . += HEAP_SIZE; + . = ALIGN(16); + _eheap = .; + + _stack = .; + . += STACK_SIZE; + . = ALIGN(16); + _stack = .; + } + + /* Put the static bits of our inital stack at the bottom */ + .istack : { + *(.istack) + } + + _end = .; + + /DISCARD/ : { *(.comment) *(.note) *(.note.*) } +} diff --git a/payloads/libpayload/sample/Makefile b/payloads/libpayload/sample/Makefile new file mode 100644 index 0000000000..a2599fbc32 --- /dev/null +++ b/payloads/libpayload/sample/Makefile @@ -0,0 +1,51 @@ +## +## This file is part of the libpayload project. +## +## Copyright (C) 2008 Advanced Micro Devices, Inc. +## +## Redistribution and use in source and binary forms, with or without +## modification, are permitted provided that the following conditions +## are met: +## 1. Redistributions of source code must retain the above copyright +## notice, this list of conditions and the following disclaimer. +## 2. Redistributions in binary form must reproduce the above copyright +## notice, this list of conditions and the following disclaimer in the +## documentation and/or other materials provided with the distribution. +## 3. The name of the author may not be used to endorse or promote products +## derived from this software without specific prior written permission. +## +## THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND +## ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +## IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +## ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE +## FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +## DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +## OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +## HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +## LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +## OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +## SUCH DAMAGE. +## + +# Sample libpayload Makefile. + +CC=gcc +CROSS_CFLAGS = -m32 + +INCLUDES=-I../include +INCLUDES += -I$(shell $(CC) $(CROSS_CFLAGS) -print-search-dirs | head -n 1 | cut -d' ' -f2)include + +LIBPAYLOAD=../libpayload.a +LIBGCC:=$(shell $(CC) $(CROSS_CFLAGS) -print-libgcc-file-name) +CFLAGS := -Werror -fno-stack-protector -nostdinc $(INCLUDES) + +all: hello.elf + +hello.elf: hello.o + ld -T ../libpayload.ldscript -o $@ hello.o ../i386/head.o $(LIBPAYLOAD) $(LIBGCC) + +hello.o: hello.c + $(CC) $(CROSS_CFLAGS) $(CFLAGS) -c -o $@ $< + +clean: + rm -f hello.elf hello.o diff --git a/payloads/libpayload/sample/hello.c b/payloads/libpayload/sample/hello.c new file mode 100644 index 0000000000..01948f6d8a --- /dev/null +++ b/payloads/libpayload/sample/hello.c @@ -0,0 +1,39 @@ +/* + * This file is part of the libpayload project. + * + * Copyright (C) 2008 Advanced Micro Devices, Inc. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +/* Example file for libpayload. */ + +#include + +int main(void) { + printf("Hello world!\n"); + halt(); + + return 0; +} -- cgit v1.2.3