|
|
1.1 root 1: /*
2: * Copyright (c) 2004-2005 Fabrice Bellard
3: *
4: * This program is free software; you can redistribute it and/or
5: * modify it under the terms of the GNU General Public License V2
6: * as published by the Free Software Foundation
7: *
8: * This program is distributed in the hope that it will be useful,
9: * but WITHOUT ANY WARRANTY; without even the implied warranty of
10: * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11: * GNU General Public License for more details.
12: *
13: * You should have received a copy of the GNU General Public License
14: * along with this program; if not, write to the Free Software
15: * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
16: * MA 02110-1301, USA.
17: */
18:
19: #include "config.h"
20: #include "kernel/kernel.h"
21: #include "libopenbios/bindings.h"
22: #include "drivers/pci.h"
23: #include "drivers/drivers.h"
24: #include "libopenbios/fontdata.h"
25: #include "asm/io.h"
26: #include "libc/vsprintf.h"
27: #include "drivers/vga.h"
28: #include "packages/video.h"
29: #include "libopenbios/ofmem.h"
30:
31: /* VGA init. We use the Bochs VESA VBE extensions */
32: #define VBE_DISPI_INDEX_ID 0x0
33: #define VBE_DISPI_INDEX_XRES 0x1
34: #define VBE_DISPI_INDEX_YRES 0x2
35: #define VBE_DISPI_INDEX_BPP 0x3
36: #define VBE_DISPI_INDEX_ENABLE 0x4
37: #define VBE_DISPI_INDEX_BANK 0x5
38: #define VBE_DISPI_INDEX_VIRT_WIDTH 0x6
39: #define VBE_DISPI_INDEX_VIRT_HEIGHT 0x7
40: #define VBE_DISPI_INDEX_X_OFFSET 0x8
41: #define VBE_DISPI_INDEX_Y_OFFSET 0x9
42: #define VBE_DISPI_INDEX_NB 0xa
43:
44: #define VBE_DISPI_ID0 0xB0C0
45: #define VBE_DISPI_ID1 0xB0C1
46: #define VBE_DISPI_ID2 0xB0C2
47:
48: #define VBE_DISPI_DISABLED 0x00
49: #define VBE_DISPI_ENABLED 0x01
50: #define VBE_DISPI_LFB_ENABLED 0x40
51: #define VBE_DISPI_NOCLEARMEM 0x80
52:
53: static void vbe_outw(int index, int val)
54: {
55: outw(index, 0x1ce);
56: outw(val, 0x1d0);
57: }
58:
59: /* for depth = 8 mode, set a hardware palette entry */
60: void vga_set_color(int i, unsigned int r, unsigned int g, unsigned int b)
61: {
62: r &= 0xff;
63: g &= 0xff;
64: b &= 0xff;
65: outb(i, 0x3c8);
66: outb(r >> 2, 0x3c9);
67: outb(g >> 2, 0x3c9);
68: outb(b >> 2, 0x3c9);
69: }
70:
71: /* build standard RGB palette */
72: static void vga_build_rgb_palette(void)
73: {
74: static const uint8_t pal_value[6] = { 0x00, 0x33, 0x66, 0x99, 0xcc, 0xff };
75: int i, r, g, b;
76:
77: i = 0;
78: for(r = 0; r < 6; r++) {
79: for(g = 0; g < 6; g++) {
80: for(b = 0; b < 6; b++) {
81: vga_set_color(i, pal_value[r], pal_value[g], pal_value[b]);
82: i++;
83: }
84: }
85: }
86: }
87:
88: /* depth = 8, 15, 16 or 32 */
89: void vga_vbe_set_mode(int width, int height, int depth)
90: {
91: outb(0x00, 0x3c0); /* enable blanking */
92: vbe_outw(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_DISABLED);
93: vbe_outw(VBE_DISPI_INDEX_X_OFFSET, 0);
94: vbe_outw(VBE_DISPI_INDEX_Y_OFFSET, 0);
95: vbe_outw(VBE_DISPI_INDEX_XRES, width);
96: vbe_outw(VBE_DISPI_INDEX_YRES, height);
97: vbe_outw(VBE_DISPI_INDEX_BPP, depth);
98: vbe_outw(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED);
99: outb(0x00, 0x3c0);
100: outb(0x20, 0x3c0); /* disable blanking */
101:
102: if (depth == 8)
103: vga_build_rgb_palette();
104: }
105:
106: #ifdef CONFIG_VGA_WIDTH
107: #define VGA_DEFAULT_WIDTH CONFIG_VGA_WIDTH
108: #else
109: #define VGA_DEFAULT_WIDTH 800
110: #endif
111:
112: #ifdef CONFIG_VGA_HEIGHT
113: #define VGA_DEFAULT_HEIGHT CONFIG_VGA_HEIGHT
114: #else
115: #define VGA_DEFAULT_HEIGHT 600
116: #endif
117:
118: #ifdef CONFIG_VGA_DEPTH
119: #define VGA_DEFAULT_DEPTH CONFIG_VGA_DEPTH
120: #else
121: #define VGA_DEFAULT_DEPTH 8
122: #endif
123:
124: #define VGA_DEFAULT_LINEBYTES (VGA_DEFAULT_WIDTH*((VGA_DEFAULT_DEPTH+7)/8))
125:
126: void vga_vbe_init(const char *path, unsigned long fb, uint32_t fb_size,
127: unsigned long rom, uint32_t rom_size)
128: {
129: phandle_t ph, chosen, aliases, options;
130: char buf[6];
131: int width = VGA_DEFAULT_WIDTH;
132: int height = VGA_DEFAULT_HEIGHT;
133: int depth = VGA_DEFAULT_DEPTH;
134: int linebytes = VGA_DEFAULT_LINEBYTES;
135:
1.1.1.2 ! root 136: #if defined(CONFIG_QEMU) && (defined(CONFIG_PPC) || defined(CONFIG_SPARC32) || defined(CONFIG_SPARC64))
1.1 root 137: int w, h, d;
138: w = fw_cfg_read_i16(FW_CFG_ARCH_WIDTH);
139: h = fw_cfg_read_i16(FW_CFG_ARCH_HEIGHT);
140: d = fw_cfg_read_i16(FW_CFG_ARCH_DEPTH);
141: if (w && h && d) {
142: width = w;
143: height = h;
144: depth = d;
145: linebytes = (width * ((depth + 7) / 8));
146: }
147: #endif
148:
149: vga_vbe_set_mode(width, height, depth);
150:
151: #if 0
152: ph = find_dev(path);
153: #else
154: ph = get_cur_dev();
155: #endif
156:
157: set_int_property(ph, "width", width);
158: set_int_property(ph, "height", height);
159: set_int_property(ph, "depth", depth);
160: set_int_property(ph, "linebytes", linebytes);
161: set_int_property(ph, "address", (u32)(fb & ~0x0000000F));
162:
163: chosen = find_dev("/chosen");
164: push_str(path);
165: fword("open-dev");
166: set_int_property(chosen, "display", POP());
167:
168: aliases = find_dev("/aliases");
169: set_property(aliases, "screen", path, strlen(path) + 1);
170:
171: options = find_dev("/options");
172: snprintf(buf, sizeof(buf), "%d", width / FONT_WIDTH);
173: set_property(options, "screen-#columns", buf, strlen(buf) + 1);
174: snprintf(buf, sizeof(buf), "%d", height / FONT_HEIGHT);
175: set_property(options, "screen-#rows", buf, strlen(buf) + 1);
176:
177: if (rom_size >= 8) {
178: const char *p;
179: int size;
180:
181: p = (const char *)rom;
182: if (p[0] == 'N' && p[1] == 'D' && p[2] == 'R' && p[3] == 'V') {
183: size = *(uint32_t*)(p + 4);
184: set_property(ph, "driver,AAPL,MacOS,PowerPC",
185: p + 8, size);
186: }
187: }
188:
189: init_video(fb, width, height, depth, linebytes);
190: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.