1cabdff1aSopenharmony_ci/*
2cabdff1aSopenharmony_ci * Copyright (c) 2014 Vittorio Giovara <vittorio.giovara@gmail.com>
3cabdff1aSopenharmony_ci *
4cabdff1aSopenharmony_ci * This file is part of FFmpeg.
5cabdff1aSopenharmony_ci *
6cabdff1aSopenharmony_ci * FFmpeg is free software; you can redistribute it and/or
7cabdff1aSopenharmony_ci * modify it under the terms of the GNU Lesser General Public
8cabdff1aSopenharmony_ci * License as published by the Free Software Foundation; either
9cabdff1aSopenharmony_ci * version 2.1 of the License, or (at your option) any later version.
10cabdff1aSopenharmony_ci *
11cabdff1aSopenharmony_ci * FFmpeg is distributed in the hope that it will be useful,
12cabdff1aSopenharmony_ci * but WITHOUT ANY WARRANTY; without even the implied warranty of
13cabdff1aSopenharmony_ci * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14cabdff1aSopenharmony_ci * Lesser General Public License for more details.
15cabdff1aSopenharmony_ci *
16cabdff1aSopenharmony_ci * You should have received a copy of the GNU Lesser General Public
17cabdff1aSopenharmony_ci * License along with FFmpeg; if not, write to the Free Software
18cabdff1aSopenharmony_ci * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19cabdff1aSopenharmony_ci */
20cabdff1aSopenharmony_ci
21cabdff1aSopenharmony_ci#include <stdint.h>
22cabdff1aSopenharmony_ci#include <string.h>
23cabdff1aSopenharmony_ci#include <math.h>
24cabdff1aSopenharmony_ci
25cabdff1aSopenharmony_ci#include "display.h"
26cabdff1aSopenharmony_ci#include "libm.h"
27cabdff1aSopenharmony_ci#include "mathematics.h"
28cabdff1aSopenharmony_ci
29cabdff1aSopenharmony_ci// fixed point to double
30cabdff1aSopenharmony_ci#define CONV_FP(x) ((double) (x)) / (1 << 16)
31cabdff1aSopenharmony_ci
32cabdff1aSopenharmony_ci// double to fixed point
33cabdff1aSopenharmony_ci#define CONV_DB(x) (int32_t) ((x) * (1 << 16))
34cabdff1aSopenharmony_ci
35cabdff1aSopenharmony_cidouble av_display_rotation_get(const int32_t matrix[9])
36cabdff1aSopenharmony_ci{
37cabdff1aSopenharmony_ci    double rotation, scale[2];
38cabdff1aSopenharmony_ci
39cabdff1aSopenharmony_ci    scale[0] = hypot(CONV_FP(matrix[0]), CONV_FP(matrix[3]));
40cabdff1aSopenharmony_ci    scale[1] = hypot(CONV_FP(matrix[1]), CONV_FP(matrix[4]));
41cabdff1aSopenharmony_ci
42cabdff1aSopenharmony_ci    if (scale[0] == 0.0 || scale[1] == 0.0)
43cabdff1aSopenharmony_ci        return NAN;
44cabdff1aSopenharmony_ci
45cabdff1aSopenharmony_ci    rotation = atan2(CONV_FP(matrix[1]) / scale[1],
46cabdff1aSopenharmony_ci                     CONV_FP(matrix[0]) / scale[0]) * 180 / M_PI;
47cabdff1aSopenharmony_ci
48cabdff1aSopenharmony_ci    return -rotation;
49cabdff1aSopenharmony_ci}
50cabdff1aSopenharmony_ci
51cabdff1aSopenharmony_civoid av_display_rotation_set(int32_t matrix[9], double angle)
52cabdff1aSopenharmony_ci{
53cabdff1aSopenharmony_ci    double radians = -angle * M_PI / 180.0f;
54cabdff1aSopenharmony_ci    double c = cos(radians);
55cabdff1aSopenharmony_ci    double s = sin(radians);
56cabdff1aSopenharmony_ci
57cabdff1aSopenharmony_ci    memset(matrix, 0, 9 * sizeof(int32_t));
58cabdff1aSopenharmony_ci
59cabdff1aSopenharmony_ci    matrix[0] = CONV_DB(c);
60cabdff1aSopenharmony_ci    matrix[1] = CONV_DB(-s);
61cabdff1aSopenharmony_ci    matrix[3] = CONV_DB(s);
62cabdff1aSopenharmony_ci    matrix[4] = CONV_DB(c);
63cabdff1aSopenharmony_ci    matrix[8] = 1 << 30;
64cabdff1aSopenharmony_ci}
65cabdff1aSopenharmony_ci
66cabdff1aSopenharmony_civoid av_display_matrix_flip(int32_t matrix[9], int hflip, int vflip)
67cabdff1aSopenharmony_ci{
68cabdff1aSopenharmony_ci    int i;
69cabdff1aSopenharmony_ci    const int flip[] = { 1 - 2 * (!!hflip), 1 - 2 * (!!vflip), 1 };
70cabdff1aSopenharmony_ci
71cabdff1aSopenharmony_ci    if (hflip || vflip)
72cabdff1aSopenharmony_ci        for (i = 0; i < 9; i++)
73cabdff1aSopenharmony_ci            matrix[i] *= flip[i % 3];
74cabdff1aSopenharmony_ci}
75