StereoCalibration.h

Go to the documentation of this file.

// ****************************************************************************
// This file is part of the Integrating Vision Toolkit (IVT).
//
// The IVT is maintained by the Karlsruhe Institute of Technology (KIT)
// (www.kit.edu) in cooperation with the company Keyetech (www.keyetech.de).
//
// Copyright (C) 2014 Karlsruhe Institute of Technology (KIT).
// All rights reserved.
//
// Redistribution and use in source and binary forms, with or without
// modification, are permitted provided that the following conditions are met:
//
// 1. Redistributions of source code must retain the above copyright
//    notice, this list of conditions and the following disclaimer.
//
// 2. Redistributions 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.
//
// 3. Neither the name of the KIT nor the names of its contributors may be
//    used to endorse or promote products derived from this software
//    without specific prior written permission.
//
// THIS SOFTWARE IS PROVIDED BY THE KIT 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 KIT 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.
// ****************************************************************************
// ****************************************************************************
// Filename:  StereoCalibration.h
// Author:    Pedram Azad
// Date:      2004
// ****************************************************************************


#ifndef _STEREO_CALIBRATION_H_
#define _STEREO_CALIBRATION_H_


// ****************************************************************************
// Necessary includes
// ****************************************************************************

#include "Math/Math3d.h"


// ****************************************************************************
// Forward declarations
// ****************************************************************************

class CCalibration;
class CByteImage;
struct Vec2d;
struct Vec3d;
struct Mat3d;
struct PointPair2d;
struct PointPair3d;



// ****************************************************************************
// CStereoCalibration
// ****************************************************************************

class CStereoCalibration
{
public:
        CStereoCalibration();

        ~CStereoCalibration();
        
        CStereoCalibration(const CStereoCalibration &stereoCalibration);

        
        void Set(const CStereoCalibration &stereoCalibration);
        
        void SetSingleCalibrations(const CCalibration &leftCalibration, const CCalibration &rightCalibration, bool bTransformLeftCameraToIdentity = false);
        
        void SetDistortionParameters(float d1_left, float d2_left, float d3_left, float d4_left, float d1_right, float d2_right, float d3_right, float d4_right);

        void SetExtrinsicParameters(const Mat3d& left_rotation, const Vec3d& left_translation, const Mat3d& right_rotation, const Vec3d& right_translation, bool bTransformLeftCameraToIdentity = false);
        
        bool LoadCameraParameters(const char *pCameraParameterFileName, bool bTransformLeftCameraToIdentity = true);
                
        bool SaveCameraParameters(const char *pCameraParameterFileName) const;

        
        const CCalibration* GetLeftCalibration() const { return m_pLeftCalibration; }
        
        const CCalibration* GetRightCalibration() const { return m_pRightCalibration; }

        
        void Calculate3DPoint(const Vec2d &cameraPointLeft, const Vec2d &cameraPointRight, Vec3d &worldPoint, bool bInputImagesAreRectified, bool bUseDistortionParameters = true, PointPair3d *pConnectionLine = 0);
        
        void CalculateEpipolarLineInLeftImage(const Vec2d &pointInRightImage, Vec3d &l);
        
        void CalculateEpipolarLineInLeftImage(const Vec2d &pointInRightImage, PointPair2d &epipolarLine);
        
        void CalculateEpipolarLineInLeftImage(const Vec2d &pointInRightImage, float &m, float &c);
        
        void CalculateEpipolarLineInRightImage(const Vec2d &pointInLeftImage, Vec3d &l);
        
        void CalculateEpipolarLineInRightImage(const Vec2d &pointInLeftImage, PointPair2d &epipolarLine);
        
        void CalculateEpipolarLineInRightImage(const Vec2d &pointInLeftImage, float &m, float &c);
        
        
        float CalculateEpipolarLineInLeftImageDistance(const Vec2d &pointInLeftImage, const Vec2d &pointInRightImage);
        
        float CalculateEpipolarLineInRightImageDistance(const Vec2d &pointInLeftImage, const Vec2d &pointInRightImage);
        
        void GetProjectionMatricesForRectifiedImages(Mat3d &P1Left, Vec3d &p2Left, Mat3d &P1Right, Vec3d &p2Right) const;
        
        
        // public attributes
        int width;
        int height;
        
        Mat3d rectificationHomographyLeft;
        
        Mat3d rectificationHomographyRight;
                

private:
        // private methods
        void TransformLeftCameraToIdentity();
        void CalculateFundamentalMatrix();

        // private attributes
        CCalibration *m_pLeftCalibration;
        CCalibration *m_pRightCalibration;
        
        Mat3d F, FT; // F = fundamental matrix, FT = transposed fundamental matrix
};



#endif /* _STEREO_CALIBRATION_H_ */