← Back to branch summary

~ubuntu-branches/debian/stretch/grub2/stretch

« back to all changes in this revision

Viewing changes to kern/i386/qemu/init.c

Tags: upstream-1.98+20100705
Import upstream version 1.98+20100705

Show diffs side-by-side

added added

removed removed

Lines of Context:
kern/i386/qemu/init.c
 
1
/*
 
2
 *  GRUB  --  GRand Unified Bootloader
 
3
 *  Copyright (C) 2010  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
#include <grub/pci.h>
 
20
#include <grub/machine/kernel.h>
 
21
#include <grub/misc.h>
 
22
#include <grub/vga.h>
 
23
 
 
24
static struct {grub_uint8_t r, g, b, a; } colors[] =
 
25
  {
 
26
    // {R, G, B, A}
 
27
    {0x00, 0x00, 0x00, 0xFF}, // 0 = black
 
28
    {0x00, 0x00, 0xA8, 0xFF}, // 1 = blue
 
29
    {0x00, 0xA8, 0x00, 0xFF}, // 2 = green
 
30
    {0x00, 0xA8, 0xA8, 0xFF}, // 3 = cyan
 
31
    {0xA8, 0x00, 0x00, 0xFF}, // 4 = red
 
32
    {0xA8, 0x00, 0xA8, 0xFF}, // 5 = magenta
 
33
    {0xA8, 0x54, 0x00, 0xFF}, // 6 = brown
 
34
    {0xA8, 0xA8, 0xA8, 0xFF}, // 7 = light gray
 
35
 
 
36
    {0x54, 0x54, 0x54, 0xFF}, // 8 = dark gray
 
37
    {0x54, 0x54, 0xFE, 0xFF}, // 9 = bright blue
 
38
    {0x54, 0xFE, 0x54, 0xFF}, // 10 = bright green
 
39
    {0x54, 0xFE, 0xFE, 0xFF}, // 11 = bright cyan
 
40
    {0xFE, 0x54, 0x54, 0xFF}, // 12 = bright red
 
41
    {0xFE, 0x54, 0xFE, 0xFF}, // 13 = bright magenta
 
42
    {0xFE, 0xFE, 0x54, 0xFF}, // 14 = yellow
 
43
    {0xFE, 0xFE, 0xFE, 0xFF}  // 15 = white
 
44
  };
 
45
 
 
46
#include <ascii.h>
 
47
 
 
48
static void
 
49
load_font (void)
 
50
{
 
51
  unsigned i;
 
52
 
 
53
  grub_vga_gr_write (0 << 2, GRUB_VGA_GR_GR6);
 
54
 
 
55
  grub_vga_sr_write (GRUB_VGA_SR_MEMORY_MODE_NORMAL, GRUB_VGA_SR_MEMORY_MODE);
 
56
  grub_vga_sr_write (1 << GRUB_VGA_TEXT_FONT_PLANE,
 
57
                     GRUB_VGA_SR_MAP_MASK_REGISTER);
 
58
 
 
59
  grub_vga_gr_write (0, GRUB_VGA_GR_DATA_ROTATE);
 
60
  grub_vga_gr_write (0, GRUB_VGA_GR_MODE);
 
61
  grub_vga_gr_write (0xff, GRUB_VGA_GR_BITMASK);
 
62
 
 
63
  for (i = 0; i < 128; i++)
 
64
    grub_memcpy ((void *) (0xa0000 + 32 * i), ascii_bitmaps + 16 * i, 16);
 
65
}
 
66
 
 
67
static void
 
68
load_palette (void)
 
69
{
 
70
  unsigned i;
 
71
  for (i = 0; i < 16; i++)
 
72
    {
 
73
      grub_outb (i, GRUB_VGA_IO_ARX);
 
74
      grub_outb (i, GRUB_VGA_IO_ARX);
 
75
    }
 
76
 
 
77
  for (i = 0; i < ARRAY_SIZE (colors); i++)
 
78
    grub_vga_palette_write (i, colors[i].r, colors[i].g, colors[i].b);
 
79
}
 
80
 
 
81
void
 
82
grub_qemu_init_cirrus (void)
 
83
{
 
84
  auto int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid);
 
85
  int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid __attribute__ ((unused)))
 
86
    {
 
87
      grub_pci_address_t addr;
 
88
      grub_uint32_t class;
 
89
 
 
90
      addr = grub_pci_make_address (dev, GRUB_PCI_REG_CLASS);
 
91
      class = grub_pci_read (addr);
 
92
 
 
93
      if (((class >> 16) & 0xffff) != 0x0300)
 
94
        return 0;
 
95
      
 
96
      /* FIXME: chooose addresses dynamically.  */
 
