#!/bin/bash
# 检查到未定义的变量则停止执行并报错
set -u

# 检查参数数量
if [ "$#" -ne 1 ]; then
  echo "Error: Incorrect number of arguments"
  echo "Usage: $0 BAG_PATH"
  exit 1
fi

BAG_PATH=$1
WORD_GENERATION="/home/cicv/work/pji_desktop/simulation/catkin_map2gazebo/"

sleep 5
rosbag play $BAG_PATH
sleep 5

pkill -f "map2gazebo"
pkill -f "gazebo"
echo "Service map2gazebo stopped."

source activate simulation

cd $WORD_GENERATION

safe-rm -r build devel
catkin_make
source devel/setup.bash

echo "Starting gazebo..."
nohup roslaunch map2gazebo gazebo_world.launch > ./gazebo_world.log 2>&1 &
disown