Reset RF module if we receive only 0xFF

Author: PatrickKa

Sts1CobcSw/Outcome/Outcome.hpp

@@ -105,6 +105,8 @@ enum class ErrorCode : std::int8_t  // NOLINT
     misaligned,
     eraseFailed,
     programFailed,
+    // RF
+    receivedInvalidData,
 };
 
 

Sts1CobcSw/Outcome/Outcome.ipp

@@ -183,6 +183,9 @@ constexpr auto ToCZString(ErrorCode errorCode) -> char const *
             return "eraseFailed";
         case ErrorCode::programFailed:
             return "programFailed";
+        // RF
+        case ErrorCode::receivedInvalidData:
+            return "receivedInvalidData";
     }
     return "unknown error code";
 }

Sts1CobcSw/Rf/Rf.cpp

@@ -28,6 +28,7 @@
 
 #include <rodos_no_using_namespace.h>
 
+#include <algorithm>
 #include <array>
 #include <bit>
 #include <compare>
@@ -345,7 +346,8 @@ auto ExecuteWithRecovery(Args... args)
             return result.value();
         }
     }
-    // Reset COBC
+    // If all attempts failed, reset the whole COBC
+    DEBUG_PRINT("RF error recovery failed, resetting in %lld s\n", errorHandlingCobcResetDelay / s);
     SuspendFor(errorHandlingCobcResetDelay);
     RODOS::hwResetAndReboot();
     __builtin_unreachable();  // Tell the compiler that hwResetAndReboot() never returns
@@ -540,6 +542,17 @@ auto DoReceive(std::span<Byte> data, Duration timeout) -> Result<std::size_t>
             OUTCOME_TRY(ReadAndClearInterruptStatus());
             ReadFromFifo(data.subspan(dataIndex, rxFifoThreshold));
             dataIndex += rxFifoThreshold;
+            if(dataIndex == rxFifoThreshold)
+            {
+                if(std::ranges::all_of(data.subspan(0, dataIndex),
+                                       [](Byte byte) { return byte == 0xFF_b; }))  // NOLINT
+                {
+                    DEBUG_PRINT("Received bytes are all 0xFF\n");
+                    Reset();
+                    (void)DoInitialize();
+                    return ErrorCode::receivedInvalidData;
+                }
+            }
         }
         auto remainingData = data.subspan(dataIndex);
         OUTCOME_TRY(SetRxFifoThreshold(static_cast<Byte>(remainingData.size())));