44#include <visp3/core/vpDebug.h>
45#include <visp3/core/vpMath.h>
46#include <visp3/core/vpXmlParserCamera.h>
47#include <visp3/robot/vpViper650.h>
49static const char *opt_viper650[] = {
"CAMERA",
"eMc_ROT_XYZ",
"eMc_TRANS_XYZ", NULL};
51#ifdef VISP_HAVE_VIPER650_DATA
53 std::string(VISP_VIPER650_DATA_PATH) +
54 std::string(
"/include/const_eMc_MarlinF033C_without_distortion_Viper650.cnf");
57 std::string(VISP_VIPER650_DATA_PATH) + std::string(
"/include/const_eMc_MarlinF033C_with_distortion_Viper650.cnf");
60 std::string(VISP_VIPER650_DATA_PATH) +
61 std::string(
"/include/const_eMc_PTGreyFlea2_without_distortion_Viper650.cnf");
64 std::string(VISP_VIPER650_DATA_PATH) + std::string(
"/include/const_eMc_PTGreyFlea2_with_distortion_Viper650.cnf");
67 std::string(VISP_VIPER650_DATA_PATH) + std::string(
"/include/"
68 "const_eMc_schunk_gripper_without_distortion_Viper650."
72 std::string(VISP_VIPER650_DATA_PATH) +
73 std::string(
"/include/const_eMc_schunk_gripper_with_distortion_Viper650.cnf");
76 std::string(VISP_VIPER650_DATA_PATH) + std::string(
"/include/const_eMc_generic_without_distortion_Viper650.cnf");
79 std::string(VISP_VIPER650_DATA_PATH) + std::string(
"/include/const_eMc_generic_with_distortion_Viper650.cnf");
82 std::string(VISP_VIPER650_DATA_PATH) + std::string(
"/include/const_camera_Viper650.xml");
109 c56 = -341.33 / 9102.22;
181#ifdef VISP_HAVE_VIPER650_DATA
183 std::string filename_eMc;
195 "Feature TOOL_MARLIN_F033C_CAMERA is not implemented for Kannala-Brandt projection model yet.");
210 "Feature TOOL_PTGREY_FLEA2_CAMERA is not implemented for Kannala-Brandt projection model yet.");
226 "Feature TOOL_SCHUNK_GRIPPER_CAMERA is not implemented for Kannala-Brandt projection model yet.");
241 "Feature TOOL_GENERIC_CAMERA is not implemented for Kannala-Brandt projection model yet.");
248 "No predefined file available for a custom tool"
249 "You should use init(vpViper650::vpToolType, const std::string&) or"
250 "init(vpViper650::vpToolType, const vpHomogeneousMatrix&) instead");
258 this->
init(filename_eMc);
284 "Feature TOOL_MARLIN_F033C_CAMERA is not implemented for Kannala-Brandt projection model yet.");
310 "Feature TOOL_PTGREY_FLEA2_CAMERA is not implemented for Kannala-Brandt projection model yet.");
329 "Feature TOOL_GENERIC_CAMERA is not implemented for Kannala-Brandt projection model yet.");
336 "No predefined parameters available for a custom tool"
337 "You should use init(vpViper650::vpToolType, const std::string&) or"
338 "init(vpViper650::vpToolType, const vpHomogeneousMatrix&) instead");
419 std::ifstream fdconfig(filename.c_str(), std::ios::in);
421 if (!fdconfig.is_open()) {
428 bool get_erc =
false;
429 bool get_etc =
false;
432 while (std::getline(fdconfig, line)) {
434 if ((line.compare(0, 1,
"#") == 0) || line.empty()) {
437 std::istringstream ss(line);
441 for (code = 0; NULL != opt_viper650[code]; ++code) {
442 if (key.compare(opt_viper650[code]) == 0) {
452 ss >> erc_[0] >> erc_[1] >> erc_[2];
455 erc_ = erc_ * M_PI / 180.0;
461 ss >> etc_[0] >> etc_[1] >> etc_[2];
468 filename.c_str(), lineNum));
474 if (get_etc && get_erc) {
478 "Could not read translation and rotation "
479 "parameters from config file %s",
554 const unsigned int &image_height)
const
556#if defined(VISP_HAVE_VIPER650_DATA)
619 if (image_width == 640 && image_height == 480) {
631 "Feature getCameraParameters is not implemented for Kannala-Brandt projection model yet.");
635 vpTRACE(
"Cannot get default intrinsic camera parameters for this image "
644 if (image_width == 640 && image_height == 480) {
656 "Feature getCameraParameters is not implemented for Kannala-Brandt projection model yet.");
660 vpTRACE(
"Cannot get default intrinsic camera parameters for this image "
668 if (image_width == 640 && image_height == 480) {
680 "Feature getCameraParameters is not implemented for Kannala-Brandt projection model yet.");
684 vpTRACE(
"Cannot get default intrinsic camera parameters for this image "
Generic class defining intrinsic camera parameters.
void initPersProjWithoutDistortion(double px, double py, double u0, double v0)
vpCameraParametersProjType
@ perspectiveProjWithDistortion
Perspective projection with distortion model.
@ ProjWithKannalaBrandtDistortion
Projection with Kannala-Brandt distortion model.
@ perspectiveProjWithoutDistortion
Perspective projection without distortion model.
void initPersProjWithDistortion(double px, double py, double u0, double v0, double kud, double kdu)
error that can be emitted by ViSP classes.
@ badValue
Used to indicate that a value is not in the allowed range.
@ notImplementedError
Not implemented.
Implementation of an homogeneous matrix and operations on such kind of matrices.
void buildFrom(const vpTranslationVector &t, const vpRotationMatrix &R)
Definition of the vpImage class member functions.
unsigned int getWidth() const
unsigned int getHeight() const
static double rad(double deg)
Error that can be emitted by the vpRobot class and its derivatives.
@ readingParametersError
Cannot parse parameters.
Implementation of a rotation matrix and operations on such kind of matrices.
Implementation of a rotation vector as Euler angle minimal representation.
Class that consider the case of a translation vector.
Modelisation of the ADEPT Viper 650 robot.
static const std::string CONST_EMC_GENERIC_WITHOUT_DISTORTION_FILENAME
static const char *const CONST_PTGREY_FLEA2_CAMERA_NAME
vpCameraParameters::vpCameraParametersProjType projModel
static const std::string CONST_EMC_SCHUNK_GRIPPER_WITHOUT_DISTORTION_FILENAME
static const vpToolType defaultTool
Default tool attached to the robot end effector.
static const std::string CONST_EMC_SCHUNK_GRIPPER_WITH_DISTORTION_FILENAME
vpToolType getToolType() const
Get the current tool type.
static const std::string CONST_EMC_GENERIC_WITH_DISTORTION_FILENAME
void parseConfigFile(const std::string &filename)
void getCameraParameters(vpCameraParameters &cam, const unsigned int &image_width, const unsigned int &image_height) const
static const char *const CONST_GENERIC_CAMERA_NAME
static const std::string CONST_EMC_MARLIN_F033C_WITH_DISTORTION_FILENAME
void setToolType(vpViper650::vpToolType tool)
Set the current tool type.
vpToolType
List of possible tools that can be attached to the robot end-effector.
@ TOOL_MARLIN_F033C_CAMERA
@ TOOL_SCHUNK_GRIPPER_CAMERA
@ TOOL_PTGREY_FLEA2_CAMERA
static const char *const CONST_MARLIN_F033C_CAMERA_NAME
static const std::string CONST_EMC_PTGREY_FLEA2_WITHOUT_DISTORTION_FILENAME
static const std::string CONST_EMC_PTGREY_FLEA2_WITH_DISTORTION_FILENAME
static const std::string CONST_EMC_MARLIN_F033C_WITHOUT_DISTORTION_FILENAME
static const std::string CONST_CAMERA_FILENAME
static const char *const CONST_SCHUNK_GRIPPER_CAMERA_NAME
virtual void set_eMc(const vpHomogeneousMatrix &eMc_)
double c56
Mechanical coupling between joint 5 and joint 6.
vpHomogeneousMatrix eMc
End effector to camera transformation.
XML parser to load and save intrinsic camera parameters.
int parse(vpCameraParameters &cam, const std::string &filename, const std::string &camera_name, const vpCameraParameters::vpCameraParametersProjType &projModel, unsigned int image_width=0, unsigned int image_height=0, bool verbose=true)