|
|
|
@ -48,50 +48,50 @@ then
@@ -48,50 +48,50 @@ then
|
|
|
|
|
fi |
|
|
|
|
fi |
|
|
|
|
|
|
|
|
|
if ver hwtypecmp V5X00090000 V5X00090001 V5X00090002 V5X000a0000 V5X000a0001 V5X000a0002 V5X00080000 V5X00080001 V5X00080002 V5X00100001 |
|
|
|
|
if ver hwtypecmp V5X00000000 V5X00000001 V5X00000002 V5X00010000 |
|
|
|
|
then |
|
|
|
|
#SKYNODE base fmu board orientation |
|
|
|
|
#FMUv5Xbase board orientation |
|
|
|
|
|
|
|
|
|
if ver hwtypecmp V5X00090000 V5X00090001 V5X000a0000 V5X000a0001 V5X00080000 V5X00080001 V5X00100001 |
|
|
|
|
if ver hwtypecmp V5X00000000 V5X00000001 |
|
|
|
|
then |
|
|
|
|
# Internal SPI BMI088 |
|
|
|
|
bmi088 -A -R 2 -s start |
|
|
|
|
bmi088 -G -R 2 -s start |
|
|
|
|
bmi088 -A -R 4 -s start |
|
|
|
|
bmi088 -G -R 4 -s start |
|
|
|
|
else |
|
|
|
|
# Internal SPI bus ICM20649 |
|
|
|
|
icm20649 -s -R 4 start |
|
|
|
|
icm20649 -s -R 6 start |
|
|
|
|
fi |
|
|
|
|
|
|
|
|
|
# Internal SPI bus ICM42688p |
|
|
|
|
icm42688p -R 4 -s start |
|
|
|
|
icm42688p -R 6 -s start |
|
|
|
|
|
|
|
|
|
# Internal SPI bus ICM-20602 (hard-mounted) |
|
|
|
|
icm20602 -R 8 -s start |
|
|
|
|
icm20602 -R 10 -s start |
|
|
|
|
|
|
|
|
|
# Internal magnetometer on I2c |
|
|
|
|
bmm150 -I -R 6 start |
|
|
|
|
bmm150 -I start |
|
|
|
|
|
|
|
|
|
else |
|
|
|
|
#FMUv5Xbase board orientation |
|
|
|
|
#SKYNODE base fmu board orientation |
|
|
|
|
|
|
|
|
|
if ver hwtypecmp V5X00000000 V5X00000001 |
|
|
|
|
if ver hwtypecmp V5X00090000 V5X00090001 V5X000a0000 V5X000a0001 V5X00080000 V5X00080001 V5X00100001 |
|
|
|
|
then |
|
|
|
|
# Internal SPI BMI088 |
|
|
|
|
bmi088 -A -R 4 -s start |
|
|
|
|
bmi088 -G -R 4 -s start |
|
|
|
|
bmi088 -A -R 2 -s start |
|
|
|
|
bmi088 -G -R 2 -s start |
|
|
|
|
else |
|
|
|
|
# Internal SPI bus ICM20649 |
|
|
|
|
icm20649 -s -R 6 start |
|
|
|
|
icm20649 -s -R 4 start |
|
|
|
|
fi |
|
|
|
|
|
|
|
|
|
# Internal SPI bus ICM42688p |
|
|
|
|
icm42688p -R 6 -s start |
|
|
|
|
icm42688p -R 4 -s start |
|
|
|
|
|
|
|
|
|
# Internal SPI bus ICM-20602 (hard-mounted) |
|
|
|
|
icm20602 -R 10 -s start |
|
|
|
|
icm20602 -R 8 -s start |
|
|
|
|
|
|
|
|
|
# Internal magnetometer on I2c |
|
|
|
|
bmm150 -I start |
|
|
|
|
bmm150 -I -R 6 start |
|
|
|
|
|
|
|
|
|
fi |
|
|
|
|
|
|
|
|
|