vga.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161
  1. /* VGA: VESA LFB (from boot). */
  2. #include "vga.h"
  3. /* Cached boot framebuffer info (set once when vga_fb_* first used). */
  4. static unsigned int vga_fb_w, vga_fb_h, vga_fb_pitch_val, vga_fb_bpp_val;
  5. static volatile unsigned char *vga_fb_lfb;
  6. static int vga_fb_cached;
  7. static volatile struct vga_boot_fb_info *vga_get_boot_fb(void)
  8. {
  9. volatile struct vga_boot_fb_info *p = VGA_BOOT_FB;
  10. __asm__ volatile ("" : "+r"(p));
  11. return p;
  12. }
  13. static void vga_cache_boot_fb(void)
  14. {
  15. volatile struct vga_boot_fb_info *info;
  16. if (vga_fb_cached)
  17. return;
  18. vga_fb_cached = 1;
  19. info = vga_get_boot_fb();
  20. if (!info->valid) {
  21. vga_fb_w = vga_fb_h = vga_fb_pitch_val = vga_fb_bpp_val = 0;
  22. vga_fb_lfb = 0;
  23. return;
  24. }
  25. vga_fb_w = info->width;
  26. vga_fb_h = info->height;
  27. vga_fb_pitch_val = info->pitch;
  28. vga_fb_bpp_val = info->bpp;
  29. /* Some BIOSes (e.g. 1024x768) report pitch in pixels or too small; enforce minimum. */
  30. {
  31. unsigned int min_pitch = vga_fb_w;
  32. if (vga_fb_bpp_val == 16)
  33. min_pitch *= 2;
  34. else if (vga_fb_bpp_val == 24)
  35. min_pitch *= 3;
  36. else if (vga_fb_bpp_val == 32)
  37. min_pitch *= 4;
  38. if (vga_fb_pitch_val < min_pitch)
  39. vga_fb_pitch_val = min_pitch;
  40. }
  41. vga_fb_lfb = (volatile unsigned char *)(unsigned long)info->lfb_base;
  42. }
  43. /* ---- LFB API ---- */
  44. unsigned int vga_fb_width(void)
  45. {
  46. vga_cache_boot_fb();
  47. return vga_fb_w;
  48. }
  49. unsigned int vga_fb_height(void)
  50. {
  51. vga_cache_boot_fb();
  52. return vga_fb_h;
  53. }
  54. unsigned int vga_fb_pitch(void)
  55. {
  56. vga_cache_boot_fb();
  57. return vga_fb_pitch_val;
  58. }
  59. unsigned int vga_fb_bpp(void)
  60. {
  61. vga_cache_boot_fb();
  62. return vga_fb_bpp_val;
  63. }
  64. void *vga_fb_ptr(void)
  65. {
  66. vga_cache_boot_fb();
  67. return (void *)vga_fb_lfb;
  68. }
  69. int vga_has_vesa(void)
  70. {
  71. vga_cache_boot_fb();
  72. return (vga_fb_w != 0 && vga_fb_lfb != 0);
  73. }
  74. /* 16bpp: RGB 5:6:5. 32bpp: BGRX byte order (standard VBE / QEMU). */
  75. static void vga_lfb_put_pixel(unsigned int x, unsigned int y, unsigned int r, unsigned int g, unsigned int b)
  76. {
  77. unsigned int pitch = vga_fb_pitch_val;
  78. unsigned int bpp = vga_fb_bpp_val;
  79. unsigned char *p;
  80. if (x >= vga_fb_w || y >= vga_fb_h || !vga_fb_lfb)
  81. return;
  82. p = (unsigned char *)vga_fb_lfb + (unsigned long)y * pitch;
  83. if (bpp == 16) {
  84. unsigned int rgb16 = ((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3);
  85. unsigned int off = x * 2;
  86. p[off] = (unsigned char)(rgb16 & 0xFF);
  87. p[off + 1] = (unsigned char)(rgb16 >> 8);
  88. } else if (bpp == 24) {
  89. unsigned int off = x * 3;
  90. p[off] = (unsigned char)b;
  91. p[off + 1] = (unsigned char)g;
  92. p[off + 2] = (unsigned char)r;
  93. } else if (bpp == 32) {
  94. unsigned int off = x * 4;
  95. p[off] = (unsigned char)b;
  96. p[off + 1] = (unsigned char)g;
  97. p[off + 2] = (unsigned char)r;
  98. p[off + 3] = 0;
  99. }
  100. }
  101. void vga_put_pixel_rgb(unsigned int x, unsigned int y, unsigned int r, unsigned int g, unsigned int b)
  102. {
  103. vga_cache_boot_fb();
  104. if (!vga_fb_lfb)
  105. return;
  106. vga_lfb_put_pixel(x, y, r, g, b);
  107. }
  108. void vga_clear_rgb(unsigned int r, unsigned int g, unsigned int b)
  109. {
  110. unsigned int pitch = vga_fb_pitch_val;
  111. unsigned int bpp = vga_fb_bpp_val;
  112. vga_cache_boot_fb();
  113. if (!vga_fb_lfb)
  114. return;
  115. if (bpp == 16) {
  116. unsigned int rgb16 = ((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3);
  117. unsigned short val = (unsigned short)((rgb16 & 0xFF) | ((rgb16 >> 8) << 8));
  118. volatile unsigned short *fb = (volatile unsigned short *)vga_fb_lfb;
  119. unsigned int n = (pitch / 2) * vga_fb_h;
  120. unsigned int i;
  121. for (i = 0; i < n; i++)
  122. fb[i] = val;
  123. } else if (bpp == 24) {
  124. volatile unsigned char *p = vga_fb_lfb;
  125. unsigned int row, x;
  126. for (row = 0; row < vga_fb_h; row++) {
  127. unsigned int row_off = row * pitch;
  128. for (x = 0; x < vga_fb_w; x++) {
  129. unsigned int off = row_off + x * 3;
  130. p[off] = (unsigned char)b;
  131. p[off + 1] = (unsigned char)g;
  132. p[off + 2] = (unsigned char)r;
  133. }
  134. }
  135. } else if (bpp == 32) {
  136. volatile unsigned int *fb = (volatile unsigned int *)vga_fb_lfb;
  137. unsigned int pixel = ((unsigned int)r << 16) | ((unsigned int)g << 8) | b;
  138. unsigned int stride = pitch / 4;
  139. unsigned int row, x;
  140. for (row = 0; row < vga_fb_h; row++)
  141. for (x = 0; x < vga_fb_w; x++)
  142. fb[row * stride + x] = pixel;
  143. }
  144. }