e7f605db2fa95f147f77055998eb45a130900b75
[platform/upstream/gstreamer.git] / sys / kms / gstkmsutils.c
1 /* GStreamer
2  *
3  * Copyright (C) 2016 Igalia
4  *
5  * Authors:
6  *  Víctor Manuel Jáquez Leal <vjaquez@igalia.com>
7  *  Javier Martin <javiermartin@by.com.es>
8  *
9  * This library is free software; you can redistribute it and/or
10  * modify it under the terms of the GNU Library General Public
11  * License as published by the Free Software Foundation; either
12  * version 2 of the License, or (at your option) any later version.
13  *
14  * This library is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17  * Library General Public License for more details.
18  *
19  * You should have received a copy of the GNU Library General Public
20  * License along with this library; if not, write to the
21  * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
22  * Boston, MA 02110-1301, USA.
23  *
24  */
25
26 #ifdef HAVE_CONFIG_H
27 #include "config.h"
28 #endif
29
30 #include <drm_fourcc.h>
31
32 #include "gstkmsutils.h"
33
34 /* *INDENT-OFF* */
35 static const struct
36 {
37   guint32 fourcc;
38   GstVideoFormat format;
39 } format_map[] = {
40 #define DEF_FMT(fourcc, fmt) \
41   { DRM_FORMAT_##fourcc,GST_VIDEO_FORMAT_##fmt }
42
43   /* DEF_FMT (XRGB1555, ???), */
44   /* DEF_FMT (XBGR1555, ???), */
45 #if G_BYTE_ORDER == G_LITTLE_ENDIAN
46   DEF_FMT (ARGB8888, BGRA),
47   DEF_FMT (XRGB8888, BGRx),
48   DEF_FMT (ABGR8888, RGBA),
49   DEF_FMT (XBGR8888, RGBx),
50 #else
51   DEF_FMT (ARGB8888, ARGB),
52   DEF_FMT (XRGB8888, xRGB),
53   DEF_FMT (ABGR8888, ABGR),
54   DEF_FMT (XBGR8888, xBGR),
55 #endif
56   /* DEF_FMT (YUYV, ???), */
57   /* DEF_FMT (YVYU, ???), */
58   DEF_FMT (YUV420, I420),
59   DEF_FMT (YVU420, YV12),
60   DEF_FMT (YUV422, Y42B),
61   DEF_FMT (NV12, NV12),
62   DEF_FMT (NV21, NV21),
63   DEF_FMT (NV16, NV16),
64
65 #undef DEF_FMT
66 };
67 /* *INDENT-ON* */
68
69 GstVideoFormat
70 gst_video_format_from_drm (guint32 drmfmt)
71 {
72   gint i;
73
74   for (i = 0; i < G_N_ELEMENTS (format_map); i++) {
75     if (format_map[i].fourcc == drmfmt)
76       return format_map[i].format;
77   }
78
79   return GST_VIDEO_FORMAT_UNKNOWN;
80 }
81
82 guint32
83 gst_drm_format_from_video (GstVideoFormat fmt)
84 {
85   gint i;
86
87   for (i = 0; i < G_N_ELEMENTS (format_map); i++) {
88     if (format_map[i].format == fmt)
89       return format_map[i].fourcc;
90   }
91
92   return 0;
93 }
94
95 static GstStructure *
96 gst_video_format_to_structure (GstVideoFormat format)
97 {
98   GstStructure *structure;
99
100   structure = NULL;
101   if (format != GST_VIDEO_FORMAT_UNKNOWN)
102     structure = gst_structure_new ("video/x-raw", "format", G_TYPE_STRING,
103         gst_video_format_to_string (format), NULL);
104
105   return structure;
106 }
107
108 GstCaps *
109 gst_kms_sink_caps_template_fill (void)
110 {
111   gint i;
112   GstCaps *caps;
113   GstStructure *template;
114
115   caps = gst_caps_new_empty ();
116   for (i = 0; i < G_N_ELEMENTS (format_map); i++) {
117     template = gst_video_format_to_structure (format_map[i].format);
118     gst_structure_set (template,
119         "width", GST_TYPE_INT_RANGE, 1, G_MAXINT,
120         "height", GST_TYPE_INT_RANGE, 1, G_MAXINT,
121         "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, G_MAXINT, 1, NULL);
122     gst_caps_append_structure (caps, template);
123   }
124   return gst_caps_simplify (caps);
125 }
126
127 static const gint device_par_map[][2] = {
128   {1, 1},                       /* regular screen */
129   {16, 15},                     /* PAL TV */
130   {11, 10},                     /* 525 line Rec.601 video */
131   {54, 59},                     /* 625 line Rec.601 video */
132   {64, 45},                     /* 1280x1024 on 16:9 display */
133   {5, 3},                       /* 1280x1024 on 4:3 display */
134   {4, 3}                        /* 800x600 on 16:9 display */
135 };
136
137 #define DELTA(ratio, idx, w) \
138   (ABS(ratio - ((gdouble)device_par_map[idx][w] / device_par_map[idx][!(w)])))
139
140 void
141 gst_video_calculate_device_ratio (guint dev_width, guint dev_height,
142     guint dev_width_mm, guint dev_height_mm,
143     guint * dpy_par_n, guint * dpy_par_d)
144 {
145   gdouble ratio, delta, cur_delta;
146   gint i, j, index, windex;
147
148   /* First, calculate the "real" ratio based on the X values; which is
149    * the "physical" w/h divided by the w/h in pixels of the display */
150   if (dev_width == 0 || dev_height == 0
151       || dev_width_mm == 0 || dev_height_mm == 0)
152     ratio = 1.0;
153   else
154     ratio = (gdouble) (dev_width_mm * dev_height) / (dev_height_mm * dev_width);
155
156   /* Now, find the one from device_par_map[][2] with the lowest delta
157    * to the real one */
158   delta = DELTA (ratio, 0, 0);
159   index = 0;
160   windex = 0;
161
162   for (i = 1; i < G_N_ELEMENTS (device_par_map); i++) {
163     for (j = 0; j < 2; j++) {
164       cur_delta = DELTA (ratio, i, j);
165       if (cur_delta < delta) {
166         index = i;
167         windex = j;
168         delta = cur_delta;
169       }
170     }
171   }
172
173   if (dpy_par_n)
174     *dpy_par_n = device_par_map[index][windex];
175
176   if (dpy_par_d)
177     *dpy_par_d = device_par_map[index][windex ^ 1];
178 }