#!/bin/sh
#
# Start telemetry
#

. /etc/telemetry.conf

keydir="/etc"

start_telemetry() {
  if [ ! -f /usr/bin/telemetry_rx -a ! -f /usr/bin/telemetry_tx ]; then
	  ln -s /usr/bin/wfb_rx /usr/bin/telemetry_rx ; chmod +x /usr/bin/telemetry_rx
	  ln -s /usr/bin/wfb_tx /usr/bin/telemetry_tx ; chmod +x /usr/bin/telemetry_tx
  else
	if [ ${one_way} = "false" ]; then
	  telemetry_rx -p ${radio_port} -u ${port_rx} -K ${keydir}/drone.key -k ${fec_k} -n ${fec_n} -i ${stream_rx} ${wlan} &
	fi
	telemetry_tx -p ${radio_port} -u ${port_tx} -K ${keydir}/drone.key -B ${bandwidth} -M ${mcs_index} -S ${stbc} -L ${ldpc} -G ${guard_interval} -k ${fec_k} -n ${fec_n} -T ${fec_timeout} -i ${stream_tx} ${wlan} &
  fi
}

case "$1" in
  start)
	  echo "Loading MAVLink telemetry service..."

	  start_telemetry

	  echo "Done."
    ;;
  stop)
    echo "Stopping telemetry service..."
    kill -9 $(pidof telemetry_rx)
    kill -9 $(pidof telemetry_tx)
    ;;
    *)
    echo "Usage: $0 {start|stop}"
    exit 1
esac