optimization

code/arduino/Movement-sensor-code/SensorManager.cpp

@@ -9,15 +9,15 @@ void SensorManager::sensorSetup() {
   //wait for the sensor to start before continue
   if (myIMU.begin() == false) {
     delay(1000);
-    Serial.println(".");
+    // Serial.println(".");
   }
   //start sensorfunction and start autocalibration
   //once calibration is enabled it attempts to every 5 min
 
-  Wire.setClock(400000);                          
   myIMU.enableGyroIntegratedRotationVector(100);  //send data every 100ms
   myIMU.enableAccelerometer(100);                 //Send data update every 100ms
   Serial.println(F("magnetometer rotation enabled"));
+  myIMU.enableStepCounter(500);  //Send data update every 500ms
 }
 //get sensordata
 SensorManager::RotationQuintillions SensorManager::getQuintillions() {
@@ -39,7 +39,7 @@ SensorManager::RotationQuintillions SensorManager::getQuintillions() {
     return rotation;
   }
 }
-//calculate Quintillions to Euler angles from -1π to +1π 
+//calculate Quintillions to Euler angles from -1π to +1π
 SensorManager::eulerAngles SensorManager::getEulerAngles() {
   SensorManager::RotationQuintillions rotation = getQuintillions();
   float roll = atan2(2.0f * (rotation.w * rotation.i + rotation.j * rotation.k), 1.0f - 2.0f * (rotation.i * rotation.i + rotation.j * rotation.j));
@@ -48,11 +48,24 @@ SensorManager::eulerAngles SensorManager::getEulerAngles() {
   eulerAngles EulerAngles = { roll, pitch, yaw };
   return EulerAngles;
 }
-SensorManager::acceleration SensorManager::getAcelleration(){    
-    float x = myIMU.getAccelX();
-    float y = myIMU.getAccelY();
-    float z = myIMU.getAccelZ();
-    acceleration Acceleration = { x, y, z };
+SensorManager::acceleration SensorManager::getAcelleration() {
+  float x = myIMU.getAccelX();
+  float y = myIMU.getAccelY();
+  float z = myIMU.getAccelZ();
+  acceleration Acceleration = { x, y, z };
 
-    return Acceleration;
+  return Acceleration;
+}
+
+bool SensorManager::sensorTap() {
+  int taps = 0;
+  if (myIMU.dataAvailable() == true) {
+    int taps = myIMU.getStepCount();
+  }
+  if (taps) {
+    return true;
+  }
+  else {
+    return false;
+  }
 }