Simplify more errors by using goto
[libav.git] / libavdevice / vfwcap.c
1 /*
2 * VFW capture interface
3 * Copyright (c) 2006-2008 Ramiro Polla.
4 *
5 * This file is part of FFmpeg.
6 *
7 * FFmpeg is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2.1 of the License, or (at your option) any later version.
11 *
12 * FFmpeg is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
16 *
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with FFmpeg; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20 */
21
22 #include "avformat.h"
23 #include <vfw.h>
24 #include <windows.h>
25
26 //#define DEBUG_VFW
27
28 /* Defines for VFW missing from MinGW.
29 * Remove this when MinGW incorporates them. */
30 #define WM_CAP_START (0x0400)
31 #define WM_CAP_SET_CALLBACK_VIDEOSTREAM (WM_CAP_START + 6)
32 #define WM_CAP_DRIVER_CONNECT (WM_CAP_START + 10)
33 #define WM_CAP_DRIVER_DISCONNECT (WM_CAP_START + 11)
34 #define WM_CAP_GET_VIDEOFORMAT (WM_CAP_START + 44)
35 #define WM_CAP_SET_VIDEOFORMAT (WM_CAP_START + 45)
36 #define WM_CAP_SET_PREVIEW (WM_CAP_START + 50)
37 #define WM_CAP_SET_OVERLAY (WM_CAP_START + 51)
38 #define WM_CAP_SEQUENCE_NOFILE (WM_CAP_START + 63)
39 #define WM_CAP_SET_SEQUENCE_SETUP (WM_CAP_START + 64)
40 #define WM_CAP_GET_SEQUENCE_SETUP (WM_CAP_START + 65)
41
42 #define HWND_MESSAGE ((HWND)-3)
43
44 #define BI_RGB 0
45
46 typedef struct videohdr_tag {
47 LPBYTE lpData;
48 DWORD dwBufferLength;
49 DWORD dwBytesUsed;
50 DWORD dwTimeCaptured;
51 DWORD dwUser;
52 DWORD dwFlags;
53 DWORD_PTR dwReserved[4];
54 } VIDEOHDR, NEAR *PVIDEOHDR, FAR * LPVIDEOHDR;
55
56 typedef struct {
57 DWORD dwRequestMicroSecPerFrame;
58 BOOL fMakeUserHitOKToCapture;
59 UINT wPercentDropForError;
60 BOOL fYield;
61 DWORD dwIndexSize;
62 UINT wChunkGranularity;
63 BOOL fUsingDOSMemory;
64 UINT wNumVideoRequested;
65 BOOL fCaptureAudio;
66 UINT wNumAudioRequested;
67 UINT vKeyAbort;
68 BOOL fAbortLeftMouse;
69 BOOL fAbortRightMouse;
70 BOOL fLimitEnabled;
71 UINT wTimeLimit;
72 BOOL fMCIControl;
73 BOOL fStepMCIDevice;
74 DWORD dwMCIStartTime;
75 DWORD dwMCIStopTime;
76 BOOL fStepCaptureAt2x;
77 UINT wStepCaptureAverageFrames;
78 DWORD dwAudioBufferSize;
79 BOOL fDisableWriteCache;
80 UINT AVStreamMaster;
81 } CAPTUREPARMS;
82 /* End of missing MinGW defines */
83
84 struct vfw_ctx {
85 HWND hwnd;
86 HANDLE mutex;
87 HANDLE event;
88 AVPacketList *pktl;
89 AVFormatContext *s;
90 unsigned int curbufsize;
91 unsigned int frame_num;
92 };
93
94 static enum PixelFormat vfw_pixfmt(DWORD biCompression, WORD biBitCount)
95 {
96 switch(biCompression) {
97 case MKTAG('Y', 'U', 'Y', '2'):
98 return PIX_FMT_YUYV422;
99 case BI_RGB:
100 switch(biBitCount) { /* 1-8 are untested */
101 case 1:
102 return PIX_FMT_MONOWHITE;
103 case 4:
104 return PIX_FMT_RGB4;
105 case 8:
106 return PIX_FMT_RGB8;
107 case 16:
108 return PIX_FMT_RGB555;
109 case 24:
110 return PIX_FMT_BGR24;
111 case 32:
112 return PIX_FMT_RGB32;
113 }
114 }
115 return -1;
116 }
117
118 #define dstruct(pctx, sname, var, type) \
119 av_log(pctx, AV_LOG_DEBUG, #var":\t%"type"\n", sname->var)
120
121 static void dump_captureparms(AVFormatContext *s, CAPTUREPARMS *cparms)
122 {
123 av_log(s, AV_LOG_DEBUG, "CAPTUREPARMS\n");
124 dstruct(s, cparms, dwRequestMicroSecPerFrame, "lu");
125 dstruct(s, cparms, fMakeUserHitOKToCapture, "d");
126 dstruct(s, cparms, wPercentDropForError, "u");
127 dstruct(s, cparms, fYield, "d");
128 dstruct(s, cparms, dwIndexSize, "lu");
129 dstruct(s, cparms, wChunkGranularity, "u");
130 dstruct(s, cparms, fUsingDOSMemory, "d");
131 dstruct(s, cparms, wNumVideoRequested, "u");
132 dstruct(s, cparms, fCaptureAudio, "d");
133 dstruct(s, cparms, wNumAudioRequested, "u");
134 dstruct(s, cparms, vKeyAbort, "u");
135 dstruct(s, cparms, fAbortLeftMouse, "d");
136 dstruct(s, cparms, fAbortRightMouse, "d");
137 dstruct(s, cparms, fLimitEnabled, "d");
138 dstruct(s, cparms, wTimeLimit, "u");
139 dstruct(s, cparms, fMCIControl, "d");
140 dstruct(s, cparms, fStepMCIDevice, "d");
141 dstruct(s, cparms, dwMCIStartTime, "lu");
142 dstruct(s, cparms, dwMCIStopTime, "lu");
143 dstruct(s, cparms, fStepCaptureAt2x, "d");
144 dstruct(s, cparms, wStepCaptureAverageFrames, "u");
145 dstruct(s, cparms, dwAudioBufferSize, "lu");
146 dstruct(s, cparms, fDisableWriteCache, "d");
147 dstruct(s, cparms, AVStreamMaster, "u");
148 }
149
150 static void dump_videohdr(AVFormatContext *s, VIDEOHDR *vhdr)
151 {
152 #ifdef DEBUG_VFW
153 av_log(s, AV_LOG_DEBUG, "VIDEOHDR\n");
154 dstruct(s, vhdr, lpData, "p");
155 dstruct(s, vhdr, dwBufferLength, "lu");
156 dstruct(s, vhdr, dwBytesUsed, "lu");
157 dstruct(s, vhdr, dwTimeCaptured, "lu");
158 dstruct(s, vhdr, dwUser, "lu");
159 dstruct(s, vhdr, dwFlags, "lu");
160 dstruct(s, vhdr, dwReserved[0], "lu");
161 dstruct(s, vhdr, dwReserved[1], "lu");
162 dstruct(s, vhdr, dwReserved[2], "lu");
163 dstruct(s, vhdr, dwReserved[3], "lu");
164 #endif
165 }
166
167 static void dump_bih(AVFormatContext *s, BITMAPINFOHEADER *bih)
168 {
169 av_log(s, AV_LOG_DEBUG, "BITMAPINFOHEADER\n");
170 dstruct(s, bih, biSize, "lu");
171 dstruct(s, bih, biWidth, "ld");
172 dstruct(s, bih, biHeight, "ld");
173 dstruct(s, bih, biPlanes, "d");
174 dstruct(s, bih, biBitCount, "d");
175 dstruct(s, bih, biCompression, "lu");
176 av_log(s, AV_LOG_DEBUG, " biCompression:\t\"%.4s\"\n",
177 (char*) &bih->biCompression);
178 dstruct(s, bih, biSizeImage, "lu");
179 dstruct(s, bih, biXPelsPerMeter, "lu");
180 dstruct(s, bih, biYPelsPerMeter, "lu");
181 dstruct(s, bih, biClrUsed, "lu");
182 dstruct(s, bih, biClrImportant, "lu");
183 }
184
185 static int shall_we_drop(struct vfw_ctx *ctx)
186 {
187 AVFormatContext *s = ctx->s;
188 const uint8_t dropscore[] = {62, 75, 87, 100};
189 const int ndropscores = sizeof(dropscore)/sizeof(dropscore[0]);
190 unsigned int buffer_fullness = (ctx->curbufsize*100)/s->max_picture_buffer;
191
192 if(dropscore[++ctx->frame_num%ndropscores] <= buffer_fullness) {
193 av_log(ctx->s, AV_LOG_ERROR,
194 "real-time buffer %d%% full! frame dropped!\n", buffer_fullness);
195 return 1;
196 }
197
198 return 0;
199 }
200
201 static LRESULT CALLBACK videostream_cb(HWND hwnd, LPVIDEOHDR vdhdr)
202 {
203 struct vfw_ctx *ctx;
204 AVPacketList **ppktl, *pktl_next;
205
206 ctx = (struct vfw_ctx *) GetWindowLongPtr(hwnd, GWLP_USERDATA);
207
208 dump_videohdr(ctx->s, vdhdr);
209
210 if(shall_we_drop(ctx))
211 return FALSE;
212
213 WaitForSingleObject(ctx->mutex, INFINITE);
214
215 pktl_next = av_mallocz(sizeof(AVPacketList));
216 if(!pktl_next)
217 goto fail;
218
219 if(av_new_packet(&pktl_next->pkt, vdhdr->dwBytesUsed) < 0) {
220 av_free(pktl_next);
221 goto fail;
222 }
223
224 pktl_next->pkt.pts = vdhdr->dwTimeCaptured;
225 memcpy(pktl_next->pkt.data, vdhdr->lpData, vdhdr->dwBytesUsed);
226
227 for(ppktl = &ctx->pktl ; *ppktl ; ppktl = &(*ppktl)->next);
228 *ppktl = pktl_next;
229
230 ctx->curbufsize += vdhdr->dwBytesUsed;
231
232 SetEvent(ctx->event);
233 ReleaseMutex(ctx->mutex);
234
235 return TRUE;
236 fail:
237 ReleaseMutex(ctx->mutex);
238 return FALSE;
239 }
240
241 static int vfw_read_close(AVFormatContext *s);
242
243 static int vfw_read_header(AVFormatContext *s, AVFormatParameters *ap)
244 {
245 struct vfw_ctx *ctx = s->priv_data;
246 AVCodecContext *codec;
247 AVStream *st;
248 int devnum;
249 int bisize;
250 BITMAPINFO *bi;
251 CAPTUREPARMS cparms;
252 DWORD biCompression;
253 WORD biBitCount;
254 int width;
255 int height;
256 int ret;
257
258 if(!ap->time_base.den) {
259 av_log(s, AV_LOG_ERROR, "A time base must be specified.\n");
260 return AVERROR_IO;
261 }
262
263 ctx->s = s;
264
265 ctx->hwnd = capCreateCaptureWindow(NULL, 0, 0, 0, 0, 0, HWND_MESSAGE, 0);
266 if(!ctx->hwnd) {
267 av_log(s, AV_LOG_ERROR, "Could not create capture window.\n");
268 return AVERROR_IO;
269 }
270
271 /* If atoi fails, devnum==0 and the default device is used */
272 devnum = atoi(s->filename);
273
274 ret = SendMessage(ctx->hwnd, WM_CAP_DRIVER_CONNECT, devnum, 0);
275 if(!ret) {
276 av_log(s, AV_LOG_ERROR, "Could not connect to device.\n");
277 DestroyWindow(ctx->hwnd);
278 return AVERROR(ENODEV);
279 }
280
281 SendMessage(ctx->hwnd, WM_CAP_SET_OVERLAY, 0, 0);
282 SendMessage(ctx->hwnd, WM_CAP_SET_PREVIEW, 0, 0);
283
284 ret = SendMessage(ctx->hwnd, WM_CAP_SET_CALLBACK_VIDEOSTREAM, 0,
285 (LPARAM) videostream_cb);
286 if(!ret) {
287 av_log(s, AV_LOG_ERROR, "Could not set video stream callback.\n");
288 goto fail_io;
289 }
290
291 SetWindowLongPtr(ctx->hwnd, GWLP_USERDATA, (LONG_PTR) ctx);
292
293 st = av_new_stream(s, 0);
294 if(!st) {
295 vfw_read_close(s);
296 return AVERROR_NOMEM;
297 }
298
299 /* Set video format */
300 bisize = SendMessage(ctx->hwnd, WM_CAP_GET_VIDEOFORMAT, 0, 0);
301 if(!bisize) {
302 goto fail_io;
303 }
304 bi = av_malloc(bisize);
305 if(!bi) {
306 vfw_read_close(s);
307 return AVERROR_NOMEM;
308 }
309 ret = SendMessage(ctx->hwnd, WM_CAP_GET_VIDEOFORMAT, bisize, (LPARAM) bi);
310 if(!ret) {
311 goto fail_bi;
312 }
313
314 dump_bih(s, &bi->bmiHeader);
315
316 width = ap->width ? ap->width : bi->bmiHeader.biWidth ;
317 height = ap->height ? ap->height : bi->bmiHeader.biHeight;
318 bi->bmiHeader.biWidth = width ;
319 bi->bmiHeader.biHeight = height;
320
321 ret = SendMessage(ctx->hwnd, WM_CAP_SET_VIDEOFORMAT, bisize, (LPARAM) bi);
322 if(!ret) {
323 av_log(s, AV_LOG_ERROR, "Could not set Video Format.\n");
324 goto fail_bi;
325 }
326
327 biCompression = bi->bmiHeader.biCompression;
328 biBitCount = bi->bmiHeader.biBitCount;
329
330 av_free(bi);
331
332 /* Set sequence setup */
333 ret = SendMessage(ctx->hwnd, WM_CAP_GET_SEQUENCE_SETUP, sizeof(cparms),
334 (LPARAM) &cparms);
335 if(!ret) {
336 goto fail_io;
337 }
338
339 dump_captureparms(s, &cparms);
340
341 cparms.fYield = 1; // Spawn a background thread
342 cparms.dwRequestMicroSecPerFrame =
343 (ap->time_base.num*1000000) / ap->time_base.den;
344 cparms.fAbortLeftMouse = 0;
345 cparms.fAbortRightMouse = 0;
346 cparms.fCaptureAudio = 0;
347 cparms.vKeyAbort = 0;
348
349 ret = SendMessage(ctx->hwnd, WM_CAP_SET_SEQUENCE_SETUP, sizeof(cparms),
350 (LPARAM) &cparms);
351 if(!ret) {
352 goto fail_io;
353 }
354
355 codec = st->codec;
356 codec->time_base = ap->time_base;
357 codec->codec_type = CODEC_TYPE_VIDEO;
358 codec->width = width;
359 codec->height = height;
360 codec->codec_id = CODEC_ID_RAWVIDEO;
361 codec->pix_fmt = vfw_pixfmt(biCompression, biBitCount);
362 if(biCompression == BI_RGB)
363 codec->bits_per_sample = biBitCount;
364
365 av_set_pts_info(st, 32, 1, 1000);
366
367 if(codec->pix_fmt == -1) {
368 av_log(s, AV_LOG_ERROR, "Unknown compression type."
369 "Please report verbose (-v 99) debug information.\n");
370 vfw_read_close(s);
371 return AVERROR_PATCHWELCOME;
372 }
373
374 ctx->mutex = CreateMutex(NULL, 0, NULL);
375 if(!ctx->mutex) {
376 av_log(s, AV_LOG_ERROR, "Could not create Mutex.\n" );
377 goto fail_io;
378 }
379 ctx->event = CreateEvent(NULL, 1, 0, NULL);
380 if(!ctx->event) {
381 av_log(s, AV_LOG_ERROR, "Could not create Event.\n" );
382 goto fail_io;
383 }
384
385 ret = SendMessage(ctx->hwnd, WM_CAP_SEQUENCE_NOFILE, 0, 0);
386 if(!ret) {
387 av_log(s, AV_LOG_ERROR, "Could not start capture sequence.\n" );
388 goto fail_io;
389 }
390
391 return 0;
392
393 fail_bi:
394 av_free(bi);
395
396 fail_io:
397 vfw_read_close(s);
398 return AVERROR_IO;
399 }
400
401 static int vfw_read_packet(AVFormatContext *s, AVPacket *pkt)
402 {
403 struct vfw_ctx *ctx = s->priv_data;
404 AVPacketList *pktl = NULL;
405
406 while(!pktl) {
407 WaitForSingleObject(ctx->mutex, INFINITE);
408 pktl = ctx->pktl;
409 if(ctx->pktl) {
410 *pkt = ctx->pktl->pkt;
411 ctx->pktl = ctx->pktl->next;
412 av_free(pktl);
413 }
414 ResetEvent(ctx->event);
415 ReleaseMutex(ctx->mutex);
416 if(!pktl) {
417 if(s->flags & AVFMT_FLAG_NONBLOCK) {
418 return AVERROR(EAGAIN);
419 } else {
420 WaitForSingleObject(ctx->event, INFINITE);
421 }
422 }
423 }
424
425 ctx->curbufsize -= pkt->size;
426
427 return pkt->size;
428 }
429
430 static int vfw_read_close(AVFormatContext *s)
431 {
432 struct vfw_ctx *ctx = s->priv_data;
433
434 if(ctx->hwnd) {
435 SendMessage(ctx->hwnd, WM_CAP_SET_CALLBACK_VIDEOSTREAM, 0, 0);
436 SendMessage(ctx->hwnd, WM_CAP_DRIVER_DISCONNECT, 0, 0);
437 DestroyWindow(ctx->hwnd);
438 }
439 if(ctx->mutex)
440 CloseHandle(ctx->mutex);
441 if(ctx->event)
442 CloseHandle(ctx->event);
443
444 return 0;
445 }
446
447 AVInputFormat vfwcap_demuxer = {
448 "vfwcap",
449 "VFW video capture",
450 sizeof(struct vfw_ctx),
451 NULL,
452 vfw_read_header,
453 vfw_read_packet,
454 vfw_read_close,
455 .flags = AVFMT_NOFILE,
456 };