@@ -167,12 +167,13 @@ func (p *Device) setRangeGyro(gyroRange RangeGyro) (err error) {
167167 p .gRange = 500
168168 case RangeGyro1000 :
169169 p .gRange = 1000
170- case RangeGyro2000 :
170+ case RangeGyro2000 , rangeGyroDefault :
171+ gyroRange = RangeGyro2000
171172 p .gRange = 2000
172173 default :
173174 return errInvalidRangeGyro
174175 }
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 )
176177}
177178
178179// setRangeAccel configures the full scale range of the accelerometer.
@@ -187,12 +188,13 @@ func (p *Device) setRangeAccel(accRange RangeAccel) (err error) {
187188 p .aRange = 4
188189 case RangeAccel8 :
189190 p .aRange = 8
190- case RangeAccel16 :
191+ case RangeAccel16 , rangeAccelDefault :
192+ accRange = RangeAccel16
191193 p .aRange = 16
192194 default :
193195 return errInvalidRangeAccel
194196 }
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 )
196198}
197199
198200// Sleep sets the sleep bit on the power managment 1 field.
@@ -218,12 +220,3 @@ func b2u8(b bool) byte {
218220 }
219221 return 0
220222}
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