refactor(intrinsics): adjust intrinsics types
This commit is contained in:
parent
611468ad90
commit
938dc08654
|
@ -190,6 +190,11 @@ class MYNTEYE_API API {
|
||||||
* Get the intrinsics of stream.
|
* Get the intrinsics of stream.
|
||||||
*/
|
*/
|
||||||
Intrinsics GetIntrinsics(const Stream &stream) const;
|
Intrinsics GetIntrinsics(const Stream &stream) const;
|
||||||
|
/**
|
||||||
|
* Get the intrinsics of stream.
|
||||||
|
*/
|
||||||
|
template<typename T>
|
||||||
|
T GetIntrinsics(const Stream &from) const;
|
||||||
/**
|
/**
|
||||||
* Get the extrinsics from one stream to another.
|
* Get the extrinsics from one stream to another.
|
||||||
*/
|
*/
|
||||||
|
@ -202,11 +207,6 @@ class MYNTEYE_API API {
|
||||||
* Get the extrinsics from one stream to motion.
|
* Get the extrinsics from one stream to motion.
|
||||||
*/
|
*/
|
||||||
Extrinsics GetMotionExtrinsics(const Stream &from) const;
|
Extrinsics GetMotionExtrinsics(const Stream &from) const;
|
||||||
/**
|
|
||||||
* Get the intrinsics of stream.
|
|
||||||
*/
|
|
||||||
template<typename T>
|
|
||||||
T GetIntrinsics(const Stream &from) const;
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Log all option infos.
|
* Log all option infos.
|
||||||
|
@ -315,13 +315,6 @@ T API::GetIntrinsics(const Stream &from) const {
|
||||||
return device_->GetIntrinsics<T>(from);
|
return device_->GetIntrinsics<T>(from);
|
||||||
}
|
}
|
||||||
|
|
||||||
template <typename T>
|
|
||||||
T Device::GetIntrinsics(const Stream &from) const {
|
|
||||||
T res;
|
|
||||||
printf("type %d\n", res.calib_model_);
|
|
||||||
return res;
|
|
||||||
}
|
|
||||||
|
|
||||||
MYNTEYE_END_NAMESPACE
|
MYNTEYE_END_NAMESPACE
|
||||||
|
|
||||||
#endif // MYNTEYE_API_API_H_
|
#endif // MYNTEYE_API_API_H_
|
||||||
|
|
|
@ -154,6 +154,11 @@ class MYNTEYE_API Device {
|
||||||
* Get the intrinsics of stream.
|
* Get the intrinsics of stream.
|
||||||
*/
|
*/
|
||||||
Intrinsics GetIntrinsics(const Stream &stream) const;
|
Intrinsics GetIntrinsics(const Stream &stream) const;
|
||||||
|
/**
|
||||||
|
* Get the intrinsics of stream.
|
||||||
|
*/
|
||||||
|
template<typename T>
|
||||||
|
T GetIntrinsics(const Stream &from) const;
|
||||||
/**
|
/**
|
||||||
* Get the extrinsics from one stream to another.
|
* Get the extrinsics from one stream to another.
|
||||||
*/
|
*/
|
||||||
|
@ -203,12 +208,6 @@ class MYNTEYE_API Device {
|
||||||
*/
|
*/
|
||||||
void SetMotionExtrinsics(const Stream &from, const Extrinsics &ex);
|
void SetMotionExtrinsics(const Stream &from, const Extrinsics &ex);
|
||||||
|
|
||||||
/**
|
|
||||||
* Get the intrinsics of stream.
|
|
||||||
*/
|
|
||||||
template<typename T>
|
|
||||||
T GetIntrinsics(const Stream &from) const;
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Log all option infos.
|
* Log all option infos.
|
||||||
*/
|
*/
|
||||||
|
@ -366,6 +365,13 @@ class MYNTEYE_API Device {
|
||||||
friend tools::DeviceWriter;
|
friend tools::DeviceWriter;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
template <typename T>
|
||||||
|
T Device::GetIntrinsics(const Stream &from) const {
|
||||||
|
T res;
|
||||||
|
printf("type %d\n", res.calib_model_);
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
MYNTEYE_END_NAMESPACE
|
MYNTEYE_END_NAMESPACE
|
||||||
|
|
||||||
#endif // MYNTEYE_DEVICE_DEVICE_H_
|
#endif // MYNTEYE_DEVICE_DEVICE_H_
|
||||||
|
|
|
@ -395,32 +395,35 @@ std::ostream &operator<<(std::ostream &os, const StreamRequest &request);
|
||||||
* @brief Intrinsic and extrinsic properties.
|
* @brief Intrinsic and extrinsic properties.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/** different model of camera calibration */
|
/**
|
||||||
typedef enum CalibrationModel {
|
* @ingroup calibration
|
||||||
/** pinhole camera */
|
* Camera calibration model.
|
||||||
CALIB_MODEL_PINHOLE = 0,
|
*/
|
||||||
/** equidistant camera */
|
enum class CalibrationModel : std::uint8_t {
|
||||||
CALIB_MODEL_KANNALA_BRANDT = 1,
|
/** Unknow */
|
||||||
|
CALIB_MODEL_UNKNOW = 0,
|
||||||
CALIB_MODEL_UNKNOW,
|
/** Pinhole */
|
||||||
|
CALIB_MODEL_PINHOLE = 1,
|
||||||
|
/** Equidistant: KANNALA_BRANDT */
|
||||||
|
CALIB_MODEL_KANNALA_BRANDT = 2,
|
||||||
// CALIB_MODEL_SCARAMUZZA,
|
// CALIB_MODEL_SCARAMUZZA,
|
||||||
// CALIB_MODEL_MEI
|
// CALIB_MODEL_MEI,
|
||||||
}CALIB_MODEL;
|
};
|
||||||
|
|
||||||
|
struct MYNTEYE_API IntrinsicsBase {
|
||||||
|
IntrinsicsBase() {
|
||||||
|
calib_model = CalibrationModel::CALIB_MODEL_UNKNOW;
|
||||||
|
}
|
||||||
|
CalibrationModel calib_model;
|
||||||
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @ingroup calibration
|
* @ingroup calibration
|
||||||
* Stream intrinsics,
|
* Stream intrinsics (Pinhole)
|
||||||
*/
|
*/
|
||||||
struct MYNTEYE_API IntrinsicsBase {
|
struct MYNTEYE_API IntrinsicsPinhole : public IntrinsicsBase {
|
||||||
IntrinsicsBase() {
|
IntrinsicsPinhole() {
|
||||||
calib_model_ = CALIB_MODEL_UNKNOW;
|
calib_model = CalibrationModel::CALIB_MODEL_PINHOLE;
|
||||||
}
|
|
||||||
CALIB_MODEL calib_model_;
|
|
||||||
};
|
|
||||||
|
|
||||||
struct MYNTEYE_API Intrinsics : public IntrinsicsBase {
|
|
||||||
Intrinsics() {
|
|
||||||
calib_model_ = CALIB_MODEL_PINHOLE;
|
|
||||||
}
|
}
|
||||||
/** The width of the image in pixels */
|
/** The width of the image in pixels */
|
||||||
std::uint16_t width;
|
std::uint16_t width;
|
||||||
|
@ -440,25 +443,22 @@ struct MYNTEYE_API Intrinsics : public IntrinsicsBase {
|
||||||
double coeffs[5];
|
double coeffs[5];
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
MYNTEYE_API
|
||||||
model_type: KANNALA_BRANDT
|
std::ostream &operator<<(std::ostream &os, const IntrinsicsPinhole &in);
|
||||||
camera_name: KANNALA_BRANDT
|
|
||||||
image_width: 640
|
|
||||||
image_height: 400
|
|
||||||
projection_parameters:
|
|
||||||
k2: 4.9972342319338209e-01
|
|
||||||
k3: 4.3314206872885375e-01
|
|
||||||
k4: -9.2064699153680563e-01
|
|
||||||
k5: 4.1211925379358533e-01
|
|
||||||
mu: 2.0077513040612871e+02
|
|
||||||
mv: 2.0099851605062454e+02
|
|
||||||
u0: 3.1079403134153824e+02
|
|
||||||
v0: 2.1225649273618896e+02
|
|
||||||
*/
|
|
||||||
|
|
||||||
struct MYNTEYE_API Intrinsics2 : public IntrinsicsBase {
|
/**
|
||||||
Intrinsics2() {
|
* @ingroup calibration
|
||||||
calib_model_ = CALIB_MODEL_KANNALA_BRANDT;
|
* Stream intrinsics (Pinhole)
|
||||||
|
*/
|
||||||
|
using Intrinsics = IntrinsicsPinhole;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @ingroup calibration
|
||||||
|
* Stream intrinsics (Equidistant: KANNALA_BRANDT)
|
||||||
|
*/
|
||||||
|
struct MYNTEYE_API IntrinsicsEquidistant : public IntrinsicsBase {
|
||||||
|
IntrinsicsEquidistant() {
|
||||||
|
calib_model = CalibrationModel::CALIB_MODEL_KANNALA_BRANDT;
|
||||||
}
|
}
|
||||||
/** The width of the image in pixels */
|
/** The width of the image in pixels */
|
||||||
std::uint16_t width;
|
std::uint16_t width;
|
||||||
|
@ -475,33 +475,8 @@ struct MYNTEYE_API Intrinsics2 : public IntrinsicsBase {
|
||||||
double v0;
|
double v0;
|
||||||
};
|
};
|
||||||
|
|
||||||
// union MYNTEYE_API CameraParameters {
|
|
||||||
// struct IntrinsicsBase intrinsics_base;
|
|
||||||
// struct Intrinsics intrinsics10;
|
|
||||||
// struct Intrinsics2 intrinsics20;
|
|
||||||
// unsigned char raw[];
|
|
||||||
// CameraParameters(struct IntrinsicsBase& base) {
|
|
||||||
// memset(raw, 0, sizeof(union CameraParameters));
|
|
||||||
// switch (base.calib_model_) {
|
|
||||||
// case CALIB_MODEL_10:
|
|
||||||
// intrinsics10 = static_cast<struct Intrinsics&>(base);
|
|
||||||
// break;
|
|
||||||
// case CALIB_MODEL_20:
|
|
||||||
// intrinsics20 = static_cast<struct Intrinsics2&>(base);
|
|
||||||
// break;
|
|
||||||
// default:
|
|
||||||
// // warning!!! no impl!!!
|
|
||||||
// intrinsics_base = base;
|
|
||||||
// return;
|
|
||||||
// }
|
|
||||||
// }
|
|
||||||
// CALIB_MODEL getModelType() {return intrinsics_base.calib_model_;}
|
|
||||||
// };
|
|
||||||
// MYNTEYE_API
|
|
||||||
// std::ostream &operator<<(std::ostream &os, const CameraParameters &in);
|
|
||||||
|
|
||||||
MYNTEYE_API
|
MYNTEYE_API
|
||||||
std::ostream &operator<<(std::ostream &os, const Intrinsics &in);
|
std::ostream &operator<<(std::ostream &os, const IntrinsicsEquidistant &in);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @ingroup calibration
|
* @ingroup calibration
|
||||||
|
|
|
@ -31,28 +31,6 @@ int main(int argc, char *argv[]) {
|
||||||
<< "}";
|
<< "}";
|
||||||
LOG(INFO) << "Extrinsics right to left: {"
|
LOG(INFO) << "Extrinsics right to left: {"
|
||||||
<< api->GetExtrinsics(Stream::RIGHT, Stream::LEFT) << "}";
|
<< api->GetExtrinsics(Stream::RIGHT, Stream::LEFT) << "}";
|
||||||
auto inr = api->GetIntrinsics(Stream::LEFT);
|
|
||||||
// CameraParameters cmm(inr);
|
|
||||||
// for (int i = 0;i< sizeof(cmm) ; i++) {
|
|
||||||
// printf(" %x ",cmm.raw[i]);
|
|
||||||
// }
|
|
||||||
// printf("end: %d\n", (int)(cmm.getModelType()));
|
|
||||||
|
|
||||||
// Intrinsics2 xxx2;
|
|
||||||
// CameraParameters cmm2(xxx2);
|
|
||||||
// for (int i = 0;i< sizeof(cmm2) ; i++) {
|
|
||||||
// printf(" %x ",cmm2.raw[i]);
|
|
||||||
// }
|
|
||||||
// printf("end: %d\n", (int)(cmm2.getModelType()));
|
|
||||||
|
|
||||||
// IntrinsicsBase xxx3;
|
|
||||||
// CameraParameters cmm3(xxx3);
|
|
||||||
// for (int i = 0;i< sizeof(cmm3) ; i++) {
|
|
||||||
// printf(" %x ",cmm3.raw[i]);
|
|
||||||
// }
|
|
||||||
// printf("end: %d\n", (int)(cmm3.getModelType()));
|
|
||||||
|
|
||||||
api->GetIntrinsics<Intrinsics>(Stream::LEFT);
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
|
@ -188,8 +188,9 @@ std::ostream &operator<<(std::ostream &os, const StreamRequest &request) {
|
||||||
<< ", format: " << request.format << ", fps: " << request.fps;
|
<< ", format: " << request.format << ", fps: " << request.fps;
|
||||||
}
|
}
|
||||||
|
|
||||||
std::ostream &operator<<(std::ostream &os, const Intrinsics &in) {
|
std::ostream &operator<<(std::ostream &os, const IntrinsicsPinhole &in) {
|
||||||
os << FULL_PRECISION << "width: " << in.width << ", height: " << in.height
|
os << "pinhole, " << FULL_PRECISION
|
||||||
|
<< "width: " << in.width << ", height: " << in.height
|
||||||
<< ", fx: " << in.fx << ", fy: " << in.fy << ", cx: " << in.cx
|
<< ", fx: " << in.fx << ", fy: " << in.fy << ", cx: " << in.cx
|
||||||
<< ", cy: " << in.cy << ", model: " << static_cast<int>(in.model)
|
<< ", cy: " << in.cy << ", model: " << static_cast<int>(in.model)
|
||||||
<< ", coeffs: [";
|
<< ", coeffs: [";
|
||||||
|
@ -198,6 +199,16 @@ std::ostream &operator<<(std::ostream &os, const Intrinsics &in) {
|
||||||
return os << in.coeffs[4] << "]";
|
return os << in.coeffs[4] << "]";
|
||||||
}
|
}
|
||||||
|
|
||||||
|
std::ostream &operator<<(std::ostream &os, const IntrinsicsEquidistant &in) {
|
||||||
|
os << "equidistant, " << FULL_PRECISION
|
||||||
|
<< "width: " << in.width << ", height: " << in.height
|
||||||
|
<< ", k2: " << in.k2 << ", k3: " << in.k3
|
||||||
|
<< ", k4: " << in.k4 << ", k5: " << in.k5
|
||||||
|
<< ", mu: " << in.mu << ", mv: " << in.mv
|
||||||
|
<< ", u0: " << in.u0 << ", v0: " << in.v0;
|
||||||
|
return os;
|
||||||
|
}
|
||||||
|
|
||||||
std::ostream &operator<<(std::ostream &os, const ImuIntrinsics &in) {
|
std::ostream &operator<<(std::ostream &os, const ImuIntrinsics &in) {
|
||||||
os << FULL_PRECISION << "scale: [";
|
os << FULL_PRECISION << "scale: [";
|
||||||
for (int i = 0; i <= 2; i++)
|
for (int i = 0; i <= 2; i++)
|
||||||
|
|
Loading…
Reference in New Issue
Block a user