source: src/linux/universal/linux-4.9/drivers/video/fbdev/efifb.c @ 31885

Last change on this file since 31885 was 31885, checked in by brainslayer, 5 weeks ago

update

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