work in progress for SPI impl - getting there

Author: gigapod

examples/Example05_NavigationSPI/Example05_NavigationSPI.ino

@@ -60,7 +60,7 @@
 // ESP32 IoT RedBoard
 #define IRQ_PIN 26
 #define RST_PIN 27
-#define CS_PIN 6
+#define CS_PIN 25
 
 // rp2350 thing plus
 // #define IRQ_PIN 11
@@ -119,6 +119,7 @@ static void on_is_ready_change(bool isReady)
         {
             // Place the sensor in Navigation mode and print out a menue.
             startNavigation = false;
+            Serial.println("[SETUP]\tStarting Navigation mode...");
             fpc_result_t rc = mySensor.startNavigationMode(0);
 
             // error?
@@ -282,6 +283,8 @@ void loop()
     {
         Serial.print("[ERROR] Sensor Processing Error: ");
         Serial.println(rc);
+        // mySensor.clearData();
+        // reset_sensor();
     }
 
     delay(200);

src/sfTk/sfDevFPC2534.cpp

@@ -32,11 +32,13 @@ fpc_result_t sfDevFPC2534::sendCommand(fpc_cmd_hdr_t &cmd, size_t size)
     frameHeader.payload_size = (uint16_t)size;
 
     // send message header, then payload
+    _comm->beginWrite();
     fpc_result_t rc = _comm->write((uint8_t *)&frameHeader, sizeof(fpc_frame_hdr_t));
 
     if (rc == FPC_RESULT_OK)
         rc = _comm->write((uint8_t *)&cmd, size);
 
+    _comm->endWrite();
     return rc;
 }
 //--------------------------------------------------------------------------------------------
