Detailed Description

This "software driver" implements the communication protocol for interfacing a DUO3D Stereo Camera.

See also the example configuration file for rawlog-grabber in "share/mrpt/config_files/rawlog-grabber".

 PARAMETERS IN THE ".INI"-LIKE CONFIGURATION STRINGS:
-------------------------------------------------------
  [supplied_section_name]
        image_width                     = 640                   // [int]        x Resolution
        image_height                    = 480                   // [int]        y Resolution
        fps                                             = 30                    // [int]        Frames per second (<= 30)
        exposure                                = 50                    // [int]        Exposure value (1..100)
        led                                             = 0                             // [int]        Led intensity (only for some device models) (1..100).
        gain                                    = 50                    // [int]        Camera gain (1..100)
        capture_rectified               = false                 // [bool]       Rectify captured images
        capture_imu                     = true                  // [bool]       Capture IMU data from DUO3D device (if available)
        calibration_from_file   = true                  // [bool]       Use YML calibration files provided by calibration application supplied with DUO3D device
        intrinsic_filename              = ""                    // [string]     Intrinsic parameters file. This filename should contain a substring _RWWWxHHH_ with WWW being the image width and HHH the image height, as provided by the calibration application.
        extrinsic_filename              = ""                    // [string]     Extrinsic parameters file. This filename should contain a substring _RWWWxHHH_ with WWW being the image width and HHH the image height, as provided by the calibration application.
        rectify_map_filename    = ""                    // [string]     Rectification map file. This filename should contain a substring _RWWWxHHH_ with WWW being the image width and HHH the image height, as provided by the calibration application.
  pose_x=0.21   // camera 3D position in the robot (meters)
  pose_y=0
  pose_z=0.34
  pose_yaw=0    // Angles in degrees
  pose_pitch=0
  pose_roll=0

Definition at line 125 of file CDUO3DCamera.h.

#include <mrpt/hwdrivers/CDUO3DCamera.h>

Inheritance diagram for mrpt::hwdrivers::CDUO3DCamera:

Public Member Functions
	CDUO3DCamera ()
	Default Constructor (does not open the camera) More...

	CDUO3DCamera (const TCaptureOptions_DUO3D &options)
	Constructor: tries to open the camera with the given options. More...

virtual	~CDUO3DCamera ()
	Destructor. More...

const TCaptureOptions_DUO3D &	getCameraOptions () const
	Returns the current settings of the camera. More...

void	open (const TCaptureOptions_DUO3D &options, const bool startCapture=true)
	Tries to open the camera with the given options, and starts capturing. More...

void	startCapture ()
	Start the actual data capture of the camera. More...

void	stopCapture ()
	Stop capture. More...

void	close ()
	Stop capture and closes the opened camera, if any. More...

void	getObservations (mrpt::obs::CObservationStereoImages &outObservation_img, mrpt::obs::CObservationIMU &outObservation_imu, bool &there_is_img, bool &there_is_imu)
	Specific laser scanner "software drivers" must process here new data from the I/O stream, and, if a whole scan has arrived, return it. More...

bool	captureIMUIsSet ()
	Indicates if the camera is grabbing IMU data. More...

void *	getEvent ()
	Returned pointer to be reinterpreted as DUO3D's "HANDLE". More...

void	setDataFrame (void *frame)
	frame is a reinterpreted PDUOFrame More...

Protected Member Functions
bool	queryVersion (std::string version, bool printOutVersion=false)
	Queries the DUO3D Camera firmware version. More...

void *	m_get_duo_frame ()
	Gets a stereo frame from the DUO3D Camera (void* to be reinterpreted as PDUOFrame) More...

bool	m_open_duo_camera (int width, int height, float fps)
	Opens DUO3D camera. More...

void	m_close_duo_camera ()
	Closes DUO3D camera. More...

void	m_set_exposure (float value)
	Sets DUO3D camera Exposure setting. More...

void	m_set_gain (float value)
	Sets DUO3D camera Gain setting. More...

void	m_set_led (float value)
	Sets DUO3D camera LED setting. More...

Protected Attributes
TCaptureOptions_DUO3D	m_options

mrpt::vision::CStereoRectifyMap	m_rectify_map

void *	m_duo
	Opaque pointer to DUO's DUOInstance. More...

void *	m_pframe_data
	Pointer, to be reinterpreted as "PDUOFrame". More...

void *	m_evFrame
	DUO's HANDLE. More...

