MPU6050_tockn icon indicating copy to clipboard operation
MPU6050_tockn copied to clipboard

Added new methods for sensitivity adjustment

Open ghost opened this issue 5 years ago • 0 comments

Changes

I added two new methods to the class MPU6050, that can adjust the sensitivity of the sensor.

New methods:

  • setGyroSensitivity(int)
  • setAccelSensitivity(int)

Updated the other methods, that used hard coded sensitivity values.

Test data

Before update

========================================
calculate gyro offsets
DO NOT MOVE A MPU6050...
Done!
X : -1.29
Y : 1.20
Z : -1.26
Program will start after 3 seconds
===============================================================================================
temp : 26.95
accX : 1.02	accY : -0.01	accZ : 0.07
gyroX : 0.15	gyroY : -0.07	gyroZ : 0.02
accAngleX : -0.56	accAngleY : -85.21
gyroAngleX : 1.30	gyroAngleY : -0.59	gyroAngleZ : 0.13
angleX : 0.81	angleY : -86.33	angleZ : 0.13
=======================================================

=======================================================
temp : 27.00
accX : 1.02	accY : -0.01	accZ : 0.07
gyroX : -0.08	gyroY : -0.21	gyroZ : -0.08
accAngleX : -0.47	accAngleY : -85.31
gyroAngleX : 1.31	gyroAngleY : -0.59	gyroAngleZ : 0.17
angleX : -0.54	angleY : -85.40	angleZ : 0.17
=======================================================

=======================================================
temp : 26.95
accX : 1.02	accY : -0.01	accZ : 0.07
gyroX : 0.10	gyroY : 0.00	gyroZ : 0.08
accAngleX : -0.60	accAngleY : -85.39
gyroAngleX : 1.30	gyroAngleY : -0.64	gyroAngleZ : 0.18
angleX : -0.53	angleY : -85.38	angleZ : 0.18
=======================================================

After update Testing the use of the new methods before calibration

========================================
calculate gyro offsets
DO NOT MOVE A MPU6050...
Done!
X : -1.29
Y : 1.15
Z : -1.30
Program will start after 3 seconds
===============================================================================================
temp : 27.85
accX : 1.02	accY : -0.00	accZ : 0.07
gyroX : -0.06	gyroY : -0.05	gyroZ : 0.08
accAngleX : -0.26	accAngleY : -85.83
gyroAngleX : -0.49	gyroAngleY : -0.46	gyroAngleZ : 0.68
angleX : -0.48	angleY : -2.17	angleZ : 0.68
=======================================================

=======================================================
temp : 27.94
accX : 1.03	accY : -0.00	accZ : 0.07
gyroX : -0.12	gyroY : 0.01	gyroZ : -0.04
accAngleX : -0.18	accAngleY : -85.77
gyroAngleX : -0.46	gyroAngleY : -0.47	gyroAngleZ : 0.70
angleX : -0.25	angleY : -85.73	angleZ : 0.70
=======================================================

=======================================================
temp : 27.85
accX : 1.01	accY : -0.00	accZ : 0.07
gyroX : 0.01	gyroY : -0.05	gyroZ : 0.02
accAngleX : -0.21	accAngleY : -85.76
gyroAngleX : -0.47	gyroAngleY : -0.52	gyroAngleZ : 0.69
angleX : -0.26	angleY : -85.66	angleZ : 0.69
=======================================================

Testing the use of the new methods after calibration

========================================
calculate gyro offsets
DO NOT MOVE A MPU6050...
Done!
X : -1.26
Y : 1.16
Z : -1.28
Program will start after 3 seconds
===============================================================================================
temp : 28.13
accX : 1.02	accY : -0.00	accZ : 0.08
gyroX : 0.16	gyroY : -0.13	gyroZ : 0.12
accAngleX : -0.18	accAngleY : -85.58
gyroAngleX : 1.41	gyroAngleY : -1.10	gyroAngleZ : 1.06
angleX : 1.15	angleY : -86.88	angleZ : 1.06
=======================================================

=======================================================
temp : 28.08
accX : 1.02	accY : -0.01	accZ : 0.07
gyroX : 0.10	gyroY : -0.00	gyroZ : -0.00
accAngleX : -0.33	accAngleY : -85.64
gyroAngleX : 1.36	gyroAngleY : -1.09	gyroAngleZ : 1.01
angleX : -0.26	angleY : -85.62	angleZ : 1.01
=======================================================

=======================================================
temp : 28.18
accX : 1.02	accY : -0.01	accZ : 0.07
gyroX : -0.02	gyroY : -0.06	gyroZ : -0.12
accAngleX : -0.33	accAngleY : -85.49
gyroAngleX : 1.35	gyroAngleY : -1.16	gyroAngleZ : 0.95
angleX : -0.28	angleY : -85.60	angleZ : 0.95
=======================================================

ghost avatar Apr 25 '19 18:04 ghost