pointcloud published at very slow rate from laser_assembler
My laser_scan_assembler.launch file is:
<launch>
<node pkg="laser_assembler" type="laser_scan_assembler" output="screen" name="laser_scan_assembler">
<remap from="scan" to="/multisense/lidar_scan"/>
<param name="max_scans" type="int" value="400" />
<param name="fixed_frame" type="string" value="head" />
</node>
<node pkg="laser_assembler" type="periodic_snapshotter" output="screen" name="periodic_snapshotter" />
<node pkg="tf" type="static_transform_publisher" name="baselink_laser_broadcaster" args="0 0 1 0 0 0 map odom_combined 10"/>
</launch>
After i launch this file i'm getting this message:
[ INFO] [1501231708.149345614]: TF Cache Time: 10.000000 Seconds
[ INFO] [1501231708.153398871]: Max Scans in History: 400
[ INFO] [1501231708.155791735]: Fixed Frame: head
[ INFO] [1501231708.462372713, 215.177000000]: waitForService: Service [/build_cloud] is now available.
[ INFO] [1501231708.462553053, 215.177000000]: Found build_cloud! Starting the snapshotter
[ INFO] [1501231740.307119973, 225.216000000]: Published Cloud with 101810 points
When i run command rostopic hz /assembled_cloud
in another terminal i get this:
subscribed to [/assembled_cloud]
WARNING: may be using simulated time
average rate: 0.200
min: 5.008s max: 5.008s std dev: 0.00000s window: 2
no new messages
no new messages
no new messages
When i try to visualize it in rviz, i'm not getting any visual signs of pointcloud. So what should i do to make it work like normal. my urdf of the ray_sensor of multisense camera is:
<gazebo reference="head_hokuyo_frame">
<sensor name="head_hokuyo_sensor" type="ray">
<pose>0 0 0 0 0 0</pose>
<visualize>true</visualize>
<update_rate>40</update_rate>
<ray>
<scan>
<horizontal>
<samples>1081</samples>
<resolution>1</resolution>
<min_angle>-2.356194</min_angle>
<max_angle>2.356194</max_angle>
</horizontal>
</scan>
<range>
<min>0.10</min>
<max>30.0</max>
<resolution>0.01</resolution>
</range>
<noise>
<type>gaussian</type>
<!-- Noise parameters based on published spec for Hokuyo laser
achieving "+-30mm" accuracy at range < 10m. A mean of 0.0m and
stddev of 0.01m will put 99.7% of samples within 0.03m of the true
reading. -->
<mean>0.0</mean>
<stddev>0.01</stddev>
</noise>
</ray>
<plugin filename="libgazebo_ros_laser.so" name="gazebo_ros_head_hokuyo_controller">
<topicName>/multisense/lidar_scan</topicName>
<frameName>head</frameName>
</plugin>
</sensor>
</gazebo>
I am usign ros indiog, ubuntu 14.04 with xenomai patched, i build the laser_assembler package from source. Since i dind't foud the indigo version of the package i used hydro version.