#433 Added memory sub system tester

src/modules/src/mem_cf2.c

@@ -50,6 +50,9 @@
 #include "assert.h"
 #include "debug.h"
 
+#include "log.h"
+#include "param.h"
+
 #if 0
 #define MEM_DEBUG(fmt, ...) DEBUG_PRINT("D/log " fmt, ## __VA_ARGS__)
 #define MEM_ERROR(fmt, ...) DEBUG_PRINT("E/log " fmt, ## __VA_ARGS__)
@@ -70,7 +73,8 @@
 #define TRAJ_ID         0x03
 #define LOCO2_ID        0x04
 #define LH_ID           0x05
-#define OW_FIRST_ID     0x06
+#define TESTER_ID       0x06
+#define OW_FIRST_ID     0x07
 
 #define STATUS_OK 0
 
@@ -81,6 +85,7 @@
 #define MEM_TYPE_TRAJ   0x12
 #define MEM_TYPE_LOCO2  0x13
 #define MEM_TYPE_LH     0x14
+#define MEM_TYPE_TESTER 0x15
 
 #define MEM_LOCO_INFO             0x0000
 #define MEM_LOCO_ANCHOR_BASE      0x1000
@@ -95,6 +100,7 @@
 #define MEM_LOCO2_ANCHOR_PAGE_SIZE 0x0100
 #define MEM_LOCO2_PAGE_LEN         (3 * sizeof(float) + 1)
 
+#define MEM_TESTER_SIZE            0x1000
 
 //Private functions
 static void memTask(void * prm);
@@ -107,6 +113,11 @@ static void createNbrResponse(CRTPPacket* p);
 static void createInfoResponse(CRTPPacket* p, uint8_t memId);
 static void createInfoResponseBody(CRTPPacket* p, uint8_t type, uint32_t memSize, const uint8_t data[8]);
 
+static uint8_t handleMemTesterRead(uint32_t memAddr, uint8_t readLen, uint8_t* dest);
+static uint8_t handleMemTesterWrite(uint32_t memAddr, uint8_t writeLen, uint8_t* src);
+static uint32_t memTesterWriteErrorCount = 0;
+static uint8_t memTesterWriteReset = 0;
+
 static bool isInit = false;
 
 static uint8_t nbrOwMems = 0;
@@ -218,6 +229,9 @@ void createInfoResponse(CRTPPacket* p, uint8_t memId)
     case LH_ID:
       createInfoResponseBody(p, MEM_TYPE_LH, sizeof(lighthouseBaseStationsGeometry), noData);
       break;
+    case TESTER_ID:
+      createInfoResponseBody(p, MEM_TYPE_TESTER, MEM_TESTER_SIZE, noData);
+      break;
     default:
       if (owGetinfo(memId - OW_FIRST_ID, &serialNbr))
       {
@@ -306,6 +320,10 @@ void memReadProcess()
       }
       break;
 
+    case TESTER_ID:
+      status = handleMemTesterRead(memAddr, readLen, &p.data[6]);
+      break;
+
     default:
       {
         memId = memId - OW_FIRST_ID;
@@ -521,6 +539,10 @@ void memWriteProcess()
       }
       break;
 
+    case TESTER_ID:
+      status = handleMemTesterWrite(memAddr, writeLen, &p.data[5]);
+      break;
+
     case LOCO_ID:
         // Fall through
     case LOCO2_ID:
@@ -545,3 +567,54 @@ void memWriteProcess()
 
   crtpSendPacket(&p);
 }
+
+
+// The memory tester is used to verify the functionality of the memory sub system.
+// It supports "virtual" read and writes that are used by a test script to
+// check that a client (for instance the python lib) is working as expected.
+
+// When reading data from the tester, it simply fills up a buffer with known data so that the
+// client can examine the data and verify that buffers have benn correctly assembled.
+static uint8_t handleMemTesterRead(uint32_t memAddr, uint8_t readLen, uint8_t* dest) {
+  for (int i = 0; i < readLen; i++) {
+    uint32_t addr = memAddr + i;
+    uint8_t data = addr & 0xff;
+    dest[i] = data;
+  }
+
+  return STATUS_OK;
+}
+
+// When writing data to the tester, the tester verifies that the received data
+// contains the expected values.
+static uint8_t handleMemTesterWrite(uint32_t memAddr, uint8_t writeLen, uint8_t* src) {
+  if (memTesterWriteReset) {
+    memTesterWriteReset = 0;
+    memTesterWriteErrorCount = 0;
+  }
+
+  for (int i = 0; i < writeLen; i++) {
+    uint32_t addr = memAddr + i;
+    uint8_t expectedData = addr & 0xff;
+    uint8_t actualData = src[i];
+    if (actualData != expectedData) {
+      // Log first error
+      if (memTesterWriteErrorCount == 0) {
+        DEBUG_PRINT("Verification failed: expected: %d, actual: %d, addr: %lu\n", expectedData, actualData, addr);
+      }
+
+      memTesterWriteErrorCount++;
+      break;
+    }
+  }
+
+  return STATUS_OK;
+}
+
+PARAM_GROUP_START(memTst)
+  PARAM_ADD(PARAM_UINT8, resetW, &memTesterWriteReset)
+PARAM_GROUP_STOP(memTst)
+
+LOG_GROUP_START(memTst)
+  LOG_ADD(LOG_UINT32, errCntW, &memTesterWriteErrorCount)
+LOG_GROUP_STOP(memTst)