colors.c 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133
  1. /* colors command: full-screen animated rainbow in VESA LFB. Target 60fps. Press ESC to return. */
  2. #include "fbtext.h"
  3. #include "io.h"
  4. #include "timer.h"
  5. #include "vga.h"
  6. #define RAINBOW_SEG 256
  7. #define RAINBOW_FULL (6 * RAINBOW_SEG)
  8. #define FRAME_MS 16
  9. #define PHASE_STEP 32
  10. /* FPS overlay: 7 chars × 8 px wide, 8 px tall. Rainbow must not draw here. */
  11. #define FPS_RECT_W (7 * 8)
  12. #define FPS_RECT_H 8
  13. static void hue_to_rgb(unsigned int hue, unsigned int *r, unsigned int *g, unsigned int *b)
  14. {
  15. unsigned int seg = hue / RAINBOW_SEG;
  16. unsigned int f = hue % RAINBOW_SEG;
  17. unsigned int r1, g1, b1, r2, g2, b2;
  18. if (seg >= 6)
  19. seg = 0;
  20. switch (seg) {
  21. case 0: r1=255; g1=0; b1=0; r2=255; g2=255; b2=0; break; /* R → Y */
  22. case 1: r1=255; g1=255; b1=0; r2=0; g2=255; b2=0; break; /* Y → G */
  23. case 2: r1=0; g1=255; b1=0; r2=0; g2=255; b2=255; break; /* G → C */
  24. case 3: r1=0; g1=255; b1=255; r2=0; g2=0; b2=255; break; /* C → B */
  25. case 4: r1=0; g1=0; b1=255; r2=255; g2=0; b2=255; break; /* B → M */
  26. default: r1=255; g1=0; b1=255; r2=255; g2=0; b2=0; break; /* M → R */
  27. }
  28. *r = (r1 * (RAINBOW_SEG - f) + r2 * f) / RAINBOW_SEG;
  29. *g = (g1 * (RAINBOW_SEG - f) + g2 * f) / RAINBOW_SEG;
  30. *b = (b1 * (RAINBOW_SEG - f) + b2 * f) / RAINBOW_SEG;
  31. }
  32. static void draw_frame(unsigned char *fb, unsigned int w, unsigned int h,
  33. unsigned int pitch, unsigned int bpp, unsigned int phase)
  34. {
  35. /* One full rainbow across width and height (stretched) */
  36. unsigned int scale_x = RAINBOW_FULL / (w ? w : 1);
  37. unsigned int scale_y = RAINBOW_FULL / (h ? h : 1);
  38. unsigned int y, x;
  39. for (y = 0; y < h; y++) {
  40. for (x = 0; x < w; x++) {
  41. /* Leave FPS rect untouched so the overlay is never overwritten */
  42. if (y < FPS_RECT_H && x < FPS_RECT_W)
  43. continue;
  44. unsigned int hue = (phase + x * scale_x + y * scale_y) % RAINBOW_FULL;
  45. unsigned int r, g, b;
  46. hue_to_rgb(hue, &r, &g, &b);
  47. if (bpp == 16) {
  48. unsigned int rgb16 = ((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3);
  49. unsigned int off = (unsigned long)y * pitch + x * 2;
  50. fb[off] = (unsigned char)(rgb16 & 0xFF);
  51. fb[off + 1] = (unsigned char)(rgb16 >> 8);
  52. } else if (bpp == 24) {
  53. unsigned int off = (unsigned long)y * pitch + x * 3;
  54. fb[off] = (unsigned char)b;
  55. fb[off + 1] = (unsigned char)g;
  56. fb[off + 2] = (unsigned char)r;
  57. } else if (bpp == 32) {
  58. volatile unsigned int *row = (volatile unsigned int *)(fb + (unsigned long)y * pitch);
  59. row[x] = (unsigned int)b | ((unsigned int)g << 8) | ((unsigned int)r << 16);
  60. }
  61. }
  62. }
  63. }
  64. #define FPS_BUF_SIZE 8
  65. static void format_fps(unsigned int fps, char *buf)
  66. {
  67. unsigned int f = fps;
  68. if (f > 999)
  69. f = 999;
  70. buf[0] = (char)('0' + (f / 100));
  71. buf[1] = (char)('0' + ((f / 10) % 10));
  72. buf[2] = (char)('0' + (f % 10));
  73. buf[3] = ' ';
  74. buf[4] = 'f';
  75. buf[5] = 'p';
  76. buf[6] = 's';
  77. buf[7] = '\0';
  78. }
  79. void program_colors_main(void)
  80. {
  81. unsigned char *fb;
  82. unsigned int w, h, pitch, bpp;
  83. unsigned int phase = 0;
  84. unsigned int frame_start;
  85. unsigned int frame_count = 0;
  86. unsigned int last_fps_ticks;
  87. unsigned int displayed_fps = 0;
  88. char fps_buf[FPS_BUF_SIZE];
  89. if (!vga_has_vesa())
  90. return;
  91. fb = (unsigned char *)vga_fb_ptr();
  92. if (!fb)
  93. return;
  94. w = vga_fb_width();
  95. h = vga_fb_height();
  96. pitch = vga_fb_pitch();
  97. bpp = vga_fb_bpp();
  98. if (bpp != 16 && bpp != 24 && bpp != 32)
  99. return;
  100. io_drain_keyboard();
  101. last_fps_ticks = get_ticks_ms();
  102. for (;;) {
  103. frame_start = get_ticks_ms();
  104. if (io_poll_key() == 0x1B)
  105. break;
  106. draw_frame(fb, w, h, pitch, bpp, phase);
  107. phase = (phase + PHASE_STEP) % RAINBOW_FULL;
  108. frame_count++;
  109. if (get_ticks_ms() - last_fps_ticks >= 1000) {
  110. displayed_fps = frame_count;
  111. frame_count = 0;
  112. last_fps_ticks = get_ticks_ms();
  113. }
  114. format_fps(displayed_fps, fps_buf);
  115. fbtext_draw_string_xy(0, 0, fps_buf, 255, 255, 255, 0);
  116. while (get_ticks_ms() - frame_start < FRAME_MS)
  117. __asm__ volatile ("hlt");
  118. }
  119. }