igt_color_encoding.c 7.14 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
/*
 * Copyright © 2018 Intel Corporation
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
 * IN THE SOFTWARE.
 */

#include "igt_color_encoding.h"
#include "igt_matrix.h"
26
#include "igt_core.h"
27 28
#include "igt_fb.h"
#include "drmtest.h"
29 30 31 32 33 34 35 36 37 38 39 40 41

struct color_encoding {
	float kr, kb;
};

static const struct color_encoding color_encodings[IGT_NUM_COLOR_ENCODINGS] = {
	[IGT_COLOR_YCBCR_BT601] = { .kr = .299f, .kb = .114f, },
	[IGT_COLOR_YCBCR_BT709] = { .kr = .2126f, .kb = .0722f, },
	[IGT_COLOR_YCBCR_BT2020] = { .kr = .2627f, .kb = .0593f, },
};

static struct igt_mat4 rgb_to_ycbcr_matrix(const struct color_encoding *e)
{
42 43 44
	float kr = e->kr;
	float kb = e->kb;
	float kg = 1.0f - kr - kb;
45 46

	struct igt_mat4 ret = {
47 48 49
		.d[m(0, 0)] = kr,
		.d[m(0, 1)] = kg,
		.d[m(0, 2)] = kb,
50

51 52 53
		.d[m(1, 0)] = -kr / (1.0f - kb),
		.d[m(1, 1)] = -kg / (1.0f - kb),
		.d[m(1, 2)] = 1.0f,
54

55 56 57
		.d[m(2, 0)] = 1.0f,
		.d[m(2, 1)] = -kg / (1.0f - kr),
		.d[m(2, 2)] = -kb / (1.0f - kr),
58

59
		.d[m(3, 3)] = 1.0f,
60 61 62 63 64 65 66
	};

	return ret;
}

static struct igt_mat4 ycbcr_to_rgb_matrix(const struct color_encoding *e)
{
67 68 69
	float kr = e->kr;
	float kb = e->kb;
	float kg = 1.0f - kr - kb;
70 71

	struct igt_mat4 ret = {
72 73 74
		.d[m(0, 0)] = 1.0f,
		.d[m(0, 1)] = 0.0f,
		.d[m(0, 2)] = 1.0 - kr,
75

76 77 78
		.d[m(1, 0)] = 1.0f,
		.d[m(1, 1)] = -(1.0 - kb) * kb / kg,
		.d[m(1, 2)] = -(1.0 - kr) * kr / kg,
79

80 81 82
		.d[m(2, 0)] = 1.0f,
		.d[m(2, 1)] = 1.0 - kb,
		.d[m(2, 2)] = 0.0f,
83

84
		.d[m(3, 3)] = 1.0f,
85 86 87 88 89
	};

	return ret;
}

90 91 92 93
static struct igt_mat4 ycbcr_input_convert_matrix(enum igt_color_range color_range, float scale,
						  float ofs_y, float max_y,
						  float ofs_cbcr, float mid_cbcr, float max_cbcr,
						  float max_val)
94 95 96 97
{
	struct igt_mat4 t, s;

	if (color_range == IGT_COLOR_YCBCR_FULL_RANGE) {
98 99
		t = igt_matrix_translate(0.f, -mid_cbcr, -mid_cbcr);
		s = igt_matrix_scale(scale, 2.0f * scale, 2.0f * scale);
100
	} else {
101 102 103 104
		t = igt_matrix_translate(-ofs_y, -mid_cbcr, -mid_cbcr);
		s = igt_matrix_scale(scale * max_val / (max_y - ofs_y),
				     scale * max_val / (max_cbcr - mid_cbcr),
				     scale * max_val / (max_cbcr - mid_cbcr));
105 106 107 108 109
	}

	return igt_matrix_multiply(&s, &t);
}

110 111 112 113
static struct igt_mat4 ycbcr_output_convert_matrix(enum igt_color_range color_range, float scale,
						   float ofs_y, float max_y,
						   float ofs_cbcr, float mid_cbcr, float max_cbcr,
						   float max_val)
114 115 116 117
{
	struct igt_mat4 s, t;

	if (color_range == IGT_COLOR_YCBCR_FULL_RANGE) {
118 119
		s = igt_matrix_scale(scale, 0.5f * scale, 0.5f * scale);
		t = igt_matrix_translate(0.f, mid_cbcr, mid_cbcr);
120
	} else {
121 122 123 124
		s = igt_matrix_scale(scale * (max_y - ofs_y) / max_val,
				     scale * (max_cbcr - mid_cbcr) / max_val,
				     scale * (max_cbcr - mid_cbcr) / max_val);
		t = igt_matrix_translate(ofs_y, mid_cbcr, mid_cbcr);
125 126 127 128 129
	}

	return igt_matrix_multiply(&t, &s);
}

