#!/bin/sh
# PX4 commands need the 'px4-' prefix in bash.
# (px4-alias.sh is expected to be in the PATH)
. px4-alias.sh

# navio config for a quad
uorb start
if [ -f eeprom/parameters ]
then
	param load
fi
param set SYS_AUTOSTART 4001
param set MAV_BROADCAST 1
param set MAV_TYPE 2
param set BAT_CNT_V_VOLT 0.001
param set BAT_V_DIV 10.9176300578
param set BAT_CNT_V_CURR 0.001
param set BAT_A_PER_V 15.391030303
dataman start
df_lsm9ds1_wrapper start -R 4
#df_mpu9250_wrapper start -R 10
ms5611 start
navio_rgbled start
navio_adc start
gps start -d /dev/spidev0.0 -i spi -p ubx
rc_update start
sensors start
commander start
navigator start
ekf2 start
land_detector start multicopter
mc_pos_control start
mc_att_control start
mavlink start -x -u 14556 -r 1000000
mavlink stream -u 14556 -s HIGHRES_IMU -r 50
mavlink stream -u 14556 -s ATTITUDE -r 50

if [ -f /dev/ttyUSB0 ]
then
	mavlink start -x -d /dev/ttyUSB0
	mavlink stream -d /dev/ttyUSB0 -s HIGHRES_IMU -r 50
	mavlink stream -d /dev/ttyUSB0 -s ATTITUDE -r 50
fi

navio_sysfs_rc_in start
linux_pwm_out start
logger start -t -b 200
mavlink boot_complete

sleep 5

ver all
sleep 1
commander check
sleep 1
dataman status
sleep 1
ekf2 status
sleep 1
logger status
sleep 1
mavlink status
sleep 1
mavlink status streams
sleep 1
param show
sleep 1
param status
sleep 1
pwm info
sleep 1
sensors status
sleep 1
perf
sleep 1
perf latency
sleep 1
work_queue status
sleep 1
uorb top -1
sleep 1

shutdown