ardupilot/Tools/scripts/decode_devid.py

106 lines
2.7 KiB
Python
Raw Normal View History

2017-04-28 04:05:13 -03:00
#!/usr/bin/env python
'''
decode a device ID, such as used for COMPASS_DEV_ID, INS_ACC_ID etc
To understand the devtype you should look at the backend headers for
the sensor library, such as libraries/AP_Compass/AP_Compass_Backend.h
'''
import sys
2017-07-31 20:40:43 -03:00
import optparse
2017-04-28 04:05:13 -03:00
2018-09-12 13:01:47 -03:00
def num(s):
try:
return int(s)
except ValueError:
return int(s, 16)
2017-07-31 20:40:43 -03:00
parser = optparse.OptionParser("decode_devid.py")
parser.add_option("-C", "--compass", action='store_true', help='decode compass IDs')
parser.add_option("-I", "--imu", action='store_true', help='decode IMU IDs')
opts, args = parser.parse_args()
if len(args) == 0:
print("Please supply a device ID")
sys.exit(1)
2018-09-12 13:01:47 -03:00
devid=num(args[0])
2017-04-28 04:05:13 -03:00
bus_type=devid & 0x07
bus=(devid>>3) & 0x1F
address=(devid>>8)&0xFF
devtype=(devid>>16)
2017-07-31 20:40:43 -03:00
bustypes = {
1: "I2C",
2: "SPI",
2018-06-27 00:31:33 -03:00
3: "UAVCAN",
4: "SITL"
2017-07-31 20:40:43 -03:00
}
compass_types = {
0x01 : "DEVTYPE_HMC5883_OLD",
0x07 : "DEVTYPE_HMC5883",
0x02 : "DEVTYPE_LSM303D",
0x04 : "DEVTYPE_AK8963 ",
0x05 : "DEVTYPE_BMM150 ",
0x06 : "DEVTYPE_LSM9DS1",
0x08 : "DEVTYPE_LIS3MDL",
0x09 : "DEVTYPE_AK09916",
0x0A : "DEVTYPE_IST8310",
0x0B : "DEVTYPE_ICM20948",
0x0C : "DEVTYPE_MMC3416",
2018-06-27 00:31:33 -03:00
0x0D : "DEVTYPE_QMC5883L",
0x0E : "DEVTYPE_MAG3110",
2018-09-26 14:51:38 -03:00
0x0F : "DEVTYPE_SITL",
0x10 : "DEVTYPE_IST8308",
2020-03-26 04:18:46 -03:00
0x11 : "DEVTYPE_RM3100_OLD",
0x12 : "DEVTYPE_RM3100",
2017-07-31 20:40:43 -03:00
}
imu_types = {
0x09 : "DEVTYPE_BMI160",
0x10 : "DEVTYPE_L3G4200D",
0x11 : "DEVTYPE_ACC_LSM303D",
0x12 : "DEVTYPE_ACC_BMA180",
0x13 : "DEVTYPE_ACC_MPU6000",
0x16 : "DEVTYPE_ACC_MPU9250",
0x17 : "DEVTYPE_ACC_IIS328DQ",
2017-07-31 20:40:43 -03:00
0x21 : "DEVTYPE_GYR_MPU6000",
0x22 : "DEVTYPE_GYR_L3GD20",
0x24 : "DEVTYPE_GYR_MPU9250",
0x25 : "DEVTYPE_GYR_I3G4250D",
0x26 : "DEVTYPE_GYR_LSM9DS1",
0x27 : "DEVTYPE_INS_ICM20789",
0x28 : "DEVTYPE_INS_ICM20689",
2018-06-27 00:31:33 -03:00
0x29 : "DEVTYPE_INS_BMI055",
0x2A : "DEVTYPE_SITL",
2019-03-25 19:49:32 -03:00
0x2B : "DEVTYPE_INS_BMI088",
0x2C : "DEVTYPE_INS_ICM20948",
0x2D : "DEVTYPE_INS_ICM20648",
0x2E : "DEVTYPE_INS_ICM20649",
0x2F : "DEVTYPE_INS_ICM20602",
0x30 : "DEVTYPE_INS_ICM20601",
2017-07-31 20:40:43 -03:00
}
decoded_devname = ""
2017-04-28 04:05:13 -03:00
2017-07-31 20:40:43 -03:00
if opts.compass:
decoded_devname = compass_types.get(devtype, "UNKNOWN")
2017-04-28 04:05:13 -03:00
2017-07-31 20:40:43 -03:00
if opts.imu:
decoded_devname = imu_types.get(devtype, "UNKNOWN")
2017-04-28 04:05:13 -03:00
if bus_type == 3:
#uavcan devtype represents sensor_id
print("bus_type:%s(%u) bus:%u address:%u(0x%x) sensor_id:%u(0x%x) %s" % (
bustypes.get(bus_type,"UNKNOWN"), bus_type,
bus, address, address, devtype-1, devtype-1, decoded_devname))
else:
print("bus_type:%s(%u) bus:%u address:%u(0x%x) devtype:%u(0x%x) %s" % (
bustypes.get(bus_type,"UNKNOWN"), bus_type,
bus, address, address, devtype, devtype, decoded_devname))