130 131 132 133 134 135 136 137
static const struct color_encoding_format {
	uint32_t fourcc;

	float max_val;

	float ofs_y, max_y, ofs_cbcr, mid_cbcr, max_cbcr;
} formats[] = {
	{ DRM_FORMAT_XRGB8888, 255.f, },
138
	{ IGT_FORMAT_FLOAT, 1.f, },
139 140 141 142 143 144 145 146 147 148 149 150
	{ DRM_FORMAT_NV12, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_NV16, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_NV21, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_NV61, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_YUV420, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_YUV422, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_YVU420, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_YVU422, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_YUYV, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_YVYU, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_UYVY, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
	{ DRM_FORMAT_VYUY, 255.f, 16.f, 235.f, 16.f, 128.f, 240.f },
151 152 153
	{ DRM_FORMAT_P010, 65472.f, 4096.f, 60160.f, 4096.f, 32768.f, 61440.f },
	{ DRM_FORMAT_P012, 65520.f, 4096.f, 60160.f, 4096.f, 32768.f, 61440.f },
	{ DRM_FORMAT_P016, 65535.f, 4096.f, 60160.f, 4096.f, 32768.f, 61440.f },
154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169
};

static const struct color_encoding_format *lookup_fourcc(uint32_t fourcc)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(formats); i++)
		if (fourcc == formats[i].fourcc)
			return &formats[i];

	igt_assert_f(0, "Could not look up fourcc %.4s\n", (char *)&fourcc);
}

struct igt_mat4 igt_ycbcr_to_rgb_matrix(uint32_t from_fourcc,
					uint32_t to_fourcc,
					enum igt_color_encoding color_encoding,
170 171 172 173
					enum igt_color_range color_range)
{
	const struct color_encoding *e = &color_encodings[color_encoding];
	struct igt_mat4 r, c;
174 175 176
	const struct color_encoding_format *fycbcr = lookup_fourcc(from_fourcc);
	const struct color_encoding_format *frgb = lookup_fourcc(to_fourcc);
	float scale = frgb->max_val / fycbcr->max_val;
177

178 179 180
	igt_assert(fycbcr->ofs_y && !frgb->ofs_y);

	r = ycbcr_input_convert_matrix(color_range, scale, fycbcr->ofs_y, fycbcr->max_y, fycbcr->ofs_cbcr, fycbcr->mid_cbcr, fycbcr->max_cbcr, fycbcr->max_val);
181 182 183 184 185
	c = ycbcr_to_rgb_matrix(e);

	return igt_matrix_multiply(&c, &r);
}

186 187 188
struct igt_mat4 igt_rgb_to_ycbcr_matrix(uint32_t from_fourcc,
					uint32_t to_fourcc,
					enum igt_color_encoding color_encoding,
189 190 191
					enum igt_color_range color_range)
{
	const struct color_encoding *e = &color_encodings[color_encoding];
192 193
	const struct color_encoding_format *frgb = lookup_fourcc(from_fourcc);
	const struct color_encoding_format *fycbcr = lookup_fourcc(to_fourcc);
194
	struct igt_mat4 c, r;
195 196 197
	float scale = fycbcr->max_val / frgb->max_val;

	igt_assert(fycbcr->ofs_y && !frgb->ofs_y);
198 199

	c = rgb_to_ycbcr_matrix(e);
200
	r = ycbcr_output_convert_matrix(color_range, scale, fycbcr->ofs_y, fycbcr->max_y, fycbcr->ofs_cbcr, fycbcr->mid_cbcr, fycbcr->max_cbcr, fycbcr->max_val);
201 202 203

	return igt_matrix_multiply(&r, &c);
}
204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222

const char *igt_color_encoding_to_str(enum igt_color_encoding encoding)
{
	switch (encoding) {
	case IGT_COLOR_YCBCR_BT601: return "ITU-R BT.601 YCbCr";
	case IGT_COLOR_YCBCR_BT709: return "ITU-R BT.709 YCbCr";
	case IGT_COLOR_YCBCR_BT2020: return "ITU-R BT.2020 YCbCr";
	default: igt_assert(0); return NULL;
	}
}

const char *igt_color_range_to_str(enum igt_color_range range)
{
	switch (range) {
	case IGT_COLOR_YCBCR_LIMITED_RANGE: return "YCbCr limited range";
	case IGT_COLOR_YCBCR_FULL_RANGE: return "YCbCr full range";
	default: igt_assert(0); return NULL;
	}
}