1122 lines
38 KiB
C++
1122 lines
38 KiB
C++
/* This is the contributed code:
|
|
Firewire and video4linux camera support for highgui
|
|
|
|
2003-03-12 Magnus Lundin
|
|
lundin@mlu.mine.nu
|
|
|
|
THIS EXEPERIMENTAL CODE
|
|
Tested on 2.4.19 with 1394, video1394, v4l, dc1394 and raw1394 support
|
|
|
|
This set of files adds support for firevre and usb cameras.
|
|
First it tries to install a firewire camera,
|
|
if that fails it tries a v4l/USB camera
|
|
|
|
It has been tested with the motempl sample program
|
|
|
|
INSTALLATION
|
|
Install OpenCV
|
|
Install v4l
|
|
Install dc1394 raw1394 - coriander should work with your camera
|
|
Backup highgui folder
|
|
Copy new files
|
|
cd into highgui folder
|
|
make clean (cvcap.cpp must be rebuilt)
|
|
make
|
|
make install
|
|
|
|
|
|
The build is controlled by the following entries in the highgui Makefile:
|
|
|
|
libhighgui_la_LIBADD = -L/usr/X11R6/lib -lXm -lMrm -lUil -lpng -ljpeg -lz -ltiff -lavcodec -lraw1394 -ldc1394_control
|
|
DEFS = -DHAVE_CONFIG_H -DHAVE_DC1394 HAVE_CAMV4L
|
|
|
|
|
|
Now it should be possible to use highgui camera functions, works for me.
|
|
|
|
|
|
THINGS TO DO
|
|
Better ways to select 1394 or v4l camera
|
|
Better support for videosize
|
|
Format7
|
|
|
|
Comments and changes welcome
|
|
/Magnus
|
|
|
|
2005-10-19 Roman Stanchak
|
|
rstanchak@yahoo.com
|
|
|
|
Support added for setting MODE and other DC1394 properties. Also added CONVERT_RGB flag
|
|
which indicates whether or not color conversion is performed in cvRetrieveFrame. The default
|
|
for CONVERT_RGB=1 for backward compatibility.
|
|
|
|
Tested with 2.6.12 with libdc1394-1.0.0, libraw1394-0.10.1 using a Point Grey Flea
|
|
|
|
*/
|
|
|
|
|
|
/*M///////////////////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING.
|
|
//
|
|
// By downloading, copying, installing or using the software you agree to this license.
|
|
// If you do not agree to this license, do not download, install,
|
|
// copy or use the software.
|
|
//
|
|
//
|
|
// Intel License Agreement
|
|
// For Open Source Computer Vision Library
|
|
//
|
|
// Copyright (C) 2000, Intel Corporation, all rights reserved.
|
|
// Third party copyrights are property of their respective owners.
|
|
//
|
|
// Redistribution and use in source and binary forms, with or without modification,
|
|
// are permitted provided that the following conditions are met:
|
|
//
|
|
// * Redistribution's of source code must retain the above copyright notice,
|
|
// this list of conditions and the following disclaimer.
|
|
//
|
|
// * Redistribution's in binary form must reproduce the above copyright notice,
|
|
// this list of conditions and the following disclaimer in the documentation
|
|
// and/or other materials provided with the distribution.
|
|
//
|
|
// * The name of Intel Corporation may not be used to endorse or promote products
|
|
// derived from this software without specific prior written permission.
|
|
//
|
|
// This software is provided by the copyright holders and contributors "as is" and
|
|
// any express or implied warranties, including, but not limited to, the implied
|
|
// warranties of merchantability and fitness for a particular purpose are disclaimed.
|
|
// In no event shall the Intel Corporation or contributors be liable for any direct,
|
|
// indirect, incidental, special, exemplary, or consequential damages
|
|
// (including, but not limited to, procurement of substitute goods or services;
|
|
// loss of use, data, or profits; or business interruption) however caused
|
|
// and on any theory of liability, whether in contract, strict liability,
|
|
// or tort (including negligence or otherwise) arising in any way out of
|
|
// the use of this software, even if advised of the possibility of such damage.
|
|
//
|
|
//M*/
|
|
|
|
#include "precomp.hpp"
|
|
|
|
#if !defined WIN32 && defined HAVE_DC1394
|
|
|
|
#include <unistd.h>
|
|
#include <stdint.h>
|
|
#include <libraw1394/raw1394.h>
|
|
#include <libdc1394/dc1394_control.h>
|
|
|
|
#ifdef NDEBUG
|
|
#define CV_WARN(message)
|
|
#else
|
|
#define CV_WARN(message) fprintf(stderr, "warning: %s (%s:%d)\n", message, __FILE__, __LINE__)
|
|
#endif
|
|
|
|
#define CV_DC1394_CALL(expr) \
|
|
if((expr)<0){ \
|
|
OPENCV_ERROR(CV_StsInternal, "", "libdc1394 function call returned < 0"); \
|
|
}
|
|
|
|
#define DELAY 50000
|
|
|
|
// bpp for 16-bits cameras... this value works for PtGrey DragonFly...
|
|
#define MONO16_BPP 8
|
|
|
|
/* should be in pixelformat */
|
|
static void uyv2bgr(const unsigned char *src, unsigned char *dest, unsigned long long int NumPixels);
|
|
static void uyvy2bgr(const unsigned char *src, unsigned char *dest, unsigned long long int NumPixels);
|
|
static void uyyvyy2bgr(const unsigned char *src, unsigned char *dest, unsigned long long int NumPixels);
|
|
static void y2bgr(const unsigned char *src, unsigned char *dest, unsigned long long int NumPixels);
|
|
static void y162bgr(const unsigned char *src, unsigned char *dest, unsigned long long int NumPixels, int bits);
|
|
static void rgb482bgr(const unsigned char *src8, unsigned char *dest, unsigned long long int NumPixels, int bits);
|
|
|
|
static const char * videodev[4]={
|
|
"/dev/video1394/0",
|
|
"/dev/video1394/1",
|
|
"/dev/video1394/2",
|
|
"/dev/video1394/3"
|
|
};
|
|
|
|
typedef struct CvCaptureCAM_DC1394
|
|
{
|
|
raw1394handle_t handle;
|
|
nodeid_t camera_node;
|
|
dc1394_cameracapture* camera;
|
|
int format;
|
|
int mode;
|
|
int color_mode;
|
|
int frame_rate;
|
|
const char * device_name;
|
|
IplImage frame;
|
|
int convert;
|
|
int buffer_is_writeable; // indicates whether frame.imageData is allocated by OpenCV or DC1394
|
|
}
|
|
CvCaptureCAM_DC1394;
|
|
|
|
static void icvCloseCAM_DC1394( CvCaptureCAM_DC1394* capture );
|
|
|
|
static int icvGrabFrameCAM_DC1394( CvCaptureCAM_DC1394* capture );
|
|
static IplImage* icvRetrieveFrameCAM_DC1394( CvCaptureCAM_DC1394* capture, int );
|
|
|
|
static double icvGetPropertyCAM_DC1394( CvCaptureCAM_DC1394* capture, int property_id );
|
|
static int icvSetPropertyCAM_DC1394( CvCaptureCAM_DC1394* capture, int property_id, double value );
|
|
|
|
// utility functions
|
|
static int icvFormatSupportedCAM_DC1394(int format, quadlet_t formats);
|
|
static int icvModeSupportedCAM_DC1394(int format, int mode, quadlet_t modes);
|
|
static int icvColorMode( int mode );
|
|
static unsigned int icvGetBestFrameRate( CvCaptureCAM_DC1394 * capture, int format, int mode);
|
|
static int icvResizeFrame(CvCaptureCAM_DC1394 * capture);
|
|
|
|
/*********************** Implementations ***************************************/
|
|
#define MAX_PORTS 3
|
|
#define MAX_CAMERAS 8
|
|
#define NUM_BUFFERS 8
|
|
struct raw1394_portinfo ports[MAX_PORTS];
|
|
static raw1394handle_t handles[MAX_PORTS];
|
|
static int camCount[MAX_PORTS];
|
|
static int numPorts = -1;
|
|
static int numCameras = 0;
|
|
static nodeid_t *camera_nodes;
|
|
struct camnode {dc1394_cameracapture cam;int portnum;} cameras[MAX_CAMERAS];
|
|
|
|
static const int preferred_modes[]
|
|
= {
|
|
// uncomment the following line to test a particular mode:
|
|
//FORMAT_VGA_NONCOMPRESSED, MODE_640x480_MONO16, 0,
|
|
FORMAT_SVGA_NONCOMPRESSED_2,
|
|
MODE_1600x1200_RGB, MODE_1600x1200_YUV422, MODE_1280x960_RGB, MODE_1280x960_YUV422,
|
|
MODE_1600x1200_MONO, MODE_1280x960_MONO, MODE_1600x1200_MONO16, MODE_1280x960_MONO16,
|
|
FORMAT_SVGA_NONCOMPRESSED_1,
|
|
MODE_1024x768_RGB, MODE_1024x768_YUV422, MODE_800x600_RGB, MODE_800x600_YUV422,
|
|
MODE_1024x768_MONO, MODE_800x600_MONO, MODE_1024x768_MONO16, MODE_800x600_MONO16,
|
|
FORMAT_VGA_NONCOMPRESSED,
|
|
MODE_640x480_RGB, MODE_640x480_YUV422, MODE_640x480_YUV411, MODE_320x240_YUV422,
|
|
MODE_160x120_YUV444, MODE_640x480_MONO, MODE_640x480_MONO16,
|
|
FORMAT_SCALABLE_IMAGE_SIZE,
|
|
MODE_FORMAT7_0, MODE_FORMAT7_1, MODE_FORMAT7_2, MODE_FORMAT7_3,
|
|
MODE_FORMAT7_4, MODE_FORMAT7_5, MODE_FORMAT7_6, MODE_FORMAT7_7,
|
|
0
|
|
};
|
|
|
|
void icvInitCapture_DC1394(){
|
|
int p;
|
|
|
|
raw1394handle_t raw_handle = raw1394_new_handle();
|
|
if( raw_handle == 0 ) {
|
|
numPorts = 0;
|
|
return;
|
|
}
|
|
numPorts = raw1394_get_port_info(raw_handle, ports, MAX_PORTS);
|
|
raw1394_destroy_handle(raw_handle);
|
|
for (p = 0; p < numPorts; p++) {
|
|
handles[p] = dc1394_create_handle(p);
|
|
if (handles[p]==NULL) { numPorts=-1; return; /*ERROR_CLEANUP_EXIT*/ }
|
|
|
|
/* get the camera nodes and describe them as we find them */
|
|
camera_nodes = dc1394_get_camera_nodes(handles[p], &camCount[p], 0);
|
|
for (int i=0;i<camCount[p];i++) {
|
|
cameras[numCameras].cam.node = camera_nodes[i];
|
|
cameras[numCameras].portnum = p;
|
|
dc1394_stop_iso_transmission(handles[p], camera_nodes[i]);
|
|
numCameras++;
|
|
}
|
|
}
|
|
};
|
|
|
|
static CvCaptureCAM_DC1394 * icvCaptureFromCAM_DC1394 (int index)
|
|
{
|
|
quadlet_t modes[8], formats;
|
|
int i;
|
|
|
|
if (numPorts<0) icvInitCapture_DC1394();
|
|
if (numPorts==0)
|
|
return 0; /* No i1394 ports found */
|
|
if (numCameras<1)
|
|
return 0;
|
|
if (index>=numCameras)
|
|
return 0;
|
|
if (index<0)
|
|
return 0;
|
|
|
|
CvCaptureCAM_DC1394 * pcap = (CvCaptureCAM_DC1394*)cvAlloc(sizeof(*pcap));
|
|
|
|
/* Select a port and camera */
|
|
pcap->device_name = videodev[cameras[index].portnum];
|
|
pcap->handle = handles[cameras[index].portnum];
|
|
pcap->camera = &cameras[index].cam;
|
|
|
|
// get supported formats
|
|
if (dc1394_query_supported_formats(pcap->handle, pcap->camera->node, &formats)<0) {
|
|
fprintf(stderr,"%s:%d: Could not query supported formats\n",__FILE__,__LINE__);
|
|
formats=0x0;
|
|
}
|
|
for (i=0; i < NUM_FORMATS; i++) {
|
|
modes[i]=0;
|
|
if (icvFormatSupportedCAM_DC1394(i+FORMAT_MIN, formats)){
|
|
if (dc1394_query_supported_modes(pcap->handle, pcap->camera->node, i+FORMAT_MIN, &modes[i])<0) {
|
|
fprintf(stderr,"%s:%d: Could not query Format%d modes\n",__FILE__,__LINE__,i);
|
|
}
|
|
}
|
|
}
|
|
|
|
pcap->format = 0;
|
|
pcap->mode = 0;
|
|
pcap->color_mode = 0;
|
|
pcap->frame_rate = 0;
|
|
|
|
int format_idx = -1;
|
|
|
|
// scan the list of preferred modes, and find a supported one
|
|
for(i=0; (pcap->mode == 0) && (preferred_modes[i] != 0); i++) {
|
|
if((preferred_modes[i] >= FORMAT_MIN) && (preferred_modes[i] <= FORMAT_MAX)) {
|
|
pcap->format = preferred_modes[i];
|
|
format_idx = preferred_modes[i] - FORMAT_MIN;
|
|
continue;
|
|
}
|
|
assert(format_idx != -1);
|
|
if ( ! icvFormatSupportedCAM_DC1394(pcap->format, formats) )
|
|
continue;
|
|
if ( icvModeSupportedCAM_DC1394(pcap->format, preferred_modes[i], modes[format_idx]) ){
|
|
pcap->mode = preferred_modes[i];
|
|
}
|
|
}
|
|
if (pcap->mode == 0) {
|
|
fprintf(stderr,"%s:%d: Could not find a supported mode for this camera\n",__FILE__,__LINE__);
|
|
goto ERROR;
|
|
}
|
|
|
|
pcap->color_mode = icvColorMode( pcap->mode );
|
|
if( pcap->color_mode == -1){
|
|
fprintf(stderr,"%s:%d: ERROR: BPP is Unsupported!!\n",__FILE__,__LINE__);
|
|
goto ERROR;
|
|
}
|
|
|
|
// set frame rate to optimal value given format and mode
|
|
pcap->frame_rate = icvGetBestFrameRate(pcap, pcap->format, pcap->mode);
|
|
|
|
if (pcap->format!=FORMAT_SCALABLE_IMAGE_SIZE) { // everything except Format 7
|
|
if (dc1394_dma_setup_capture(pcap->handle, pcap->camera->node, index+1 /*channel*/,
|
|
pcap->format, pcap->mode, SPEED_400,
|
|
pcap->frame_rate, NUM_BUFFERS,
|
|
#ifdef HAVE_DC1394_095
|
|
0 /*do_extra_buffering*/,
|
|
#endif
|
|
1 /*DROP_FRAMES*/,
|
|
pcap->device_name, pcap->camera) != DC1394_SUCCESS) {
|
|
fprintf(stderr,"%s:%d: Failed to setup DMA capture with VIDEO1394\n",__FILE__,__LINE__);
|
|
goto ERROR;
|
|
}
|
|
}
|
|
else {
|
|
if(dc1394_dma_setup_format7_capture(pcap->handle,pcap->camera->node,index+1 /*channel*/,
|
|
pcap->mode, SPEED_400, QUERY_FROM_CAMERA,
|
|
(unsigned int)QUERY_FROM_CAMERA, (unsigned int)QUERY_FROM_CAMERA,
|
|
(unsigned int)QUERY_FROM_CAMERA, (unsigned int)QUERY_FROM_CAMERA,
|
|
NUM_BUFFERS,
|
|
#ifdef HAVE_DC1394_095
|
|
0 /*do_extra_buffering*/,
|
|
#endif
|
|
1 /*DROP_FRAMES*/,
|
|
pcap->device_name, pcap->camera) != DC1394_SUCCESS) {
|
|
fprintf(stderr,"%s:%d: Failed to setup DMA capture with VIDEO1394\n",__FILE__,__LINE__);
|
|
goto ERROR;
|
|
}
|
|
}
|
|
|
|
if (dc1394_start_iso_transmission(pcap->handle, pcap->camera->node)!=DC1394_SUCCESS) {
|
|
fprintf(stderr,"%s:%d: Could not start ISO transmission\n",__FILE__,__LINE__);
|
|
goto ERROR;
|
|
}
|
|
|
|
usleep(DELAY);
|
|
|
|
dc1394bool_t status;
|
|
if (dc1394_get_iso_status(pcap->handle, pcap->camera->node, &status)!=DC1394_SUCCESS) {
|
|
fprintf(stderr,"%s:%d: Could get ISO status",__FILE__,__LINE__);
|
|
goto ERROR;
|
|
}
|
|
if (status==DC1394_FALSE) {
|
|
fprintf(stderr,"%s:%d: ISO transmission refuses to start",__FILE__,__LINE__);
|
|
goto ERROR;
|
|
}
|
|
|
|
// convert camera image to RGB by default
|
|
pcap->convert=1;
|
|
|
|
// no image data allocated yet
|
|
pcap->buffer_is_writeable = 0;
|
|
|
|
memset(&(pcap->frame), 0, sizeof(IplImage));
|
|
icvResizeFrame( pcap );
|
|
return pcap;
|
|
|
|
ERROR:
|
|
return 0;
|
|
};
|
|
|
|
static void icvCloseCAM_DC1394( CvCaptureCAM_DC1394* capture ){
|
|
dc1394_stop_iso_transmission(capture->handle, capture->camera->node);
|
|
dc1394_dma_unlisten (capture->handle, capture->camera);
|
|
/* Deallocate space for RGBA data */
|
|
if(capture->convert){
|
|
cvFree(&capture->frame.imageData);
|
|
}
|
|
}
|
|
|
|
static int icvGrabFrameCAM_DC1394( CvCaptureCAM_DC1394* capture ){
|
|
// TODO: should this function wait until the next frame is available or return
|
|
// immediately ?
|
|
float waiting = 0;
|
|
do{
|
|
int result = dc1394_dma_single_capture_poll(capture->camera);
|
|
if(result==DC1394_SUCCESS){
|
|
return 1;
|
|
}
|
|
else if(result==DC1394_NO_FRAME){
|
|
usleep(1000000/120); //sleep for at least a 1/2 of the frame rate
|
|
waiting += 1.0/120.0;
|
|
}
|
|
else{
|
|
printf("dc1394_dma_single_capture_poll failed\n");
|
|
return 0;
|
|
}
|
|
} while(waiting<2);
|
|
printf("dc1394_dma_single_capture_poll timed out\n");
|
|
return 0;
|
|
}
|
|
|
|
static IplImage* icvRetrieveFrameCAM_DC1394( CvCaptureCAM_DC1394* capture, int ){
|
|
if(capture->camera->capture_buffer )
|
|
{
|
|
if(capture->convert){
|
|
/* Convert to RGBA */
|
|
unsigned char * src = (unsigned char *)capture->camera->capture_buffer;
|
|
unsigned char * dst = (unsigned char *)capture->frame.imageData;
|
|
switch (capture->color_mode) {
|
|
case COLOR_FORMAT7_RGB8:
|
|
//printf("icvRetrieveFrame convert RGB to BGR\n");
|
|
/* Convert RGB to BGR */
|
|
for (int i=0;i<capture->frame.imageSize;i+=6) {
|
|
dst[i] = src[i+2];
|
|
dst[i+1] = src[i+1];
|
|
dst[i+2] = src[i];
|
|
dst[i+3] = src[i+5];
|
|
dst[i+4] = src[i+4];
|
|
dst[i+5] = src[i+3];
|
|
}
|
|
break;
|
|
case COLOR_FORMAT7_YUV422:
|
|
//printf("icvRetrieveFrame convert YUV422 to BGR %d\n");
|
|
uyvy2bgr(src,
|
|
dst,
|
|
capture->camera->frame_width * capture->camera->frame_height);
|
|
break;
|
|
case COLOR_FORMAT7_MONO8:
|
|
//printf("icvRetrieveFrame convert MONO8 to BGR %d\n");
|
|
y2bgr(src,
|
|
dst,
|
|
capture->camera->frame_width * capture->camera->frame_height);
|
|
break;
|
|
case COLOR_FORMAT7_YUV411:
|
|
//printf("icvRetrieveFrame convert YUV411 to BGR %d\n");
|
|
uyyvyy2bgr(src,
|
|
dst,
|
|
capture->camera->frame_width * capture->camera->frame_height);
|
|
break;
|
|
case COLOR_FORMAT7_YUV444:
|
|
//printf("icvRetrieveFrame convert YUV444 to BGR %d\n");
|
|
uyv2bgr(src,
|
|
dst,
|
|
capture->camera->frame_width * capture->camera->frame_height);
|
|
break;
|
|
case COLOR_FORMAT7_MONO16:
|
|
//printf("icvRetrieveFrame convert MONO16 to BGR %d\n");
|
|
y162bgr(src,
|
|
dst,
|
|
capture->camera->frame_width * capture->camera->frame_height, MONO16_BPP);
|
|
break;
|
|
case COLOR_FORMAT7_RGB16:
|
|
//printf("icvRetrieveFrame convert RGB16 to BGR %d\n");
|
|
rgb482bgr(src,
|
|
dst,
|
|
capture->camera->frame_width * capture->camera->frame_height, MONO16_BPP);
|
|
break;
|
|
default:
|
|
fprintf(stderr,"%s:%d: Unsupported color mode %d\n",__FILE__,__LINE__,capture->color_mode);
|
|
return 0;
|
|
} /* switch (capture->mode) */
|
|
}
|
|
else{
|
|
// return raw data
|
|
capture->frame.imageData = (char *) capture->camera->capture_buffer;
|
|
capture->frame.imageDataOrigin = (char *) capture->camera->capture_buffer;
|
|
}
|
|
|
|
// TODO: if convert=0, we are not actually done with the buffer
|
|
// but this seems to work anyway.
|
|
dc1394_dma_done_with_buffer(capture->camera);
|
|
|
|
return &capture->frame;
|
|
}
|
|
return 0;
|
|
};
|
|
|
|
static double icvGetPropertyCAM_DC1394( CvCaptureCAM_DC1394* capture, int property_id ){
|
|
int index=-1;
|
|
switch ( property_id ) {
|
|
case CV_CAP_PROP_CONVERT_RGB:
|
|
return capture->convert;
|
|
case CV_CAP_PROP_MODE:
|
|
return capture->mode;
|
|
case CV_CAP_PROP_FORMAT:
|
|
return capture->format;
|
|
case CV_CAP_PROP_FPS:
|
|
CV_DC1394_CALL(dc1394_get_video_framerate(capture->handle, capture->camera->node,
|
|
(unsigned int *) &capture->camera->frame_rate));
|
|
switch(capture->camera->frame_rate) {
|
|
case FRAMERATE_1_875:
|
|
return 1.875;
|
|
case FRAMERATE_3_75:
|
|
return 3.75;
|
|
case FRAMERATE_7_5:
|
|
return 7.5;
|
|
case FRAMERATE_15:
|
|
return 15.;
|
|
case FRAMERATE_30:
|
|
return 30.;
|
|
case FRAMERATE_60:
|
|
return 60;
|
|
#if NUM_FRAMERATES > 6
|
|
case FRAMERATE_120:
|
|
return 120;
|
|
#endif
|
|
#if NUM_FRAMERATES > 7
|
|
case FRAMERATE_240:
|
|
return 240;
|
|
#endif
|
|
}
|
|
default:
|
|
index = property_id; // did they pass in a LIBDC1394 feature flag?
|
|
break;
|
|
}
|
|
if(index>=FEATURE_MIN && index<=FEATURE_MAX){
|
|
dc1394bool_t has_feature;
|
|
CV_DC1394_CALL( dc1394_is_feature_present(capture->handle, capture->camera->node,
|
|
index, &has_feature));
|
|
if(!has_feature){
|
|
CV_WARN("Feature is not supported by this camera");
|
|
}
|
|
else{
|
|
unsigned int value;
|
|
dc1394_get_feature_value(capture->handle, capture->camera->node, index, &value);
|
|
return (double) value;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
};
|
|
|
|
// resize capture->frame appropriately depending on camera and capture settings
|
|
static int icvResizeFrame(CvCaptureCAM_DC1394 * capture){
|
|
if(capture->convert){
|
|
// resize if sizes are different, formats are different
|
|
// or conversion option has changed
|
|
if(capture->camera->frame_width != capture->frame.width ||
|
|
capture->camera->frame_height != capture->frame.height ||
|
|
capture->frame.depth != 8 ||
|
|
capture->frame.nChannels != 3 ||
|
|
capture->frame.imageData == NULL ||
|
|
capture->buffer_is_writeable == 0)
|
|
{
|
|
if(capture->frame.imageData && capture->buffer_is_writeable){
|
|
cvReleaseData( &(capture->frame));
|
|
}
|
|
cvInitImageHeader( &capture->frame, cvSize( capture->camera->frame_width,
|
|
capture->camera->frame_height ),
|
|
IPL_DEPTH_8U, 3, IPL_ORIGIN_TL, 4 );
|
|
cvCreateData( &(capture->frame) );
|
|
capture->buffer_is_writeable = 1;
|
|
}
|
|
|
|
}
|
|
else {
|
|
// free image data if allocated by opencv
|
|
if(capture->buffer_is_writeable){
|
|
cvReleaseData(&(capture->frame));
|
|
}
|
|
|
|
// figure out number of channels and bpp
|
|
int bpp = 8;
|
|
int nch = 3;
|
|
int width = capture->camera->frame_width;
|
|
int height = capture->camera->frame_height;
|
|
double code = CV_FOURCC('B','G','R',0);
|
|
switch(capture->color_mode){
|
|
case COLOR_FORMAT7_YUV422:
|
|
nch = 2;
|
|
code = CV_FOURCC('Y','4','2','2');
|
|
break;
|
|
case COLOR_FORMAT7_MONO8:
|
|
code = CV_FOURCC('Y',0,0,0);
|
|
nch = 1;
|
|
break;
|
|
case COLOR_FORMAT7_YUV411:
|
|
code = CV_FOURCC('Y','4','1','1');
|
|
width *= 2;
|
|
nch = 3; //yy[u/v]
|
|
break;
|
|
case COLOR_FORMAT7_YUV444:
|
|
code = CV_FOURCC('Y','U','V',0);
|
|
nch = 3;
|
|
break;
|
|
case COLOR_FORMAT7_MONO16:
|
|
code = CV_FOURCC('Y',0,0,0);
|
|
bpp = IPL_DEPTH_16S;
|
|
nch = 1;
|
|
break;
|
|
case COLOR_FORMAT7_RGB16:
|
|
bpp = IPL_DEPTH_16S;
|
|
nch = 3;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
// reset image header
|
|
cvInitImageHeader( &capture->frame,cvSize( width, height ), bpp, nch, IPL_ORIGIN_TL, 4 );
|
|
//assert(capture->frame.imageSize == capture->camera->quadlets_per_frame*4);
|
|
capture->buffer_is_writeable = 0;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
// Toggle setting about whether or not RGB color conversion is to be performed
|
|
// Allocates/Initializes capture->frame appropriately
|
|
int icvSetConvertRGB(CvCaptureCAM_DC1394 * capture, int convert){
|
|
if(convert==capture->convert){
|
|
// no action necessary
|
|
return 1;
|
|
}
|
|
capture->convert = convert;
|
|
return icvResizeFrame( capture );
|
|
}
|
|
|
|
// given desired format, mode, and modes bitmask from camera, determine if format and mode are supported
|
|
static int
|
|
icvFormatSupportedCAM_DC1394(int format, quadlet_t formats){
|
|
// formats is a bitmask whose higher order bits indicate whether format is supported
|
|
int shift = 31 - (format - FORMAT_MIN);
|
|
int mask = 1 << shift;
|
|
return (formats & mask) != 0;
|
|
}
|
|
|
|
// analyze modes bitmask from camera to determine if desired format and mode are supported
|
|
static int
|
|
icvModeSupportedCAM_DC1394(int format, int mode, quadlet_t modes){
|
|
// modes is a bitmask whose higher order bits indicate whether mode is supported
|
|
int format_idx = format - FORMAT_MIN;
|
|
int mode_format_min = MODE_FORMAT0_MIN + 32*format_idx;
|
|
int shift = 31 - (mode - mode_format_min);
|
|
int mask = 0x1 << shift;
|
|
return (modes & mask) != 0;
|
|
}
|
|
|
|
// Setup camera to use given dc1394 mode
|
|
static int
|
|
icvSetModeCAM_DC1394( CvCaptureCAM_DC1394 * capture, int mode ){
|
|
quadlet_t modes, formats;
|
|
//printf("<icvSetModeCAM_DC1394>\n");
|
|
|
|
// figure out corrent format for this mode
|
|
int format = (mode - MODE_FORMAT0_MIN) / 32 + FORMAT_MIN;
|
|
|
|
// get supported formats
|
|
if (dc1394_query_supported_formats(capture->handle, capture->camera->node, &formats)<0) {
|
|
fprintf(stderr,"%s:%d: Could not query supported formats\n",__FILE__,__LINE__);
|
|
return 0;
|
|
}
|
|
|
|
// is format for requested mode supported ?
|
|
if(icvFormatSupportedCAM_DC1394(format, formats)==0){
|
|
return 0;
|
|
}
|
|
|
|
// get supported modes for requested format
|
|
if (dc1394_query_supported_modes(capture->handle, capture->camera->node, format, &modes)<0){
|
|
fprintf(stderr,"%s:%d: Could not query supported modes for format %d\n",__FILE__,__LINE__, capture->format);
|
|
return 0;
|
|
}
|
|
|
|
// is requested mode supported ?
|
|
if(! icvModeSupportedCAM_DC1394(format, mode, modes) ){
|
|
return 0;
|
|
}
|
|
|
|
int color_mode = icvColorMode( mode );
|
|
|
|
if(color_mode == -1){
|
|
return 0;
|
|
}
|
|
|
|
int frame_rate = icvGetBestFrameRate(capture, format, mode);
|
|
|
|
dc1394_dma_unlisten(capture->handle, capture->camera);
|
|
if (dc1394_dma_setup_capture(capture->handle, capture->camera->node, capture->camera->channel /*channel*/,
|
|
format, mode, SPEED_400,
|
|
frame_rate, NUM_BUFFERS,
|
|
#ifdef HAVE_DC1394_095
|
|
0 /*do_extra_buffering*/,
|
|
#endif
|
|
1 /*DROP_FRAMES*/,
|
|
capture->device_name, capture->camera) != DC1394_SUCCESS) {
|
|
fprintf(stderr,"%s:%d: Failed to setup DMA capture with VIDEO1394\n",__FILE__,__LINE__);
|
|
return 0;
|
|
}
|
|
dc1394_start_iso_transmission(capture->handle, capture->camera->node);
|
|
|
|
capture->frame_rate = frame_rate;
|
|
capture->format = format;
|
|
capture->mode = mode;
|
|
capture->color_mode = color_mode;
|
|
|
|
// now fix image size to match new mode
|
|
icvResizeFrame( capture );
|
|
return 1;
|
|
}
|
|
|
|
// query camera for supported frame rates and select fastest for given format and mode
|
|
static unsigned int icvGetBestFrameRate( CvCaptureCAM_DC1394 * capture, int format, int mode ){
|
|
quadlet_t framerates;
|
|
if (dc1394_query_supported_framerates(capture->handle, capture->camera->node,
|
|
format, mode, &framerates)!=DC1394_SUCCESS)
|
|
{
|
|
fprintf(stderr,"%s:%d: Could not query supported framerates\n",__FILE__,__LINE__);
|
|
framerates = 0;
|
|
}
|
|
|
|
for (int f=FRAMERATE_MAX; f>=FRAMERATE_MIN; f--) {
|
|
if (framerates & (0x1<< (31-(f-FRAMERATE_MIN)))) {
|
|
return f;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
icvSetFrameRateCAM_DC1394( CvCaptureCAM_DC1394 * capture, double value ){
|
|
unsigned int fps=15;
|
|
if(capture->format == FORMAT_SCALABLE_IMAGE_SIZE)
|
|
return 0; /* format 7 has no fixed framerates */
|
|
if (value==-1){
|
|
fps=icvGetBestFrameRate( capture, capture->format, capture->mode );
|
|
}
|
|
else if (value==1.875)
|
|
fps=FRAMERATE_1_875;
|
|
else if (value==3.75)
|
|
fps=FRAMERATE_3_75;
|
|
else if (value==7.5)
|
|
fps=FRAMERATE_7_5;
|
|
else if (value==15)
|
|
fps=FRAMERATE_15;
|
|
else if (value==30)
|
|
fps=FRAMERATE_30;
|
|
else if (value==60)
|
|
fps=FRAMERATE_60;
|
|
#if NUM_FRAMERATES > 6
|
|
else if (value==120)
|
|
fps=FRAMERATE_120;
|
|
#endif
|
|
#if NUM_FRAMERATES > 7
|
|
else if (value==240)
|
|
fps=FRAMERATE_240;
|
|
#endif
|
|
dc1394_set_video_framerate(capture->handle, capture->camera->node,fps);
|
|
dc1394_get_video_framerate(capture->handle, capture->camera->node,
|
|
(unsigned int *) &capture->camera->frame_rate);
|
|
|
|
return fps==(unsigned int) capture->camera->frame_rate;
|
|
}
|
|
|
|
// for given mode return color format
|
|
static int
|
|
icvColorMode( int mode ){
|
|
switch(mode) {
|
|
case MODE_160x120_YUV444:
|
|
return COLOR_FORMAT7_YUV444;
|
|
case MODE_320x240_YUV422:
|
|
case MODE_640x480_YUV422:
|
|
case MODE_800x600_YUV422:
|
|
case MODE_1024x768_YUV422:
|
|
case MODE_1280x960_YUV422:
|
|
case MODE_1600x1200_YUV422:
|
|
return COLOR_FORMAT7_YUV422;
|
|
case MODE_640x480_YUV411:
|
|
return COLOR_FORMAT7_YUV411;
|
|
case MODE_640x480_RGB:
|
|
case MODE_800x600_RGB:
|
|
case MODE_1024x768_RGB:
|
|
case MODE_1280x960_RGB:
|
|
case MODE_1600x1200_RGB:
|
|
return COLOR_FORMAT7_RGB8;
|
|
case MODE_640x480_MONO:
|
|
case MODE_800x600_MONO:
|
|
case MODE_1024x768_MONO:
|
|
case MODE_1280x960_MONO:
|
|
case MODE_1600x1200_MONO:
|
|
return COLOR_FORMAT7_MONO8;
|
|
case MODE_640x480_MONO16:
|
|
case MODE_800x600_MONO16:
|
|
case MODE_1024x768_MONO16:
|
|
case MODE_1280x960_MONO16:
|
|
case MODE_1600x1200_MONO16:
|
|
return COLOR_FORMAT7_MONO16;
|
|
case MODE_FORMAT7_0:
|
|
case MODE_FORMAT7_1:
|
|
case MODE_FORMAT7_2:
|
|
case MODE_FORMAT7_3:
|
|
case MODE_FORMAT7_4:
|
|
case MODE_FORMAT7_5:
|
|
case MODE_FORMAT7_6:
|
|
case MODE_FORMAT7_7:
|
|
fprintf(stderr,"%s:%d: Format7 not yet supported\n",__FILE__,__LINE__);
|
|
default:
|
|
break;
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
// function to set camera properties using dc1394 feature enum
|
|
// val == -1 indicates to set this property to 'auto'
|
|
static int
|
|
icvSetFeatureCAM_DC1394( CvCaptureCAM_DC1394* capture, int feature_id, int val){
|
|
dc1394bool_t isOn = DC1394_FALSE;
|
|
dc1394bool_t hasAutoCapability = DC1394_FALSE;
|
|
dc1394bool_t isAutoOn = DC1394_FALSE;
|
|
unsigned int nval;
|
|
unsigned int minval,maxval;
|
|
|
|
// Turn the feature on if it is OFF
|
|
if( dc1394_is_feature_on(capture->handle, capture->camera->node, feature_id, &isOn)
|
|
== DC1394_FAILURE ) {
|
|
return 0;
|
|
}
|
|
if( isOn == DC1394_FALSE ) {
|
|
// try to turn it on.
|
|
if( dc1394_feature_on_off(capture->handle, capture->camera->node, feature_id, 1) == DC1394_FAILURE ) {
|
|
fprintf(stderr, "error turning feature %d on!\n", feature_id);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
// Check if the feature supports auto mode
|
|
dc1394_has_auto_mode(capture->handle, capture->camera->node, feature_id, &hasAutoCapability);
|
|
if( hasAutoCapability ) {
|
|
|
|
// now check if the auto is on.
|
|
if( dc1394_is_feature_auto(capture->handle, capture->camera->node, feature_id, &isAutoOn ) == DC1394_FAILURE ) {
|
|
fprintf(stderr, "error determining if feature %d has auto on!\n", feature_id);
|
|
return 0;
|
|
}
|
|
}
|
|
// Caller requested auto mode, but cannot support it
|
|
else if(val==-1){
|
|
fprintf(stderr, "feature %d does not support auto mode\n", feature_id);
|
|
return 0;
|
|
}
|
|
|
|
if(val==-1){
|
|
// if the auto mode isn't enabled, enable it
|
|
if( isAutoOn == DC1394_FALSE ) {
|
|
if(dc1394_auto_on_off(capture->handle, capture->camera->node, feature_id, 1) == DC1394_FAILURE ) {
|
|
fprintf(stderr, "error turning feature %d auto ON!\n", feature_id);
|
|
return 0;
|
|
}
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
// ELSE turn OFF auto and adjust feature manually
|
|
if( isAutoOn == DC1394_TRUE ) {
|
|
if(dc1394_auto_on_off(capture->handle, capture->camera->node, feature_id, 0) == DC1394_FAILURE ) {
|
|
fprintf(stderr, "error turning feature %d auto OFF!\n", feature_id);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
// Clamp val to within feature range
|
|
CV_DC1394_CALL( dc1394_get_min_value(capture->handle, capture->camera->node, feature_id, &minval));
|
|
CV_DC1394_CALL( dc1394_get_max_value(capture->handle, capture->camera->node, feature_id, &maxval));
|
|
val = (int)MIN(maxval, MAX((unsigned)val, minval));
|
|
|
|
|
|
if (dc1394_set_feature_value(capture->handle, capture->camera->node, feature_id, val) ==
|
|
DC1394_FAILURE){
|
|
fprintf(stderr, "error setting feature value\n");
|
|
return 0;
|
|
}
|
|
if (dc1394_get_feature_value(capture->handle, capture->camera->node, feature_id, &nval) ==
|
|
DC1394_FAILURE){
|
|
fprintf(stderr, "error setting feature value\n");
|
|
return 0;
|
|
}
|
|
return nval==(unsigned int)val;
|
|
|
|
}
|
|
|
|
// cvSetCaptureProperty callback function implementation
|
|
static int
|
|
icvSetPropertyCAM_DC1394( CvCaptureCAM_DC1394* capture, int property_id, double value ){
|
|
int index=-1;
|
|
switch ( property_id ) {
|
|
case CV_CAP_PROP_CONVERT_RGB:
|
|
return icvSetConvertRGB( capture, value != 0 );
|
|
case CV_CAP_PROP_MODE:
|
|
return icvSetModeCAM_DC1394( capture, (int) value );
|
|
case CV_CAP_PROP_FPS:
|
|
return icvSetFrameRateCAM_DC1394( capture, value );
|
|
case CV_CAP_PROP_BRIGHTNESS:
|
|
index = FEATURE_BRIGHTNESS;
|
|
break;
|
|
case CV_CAP_PROP_CONTRAST:
|
|
index = FEATURE_GAMMA;
|
|
break;
|
|
case CV_CAP_PROP_SATURATION:
|
|
index = FEATURE_SATURATION;
|
|
break;
|
|
case CV_CAP_PROP_HUE:
|
|
index = FEATURE_HUE;
|
|
break;
|
|
case CV_CAP_PROP_GAIN:
|
|
index = FEATURE_GAIN;
|
|
break;
|
|
default:
|
|
index = property_id; // did they pass in a LIBDC1394 feature flag?
|
|
break;
|
|
}
|
|
if(index>=FEATURE_MIN && index<=FEATURE_MAX){
|
|
return icvSetFeatureCAM_DC1394(capture, index, (int) value);
|
|
}
|
|
return 0;
|
|
};
|
|
|
|
/**********************************************************************
|
|
*
|
|
* CONVERSION FUNCTIONS TO RGB 24bpp
|
|
*
|
|
**********************************************************************/
|
|
|
|
/* color conversion functions from Bart Nabbe. *//* corrected by Damien: bad coeficients in YUV2RGB */
|
|
#define YUV2RGB(y, u, v, r, g, b)\
|
|
r = y + ((v*1436) >> 10);\
|
|
g = y - ((u*352 + v*731) >> 10);\
|
|
b = y + ((u*1814) >> 10);\
|
|
r = r < 0 ? 0 : r;\
|
|
g = g < 0 ? 0 : g;\
|
|
b = b < 0 ? 0 : b;\
|
|
r = r > 255 ? 255 : r;\
|
|
g = g > 255 ? 255 : g;\
|
|
b = b > 255 ? 255 : b
|
|
|
|
static void
|
|
uyv2bgr(const unsigned char *src, unsigned char *dest,
|
|
unsigned long long int NumPixels)
|
|
{
|
|
register int i = NumPixels + (NumPixels << 1) - 1;
|
|
register int j = NumPixels + (NumPixels << 1) - 1;
|
|
register int y, u, v;
|
|
register int r, g, b;
|
|
|
|
while (i > 0) {
|
|
v = src[i--] - 128;
|
|
y = src[i--];
|
|
u = src[i--] - 128;
|
|
YUV2RGB(y, u, v, r, g, b);
|
|
dest[j--] = r;
|
|
dest[j--] = g;
|
|
dest[j--] = b;
|
|
}
|
|
}
|
|
|
|
static void
|
|
uyvy2bgr(const unsigned char *src, unsigned char *dest,
|
|
unsigned long long int NumPixels)
|
|
{
|
|
register int i = (NumPixels << 1) - 1;
|
|
register int j = NumPixels + (NumPixels << 1) - 1;
|
|
register int y0, y1, u, v;
|
|
register int r, g, b;
|
|
|
|
while (i > 0) {
|
|
y1 = src[i--];
|
|
v = src[i--] - 128;
|
|
y0 = src[i--];
|
|
u = src[i--] - 128;
|
|
YUV2RGB(y1, u, v, r, g, b);
|
|
dest[j--] = r;
|
|
dest[j--] = g;
|
|
dest[j--] = b;
|
|
YUV2RGB(y0, u, v, r, g, b);
|
|
dest[j--] = r;
|
|
dest[j--] = g;
|
|
dest[j--] = b;
|
|
}
|
|
}
|
|
|
|
|
|
static void
|
|
uyyvyy2bgr(const unsigned char *src, unsigned char *dest,
|
|
unsigned long long int NumPixels)
|
|
{
|
|
register int i = NumPixels + (NumPixels >> 1) - 1;
|
|
register int j = NumPixels + (NumPixels << 1) - 1;
|
|
register int y0, y1, y2, y3, u, v;
|
|
register int r, g, b;
|
|
|
|
while (i > 0) {
|
|
y3 = src[i--];
|
|
y2 = src[i--];
|
|
v = src[i--] - 128;
|
|
y1 = src[i--];
|
|
y0 = src[i--];
|
|
u = src[i--] - 128;
|
|
YUV2RGB(y3, u, v, r, g, b);
|
|
dest[j--] = r;
|
|
dest[j--] = g;
|
|
dest[j--] = b;
|
|
YUV2RGB(y2, u, v, r, g, b);
|
|
dest[j--] = r;
|
|
dest[j--] = g;
|
|
dest[j--] = b;
|
|
YUV2RGB(y1, u, v, r, g, b);
|
|
dest[j--] = r;
|
|
dest[j--] = g;
|
|
dest[j--] = b;
|
|
YUV2RGB(y0, u, v, r, g, b);
|
|
dest[j--] = r;
|
|
dest[j--] = g;
|
|
dest[j--] = b;
|
|
}
|
|
}
|
|
|
|
static void
|
|
y2bgr(const unsigned char *src, unsigned char *dest,
|
|
unsigned long long int NumPixels)
|
|
{
|
|
register int i = NumPixels - 1;
|
|
register int j = NumPixels + (NumPixels << 1) - 1;
|
|
register int y;
|
|
|
|
while (i > 0) {
|
|
y = src[i--];
|
|
dest[j--] = y;
|
|
dest[j--] = y;
|
|
dest[j--] = y;
|
|
}
|
|
}
|
|
|
|
static void
|
|
y162bgr(const unsigned char *src, unsigned char *dest,
|
|
unsigned long long int NumPixels, int bits)
|
|
{
|
|
register int i = (NumPixels << 1) - 1;
|
|
register int j = NumPixels + (NumPixels << 1) - 1;
|
|
register int y;
|
|
|
|
while (i > 0) {
|
|
y = src[i--];
|
|
y = (y + (src[i--] << 8)) >> (bits - 8);
|
|
dest[j--] = y;
|
|
dest[j--] = y;
|
|
dest[j--] = y;
|
|
}
|
|
}
|
|
|
|
// this one was in coriander but didn't take bits into account
|
|
static void
|
|
rgb482bgr(const unsigned char *src, unsigned char *dest,
|
|
unsigned long long int NumPixels, int bits)
|
|
{
|
|
register int i = (NumPixels << 1) - 1;
|
|
register int j = NumPixels + (NumPixels << 1) - 1;
|
|
register int y;
|
|
|
|
while (i > 0) {
|
|
y = src[i--];
|
|
dest[j-2] = (y + (src[i--] << 8)) >> (bits - 8);
|
|
j--;
|
|
y = src[i--];
|
|
dest[j] = (y + (src[i--] << 8)) >> (bits - 8);
|
|
j--;
|
|
y = src[i--];
|
|
dest[j+2] = (y + (src[i--] << 8)) >> (bits - 8);
|
|
j--;
|
|
}
|
|
}
|
|
|
|
|
|
class CvCaptureCAM_DC1394_CPP : public CvCapture
|
|
{
|
|
public:
|
|
CvCaptureCAM_DC1394_CPP() { captureDC1394 = 0; }
|
|
virtual ~CvCaptureCAM_DC1394_CPP() { close(); }
|
|
|
|
virtual bool open( int index );
|
|
virtual void close();
|
|
|
|
virtual double getProperty(int);
|
|
virtual bool setProperty(int, double);
|
|
virtual bool grabFrame();
|
|
virtual IplImage* retrieveFrame(int);
|
|
virtual int getCaptureDomain() { return CV_CAP_DC1394; } // Return the type of the capture object: CV_CAP_VFW, etc...
|
|
protected:
|
|
|
|
CvCaptureCAM_DC1394* captureDC1394;
|
|
};
|
|
|
|
bool CvCaptureCAM_DC1394_CPP::open( int index )
|
|
{
|
|
close();
|
|
captureDC1394 = icvCaptureFromCAM_DC1394(index);
|
|
return captureDC1394 != 0;
|
|
}
|
|
|
|
void CvCaptureCAM_DC1394_CPP::close()
|
|
{
|
|
if( captureDC1394 )
|
|
{
|
|
icvCloseCAM_DC1394( captureDC1394 );
|
|
cvFree( &captureDC1394 );
|
|
}
|
|
}
|
|
|
|
bool CvCaptureCAM_DC1394_CPP::grabFrame()
|
|
{
|
|
return captureDC1394 ? icvGrabFrameCAM_DC1394( captureDC1394 ) != 0 : false;
|
|
}
|
|
|
|
IplImage* CvCaptureCAM_DC1394_CPP::retrieveFrame(int)
|
|
{
|
|
return captureDC1394 ? (IplImage*)icvRetrieveFrameCAM_DC1394( captureDC1394, 0 ) : 0;
|
|
}
|
|
|
|
double CvCaptureCAM_DC1394_CPP::getProperty( int propId )
|
|
{
|
|
return captureDC1394 ? icvGetPropertyCAM_DC1394( captureDC1394, propId ) : 0;
|
|
}
|
|
|
|
bool CvCaptureCAM_DC1394_CPP::setProperty( int propId, double value )
|
|
{
|
|
return captureDC1394 ? icvSetPropertyCAM_DC1394( captureDC1394, propId, value ) != 0 : false;
|
|
}
|
|
|
|
CvCapture* cvCreateCameraCapture_DC1394( int index )
|
|
{
|
|
CvCaptureCAM_DC1394_CPP* capture = new CvCaptureCAM_DC1394_CPP;
|
|
|
|
if( capture->open( index ))
|
|
return capture;
|
|
|
|
delete capture;
|
|
return 0;
|
|
}
|
|
|
|
#endif
|