mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-06 17:57:45 +08:00
Fixed PnP camera matrix empty when computing loop closure. Updated odometry nonholomic motion estimation (using arc around ICR).
This commit is contained in:
@@ -127,7 +127,9 @@ void CameraThread::mainLoop()
|
||||
if(_cameraRGBD)
|
||||
{
|
||||
SensorData data;
|
||||
if(dynamic_cast<CameraStereoDC1394*>(_cameraRGBD) || dynamic_cast<CameraStereoDC1394*>(_cameraRGBD))
|
||||
if(dynamic_cast<CameraStereoFlyCapture2*>(_cameraRGBD) ||
|
||||
dynamic_cast<CameraStereoDC1394*>(_cameraRGBD) ||
|
||||
dynamic_cast<CameraStereoImages*>(_cameraRGBD))
|
||||
{
|
||||
//stereo
|
||||
data = SensorData(rgb, depth, StereoCameraModel(fx, fx, cx, cy, fyOrBaseline, _cameraRGBD->getLocalTransform()), ++_seq, stamp);
|
||||
|
||||
Reference in New Issue
Block a user