Home | History | Annotate | Line # | Download | only in prekern
console.c revision 1.3.6.1
      1  1.3.6.1  christos /*	$NetBSD: console.c,v 1.3.6.1 2019/06/10 22:05:47 christos Exp $	*/
      2      1.1      maxv 
      3      1.1      maxv /*
      4      1.1      maxv  * Copyright (c) 2017 The NetBSD Foundation, Inc. All rights reserved.
      5      1.1      maxv  *
      6      1.1      maxv  * This code is derived from software contributed to The NetBSD Foundation
      7      1.1      maxv  * by Maxime Villard.
      8      1.1      maxv  *
      9      1.1      maxv  * Redistribution and use in source and binary forms, with or without
     10      1.1      maxv  * modification, are permitted provided that the following conditions
     11      1.1      maxv  * are met:
     12      1.1      maxv  * 1. Redistributions of source code must retain the above copyright
     13      1.1      maxv  *    notice, this list of conditions and the following disclaimer.
     14      1.1      maxv  * 2. Redistributions in binary form must reproduce the above copyright
     15      1.1      maxv  *    notice, this list of conditions and the following disclaimer in the
     16      1.1      maxv  *    documentation and/or other materials provided with the distribution.
     17      1.1      maxv  *
     18      1.1      maxv  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     19      1.1      maxv  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     20      1.1      maxv  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     21      1.1      maxv  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     22      1.1      maxv  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     23      1.1      maxv  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     24      1.1      maxv  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     25      1.1      maxv  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     26      1.1      maxv  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     27      1.1      maxv  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     28      1.1      maxv  * POSSIBILITY OF SUCH DAMAGE.
     29      1.1      maxv  */
     30      1.1      maxv 
     31      1.1      maxv #include "prekern.h"
     32      1.1      maxv 
     33      1.1      maxv extern vaddr_t atdevbase;
     34      1.1      maxv #define CONS_WID 80
     35      1.1      maxv #define CONS_HEI 25
     36      1.1      maxv 
     37      1.1      maxv static char *cons_start;
     38      1.1      maxv static size_t cons_x, cons_y;
     39      1.1      maxv static char cons_buffer[CONS_WID * 2 * CONS_HEI];
     40      1.1      maxv 
     41      1.2      maxv void init_cons(void)
     42      1.1      maxv {
     43      1.1      maxv 	cons_start = (char *)atdevbase + (0xB8000 - IOM_BEGIN);
     44      1.1      maxv 	cons_x = 0;
     45      1.1      maxv 	cons_y = 0;
     46      1.1      maxv }
     47      1.1      maxv 
     48      1.2      maxv static void check_scroll(void)
     49      1.1      maxv {
     50      1.1      maxv 	char *src, *dst;
     51      1.1      maxv 	size_t i;
     52      1.1      maxv 
     53      1.1      maxv 	if (cons_y != CONS_HEI)
     54      1.1      maxv 		return;
     55      1.1      maxv 
     56      1.1      maxv 	for (i = 0; i < CONS_HEI-1; i++) {
     57      1.1      maxv 		dst = &cons_buffer[0] + i * (CONS_WID * 2);
     58      1.1      maxv 		src = &cons_buffer[0] + (i + 1) * (CONS_WID * 2);
     59      1.1      maxv 		memcpy(dst, src, (CONS_WID * 2));
     60      1.1      maxv 	}
     61      1.1      maxv 	memset(&cons_buffer[0] + (CONS_WID * 2) * (CONS_HEI-1), 0,
     62      1.1      maxv 	    (CONS_WID * 2));
     63      1.1      maxv 	cons_y--;
     64  1.3.6.1  christos 	memcpy(cons_start, &cons_buffer[0], CONS_WID * 2 * CONS_HEI);
     65      1.1      maxv }
     66      1.1      maxv 
     67      1.1      maxv void print_ext(int color, char *buf)
     68      1.1      maxv {
     69      1.1      maxv 	char *ptr, *scr;
     70      1.1      maxv 	size_t i;
     71      1.1      maxv 
     72      1.1      maxv 	for (i = 0; buf[i] != '\0'; i++) {
     73      1.1      maxv 		if (buf[i] == '\n') {
     74      1.1      maxv 			cons_x = 0;
     75      1.1      maxv 			cons_y++;
     76      1.1      maxv 			check_scroll();
     77      1.1      maxv 		} else {
     78      1.1      maxv 			if (cons_x + 1 == CONS_WID) {
     79      1.1      maxv 				cons_x = 0;
     80      1.1      maxv 				cons_y++;
     81      1.1      maxv 				check_scroll();
     82      1.1      maxv 			}
     83      1.1      maxv 			ptr = (cons_start + 2 * cons_x + 160 * cons_y);
     84      1.1      maxv 			scr = (cons_buffer + 2 * cons_x + 160 * cons_y);
     85      1.1      maxv 			ptr[0] = scr[0] = buf[i];
     86      1.1      maxv 			ptr[1] = scr[1] = color;
     87      1.1      maxv 			cons_x++;
     88      1.1      maxv 		}
     89      1.1      maxv 	}
     90      1.1      maxv }
     91      1.1      maxv 
     92      1.1      maxv void print(char *buf)
     93      1.1      maxv {
     94      1.1      maxv 	print_ext(WHITE_ON_BLACK, buf);
     95      1.1      maxv }
     96      1.1      maxv 
     97      1.1      maxv void print_state(bool ok, char *buf)
     98      1.1      maxv {
     99      1.1      maxv 	print("[");
    100      1.1      maxv 	if (ok)
    101      1.1      maxv 		print_ext(GREEN_ON_BLACK, "+");
    102      1.1      maxv 	else
    103      1.1      maxv 		print_ext(RED_ON_BLACK, "!");
    104      1.1      maxv 	print("] ");
    105      1.1      maxv 	print(buf);
    106      1.1      maxv 	print("\n");
    107      1.1      maxv }
    108      1.1      maxv 
    109      1.2      maxv void print_banner(void)
    110      1.1      maxv {
    111      1.3      maxv 	char *banner =
    112      1.1      maxv 		"           __________                 __                        \n"
    113      1.1      maxv 		"           \\______   \\_______   ____ |  | __ ___________  ____  \n"
    114      1.1      maxv 		"            |     ___/\\_  __ \\_/ __ \\|  |/ // __ \\_  __ \\/    \\ \n"
    115      1.1      maxv 		"            |    |     |  | \\/\\  ___/|    <\\  ___/|  | \\/   |  \\\n"
    116      1.1      maxv 		"            |____|     |__|    \\___  >__|_ \\\\___  >__|  |___|  /\n"
    117      1.1      maxv 		"                                   \\/     \\/    \\/           \\/    Version 1.0\n"
    118      1.1      maxv 	;
    119      1.1      maxv 	print(banner);
    120      1.1      maxv }
    121