dv1394.c 6.84 KB
Newer Older
1 2 3 4
/*
 * Linux DV1394 interface
 * Copyright (c) 2003 Max Krasnyansky <maxk@qualcomm.com>
 *
5 6 7
 * This file is part of FFmpeg.
 *
 * FFmpeg is free software; you can redistribute it and/or
8 9
 * modify it under the terms of the GNU Lesser General Public
 * 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 14 15 16 17
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * 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 "config.h"
23 24
#include <unistd.h>
#include <fcntl.h>
25
#include <errno.h>
26
#include <poll.h>
27 28 29 30
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <sys/time.h>
#include <time.h>
31
#include <strings.h>
32

33
#include "libavformat/avformat.h"
34 35 36

#undef DV1394_DEBUG

37
#include "libavformat/dv.h"
38 39 40 41 42
#include "dv1394.h"

struct dv1394_data {
    int fd;
    int channel;
43
    int format;
44

45
    uint8_t *ring; /* Ring buffer */
46 47 48
    int index;  /* Current frame index */
    int avail;  /* Number of frames available for reading */
    int done;   /* Number of completed frames */
49

50
    DVDemuxContext* dv_demux; /* Generic DV muxing/demuxing context */
51 52
};

53
/*
54
 * The trick here is to kludge around well known problem with kernel Ooopsing
55
 * when you try to capture PAL on a device node configure for NTSC. That's
56 57 58
 * why we have to configure the device node for PAL, and then read only NTSC
 * amount of data.
 */
59 60 61 62
static int dv1394_reset(struct dv1394_data *dv)
{
    struct dv1394_init init;

63
    init.channel     = dv->channel;
64
    init.api_version = DV1394_API_VERSION;
65
    init.n_frames    = DV1394_RING_FRAMES;
66
    init.format      = DV1394_PAL;
67 68 69 70

    if (ioctl(dv->fd, DV1394_INIT, &init) < 0)
        return -1;

71
    dv->avail  = dv->done = 0;
72 73 74 75 76 77 78
    return 0;
}

static int dv1394_start(struct dv1394_data *dv)
{
    /* Tell DV1394 driver to enable receiver */
    if (ioctl(dv->fd, DV1394_START_RECEIVE, 0) < 0) {
79
        av_log(NULL, AV_LOG_ERROR, "Failed to start receiver: %s\n", strerror(errno));
80 81 82 83 84 85 86 87 88
        return -1;
    }
    return 0;
}

static int dv1394_read_header(AVFormatContext * context, AVFormatParameters * ap)
{
    struct dv1394_data *dv = context->priv_data;

89
    dv->dv_demux = dv_init_demux(context);
90 91
    if (!dv->dv_demux)
        goto failed;
92

93
    if (ap->standard && !strcasecmp(ap->standard, "pal"))
94
        dv->format = DV1394_PAL;
95
    else
96
        dv->format = DV1394_NTSC;
97 98 99 100 101

    if (ap->channel)
        dv->channel = ap->channel;
    else
        dv->channel = DV1394_DEFAULT_CHANNEL;
102 103

    /* Open and initialize DV1394 device */
104
    dv->fd = open(context->filename, O_RDONLY);
105
    if (dv->fd < 0) {
106
        av_log(context, AV_LOG_ERROR, "Failed to open DV interface: %s\n", strerror(errno));
107 108 109 110
        goto failed;
    }

    if (dv1394_reset(dv) < 0) {
111
        av_log(context, AV_LOG_ERROR, "Failed to initialize DV interface: %s\n", strerror(errno));
112 113 114
        goto failed;
    }

115
    dv->ring = mmap(NULL, DV1394_PAL_FRAME_SIZE * DV1394_RING_FRAMES,
116
                    PROT_READ, MAP_PRIVATE, dv->fd, 0);
117
    if (dv->ring == MAP_FAILED) {
118
        av_log(context, AV_LOG_ERROR, "Failed to mmap DV ring buffer: %s\n", strerror(errno));
119 120 121 122 123 124 125 126 127 128
        goto failed;
    }

    if (dv1394_start(dv) < 0)
        goto failed;

    return 0;

failed:
    close(dv->fd);
129
    return AVERROR(EIO);
130 131
}

