@@ -167,12 +167,13 @@ func (p *Device) setRangeGyro(gyroRange RangeGyro) (err error) {
167
167
p .gRange = 500
168
168
case RangeGyro1000 :
169
169
p .gRange = 1000
170
- case RangeGyro2000 :
170
+ case RangeGyro2000 , rangeGyroDefault :
171
+ gyroRange = RangeGyro2000
171
172
p .gRange = 2000
172
173
default :
173
174
return errInvalidRangeGyro
174
175
}
175
- return p .writeMasked (_GYRO_CONFIG , _G_FS_SEL , uint8 (gyroRange )<< _G_FS_SHIFT )
176
+ return p .writeMasked (_GYRO_CONFIG , _G_FS_SEL , uint8 (gyroRange - 1 )<< _G_FS_SHIFT )
176
177
}
177
178
178
179
// setRangeAccel configures the full scale range of the accelerometer.
@@ -187,12 +188,13 @@ func (p *Device) setRangeAccel(accRange RangeAccel) (err error) {
187
188
p .aRange = 4
188
189
case RangeAccel8 :
189
190
p .aRange = 8
190
- case RangeAccel16 :
191
+ case RangeAccel16 , rangeAccelDefault :
192
+ accRange = RangeAccel16
191
193
p .aRange = 16
192
194
default :
193
195
return errInvalidRangeAccel
194
196
}
195
- return p .writeMasked (_ACCEL_CONFIG , _AFS_SEL , uint8 (accRange )<< _AFS_SHIFT )
197
+ return p .writeMasked (_ACCEL_CONFIG , _AFS_SEL , uint8 (accRange - 1 )<< _AFS_SHIFT )
196
198
}
197
199
198
200
// Sleep sets the sleep bit on the power managment 1 field.
@@ -218,12 +220,3 @@ func b2u8(b bool) byte {
218
220
}
219
221
return 0
220
222
}
221
-
222
- func DefaultConfig () Config {
223
- return Config {
224
- AccelRange : RangeAccel16 ,
225
- GyroRange : RangeGyro2000 ,
226
- sampleRatio : 0 , // TODO add const values.
227
- clkSel : 0 ,
228
- }
229
- }
0 commit comments