Constructor & Destructor Documentation

◆ CDUO3DCamera() [1/2]

CDUO3DCamera::CDUO3DCamera ( )

Default Constructor (does not open the camera)

Default constructor.

Definition at line 272 of file CDUO3DCamera.cpp.

References FALSE, m_duo, M_DUO_VALUE, m_evFrame, m_pframe_data, and THROW_EXCEPTION.

◆ CDUO3DCamera() [2/2]

CDUO3DCamera::CDUO3DCamera ( const TCaptureOptions_DUO3D & options )

Constructor: tries to open the camera with the given options.

Custom initialization and start grabbing constructor.

Raises an exception on error.

See also: open()

Definition at line 288 of file CDUO3DCamera.cpp.

References FALSE, m_duo, M_DUO_VALUE, m_evFrame, m_pframe_data, open(), and THROW_EXCEPTION.

◆ ~CDUO3DCamera()

CDUO3DCamera::~CDUO3DCamera ( )

virtual

Destructor.

Definition at line 304 of file CDUO3DCamera.cpp.

References close(), m_duo, and M_DUO_PTR.

Member Function Documentation

◆ captureIMUIsSet()

bool mrpt::hwdrivers::CDUO3DCamera::captureIMUIsSet ( )

inline

Indicates if the camera is grabbing IMU data.

Definition at line 179 of file CDUO3DCamera.h.

References mrpt::hwdrivers::TCaptureOptions_DUO3D::m_capture_imu.

◆ close()

void CDUO3DCamera::close ( )

Stop capture and closes the opened camera, if any.

Closes DUO camera.

Called automatically on object destruction.

Definition at line 490 of file CDUO3DCamera.cpp.

References M_DUO_VALUE.

Referenced by open(), and ~CDUO3DCamera().

◆ getCameraOptions()

const TCaptureOptions_DUO3D& mrpt::hwdrivers::CDUO3DCamera::getCameraOptions ( ) const

inline

Returns the current settings of the camera.

Definition at line 151 of file CDUO3DCamera.h.

◆ getEvent()

void* mrpt::hwdrivers::CDUO3DCamera::getEvent ( )

inline

Returned pointer to be reinterpreted as DUO3D's "HANDLE".

Definition at line 182 of file CDUO3DCamera.h.

◆ getObservations()

void CDUO3DCamera::getObservations	(	mrpt::obs::CObservationStereoImages &	outObservation_img,
		mrpt::obs::CObservationIMU &	outObservation_imu,
		bool &	there_is_img,
		bool &	there_is_imu
	)

Specific laser scanner "software drivers" must process here new data from the I/O stream, and, if a whole scan has arrived, return it.

This method will be typically called in a different thread than other methods, and will be called in a timely fashion.

Definition at line 425 of file CDUO3DCamera.cpp.

References mrpt::obs::CObservationIMU::dataIsPresent, mrpt::obs::CObservationStereoImages::imageLeft, mrpt::obs::CObservationStereoImages::imageRight, mrpt::utils::CImage::loadFromMemoryBuffer(), mrpt::hwdrivers::TCaptureOptions_DUO3D::m_capture_imu, mrpt::hwdrivers::TCaptureOptions_DUO3D::m_capture_rectified, m_get_duo_frame(), mrpt::hwdrivers::TCaptureOptions_DUO3D::m_img_height, mrpt::hwdrivers::TCaptureOptions_DUO3D::m_img_width, m_options, m_pframe_data, m_rectify_map, mrpt::hwdrivers::TCaptureOptions_DUO3D::m_stereo_camera, mrpt::system::now(), mrpt::obs::CObservationIMU::rawMeasurements, mrpt::vision::CStereoRectifyMap::rectify(), mrpt::obs::CObservationStereoImages::setStereoCameraParams(), and mrpt::obs::CObservation::timestamp.

◆ m_close_duo_camera()

void mrpt::hwdrivers::CDUO3DCamera::m_close_duo_camera ( )

protected

Closes DUO3D camera.

◆ m_get_duo_frame()

void * CDUO3DCamera::m_get_duo_frame ( )

protected

Gets a stereo frame from the DUO3D Camera (void* to be reinterpreted as PDUOFrame)

Definition at line 501 of file CDUO3DCamera.cpp.

References M_DUO_VALUE, m_evFrame, and m_pframe_data.

Referenced by getObservations().

◆ m_open_duo_camera()