@@ -213,6 +215,8 @@ fpc_result_t sfDevFPC2534::parseStatusCommand(fpc_cmd_hdr_t *cmd_hdr, size_t siz
 
     fpc_cmd_status_response_t *status = (fpc_cmd_status_response_t *)cmd_hdr;
 
+    Serial.printf("Parsing Status Command: Event: 0x%04X, State: 0x%04X, AppFail: 0x%04X\r\n", status->event,
+                  status->state, status->app_fail_code);
     // TODO: Implement secure interface handling
     // if (status->state & STATE_SECURE_INTERFACE)
     // {
@@ -540,8 +544,11 @@ fpc_result_t sfDevFPC2534::parseCommand(uint8_t *payload, size_t size)
     if (payload == nullptr || size == 0)
         return FPC_RESULT_INVALID_PARAM;
 
+    Serial.printf("Parsing command of size %d\n\r", size);
+
     fpc_cmd_hdr_t *cmdHeader = (fpc_cmd_hdr_t *)payload;
 
+    Serial.printf("Command ID: 0x%02X, Type: 0x%02X\n\r", cmdHeader->cmd_id, cmdHeader->type);
     // look legit?
     if (cmdHeader->type != FPC_FRAME_TYPE_CMD_EVENT && cmdHeader->type != FPC_FRAME_TYPE_CMD_RESPONSE)
         return FPC_RESULT_INVALID_PARAM;
@@ -644,8 +651,8 @@ fpc_result_t sfDevFPC2534::processNextResponse(bool flushNone)
         return rc;
 
     // Debug output - helpful when developing
-    // Serial.printf("Frame Header: ver 0x%04X, type 0x%02X, flags 0x%04X, payload size %d\n\r", frameHeader.version,
-    //               frameHeader.type, frameHeader.flags, frameHeader.payload_size);
+    Serial.printf("Frame Header: ver 0x%04X, type 0x%02X, flags 0x%04X, payload size %d\n\r", frameHeader.version,
+                  frameHeader.type, frameHeader.flags, frameHeader.payload_size);
 
     // Sanity check of the header...
     if (frameHeader.version != FPC_FRAME_PROTOCOL_VERSION ||

src/sfTk/sfDevFPC2534SPI.cpp

@@ -12,7 +12,7 @@
 
 // --------------------------------------------------------------------------------------------
 // CTOR
-sfDevFPC2534SPI::sfDevFPC2534SPI() : _spiPort{nullptr}, _csPin{0}
+sfDevFPC2534SPI::sfDevFPC2534SPI() : _inWrite{false}, _spiPort{nullptr}, _csPin{0}
 {
 }
 
@@ -42,7 +42,7 @@ bool sfDevFPC2534SPI::initialize(SPIClass &spiPort, SPISettings &busSPISettings,
 bool sfDevFPC2534SPI::initialize(uint8_t csPin, uint32_t interruptPin, bool bInit)
 {
     // If the transaction settings are not provided by the user they are built here.
-    SPISettings spiSettings = SPISettings(3000000, MSBFIRST, SPI_MODE3);
+    SPISettings spiSettings = SPISettings(3000000, MSBFIRST, SPI_MODE0);
     return initialize(SPI, spiSettings, csPin, interruptPin, bInit);
 }
 //--------------------------------------------------------------------------------------------
@@ -67,29 +67,45 @@ void sfDevFPC2534SPI::clearData()
     clearISRDataAvailable();
 }
 
-//--------------------------------------------------------------------------------------------
-// Write data to the device
-//
-uint16_t sfDevFPC2534SPI::write(const uint8_t *data, size_t len)
+void sfDevFPC2534SPI::beginWrite(void)
 {
+
     if (_spiPort == nullptr)
-        return FPC_RESULT_IO_RUNTIME_FAILURE; // I2C bus not initialized
+        return; // SPI bus not initialized
 
     _spiPort->beginTransaction(_spiSettings);
 
     // Signal communication start
     digitalWrite(_csPin, LOW);
-
     // the  datasheet specifiies a delay greater than 500us after CS goes low
     delayMicroseconds(600);
+    _inWrite = true;
+    Serial.println("Begin SPI Write");
+}
 
-    // now send the data
-    for (size_t i = 0; i < len; i++)
-        _spiPort->transfer(*data++);
-
+void sfDevFPC2534SPI ::endWrite(void)
+{
+    if (_spiPort == nullptr)
+        return; // SPI bus not initialized
     // End comms
     digitalWrite(_csPin, HIGH);
     _spiPort->endTransaction();
+    _inWrite = false;
+    Serial.println("End SPI Write");
+}
+//--------------------------------------------------------------------------------------------
+// Write data to the device
+//
+uint16_t sfDevFPC2534SPI::write(const uint8_t *data, size_t len)
+{
+    if (_spiPort == nullptr)
+        return FPC_RESULT_IO_RUNTIME_FAILURE; // I2C bus not initialized
+
+    Serial.printf("Writing %d bytes to SPI\r\n", len);
+    // now send the data
+
+    for (size_t i = 0; i < len; i++)
+        _spiPort->transfer(*data++);
 
     return FPC_RESULT_OK;
 }
@@ -108,6 +124,9 @@ uint16_t sfDevFPC2534SPI::read(uint8_t *data, size_t len)
     if (data == nullptr)
         return FPC_RESULT_INVALID_PARAM;
 
+    if (_inWrite)
+        endWrite();
+
     _spiPort->beginTransaction(_spiSettings);
 
     // Signal communication start
@@ -116,6 +135,7 @@ uint16_t sfDevFPC2534SPI::read(uint8_t *data, size_t len)
     // the  datasheet specifiies a delay greater than 500us after CS goes low
     delayMicroseconds(600);
 
+    Serial.printf("Reading %d bytes from SPI\r\n", len);
     // Lets read the data...
     for (size_t i = 0; i < len; i++)
         *data++ = _spiPort->transfer(0x00);

src/sfTk/sfDevFPC2534SPI.h

@@ -32,7 +32,12 @@ class sfDevFPC2534SPI : public sfDevFPC2534IComm
     uint16_t write(const uint8_t *data, size_t len);
     uint16_t read(uint8_t *data, size_t len);
 
+    void beginWrite(void) override;
+    void endWrite(void) override;
+
   private:
+    bool _inWrite;
+
     // SPI Things
     SPIClass *_spiPort;
     SPISettings _spiSettings;