1*8044SWilliam.Kucharski@Sun.COM /* kernel.c - the C part of the kernel */ 2*8044SWilliam.Kucharski@Sun.COM /* Copyright (C) 1999 Free Software Foundation, Inc. 3*8044SWilliam.Kucharski@Sun.COM 4*8044SWilliam.Kucharski@Sun.COM This program is free software; you can redistribute it and/or modify 5*8044SWilliam.Kucharski@Sun.COM it under the terms of the GNU General Public License as published by 6*8044SWilliam.Kucharski@Sun.COM the Free Software Foundation; either version 2 of the License, or 7*8044SWilliam.Kucharski@Sun.COM (at your option) any later version. 8*8044SWilliam.Kucharski@Sun.COM 9*8044SWilliam.Kucharski@Sun.COM This program is distributed in the hope that it will be useful, 10*8044SWilliam.Kucharski@Sun.COM but WITHOUT ANY WARRANTY; without even the implied warranty of 11*8044SWilliam.Kucharski@Sun.COM MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12*8044SWilliam.Kucharski@Sun.COM GNU General Public License for more details. 13*8044SWilliam.Kucharski@Sun.COM 14*8044SWilliam.Kucharski@Sun.COM You should have received a copy of the GNU General Public License 15*8044SWilliam.Kucharski@Sun.COM along with this program; if not, write to the Free Software 16*8044SWilliam.Kucharski@Sun.COM Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ 17*8044SWilliam.Kucharski@Sun.COM 18*8044SWilliam.Kucharski@Sun.COM #include <multiboot.h> 19*8044SWilliam.Kucharski@Sun.COM 20*8044SWilliam.Kucharski@Sun.COM /* Macros. */ 21*8044SWilliam.Kucharski@Sun.COM 22*8044SWilliam.Kucharski@Sun.COM /* Check if the bit BIT in FLAGS is set. */ 23*8044SWilliam.Kucharski@Sun.COM #define CHECK_FLAG(flags,bit) ((flags) & (1 << (bit))) 24*8044SWilliam.Kucharski@Sun.COM 25*8044SWilliam.Kucharski@Sun.COM /* Some screen stuff. */ 26*8044SWilliam.Kucharski@Sun.COM /* The number of columns. */ 27*8044SWilliam.Kucharski@Sun.COM #define COLUMNS 80 28*8044SWilliam.Kucharski@Sun.COM /* The number of lines. */ 29*8044SWilliam.Kucharski@Sun.COM #define LINES 24 30*8044SWilliam.Kucharski@Sun.COM /* The attribute of an character. */ 31*8044SWilliam.Kucharski@Sun.COM #define ATTRIBUTE 7 32*8044SWilliam.Kucharski@Sun.COM /* The video memory address. */ 33*8044SWilliam.Kucharski@Sun.COM #define VIDEO 0xB8000 34*8044SWilliam.Kucharski@Sun.COM 35*8044SWilliam.Kucharski@Sun.COM /* Variables. */ 36*8044SWilliam.Kucharski@Sun.COM /* Save the X position. */ 37*8044SWilliam.Kucharski@Sun.COM static int xpos; 38*8044SWilliam.Kucharski@Sun.COM /* Save the Y position. */ 39*8044SWilliam.Kucharski@Sun.COM static int ypos; 40*8044SWilliam.Kucharski@Sun.COM /* Point to the video memory. */ 41*8044SWilliam.Kucharski@Sun.COM static volatile unsigned char *video; 42*8044SWilliam.Kucharski@Sun.COM 43*8044SWilliam.Kucharski@Sun.COM /* Forward declarations. */ 44*8044SWilliam.Kucharski@Sun.COM void cmain (unsigned long magic, unsigned long addr); 45*8044SWilliam.Kucharski@Sun.COM static void cls (void); 46*8044SWilliam.Kucharski@Sun.COM static void itoa (char *buf, int base, int d); 47*8044SWilliam.Kucharski@Sun.COM static void putchar (int c); 48*8044SWilliam.Kucharski@Sun.COM void printf (const char *format, ...); 49*8044SWilliam.Kucharski@Sun.COM 50*8044SWilliam.Kucharski@Sun.COM /* Check if MAGIC is valid and print the Multiboot information structure 51*8044SWilliam.Kucharski@Sun.COM pointed by ADDR. */ 52*8044SWilliam.Kucharski@Sun.COM void 53*8044SWilliam.Kucharski@Sun.COM cmain (unsigned long magic, unsigned long addr) 54*8044SWilliam.Kucharski@Sun.COM { 55*8044SWilliam.Kucharski@Sun.COM multiboot_info_t *mbi; 56*8044SWilliam.Kucharski@Sun.COM 57*8044SWilliam.Kucharski@Sun.COM /* Clear the screen. */ 58*8044SWilliam.Kucharski@Sun.COM cls (); 59*8044SWilliam.Kucharski@Sun.COM 60*8044SWilliam.Kucharski@Sun.COM /* Am I booted by a Multiboot-compliant boot loader? */ 61*8044SWilliam.Kucharski@Sun.COM if (magic != MULTIBOOT_BOOTLOADER_MAGIC) 62*8044SWilliam.Kucharski@Sun.COM { 63*8044SWilliam.Kucharski@Sun.COM printf ("Invalid magic number: 0x%x\n", (unsigned) magic); 64*8044SWilliam.Kucharski@Sun.COM return; 65*8044SWilliam.Kucharski@Sun.COM } 66*8044SWilliam.Kucharski@Sun.COM 67*8044SWilliam.Kucharski@Sun.COM /* Set MBI to the address of the Multiboot information structure. */ 68*8044SWilliam.Kucharski@Sun.COM mbi = (multiboot_info_t *) addr; 69*8044SWilliam.Kucharski@Sun.COM 70*8044SWilliam.Kucharski@Sun.COM /* Print out the flags. */ 71*8044SWilliam.Kucharski@Sun.COM printf ("flags = 0x%x\n", (unsigned) mbi->flags); 72*8044SWilliam.Kucharski@Sun.COM 73*8044SWilliam.Kucharski@Sun.COM /* Are mem_* valid? */ 74*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 0)) 75*8044SWilliam.Kucharski@Sun.COM printf ("mem_lower = %uKB, mem_upper = %uKB\n", 76*8044SWilliam.Kucharski@Sun.COM (unsigned) mbi->mem_lower, (unsigned) mbi->mem_upper); 77*8044SWilliam.Kucharski@Sun.COM 78*8044SWilliam.Kucharski@Sun.COM /* Is boot_device valid? */ 79*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 1)) 80*8044SWilliam.Kucharski@Sun.COM printf ("boot_device = 0x%x\n", (unsigned) mbi->boot_device); 81*8044SWilliam.Kucharski@Sun.COM 82*8044SWilliam.Kucharski@Sun.COM /* Is the command line passed? */ 83*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 2)) 84*8044SWilliam.Kucharski@Sun.COM printf ("cmdline = %s\n", (char *) mbi->cmdline); 85*8044SWilliam.Kucharski@Sun.COM 86*8044SWilliam.Kucharski@Sun.COM /* Are mods_* valid? */ 87*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 3)) 88*8044SWilliam.Kucharski@Sun.COM { 89*8044SWilliam.Kucharski@Sun.COM module_t *mod; 90*8044SWilliam.Kucharski@Sun.COM int i; 91*8044SWilliam.Kucharski@Sun.COM 92*8044SWilliam.Kucharski@Sun.COM printf ("mods_count = %d, mods_addr = 0x%x\n", 93*8044SWilliam.Kucharski@Sun.COM (int) mbi->mods_count, (int) mbi->mods_addr); 94*8044SWilliam.Kucharski@Sun.COM for (i = 0, mod = (module_t *) mbi->mods_addr; 95*8044SWilliam.Kucharski@Sun.COM i < mbi->mods_count; 96*8044SWilliam.Kucharski@Sun.COM i++, mod++) 97*8044SWilliam.Kucharski@Sun.COM printf (" mod_start = 0x%x, mod_end = 0x%x, string = %s\n", 98*8044SWilliam.Kucharski@Sun.COM (unsigned) mod->mod_start, 99*8044SWilliam.Kucharski@Sun.COM (unsigned) mod->mod_end, 100*8044SWilliam.Kucharski@Sun.COM (char *) mod->string); 101*8044SWilliam.Kucharski@Sun.COM } 102*8044SWilliam.Kucharski@Sun.COM 103*8044SWilliam.Kucharski@Sun.COM /* Bits 4 and 5 are mutually exclusive! */ 104*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 4) && CHECK_FLAG (mbi->flags, 5)) 105*8044SWilliam.Kucharski@Sun.COM { 106*8044SWilliam.Kucharski@Sun.COM printf ("Both bits 4 and 5 are set.\n"); 107*8044SWilliam.Kucharski@Sun.COM return; 108*8044SWilliam.Kucharski@Sun.COM } 109*8044SWilliam.Kucharski@Sun.COM 110*8044SWilliam.Kucharski@Sun.COM /* Is the symbol table of a.out valid? */ 111*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 4)) 112*8044SWilliam.Kucharski@Sun.COM { 113*8044SWilliam.Kucharski@Sun.COM aout_symbol_table_t *aout_sym = &(mbi->u.aout_sym); 114*8044SWilliam.Kucharski@Sun.COM 115*8044SWilliam.Kucharski@Sun.COM printf ("aout_symbol_table: tabsize = 0x%0x, " 116*8044SWilliam.Kucharski@Sun.COM "strsize = 0x%x, addr = 0x%x\n", 117*8044SWilliam.Kucharski@Sun.COM (unsigned) aout_sym->tabsize, 118*8044SWilliam.Kucharski@Sun.COM (unsigned) aout_sym->strsize, 119*8044SWilliam.Kucharski@Sun.COM (unsigned) aout_sym->addr); 120*8044SWilliam.Kucharski@Sun.COM } 121*8044SWilliam.Kucharski@Sun.COM 122*8044SWilliam.Kucharski@Sun.COM /* Is the section header table of ELF valid? */ 123*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 5)) 124*8044SWilliam.Kucharski@Sun.COM { 125*8044SWilliam.Kucharski@Sun.COM elf_section_header_table_t *elf_sec = &(mbi->u.elf_sec); 126*8044SWilliam.Kucharski@Sun.COM 127*8044SWilliam.Kucharski@Sun.COM printf ("elf_sec: num = %u, size = 0x%x," 128*8044SWilliam.Kucharski@Sun.COM " addr = 0x%x, shndx = 0x%x\n", 129*8044SWilliam.Kucharski@Sun.COM (unsigned) elf_sec->num, (unsigned) elf_sec->size, 130*8044SWilliam.Kucharski@Sun.COM (unsigned) elf_sec->addr, (unsigned) elf_sec->shndx); 131*8044SWilliam.Kucharski@Sun.COM } 132*8044SWilliam.Kucharski@Sun.COM 133*8044SWilliam.Kucharski@Sun.COM /* Are mmap_* valid? */ 134*8044SWilliam.Kucharski@Sun.COM if (CHECK_FLAG (mbi->flags, 6)) 135*8044SWilliam.Kucharski@Sun.COM { 136*8044SWilliam.Kucharski@Sun.COM memory_map_t *mmap; 137*8044SWilliam.Kucharski@Sun.COM 138*8044SWilliam.Kucharski@Sun.COM printf ("mmap_addr = 0x%x, mmap_length = 0x%x\n", 139*8044SWilliam.Kucharski@Sun.COM (unsigned) mbi->mmap_addr, (unsigned) mbi->mmap_length); 140*8044SWilliam.Kucharski@Sun.COM for (mmap = (memory_map_t *) mbi->mmap_addr; 141*8044SWilliam.Kucharski@Sun.COM (unsigned long) mmap < mbi->mmap_addr + mbi->mmap_length; 142*8044SWilliam.Kucharski@Sun.COM mmap = (memory_map_t *) ((unsigned long) mmap 143*8044SWilliam.Kucharski@Sun.COM + mmap->size + sizeof (mmap->size))) 144*8044SWilliam.Kucharski@Sun.COM printf (" size = 0x%x, base_addr = 0x%x%x," 145*8044SWilliam.Kucharski@Sun.COM " length = 0x%x%x, type = 0x%x\n", 146*8044SWilliam.Kucharski@Sun.COM (unsigned) mmap->size, 147*8044SWilliam.Kucharski@Sun.COM (unsigned) mmap->base_addr_high, 148*8044SWilliam.Kucharski@Sun.COM (unsigned) mmap->base_addr_low, 149*8044SWilliam.Kucharski@Sun.COM (unsigned) mmap->length_high, 150*8044SWilliam.Kucharski@Sun.COM (unsigned) mmap->length_low, 151*8044SWilliam.Kucharski@Sun.COM (unsigned) mmap->type); 152*8044SWilliam.Kucharski@Sun.COM } 153*8044SWilliam.Kucharski@Sun.COM } 154*8044SWilliam.Kucharski@Sun.COM 155*8044SWilliam.Kucharski@Sun.COM /* Clear the screen and initialize VIDEO, XPOS and YPOS. */ 156*8044SWilliam.Kucharski@Sun.COM static void 157*8044SWilliam.Kucharski@Sun.COM cls (void) 158*8044SWilliam.Kucharski@Sun.COM { 159*8044SWilliam.Kucharski@Sun.COM int i; 160*8044SWilliam.Kucharski@Sun.COM 161*8044SWilliam.Kucharski@Sun.COM video = (unsigned char *) VIDEO; 162*8044SWilliam.Kucharski@Sun.COM 163*8044SWilliam.Kucharski@Sun.COM for (i = 0; i < COLUMNS * LINES * 2; i++) 164*8044SWilliam.Kucharski@Sun.COM *(video + i) = 0; 165*8044SWilliam.Kucharski@Sun.COM 166*8044SWilliam.Kucharski@Sun.COM xpos = 0; 167*8044SWilliam.Kucharski@Sun.COM ypos = 0; 168*8044SWilliam.Kucharski@Sun.COM } 169*8044SWilliam.Kucharski@Sun.COM 170*8044SWilliam.Kucharski@Sun.COM /* Convert the integer D to a string and save the string in BUF. If 171*8044SWilliam.Kucharski@Sun.COM BASE is equal to 'd', interpret that D is decimal, and if BASE is 172*8044SWilliam.Kucharski@Sun.COM equal to 'x', interpret that D is hexadecimal. */ 173*8044SWilliam.Kucharski@Sun.COM static void 174*8044SWilliam.Kucharski@Sun.COM itoa (char *buf, int base, int d) 175*8044SWilliam.Kucharski@Sun.COM { 176*8044SWilliam.Kucharski@Sun.COM char *p = buf; 177*8044SWilliam.Kucharski@Sun.COM char *p1, *p2; 178*8044SWilliam.Kucharski@Sun.COM unsigned long ud = d; 179*8044SWilliam.Kucharski@Sun.COM int divisor = 10; 180*8044SWilliam.Kucharski@Sun.COM 181*8044SWilliam.Kucharski@Sun.COM /* If %d is specified and D is minus, put `-' in the head. */ 182*8044SWilliam.Kucharski@Sun.COM if (base == 'd' && d < 0) 183*8044SWilliam.Kucharski@Sun.COM { 184*8044SWilliam.Kucharski@Sun.COM *p++ = '-'; 185*8044SWilliam.Kucharski@Sun.COM buf++; 186*8044SWilliam.Kucharski@Sun.COM ud = -d; 187*8044SWilliam.Kucharski@Sun.COM } 188*8044SWilliam.Kucharski@Sun.COM else if (base == 'x') 189*8044SWilliam.Kucharski@Sun.COM divisor = 16; 190*8044SWilliam.Kucharski@Sun.COM 191*8044SWilliam.Kucharski@Sun.COM /* Divide UD by DIVISOR until UD == 0. */ 192*8044SWilliam.Kucharski@Sun.COM do 193*8044SWilliam.Kucharski@Sun.COM { 194*8044SWilliam.Kucharski@Sun.COM int remainder = ud % divisor; 195*8044SWilliam.Kucharski@Sun.COM 196*8044SWilliam.Kucharski@Sun.COM *p++ = (remainder < 10) ? remainder + '0' : remainder + 'a' - 10; 197*8044SWilliam.Kucharski@Sun.COM } 198*8044SWilliam.Kucharski@Sun.COM while (ud /= divisor); 199*8044SWilliam.Kucharski@Sun.COM 200*8044SWilliam.Kucharski@Sun.COM /* Terminate BUF. */ 201*8044SWilliam.Kucharski@Sun.COM *p = 0; 202*8044SWilliam.Kucharski@Sun.COM 203*8044SWilliam.Kucharski@Sun.COM /* Reverse BUF. */ 204*8044SWilliam.Kucharski@Sun.COM p1 = buf; 205*8044SWilliam.Kucharski@Sun.COM p2 = p - 1; 206*8044SWilliam.Kucharski@Sun.COM while (p1 < p2) 207*8044SWilliam.Kucharski@Sun.COM { 208*8044SWilliam.Kucharski@Sun.COM char tmp = *p1; 209*8044SWilliam.Kucharski@Sun.COM *p1 = *p2; 210*8044SWilliam.Kucharski@Sun.COM *p2 = tmp; 211*8044SWilliam.Kucharski@Sun.COM p1++; 212*8044SWilliam.Kucharski@Sun.COM p2--; 213*8044SWilliam.Kucharski@Sun.COM } 214*8044SWilliam.Kucharski@Sun.COM } 215*8044SWilliam.Kucharski@Sun.COM 216*8044SWilliam.Kucharski@Sun.COM /* Put the character C on the screen. */ 217*8044SWilliam.Kucharski@Sun.COM static void 218*8044SWilliam.Kucharski@Sun.COM putchar (int c) 219*8044SWilliam.Kucharski@Sun.COM { 220*8044SWilliam.Kucharski@Sun.COM if (c == '\n' || c == '\r') 221*8044SWilliam.Kucharski@Sun.COM { 222*8044SWilliam.Kucharski@Sun.COM newline: 223*8044SWilliam.Kucharski@Sun.COM xpos = 0; 224*8044SWilliam.Kucharski@Sun.COM ypos++; 225*8044SWilliam.Kucharski@Sun.COM if (ypos >= LINES) 226*8044SWilliam.Kucharski@Sun.COM ypos = 0; 227*8044SWilliam.Kucharski@Sun.COM return; 228*8044SWilliam.Kucharski@Sun.COM } 229*8044SWilliam.Kucharski@Sun.COM 230*8044SWilliam.Kucharski@Sun.COM *(video + (xpos + ypos * COLUMNS) * 2) = c & 0xFF; 231*8044SWilliam.Kucharski@Sun.COM *(video + (xpos + ypos * COLUMNS) * 2 + 1) = ATTRIBUTE; 232*8044SWilliam.Kucharski@Sun.COM 233*8044SWilliam.Kucharski@Sun.COM xpos++; 234*8044SWilliam.Kucharski@Sun.COM if (xpos >= COLUMNS) 235*8044SWilliam.Kucharski@Sun.COM goto newline; 236*8044SWilliam.Kucharski@Sun.COM } 237*8044SWilliam.Kucharski@Sun.COM 238*8044SWilliam.Kucharski@Sun.COM /* Format a string and print it on the screen, just like the libc 239*8044SWilliam.Kucharski@Sun.COM function printf. */ 240*8044SWilliam.Kucharski@Sun.COM void 241*8044SWilliam.Kucharski@Sun.COM printf (const char *format, ...) 242*8044SWilliam.Kucharski@Sun.COM { 243*8044SWilliam.Kucharski@Sun.COM char **arg = (char **) &format; 244*8044SWilliam.Kucharski@Sun.COM int c; 245*8044SWilliam.Kucharski@Sun.COM char buf[20]; 246*8044SWilliam.Kucharski@Sun.COM 247*8044SWilliam.Kucharski@Sun.COM arg++; 248*8044SWilliam.Kucharski@Sun.COM 249*8044SWilliam.Kucharski@Sun.COM while ((c = *format++) != 0) 250*8044SWilliam.Kucharski@Sun.COM { 251*8044SWilliam.Kucharski@Sun.COM if (c != '%') 252*8044SWilliam.Kucharski@Sun.COM putchar (c); 253*8044SWilliam.Kucharski@Sun.COM else 254*8044SWilliam.Kucharski@Sun.COM { 255*8044SWilliam.Kucharski@Sun.COM char *p; 256*8044SWilliam.Kucharski@Sun.COM 257*8044SWilliam.Kucharski@Sun.COM c = *format++; 258*8044SWilliam.Kucharski@Sun.COM switch (c) 259*8044SWilliam.Kucharski@Sun.COM { 260*8044SWilliam.Kucharski@Sun.COM case 'd': 261*8044SWilliam.Kucharski@Sun.COM case 'u': 262*8044SWilliam.Kucharski@Sun.COM case 'x': 263*8044SWilliam.Kucharski@Sun.COM itoa (buf, c, *((int *) arg++)); 264*8044SWilliam.Kucharski@Sun.COM p = buf; 265*8044SWilliam.Kucharski@Sun.COM goto string; 266*8044SWilliam.Kucharski@Sun.COM break; 267*8044SWilliam.Kucharski@Sun.COM 268*8044SWilliam.Kucharski@Sun.COM case 's': 269*8044SWilliam.Kucharski@Sun.COM p = *arg++; 270*8044SWilliam.Kucharski@Sun.COM if (! p) 271*8044SWilliam.Kucharski@Sun.COM p = "(null)"; 272*8044SWilliam.Kucharski@Sun.COM 273*8044SWilliam.Kucharski@Sun.COM string: 274*8044SWilliam.Kucharski@Sun.COM while (*p) 275*8044SWilliam.Kucharski@Sun.COM putchar (*p++); 276*8044SWilliam.Kucharski@Sun.COM break; 277*8044SWilliam.Kucharski@Sun.COM 278*8044SWilliam.Kucharski@Sun.COM default: 279*8044SWilliam.Kucharski@Sun.COM putchar (*((int *) arg++)); 280*8044SWilliam.Kucharski@Sun.COM break; 281*8044SWilliam.Kucharski@Sun.COM } 282*8044SWilliam.Kucharski@Sun.COM } 283*8044SWilliam.Kucharski@Sun.COM } 284*8044SWilliam.Kucharski@Sun.COM } 285