forked from NeBula-Autonomy/LOCUS
-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
- Loading branch information
Sangwoo Moon
committed
Jun 3, 2022
1 parent
be84e41
commit aab5a59
Showing
4 changed files
with
169 additions
and
77 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
127 changes: 127 additions & 0 deletions
127
tmuxp_config/nebula_odometry_datasets/E_Spot1_Valentine1.yaml
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,127 @@ | ||
session_name: locus_dataset | ||
|
||
environment: | ||
# Path for the dataset | ||
DATA_PATH: /home/costar/data/E_Spot1_Valentine1 | ||
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: "2" | ||
# Number of lidars to use (if available) | ||
NUM_VLP: "1" | ||
|
||
# Change the robot name and type to match the dataset | ||
ROBOT_NAME: spot1 | ||
ROBOT_TYPE: spot | ||
# 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: "1600" | ||
# 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: "1550" | ||
# 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; | ||
|
||
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; | ||
|
||
# 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 | ||
|
||
|
||
|
||
- 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 \ |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters