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
|
sh /etc/init.d/rc.error
|
||||||
fi
|
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"
|
echo "Starting MTD driver"
|
||||||
if mtd start /fs/mtd
|
if mtd start /fs/mtd
|
||||||
then
|
then
|
||||||
|
|
@ -298,11 +90,6 @@ then
|
||||||
echo "Set FMU mode_pwm"
|
echo "Set FMU mode_pwm"
|
||||||
fi
|
fi
|
||||||
|
|
||||||
# optional PWM input driver
|
|
||||||
if pwm_input start
|
|
||||||
then
|
|
||||||
echo "started pwm_input driver"
|
|
||||||
fi
|
|
||||||
|
|
||||||
echo "Starting ArduPilot"
|
echo "Starting ArduPilot"
|
||||||
if ArduPilot start
|
if ArduPilot start
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue