]>
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 | ||
48c68c4f | 23 | static struct fb_var_screeninfo efifb_defined = { |
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 | ||
48c68c4f | 34 | static struct fb_fix_screeninfo efifb_fix = { |
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 | ||
1b23170a MG |
308 | EXPORT_SYMBOL_GPL(vga_default_device); |
309 | ||
b4aa0163 MG |
310 | void vga_set_default_device(struct pci_dev *pdev) |
311 | { | |
312 | default_vga = pdev; | |
313 | } | |
314 | ||
7c08c9ae PJ |
315 | static int __init efifb_setup(char *options) |
316 | { | |
317 | char *this_opt; | |
318 | int i; | |
b4aa0163 | 319 | struct pci_dev *dev = NULL; |
7c08c9ae | 320 | |
b4aa0163 MG |
321 | if (options && *options) { |
322 | while ((this_opt = strsep(&options, ",")) != NULL) { | |
323 | if (!*this_opt) continue; | |
7c08c9ae | 324 | |
b4aa0163 MG |
325 | for (i = 0; i < M_UNKNOWN; i++) { |
326 | if (!strcmp(this_opt, dmi_list[i].optname) && | |
327 | dmi_list[i].base != 0) { | |
328 | screen_info.lfb_base = dmi_list[i].base; | |
329 | screen_info.lfb_linelength = dmi_list[i].stride; | |
330 | screen_info.lfb_width = dmi_list[i].width; | |
331 | screen_info.lfb_height = dmi_list[i].height; | |
332 | } | |
7c08c9ae | 333 | } |
b4aa0163 MG |
334 | if (!strncmp(this_opt, "base:", 5)) |
335 | screen_info.lfb_base = simple_strtoul(this_opt+5, NULL, 0); | |
336 | else if (!strncmp(this_opt, "stride:", 7)) | |
337 | screen_info.lfb_linelength = simple_strtoul(this_opt+7, NULL, 0) * 4; | |
338 | else if (!strncmp(this_opt, "height:", 7)) | |
339 | screen_info.lfb_height = simple_strtoul(this_opt+7, NULL, 0); | |
340 | else if (!strncmp(this_opt, "width:", 6)) | |
341 | screen_info.lfb_width = simple_strtoul(this_opt+6, NULL, 0); | |
7c08c9ae | 342 | } |
7c08c9ae | 343 | } |
b4aa0163 MG |
344 | |
345 | for_each_pci_dev(dev) { | |
346 | int i; | |
347 | ||
348 | if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA) | |
349 | continue; | |
350 | ||
351 | for (i=0; i < DEVICE_COUNT_RESOURCE; i++) { | |
352 | resource_size_t start, end; | |
353 | ||
354 | if (!(pci_resource_flags(dev, i) & IORESOURCE_MEM)) | |
355 | continue; | |
356 | ||
357 | start = pci_resource_start(dev, i); | |
358 | end = pci_resource_end(dev, i); | |
359 | ||
360 | if (!start || !end) | |
361 | continue; | |
362 | ||
363 | if (screen_info.lfb_base >= start && | |
364 | (screen_info.lfb_base + screen_info.lfb_size) < end) | |
365 | default_vga = dev; | |
366 | } | |
367 | } | |
368 | ||
7c08c9ae PJ |
369 | return 0; |
370 | } | |
371 | ||
bb8b2662 | 372 | static int __init efifb_probe(struct platform_device *dev) |
7c83172b HY |
373 | { |
374 | struct fb_info *info; | |
375 | int err; | |
376 | unsigned int size_vmode; | |
377 | unsigned int size_remap; | |
378 | unsigned int size_total; | |
7c08c9ae | 379 | |
7c08c9ae PJ |
380 | if (!screen_info.lfb_depth) |
381 | screen_info.lfb_depth = 32; | |
382 | if (!screen_info.pages) | |
383 | screen_info.pages = 1; | |
133bb070 MG |
384 | if (!screen_info.lfb_base) { |
385 | printk(KERN_DEBUG "efifb: invalid framebuffer address\n"); | |
386 | return -ENODEV; | |
387 | } | |
388 | printk(KERN_INFO "efifb: probing for efifb\n"); | |
7c08c9ae PJ |
389 | |
390 | /* just assume they're all unset if any are */ | |
391 | if (!screen_info.blue_size) { | |
392 | screen_info.blue_size = 8; | |
393 | screen_info.blue_pos = 0; | |
394 | screen_info.green_size = 8; | |
395 | screen_info.green_pos = 8; | |
396 | screen_info.red_size = 8; | |
397 | screen_info.red_pos = 16; | |
398 | screen_info.rsvd_size = 8; | |
399 | screen_info.rsvd_pos = 24; | |
400 | } | |
7c83172b HY |
401 | |
402 | efifb_fix.smem_start = screen_info.lfb_base; | |
403 | efifb_defined.bits_per_pixel = screen_info.lfb_depth; | |
404 | efifb_defined.xres = screen_info.lfb_width; | |
405 | efifb_defined.yres = screen_info.lfb_height; | |
406 | efifb_fix.line_length = screen_info.lfb_linelength; | |
407 | ||
408 | /* size_vmode -- that is the amount of memory needed for the | |
409 | * used video mode, i.e. the minimum amount of | |
410 | * memory we need. */ | |
411 | size_vmode = efifb_defined.yres * efifb_fix.line_length; | |
412 | ||
413 | /* size_total -- all video memory we have. Used for | |
414 | * entries, ressource allocation and bounds | |
415 | * checking. */ | |
416 | size_total = screen_info.lfb_size; | |
417 | if (size_total < size_vmode) | |
418 | size_total = size_vmode; | |
419 | ||
420 | /* size_remap -- the amount of video memory we are going to | |
421 | * use for efifb. With modern cards it is no | |
422 | * option to simply use size_total as that | |
423 | * wastes plenty of kernel address space. */ | |
424 | size_remap = size_vmode * 2; | |
7c83172b HY |
425 | if (size_remap > size_total) |
426 | size_remap = size_total; | |
7c08c9ae PJ |
427 | if (size_remap % PAGE_SIZE) |
428 | size_remap += PAGE_SIZE - (size_remap % PAGE_SIZE); | |
7c83172b HY |
429 | efifb_fix.smem_len = size_remap; |
430 | ||
7c08c9ae | 431 | if (request_mem_region(efifb_fix.smem_start, size_remap, "efifb")) { |
da0241f1 | 432 | request_mem_succeeded = true; |
7c08c9ae | 433 | } else { |
7c83172b HY |
434 | /* We cannot make this fatal. Sometimes this comes from magic |
435 | spaces our resource handlers simply don't know about */ | |
436 | printk(KERN_WARNING | |
437 | "efifb: cannot reserve video memory at 0x%lx\n", | |
438 | efifb_fix.smem_start); | |
7c08c9ae | 439 | } |
7c83172b HY |
440 | |
441 | info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev); | |
442 | if (!info) { | |
7c08c9ae | 443 | printk(KERN_ERR "efifb: cannot allocate framebuffer\n"); |
7c83172b HY |
444 | err = -ENOMEM; |
445 | goto err_release_mem; | |
446 | } | |
447 | info->pseudo_palette = info->par; | |
448 | info->par = NULL; | |
449 | ||
1471ca9a MS |
450 | info->apertures = alloc_apertures(1); |
451 | if (!info->apertures) { | |
452 | err = -ENOMEM; | |
453 | goto err_release_fb; | |
454 | } | |
455 | info->apertures->ranges[0].base = efifb_fix.smem_start; | |
456 | info->apertures->ranges[0].size = size_remap; | |
4410f391 | 457 | |
3c004b4f | 458 | info->screen_base = ioremap_wc(efifb_fix.smem_start, efifb_fix.smem_len); |
7c83172b HY |
459 | if (!info->screen_base) { |
460 | printk(KERN_ERR "efifb: abort, cannot ioremap video memory " | |
461 | "0x%x @ 0x%lx\n", | |
462 | efifb_fix.smem_len, efifb_fix.smem_start); | |
463 | err = -EIO; | |
7c08c9ae | 464 | goto err_release_fb; |
7c83172b HY |
465 | } |
466 | ||
467 | printk(KERN_INFO "efifb: framebuffer at 0x%lx, mapped to 0x%p, " | |
468 | "using %dk, total %dk\n", | |
469 | efifb_fix.smem_start, info->screen_base, | |
470 | size_remap/1024, size_total/1024); | |
471 | printk(KERN_INFO "efifb: mode is %dx%dx%d, linelength=%d, pages=%d\n", | |
472 | efifb_defined.xres, efifb_defined.yres, | |
473 | efifb_defined.bits_per_pixel, efifb_fix.line_length, | |
474 | screen_info.pages); | |
475 | ||
476 | efifb_defined.xres_virtual = efifb_defined.xres; | |
477 | efifb_defined.yres_virtual = efifb_fix.smem_len / | |
478 | efifb_fix.line_length; | |
479 | printk(KERN_INFO "efifb: scrolling: redraw\n"); | |
480 | efifb_defined.yres_virtual = efifb_defined.yres; | |
481 | ||
482 | /* some dummy values for timing to make fbset happy */ | |
483 | efifb_defined.pixclock = 10000000 / efifb_defined.xres * | |
484 | 1000 / efifb_defined.yres; | |
485 | efifb_defined.left_margin = (efifb_defined.xres / 8) & 0xf8; | |
486 | efifb_defined.hsync_len = (efifb_defined.xres / 8) & 0xf8; | |
487 | ||
488 | efifb_defined.red.offset = screen_info.red_pos; | |
489 | efifb_defined.red.length = screen_info.red_size; | |
490 | efifb_defined.green.offset = screen_info.green_pos; | |
491 | efifb_defined.green.length = screen_info.green_size; | |
492 | efifb_defined.blue.offset = screen_info.blue_pos; | |
493 | efifb_defined.blue.length = screen_info.blue_size; | |
494 | efifb_defined.transp.offset = screen_info.rsvd_pos; | |
495 | efifb_defined.transp.length = screen_info.rsvd_size; | |
496 | ||
497 | printk(KERN_INFO "efifb: %s: " | |
498 | "size=%d:%d:%d:%d, shift=%d:%d:%d:%d\n", | |
499 | "Truecolor", | |
500 | screen_info.rsvd_size, | |
501 | screen_info.red_size, | |
502 | screen_info.green_size, | |
503 | screen_info.blue_size, | |
504 | screen_info.rsvd_pos, | |
505 | screen_info.red_pos, | |
506 | screen_info.green_pos, | |
507 | screen_info.blue_pos); | |
508 | ||
509 | efifb_fix.ypanstep = 0; | |
510 | efifb_fix.ywrapstep = 0; | |
511 | ||
512 | info->fbops = &efifb_ops; | |
513 | info->var = efifb_defined; | |
514 | info->fix = efifb_fix; | |
4410f391 | 515 | info->flags = FBINFO_FLAG_DEFAULT | FBINFO_MISC_FIRMWARE; |
7c83172b | 516 | |
7c08c9ae PJ |
517 | if ((err = fb_alloc_cmap(&info->cmap, 256, 0)) < 0) { |
518 | printk(KERN_ERR "efifb: cannot allocate colormap\n"); | |
7c83172b HY |
519 | goto err_unmap; |
520 | } | |
7c08c9ae PJ |
521 | if ((err = register_framebuffer(info)) < 0) { |
522 | printk(KERN_ERR "efifb: cannot register framebuffer\n"); | |
7c83172b HY |
523 | goto err_fb_dealoc; |
524 | } | |
525 | printk(KERN_INFO "fb%d: %s frame buffer device\n", | |
7c08c9ae | 526 | info->node, info->fix.id); |
7c83172b HY |
527 | return 0; |
528 | ||
529 | err_fb_dealoc: | |
530 | fb_dealloc_cmap(&info->cmap); | |
531 | err_unmap: | |
532 | iounmap(info->screen_base); | |
7c08c9ae | 533 | err_release_fb: |
7c83172b HY |
534 | framebuffer_release(info); |
535 | err_release_mem: | |
da0241f1 | 536 | if (request_mem_succeeded) |
7c08c9ae | 537 | release_mem_region(efifb_fix.smem_start, size_total); |
7c83172b HY |
538 | return err; |
539 | } | |
540 | ||
541 | static struct platform_driver efifb_driver = { | |
7c83172b HY |
542 | .driver = { |
543 | .name = "efifb", | |
544 | }, | |
545 | }; | |
546 | ||
547 | static struct platform_device efifb_device = { | |
548 | .name = "efifb", | |
549 | }; | |
550 | ||
551 | static int __init efifb_init(void) | |
552 | { | |
553 | int ret; | |
7c08c9ae | 554 | char *option = NULL; |
7c83172b | 555 | |
f462ed93 MG |
556 | if (screen_info.orig_video_isVGA != VIDEO_TYPE_EFI || |
557 | !(screen_info.capabilities & VIDEO_CAPABILITY_SKIP_QUIRKS)) | |
558 | dmi_check_system(dmi_system_table); | |
e14a685d | 559 | |
7c83172b HY |
560 | if (screen_info.orig_video_isVGA != VIDEO_TYPE_EFI) |
561 | return -ENODEV; | |
7c08c9ae PJ |
562 | |
563 | if (fb_get_options("efifb", &option)) | |
564 | return -ENODEV; | |
565 | efifb_setup(option); | |
566 | ||
567 | /* We don't get linelength from UGA Draw Protocol, only from | |
568 | * EFI Graphics Protocol. So if it's not in DMI, and it's not | |
569 | * passed in from the user, we really can't use the framebuffer. | |
570 | */ | |
571 | if (!screen_info.lfb_linelength) | |
572 | return -ENODEV; | |
7c83172b | 573 | |
bb8b2662 AL |
574 | ret = platform_device_register(&efifb_device); |
575 | if (ret) | |
576 | return ret; | |
7c83172b | 577 | |
bb8b2662 AL |
578 | /* |
579 | * This is not just an optimization. We will interfere | |
580 | * with a real driver if we get reprobed, so don't allow | |
581 | * it. | |
582 | */ | |
583 | ret = platform_driver_probe(&efifb_driver, efifb_probe); | |
584 | if (ret) { | |
e6b8480c | 585 | platform_device_unregister(&efifb_device); |
bb8b2662 | 586 | return ret; |
7c83172b | 587 | } |
bb8b2662 | 588 | |
7c83172b HY |
589 | return ret; |
590 | } | |
591 | module_init(efifb_init); | |
592 | ||
593 | MODULE_LICENSE("GPL"); |