97
      addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG0);
 
98
      grub_pci_write (addr, 0xf0000000 | GRUB_PCI_ADDR_MEM_PREFETCH
 
99
                      | GRUB_PCI_ADDR_SPACE_MEMORY | GRUB_PCI_ADDR_MEM_TYPE_32);
 
100
      addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG1);
 
101
      grub_pci_write (addr, 0xf2000000
 
102
                      | GRUB_PCI_ADDR_SPACE_MEMORY | GRUB_PCI_ADDR_MEM_TYPE_32);
 
103
 
 
104
      addr = grub_pci_make_address (dev, GRUB_PCI_REG_COMMAND);
 
105
      grub_pci_write (addr, GRUB_PCI_COMMAND_MEM_ENABLED
 
106
                      | GRUB_PCI_COMMAND_IO_ENABLED);
 
107
      
 
108
      return 1;
 
109
    }
 
110
 
 
111
  grub_pci_iterate (find_card);
 
112
 
 
113
  grub_outb (1, 0x3c2);
 
114
 
 
115
  load_font ();
 
116
 
 
117
  grub_vga_gr_write (GRUB_VGA_GR_GR6_MMAP_CGA, GRUB_VGA_GR_GR6);
 
118
  grub_vga_gr_write (GRUB_VGA_GR_MODE_ODD_EVEN, GRUB_VGA_GR_MODE);
 
119
 
 
120
  grub_vga_sr_write (GRUB_VGA_SR_MEMORY_MODE_NORMAL, GRUB_VGA_SR_MEMORY_MODE);
 
121
 
 
122
  grub_vga_sr_write ((1 << GRUB_VGA_TEXT_TEXT_PLANE)
 
123
                     | (1 << GRUB_VGA_TEXT_ATTR_PLANE),
 
124
                     GRUB_VGA_SR_MAP_MASK_REGISTER);
 
125
 
 
126
  grub_vga_cr_write (15, GRUB_VGA_CR_CELL_HEIGHT);
 
127
  grub_vga_cr_write (79, GRUB_VGA_CR_WIDTH);
 
128
  grub_vga_cr_write (40, GRUB_VGA_CR_PITCH);
 
129
 
 
130
  int vert = 25 * 16;
 
131
  grub_vga_cr_write (vert & 0xff, GRUB_VGA_CR_HEIGHT);
 
132
  grub_vga_cr_write (((vert >> GRUB_VGA_CR_OVERFLOW_HEIGHT1_SHIFT)
 
133
                      & GRUB_VGA_CR_OVERFLOW_HEIGHT1_MASK)
 
134
                     | ((vert >> GRUB_VGA_CR_OVERFLOW_HEIGHT2_SHIFT)
 
135
                        & GRUB_VGA_CR_OVERFLOW_HEIGHT2_MASK),
 
136
                     GRUB_VGA_CR_OVERFLOW);
 
137
 
 
138
  load_palette ();
 
139
 
 
140
  grub_outb (0x10, 0x3c0);
 
141
  grub_outb (0, 0x3c1);
 
142
  grub_outb (0x14, 0x3c0);
 
143
  grub_outb (0, 0x3c1);
 
144
 
 
145
  grub_vga_sr_write (GRUB_VGA_SR_CLOCKING_MODE_8_DOT_CLOCK,
 
146
                     GRUB_VGA_SR_CLOCKING_MODE);
 
147
 
 
148
  grub_vga_cr_write (14, GRUB_VGA_CR_CURSOR_START);
 
149
  grub_vga_cr_write (15, GRUB_VGA_CR_CURSOR_END);
 
150
 
 
151
  grub_outb (0x20, 0x3c0);
 
152
}