mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-01 17:10:26 +08:00
Fixed fatal error in #91
This commit is contained in:
@@ -3180,11 +3180,12 @@ void DBDriverSqlite3::stepSensorData(sqlite3_stmt * ppStmt,
|
||||
std::vector<float> calibration;
|
||||
// multi-cameras [fx,fy,cx,cy,width,height,local_transform, ... ,fx,fy,cx,cy,width,height,local_transform] (6+12)*float * numCameras
|
||||
// stereo [fx, fy, cx, cy, baseline, local_transform] (5+12)*float
|
||||
if(sensorData.cameraModels().size())
|
||||
if(sensorData.cameraModels().size() && sensorData.cameraModels()[0].isValidForProjection())
|
||||
{
|
||||
calibration.resize(sensorData.cameraModels().size() * (6+Transform().size()));
|
||||
for(unsigned int i=0; i<sensorData.cameraModels().size(); ++i)
|
||||
{
|
||||
UASSERT(sensorData.cameraModels()[i].isValidForProjection());
|
||||
const Transform & localTransform = sensorData.cameraModels()[i].localTransform();
|
||||
calibration[i*(6+localTransform.size())] = sensorData.cameraModels()[i].fx();
|
||||
calibration[i*(6+localTransform.size())+1] = sensorData.cameraModels()[i].fy();
|
||||
|
||||
Reference in New Issue
Block a user