Home | History | Annotate | Line # | Download | only in prekern
console.c revision 1.5
      1  1.5  maxv /*	$NetBSD: console.c,v 1.5 2020/05/23 08:23:28 maxv 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.4  maxv 	memcpy(cons_start, &cons_buffer[0], CONS_WID * 2 * CONS_HEI);
     65  1.1  maxv }
     66  1.1  maxv 
     67  1.5  maxv static void putc(int color, char c)
     68  1.1  maxv {
     69  1.1  maxv 	char *ptr, *scr;
     70  1.1  maxv 
     71  1.5  maxv 	if (c == '\n') {
     72  1.5  maxv 		cons_x = 0;
     73  1.5  maxv 		cons_y++;
     74  1.5  maxv 		check_scroll();
     75  1.5  maxv 	} else {
     76  1.5  maxv 		if (cons_x + 1 == CONS_WID) {
     77  1.1  maxv 			cons_x = 0;
     78  1.1  maxv 			cons_y++;
     79  1.1  maxv 			check_scroll();
     80  1.1  maxv 		}
     81  1.5  maxv 		ptr = (cons_start + 2 * cons_x + 160 * cons_y);
     82  1.5  maxv 		scr = (cons_buffer + 2 * cons_x + 160 * cons_y);
     83  1.5  maxv 		ptr[0] = scr[0] = c;
     84  1.5  maxv 		ptr[1] = scr[1] = color;
     85  1.5  maxv 		cons_x++;
     86  1.5  maxv 	}
     87  1.5  maxv }
     88  1.5  maxv 
     89  1.5  maxv void print_ext(int color, char *buf)
     90  1.5  maxv {
     91  1.5  maxv 	size_t i;
     92  1.5  maxv 
     93  1.5  maxv 	for (i = 0; buf[i] != '\0'; i++) {
     94  1.5  maxv 		putc(color, buf[i]);
     95  1.1  maxv 	}
     96  1.1  maxv }
     97  1.1  maxv 
     98  1.1  maxv void print(char *buf)
     99  1.1  maxv {
    100  1.1  maxv 	print_ext(WHITE_ON_BLACK, buf);
    101  1.1  maxv }
    102  1.1  maxv 
    103  1.1  maxv void print_state(bool ok, char *buf)
    104  1.1  maxv {
    105  1.1  maxv 	print("[");
    106  1.1  maxv 	if (ok)
    107  1.1  maxv 		print_ext(GREEN_ON_BLACK, "+");
    108  1.1  maxv 	else
    109  1.1  maxv 		print_ext(RED_ON_BLACK, "!");
    110  1.1  maxv 	print("] ");
    111  1.1  maxv 	print(buf);
    112  1.1  maxv 	print("\n");
    113  1.1  maxv }
    114  1.1  maxv 
    115  1.2  maxv void print_banner(void)
    116  1.1  maxv {
    117  1.3  maxv 	char *banner =
    118  1.1  maxv 		"           __________                 __                        \n"
    119  1.1  maxv 		"           \\______   \\_______   ____ |  | __ ___________  ____  \n"
    120  1.1  maxv 		"            |     ___/\\_  __ \\_/ __ \\|  |/ // __ \\_  __ \\/    \\ \n"
    121  1.1  maxv 		"            |    |     |  | \\/\\  ___/|    <\\  ___/|  | \\/   |  \\\n"
    122  1.1  maxv 		"            |____|     |__|    \\___  >__|_ \\\\___  >__|  |___|  /\n"
    123  1.1  maxv 		"                                   \\/     \\/    \\/           \\/    Version 1.0\n"
    124  1.1  maxv 	;
    125  1.1  maxv 	print(banner);
    126  1.1  maxv }
    127