rosparam set /use_sim_time true
ctrazzi@extars:~/locus_ws/src/LOCUS/tmuxp_config$ rosparam set /use_sim_time true
This is the rviz output:
And this is the rqt_graph:
I think this is a remapping problem, because the rosbag topics are non connected to locus.
This is my run_locus.yaml
session_name: locus_dataset
environment:
# Path for the dataset
DATA_PATH: /home/ctrazzi/data/Sanp
DATA_FOLDER: rosbag/
# Change the run number to save the output data in a different folder
RUN_NUMBER: "test_01"
# version of logging. If unsure, select 2 (the latest). 1 is for tunnel datasets
LOG_VERSION: "3"
# Number of lidars to use (if available)
NUM_VLP: "1"
# Change the robot name and type to match the dataset
ROBOT_NAME: extars
ROBOT_TYPE: extars
# If unsure, leave as base1
BASE_NAME: base1
# Rosbag parameters
START: "0"
RATE: "1.0"
# See https://github.com/NeBula-Autonomy/nebula-odometry-dataset/blob/main/pages/dataset.md
# for the expected length of datasets
# This param can be used to automatically close the session at the end of the run (currently disabled)
TIME_TO_END: "600"
# This param is used to start saving the map near the end of the run (try 1 minute before the end)
TIME_TO_MAP_SAVE: "500"
# The topic for the odometry to record
ODOM: locus/odometry
options:
default-command: /bin/bash
windows:
- window_name: locus
focus: true
layout: tiled
shell_command_before:
- rosparam set /use_sim_time true
# Set up the parameter files from the GT products
- cp $DATA_PATH/fiducial_calibration_$ROBOT_NAME.yaml ~/.ros/
- if [ $ROBOT_TYPE = 'husky' ]; then
cp $DATA_PATH/$ROBOT_NAME*.yaml $(rospack find sensor_description)/config/ ;
fi;
- if [ $ROBOT_TYPE = 'spot' ]; then
cp $DATA_PATH/$ROBOT_NAME*.yaml $(rospack find sensor_description)/config/ ;
fi;
- if [ $ROBOT_TYPE = 'extars' ]; then
cp $DATA_PATH/$ROBOT_NAME*.yaml $(rospack find sensor_description)/config/ ;
fi;
panes:
################################### RUN ###################################
# Bags and topics of interest (switching if the log versions is older)
- if [ $LOG_VERSION -eq 2 ]; then
sleep 10; rosbag play $DATA_PATH/$DATA_FOLDER*.bag -s$START -r$RATE --clock --topics clock:=/clock
/$ROBOT_NAME/velodyne_points /$ROBOT_NAME/velodyne_front/velodyne_points /$ROBOT_NAME/velodyne_rear/velodyne_points
/$ROBOT_NAME/hero/wio_ekf/odom /$ROBOT_NAME/vn100/imu_wori_wcov /$ROBOT_NAME/visual_odom
/$ROBOT_NAME/wheel_odom /$ROBOT_NAME/hvm/lidar/points /$ROBOT_NAME/hvm/odometry
/$ROBOT_NAME/unreconciled_artifact /$ROBOT_NAME/uwb_frontend/range_measurements ;
fi;
if [ $LOG_VERSION -eq 1 ]; then
sleep 10;rosbag play $DATA_PATH/$DATA_FOLDER*.bag -s$START -r$RATE --clock --prefix $ROBOT_NAME/
--topics clock:=/clock velodyne_points velodyne_front/velodyne_points /velodyne_rear/velodyne_points
hero/wio_ekf/odom vn100/imu_wori_wcov vn100/imu visual_odom /tf_static ;
fi;
- if [ $LOG_VERSION -eq 3 ]; then
rosbag play $DATA_PATH/$DATA_FOLDER/test_manuale.bag ;
fi;
# launch rviz
- rviz -d $(rospack find locus)/rviz/$(echo $ROBOT_NAME)_locus.rviz
# Front-end
- if [ $ROBOT_TYPE = 'husky' ]; then
roslaunch locus locus.launch robot_namespace:=$ROBOT_NAME number_of_velodynes:=$NUM_VLP;
fi;
if [ $ROBOT_TYPE = 'spot' ]; then
roslaunch locus locus.launch robot_namespace:=$ROBOT_NAME;
fi
- if [ $ROBOT_TYPE = 'extars' ]; then
roslaunch locus locus_extars.launch robot_namespace:=$ROBOT_NAME number_of_velodynes:=$NUM_VLP;
fi;
- window_name: record_at_end
focus: false
layout: tiled
shell_command_before:
- rosparam set /use_sim_time true
panes:
# Map
# Front-End Map
- sleep $TIME_TO_MAP_SAVE; rosrun pcl_ros pointcloud_to_pcd input:=/$ROBOT_NAME/locus/octree_map _prefix:=$DATA_PATH/locus_$RUN_NUMBER/map_locus
# ..
-
- window_name: record
focus: false
layout: tiled
shell_command_before:
- mkdir $DATA_PATH/locus_$RUN_NUMBER
- rosparam set /use_sim_time true
panes:
################################### RECORD ###################################
# Odometry
- rosbag record -O $DATA_PATH/locus_$RUN_NUMBER/odometry.bag /$ROBOT_NAME/$ODOM /$ROBOT_NAME/locus/localization_integrated_estimate /$ROBOT_NAME/locus/odometry_integrated_estimate /$ROBOT_NAME/locus/localization_incremental_estimate /$ROBOT_NAME/locus/odometry_incremental_estimate
- rosbag record -O $DATA_PATH/locus_$RUN_NUMBER/stationary.bag /$ROBOT_NAME/stationary_accel
# Odometry Rate and Delay
- rostopic hz /$ROBOT_NAME/$ODOM -w3 >> $DATA_PATH/locus_$RUN_NUMBER/rate.txt
- rostopic delay /$ROBOT_NAME/$ODOM -w3 >> $DATA_PATH/locus_$RUN_NUMBER/delay.txt
# Computation Time Profiling
- rosbag record -O $DATA_PATH/locus_$RUN_NUMBER/lidar_callback_duration.bag /$ROBOT_NAME/locus/lidar_callback_duration
- rosbag record -O $DATA_PATH/locus_$RUN_NUMBER/scan_to_scan_duration.bag /$ROBOT_NAME/locus/scan_to_scan_duration
- rosbag record -O $DATA_PATH/locus_$RUN_NUMBER/scan_to_map_duration.bag /$ROBOT_NAME/locus/scan_to_submap_duration
################################ END RECORDING ###############################
# Uncomment the line below to automatically end the run
# - sleep $TIME_TO_END; rosnode kill -a
# Use the line below to prepare a kill command when you want to stop
- rosnode kill -a \
Hello, I have finally manage to run your example dataset. Now I am trying to run mine, but I can not remap the topic correctly.
When I launch my modified tmux scrip I get the following output from the two terminals: first terminal:
second terminal:
This is the rviz output:
And this is the rqt_graph:
I think this is a remapping problem, because the rosbag topics are non connected to locus.
This is my run_locus.yaml
And this is my locus.launch:
Can you please help me? Thanks in advance.