viso2“视觉里程表迷路”

时间:2014-01-22 09:54:40

标签: c++ camera transform opticalflow

嗨我对viso2包的立体测距法有一些问题,当我试图运行启动文件时,它给了我“视觉里程表迷路”。我目前正在使用2 Ueye UI-1226LE - USB 2.0相机立体声odometry.Below是它给我的错误。

SUMMARY
========

PARAMETERS
 * /dynparam_ubuntu_14461_8489014763432242877/auto_exposure
 * /dynparam_ubuntu_14461_8489014763432242877/frame_rate
 * /dynparam_ubuntu_14461_8489014763432242877/l_pixel_clock
 * /dynparam_ubuntu_14461_8489014763432242877/r_pixel_clock
 * /dynparam_ubuntu_14461_8489014763432242877/zoom
 * /kitty_stereo/stereo_image_proc/correlation_window_size
 * /kitty_stereo/stereo_image_proc/disparity_range
 * /kitty_stereo/stereo_image_proc/min_disparity
 * /kitty_stereo/stereo_image_proc/prefilter_cap
 * /kitty_stereo/stereo_image_proc/prefilter_size
 * /kitty_stereo/stereo_image_proc/speckle_range
 * /kitty_stereo/stereo_image_proc/speckle_size
 * /kitty_stereo/stereo_image_proc/texture_threshold
 * /kitty_stereo/stereo_image_proc/uniqueness_ratio
 * /rosdistro
 * /rosversion
 * /use_sim_time

NODES
  /kitty_stereo/
    stereo_image_proc (stereo_image_proc/stereo_image_proc)
  /
    base_link_to_camera (tf/static_transform_publisher)
    dynparam_ubuntu_14461_8489014763432242877 (dynamic_reconfigure/dynparam)
    rosbag (rosbag/play)
    stereo_odometer (viso2_ros/stereo_odometer)

ROS_MASTER_URI=http:// localhost:11311

core service [/rosout] found
process[base_link_to_camera-1]: started with pid [14521]
process[rosbag-2]: started with pid [14539]
process[kitty_stereo/stereo_image_proc-3]: started with pid [14556]
process[stereo_odometer-4]: started with pid [14577]
[ INFO] [1390285927.188771517]: Subscribing to:
    * /kitty_stereo/left/image_rect
    * /kitty_stereo/right/image_rect
    * /kitty_stereo/left/camera_info
    * /kitty_stereo/right/camera_info
process[dynparam_ubuntu_14461_8489014763432242877-5]: started with pid [14602]
[ INFO] [1390285927.228780458]: Basic Odometer Settings:
  odom_frame_id      = /odom
  base_link_frame_id = /base_link
  publish_tf         = true
[ INFO] [1390285928.211526383, 1385798595.722205257]: Retrieving initial transform for /base_link to /camera.
[ INFO] [1390285928.211638745, 1385798595.722205257]: Initialized libviso2 stereo odometry with the following parameters:
Calibration parameters:
  f  = 1504.27
  cu = 188.791
  cv = 59.5449
Matcher parameters:
  nms_n                  = 3
  nms_tau                = 50
  match_binsize          = 50
  match_radius           = 200
  match_disp_tolerance   = 2
  outlier_disp_tolerance = 5
  outlier_flow_tolerance = 5
  multi_stage            = 1
  half_resolution        = 1
  refinement             = 1
Bucketing parameters:
  max_features  = 2
  bucket_width  = 50
  bucket_height = 50
Stereo odometry parameters:
  base             = 0.281359
  ransac_iters     = 200
  inlier_threshold = 1.5
  reweighting      = 1
  ref_frame_change_method = 0
  ref_frame_motion_threshold = 5
  ref_frame_inlier_threshold = 150
[ WARN] [1390285928.216198038, 1385798595.722205257]: Visual Odometer got lost!
[dynparam_ubuntu_14461_8489014763432242877-5] process has finished cleanly
log file: /home/acsc/.ros/log/a56e242a-8245-11e3-bf8d-48022a9ad0c5/dynparam_ubuntu_14461_8489014763432242877-5*.log
[ WARN] [1390285929.245663614, 1385798596.751227928]: Visual Odometer got lost!
[ WARN] [1390285930.250121013, 1385798597.777895990]: Visual Odometer got lost!
[ WARN] [1390285931.248951670, 1385798598.781152478]: Visual Odometer got lost!
[ WARN] [1390285932.318369814, 1385798599.847003310]: Visual Odometer got lost!
[ WARN] [1390285933.353832605, 1385798600.882260371]: Visual Odometer got lost!
[ WARN] [1390285934.417855748, 1385798601.942012156]: Visual Odometer got lost!
[ WARN] [1390285935.456077597, 1385798602.975817837]: Visual Odometer got lost!
[ WARN] [1390285936.456490832, 1385798603.986285772]: Visual Odometer got lost!
[ WARN] [1390285937.527047462, 1385798605.048900696]: Visual Odometer got lost!
[ WARN] [1390285938.559818811, 1385798606.088479625]: Visual Odometer got lost!
[ WARN] [1390285939.594780232, 1385798607.122738611]: Visual Odometer got lost!

这是我目前正在使用的启动文件

<launch>

    <!-- Arguments -->
    <arg name="kitty_01" default="/home/acsc/fuerte_workspace/sandbox/kitti_01.bag"/> <!-- Your bagfile here -->
    <arg name="camera" default="/kitty_stereo" /> <!-- The namespace where images are published -->
    <arg name="disparity_params" default="/home/acsc/fuerte_workspace/sandbox/disparity_params.yaml"/> <!-- Camera calibration parameters -->

    <param name="/use_sim_time" value="true"/>

<node pkg="tf" type="static_transform_publisher" name="base_link_to_camera" args="0 0 0 0 0 0 /base_link /camera 100 " />

    <!-- Run the rosbag -->
    <node pkg="rosbag" type="play" name="rosbag" args="--clock $(arg kitty_01)"/>

    <!-- Run the ROS package stereo_image_proc -->
    <group ns="$(arg camera)" >
        <node pkg="stereo_image_proc" type="stereo_image_proc" name="stereo_image_proc">
            <rosparam file="$(arg disparity_params)"/>
        </node>
    </group>

    <!-- Run the viso2_ros package -->
    <node pkg="viso2_ros" type="stereo_odometer" name="stereo_odometer" output="screen">
        <remap from="stereo" to="$(arg camera)"/>
        <remap from="image" to="image_rect"/>
    </node>
<node name="$(anon dynparam)" pkg="dynamic_reconfigure" type="dynparam" args="set_from_parameters camera">
 <param name="zoom" value="2"/>
 <param name="l_pixel_clock" value="20"/>
 <param name="r_pixel_clock" value="20"/>
 <param name="auto_exposure" value="true"/>
 <param name="frame_rate" value="30"/>
</node>


</launch>

0 个答案:

没有答案