]> git.sesse.net Git - nageru/blob - ffmpeg_capture.cpp
Add the GPU memory metrics to the Grafana dashboard.
[nageru] / ffmpeg_capture.cpp
1 #include "ffmpeg_capture.h"
2
3 #include <assert.h>
4 #include <pthread.h>
5 #include <stdint.h>
6 #include <stdio.h>
7 #include <stdlib.h>
8 #include <string.h>
9 #include <sys/stat.h>
10 #include <unistd.h>
11
12 extern "C" {
13 #include <libavcodec/avcodec.h>
14 #include <libavformat/avformat.h>
15 #include <libavutil/avutil.h>
16 #include <libavutil/error.h>
17 #include <libavutil/frame.h>
18 #include <libavutil/imgutils.h>
19 #include <libavutil/mem.h>
20 #include <libavutil/pixfmt.h>
21 #include <libavutil/opt.h>
22 #include <libswscale/swscale.h>
23 }
24
25 #include <chrono>
26 #include <cstdint>
27 #include <utility>
28 #include <vector>
29
30 #include "bmusb/bmusb.h"
31 #include "ffmpeg_raii.h"
32 #include "ffmpeg_util.h"
33 #include "flags.h"
34 #include "image_input.h"
35 #include "ref_counted_frame.h"
36 #include "timebase.h"
37
38 #define FRAME_SIZE (8 << 20)  // 8 MB.
39
40 using namespace std;
41 using namespace std::chrono;
42 using namespace bmusb;
43 using namespace movit;
44
45 namespace {
46
47 steady_clock::time_point compute_frame_start(int64_t frame_pts, int64_t pts_origin, const AVRational &video_timebase, const steady_clock::time_point &origin, double rate)
48 {
49         const duration<double> pts((frame_pts - pts_origin) * double(video_timebase.num) / double(video_timebase.den));
50         return origin + duration_cast<steady_clock::duration>(pts / rate);
51 }
52
53 bool changed_since(const std::string &pathname, const timespec &ts)
54 {
55         if (ts.tv_sec < 0) {
56                 return false;
57         }
58         struct stat buf;
59         if (stat(pathname.c_str(), &buf) != 0) {
60                 fprintf(stderr, "%s: Couldn't check for new version, leaving the old in place.\n", pathname.c_str());
61                 return false;
62         }
63         return (buf.st_mtim.tv_sec != ts.tv_sec || buf.st_mtim.tv_nsec != ts.tv_nsec);
64 }
65
66 bool is_full_range(const AVPixFmtDescriptor *desc)
67 {
68         // This is horrible, but there's no better way that I know of.
69         return (strchr(desc->name, 'j') != nullptr);
70 }
71
72 AVPixelFormat decide_dst_format(AVPixelFormat src_format, bmusb::PixelFormat dst_format_type)
73 {
74         if (dst_format_type == bmusb::PixelFormat_8BitBGRA) {
75                 return AV_PIX_FMT_BGRA;
76         }
77         if (dst_format_type == FFmpegCapture::PixelFormat_NV12) {
78                 return AV_PIX_FMT_NV12;
79         }
80
81         assert(dst_format_type == bmusb::PixelFormat_8BitYCbCrPlanar);
82
83         // If this is a non-Y'CbCr format, just convert to 4:4:4 Y'CbCr
84         // and be done with it. It's too strange to spend a lot of time on.
85         // (Let's hope there's no alpha.)
86         const AVPixFmtDescriptor *src_desc = av_pix_fmt_desc_get(src_format);
87         if (src_desc == nullptr ||
88             src_desc->nb_components != 3 ||
89             (src_desc->flags & AV_PIX_FMT_FLAG_RGB)) {
90                 return AV_PIX_FMT_YUV444P;
91         }
92
93         // The best for us would be Cb and Cr together if possible,
94         // but FFmpeg doesn't support that except in the special case of
95         // NV12, so we need to go to planar even for the case of NV12.
96         // Thus, look for the closest (but no worse) 8-bit planar Y'CbCr format
97         // that matches in color range. (This will also include the case of
98         // the source format already being acceptable.)
99         bool src_full_range = is_full_range(src_desc);
100         const char *best_format = "yuv444p";
101         unsigned best_score = numeric_limits<unsigned>::max();
102         for (const AVPixFmtDescriptor *desc = av_pix_fmt_desc_next(nullptr);
103              desc;
104              desc = av_pix_fmt_desc_next(desc)) {
105                 // Find planar Y'CbCr formats only.
106                 if (desc->nb_components != 3) continue;
107                 if (desc->flags & AV_PIX_FMT_FLAG_RGB) continue;
108                 if (!(desc->flags & AV_PIX_FMT_FLAG_PLANAR)) continue;
109                 if (desc->comp[0].plane != 0 ||
110                     desc->comp[1].plane != 1 ||
111                     desc->comp[2].plane != 2) continue;
112
113                 // 8-bit formats only.
114                 if (desc->flags & AV_PIX_FMT_FLAG_BE) continue;
115                 if (desc->comp[0].depth != 8) continue;
116
117                 // Same or better chroma resolution only.
118                 int chroma_w_diff = desc->log2_chroma_w - src_desc->log2_chroma_w;
119                 int chroma_h_diff = desc->log2_chroma_h - src_desc->log2_chroma_h;
120                 if (chroma_w_diff < 0 || chroma_h_diff < 0)
121                         continue;
122
123                 // Matching full/limited range only.
124                 if (is_full_range(desc) != src_full_range)
125                         continue;
126
127                 // Pick something with as little excess chroma resolution as possible.
128                 unsigned score = (1 << (chroma_w_diff)) << chroma_h_diff;
129                 if (score < best_score) {
130                         best_score = score;
131                         best_format = desc->name;
132                 }
133         }
134         return av_get_pix_fmt(best_format);
135 }
136
137 YCbCrFormat decode_ycbcr_format(const AVPixFmtDescriptor *desc, const AVFrame *frame)
138 {
139         YCbCrFormat format;
140         AVColorSpace colorspace = av_frame_get_colorspace(frame);
141         switch (colorspace) {
142         case AVCOL_SPC_BT709:
143                 format.luma_coefficients = YCBCR_REC_709;
144                 break;
145         case AVCOL_SPC_BT470BG:
146         case AVCOL_SPC_SMPTE170M:
147         case AVCOL_SPC_SMPTE240M:
148                 format.luma_coefficients = YCBCR_REC_601;
149                 break;
150         case AVCOL_SPC_BT2020_NCL:
151                 format.luma_coefficients = YCBCR_REC_2020;
152                 break;
153         case AVCOL_SPC_UNSPECIFIED:
154                 format.luma_coefficients = (frame->height >= 720 ? YCBCR_REC_709 : YCBCR_REC_601);
155                 break;
156         default:
157                 fprintf(stderr, "Unknown Y'CbCr coefficient enum %d from FFmpeg; choosing Rec. 709.\n",
158                         colorspace);
159                 format.luma_coefficients = YCBCR_REC_709;
160                 break;
161         }
162
163         format.full_range = is_full_range(desc);
164         format.num_levels = 1 << desc->comp[0].depth;
165         format.chroma_subsampling_x = 1 << desc->log2_chroma_w;
166         format.chroma_subsampling_y = 1 << desc->log2_chroma_h;
167
168         switch (frame->chroma_location) {
169         case AVCHROMA_LOC_LEFT:
170                 format.cb_x_position = 0.0;
171                 format.cb_y_position = 0.5;
172                 break;
173         case AVCHROMA_LOC_CENTER:
174                 format.cb_x_position = 0.5;
175                 format.cb_y_position = 0.5;
176                 break;
177         case AVCHROMA_LOC_TOPLEFT:
178                 format.cb_x_position = 0.0;
179                 format.cb_y_position = 0.0;
180                 break;
181         case AVCHROMA_LOC_TOP:
182                 format.cb_x_position = 0.5;
183                 format.cb_y_position = 0.0;
184                 break;
185         case AVCHROMA_LOC_BOTTOMLEFT:
186                 format.cb_x_position = 0.0;
187                 format.cb_y_position = 1.0;
188                 break;
189         case AVCHROMA_LOC_BOTTOM:
190                 format.cb_x_position = 0.5;
191                 format.cb_y_position = 1.0;
192                 break;
193         default:
194                 fprintf(stderr, "Unknown chroma location coefficient enum %d from FFmpeg; choosing Rec. 709.\n",
195                         frame->chroma_location);
196                 format.cb_x_position = 0.5;
197                 format.cb_y_position = 0.5;
198                 break;
199         }
200
201         format.cr_x_position = format.cb_x_position;
202         format.cr_y_position = format.cb_y_position;
203         return format;
204 }
205
206 }  // namespace
207
208 FFmpegCapture::FFmpegCapture(const string &filename, unsigned width, unsigned height)
209         : filename(filename), width(width), height(height), video_timebase{1, 1}
210 {
211         description = "Video: " + filename;
212
213         last_frame = steady_clock::now();
214
215         avformat_network_init();  // In case someone wants this.
216 }
217
218 FFmpegCapture::~FFmpegCapture()
219 {
220         if (has_dequeue_callbacks) {
221                 dequeue_cleanup_callback();
222         }
223         avresample_free(&resampler);
224 }
225
226 void FFmpegCapture::configure_card()
227 {
228         if (video_frame_allocator == nullptr) {
229                 owned_video_frame_allocator.reset(new MallocFrameAllocator(FRAME_SIZE, NUM_QUEUED_VIDEO_FRAMES));
230                 set_video_frame_allocator(owned_video_frame_allocator.get());
231         }
232         if (audio_frame_allocator == nullptr) {
233                 // Audio can come out in pretty large chunks, so increase from the default 1 MB.
234                 owned_audio_frame_allocator.reset(new MallocFrameAllocator(1 << 20, NUM_QUEUED_AUDIO_FRAMES));
235                 set_audio_frame_allocator(owned_audio_frame_allocator.get());
236         }
237 }
238
239 void FFmpegCapture::start_bm_capture()
240 {
241         if (running) {
242                 return;
243         }
244         running = true;
245         producer_thread_should_quit.unquit();
246         producer_thread = thread(&FFmpegCapture::producer_thread_func, this);
247 }
248
249 void FFmpegCapture::stop_dequeue_thread()
250 {
251         if (!running) {
252                 return;
253         }
254         running = false;
255         producer_thread_should_quit.quit();
256         producer_thread.join();
257 }
258
259 std::map<uint32_t, VideoMode> FFmpegCapture::get_available_video_modes() const
260 {
261         // Note: This will never really be shown in the UI.
262         VideoMode mode;
263
264         char buf[256];
265         snprintf(buf, sizeof(buf), "%ux%u", width, height);
266         mode.name = buf;
267         
268         mode.autodetect = false;
269         mode.width = width;
270         mode.height = height;
271         mode.frame_rate_num = 60;
272         mode.frame_rate_den = 1;
273         mode.interlaced = false;
274
275         return {{ 0, mode }};
276 }
277
278 void FFmpegCapture::producer_thread_func()
279 {
280         char thread_name[16];
281         snprintf(thread_name, sizeof(thread_name), "FFmpeg_C_%d", card_index);
282         pthread_setname_np(pthread_self(), thread_name);
283
284         while (!producer_thread_should_quit.should_quit()) {
285                 string filename_copy;
286                 {
287                         lock_guard<mutex> lock(filename_mu);
288                         filename_copy = filename;
289                 }
290
291                 string pathname = search_for_file(filename_copy);
292                 if (pathname.empty()) {
293                         fprintf(stderr, "%s not found, sleeping one second and trying again...\n", filename_copy.c_str());
294                         send_disconnected_frame();
295                         producer_thread_should_quit.sleep_for(seconds(1));
296                         continue;
297                 }
298                 should_interrupt = false;
299                 if (!play_video(pathname)) {
300                         // Error.
301                         fprintf(stderr, "Error when playing %s, sleeping one second and trying again...\n", pathname.c_str());
302                         send_disconnected_frame();
303                         producer_thread_should_quit.sleep_for(seconds(1));
304                         continue;
305                 }
306
307                 // Probably just EOF, will exit the loop above on next test.
308         }
309
310         if (has_dequeue_callbacks) {
311                 dequeue_cleanup_callback();
312                 has_dequeue_callbacks = false;
313         }
314 }
315
316 void FFmpegCapture::send_disconnected_frame()
317 {
318         // Send an empty frame to signal that we have no signal anymore.
319         FrameAllocator::Frame video_frame = video_frame_allocator->alloc_frame();
320         if (video_frame.data) {
321                 VideoFormat video_format;
322                 video_format.width = width;
323                 video_format.height = height;
324                 video_format.frame_rate_nom = 60;
325                 video_format.frame_rate_den = 1;
326                 video_format.is_connected = false;
327                 if (pixel_format == bmusb::PixelFormat_8BitBGRA) {
328                         video_format.stride = width * 4;
329                         video_frame.len = width * height * 4;
330                         memset(video_frame.data, 0, video_frame.len);
331                 } else {
332                         video_format.stride = width;
333                         current_frame_ycbcr_format.luma_coefficients = YCBCR_REC_709;
334                         current_frame_ycbcr_format.full_range = true;
335                         current_frame_ycbcr_format.num_levels = 256;
336                         current_frame_ycbcr_format.chroma_subsampling_x = 2;
337                         current_frame_ycbcr_format.chroma_subsampling_y = 2;
338                         current_frame_ycbcr_format.cb_x_position = 0.0f;
339                         current_frame_ycbcr_format.cb_y_position = 0.0f;
340                         current_frame_ycbcr_format.cr_x_position = 0.0f;
341                         current_frame_ycbcr_format.cr_y_position = 0.0f;
342                         video_frame.len = width * height * 2;
343                         memset(video_frame.data, 0, width * height);
344                         memset(video_frame.data + width * height, 128, width * height);  // Valid for both NV12 and planar.
345                 }
346
347                 frame_callback(-1, AVRational{1, TIMEBASE}, -1, AVRational{1, TIMEBASE}, timecode++,
348                         video_frame, /*video_offset=*/0, video_format,
349                         FrameAllocator::Frame(), /*audio_offset=*/0, AudioFormat());
350                 last_frame_was_connected = false;
351         }
352 }
353
354 bool FFmpegCapture::play_video(const string &pathname)
355 {
356         // Note: Call before open, not after; otherwise, there's a race.
357         // (There is now, too, but it tips the correct way. We could use fstat()
358         // if we had the file descriptor.)
359         timespec last_modified;
360         struct stat buf;
361         if (stat(pathname.c_str(), &buf) != 0) {
362                 // Probably some sort of protocol, so can't stat.
363                 last_modified.tv_sec = -1;
364         } else {
365                 last_modified = buf.st_mtim;
366         }
367
368         AVDictionary *opts = nullptr;
369         av_dict_set(&opts, "fflags", "nobuffer", 0);
370
371         auto format_ctx = avformat_open_input_unique(pathname.c_str(), nullptr, &opts, AVIOInterruptCB{ &FFmpegCapture::interrupt_cb_thunk, this });
372         if (format_ctx == nullptr) {
373                 fprintf(stderr, "%s: Error opening file\n", pathname.c_str());
374                 return false;
375         }
376
377         if (avformat_find_stream_info(format_ctx.get(), nullptr) < 0) {
378                 fprintf(stderr, "%s: Error finding stream info\n", pathname.c_str());
379                 return false;
380         }
381
382         int video_stream_index = find_stream_index(format_ctx.get(), AVMEDIA_TYPE_VIDEO);
383         if (video_stream_index == -1) {
384                 fprintf(stderr, "%s: No video stream found\n", pathname.c_str());
385                 return false;
386         }
387
388         int audio_stream_index = find_stream_index(format_ctx.get(), AVMEDIA_TYPE_AUDIO);
389
390         // Open video decoder.
391         const AVCodecParameters *video_codecpar = format_ctx->streams[video_stream_index]->codecpar;
392         AVCodec *video_codec = avcodec_find_decoder(video_codecpar->codec_id);
393         video_timebase = format_ctx->streams[video_stream_index]->time_base;
394         AVCodecContextWithDeleter video_codec_ctx = avcodec_alloc_context3_unique(nullptr);
395         if (avcodec_parameters_to_context(video_codec_ctx.get(), video_codecpar) < 0) {
396                 fprintf(stderr, "%s: Cannot fill video codec parameters\n", pathname.c_str());
397                 return false;
398         }
399         if (video_codec == nullptr) {
400                 fprintf(stderr, "%s: Cannot find video decoder\n", pathname.c_str());
401                 return false;
402         }
403         if (avcodec_open2(video_codec_ctx.get(), video_codec, nullptr) < 0) {
404                 fprintf(stderr, "%s: Cannot open video decoder\n", pathname.c_str());
405                 return false;
406         }
407         unique_ptr<AVCodecContext, decltype(avcodec_close)*> video_codec_ctx_cleanup(
408                 video_codec_ctx.get(), avcodec_close);
409
410         // Open audio decoder, if we have audio.
411         AVCodecContextWithDeleter audio_codec_ctx;
412         if (audio_stream_index != -1) {
413                 audio_codec_ctx = avcodec_alloc_context3_unique(nullptr);
414                 const AVCodecParameters *audio_codecpar = format_ctx->streams[audio_stream_index]->codecpar;
415                 audio_timebase = format_ctx->streams[audio_stream_index]->time_base;
416                 if (avcodec_parameters_to_context(audio_codec_ctx.get(), audio_codecpar) < 0) {
417                         fprintf(stderr, "%s: Cannot fill audio codec parameters\n", pathname.c_str());
418                         return false;
419                 }
420                 AVCodec *audio_codec = avcodec_find_decoder(audio_codecpar->codec_id);
421                 if (audio_codec == nullptr) {
422                         fprintf(stderr, "%s: Cannot find audio decoder\n", pathname.c_str());
423                         return false;
424                 }
425                 if (avcodec_open2(audio_codec_ctx.get(), audio_codec, nullptr) < 0) {
426                         fprintf(stderr, "%s: Cannot open audio decoder\n", pathname.c_str());
427                         return false;
428                 }
429         }
430         unique_ptr<AVCodecContext, decltype(avcodec_close)*> audio_codec_ctx_cleanup(
431                 audio_codec_ctx.get(), avcodec_close);
432
433         internal_rewind();
434
435         // Main loop.
436         bool first_frame = true;
437         while (!producer_thread_should_quit.should_quit()) {
438                 if (process_queued_commands(format_ctx.get(), pathname, last_modified, /*rewound=*/nullptr)) {
439                         return true;
440                 }
441                 UniqueFrame audio_frame = audio_frame_allocator->alloc_frame();
442                 AudioFormat audio_format;
443
444                 int64_t audio_pts;
445                 bool error;
446                 AVFrameWithDeleter frame = decode_frame(format_ctx.get(), video_codec_ctx.get(), audio_codec_ctx.get(),
447                         pathname, video_stream_index, audio_stream_index, audio_frame.get(), &audio_format, &audio_pts, &error);
448                 if (error) {
449                         return false;
450                 }
451                 if (frame == nullptr) {
452                         // EOF. Loop back to the start if we can.
453                         if (av_seek_frame(format_ctx.get(), /*stream_index=*/-1, /*timestamp=*/0, /*flags=*/0) < 0) {
454                                 fprintf(stderr, "%s: Rewind failed, not looping.\n", pathname.c_str());
455                                 return true;
456                         }
457                         if (video_codec_ctx != nullptr) {
458                                 avcodec_flush_buffers(video_codec_ctx.get());
459                         }
460                         if (audio_codec_ctx != nullptr) {
461                                 avcodec_flush_buffers(audio_codec_ctx.get());
462                         }
463                         // If the file has changed since last time, return to get it reloaded.
464                         // Note that depending on how you move the file into place, you might
465                         // end up corrupting the one you're already playing, so this path
466                         // might not trigger.
467                         if (changed_since(pathname, last_modified)) {
468                                 return true;
469                         }
470                         internal_rewind();
471                         continue;
472                 }
473
474                 VideoFormat video_format = construct_video_format(frame.get(), video_timebase);
475                 UniqueFrame video_frame = make_video_frame(frame.get(), pathname, &error);
476                 if (error) {
477                         return false;
478                 }
479
480                 for ( ;; ) {
481                         if (last_pts == 0 && pts_origin == 0) {
482                                 pts_origin = frame->pts;        
483                         }
484                         next_frame_start = compute_frame_start(frame->pts, pts_origin, video_timebase, start, rate);
485                         if (first_frame && last_frame_was_connected) {
486                                 // If reconnect took more than one second, this is probably a live feed,
487                                 // and we should reset the resampler. (Or the rate is really, really low,
488                                 // in which case a reset on the first frame is fine anyway.)
489                                 if (duration<double>(next_frame_start - last_frame).count() >= 1.0) {
490                                         last_frame_was_connected = false;
491                                 }
492                         }
493                         video_frame->received_timestamp = next_frame_start;
494
495                         // The easiest way to get all the rate conversions etc. right is to move the
496                         // audio PTS into the video PTS timebase and go from there. (We'll get some
497                         // rounding issues, but they should not be a big problem.)
498                         int64_t audio_pts_as_video_pts = av_rescale_q(audio_pts, audio_timebase, video_timebase);
499                         audio_frame->received_timestamp = compute_frame_start(audio_pts_as_video_pts, pts_origin, video_timebase, start, rate);
500
501                         if (audio_frame->len != 0) {
502                                 // The received timestamps in Nageru are measured after we've just received the frame.
503                                 // However, pts (especially audio pts) is at the _beginning_ of the frame.
504                                 // If we have locked audio, the distinction doesn't really matter, as pts is
505                                 // on a relative scale and a fixed offset is fine. But if we don't, we will have
506                                 // a different number of samples each time, which will cause huge audio jitter
507                                 // and throw off the resampler.
508                                 //
509                                 // In a sense, we should have compensated by adding the frame and audio lengths
510                                 // to video_frame->received_timestamp and audio_frame->received_timestamp respectively,
511                                 // but that would mean extra waiting in sleep_until(). All we need is that they
512                                 // are correct relative to each other, though (and to the other frames we send),
513                                 // so just align the end of the audio frame, and we're fine.
514                                 size_t num_samples = (audio_frame->len * 8) / audio_format.bits_per_sample / audio_format.num_channels;
515                                 double offset = double(num_samples) / OUTPUT_FREQUENCY -
516                                         double(video_format.frame_rate_den) / video_format.frame_rate_nom;
517                                 audio_frame->received_timestamp += duration_cast<steady_clock::duration>(duration<double>(offset));
518                         }
519
520                         steady_clock::time_point now = steady_clock::now();
521                         if (duration<double>(now - next_frame_start).count() >= 0.1) {
522                                 // If we don't have enough CPU to keep up, or if we have a live stream
523                                 // where the initial origin was somehow wrong, we could be behind indefinitely.
524                                 // In particular, this will give the audio resampler problems as it tries
525                                 // to speed up to reduce the delay, hitting the low end of the buffer every time.
526                                 fprintf(stderr, "%s: Playback %.0f ms behind, resetting time scale\n",
527                                         pathname.c_str(),
528                                         1e3 * duration<double>(now - next_frame_start).count());
529                                 pts_origin = frame->pts;
530                                 start = next_frame_start = now;
531                                 timecode += MAX_FPS * 2 + 1;
532                         }
533                         bool finished_wakeup = producer_thread_should_quit.sleep_until(next_frame_start);
534                         if (finished_wakeup) {
535                                 if (audio_frame->len > 0) {
536                                         assert(audio_pts != -1);
537                                 }
538                                 if (!last_frame_was_connected) {
539                                         // We're recovering from an error (or really slow load, see above).
540                                         // Make sure to get the audio resampler reset. (This is a hack;
541                                         // ideally, the frame callback should just accept a way to signal
542                                         // audio discontinuity.)
543                                         timecode += MAX_FPS * 2 + 1;
544                                 }
545                                 frame_callback(frame->pts, video_timebase, audio_pts, audio_timebase, timecode++,
546                                         video_frame.get_and_release(), 0, video_format,
547                                         audio_frame.get_and_release(), 0, audio_format);
548                                 first_frame = false;
549                                 last_frame = steady_clock::now();
550                                 last_frame_was_connected = true;
551                                 break;
552                         } else {
553                                 if (producer_thread_should_quit.should_quit()) break;
554
555                                 bool rewound = false;
556                                 if (process_queued_commands(format_ctx.get(), pathname, last_modified, &rewound)) {
557                                         return true;
558                                 }
559                                 // If we just rewound, drop this frame on the floor and be done.
560                                 if (rewound) {
561                                         break;
562                                 }
563                                 // OK, we didn't, so probably a rate change. Recalculate next_frame_start,
564                                 // but if it's now in the past, we'll reset the origin, so that we don't
565                                 // generate a huge backlog of frames that we need to run through quickly.
566                                 next_frame_start = compute_frame_start(frame->pts, pts_origin, video_timebase, start, rate);
567                                 steady_clock::time_point now = steady_clock::now();
568                                 if (next_frame_start < now) {
569                                         pts_origin = frame->pts;
570                                         start = next_frame_start = now;
571                                 }
572                         }
573                 }
574                 last_pts = frame->pts;
575         }
576         return true;
577 }
578
579 void FFmpegCapture::internal_rewind()
580 {                               
581         pts_origin = last_pts = 0;
582         start = next_frame_start = steady_clock::now();
583 }
584
585 bool FFmpegCapture::process_queued_commands(AVFormatContext *format_ctx, const std::string &pathname, timespec last_modified, bool *rewound)
586 {
587         // Process any queued commands from other threads.
588         vector<QueuedCommand> commands;
589         {
590                 lock_guard<mutex> lock(queue_mu);
591                 swap(commands, command_queue);
592         }
593         for (const QueuedCommand &cmd : commands) {
594                 switch (cmd.command) {
595                 case QueuedCommand::REWIND:
596                         if (av_seek_frame(format_ctx, /*stream_index=*/-1, /*timestamp=*/0, /*flags=*/0) < 0) {
597                                 fprintf(stderr, "%s: Rewind failed, stopping play.\n", pathname.c_str());
598                         }
599                         // If the file has changed since last time, return to get it reloaded.
600                         // Note that depending on how you move the file into place, you might
601                         // end up corrupting the one you're already playing, so this path
602                         // might not trigger.
603                         if (changed_since(pathname, last_modified)) {
604                                 return true;
605                         }
606                         internal_rewind();
607                         if (rewound != nullptr) {
608                                 *rewound = true;
609                         }
610                         break;
611
612                 case QueuedCommand::CHANGE_RATE:
613                         // Change the origin to the last played frame.
614                         start = compute_frame_start(last_pts, pts_origin, video_timebase, start, rate);
615                         pts_origin = last_pts;
616                         rate = cmd.new_rate;
617                         break;
618                 }
619         }
620         return false;
621 }
622
623 namespace {
624
625 }  // namespace
626
627 AVFrameWithDeleter FFmpegCapture::decode_frame(AVFormatContext *format_ctx, AVCodecContext *video_codec_ctx, AVCodecContext *audio_codec_ctx,
628         const std::string &pathname, int video_stream_index, int audio_stream_index,
629         FrameAllocator::Frame *audio_frame, AudioFormat *audio_format, int64_t *audio_pts, bool *error)
630 {
631         *error = false;
632
633         // Read packets until we have a frame or there are none left.
634         bool frame_finished = false;
635         AVFrameWithDeleter audio_avframe = av_frame_alloc_unique();
636         AVFrameWithDeleter video_avframe = av_frame_alloc_unique();
637         bool eof = false;
638         *audio_pts = -1;
639         bool has_audio = false;
640         do {
641                 AVPacket pkt;
642                 unique_ptr<AVPacket, decltype(av_packet_unref)*> pkt_cleanup(
643                         &pkt, av_packet_unref);
644                 av_init_packet(&pkt);
645                 pkt.data = nullptr;
646                 pkt.size = 0;
647                 if (av_read_frame(format_ctx, &pkt) == 0) {
648                         if (pkt.stream_index == audio_stream_index && audio_callback != nullptr) {
649                                 audio_callback(&pkt, format_ctx->streams[audio_stream_index]->time_base);
650                         }
651                         if (pkt.stream_index == video_stream_index) {
652                                 if (avcodec_send_packet(video_codec_ctx, &pkt) < 0) {
653                                         fprintf(stderr, "%s: Cannot send packet to video codec.\n", pathname.c_str());
654                                         *error = true;
655                                         return AVFrameWithDeleter(nullptr);
656                                 }
657                         } else if (pkt.stream_index == audio_stream_index) {
658                                 has_audio = true;
659                                 if (avcodec_send_packet(audio_codec_ctx, &pkt) < 0) {
660                                         fprintf(stderr, "%s: Cannot send packet to audio codec.\n", pathname.c_str());
661                                         *error = true;
662                                         return AVFrameWithDeleter(nullptr);
663                                 }
664                         }
665                 } else {
666                         eof = true;  // Or error, but ignore that for the time being.
667                 }
668
669                 // Decode audio, if any.
670                 if (has_audio) {
671                         for ( ;; ) {
672                                 int err = avcodec_receive_frame(audio_codec_ctx, audio_avframe.get());
673                                 if (err == 0) {
674                                         if (*audio_pts == -1) {
675                                                 *audio_pts = audio_avframe->pts;
676                                         }
677                                         convert_audio(audio_avframe.get(), audio_frame, audio_format);
678                                 } else if (err == AVERROR(EAGAIN)) {
679                                         break;
680                                 } else {
681                                         fprintf(stderr, "%s: Cannot receive frame from audio codec.\n", pathname.c_str());
682                                         *error = true;
683                                         return AVFrameWithDeleter(nullptr);
684                                 }
685                         }
686                 }
687
688                 // Decode video, if we have a frame.
689                 int err = avcodec_receive_frame(video_codec_ctx, video_avframe.get());
690                 if (err == 0) {
691                         frame_finished = true;
692                         break;
693                 } else if (err != AVERROR(EAGAIN)) {
694                         fprintf(stderr, "%s: Cannot receive frame from video codec.\n", pathname.c_str());
695                         *error = true;
696                         return AVFrameWithDeleter(nullptr);
697                 }
698         } while (!eof);
699
700         if (frame_finished)
701                 return video_avframe;
702         else
703                 return AVFrameWithDeleter(nullptr);
704 }
705
706 void FFmpegCapture::convert_audio(const AVFrame *audio_avframe, FrameAllocator::Frame *audio_frame, AudioFormat *audio_format)
707 {
708         // Decide on a format. If there already is one in this audio frame,
709         // we're pretty much forced to use it. If not, we try to find an exact match.
710         // If that still doesn't work, we default to 32-bit signed chunked
711         // (float would be nice, but there's really no way to signal that yet).
712         AVSampleFormat dst_format;
713         if (audio_format->bits_per_sample == 0) {
714                 switch (audio_avframe->format) {
715                 case AV_SAMPLE_FMT_S16:
716                 case AV_SAMPLE_FMT_S16P:
717                         audio_format->bits_per_sample = 16;
718                         dst_format = AV_SAMPLE_FMT_S16;
719                         break;
720                 case AV_SAMPLE_FMT_S32:
721                 case AV_SAMPLE_FMT_S32P:
722                 default:
723                         audio_format->bits_per_sample = 32;
724                         dst_format = AV_SAMPLE_FMT_S32;
725                         break;
726                 }
727         } else if (audio_format->bits_per_sample == 16) {
728                 dst_format = AV_SAMPLE_FMT_S16;
729         } else if (audio_format->bits_per_sample == 32) {
730                 dst_format = AV_SAMPLE_FMT_S32;
731         } else {
732                 assert(false);
733         }
734         audio_format->num_channels = 2;
735
736         int64_t channel_layout = audio_avframe->channel_layout;
737         if (channel_layout == 0) {
738                 channel_layout = av_get_default_channel_layout(audio_avframe->channels);
739         }
740
741         if (resampler == nullptr ||
742             audio_avframe->format != last_src_format ||
743             dst_format != last_dst_format ||
744             channel_layout != last_channel_layout ||
745             av_frame_get_sample_rate(audio_avframe) != last_sample_rate) {
746                 avresample_free(&resampler);
747                 resampler = avresample_alloc_context();
748                 if (resampler == nullptr) {
749                         fprintf(stderr, "Allocating resampler failed.\n");
750                         exit(1);
751                 }
752
753                 av_opt_set_int(resampler, "in_channel_layout",  channel_layout,                             0);
754                 av_opt_set_int(resampler, "out_channel_layout", AV_CH_LAYOUT_STEREO,                        0);
755                 av_opt_set_int(resampler, "in_sample_rate",     av_frame_get_sample_rate(audio_avframe),    0);
756                 av_opt_set_int(resampler, "out_sample_rate",    OUTPUT_FREQUENCY,                           0);
757                 av_opt_set_int(resampler, "in_sample_fmt",      audio_avframe->format,                      0);
758                 av_opt_set_int(resampler, "out_sample_fmt",     dst_format,                                 0);
759
760                 if (avresample_open(resampler) < 0) {
761                         fprintf(stderr, "Could not open resample context.\n");
762                         exit(1);
763                 }
764
765                 last_src_format = AVSampleFormat(audio_avframe->format);
766                 last_dst_format = dst_format;
767                 last_channel_layout = channel_layout;
768                 last_sample_rate = av_frame_get_sample_rate(audio_avframe);
769         }
770
771         size_t bytes_per_sample = (audio_format->bits_per_sample / 8) * 2;
772         size_t num_samples_room = (audio_frame->size - audio_frame->len) / bytes_per_sample;
773
774         uint8_t *data = audio_frame->data + audio_frame->len;
775         int out_samples = avresample_convert(resampler, &data, 0, num_samples_room,
776                 const_cast<uint8_t **>(audio_avframe->data), audio_avframe->linesize[0], audio_avframe->nb_samples);
777         if (out_samples < 0) {
778                 fprintf(stderr, "Audio conversion failed.\n");
779                 exit(1);
780         }
781
782         audio_frame->len += out_samples * bytes_per_sample;
783 }
784
785 VideoFormat FFmpegCapture::construct_video_format(const AVFrame *frame, AVRational video_timebase)
786 {
787         VideoFormat video_format;
788         video_format.width = width;
789         video_format.height = height;
790         if (pixel_format == bmusb::PixelFormat_8BitBGRA) {
791                 video_format.stride = width * 4;
792         } else if (pixel_format == FFmpegCapture::PixelFormat_NV12) {
793                 video_format.stride = width;
794         } else {
795                 assert(pixel_format == bmusb::PixelFormat_8BitYCbCrPlanar);
796                 video_format.stride = width;
797         }
798         video_format.frame_rate_nom = video_timebase.den;
799         video_format.frame_rate_den = av_frame_get_pkt_duration(frame) * video_timebase.num;
800         if (video_format.frame_rate_nom == 0 || video_format.frame_rate_den == 0) {
801                 // Invalid frame rate.
802                 video_format.frame_rate_nom = 60;
803                 video_format.frame_rate_den = 1;
804         }
805         video_format.has_signal = true;
806         video_format.is_connected = true;
807         return video_format;
808 }
809
810 UniqueFrame FFmpegCapture::make_video_frame(const AVFrame *frame, const string &pathname, bool *error)
811 {
812         *error = false;
813
814         UniqueFrame video_frame(video_frame_allocator->alloc_frame());
815         if (video_frame->data == nullptr) {
816                 return video_frame;
817         }
818
819         if (sws_ctx == nullptr ||
820             sws_last_width != frame->width ||
821             sws_last_height != frame->height ||
822             sws_last_src_format != frame->format) {
823                 sws_dst_format = decide_dst_format(AVPixelFormat(frame->format), pixel_format);
824                 sws_ctx.reset(
825                         sws_getContext(frame->width, frame->height, AVPixelFormat(frame->format),
826                                 width, height, sws_dst_format,
827                                 SWS_BICUBIC, nullptr, nullptr, nullptr));
828                 sws_last_width = frame->width;
829                 sws_last_height = frame->height;
830                 sws_last_src_format = frame->format;
831         }
832         if (sws_ctx == nullptr) {
833                 fprintf(stderr, "%s: Could not create scaler context\n", pathname.c_str());
834                 *error = true;
835                 return video_frame;
836         }
837
838         uint8_t *pic_data[4] = { nullptr, nullptr, nullptr, nullptr };
839         int linesizes[4] = { 0, 0, 0, 0 };
840         if (pixel_format == bmusb::PixelFormat_8BitBGRA) {
841                 pic_data[0] = video_frame->data;
842                 linesizes[0] = width * 4;
843                 video_frame->len = (width * 4) * height;
844         } else if (pixel_format == PixelFormat_NV12) {
845                 pic_data[0] = video_frame->data;
846                 linesizes[0] = width;
847
848                 pic_data[1] = pic_data[0] + width * height;
849                 linesizes[1] = width;
850
851                 video_frame->len = (width * 2) * height;
852
853                 const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(sws_dst_format);
854                 current_frame_ycbcr_format = decode_ycbcr_format(desc, frame);
855         } else {
856                 assert(pixel_format == bmusb::PixelFormat_8BitYCbCrPlanar);
857                 const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(sws_dst_format);
858
859                 int chroma_width = AV_CEIL_RSHIFT(int(width), desc->log2_chroma_w);
860                 int chroma_height = AV_CEIL_RSHIFT(int(height), desc->log2_chroma_h);
861
862                 pic_data[0] = video_frame->data;
863                 linesizes[0] = width;
864
865                 pic_data[1] = pic_data[0] + width * height;
866                 linesizes[1] = chroma_width;
867
868                 pic_data[2] = pic_data[1] + chroma_width * chroma_height;
869                 linesizes[2] = chroma_width;
870
871                 video_frame->len = width * height + 2 * chroma_width * chroma_height;
872
873                 current_frame_ycbcr_format = decode_ycbcr_format(desc, frame);
874         }
875         sws_scale(sws_ctx.get(), frame->data, frame->linesize, 0, frame->height, pic_data, linesizes);
876
877         return video_frame;
878 }
879
880 int FFmpegCapture::interrupt_cb_thunk(void *unique)
881 {
882         return reinterpret_cast<FFmpegCapture *>(unique)->interrupt_cb();
883 }
884
885 int FFmpegCapture::interrupt_cb()
886 {
887         return should_interrupt.load();
888 }