CameraHandler() {
zarray_t* urls = image_source_enumerate();
bool gotCamera = false;
for (int i = 0; i < zarray_size(urls); ++i) {
char* url;
zarray_get(urls, i, &url);
_isrc = image_source_open(url);
if (_isrc != NULL) {
printf("connected to camera %s\n", url);
gotCamera = true;
free(url);
break;
}
}
zarray_destroy(urls);
if (!gotCamera) {
printf("couldn't find a camera\n");
exit(1);
}
if (pthread_mutex_init(&_dataMutex, NULL)) {
printf("dataMutex not initialized\n");
exit(1);
}
_im = nullptr;
_running = false;
_staticImage = false;
_isrc->start(_isrc);
}
int
main (int argc, char *argv[])
{
// so that redirected stdout won't be insanely buffered.
setvbuf (stdout, (char *) NULL, _IONBF, 0);
char *url = NULL;
if (argc > 1) {
// if URL is provided on command line, use that.
url = argv[1];
}
else {
// otherwise, show all cameras and use the first one.
zarray_t *urls = image_source_enumerate ();
printf ("Cameras:\n");
for (int i = 0; zarray_size (urls); i++) {
char *url;
zarray_get (urls, i, &url);
printf (" %3d: %s\n", i, url);
}
if (0==zarray_size (urls)) {
printf ("Found no cameras.\n");
return -1;
}
zarray_get (urls, 0, &url);
}
image_source_t *isrc = image_source_open (url);
if (isrc == NULL) {
printf ("Error opening device.\n");
return -1;
}
for (int i = 0; i < isrc->num_formats (isrc); i++) {
image_source_format_t ifmt;
isrc->get_format (isrc, i, &ifmt);
printf ("%3d: %4d x %4d (%s)\n",
i, ifmt.width, ifmt.height, ifmt.format);
}
if (1) {
int res = isrc->start (isrc);
printf ("start: res = %d\n", res);
}
int nframes = 0;
// setlinebuf(stdout);
while(1) {
image_source_data_t *frmd = calloc (1, sizeof(*frmd));
int res = isrc->get_frame (isrc, frmd);
if (res < 0) {
printf ("get_frame fail: %d\n", res);
continue;
}
else
nframes++;
printf ("get_frame: res = %d count = %10d (%10d bytes)\r",
res, nframes, frmd->datalen);
fflush (stdout);
isrc->release_frame (isrc, frmd);
}
return 0;
}
