Ask Your Question

Revision history [back]

click to hide/show revision 1
initial version

rpg_svo doesn't grab first and second frame

I'm trying to use rpg_svo, but I'm never seeing the normal "Selected frame" messages. This is the output from the suggested rosbag on the wiki:

# ./test_pipeline 
[INFO] SVO initialized
reading image /home/mark/svo_datasets/sin2_tex2_h1_v8_d/img/frame_000002_0.png
[INFO] RESET
[INFO] Init: Selected first frame.
Frame-Id: 0     #Features: 0    Proc. Time: 6.421ms 
[INFO] Init: KLT tracked 565 features
[INFO] Init: KLT 25.3823px average disparity.
Frame-Id: 1     #Features: 0    Proc. Time: 15.017ms 
[INFO] Init: KLT tracked 543 features
[INFO] Init: KLT 50.8035px average disparity.
[INFO] Init: Homography RANSAC 543 inliers.
[INFO] Init: Selected second frame, triangulated initial map.
Frame-Id: 2     #Features: 498  Proc. Time: 14.268ms

This is what happens when I launch mine (note that I only see the "Init: KLT" messages above):

# roslaunch svo_ros live.launch
... logging to /home/mark/.ros/log/806c7c96-b3ce-11e5-a526-001c42361d26/roslaunch-ubuntu-6899.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt

started roslaunch server http://ubuntu:47686/

SUMMARY
========

CLEAR PARAMETERS
 * /svo/

PARAMETERS
 * /rosdistro: indigo
 * /rosversion: 1.11.16
 * /svo/cam_cx: 320.362717
 * /svo/cam_cy: 245.340008
 * /svo/cam_d0: 0.198003
 * /svo/cam_d1: -0.549356
 * /svo/cam_d2: 0.004226
 * /svo/cam_d3: -0.002177
 * /svo/cam_fx: 624.167255
 * /svo/cam_fy: 623.400598
 * /svo/cam_height: 480
 * /svo/cam_model: Pinhole
 * /svo/cam_topic: /camera/color/ima...
 * /svo/cam_width: 640
 * /svo/grid_size: 30
 * /svo/loba_num_iter: 0
 * /svo/max_n_kfs: 10

NODES
  /
    svo (svo_ros/vo)

ROS_MASTER_URI=http://localhost:11311

