Revert "Reduce delays and remove them where not needed"

This reverts commit 1c3bb5c.

Author: giulcioffi

src/Arduino_BHY2Host.cpp

@@ -48,7 +48,6 @@ void Arduino_BHY2Host::update()
       eslovHandler.update();
     } else {
       uint8_t available = availableSensorData();
-      delay(1);
       for (int i = 0; i < available; i++) {
         SensorDataPacket data;
         readSensorData(data);

src/EslovHandler.cpp

@@ -1,6 +1,6 @@
 #include "EslovHandler.h"
 
-#define ESLOV_DELAY (1)
+#define ESLOV_DELAY (10)
 
 EslovHandler::EslovHandler() :
   _rxIndex(0),
@@ -70,6 +70,8 @@ void EslovHandler::update()
         dump();
 
         _rxIndex = 0;
+
+        delay(ESLOV_DELAY);
 
         Serial.write(ack);
       }
@@ -84,15 +86,9 @@ void EslovHandler::update()
 
       SensorDataPacket sensorData;
       while (availableData) {
+        //delay(ESLOV_DELAY);
         requestSensorData(sensorData);
-        /*
-        This delay is needed because the synchronization mechanism over the Eslov Int Pin
-        may not apply for the requests from the host board to Nicla.
-        It may happen that the onRequest callback on Nicla side is serviced after a certain delay.
-        We need to add this delay of 10ms to avoid that a second request is issued before
-        the first one is handled.
-        */
-        delay(10);
+        delay(ESLOV_DELAY);
         Serial.write((uint8_t*)&sensorData, sizeof(SensorDataPacket));
         availableData--;
       }
@@ -111,7 +107,7 @@ void EslovHandler::update()
       while (availableData) {
         //delay(ESLOV_DELAY);
         requestSensorLongData(sensorData);
-        delay(10);
+        delay(ESLOV_DELAY);
         Serial.write((uint8_t*)&sensorData, sizeof(SensorLongDataPacket));
         availableData--;
       }
@@ -184,28 +180,31 @@ void EslovHandler::writeDfuPacket(uint8_t *data, uint8_t length)
 
 void EslovHandler::writeStateChange(EslovState state)
 {
+  delay(ESLOV_DELAY);
   while(!digitalRead(_eslovIntPin)) {}
   uint8_t packet[2] = {ESLOV_SENSOR_STATE_OPCODE, state};
   Wire.beginTransmission(ESLOV_DEFAULT_ADDRESS);
   Wire.write((uint8_t*)packet, sizeof(packet));
   Wire.endTransmission();
+  delay(ESLOV_DELAY);
   _eslovState = state;
 }
 
 void EslovHandler::writeConfigPacket(SensorConfigurationPacket& config)
 {
-  while(!digitalRead(_eslovIntPin)) {}
+  delay(ESLOV_DELAY);
   uint8_t packet[sizeof(SensorConfigurationPacket) + 1]; 
   packet[0] = ESLOV_SENSOR_CONFIG_OPCODE;
   memcpy(&packet[1], &config, sizeof(SensorConfigurationPacket));
   Wire.beginTransmission(ESLOV_DEFAULT_ADDRESS);
   Wire.write(packet, sizeof(SensorConfigurationPacket) + 1);
   Wire.endTransmission();
+  delay(ESLOV_DELAY);
 }
 
 uint8_t EslovHandler::requestPacketAck()
-{
-  while(!digitalRead(_eslovIntPin)) {}
+{ 
+  delay(ESLOV_DELAY);
   uint8_t ret = 0;
   while(!ret) {
     ret = Wire.requestFrom(ESLOV_DEFAULT_ADDRESS, 1);
@@ -224,6 +223,7 @@ uint8_t EslovHandler::requestAvailableData()
   uint8_t ret = Wire.requestFrom(ESLOV_DEFAULT_ADDRESS, 1);
   if (!ret) return 0;
   return Wire.read();
+  delay(ESLOV_DELAY);
 }
 
 uint8_t EslovHandler::requestAvailableLongData() 
@@ -240,8 +240,9 @@ bool EslovHandler::requestSensorData(SensorDataPacket &sData)
 {
   if (_eslovState != ESLOV_READ_SENSOR_STATE) {
     writeStateChange(ESLOV_READ_SENSOR_STATE);
+    while(!digitalRead(_eslovIntPin)) {}
   }
-  while(!digitalRead(_eslovIntPin)) {}
+  //uint8_t ret = Wire.requestFrom(ESLOV_DEFAULT_ADDRESS, sizeof(SensorDataPacket));
   uint8_t ret = Wire.requestFrom(ESLOV_DEFAULT_ADDRESS, sizeof(SensorDataPacket));
   if (!ret) return false;
 
@@ -256,8 +257,8 @@ bool EslovHandler::requestSensorLongData(SensorLongDataPacket &sData)
 {
   if (_eslovState != ESLOV_READ_LONG_SENSOR_STATE) {
     writeStateChange(ESLOV_READ_LONG_SENSOR_STATE);
+    while(!digitalRead(_eslovIntPin)) {}
   }
-  while(!digitalRead(_eslovIntPin)) {}
   uint8_t ret = Wire.requestFrom(ESLOV_DEFAULT_ADDRESS, sizeof(SensorLongDataPacket));
   if (!ret) return false;