run_sensors.sh

#!/bin/bash

help() {
    echo "Usage: run_sensors.sh [options] [sensor_list]

    Options:
      --local      Use the 'local_sensors_compose.yaml' file
      --build      Build Docker images for the specified sensors
      --no-cache   Build Docker images with no cache
      --ros-time   Use internal ROS timestamps for lidar msgs (i.e. not GPS/PPS)
                   Only activated if --local is defined
      -h, --help   Show this help message and exit
    "
    exit 0
}

# Function to handle termination
stop_sensors() {
    echo "Caught signal, stopping Docker Compose..."
    docker compose -f "$compose_file" kill
    docker compose -f "$compose_file" down
    exit 0
}

# Trap SIGINT and SIGTERM
trap 'stop_sensors' SIGINT SIGTERM

# Default values
compose_file="./sensors_compose.yaml"
services=""
build_docker=""
run_action_count=0  # Counter to track --local and --build
build_no_cache=""
ros_time="False"
run_local="False"

while [[ $# -gt 0 ]]; do
    case $1 in
        --local)
            run_local="True"
            ((run_action_count++))  # Increment counter for --local
            shift
            ;;
        --build)
            build_docker="True"
            ((run_action_count++))  # Increment counter for --build
            shift
            ;;
        --no-cache)
            build_no_cache="--no-cache"
            shift
            ;;
        --ros-time)
            ros_time="True"
            shift
            ;;
        -h|--help)
            help
            ;;
        *)
            services="$services $1"
            shift
            ;;
    esac
done

# Create logs directory
SCRIPT_DIR=$(dirname "$(readlink -f "${BASH_SOURCE[0]}")")
mkdir -p "$SCRIPT_DIR/logs"

# Restart license checking service as it sometimes gets stuck
sudo /bin/systemctl restart codemeter.service

build_docker_images() {
    original_dir=$(pwd)  # Save the original directory
    for service in $services; do
        found=0
        # Search recursively for directories matching the service name
        for dir in $(find . -type d -name "$service"); do
            # Check for Dockerfile in the directory
            if [[ -f "$dir/Dockerfile" ]]; then
                echo "Building Docker image for $service..."
                pushd "$dir" > /dev/null   # Change to the directory containing the Dockerfile
                docker build $build_no_cache -t "$service:latest" --target runtime .
                popd > /dev/null   # Return to the original directory
                found=1
                break
            fi
        done
        # If no matching Dockerfile or directory is found
        if [[ $found -eq 0 ]]; then
            echo "No directory or Dockerfile found for $service."
        fi
    done
}

if [ "$run_local" == "True" ]; then
    compose_file="./local_sensors_compose.yaml"
    # Edit compose_file name if needed for ros_time version
    if [ "$ros_time" == "True" ]; then
        compose_file=${compose_file::-5}"_ros_time.yaml"
    fi
fi

# If both --local and --build are provided, first build, then run Docker Compose
if [ "$run_action_count" -eq 2 ]; then
    if [ -n "$services" ]; then
        build_docker_images
        docker compose -f "$compose_file" up $services &
    else
        echo "No services specified for building."
        exit 1
    fi

    # If only --build is provided, build the Docker images but don't run services
elif [ -n "$build_docker" ]; then
    if [ -n "$services" ]; then
        build_docker_images
    else
        echo "No services specified for building."
        exit 1
    fi

    # Default case: run Docker Compose with the defined compose file
else
    if [ -n "$services" ]; then
        docker compose -f "$compose_file" up $services &
    else
        docker compose -f "$compose_file" up &
    fi
fi

# Wait for Docker Compose to finish
wait $!