efifb.c 9.6 KB

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