void MiniBeeV2::setupAccelleroTWI(void) { #if MINIBEE_REVISION == 'B' //setup for ADXL345 Accelerometer accel.powerOn(); accel.setJustifyBit( false ); accel.setFullResBit( true ); accel.setRangeSetting( 16 ); // 2: 2g, 4: 4g, 8: 8g, 16: 16g #endif //set rate etc #if MINIBEE_REVISION == 'A' setupTWI(); //------- LIS302DL setup -------------- Wire.beginTransmission(accel1Address); Wire.send(0x21); // CTRL_REG2 (21h) Wire.send(B01000000); Wire.endTransmission(); //SPI 4/3 wire //1=ReBoot - reset chip defaults //n/a //filter off/on //filter for freefall 2 //filter for freefall 1 //filter freq MSB //filter freq LSB - Hipass filter (at 400hz) 00=8hz, 01=4hz, 10=2hz, 11=1hz (lower by 4x if sample rate is 100hz) Wire.beginTransmission(accel1Address); Wire.send(0x20); // CTRL_REG1 (20h) Wire.send(B01000111); Wire.endTransmission(); //sample rate 100/400hz //power off/on //2g/8g //self test //self test //z enable //y enable //x enable //-------end LIS302DL setup -------------- #endif }
void setup(void){ int x, y, z, i; double xyz[3], gains[3], gains_orig[3]; Serial.begin(57600); Serial.println(""); accel.powerOn(); accel.getAxisGains(gains_orig); Serial.println("gains_orig[]:"); for(i = 0; i < 3; i++){ Serial.print(gains_orig[i], 6); Serial.print(" "); } Serial.println(""); gains[0] = .1; gains[1] = 1.1; gains[2] = 2.1; accel.setAxisGains(gains); accel.getAxisGains(gains); Serial.println("set gains[]:"); for(i = 0; i < 3; i++){ Serial.print(gains[i]); Serial.print(" "); } Serial.println(""); accel.setAxisGains(gains_orig); accel.getAxisGains(gains); Serial.println("original gains?"); for(i = 0; i < 3; i++){ Serial.print(gains[i], 6); Serial.print(" "); } Serial.println(""); accel.readAccel(&x, &y, &z); Serial.print("XYZ COUNTS: "); Serial.print(x, DEC); Serial.print(" "); Serial.print(y, DEC); Serial.print(" "); Serial.print(z, DEC); Serial.println(""); accel.get_Gxyz(xyz); Serial.print("XYZ Gs: "); for(i = 0; i<3; i++){ Serial.print(xyz[i], DEC); Serial.print(" "); } Serial.println(""); accel.setTapThreshold(1); Serial.print("getTapThreshold(): "); Serial.println(accel.getTapThreshold(), DEC); accel.setAxisOffset(2, 3, 4); Serial.print("getAxisOffset(&x, &y, &z): "); accel.getAxisOffset(&x, &y, &z); Serial.print(x); Serial.print(" "); Serial.print(y); Serial.print(" "); Serial.print(z); Serial.println(""); accel.setTapDuration(5); Serial.print("getTapDuration(): "); Serial.println(accel.getTapDuration(), DEC); accel.setDoubleTapLatency(6); Serial.print("getDoubleTapLatency(): "); Serial.println(accel.getDoubleTapLatency(), DEC); accel.setDoubleTapWindow(7); Serial.print("getDoubleTapWindow() "); Serial.println(accel.getDoubleTapWindow()); accel.setActivityThreshold(8); Serial.print("getActivityThreshold() "); Serial.println(accel.getActivityThreshold(), DEC); accel.setInactivityThreshold(9); Serial.print("getInactivityThreshold() "); Serial.println(accel.getInactivityThreshold(), DEC); accel.setTimeInactivity(10); Serial.print("getTimeInactivity(): "); Serial.println(accel.getTimeInactivity()); accel.setFreeFallThreshold(11); Serial.print("getFreeFallThreshold(): "); Serial.println(accel.getFreeFallThreshold()); accel.setFreeFallDuration(12); Serial.print("getFreeFallDuration(): "); Serial.println(accel.getFreeFallDuration(), DEC); Serial.print("isActivityXEnabled(): "); Serial.println(accel.isActivityXEnabled(), DEC); Serial.print("isActivityYEnabled(): "); Serial.println(accel.isActivityYEnabled(), DEC); Serial.print("isActivityZEnabled(): "); Serial.println(accel.isActivityZEnabled(), DEC); Serial.print("isInactivityXEnabled(): "); Serial.println(accel.isInactivityXEnabled(), DEC); Serial.print("isInactivityYEnabled(): "); Serial.println(accel.isInactivityYEnabled(), DEC); Serial.print("isInactivityZEnabled(): "); Serial.println(accel.isInactivityZEnabled(), DEC); Serial.print("isActivityAc(): "); Serial.println(accel.isInactivityAc(), DEC); accel.setActivityAc(true); accel.setInactivityAc(true); accel.setSuppressBit(true); Serial.print("getSuppressBit(); true? "); Serial.println(accel.getSuppressBit()); accel.setSuppressBit(false); Serial.print("getSuppressBit(); false? "); Serial.println(accel.getSuppressBit()); accel.setTapDetectionOnX(true); Serial.print("isTapDetectionOnX(); true? "); Serial.println(accel.isTapDetectionOnX(), DEC); accel.setTapDetectionOnX(false); Serial.print("isTapDetectionOnX(); false? "); Serial.println(accel.isTapDetectionOnX(), DEC); accel.setTapDetectionOnY(true); Serial.print("isTapDetectionOnY(); true? "); Serial.println(accel.isTapDetectionOnY(), DEC); accel.setTapDetectionOnY(false); Serial.print("isTapDetectionOnY(); false? "); Serial.println(accel.isTapDetectionOnY(), DEC); accel.setTapDetectionOnZ(true); Serial.print("isTapDetectionOnZ(); true? "); Serial.println(accel.isTapDetectionOnZ(), DEC); accel.setTapDetectionOnZ(false); Serial.print("isTapDetectionOnZ(); false? "); Serial.println(accel.isTapDetectionOnZ(), DEC); accel.setActivityX(true); accel.setActivityY(true); accel.setActivityZ(true); accel.setInactivityX(false); accel.setInactivityY(false); accel.setInactivityZ(false); Serial.print("isActivitySourceOnX(): "); Serial.println(accel.isActivitySourceOnX(), DEC); Serial.print("accel.isActivitySourceOnY(): "); Serial.println(accel.isActivitySourceOnY(), DEC); Serial.print("accel.isActivitySourceOnZ(): "); Serial.println(accel.isActivitySourceOnZ(), DEC); Serial.print("accel.isTapSourceOnX(): "); Serial.println(accel.isTapSourceOnX(), DEC); Serial.print("accel.isTapSourceOnY(): "); Serial.println(accel.isTapSourceOnY(), DEC); Serial.print("accel.isTapSourceOnZ(): "); Serial.println(accel.isTapSourceOnZ(), DEC); Serial.print("accel.isAsleep(): "); Serial.println(accel.isAsleep(), DEC); Serial.print("accel.isLowPower(): "); Serial.println(accel.isLowPower(), DEC); accel.setLowPower(false); accel.setRate(3.14159); Serial.print("getRate(): 3.14159?"); Serial.println(accel.getRate()); Serial.print("getInterruptSource(): "); Serial.println(accel.getInterruptSource(), DEC); Serial.print("getInterruptSource(1): "); Serial.println(accel.getInterruptSource(1), DEC); Serial.print("getInterruptMapping(1): "); Serial.println(accel.getInterruptMapping(1), DEC); accel.setInterruptMapping(1, true); Serial.print("isInterruptEnabled(1): "); Serial.println(accel.isInterruptEnabled(1)); accel.setInterrupt(1, true); accel.setSelfTestBit(false); Serial.print("getSelfTestBit(): "); Serial.println(accel.getSelfTestBit(), DEC); accel.printAllRegister(); }