]> git.sesse.net Git - ffmpeg/blob - libavfilter/vf_v360.c
avfilter/vf_v360: reverse order of remap for loops
[ffmpeg] / libavfilter / vf_v360.c
1 /*
2  * Copyright (c) 2019 Eugene Lyapustin
3  *
4  * This file is part of FFmpeg.
5  *
6  * FFmpeg is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2.1 of the License, or (at your option) any later version.
10  *
11  * FFmpeg is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with FFmpeg; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19  */
20
21 /**
22  * @file
23  * 360 video conversion filter.
24  * Principle of operation:
25  *
26  * (for each pixel in output frame)
27  * 1) Calculate OpenGL-like coordinates (x, y, z) for pixel position (i, j)
28  * 2) Apply 360 operations (rotation, mirror) to (x, y, z)
29  * 3) Calculate pixel position (u, v) in input frame
30  * 4) Calculate interpolation window and weight for each pixel
31  *
32  * (for each frame)
33  * 5) Remap input frame to output frame using precalculated data
34  */
35
36 #include <math.h>
37
38 #include "libavutil/avassert.h"
39 #include "libavutil/imgutils.h"
40 #include "libavutil/pixdesc.h"
41 #include "libavutil/opt.h"
42 #include "avfilter.h"
43 #include "formats.h"
44 #include "internal.h"
45 #include "video.h"
46 #include "v360.h"
47
48 typedef struct ThreadData {
49     AVFrame *in;
50     AVFrame *out;
51 } ThreadData;
52
53 #define OFFSET(x) offsetof(V360Context, x)
54 #define FLAGS AV_OPT_FLAG_FILTERING_PARAM|AV_OPT_FLAG_VIDEO_PARAM
55
56 static const AVOption v360_options[] = {
57     {     "input", "set input projection",              OFFSET(in), AV_OPT_TYPE_INT,    {.i64=EQUIRECTANGULAR}, 0,    NB_PROJECTIONS-1, FLAGS, "in" },
58     {         "e", "equirectangular",                            0, AV_OPT_TYPE_CONST,  {.i64=EQUIRECTANGULAR}, 0,                   0, FLAGS, "in" },
59     {  "equirect", "equirectangular",                            0, AV_OPT_TYPE_CONST,  {.i64=EQUIRECTANGULAR}, 0,                   0, FLAGS, "in" },
60     {      "c3x2", "cubemap 3x2",                                0, AV_OPT_TYPE_CONST,  {.i64=CUBEMAP_3_2},     0,                   0, FLAGS, "in" },
61     {      "c6x1", "cubemap 6x1",                                0, AV_OPT_TYPE_CONST,  {.i64=CUBEMAP_6_1},     0,                   0, FLAGS, "in" },
62     {       "eac", "equi-angular cubemap",                       0, AV_OPT_TYPE_CONST,  {.i64=EQUIANGULAR},     0,                   0, FLAGS, "in" },
63     {  "dfisheye", "dual fisheye",                               0, AV_OPT_TYPE_CONST,  {.i64=DUAL_FISHEYE},    0,                   0, FLAGS, "in" },
64     {    "barrel", "barrel facebook's 360 format",               0, AV_OPT_TYPE_CONST,  {.i64=BARREL},          0,                   0, FLAGS, "in" },
65     {        "fb", "barrel facebook's 360 format",               0, AV_OPT_TYPE_CONST,  {.i64=BARREL},          0,                   0, FLAGS, "in" },
66     {      "c1x6", "cubemap 1x6",                                0, AV_OPT_TYPE_CONST,  {.i64=CUBEMAP_1_6},     0,                   0, FLAGS, "in" },
67     {        "sg", "stereographic",                              0, AV_OPT_TYPE_CONST,  {.i64=STEREOGRAPHIC},   0,                   0, FLAGS, "in" },
68     {    "output", "set output projection",            OFFSET(out), AV_OPT_TYPE_INT,    {.i64=CUBEMAP_3_2},     0,    NB_PROJECTIONS-1, FLAGS, "out" },
69     {         "e", "equirectangular",                            0, AV_OPT_TYPE_CONST,  {.i64=EQUIRECTANGULAR}, 0,                   0, FLAGS, "out" },
70     {  "equirect", "equirectangular",                            0, AV_OPT_TYPE_CONST,  {.i64=EQUIRECTANGULAR}, 0,                   0, FLAGS, "out" },
71     {      "c3x2", "cubemap 3x2",                                0, AV_OPT_TYPE_CONST,  {.i64=CUBEMAP_3_2},     0,                   0, FLAGS, "out" },
72     {      "c6x1", "cubemap 6x1",                                0, AV_OPT_TYPE_CONST,  {.i64=CUBEMAP_6_1},     0,                   0, FLAGS, "out" },
73     {       "eac", "equi-angular cubemap",                       0, AV_OPT_TYPE_CONST,  {.i64=EQUIANGULAR},     0,                   0, FLAGS, "out" },
74     {  "dfisheye", "dual fisheye",                               0, AV_OPT_TYPE_CONST,  {.i64=DUAL_FISHEYE},    0,                   0, FLAGS, "out" },
75     {      "flat", "regular video",                              0, AV_OPT_TYPE_CONST,  {.i64=FLAT},            0,                   0, FLAGS, "out" },
76     {"rectilinear", "regular video",                             0, AV_OPT_TYPE_CONST,  {.i64=FLAT},            0,                   0, FLAGS, "out" },
77     {  "gnomonic", "regular video",                              0, AV_OPT_TYPE_CONST,  {.i64=FLAT},            0,                   0, FLAGS, "out" },
78     {    "barrel", "barrel facebook's 360 format",               0, AV_OPT_TYPE_CONST,  {.i64=BARREL},          0,                   0, FLAGS, "out" },
79     {        "fb", "barrel facebook's 360 format",               0, AV_OPT_TYPE_CONST,  {.i64=BARREL},          0,                   0, FLAGS, "out" },
80     {      "c1x6", "cubemap 1x6",                                0, AV_OPT_TYPE_CONST,  {.i64=CUBEMAP_1_6},     0,                   0, FLAGS, "out" },
81     {        "sg", "stereographic",                              0, AV_OPT_TYPE_CONST,  {.i64=STEREOGRAPHIC},   0,                   0, FLAGS, "out" },
82     {    "interp", "set interpolation method",      OFFSET(interp), AV_OPT_TYPE_INT,    {.i64=BILINEAR},        0, NB_INTERP_METHODS-1, FLAGS, "interp" },
83     {      "near", "nearest neighbour",                          0, AV_OPT_TYPE_CONST,  {.i64=NEAREST},         0,                   0, FLAGS, "interp" },
84     {   "nearest", "nearest neighbour",                          0, AV_OPT_TYPE_CONST,  {.i64=NEAREST},         0,                   0, FLAGS, "interp" },
85     {      "line", "bilinear interpolation",                     0, AV_OPT_TYPE_CONST,  {.i64=BILINEAR},        0,                   0, FLAGS, "interp" },
86     {    "linear", "bilinear interpolation",                     0, AV_OPT_TYPE_CONST,  {.i64=BILINEAR},        0,                   0, FLAGS, "interp" },
87     {      "cube", "bicubic interpolation",                      0, AV_OPT_TYPE_CONST,  {.i64=BICUBIC},         0,                   0, FLAGS, "interp" },
88     {     "cubic", "bicubic interpolation",                      0, AV_OPT_TYPE_CONST,  {.i64=BICUBIC},         0,                   0, FLAGS, "interp" },
89     {      "lanc", "lanczos interpolation",                      0, AV_OPT_TYPE_CONST,  {.i64=LANCZOS},         0,                   0, FLAGS, "interp" },
90     {   "lanczos", "lanczos interpolation",                      0, AV_OPT_TYPE_CONST,  {.i64=LANCZOS},         0,                   0, FLAGS, "interp" },
91     {         "w", "output width",                   OFFSET(width), AV_OPT_TYPE_INT,    {.i64=0},               0,           INT16_MAX, FLAGS, "w"},
92     {         "h", "output height",                 OFFSET(height), AV_OPT_TYPE_INT,    {.i64=0},               0,           INT16_MAX, FLAGS, "h"},
93     { "in_stereo", "input stereo format",        OFFSET(in_stereo), AV_OPT_TYPE_INT,    {.i64=STEREO_2D},       0,    NB_STEREO_FMTS-1, FLAGS, "stereo" },
94     {"out_stereo", "output stereo format",      OFFSET(out_stereo), AV_OPT_TYPE_INT,    {.i64=STEREO_2D},       0,    NB_STEREO_FMTS-1, FLAGS, "stereo" },
95     {        "2d", "2d mono",                                    0, AV_OPT_TYPE_CONST,  {.i64=STEREO_2D},       0,                   0, FLAGS, "stereo" },
96     {       "sbs", "side by side",                               0, AV_OPT_TYPE_CONST,  {.i64=STEREO_SBS},      0,                   0, FLAGS, "stereo" },
97     {        "tb", "top bottom",                                 0, AV_OPT_TYPE_CONST,  {.i64=STEREO_TB},       0,                   0, FLAGS, "stereo" },
98     { "in_forder", "input cubemap face order",   OFFSET(in_forder), AV_OPT_TYPE_STRING, {.str="rludfb"},        0,     NB_DIRECTIONS-1, FLAGS, "in_forder"},
99     {"out_forder", "output cubemap face order", OFFSET(out_forder), AV_OPT_TYPE_STRING, {.str="rludfb"},        0,     NB_DIRECTIONS-1, FLAGS, "out_forder"},
100     {   "in_frot", "input cubemap face rotation",  OFFSET(in_frot), AV_OPT_TYPE_STRING, {.str="000000"},        0,     NB_DIRECTIONS-1, FLAGS, "in_frot"},
101     {  "out_frot", "output cubemap face rotation",OFFSET(out_frot), AV_OPT_TYPE_STRING, {.str="000000"},        0,     NB_DIRECTIONS-1, FLAGS, "out_frot"},
102     {    "in_pad", "input cubemap pads",            OFFSET(in_pad), AV_OPT_TYPE_FLOAT,  {.dbl=0.f},           0.f,                 1.f, FLAGS, "in_pad"},
103     {   "out_pad", "output cubemap pads",          OFFSET(out_pad), AV_OPT_TYPE_FLOAT,  {.dbl=0.f},           0.f,                 1.f, FLAGS, "out_pad"},
104     {       "yaw", "yaw rotation",                     OFFSET(yaw), AV_OPT_TYPE_FLOAT,  {.dbl=0.f},        -180.f,               180.f, FLAGS, "yaw"},
105     {     "pitch", "pitch rotation",                 OFFSET(pitch), AV_OPT_TYPE_FLOAT,  {.dbl=0.f},        -180.f,               180.f, FLAGS, "pitch"},
106     {      "roll", "roll rotation",                   OFFSET(roll), AV_OPT_TYPE_FLOAT,  {.dbl=0.f},        -180.f,               180.f, FLAGS, "roll"},
107     {    "rorder", "rotation order",                OFFSET(rorder), AV_OPT_TYPE_STRING, {.str="ypr"},           0,                   0, FLAGS, "rorder"},
108     {     "h_fov", "horizontal field of view",       OFFSET(h_fov), AV_OPT_TYPE_FLOAT,  {.dbl=90.f},     0.00001f,               360.f, FLAGS, "h_fov"},
109     {     "v_fov", "vertical field of view",         OFFSET(v_fov), AV_OPT_TYPE_FLOAT,  {.dbl=45.f},     0.00001f,               360.f, FLAGS, "v_fov"},
110     {     "d_fov", "diagonal field of view",         OFFSET(d_fov), AV_OPT_TYPE_FLOAT,  {.dbl=0.f},           0.f,               360.f, FLAGS, "d_fov"},
111     {    "h_flip", "flip out video horizontally",   OFFSET(h_flip), AV_OPT_TYPE_BOOL,   {.i64=0},               0,                   1, FLAGS, "h_flip"},
112     {    "v_flip", "flip out video vertically",     OFFSET(v_flip), AV_OPT_TYPE_BOOL,   {.i64=0},               0,                   1, FLAGS, "v_flip"},
113     {    "d_flip", "flip out video indepth",        OFFSET(d_flip), AV_OPT_TYPE_BOOL,   {.i64=0},               0,                   1, FLAGS, "d_flip"},
114     {   "ih_flip", "flip in video horizontally",   OFFSET(ih_flip), AV_OPT_TYPE_BOOL,   {.i64=0},               0,                   1, FLAGS, "ih_flip"},
115     {   "iv_flip", "flip in video vertically",     OFFSET(iv_flip), AV_OPT_TYPE_BOOL,   {.i64=0},               0,                   1, FLAGS, "iv_flip"},
116     {  "in_trans", "transpose video input",   OFFSET(in_transpose), AV_OPT_TYPE_BOOL,   {.i64=0},               0,                   1, FLAGS, "in_transpose"},
117     { "out_trans", "transpose video output", OFFSET(out_transpose), AV_OPT_TYPE_BOOL,   {.i64=0},               0,                   1, FLAGS, "out_transpose"},
118     { NULL }
119 };
120
121 AVFILTER_DEFINE_CLASS(v360);
122
123 static int query_formats(AVFilterContext *ctx)
124 {
125     static const enum AVPixelFormat pix_fmts[] = {
126         // YUVA444
127         AV_PIX_FMT_YUVA444P,   AV_PIX_FMT_YUVA444P9,
128         AV_PIX_FMT_YUVA444P10, AV_PIX_FMT_YUVA444P12,
129         AV_PIX_FMT_YUVA444P16,
130
131         // YUVA422
132         AV_PIX_FMT_YUVA422P,   AV_PIX_FMT_YUVA422P9,
133         AV_PIX_FMT_YUVA422P10, AV_PIX_FMT_YUVA422P12,
134         AV_PIX_FMT_YUVA422P16,
135
136         // YUVA420
137         AV_PIX_FMT_YUVA420P,   AV_PIX_FMT_YUVA420P9,
138         AV_PIX_FMT_YUVA420P10, AV_PIX_FMT_YUVA420P16,
139
140         // YUVJ
141         AV_PIX_FMT_YUVJ444P, AV_PIX_FMT_YUVJ440P,
142         AV_PIX_FMT_YUVJ422P, AV_PIX_FMT_YUVJ420P,
143         AV_PIX_FMT_YUVJ411P,
144
145         // YUV444
146         AV_PIX_FMT_YUV444P,   AV_PIX_FMT_YUV444P9,
147         AV_PIX_FMT_YUV444P10, AV_PIX_FMT_YUV444P12,
148         AV_PIX_FMT_YUV444P14, AV_PIX_FMT_YUV444P16,
149
150         // YUV440
151         AV_PIX_FMT_YUV440P, AV_PIX_FMT_YUV440P10,
152         AV_PIX_FMT_YUV440P12,
153
154         // YUV422
155         AV_PIX_FMT_YUV422P,   AV_PIX_FMT_YUV422P9,
156         AV_PIX_FMT_YUV422P10, AV_PIX_FMT_YUV422P12,
157         AV_PIX_FMT_YUV422P14, AV_PIX_FMT_YUV422P16,
158
159         // YUV420
160         AV_PIX_FMT_YUV420P,   AV_PIX_FMT_YUV420P9,
161         AV_PIX_FMT_YUV420P10, AV_PIX_FMT_YUV420P12,
162         AV_PIX_FMT_YUV420P14, AV_PIX_FMT_YUV420P16,
163
164         // YUV411
165         AV_PIX_FMT_YUV411P,
166
167         // YUV410
168         AV_PIX_FMT_YUV410P,
169
170         // GBR
171         AV_PIX_FMT_GBRP,   AV_PIX_FMT_GBRP9,
172         AV_PIX_FMT_GBRP10, AV_PIX_FMT_GBRP12,
173         AV_PIX_FMT_GBRP14, AV_PIX_FMT_GBRP16,
174
175         // GBRA
176         AV_PIX_FMT_GBRAP,   AV_PIX_FMT_GBRAP10,
177         AV_PIX_FMT_GBRAP12, AV_PIX_FMT_GBRAP16,
178
179         // GRAY
180         AV_PIX_FMT_GRAY8,  AV_PIX_FMT_GRAY9,
181         AV_PIX_FMT_GRAY10, AV_PIX_FMT_GRAY12,
182         AV_PIX_FMT_GRAY14, AV_PIX_FMT_GRAY16,
183
184         AV_PIX_FMT_NONE
185     };
186
187     AVFilterFormats *fmts_list = ff_make_format_list(pix_fmts);
188     if (!fmts_list)
189         return AVERROR(ENOMEM);
190     return ff_set_common_formats(ctx, fmts_list);
191 }
192
193 #define DEFINE_REMAP1_LINE(bits, div)                                                           \
194 static void remap1_##bits##bit_line_c(uint8_t *dst, int width, const uint8_t *src,              \
195                                       ptrdiff_t in_linesize,                                    \
196                                       const uint16_t *u, const uint16_t *v, const int16_t *ker) \
197 {                                                                                               \
198     const uint##bits##_t *s = (const uint##bits##_t *)src;                                      \
199     uint##bits##_t *d = (uint##bits##_t *)dst;                                                  \
200                                                                                                 \
201     in_linesize /= div;                                                                         \
202                                                                                                 \
203     for (int x = 0; x < width; x++)                                                             \
204         d[x] = s[v[x] * in_linesize + u[x]];                                                    \
205 }
206
207 DEFINE_REMAP1_LINE( 8, 1)
208 DEFINE_REMAP1_LINE(16, 2)
209
210 typedef struct XYRemap {
211     uint16_t u[4][4];
212     uint16_t v[4][4];
213     float ker[4][4];
214 } XYRemap;
215
216 /**
217  * Generate remapping function with a given window size and pixel depth.
218  *
219  * @param ws size of interpolation window
220  * @param bits number of bits per pixel
221  */
222 #define DEFINE_REMAP(ws, bits)                                                                             \
223 static int remap##ws##_##bits##bit_slice(AVFilterContext *ctx, void *arg, int jobnr, int nb_jobs)          \
224 {                                                                                                          \
225     ThreadData *td = (ThreadData*)arg;                                                                     \
226     const V360Context *s = ctx->priv;                                                                      \
227     const AVFrame *in = td->in;                                                                            \
228     AVFrame *out = td->out;                                                                                \
229                                                                                                            \
230     for (int stereo = 0; stereo < 1 + s->out_stereo > STEREO_2D; stereo++) {                               \
231         for (int plane = 0; plane < s->nb_planes; plane++) {                                               \
232             const int in_linesize  = in->linesize[plane];                                                  \
233             const int out_linesize = out->linesize[plane];                                                 \
234             const int uv_linesize = s->uv_linesize[plane];                                                 \
235             const int in_offset_w = stereo ? s->in_offset_w[plane] : 0;                                    \
236             const int in_offset_h = stereo ? s->in_offset_h[plane] : 0;                                    \
237             const int out_offset_w = stereo ? s->out_offset_w[plane] : 0;                                  \
238             const int out_offset_h = stereo ? s->out_offset_h[plane] : 0;                                  \
239             const uint8_t *src = in->data[plane] + in_offset_h * in_linesize + in_offset_w * (bits >> 3);  \
240             uint8_t *dst = out->data[plane] + out_offset_h * out_linesize + out_offset_w * (bits >> 3);    \
241             const int width = s->pr_width[plane];                                                          \
242             const int height = s->pr_height[plane];                                                        \
243                                                                                                            \
244             const int slice_start = (height *  jobnr     ) / nb_jobs;                                      \
245             const int slice_end   = (height * (jobnr + 1)) / nb_jobs;                                      \
246                                                                                                            \
247             for (int y = slice_start; y < slice_end; y++) {                                                \
248                 const unsigned map = s->map[plane];                                                        \
249                 const uint16_t *u = s->u[map] + y * uv_linesize * ws * ws;                                 \
250                 const uint16_t *v = s->v[map] + y * uv_linesize * ws * ws;                                 \
251                 const int16_t *ker = s->ker[map] + y * uv_linesize * ws * ws;                              \
252                                                                                                            \
253                 s->remap_line(dst + y * out_linesize, width, src, in_linesize, u, v, ker);                 \
254             }                                                                                              \
255         }                                                                                                  \
256     }                                                                                                      \
257                                                                                                            \
258     return 0;                                                                                              \
259 }
260
261 DEFINE_REMAP(1,  8)
262 DEFINE_REMAP(2,  8)
263 DEFINE_REMAP(4,  8)
264 DEFINE_REMAP(1, 16)
265 DEFINE_REMAP(2, 16)
266 DEFINE_REMAP(4, 16)
267
268 #define DEFINE_REMAP_LINE(ws, bits, div)                                                                   \
269 static void remap##ws##_##bits##bit_line_c(uint8_t *dst, int width, const uint8_t *src,                    \
270                                            ptrdiff_t in_linesize,                                          \
271                                            const uint16_t *u, const uint16_t *v, const int16_t *ker)       \
272 {                                                                                                          \
273     const uint##bits##_t *s = (const uint##bits##_t *)src;                                                 \
274     uint##bits##_t *d = (uint##bits##_t *)dst;                                                             \
275                                                                                                            \
276     in_linesize /= div;                                                                                    \
277                                                                                                            \
278     for (int x = 0; x < width; x++) {                                                                      \
279         const uint16_t *uu = u + x * ws * ws;                                                              \
280         const uint16_t *vv = v + x * ws * ws;                                                              \
281         const int16_t *kker = ker + x * ws * ws;                                                           \
282         int tmp = 0;                                                                                       \
283                                                                                                            \
284         for (int i = 0; i < ws; i++) {                                                                     \
285             for (int j = 0; j < ws; j++) {                                                                 \
286                 tmp += kker[i * ws + j] * s[vv[i * ws + j] * in_linesize + uu[i * ws + j]];                \
287             }                                                                                              \
288         }                                                                                                  \
289                                                                                                            \
290         d[x] = av_clip_uint##bits(tmp >> 14);                                                              \
291     }                                                                                                      \
292 }
293
294 DEFINE_REMAP_LINE(2,  8, 1)
295 DEFINE_REMAP_LINE(4,  8, 1)
296 DEFINE_REMAP_LINE(2, 16, 2)
297 DEFINE_REMAP_LINE(4, 16, 2)
298
299 void ff_v360_init(V360Context *s, int depth)
300 {
301     switch (s->interp) {
302     case NEAREST:
303         s->remap_line = depth <= 8 ? remap1_8bit_line_c : remap1_16bit_line_c;
304         break;
305     case BILINEAR:
306         s->remap_line = depth <= 8 ? remap2_8bit_line_c : remap2_16bit_line_c;
307         break;
308     case BICUBIC:
309     case LANCZOS:
310         s->remap_line = depth <= 8 ? remap4_8bit_line_c : remap4_16bit_line_c;
311         break;
312     }
313
314     if (ARCH_X86)
315         ff_v360_init_x86(s, depth);
316 }
317
318 /**
319  * Save nearest pixel coordinates for remapping.
320  *
321  * @param du horizontal relative coordinate
322  * @param dv vertical relative coordinate
323  * @param rmap calculated 4x4 window
324  * @param u u remap data
325  * @param v v remap data
326  * @param ker ker remap data
327  */
328 static void nearest_kernel(float du, float dv, const XYRemap *rmap,
329                            uint16_t *u, uint16_t *v, int16_t *ker)
330 {
331     const int i = roundf(dv) + 1;
332     const int j = roundf(du) + 1;
333
334     u[0] = rmap->u[i][j];
335     v[0] = rmap->v[i][j];
336 }
337
338 /**
339  * Calculate kernel for bilinear interpolation.
340  *
341  * @param du horizontal relative coordinate
342  * @param dv vertical relative coordinate
343  * @param rmap calculated 4x4 window
344  * @param u u remap data
345  * @param v v remap data
346  * @param ker ker remap data
347  */
348 static void bilinear_kernel(float du, float dv, const XYRemap *rmap,
349                             uint16_t *u, uint16_t *v, int16_t *ker)
350 {
351     for (int i = 0; i < 2; i++) {
352         for (int j = 0; j < 2; j++) {
353             u[i * 2 + j] = rmap->u[i + 1][j + 1];
354             v[i * 2 + j] = rmap->v[i + 1][j + 1];
355         }
356     }
357
358     ker[0] = (1.f - du) * (1.f - dv) * 16384;
359     ker[1] =        du  * (1.f - dv) * 16384;
360     ker[2] = (1.f - du) *        dv  * 16384;
361     ker[3] =        du  *        dv  * 16384;
362 }
363
364 /**
365  * Calculate 1-dimensional cubic coefficients.
366  *
367  * @param t relative coordinate
368  * @param coeffs coefficients
369  */
370 static inline void calculate_bicubic_coeffs(float t, float *coeffs)
371 {
372     const float tt  = t * t;
373     const float ttt = t * t * t;
374
375     coeffs[0] =     - t / 3.f + tt / 2.f - ttt / 6.f;
376     coeffs[1] = 1.f - t / 2.f - tt       + ttt / 2.f;
377     coeffs[2] =       t       + tt / 2.f - ttt / 2.f;
378     coeffs[3] =     - t / 6.f            + ttt / 6.f;
379 }
380
381 /**
382  * Calculate kernel for bicubic interpolation.
383  *
384  * @param du horizontal relative coordinate
385  * @param dv vertical relative coordinate
386  * @param rmap calculated 4x4 window
387  * @param u u remap data
388  * @param v v remap data
389  * @param ker ker remap data
390  */
391 static void bicubic_kernel(float du, float dv, const XYRemap *rmap,
392                            uint16_t *u, uint16_t *v, int16_t *ker)
393 {
394     float du_coeffs[4];
395     float dv_coeffs[4];
396
397     calculate_bicubic_coeffs(du, du_coeffs);
398     calculate_bicubic_coeffs(dv, dv_coeffs);
399
400     for (int i = 0; i < 4; i++) {
401         for (int j = 0; j < 4; j++) {
402             u[i * 4 + j] = rmap->u[i][j];
403             v[i * 4 + j] = rmap->v[i][j];
404             ker[i * 4 + j] = du_coeffs[j] * dv_coeffs[i] * 16384;
405         }
406     }
407 }
408
409 /**
410  * Calculate 1-dimensional lanczos coefficients.
411  *
412  * @param t relative coordinate
413  * @param coeffs coefficients
414  */
415 static inline void calculate_lanczos_coeffs(float t, float *coeffs)
416 {
417     float sum = 0.f;
418
419     for (int i = 0; i < 4; i++) {
420         const float x = M_PI * (t - i + 1);
421         if (x == 0.f) {
422             coeffs[i] = 1.f;
423         } else {
424             coeffs[i] = sinf(x) * sinf(x / 2.f) / (x * x / 2.f);
425         }
426         sum += coeffs[i];
427     }
428
429     for (int i = 0; i < 4; i++) {
430         coeffs[i] /= sum;
431     }
432 }
433
434 /**
435  * Calculate kernel for lanczos interpolation.
436  *
437  * @param du horizontal relative coordinate
438  * @param dv vertical relative coordinate
439  * @param rmap calculated 4x4 window
440  * @param u u remap data
441  * @param v v remap data
442  * @param ker ker remap data
443  */
444 static void lanczos_kernel(float du, float dv, const XYRemap *rmap,
445                            uint16_t *u, uint16_t *v, int16_t *ker)
446 {
447     float du_coeffs[4];
448     float dv_coeffs[4];
449
450     calculate_lanczos_coeffs(du, du_coeffs);
451     calculate_lanczos_coeffs(dv, dv_coeffs);
452
453     for (int i = 0; i < 4; i++) {
454         for (int j = 0; j < 4; j++) {
455             u[i * 4 + j] = rmap->u[i][j];
456             v[i * 4 + j] = rmap->v[i][j];
457             ker[i * 4 + j] = du_coeffs[j] * dv_coeffs[i] * 16384;
458         }
459     }
460 }
461
462 /**
463  * Modulo operation with only positive remainders.
464  *
465  * @param a dividend
466  * @param b divisor
467  *
468  * @return positive remainder of (a / b)
469  */
470 static inline int mod(int a, int b)
471 {
472     const int res = a % b;
473     if (res < 0) {
474         return res + b;
475     } else {
476         return res;
477     }
478 }
479
480 /**
481  * Convert char to corresponding direction.
482  * Used for cubemap options.
483  */
484 static int get_direction(char c)
485 {
486     switch (c) {
487     case 'r':
488         return RIGHT;
489     case 'l':
490         return LEFT;
491     case 'u':
492         return UP;
493     case 'd':
494         return DOWN;
495     case 'f':
496         return FRONT;
497     case 'b':
498         return BACK;
499     default:
500         return -1;
501     }
502 }
503
504 /**
505  * Convert char to corresponding rotation angle.
506  * Used for cubemap options.
507  */
508 static int get_rotation(char c)
509 {
510     switch (c) {
511     case '0':
512         return ROT_0;
513     case '1':
514         return ROT_90;
515     case '2':
516         return ROT_180;
517     case '3':
518         return ROT_270;
519     default:
520         return -1;
521     }
522 }
523
524 /**
525  * Convert char to corresponding rotation order.
526  */
527 static int get_rorder(char c)
528 {
529     switch (c) {
530     case 'Y':
531     case 'y':
532         return YAW;
533     case 'P':
534     case 'p':
535         return PITCH;
536     case 'R':
537     case 'r':
538         return ROLL;
539     default:
540         return -1;
541     }
542 }
543
544 /**
545  * Prepare data for processing cubemap input format.
546  *
547  * @param ctx filter context
548  *
549  * @return error code
550  */
551 static int prepare_cube_in(AVFilterContext *ctx)
552 {
553     V360Context *s = ctx->priv;
554
555     for (int face = 0; face < NB_FACES; face++) {
556         const char c = s->in_forder[face];
557         int direction;
558
559         if (c == '\0') {
560             av_log(ctx, AV_LOG_ERROR,
561                    "Incomplete in_forder option. Direction for all 6 faces should be specified.\n");
562             return AVERROR(EINVAL);
563         }
564
565         direction = get_direction(c);
566         if (direction == -1) {
567             av_log(ctx, AV_LOG_ERROR,
568                    "Incorrect direction symbol '%c' in in_forder option.\n", c);
569             return AVERROR(EINVAL);
570         }
571
572         s->in_cubemap_face_order[direction] = face;
573     }
574
575     for (int face = 0; face < NB_FACES; face++) {
576         const char c = s->in_frot[face];
577         int rotation;
578
579         if (c == '\0') {
580             av_log(ctx, AV_LOG_ERROR,
581                    "Incomplete in_frot option. Rotation for all 6 faces should be specified.\n");
582             return AVERROR(EINVAL);
583         }
584
585         rotation = get_rotation(c);
586         if (rotation == -1) {
587             av_log(ctx, AV_LOG_ERROR,
588                    "Incorrect rotation symbol '%c' in in_frot option.\n", c);
589             return AVERROR(EINVAL);
590         }
591
592         s->in_cubemap_face_rotation[face] = rotation;
593     }
594
595     return 0;
596 }
597
598 /**
599  * Prepare data for processing cubemap output format.
600  *
601  * @param ctx filter context
602  *
603  * @return error code
604  */
605 static int prepare_cube_out(AVFilterContext *ctx)
606 {
607     V360Context *s = ctx->priv;
608
609     for (int face = 0; face < NB_FACES; face++) {
610         const char c = s->out_forder[face];
611         int direction;
612
613         if (c == '\0') {
614             av_log(ctx, AV_LOG_ERROR,
615                    "Incomplete out_forder option. Direction for all 6 faces should be specified.\n");
616             return AVERROR(EINVAL);
617         }
618
619         direction = get_direction(c);
620         if (direction == -1) {
621             av_log(ctx, AV_LOG_ERROR,
622                    "Incorrect direction symbol '%c' in out_forder option.\n", c);
623             return AVERROR(EINVAL);
624         }
625
626         s->out_cubemap_direction_order[face] = direction;
627     }
628
629     for (int face = 0; face < NB_FACES; face++) {
630         const char c = s->out_frot[face];
631         int rotation;
632
633         if (c == '\0') {
634             av_log(ctx, AV_LOG_ERROR,
635                    "Incomplete out_frot option. Rotation for all 6 faces should be specified.\n");
636             return AVERROR(EINVAL);
637         }
638
639         rotation = get_rotation(c);
640         if (rotation == -1) {
641             av_log(ctx, AV_LOG_ERROR,
642                    "Incorrect rotation symbol '%c' in out_frot option.\n", c);
643             return AVERROR(EINVAL);
644         }
645
646         s->out_cubemap_face_rotation[face] = rotation;
647     }
648
649     return 0;
650 }
651
652 static inline void rotate_cube_face(float *uf, float *vf, int rotation)
653 {
654     float tmp;
655
656     switch (rotation) {
657     case ROT_0:
658         break;
659     case ROT_90:
660         tmp =  *uf;
661         *uf = -*vf;
662         *vf =  tmp;
663         break;
664     case ROT_180:
665         *uf = -*uf;
666         *vf = -*vf;
667         break;
668     case ROT_270:
669         tmp = -*uf;
670         *uf =  *vf;
671         *vf =  tmp;
672         break;
673     default:
674         av_assert0(0);
675     }
676 }
677
678 static inline void rotate_cube_face_inverse(float *uf, float *vf, int rotation)
679 {
680     float tmp;
681
682     switch (rotation) {
683     case ROT_0:
684         break;
685     case ROT_90:
686         tmp = -*uf;
687         *uf =  *vf;
688         *vf =  tmp;
689         break;
690     case ROT_180:
691         *uf = -*uf;
692         *vf = -*vf;
693         break;
694     case ROT_270:
695         tmp =  *uf;
696         *uf = -*vf;
697         *vf =  tmp;
698         break;
699     default:
700         av_assert0(0);
701     }
702 }
703
704 /**
705  * Normalize vector.
706  *
707  * @param vec vector
708  */
709 static void normalize_vector(float *vec)
710 {
711     const float norm = sqrtf(vec[0] * vec[0] + vec[1] * vec[1] + vec[2] * vec[2]);
712
713     vec[0] /= norm;
714     vec[1] /= norm;
715     vec[2] /= norm;
716 }
717
718 /**
719  * Calculate 3D coordinates on sphere for corresponding cubemap position.
720  * Common operation for every cubemap.
721  *
722  * @param s filter context
723  * @param uf horizontal cubemap coordinate [0, 1)
724  * @param vf vertical cubemap coordinate [0, 1)
725  * @param face face of cubemap
726  * @param vec coordinates on sphere
727  */
728 static void cube_to_xyz(const V360Context *s,
729                         float uf, float vf, int face,
730                         float *vec)
731 {
732     const int direction = s->out_cubemap_direction_order[face];
733     float l_x, l_y, l_z;
734
735     uf /= (1.f - s->out_pad);
736     vf /= (1.f - s->out_pad);
737
738     rotate_cube_face_inverse(&uf, &vf, s->out_cubemap_face_rotation[face]);
739
740     switch (direction) {
741     case RIGHT:
742         l_x =  1.f;
743         l_y = -vf;
744         l_z =  uf;
745         break;
746     case LEFT:
747         l_x = -1.f;
748         l_y = -vf;
749         l_z = -uf;
750         break;
751     case UP:
752         l_x =  uf;
753         l_y =  1.f;
754         l_z = -vf;
755         break;
756     case DOWN:
757         l_x =  uf;
758         l_y = -1.f;
759         l_z =  vf;
760         break;
761     case FRONT:
762         l_x =  uf;
763         l_y = -vf;
764         l_z = -1.f;
765         break;
766     case BACK:
767         l_x = -uf;
768         l_y = -vf;
769         l_z =  1.f;
770         break;
771     default:
772         av_assert0(0);
773     }
774
775     vec[0] = l_x;
776     vec[1] = l_y;
777     vec[2] = l_z;
778
779     normalize_vector(vec);
780 }
781
782 /**
783  * Calculate cubemap position for corresponding 3D coordinates on sphere.
784  * Common operation for every cubemap.
785  *
786  * @param s filter context
787  * @param vec coordinated on sphere
788  * @param uf horizontal cubemap coordinate [0, 1)
789  * @param vf vertical cubemap coordinate [0, 1)
790  * @param direction direction of view
791  */
792 static void xyz_to_cube(const V360Context *s,
793                         const float *vec,
794                         float *uf, float *vf, int *direction)
795 {
796     const float phi   = atan2f(vec[0], -vec[2]);
797     const float theta = asinf(-vec[1]);
798     float phi_norm, theta_threshold;
799     int face;
800
801     if (phi >= -M_PI_4 && phi < M_PI_4) {
802         *direction = FRONT;
803         phi_norm = phi;
804     } else if (phi >= -(M_PI_2 + M_PI_4) && phi < -M_PI_4) {
805         *direction = LEFT;
806         phi_norm = phi + M_PI_2;
807     } else if (phi >= M_PI_4 && phi < M_PI_2 + M_PI_4) {
808         *direction = RIGHT;
809         phi_norm = phi - M_PI_2;
810     } else {
811         *direction = BACK;
812         phi_norm = phi + ((phi > 0.f) ? -M_PI : M_PI);
813     }
814
815     theta_threshold = atanf(cosf(phi_norm));
816     if (theta > theta_threshold) {
817         *direction = DOWN;
818     } else if (theta < -theta_threshold) {
819         *direction = UP;
820     }
821
822     switch (*direction) {
823     case RIGHT:
824         *uf =  vec[2] / vec[0];
825         *vf = -vec[1] / vec[0];
826         break;
827     case LEFT:
828         *uf =  vec[2] / vec[0];
829         *vf =  vec[1] / vec[0];
830         break;
831     case UP:
832         *uf =  vec[0] / vec[1];
833         *vf = -vec[2] / vec[1];
834         break;
835     case DOWN:
836         *uf = -vec[0] / vec[1];
837         *vf = -vec[2] / vec[1];
838         break;
839     case FRONT:
840         *uf = -vec[0] / vec[2];
841         *vf =  vec[1] / vec[2];
842         break;
843     case BACK:
844         *uf = -vec[0] / vec[2];
845         *vf = -vec[1] / vec[2];
846         break;
847     default:
848         av_assert0(0);
849     }
850
851     face = s->in_cubemap_face_order[*direction];
852     rotate_cube_face(uf, vf, s->in_cubemap_face_rotation[face]);
853
854     (*uf) *= s->input_mirror_modifier[0];
855     (*vf) *= s->input_mirror_modifier[1];
856 }
857
858 /**
859  * Find position on another cube face in case of overflow/underflow.
860  * Used for calculation of interpolation window.
861  *
862  * @param s filter context
863  * @param uf horizontal cubemap coordinate
864  * @param vf vertical cubemap coordinate
865  * @param direction direction of view
866  * @param new_uf new horizontal cubemap coordinate
867  * @param new_vf new vertical cubemap coordinate
868  * @param face face position on cubemap
869  */
870 static void process_cube_coordinates(const V360Context *s,
871                                      float uf, float vf, int direction,
872                                      float *new_uf, float *new_vf, int *face)
873 {
874     /*
875      *  Cubemap orientation
876      *
877      *           width
878      *         <------->
879      *         +-------+
880      *         |       |                              U
881      *         | up    |                   h       ------->
882      * +-------+-------+-------+-------+ ^ e      |
883      * |       |       |       |       | | i    V |
884      * | left  | front | right | back  | | g      |
885      * +-------+-------+-------+-------+ v h      v
886      *         |       |                   t
887      *         | down  |
888      *         +-------+
889      */
890
891     *face = s->in_cubemap_face_order[direction];
892     rotate_cube_face_inverse(&uf, &vf, s->in_cubemap_face_rotation[*face]);
893
894     if ((uf < -1.f || uf >= 1.f) && (vf < -1.f || vf >= 1.f)) {
895         // There are no pixels to use in this case
896         *new_uf = uf;
897         *new_vf = vf;
898     } else if (uf < -1.f) {
899         uf += 2.f;
900         switch (direction) {
901         case RIGHT:
902             direction = FRONT;
903             *new_uf =  uf;
904             *new_vf =  vf;
905             break;
906         case LEFT:
907             direction = BACK;
908             *new_uf =  uf;
909             *new_vf =  vf;
910             break;
911         case UP:
912             direction = LEFT;
913             *new_uf =  vf;
914             *new_vf = -uf;
915             break;
916         case DOWN:
917             direction = LEFT;
918             *new_uf = -vf;
919             *new_vf =  uf;
920             break;
921         case FRONT:
922             direction = LEFT;
923             *new_uf =  uf;
924             *new_vf =  vf;
925             break;
926         case BACK:
927             direction = RIGHT;
928             *new_uf =  uf;
929             *new_vf =  vf;
930             break;
931         default:
932             av_assert0(0);
933         }
934     } else if (uf >= 1.f) {
935         uf -= 2.f;
936         switch (direction) {
937         case RIGHT:
938             direction = BACK;
939             *new_uf =  uf;
940             *new_vf =  vf;
941             break;
942         case LEFT:
943             direction = FRONT;
944             *new_uf =  uf;
945             *new_vf =  vf;
946             break;
947         case UP:
948             direction = RIGHT;
949             *new_uf = -vf;
950             *new_vf =  uf;
951             break;
952         case DOWN:
953             direction = RIGHT;
954             *new_uf =  vf;
955             *new_vf = -uf;
956             break;
957         case FRONT:
958             direction = RIGHT;
959             *new_uf =  uf;
960             *new_vf =  vf;
961             break;
962         case BACK:
963             direction = LEFT;
964             *new_uf =  uf;
965             *new_vf =  vf;
966             break;
967         default:
968             av_assert0(0);
969         }
970     } else if (vf < -1.f) {
971         vf += 2.f;
972         switch (direction) {
973         case RIGHT:
974             direction = UP;
975             *new_uf =  vf;
976             *new_vf = -uf;
977             break;
978         case LEFT:
979             direction = UP;
980             *new_uf = -vf;
981             *new_vf =  uf;
982             break;
983         case UP:
984             direction = BACK;
985             *new_uf = -uf;
986             *new_vf = -vf;
987             break;
988         case DOWN:
989             direction = FRONT;
990             *new_uf =  uf;
991             *new_vf =  vf;
992             break;
993         case FRONT:
994             direction = UP;
995             *new_uf =  uf;
996             *new_vf =  vf;
997             break;
998         case BACK:
999             direction = UP;
1000             *new_uf = -uf;
1001             *new_vf = -vf;
1002             break;
1003         default:
1004             av_assert0(0);
1005         }
1006     } else if (vf >= 1.f) {
1007         vf -= 2.f;
1008         switch (direction) {
1009         case RIGHT:
1010             direction = DOWN;
1011             *new_uf = -vf;
1012             *new_vf =  uf;
1013             break;
1014         case LEFT:
1015             direction = DOWN;
1016             *new_uf =  vf;
1017             *new_vf = -uf;
1018             break;
1019         case UP:
1020             direction = FRONT;
1021             *new_uf =  uf;
1022             *new_vf =  vf;
1023             break;
1024         case DOWN:
1025             direction = BACK;
1026             *new_uf = -uf;
1027             *new_vf = -vf;
1028             break;
1029         case FRONT:
1030             direction = DOWN;
1031             *new_uf =  uf;
1032             *new_vf =  vf;
1033             break;
1034         case BACK:
1035             direction = DOWN;
1036             *new_uf = -uf;
1037             *new_vf = -vf;
1038             break;
1039         default:
1040             av_assert0(0);
1041         }
1042     } else {
1043         // Inside cube face
1044         *new_uf = uf;
1045         *new_vf = vf;
1046     }
1047
1048     *face = s->in_cubemap_face_order[direction];
1049     rotate_cube_face(new_uf, new_vf, s->in_cubemap_face_rotation[*face]);
1050 }
1051
1052 /**
1053  * Calculate 3D coordinates on sphere for corresponding frame position in cubemap3x2 format.
1054  *
1055  * @param s filter context
1056  * @param i horizontal position on frame [0, width)
1057  * @param j vertical position on frame [0, height)
1058  * @param width frame width
1059  * @param height frame height
1060  * @param vec coordinates on sphere
1061  */
1062 static void cube3x2_to_xyz(const V360Context *s,
1063                            int i, int j, int width, int height,
1064                            float *vec)
1065 {
1066     const float ew = width  / 3.f;
1067     const float eh = height / 2.f;
1068
1069     const int u_face = floorf(i / ew);
1070     const int v_face = floorf(j / eh);
1071     const int face = u_face + 3 * v_face;
1072
1073     const int u_shift = ceilf(ew * u_face);
1074     const int v_shift = ceilf(eh * v_face);
1075     const int ewi = ceilf(ew * (u_face + 1)) - u_shift;
1076     const int ehi = ceilf(eh * (v_face + 1)) - v_shift;
1077
1078     const float uf = 2.f * (i - u_shift) / ewi - 1.f;
1079     const float vf = 2.f * (j - v_shift) / ehi - 1.f;
1080
1081     cube_to_xyz(s, uf, vf, face, vec);
1082 }
1083
1084 /**
1085  * Calculate frame position in cubemap3x2 format for corresponding 3D coordinates on sphere.
1086  *
1087  * @param s filter context
1088  * @param vec coordinates on sphere
1089  * @param width frame width
1090  * @param height frame height
1091  * @param us horizontal coordinates for interpolation window
1092  * @param vs vertical coordinates for interpolation window
1093  * @param du horizontal relative coordinate
1094  * @param dv vertical relative coordinate
1095  */
1096 static void xyz_to_cube3x2(const V360Context *s,
1097                            const float *vec, int width, int height,
1098                            uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1099 {
1100     const float ew = width  / 3.f;
1101     const float eh = height / 2.f;
1102     float uf, vf;
1103     int ui, vi;
1104     int ewi, ehi;
1105     int direction, face;
1106     int u_face, v_face;
1107
1108     xyz_to_cube(s, vec, &uf, &vf, &direction);
1109
1110     uf *= (1.f - s->in_pad);
1111     vf *= (1.f - s->in_pad);
1112
1113     face = s->in_cubemap_face_order[direction];
1114     u_face = face % 3;
1115     v_face = face / 3;
1116     ewi = ceilf(ew * (u_face + 1)) - ceilf(ew * u_face);
1117     ehi = ceilf(eh * (v_face + 1)) - ceilf(eh * v_face);
1118
1119     uf = 0.5f * ewi * (uf + 1.f);
1120     vf = 0.5f * ehi * (vf + 1.f);
1121
1122     ui = floorf(uf);
1123     vi = floorf(vf);
1124
1125     *du = uf - ui;
1126     *dv = vf - vi;
1127
1128     for (int i = -1; i < 3; i++) {
1129         for (int j = -1; j < 3; j++) {
1130             int new_ui = ui + j;
1131             int new_vi = vi + i;
1132             int u_shift, v_shift;
1133             int new_ewi, new_ehi;
1134
1135             if (new_ui >= 0 && new_ui < ewi && new_vi >= 0 && new_vi < ehi) {
1136                 face = s->in_cubemap_face_order[direction];
1137
1138                 u_face = face % 3;
1139                 v_face = face / 3;
1140                 u_shift = ceilf(ew * u_face);
1141                 v_shift = ceilf(eh * v_face);
1142             } else {
1143                 uf = 2.f * new_ui / ewi - 1.f;
1144                 vf = 2.f * new_vi / ehi - 1.f;
1145
1146                 uf /= (1.f - s->in_pad);
1147                 vf /= (1.f - s->in_pad);
1148
1149                 process_cube_coordinates(s, uf, vf, direction, &uf, &vf, &face);
1150
1151                 uf *= (1.f - s->in_pad);
1152                 vf *= (1.f - s->in_pad);
1153
1154                 u_face = face % 3;
1155                 v_face = face / 3;
1156                 u_shift = ceilf(ew * u_face);
1157                 v_shift = ceilf(eh * v_face);
1158                 new_ewi = ceilf(ew * (u_face + 1)) - u_shift;
1159                 new_ehi = ceilf(eh * (v_face + 1)) - v_shift;
1160
1161                 new_ui = av_clip(roundf(0.5f * new_ewi * (uf + 1.f)), 0, new_ewi - 1);
1162                 new_vi = av_clip(roundf(0.5f * new_ehi * (vf + 1.f)), 0, new_ehi - 1);
1163             }
1164
1165             us[i + 1][j + 1] = u_shift + new_ui;
1166             vs[i + 1][j + 1] = v_shift + new_vi;
1167         }
1168     }
1169 }
1170
1171 /**
1172  * Calculate 3D coordinates on sphere for corresponding frame position in cubemap1x6 format.
1173  *
1174  * @param s filter context
1175  * @param i horizontal position on frame [0, width)
1176  * @param j vertical position on frame [0, height)
1177  * @param width frame width
1178  * @param height frame height
1179  * @param vec coordinates on sphere
1180  */
1181 static void cube1x6_to_xyz(const V360Context *s,
1182                            int i, int j, int width, int height,
1183                            float *vec)
1184 {
1185     const float ew = width;
1186     const float eh = height / 6.f;
1187
1188     const int face = floorf(j / eh);
1189
1190     const int v_shift = ceilf(eh * face);
1191     const int ehi = ceilf(eh * (face + 1)) - v_shift;
1192
1193     const float uf = 2.f *  i            / ew  - 1.f;
1194     const float vf = 2.f * (j - v_shift) / ehi - 1.f;
1195
1196     cube_to_xyz(s, uf, vf, face, vec);
1197 }
1198
1199 /**
1200  * Calculate 3D coordinates on sphere for corresponding frame position in cubemap6x1 format.
1201  *
1202  * @param s filter context
1203  * @param i horizontal position on frame [0, width)
1204  * @param j vertical position on frame [0, height)
1205  * @param width frame width
1206  * @param height frame height
1207  * @param vec coordinates on sphere
1208  */
1209 static void cube6x1_to_xyz(const V360Context *s,
1210                            int i, int j, int width, int height,
1211                            float *vec)
1212 {
1213     const float ew = width / 6.f;
1214     const float eh = height;
1215
1216     const int face = floorf(i / ew);
1217
1218     const int u_shift = ceilf(ew * face);
1219     const int ewi = ceilf(ew * (face + 1)) - u_shift;
1220
1221     const float uf = 2.f * (i - u_shift) / ewi - 1.f;
1222     const float vf = 2.f *  j            / eh  - 1.f;
1223
1224     cube_to_xyz(s, uf, vf, face, vec);
1225 }
1226
1227 /**
1228  * Calculate frame position in cubemap1x6 format for corresponding 3D coordinates on sphere.
1229  *
1230  * @param s filter context
1231  * @param vec coordinates on sphere
1232  * @param width frame width
1233  * @param height frame height
1234  * @param us horizontal coordinates for interpolation window
1235  * @param vs vertical coordinates for interpolation window
1236  * @param du horizontal relative coordinate
1237  * @param dv vertical relative coordinate
1238  */
1239 static void xyz_to_cube1x6(const V360Context *s,
1240                            const float *vec, int width, int height,
1241                            uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1242 {
1243     const float eh = height / 6.f;
1244     const int ewi = width;
1245     float uf, vf;
1246     int ui, vi;
1247     int ehi;
1248     int direction, face;
1249
1250     xyz_to_cube(s, vec, &uf, &vf, &direction);
1251
1252     uf *= (1.f - s->in_pad);
1253     vf *= (1.f - s->in_pad);
1254
1255     face = s->in_cubemap_face_order[direction];
1256     ehi = ceilf(eh * (face + 1)) - ceilf(eh * face);
1257
1258     uf = 0.5f * ewi * (uf + 1.f);
1259     vf = 0.5f * ehi * (vf + 1.f);
1260
1261     ui = floorf(uf);
1262     vi = floorf(vf);
1263
1264     *du = uf - ui;
1265     *dv = vf - vi;
1266
1267     for (int i = -1; i < 3; i++) {
1268         for (int j = -1; j < 3; j++) {
1269             int new_ui = ui + j;
1270             int new_vi = vi + i;
1271             int v_shift;
1272             int new_ehi;
1273
1274             if (new_ui >= 0 && new_ui < ewi && new_vi >= 0 && new_vi < ehi) {
1275                 face = s->in_cubemap_face_order[direction];
1276
1277                 v_shift = ceilf(eh * face);
1278             } else {
1279                 uf = 2.f * new_ui / ewi - 1.f;
1280                 vf = 2.f * new_vi / ehi - 1.f;
1281
1282                 uf /= (1.f - s->in_pad);
1283                 vf /= (1.f - s->in_pad);
1284
1285                 process_cube_coordinates(s, uf, vf, direction, &uf, &vf, &face);
1286
1287                 uf *= (1.f - s->in_pad);
1288                 vf *= (1.f - s->in_pad);
1289
1290                 v_shift = ceilf(eh * face);
1291                 new_ehi = ceilf(eh * (face + 1)) - v_shift;
1292
1293                 new_ui = av_clip(roundf(0.5f *     ewi * (uf + 1.f)), 0,     ewi - 1);
1294                 new_vi = av_clip(roundf(0.5f * new_ehi * (vf + 1.f)), 0, new_ehi - 1);
1295             }
1296
1297             us[i + 1][j + 1] =           new_ui;
1298             vs[i + 1][j + 1] = v_shift + new_vi;
1299         }
1300     }
1301 }
1302
1303 /**
1304  * Calculate frame position in cubemap6x1 format for corresponding 3D coordinates on sphere.
1305  *
1306  * @param s filter context
1307  * @param vec coordinates on sphere
1308  * @param width frame width
1309  * @param height frame height
1310  * @param us horizontal coordinates for interpolation window
1311  * @param vs vertical coordinates for interpolation window
1312  * @param du horizontal relative coordinate
1313  * @param dv vertical relative coordinate
1314  */
1315 static void xyz_to_cube6x1(const V360Context *s,
1316                            const float *vec, int width, int height,
1317                            uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1318 {
1319     const float ew = width / 6.f;
1320     const int ehi = height;
1321     float uf, vf;
1322     int ui, vi;
1323     int ewi;
1324     int direction, face;
1325
1326     xyz_to_cube(s, vec, &uf, &vf, &direction);
1327
1328     uf *= (1.f - s->in_pad);
1329     vf *= (1.f - s->in_pad);
1330
1331     face = s->in_cubemap_face_order[direction];
1332     ewi = ceilf(ew * (face + 1)) - ceilf(ew * face);
1333
1334     uf = 0.5f * ewi * (uf + 1.f);
1335     vf = 0.5f * ehi * (vf + 1.f);
1336
1337     ui = floorf(uf);
1338     vi = floorf(vf);
1339
1340     *du = uf - ui;
1341     *dv = vf - vi;
1342
1343     for (int i = -1; i < 3; i++) {
1344         for (int j = -1; j < 3; j++) {
1345             int new_ui = ui + j;
1346             int new_vi = vi + i;
1347             int u_shift;
1348             int new_ewi;
1349
1350             if (new_ui >= 0 && new_ui < ewi && new_vi >= 0 && new_vi < ehi) {
1351                 face = s->in_cubemap_face_order[direction];
1352
1353                 u_shift = ceilf(ew * face);
1354             } else {
1355                 uf = 2.f * new_ui / ewi - 1.f;
1356                 vf = 2.f * new_vi / ehi - 1.f;
1357
1358                 uf /= (1.f - s->in_pad);
1359                 vf /= (1.f - s->in_pad);
1360
1361                 process_cube_coordinates(s, uf, vf, direction, &uf, &vf, &face);
1362
1363                 uf *= (1.f - s->in_pad);
1364                 vf *= (1.f - s->in_pad);
1365
1366                 u_shift = ceilf(ew * face);
1367                 new_ewi = ceilf(ew * (face + 1)) - u_shift;
1368
1369                 new_ui = av_clip(roundf(0.5f * new_ewi * (uf + 1.f)), 0, new_ewi - 1);
1370                 new_vi = av_clip(roundf(0.5f *     ehi * (vf + 1.f)), 0,     ehi - 1);
1371             }
1372
1373             us[i + 1][j + 1] = u_shift + new_ui;
1374             vs[i + 1][j + 1] =           new_vi;
1375         }
1376     }
1377 }
1378
1379 /**
1380  * Calculate 3D coordinates on sphere for corresponding frame position in equirectangular format.
1381  *
1382  * @param s filter context
1383  * @param i horizontal position on frame [0, width)
1384  * @param j vertical position on frame [0, height)
1385  * @param width frame width
1386  * @param height frame height
1387  * @param vec coordinates on sphere
1388  */
1389 static void equirect_to_xyz(const V360Context *s,
1390                             int i, int j, int width, int height,
1391                             float *vec)
1392 {
1393     const float phi   = ((2.f * i) / width  - 1.f) * M_PI;
1394     const float theta = ((2.f * j) / height - 1.f) * M_PI_2;
1395
1396     const float sin_phi   = sinf(phi);
1397     const float cos_phi   = cosf(phi);
1398     const float sin_theta = sinf(theta);
1399     const float cos_theta = cosf(theta);
1400
1401     vec[0] =  cos_theta * sin_phi;
1402     vec[1] = -sin_theta;
1403     vec[2] = -cos_theta * cos_phi;
1404 }
1405
1406 /**
1407  * Prepare data for processing stereographic output format.
1408  *
1409  * @param ctx filter context
1410  *
1411  * @return error code
1412  */
1413 static int prepare_stereographic_out(AVFilterContext *ctx)
1414 {
1415     V360Context *s = ctx->priv;
1416
1417     const float h_angle = tanf(FFMIN(s->h_fov, 359.f) * M_PI / 720.f);
1418     const float v_angle = tanf(FFMIN(s->v_fov, 359.f) * M_PI / 720.f);
1419
1420     s->flat_range[0] = h_angle;
1421     s->flat_range[1] = v_angle;
1422
1423     return 0;
1424 }
1425
1426 /**
1427  * Calculate 3D coordinates on sphere for corresponding frame position in stereographic format.
1428  *
1429  * @param s filter context
1430  * @param i horizontal position on frame [0, width)
1431  * @param j vertical position on frame [0, height)
1432  * @param width frame width
1433  * @param height frame height
1434  * @param vec coordinates on sphere
1435  */
1436 static void stereographic_to_xyz(const V360Context *s,
1437                                  int i, int j, int width, int height,
1438                                  float *vec)
1439 {
1440     const float x = ((2.f * i) / width  - 1.f) * s->flat_range[0];
1441     const float y = ((2.f * j) / height - 1.f) * s->flat_range[1];
1442     const float xy = x * x + y * y;
1443
1444     vec[0] = 2.f * x / (1.f + xy);
1445     vec[1] = (-1.f + xy) / (1.f + xy);
1446     vec[2] = 2.f * y / (1.f + xy);
1447
1448     normalize_vector(vec);
1449 }
1450
1451 /**
1452  * Calculate frame position in stereographic format for corresponding 3D coordinates on sphere.
1453  *
1454  * @param s filter context
1455  * @param vec coordinates on sphere
1456  * @param width frame width
1457  * @param height frame height
1458  * @param us horizontal coordinates for interpolation window
1459  * @param vs vertical coordinates for interpolation window
1460  * @param du horizontal relative coordinate
1461  * @param dv vertical relative coordinate
1462  */
1463 static void xyz_to_stereographic(const V360Context *s,
1464                                  const float *vec, int width, int height,
1465                                  uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1466 {
1467     const float x = av_clipf(vec[0] / (1.f - vec[1]), -1.f, 1.f) * s->input_mirror_modifier[0];
1468     const float y = av_clipf(vec[2] / (1.f - vec[1]), -1.f, 1.f) * s->input_mirror_modifier[1];
1469     float uf, vf;
1470     int ui, vi;
1471
1472     uf = (x + 1.f) * width  / 2.f;
1473     vf = (y + 1.f) * height / 2.f;
1474     ui = floorf(uf);
1475     vi = floorf(vf);
1476
1477     *du = uf - ui;
1478     *dv = vf - vi;
1479
1480     for (int i = -1; i < 3; i++) {
1481         for (int j = -1; j < 3; j++) {
1482             us[i + 1][j + 1] = av_clip(ui + j, 0, width - 1);
1483             vs[i + 1][j + 1] = av_clip(vi + i, 0, height - 1);
1484         }
1485     }
1486 }
1487
1488 /**
1489  * Calculate frame position in equirectangular format for corresponding 3D coordinates on sphere.
1490  *
1491  * @param s filter context
1492  * @param vec coordinates on sphere
1493  * @param width frame width
1494  * @param height frame height
1495  * @param us horizontal coordinates for interpolation window
1496  * @param vs vertical coordinates for interpolation window
1497  * @param du horizontal relative coordinate
1498  * @param dv vertical relative coordinate
1499  */
1500 static void xyz_to_equirect(const V360Context *s,
1501                             const float *vec, int width, int height,
1502                             uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1503 {
1504     const float phi   = atan2f(vec[0], -vec[2]) * s->input_mirror_modifier[0];
1505     const float theta = asinf(-vec[1]) * s->input_mirror_modifier[1];
1506     float uf, vf;
1507     int ui, vi;
1508
1509     uf = (phi   / M_PI   + 1.f) * width  / 2.f;
1510     vf = (theta / M_PI_2 + 1.f) * height / 2.f;
1511     ui = floorf(uf);
1512     vi = floorf(vf);
1513
1514     *du = uf - ui;
1515     *dv = vf - vi;
1516
1517     for (int i = -1; i < 3; i++) {
1518         for (int j = -1; j < 3; j++) {
1519             us[i + 1][j + 1] = mod(ui + j, width);
1520             vs[i + 1][j + 1] = av_clip(vi + i, 0, height - 1);
1521         }
1522     }
1523 }
1524
1525 /**
1526  * Prepare data for processing equi-angular cubemap input format.
1527  *
1528  * @param ctx filter context
1529
1530  * @return error code
1531  */
1532 static int prepare_eac_in(AVFilterContext *ctx)
1533 {
1534     V360Context *s = ctx->priv;
1535
1536     if (s->ih_flip && s->iv_flip) {
1537         s->in_cubemap_face_order[RIGHT] = BOTTOM_LEFT;
1538         s->in_cubemap_face_order[LEFT]  = BOTTOM_RIGHT;
1539         s->in_cubemap_face_order[UP]    = TOP_LEFT;
1540         s->in_cubemap_face_order[DOWN]  = TOP_RIGHT;
1541         s->in_cubemap_face_order[FRONT] = BOTTOM_MIDDLE;
1542         s->in_cubemap_face_order[BACK]  = TOP_MIDDLE;
1543     } else if (s->ih_flip) {
1544         s->in_cubemap_face_order[RIGHT] = TOP_LEFT;
1545         s->in_cubemap_face_order[LEFT]  = TOP_RIGHT;
1546         s->in_cubemap_face_order[UP]    = BOTTOM_LEFT;
1547         s->in_cubemap_face_order[DOWN]  = BOTTOM_RIGHT;
1548         s->in_cubemap_face_order[FRONT] = TOP_MIDDLE;
1549         s->in_cubemap_face_order[BACK]  = BOTTOM_MIDDLE;
1550     } else if (s->iv_flip) {
1551         s->in_cubemap_face_order[RIGHT] = BOTTOM_RIGHT;
1552         s->in_cubemap_face_order[LEFT]  = BOTTOM_LEFT;
1553         s->in_cubemap_face_order[UP]    = TOP_RIGHT;
1554         s->in_cubemap_face_order[DOWN]  = TOP_LEFT;
1555         s->in_cubemap_face_order[FRONT] = BOTTOM_MIDDLE;
1556         s->in_cubemap_face_order[BACK]  = TOP_MIDDLE;
1557     } else {
1558         s->in_cubemap_face_order[RIGHT] = TOP_RIGHT;
1559         s->in_cubemap_face_order[LEFT]  = TOP_LEFT;
1560         s->in_cubemap_face_order[UP]    = BOTTOM_RIGHT;
1561         s->in_cubemap_face_order[DOWN]  = BOTTOM_LEFT;
1562         s->in_cubemap_face_order[FRONT] = TOP_MIDDLE;
1563         s->in_cubemap_face_order[BACK]  = BOTTOM_MIDDLE;
1564     }
1565
1566     if (s->iv_flip) {
1567         s->in_cubemap_face_rotation[TOP_LEFT]      = ROT_270;
1568         s->in_cubemap_face_rotation[TOP_MIDDLE]    = ROT_90;
1569         s->in_cubemap_face_rotation[TOP_RIGHT]     = ROT_270;
1570         s->in_cubemap_face_rotation[BOTTOM_LEFT]   = ROT_0;
1571         s->in_cubemap_face_rotation[BOTTOM_MIDDLE] = ROT_0;
1572         s->in_cubemap_face_rotation[BOTTOM_RIGHT]  = ROT_0;
1573     } else {
1574         s->in_cubemap_face_rotation[TOP_LEFT]      = ROT_0;
1575         s->in_cubemap_face_rotation[TOP_MIDDLE]    = ROT_0;
1576         s->in_cubemap_face_rotation[TOP_RIGHT]     = ROT_0;
1577         s->in_cubemap_face_rotation[BOTTOM_LEFT]   = ROT_270;
1578         s->in_cubemap_face_rotation[BOTTOM_MIDDLE] = ROT_90;
1579         s->in_cubemap_face_rotation[BOTTOM_RIGHT]  = ROT_270;
1580     }
1581
1582     return 0;
1583 }
1584
1585 /**
1586  * Prepare data for processing equi-angular cubemap output format.
1587  *
1588  * @param ctx filter context
1589  *
1590  * @return error code
1591  */
1592 static int prepare_eac_out(AVFilterContext *ctx)
1593 {
1594     V360Context *s = ctx->priv;
1595
1596     s->out_cubemap_direction_order[TOP_LEFT]      = LEFT;
1597     s->out_cubemap_direction_order[TOP_MIDDLE]    = FRONT;
1598     s->out_cubemap_direction_order[TOP_RIGHT]     = RIGHT;
1599     s->out_cubemap_direction_order[BOTTOM_LEFT]   = DOWN;
1600     s->out_cubemap_direction_order[BOTTOM_MIDDLE] = BACK;
1601     s->out_cubemap_direction_order[BOTTOM_RIGHT]  = UP;
1602
1603     s->out_cubemap_face_rotation[TOP_LEFT]      = ROT_0;
1604     s->out_cubemap_face_rotation[TOP_MIDDLE]    = ROT_0;
1605     s->out_cubemap_face_rotation[TOP_RIGHT]     = ROT_0;
1606     s->out_cubemap_face_rotation[BOTTOM_LEFT]   = ROT_270;
1607     s->out_cubemap_face_rotation[BOTTOM_MIDDLE] = ROT_90;
1608     s->out_cubemap_face_rotation[BOTTOM_RIGHT]  = ROT_270;
1609
1610     return 0;
1611 }
1612
1613 /**
1614  * Calculate 3D coordinates on sphere for corresponding frame position in equi-angular cubemap format.
1615  *
1616  * @param s filter context
1617  * @param i horizontal position on frame [0, width)
1618  * @param j vertical position on frame [0, height)
1619  * @param width frame width
1620  * @param height frame height
1621  * @param vec coordinates on sphere
1622  */
1623 static void eac_to_xyz(const V360Context *s,
1624                        int i, int j, int width, int height,
1625                        float *vec)
1626 {
1627     const float pixel_pad = 2;
1628     const float u_pad = pixel_pad / width;
1629     const float v_pad = pixel_pad / height;
1630
1631     int u_face, v_face, face;
1632
1633     float l_x, l_y, l_z;
1634
1635     float uf = (float)i / width;
1636     float vf = (float)j / height;
1637
1638     // EAC has 2-pixel padding on faces except between faces on the same row
1639     // Padding pixels seems not to be stretched with tangent as regular pixels
1640     // Formulas below approximate original padding as close as I could get experimentally
1641
1642     // Horizontal padding
1643     uf = 3.f * (uf - u_pad) / (1.f - 2.f * u_pad);
1644     if (uf < 0.f) {
1645         u_face = 0;
1646         uf -= 0.5f;
1647     } else if (uf >= 3.f) {
1648         u_face = 2;
1649         uf -= 2.5f;
1650     } else {
1651         u_face = floorf(uf);
1652         uf = fmodf(uf, 1.f) - 0.5f;
1653     }
1654
1655     // Vertical padding
1656     v_face = floorf(vf * 2.f);
1657     vf = (vf - v_pad - 0.5f * v_face) / (0.5f - 2.f * v_pad) - 0.5f;
1658
1659     if (uf >= -0.5f && uf < 0.5f) {
1660         uf = tanf(M_PI_2 * uf);
1661     } else {
1662         uf = 2.f * uf;
1663     }
1664     if (vf >= -0.5f && vf < 0.5f) {
1665         vf = tanf(M_PI_2 * vf);
1666     } else {
1667         vf = 2.f * vf;
1668     }
1669
1670     face = u_face + 3 * v_face;
1671
1672     switch (face) {
1673     case TOP_LEFT:
1674         l_x = -1.f;
1675         l_y = -vf;
1676         l_z = -uf;
1677         break;
1678     case TOP_MIDDLE:
1679         l_x =  uf;
1680         l_y = -vf;
1681         l_z = -1.f;
1682         break;
1683     case TOP_RIGHT:
1684         l_x =  1.f;
1685         l_y = -vf;
1686         l_z =  uf;
1687         break;
1688     case BOTTOM_LEFT:
1689         l_x = -vf;
1690         l_y = -1.f;
1691         l_z =  uf;
1692         break;
1693     case BOTTOM_MIDDLE:
1694         l_x = -vf;
1695         l_y =  uf;
1696         l_z =  1.f;
1697         break;
1698     case BOTTOM_RIGHT:
1699         l_x = -vf;
1700         l_y =  1.f;
1701         l_z = -uf;
1702         break;
1703     default:
1704         av_assert0(0);
1705     }
1706
1707     vec[0] = l_x;
1708     vec[1] = l_y;
1709     vec[2] = l_z;
1710
1711     normalize_vector(vec);
1712 }
1713
1714 /**
1715  * Calculate frame position in equi-angular cubemap format for corresponding 3D coordinates on sphere.
1716  *
1717  * @param s filter context
1718  * @param vec coordinates on sphere
1719  * @param width frame width
1720  * @param height frame height
1721  * @param us horizontal coordinates for interpolation window
1722  * @param vs vertical coordinates for interpolation window
1723  * @param du horizontal relative coordinate
1724  * @param dv vertical relative coordinate
1725  */
1726 static void xyz_to_eac(const V360Context *s,
1727                        const float *vec, int width, int height,
1728                        uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1729 {
1730     const float pixel_pad = 2;
1731     const float u_pad = pixel_pad / width;
1732     const float v_pad = pixel_pad / height;
1733
1734     float uf, vf;
1735     int ui, vi;
1736     int direction, face;
1737     int u_face, v_face;
1738
1739     xyz_to_cube(s, vec, &uf, &vf, &direction);
1740
1741     face = s->in_cubemap_face_order[direction];
1742     u_face = face % 3;
1743     v_face = face / 3;
1744
1745     uf = M_2_PI * atanf(uf) + 0.5f;
1746     vf = M_2_PI * atanf(vf) + 0.5f;
1747
1748     // These formulas are inversed from eac_to_xyz ones
1749     uf = (uf + u_face) * (1.f - 2.f * u_pad) / 3.f + u_pad;
1750     vf = vf * (0.5f - 2.f * v_pad) + v_pad + 0.5f * v_face;
1751
1752     uf *= width;
1753     vf *= height;
1754
1755     ui = floorf(uf);
1756     vi = floorf(vf);
1757
1758     *du = uf - ui;
1759     *dv = vf - vi;
1760
1761     for (int i = -1; i < 3; i++) {
1762         for (int j = -1; j < 3; j++) {
1763             us[i + 1][j + 1] = av_clip(ui + j, 0, width  - 1);
1764             vs[i + 1][j + 1] = av_clip(vi + i, 0, height - 1);
1765         }
1766     }
1767 }
1768
1769 /**
1770  * Prepare data for processing flat output format.
1771  *
1772  * @param ctx filter context
1773  *
1774  * @return error code
1775  */
1776 static int prepare_flat_out(AVFilterContext *ctx)
1777 {
1778     V360Context *s = ctx->priv;
1779
1780     const float h_angle = 0.5f * s->h_fov * M_PI / 180.f;
1781     const float v_angle = 0.5f * s->v_fov * M_PI / 180.f;
1782
1783     s->flat_range[0] =  tanf(h_angle);
1784     s->flat_range[1] =  tanf(v_angle);
1785     s->flat_range[2] = -1.f;
1786
1787     return 0;
1788 }
1789
1790 /**
1791  * Calculate 3D coordinates on sphere for corresponding frame position in flat format.
1792  *
1793  * @param s filter context
1794  * @param i horizontal position on frame [0, width)
1795  * @param j vertical position on frame [0, height)
1796  * @param width frame width
1797  * @param height frame height
1798  * @param vec coordinates on sphere
1799  */
1800 static void flat_to_xyz(const V360Context *s,
1801                         int i, int j, int width, int height,
1802                         float *vec)
1803 {
1804     const float l_x =  s->flat_range[0] * (2.f * i / width  - 1.f);
1805     const float l_y = -s->flat_range[1] * (2.f * j / height - 1.f);
1806     const float l_z =  s->flat_range[2];
1807
1808     vec[0] = l_x;
1809     vec[1] = l_y;
1810     vec[2] = l_z;
1811
1812     normalize_vector(vec);
1813 }
1814
1815 /**
1816  * Calculate 3D coordinates on sphere for corresponding frame position in dual fisheye format.
1817  *
1818  * @param s filter context
1819  * @param i horizontal position on frame [0, width)
1820  * @param j vertical position on frame [0, height)
1821  * @param width frame width
1822  * @param height frame height
1823  * @param vec coordinates on sphere
1824  */
1825 static void dfisheye_to_xyz(const V360Context *s,
1826                             int i, int j, int width, int height,
1827                             float *vec)
1828 {
1829     const float scale = 1.f + s->out_pad;
1830
1831     const float ew = width / 2.f;
1832     const float eh = height;
1833
1834     const int ei = i >= ew ? i - ew : i;
1835     const float m = i >= ew ? -1.f : 1.f;
1836
1837     const float uf = ((2.f * ei) / ew - 1.f) * scale;
1838     const float vf = ((2.f *  j) / eh - 1.f) * scale;
1839
1840     const float phi   = M_PI + atan2f(vf, uf * m);
1841     const float theta = m * M_PI_2 * (1.f - hypotf(uf, vf));
1842
1843     const float sin_phi   = sinf(phi);
1844     const float cos_phi   = cosf(phi);
1845     const float sin_theta = sinf(theta);
1846     const float cos_theta = cosf(theta);
1847
1848     vec[0] = cos_theta * cos_phi;
1849     vec[1] = cos_theta * sin_phi;
1850     vec[2] = sin_theta;
1851
1852     normalize_vector(vec);
1853 }
1854
1855 /**
1856  * Calculate frame position in dual fisheye format for corresponding 3D coordinates on sphere.
1857  *
1858  * @param s filter context
1859  * @param vec coordinates on sphere
1860  * @param width frame width
1861  * @param height frame height
1862  * @param us horizontal coordinates for interpolation window
1863  * @param vs vertical coordinates for interpolation window
1864  * @param du horizontal relative coordinate
1865  * @param dv vertical relative coordinate
1866  */
1867 static void xyz_to_dfisheye(const V360Context *s,
1868                             const float *vec, int width, int height,
1869                             uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1870 {
1871     const float scale = 1.f - s->in_pad;
1872
1873     const float ew = width / 2.f;
1874     const float eh = height;
1875
1876     const float phi   = atan2f(-vec[1], -vec[0]) * s->input_mirror_modifier[0];
1877     const float theta = acosf(fabsf(vec[2])) / M_PI * s->input_mirror_modifier[1];
1878
1879     float uf = (theta * cosf(phi) * scale + 0.5f) * ew;
1880     float vf = (theta * sinf(phi) * scale + 0.5f) * eh;
1881
1882     int ui, vi;
1883     int u_shift;
1884
1885     if (vec[2] >= 0) {
1886         u_shift = 0;
1887     } else {
1888         u_shift = ceilf(ew);
1889         uf = ew - uf;
1890     }
1891
1892     ui = floorf(uf);
1893     vi = floorf(vf);
1894
1895     *du = uf - ui;
1896     *dv = vf - vi;
1897
1898     for (int i = -1; i < 3; i++) {
1899         for (int j = -1; j < 3; j++) {
1900             us[i + 1][j + 1] = av_clip(u_shift + ui + j, 0, width  - 1);
1901             vs[i + 1][j + 1] = av_clip(          vi + i, 0, height - 1);
1902         }
1903     }
1904 }
1905
1906 /**
1907  * Calculate 3D coordinates on sphere for corresponding frame position in barrel facebook's format.
1908  *
1909  * @param s filter context
1910  * @param i horizontal position on frame [0, width)
1911  * @param j vertical position on frame [0, height)
1912  * @param width frame width
1913  * @param height frame height
1914  * @param vec coordinates on sphere
1915  */
1916 static void barrel_to_xyz(const V360Context *s,
1917                           int i, int j, int width, int height,
1918                           float *vec)
1919 {
1920     const float scale = 0.99f;
1921     float l_x, l_y, l_z;
1922
1923     if (i < 4 * width / 5) {
1924         const float theta_range = M_PI_4;
1925
1926         const int ew = 4 * width / 5;
1927         const int eh = height;
1928
1929         const float phi   = ((2.f * i) / ew - 1.f) * M_PI        / scale;
1930         const float theta = ((2.f * j) / eh - 1.f) * theta_range / scale;
1931
1932         const float sin_phi   = sinf(phi);
1933         const float cos_phi   = cosf(phi);
1934         const float sin_theta = sinf(theta);
1935         const float cos_theta = cosf(theta);
1936
1937         l_x =  cos_theta * sin_phi;
1938         l_y = -sin_theta;
1939         l_z = -cos_theta * cos_phi;
1940     } else {
1941         const int ew = width  / 5;
1942         const int eh = height / 2;
1943
1944         float uf, vf;
1945
1946         if (j < eh) {   // UP
1947             uf = 2.f * (i - 4 * ew) / ew  - 1.f;
1948             vf = 2.f * (j         ) / eh - 1.f;
1949
1950             uf /= scale;
1951             vf /= scale;
1952
1953             l_x =  uf;
1954             l_y =  1.f;
1955             l_z = -vf;
1956         } else {            // DOWN
1957             uf = 2.f * (i - 4 * ew) / ew - 1.f;
1958             vf = 2.f * (j -     eh) / eh - 1.f;
1959
1960             uf /= scale;
1961             vf /= scale;
1962
1963             l_x =  uf;
1964             l_y = -1.f;
1965             l_z =  vf;
1966         }
1967     }
1968
1969     vec[0] = l_x;
1970     vec[1] = l_y;
1971     vec[2] = l_z;
1972
1973     normalize_vector(vec);
1974 }
1975
1976 /**
1977  * Calculate frame position in barrel facebook's format for corresponding 3D coordinates on sphere.
1978  *
1979  * @param s filter context
1980  * @param vec coordinates on sphere
1981  * @param width frame width
1982  * @param height frame height
1983  * @param us horizontal coordinates for interpolation window
1984  * @param vs vertical coordinates for interpolation window
1985  * @param du horizontal relative coordinate
1986  * @param dv vertical relative coordinate
1987  */
1988 static void xyz_to_barrel(const V360Context *s,
1989                           const float *vec, int width, int height,
1990                           uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv)
1991 {
1992     const float scale = 0.99f;
1993
1994     const float phi   = atan2f(vec[0], -vec[2]) * s->input_mirror_modifier[0];
1995     const float theta = asinf(-vec[1]) * s->input_mirror_modifier[1];
1996     const float theta_range = M_PI_4;
1997
1998     int ew, eh;
1999     int u_shift, v_shift;
2000     float uf, vf;
2001     int ui, vi;
2002
2003     if (theta > -theta_range && theta < theta_range) {
2004         ew = 4 * width / 5;
2005         eh = height;
2006
2007         u_shift = s->ih_flip ? width / 5 : 0;
2008         v_shift = 0;
2009
2010         uf = (phi   / M_PI        * scale + 1.f) * ew / 2.f;
2011         vf = (theta / theta_range * scale + 1.f) * eh / 2.f;
2012     } else {
2013         ew = width  / 5;
2014         eh = height / 2;
2015
2016         u_shift = s->ih_flip ? 0 : 4 * ew;
2017
2018         if (theta < 0.f) {  // UP
2019             uf =  vec[0] / vec[1];
2020             vf = -vec[2] / vec[1];
2021             v_shift = 0;
2022         } else {            // DOWN
2023             uf = -vec[0] / vec[1];
2024             vf = -vec[2] / vec[1];
2025             v_shift = eh;
2026         }
2027
2028         uf *= s->input_mirror_modifier[0] * s->input_mirror_modifier[1];
2029         vf *= s->input_mirror_modifier[1];
2030
2031         uf = 0.5f * ew * (uf * scale + 1.f);
2032         vf = 0.5f * eh * (vf * scale + 1.f);
2033     }
2034
2035     ui = floorf(uf);
2036     vi = floorf(vf);
2037
2038     *du = uf - ui;
2039     *dv = vf - vi;
2040
2041     for (int i = -1; i < 3; i++) {
2042         for (int j = -1; j < 3; j++) {
2043             us[i + 1][j + 1] = u_shift + av_clip(ui + j, 0, ew - 1);
2044             vs[i + 1][j + 1] = v_shift + av_clip(vi + i, 0, eh - 1);
2045         }
2046     }
2047 }
2048
2049 static void multiply_matrix(float c[3][3], const float a[3][3], const float b[3][3])
2050 {
2051     for (int i = 0; i < 3; i++) {
2052         for (int j = 0; j < 3; j++) {
2053             float sum = 0;
2054
2055             for (int k = 0; k < 3; k++)
2056                 sum += a[i][k] * b[k][j];
2057
2058             c[i][j] = sum;
2059         }
2060     }
2061 }
2062
2063 /**
2064  * Calculate rotation matrix for yaw/pitch/roll angles.
2065  */
2066 static inline void calculate_rotation_matrix(float yaw, float pitch, float roll,
2067                                              float rot_mat[3][3],
2068                                              const int rotation_order[3])
2069 {
2070     const float yaw_rad   = yaw   * M_PI / 180.f;
2071     const float pitch_rad = pitch * M_PI / 180.f;
2072     const float roll_rad  = roll  * M_PI / 180.f;
2073
2074     const float sin_yaw   = sinf(-yaw_rad);
2075     const float cos_yaw   = cosf(-yaw_rad);
2076     const float sin_pitch = sinf(pitch_rad);
2077     const float cos_pitch = cosf(pitch_rad);
2078     const float sin_roll  = sinf(roll_rad);
2079     const float cos_roll  = cosf(roll_rad);
2080
2081     float m[3][3][3];
2082     float temp[3][3];
2083
2084     m[0][0][0] =  cos_yaw;  m[0][0][1] = 0;          m[0][0][2] =  sin_yaw;
2085     m[0][1][0] =  0;        m[0][1][1] = 1;          m[0][1][2] =  0;
2086     m[0][2][0] = -sin_yaw;  m[0][2][1] = 0;          m[0][2][2] =  cos_yaw;
2087
2088     m[1][0][0] = 1;         m[1][0][1] = 0;          m[1][0][2] =  0;
2089     m[1][1][0] = 0;         m[1][1][1] = cos_pitch;  m[1][1][2] = -sin_pitch;
2090     m[1][2][0] = 0;         m[1][2][1] = sin_pitch;  m[1][2][2] =  cos_pitch;
2091
2092     m[2][0][0] = cos_roll;  m[2][0][1] = -sin_roll;  m[2][0][2] =  0;
2093     m[2][1][0] = sin_roll;  m[2][1][1] =  cos_roll;  m[2][1][2] =  0;
2094     m[2][2][0] = 0;         m[2][2][1] =  0;         m[2][2][2] =  1;
2095
2096     multiply_matrix(temp, m[rotation_order[0]], m[rotation_order[1]]);
2097     multiply_matrix(rot_mat, temp, m[rotation_order[2]]);
2098 }
2099
2100 /**
2101  * Rotate vector with given rotation matrix.
2102  *
2103  * @param rot_mat rotation matrix
2104  * @param vec vector
2105  */
2106 static inline void rotate(const float rot_mat[3][3],
2107                           float *vec)
2108 {
2109     const float x_tmp = vec[0] * rot_mat[0][0] + vec[1] * rot_mat[0][1] + vec[2] * rot_mat[0][2];
2110     const float y_tmp = vec[0] * rot_mat[1][0] + vec[1] * rot_mat[1][1] + vec[2] * rot_mat[1][2];
2111     const float z_tmp = vec[0] * rot_mat[2][0] + vec[1] * rot_mat[2][1] + vec[2] * rot_mat[2][2];
2112
2113     vec[0] = x_tmp;
2114     vec[1] = y_tmp;
2115     vec[2] = z_tmp;
2116 }
2117
2118 static inline void set_mirror_modifier(int h_flip, int v_flip, int d_flip,
2119                                        float *modifier)
2120 {
2121     modifier[0] = h_flip ? -1.f : 1.f;
2122     modifier[1] = v_flip ? -1.f : 1.f;
2123     modifier[2] = d_flip ? -1.f : 1.f;
2124 }
2125
2126 static inline void mirror(const float *modifier, float *vec)
2127 {
2128     vec[0] *= modifier[0];
2129     vec[1] *= modifier[1];
2130     vec[2] *= modifier[2];
2131 }
2132
2133 static int allocate_plane(V360Context *s, int sizeof_uv, int sizeof_ker, int p)
2134 {
2135     s->u[p] = av_calloc(s->uv_linesize[p] * s->pr_height[p], sizeof_uv);
2136     s->v[p] = av_calloc(s->uv_linesize[p] * s->pr_height[p], sizeof_uv);
2137     if (!s->u[p] || !s->v[p])
2138         return AVERROR(ENOMEM);
2139     if (sizeof_ker) {
2140         s->ker[p] = av_calloc(s->uv_linesize[p] * s->pr_height[p], sizeof_ker);
2141         if (!s->ker[p])
2142             return AVERROR(ENOMEM);
2143     }
2144
2145     return 0;
2146 }
2147
2148 static void fov_from_dfov(V360Context *s, float w, float h)
2149 {
2150     const float da = tanf(0.5 * FFMIN(s->d_fov, 359.f) * M_PI / 180.f);
2151     const float d = hypotf(w, h);
2152
2153     s->h_fov = atan2f(da * w, d) * 360.f / M_PI;
2154     s->v_fov = atan2f(da * h, d) * 360.f / M_PI;
2155
2156     if (s->h_fov < 0.f)
2157         s->h_fov += 360.f;
2158     if (s->v_fov < 0.f)
2159         s->v_fov += 360.f;
2160 }
2161
2162 static void set_dimensions(int *outw, int *outh, int w, int h, const AVPixFmtDescriptor *desc)
2163 {
2164     outw[1] = outw[2] = FF_CEIL_RSHIFT(w, desc->log2_chroma_w);
2165     outw[0] = outw[3] = w;
2166     outh[1] = outh[2] = FF_CEIL_RSHIFT(h, desc->log2_chroma_h);
2167     outh[0] = outh[3] = h;
2168 }
2169
2170 static int config_output(AVFilterLink *outlink)
2171 {
2172     AVFilterContext *ctx = outlink->src;
2173     AVFilterLink *inlink = ctx->inputs[0];
2174     V360Context *s = ctx->priv;
2175     const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(inlink->format);
2176     const int depth = desc->comp[0].depth;
2177     int sizeof_uv;
2178     int sizeof_ker;
2179     int elements;
2180     int err;
2181     int h, w;
2182     int in_offset_h, in_offset_w;
2183     int out_offset_h, out_offset_w;
2184     float hf, wf;
2185     void (*in_transform)(const V360Context *s,
2186                          const float *vec, int width, int height,
2187                          uint16_t us[4][4], uint16_t vs[4][4], float *du, float *dv);
2188     void (*out_transform)(const V360Context *s,
2189                           int i, int j, int width, int height,
2190                           float *vec);
2191     void (*calculate_kernel)(float du, float dv, const XYRemap *rmap,
2192                              uint16_t *u, uint16_t *v, int16_t *ker);
2193     int (*prepare_out)(AVFilterContext *ctx);
2194
2195     s->input_mirror_modifier[0] = s->ih_flip ? -1.f : 1.f;
2196     s->input_mirror_modifier[1] = s->iv_flip ? -1.f : 1.f;
2197
2198     switch (s->interp) {
2199     case NEAREST:
2200         calculate_kernel = nearest_kernel;
2201         s->remap_slice = depth <= 8 ? remap1_8bit_slice : remap1_16bit_slice;
2202         elements = 1;
2203         sizeof_uv = sizeof(uint16_t) * elements;
2204         sizeof_ker = 0;
2205         break;
2206     case BILINEAR:
2207         calculate_kernel = bilinear_kernel;
2208         s->remap_slice = depth <= 8 ? remap2_8bit_slice : remap2_16bit_slice;
2209         elements = 2 * 2;
2210         sizeof_uv = sizeof(uint16_t) * elements;
2211         sizeof_ker = sizeof(uint16_t) * elements;
2212         break;
2213     case BICUBIC:
2214         calculate_kernel = bicubic_kernel;
2215         s->remap_slice = depth <= 8 ? remap4_8bit_slice : remap4_16bit_slice;
2216         elements = 4 * 4;
2217         sizeof_uv = sizeof(uint16_t) * elements;
2218         sizeof_ker = sizeof(uint16_t) * elements;
2219         break;
2220     case LANCZOS:
2221         calculate_kernel = lanczos_kernel;
2222         s->remap_slice = depth <= 8 ? remap4_8bit_slice : remap4_16bit_slice;
2223         elements = 4 * 4;
2224         sizeof_uv = sizeof(uint16_t) * elements;
2225         sizeof_ker = sizeof(uint16_t) * elements;
2226         break;
2227     default:
2228         av_assert0(0);
2229     }
2230
2231     ff_v360_init(s, depth);
2232
2233     for (int order = 0; order < NB_RORDERS; order++) {
2234         const char c = s->rorder[order];
2235         int rorder;
2236
2237         if (c == '\0') {
2238             av_log(ctx, AV_LOG_ERROR,
2239                    "Incomplete rorder option. Direction for all 3 rotation orders should be specified.\n");
2240             return AVERROR(EINVAL);
2241         }
2242
2243         rorder = get_rorder(c);
2244         if (rorder == -1) {
2245             av_log(ctx, AV_LOG_ERROR,
2246                    "Incorrect rotation order symbol '%c' in rorder option.\n", c);
2247             return AVERROR(EINVAL);
2248         }
2249
2250         s->rotation_order[order] = rorder;
2251     }
2252
2253     switch (s->in_stereo) {
2254     case STEREO_2D:
2255         w = inlink->w;
2256         h = inlink->h;
2257         in_offset_w = in_offset_h = 0;
2258         break;
2259     case STEREO_SBS:
2260         w = inlink->w / 2;
2261         h = inlink->h;
2262         in_offset_w = w;
2263         in_offset_h = 0;
2264         break;
2265     case STEREO_TB:
2266         w = inlink->w;
2267         h = inlink->h / 2;
2268         in_offset_w = 0;
2269         in_offset_h = h;
2270         break;
2271     default:
2272         av_assert0(0);
2273     }
2274
2275     set_dimensions(s->inplanewidth, s->inplaneheight, w, h, desc);
2276     set_dimensions(s->in_offset_w, s->in_offset_h, in_offset_w, in_offset_h, desc);
2277
2278     switch (s->in) {
2279     case EQUIRECTANGULAR:
2280         in_transform = xyz_to_equirect;
2281         err = 0;
2282         wf = w;
2283         hf = h;
2284         break;
2285     case CUBEMAP_3_2:
2286         in_transform = xyz_to_cube3x2;
2287         err = prepare_cube_in(ctx);
2288         wf = w / 3.f * 4.f;
2289         hf = h;
2290         break;
2291     case CUBEMAP_1_6:
2292         in_transform = xyz_to_cube1x6;
2293         err = prepare_cube_in(ctx);
2294         wf = w * 4.f;
2295         hf = h / 3.f;
2296         break;
2297     case CUBEMAP_6_1:
2298         in_transform = xyz_to_cube6x1;
2299         err = prepare_cube_in(ctx);
2300         wf = w / 3.f * 2.f;
2301         hf = h * 2.f;
2302         break;
2303     case EQUIANGULAR:
2304         in_transform = xyz_to_eac;
2305         err = prepare_eac_in(ctx);
2306         wf = w;
2307         hf = h / 9.f * 8.f;
2308         break;
2309     case FLAT:
2310         av_log(ctx, AV_LOG_ERROR, "Flat format is not accepted as input.\n");
2311         return AVERROR(EINVAL);
2312     case DUAL_FISHEYE:
2313         in_transform = xyz_to_dfisheye;
2314         err = 0;
2315         wf = w;
2316         hf = h;
2317         break;
2318     case BARREL:
2319         in_transform = xyz_to_barrel;
2320         err = 0;
2321         wf = w / 5.f * 4.f;
2322         hf = h;
2323         break;
2324     case STEREOGRAPHIC:
2325         in_transform = xyz_to_stereographic;
2326         err = 0;
2327         wf = w;
2328         hf = h / 2.f;
2329         break;
2330     default:
2331         av_log(ctx, AV_LOG_ERROR, "Specified input format is not handled.\n");
2332         return AVERROR_BUG;
2333     }
2334
2335     if (err != 0) {
2336         return err;
2337     }
2338
2339     switch (s->out) {
2340     case EQUIRECTANGULAR:
2341         out_transform = equirect_to_xyz;
2342         prepare_out = NULL;
2343         w = roundf(wf);
2344         h = roundf(hf);
2345         break;
2346     case CUBEMAP_3_2:
2347         out_transform = cube3x2_to_xyz;
2348         prepare_out = prepare_cube_out;
2349         w = roundf(wf / 4.f * 3.f);
2350         h = roundf(hf);
2351         break;
2352     case CUBEMAP_1_6:
2353         out_transform = cube1x6_to_xyz;
2354         prepare_out = prepare_cube_out;
2355         w = roundf(wf / 4.f);
2356         h = roundf(hf * 3.f);
2357         break;
2358     case CUBEMAP_6_1:
2359         out_transform = cube6x1_to_xyz;
2360         prepare_out = prepare_cube_out;
2361         w = roundf(wf / 2.f * 3.f);
2362         h = roundf(hf / 2.f);
2363         break;
2364     case EQUIANGULAR:
2365         out_transform = eac_to_xyz;
2366         prepare_out = prepare_eac_out;
2367         w = roundf(wf);
2368         h = roundf(hf / 8.f * 9.f);
2369         break;
2370     case FLAT:
2371         out_transform = flat_to_xyz;
2372         prepare_out = prepare_flat_out;
2373         w = roundf(wf);
2374         h = roundf(hf);
2375         break;
2376     case DUAL_FISHEYE:
2377         out_transform = dfisheye_to_xyz;
2378         prepare_out = NULL;
2379         w = roundf(wf);
2380         h = roundf(hf);
2381         break;
2382     case BARREL:
2383         out_transform = barrel_to_xyz;
2384         prepare_out = NULL;
2385         w = roundf(wf / 4.f * 5.f);
2386         h = roundf(hf);
2387         break;
2388     case STEREOGRAPHIC:
2389         out_transform = stereographic_to_xyz;
2390         prepare_out = prepare_stereographic_out;
2391         w = roundf(wf);
2392         h = roundf(hf * 2.f);
2393         break;
2394     default:
2395         av_log(ctx, AV_LOG_ERROR, "Specified output format is not handled.\n");
2396         return AVERROR_BUG;
2397     }
2398
2399     // Override resolution with user values if specified
2400     if (s->width > 0 && s->height > 0) {
2401         w = s->width;
2402         h = s->height;
2403     } else if (s->width > 0 || s->height > 0) {
2404         av_log(ctx, AV_LOG_ERROR, "Both width and height values should be specified.\n");
2405         return AVERROR(EINVAL);
2406     } else {
2407         if (s->out_transpose)
2408             FFSWAP(int, w, h);
2409
2410         if (s->in_transpose)
2411             FFSWAP(int, w, h);
2412     }
2413
2414     if (s->d_fov > 0.f)
2415         fov_from_dfov(s, w, h);
2416
2417     if (prepare_out) {
2418         err = prepare_out(ctx);
2419         if (err != 0)
2420             return err;
2421     }
2422
2423     set_dimensions(s->pr_width, s->pr_height, w, h, desc);
2424
2425     switch (s->out_stereo) {
2426     case STEREO_2D:
2427         out_offset_w = out_offset_h = 0;
2428         break;
2429     case STEREO_SBS:
2430         out_offset_w = w;
2431         out_offset_h = 0;
2432         w *= 2;
2433         break;
2434     case STEREO_TB:
2435         out_offset_w = 0;
2436         out_offset_h = h;
2437         h *= 2;
2438         break;
2439     default:
2440         av_assert0(0);
2441     }
2442
2443     set_dimensions(s->out_offset_w, s->out_offset_h, out_offset_w, out_offset_h, desc);
2444     set_dimensions(s->planewidth, s->planeheight, w, h, desc);
2445
2446     for (int i = 0; i < 4; i++)
2447         s->uv_linesize[i] = FFALIGN(s->pr_width[i], 8);
2448
2449     outlink->h = h;
2450     outlink->w = w;
2451
2452     s->nb_planes = av_pix_fmt_count_planes(inlink->format);
2453
2454     if (desc->log2_chroma_h == desc->log2_chroma_w && desc->log2_chroma_h == 0) {
2455         s->nb_allocated = 1;
2456         s->map[0] = s->map[1] = s->map[2] = s->map[3] = 0;
2457     } else {
2458         s->nb_allocated = 2;
2459         s->map[0] = 0;
2460         s->map[1] = s->map[2] = 1;
2461         s->map[3] = 0;
2462     }
2463
2464     for (int i = 0; i < s->nb_allocated; i++)
2465         allocate_plane(s, sizeof_uv, sizeof_ker, i);
2466
2467     calculate_rotation_matrix(s->yaw, s->pitch, s->roll, s->rot_mat, s->rotation_order);
2468     set_mirror_modifier(s->h_flip, s->v_flip, s->d_flip, s->output_mirror_modifier);
2469
2470     // Calculate remap data
2471     for (int p = 0; p < s->nb_allocated; p++) {
2472         const int width = s->pr_width[p];
2473         const int uv_linesize = s->uv_linesize[p];
2474         const int height = s->pr_height[p];
2475         const int in_width = s->inplanewidth[p];
2476         const int in_height = s->inplaneheight[p];
2477         float du, dv;
2478         float vec[3];
2479         XYRemap rmap;
2480
2481         for (int j = 0; j < height; j++) {
2482             for (int i = 0; i < width; i++) {
2483                 uint16_t *u = s->u[p] + (j * uv_linesize + i) * elements;
2484                 uint16_t *v = s->v[p] + (j * uv_linesize + i) * elements;
2485                 int16_t *ker = s->ker[p] + (j * uv_linesize + i) * elements;
2486
2487                 if (s->out_transpose)
2488                     out_transform(s, j, i, height, width, vec);
2489                 else
2490                     out_transform(s, i, j, width, height, vec);
2491                 av_assert1(!isnan(vec[0]) && !isnan(vec[1]) && !isnan(vec[2]));
2492                 rotate(s->rot_mat, vec);
2493                 av_assert1(!isnan(vec[0]) && !isnan(vec[1]) && !isnan(vec[2]));
2494                 normalize_vector(vec);
2495                 mirror(s->output_mirror_modifier, vec);
2496                 if (s->in_transpose)
2497                     in_transform(s, vec, in_height, in_width, rmap.v, rmap.u, &du, &dv);
2498                 else
2499                     in_transform(s, vec, in_width, in_height, rmap.u, rmap.v, &du, &dv);
2500                 av_assert1(!isnan(du) && !isnan(dv));
2501                 calculate_kernel(du, dv, &rmap, u, v, ker);
2502             }
2503         }
2504     }
2505
2506     return 0;
2507 }
2508
2509 static int filter_frame(AVFilterLink *inlink, AVFrame *in)
2510 {
2511     AVFilterContext *ctx = inlink->dst;
2512     AVFilterLink *outlink = ctx->outputs[0];
2513     V360Context *s = ctx->priv;
2514     AVFrame *out;
2515     ThreadData td;
2516
2517     out = ff_get_video_buffer(outlink, outlink->w, outlink->h);
2518     if (!out) {
2519         av_frame_free(&in);
2520         return AVERROR(ENOMEM);
2521     }
2522     av_frame_copy_props(out, in);
2523
2524     td.in = in;
2525     td.out = out;
2526
2527     ctx->internal->execute(ctx, s->remap_slice, &td, NULL, FFMIN(outlink->h, ff_filter_get_nb_threads(ctx)));
2528
2529     av_frame_free(&in);
2530     return ff_filter_frame(outlink, out);
2531 }
2532
2533 static av_cold void uninit(AVFilterContext *ctx)
2534 {
2535     V360Context *s = ctx->priv;
2536
2537     for (int p = 0; p < s->nb_allocated; p++) {
2538         av_freep(&s->u[p]);
2539         av_freep(&s->v[p]);
2540         av_freep(&s->ker[p]);
2541     }
2542 }
2543
2544 static const AVFilterPad inputs[] = {
2545     {
2546         .name         = "default",
2547         .type         = AVMEDIA_TYPE_VIDEO,
2548         .filter_frame = filter_frame,
2549     },
2550     { NULL }
2551 };
2552
2553 static const AVFilterPad outputs[] = {
2554     {
2555         .name         = "default",
2556         .type         = AVMEDIA_TYPE_VIDEO,
2557         .config_props = config_output,
2558     },
2559     { NULL }
2560 };
2561
2562 AVFilter ff_vf_v360 = {
2563     .name          = "v360",
2564     .description   = NULL_IF_CONFIG_SMALL("Convert 360 projection of video."),
2565     .priv_size     = sizeof(V360Context),
2566     .uninit        = uninit,
2567     .query_formats = query_formats,
2568     .inputs        = inputs,
2569     .outputs       = outputs,
2570     .priv_class    = &v360_class,
2571     .flags         = AVFILTER_FLAG_SLICE_THREADS,
2572 };