#!/usr/bin/env bash
export LD_LIBRARY_PATH=/usr/local/Aria/lib:$LD_LIBRARY_PATH
source /opt/ros/hydro/setup.bash
source /ws_linux/devel/setup.bash

[[ -v PIONIER_ID ]] || {
    echo 
    echo '!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!';
    echo 'Please set the $PIONIER_ID environment variable.';
    echo '!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!';
    exit -1;
}
# [[ -v ROS_NAMESPACE ]] || export ROS_NAMESPACE=/PIONIER$PIONIER_ID


echo
echo
echo "ENVIRONMENT CONFIG"
env | grep -e ROS_MASTER_URI -e ARIA_PORT -e PIONIER_ID -e ROS_NAMESPACE | sed 's/^/  - /'
echo
echo

set -x
roslaunch rosaria_bringup rosaria_bringup.launch pionier_id:=${PIONIER_ID}