Home | History | Annotate | Line # | Download | only in prekern
console.c revision 1.1
      1  1.1  maxv /*	$NetBSD: console.c,v 1.1 2017/10/10 09:29:14 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.1  maxv void init_cons()
     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.1  maxv static void check_scroll()
     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.1  maxv 	memcpy(cons_start, &cons_buffer[0], (CONS_WID * 2) * (CONS_HEI-1));
     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.1  maxv void print_banner()
    110  1.1  maxv {
    111  1.1  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