c8188d8a00b2e56d00834d49c24c3be3b5f4ba0b
[android/external-libkmsxx.git] / libkmstest / testpat.cpp
2 #include <chrono>
3 #include <cstring>
4 #include <cassert>
6 #include <xf86drm.h>
7 #include <xf86drmMode.h>
8 #include <drm_fourcc.h>
9 #include <drm.h>
10 #include <drm_mode.h>
12 #include "kms++.h"
13 #include "color.h"
15 #define ARRAY_SIZE(arr) (sizeof(arr) / sizeof((arr)[0]))
17 namespace kms
18 {
19 static void draw_pixel(DumbFramebuffer& buf, unsigned x, unsigned y, RGB color)
20 {
21         static RGB c1;
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                 }
43                 uint8_t *p = (uint8_t*)(buf.map(0) + buf.stride(0) * y + x * 2);
45                 YUV yuv1 = c1.yuv();
46                 YUV yuv2 = color.yuv();
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                 }
61                 uint8_t *p = (uint8_t*)(buf.map(0) + buf.stride(0) * y + x * 2);
63                 YUV yuv1 = c1.yuv();
64                 YUV yuv2 = color.yuv();
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 }
77 static void draw_rgb_test_pattern(DumbFramebuffer& fb)
78 {
79         unsigned x, y;
80         unsigned w = fb.width();
81         unsigned h = fb.height();
83         const unsigned mw = 20;
85         const unsigned xm1 = mw;
86         const unsigned xm2 = w - mw - 1;
87         const unsigned ym1 = mw;
88         const unsigned ym2 = h - mw - 1;
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;
125                                         unsigned c = (y - ym1 - 1) % 256;
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                                         }
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         }
149 void draw_test_pattern(DumbFramebuffer& fb)
151         using namespace std::chrono;
153         auto t1 = high_resolution_clock::now();
155         draw_rgb_test_pattern(fb);
157         auto t2 = high_resolution_clock::now();
158         auto time_span = duration_cast<microseconds>(t2 - t1);
160         printf("draw took %u us\n", (unsigned)time_span.count());