#!/usr/bin/env bash
# Load every overlay needed to deserialize the TianGong custom message types
# before rosbag2 discovers the configured topics.
set -eo pipefail

APP_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"

required_setups=(
  /opt/ros/jazzy/setup.bash
  /home/nvidia/xos/setup.bash
  /opt/robot_tele_server/install/setup.bash
  "$APP_DIR/ros2_py/install/setup.bash"
)
for setup_file in "${required_setups[@]}"; do
  if [[ ! -f "$setup_file" ]]; then
    echo "Required ROS setup is missing: $setup_file" >&2
    exit 1
  fi
  # shellcheck disable=SC1090
  source "$setup_file"
done
set -u

exec python3 "$APP_DIR/data_recorder_node.py" \
  --config "$APP_DIR/config.toml" \
  "$@"