From: luowei <lw@rock-chips.com>
Date: Thu, 23 May 2013 12:06:27 +0000 (+0800)
Subject: mpu3050:fix Unsupported Product Revision Detected
X-Git-Tag: firefly_0821_release~7044
X-Git-Url: http://demsky.eecs.uci.edu/git/?a=commitdiff_plain;h=b14e4ca4dc20519d4a3defde9450cb311a14d51c;p=firefly-linux-kernel-4.4.55.git

mpu3050:fix Unsupported Product Revision Detected
---

diff --git a/drivers/misc/inv_mpu/mldl_cfg.c b/drivers/misc/inv_mpu/mldl_cfg.c
index ccacc8ec0b56..155f4a980b25 100755
--- a/drivers/misc/inv_mpu/mldl_cfg.c
+++ b/drivers/misc/inv_mpu/mldl_cfg.c
@@ -305,10 +305,16 @@ static struct prod_rev_map_t prod_rev_map[] = {
 	{MPU_SILICON_REV_B4, 115},	/* 20 V  */
 	{MPU_SILICON_REV_B6, 131},	/* 21 B6 (B6/A9)  */
 	{MPU_SILICON_REV_B4, 115},	/* 22 B4 (B7/A10) */
-	{MPU_SILICON_REV_B6, 0},	/* 23 B6 */
-	{MPU_SILICON_REV_B6, 0},	/* 24 |  */
-	{MPU_SILICON_REV_B6, 0},	/* 25 |  */
-	{MPU_SILICON_REV_B6, 131},	/* 26 V  (B6/A11) */
+	{MPU_SILICON_REV_B6, 131},	/* 23 B6 (npp)    */
+	{MPU_SILICON_REV_B6, 131},	/* 24 |  (npp)    */
+	{MPU_SILICON_REV_B6, 131},	/* 25 V  (npp)    */	
+	{MPU_SILICON_REV_B6, 131},	/* 26    (B6/A11) */	
+	{MPU_SILICON_REV_B6, 131},	/* 27    (B6/A11) */
+	{MPU_SILICON_REV_B6, 131},	/* 28    (B6/A11) */
+	{MPU_SILICON_REV_B6, 131},	/* 29    (B6/A11) */
+	{MPU_SILICON_REV_B6, 131},	/* 30    (B6/A11) */
+	{MPU_SILICON_REV_B6, 131},	/* 31    (B6/A11) */
+	{MPU_SILICON_REV_B6, 131},	/* 32    (B6/A11) */
 };
 
 /**
@@ -362,16 +368,17 @@ static int inv_get_silicon_rev_mpu3050(
 		return result;
 	}
 
-	if (index < OLDEST_PROD_REV_SUPPORTED || index >= NUM_OF_PROD_REVS) {
-		mpu_chip_info->silicon_revision = 0;
-		mpu_chip_info->gyro_sens_trim = 0;
-		MPL_LOGE("Unsupported Product Revision Detected : %d\n", index);
-		return INV_ERROR_INVALID_MODULE;
+	if (OLDEST_PROD_REV_SUPPORTED <= index && NUM_OF_PROD_REVS >= index) {
+		mpu_chip_info->silicon_revision = prod_rev_map[index].silicon_rev;
+		mpu_chip_info->gyro_sens_trim = prod_rev_map[index].gyro_trim;
+	}
+	else
+	{
+		mpu_chip_info->silicon_revision = MPU_SILICON_REV_B6;
+		mpu_chip_info->gyro_sens_trim = 131;
 	}
 
 	mpu_chip_info->product_revision = index;
-	mpu_chip_info->silicon_revision = prod_rev_map[index].silicon_rev;
-	mpu_chip_info->gyro_sens_trim = prod_rev_map[index].gyro_trim;
 	if (mpu_chip_info->gyro_sens_trim == 0) {
 		MPL_LOGE("gyro sensitivity trim is 0"
 			 " - unsupported non production part.\n");