From 45ac4835cde392ff7bbc6fb0def006d220710957 Mon Sep 17 00:00:00 2001
From: Kris Winer <kriswiner@users.noreply.github.com>
Date: Tue, 27 Sep 2016 09:19:40 -0700
Subject: [PATCH] Update EM71280_MPU9250_BMP280_M24512DFC_WS_Acc_Cal.ino

---
 .../EM71280_MPU9250_BMP280_M24512DFC_WS_Acc_Cal.ino           | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/WarmStartandAccelCal/EM71280_MPU9250_BMP280_M24512DFC_WS_Acc_Cal.ino b/WarmStartandAccelCal/EM71280_MPU9250_BMP280_M24512DFC_WS_Acc_Cal.ino
index 824f0b1..d71c525 100644
--- a/WarmStartandAccelCal/EM71280_MPU9250_BMP280_M24512DFC_WS_Acc_Cal.ino
+++ b/WarmStartandAccelCal/EM71280_MPU9250_BMP280_M24512DFC_WS_Acc_Cal.ino
@@ -1677,9 +1677,9 @@ void MPU9250SelfTest(float * destination) // Should return percent deviation fro
    
   writeByte(MPU9250_ADDRESS, SMPLRT_DIV, 0x00);    // Set gyro sample rate to 1 kHz
   writeByte(MPU9250_ADDRESS, CONFIG, 0x02);        // Set gyro sample rate to 1 kHz and DLPF to 92 Hz
-  writeByte(MPU9250_ADDRESS, GYRO_CONFIG, 1<<FS);  // Set full scale range for the gyro to 250 dps
+  writeByte(MPU9250_ADDRESS, GYRO_CONFIG, FS<<3);  // Set full scale range for the gyro to 250 dps
   writeByte(MPU9250_ADDRESS, ACCEL_CONFIG2, 0x02); // Set accelerometer rate to 1 kHz and bandwidth to 92 Hz
-  writeByte(MPU9250_ADDRESS, ACCEL_CONFIG, 1<<FS); // Set full scale range for the accelerometer to 2 g
+  writeByte(MPU9250_ADDRESS, ACCEL_CONFIG, FS<<3); // Set full scale range for the accelerometer to 2 g
 
   for( int ii = 0; ii < 200; ii++) {  // get average current values of gyro and acclerometer