mirror of https://github.com/ArduPilot/ardupilot
VRBRAIN: removed sensor driver startup now managed into AP_BoardConfig
This commit is contained in:
LukeMike
Andrew Tridgell
parent
9be5e37faa
commit
451390ddec
|
|
@ -66,214 +66,6 @@ else
|
|||
sh /etc/init.d/rc.error
|
||||
fi
|
||||
|
||||
echo "Starting APM sensors"
|
||||
|
||||
set INTERNAL_MS5611 false
|
||||
set INTERNAL_MPU6000 false
|
||||
set INTERNAL_MPU9250 false
|
||||
set INTERNAL_HMC5883 false
|
||||
|
||||
set EXTERNAL_EXP_MS5611 false
|
||||
set EXTERNAL_EXP_MPU6000 false
|
||||
set EXTERNAL_EXP_HMC5983 false
|
||||
|
||||
set EXTERNAL_IMU_MS5611 false
|
||||
set EXTERNAL_IMU_MPU6000 false
|
||||
set EXTERNAL_IMU_HMC5983 false
|
||||
|
||||
set EXTERNAL_GPS_HMC5883 false
|
||||
|
||||
if ver hwcmp VRBRAIN_V51
|
||||
then
|
||||
echo "Detected VRBRAINv51 board"
|
||||
set INTERNAL_MS5611 true
|
||||
set INTERNAL_MPU6000 true
|
||||
set INTERNAL_HMC5883 true
|
||||
set EXTERNAL_GPS_HMC5883 true
|
||||
fi
|
||||
|
||||
if ver hwcmp VRBRAIN_V52
|
||||
then
|
||||
echo "Detected VRBRAINv52 board"
|
||||
set INTERNAL_MS5611 true
|
||||
set INTERNAL_MPU6000 true
|
||||
set INTERNAL_HMC5883 true
|
||||
set EXTERNAL_GPS_HMC5883 true
|
||||
fi
|
||||
|
||||
if ver hwcmp VRBRAIN_V54
|
||||
then
|
||||
echo "Detected VRBRAINv54 board"
|
||||
set INTERNAL_MS5611 true
|
||||
set INTERNAL_MPU6000 true
|
||||
set INTERNAL_HMC5883 true
|
||||
set EXTERNAL_GPS_HMC5883 true
|
||||
fi
|
||||
|
||||
if ver hwcmp VRCORE_V10
|
||||
then
|
||||
echo "Detected VRCOREv10 board"
|
||||
set INTERNAL_MS5611 true
|
||||
set INTERNAL_MPU6000 true
|
||||
set EXTERNAL_GPS_HMC5883 true
|
||||
fi
|
||||
|
||||
if ver hwcmp VRUBRAIN_V51
|
||||
then
|
||||
echo "Detected VRUBRAINv51 board"
|
||||
set INTERNAL_MS5611 true
|
||||
set INTERNAL_MPU6000 true
|
||||
set EXTERNAL_GPS_HMC5883 true
|
||||
fi
|
||||
|
||||
if ver hwcmp VRUBRAIN_V52
|
||||
then
|
||||
echo "Detected VRUBRAINv52 board"
|
||||
set INTERNAL_MS5611 true
|
||||
set INTERNAL_MPU6000 true
|
||||
set EXTERNAL_GPS_HMC5883 true
|
||||
fi
|
||||
|
||||
if [ $INTERNAL_MS5611 == true ]
|
||||
then
|
||||
echo "Starting MS5611 Internal"
|
||||
if ms5611 -s start
|
||||
then
|
||||
echo "MS5611 Internal started OK"
|
||||
else
|
||||
echo "MS5611 Internal start failed"
|
||||
sh /etc/init.d/rc.error
|
||||
fi
|
||||
fi
|
||||
|
||||
if [ $EXTERNAL_GPS_HMC5883 == true ]
|
||||
then
|
||||
echo "Starting HMC5883 External GPS"
|
||||
if hmc5883 -C -X start
|
||||
then
|
||||
echo "HMC5883 External GPS started OK"
|
||||
else
|
||||
echo "HMC5883 External GPS start failed"
|
||||
# sh /etc/init.d/rc.error
|
||||
fi
|
||||
fi
|
||||
|
||||
if [ $INTERNAL_HMC5883 == true ]
|
||||
then
|
||||
echo "Starting HMC5883 Internal"
|
||||
if hmc5883 -C -R 12 -I start
|
||||
then
|
||||
echo "HMC5883 Internal started OK"
|
||||
else
|
||||
echo "HMC5883 Internal start failed"
|
||||
# sh /etc/init.d/rc.error
|
||||
fi
|
||||
fi
|
||||
|
||||
if [ $INTERNAL_MPU6000 == true ]
|
||||
then
|
||||
echo "Starting MPU6000 Internal"
|
||||
if mpu6000 -R 12 start
|
||||
then
|
||||
echo "MPU6000 Internal started OK"
|
||||
else
|
||||
echo "[APM] MPU6000 Internal start failed"
|
||||
sh /etc/init.d/rc.error
|
||||
fi
|
||||
fi
|
||||
|
||||
if [ $INTERNAL_MPU9250 == true ]
|
||||
then
|
||||
echo "Starting MPU9250 Internal"
|
||||
if mpu9250 -R 4 start
|
||||
then
|
||||
echo "MPU9250 Internal started OK"
|
||||
else
|
||||
echo "[APM] MPU9250 Internal start failed"
|
||||
sh /etc/init.d/rc.error
|
||||
fi
|
||||
fi
|
||||
|
||||
# optional ETS airspeed sensor
|
||||
if ets_airspeed start
|
||||
then
|
||||
echo "Found ETS airspeed sensor"
|
||||
else
|
||||
if ets_airspeed start -b 2
|
||||
then
|
||||
echo "Found ETS airspeed sensor"
|
||||
else
|
||||
echo "ETS airspeed sensor start failed"
|
||||
fi
|
||||
fi
|
||||
|
||||
if meas_airspeed start
|
||||
then
|
||||
echo "Found MEAS airspeed sensor"
|
||||
else
|
||||
if meas_airspeed start -b 2
|
||||
then
|
||||
echo "Found MEAS airspeed sensor"
|
||||
else
|
||||
echo "MEAS airspeed sensor start failed"
|
||||
fi
|
||||
fi
|
||||
|
||||
# optional Range Finder sensor
|
||||
if ll40ls -X start
|
||||
then
|
||||
echo "Found external ll40ls sensor"
|
||||
fi
|
||||
|
||||
if [ $LL_I2C_AUX == true ]
|
||||
then
|
||||
if ll40ls -I start
|
||||
then
|
||||
echo "Found internal ll40ls sensor"
|
||||
fi
|
||||
fi
|
||||
|
||||
if [ $LL_PWM_INPUT == true ]
|
||||
then
|
||||
# optional PWM input driver
|
||||
if pwm_input start
|
||||
then
|
||||
echo "started pwm_input driver"
|
||||
if ll40ls start pwm
|
||||
then
|
||||
echo "Found ll40ls sensor PWM"
|
||||
fi
|
||||
fi
|
||||
fi
|
||||
|
||||
if trone start
|
||||
then
|
||||
echo "Found trone sensor"
|
||||
fi
|
||||
|
||||
if mb12xx start
|
||||
then
|
||||
echo "Found mb12xx sensor"
|
||||
fi
|
||||
|
||||
# Starting Optional PX4Flow sensor
|
||||
if px4flow start
|
||||
then
|
||||
echo "Found PX4Flow sensor"
|
||||
fi
|
||||
|
||||
if irlock start
|
||||
then
|
||||
echo "Found IR-Lock and Pixy vision sensor"
|
||||
else
|
||||
if irlock start -b 2
|
||||
then
|
||||
echo "Found IR-Lock and Pixy vision sensor"
|
||||
else
|
||||
echo "IR-Lock and Pixy vision sensor start failed"
|
||||
fi
|
||||
fi
|
||||
|
||||
echo "Starting MTD driver"
|
||||
if mtd start /fs/mtd
|
||||
then
|
||||
|
|
@ -298,11 +90,6 @@ then
|
|||
echo "Set FMU mode_pwm"
|
||||
fi
|
||||
|
||||
# optional PWM input driver
|
||||
if pwm_input start
|
||||
then
|
||||
echo "started pwm_input driver"
|
||||
fi
|
||||
|
||||
echo "Starting ArduPilot"
|
||||
if ArduPilot start
|
||||
|
|
|
|||
Loading…
Reference in New Issue