Representations/Perception/CameraInfo.cpp

Go to the documentation of this file.

/**
* @file CameraInfo.cpp
*
* Implementation of class CameraInfo.
*
* @author <a href="mailto:juengel@informatik.hu-berlin.de">Matthias Juengel</a>
* @author <a href="mailto:walter.nistico@uni-dortmund.de">Walter Nistico</a>
*/

#include "CameraInfo.h"

CameraInfo::CameraInfo() : 
resolutionWidth(cameraResolutionWidth_ERS7),
resolutionHeight(cameraResolutionHeight_ERS7),
openingAngleWidth(openingAngleWidth_ERS7),
openingAngleHeight(openingAngleHeight_ERS7),
focalLength(focalLength_ERS7),
focalLengthMM(focalLengthMM_ERS7),
pixelPerMM(pixelPerMM_ERS7),
opticalCenter(opticalCenterX_ERS7, opticalCenterY_ERS7),
secondOrderRadialDistortion(secondOrderRadialDistortion_ERS7),
fourthOrderRadialDistortion(fourthOrderRadialDistortion_ERS7),
focalLenPow2(focalLength*focalLength),
focalLenPow4(focalLength*focalLength*focalLength*focalLength),
focalLengthInv(1.0/focalLength),
simulated(false)
{
} 

CameraInfo::CameraInfo(RobotDesign::Design robotDesign) : 
resolutionWidth(robotDesign == RobotDesign::ERS210 ? cameraResolutionWidth_ERS210 : cameraResolutionWidth_ERS7),
resolutionHeight(robotDesign == RobotDesign::ERS210 ? cameraResolutionHeight_ERS210 : cameraResolutionHeight_ERS7),
openingAngleWidth(robotDesign == RobotDesign::ERS210 ? openingAngleWidth_ERS210 : openingAngleWidth_ERS7),
openingAngleHeight(robotDesign == RobotDesign::ERS210 ? openingAngleHeight_ERS210 : openingAngleHeight_ERS7),
focalLength(robotDesign == RobotDesign::ERS210 ? focalLength_ERS210 : focalLength_ERS7),
focalLengthMM(robotDesign == RobotDesign::ERS210 ? focalLengthMM_ERS210 : focalLengthMM_ERS7),
pixelPerMM(robotDesign == RobotDesign::ERS210 ? pixelPerMM_ERS210 : pixelPerMM_ERS7),
opticalCenter(robotDesign == RobotDesign::ERS210 ? opticalCenterX_ERS210 : opticalCenterX_ERS7, 
                  robotDesign == RobotDesign::ERS210 ? opticalCenterY_ERS210 : opticalCenterY_ERS7),
secondOrderRadialDistortion(robotDesign == RobotDesign::ERS210 ? secondOrderRadialDistortion_ERS210 : secondOrderRadialDistortion_ERS7),
fourthOrderRadialDistortion(robotDesign == RobotDesign::ERS210 ? fourthOrderRadialDistortion_ERS210 : fourthOrderRadialDistortion_ERS7),
focalLenPow2(focalLength*focalLength),
focalLenPow4(focalLength*focalLength*focalLength*focalLength),
focalLengthInv(1.0/focalLength),
simulated(false)
{
} 
/*
In& operator>>(In& stream,CameraInfo& cameraInfo)
{
  char c;
  stream >> cameraInfo.resolutionWidth;
  stream >> cameraInfo.resolutionHeight;
  stream >> cameraInfo.openingAngleWidth;
  stream >> cameraInfo.openingAngleHeight;
  stream >> cameraInfo.focalLength;
  stream >> cameraInfo.focalLengthMM;
  stream >> cameraInfo.pixelPerMM;
  stream >> cameraInfo.opticalCenter;
  stream >> cameraInfo.secondOrderRadialDistortion;
  stream >> cameraInfo.fourthOrderRadialDistortion;
  stream >> cameraInfo.focalLenPow2;
  stream >> cameraInfo.focalLenPow4;
  stream >> c;
  cameraInfo.simulated = c != 0;
  cameraInfo.focalLengthInv = 1.0/cameraInfo.focalLength;
  return stream;
}

Out& operator<<(Out& stream, const CameraInfo& cameraInfo)
{
  stream << cameraInfo.resolutionWidth;
  stream << cameraInfo.resolutionHeight;
  stream << cameraInfo.openingAngleWidth;
  stream << cameraInfo.openingAngleHeight;
  stream << cameraInfo.focalLength;
  stream << cameraInfo.focalLengthMM;
  stream << cameraInfo.pixelPerMM;
  stream << cameraInfo.opticalCenter;
  stream << cameraInfo.secondOrderRadialDistortion;
  stream << cameraInfo.fourthOrderRadialDistortion;
  stream << cameraInfo.focalLenPow2;
  stream << cameraInfo.focalLenPow4;
  stream << (char) cameraInfo.simulated;
  return stream;
}
*/

---