@@ -59,85 +59,22 @@ bool CurieImuClass::begin()
59
59
60
60
int CurieImuClass::getGyroRange ()
61
61
{
62
- uint8_t fullScaleGyroRange = getFullScaleGyroRange ();
63
-
64
- switch (fullScaleGyroRange) {
65
- case BMI160_GYRO_RANGE_2000:
66
- return 2000 ;
67
-
68
- case BMI160_GYRO_RANGE_1000:
69
- return 1000 ;
70
-
71
- case BMI160_GYRO_RANGE_500:
72
- return 500 ;
73
-
74
- case BMI160_GYRO_RANGE_250:
75
- return 250 ;
76
-
77
- case BMI160_GYRO_RANGE_125:
78
- return 125 ;
79
-
80
- default :
81
- return -1 ;
82
- }
62
+ return getFullScaleGyroRange ();
83
63
}
84
64
85
65
void CurieImuClass::setGyroRange (int range)
86
66
{
87
- uint8_t fullScaleGyroRange;
88
-
89
- if (range >= 2000 ) {
90
- fullScaleGyroRange = BMI160_GYRO_RANGE_2000;
91
- } else if (range >= 1000 ) {
92
- fullScaleGyroRange = BMI160_GYRO_RANGE_1000;
93
- } else if (range >= 500 ) {
94
- fullScaleGyroRange = BMI160_GYRO_RANGE_500;
95
- } else if (range >= 250 ) {
96
- fullScaleGyroRange = BMI160_GYRO_RANGE_250;
97
- } else {
98
- fullScaleGyroRange = BMI160_GYRO_RANGE_125;
99
- }
100
-
101
- setFullScaleGyroRange (fullScaleGyroRange);
67
+ setFullScaleGyroRange (range);
102
68
}
103
69
104
70
int CurieImuClass::getAccelerometerRange ()
105
71
{
106
- uint8_t fullScaleAccelRange = getFullScaleAccelRange ();
107
-
108
- switch (fullScaleAccelRange) {
109
- case BMI160_ACCEL_RANGE_2G:
110
- return 2 ;
111
-
112
- case BMI160_ACCEL_RANGE_4G:
113
- return 4 ;
114
-
115
- case BMI160_ACCEL_RANGE_8G:
116
- return 8 ;
117
-
118
- case BMI160_ACCEL_RANGE_16G:
119
- return 16 ;
120
-
121
- default :
122
- return -1 ;
123
- }
72
+ return getFullScaleAccelRange ();
124
73
}
125
74
126
75
void CurieImuClass::setAccelerometerRange (int range)
127
76
{
128
- uint8_t fullScaleAccelRange;
129
-
130
- if (range >= 16 ) {
131
- fullScaleAccelRange = BMI160_ACCEL_RANGE_16G;
132
- } else if (range >= 8 ) {
133
- fullScaleAccelRange = BMI160_ACCEL_RANGE_8G;
134
- } else if (range >= 4 ) {
135
- fullScaleAccelRange = BMI160_ACCEL_RANGE_4G;
136
- } else {
137
- fullScaleAccelRange = BMI160_ACCEL_RANGE_2G;
138
- }
139
-
140
- setFullScaleAccelRange (fullScaleAccelRange);
77
+ setFullScaleAccelRange (range);
141
78
}
142
79
143
80
void CurieImuClass::autoCalibrateGyroOffset ()
0 commit comments