#!/bin/sh
chip=$(ipcinfo -c)
fw=$(grep "BUILD_OPTION" "/etc/os-release" | cut -d= -f2)

if [ -e /etc/datalink.conf ]; then
	. /etc/datalink.conf
fi

case "$1" in
	start)
		if [ "$(fw_printenv -n fpv)" = "false" ]; then
			if grep -q "#console" /etc/inittab; then
				sed -i "s/#console/console/g" /etc/inittab
				rm -f /etc/system.ok
				echo "Restart system to restore console..."
				reboot
			fi
			exit 0
		fi

		if [ ! -f /etc/system.ok ]; then
			tweaksys "$chip"
		fi

		echo "Starting FPV datalink..."
		if [ "$fw" = "lte" ]; then
			if [ "$usb_modem" = "true" ]; then
				echo "Starting lte modem configuration..."
			fi

			if [ "$use_zt" = "true" ]; then
				echo "Starting ZeroTier-One daemon..."
				/usr/sbin/zerotier-one -d &
				if [ ! -f "/var/lib/zerotier-one/networks.d/$zt_netid.conf" ]; then
					sleep 8
					zerotier-cli join "$zt_netid" > /dev/null
					echo "Don't forget to authorize my.zerotier.com!"
				fi
			fi

			if [ "$telemetry" = "true" ]; then
				telemetry start
			fi
		else
			echo "Starting wifibroadcast service..."
			wifibroadcast start
		fi
		;;

	stop)
		echo "Stopping FPV datalink services..."
		killall -q wfb_tx
		killall -q wfb_rx
		killall -q telemetry_rx
		killall -q telemetry_tx
		killall -q mavlink-routerd
		killall -q mavfwd
		;;

	*)
		echo "Usage: $0 {start|stop}"
		exit 1
		;;
esac