fully implemented special request handling

linux/devices/RwPollingTask.cpp

@@ -73,7 +73,7 @@ ReturnValue_t RwPollingTask::performOperation(uint8_t operationCode) {
     if (writeAndReadAllRws(rws::CLEAR_LAST_RESET_STATUS) != returnvalue::OK) {
       continue;
     }
-    // TODO: Special requests
+    handleSpecialRequests();
   }
 
   return returnvalue::OK;
@@ -382,6 +382,54 @@ size_t RwPollingTask::idAndIdxToReadBuffer(DeviceCommandId_t id, uint8_t rwIdx,
   return rws::idToPacketLen(id);
 }
 
+void RwPollingTask::fillSpecialRequestArray() {
+  for (unsigned idx = 0; idx < rwCookies.size(); idx++) {
+    if (skipCommandingForRw[idx]) {
+      specialRequestIds[idx] = DeviceHandlerIF::NO_COMMAND_ID;
+      continue;
+    }
+    switch (rwCookies[idx]->specialRequest) {
+      case (rws::SpecialRwRequest::GET_TM): {
+        specialRequestIds[idx] = rws::GET_TM;
+        break;
+      }
+      case (rws::SpecialRwRequest::INIT_RW_CONTROLLER): {
+        specialRequestIds[idx] = rws::INIT_RW_CONTROLLER;
+        break;
+      }
+      default: {
+        specialRequestIds[idx] = DeviceHandlerIF::NO_COMMAND_ID;
+      }
+    }
+  }
+}
+
+void RwPollingTask::handleSpecialRequests() {
+  int fd = 0;
+  fillSpecialRequestArray();
+  ReturnValue_t result = openSpi(O_RDWR, fd);
+  if (result != returnvalue::OK) {
+    return;
+  }
+  for (unsigned idx = 0; idx < rwCookies.size(); idx++) {
+    if (specialRequestIds[idx] == DeviceHandlerIF::NO_COMMAND_ID) {
+      continue;
+    }
+    prepareSimpleCommand(specialRequestIds[idx]);
+    writeOneRwCmd(idx, fd);
+  }
+  closeSpi(fd);
+  usleep(rws::SPI_REPLY_DELAY);
+  for (unsigned idx = 0; idx < rwCookies.size(); idx++) {
+    if (specialRequestIds[idx] == DeviceHandlerIF::NO_COMMAND_ID) {
+      continue;
+    }
+    uint8_t* replyBuf;
+    size_t maxReadLen = idAndIdxToReadBuffer(specialRequestIds[idx], idx, &replyBuf);
+    readNextReply(*rwCookies[idx], replyBuf, maxReadLen);
+  }
+}
+
 // This closes the SPI
 void RwPollingTask::closeSpi(int fd) {
   // This will perform the function to close the SPI