132
static int dv1394_read_packet(AVFormatContext *context, AVPacket *pkt)
133 134
{
    struct dv1394_data *dv = context->priv_data;
135 136 137 138
    int size;

    size = dv_get_packet(dv->dv_demux, pkt);
    if (size > 0)
139
        return size;
140 141 142 143

    if (!dv->avail) {
        struct dv1394_status s;
        struct pollfd p;
144 145 146 147 148 149 150

        if (dv->done) {
            /* Request more frames */
            if (ioctl(dv->fd, DV1394_RECEIVE_FRAMES, dv->done) < 0) {
                /* This usually means that ring buffer overflowed.
                 * We have to reset :(.
                 */
151

152
                av_log(context, AV_LOG_ERROR, "DV1394: Ring buffer overflow. Reseting ..\n");
153

154 155 156 157 158
                dv1394_reset(dv);
                dv1394_start(dv);
            }
            dv->done = 0;
        }
159 160

        /* Wait until more frames are available */
161 162 163
restart_poll:
        p.fd = dv->fd;
        p.events = POLLIN | POLLERR | POLLHUP;
164
        if (poll(&p, 1, -1) < 0) {
165 166
            if (errno == EAGAIN || errno == EINTR)
                goto restart_poll;
167
            av_log(context, AV_LOG_ERROR, "Poll failed: %s\n", strerror(errno));
168
            return AVERROR(EIO);
169 170 171
        }

        if (ioctl(dv->fd, DV1394_GET_STATUS, &s) < 0) {
172
            av_log(context, AV_LOG_ERROR, "Failed to get status: %s\n", strerror(errno));
173
            return AVERROR(EIO);
174 175
        }
#ifdef DV1394_DEBUG
176
        av_log(context, AV_LOG_DEBUG, "DV1394: status\n"
177 178 179 180 181 182 183 184 185 186
                "\tactive_frame\t%d\n"
                "\tfirst_clear_frame\t%d\n"
                "\tn_clear_frames\t%d\n"
                "\tdropped_frames\t%d\n",
                s.active_frame, s.first_clear_frame,
                s.n_clear_frames, s.dropped_frames);
#endif

        dv->avail = s.n_clear_frames;
        dv->index = s.first_clear_frame;
187
        dv->done  = 0;
188 189

        if (s.dropped_frames) {
190
            av_log(context, AV_LOG_ERROR, "DV1394: Frame drop detected (%d). Reseting ..\n",
191 192 193 194 195 196 197 198
                    s.dropped_frames);

            dv1394_reset(dv);
            dv1394_start(dv);
        }
    }

#ifdef DV1394_DEBUG
199
    av_log(context, AV_LOG_DEBUG, "index %d, avail %d, done %d\n", dv->index, dv->avail,
200 201 202
            dv->done);
#endif

203 204
    size = dv_produce_packet(dv->dv_demux, pkt,
                             dv->ring + (dv->index * DV1394_PAL_FRAME_SIZE),
205
                             DV1394_PAL_FRAME_SIZE);
206 207
    dv->index = (dv->index + 1) % DV1394_RING_FRAMES;
    dv->done++; dv->avail--;
208

209
    return size;
210 211 212 213 214 215 216 217
}

static int dv1394_close(AVFormatContext * context)
{
    struct dv1394_data *dv = context->priv_data;

    /* Shutdown DV1394 receiver */
    if (ioctl(dv->fd, DV1394_SHUTDOWN, 0) < 0)
218
        av_log(context, AV_LOG_ERROR, "Failed to shutdown DV1394: %s\n", strerror(errno));
219 220 221

    /* Unmap ring buffer */
    if (munmap(dv->ring, DV1394_NTSC_FRAME_SIZE * DV1394_RING_FRAMES) < 0)
222
        av_log(context, AV_LOG_ERROR, "Failed to munmap DV1394 ring buffer: %s\n", strerror(errno));
223 224

    close(dv->fd);
225
    av_free(dv->dv_demux);
226 227 228 229

    return 0;
}

230
AVInputFormat dv1394_demuxer = {
231
    .name           = "dv1394",
232
    .long_name      = NULL_IF_CONFIG_SMALL("DV1394 A/V grab"),
233 234 235 236 237 238
    .priv_data_size = sizeof(struct dv1394_data),
    .read_header    = dv1394_read_header,
    .read_packet    = dv1394_read_packet,
    .read_close     = dv1394_close,
    .flags          = AVFMT_NOFILE
};