1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright 2020-2021 NXP
4  */
5 
6 #include <linux/init.h>
7 #include <linux/device.h>
8 #include <linux/ioctl.h>
9 #include <linux/list.h>
10 #include <linux/module.h>
11 #include <linux/kernel.h>
12 #include <linux/slab.h>
13 #include <linux/delay.h>
14 #include <linux/types.h>
15 #include <media/v4l2-device.h>
16 #include "vpu.h"
17 #include "vpu_helpers.h"
18 
19 static const u8 colorprimaries[] = {
20 	V4L2_COLORSPACE_LAST,
21 	V4L2_COLORSPACE_REC709,         /*Rec. ITU-R BT.709-6*/
22 	0,
23 	0,
24 	V4L2_COLORSPACE_470_SYSTEM_M,   /*Rec. ITU-R BT.470-6 System M*/
25 	V4L2_COLORSPACE_470_SYSTEM_BG,  /*Rec. ITU-R BT.470-6 System B, G*/
26 	V4L2_COLORSPACE_SMPTE170M,      /*SMPTE170M*/
27 	V4L2_COLORSPACE_SMPTE240M,      /*SMPTE240M*/
28 	0,                              /*Generic film*/
29 	V4L2_COLORSPACE_BT2020,         /*Rec. ITU-R BT.2020-2*/
30 	0,                              /*SMPTE ST 428-1*/
31 };
32 
33 static const u8 colortransfers[] = {
34 	V4L2_XFER_FUNC_LAST,
35 	V4L2_XFER_FUNC_709,             /*Rec. ITU-R BT.709-6*/
36 	0,
37 	0,
38 	0,                              /*Rec. ITU-R BT.470-6 System M*/
39 	0,                              /*Rec. ITU-R BT.470-6 System B, G*/
40 	V4L2_XFER_FUNC_709,             /*SMPTE170M*/
41 	V4L2_XFER_FUNC_SMPTE240M,       /*SMPTE240M*/
42 	V4L2_XFER_FUNC_NONE,            /*Linear transfer characteristics*/
43 	0,
44 	0,
45 	0,                              /*IEC 61966-2-4*/
46 	0,                              /*Rec. ITU-R BT.1361-0 extended colour gamut*/
47 	V4L2_XFER_FUNC_SRGB,            /*IEC 61966-2-1 sRGB or sYCC*/
48 	V4L2_XFER_FUNC_709,             /*Rec. ITU-R BT.2020-2 (10 bit system)*/
49 	V4L2_XFER_FUNC_709,             /*Rec. ITU-R BT.2020-2 (12 bit system)*/
50 	V4L2_XFER_FUNC_SMPTE2084,       /*SMPTE ST 2084*/
51 	0,                              /*SMPTE ST 428-1*/
52 	0                               /*Rec. ITU-R BT.2100-0 hybrid log-gamma (HLG)*/
53 };
54 
55 static const u8 colormatrixcoefs[] = {
56 	V4L2_YCBCR_ENC_LAST,
57 	V4L2_YCBCR_ENC_709,              /*Rec. ITU-R BT.709-6*/
58 	0,
59 	0,
60 	0,                               /*Title 47 Code of Federal Regulations*/
61 	V4L2_YCBCR_ENC_601,              /*Rec. ITU-R BT.601-7 625*/
62 	V4L2_YCBCR_ENC_601,              /*Rec. ITU-R BT.601-7 525*/
63 	V4L2_YCBCR_ENC_SMPTE240M,        /*SMPTE240M*/
64 	0,
65 	V4L2_YCBCR_ENC_BT2020,           /*Rec. ITU-R BT.2020-2*/
66 	V4L2_YCBCR_ENC_BT2020_CONST_LUM  /*Rec. ITU-R BT.2020-2 constant*/
67 };
68 
vpu_color_cvrt_primaries_v2i(u32 primaries)69 u32 vpu_color_cvrt_primaries_v2i(u32 primaries)
70 {
71 	return vpu_helper_find_in_array_u8(colorprimaries, ARRAY_SIZE(colorprimaries), primaries);
72 }
73 
vpu_color_cvrt_primaries_i2v(u32 primaries)74 u32 vpu_color_cvrt_primaries_i2v(u32 primaries)
75 {
76 	return primaries < ARRAY_SIZE(colorprimaries) ? colorprimaries[primaries] : 0;
77 }
78 
vpu_color_cvrt_transfers_v2i(u32 transfers)79 u32 vpu_color_cvrt_transfers_v2i(u32 transfers)
80 {
81 	return vpu_helper_find_in_array_u8(colortransfers, ARRAY_SIZE(colortransfers), transfers);
82 }
83 
vpu_color_cvrt_transfers_i2v(u32 transfers)84 u32 vpu_color_cvrt_transfers_i2v(u32 transfers)
85 {
86 	return transfers < ARRAY_SIZE(colortransfers) ? colortransfers[transfers] : 0;
87 }
88 
vpu_color_cvrt_matrix_v2i(u32 matrix)89 u32 vpu_color_cvrt_matrix_v2i(u32 matrix)
90 {
91 	return vpu_helper_find_in_array_u8(colormatrixcoefs, ARRAY_SIZE(colormatrixcoefs), matrix);
92 }
93 
vpu_color_cvrt_matrix_i2v(u32 matrix)94 u32 vpu_color_cvrt_matrix_i2v(u32 matrix)
95 {
96 	return matrix < ARRAY_SIZE(colormatrixcoefs) ? colormatrixcoefs[matrix] : 0;
97 }
98 
vpu_color_cvrt_full_range_v2i(u32 full_range)99 u32 vpu_color_cvrt_full_range_v2i(u32 full_range)
100 {
101 	return (full_range == V4L2_QUANTIZATION_FULL_RANGE);
102 }
103 
vpu_color_cvrt_full_range_i2v(u32 full_range)104 u32 vpu_color_cvrt_full_range_i2v(u32 full_range)
105 {
106 	if (full_range)
107 		return V4L2_QUANTIZATION_FULL_RANGE;
108 
109 	return V4L2_QUANTIZATION_LIM_RANGE;
110 }
111 
vpu_color_check_primaries(u32 primaries)112 int vpu_color_check_primaries(u32 primaries)
113 {
114 	return vpu_color_cvrt_primaries_v2i(primaries) ? 0 : -EINVAL;
115 }
116 
vpu_color_check_transfers(u32 transfers)117 int vpu_color_check_transfers(u32 transfers)
118 {
119 	return vpu_color_cvrt_transfers_v2i(transfers) ? 0 : -EINVAL;
120 }
121 
vpu_color_check_matrix(u32 matrix)122 int vpu_color_check_matrix(u32 matrix)
123 {
124 	return vpu_color_cvrt_matrix_v2i(matrix) ? 0 : -EINVAL;
125 }
126 
vpu_color_check_full_range(u32 full_range)127 int vpu_color_check_full_range(u32 full_range)
128 {
129 	int ret = -EINVAL;
130 
131 	switch (full_range) {
132 	case V4L2_QUANTIZATION_FULL_RANGE:
133 	case V4L2_QUANTIZATION_LIM_RANGE:
134 		ret = 0;
135 		break;
136 	default:
137 		break;
138 	}
139 
140 	return ret;
141 }
142 
vpu_color_get_default(u32 primaries,u32 * ptransfers,u32 * pmatrix,u32 * pfull_range)143 int vpu_color_get_default(u32 primaries, u32 *ptransfers, u32 *pmatrix, u32 *pfull_range)
144 {
145 	u32 transfers;
146 	u32 matrix;
147 	u32 full_range;
148 
149 	switch (primaries) {
150 	case V4L2_COLORSPACE_REC709:
151 		transfers = V4L2_XFER_FUNC_709;
152 		matrix = V4L2_YCBCR_ENC_709;
153 		break;
154 	case V4L2_COLORSPACE_470_SYSTEM_M:
155 	case V4L2_COLORSPACE_470_SYSTEM_BG:
156 	case V4L2_COLORSPACE_SMPTE170M:
157 		transfers = V4L2_XFER_FUNC_709;
158 		matrix = V4L2_YCBCR_ENC_601;
159 		break;
160 	case V4L2_COLORSPACE_SMPTE240M:
161 		transfers = V4L2_XFER_FUNC_SMPTE240M;
162 		matrix = V4L2_YCBCR_ENC_SMPTE240M;
163 		break;
164 	case V4L2_COLORSPACE_BT2020:
165 		transfers = V4L2_XFER_FUNC_709;
166 		matrix = V4L2_YCBCR_ENC_BT2020;
167 		break;
168 	default:
169 		transfers = V4L2_XFER_FUNC_DEFAULT;
170 		matrix = V4L2_YCBCR_ENC_DEFAULT;
171 		break;
172 	}
173 	full_range = V4L2_QUANTIZATION_LIM_RANGE;
174 
175 	if (ptransfers)
176 		*ptransfers = transfers;
177 	if (pmatrix)
178 		*pmatrix = matrix;
179 	if (pfull_range)
180 		*pfull_range = full_range;
181 
182 	return 0;
183 }
184