bool mrpt::hwdrivers::CDUO3DCamera::m_open_duo_camera	(	int	width,
		int	height,
		float	fps
	)

protected

Opens DUO3D camera.

◆ m_set_exposure()

void CDUO3DCamera::m_set_exposure ( float value )

protected

Sets DUO3D camera Exposure setting.

Definition at line 512 of file CDUO3DCamera.cpp.

References M_DUO_VALUE.

◆ m_set_gain()

void CDUO3DCamera::m_set_gain ( float value )

protected

Sets DUO3D camera Gain setting.

Definition at line 520 of file CDUO3DCamera.cpp.

References M_DUO_VALUE.

◆ m_set_led()

void CDUO3DCamera::m_set_led ( float value )

protected

Sets DUO3D camera LED setting.

Definition at line 528 of file CDUO3DCamera.cpp.

References M_DUO_VALUE.

◆ open()

void CDUO3DCamera::open	(	const TCaptureOptions_DUO3D &	options,
		const bool	startCapture = `true`
	)

Tries to open the camera with the given options, and starts capturing.

Tries to open the camera with the given options.

Raises an exception on error.

Parameters

[in] startCapture If set to false, the camera is only opened and configured, but a posterior call to startCapture() is required to start grabbing data.

See also: close(), startCapture()

Raises an exception on error.

See also: close()

Definition at line 313 of file CDUO3DCamera.cpp.

Referenced by CDUO3DCamera().

◆ queryVersion()

bool CDUO3DCamera::queryVersion	(	std::string	version,
		bool	printOutVersion = `false`
	)

protected

Queries the DUO3D Camera firmware version.

Definition at line 537 of file CDUO3DCamera.cpp.

References version.

◆ setDataFrame()

void mrpt::hwdrivers::CDUO3DCamera::setDataFrame ( void * frame )

inline

frame is a reinterpreted PDUOFrame

Definition at line 185 of file CDUO3DCamera.h.

◆ startCapture()

void mrpt::hwdrivers::CDUO3DCamera::startCapture ( )

Start the actual data capture of the camera.

Must be called after open(), only when "startCapture" was set to false.

Referenced by open().

◆ stopCapture()

void mrpt::hwdrivers::CDUO3DCamera::stopCapture ( )

Stop capture.

Member Data Documentation

◆ m_duo

void* mrpt::hwdrivers::CDUO3DCamera::m_duo

protected

Opaque pointer to DUO's DUOInstance.

Definition at line 136 of file CDUO3DCamera.h.

Referenced by CDUO3DCamera(), and ~CDUO3DCamera().

◆ m_evFrame

void* mrpt::hwdrivers::CDUO3DCamera::m_evFrame

protected

DUO's HANDLE.

Definition at line 138 of file CDUO3DCamera.h.

Referenced by CDUO3DCamera(), and m_get_duo_frame().

◆ m_options

TCaptureOptions_DUO3D mrpt::hwdrivers::CDUO3DCamera::m_options

protected

Definition at line 131 of file CDUO3DCamera.h.

Referenced by getObservations(), and open().

◆ m_pframe_data

void* mrpt::hwdrivers::CDUO3DCamera::m_pframe_data

protected

Pointer, to be reinterpreted as "PDUOFrame".

Definition at line 137 of file CDUO3DCamera.h.

Referenced by CDUO3DCamera(), getObservations(), and m_get_duo_frame().

◆ m_rectify_map

mrpt::vision::CStereoRectifyMap mrpt::hwdrivers::CDUO3DCamera::m_rectify_map

protected

Definition at line 134 of file CDUO3DCamera.h.

Referenced by getObservations(), and open().

Detailed Description

Public Member Functions

Protected Member Functions

Protected Attributes

Constructor & Destructor Documentation

◆ CDUO3DCamera() [1/2]

◆ CDUO3DCamera() [2/2]

◆ ~CDUO3DCamera()

Member Function Documentation

◆ captureIMUIsSet()

◆ close()

◆ getCameraOptions()

◆ getEvent()

◆ getObservations()

◆ m_close_duo_camera()

◆ m_get_duo_frame()

◆ m_open_duo_camera()

◆ m_set_exposure()

◆ m_set_gain()

◆ m_set_led()

◆ open()

◆ queryVersion()

◆ setDataFrame()

◆ startCapture()

◆ stopCapture()

Member Data Documentation

◆ m_duo

◆ m_evFrame

◆ m_options

◆ m_pframe_data

◆ m_rectify_map