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

## 检查参数数量
#if [ "$#" -ne 6 ]; then
#  echo "Error: Incorrect number of arguments"
#  echo "Usage: $0 IMAGE_NAME CONTAINER_NAME WORLD_NAME MAP_PGM_NAME MAP_YAML_NAME BUILD_MAP_NAME"
#  exit 1
#fi

SIMULATION_PATH="/home/cicv/work/pji_desktop/simulation"

# 轨迹生成
## 清理环境
killall -9 roscore # 如果提示未找到进程不用管，继续执行下一条
killall -9 rosmaster
## 配置环境
cd "$SIMULATION_PATH"/track_space
rm -r build devel
catkin_make -DPYTHON_EXECUTABLE=/usr/bin/python3
source devel/setup.bash
## 在新终端中运行roscore
gnome-terminal --tab -e 'bash -c "roscore"'
sleep 1
## 生成轨迹图片
rosrun trajectory demo_node "$SIMULATION_PATH"/map_bag/map_0517_1.bag \
      "$SIMULATION_PATH"/build_map_bag/build_map_0517_1.bag \
      "$SIMULATION_PATH"/runtime/evaluation/trackPicture/0517_1.png

# 算法评价
cd "$SIMULATION_PATH"/pji_single/run
./pji_single_old "$SIMULATION_PATH"/build_map_bag/build_map_0517_1.bag \
      "$SIMULATION_PATH"/runtime/evaluation/result  \
      "$SIMULATION_PATH"/runtime/evaluation/trackPicture/0517_1.png