setup_omap_layer: handle bad arguments better
[sdl_omap.git] / src / video / omapdss / osdl_video.c
CommitLineData
f641fccb 1/*
f9b3f440 2 * (C) GraÅžvydas "notaz" Ignotas, 2010-2011
f641fccb 3 *
4 * This work is licensed under the terms of the GNU LGPL, version 2.1 or later.
5 * See the COPYING file in the top-level directory.
6 */
7
8#include <stdio.h>
9#include <stdlib.h>
10#include <string.h>
11#include <strings.h>
12#include <ctype.h>
13#include <sys/types.h>
14#include <sys/stat.h>
15#include <fcntl.h>
16#include <sys/ioctl.h>
17#include <unistd.h>
18#include <linux/fb.h>
19
20#include "omapsdl.h"
21#include "omapfb.h"
22#include "linux/fbdev.h"
f9b3f440 23#include "linux/xenv.h"
f641fccb 24
25struct omapfb_saved_layer {
26 struct omapfb_plane_info pi;
27 struct omapfb_mem_info mi;
28};
29
b9a19b44 30static const char *get_fb_device(void)
31{
32 const char *fbname = getenv("SDL_FBDEV");
33 if (fbname == NULL)
34 fbname = "/dev/fb1";
35
36 return fbname;
37}
38
f641fccb 39static int osdl_setup_omapfb(int fd, int enabled, int x, int y, int w, int h, int mem)
40{
41 struct omapfb_plane_info pi;
42 struct omapfb_mem_info mi;
43 int ret;
44
5f4b1fd3 45 memset(&pi, 0, sizeof(pi));
46 memset(&mi, 0, sizeof(mi));
47
f641fccb 48 ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);
49 if (ret != 0) {
7b66578c 50 err_perror("QUERY_PLANE");
f641fccb 51 return -1;
52 }
53
54 ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);
55 if (ret != 0) {
7b66578c 56 err_perror("QUERY_MEM");
f641fccb 57 return -1;
58 }
59
60 /* must disable when changing stuff */
61 if (pi.enabled) {
62 pi.enabled = 0;
63 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
64 if (ret != 0)
7b66578c 65 err_perror("SETUP_PLANE");
f641fccb 66 }
67
13f953aa 68 if (mi.size < mem) {
69 mi.size = mem;
70 ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);
71 if (ret != 0) {
72 err_perror("SETUP_MEM");
73 return -1;
74 }
f641fccb 75 }
76
77 pi.pos_x = x;
78 pi.pos_y = y;
79 pi.out_width = w;
80 pi.out_height = h;
81 pi.enabled = enabled;
82
83 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
84 if (ret != 0) {
7b66578c 85 err_perror("SETUP_PLANE");
6f13ad97 86 err("(%d %d %d %d)\n", x, y, w, h);
f641fccb 87 return -1;
88 }
89
90 return 0;
91}
92
93static int read_sysfs(const char *fname, char *buff, size_t size)
94{
95 FILE *f;
96 int ret;
97
98 f = fopen(fname, "r");
99 if (f == NULL) {
7b66578c 100 err_perror("open %s: ", fname);
f641fccb 101 return -1;
102 }
103
104 ret = fread(buff, 1, size - 1, f);
105 fclose(f);
106 if (ret <= 0) {
7b66578c 107 err_perror("read %s: ", fname);
f641fccb 108 return -1;
109 }
110
111 buff[ret] = 0;
112 for (ret--; ret >= 0 && isspace(buff[ret]); ret--)
113 buff[ret] = 0;
114
115 return 0;
116}
117
b9a19b44 118int osdl_video_detect_screen(struct SDL_PrivateVideoData *pdata)
f641fccb 119{
f641fccb 120 int fb_id, overlay_id = -1, screen_id = -1;
b9a19b44 121 struct fb_var_screeninfo fbvar;
f641fccb 122 char buff[64], screen_name[64];
b9a19b44 123 const char *fbname;
f641fccb 124 struct stat status;
b9a19b44 125 int fd, i, ret;
126 int w, h;
f641fccb 127 FILE *f;
128
5f4b1fd3 129 pdata->phys_w = pdata->phys_h = 0;
130
b9a19b44 131 fbname = get_fb_device();
f641fccb 132
b9a19b44 133 /* Figure out screen resolution, we need to know default resolution
134 * to report to SDL and for centering stuff.
f641fccb 135 * The only way to achieve this seems to be walking some sysfs files.. */
136 ret = stat(fbname, &status);
137 if (ret != 0) {
7b66578c 138 err_perror("can't stat %s", fbname);
b9a19b44 139 goto skip_screen;
f641fccb 140 }
141 fb_id = minor(status.st_rdev);
142
143 snprintf(buff, sizeof(buff), "/sys/class/graphics/fb%d/overlays", fb_id);
144 f = fopen(buff, "r");
145 if (f == NULL) {
7b66578c 146 err("can't open %s, skip screen detection", buff);
f641fccb 147 goto skip_screen;
148 }
149
150 ret = fscanf(f, "%d", &overlay_id);
151 fclose(f);
152 if (ret != 1) {
7b66578c 153 err("can't parse %s, skip screen detection", buff);
f641fccb 154 goto skip_screen;
155 }
156
157 snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/overlay%d/manager", overlay_id);
158 ret = read_sysfs(buff, screen_name, sizeof(screen_name));
159 if (ret < 0) {
7b66578c 160 err("skip screen detection");
f641fccb 161 goto skip_screen;
162 }
163
164 for (i = 0; ; i++) {
165 snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/name", i);
166 ret = read_sysfs(buff, buff, sizeof(buff));
167 if (ret < 0)
168 break;
169
170 if (strcmp(screen_name, buff) == 0) {
171 screen_id = i;
172 break;
173 }
174 }
175
176 if (screen_id < 0) {
7b66578c 177 err("could not find screen");
f641fccb 178 goto skip_screen;
179 }
180
181 snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/timings", screen_id);
182 f = fopen(buff, "r");
183 if (f == NULL) {
7b66578c 184 err("can't open %s, skip screen detection", buff);
f641fccb 185 goto skip_screen;
186 }
187
b9a19b44 188 ret = fscanf(f, "%*d,%d/%*d/%*d/%*d,%d/%*d/%*d/%*d", &w, &h);
f641fccb 189 fclose(f);
190 if (ret != 2) {
7b66578c 191 err("can't parse %s (%d), skip screen detection", buff, ret);
f641fccb 192 goto skip_screen;
193 }
194
7b66578c 195 log("detected %dx%d '%s' (%d) screen attached to fb %d and overlay %d",
b9a19b44 196 w, h, screen_name, screen_id, fb_id, overlay_id);
197
5f4b1fd3 198 pdata->phys_w = w;
199 pdata->phys_h = h;
b9a19b44 200 return 0;
f641fccb 201
202skip_screen:
b9a19b44 203 /* attempt to extract this from FB then */
204 fd = open(fbname, O_RDWR);
205 if (fd == -1) {
206 err_perror("open %s", fbname);
207 return -1;
208 }
209
210 ret = ioctl(fd, FBIOGET_VSCREENINFO, &fbvar);
211 close(fd);
212 if (ret == -1) {
213 err_perror("ioctl %s", fbname);
214 return -1;
215 }
216
217 if (fbvar.xres == 0 || fbvar.yres == 0) {
218 err("VSCREENINFO has nothing meaningful");
219 return -1;
220 }
221
5f4b1fd3 222 pdata->phys_w = fbvar.xres;
223 pdata->phys_h = fbvar.yres;
b9a19b44 224 return 0;
225}
226
227static int osdl_setup_omap_layer(struct SDL_PrivateVideoData *pdata,
228 const char *fbname, int width, int height, int bpp)
229{
230 int x = 0, y = 0, w = width, h = height; /* layer size and pos */
231 int screen_w = w, screen_h = h;
f151701d 232 int tmp_w, tmp_h;
b9a19b44 233 const char *tmp;
f11c56a6 234 int retval = -1;
b9a19b44 235 int ret, fd;
236
5f4b1fd3 237 pdata->layer_x = pdata->layer_y = pdata->layer_w = pdata->layer_h = 0;
238
239 if (pdata->phys_w != 0)
240 screen_w = pdata->phys_w;
241 if (pdata->phys_h != 0)
242 screen_h = pdata->phys_h;
b9a19b44 243
244 fd = open(fbname, O_RDWR);
245 if (fd == -1) {
246 err_perror("open %s", fbname);
247 return -1;
248 }
249
250 /* FIXME: assuming layer doesn't change here */
251 if (pdata->saved_layer == NULL) {
252 struct omapfb_saved_layer *slayer;
253 slayer = calloc(1, sizeof(*slayer));
254 if (slayer == NULL)
f11c56a6 255 goto out;
b9a19b44 256
257 ret = ioctl(fd, OMAPFB_QUERY_PLANE, &slayer->pi);
258 if (ret != 0) {
259 err_perror("QUERY_PLANE");
f11c56a6 260 goto out;
b9a19b44 261 }
262
263 ret = ioctl(fd, OMAPFB_QUERY_MEM, &slayer->mi);
264 if (ret != 0) {
265 err_perror("QUERY_MEM");
f11c56a6 266 goto out;
b9a19b44 267 }
268
269 pdata->saved_layer = slayer;
270 }
271
f641fccb 272 tmp = getenv("SDL_OMAP_LAYER_SIZE");
273 if (tmp != NULL) {
f641fccb 274 if (strcasecmp(tmp, "fullscreen") == 0)
275 w = screen_w, h = screen_h;
f151701d 276 else if (sscanf(tmp, "%dx%d", &tmp_w, &tmp_h) == 2)
277 w = tmp_w, h = tmp_h;
f641fccb 278 else
7b66578c 279 err("layer size specified incorrectly, "
280 "should be like 800x480");
f641fccb 281 }
f11c56a6 282
283 /* the layer can't be set larger than screen */
284 tmp_w = w, tmp_h = h;
285 if (w > screen_w)
286 w = screen_w;
287 if (h > screen_h)
288 h = screen_h;
289 if (w != tmp_w || h != tmp_h)
290 log("layer resized %dx%d -> %dx%d to fit screen", tmp_w, tmp_h, w, h);
f641fccb 291
292 x = screen_w / 2 - w / 2;
293 y = screen_h / 2 - h / 2;
f9b3f440 294 ret = osdl_setup_omapfb(fd, 1, x, y, w, h, width * height * ((bpp + 7) / 8) * 2);
5f4b1fd3 295 if (ret == 0) {
296 pdata->layer_x = x;
297 pdata->layer_y = y;
298 pdata->layer_w = w;
299 pdata->layer_h = h;
300 }
f641fccb 301
f11c56a6 302 retval = ret;
303out:
304 close(fd);
305 return retval;
f641fccb 306}
307
455c8c43 308void *osdl_video_set_mode(struct SDL_PrivateVideoData *pdata,
309 int border_l, int border_r, int border_t, int border_b,
310 int width, int height, int bpp, int doublebuf)
f641fccb 311{
312 const char *fbname;
455c8c43 313 void *result;
f641fccb 314 int ret;
315
b9a19b44 316 fbname = get_fb_device();
f641fccb 317
318 if (pdata->fbdev != NULL) {
319 vout_fbdev_finish(pdata->fbdev);
320 pdata->fbdev = NULL;
321 }
322
f641fccb 323 ret = osdl_setup_omap_layer(pdata, fbname, width, height, bpp);
324 if (ret < 0)
455c8c43 325 return NULL;
f641fccb 326
0bb19c41 327 pdata->fbdev = vout_fbdev_init(fbname, &width, &height, bpp, doublebuf ? 2 : 1);
f641fccb 328 if (pdata->fbdev == NULL)
455c8c43 329 return NULL;
330
331 if (border_l | border_r | border_t | border_b) {
332 width -= border_l + border_r;
333 height -= border_t + border_b;
334 result = vout_fbdev_resize(pdata->fbdev, width, height, bpp,
335 border_l, border_r, border_t, border_b, doublebuf ? 2 : 1);
336 }
337 else {
338 result = osdl_video_flip(pdata);
339 }
340 if (result == NULL) {
341 osdl_video_finish(pdata);
342 return NULL;
343 }
f641fccb 344
f9b3f440 345 if (!pdata->xenv_up) {
346 ret = xenv_init();
347 if (ret == 0)
348 pdata->xenv_up = 1;
f641fccb 349 }
350
455c8c43 351 return result;
f641fccb 352}
353
354void *osdl_video_flip(struct SDL_PrivateVideoData *pdata)
355{
356 if (pdata->fbdev == NULL)
357 return NULL;
358
5f4b1fd3 359 if (pdata->cfg_force_vsync)
f641fccb 360 vout_fbdev_wait_vsync(pdata->fbdev);
361
362 return vout_fbdev_flip(pdata->fbdev);
363}
364
365void osdl_video_finish(struct SDL_PrivateVideoData *pdata)
366{
367 static const char *fbname;
368
b9a19b44 369 fbname = get_fb_device();
f641fccb 370 if (pdata->fbdev != NULL) {
371 vout_fbdev_finish(pdata->fbdev);
372 pdata->fbdev = NULL;
373 }
374
375 /* restore the OMAP layer */
376 if (pdata->saved_layer != NULL) {
377 struct omapfb_saved_layer *slayer = pdata->saved_layer;
378 int fd;
379
380 fd = open(fbname, O_RDWR);
381 if (fd != -1) {
382 int enabled = slayer->pi.enabled;
383
384 /* be sure to disable while setting up */
385 slayer->pi.enabled = 0;
386 ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
387 ioctl(fd, OMAPFB_SETUP_MEM, &slayer->mi);
388 if (enabled) {
389 slayer->pi.enabled = enabled;
390 ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
391 }
392 close(fd);
393 }
394 free(slayer);
395 pdata->saved_layer = NULL;
396 }
397
f9b3f440 398 if (pdata->xenv_up) {
399 xenv_finish();
400 pdata->xenv_up = 0;
f641fccb 401 }
402}
403