From 10218d4b4f5cf9dc31b76bad437dfeedb7dc404f Mon Sep 17 00:00:00 2001
From: Thang Tran <TranKimThang279@gmail.com>
Date: Thu, 15 Aug 2019 20:24:57 +0200
Subject: [PATCH] libraries: fixed SPI

to handle other bit lengths rather than 8.
Thanks to @UlliBien for the fix suggestion.

Fixes: https://github.com/esp8266/Arduino/issues/2820
---
 libraries/SPI/SPI.cpp | 44 ++++++++++++++++++++++++-------------------
 1 file changed, 25 insertions(+), 19 deletions(-)

diff --git a/libraries/SPI/SPI.cpp b/libraries/SPI/SPI.cpp
index 0e8d7f1889..1aeb4ce923 100644
--- a/libraries/SPI/SPI.cpp
+++ b/libraries/SPI/SPI.cpp
@@ -307,27 +307,33 @@ uint8_t SPIClass::transfer(uint8_t data) {
 }
 
 uint16_t SPIClass::transfer16(uint16_t data) {
-    union {
-            uint16_t val;
-            struct {
-                    uint8_t lsb;
-                    uint8_t msb;
-            };
-    } in, out;
-    in.val = data;
-
-    if((SPI1C & (SPICWBO | SPICRBO))) {
-        //LSBFIRST
-        out.lsb = transfer(in.lsb);
-        out.msb = transfer(in.msb);
-    } else {
-        //MSBFIRST
-        out.msb = transfer(in.msb);
-        out.lsb = transfer(in.lsb);
-    }
-    return out.val;
+    while (SPI1CMD & SPIBUSY) {}
+    // Set to 16Bits transfer
+    setDataBits(16);
+
+    const bool isBigEndian = !(SPI1C & (SPICWBO | SPICRBO));
+
+    // Change byte order for MSBFIRST
+    if (isBigEndian)
+        SPI1W0 = (data >> 8) | (data << 8);
+    else
+        SPI1W0 = data;
+
+    // Start the transmission
+    SPI1CMD |= SPIBUSY;
+    // Wait for transmission to complete
+    while (SPI1CMD & SPIBUSY) {}
+    data = SPI1W0;
+
+    // Change byte order for MSBFIRST
+    if (isBigEndian)
+        return (data >> 8) | (data << 8);
+
+    // If !isBigEndian, return the normal data.
+    return data;
 }
 
+
 void SPIClass::transfer(void *buf, uint16_t count) {
     uint8_t *cbuf = reinterpret_cast<uint8_t*>(buf);