colors.c 5.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206
  1. /* colors command: full-screen animated rainbow in VESA LFB. Target 30fps (matches flush rate). 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 33 /* matches 30Hz flush rate */
  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. /* Precomputed hue-to-RGB lookup table. Packed as 0x00BBGGRR for fast 32-bit load. */
  14. static unsigned int hue_lut[RAINBOW_FULL];
  15. static void build_hue_lut(void)
  16. {
  17. unsigned int i;
  18. for (i = 0; i < RAINBOW_FULL; i++) {
  19. unsigned int seg = i / RAINBOW_SEG;
  20. unsigned int f = i % RAINBOW_SEG;
  21. unsigned int r1, g1, b1, r2, g2, b2;
  22. if (seg >= 6)
  23. seg = 0;
  24. switch (seg) {
  25. case 0: r1=255; g1=0; b1=0; r2=255; g2=255; b2=0; break;
  26. case 1: r1=255; g1=255; b1=0; r2=0; g2=255; b2=0; break;
  27. case 2: r1=0; g1=255; b1=0; r2=0; g2=255; b2=255; break;
  28. case 3: r1=0; g1=255; b1=255; r2=0; g2=0; b2=255; break;
  29. case 4: r1=0; g1=0; b1=255; r2=255; g2=0; b2=255; break;
  30. default: r1=255; g1=0; b1=255; r2=255; g2=0; b2=0; break;
  31. }
  32. unsigned int r = (r1 * (RAINBOW_SEG - f) + r2 * f) / RAINBOW_SEG;
  33. unsigned int g = (g1 * (RAINBOW_SEG - f) + g2 * f) / RAINBOW_SEG;
  34. unsigned int b = (b1 * (RAINBOW_SEG - f) + b2 * f) / RAINBOW_SEG;
  35. hue_lut[i] = b | (g << 8) | (r << 16);
  36. }
  37. }
  38. static void draw_frame(unsigned char *fb, unsigned int w, unsigned int h,
  39. unsigned int pitch, unsigned int bpp, unsigned int phase)
  40. {
  41. unsigned int scale_x = RAINBOW_FULL / (w ? w : 1);
  42. unsigned int scale_y = RAINBOW_FULL / (h ? h : 1);
  43. unsigned int y;
  44. for (y = 0; y < h; y++) {
  45. unsigned int row_hue = (phase + y * scale_y) % RAINBOW_FULL;
  46. unsigned char *row = fb + (unsigned long)y * pitch;
  47. if (y < FPS_RECT_H) {
  48. /* Skip FPS rect columns */
  49. unsigned int x;
  50. if (bpp == 32) {
  51. unsigned int *p = (unsigned int *)row;
  52. for (x = 0; x < w; x++) {
  53. if (x >= FPS_RECT_W) {
  54. unsigned int packed = hue_lut[row_hue];
  55. *p = packed;
  56. }
  57. p++;
  58. row_hue += scale_x;
  59. if (row_hue >= RAINBOW_FULL)
  60. row_hue -= RAINBOW_FULL;
  61. }
  62. } else if (bpp == 24) {
  63. for (x = 0; x < w; x++) {
  64. if (x >= FPS_RECT_W) {
  65. unsigned int packed = hue_lut[row_hue];
  66. row[x * 3] = (unsigned char)(packed & 0xFF);
  67. row[x * 3 + 1] = (unsigned char)((packed >> 8) & 0xFF);
  68. row[x * 3 + 2] = (unsigned char)((packed >> 16) & 0xFF);
  69. }
  70. row_hue += scale_x;
  71. if (row_hue >= RAINBOW_FULL)
  72. row_hue -= RAINBOW_FULL;
  73. }
  74. } else if (bpp == 16) {
  75. for (x = 0; x < w; x++) {
  76. if (x >= FPS_RECT_W) {
  77. unsigned int packed = hue_lut[row_hue];
  78. unsigned int r = (packed >> 16) & 0xFF;
  79. unsigned int g = (packed >> 8) & 0xFF;
  80. unsigned int b = packed & 0xFF;
  81. unsigned int rgb16 = ((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3);
  82. unsigned short *p = (unsigned short *)(row + x * 2);
  83. *p = (unsigned short)rgb16;
  84. }
  85. row_hue += scale_x;
  86. if (row_hue >= RAINBOW_FULL)
  87. row_hue -= RAINBOW_FULL;
  88. }
  89. }
  90. } else {
  91. /* Full row, no FPS rect check — tight inner loop */
  92. unsigned int x;
  93. if (bpp == 32) {
  94. unsigned int *p = (unsigned int *)row;
  95. for (x = 0; x < w; x++) {
  96. *p++ = hue_lut[row_hue];
  97. row_hue += scale_x;
  98. if (row_hue >= RAINBOW_FULL)
  99. row_hue -= RAINBOW_FULL;
  100. }
  101. } else if (bpp == 24) {
  102. for (x = 0; x < w; x++) {
  103. unsigned int packed = hue_lut[row_hue];
  104. row[x * 3] = (unsigned char)(packed & 0xFF);
  105. row[x * 3 + 1] = (unsigned char)((packed >> 8) & 0xFF);
  106. row[x * 3 + 2] = (unsigned char)((packed >> 16) & 0xFF);
  107. row_hue += scale_x;
  108. if (row_hue >= RAINBOW_FULL)
  109. row_hue -= RAINBOW_FULL;
  110. }
  111. } else if (bpp == 16) {
  112. for (x = 0; x < w; x++) {
  113. unsigned int packed = hue_lut[row_hue];
  114. unsigned int r = (packed >> 16) & 0xFF;
  115. unsigned int g = (packed >> 8) & 0xFF;
  116. unsigned int b = packed & 0xFF;
  117. unsigned int rgb16 = ((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3);
  118. unsigned short *p = (unsigned short *)(row + x * 2);
  119. *p = (unsigned short)rgb16;
  120. row_hue += scale_x;
  121. if (row_hue >= RAINBOW_FULL)
  122. row_hue -= RAINBOW_FULL;
  123. }
  124. }
  125. }
  126. }
  127. }
  128. #define FPS_BUF_SIZE 8
  129. static void format_fps(unsigned int fps, char *buf)
  130. {
  131. unsigned int f = fps;
  132. if (f > 999)
  133. f = 999;
  134. buf[0] = (char)('0' + (f / 100));
  135. buf[1] = (char)('0' + ((f / 10) % 10));
  136. buf[2] = (char)('0' + (f % 10));
  137. buf[3] = ' ';
  138. buf[4] = 'f';
  139. buf[5] = 'p';
  140. buf[6] = 's';
  141. buf[7] = '\0';
  142. }
  143. void program_colors_main(void)
  144. {
  145. unsigned char *fb;
  146. unsigned int w, h, pitch, bpp;
  147. unsigned int phase = 0;
  148. unsigned int frame_start;
  149. unsigned int frame_count = 0;
  150. unsigned int last_fps_ticks;
  151. unsigned int displayed_fps = 0;
  152. char fps_buf[FPS_BUF_SIZE];
  153. if (!vga_has_vesa())
  154. return;
  155. build_hue_lut();
  156. fb = (unsigned char *)vga_fb_ptr();
  157. if (!fb)
  158. return;
  159. w = vga_fb_width();
  160. h = vga_fb_height();
  161. pitch = vga_fb_pitch();
  162. bpp = vga_fb_bpp();
  163. if (bpp != 16 && bpp != 24 && bpp != 32)
  164. return;
  165. io_drain_keyboard();
  166. last_fps_ticks = get_ticks_ms();
  167. for (;;) {
  168. frame_start = get_ticks_ms();
  169. if (io_poll_key() == 0x1B)
  170. break;
  171. draw_frame(fb, w, h, pitch, bpp, phase);
  172. phase = (phase + PHASE_STEP) % RAINBOW_FULL;
  173. /* Mark all rows dirty since we drew the full screen */
  174. vga_fb_mark_dirty_rect(0, h);
  175. /* Trigger flush so the 30Hz timer sees dirty rows */
  176. vga_fb_flush_pending_check();
  177. frame_count++;
  178. if (get_ticks_ms() - last_fps_ticks >= 1000) {
  179. displayed_fps = frame_count;
  180. frame_count = 0;
  181. last_fps_ticks = get_ticks_ms();
  182. }
  183. format_fps(displayed_fps, fps_buf);
  184. fbtext_draw_string_xy(0, 0, fps_buf, 255, 255, 255, 0);
  185. /* Sleep with hlt to give the system breathing room */
  186. while (get_ticks_ms() - frame_start < FRAME_MS)
  187. __asm__ volatile ("hlt");
  188. }
  189. }