core service [/rosout] found
process[svo-1]: started with pid [6918]
create vo_node
[ WARN] [1452105949.179495580]: Cannot find value for parameter: svo/publish_img_pyr_level, assigning default: 0
[ WARN] [1452105949.180625334]: Cannot find value for parameter: svo/publish_every_nth_img, assigning default: 1
[ WARN] [1452105949.181837194]: Cannot find value for parameter: svo/publish_every_nth_dense_input, assigning default: 1
[ WARN] [1452105949.185047520]: Cannot find value for parameter: svo/publish_world_in_cam_frame, assigning default: 1
[ WARN] [1452105949.185818236]: Cannot find value for parameter: svo/publish_map_every_frame, assigning default: 0
[ WARN] [1452105949.186840312]: Cannot find value for parameter: svo/publish_point_display_time, assigning default: 0
[ WARN] [1452105949.408194780]: Cannot find value for parameter: svo/publish_markers, assigning default: 1
[ WARN] [1452105949.408822669]: Cannot find value for parameter: svo/publish_dense_input, assigning default: 0
[ WARN] [1452105949.409621654]: Cannot find value for parameter: svo/accept_console_user_input, assigning default: 1
[ INFO] [1452105949.410586043]: Found parameter: svo/cam_model, value: Pinhole
[ INFO] [1452105949.412961167]: Found parameter: svo/cam_width, value: 640
[ INFO] [1452105949.414143712]: Found parameter: svo/cam_height, value: 480
[ INFO] [1452105949.415291525]: Found parameter: svo/cam_fx, value: 624.167
[ INFO] [1452105949.416488787]: Found parameter: svo/cam_fy, value: 623.401
[ INFO] [1452105949.417760878]: Found parameter: svo/cam_cx, value: 320.363
[ INFO] [1452105949.419177927]: Found parameter: svo/cam_cy, value: 245.34
[ INFO] [1452105949.420738599]: Found parameter: svo/cam_d0, value: 0.198003
[ INFO] [1452105949.422144347]: Found parameter: svo/cam_d1, value: -0.549356
[ INFO] [1452105949.423109725]: Found parameter: svo/cam_d2, value: 0.004226
[ INFO] [1452105949.423798320]: Found parameter: svo/cam_d3, value: -0.002177
[ WARN] [1452105949.431360389]: Cannot find value for parameter: svo/init_tz, assigning default: 0
[ WARN] [1452105949.432451963]: Cannot find value for parameter: svo/init_ty, assigning default: 0
[ WARN] [1452105949.433854444]: Cannot find value for parameter: svo/init_tx, assigning default: 0
[ WARN] [1452105949.435479614]: Cannot find value for parameter: svo/init_rz, assigning default: 0
[ WARN] [1452105949.437368907]: Cannot find value for parameter: svo/init_ry, assigning default: 0
[ WARN] [1452105949.438416004]: Cannot find value for parameter: svo/init_rx, assigning default: 0
[INFO] SVO initialized
[ INFO] [1452105949.439655113]: Found parameter: svo/cam_topic, value: /camera/color/image_raw
[INFO] RESET
[INFO] Init: Selected first frame.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0px average disparity.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0.138389px average disparity.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0.138361px average disparity.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0.0867741px average disparity.
[INFO] Init: KLT tracked 264 features
**This goes on for a very long time**
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 3.97886px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 3.97881px average disparity.
[INFO] Init: KLT 4.53225px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 4.53225px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 4.5919px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 4.59181px average disparity.
**I kill the svo** 
[svo-1] killing on exit
SVO terminated.
[INFO] DepthFilter stop thread invoked.
[INFO] DepthFilter interrupt and join thread... 
[INFO] DepthFilter destructed.
[INFO] SVO destructor invoked
[INFO] Map destructed
[svo-1] escalating to SIGTERM
shutting down processing monitor...
... shutting down processing monitor complete
done

Has anyone encountered this problem? I think it's with a parameter/setting within the SVO.

Thanks!

rpg_svo doesn't grab first and second frame

I'm trying to use rpg_svo, but I'm never seeing the normal "Selected frame" messages. This is the output from the suggested rosbag dataset on the wiki:

# ./test_pipeline 
[INFO] SVO initialized
reading image /home/mark/svo_datasets/sin2_tex2_h1_v8_d/img/frame_000002_0.png
[INFO] RESET
[INFO] Init: Selected first frame.
Frame-Id: 0     #Features: 0    Proc. Time: 6.421ms 
[INFO] Init: KLT tracked 565 features
[INFO] Init: KLT 25.3823px average disparity.
Frame-Id: 1     #Features: 0    Proc. Time: 15.017ms 
[INFO] Init: KLT tracked 543 features
[INFO] Init: KLT 50.8035px average disparity.
[INFO] Init: Homography RANSAC 543 inliers.
[INFO] Init: Selected second frame, triangulated initial map.
Frame-Id: 2     #Features: 498  Proc. Time: 14.268ms

This is what happens when I launch mine (note that I only see the "Init: KLT" messages above):

# roslaunch svo_ros live.launch
... logging to /home/mark/.ros/log/806c7c96-b3ce-11e5-a526-001c42361d26/roslaunch-ubuntu-6899.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt

started roslaunch server http://ubuntu:47686/

SUMMARY
========

CLEAR PARAMETERS
 * /svo/

PARAMETERS
 * /rosdistro: indigo
 * /rosversion: 1.11.16
 * /svo/cam_cx: 320.362717
 * /svo/cam_cy: 245.340008
 * /svo/cam_d0: 0.198003
 * /svo/cam_d1: -0.549356
 * /svo/cam_d2: 0.004226
 * /svo/cam_d3: -0.002177
 * /svo/cam_fx: 624.167255
 * /svo/cam_fy: 623.400598
 * /svo/cam_height: 480
 * /svo/cam_model: Pinhole
 * /svo/cam_topic: /camera/color/ima...
 * /svo/cam_width: 640
 * /svo/grid_size: 30
 * /svo/loba_num_iter: 0
 * /svo/max_n_kfs: 10

NODES
  /
    svo (svo_ros/vo)

