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