Fix file write() for len > 255

Author: facchinm

src/utility/spi_drv.cpp

@@ -449,6 +449,22 @@ int SpiDrv::waitResponse(uint8_t cmd, uint8_t* numParamRead, uint8_t** params, u
     return 1;
 }
 
+void SpiDrv::sendParamNoLen(uint8_t* param, size_t param_len, uint8_t lastParam)
+{
+    int i = 0;
+    // Send Spi paramLen
+    sendParamLen8(0);
+
+    // Send Spi param data
+    for (i=0; i<param_len; ++i)
+    {
+        spiTransfer(param[i]);
+    }
+
+    // if lastParam==1 Send Spi END CMD
+    if (lastParam == 1)
+        spiTransfer(END_CMD);
+}
 
 void SpiDrv::sendParam(uint8_t* param, uint8_t param_len, uint8_t lastParam)
 {

src/utility/spi_drv.h

@@ -85,6 +85,8 @@ class SpiDrv
 
     static void sendParam(uint8_t* param, uint8_t param_len, uint8_t lastParam = NO_LAST_PARAM);
 
+    static void sendParamNoLen(uint8_t* param, size_t param_len, uint8_t lastParam = NO_LAST_PARAM);
+
     static void sendParamLen8(uint8_t param_len);
 
     static void sendParamLen16(uint16_t param_len);

src/utility/wifi_drv.cpp

@@ -1110,20 +1110,25 @@ int8_t WiFiDrv::downloadFile(const char* url, uint8_t url_len, const char *filen
     return _data;
 }
 
-int8_t WiFiDrv::fileOperation(uint8_t operation, const char *filename, uint8_t filename_len, size_t offset, uint8_t* buffer, uint8_t len)
+int8_t WiFiDrv::fileOperation(uint8_t operation, const char *filename, uint8_t filename_len, size_t offset, uint8_t* buffer, size_t len)
 {
     WAIT_FOR_SLAVE_SELECT();
     // Send Command
-    SpiDrv::sendCmd(operation, PARAM_NUMS_3);
+    uint8_t numParams = PARAM_NUMS_3;
+    if (operation == WRITE_FILE) {
+        numParams = PARAM_NUMS_4;
+    }
+
+    SpiDrv::sendCmd(operation, numParams);
     SpiDrv::sendParam((uint8_t*)&offset, sizeof(offset), NO_LAST_PARAM);
     SpiDrv::sendParam((uint8_t*)&len, sizeof(len), NO_LAST_PARAM);
     SpiDrv::sendParam((uint8_t*)filename, filename_len, (operation == WRITE_FILE) ? NO_LAST_PARAM : LAST_PARAM);
     if (operation == WRITE_FILE) {
-        SpiDrv::sendParam((uint8_t*)buffer, len, LAST_PARAM);
+        SpiDrv::sendParamNoLen((uint8_t*)buffer, len, LAST_PARAM);
     }
 
     // pad to multiple of 4
-    int commandSize = 7 + sizeof(offset) + sizeof(len) + filename_len;
+    int commandSize = 4 + numParams + sizeof(offset) + sizeof(len) + filename_len;
     while (commandSize % 4) {
         SpiDrv::readChar();
         commandSize++;

src/utility/wifi_drv.h

@@ -288,7 +288,7 @@ class WiFiDrv
 
     static int8_t downloadFile(const char* url, uint8_t url_len, const char *filename, uint8_t filename_len);
 
-    static int8_t fileOperation(uint8_t operation, const char *filename, uint8_t filename_len, size_t offset, uint8_t* buffer, uint8_t len);
+    static int8_t fileOperation(uint8_t operation, const char *filename, uint8_t filename_len, size_t offset, uint8_t* buffer, size_t len);
 
     static int8_t readFile(const char *filename, uint8_t filename_len, size_t offset, uint8_t* buffer, size_t buffer_len) {
         return fileOperation(READ_FILE, filename, filename_len, offset, buffer, buffer_len);