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();
}
