ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
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]