Commit | Line | Data |
---|---|---|
7c83172b HY |
1 | /* |
2 | * Framebuffer driver for EFI/UEFI based system | |
3 | * | |
4 | * (c) 2006 Edgar Hucek <gimli@dark-green.com> | |
5 | * Original efi driver written by Gerd Knorr <kraxel@goldbach.in-berlin.de> | |
6 | * | |
7 | */ | |
8 | ||
9 | #include <linux/module.h> | |
10 | #include <linux/kernel.h> | |
11 | #include <linux/errno.h> | |
12 | #include <linux/fb.h> | |
13 | #include <linux/platform_device.h> | |
14 | #include <linux/screen_info.h> | |
7c08c9ae | 15 | #include <linux/dmi.h> |
85a00d9b | 16 | #include <linux/pci.h> |
7c83172b HY |
17 | #include <video/vga.h> |
18 | ||
da0241f1 AL |
19 | static bool request_mem_succeeded = false; |
20 | ||
b4aa0163 MG |
21 | static struct pci_dev *default_vga; |
22 | ||
ec81c9cc | 23 | static struct fb_var_screeninfo efifb_defined __devinitdata = { |
7c83172b HY |
24 | .activate = FB_ACTIVATE_NOW, |
25 | .height = -1, | |
26 | .width = -1, | |
27 | .right_margin = 32, | |
28 | .upper_margin = 16, | |
29 | .lower_margin = 4, | |
30 | .vsync_len = 4, | |
31 | .vmode = FB_VMODE_NONINTERLACED, | |
32 | }; | |
33 | ||
ec81c9cc | 34 | static struct fb_fix_screeninfo efifb_fix __devinitdata = { |
7c83172b HY |
35 | .id = "EFI VGA", |
36 | .type = FB_TYPE_PACKED_PIXELS, | |
37 | .accel = FB_ACCEL_NONE, | |
38 | .visual = FB_VISUAL_TRUECOLOR, | |
39 | }; | |
40 | ||
7c08c9ae PJ |
41 | enum { |
42 | M_I17, /* 17-Inch iMac */ | |
43 | M_I20, /* 20-Inch iMac */ | |
44 | M_I20_SR, /* 20-Inch iMac (Santa Rosa) */ | |
45 | M_I24, /* 24-Inch iMac */ | |
a5757c2a LM |
46 | M_I24_8_1, /* 24-Inch iMac, 8,1th gen */ |
47 | M_I24_10_1, /* 24-Inch iMac, 10,1th gen */ | |
48 | M_I27_11_1, /* 27-Inch iMac, 11,1th gen */ | |
7c08c9ae | 49 | M_MINI, /* Mac Mini */ |
a5757c2a LM |
50 | M_MINI_3_1, /* Mac Mini, 3,1th gen */ |
51 | M_MINI_4_1, /* Mac Mini, 4,1th gen */ | |
7c08c9ae PJ |
52 | M_MB, /* MacBook */ |
53 | M_MB_2, /* MacBook, 2nd rev. */ | |
54 | M_MB_3, /* MacBook, 3rd rev. */ | |
a5757c2a LM |
55 | M_MB_5_1, /* MacBook, 5th rev. */ |
56 | M_MB_6_1, /* MacBook, 6th rev. */ | |
57 | M_MB_7_1, /* MacBook, 7th rev. */ | |
7c08c9ae PJ |
58 | M_MB_SR, /* MacBook, 2nd gen, (Santa Rosa) */ |
59 | M_MBA, /* MacBook Air */ | |
97fb8507 | 60 | M_MBA_3, /* Macbook Air, 3rd rev */ |
7c08c9ae PJ |
61 | M_MBP, /* MacBook Pro */ |
62 | M_MBP_2, /* MacBook Pro 2nd gen */ | |
a5757c2a | 63 | M_MBP_2_2, /* MacBook Pro 2,2nd gen */ |
7c08c9ae PJ |
64 | M_MBP_SR, /* MacBook Pro (Santa Rosa) */ |
65 | M_MBP_4, /* MacBook Pro, 4th gen */ | |
8a3bdfe6 | 66 | M_MBP_5_1, /* MacBook Pro, 5,1th gen */ |
a5757c2a LM |
67 | M_MBP_5_2, /* MacBook Pro, 5,2th gen */ |
68 | M_MBP_5_3, /* MacBook Pro, 5,3rd gen */ | |
69 | M_MBP_6_1, /* MacBook Pro, 6,1th gen */ | |
70 | M_MBP_6_2, /* MacBook Pro, 6,2th gen */ | |
71 | M_MBP_7_1, /* MacBook Pro, 7,1th gen */ | |
e9c5db0b | 72 | M_MBP_8_2, /* MacBook Pro, 8,2nd gen */ |
7c08c9ae PJ |
73 | M_UNKNOWN /* placeholder */ |
74 | }; | |
75 | ||
47dfe51f PJ |
76 | #define OVERRIDE_NONE 0x0 |
77 | #define OVERRIDE_BASE 0x1 | |
78 | #define OVERRIDE_STRIDE 0x2 | |
79 | #define OVERRIDE_HEIGHT 0x4 | |
80 | #define OVERRIDE_WIDTH 0x8 | |
81 | ||
7c08c9ae PJ |
82 | static struct efifb_dmi_info { |
83 | char *optname; | |
84 | unsigned long base; | |
85 | int stride; | |
86 | int width; | |
87 | int height; | |
47dfe51f | 88 | int flags; |
ec81c9cc | 89 | } dmi_list[] __initdata = { |
47dfe51f PJ |
90 | [M_I17] = { "i17", 0x80010000, 1472 * 4, 1440, 900, OVERRIDE_NONE }, |
91 | [M_I20] = { "i20", 0x80010000, 1728 * 4, 1680, 1050, OVERRIDE_NONE }, /* guess */ | |
92 | [M_I20_SR] = { "imac7", 0x40010000, 1728 * 4, 1680, 1050, OVERRIDE_NONE }, | |
93 | [M_I24] = { "i24", 0x80010000, 2048 * 4, 1920, 1200, OVERRIDE_NONE }, /* guess */ | |
94 | [M_I24_8_1] = { "imac8", 0xc0060000, 2048 * 4, 1920, 1200, OVERRIDE_NONE }, | |
95 | [M_I24_10_1] = { "imac10", 0xc0010000, 2048 * 4, 1920, 1080, OVERRIDE_NONE }, | |
96 | [M_I27_11_1] = { "imac11", 0xc0010000, 2560 * 4, 2560, 1440, OVERRIDE_NONE }, | |
97 | [M_MINI]= { "mini", 0x80000000, 2048 * 4, 1024, 768, OVERRIDE_NONE }, | |
98 | [M_MINI_3_1] = { "mini31", 0x40010000, 1024 * 4, 1024, 768, OVERRIDE_NONE }, | |
99 | [M_MINI_4_1] = { "mini41", 0xc0010000, 2048 * 4, 1920, 1200, OVERRIDE_NONE }, | |
100 | [M_MB] = { "macbook", 0x80000000, 2048 * 4, 1280, 800, OVERRIDE_NONE }, | |
101 | [M_MB_5_1] = { "macbook51", 0x80010000, 2048 * 4, 1280, 800, OVERRIDE_NONE }, | |
102 | [M_MB_6_1] = { "macbook61", 0x80010000, 2048 * 4, 1280, 800, OVERRIDE_NONE }, | |
103 | [M_MB_7_1] = { "macbook71", 0x80010000, 2048 * 4, 1280, 800, OVERRIDE_NONE }, | |
104 | [M_MBA] = { "mba", 0x80000000, 2048 * 4, 1280, 800, OVERRIDE_NONE }, | |
97fb8507 MG |
105 | /* 11" Macbook Air 3,1 passes the wrong stride */ |
106 | [M_MBA_3] = { "mba3", 0, 2048 * 4, 0, 0, OVERRIDE_STRIDE }, | |
47dfe51f PJ |
107 | [M_MBP] = { "mbp", 0x80010000, 1472 * 4, 1440, 900, OVERRIDE_NONE }, |
108 | [M_MBP_2] = { "mbp2", 0, 0, 0, 0, OVERRIDE_NONE }, /* placeholder */ | |
109 | [M_MBP_2_2] = { "mbp22", 0x80010000, 1472 * 4, 1440, 900, OVERRIDE_NONE }, | |
110 | [M_MBP_SR] = { "mbp3", 0x80030000, 2048 * 4, 1440, 900, OVERRIDE_NONE }, | |
111 | [M_MBP_4] = { "mbp4", 0xc0060000, 2048 * 4, 1920, 1200, OVERRIDE_NONE }, | |
112 | [M_MBP_5_1] = { "mbp51", 0xc0010000, 2048 * 4, 1440, 900, OVERRIDE_NONE }, | |
113 | [M_MBP_5_2] = { "mbp52", 0xc0010000, 2048 * 4, 1920, 1200, OVERRIDE_NONE }, | |
114 | [M_MBP_5_3] = { "mbp53", 0xd0010000, 2048 * 4, 1440, 900, OVERRIDE_NONE }, | |
115 | [M_MBP_6_1] = { "mbp61", 0x90030000, 2048 * 4, 1920, 1200, OVERRIDE_NONE }, | |
116 | [M_MBP_6_2] = { "mbp62", 0x90030000, 2048 * 4, 1680, 1050, OVERRIDE_NONE }, | |
117 | [M_MBP_7_1] = { "mbp71", 0xc0010000, 2048 * 4, 1280, 800, OVERRIDE_NONE }, | |
118 | [M_MBP_8_2] = { "mbp82", 0x90010000, 1472 * 4, 1440, 900, OVERRIDE_NONE }, | |
119 | [M_UNKNOWN] = { NULL, 0, 0, 0, 0, OVERRIDE_NONE } | |
7c08c9ae PJ |
120 | }; |
121 | ||
122 | static int set_system(const struct dmi_system_id *id); | |
123 | ||
124 | #define EFIFB_DMI_SYSTEM_ID(vendor, name, enumid) \ | |
125 | { set_system, name, { \ | |
126 | DMI_MATCH(DMI_BIOS_VENDOR, vendor), \ | |
127 | DMI_MATCH(DMI_PRODUCT_NAME, name) }, \ | |
128 | &dmi_list[enumid] } | |
129 | ||
ec81c9cc | 130 | static const struct dmi_system_id dmi_system_table[] __initconst = { |
7c08c9ae PJ |
131 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "iMac4,1", M_I17), |
132 | /* At least one of these two will be right; maybe both? */ | |
133 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "iMac5,1", M_I20), | |
134 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "iMac5,1", M_I20), | |
135 | /* At least one of these two will be right; maybe both? */ | |
136 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "iMac6,1", M_I24), | |
137 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "iMac6,1", M_I24), | |
138 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "iMac7,1", M_I20_SR), | |
a5757c2a LM |
139 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "iMac8,1", M_I24_8_1), |
140 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "iMac10,1", M_I24_10_1), | |
141 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "iMac11,1", M_I27_11_1), | |
7c08c9ae | 142 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "Macmini1,1", M_MINI), |
a5757c2a LM |
143 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "Macmini3,1", M_MINI_3_1), |
144 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "Macmini4,1", M_MINI_4_1), | |
7c08c9ae PJ |
145 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "MacBook1,1", M_MB), |
146 | /* At least one of these two will be right; maybe both? */ | |
147 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "MacBook2,1", M_MB), | |
148 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBook2,1", M_MB), | |
149 | /* At least one of these two will be right; maybe both? */ | |
150 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "MacBook3,1", M_MB), | |
151 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBook3,1", M_MB), | |
152 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBook4,1", M_MB), | |
a5757c2a LM |
153 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBook5,1", M_MB_5_1), |
154 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBook6,1", M_MB_6_1), | |
155 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBook7,1", M_MB_7_1), | |
7c08c9ae | 156 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookAir1,1", M_MBA), |
97fb8507 | 157 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookAir3,1", M_MBA_3), |
7c08c9ae PJ |
158 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "MacBookPro1,1", M_MBP), |
159 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "MacBookPro2,1", M_MBP_2), | |
a5757c2a | 160 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "MacBookPro2,2", M_MBP_2_2), |
7c08c9ae PJ |
161 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro2,1", M_MBP_2), |
162 | EFIFB_DMI_SYSTEM_ID("Apple Computer, Inc.", "MacBookPro3,1", M_MBP_SR), | |
163 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro3,1", M_MBP_SR), | |
164 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro4,1", M_MBP_4), | |
8a3bdfe6 | 165 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro5,1", M_MBP_5_1), |
a5757c2a LM |
166 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro5,2", M_MBP_5_2), |
167 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro5,3", M_MBP_5_3), | |
168 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro6,1", M_MBP_6_1), | |
169 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro6,2", M_MBP_6_2), | |
170 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro7,1", M_MBP_7_1), | |
e9c5db0b | 171 | EFIFB_DMI_SYSTEM_ID("Apple Inc.", "MacBookPro8,2", M_MBP_8_2), |
7c08c9ae PJ |
172 | {}, |
173 | }; | |
174 | ||
47dfe51f PJ |
175 | #define choose_value(dmivalue, fwvalue, field, flags) ({ \ |
176 | typeof(fwvalue) _ret_ = fwvalue; \ | |
177 | if ((flags) & (field)) \ | |
178 | _ret_ = dmivalue; \ | |
179 | else if ((fwvalue) == 0) \ | |
180 | _ret_ = dmivalue; \ | |
181 | _ret_; \ | |
182 | }) | |
183 | ||
7c08c9ae PJ |
184 | static int set_system(const struct dmi_system_id *id) |
185 | { | |
186 | struct efifb_dmi_info *info = id->driver_data; | |
7c08c9ae | 187 | |
47dfe51f PJ |
188 | if (info->base == 0 && info->height == 0 && info->width == 0 |
189 | && info->stride == 0) | |
190 | return 0; | |
7c08c9ae PJ |
191 | |
192 | /* Trust the bootloader over the DMI tables */ | |
85a00d9b PJ |
193 | if (screen_info.lfb_base == 0) { |
194 | #if defined(CONFIG_PCI) | |
195 | struct pci_dev *dev = NULL; | |
196 | int found_bar = 0; | |
197 | #endif | |
47dfe51f PJ |
198 | if (info->base) { |
199 | screen_info.lfb_base = choose_value(info->base, | |
200 | screen_info.lfb_base, OVERRIDE_BASE, | |
201 | info->flags); | |
7c08c9ae | 202 | |
85a00d9b | 203 | #if defined(CONFIG_PCI) |
47dfe51f PJ |
204 | /* make sure that the address in the table is actually |
205 | * on a VGA device's PCI BAR */ | |
206 | ||
207 | for_each_pci_dev(dev) { | |
208 | int i; | |
209 | if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA) | |
210 | continue; | |
211 | for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) { | |
212 | resource_size_t start, end; | |
213 | ||
214 | start = pci_resource_start(dev, i); | |
215 | if (start == 0) | |
216 | break; | |
217 | end = pci_resource_end(dev, i); | |
218 | if (screen_info.lfb_base >= start && | |
219 | screen_info.lfb_base < end) { | |
220 | found_bar = 1; | |
221 | } | |
85a00d9b PJ |
222 | } |
223 | } | |
47dfe51f PJ |
224 | if (!found_bar) |
225 | screen_info.lfb_base = 0; | |
85a00d9b | 226 | #endif |
47dfe51f | 227 | } |
85a00d9b PJ |
228 | } |
229 | if (screen_info.lfb_base) { | |
47dfe51f PJ |
230 | screen_info.lfb_linelength = choose_value(info->stride, |
231 | screen_info.lfb_linelength, OVERRIDE_STRIDE, | |
232 | info->flags); | |
233 | screen_info.lfb_width = choose_value(info->width, | |
234 | screen_info.lfb_width, OVERRIDE_WIDTH, | |
235 | info->flags); | |
236 | screen_info.lfb_height = choose_value(info->height, | |
237 | screen_info.lfb_height, OVERRIDE_HEIGHT, | |
238 | info->flags); | |
85a00d9b PJ |
239 | if (screen_info.orig_video_isVGA == 0) |
240 | screen_info.orig_video_isVGA = VIDEO_TYPE_EFI; | |
241 | } else { | |
242 | screen_info.lfb_linelength = 0; | |
243 | screen_info.lfb_width = 0; | |
244 | screen_info.lfb_height = 0; | |
245 | screen_info.orig_video_isVGA = 0; | |
246 | return 0; | |
247 | } | |
47dfe51f | 248 | |
dc3e5b6a | 249 | printk(KERN_INFO "efifb: dmi detected %s - framebuffer at 0x%08x " |
47dfe51f | 250 | "(%dx%d, stride %d)\n", id->ident, |
dc3e5b6a | 251 | screen_info.lfb_base, screen_info.lfb_width, |
47dfe51f PJ |
252 | screen_info.lfb_height, screen_info.lfb_linelength); |
253 | ||
254 | ||
85a00d9b | 255 | return 1; |
7c08c9ae PJ |
256 | } |
257 | ||
7c83172b HY |
258 | static int efifb_setcolreg(unsigned regno, unsigned red, unsigned green, |
259 | unsigned blue, unsigned transp, | |
260 | struct fb_info *info) | |
261 | { | |
262 | /* | |
263 | * Set a single color register. The values supplied are | |
264 | * already rounded down to the hardware's capabilities | |
265 | * (according to the entries in the `var' structure). Return | |
266 | * != 0 for invalid regno. | |
267 | */ | |
268 | ||
269 | if (regno >= info->cmap.len) | |
270 | return 1; | |
271 | ||
272 | if (regno < 16) { | |
273 | red >>= 8; | |
274 | green >>= 8; | |
275 | blue >>= 8; | |
276 | ((u32 *)(info->pseudo_palette))[regno] = | |
277 | (red << info->var.red.offset) | | |
278 | (green << info->var.green.offset) | | |
279 | (blue << info->var.blue.offset); | |
280 | } | |
281 | return 0; | |
282 | } | |
283 | ||
89f3f219 MS |
284 | static void efifb_destroy(struct fb_info *info) |
285 | { | |
286 | if (info->screen_base) | |
287 | iounmap(info->screen_base); | |
da0241f1 AL |
288 | if (request_mem_succeeded) |
289 | release_mem_region(info->apertures->ranges[0].base, | |
290 | info->apertures->ranges[0].size); | |
89f3f219 MS |
291 | framebuffer_release(info); |
292 | } | |
293 | ||
7c83172b HY |
294 | static struct fb_ops efifb_ops = { |
295 | .owner = THIS_MODULE, | |
89f3f219 | 296 | .fb_destroy = efifb_destroy, |
7c83172b HY |
297 | .fb_setcolreg = efifb_setcolreg, |
298 | .fb_fillrect = cfb_fillrect, | |
299 | .fb_copyarea = cfb_copyarea, | |
300 | .fb_imageblit = cfb_imageblit, | |
301 | }; | |
302 | ||
b4aa0163 MG |
303 | struct pci_dev *vga_default_device(void) |
304 | { | |
305 | return default_vga; | |
306 | } | |
307 | ||
308 | void vga_set_default_device(struct pci_dev *pdev) | |
309 | { | |
310 | default_vga = pdev; | |
311 | } | |
312 | ||
7c08c9ae PJ |
313 | static int __init efifb_setup(char *options) |
314 | { | |
315 | char *this_opt; | |
316 | int i; | |
b4aa0163 | 317 | struct pci_dev *dev = NULL; |
7c08c9ae | 318 | |
b4aa0163 MG |
319 | if (options && *options) { |
320 | while ((this_opt = strsep(&options, ",")) != NULL) { | |
321 | if (!*this_opt) continue; | |
7c08c9ae | 322 | |
b4aa0163 MG |
323 | for (i = 0; i < M_UNKNOWN; i++) { |
324 | if (!strcmp(this_opt, dmi_list[i].optname) && | |
325 | dmi_list[i].base != 0) { | |
326 | screen_info.lfb_base = dmi_list[i].base; | |
327 | screen_info.lfb_linelength = dmi_list[i].stride; | |
328 | screen_info.lfb_width = dmi_list[i].width; | |
329 | screen_info.lfb_height = dmi_list[i].height; | |
330 | } | |
7c08c9ae | 331 | } |
b4aa0163 MG |
332 | if (!strncmp(this_opt, "base:", 5)) |
333 | screen_info.lfb_base = simple_strtoul(this_opt+5, NULL, 0); | |
334 | else if (!strncmp(this_opt, "stride:", 7)) | |
335 | screen_info.lfb_linelength = simple_strtoul(this_opt+7, NULL, 0) * 4; | |
336 | else if (!strncmp(this_opt, "height:", 7)) | |
337 | screen_info.lfb_height = simple_strtoul(this_opt+7, NULL, 0); | |
338 | else if (!strncmp(this_opt, "width:", 6)) | |
339 | screen_info.lfb_width = simple_strtoul(this_opt+6, NULL, 0); | |
7c08c9ae | 340 | } |
7c08c9ae | 341 | } |
b4aa0163 MG |
342 | |
343 | for_each_pci_dev(dev) { | |
344 | int i; | |
345 | ||
346 | if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA) | |
347 | continue; | |
348 | ||
349 | for (i=0; i < DEVICE_COUNT_RESOURCE; i++) { | |
350 | resource_size_t start, end; | |
351 | ||
352 | if (!(pci_resource_flags(dev, i) & IORESOURCE_MEM)) | |
353 | continue; | |
354 | ||
355 | start = pci_resource_start(dev, i); | |
356 | end = pci_resource_end(dev, i); | |
357 | ||
358 | if (!start || !end) | |
359 | continue; | |
360 | ||
361 | if (screen_info.lfb_base >= start && | |
362 | (screen_info.lfb_base + screen_info.lfb_size) < end) | |
363 | default_vga = dev; | |
364 | } | |
365 | } | |
366 | ||
7c08c9ae PJ |
367 | return 0; |
368 | } | |
369 | ||
bb8b2662 | 370 | static int __init efifb_probe(struct platform_device *dev) |
7c83172b HY |
371 | { |
372 | struct fb_info *info; | |
373 | int err; | |
374 | unsigned int size_vmode; | |
375 | unsigned int size_remap; | |
376 | unsigned int size_total; | |
7c08c9ae | 377 | |
7c08c9ae PJ |
378 | if (!screen_info.lfb_depth) |
379 | screen_info.lfb_depth = 32; | |
380 | if (!screen_info.pages) | |
381 | screen_info.pages = 1; | |
133bb070 MG |
382 | if (!screen_info.lfb_base) { |
383 | printk(KERN_DEBUG "efifb: invalid framebuffer address\n"); | |
384 | return -ENODEV; | |
385 | } | |
386 | printk(KERN_INFO "efifb: probing for efifb\n"); | |
7c08c9ae PJ |
387 | |
388 | /* just assume they're all unset if any are */ | |
389 | if (!screen_info.blue_size) { | |
390 | screen_info.blue_size = 8; | |
391 | screen_info.blue_pos = 0; | |
392 | screen_info.green_size = 8; | |
393 | screen_info.green_pos = 8; | |
394 | screen_info.red_size = 8; | |
395 | screen_info.red_pos = 16; | |
396 | screen_info.rsvd_size = 8; | |
397 | screen_info.rsvd_pos = 24; | |
398 | } | |
7c83172b HY |
399 | |
400 | efifb_fix.smem_start = screen_info.lfb_base; | |
401 | efifb_defined.bits_per_pixel = screen_info.lfb_depth; | |
402 | efifb_defined.xres = screen_info.lfb_width; | |
403 | efifb_defined.yres = screen_info.lfb_height; | |
404 | efifb_fix.line_length = screen_info.lfb_linelength; | |
405 | ||
406 | /* size_vmode -- that is the amount of memory needed for the | |
407 | * used video mode, i.e. the minimum amount of | |
408 | * memory we need. */ | |
409 | size_vmode = efifb_defined.yres * efifb_fix.line_length; | |
410 | ||
411 | /* size_total -- all video memory we have. Used for | |
412 | * entries, ressource allocation and bounds | |
413 | * checking. */ | |
414 | size_total = screen_info.lfb_size; | |
415 | if (size_total < size_vmode) | |
416 | size_total = size_vmode; | |
417 | ||
418 | /* size_remap -- the amount of video memory we are going to | |
419 | * use for efifb. With modern cards it is no | |
420 | * option to simply use size_total as that | |
421 | * wastes plenty of kernel address space. */ | |
422 | size_remap = size_vmode * 2; | |
7c83172b HY |
423 | if (size_remap > size_total) |
424 | size_remap = size_total; | |
7c08c9ae PJ |
425 | if (size_remap % PAGE_SIZE) |
426 | size_remap += PAGE_SIZE - (size_remap % PAGE_SIZE); | |
7c83172b HY |
427 | efifb_fix.smem_len = size_remap; |
428 | ||
7c08c9ae | 429 | if (request_mem_region(efifb_fix.smem_start, size_remap, "efifb")) { |
da0241f1 | 430 | request_mem_succeeded = true; |
7c08c9ae | 431 | } else { |
7c83172b HY |
432 | /* We cannot make this fatal. Sometimes this comes from magic |
433 | spaces our resource handlers simply don't know about */ | |
434 | printk(KERN_WARNING | |
435 | "efifb: cannot reserve video memory at 0x%lx\n", | |
436 | efifb_fix.smem_start); | |
7c08c9ae | 437 | } |
7c83172b HY |
438 | |
439 | info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev); | |
440 | if (!info) { | |
7c08c9ae | 441 | printk(KERN_ERR "efifb: cannot allocate framebuffer\n"); |
7c83172b HY |
442 | err = -ENOMEM; |
443 | goto err_release_mem; | |
444 | } | |
445 | info->pseudo_palette = info->par; | |
446 | info->par = NULL; | |
447 | ||
1471ca9a MS |
448 | info->apertures = alloc_apertures(1); |
449 | if (!info->apertures) { | |
450 | err = -ENOMEM; | |
451 | goto err_release_fb; | |
452 | } | |
453 | info->apertures->ranges[0].base = efifb_fix.smem_start; | |
454 | info->apertures->ranges[0].size = size_remap; | |
4410f391 | 455 | |
3c004b4f | 456 | info->screen_base = ioremap_wc(efifb_fix.smem_start, efifb_fix.smem_len); |
7c83172b HY |
457 | if (!info->screen_base) { |
458 | printk(KERN_ERR "efifb: abort, cannot ioremap video memory " | |
459 | "0x%x @ 0x%lx\n", | |
460 | efifb_fix.smem_len, efifb_fix.smem_start); | |
461 | err = -EIO; | |
7c08c9ae | 462 | goto err_release_fb; |
7c83172b HY |
463 | } |
464 | ||
465 | printk(KERN_INFO "efifb: framebuffer at 0x%lx, mapped to 0x%p, " | |
466 | "using %dk, total %dk\n", | |
467 | efifb_fix.smem_start, info->screen_base, | |
468 | size_remap/1024, size_total/1024); | |
469 | printk(KERN_INFO "efifb: mode is %dx%dx%d, linelength=%d, pages=%d\n", | |
470 | efifb_defined.xres, efifb_defined.yres, | |
471 | efifb_defined.bits_per_pixel, efifb_fix.line_length, | |
472 | screen_info.pages); | |
473 | ||
474 | efifb_defined.xres_virtual = efifb_defined.xres; | |
475 | efifb_defined.yres_virtual = efifb_fix.smem_len / | |
476 | efifb_fix.line_length; | |
477 | printk(KERN_INFO "efifb: scrolling: redraw\n"); | |
478 | efifb_defined.yres_virtual = efifb_defined.yres; | |
479 | ||
480 | /* some dummy values for timing to make fbset happy */ | |
481 | efifb_defined.pixclock = 10000000 / efifb_defined.xres * | |
482 | 1000 / efifb_defined.yres; | |
483 | efifb_defined.left_margin = (efifb_defined.xres / 8) & 0xf8; | |
484 | efifb_defined.hsync_len = (efifb_defined.xres / 8) & 0xf8; | |
485 | ||
486 | efifb_defined.red.offset = screen_info.red_pos; | |
487 | efifb_defined.red.length = screen_info.red_size; | |
488 | efifb_defined.green.offset = screen_info.green_pos; | |
489 | efifb_defined.green.length = screen_info.green_size; | |
490 | efifb_defined.blue.offset = screen_info.blue_pos; | |
491 | efifb_defined.blue.length = screen_info.blue_size; | |
492 | efifb_defined.transp.offset = screen_info.rsvd_pos; | |
493 | efifb_defined.transp.length = screen_info.rsvd_size; | |
494 | ||
495 | printk(KERN_INFO "efifb: %s: " | |
496 | "size=%d:%d:%d:%d, shift=%d:%d:%d:%d\n", | |
497 | "Truecolor", | |
498 | screen_info.rsvd_size, | |
499 | screen_info.red_size, | |
500 | screen_info.green_size, | |
501 | screen_info.blue_size, | |
502 | screen_info.rsvd_pos, | |
503 | screen_info.red_pos, | |
504 | screen_info.green_pos, | |
505 | screen_info.blue_pos); | |
506 | ||
507 | efifb_fix.ypanstep = 0; | |
508 | efifb_fix.ywrapstep = 0; | |
509 | ||
510 | info->fbops = &efifb_ops; | |
511 | info->var = efifb_defined; | |
512 | info->fix = efifb_fix; | |
4410f391 | 513 | info->flags = FBINFO_FLAG_DEFAULT | FBINFO_MISC_FIRMWARE; |
7c83172b | 514 | |
7c08c9ae PJ |
515 | if ((err = fb_alloc_cmap(&info->cmap, 256, 0)) < 0) { |
516 | printk(KERN_ERR "efifb: cannot allocate colormap\n"); | |
7c83172b HY |
517 | goto err_unmap; |
518 | } | |
7c08c9ae PJ |
519 | if ((err = register_framebuffer(info)) < 0) { |
520 | printk(KERN_ERR "efifb: cannot register framebuffer\n"); | |
7c83172b HY |
521 | goto err_fb_dealoc; |
522 | } | |
523 | printk(KERN_INFO "fb%d: %s frame buffer device\n", | |
7c08c9ae | 524 | info->node, info->fix.id); |
7c83172b HY |
525 | return 0; |
526 | ||
527 | err_fb_dealoc: | |
528 | fb_dealloc_cmap(&info->cmap); | |
529 | err_unmap: | |
530 | iounmap(info->screen_base); | |
7c08c9ae | 531 | err_release_fb: |
7c83172b HY |
532 | framebuffer_release(info); |
533 | err_release_mem: | |
da0241f1 | 534 | if (request_mem_succeeded) |
7c08c9ae | 535 | release_mem_region(efifb_fix.smem_start, size_total); |
7c83172b HY |
536 | return err; |
537 | } | |
538 | ||
539 | static struct platform_driver efifb_driver = { | |
7c83172b HY |
540 | .driver = { |
541 | .name = "efifb", | |
542 | }, | |
543 | }; | |
544 | ||
545 | static struct platform_device efifb_device = { | |
546 | .name = "efifb", | |
547 | }; | |
548 | ||
549 | static int __init efifb_init(void) | |
550 | { | |
551 | int ret; | |
7c08c9ae | 552 | char *option = NULL; |
7c83172b | 553 | |
e14a685d BM |
554 | dmi_check_system(dmi_system_table); |
555 | ||
7c83172b HY |
556 | if (screen_info.orig_video_isVGA != VIDEO_TYPE_EFI) |
557 | return -ENODEV; | |
7c08c9ae PJ |
558 | |
559 | if (fb_get_options("efifb", &option)) | |
560 | return -ENODEV; | |
561 | efifb_setup(option); | |
562 | ||
563 | /* We don't get linelength from UGA Draw Protocol, only from | |
564 | * EFI Graphics Protocol. So if it's not in DMI, and it's not | |
565 | * passed in from the user, we really can't use the framebuffer. | |
566 | */ | |
567 | if (!screen_info.lfb_linelength) | |
568 | return -ENODEV; | |
7c83172b | 569 | |
bb8b2662 AL |
570 | ret = platform_device_register(&efifb_device); |
571 | if (ret) | |
572 | return ret; | |
7c83172b | 573 | |
bb8b2662 AL |
574 | /* |
575 | * This is not just an optimization. We will interfere | |
576 | * with a real driver if we get reprobed, so don't allow | |
577 | * it. | |
578 | */ | |
579 | ret = platform_driver_probe(&efifb_driver, efifb_probe); | |
580 | if (ret) { | |
e6b8480c | 581 | platform_device_unregister(&efifb_device); |
bb8b2662 | 582 | return ret; |
7c83172b | 583 | } |
bb8b2662 | 584 | |
7c83172b HY |
585 | return ret; |
586 | } | |
587 | module_init(efifb_init); | |
588 | ||
589 | MODULE_LICENSE("GPL"); |