diff --git a/mk/PX4/ROMFS/init.d/rc.APM b/mk/PX4/ROMFS/init.d/rc.APM index 0b5c4cdba5..7714b493f8 100755 --- a/mk/PX4/ROMFS/init.d/rc.APM +++ b/mk/PX4/ROMFS/init.d/rc.APM @@ -250,18 +250,6 @@ then fi fi - -echo "Starting APM sensors" - -if ms5611 start -then - echo "ms5611 started OK" -else - echo "no ms5611 found" - echo "No ms5611 found" >> $logfile - sh /etc/init.d/rc.error -fi - if adc start then echo "adc started OK" @@ -270,232 +258,6 @@ else sh /etc/init.d/rc.error fi -if [ $BOARD == FMUv1 ] -then - echo "Starting FMUv1 sensors" - if hmc5883 -C -T -X start - then - echo "Have external hmc5883" - else - echo "No external hmc5883" - fi - if hmc5883 -C -T -I start - then - echo "Have internal hmc5883" - else - echo "No internal hmc5883" - fi - if mpu6000 start - then - echo "mpu6000 started OK" - else - sh /etc/init.d/rc.error - fi - if l3gd20 start - then - echo "l3gd20 started OK" - else - echo "No l3gd20" - echo "No l3gd20" >> $logfile - fi -fi - -if [ $BOARD == FMUv2 ] -then - echo "Starting FMUv2 sensors" - if hmc5883 -C -T -X start - then - echo "Have external hmc5883" - else - echo "No external hmc5883" - fi - if hmc5883 -C -T -I -R 4 start - then - echo "Have internal hmc5883" - else - echo "No internal hmc5883" - fi - - # external MPU6000 is rotated YAW_180 from standard - if mpu6000 -X -R 4 start - then - echo "Found MPU6000 external" - set HAVE_FMUV3 true - else - if mpu9250 -X -R 4 start - then - echo "Found MPU9250 external" - set HAVE_FMUV3 true - else - echo "No MPU6000 or MPU9250 external" - set HAVE_FMUV3 false - fi - fi - if [ $HAVE_FMUV3 == true ] - then - # external L3GD20 is rotated YAW_180 from standard - if l3gd20 -X -R 4 start - then - echo "l3gd20 external started OK" - else - echo "No l3gd20" - sh /etc/init.d/rc.error - fi - # external LSM303D is rotated YAW_270 from standard - if lsm303d -a 16 -X -R 6 start - then - echo "lsm303d external started OK" - else - echo "No lsm303d" - sh /etc/init.d/rc.error - fi - # internal MPU6000 is rotated ROLL_180_YAW_270 from standard - if mpu6000 -R 14 start - then - echo "Found MPU6000 internal" - else - if mpu9250 -R 14 start - then - echo "Found MPU9250 internal" - else - echo "No MPU6000 or MPU9250" - echo "No MPU6000 or MPU9250" >> $logfile - sh /etc/init.d/rc.error - fi - fi - if hmc5883 -C -T -S -R 8 start - then - echo "Found SPI hmc5883" - fi - else - if mpu6000 start - then - echo "Found MPU6000" - else - if mpu9250 start - then - echo "Found MPU9250" - else - echo "No MPU6000 or MPU9250" - echo "No MPU9250" >> $logfile - fi - fi - if l3gd20 start - then - echo "l3gd20 started OK" - else - sh /etc/init.d/rc.error - fi - if lsm303d -a 16 start - then - echo "lsm303d started OK" - else - sh /etc/init.d/rc.error - fi - fi -fi - - -if [ $BOARD == FMUv4 ] -then - echo "Starting FMUv4 sensors" - if hmc5883 -C -T -X start - then - echo "Have external hmc5883" - else - echo "No external hmc5883" - fi - if hmc5883 -C -T -S -R 2 start - then - echo "Have SPI hmc5883" - else - echo "No SPI hmc5883" - fi - - if mpu6000 -R 2 -T 20608 start - then - echo "Found ICM-20608 internal" - fi - - if mpu9250 -R 2 start - then - echo "Found mpu9250 internal" - fi -fi - -# optional ETS airspeed sensor -if ets_airspeed start -then - echo "Found ETS airspeed sensor" -fi - -if meas_airspeed start -then - echo "Found MEAS airspeed sensor" -else - if meas_airspeed start -b 2 - then - echo "Found MEAS airspeed sensor (bus2)" - fi -fi - -# optional Range Finder sensor -if ll40ls -X start -then - echo "Found external ll40ls sensor" -fi - -if ll40ls -I start -then - echo "Found internal ll40ls sensor" -fi - -if trone start -then - echo "Found trone sensor" -fi - -if mb12xx start -then - echo "Found mb12xx sensor" -fi - -# optional PX4Flow sensor -if [ -f /bin/px4flow ] -then - if px4flow start - then - echo "Found px4flow sensor" - fi -fi - -# optional PWM input driver -if pwm_input start -then - echo "started pwm_input driver" -fi - -# optional oreo leds -if [ -f /bin/oreoled ] -then - if oreoled start autoupdate - then - echo "oreoled started OK" - fi -fi - -# optional smbus battery monitor -if batt_smbus -b 2 start -then - echo "Found batt_smbus" -fi - -# optional irlock -if irlock start -then - echo "irlock started" -fi - echo Starting ArduPilot $deviceA $deviceC $deviceD if ArduPilot -d $deviceA -d2 $deviceC -d3 $deviceD start then