Revision history [back]

Well , now I change the launch file. And I can get kinect_odometry/odometry.

My launch file

  <launch>
      <arg name="camera" default="camera" />
      <node pkg="nodelet" type="nodelet" args="manager" name="nodelet_manager" />
      <node pkg="nodelet" type="nodelet" name="convert_openni_fovis"
    args="load depth_image_proc/convert_metric nodelet_manager">
        <remap from="image_raw" to="$(arg camera)/depth_registered/sw_registered/image_rect_raw"/>
        <remap from="image" to="$(arg camera)/depth_registered/sw_registered/image_rect_raw"/>
      </node>
      <node pkg="fovis_ros" type="fovis_mono_depth_odometer" name="kinect_odometer" >
         <remap from="/camera/rgb/image_rect" to="$(arg camera)/rgb/image_rect_color" />
         <remap from="/camera/rgb/camera_info" to="$(arg camera)/rgb/camera_info" />
         <remap from="/camera/depth_registered/camera_info" to="$(arg camera)/depth_registered/camera_info" />
         <remap from="/camera/depth_registered/image_rect" to="$(arg camera)/depth_registered/image_raw" />
         <param name="approximate_sync" type="bool" value="True" />
         <param name="publish_tf" type="bool" value="False" />
      </node>
   </launch>

But when I listen to the kinect_odometry/odometry the speed is really slow. Here is the solution when I use rostopic hz /kinect_odometry/odometry

subscribed to [/kinect_odometer/odometry]
average rate: 1.110
min: 0.031s max: 2.349s std dev: 1.03080s window: 4
no new messages
average rate: 0.816
min: 0.031s max: 2.349s std dev: 1.05589s window: 5
no new messages
no new messages
average rate: 0.814
min: 0.031s max: 2.349s std dev: 1.04865s window: 7
average rate: 0.986
min: 0.008s max: 2.349s std dev: 0.99807s window: 9
average rate: 0.937
min: 0.008s max: 2.349s std dev: 0.95311s window: 10
average rate: 1.149
min: 0.008s max: 2.349s std dev: 0.89629s window: 13
average rate: 1.134
min: 0.008s max: 2.349s std dev: 0.86203s window: 14
no new messages
no new messages
average rate: 1.099
min: 0.008s max: 2.728s std dev: 0.93666s window: 17
average rate: 1.325
min: 0.008s max: 2.728s std dev: 0.86837s window: 22
no new messages
average rate: 1.345
min: 0.008s max: 2.728s std dev: 0.83081s window: 25
average rate: 1.321
min: 0.008s max: 2.728s std dev: 0.81679s window: 26
average rate: 1.362
min: 0.008s max: 2.728s std dev: 0.79061s window: 28
average rate: 1.383
min: 0.008s max: 2.728s std dev: 0.76532s window: 30
average rate: 1.465
min: 0.008s max: 2.728s std dev: 0.73953s window: 33
no new messages
average rate: 1.962
min: 0.008s max: 2.728s std dev: 0.68506s window: 48
average rate: 2.047
min: 0.008s max: 2.728s std dev: 0.67079s window: 51
average rate: 2.015
min: 0.008s max: 2.728s std dev: 0.65956s window: 53

And the /kinect_odometry/odometry 's tf is not right. Here is the information.

header: 
  seq: 1024
  stamp: 
secs: 1439273720
nsecs: 388915054
  frame_id: /odom
child_frame_id: /base_link
pose: 
  pose: 
    position: 
      x: 0.139448156997
      y: -0.227385449773
      z: 0.124124237032
    orientation: 
      x: -0.0633254242434
      y: -0.0353054853487
      z: 0.0757631766723
      w: 0.994486477741
  covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
twist: 
  twist: 
    linear: 
      x: 0.00174292186494
      y: -0.00232265608642
      z: 0.00337630796951
    angular: 
      x: -0.000685349219346
      y: -0.000502666621993
      z: 0.000456907987173
  covariance: [1.0224316406560768e-07, -7.616318426533473e-09, 1.7433140328573201e-07, -4.128402748192066e-09, -3.944298730610046e-08, -1.0205352673804458e-08, -7.61631842653347e-09, 5.275556588960542e-08, -3.773505154967186e-08, 3.684514721748715e-08, -7.266755224586835e-09, -7.44861577251414e-08, 1.7433140328573201e-07, -3.7735051549671867e-08, 3.918450240129815e-07, -2.6717516655279676e-08, -5.263352843462323e-08, 2.6472326410758085e-08, -4.1284027481920636e-09, 3.684514721748715e-08, -2.6717516655279673e-08, 3.403722757446608e-08, -6.866217681678221e-09, -5.8346976472105756e-08, -3.944298730610046e-08, -7.266755224586836e-09, -5.263352843462324e-08, -6.866217681678222e-09, 2.5862922692127495e-08, 2.5460486939339697e-08, -1.0205352673804473e-08, -7.448615772514142e-08, 2.6472326410758068e-08, -5.834697647210577e-08, 2.5460486939339697e-08, 1.8267940776323038e-07]