kmssink: enable UYVY, YUY2, and YVYU (interleaved YUV 4:2:2) formats
[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 (UYVY, UYVY),
57   DEF_FMT (YUYV, YUY2),
58   DEF_FMT (YVYU, YVYU),
59   DEF_FMT (YUV420, I420),
60   DEF_FMT (YVU420, YV12),
61   DEF_FMT (YUV422, Y42B),
62   DEF_FMT (NV12, NV12),
63   DEF_FMT (NV21, NV21),
64   DEF_FMT (NV16, NV16),
65
66 #undef DEF_FMT
67 };
68 /* *INDENT-ON* */
69
70 GstVideoFormat
71 gst_video_format_from_drm (guint32 drmfmt)
72 {
73   gint i;
74
75   for (i = 0; i < G_N_ELEMENTS (format_map); i++) {
76     if (format_map[i].fourcc == drmfmt)
77       return format_map[i].format;
78   }
79
80   return GST_VIDEO_FORMAT_UNKNOWN;
81 }
82
83 guint32
84 gst_drm_format_from_video (GstVideoFormat fmt)
85 {
86   gint i;
87
88   for (i = 0; i < G_N_ELEMENTS (format_map); i++) {
89     if (format_map[i].format == fmt)
90       return format_map[i].fourcc;
91   }
92
93   return 0;
94 }
95
96 static GstStructure *
97 gst_video_format_to_structure (GstVideoFormat format)
98 {
99   GstStructure *structure;
100
101   structure = NULL;
102   if (format != GST_VIDEO_FORMAT_UNKNOWN)
103     structure = gst_structure_new ("video/x-raw", "format", G_TYPE_STRING,
104         gst_video_format_to_string (format), NULL);
105
106   return structure;
107 }
108
109 GstCaps *
110 gst_kms_sink_caps_template_fill (void)
111 {
112   gint i;
113   GstCaps *caps;
114   GstStructure *template;
115
116   caps = gst_caps_new_empty ();
117   for (i = 0; i < G_N_ELEMENTS (format_map); i++) {
118     template = gst_video_format_to_structure (format_map[i].format);
119     gst_structure_set (template,
120         "width", GST_TYPE_INT_RANGE, 1, G_MAXINT,
121         "height", GST_TYPE_INT_RANGE, 1, G_MAXINT,
122         "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, G_MAXINT, 1, NULL);
123     gst_caps_append_structure (caps, template);
124   }
125   return gst_caps_simplify (caps);
126 }
127
128 static const gint device_par_map[][2] = {
129   {1, 1},                       /* regular screen */
130   {16, 15},                     /* PAL TV */
131   {11, 10},                     /* 525 line Rec.601 video */
132   {54, 59},                     /* 625 line Rec.601 video */
133   {64, 45},                     /* 1280x1024 on 16:9 display */
134   {5, 3},                       /* 1280x1024 on 4:3 display */
135   {4, 3}                        /* 800x600 on 16:9 display */
136 };
137
138 #define DELTA(ratio, idx, w) \
139   (ABS(ratio - ((gdouble)device_par_map[idx][w] / device_par_map[idx][!(w)])))
140
141 void
142 gst_video_calculate_device_ratio (guint dev_width, guint dev_height,
143     guint dev_width_mm, guint dev_height_mm,
144     guint * dpy_par_n, guint * dpy_par_d)
145 {
146   gdouble ratio, delta, cur_delta;
147   gint i, j, index, windex;
148
149   /* First, calculate the "real" ratio based on the X values; which is
150    * the "physical" w/h divided by the w/h in pixels of the display */
151   if (dev_width == 0 || dev_height == 0
152       || dev_width_mm == 0 || dev_height_mm == 0)
153     ratio = 1.0;
154   else
155     ratio = (gdouble) (dev_width_mm * dev_height) / (dev_height_mm * dev_width);
156
157   /* Now, find the one from device_par_map[][2] with the lowest delta
158    * to the real one */
159   delta = DELTA (ratio, 0, 0);
160   index = 0;
161   windex = 0;
162
163   for (i = 1; i < G_N_ELEMENTS (device_par_map); i++) {
164     for (j = 0; j < 2; j++) {
165       cur_delta = DELTA (ratio, i, j);
166       if (cur_delta < delta) {
167         index = i;
168         windex = j;
169         delta = cur_delta;
170       }
171     }
172   }
173
174   if (dpy_par_n)
175     *dpy_par_n = device_par_map[index][windex];
176
177   if (dpy_par_d)
178     *dpy_par_d = device_par_map[index][windex ^ 1];
179 }