| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265 |
- /******************************************************************************
- Copyright (C) 2013 by Hugh Bailey <[email protected]>
- This program is free software: you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation, either version 2 of the License, or
- (at your option) any later version.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- You should have received a copy of the GNU General Public License
- along with this program. If not, see <http://www.gnu.org/licenses/>.
- ******************************************************************************/
- #include <assert.h>
- #include "../util/bmem.h"
- #include "../util/platform.h"
- #include "../util/threading.h"
- #include "../util/darray.h"
- #include "format-conversion.h"
- #include "video-io.h"
- struct video_input {
- struct video_convert_info conversion;
- void (*callback)(void *param, const struct video_frame *frame);
- void *param;
- };
- struct video_output {
- struct video_output_info info;
- pthread_t thread;
- pthread_mutex_t data_mutex;
- event_t stop_event;
- struct video_frame cur_frame;
- struct video_frame next_frame;
- bool new_frame;
- event_t update_event;
- uint64_t frame_time;
- volatile uint64_t cur_video_time;
- bool initialized;
- pthread_mutex_t input_mutex;
- DARRAY(struct video_input) inputs;
- };
- /* ------------------------------------------------------------------------- */
- static inline void video_swapframes(struct video_output *video)
- {
- if (video->new_frame) {
- video->cur_frame = video->next_frame;
- video->new_frame = false;
- }
- }
- static inline void video_output_cur_frame(struct video_output *video)
- {
- size_t width = video->info.width;
- size_t height = video->info.height;
- if (!video->cur_frame.data[0])
- return;
- pthread_mutex_lock(&video->input_mutex);
- /* TODO: conversion */
- for (size_t i = 0; i < video->inputs.num; i++) {
- struct video_input *input = video->inputs.array+i;
- input->callback(input->param, &video->cur_frame);
- }
- pthread_mutex_unlock(&video->input_mutex);
- }
- static void *video_thread(void *param)
- {
- struct video_output *video = param;
- uint64_t cur_time = os_gettime_ns();
- while (event_try(&video->stop_event) == EAGAIN) {
- /* wait half a frame, update frame */
- os_sleepto_ns(cur_time += (video->frame_time/2));
- video->cur_video_time = cur_time;
- event_signal(&video->update_event);
- /* wait another half a frame, swap and output frames */
- os_sleepto_ns(cur_time += (video->frame_time/2));
- pthread_mutex_lock(&video->data_mutex);
- video_swapframes(video);
- video_output_cur_frame(video);
- pthread_mutex_unlock(&video->data_mutex);
- }
- return NULL;
- }
- /* ------------------------------------------------------------------------- */
- static inline bool valid_video_params(struct video_output_info *info)
- {
- return info->height != 0 && info->width != 0 && info->fps_den != 0 &&
- info->fps_num != 0;
- }
- int video_output_open(video_t *video, struct video_output_info *info)
- {
- struct video_output *out;
- if (!valid_video_params(info))
- return VIDEO_OUTPUT_INVALIDPARAM;
- out = bmalloc(sizeof(struct video_output));
- memset(out, 0, sizeof(struct video_output));
- memcpy(&out->info, info, sizeof(struct video_output_info));
- out->frame_time = (uint64_t)(1000000000.0 * (double)info->fps_den /
- (double)info->fps_num);
- out->initialized = false;
- if (pthread_mutex_init(&out->data_mutex, NULL) != 0)
- goto fail;
- if (pthread_mutex_init(&out->input_mutex, NULL) != 0)
- goto fail;
- if (event_init(&out->stop_event, EVENT_TYPE_MANUAL) != 0)
- goto fail;
- if (event_init(&out->update_event, EVENT_TYPE_AUTO) != 0)
- goto fail;
- if (pthread_create(&out->thread, NULL, video_thread, out) != 0)
- goto fail;
- out->initialized = true;
- *video = out;
- return VIDEO_OUTPUT_SUCCESS;
- fail:
- video_output_close(out);
- return VIDEO_OUTPUT_FAIL;
- }
- void video_output_close(video_t video)
- {
- if (!video)
- return;
- video_output_stop(video);
- da_free(video->inputs);
- event_destroy(&video->update_event);
- event_destroy(&video->stop_event);
- pthread_mutex_destroy(&video->data_mutex);
- pthread_mutex_destroy(&video->input_mutex);
- bfree(video);
- }
- static size_t video_get_input_idx(video_t video,
- void (*callback)(void *param, const struct video_frame *frame),
- void *param)
- {
- for (size_t i = 0; i < video->inputs.num; i++) {
- struct video_input *input = video->inputs.array+i;
- if (input->callback == callback && input->param == param)
- return i;
- }
- return DARRAY_INVALID;
- }
- void video_output_connect(video_t video,
- struct video_convert_info *conversion,
- void (*callback)(void *param, const struct video_frame *frame),
- void *param)
- {
- pthread_mutex_lock(&video->input_mutex);
- if (video_get_input_idx(video, callback, param) == DARRAY_INVALID) {
- struct video_input input;
- input.callback = callback;
- input.param = param;
- /* TODO: conversion */
- if (conversion) {
- input.conversion = *conversion;
- if (input.conversion.width == 0)
- input.conversion.width = video->info.width;
- if (input.conversion.height == 0)
- input.conversion.height = video->info.height;
- } else {
- input.conversion.format = video->info.format;
- input.conversion.width = video->info.width;
- input.conversion.height = video->info.height;
- }
- da_push_back(video->inputs, &input);
- }
- pthread_mutex_unlock(&video->input_mutex);
- }
- void video_output_disconnect(video_t video,
- void (*callback)(void *param, const struct video_frame *frame),
- void *param)
- {
- pthread_mutex_lock(&video->input_mutex);
- size_t idx = video_get_input_idx(video, callback, param);
- if (idx != DARRAY_INVALID)
- da_erase(video->inputs, idx);
- pthread_mutex_unlock(&video->input_mutex);
- }
- const struct video_output_info *video_output_getinfo(video_t video)
- {
- return &video->info;
- }
- void video_output_frame(video_t video, struct video_frame *frame)
- {
- pthread_mutex_lock(&video->data_mutex);
- video->next_frame = *frame;
- video->new_frame = true;
- pthread_mutex_unlock(&video->data_mutex);
- }
- bool video_output_wait(video_t video)
- {
- event_wait(&video->update_event);
- return event_try(&video->stop_event) == EAGAIN;
- }
- uint64_t video_getframetime(video_t video)
- {
- return video->frame_time;
- }
- uint64_t video_gettime(video_t video)
- {
- return video->cur_video_time;
- }
- void video_output_stop(video_t video)
- {
- void *thread_ret;
- if (!video)
- return;
- if (video->initialized) {
- event_signal(&video->stop_event);
- pthread_join(video->thread, &thread_ret);
- event_signal(&video->update_event);
- }
- }
|