mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-03 16:27:46 +08:00
fixed "CameraModel() Condition (fx > 0.0) not met! [fx=0.000000]" error on appearance-based demo
This commit is contained in:
+15
-8
@@ -896,14 +896,21 @@ rtabmap::Signature nodeDataFromROS(const rtabmap_ros::NodeData & msg)
|
|||||||
{
|
{
|
||||||
for(unsigned int i=0; i<msg.fx.size(); ++i)
|
for(unsigned int i=0; i<msg.fx.size(); ++i)
|
||||||
{
|
{
|
||||||
models.push_back(rtabmap::CameraModel(
|
if(msg.fx[i] == 0)
|
||||||
msg.fx[i],
|
{
|
||||||
msg.fy[i],
|
models.push_back(rtabmap::CameraModel());
|
||||||
msg.cx[i],
|
}
|
||||||
msg.cy[i],
|
else
|
||||||
transformFromGeometryMsg(msg.localTransform[i]),
|
{
|
||||||
0.0,
|
models.push_back(rtabmap::CameraModel(
|
||||||
cv::Size(msg.width[i], msg.height[i])));
|
msg.fx[i],
|
||||||
|
msg.fy[i],
|
||||||
|
msg.cx[i],
|
||||||
|
msg.cy[i],
|
||||||
|
transformFromGeometryMsg(msg.localTransform[i]),
|
||||||
|
0.0,
|
||||||
|
cv::Size(msg.width[i], msg.height[i])));
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user