1cabdff1aSopenharmony_ci/*
2cabdff1aSopenharmony_ci * Texture block compression
3cabdff1aSopenharmony_ci * Copyright (C) 2015 Vittorio Giovara <vittorio.giovara@gmail.com>
4cabdff1aSopenharmony_ci * Based on public domain code by Fabian Giesen, Sean Barrett and Yann Collet.
5cabdff1aSopenharmony_ci *
6cabdff1aSopenharmony_ci * This file is part of FFmpeg
7cabdff1aSopenharmony_ci *
8cabdff1aSopenharmony_ci * Permission is hereby granted, free of charge, to any person obtaining a
9cabdff1aSopenharmony_ci * copy of this software and associated documentation files (the "Software"),
10cabdff1aSopenharmony_ci * to deal in the Software without restriction, including without limitation
11cabdff1aSopenharmony_ci * the rights to use, copy, modify, merge, publish, distribute, sublicense,
12cabdff1aSopenharmony_ci * and/or sell copies of the Software, and to permit persons to whom the
13cabdff1aSopenharmony_ci * Software is furnished to do so, subject to the following conditions:
14cabdff1aSopenharmony_ci * The above copyright notice and this permission notice shall be included
15cabdff1aSopenharmony_ci * in all copies or substantial portions of the Software.
16cabdff1aSopenharmony_ci *
17cabdff1aSopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18cabdff1aSopenharmony_ci * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19cabdff1aSopenharmony_ci * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
20cabdff1aSopenharmony_ci * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21cabdff1aSopenharmony_ci * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22cabdff1aSopenharmony_ci * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
23cabdff1aSopenharmony_ci * IN THE SOFTWARE.
24cabdff1aSopenharmony_ci */
25cabdff1aSopenharmony_ci
26cabdff1aSopenharmony_ci#include <stddef.h>
27cabdff1aSopenharmony_ci#include <stdint.h>
28cabdff1aSopenharmony_ci
29cabdff1aSopenharmony_ci#include "libavutil/attributes.h"
30cabdff1aSopenharmony_ci#include "libavutil/common.h"
31cabdff1aSopenharmony_ci#include "libavutil/intreadwrite.h"
32cabdff1aSopenharmony_ci
33cabdff1aSopenharmony_ci#include "texturedsp.h"
34cabdff1aSopenharmony_ci
35cabdff1aSopenharmony_cistatic const uint8_t expand5[32] = {
36cabdff1aSopenharmony_ci      0,   8,  16,  24,  33,  41,  49,  57,  66,  74,  82,  90,
37cabdff1aSopenharmony_ci     99, 107, 115, 123, 132, 140, 148, 156, 165, 173, 181, 189,
38cabdff1aSopenharmony_ci    198, 206, 214, 222, 231, 239, 247, 255,
39cabdff1aSopenharmony_ci};
40cabdff1aSopenharmony_ci
41cabdff1aSopenharmony_cistatic const uint8_t expand6[64] = {
42cabdff1aSopenharmony_ci      0,   4,   8,  12,  16,  20,  24,  28,  32,  36,  40,  44,
43cabdff1aSopenharmony_ci     48,  52,  56,  60,  65,  69,  73,  77,  81,  85,  89,  93,
44cabdff1aSopenharmony_ci     97, 101, 105, 109, 113, 117, 121, 125, 130, 134, 138, 142,
45cabdff1aSopenharmony_ci    146, 150, 154, 158, 162, 166, 170, 174, 178, 182, 186, 190,
46cabdff1aSopenharmony_ci    195, 199, 203, 207, 211, 215, 219, 223, 227, 231, 235, 239,
47cabdff1aSopenharmony_ci    243, 247, 251, 255,
48cabdff1aSopenharmony_ci};
49cabdff1aSopenharmony_ci
50cabdff1aSopenharmony_cistatic const uint8_t match5[256][2] = {
51cabdff1aSopenharmony_ci    {  0,  0 }, {  0,  0 }, {  0,  1 }, {  0,  1 }, {  1,  0 }, {  1,  0 },
52cabdff1aSopenharmony_ci    {  1,  0 }, {  1,  1 }, {  1,  1 }, {  2,  0 }, {  2,  0 }, {  0,  4 },
53cabdff1aSopenharmony_ci    {  2,  1 }, {  2,  1 }, {  2,  1 }, {  3,  0 }, {  3,  0 }, {  3,  0 },
54cabdff1aSopenharmony_ci    {  3,  1 }, {  1,  5 }, {  3,  2 }, {  3,  2 }, {  4,  0 }, {  4,  0 },
55cabdff1aSopenharmony_ci    {  4,  1 }, {  4,  1 }, {  4,  2 }, {  4,  2 }, {  4,  2 }, {  3,  5 },
56cabdff1aSopenharmony_ci    {  5,  1 }, {  5,  1 }, {  5,  2 }, {  4,  4 }, {  5,  3 }, {  5,  3 },
57cabdff1aSopenharmony_ci    {  5,  3 }, {  6,  2 }, {  6,  2 }, {  6,  2 }, {  6,  3 }, {  5,  5 },
58cabdff1aSopenharmony_ci    {  6,  4 }, {  6,  4 }, {  4,  8 }, {  7,  3 }, {  7,  3 }, {  7,  3 },
59cabdff1aSopenharmony_ci    {  7,  4 }, {  7,  4 }, {  7,  4 }, {  7,  5 }, {  5,  9 }, {  7,  6 },
60cabdff1aSopenharmony_ci    {  7,  6 }, {  8,  4 }, {  8,  4 }, {  8,  5 }, {  8,  5 }, {  8,  6 },
61cabdff1aSopenharmony_ci    {  8,  6 }, {  8,  6 }, {  7,  9 }, {  9,  5 }, {  9,  5 }, {  9,  6 },
62cabdff1aSopenharmony_ci    {  8,  8 }, {  9,  7 }, {  9,  7 }, {  9,  7 }, { 10,  6 }, { 10,  6 },
63cabdff1aSopenharmony_ci    { 10,  6 }, { 10,  7 }, {  9,  9 }, { 10,  8 }, { 10,  8 }, {  8, 12 },
64cabdff1aSopenharmony_ci    { 11,  7 }, { 11,  7 }, { 11,  7 }, { 11,  8 }, { 11,  8 }, { 11,  8 },
65cabdff1aSopenharmony_ci    { 11,  9 }, {  9, 13 }, { 11, 10 }, { 11, 10 }, { 12,  8 }, { 12,  8 },
66cabdff1aSopenharmony_ci    { 12,  9 }, { 12,  9 }, { 12, 10 }, { 12, 10 }, { 12, 10 }, { 11, 13 },
67cabdff1aSopenharmony_ci    { 13,  9 }, { 13,  9 }, { 13, 10 }, { 12, 12 }, { 13, 11 }, { 13, 11 },
68cabdff1aSopenharmony_ci    { 13, 11 }, { 14, 10 }, { 14, 10 }, { 14, 10 }, { 14, 11 }, { 13, 13 },
69cabdff1aSopenharmony_ci    { 14, 12 }, { 14, 12 }, { 12, 16 }, { 15, 11 }, { 15, 11 }, { 15, 11 },
70cabdff1aSopenharmony_ci    { 15, 12 }, { 15, 12 }, { 15, 12 }, { 15, 13 }, { 13, 17 }, { 15, 14 },
71cabdff1aSopenharmony_ci    { 15, 14 }, { 16, 12 }, { 16, 12 }, { 16, 13 }, { 16, 13 }, { 16, 14 },
72cabdff1aSopenharmony_ci    { 16, 14 }, { 16, 14 }, { 15, 17 }, { 17, 13 }, { 17, 13 }, { 17, 14 },
73cabdff1aSopenharmony_ci    { 16, 16 }, { 17, 15 }, { 17, 15 }, { 17, 15 }, { 18, 14 }, { 18, 14 },
74cabdff1aSopenharmony_ci    { 18, 14 }, { 18, 15 }, { 17, 17 }, { 18, 16 }, { 18, 16 }, { 16, 20 },
75cabdff1aSopenharmony_ci    { 19, 15 }, { 19, 15 }, { 19, 15 }, { 19, 16 }, { 19, 16 }, { 19, 16 },
76cabdff1aSopenharmony_ci    { 19, 17 }, { 17, 21 }, { 19, 18 }, { 19, 18 }, { 20, 16 }, { 20, 16 },
77cabdff1aSopenharmony_ci    { 20, 17 }, { 20, 17 }, { 20, 18 }, { 20, 18 }, { 20, 18 }, { 19, 21 },
78cabdff1aSopenharmony_ci    { 21, 17 }, { 21, 17 }, { 21, 18 }, { 20, 20 }, { 21, 19 }, { 21, 19 },
79cabdff1aSopenharmony_ci    { 21, 19 }, { 22, 18 }, { 22, 18 }, { 22, 18 }, { 22, 19 }, { 21, 21 },
80cabdff1aSopenharmony_ci    { 22, 20 }, { 22, 20 }, { 20, 24 }, { 23, 19 }, { 23, 19 }, { 23, 19 },
81cabdff1aSopenharmony_ci    { 23, 20 }, { 23, 20 }, { 23, 20 }, { 23, 21 }, { 21, 25 }, { 23, 22 },
82cabdff1aSopenharmony_ci    { 23, 22 }, { 24, 20 }, { 24, 20 }, { 24, 21 }, { 24, 21 }, { 24, 22 },
83cabdff1aSopenharmony_ci    { 24, 22 }, { 24, 22 }, { 23, 25 }, { 25, 21 }, { 25, 21 }, { 25, 22 },
84cabdff1aSopenharmony_ci    { 24, 24 }, { 25, 23 }, { 25, 23 }, { 25, 23 }, { 26, 22 }, { 26, 22 },
85cabdff1aSopenharmony_ci    { 26, 22 }, { 26, 23 }, { 25, 25 }, { 26, 24 }, { 26, 24 }, { 24, 28 },
86cabdff1aSopenharmony_ci    { 27, 23 }, { 27, 23 }, { 27, 23 }, { 27, 24 }, { 27, 24 }, { 27, 24 },
87cabdff1aSopenharmony_ci    { 27, 25 }, { 25, 29 }, { 27, 26 }, { 27, 26 }, { 28, 24 }, { 28, 24 },
88cabdff1aSopenharmony_ci    { 28, 25 }, { 28, 25 }, { 28, 26 }, { 28, 26 }, { 28, 26 }, { 27, 29 },
89cabdff1aSopenharmony_ci    { 29, 25 }, { 29, 25 }, { 29, 26 }, { 28, 28 }, { 29, 27 }, { 29, 27 },
90cabdff1aSopenharmony_ci    { 29, 27 }, { 30, 26 }, { 30, 26 }, { 30, 26 }, { 30, 27 }, { 29, 29 },
91cabdff1aSopenharmony_ci    { 30, 28 }, { 30, 28 }, { 30, 28 }, { 31, 27 }, { 31, 27 }, { 31, 27 },
92cabdff1aSopenharmony_ci    { 31, 28 }, { 31, 28 }, { 31, 28 }, { 31, 29 }, { 31, 29 }, { 31, 30 },
93cabdff1aSopenharmony_ci    { 31, 30 }, { 31, 30 }, { 31, 31 }, { 31, 31 },
94cabdff1aSopenharmony_ci};
95cabdff1aSopenharmony_ci
96cabdff1aSopenharmony_cistatic const uint8_t match6[256][2] = {
97cabdff1aSopenharmony_ci    {  0,  0 }, {  0,  1 }, {  1,  0 }, {  1,  0 }, {  1,  1 }, {  2,  0 },
98cabdff1aSopenharmony_ci    {  2,  1 }, {  3,  0 }, {  3,  0 }, {  3,  1 }, {  4,  0 }, {  4,  0 },
99cabdff1aSopenharmony_ci    {  4,  1 }, {  5,  0 }, {  5,  1 }, {  6,  0 }, {  6,  0 }, {  6,  1 },
100cabdff1aSopenharmony_ci    {  7,  0 }, {  7,  0 }, {  7,  1 }, {  8,  0 }, {  8,  1 }, {  8,  1 },
101cabdff1aSopenharmony_ci    {  8,  2 }, {  9,  1 }, {  9,  2 }, {  9,  2 }, {  9,  3 }, { 10,  2 },
102cabdff1aSopenharmony_ci    { 10,  3 }, { 10,  3 }, { 10,  4 }, { 11,  3 }, { 11,  4 }, { 11,  4 },
103cabdff1aSopenharmony_ci    { 11,  5 }, { 12,  4 }, { 12,  5 }, { 12,  5 }, { 12,  6 }, { 13,  5 },
104cabdff1aSopenharmony_ci    { 13,  6 }, {  8, 16 }, { 13,  7 }, { 14,  6 }, { 14,  7 }, {  9, 17 },
105cabdff1aSopenharmony_ci    { 14,  8 }, { 15,  7 }, { 15,  8 }, { 11, 16 }, { 15,  9 }, { 15, 10 },
106cabdff1aSopenharmony_ci    { 16,  8 }, { 16,  9 }, { 16, 10 }, { 15, 13 }, { 17,  9 }, { 17, 10 },
107cabdff1aSopenharmony_ci    { 17, 11 }, { 15, 16 }, { 18, 10 }, { 18, 11 }, { 18, 12 }, { 16, 16 },
108cabdff1aSopenharmony_ci    { 19, 11 }, { 19, 12 }, { 19, 13 }, { 17, 17 }, { 20, 12 }, { 20, 13 },
109cabdff1aSopenharmony_ci    { 20, 14 }, { 19, 16 }, { 21, 13 }, { 21, 14 }, { 21, 15 }, { 20, 17 },
110cabdff1aSopenharmony_ci    { 22, 14 }, { 22, 15 }, { 25, 10 }, { 22, 16 }, { 23, 15 }, { 23, 16 },
111cabdff1aSopenharmony_ci    { 26, 11 }, { 23, 17 }, { 24, 16 }, { 24, 17 }, { 27, 12 }, { 24, 18 },
112cabdff1aSopenharmony_ci    { 25, 17 }, { 25, 18 }, { 28, 13 }, { 25, 19 }, { 26, 18 }, { 26, 19 },
113cabdff1aSopenharmony_ci    { 29, 14 }, { 26, 20 }, { 27, 19 }, { 27, 20 }, { 30, 15 }, { 27, 21 },
114cabdff1aSopenharmony_ci    { 28, 20 }, { 28, 21 }, { 28, 21 }, { 28, 22 }, { 29, 21 }, { 29, 22 },
115cabdff1aSopenharmony_ci    { 24, 32 }, { 29, 23 }, { 30, 22 }, { 30, 23 }, { 25, 33 }, { 30, 24 },
116cabdff1aSopenharmony_ci    { 31, 23 }, { 31, 24 }, { 27, 32 }, { 31, 25 }, { 31, 26 }, { 32, 24 },
117cabdff1aSopenharmony_ci    { 32, 25 }, { 32, 26 }, { 31, 29 }, { 33, 25 }, { 33, 26 }, { 33, 27 },
118cabdff1aSopenharmony_ci    { 31, 32 }, { 34, 26 }, { 34, 27 }, { 34, 28 }, { 32, 32 }, { 35, 27 },
119cabdff1aSopenharmony_ci    { 35, 28 }, { 35, 29 }, { 33, 33 }, { 36, 28 }, { 36, 29 }, { 36, 30 },
120cabdff1aSopenharmony_ci    { 35, 32 }, { 37, 29 }, { 37, 30 }, { 37, 31 }, { 36, 33 }, { 38, 30 },
121cabdff1aSopenharmony_ci    { 38, 31 }, { 41, 26 }, { 38, 32 }, { 39, 31 }, { 39, 32 }, { 42, 27 },
122cabdff1aSopenharmony_ci    { 39, 33 }, { 40, 32 }, { 40, 33 }, { 43, 28 }, { 40, 34 }, { 41, 33 },
123cabdff1aSopenharmony_ci    { 41, 34 }, { 44, 29 }, { 41, 35 }, { 42, 34 }, { 42, 35 }, { 45, 30 },
124cabdff1aSopenharmony_ci    { 42, 36 }, { 43, 35 }, { 43, 36 }, { 46, 31 }, { 43, 37 }, { 44, 36 },
125cabdff1aSopenharmony_ci    { 44, 37 }, { 44, 37 }, { 44, 38 }, { 45, 37 }, { 45, 38 }, { 40, 48 },
126cabdff1aSopenharmony_ci    { 45, 39 }, { 46, 38 }, { 46, 39 }, { 41, 49 }, { 46, 40 }, { 47, 39 },
127cabdff1aSopenharmony_ci    { 47, 40 }, { 43, 48 }, { 47, 41 }, { 47, 42 }, { 48, 40 }, { 48, 41 },
128cabdff1aSopenharmony_ci    { 48, 42 }, { 47, 45 }, { 49, 41 }, { 49, 42 }, { 49, 43 }, { 47, 48 },
129cabdff1aSopenharmony_ci    { 50, 42 }, { 50, 43 }, { 50, 44 }, { 48, 48 }, { 51, 43 }, { 51, 44 },
130cabdff1aSopenharmony_ci    { 51, 45 }, { 49, 49 }, { 52, 44 }, { 52, 45 }, { 52, 46 }, { 51, 48 },
131cabdff1aSopenharmony_ci    { 53, 45 }, { 53, 46 }, { 53, 47 }, { 52, 49 }, { 54, 46 }, { 54, 47 },
132cabdff1aSopenharmony_ci    { 57, 42 }, { 54, 48 }, { 55, 47 }, { 55, 48 }, { 58, 43 }, { 55, 49 },
133cabdff1aSopenharmony_ci    { 56, 48 }, { 56, 49 }, { 59, 44 }, { 56, 50 }, { 57, 49 }, { 57, 50 },
134cabdff1aSopenharmony_ci    { 60, 45 }, { 57, 51 }, { 58, 50 }, { 58, 51 }, { 61, 46 }, { 58, 52 },
135cabdff1aSopenharmony_ci    { 59, 51 }, { 59, 52 }, { 62, 47 }, { 59, 53 }, { 60, 52 }, { 60, 53 },
136cabdff1aSopenharmony_ci    { 60, 53 }, { 60, 54 }, { 61, 53 }, { 61, 54 }, { 61, 54 }, { 61, 55 },
137cabdff1aSopenharmony_ci    { 62, 54 }, { 62, 55 }, { 62, 55 }, { 62, 56 }, { 63, 55 }, { 63, 56 },
138cabdff1aSopenharmony_ci    { 63, 56 }, { 63, 57 }, { 63, 58 }, { 63, 59 }, { 63, 59 }, { 63, 60 },
139cabdff1aSopenharmony_ci    { 63, 61 }, { 63, 62 }, { 63, 62 }, { 63, 63 },
140cabdff1aSopenharmony_ci};
141cabdff1aSopenharmony_ci
142cabdff1aSopenharmony_ci/* Multiplication over 8 bit emulation */
143cabdff1aSopenharmony_ci#define mul8(a, b) (((a) * (b) + 128 + (((a) * (b) + 128) >> 8)) >> 8)
144cabdff1aSopenharmony_ci
145cabdff1aSopenharmony_ci/* Conversion from rgb24 to rgb565 */
146cabdff1aSopenharmony_ci#define rgb2rgb565(r, g, b) \
147cabdff1aSopenharmony_ci    ((mul8(r, 31) << 11) | (mul8(g, 63) << 5) | (mul8(b, 31) << 0))
148cabdff1aSopenharmony_ci
149cabdff1aSopenharmony_ci/* Linear interpolation at 1/3 point between a and b */
150cabdff1aSopenharmony_ci#define lerp13(a, b) ((2 * (a) + (b)) / 3)
151cabdff1aSopenharmony_ci
152cabdff1aSopenharmony_ci/* Linear interpolation on an RGB pixel */
153cabdff1aSopenharmony_cistatic inline void lerp13rgb(uint8_t *out, uint8_t *p1, uint8_t *p2)
154cabdff1aSopenharmony_ci{
155cabdff1aSopenharmony_ci    out[0] = lerp13(p1[0], p2[0]);
156cabdff1aSopenharmony_ci    out[1] = lerp13(p1[1], p2[1]);
157cabdff1aSopenharmony_ci    out[2] = lerp13(p1[2], p2[2]);
158cabdff1aSopenharmony_ci}
159cabdff1aSopenharmony_ci
160cabdff1aSopenharmony_ci/* Conversion from rgb565 to rgb24 */
161cabdff1aSopenharmony_cistatic inline void rgb5652rgb(uint8_t *out, uint16_t v)
162cabdff1aSopenharmony_ci{
163cabdff1aSopenharmony_ci    int rv = (v & 0xf800) >> 11;
164cabdff1aSopenharmony_ci    int gv = (v & 0x07e0) >> 5;
165cabdff1aSopenharmony_ci    int bv = (v & 0x001f) >> 0;
166cabdff1aSopenharmony_ci
167cabdff1aSopenharmony_ci    out[0] = expand5[rv];
168cabdff1aSopenharmony_ci    out[1] = expand6[gv];
169cabdff1aSopenharmony_ci    out[2] = expand5[bv];
170cabdff1aSopenharmony_ci    out[3] = 0;
171cabdff1aSopenharmony_ci}
172cabdff1aSopenharmony_ci
173cabdff1aSopenharmony_ci/* Color matching function */
174cabdff1aSopenharmony_cistatic unsigned int match_colors(const uint8_t *block, ptrdiff_t stride,
175cabdff1aSopenharmony_ci                                 uint16_t c0, uint16_t c1)
176cabdff1aSopenharmony_ci{
177cabdff1aSopenharmony_ci    uint32_t mask = 0;
178cabdff1aSopenharmony_ci    int dirr, dirg, dirb;
179cabdff1aSopenharmony_ci    int dots[16];
180cabdff1aSopenharmony_ci    int stops[4];
181cabdff1aSopenharmony_ci    int x, y, k = 0;
182cabdff1aSopenharmony_ci    int c0_point, half_point, c3_point;
183cabdff1aSopenharmony_ci    uint8_t color[16];
184cabdff1aSopenharmony_ci    static const uint32_t indexMap[8] = {
185cabdff1aSopenharmony_ci        0U << 30, 2U << 30, 0U << 30, 2U << 30,
186cabdff1aSopenharmony_ci        3U << 30, 3U << 30, 1U << 30, 1U << 30,
187cabdff1aSopenharmony_ci    };
188cabdff1aSopenharmony_ci
189cabdff1aSopenharmony_ci    /* Fill color and compute direction for each component */
190cabdff1aSopenharmony_ci    rgb5652rgb(color + 0, c0);
191cabdff1aSopenharmony_ci    rgb5652rgb(color + 4, c1);
192cabdff1aSopenharmony_ci    lerp13rgb(color + 8, color + 0, color + 4);
193cabdff1aSopenharmony_ci    lerp13rgb(color + 12, color + 4, color + 0);
194cabdff1aSopenharmony_ci
195cabdff1aSopenharmony_ci    dirr = color[0 * 4 + 0] - color[1 * 4 + 0];
196cabdff1aSopenharmony_ci    dirg = color[0 * 4 + 1] - color[1 * 4 + 1];
197cabdff1aSopenharmony_ci    dirb = color[0 * 4 + 2] - color[1 * 4 + 2];
198cabdff1aSopenharmony_ci
199cabdff1aSopenharmony_ci    for (y = 0; y < 4; y++) {
200cabdff1aSopenharmony_ci        for (x = 0; x < 4; x++)
201cabdff1aSopenharmony_ci            dots[k++] = block[0 + x * 4 + y * stride] * dirr +
202cabdff1aSopenharmony_ci                        block[1 + x * 4 + y * stride] * dirg +
203cabdff1aSopenharmony_ci                        block[2 + x * 4 + y * stride] * dirb;
204cabdff1aSopenharmony_ci
205cabdff1aSopenharmony_ci        stops[y] = color[0 + y * 4] * dirr +
206cabdff1aSopenharmony_ci                   color[1 + y * 4] * dirg +
207cabdff1aSopenharmony_ci                   color[2 + y * 4] * dirb;
208cabdff1aSopenharmony_ci    }
209cabdff1aSopenharmony_ci
210cabdff1aSopenharmony_ci    /* Think of the colors as arranged on a line; project point onto that line,
211cabdff1aSopenharmony_ci     * then choose next color out of available ones. we compute the crossover
212cabdff1aSopenharmony_ci     * points for 'best color in top half'/'best in bottom half' and then
213cabdff1aSopenharmony_ci     * the same inside that subinterval.
214cabdff1aSopenharmony_ci     *
215cabdff1aSopenharmony_ci     * Relying on this 1d approximation isn't always optimal in terms of
216cabdff1aSopenharmony_ci     * Euclidean distance, but it's very close and a lot faster.
217cabdff1aSopenharmony_ci     *
218cabdff1aSopenharmony_ci     * http://cbloomrants.blogspot.com/2008/12/12-08-08-dxtc-summary.html */
219cabdff1aSopenharmony_ci    c0_point   = (stops[1] + stops[3]) >> 1;
220cabdff1aSopenharmony_ci    half_point = (stops[3] + stops[2]) >> 1;
221cabdff1aSopenharmony_ci    c3_point   = (stops[2] + stops[0]) >> 1;
222cabdff1aSopenharmony_ci
223cabdff1aSopenharmony_ci    for (x = 0; x < 16; x++) {
224cabdff1aSopenharmony_ci        int dot  = dots[x];
225cabdff1aSopenharmony_ci        int bits = (dot < half_point ? 4 : 0) |
226cabdff1aSopenharmony_ci                   (dot < c0_point   ? 2 : 0) |
227cabdff1aSopenharmony_ci                   (dot < c3_point   ? 1 : 0);
228cabdff1aSopenharmony_ci
229cabdff1aSopenharmony_ci        mask >>= 2;
230cabdff1aSopenharmony_ci        mask  |= indexMap[bits];
231cabdff1aSopenharmony_ci    }
232cabdff1aSopenharmony_ci
233cabdff1aSopenharmony_ci    return mask;
234cabdff1aSopenharmony_ci}
235cabdff1aSopenharmony_ci
236cabdff1aSopenharmony_ci/* Color optimization function */
237cabdff1aSopenharmony_cistatic void optimize_colors(const uint8_t *block, ptrdiff_t stride,
238cabdff1aSopenharmony_ci                            uint16_t *pmax16, uint16_t *pmin16)
239cabdff1aSopenharmony_ci{
240cabdff1aSopenharmony_ci    const uint8_t *minp;
241cabdff1aSopenharmony_ci    const uint8_t *maxp;
242cabdff1aSopenharmony_ci    const int iter_power = 4;
243cabdff1aSopenharmony_ci    double magn;
244cabdff1aSopenharmony_ci    int v_r, v_g, v_b;
245cabdff1aSopenharmony_ci    float covf[6], vfr, vfg, vfb;
246cabdff1aSopenharmony_ci    int mind, maxd;
247cabdff1aSopenharmony_ci    int cov[6] = { 0 };
248cabdff1aSopenharmony_ci    int mu[3], min[3], max[3];
249cabdff1aSopenharmony_ci    int ch, iter, x, y;
250cabdff1aSopenharmony_ci
251cabdff1aSopenharmony_ci    /* Determine color distribution */
252cabdff1aSopenharmony_ci    for (ch = 0; ch < 3; ch++) {
253cabdff1aSopenharmony_ci        const uint8_t *bp = &block[ch];
254cabdff1aSopenharmony_ci        int muv, minv, maxv;
255cabdff1aSopenharmony_ci
256cabdff1aSopenharmony_ci        muv = minv = maxv = bp[0];
257cabdff1aSopenharmony_ci        for (y = 0; y < 4; y++) {
258cabdff1aSopenharmony_ci            for (x = 0; x < 4; x++) {
259cabdff1aSopenharmony_ci                muv += bp[x * 4 + y * stride];
260cabdff1aSopenharmony_ci                if (bp[x * 4 + y * stride] < minv)
261cabdff1aSopenharmony_ci                    minv = bp[x * 4 + y * stride];
262cabdff1aSopenharmony_ci                else if (bp[x * 4 + y * stride] > maxv)
263cabdff1aSopenharmony_ci                    maxv = bp[x * 4 + y * stride];
264cabdff1aSopenharmony_ci            }
265cabdff1aSopenharmony_ci        }
266cabdff1aSopenharmony_ci
267cabdff1aSopenharmony_ci        mu[ch]  = (muv + 8) >> 4;
268cabdff1aSopenharmony_ci        min[ch] = minv;
269cabdff1aSopenharmony_ci        max[ch] = maxv;
270cabdff1aSopenharmony_ci    }
271cabdff1aSopenharmony_ci
272cabdff1aSopenharmony_ci    /* Determine covariance matrix */
273cabdff1aSopenharmony_ci    for (y = 0; y < 4; y++) {
274cabdff1aSopenharmony_ci        for (x = 0; x < 4; x++) {
275cabdff1aSopenharmony_ci            int r = block[x * 4 + stride * y + 0] - mu[0];
276cabdff1aSopenharmony_ci            int g = block[x * 4 + stride * y + 1] - mu[1];
277cabdff1aSopenharmony_ci            int b = block[x * 4 + stride * y + 2] - mu[2];
278cabdff1aSopenharmony_ci
279cabdff1aSopenharmony_ci            cov[0] += r * r;
280cabdff1aSopenharmony_ci            cov[1] += r * g;
281cabdff1aSopenharmony_ci            cov[2] += r * b;
282cabdff1aSopenharmony_ci            cov[3] += g * g;
283cabdff1aSopenharmony_ci            cov[4] += g * b;
284cabdff1aSopenharmony_ci            cov[5] += b * b;
285cabdff1aSopenharmony_ci        }
286cabdff1aSopenharmony_ci    }
287cabdff1aSopenharmony_ci
288cabdff1aSopenharmony_ci    /* Convert covariance matrix to float, find principal axis via power iter */
289cabdff1aSopenharmony_ci    for (x = 0; x < 6; x++)
290cabdff1aSopenharmony_ci        covf[x] = cov[x] / 255.0f;
291cabdff1aSopenharmony_ci
292cabdff1aSopenharmony_ci    vfr = (float) (max[0] - min[0]);
293cabdff1aSopenharmony_ci    vfg = (float) (max[1] - min[1]);
294cabdff1aSopenharmony_ci    vfb = (float) (max[2] - min[2]);
295cabdff1aSopenharmony_ci
296cabdff1aSopenharmony_ci    for (iter = 0; iter < iter_power; iter++) {
297cabdff1aSopenharmony_ci        float r = vfr * covf[0] + vfg * covf[1] + vfb * covf[2];
298cabdff1aSopenharmony_ci        float g = vfr * covf[1] + vfg * covf[3] + vfb * covf[4];
299cabdff1aSopenharmony_ci        float b = vfr * covf[2] + vfg * covf[4] + vfb * covf[5];
300cabdff1aSopenharmony_ci
301cabdff1aSopenharmony_ci        vfr = r;
302cabdff1aSopenharmony_ci        vfg = g;
303cabdff1aSopenharmony_ci        vfb = b;
304cabdff1aSopenharmony_ci    }
305cabdff1aSopenharmony_ci
306cabdff1aSopenharmony_ci    magn = fabs(vfr);
307cabdff1aSopenharmony_ci    if (fabs(vfg) > magn)
308cabdff1aSopenharmony_ci        magn = fabs(vfg);
309cabdff1aSopenharmony_ci    if (fabs(vfb) > magn)
310cabdff1aSopenharmony_ci        magn = fabs(vfb);
311cabdff1aSopenharmony_ci
312cabdff1aSopenharmony_ci    /* if magnitude is too small, default to luminance */
313cabdff1aSopenharmony_ci    if (magn < 4.0f) {
314cabdff1aSopenharmony_ci        /* JPEG YCbCr luma coefs, scaled by 1000 */
315cabdff1aSopenharmony_ci        v_r = 299;
316cabdff1aSopenharmony_ci        v_g = 587;
317cabdff1aSopenharmony_ci        v_b = 114;
318cabdff1aSopenharmony_ci    } else {
319cabdff1aSopenharmony_ci        magn = 512.0 / magn;
320cabdff1aSopenharmony_ci        v_r  = (int) (vfr * magn);
321cabdff1aSopenharmony_ci        v_g  = (int) (vfg * magn);
322cabdff1aSopenharmony_ci        v_b  = (int) (vfb * magn);
323cabdff1aSopenharmony_ci    }
324cabdff1aSopenharmony_ci
325cabdff1aSopenharmony_ci    /* Pick colors at extreme points */
326cabdff1aSopenharmony_ci    mind = maxd = block[0] * v_r + block[1] * v_g + block[2] * v_b;
327cabdff1aSopenharmony_ci    minp = maxp = block;
328cabdff1aSopenharmony_ci    for (y = 0; y < 4; y++) {
329cabdff1aSopenharmony_ci        for (x = 0; x < 4; x++) {
330cabdff1aSopenharmony_ci            int dot = block[x * 4 + y * stride + 0] * v_r +
331cabdff1aSopenharmony_ci                      block[x * 4 + y * stride + 1] * v_g +
332cabdff1aSopenharmony_ci                      block[x * 4 + y * stride + 2] * v_b;
333cabdff1aSopenharmony_ci
334cabdff1aSopenharmony_ci            if (dot < mind) {
335cabdff1aSopenharmony_ci                mind = dot;
336cabdff1aSopenharmony_ci                minp = block + x * 4 + y * stride;
337cabdff1aSopenharmony_ci            } else if (dot > maxd) {
338cabdff1aSopenharmony_ci                maxd = dot;
339cabdff1aSopenharmony_ci                maxp = block + x * 4 + y * stride;
340cabdff1aSopenharmony_ci            }
341cabdff1aSopenharmony_ci        }
342cabdff1aSopenharmony_ci    }
343cabdff1aSopenharmony_ci
344cabdff1aSopenharmony_ci    *pmax16 = rgb2rgb565(maxp[0], maxp[1], maxp[2]);
345cabdff1aSopenharmony_ci    *pmin16 = rgb2rgb565(minp[0], minp[1], minp[2]);
346cabdff1aSopenharmony_ci}
347cabdff1aSopenharmony_ci
348cabdff1aSopenharmony_ci/* Try to optimize colors to suit block contents better, by solving
349cabdff1aSopenharmony_ci * a least squares system via normal equations + Cramer's rule. */
350cabdff1aSopenharmony_cistatic int refine_colors(const uint8_t *block, ptrdiff_t stride,
351cabdff1aSopenharmony_ci                         uint16_t *pmax16, uint16_t *pmin16, uint32_t mask)
352cabdff1aSopenharmony_ci{
353cabdff1aSopenharmony_ci    uint32_t cm = mask;
354cabdff1aSopenharmony_ci    uint16_t oldMin = *pmin16;
355cabdff1aSopenharmony_ci    uint16_t oldMax = *pmax16;
356cabdff1aSopenharmony_ci    uint16_t min16, max16;
357cabdff1aSopenharmony_ci    int x, y;
358cabdff1aSopenharmony_ci
359cabdff1aSopenharmony_ci    /* Additional magic to save a lot of multiplies in the accumulating loop.
360cabdff1aSopenharmony_ci     * The tables contain precomputed products of weights for least squares
361cabdff1aSopenharmony_ci     * system, accumulated inside one 32-bit register */
362cabdff1aSopenharmony_ci    static const int w1tab[4] = { 3, 0, 2, 1 };
363cabdff1aSopenharmony_ci    static const int prods[4] = { 0x090000, 0x000900, 0x040102, 0x010402 };
364cabdff1aSopenharmony_ci
365cabdff1aSopenharmony_ci    /* Check if all pixels have the same index */
366cabdff1aSopenharmony_ci    if ((mask ^ (mask << 2)) < 4) {
367cabdff1aSopenharmony_ci        /* If so, linear system would be singular; solve using optimal
368cabdff1aSopenharmony_ci         * single-color match on average color. */
369cabdff1aSopenharmony_ci        int r = 8, g = 8, b = 8;
370cabdff1aSopenharmony_ci        for (y = 0; y < 4; y++) {
371cabdff1aSopenharmony_ci            for (x = 0; x < 4; x++) {
372cabdff1aSopenharmony_ci                r += block[0 + x * 4 + y * stride];
373cabdff1aSopenharmony_ci                g += block[1 + x * 4 + y * stride];
374cabdff1aSopenharmony_ci                b += block[2 + x * 4 + y * stride];
375cabdff1aSopenharmony_ci            }
376cabdff1aSopenharmony_ci        }
377cabdff1aSopenharmony_ci
378cabdff1aSopenharmony_ci        r >>= 4;
379cabdff1aSopenharmony_ci        g >>= 4;
380cabdff1aSopenharmony_ci        b >>= 4;
381cabdff1aSopenharmony_ci
382cabdff1aSopenharmony_ci        max16 = (match5[r][0] << 11) | (match6[g][0] << 5) | match5[b][0];
383cabdff1aSopenharmony_ci        min16 = (match5[r][1] << 11) | (match6[g][1] << 5) | match5[b][1];
384cabdff1aSopenharmony_ci    } else {
385cabdff1aSopenharmony_ci        float fr, fg, fb;
386cabdff1aSopenharmony_ci        int at1_r = 0, at1_g = 0, at1_b = 0;
387cabdff1aSopenharmony_ci        int at2_r = 0, at2_g = 0, at2_b = 0;
388cabdff1aSopenharmony_ci        int akku = 0;
389cabdff1aSopenharmony_ci        int xx, xy, yy;
390cabdff1aSopenharmony_ci
391cabdff1aSopenharmony_ci        for (y = 0; y < 4; y++) {
392cabdff1aSopenharmony_ci            for (x = 0; x < 4; x++) {
393cabdff1aSopenharmony_ci                int step = cm & 3;
394cabdff1aSopenharmony_ci                int w1 = w1tab[step];
395cabdff1aSopenharmony_ci                int r = block[0 + x * 4 + y * stride];
396cabdff1aSopenharmony_ci                int g = block[1 + x * 4 + y * stride];
397cabdff1aSopenharmony_ci                int b = block[2 + x * 4 + y * stride];
398cabdff1aSopenharmony_ci
399cabdff1aSopenharmony_ci                akku  += prods[step];
400cabdff1aSopenharmony_ci                at1_r += w1 * r;
401cabdff1aSopenharmony_ci                at1_g += w1 * g;
402cabdff1aSopenharmony_ci                at1_b += w1 * b;
403cabdff1aSopenharmony_ci                at2_r += r;
404cabdff1aSopenharmony_ci                at2_g += g;
405cabdff1aSopenharmony_ci                at2_b += b;
406cabdff1aSopenharmony_ci
407cabdff1aSopenharmony_ci                cm >>= 2;
408cabdff1aSopenharmony_ci            }
409cabdff1aSopenharmony_ci        }
410cabdff1aSopenharmony_ci
411cabdff1aSopenharmony_ci        at2_r = 3 * at2_r - at1_r;
412cabdff1aSopenharmony_ci        at2_g = 3 * at2_g - at1_g;
413cabdff1aSopenharmony_ci        at2_b = 3 * at2_b - at1_b;
414cabdff1aSopenharmony_ci
415cabdff1aSopenharmony_ci        /* Extract solutions and decide solvability */
416cabdff1aSopenharmony_ci        xx =  akku >> 16;
417cabdff1aSopenharmony_ci        yy = (akku >>  8) & 0xFF;
418cabdff1aSopenharmony_ci        xy = (akku >>  0) & 0xFF;
419cabdff1aSopenharmony_ci
420cabdff1aSopenharmony_ci        fr = 3.0f * 31.0f / 255.0f / (xx * yy - xy * xy);
421cabdff1aSopenharmony_ci        fg = fr * 63.0f / 31.0f;
422cabdff1aSopenharmony_ci        fb = fr;
423cabdff1aSopenharmony_ci
424cabdff1aSopenharmony_ci        /* Solve */
425cabdff1aSopenharmony_ci        max16  = av_clip_uintp2((at1_r * yy - at2_r * xy) * fr + 0.5f, 5) << 11;
426cabdff1aSopenharmony_ci        max16 |= av_clip_uintp2((at1_g * yy - at2_g * xy) * fg + 0.5f, 6) <<  5;
427cabdff1aSopenharmony_ci        max16 |= av_clip_uintp2((at1_b * yy - at2_b * xy) * fb + 0.5f, 5) <<  0;
428cabdff1aSopenharmony_ci
429cabdff1aSopenharmony_ci        min16  = av_clip_uintp2((at2_r * xx - at1_r * xy) * fr + 0.5f, 5) << 11;
430cabdff1aSopenharmony_ci        min16 |= av_clip_uintp2((at2_g * xx - at1_g * xy) * fg + 0.5f, 6) <<  5;
431cabdff1aSopenharmony_ci        min16 |= av_clip_uintp2((at2_b * xx - at1_b * xy) * fb + 0.5f, 5) <<  0;
432cabdff1aSopenharmony_ci    }
433cabdff1aSopenharmony_ci
434cabdff1aSopenharmony_ci    *pmin16 = min16;
435cabdff1aSopenharmony_ci    *pmax16 = max16;
436cabdff1aSopenharmony_ci    return oldMin != min16 || oldMax != max16;
437cabdff1aSopenharmony_ci}
438cabdff1aSopenharmony_ci
439cabdff1aSopenharmony_ci/* Check if input block is a constant color */
440cabdff1aSopenharmony_cistatic int constant_color(const uint8_t *block, ptrdiff_t stride)
441cabdff1aSopenharmony_ci{
442cabdff1aSopenharmony_ci    int x, y;
443cabdff1aSopenharmony_ci    uint32_t first = AV_RL32(block);
444cabdff1aSopenharmony_ci
445cabdff1aSopenharmony_ci    for (y = 0; y < 4; y++)
446cabdff1aSopenharmony_ci        for (x = 0; x < 4; x++)
447cabdff1aSopenharmony_ci            if (first != AV_RL32(block + x * 4 + y * stride))
448cabdff1aSopenharmony_ci                return 0;
449cabdff1aSopenharmony_ci    return 1;
450cabdff1aSopenharmony_ci}
451cabdff1aSopenharmony_ci
452cabdff1aSopenharmony_ci/* Main color compression function */
453cabdff1aSopenharmony_cistatic void compress_color(uint8_t *dst, ptrdiff_t stride, const uint8_t *block)
454cabdff1aSopenharmony_ci{
455cabdff1aSopenharmony_ci    uint32_t mask;
456cabdff1aSopenharmony_ci    uint16_t max16, min16;
457cabdff1aSopenharmony_ci    int constant = constant_color(block, stride);
458cabdff1aSopenharmony_ci
459cabdff1aSopenharmony_ci    /* Constant color will load values from tables */
460cabdff1aSopenharmony_ci    if (constant) {
461cabdff1aSopenharmony_ci        int r = block[0];
462cabdff1aSopenharmony_ci        int g = block[1];
463cabdff1aSopenharmony_ci        int b = block[2];
464cabdff1aSopenharmony_ci        mask  = 0xAAAAAAAA;
465cabdff1aSopenharmony_ci        max16 = (match5[r][0] << 11) | (match6[g][0] << 5) | match5[b][0];
466cabdff1aSopenharmony_ci        min16 = (match5[r][1] << 11) | (match6[g][1] << 5) | match5[b][1];
467cabdff1aSopenharmony_ci    } else {
468cabdff1aSopenharmony_ci        int refine;
469cabdff1aSopenharmony_ci
470cabdff1aSopenharmony_ci        /* Otherwise find pca and map along principal axis */
471cabdff1aSopenharmony_ci        optimize_colors(block, stride, &max16, &min16);
472cabdff1aSopenharmony_ci        if (max16 != min16)
473cabdff1aSopenharmony_ci            mask = match_colors(block, stride, max16, min16);
474cabdff1aSopenharmony_ci        else
475cabdff1aSopenharmony_ci            mask = 0;
476cabdff1aSopenharmony_ci
477cabdff1aSopenharmony_ci        /* One pass refinement */
478cabdff1aSopenharmony_ci        refine  = refine_colors(block, stride, &max16, &min16, mask);
479cabdff1aSopenharmony_ci        if (refine) {
480cabdff1aSopenharmony_ci            if (max16 != min16)
481cabdff1aSopenharmony_ci                mask = match_colors(block, stride, max16, min16);
482cabdff1aSopenharmony_ci            else
483cabdff1aSopenharmony_ci                mask = 0;
484cabdff1aSopenharmony_ci        }
485cabdff1aSopenharmony_ci    }
486cabdff1aSopenharmony_ci
487cabdff1aSopenharmony_ci    /* Finally write the color block */
488cabdff1aSopenharmony_ci    if (max16 < min16) {
489cabdff1aSopenharmony_ci        FFSWAP(uint16_t, min16, max16);
490cabdff1aSopenharmony_ci        mask ^= 0x55555555;
491cabdff1aSopenharmony_ci    }
492cabdff1aSopenharmony_ci
493cabdff1aSopenharmony_ci    AV_WL16(dst + 0, max16);
494cabdff1aSopenharmony_ci    AV_WL16(dst + 2, min16);
495cabdff1aSopenharmony_ci    AV_WL32(dst + 4, mask);
496cabdff1aSopenharmony_ci}
497cabdff1aSopenharmony_ci
498cabdff1aSopenharmony_ci/* Alpha compression function */
499cabdff1aSopenharmony_cistatic void compress_alpha(uint8_t *dst, ptrdiff_t stride, const uint8_t *block)
500cabdff1aSopenharmony_ci{
501cabdff1aSopenharmony_ci    int x, y;
502cabdff1aSopenharmony_ci    int dist, bias, dist4, dist2;
503cabdff1aSopenharmony_ci    int mn, mx;
504cabdff1aSopenharmony_ci    int bits = 0;
505cabdff1aSopenharmony_ci    int mask = 0;
506cabdff1aSopenharmony_ci
507cabdff1aSopenharmony_ci    memset(dst, 0, 8);
508cabdff1aSopenharmony_ci
509cabdff1aSopenharmony_ci    /* Find min/max color */
510cabdff1aSopenharmony_ci    mn = mx = block[3];
511cabdff1aSopenharmony_ci    for (y = 0; y < 4; y++) {
512cabdff1aSopenharmony_ci        for (x = 0; x < 4; x++) {
513cabdff1aSopenharmony_ci            int val = block[3 + x * 4 + y * stride];
514cabdff1aSopenharmony_ci            if (val < mn)
515cabdff1aSopenharmony_ci                mn = val;
516cabdff1aSopenharmony_ci            else if (val > mx)
517cabdff1aSopenharmony_ci                mx = val;
518cabdff1aSopenharmony_ci        }
519cabdff1aSopenharmony_ci    }
520cabdff1aSopenharmony_ci
521cabdff1aSopenharmony_ci    /* Encode them */
522cabdff1aSopenharmony_ci    dst[0] = (uint8_t) mx;
523cabdff1aSopenharmony_ci    dst[1] = (uint8_t) mn;
524cabdff1aSopenharmony_ci    dst += 2;
525cabdff1aSopenharmony_ci
526cabdff1aSopenharmony_ci    /* Mono-alpha shortcut */
527cabdff1aSopenharmony_ci    if (mn == mx)
528cabdff1aSopenharmony_ci        return;
529cabdff1aSopenharmony_ci
530cabdff1aSopenharmony_ci    /* Determine bias and emit color indices.
531cabdff1aSopenharmony_ci     * Given the choice of mx/mn, these indices are optimal:
532cabdff1aSopenharmony_ci     * fgiesen.wordpress.com/2009/12/15/dxt5-alpha-block-index-determination */
533cabdff1aSopenharmony_ci    dist = mx - mn;
534cabdff1aSopenharmony_ci
535cabdff1aSopenharmony_ci    dist4 = dist * 4;
536cabdff1aSopenharmony_ci    dist2 = dist * 2;
537cabdff1aSopenharmony_ci    if (dist < 8)
538cabdff1aSopenharmony_ci        bias = dist - 1 - mn * 7;
539cabdff1aSopenharmony_ci    else
540cabdff1aSopenharmony_ci        bias = dist / 2 + 2 - mn * 7;
541cabdff1aSopenharmony_ci
542cabdff1aSopenharmony_ci    for (y = 0; y < 4; y++) {
543cabdff1aSopenharmony_ci        for (x = 0; x < 4; x++) {
544cabdff1aSopenharmony_ci            int alp = block[3 + x * 4 + y * stride] * 7 + bias;
545cabdff1aSopenharmony_ci            int ind, tmp;
546cabdff1aSopenharmony_ci
547cabdff1aSopenharmony_ci            /* This is a "linear scale" lerp factor between 0 (val=min)
548cabdff1aSopenharmony_ci             * and 7 (val=max) to select index. */
549cabdff1aSopenharmony_ci            tmp  = (alp >= dist4) ? -1 : 0;
550cabdff1aSopenharmony_ci            ind  = tmp & 4;
551cabdff1aSopenharmony_ci            alp -= dist4 & tmp;
552cabdff1aSopenharmony_ci            tmp  = (alp >= dist2) ? -1 : 0;
553cabdff1aSopenharmony_ci            ind += tmp & 2;
554cabdff1aSopenharmony_ci            alp -= dist2 & tmp;
555cabdff1aSopenharmony_ci            ind += (alp >= dist);
556cabdff1aSopenharmony_ci
557cabdff1aSopenharmony_ci            /* Turn linear scale into DXT index (0/1 are extreme points) */
558cabdff1aSopenharmony_ci            ind  = -ind & 7;
559cabdff1aSopenharmony_ci            ind ^= (2 > ind);
560cabdff1aSopenharmony_ci
561cabdff1aSopenharmony_ci            /* Write index */
562cabdff1aSopenharmony_ci            mask |= ind << bits;
563cabdff1aSopenharmony_ci            bits += 3;
564cabdff1aSopenharmony_ci            if (bits >= 8) {
565cabdff1aSopenharmony_ci                *dst++ = mask;
566cabdff1aSopenharmony_ci                mask >>= 8;
567cabdff1aSopenharmony_ci                bits  -= 8;
568cabdff1aSopenharmony_ci            }
569cabdff1aSopenharmony_ci        }
570cabdff1aSopenharmony_ci    }
571cabdff1aSopenharmony_ci}
572cabdff1aSopenharmony_ci
573cabdff1aSopenharmony_ci/**
574cabdff1aSopenharmony_ci * Convert a RGBA buffer to unscaled YCoCg.
575cabdff1aSopenharmony_ci * Scale is usually introduced to avoid banding over a certain range of colors,
576cabdff1aSopenharmony_ci * but this version of the algorithm does not introduce it as much as other
577cabdff1aSopenharmony_ci * implementations, allowing for a simpler and faster conversion.
578cabdff1aSopenharmony_ci */
579cabdff1aSopenharmony_cistatic void rgba2ycocg(uint8_t *dst, const uint8_t *pixel)
580cabdff1aSopenharmony_ci{
581cabdff1aSopenharmony_ci    int r =  pixel[0];
582cabdff1aSopenharmony_ci    int g = (pixel[1] + 1) >> 1;
583cabdff1aSopenharmony_ci    int b =  pixel[2];
584cabdff1aSopenharmony_ci    int t = (2 + r + b) >> 2;
585cabdff1aSopenharmony_ci
586cabdff1aSopenharmony_ci    dst[0] = av_clip_uint8(128 + ((r - b + 1) >> 1));   /* Co */
587cabdff1aSopenharmony_ci    dst[1] = av_clip_uint8(128 + g - t);                /* Cg */
588cabdff1aSopenharmony_ci    dst[2] = 0;
589cabdff1aSopenharmony_ci    dst[3] = av_clip_uint8(g + t);                      /* Y */
590cabdff1aSopenharmony_ci}
591cabdff1aSopenharmony_ci
592cabdff1aSopenharmony_ci/**
593cabdff1aSopenharmony_ci * Compress one block of RGBA pixels in a DXT1 texture and store the
594cabdff1aSopenharmony_ci * resulting bytes in 'dst'. Alpha is not preserved.
595cabdff1aSopenharmony_ci *
596cabdff1aSopenharmony_ci * @param dst    output buffer.
597cabdff1aSopenharmony_ci * @param stride scanline in bytes.
598cabdff1aSopenharmony_ci * @param block  block to compress.
599cabdff1aSopenharmony_ci * @return how much texture data has been written.
600cabdff1aSopenharmony_ci */
601cabdff1aSopenharmony_cistatic int dxt1_block(uint8_t *dst, ptrdiff_t stride, const uint8_t *block)
602cabdff1aSopenharmony_ci{
603cabdff1aSopenharmony_ci    compress_color(dst, stride, block);
604cabdff1aSopenharmony_ci
605cabdff1aSopenharmony_ci    return 8;
606cabdff1aSopenharmony_ci}
607cabdff1aSopenharmony_ci
608cabdff1aSopenharmony_ci/**
609cabdff1aSopenharmony_ci * Compress one block of RGBA pixels in a DXT5 texture and store the
610cabdff1aSopenharmony_ci * resulting bytes in 'dst'. Alpha is preserved.
611cabdff1aSopenharmony_ci *
612cabdff1aSopenharmony_ci * @param dst    output buffer.
613cabdff1aSopenharmony_ci * @param stride scanline in bytes.
614cabdff1aSopenharmony_ci * @param block  block to compress.
615cabdff1aSopenharmony_ci * @return how much texture data has been written.
616cabdff1aSopenharmony_ci */
617cabdff1aSopenharmony_cistatic int dxt5_block(uint8_t *dst, ptrdiff_t stride, const uint8_t *block)
618cabdff1aSopenharmony_ci{
619cabdff1aSopenharmony_ci    compress_alpha(dst, stride, block);
620cabdff1aSopenharmony_ci    compress_color(dst + 8, stride, block);
621cabdff1aSopenharmony_ci
622cabdff1aSopenharmony_ci    return 16;
623cabdff1aSopenharmony_ci}
624cabdff1aSopenharmony_ci
625cabdff1aSopenharmony_ci/**
626cabdff1aSopenharmony_ci * Compress one block of RGBA pixels in a DXT5-YCoCg texture and store the
627cabdff1aSopenharmony_ci * resulting bytes in 'dst'. Alpha is not preserved.
628cabdff1aSopenharmony_ci *
629cabdff1aSopenharmony_ci * @param dst    output buffer.
630cabdff1aSopenharmony_ci * @param stride scanline in bytes.
631cabdff1aSopenharmony_ci * @param block  block to compress.
632cabdff1aSopenharmony_ci * @return how much texture data has been written.
633cabdff1aSopenharmony_ci */
634cabdff1aSopenharmony_cistatic int dxt5ys_block(uint8_t *dst, ptrdiff_t stride, const uint8_t *block)
635cabdff1aSopenharmony_ci{
636cabdff1aSopenharmony_ci    int x, y;
637cabdff1aSopenharmony_ci    uint8_t reorder[64];
638cabdff1aSopenharmony_ci
639cabdff1aSopenharmony_ci    /* Reorder the components and then run a normal DXT5 compression. */
640cabdff1aSopenharmony_ci    for (y = 0; y < 4; y++)
641cabdff1aSopenharmony_ci        for (x = 0; x < 4; x++)
642cabdff1aSopenharmony_ci            rgba2ycocg(reorder + x * 4 + y * 16, block + x * 4 + y * stride);
643cabdff1aSopenharmony_ci
644cabdff1aSopenharmony_ci    compress_alpha(dst + 0, 16, reorder);
645cabdff1aSopenharmony_ci    compress_color(dst + 8, 16, reorder);
646cabdff1aSopenharmony_ci
647cabdff1aSopenharmony_ci    return 16;
648cabdff1aSopenharmony_ci}
649cabdff1aSopenharmony_ci
650cabdff1aSopenharmony_ci/**
651cabdff1aSopenharmony_ci * Compress one block of RGBA pixels in a RGTC1U texture and store the
652cabdff1aSopenharmony_ci * resulting bytes in 'dst'. Use the alpha channel of the input image.
653cabdff1aSopenharmony_ci *
654cabdff1aSopenharmony_ci * @param dst    output buffer.
655cabdff1aSopenharmony_ci * @param stride scanline in bytes.
656cabdff1aSopenharmony_ci * @param block  block to compress.
657cabdff1aSopenharmony_ci * @return how much texture data has been written.
658cabdff1aSopenharmony_ci */
659cabdff1aSopenharmony_cistatic int rgtc1u_alpha_block(uint8_t *dst, ptrdiff_t stride, const uint8_t *block)
660cabdff1aSopenharmony_ci{
661cabdff1aSopenharmony_ci    compress_alpha(dst, stride, block);
662cabdff1aSopenharmony_ci
663cabdff1aSopenharmony_ci    return 8;
664cabdff1aSopenharmony_ci}
665cabdff1aSopenharmony_ci
666cabdff1aSopenharmony_ciav_cold void ff_texturedspenc_init(TextureDSPContext *c)
667cabdff1aSopenharmony_ci{
668cabdff1aSopenharmony_ci    c->dxt1_block         = dxt1_block;
669cabdff1aSopenharmony_ci    c->dxt5_block         = dxt5_block;
670cabdff1aSopenharmony_ci    c->dxt5ys_block       = dxt5ys_block;
671cabdff1aSopenharmony_ci    c->rgtc1u_alpha_block = rgtc1u_alpha_block;
672cabdff1aSopenharmony_ci}
673cabdff1aSopenharmony_ci
674cabdff1aSopenharmony_ci#define TEXTUREDSP_FUNC_NAME ff_texturedsp_compress_thread
675cabdff1aSopenharmony_ci#define TEXTUREDSP_TEX_FUNC(a, b, c) tex_funct(c, b, a)
676cabdff1aSopenharmony_ci#include "texturedsp_template.c"
677