efi.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2018, Bin Meng <bmeng.cn@gmail.com>
  4. *
  5. * EFI framebuffer driver based on GOP
  6. */
  7. #include <common.h>
  8. #include <dm.h>
  9. #include <efi_api.h>
  10. #include <log.h>
  11. #include <vbe.h>
  12. #include <video.h>
  13. struct pixel {
  14. u8 pos;
  15. u8 size;
  16. };
  17. static const struct efi_framebuffer {
  18. struct pixel red;
  19. struct pixel green;
  20. struct pixel blue;
  21. struct pixel rsvd;
  22. } efi_framebuffer_format_map[] = {
  23. [EFI_GOT_RGBA8] = { {0, 8}, {8, 8}, {16, 8}, {24, 8} },
  24. [EFI_GOT_BGRA8] = { {16, 8}, {8, 8}, {0, 8}, {24, 8} },
  25. };
  26. static void efi_find_pixel_bits(u32 mask, u8 *pos, u8 *size)
  27. {
  28. u8 first, len;
  29. first = 0;
  30. len = 0;
  31. if (mask) {
  32. while (!(mask & 0x1)) {
  33. mask = mask >> 1;
  34. first++;
  35. }
  36. while (mask & 0x1) {
  37. mask = mask >> 1;
  38. len++;
  39. }
  40. }
  41. *pos = first;
  42. *size = len;
  43. }
  44. static int save_vesa_mode(struct vesa_mode_info *vesa)
  45. {
  46. struct efi_entry_gopmode *mode;
  47. const struct efi_framebuffer *fbinfo;
  48. int size;
  49. int ret;
  50. ret = efi_info_get(EFIET_GOP_MODE, (void **)&mode, &size);
  51. if (ret == -ENOENT) {
  52. debug("efi graphics output protocol mode not found\n");
  53. return -ENXIO;
  54. }
  55. vesa->phys_base_ptr = mode->fb_base;
  56. vesa->x_resolution = mode->info->width;
  57. vesa->y_resolution = mode->info->height;
  58. if (mode->info->pixel_format < EFI_GOT_BITMASK) {
  59. fbinfo = &efi_framebuffer_format_map[mode->info->pixel_format];
  60. vesa->red_mask_size = fbinfo->red.size;
  61. vesa->red_mask_pos = fbinfo->red.pos;
  62. vesa->green_mask_size = fbinfo->green.size;
  63. vesa->green_mask_pos = fbinfo->green.pos;
  64. vesa->blue_mask_size = fbinfo->blue.size;
  65. vesa->blue_mask_pos = fbinfo->blue.pos;
  66. vesa->reserved_mask_size = fbinfo->rsvd.size;
  67. vesa->reserved_mask_pos = fbinfo->rsvd.pos;
  68. vesa->bits_per_pixel = 32;
  69. vesa->bytes_per_scanline = mode->info->pixels_per_scanline * 4;
  70. } else if (mode->info->pixel_format == EFI_GOT_BITMASK) {
  71. efi_find_pixel_bits(mode->info->pixel_bitmask[0],
  72. &vesa->red_mask_pos,
  73. &vesa->red_mask_size);
  74. efi_find_pixel_bits(mode->info->pixel_bitmask[1],
  75. &vesa->green_mask_pos,
  76. &vesa->green_mask_size);
  77. efi_find_pixel_bits(mode->info->pixel_bitmask[2],
  78. &vesa->blue_mask_pos,
  79. &vesa->blue_mask_size);
  80. efi_find_pixel_bits(mode->info->pixel_bitmask[3],
  81. &vesa->reserved_mask_pos,
  82. &vesa->reserved_mask_size);
  83. vesa->bits_per_pixel = vesa->red_mask_size +
  84. vesa->green_mask_size +
  85. vesa->blue_mask_size +
  86. vesa->reserved_mask_size;
  87. vesa->bytes_per_scanline = (mode->info->pixels_per_scanline *
  88. vesa->bits_per_pixel) / 8;
  89. } else {
  90. debug("efi set unknown framebuffer format: %d\n",
  91. mode->info->pixel_format);
  92. return -EINVAL;
  93. }
  94. return 0;
  95. }
  96. static int efi_video_probe(struct udevice *dev)
  97. {
  98. struct video_uc_platdata *plat = dev_get_uclass_platdata(dev);
  99. struct video_priv *uc_priv = dev_get_uclass_priv(dev);
  100. struct vesa_mode_info *vesa = &mode_info.vesa;
  101. int ret;
  102. /* Initialize vesa_mode_info structure */
  103. ret = save_vesa_mode(vesa);
  104. if (ret)
  105. goto err;
  106. ret = vbe_setup_video_priv(vesa, uc_priv, plat);
  107. if (ret)
  108. goto err;
  109. printf("Video: %dx%dx%d\n", uc_priv->xsize, uc_priv->ysize,
  110. vesa->bits_per_pixel);
  111. return 0;
  112. err:
  113. printf("No video mode configured in EFI!\n");
  114. return ret;
  115. }
  116. static const struct udevice_id efi_video_ids[] = {
  117. { .compatible = "efi-fb" },
  118. { }
  119. };
  120. U_BOOT_DRIVER(efi_video) = {
  121. .name = "efi_video",
  122. .id = UCLASS_VIDEO,
  123. .of_match = efi_video_ids,
  124. .probe = efi_video_probe,
  125. };