#!/bin/sh
#
# @name Germandrones Songbird V3
#
# @type VTOL Tiltrotor
# @class VTOL
#
# @maintainer Germandrones

# this list contains only the absolutely required parameters and the parameters depending on the drone specific electronics

. ${R}etc/init.d/rc.vtol_defaults

param set-default MAV_TYPE 21
param set-default VT_TYPE 3

param set-default CA_AIRFRAME 31
param set-default CA_ROTOR0_TILT 2
param set-default CA_ROTOR1_TILT 1
param set-default CA_ROTOR2_TILT 1
param set-default CA_ROTOR3_TILT 2

param set-default CA_SV_TL_COUNT 2
param set-default CA_SV_TL0_CT 3
param set-default CA_SV_TL1_CT 3

#GD Songbird specific parameters
param set-default MNT_TRIP_MAVLINK 0

#GD Apply parameters for two motors flight.
if param compare CA_MOTOR_DISABLE 5
then
	param set FW_PR_FF 0.8
	param set FW_THR_MAX 0.8
else if param compare CA_MOTOR_DISABLE 0
	param set FW_PR_FF 0.5
	param set FW_THR_MAX 0.7
     fi
fi

# batt_pac power monitor
batt_pac17xx start -X -R 0.2 -r 80

# board temperatur measurement, is reported as a NAMED_VALUE_FLOAT uORB message
temp_lm75 start -n tempPDB

# payload interface
gd_payload start

uavcan start

#GD 261016 Flexible UART configuration: each UART starts the device of its profile.
#   CFG_UARTx_PROF = profile, CFG_UARTx_BAUD = baud rate, CFG_UARTx_MRATE = MAVLink data rate (MAVLink
#   profiles only), x = ttySx (ttyS3 is the PX4IO: not configurable).
#   Profiles: ${R}etc/init.d/rc.gd_uart_profiles. Profile 0: the UART is not used.
#   261022: all five UARTs are marked for rc.serial (PRT_xxx_ 1), whatever their profile: PX4's own
#   port parameters (MAV_x_CONFIG, GPS_x_CONFIG, RC_CRSF_PRT_CFG, ...) start nothing on them; one
#   still set is reported by rc.serial as "Conflicting config for /dev/ttySx".
#   Replaces the hand-written lines of vic_rpi_trial:
#     mavlink start -d /dev/ttyS4 -b 115200 -f -m normal -r 20000   -> profile 3 (ELRS telemetry)
#       (that line never started the link: "-m normal" is no mode for mavlink start, "invalid mode")
#     tr24da100 start -d /dev/ttyS5                                  -> profile 6 (radar)
#     mavlink stream -d /dev/ttyS1 -s TIMESYNC -r 1                  -> into the MAVLink profiles of mode Normal
#       (1, 2, 3): here it ran before the ttyS1 link existed and never took effect.

# Defaults: the param set-default lines of the region below, from the sockets of the table
#   (Tools/gd/uart_profiles/uart_config.json). A UAV's own values win.
#GD UART configuration: begin (written by Tools/gd/uart_profiles/uart_profiles.py from uart_config.json: edit there, not here)
param set-default CFG_UART0_PROF 1
param set-default CFG_UART1_PROF 1
param set-default CFG_UART2_PROF 8
param set-default CFG_UART4_PROF 4
param set-default CFG_UART5_PROF 11

# Parameter sets: the chosen variant of each set (CFG_FW_MOTORS ...), at every boot
. ${R}etc/init.d/rc.gd_param_sets

set PROFILES_F ${R}etc/init.d/rc.gd_uart_profiles

# UART 0 = /dev/ttyS0 = TELEM1
set SERIAL_DEV /dev/ttyS0
set PROF_PARAM CFG_UART0_PROF
set BAUD_PARAM CFG_UART0_BAUD
set RATE_PARAM CFG_UART0_MRATE
. $PROFILES_F
set PRT_TEL1_ 1

# UART 1 = /dev/ttyS1 = TELEM2
set SERIAL_DEV /dev/ttyS1
set PROF_PARAM CFG_UART1_PROF
set BAUD_PARAM CFG_UART1_BAUD
set RATE_PARAM CFG_UART1_MRATE
. $PROFILES_F
set PRT_TEL2_ 1

# UART 2 = /dev/ttyS2 = GPS1
set SERIAL_DEV /dev/ttyS2
set PROF_PARAM CFG_UART2_PROF
set BAUD_PARAM CFG_UART2_BAUD
set RATE_PARAM CFG_UART2_MRATE
. $PROFILES_F
set PRT_GPS1_ 1

# UART 4 = /dev/ttyS4 = DEBUG / TELEM3
set SERIAL_DEV /dev/ttyS4
set PROF_PARAM CFG_UART4_PROF
set BAUD_PARAM CFG_UART4_BAUD
set RATE_PARAM CFG_UART4_MRATE
. $PROFILES_F
set PRT_TEL3_ 1

# UART 5 = /dev/ttyS5 = GPS2 / SER4
set SERIAL_DEV /dev/ttyS5
set PROF_PARAM CFG_UART5_PROF
set BAUD_PARAM CFG_UART5_BAUD
set RATE_PARAM CFG_UART5_MRATE
. $PROFILES_F
set PRT_GPS2_ 1

# GNSS receivers of the GNSS profiles: one gps command for both (PX4: two receivers at most).
# GPS_1_* belong to GNSS receiver 1, GPS_2_* to GNSS receiver 2.
if [ "x$GNSS1_DEV" != "x" ]
then
	if [ "x$GNSS2_DEV" != "x" ]
	then
		gps start -d ${GNSS1_DEV} -b p:${GNSS1_BAUD_PARAM} -e ${GNSS2_DEV} -g p:${GNSS2_BAUD_PARAM}
	else
		gps start -d ${GNSS1_DEV} -b p:${GNSS1_BAUD_PARAM}
	fi
else
	if [ "x$GNSS2_DEV" != "x" ]
	then
		echo "ERROR CFG_UART: GNSS receiver 2 on ${GNSS2_DEV} needs a GNSS receiver 1: not started"
	fi
fi

unset PROFILES_F
unset SERIAL_DEV
unset PROF_PARAM
unset BAUD_PARAM
unset RATE_PARAM
unset UART_USED
unset PROF5_DEV1
unset PROF6_DEV1
unset PROF7_DEV1
unset PROF10_DEV1
unset PROF11_DEV1
unset PROF12_DEV1
unset PROF13_DEV1
unset PROF10_USED
unset PROF12_USED
unset EXCLUDED_BY
unset GNSS1_DEV
unset GNSS1_BAUD_PARAM
unset GNSS2_DEV
unset GNSS2_BAUD_PARAM
#GD UART configuration: end

# Serial Port Mapping
# UART      Device      Port                    Name on Carrier board
# USART2    /dev/ttyS0  TELEM1 (flow control)   TELEMETRY1
# USART3    /dev/ttyS1  TELEM2 (flow control)
# UART4     /dev/ttyS2  GPS1                    GPS1
# USART6    /dev/ttyS3  PX4IO
# UART7     /dev/ttyS4  CONSOLE/ADSB-IN         DEBUG
# UART8     /dev/ttyS5  GPS2                    SER4
