a8f667ca4e309234ba17a0bda16a6a0be2bab7fb
[seabios.git] / src / vgahooks.c
1 // Hooks for via vgabios calls into main bios.
2 //
3 // Copyright (C) 2008  Kevin O'Connor <kevin@koconnor.net>
4 //
5 // This file may be distributed under the terms of the GNU LGPLv3 license.
6
7 #include "bregs.h" // set_code_invalid
8 #include "biosvar.h" // GET_GLOBAL
9 #include "pci.h" // pci_find_device
10 #include "pci_regs.h" // PCI_VENDOR_ID
11 #include "pci_ids.h" // PCI_VENDOR_ID_VIA
12 #include "util.h" // handle_155f
13 #include "config.h" // CONFIG_*
14
15 #define VH_VIA 1
16 #define VH_INTEL 2
17
18 int VGAHookHandlerType VAR16VISIBLE;
19
20 static void
21 handle_155fXX(struct bregs *regs)
22 {
23     set_code_unimplemented(regs, RET_EUNSUPPORTED);
24 }
25
26
27 /****************************************************************
28  * Via hooks
29  ****************************************************************/
30
31 int ViaFBsize VAR16VISIBLE, ViaRamSpeed VAR16VISIBLE;
32
33 static void
34 via_155f01(struct bregs *regs)
35 {
36     regs->eax = 0x5f;
37     regs->cl = 2; // panel type =  2 = 1024 * 768
38     set_success(regs);
39     dprintf(1, "Warning: VGA panel type is hardcoded\n");
40 }
41
42 static void
43 via_155f02(struct bregs *regs)
44 {
45     regs->eax = 0x5f;
46     regs->bx = 2;
47     regs->cx = 0x401;  // PAL + crt only
48     regs->dx = 0;  // TV Layout - default
49     set_success(regs);
50     dprintf(1, "Warning: VGA TV/CRT output type is hardcoded\n");
51 }
52
53 static void
54 via_155f18(struct bregs *regs)
55 {
56     int fbsize = GET_GLOBAL(ViaFBsize), ramspeed = GET_GLOBAL(ViaRamSpeed);
57     if (fbsize < 0 || ramspeed < 0) {
58         set_code_invalid(regs, RET_EUNSUPPORTED);
59         return;
60     }
61     regs->eax = 0x5f;
62     regs->ebx = 0x500 | (ramspeed << 4) | fbsize;
63     regs->ecx = 0x060;
64     set_success(regs);
65 }
66
67 static void
68 via_155f19(struct bregs *regs)
69 {
70     set_invalid_silent(regs);
71 }
72
73 static void
74 via_155f(struct bregs *regs)
75 {
76     switch (regs->al) {
77     case 0x01: via_155f01(regs); break;
78     case 0x02: via_155f02(regs); break;
79     case 0x18: via_155f18(regs); break;
80     case 0x19: via_155f19(regs); break;
81     default:   handle_155fXX(regs); break;
82     }
83 }
84
85 static int
86 getFBSize(struct pci_device *pci)
87 {
88     /* FB config */
89     u8 reg = pci_config_readb(pci->bdf, 0xa1);
90
91     /* GFX disabled ? */
92     if (!(reg & 0x80))
93         return -1;
94
95     static u8 mem_power[] = {0, 3, 4, 5, 6, 7, 8, 9};
96     return mem_power[(reg >> 4) & 0x7];
97 }
98
99 static int
100 getViaRamSpeed(struct pci_device *pci)
101 {
102     return (pci_config_readb(pci->bdf, 0x90) & 0x07) + 3;
103 }
104
105 static int
106 getAMDRamSpeed(void)
107 {
108     struct pci_device *pci = pci_find_device(PCI_VENDOR_ID_AMD
109                                              , PCI_DEVICE_ID_AMD_K8_NB_MEMCTL);
110     if (!pci)
111         return -1;
112
113     /* mem clk 0 = DDR2 400 */
114     return (pci_config_readb(pci->bdf, 0x94) & 0x7) + 6;
115 }
116
117 /* int 0x15 - 5f18
118
119    ECX = unknown/dont care
120    EBX[3..0] Frame Buffer Size 2^N MiB
121    EBX[7..4] Memory speed:
122        0: SDR  66Mhz
123        1: SDR 100Mhz
124        2: SDR 133Mhz
125        3: DDR 100Mhz (PC1600 or DDR200)
126        4: DDR 133Mhz (PC2100 or DDR266)
127        5: DDR 166Mhz (PC2700 or DDR333)
128        6: DDR 200Mhz (PC3200 or DDR400)
129        7: DDR2 133Mhz (DDR2 533)
130        8: DDR2 166Mhz (DDR2 667)
131        9: DDR2 200Mhz (DDR2 800)
132        A: DDR2 233Mhz (DDR2 1066)
133        B: and above: Unknown
134    EBX[?..8] Total memory size?
135    EAX = 0x5f for success
136 */
137
138 #define PCI_DEVICE_ID_VIA_K8M890CE_3    0x3336
139 #define PCI_DEVICE_ID_VIA_VX855_MEMCTRL 0x3409
140
141 static void
142 via_setup(struct pci_device *pci)
143 {
144     VGAHookHandlerType = VH_VIA;
145
146     struct pci_device *d = pci_find_device(PCI_VENDOR_ID_VIA
147                                            , PCI_DEVICE_ID_VIA_K8M890CE_3);
148     if (d) {
149         ViaFBsize = getFBSize(d);
150         ViaRamSpeed = getAMDRamSpeed();
151         return;
152     }
153     d = pci_find_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_VX855_MEMCTRL);
154     if (d) {
155         ViaFBsize = getFBSize(d);
156         ViaRamSpeed = getViaRamSpeed(d);
157         return;
158     }
159
160     dprintf(1, "Warning: VGA memory size and speed is hardcoded\n");
161     ViaFBsize = 5; // 32M frame buffer
162     ViaRamSpeed = 4; // MCLK = DDR266
163 }
164
165
166 /****************************************************************
167  * Intel VGA hooks
168  ****************************************************************/
169
170 u8 IntelDisplayType VAR16VISIBLE, IntelDisplayId VAR16VISIBLE;
171
172 static void
173 intel_155f35(struct bregs *regs)
174 {
175     regs->ax = 0x005f;
176     regs->cl = GET_GLOBAL(IntelDisplayType);
177     set_success(regs);
178 }
179
180 static void
181 intel_155f40(struct bregs *regs)
182 {
183     regs->ax = 0x005f;
184     regs->cl = GET_GLOBAL(IntelDisplayId);
185     set_success(regs);
186 }
187
188 static void
189 intel_155f(struct bregs *regs)
190 {
191     switch (regs->al) {
192     case 0x35: intel_155f35(regs); break;
193     case 0x40: intel_155f40(regs); break;
194     default:   handle_155fXX(regs); break;
195     }
196 }
197
198 #define BOOT_DISPLAY_DEFAULT    (0)
199 #define BOOT_DISPLAY_CRT        (1 << 0)
200 #define BOOT_DISPLAY_TV         (1 << 1)
201 #define BOOT_DISPLAY_EFP        (1 << 2)
202 #define BOOT_DISPLAY_LCD        (1 << 3)
203 #define BOOT_DISPLAY_CRT2       (1 << 4)
204 #define BOOT_DISPLAY_TV2        (1 << 5)
205 #define BOOT_DISPLAY_EFP2       (1 << 6)
206 #define BOOT_DISPLAY_LCD2       (1 << 7)
207
208 static void
209 roda_setup(struct pci_device *pci)
210 {
211     VGAHookHandlerType = VH_INTEL;
212     // IntelDisplayType = BOOT_DISPLAY_DEFAULT;
213     IntelDisplayType = BOOT_DISPLAY_LCD;
214     // IntelDisplayId = inb(0x60f) & 0x0f; // Correct according to Crete
215     IntelDisplayId = 3; // Correct according to empirical studies
216 }
217
218 static void
219 kontron_setup(struct pci_device *pci)
220 {
221     VGAHookHandlerType = VH_INTEL;
222     IntelDisplayType = BOOT_DISPLAY_CRT;
223     IntelDisplayId = 3;
224 }
225
226 static void
227 getac_setup(struct pci_device *pci)
228 {
229 }
230
231
232 /****************************************************************
233  * Entry and setup
234  ****************************************************************/
235
236 // Main 16bit entry point
237 void
238 handle_155f(struct bregs *regs)
239 {
240     if (!CONFIG_VGAHOOKS) {
241         handle_155fXX(regs);
242         return;
243     }
244
245     int htype = GET_GLOBAL(VGAHookHandlerType);
246     switch (htype) {
247     case VH_VIA:   via_155f(regs); break;
248     case VH_INTEL: intel_155f(regs); break;
249     default:       handle_155fXX(regs); break;
250     }
251 }
252
253 // Setup
254 void
255 vgahook_setup(struct pci_device *pci)
256 {
257     if (!CONFIG_VGAHOOKS || !CBvendor || !CBpart)
258         return;
259
260     if (strcmp(CBvendor, "KONTRON") == 0 && strcmp(CBpart, "986LCD-M") == 0)
261         kontron_setup(pci);
262     else if (strcmp(CBvendor, "GETAC") == 0 && strcmp(CBpart, "P470") == 0)
263         getac_setup(pci);
264     else if (strcmp(CBvendor, "RODA") == 0 && strcmp(CBpart, "RK886EX") == 0)
265         roda_setup(pci);
266     else if (pci->vendor == PCI_VENDOR_ID_VIA)
267         via_setup(pci);
268 }