dv1394.c 7.31 KB
Newer Older
1 2 3 4
/*
 * Linux DV1394 interface
 * Copyright (c) 2003 Max Krasnyansky <maxk@qualcomm.com>
 *
5
 * This file is part of Libav.
6
 *
7
 * Libav 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
 * Libav 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 Libav; 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
#include <sys/ioctl.h>
#include <sys/mman.h>

30 31
#include "libavutil/log.h"
#include "libavutil/opt.h"
32 33
#include "libavformat/avformat.h"
#include "libavformat/dv.h"
34 35 36
#include "dv1394.h"

struct dv1394_data {
37
    AVClass *class;
38 39
    int fd;
    int channel;
40
    int format;
41

42
    uint8_t *ring; /* Ring buffer */
43 44 45
    int index;  /* Current frame index */
    int avail;  /* Number of frames available for reading */
    int done;   /* Number of completed frames */
46

47
    DVDemuxContext* dv_demux; /* Generic DV muxing/demuxing context */
48 49
};

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

60
    init.channel     = dv->channel;
61
    init.api_version = DV1394_API_VERSION;
62
    init.n_frames    = DV1394_RING_FRAMES;
63
    init.format      = DV1394_PAL;
64 65 66 67

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

68
    dv->avail  = dv->done = 0;
69 70 71 72 73 74 75
    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) {
76
        av_log(NULL, AV_LOG_ERROR, "Failed to start receiver: %s\n", strerror(errno));
77 78 79 80 81
        return -1;
    }
    return 0;
}

82
static int dv1394_read_header(AVFormatContext * context)
83 84 85
{
    struct dv1394_data *dv = context->priv_data;

86
    dv->dv_demux = avpriv_dv_init_demux(context);
87 88
    if (!dv->dv_demux)
        goto failed;
89 90

    /* Open and initialize DV1394 device */
91
    dv->fd = open(context->filename, O_RDONLY);
92
    if (dv->fd < 0) {
93
        av_log(context, AV_LOG_ERROR, "Failed to open DV interface: %s\n", strerror(errno));
94 95 96 97
        goto failed;
    }

    if (dv1394_reset(dv) < 0) {
98
        av_log(context, AV_LOG_ERROR, "Failed to initialize DV interface: %s\n", strerror(errno));
99 100 101
        goto failed;
    }

102
    dv->ring = mmap(NULL, DV1394_PAL_FRAME_SIZE * DV1394_RING_FRAMES,
103
                    PROT_READ, MAP_PRIVATE, dv->fd, 0);
104
    if (dv->ring == MAP_FAILED) {
105
        av_log(context, AV_LOG_ERROR, "Failed to mmap DV ring buffer: %s\n", strerror(errno));
106 107 108 109 110 111 112 113 114 115
        goto failed;
    }

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

    return 0;

failed:
    close(dv->fd);
116
    return AVERROR(EIO);
117 118
}

119
static int dv1394_read_packet(AVFormatContext *context, AVPacket *pkt)
120 121
{
    struct dv1394_data *dv = context->priv_data;
122 123
    int size;

124
    size = avpriv_dv_get_packet(dv->dv_demux, pkt);
125
    if (size > 0)
126
        return size;
127 128 129 130

    if (!dv->avail) {
        struct dv1394_status s;
        struct pollfd p;
131 132 133 134 135 136 137

        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 :(.
                 */
138

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

141 142 143 144 145
                dv1394_reset(dv);
                dv1394_start(dv);
            }
            dv->done = 0;
        }
146 147

        /* Wait until more frames are available */
148 149 150
restart_poll:
        p.fd = dv->fd;
        p.events = POLLIN | POLLERR | POLLHUP;
151
        if (poll(&p, 1, -1) < 0) {
152 153
            if (errno == EAGAIN || errno == EINTR)
                goto restart_poll;
154
            av_log(context, AV_LOG_ERROR, "Poll failed: %s\n", strerror(errno));
155
            return AVERROR(EIO);
156 157 158
        }

        if (ioctl(dv->fd, DV1394_GET_STATUS, &s) < 0) {
159
            av_log(context, AV_LOG_ERROR, "Failed to get status: %s\n", strerror(errno));
160
            return AVERROR(EIO);
161
        }
162
        av_dlog(context, "DV1394: status\n"
163 164 165 166 167 168 169 170 171
                "\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);

        dv->avail = s.n_clear_frames;
        dv->index = s.first_clear_frame;
172
        dv->done  = 0;
173 174

        if (s.dropped_frames) {
175
            av_log(context, AV_LOG_ERROR, "DV1394: Frame drop detected (%d). Reseting ..\n",
176 177 178 179 180 181 182
                    s.dropped_frames);

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

183
    av_dlog(context, "index %d, avail %d, done %d\n", dv->index, dv->avail,
184 185
            dv->done);

186
    size = avpriv_dv_produce_packet(dv->dv_demux, pkt,
187
                             dv->ring + (dv->index * DV1394_PAL_FRAME_SIZE),
188
                             DV1394_PAL_FRAME_SIZE);
189 190
    dv->index = (dv->index + 1) % DV1394_RING_FRAMES;
    dv->done++; dv->avail--;
191

192
    return size;
193 194 195 196 197 198 199 200
}

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

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

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

    close(dv->fd);
208
    av_free(dv->dv_demux);
209 210 211 212

    return 0;
}

213
static const AVOption options[] = {
214 215 216 217
    { "standard", "", offsetof(struct dv1394_data, format), AV_OPT_TYPE_INT, {.dbl = DV1394_NTSC}, DV1394_PAL, DV1394_NTSC, AV_OPT_FLAG_DECODING_PARAM, "standard" },
    { "PAL",      "", 0, AV_OPT_TYPE_CONST, {.dbl = DV1394_PAL},   0, 0, AV_OPT_FLAG_DECODING_PARAM, "standard" },
    { "NTSC",     "", 0, AV_OPT_TYPE_CONST, {.dbl = DV1394_NTSC},  0, 0, AV_OPT_FLAG_DECODING_PARAM, "standard" },
    { "channel",  "", offsetof(struct dv1394_data, channel), AV_OPT_TYPE_INT, {.dbl = DV1394_DEFAULT_CHANNEL}, 0, INT_MAX, AV_OPT_FLAG_DECODING_PARAM },
218 219 220 221 222 223 224 225 226 227
    { NULL },
};

static const AVClass dv1394_class = {
    .class_name = "DV1394 indev",
    .item_name  = av_default_item_name,
    .option     = options,
    .version    = LIBAVUTIL_VERSION_INT,
};

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