ROS_MASTER_URI=http://localhost:11311

core service [/rosout] found
process[svo-1]: started with pid [6918]
create vo_node
[ WARN] [1452105949.179495580]: Cannot find value for parameter: svo/publish_img_pyr_level, assigning default: 0
[ WARN] [1452105949.180625334]: Cannot find value for parameter: svo/publish_every_nth_img, assigning default: 1
[ WARN] [1452105949.181837194]: Cannot find value for parameter: svo/publish_every_nth_dense_input, assigning default: 1
[ WARN] [1452105949.185047520]: Cannot find value for parameter: svo/publish_world_in_cam_frame, assigning default: 1
[ WARN] [1452105949.185818236]: Cannot find value for parameter: svo/publish_map_every_frame, assigning default: 0
[ WARN] [1452105949.186840312]: Cannot find value for parameter: svo/publish_point_display_time, assigning default: 0
[ WARN] [1452105949.408194780]: Cannot find value for parameter: svo/publish_markers, assigning default: 1
[ WARN] [1452105949.408822669]: Cannot find value for parameter: svo/publish_dense_input, assigning default: 0
[ WARN] [1452105949.409621654]: Cannot find value for parameter: svo/accept_console_user_input, assigning default: 1
[ INFO] [1452105949.410586043]: Found parameter: svo/cam_model, value: Pinhole
[ INFO] [1452105949.412961167]: Found parameter: svo/cam_width, value: 640
[ INFO] [1452105949.414143712]: Found parameter: svo/cam_height, value: 480
[ INFO] [1452105949.415291525]: Found parameter: svo/cam_fx, value: 624.167
[ INFO] [1452105949.416488787]: Found parameter: svo/cam_fy, value: 623.401
[ INFO] [1452105949.417760878]: Found parameter: svo/cam_cx, value: 320.363
[ INFO] [1452105949.419177927]: Found parameter: svo/cam_cy, value: 245.34
[ INFO] [1452105949.420738599]: Found parameter: svo/cam_d0, value: 0.198003
[ INFO] [1452105949.422144347]: Found parameter: svo/cam_d1, value: -0.549356
[ INFO] [1452105949.423109725]: Found parameter: svo/cam_d2, value: 0.004226
[ INFO] [1452105949.423798320]: Found parameter: svo/cam_d3, value: -0.002177
[ WARN] [1452105949.431360389]: Cannot find value for parameter: svo/init_tz, assigning default: 0
[ WARN] [1452105949.432451963]: Cannot find value for parameter: svo/init_ty, assigning default: 0
[ WARN] [1452105949.433854444]: Cannot find value for parameter: svo/init_tx, assigning default: 0
[ WARN] [1452105949.435479614]: Cannot find value for parameter: svo/init_rz, assigning default: 0
[ WARN] [1452105949.437368907]: Cannot find value for parameter: svo/init_ry, assigning default: 0
[ WARN] [1452105949.438416004]: Cannot find value for parameter: svo/init_rx, assigning default: 0
[INFO] SVO initialized
[ INFO] [1452105949.439655113]: Found parameter: svo/cam_topic, value: /camera/color/image_raw
[INFO] RESET
[INFO] Init: Selected first frame.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0px average disparity.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0.138389px average disparity.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0.138361px average disparity.
[INFO] Init: KLT tracked 264 features
[INFO] Init: KLT 0.0867741px average disparity.
[INFO] Init: KLT tracked 264 features
**This goes on for a very long time**
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 3.97886px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 3.97881px average disparity.
[INFO] Init: KLT 4.53225px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 4.53225px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 4.5919px average disparity.
[INFO] Init: KLT tracked 263 features
[INFO] Init: KLT 4.59181px average disparity.
**I kill the svo** 
[svo-1] killing on exit
SVO terminated.
[INFO] DepthFilter stop thread invoked.
[INFO] DepthFilter interrupt and join thread... 
[INFO] DepthFilter destructed.
[INFO] SVO destructor invoked
[INFO] Map destructed
[svo-1] escalating to SIGTERM
shutting down processing monitor...
... shutting down processing monitor complete
done

Has anyone encountered this problem? I think it's with a parameter/setting within the SVO.

Thanks!