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 | 17 | #include <video/vga.h> |
2995e506 | 18 | #include <asm/sysfb.h> |
7c83172b | 19 | |
da0241f1 AL |
20 | static bool request_mem_succeeded = false; |
21 | ||
b4aa0163 MG |
22 | static struct pci_dev *default_vga; |
23 | ||
48c68c4f | 24 | static struct fb_var_screeninfo efifb_defined = { |
7c83172b HY |
25 | .activate = FB_ACTIVATE_NOW, |
26 | .height = -1, | |
27 | .width = -1, | |
28 | .right_margin = 32, | |
29 | .upper_margin = 16, | |
30 | .lower_margin = 4, | |
31 | .vsync_len = 4, | |
32 | .vmode = FB_VMODE_NONINTERLACED, | |
33 | }; | |
34 | ||
48c68c4f | 35 | static struct fb_fix_screeninfo efifb_fix = { |
7c83172b HY |
36 | .id = "EFI VGA", |
37 | .type = FB_TYPE_PACKED_PIXELS, | |
38 | .accel = FB_ACCEL_NONE, | |
39 | .visual = FB_VISUAL_TRUECOLOR, | |
40 | }; | |
41 | ||
42 | static int efifb_setcolreg(unsigned regno, unsigned red, unsigned green, | |
43 | unsigned blue, unsigned transp, | |
44 | struct fb_info *info) | |
45 | { | |
46 | /* | |
47 | * Set a single color register. The values supplied are | |
48 | * already rounded down to the hardware's capabilities | |
49 | * (according to the entries in the `var' structure). Return | |
50 | * != 0 for invalid regno. | |
51 | */ | |
52 | ||
53 | if (regno >= info->cmap.len) | |
54 | return 1; | |
55 | ||
56 | if (regno < 16) { | |
57 | red >>= 8; | |
58 | green >>= 8; | |
59 | blue >>= 8; | |
60 | ((u32 *)(info->pseudo_palette))[regno] = | |
61 | (red << info->var.red.offset) | | |
62 | (green << info->var.green.offset) | | |
63 | (blue << info->var.blue.offset); | |
64 | } | |
65 | return 0; | |
66 | } | |
67 | ||
89f3f219 MS |
68 | static void efifb_destroy(struct fb_info *info) |
69 | { | |
70 | if (info->screen_base) | |
71 | iounmap(info->screen_base); | |
da0241f1 AL |
72 | if (request_mem_succeeded) |
73 | release_mem_region(info->apertures->ranges[0].base, | |
74 | info->apertures->ranges[0].size); | |
907355a9 | 75 | fb_dealloc_cmap(&info->cmap); |
89f3f219 MS |
76 | framebuffer_release(info); |
77 | } | |
78 | ||
7c83172b HY |
79 | static struct fb_ops efifb_ops = { |
80 | .owner = THIS_MODULE, | |
89f3f219 | 81 | .fb_destroy = efifb_destroy, |
7c83172b HY |
82 | .fb_setcolreg = efifb_setcolreg, |
83 | .fb_fillrect = cfb_fillrect, | |
84 | .fb_copyarea = cfb_copyarea, | |
85 | .fb_imageblit = cfb_imageblit, | |
86 | }; | |
87 | ||
b4aa0163 MG |
88 | struct pci_dev *vga_default_device(void) |
89 | { | |
90 | return default_vga; | |
91 | } | |
92 | ||
1b23170a MG |
93 | EXPORT_SYMBOL_GPL(vga_default_device); |
94 | ||
b4aa0163 MG |
95 | void vga_set_default_device(struct pci_dev *pdev) |
96 | { | |
97 | default_vga = pdev; | |
98 | } | |
99 | ||
e6816a8d | 100 | static int efifb_setup(char *options) |
7c08c9ae PJ |
101 | { |
102 | char *this_opt; | |
103 | int i; | |
b4aa0163 | 104 | struct pci_dev *dev = NULL; |
7c08c9ae | 105 | |
b4aa0163 MG |
106 | if (options && *options) { |
107 | while ((this_opt = strsep(&options, ",")) != NULL) { | |
108 | if (!*this_opt) continue; | |
7c08c9ae | 109 | |
b4aa0163 | 110 | for (i = 0; i < M_UNKNOWN; i++) { |
2995e506 DH |
111 | if (!strcmp(this_opt, efifb_dmi_list[i].optname) && |
112 | efifb_dmi_list[i].base != 0) { | |
113 | screen_info.lfb_base = efifb_dmi_list[i].base; | |
114 | screen_info.lfb_linelength = efifb_dmi_list[i].stride; | |
115 | screen_info.lfb_width = efifb_dmi_list[i].width; | |
116 | screen_info.lfb_height = efifb_dmi_list[i].height; | |
b4aa0163 | 117 | } |
7c08c9ae | 118 | } |
b4aa0163 MG |
119 | if (!strncmp(this_opt, "base:", 5)) |
120 | screen_info.lfb_base = simple_strtoul(this_opt+5, NULL, 0); | |
121 | else if (!strncmp(this_opt, "stride:", 7)) | |
122 | screen_info.lfb_linelength = simple_strtoul(this_opt+7, NULL, 0) * 4; | |
123 | else if (!strncmp(this_opt, "height:", 7)) | |
124 | screen_info.lfb_height = simple_strtoul(this_opt+7, NULL, 0); | |
125 | else if (!strncmp(this_opt, "width:", 6)) | |
126 | screen_info.lfb_width = simple_strtoul(this_opt+6, NULL, 0); | |
7c08c9ae | 127 | } |
7c08c9ae | 128 | } |
b4aa0163 MG |
129 | |
130 | for_each_pci_dev(dev) { | |
131 | int i; | |
132 | ||
133 | if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA) | |
134 | continue; | |
135 | ||
136 | for (i=0; i < DEVICE_COUNT_RESOURCE; i++) { | |
137 | resource_size_t start, end; | |
138 | ||
139 | if (!(pci_resource_flags(dev, i) & IORESOURCE_MEM)) | |
140 | continue; | |
141 | ||
142 | start = pci_resource_start(dev, i); | |
143 | end = pci_resource_end(dev, i); | |
144 | ||
145 | if (!start || !end) | |
146 | continue; | |
147 | ||
148 | if (screen_info.lfb_base >= start && | |
149 | (screen_info.lfb_base + screen_info.lfb_size) < end) | |
150 | default_vga = dev; | |
151 | } | |
152 | } | |
153 | ||
7c08c9ae PJ |
154 | return 0; |
155 | } | |
156 | ||
e6816a8d | 157 | static int efifb_probe(struct platform_device *dev) |
7c83172b HY |
158 | { |
159 | struct fb_info *info; | |
160 | int err; | |
161 | unsigned int size_vmode; | |
162 | unsigned int size_remap; | |
163 | unsigned int size_total; | |
e6816a8d DH |
164 | char *option = NULL; |
165 | ||
166 | if (screen_info.orig_video_isVGA != VIDEO_TYPE_EFI) | |
167 | return -ENODEV; | |
168 | ||
169 | if (fb_get_options("efifb", &option)) | |
170 | return -ENODEV; | |
171 | efifb_setup(option); | |
172 | ||
173 | /* We don't get linelength from UGA Draw Protocol, only from | |
174 | * EFI Graphics Protocol. So if it's not in DMI, and it's not | |
175 | * passed in from the user, we really can't use the framebuffer. | |
176 | */ | |
177 | if (!screen_info.lfb_linelength) | |
178 | return -ENODEV; | |
7c08c9ae | 179 | |
7c08c9ae PJ |
180 | if (!screen_info.lfb_depth) |
181 | screen_info.lfb_depth = 32; | |
182 | if (!screen_info.pages) | |
183 | screen_info.pages = 1; | |
133bb070 MG |
184 | if (!screen_info.lfb_base) { |
185 | printk(KERN_DEBUG "efifb: invalid framebuffer address\n"); | |
186 | return -ENODEV; | |
187 | } | |
188 | printk(KERN_INFO "efifb: probing for efifb\n"); | |
7c08c9ae PJ |
189 | |
190 | /* just assume they're all unset if any are */ | |
191 | if (!screen_info.blue_size) { | |
192 | screen_info.blue_size = 8; | |
193 | screen_info.blue_pos = 0; | |
194 | screen_info.green_size = 8; | |
195 | screen_info.green_pos = 8; | |
196 | screen_info.red_size = 8; | |
197 | screen_info.red_pos = 16; | |
198 | screen_info.rsvd_size = 8; | |
199 | screen_info.rsvd_pos = 24; | |
200 | } | |
7c83172b HY |
201 | |
202 | efifb_fix.smem_start = screen_info.lfb_base; | |
203 | efifb_defined.bits_per_pixel = screen_info.lfb_depth; | |
204 | efifb_defined.xres = screen_info.lfb_width; | |
205 | efifb_defined.yres = screen_info.lfb_height; | |
206 | efifb_fix.line_length = screen_info.lfb_linelength; | |
207 | ||
208 | /* size_vmode -- that is the amount of memory needed for the | |
209 | * used video mode, i.e. the minimum amount of | |
210 | * memory we need. */ | |
211 | size_vmode = efifb_defined.yres * efifb_fix.line_length; | |
212 | ||
213 | /* size_total -- all video memory we have. Used for | |
214 | * entries, ressource allocation and bounds | |
215 | * checking. */ | |
216 | size_total = screen_info.lfb_size; | |
217 | if (size_total < size_vmode) | |
218 | size_total = size_vmode; | |
219 | ||
220 | /* size_remap -- the amount of video memory we are going to | |
221 | * use for efifb. With modern cards it is no | |
222 | * option to simply use size_total as that | |
223 | * wastes plenty of kernel address space. */ | |
224 | size_remap = size_vmode * 2; | |
7c83172b HY |
225 | if (size_remap > size_total) |
226 | size_remap = size_total; | |
7c08c9ae PJ |
227 | if (size_remap % PAGE_SIZE) |
228 | size_remap += PAGE_SIZE - (size_remap % PAGE_SIZE); | |
7c83172b HY |
229 | efifb_fix.smem_len = size_remap; |
230 | ||
7c08c9ae | 231 | if (request_mem_region(efifb_fix.smem_start, size_remap, "efifb")) { |
da0241f1 | 232 | request_mem_succeeded = true; |
7c08c9ae | 233 | } else { |
7c83172b HY |
234 | /* We cannot make this fatal. Sometimes this comes from magic |
235 | spaces our resource handlers simply don't know about */ | |
236 | printk(KERN_WARNING | |
237 | "efifb: cannot reserve video memory at 0x%lx\n", | |
238 | efifb_fix.smem_start); | |
7c08c9ae | 239 | } |
7c83172b HY |
240 | |
241 | info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev); | |
242 | if (!info) { | |
7c08c9ae | 243 | printk(KERN_ERR "efifb: cannot allocate framebuffer\n"); |
7c83172b HY |
244 | err = -ENOMEM; |
245 | goto err_release_mem; | |
246 | } | |
247 | info->pseudo_palette = info->par; | |
248 | info->par = NULL; | |
249 | ||
1471ca9a MS |
250 | info->apertures = alloc_apertures(1); |
251 | if (!info->apertures) { | |
252 | err = -ENOMEM; | |
253 | goto err_release_fb; | |
254 | } | |
255 | info->apertures->ranges[0].base = efifb_fix.smem_start; | |
256 | info->apertures->ranges[0].size = size_remap; | |
4410f391 | 257 | |
3c004b4f | 258 | info->screen_base = ioremap_wc(efifb_fix.smem_start, efifb_fix.smem_len); |
7c83172b HY |
259 | if (!info->screen_base) { |
260 | printk(KERN_ERR "efifb: abort, cannot ioremap video memory " | |
261 | "0x%x @ 0x%lx\n", | |
262 | efifb_fix.smem_len, efifb_fix.smem_start); | |
263 | err = -EIO; | |
7c08c9ae | 264 | goto err_release_fb; |
7c83172b HY |
265 | } |
266 | ||
267 | printk(KERN_INFO "efifb: framebuffer at 0x%lx, mapped to 0x%p, " | |
268 | "using %dk, total %dk\n", | |
269 | efifb_fix.smem_start, info->screen_base, | |
270 | size_remap/1024, size_total/1024); | |
271 | printk(KERN_INFO "efifb: mode is %dx%dx%d, linelength=%d, pages=%d\n", | |
272 | efifb_defined.xres, efifb_defined.yres, | |
273 | efifb_defined.bits_per_pixel, efifb_fix.line_length, | |
274 | screen_info.pages); | |
275 | ||
276 | efifb_defined.xres_virtual = efifb_defined.xres; | |
277 | efifb_defined.yres_virtual = efifb_fix.smem_len / | |
278 | efifb_fix.line_length; | |
279 | printk(KERN_INFO "efifb: scrolling: redraw\n"); | |
280 | efifb_defined.yres_virtual = efifb_defined.yres; | |
281 | ||
282 | /* some dummy values for timing to make fbset happy */ | |
283 | efifb_defined.pixclock = 10000000 / efifb_defined.xres * | |
284 | 1000 / efifb_defined.yres; | |
285 | efifb_defined.left_margin = (efifb_defined.xres / 8) & 0xf8; | |
286 | efifb_defined.hsync_len = (efifb_defined.xres / 8) & 0xf8; | |
287 | ||
288 | efifb_defined.red.offset = screen_info.red_pos; | |
289 | efifb_defined.red.length = screen_info.red_size; | |
290 | efifb_defined.green.offset = screen_info.green_pos; | |
291 | efifb_defined.green.length = screen_info.green_size; | |
292 | efifb_defined.blue.offset = screen_info.blue_pos; | |
293 | efifb_defined.blue.length = screen_info.blue_size; | |
294 | efifb_defined.transp.offset = screen_info.rsvd_pos; | |
295 | efifb_defined.transp.length = screen_info.rsvd_size; | |
296 | ||
297 | printk(KERN_INFO "efifb: %s: " | |
298 | "size=%d:%d:%d:%d, shift=%d:%d:%d:%d\n", | |
299 | "Truecolor", | |
300 | screen_info.rsvd_size, | |
301 | screen_info.red_size, | |
302 | screen_info.green_size, | |
303 | screen_info.blue_size, | |
304 | screen_info.rsvd_pos, | |
305 | screen_info.red_pos, | |
306 | screen_info.green_pos, | |
307 | screen_info.blue_pos); | |
308 | ||
309 | efifb_fix.ypanstep = 0; | |
310 | efifb_fix.ywrapstep = 0; | |
311 | ||
312 | info->fbops = &efifb_ops; | |
313 | info->var = efifb_defined; | |
314 | info->fix = efifb_fix; | |
4410f391 | 315 | info->flags = FBINFO_FLAG_DEFAULT | FBINFO_MISC_FIRMWARE; |
7c83172b | 316 | |
7c08c9ae PJ |
317 | if ((err = fb_alloc_cmap(&info->cmap, 256, 0)) < 0) { |
318 | printk(KERN_ERR "efifb: cannot allocate colormap\n"); | |
7c83172b HY |
319 | goto err_unmap; |
320 | } | |
7c08c9ae PJ |
321 | if ((err = register_framebuffer(info)) < 0) { |
322 | printk(KERN_ERR "efifb: cannot register framebuffer\n"); | |
7c83172b HY |
323 | goto err_fb_dealoc; |
324 | } | |
325 | printk(KERN_INFO "fb%d: %s frame buffer device\n", | |
7c08c9ae | 326 | info->node, info->fix.id); |
7c83172b HY |
327 | return 0; |
328 | ||
329 | err_fb_dealoc: | |
330 | fb_dealloc_cmap(&info->cmap); | |
331 | err_unmap: | |
332 | iounmap(info->screen_base); | |
7c08c9ae | 333 | err_release_fb: |
7c83172b HY |
334 | framebuffer_release(info); |
335 | err_release_mem: | |
da0241f1 | 336 | if (request_mem_succeeded) |
7c08c9ae | 337 | release_mem_region(efifb_fix.smem_start, size_total); |
7c83172b HY |
338 | return err; |
339 | } | |
340 | ||
341 | static struct platform_driver efifb_driver = { | |
e6816a8d DH |
342 | .driver = { |
343 | .name = "efi-framebuffer", | |
344 | .owner = THIS_MODULE, | |
7c83172b | 345 | }, |
e6816a8d | 346 | .probe = efifb_probe, |
7c83172b HY |
347 | }; |
348 | ||
e6816a8d | 349 | module_platform_driver(efifb_driver); |
7c83172b | 350 | MODULE_LICENSE("GPL"); |