|
My launch file is
<!-- Launch RTAB-map with Kinect2 and RPLidar A2 -->
<launch>
<!--include file="$(find self_e)/launch/bringup.launch"/-->
<include file="$(find self_e)/launch/xbox.launch"/>
<!-- Image resolution of the Kinect to process in rtabmap: sd, qhd, hd -->
<arg name="resolution" default="qhd" />
<!-- Fixed frame id -->
<arg name="frame_id" default="base_footprint"/>
<!-- Hector SLAM to get ScanMatching Odometry -->
<node pkg="gmapping" type="slam_gmapping" name="slam_gmapping" output="screen">
<!--param name="map_frame" value="hector_map" />
<param name="base_frame" value="laser" />
<param name="odom_frame" value="odom" />
<param name="tf_map_scanmatch_transform_frame_name" value="laser" />
<param name="pub_map_odom_transform" value="false"/>
<param name="pub_map_scanmatch_transform" value="true"/>
<param name="pub_odometry" value="true"/>
<param name="map_resolution" value="0.05"/>
<param name="map_size" value="2048"/>
<param name="map_multi_res_levels" value="2" />
<param name="map_update_angle_thresh" value="0.06" />
<param name="scan_topic" value="/scan"/-->
<remap from="scan" to="scan_filtered"/>
<param name="base_frame" value="/base_footprint" />
<param name="odom_frame" value="/odom" />
<param name="map_update_interval" value="5.0"/>
<param name="maxUrange" value="5.5"/>
<param name="minRange" value="-0.5"/>
<param name="sigma" value="0.05"/>
<param name="kernelSize" value="1"/>
<param name="lstep" value="0.05"/>
<param name="astep" value="0.05"/>
<param name="iterations" value="5"/>
<param name="lsigma" value="0.075"/>
<param name="ogain" value="3.0"/>
<param name="lskip" value="0"/>
<param name="minimumScore" value="50"/>
<param name="srr" value="0.1"/>
<param name="srt" value="0.2"/>
<param name="str" value="0.1"/>
<param name="stt" value="0.2"/>
<param name="linearUpdate" value="0.2"/>
<param name="angularUpdate" value="0.25"/>
<param name="temporalUpdate" value="5.0"/>
<param name="resampleThreshold" value="0.5"/>
<param name="particles" value="50"/>
<param name="xmin" value="-30.0"/>
<param name="ymin" value="-30.0"/>
<param name="xmax" value="30.0"/>
<param name="ymax" value="30.0"/>
<param name="delta" value="0.025"/>
<param name="llsamplerange" value="0.01"/>
<param name="llsamplestep" value="0.01"/>
<param name="lasamplerange" value="0.005"/>
<param name="lasamplestep" value="0.005"/>
<param name="transform_publish_period" value="0.1"/>
</node>
<!-- RTAB-Map: to get a consistent 3d Map fed by the Hector odometry -->
<group ns="rtabmap">
<node name="rtabmap" pkg="rtabmap_ros" type="rtabmap" output="screen" args="--delete_db_on_start">
<param name="subscribe_depth" type="bool" value="true"/>
<param name="frame_id" type="string" value="$(arg frame_id)"/>
<param name="subscribe_scan" type="bool" value="true"/>
<param name="Grid/DepthDecimation" value="2"/>
<param name="Grid/RangeMax" value="5.0"/>
<param name="Grid/CellSize" value="0.01"/>
<param name="map_cleanup" type="bool" value="false"/>
<param name="Grid/FromDepth" type="string" value="false"/>
<param name="RGBD/ProximityPathMaxNeighbors" type="string" value="10"/>
<param name="queue_size" value="100"/>
<remap from="rgb/image" to="/camera/rgb/image_rect_color"/>
<remap from="depth/image" to="/camera/depth_registered/image_raw"/>
<remap from="rgb/camera_info" to="/camera/rgb/camera_info"/>
<remap from="depth_camera_info_topic" to="/camera/depth/camera_info"/>
<remap from="scan" to="/scan_filtered"/>
<remap from="odom" to="/odom"/>
<param name="approx_sync" type="bool" value="true"/>
<param name="Reg/Strategy" type="string" value="2"/> <!-- edited here ...........................0=Visual, 1=ICP, 2=Visual+ICP -->
<param name="Vis/MaxDepth" type="string" value="8.0"/> <!-- 3D visual words maximum depth 0=infinity -->
<param name="Vis/InlierDistance" type="string" value="0.1"/> <!-- 3D visual words correspondence distance -->
<!--param name="Optimizer/Slam2D" type="string" value="true"/-->
<param name="Reg/Force3DoF" type="string" value="true"/>
</node>
</group>
<!-- Visualization in RVIZ -->
<node pkg="rviz" type="rviz" name="rviz" args="-d $(find self_e)/rviz/2d_3d_slam.rviz"/>
<node pkg="nodelet" type="nodelet" name="points_xyzrgb" args="load rtabmap_ros/point_cloud_xyzrgb standalone_nodelet">
<remap from="rgb/image" to="data_odom_sync/image"/>
<remap from="depth/image" to="data_odom_sync/depth"/>
<remap from="rgb/camera_info" to="data_odom_sync/camera_info"/>
<remap from="cloud" to="voxel_cloud" />
<param name="voxel_size" type="double" value="0.01"/>
</node>
</launch>and gmapping is running great but in RTabMap I get this
/rtabmap/rtabmap subscribed to (approx sync): /odom, /camera/rgb/image_rect_color, /camera/depth_registered/image_raw, /camera/rgb/camera_info, /scan_filtered [ INFO] [1535643596.399870975]: rtabmap 0.17.4 started... [FATAL] (2018-08-30 21:09:57.861) util3d_mapping.cpp:810::rayTrace() Condition (end.x >= 0 && end.x < grid.cols) not met! [end.x=236 grid.cols=191] terminate called after throwing an instance of 'UException' what(): [FATAL] (2018-08-30 21:09:57.861) util3d_mapping.cpp:810::rayTrace() Condition (end.x >= 0 && end.x < grid.cols) not met! [end.x=236 grid.cols=191] [rtabmap/rtabmap-27] process has died [pid 4668, exit code -6, cmd /home/user/mapping/devel/lib/rtabmap_ros/rtabmap --delete_db_on_start rgb/image:=/camera/rgb/image_rect_color depth/image:=/camera/depth_registered/image_raw rgb/camera_info:=/camera/rgb/camera_info depth_camera_info_topic:=/camera/depth/camera_info scan:=/scan_filtered odom:=/odom __name:=rtabmap __log:=/home/user/.ros/log/faccf7fe-ac69-11e8-b7fb-e0946779494c/rtabmap-rtabmap-27.log]. log file: /home/user/.ros/log/faccf7fe-ac69-11e8-b7fb-e0946779494c/rtabmap-rtabmap-27*.log how to overcome this problem? I am actually trying to use Kinect XBOX360-freenect, RPLidar-A1-scan, IMU+ENCODER=odom to do RTabMap. Please ignore gmapping if it was meaning less to both simultaneously. But help me use KINECT+ODOM+SCAN............ |
|
Administrator
|
| Free forum by Nabble | Edit this page |
