efi.c 3.4 KB

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