| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261 | 
							- /******************************************************************************
 
-     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)
 
- {
 
- 	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 = bzalloc(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);
 
- 	}
 
- }
 
 
  |