#!/bin/bash

set -e
set -x

BOARD=NucleoH743
BOARD=MatekH743
#BOARD=F35Lightning

THISDIR=$(realpath $(dirname $0))
ROOTDIR=$(realpath "$THISDIR/../../../..")

VEHICLE="copter"
DEFAULTS_PATH=""
EXTRA_HWDEF=""

usage() {
    echo "Usage: $0 [-v <plane|copter>] [-d DEFAULT_FILEPATH] [-b BOARDNAME] [-m APPEND_DEFAULTS_PATH" >&2;
    exit 1;
}

while getopts ":v:d:b:m:" o; do
    case "${o}" in
        v)
            VEHICLE=${OPTARG}
            [ "$VEHICLE" == "plane" ] || [ "$VEHICLE" == "copter" ] || usage
            ;;
        d)
            DEFAULTS_PATH=${OPTARG}
            ;;
        m)
            MORE_DEFAULTS_PATH=${OPTARG}
            ;;
        b)
            BOARD=${OPTARG}
            ;;
        *)
            usage
            ;;
    esac
done
shift $((OPTIND-1))

if [ -z "${DEFAULTS_PATH}" ]; then
    if [ "$VEHICLE" == "plane" ]; then
        DEFAULTS_PATH="$THISDIR/plane-default.param"
        EXTRA_HWDEF="$THISDIR/plane-extra-hwdef-sitl-on-hw.dat"
    elif ["$VEHICLE" == "copter" ]; then
        DEFAULTS_PATH="$THISDIR/default.param"
        EXTRA_HWDEF="$THISDIR/extra-hwdef-sitl-on-hw.dat"
    fi
fi

if [ ! -z "${MORE_DEFAULTS_PATH}" ]; then
    NEW_DEFAULTS_PATH="/tmp/some-defaults.param"
    cp "$DEFAULTS_PATH" "$NEW_DEFAULTS_PATH"
    cat "$MORE_DEFAULTS_PATH" >> "$NEW_DEFAULTS_PATH"
    DEFAULTS_PATH="$NEW_DEFAULTS_PATH"
fi

pushd $ROOTDIR

./waf configure \
      --board=$BOARD \
      --extra-hwdef="$EXTRA_HWDEF" \
      --default-param="$DEFAULTS_PATH"

./waf ${VEHICLE} --upload