fbdev: resize: do single ioctl in nonerror path
[picodrive.git] / platform / linux / fbdev.c
CommitLineData
9f6bb3c7 1/*
2 * (C) GraÅžvydas "notaz" Ignotas, 2009-2010
3 *
9c5a64a0 4 * This work is licensed under the terms of any of these licenses
5 * (at your option):
6 * - GNU GPL, version 2 or later.
7 * - GNU LGPL, version 2.1 or later.
9f6bb3c7 8 * See the COPYING file in the top-level directory.
9 */
10
d08e7326 11#include <stdio.h>
b9fe67c6 12#include <stdlib.h>
d08e7326 13#include <string.h>
14#include <sys/types.h>
15#include <sys/stat.h>
16#include <fcntl.h>
17#include <sys/ioctl.h>
18#include <sys/mman.h>
19#include <unistd.h>
20#include <linux/fb.h>
21#include <linux/matroxfb.h>
22
d08e7326 23#include "fbdev.h"
24
b9fe67c6 25struct vout_fbdev {
26 int fd;
27 void *mem;
28 size_t mem_size;
29 struct fb_var_screeninfo fbvar_old;
30 struct fb_var_screeninfo fbvar_new;
31 int buffer_write;
207e58ef 32 int fb_size;
b9fe67c6 33 int buffer_count;
207e58ef 34 int top_border, bottom_border;
b9fe67c6 35};
36
37void *vout_fbdev_flip(struct vout_fbdev *fbdev)
d08e7326 38{
39 int draw_buf;
40
b9fe67c6 41 if (fbdev->buffer_count < 2)
42 return fbdev->mem;
d08e7326 43
b9fe67c6 44 draw_buf = fbdev->buffer_write;
45 fbdev->buffer_write++;
46 if (fbdev->buffer_write >= fbdev->buffer_count)
47 fbdev->buffer_write = 0;
d08e7326 48
207e58ef 49 fbdev->fbvar_new.yoffset =
50 (fbdev->top_border + fbdev->fbvar_new.yres + fbdev->bottom_border) * draw_buf +
51 fbdev->top_border;
89e6909b 52
b9fe67c6 53 ioctl(fbdev->fd, FBIOPAN_DISPLAY, &fbdev->fbvar_new);
54
207e58ef 55 return (char *)fbdev->mem + fbdev->fb_size * fbdev->buffer_write;
d08e7326 56}
57
b9fe67c6 58void vout_fbdev_wait_vsync(struct vout_fbdev *fbdev)
d08e7326 59{
60 int arg = 0;
b9fe67c6 61 ioctl(fbdev->fd, FBIO_WAITFORVSYNC, &arg);
d08e7326 62}
63
0238dca9 64/* it is recommended to call vout_fbdev_clear() before this */
65void *vout_fbdev_resize(struct vout_fbdev *fbdev, int w, int h, int bpp,
fcd1cdf7 66 int left_border, int right_border, int top_border, int bottom_border, int buffer_cnt)
207e58ef 67{
68 int w_total = left_border + w + right_border;
69 int h_total = top_border + h + bottom_border;
70 size_t mem_size;
71 int ret;
72
73 // unblank to be sure the mode is really accepted
74 ioctl(fbdev->fd, FBIOBLANK, FB_BLANK_UNBLANK);
75
fcd1cdf7 76 if (fbdev->fbvar_new.bits_per_pixel != bpp ||
5cf498af 77 fbdev->fbvar_new.xres != w ||
78 fbdev->fbvar_new.yres != h ||
79 fbdev->fbvar_new.xres_virtual != w_total||
80 fbdev->fbvar_new.yres_virtual < h_total ||
81 fbdev->fbvar_new.xoffset != left_border ||
82 fbdev->buffer_count != buffer_cnt)
83 {
84 if (fbdev->fbvar_new.bits_per_pixel != bpp ||
85 w != fbdev->fbvar_new.xres || h != fbdev->fbvar_new.yres)
86 printf(" switching to %dx%d@%d\n", w, h, bpp);
87
207e58ef 88 fbdev->fbvar_new.xres = w;
89 fbdev->fbvar_new.yres = h;
90 fbdev->fbvar_new.xres_virtual = w_total;
5cf498af 91 fbdev->fbvar_new.yres_virtual = h_total * buffer_cnt;
207e58ef 92 fbdev->fbvar_new.xoffset = left_border;
0238dca9 93 fbdev->fbvar_new.yoffset = top_border;
fcd1cdf7 94 fbdev->fbvar_new.bits_per_pixel = bpp;
5cf498af 95 fbdev->buffer_count = buffer_cnt;
96 fbdev->buffer_write = 1;
0238dca9 97
98 // seems to help a bit to avoid glitches
99 vout_fbdev_wait_vsync(fbdev);
100
207e58ef 101 ret = ioctl(fbdev->fd, FBIOPUT_VSCREENINFO, &fbdev->fbvar_new);
102 if (ret == -1) {
5cf498af 103 // retry with no multibuffering
104 fbdev->fbvar_new.yres_virtual = h_total;
105 ret = ioctl(fbdev->fd, FBIOPUT_VSCREENINFO, &fbdev->fbvar_new);
106 if (ret == -1) {
107 perror("FBIOPUT_VSCREENINFO ioctl");
108 return NULL;
109 }
207e58ef 110 fbdev->buffer_count = 1;
0238dca9 111 fbdev->buffer_write = 0;
207e58ef 112 fprintf(stderr, "Warning: failed to increase virtual resolution, "
5cf498af 113 "multibuffering disabled\n");
207e58ef 114 }
5cf498af 115
207e58ef 116 }
117
fcd1cdf7 118 fbdev->fb_size = w_total * h_total * bpp / 8;
207e58ef 119 fbdev->top_border = top_border;
120 fbdev->bottom_border = bottom_border;
121
122 mem_size = fbdev->fb_size * fbdev->buffer_count;
123 if (fbdev->mem_size >= mem_size)
0238dca9 124 goto out;
207e58ef 125
126 if (fbdev->mem != NULL)
127 munmap(fbdev->mem, fbdev->mem_size);
128
129 fbdev->mem = mmap(0, mem_size, PROT_WRITE|PROT_READ, MAP_SHARED, fbdev->fd, 0);
130 if (fbdev->mem == MAP_FAILED && fbdev->buffer_count > 1) {
5cf498af 131 fprintf(stderr, "Warning: can't map %zd bytes, doublebuffering disabled\n", mem_size);
207e58ef 132 fbdev->buffer_count = 1;
5cf498af 133 fbdev->buffer_write = 0;
207e58ef 134 mem_size = fbdev->fb_size;
135 fbdev->mem = mmap(0, mem_size, PROT_WRITE|PROT_READ, MAP_SHARED, fbdev->fd, 0);
136 }
137 if (fbdev->mem == MAP_FAILED) {
138 fbdev->mem = NULL;
139 fbdev->mem_size = 0;
140 perror("mmap framebuffer");
0238dca9 141 return NULL;
207e58ef 142 }
143
144 fbdev->mem_size = mem_size;
0238dca9 145
146out:
147 return (char *)fbdev->mem + fbdev->fb_size * fbdev->buffer_write;
207e58ef 148}
149
b9fe67c6 150void vout_fbdev_clear(struct vout_fbdev *fbdev)
d08e7326 151{
b9fe67c6 152 memset(fbdev->mem, 0, fbdev->mem_size);
153}
154
207e58ef 155void vout_fbdev_clear_lines(struct vout_fbdev *fbdev, int y, int count)
156{
a505b5f1 157 int stride = fbdev->fbvar_new.xres_virtual * fbdev->fbvar_new.bits_per_pixel / 8;
207e58ef 158 int i;
159
a505b5f1 160 if (y + count > fbdev->top_border + fbdev->fbvar_new.yres)
161 count = fbdev->top_border + fbdev->fbvar_new.yres - y;
207e58ef 162
163 if (y >= 0 && count > 0)
164 for (i = 0; i < fbdev->buffer_count; i++)
165 memset((char *)fbdev->mem + fbdev->fb_size * i + y * stride, 0, stride * count);
166}
167
168int vout_fbdev_get_fd(struct vout_fbdev *fbdev)
169{
170 return fbdev->fd;
171}
172
fcd1cdf7 173struct vout_fbdev *vout_fbdev_init(const char *fbdev_name, int *w, int *h, int bpp, int buffer_cnt)
b9fe67c6 174{
175 struct vout_fbdev *fbdev;
207e58ef 176 int req_w, req_h;
0238dca9 177 void *pret;
207e58ef 178 int ret;
d08e7326 179
b9fe67c6 180 fbdev = calloc(1, sizeof(*fbdev));
181 if (fbdev == NULL)
182 return NULL;
183
184 fbdev->fd = open(fbdev_name, O_RDWR);
185 if (fbdev->fd == -1) {
d08e7326 186 fprintf(stderr, "%s: ", fbdev_name);
187 perror("open");
b9fe67c6 188 goto fail_open;
d08e7326 189 }
190
b9fe67c6 191 ret = ioctl(fbdev->fd, FBIOGET_VSCREENINFO, &fbdev->fbvar_old);
d08e7326 192 if (ret == -1) {
193 perror("FBIOGET_VSCREENINFO ioctl");
194 goto fail;
195 }
196
b9fe67c6 197 fbdev->fbvar_new = fbdev->fbvar_old;
d08e7326 198
207e58ef 199 req_w = fbdev->fbvar_new.xres;
200 if (*w != 0)
201 req_w = *w;
202 req_h = fbdev->fbvar_new.yres;
203 if (*h != 0)
204 req_h = *h;
d08e7326 205
0238dca9 206 pret = vout_fbdev_resize(fbdev, req_w, req_h, bpp, 0, 0, 0, 0, buffer_cnt);
207 if (pret == NULL)
d08e7326 208 goto fail;
207e58ef 209
210 printf("%s: %ix%i@%d\n", fbdev_name, fbdev->fbvar_new.xres, fbdev->fbvar_new.yres,
211 fbdev->fbvar_new.bits_per_pixel);
212 *w = fbdev->fbvar_new.xres;
213 *h = fbdev->fbvar_new.yres;
214
b9fe67c6 215 memset(fbdev->mem, 0, fbdev->mem_size);
d08e7326 216
217 // some checks
218 ret = 0;
b9fe67c6 219 ret = ioctl(fbdev->fd, FBIO_WAITFORVSYNC, &ret);
d08e7326 220 if (ret != 0)
221 fprintf(stderr, "Warning: vsync doesn't seem to be supported\n");
222
b9fe67c6 223 if (fbdev->buffer_count > 1) {
224 fbdev->buffer_write = 0;
207e58ef 225 fbdev->fbvar_new.yoffset = fbdev->fbvar_new.yres * (fbdev->buffer_count - 1);
b9fe67c6 226 ret = ioctl(fbdev->fd, FBIOPAN_DISPLAY, &fbdev->fbvar_new);
d08e7326 227 if (ret != 0) {
b9fe67c6 228 fbdev->buffer_count = 1;
d08e7326 229 fprintf(stderr, "Warning: can't pan display, doublebuffering disabled\n");
230 }
231 }
232
233 printf("fbdev initialized.\n");
b9fe67c6 234 return fbdev;
d08e7326 235
236fail:
b9fe67c6 237 close(fbdev->fd);
238fail_open:
239 free(fbdev);
240 return NULL;
d08e7326 241}
242
b9fe67c6 243void vout_fbdev_finish(struct vout_fbdev *fbdev)
d08e7326 244{
b9fe67c6 245 ioctl(fbdev->fd, FBIOPUT_VSCREENINFO, &fbdev->fbvar_old);
246 if (fbdev->mem != MAP_FAILED)
247 munmap(fbdev->mem, fbdev->mem_size);
248 if (fbdev->fd >= 0)
249 close(fbdev->fd);
250 fbdev->mem = NULL;
251 fbdev->fd = -1;
252 free(fbdev);
d08e7326 253}
254