arch/i386-pc/bootloader/bootloader_init.c

   1 /*
   2     Copyright © 1995-2006, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Bootloader information initialisation.
   6 */
   7
   8 #include <exec/types.h>
   9 #include <exec/memory.h>
  10 #include <exec/resident.h>
  11 #include <utility/utility.h>
  12 #include <proto/exec.h>
  13 #include <proto/bootloader.h>
  14
  15 #include <aros/symbolsets.h>
  16 #include <aros/bootloader.h>
  17 #include <aros/multiboot.h>
  18 #include "bootloader_intern.h"
  19 #include LC_LIBDEFS_FILE
  20
  21 #define DEBUG 1
  22 #include <aros/debug.h>
  23
  24 #include <string.h>
  25
  26 /*
  27  * What you see here is a Multiboot-compatible header. We don't need a
  28  * sophisticated information package from the multiboot loader.
  29  *
  30  * AROS defines only the first three fields as it is now in ELF executable
  31  * format. All other things like load address or entry point are already
  32  * in the kernel image.
  33  */
  34
  35 #define MB_MAGIC    0x1BADB002  /* Magic value */
  36 #define MB_FLAGS    0x00000003  /* Need 4KB alignment for modules */
  37
  38 const struct
  39 {
  40     ULONG   magic;
  41     ULONG   flags;
  42     ULONG   chksum;
  43 } multiboot_header __attribute__((section(".text"))) =
  44 {
  45     MB_MAGIC,
  46     MB_FLAGS,
  47     -(MB_MAGIC+MB_FLAGS)
  48 };
  49
  50 static int GM_UNIQUENAME(Init)(LIBBASETYPEPTR BootLoaderBase)
  51 {
  52     struct arosmb *mb = (struct arosmb *)0x1000;
  53
  54     NEWLIST(&(BootLoaderBase->Args));
  55     NEWLIST(&(BootLoaderBase->DriveInfo));
  56
  57     /* Right. Now we extract the data currently placed in 0x1000 by exec */
  58     if (mb->magic == MBRAM_VALID)
  59     {
  60         /* Yay. There is data here */
  61         if (mb->flags & MB_FLAGS_LDRNAME)
  62         {
  63             STRPTR temp;
  64
  65             temp = AllocMem(200,MEMF_ANY);
  66             if (temp)
  67             {
  68                 strcpy(temp,mb->ldrname);
  69                 BootLoaderBase->LdrName = temp;
  70                 BootLoaderBase->Flags |= MB_FLAGS_LDRNAME;
  71                 D(bug("[BootLdr] Init: Loadername = %s\n",BootLoaderBase->LdrName));
  72             }
  73             else
  74                 bug("[BootLdr] Init: Failed to alloc memory for string\n");
  75         }
  76         if (mb->flags & MB_FLAGS_CMDLINE)
  77         {
  78             STRPTR cmd,buff;
  79             ULONG temp;
  80             struct Node *node;
  81
  82             /* First make a working copy of the command line */
  83             if ((buff = AllocMem(200,MEMF_ANY|MEMF_CLEAR)))
  84             {
  85                 strcpy(buff,mb->cmdline);
  86                 /* remove any leading spaces */
  87                 cmd = stpblk(buff);
  88                 while(cmd[0])
  89                 {
  90                     /* Split the command line */
  91                     temp = strcspn(cmd," ");
  92                     cmd[temp++] = 0x00;
  93                     D(bug("[BootLdr] Init: Argument %s\n",cmd));
  94                     /* Allocate node and insert into list */
  95                     node = AllocMem(sizeof(struct Node),MEMF_ANY|MEMF_CLEAR);
  96                     node->ln_Name = cmd;
  97                     AddTail(&(BootLoaderBase->Args),node);
  98                     /* Skip to next part */
  99                     cmd = stpblk(cmd+temp);
 100                 }
 101
 102                 BootLoaderBase->Flags |= MB_FLAGS_CMDLINE;
 103             }
 104         }
 105
 106         if (mb->flags & MB_FLAGS_GFX)
 107         {
 108             ULONG masks [] = { 0x01, 0x03, 0x07, 0x0f ,0x1f, 0x3f, 0x7f, 0xff };
 109
 110             BootLoaderBase->Vesa.FrameBuffer = (APTR)mb->vmi.phys_base;
 111             BootLoaderBase->Vesa.FrameBufferSize = mb->vci.total_memory * 64; /* FrameBufferSize is in KBytes! */
 112             BootLoaderBase->Vesa.XSize = mb->vmi.x_resolution;
 113             BootLoaderBase->Vesa.YSize = mb->vmi.y_resolution;
 114             BootLoaderBase->Vesa.BytesPerLine = mb->vmi.bytes_per_scanline;
 115             BootLoaderBase->Vesa.BitsPerPixel = mb->vmi.bits_per_pixel;
 116             BootLoaderBase->Vesa.ModeNumber = mb->vbe_mode;
 117             BootLoaderBase->Vesa.Masks[VI_Red] = masks[mb->vmi.red_mask_size-1]<<mb->vmi.red_field_position;
 118             BootLoaderBase->Vesa.Masks[VI_Blue] = masks[mb->vmi.blue_mask_size-1]<<mb->vmi.blue_field_position;
 119             BootLoaderBase->Vesa.Masks[VI_Green] = masks[mb->vmi.green_mask_size-1]<<mb->vmi.green_field_position;
 120             BootLoaderBase->Vesa.Masks[VI_Alpha] = masks[mb->vmi.reserved_mask_size-1]<<mb->vmi.reserved_field_position;
 121             BootLoaderBase->Vesa.Shifts[VI_Red] = 32 - mb->vmi.red_field_position - mb->vmi.red_mask_size;
 122             BootLoaderBase->Vesa.Shifts[VI_Blue] = 32 - mb->vmi.blue_field_position - mb->vmi.blue_mask_size;
 123             BootLoaderBase->Vesa.Shifts[VI_Green] = 32 - mb->vmi.green_field_position - mb->vmi.green_mask_size;
 124             BootLoaderBase->Vesa.Shifts[VI_Alpha] = 32 - mb->vmi.reserved_field_position - mb->vmi.reserved_mask_size;
 125             BootLoaderBase->Vesa.PaletteWidth = mb->vbe_palette_width;
 126             BootLoaderBase->Flags |= MB_FLAGS_GFX;
 127             if (BootLoaderBase->Vesa.ModeNumber != 3)
 128             {
 129                 D(bug("[BootLdr] Init: Vesa card capability flags: 0x%08lx\n", mb->vci.capabilities));
 130                 D(bug("[BootLdr] Init: Vesa mode %x type (%dx%dx%d)\n",
 131                                 BootLoaderBase->Vesa.ModeNumber,
 132                                 BootLoaderBase->Vesa.XSize,BootLoaderBase->Vesa.YSize,
 133                                 BootLoaderBase->Vesa.BitsPerPixel));
 134                 D(bug("[BootLdr] Init: Vesa FB at 0x%08x size %d kB\n",
 135                                 BootLoaderBase->Vesa.FrameBuffer,
 136                                 BootLoaderBase->Vesa.FrameBufferSize));
 137                 D(bug("[BootLdr] Init: Vesa mode palette width: %d\n", BootLoaderBase->Vesa.PaletteWidth));
 138                 D(bug("[BootLdr] Init: Vesa mode direct color flags %02x\n", mb->vmi.direct_color_mode_info));
 139             }
 140             else
 141             {
 142                 D(bug("[BootLdr] Init: Textmode graphics\n"));
 143             }
 144         }
 145
 146         if (mb->flags & MB_FLAGS_DRIVES)
 147         {
 148             struct mb_drive *curr;
 149             struct DriveInfoNode *node;
 150
 151             for (curr = (struct mb_drive *) mb->drives_addr;
 152                     (unsigned long) curr < mb->drives_addr + mb->drives_len;
 153                     curr = (struct mb_drive *) ((unsigned long) curr + curr->size))
 154             {
 155                 node = AllocMem(sizeof(struct DriveInfoNode),MEMF_ANY|MEMF_CLEAR);
 156                 node->Number = curr->number;
 157                 node->Mode = curr->mode;
 158                 node->Cylinders = curr->cyls;
 159                 node->Heads = curr->heads;
 160                 node->Sectors = curr->secs;
 161                 ADDTAIL(&(BootLoaderBase->DriveInfo),(struct Node *)node);
 162
 163                 D(bug("[BootLdr] Init: Drive %02x, CHS (%d/%d/%d) mode %s\n",
 164                         curr->number,
 165                         curr->cyls,curr->heads,curr->secs,
 166                         curr->mode?"CHS":"LBA"));
 167             }
 168             BootLoaderBase->Flags |= MB_FLAGS_DRIVES;
 169         }
 170     }
 171     return TRUE;
 172 }
 173
 174 ADD2INITLIB(GM_UNIQUENAME(Init), 0)