Commit | Line | Data |
---|---|---|
f02be79d RS |
1 | /* |
2 | * IIDC1394 grab interface (uses libdc1394 and libraw1394) | |
3 | * Copyright (c) 2004 Roman Shaposhnik | |
4 | * | |
5 | * This library is free software; you can redistribute it and/or | |
6 | * modify it under the terms of the GNU Lesser General Public | |
7 | * License as published by the Free Software Foundation; either | |
8 | * version 2 of the License, or (at your option) any later version. | |
9 | * | |
10 | * This library is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
13 | * Lesser General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU Lesser General Public | |
16 | * License along with this library; if not, write to the Free Software | |
17 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
18 | */ | |
19 | ||
20 | #include "avformat.h" | |
21 | ||
22 | #include <libraw1394/raw1394.h> | |
23 | #include <libdc1394/dc1394_control.h> | |
24 | ||
25 | #undef free | |
26 | ||
27 | typedef struct dc1394_data { | |
28 | raw1394handle_t handle; | |
29 | dc1394_cameracapture camera; | |
30 | int current_frame; | |
31 | int fps; | |
32 | ||
33 | AVPacket packet; | |
34 | } dc1394_data; | |
35 | ||
36 | struct dc1394_frame_format { | |
37 | int width; | |
38 | int height; | |
39 | enum PixelFormat pix_fmt; | |
40 | int frame_size_id; | |
41 | } dc1394_frame_formats[] = { | |
42 | { 320, 240, PIX_FMT_UYVY422, MODE_320x240_YUV422 }, | |
43 | { 640, 480, PIX_FMT_UYVY411, MODE_640x480_YUV411 }, | |
44 | { 640, 480, PIX_FMT_UYVY422, MODE_640x480_YUV422 }, | |
45 | { 0, 0, 0, MODE_320x240_YUV422 } /* default -- gotta be the last one */ | |
46 | }; | |
47 | ||
48 | struct dc1394_frame_rate { | |
49 | int frame_rate; | |
50 | int frame_rate_id; | |
51 | } dc1394_frame_rates[] = { | |
52 | { 1875, FRAMERATE_1_875 }, | |
53 | { 3750, FRAMERATE_3_75 }, | |
54 | { 7500, FRAMERATE_7_5 }, | |
55 | { 15000, FRAMERATE_15 }, | |
56 | { 30000, FRAMERATE_30 }, | |
57 | { 60000, FRAMERATE_60 }, | |
58 | { 0, FRAMERATE_30 } /* default -- gotta be the last one */ | |
59 | }; | |
60 | ||
61 | static int dc1394_read_header(AVFormatContext *c, AVFormatParameters * ap) | |
62 | { | |
63 | dc1394_data* dc1394 = c->priv_data; | |
64 | AVStream* vst; | |
65 | nodeid_t* camera_nodes; | |
66 | int res; | |
67 | struct dc1394_frame_format *fmt; | |
68 | struct dc1394_frame_rate *fps; | |
69 | ||
70 | for (fmt = dc1394_frame_formats; fmt->width; fmt++) | |
71 | if (fmt->pix_fmt == ap->pix_fmt && fmt->width == ap->width && fmt->height == ap->height) | |
72 | break; | |
73 | ||
74 | for (fps = dc1394_frame_rates; fps->frame_rate; fps++) | |
c0df9d75 | 75 | if (fps->frame_rate == av_rescale(1000, ap->time_base.den, ap->time_base.num)) |
f02be79d RS |
76 | break; |
77 | ||
78 | /* create a video stream */ | |
79 | vst = av_new_stream(c, 0); | |
80 | if (!vst) | |
81 | return -1; | |
82 | av_set_pts_info(vst, 64, 1, 1000); | |
83 | vst->codec.codec_type = CODEC_TYPE_VIDEO; | |
84 | vst->codec.codec_id = CODEC_ID_RAWVIDEO; | |
c0df9d75 MN |
85 | vst->codec.time_base.den = fps->frame_rate; |
86 | vst->codec.time_base.num = 1000; | |
f02be79d RS |
87 | vst->codec.width = fmt->width; |
88 | vst->codec.height = fmt->height; | |
89 | vst->codec.pix_fmt = fmt->pix_fmt; | |
90 | ||
91 | /* packet init */ | |
92 | av_init_packet(&dc1394->packet); | |
93 | dc1394->packet.size = avpicture_get_size(fmt->pix_fmt, fmt->width, fmt->height); | |
94 | dc1394->packet.stream_index = vst->index; | |
95 | dc1394->packet.flags |= PKT_FLAG_KEY; | |
96 | ||
97 | dc1394->current_frame = 0; | |
98 | dc1394->fps = fps->frame_rate; | |
99 | ||
100 | vst->codec.bit_rate = av_rescale(dc1394->packet.size * 8, fps->frame_rate, 1000); | |
101 | ||
102 | /* Now lets prep the hardware */ | |
103 | dc1394->handle = dc1394_create_handle(0); /* FIXME: gotta have ap->port */ | |
104 | if (!dc1394->handle) { | |
160d679c | 105 | av_log(c, AV_LOG_ERROR, "Can't acquire dc1394 handle on port %d\n", 0 /* ap->port */); |
f02be79d RS |
106 | goto out; |
107 | } | |
108 | camera_nodes = dc1394_get_camera_nodes(dc1394->handle, &res, 1); | |
109 | if (!camera_nodes || camera_nodes[ap->channel] == DC1394_NO_CAMERA) { | |
110 | av_log(c, AV_LOG_ERROR, "There's no IIDC camera on the channel %d\n", ap->channel); | |
111 | goto out_handle; | |
112 | } | |
113 | res = dc1394_dma_setup_capture(dc1394->handle, camera_nodes[ap->channel], | |
114 | 0, | |
115 | FORMAT_VGA_NONCOMPRESSED, | |
116 | fmt->frame_size_id, | |
117 | SPEED_400, | |
118 | fps->frame_rate_id, 8, 1, | |
119 | ap->device, | |
120 | &dc1394->camera); | |
121 | dc1394_free_camera_nodes(camera_nodes); | |
122 | if (res != DC1394_SUCCESS) { | |
123 | av_log(c, AV_LOG_ERROR, "Can't prepare camera for the DMA capture\n"); | |
124 | goto out_handle; | |
125 | } | |
126 | ||
127 | res = dc1394_start_iso_transmission(dc1394->handle, dc1394->camera.node); | |
128 | if (res != DC1394_SUCCESS) { | |
129 | av_log(c, AV_LOG_ERROR, "Can't start isochronous transmission\n"); | |
130 | goto out_handle_dma; | |
131 | } | |
132 | ||
133 | return 0; | |
134 | ||
135 | out_handle_dma: | |
136 | dc1394_dma_unlisten(dc1394->handle, &dc1394->camera); | |
137 | dc1394_dma_release_camera(dc1394->handle, &dc1394->camera); | |
138 | out_handle: | |
139 | dc1394_destroy_handle(dc1394->handle); | |
140 | out: | |
141 | return -1; | |
142 | } | |
143 | ||
144 | static int dc1394_read_packet(AVFormatContext *c, AVPacket *pkt) | |
145 | { | |
146 | struct dc1394_data *dc1394 = c->priv_data; | |
147 | int res; | |
148 | ||
149 | /* discard stale frame */ | |
150 | if (dc1394->current_frame++) { | |
151 | if (dc1394_dma_done_with_buffer(&dc1394->camera) != DC1394_SUCCESS) | |
152 | av_log(c, AV_LOG_ERROR, "failed to release %d frame\n", dc1394->current_frame); | |
153 | } | |
154 | ||
155 | res = dc1394_dma_single_capture(&dc1394->camera); | |
156 | ||
157 | if (res == DC1394_SUCCESS) { | |
158 | dc1394->packet.data = (uint8_t *)(dc1394->camera.capture_buffer); | |
159 | dc1394->packet.pts = (dc1394->current_frame * 1000000) / dc1394->fps; | |
160 | res = dc1394->packet.size; | |
161 | } else { | |
162 | av_log(c, AV_LOG_ERROR, "DMA capture failed\n"); | |
163 | dc1394->packet.data = NULL; | |
164 | res = -1; | |
165 | } | |
166 | ||
167 | *pkt = dc1394->packet; | |
168 | return res; | |
169 | } | |
170 | ||
171 | static int dc1394_close(AVFormatContext * context) | |
172 | { | |
173 | struct dc1394_data *dc1394 = context->priv_data; | |
174 | ||
175 | dc1394_stop_iso_transmission(dc1394->handle, dc1394->camera.node); | |
176 | dc1394_dma_unlisten(dc1394->handle, &dc1394->camera); | |
177 | dc1394_dma_release_camera(dc1394->handle, &dc1394->camera); | |
178 | dc1394_destroy_handle(dc1394->handle); | |
179 | ||
180 | return 0; | |
181 | } | |
182 | ||
183 | static AVInputFormat dc1394_format = { | |
184 | .name = "dc1394", | |
185 | .long_name = "dc1394 A/V grab", | |
186 | .priv_data_size = sizeof(struct dc1394_data), | |
187 | .read_header = dc1394_read_header, | |
188 | .read_packet = dc1394_read_packet, | |
189 | .read_close = dc1394_close, | |
190 | .flags = AVFMT_NOFILE | |
191 | }; | |
192 | ||
193 | int dc1394_init(void) | |
194 | { | |
195 | av_register_input_format(&dc1394_format); | |
196 | return 0; | |
197 | } |