1
0

v4l2-input.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988
  1. /*
  2. Copyright (C) 2014 by Leonhard Oelke <[email protected]>
  3. This program is free software: you can redistribute it and/or modify
  4. it under the terms of the GNU General Public License as published by
  5. the Free Software Foundation, either version 2 of the License, or
  6. (at your option) any later version.
  7. This program is distributed in the hope that it will be useful,
  8. but WITHOUT ANY WARRANTY; without even the implied warranty of
  9. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  10. GNU General Public License for more details.
  11. You should have received a copy of the GNU General Public License
  12. along with this program. If not, see <http://www.gnu.org/licenses/>.
  13. */
  14. #include <stdio.h>
  15. #include <stdlib.h>
  16. #include <unistd.h>
  17. #include <string.h>
  18. #include <inttypes.h>
  19. #include <fcntl.h>
  20. #include <dirent.h>
  21. #include <sys/time.h>
  22. #include <sys/types.h>
  23. #include <sys/ioctl.h>
  24. #include <sys/select.h>
  25. #include <linux/videodev2.h>
  26. #include <libv4l2.h>
  27. #include <util/threading.h>
  28. #include <util/bmem.h>
  29. #include <util/dstr.h>
  30. #include <util/platform.h>
  31. #include <obs-module.h>
  32. #include "v4l2-helpers.h"
  33. #if HAVE_UDEV
  34. #include "v4l2-udev.h"
  35. #endif
  36. /* The new dv timing api was introduced in Linux 3.4
  37. * Currently we simply disable dv timings when this is not defined */
  38. #if !defined(VIDIOC_ENUM_DV_TIMINGS) || !defined(V4L2_IN_CAP_DV_TIMINGS)
  39. #define V4L2_IN_CAP_DV_TIMINGS 0
  40. #endif
  41. #define V4L2_DATA(voidptr) struct v4l2_data *data = voidptr;
  42. #define timeval2ns(tv) \
  43. (((uint64_t) tv.tv_sec * 1000000000) + ((uint64_t) tv.tv_usec * 1000))
  44. #define V4L2_FOURCC_STR(code) \
  45. (char[5]) { \
  46. (code >> 24) & 0xFF, \
  47. (code >> 16) & 0xFF, \
  48. (code >> 8) & 0xFF, \
  49. code & 0xFF, \
  50. 0 \
  51. }
  52. #define blog(level, msg, ...) blog(level, "v4l2-input: " msg, ##__VA_ARGS__)
  53. /**
  54. * Data structure for the v4l2 source
  55. */
  56. struct v4l2_data {
  57. /* settings */
  58. char *device_id;
  59. int input;
  60. int pixfmt;
  61. int standard;
  62. int dv_timing;
  63. int resolution;
  64. int framerate;
  65. /* internal data */
  66. obs_source_t *source;
  67. pthread_t thread;
  68. os_event_t *event;
  69. int_fast32_t dev;
  70. int width;
  71. int height;
  72. int linesize;
  73. struct v4l2_buffer_data buffers;
  74. };
  75. /* forward declarations */
  76. static void v4l2_init(struct v4l2_data *data);
  77. static void v4l2_terminate(struct v4l2_data *data);
  78. /**
  79. * Prepare the output frame structure for obs and compute plane offsets
  80. *
  81. * Basically all data apart from memory pointers and the timestamp is known
  82. * before the capture starts. This function prepares the obs_source_frame
  83. * struct with all the data that is already known.
  84. *
  85. * v4l2 uses a continuous memory segment for all planes so we simply compute
  86. * offsets to add to the start address in order to give obs the correct data
  87. * pointers for the individual planes.
  88. */
  89. static void v4l2_prep_obs_frame(struct v4l2_data *data,
  90. struct obs_source_frame *frame, size_t *plane_offsets)
  91. {
  92. memset(frame, 0, sizeof(struct obs_source_frame));
  93. memset(plane_offsets, 0, sizeof(size_t) * MAX_AV_PLANES);
  94. frame->width = data->width;
  95. frame->height = data->height;
  96. frame->format = v4l2_to_obs_video_format(data->pixfmt);
  97. video_format_get_parameters(VIDEO_CS_DEFAULT, VIDEO_RANGE_PARTIAL,
  98. frame->color_matrix, frame->color_range_min,
  99. frame->color_range_max);
  100. switch(data->pixfmt) {
  101. case V4L2_PIX_FMT_NV12:
  102. frame->linesize[0] = data->linesize;
  103. frame->linesize[1] = data->linesize / 2;
  104. plane_offsets[1] = data->linesize * data->height;
  105. break;
  106. case V4L2_PIX_FMT_YVU420:
  107. frame->linesize[0] = data->linesize;
  108. frame->linesize[1] = data->linesize / 2;
  109. frame->linesize[2] = data->linesize / 2;
  110. plane_offsets[1] = data->linesize * data->height * 5 / 4;
  111. plane_offsets[2] = data->linesize * data->height;
  112. break;
  113. case V4L2_PIX_FMT_YUV420:
  114. frame->linesize[0] = data->linesize;
  115. frame->linesize[1] = data->linesize / 2;
  116. frame->linesize[2] = data->linesize / 2;
  117. plane_offsets[1] = data->linesize * data->height;
  118. plane_offsets[2] = data->linesize * data->height * 5 / 4;
  119. break;
  120. default:
  121. frame->linesize[0] = data->linesize;
  122. break;
  123. }
  124. }
  125. /*
  126. * Worker thread to get video data
  127. */
  128. static void *v4l2_thread(void *vptr)
  129. {
  130. V4L2_DATA(vptr);
  131. int r;
  132. fd_set fds;
  133. uint8_t *start;
  134. uint64_t frames;
  135. uint64_t first_ts;
  136. struct timeval tv;
  137. struct v4l2_buffer buf;
  138. struct obs_source_frame out;
  139. size_t plane_offsets[MAX_AV_PLANES];
  140. if (v4l2_start_capture(data->dev, &data->buffers) < 0)
  141. goto exit;
  142. frames = 0;
  143. first_ts = 0;
  144. v4l2_prep_obs_frame(data, &out, plane_offsets);
  145. while (os_event_try(data->event) == EAGAIN) {
  146. FD_ZERO(&fds);
  147. FD_SET(data->dev, &fds);
  148. tv.tv_sec = 1;
  149. tv.tv_usec = 0;
  150. r = select(data->dev + 1, &fds, NULL, NULL, &tv);
  151. if (r < 0) {
  152. if (errno == EINTR)
  153. continue;
  154. blog(LOG_DEBUG, "select failed");
  155. break;
  156. } else if (r == 0) {
  157. blog(LOG_DEBUG, "select timeout");
  158. continue;
  159. }
  160. buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  161. buf.memory = V4L2_MEMORY_MMAP;
  162. if (v4l2_ioctl(data->dev, VIDIOC_DQBUF, &buf) < 0) {
  163. if (errno == EAGAIN)
  164. continue;
  165. blog(LOG_DEBUG, "failed to dequeue buffer");
  166. break;
  167. }
  168. out.timestamp = timeval2ns(buf.timestamp);
  169. if (!frames)
  170. first_ts = out.timestamp;
  171. out.timestamp -= first_ts;
  172. start = (uint8_t *) data->buffers.info[buf.index].start;
  173. for (uint_fast32_t i = 0; i < MAX_AV_PLANES; ++i)
  174. out.data[i] = start + plane_offsets[i];
  175. obs_source_output_video(data->source, &out);
  176. if (v4l2_ioctl(data->dev, VIDIOC_QBUF, &buf) < 0) {
  177. blog(LOG_DEBUG, "failed to enqueue buffer");
  178. break;
  179. }
  180. frames++;
  181. }
  182. blog(LOG_INFO, "Stopped capture after %"PRIu64" frames", frames);
  183. exit:
  184. v4l2_stop_capture(data->dev);
  185. return NULL;
  186. }
  187. static const char* v4l2_getname(void)
  188. {
  189. return obs_module_text("V4L2Input");
  190. }
  191. static void v4l2_defaults(obs_data_t *settings)
  192. {
  193. obs_data_set_default_int(settings, "input", -1);
  194. obs_data_set_default_int(settings, "pixelformat", -1);
  195. obs_data_set_default_int(settings, "standard", -1);
  196. obs_data_set_default_int(settings, "dv_timing", -1);
  197. obs_data_set_default_int(settings, "resolution", -1);
  198. obs_data_set_default_int(settings, "framerate", -1);
  199. obs_data_set_default_bool(settings, "buffering", true);
  200. }
  201. /**
  202. * Enable/Disable all properties for the source.
  203. *
  204. * @note A property that should be ignored can be specified
  205. *
  206. * @param props the source properties
  207. * @param ignore ignore this property
  208. * @param enable enable/disable all properties
  209. */
  210. static void v4l2_props_set_enabled(obs_properties_t *props,
  211. obs_property_t *ignore, bool enable)
  212. {
  213. if (!props)
  214. return;
  215. for (obs_property_t *prop = obs_properties_first(props); prop != NULL;
  216. obs_property_next(&prop)) {
  217. if (prop == ignore)
  218. continue;
  219. obs_property_set_enabled(prop, enable);
  220. }
  221. }
  222. /*
  223. * List available devices
  224. */
  225. static void v4l2_device_list(obs_property_t *prop, obs_data_t *settings)
  226. {
  227. DIR *dirp;
  228. struct dirent *dp;
  229. struct dstr device;
  230. bool cur_device_found;
  231. size_t cur_device_index;
  232. const char *cur_device_name;
  233. #ifdef __FreeBSD__
  234. dirp = opendir("/dev");
  235. #else
  236. dirp = opendir("/sys/class/video4linux");
  237. #endif
  238. if (!dirp)
  239. return;
  240. cur_device_found = false;
  241. cur_device_name = obs_data_get_string(settings, "device_id");
  242. obs_property_list_clear(prop);
  243. dstr_init_copy(&device, "/dev/");
  244. while ((dp = readdir(dirp)) != NULL) {
  245. int fd;
  246. uint32_t caps;
  247. struct v4l2_capability video_cap;
  248. #ifdef __FreeBSD__
  249. if (strstr(dp->d_name, "video") == NULL)
  250. continue;
  251. #endif
  252. if (dp->d_type == DT_DIR)
  253. continue;
  254. dstr_resize(&device, 5);
  255. dstr_cat(&device, dp->d_name);
  256. if ((fd = v4l2_open(device.array, O_RDWR | O_NONBLOCK)) == -1) {
  257. blog(LOG_INFO, "Unable to open %s", device.array);
  258. continue;
  259. }
  260. if (v4l2_ioctl(fd, VIDIOC_QUERYCAP, &video_cap) == -1) {
  261. blog(LOG_INFO, "Failed to query capabilities for %s",
  262. device.array);
  263. v4l2_close(fd);
  264. continue;
  265. }
  266. #ifndef V4L2_CAP_DEVICE_CAPS
  267. caps = video_cap.capabilities;
  268. #else
  269. /* ... since Linux 3.3 */
  270. caps = (video_cap.capabilities & V4L2_CAP_DEVICE_CAPS)
  271. ? video_cap.device_caps
  272. : video_cap.capabilities;
  273. #endif
  274. if (!(caps & V4L2_CAP_VIDEO_CAPTURE)) {
  275. blog(LOG_INFO, "%s seems to not support video capture",
  276. device.array);
  277. v4l2_close(fd);
  278. continue;
  279. }
  280. obs_property_list_add_string(prop, (char *) video_cap.card,
  281. device.array);
  282. blog(LOG_INFO, "Found device '%s' at %s", video_cap.card,
  283. device.array);
  284. /* check if this is the currently used device */
  285. if (cur_device_name && !strcmp(cur_device_name, device.array))
  286. cur_device_found = true;
  287. v4l2_close(fd);
  288. }
  289. /* add currently selected device if not present, but disable it ... */
  290. if (!cur_device_found && cur_device_name && strlen(cur_device_name)) {
  291. cur_device_index = obs_property_list_add_string(prop,
  292. cur_device_name, cur_device_name);
  293. obs_property_list_item_disable(prop, cur_device_index, true);
  294. }
  295. closedir(dirp);
  296. dstr_free(&device);
  297. }
  298. /*
  299. * List inputs for device
  300. */
  301. static void v4l2_input_list(int_fast32_t dev, obs_property_t *prop)
  302. {
  303. struct v4l2_input in;
  304. memset(&in, 0, sizeof(in));
  305. obs_property_list_clear(prop);
  306. while (v4l2_ioctl(dev, VIDIOC_ENUMINPUT, &in) == 0) {
  307. obs_property_list_add_int(prop, (char *) in.name, in.index);
  308. blog(LOG_INFO, "Found input '%s' (Index %d)", in.name,
  309. in.index);
  310. in.index++;
  311. }
  312. }
  313. /*
  314. * List formats for device
  315. */
  316. static void v4l2_format_list(int dev, obs_property_t *prop)
  317. {
  318. struct v4l2_fmtdesc fmt;
  319. fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  320. fmt.index = 0;
  321. struct dstr buffer;
  322. dstr_init(&buffer);
  323. obs_property_list_clear(prop);
  324. while (v4l2_ioctl(dev, VIDIOC_ENUM_FMT, &fmt) == 0) {
  325. dstr_copy(&buffer, (char *) fmt.description);
  326. if (fmt.flags & V4L2_FMT_FLAG_EMULATED)
  327. dstr_cat(&buffer, " (Emulated)");
  328. if (v4l2_to_obs_video_format(fmt.pixelformat)
  329. != VIDEO_FORMAT_NONE) {
  330. obs_property_list_add_int(prop, buffer.array,
  331. fmt.pixelformat);
  332. blog(LOG_INFO, "Pixelformat: %s (available)",
  333. buffer.array);
  334. } else {
  335. blog(LOG_INFO, "Pixelformat: %s (unavailable)",
  336. buffer.array);
  337. }
  338. fmt.index++;
  339. }
  340. dstr_free(&buffer);
  341. }
  342. /*
  343. * List video standards for the device
  344. */
  345. static void v4l2_standard_list(int dev, obs_property_t *prop)
  346. {
  347. struct v4l2_standard std;
  348. std.index = 0;
  349. obs_property_list_clear(prop);
  350. obs_property_list_add_int(prop, obs_module_text("LeaveUnchanged"), -1);
  351. while (v4l2_ioctl(dev, VIDIOC_ENUMSTD, &std) == 0) {
  352. obs_property_list_add_int(prop, (char *) std.name, std.id);
  353. std.index++;
  354. }
  355. }
  356. /*
  357. * List dv timings for the device
  358. */
  359. static void v4l2_dv_timing_list(int dev, obs_property_t *prop)
  360. {
  361. struct v4l2_dv_timings dvt;
  362. struct dstr buf;
  363. int index = 0;
  364. dstr_init(&buf);
  365. obs_property_list_clear(prop);
  366. obs_property_list_add_int(prop, obs_module_text("LeaveUnchanged"), -1);
  367. while (v4l2_enum_dv_timing(dev, &dvt, index) == 0) {
  368. /* i do not pretend to understand, this is from qv4l2 ... */
  369. double h = (double) dvt.bt.height + dvt.bt.vfrontporch +
  370. dvt.bt.vsync + dvt.bt.vbackporch +
  371. dvt.bt.il_vfrontporch + dvt.bt.il_vsync +
  372. dvt.bt.il_vbackporch;
  373. double w = (double) dvt.bt.width + dvt.bt.hfrontporch +
  374. dvt.bt.hsync + dvt.bt.hbackporch;
  375. double i = (dvt.bt.interlaced) ? 2.0f : 1.0f;
  376. double rate = (double) dvt.bt.pixelclock / (w * (h / i));
  377. dstr_printf(&buf, "%ux%u%c %.2f",
  378. dvt.bt.width, dvt.bt.height,
  379. (dvt.bt.interlaced) ? 'i' : 'p', rate);
  380. obs_property_list_add_int(prop, buf.array, index);
  381. index++;
  382. }
  383. dstr_free(&buf);
  384. }
  385. /*
  386. * List resolutions for device and format
  387. */
  388. static void v4l2_resolution_list(int dev, uint_fast32_t pixelformat,
  389. obs_property_t *prop)
  390. {
  391. struct v4l2_frmsizeenum frmsize;
  392. frmsize.pixel_format = pixelformat;
  393. frmsize.index = 0;
  394. struct dstr buffer;
  395. dstr_init(&buffer);
  396. obs_property_list_clear(prop);
  397. obs_property_list_add_int(prop, obs_module_text("LeaveUnchanged"), -1);
  398. v4l2_ioctl(dev, VIDIOC_ENUM_FRAMESIZES, &frmsize);
  399. switch(frmsize.type) {
  400. case V4L2_FRMSIZE_TYPE_DISCRETE:
  401. while (v4l2_ioctl(dev, VIDIOC_ENUM_FRAMESIZES, &frmsize) == 0) {
  402. dstr_printf(&buffer, "%dx%d", frmsize.discrete.width,
  403. frmsize.discrete.height);
  404. obs_property_list_add_int(prop, buffer.array,
  405. v4l2_pack_tuple(frmsize.discrete.width,
  406. frmsize.discrete.height));
  407. frmsize.index++;
  408. }
  409. break;
  410. default:
  411. blog(LOG_INFO, "Stepwise and Continuous framesizes "
  412. "are currently hardcoded");
  413. for (const int *packed = v4l2_framesizes; *packed; ++packed) {
  414. int width;
  415. int height;
  416. v4l2_unpack_tuple(&width, &height, *packed);
  417. dstr_printf(&buffer, "%dx%d", width, height);
  418. obs_property_list_add_int(prop, buffer.array, *packed);
  419. }
  420. break;
  421. }
  422. dstr_free(&buffer);
  423. }
  424. /*
  425. * List framerates for device and resolution
  426. */
  427. static void v4l2_framerate_list(int dev, uint_fast32_t pixelformat,
  428. uint_fast32_t width, uint_fast32_t height, obs_property_t *prop)
  429. {
  430. struct v4l2_frmivalenum frmival;
  431. frmival.pixel_format = pixelformat;
  432. frmival.width = width;
  433. frmival.height = height;
  434. frmival.index = 0;
  435. struct dstr buffer;
  436. dstr_init(&buffer);
  437. obs_property_list_clear(prop);
  438. obs_property_list_add_int(prop, obs_module_text("LeaveUnchanged"), -1);
  439. v4l2_ioctl(dev, VIDIOC_ENUM_FRAMEINTERVALS, &frmival);
  440. switch(frmival.type) {
  441. case V4L2_FRMIVAL_TYPE_DISCRETE:
  442. while (v4l2_ioctl(dev, VIDIOC_ENUM_FRAMEINTERVALS,
  443. &frmival) == 0) {
  444. float fps = (float) frmival.discrete.denominator /
  445. frmival.discrete.numerator;
  446. int pack = v4l2_pack_tuple(frmival.discrete.numerator,
  447. frmival.discrete.denominator);
  448. dstr_printf(&buffer, "%.2f", fps);
  449. obs_property_list_add_int(prop, buffer.array, pack);
  450. frmival.index++;
  451. }
  452. break;
  453. default:
  454. blog(LOG_INFO, "Stepwise and Continuous framerates "
  455. "are currently hardcoded");
  456. for (const int *packed = v4l2_framerates; *packed; ++packed) {
  457. int num;
  458. int denom;
  459. v4l2_unpack_tuple(&num, &denom, *packed);
  460. float fps = (float) denom / num;
  461. dstr_printf(&buffer, "%.2f", fps);
  462. obs_property_list_add_int(prop, buffer.array, *packed);
  463. }
  464. break;
  465. }
  466. dstr_free(&buffer);
  467. }
  468. /*
  469. * Device selected callback
  470. */
  471. static bool device_selected(obs_properties_t *props, obs_property_t *p,
  472. obs_data_t *settings)
  473. {
  474. int dev = v4l2_open(obs_data_get_string(settings, "device_id"),
  475. O_RDWR | O_NONBLOCK);
  476. v4l2_props_set_enabled(props, p, (dev == -1) ? false : true);
  477. if (dev == -1)
  478. return false;
  479. obs_property_t *prop = obs_properties_get(props, "input");
  480. v4l2_input_list(dev, prop);
  481. v4l2_close(dev);
  482. obs_property_modified(prop, settings);
  483. return true;
  484. }
  485. /*
  486. * Input selected callback
  487. */
  488. static bool input_selected(obs_properties_t *props, obs_property_t *p,
  489. obs_data_t *settings)
  490. {
  491. UNUSED_PARAMETER(p);
  492. int dev = v4l2_open(obs_data_get_string(settings, "device_id"),
  493. O_RDWR | O_NONBLOCK);
  494. if (dev == -1)
  495. return false;
  496. obs_property_t *prop = obs_properties_get(props, "pixelformat");
  497. v4l2_format_list(dev, prop);
  498. v4l2_close(dev);
  499. obs_property_modified(prop, settings);
  500. return true;
  501. }
  502. /*
  503. * Format selected callback
  504. */
  505. static bool format_selected(obs_properties_t *props, obs_property_t *p,
  506. obs_data_t *settings)
  507. {
  508. UNUSED_PARAMETER(p);
  509. int dev = v4l2_open(obs_data_get_string(settings, "device_id"),
  510. O_RDWR | O_NONBLOCK);
  511. if (dev == -1)
  512. return false;
  513. int input = (int) obs_data_get_int(settings, "input");
  514. uint32_t caps = 0;
  515. if (v4l2_get_input_caps(dev, input, &caps) < 0)
  516. return false;
  517. caps &= V4L2_IN_CAP_STD | V4L2_IN_CAP_DV_TIMINGS;
  518. obs_property_t *resolution = obs_properties_get(props, "resolution");
  519. obs_property_t *framerate = obs_properties_get(props, "framerate");
  520. obs_property_t *standard = obs_properties_get(props, "standard");
  521. obs_property_t *dv_timing = obs_properties_get(props, "dv_timing");
  522. obs_property_set_visible(resolution, (!caps) ? true : false);
  523. obs_property_set_visible(framerate, (!caps) ? true : false);
  524. obs_property_set_visible(standard,
  525. (caps & V4L2_IN_CAP_STD) ? true : false);
  526. obs_property_set_visible(dv_timing,
  527. (caps & V4L2_IN_CAP_DV_TIMINGS) ? true : false);
  528. if (!caps) {
  529. v4l2_resolution_list(dev, obs_data_get_int(
  530. settings, "pixelformat"), resolution);
  531. }
  532. if (caps & V4L2_IN_CAP_STD)
  533. v4l2_standard_list(dev, standard);
  534. if (caps & V4L2_IN_CAP_DV_TIMINGS)
  535. v4l2_dv_timing_list(dev, dv_timing);
  536. v4l2_close(dev);
  537. if (!caps)
  538. obs_property_modified(resolution, settings);
  539. if (caps & V4L2_IN_CAP_STD)
  540. obs_property_modified(standard, settings);
  541. if (caps & V4L2_IN_CAP_DV_TIMINGS)
  542. obs_property_modified(dv_timing, settings);
  543. return true;
  544. }
  545. /*
  546. * Resolution selected callback
  547. */
  548. static bool resolution_selected(obs_properties_t *props, obs_property_t *p,
  549. obs_data_t *settings)
  550. {
  551. UNUSED_PARAMETER(p);
  552. int width, height;
  553. int dev = v4l2_open(obs_data_get_string(settings, "device_id"),
  554. O_RDWR | O_NONBLOCK);
  555. if (dev == -1)
  556. return false;
  557. obs_property_t *prop = obs_properties_get(props, "framerate");
  558. v4l2_unpack_tuple(&width, &height, obs_data_get_int(settings,
  559. "resolution"));
  560. v4l2_framerate_list(dev, obs_data_get_int(settings, "pixelformat"),
  561. width, height, prop);
  562. v4l2_close(dev);
  563. obs_property_modified(prop, settings);
  564. return true;
  565. }
  566. #if HAVE_UDEV
  567. /**
  568. * Device added callback
  569. *
  570. * If everything went fine we can start capturing again when the device is
  571. * reconnected
  572. */
  573. static void device_added(void *vptr, calldata_t *calldata)
  574. {
  575. V4L2_DATA(vptr);
  576. obs_source_update_properties(data->source);
  577. const char *dev;
  578. calldata_get_string(calldata, "device", &dev);
  579. if (strcmp(data->device_id, dev))
  580. return;
  581. blog(LOG_INFO, "Device %s reconnected", dev);
  582. v4l2_init(data);
  583. }
  584. /**
  585. * Device removed callback
  586. *
  587. * We stop recording here so we don't block the device node
  588. */
  589. static void device_removed(void *vptr, calldata_t *calldata)
  590. {
  591. V4L2_DATA(vptr);
  592. obs_source_update_properties(data->source);
  593. const char *dev;
  594. calldata_get_string(calldata, "device", &dev);
  595. if (strcmp(data->device_id, dev))
  596. return;
  597. blog(LOG_INFO, "Device %s disconnected", dev);
  598. v4l2_terminate(data);
  599. }
  600. #endif
  601. static obs_properties_t *v4l2_properties(void *vptr)
  602. {
  603. V4L2_DATA(vptr);
  604. obs_properties_t *props = obs_properties_create();
  605. obs_property_t *device_list = obs_properties_add_list(props,
  606. "device_id", obs_module_text("Device"),
  607. OBS_COMBO_TYPE_LIST, OBS_COMBO_FORMAT_STRING);
  608. obs_property_t *input_list = obs_properties_add_list(props,
  609. "input", obs_module_text("Input"),
  610. OBS_COMBO_TYPE_LIST, OBS_COMBO_FORMAT_INT);
  611. obs_property_t *format_list = obs_properties_add_list(props,
  612. "pixelformat", obs_module_text("VideoFormat"),
  613. OBS_COMBO_TYPE_LIST, OBS_COMBO_FORMAT_INT);
  614. obs_property_t *standard_list = obs_properties_add_list(props,
  615. "standard", obs_module_text("VideoStandard"),
  616. OBS_COMBO_TYPE_LIST, OBS_COMBO_FORMAT_INT);
  617. obs_property_set_visible(standard_list, false);
  618. obs_property_t *dv_timing_list = obs_properties_add_list(props,
  619. "dv_timing", obs_module_text("DVTiming"),
  620. OBS_COMBO_TYPE_LIST, OBS_COMBO_FORMAT_INT);
  621. obs_property_set_visible(dv_timing_list, false);
  622. obs_property_t *resolution_list = obs_properties_add_list(props,
  623. "resolution", obs_module_text("Resolution"),
  624. OBS_COMBO_TYPE_LIST, OBS_COMBO_FORMAT_INT);
  625. obs_properties_add_list(props,
  626. "framerate", obs_module_text("FrameRate"),
  627. OBS_COMBO_TYPE_LIST, OBS_COMBO_FORMAT_INT);
  628. obs_properties_add_bool(props,
  629. "buffering", obs_module_text("UseBuffering"));
  630. obs_data_t *settings = obs_source_get_settings(data->source);
  631. v4l2_device_list(device_list, settings);
  632. obs_data_release(settings);
  633. obs_property_set_modified_callback(device_list, device_selected);
  634. obs_property_set_modified_callback(input_list, input_selected);
  635. obs_property_set_modified_callback(format_list, format_selected);
  636. obs_property_set_modified_callback(resolution_list,
  637. resolution_selected);
  638. return props;
  639. }
  640. static void v4l2_terminate(struct v4l2_data *data)
  641. {
  642. if (data->thread) {
  643. os_event_signal(data->event);
  644. pthread_join(data->thread, NULL);
  645. os_event_destroy(data->event);
  646. data->thread = 0;
  647. }
  648. v4l2_destroy_mmap(&data->buffers);
  649. if (data->dev != -1) {
  650. v4l2_close(data->dev);
  651. data->dev = -1;
  652. }
  653. }
  654. static void v4l2_destroy(void *vptr)
  655. {
  656. V4L2_DATA(vptr);
  657. if (!data)
  658. return;
  659. v4l2_terminate(data);
  660. if (data->device_id)
  661. bfree(data->device_id);
  662. #if HAVE_UDEV
  663. signal_handler_t *sh = v4l2_get_udev_signalhandler();
  664. signal_handler_disconnect(sh, "device_added", device_added, data);
  665. signal_handler_disconnect(sh, "device_removed", device_removed, data);
  666. v4l2_unref_udev();
  667. #endif
  668. bfree(data);
  669. }
  670. /**
  671. * Initialize the v4l2 device
  672. *
  673. * This function:
  674. * - tries to open the device
  675. * - sets pixelformat and requested resolution
  676. * - sets the requested framerate
  677. * - maps the buffers
  678. * - starts the capture thread
  679. */
  680. static void v4l2_init(struct v4l2_data *data)
  681. {
  682. uint32_t input_caps;
  683. int fps_num, fps_denom;
  684. blog(LOG_INFO, "Start capture from %s", data->device_id);
  685. data->dev = v4l2_open(data->device_id, O_RDWR | O_NONBLOCK);
  686. if (data->dev == -1) {
  687. blog(LOG_ERROR, "Unable to open device");
  688. goto fail;
  689. }
  690. /* set input */
  691. if (v4l2_set_input(data->dev, &data->input) < 0) {
  692. blog(LOG_ERROR, "Unable to set input %d", data->input);
  693. goto fail;
  694. }
  695. blog(LOG_INFO, "Input: %d", data->input);
  696. if (v4l2_get_input_caps(data->dev, -1, &input_caps) < 0) {
  697. blog(LOG_ERROR, "Unable to get input capabilities");
  698. goto fail;
  699. }
  700. /* set video standard if supported */
  701. if (input_caps & V4L2_IN_CAP_STD) {
  702. if (v4l2_set_standard(data->dev, &data->standard) < 0) {
  703. blog(LOG_ERROR, "Unable to set video standard");
  704. goto fail;
  705. }
  706. data->resolution = -1;
  707. data->framerate = -1;
  708. }
  709. /* set dv timing if supported */
  710. if (input_caps & V4L2_IN_CAP_DV_TIMINGS) {
  711. if (v4l2_set_dv_timing(data->dev, &data->dv_timing) < 0) {
  712. blog(LOG_ERROR, "Unable to set dv timing");
  713. goto fail;
  714. }
  715. data->resolution = -1;
  716. data->framerate = -1;
  717. }
  718. /* set pixel format and resolution */
  719. if (v4l2_set_format(data->dev, &data->resolution, &data->pixfmt,
  720. &data->linesize) < 0) {
  721. blog(LOG_ERROR, "Unable to set format");
  722. goto fail;
  723. }
  724. if (v4l2_to_obs_video_format(data->pixfmt) == VIDEO_FORMAT_NONE) {
  725. blog(LOG_ERROR, "Selected video format not supported");
  726. goto fail;
  727. }
  728. v4l2_unpack_tuple(&data->width, &data->height, data->resolution);
  729. blog(LOG_INFO, "Resolution: %dx%d", data->width, data->height);
  730. blog(LOG_INFO, "Pixelformat: %s", V4L2_FOURCC_STR(data->pixfmt));
  731. blog(LOG_INFO, "Linesize: %d Bytes", data->linesize);
  732. /* set framerate */
  733. if (v4l2_set_framerate(data->dev, &data->framerate) < 0) {
  734. blog(LOG_ERROR, "Unable to set framerate");
  735. goto fail;
  736. }
  737. v4l2_unpack_tuple(&fps_num, &fps_denom, data->framerate);
  738. blog(LOG_INFO, "Framerate: %.2f fps", (float) fps_denom / fps_num);
  739. /* map buffers */
  740. if (v4l2_create_mmap(data->dev, &data->buffers) < 0) {
  741. blog(LOG_ERROR, "Failed to map buffers");
  742. goto fail;
  743. }
  744. /* start the capture thread */
  745. if (os_event_init(&data->event, OS_EVENT_TYPE_MANUAL) != 0)
  746. goto fail;
  747. if (pthread_create(&data->thread, NULL, v4l2_thread, data) != 0)
  748. goto fail;
  749. return;
  750. fail:
  751. blog(LOG_ERROR, "Initialization failed");
  752. v4l2_terminate(data);
  753. }
  754. /** Update source flags depending on the settings */
  755. static void v4l2_update_source_flags(struct v4l2_data *data,
  756. obs_data_t *settings)
  757. {
  758. uint32_t flags = obs_source_get_flags(data->source);
  759. flags = (obs_data_get_bool(settings, "buffering"))
  760. ? flags & ~OBS_SOURCE_FLAG_UNBUFFERED
  761. : flags | OBS_SOURCE_FLAG_UNBUFFERED;
  762. obs_source_set_flags(data->source, flags);
  763. }
  764. /**
  765. * Update the settings for the v4l2 source
  766. *
  767. * Since there are very few settings that can be changed without restarting the
  768. * stream we don't bother to even try. Whenever this is called the currently
  769. * active stream (if exists) is stopped, the settings are updated and finally
  770. * the new stream is started.
  771. */
  772. static void v4l2_update(void *vptr, obs_data_t *settings)
  773. {
  774. V4L2_DATA(vptr);
  775. v4l2_terminate(data);
  776. if (data->device_id)
  777. bfree(data->device_id);
  778. data->device_id = bstrdup(obs_data_get_string(settings, "device_id"));
  779. data->input = obs_data_get_int(settings, "input");
  780. data->pixfmt = obs_data_get_int(settings, "pixelformat");
  781. data->standard = obs_data_get_int(settings, "standard");
  782. data->dv_timing = obs_data_get_int(settings, "dv_timing");
  783. data->resolution = obs_data_get_int(settings, "resolution");
  784. data->framerate = obs_data_get_int(settings, "framerate");
  785. v4l2_update_source_flags(data, settings);
  786. v4l2_init(data);
  787. }
  788. static void *v4l2_create(obs_data_t *settings, obs_source_t *source)
  789. {
  790. struct v4l2_data *data = bzalloc(sizeof(struct v4l2_data));
  791. data->dev = -1;
  792. data->source = source;
  793. /* Bitch about build problems ... */
  794. #ifndef V4L2_CAP_DEVICE_CAPS
  795. blog(LOG_WARNING, "Plugin built without device caps support!");
  796. #endif
  797. #if !defined(VIDIOC_ENUM_DV_TIMINGS) || !defined(V4L2_IN_CAP_DV_TIMINGS)
  798. blog(LOG_WARNING, "Plugin built without dv-timing support!");
  799. #endif
  800. v4l2_update(data, settings);
  801. #if HAVE_UDEV
  802. v4l2_init_udev();
  803. signal_handler_t *sh = v4l2_get_udev_signalhandler();
  804. signal_handler_connect(sh, "device_added", &device_added, data);
  805. signal_handler_connect(sh, "device_removed", &device_removed, data);
  806. #endif
  807. return data;
  808. }
  809. struct obs_source_info v4l2_input = {
  810. .id = "v4l2_input",
  811. .type = OBS_SOURCE_TYPE_INPUT,
  812. .output_flags = OBS_SOURCE_ASYNC_VIDEO,
  813. .get_name = v4l2_getname,
  814. .create = v4l2_create,
  815. .destroy = v4l2_destroy,
  816. .update = v4l2_update,
  817. .get_defaults = v4l2_defaults,
  818. .get_properties = v4l2_properties
  819. };