arch/all-pc/boot/grub2-aros/grub-core/kern/vga_init.c

   1 /*
   2  *  GRUB  --  GRand Unified Bootloader
   3  *  Copyright (C) 2010,2011  Free Software Foundation, Inc.
   4  *
   5  *  GRUB is free software: you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation, either version 3 of the License, or
   8  *  (at your option) any later version.
   9  *
  10  *  GRUB is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 #ifndef __mips__
  20 #include <grub/pci.h>
  21 #endif
  22 #include <grub/machine/kernel.h>
  23 #include <grub/misc.h>
  24 #include <grub/vga.h>
  25
  26 static struct {grub_uint8_t r, g, b, a; } colors[] =
  27   {
  28     // {R, G, B, A}
  29     {0x00, 0x00, 0x00, 0xFF}, // 0 = black
  30     {0x00, 0x00, 0xA8, 0xFF}, // 1 = blue
  31     {0x00, 0xA8, 0x00, 0xFF}, // 2 = green
  32     {0x00, 0xA8, 0xA8, 0xFF}, // 3 = cyan
  33     {0xA8, 0x00, 0x00, 0xFF}, // 4 = red
  34     {0xA8, 0x00, 0xA8, 0xFF}, // 5 = magenta
  35     {0xA8, 0x54, 0x00, 0xFF}, // 6 = brown
  36     {0xA8, 0xA8, 0xA8, 0xFF}, // 7 = light gray
  37
  38     {0x54, 0x54, 0x54, 0xFF}, // 8 = dark gray
  39     {0x54, 0x54, 0xFE, 0xFF}, // 9 = bright blue
  40     {0x54, 0xFE, 0x54, 0xFF}, // 10 = bright green
  41     {0x54, 0xFE, 0xFE, 0xFF}, // 11 = bright cyan
  42     {0xFE, 0x54, 0x54, 0xFF}, // 12 = bright red
  43     {0xFE, 0x54, 0xFE, 0xFF}, // 13 = bright magenta
  44     {0xFE, 0xFE, 0x54, 0xFF}, // 14 = yellow
  45     {0xFE, 0xFE, 0xFE, 0xFF}  // 15 = white
  46   };
  47
  48 #ifdef __mips__
  49 extern unsigned char ascii_bitmaps[];
  50 #else
  51 #include <ascii.h>
  52 #endif
  53
  54 #ifdef __mips__
  55 #define VGA_ADDR 0xb00a0000
  56 #else
  57 #define VGA_ADDR 0xa0000
  58 #endif
  59
  60 static void
  61 load_font (void)
  62 {
  63   unsigned i;
  64
  65   grub_vga_gr_write (0 << 2, GRUB_VGA_GR_GR6);
  66
  67   grub_vga_sr_write (GRUB_VGA_SR_MEMORY_MODE_NORMAL, GRUB_VGA_SR_MEMORY_MODE);
  68   grub_vga_sr_write (1 << GRUB_VGA_TEXT_FONT_PLANE,
  69                      GRUB_VGA_SR_MAP_MASK_REGISTER);
  70
  71   grub_vga_gr_write (0, GRUB_VGA_GR_DATA_ROTATE);
  72   grub_vga_gr_write (0, GRUB_VGA_GR_MODE);
  73   grub_vga_gr_write (0xff, GRUB_VGA_GR_BITMASK);
  74
  75   for (i = 0; i < 128; i++)
  76     grub_memcpy ((void *) (VGA_ADDR + 32 * i), ascii_bitmaps + 16 * i, 16);
  77 }
  78
  79 static void
  80 load_palette (void)
  81 {
  82   unsigned i;
  83   for (i = 0; i < 16; i++)
  84     grub_vga_write_arx (i, i);
  85
  86   for (i = 0; i < ARRAY_SIZE (colors); i++)
  87     grub_vga_palette_write (i, colors[i].r, colors[i].g, colors[i].b);
  88 }
  89
  90 void
  91 grub_qemu_init_cirrus (void)
  92 {
  93 #ifndef __mips__
  94   auto int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid);
  95   int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid __attribute__ ((unused)))
  96     {
  97       grub_pci_address_t addr;
  98       grub_uint32_t class;
  99
 100       addr = grub_pci_make_address (dev, GRUB_PCI_REG_CLASS);
 101       class = grub_pci_read (addr);
 102
 103       if (((class >> 16) & 0xffff) != GRUB_PCI_CLASS_SUBCLASS_VGA)
 104         return 0;
 105
 106       /* FIXME: chooose addresses dynamically.  */
 107       addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG0);
 108       grub_pci_write (addr, 0xf0000000 | GRUB_PCI_ADDR_MEM_PREFETCH
 109                       | GRUB_PCI_ADDR_SPACE_MEMORY | GRUB_PCI_ADDR_MEM_TYPE_32);
 110       addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG1);
 111       grub_pci_write (addr, 0xf2000000
 112                       | GRUB_PCI_ADDR_SPACE_MEMORY | GRUB_PCI_ADDR_MEM_TYPE_32);
 113
 114       addr = grub_pci_make_address (dev, GRUB_PCI_REG_COMMAND);
 115       grub_pci_write (addr, GRUB_PCI_COMMAND_MEM_ENABLED
 116                       | GRUB_PCI_COMMAND_IO_ENABLED);
 117
 118       return 1;
 119     }
 120
 121   grub_pci_iterate (find_card);
 122 #endif
 123
 124   grub_outb (GRUB_VGA_IO_MISC_COLOR,
 125              GRUB_MACHINE_PCI_IO_BASE + GRUB_VGA_IO_MISC_WRITE);
 126
 127   load_font ();
 128
 129   grub_vga_gr_write (GRUB_VGA_GR_GR6_MMAP_CGA, GRUB_VGA_GR_GR6);
 130   grub_vga_gr_write (GRUB_VGA_GR_MODE_ODD_EVEN, GRUB_VGA_GR_MODE);
 131
 132   grub_vga_sr_write (GRUB_VGA_SR_MEMORY_MODE_NORMAL, GRUB_VGA_SR_MEMORY_MODE);
 133
 134   grub_vga_sr_write ((1 << GRUB_VGA_TEXT_TEXT_PLANE)
 135                      | (1 << GRUB_VGA_TEXT_ATTR_PLANE),
 136                      GRUB_VGA_SR_MAP_MASK_REGISTER);
 137
 138   grub_vga_cr_write (15, GRUB_VGA_CR_CELL_HEIGHT);
 139   grub_vga_cr_write (79, GRUB_VGA_CR_HORIZ_END);
 140   grub_vga_cr_write (40, GRUB_VGA_CR_PITCH);
 141
 142   int vert = 25 * 16;
 143   grub_vga_cr_write (vert & 0xff, GRUB_VGA_CR_VDISPLAY_END);
 144   grub_vga_cr_write (((vert >> GRUB_VGA_CR_OVERFLOW_HEIGHT1_SHIFT)
 145                       & GRUB_VGA_CR_OVERFLOW_HEIGHT1_MASK)
 146                      | ((vert >> GRUB_VGA_CR_OVERFLOW_HEIGHT2_SHIFT)
 147                         & GRUB_VGA_CR_OVERFLOW_HEIGHT2_MASK),
 148                      GRUB_VGA_CR_OVERFLOW);
 149
 150   load_palette ();
 151
 152   grub_vga_write_arx (GRUB_VGA_ARX_MODE_TEXT, GRUB_VGA_ARX_MODE);
 153   grub_vga_write_arx (0, GRUB_VGA_ARX_COLOR_SELECT);
 154
 155   grub_vga_sr_write (GRUB_VGA_SR_CLOCKING_MODE_8_DOT_CLOCK,
 156                      GRUB_VGA_SR_CLOCKING_MODE);
 157
 158   grub_vga_cr_write (14, GRUB_VGA_CR_CURSOR_START);
 159   grub_vga_cr_write (15, GRUB_VGA_CR_CURSOR_END);
 160
 161   grub_outb (0x20, GRUB_MACHINE_PCI_IO_BASE + GRUB_VGA_IO_ARX);
 162 }