diff --git a/libraries/AP_InertialSensor/AP_InertialSensor_Invensense.cpp b/libraries/AP_InertialSensor/AP_InertialSensor_Invensense.cpp index b45255e1eb..6ef9a8c7f6 100644 --- a/libraries/AP_InertialSensor/AP_InertialSensor_Invensense.cpp +++ b/libraries/AP_InertialSensor/AP_InertialSensor_Invensense.cpp @@ -911,7 +911,8 @@ bool AP_InertialSensor_Invensense::_check_whoami(void) case MPU_WHOAMI_MPU9255: _mpu_type = Invensense_MPU9250; return true; - case MPU_WHOAMI_20608: + case MPU_WHOAMI_20608D: + case MPU_WHOAMI_20608G: _mpu_type = Invensense_ICM20608; return true; case MPU_WHOAMI_20602: diff --git a/libraries/AP_InertialSensor/AP_InertialSensor_Invensense_registers.h b/libraries/AP_InertialSensor/AP_InertialSensor_Invensense_registers.h index bf1973e354..601f91a5c4 100644 --- a/libraries/AP_InertialSensor/AP_InertialSensor_Invensense_registers.h +++ b/libraries/AP_InertialSensor/AP_InertialSensor_Invensense_registers.h @@ -178,7 +178,8 @@ // WHOAMI values #define MPU_WHOAMI_6000 0x68 -#define MPU_WHOAMI_20608 0xaf +#define MPU_WHOAMI_20608D 0xae +#define MPU_WHOAMI_20608G 0xaf #define MPU_WHOAMI_20602 0x12 #define MPU_WHOAMI_20601 0xac #define MPU_WHOAMI_6500 0x70