libkmstest/testpat.cpp

   1
   2 #include <chrono>
   3 #include <cstring>
   4 #include <cassert>
   5
   6 #include <xf86drm.h>
   7 #include <xf86drmMode.h>
   8 #include <drm_fourcc.h>
   9 #include <drm.h>
  10 #include <drm_mode.h>
  11
  12 #include "kms++.h"
  13 #include "color.h"
  14
  15 #define ARRAY_SIZE(arr) (sizeof(arr) / sizeof((arr)[0]))
  16
  17 namespace kms
  18 {
  19 static void draw_pixel(DumbFramebuffer& buf, unsigned x, unsigned y, RGB color)
  20 {
  21         static RGB c1;
  22
  23         switch (buf.format()) {
  24         case PixelFormat::XRGB8888:
  25         {
  26                 uint32_t *p = (uint32_t*)(buf.map(0) + buf.stride(0) * y + x * 4);
  27                 *p = color.raw;
  28                 break;
  29         }
  30         case PixelFormat::RGB565:
  31         {
  32                 uint16_t *p = (uint16_t*)(buf.map(0) + buf.stride(0) * y + x * 2);
  33                 *p = color.rgb565();
  34                 break;
  35         }
  36         case PixelFormat::UYVY:
  37         {
  38                 if ((x & 1) == 0) {
  39                         c1 = color;
  40                         return;
  41                 }
  42
  43                 uint8_t *p = (uint8_t*)(buf.map(0) + buf.stride(0) * y + x * 2);
  44
  45                 YUV yuv1 = c1.yuv();
  46                 YUV yuv2 = color.yuv();
  47
  48                 p[0] = (yuv1.u + yuv2.u) / 2;
  49                 p[1] = yuv1.y;
  50                 p[2] = (yuv1.v + yuv2.v) / 2;
  51                 p[3] = yuv2.y;
  52                 break;
  53         }
  54         case PixelFormat::YUYV:
  55         {
  56                 if ((x & 1) == 0) {
  57                         c1 = color;
  58                         return;
  59                 }
  60
  61                 uint8_t *p = (uint8_t*)(buf.map(0) + buf.stride(0) * y + x * 2);
  62
  63                 YUV yuv1 = c1.yuv();
  64                 YUV yuv2 = color.yuv();
  65
  66                 p[0] = yuv1.y;
  67                 p[1] = (yuv1.u + yuv2.u) / 2;
  68                 p[2] = yuv2.y;
  69                 p[3] = (yuv1.v + yuv2.v) / 2;
  70                 break;
  71         }
  72         default:
  73                 throw std::invalid_argument("unknown pixelformat");
  74         }
  75 }
  76
  77 static void draw_rgb_test_pattern(DumbFramebuffer& fb)
  78 {
  79         unsigned x, y;
  80         unsigned w = fb.width();
  81         unsigned h = fb.height();
  82
  83         const unsigned mw = 20;
  84
  85         const unsigned xm1 = mw;
  86         const unsigned xm2 = w - mw - 1;
  87         const unsigned ym1 = mw;
  88         const unsigned ym2 = h - mw - 1;
  89
  90         for (y = 0; y < h; y++) {
  91                 for (x = 0; x < w; x++) {
  92                         // white margin lines
  93                         if (x == xm1 || x == xm2 || y == ym1 || y == ym2)
  94                                 draw_pixel(fb, x, y, RGB(255, 255, 255));
  95                         // white box outlines to corners
  96                         else if ((x == 0 || x == w - 1) && (y < ym1 || y > ym2))
  97                                 draw_pixel(fb, x, y, RGB(255, 255, 255));
  98                         // white box outlines to corners
  99                         else if ((y == 0 || y == h - 1) && (x < xm1 || x > xm2))
 100                                 draw_pixel(fb, x, y, RGB(255, 255, 255));
 101                         // blue bar on the left
 102                         else if (x < xm1 && (y > ym1 && y < ym2))
 103                                 draw_pixel(fb, x, y, RGB(0, 0, 255));
 104                         // blue bar on the top
 105                         else if (y < ym1 && (x > xm1 && x < xm2))
 106                                 draw_pixel(fb, x, y, RGB(0, 0, 255));
 107                         // red bar on the right
 108                         else if (x > xm2 && (y > ym1 && y < ym2))
 109                                 draw_pixel(fb, x, y, RGB(255, 0, 0));
 110                         // red bar on the bottom
 111                         else if (y > ym2 && (x > xm1 && x < xm2))
 112                                 draw_pixel(fb, x, y, RGB(255, 0, 0));
 113                         // inside the margins
 114                         else if (x > xm1 && x < xm2 && y > ym1 && y < ym2) {
 115                                 // diagonal line
 116                                 if (x == y || w - x == h - y)
 117                                         draw_pixel(fb, x, y, RGB(255, 255, 255));
 118                                 // diagonal line
 119                                 else if (w - x == y || x == h - y)
 120                                         draw_pixel(fb, x, y, RGB(255, 255, 255));
 121                                 else {
 122                                         int t = (x - xm1 - 1) * 3 / (xm2 - xm1 - 1);
 123                                         unsigned r = 0, g = 0, b = 0;
 124
 125                                         unsigned c = (y - ym1 - 1) % 256;
 126
 127                                         switch (t) {
 128                                         case 0:
 129                                                 r = c;
 130                                                 break;
 131                                         case 1:
 132                                                 g = c;
 133                                                 break;
 134                                         case 2:
 135                                                 b = c;
 136                                                 break;
 137                                         }
 138
 139                                         draw_pixel(fb, x, y, RGB(r, g, b));
 140                                 }
 141                                 // black corners
 142                         } else {
 143                                 draw_pixel(fb, x, y, RGB(0, 0, 0));
 144                         }
 145                 }
 146         }
 147 }
 148
 149 void draw_test_pattern(DumbFramebuffer& fb)
 150 {
 151         using namespace std::chrono;
 152
 153         auto t1 = high_resolution_clock::now();
 154
 155         draw_rgb_test_pattern(fb);
 156
 157         auto t2 = high_resolution_clock::now();
 158         auto time_span = duration_cast<microseconds>(t2 - t1);
 159
 160         printf("draw took %u us\n", (unsigned)time_span.count());
 161 }
 162 }