SPI: fix transfer16

Borrow implementation for samd core Should fix arduino/ArduinoCore-nRF528x-mbedos#85
arduino · Jul 3, 2020 · a15e621 · a15e621
1 parent 18a1d60
commit a15e621
Showing 1 changed file with 12 additions and 3 deletions.
diff --git a/libraries/SPI/SPI.cpp b/libraries/SPI/SPI.cpp
@@ -32,9 +32,18 @@ uint8_t arduino::MbedSPI::transfer(uint8_t data) {
 }
 
 uint16_t arduino::MbedSPI::transfer16(uint16_t data) {
-    uint8_t ret[2];
-    dev->write((const char*)&data, 2, (char*)ret, 2);
-    return ret[0] << 8 | ret[1];
+
+    union { uint16_t val; struct { uint8_t lsb; uint8_t msb; }; } t;
+    t.val = data;
+
+    if (settings.getBitOrder() == LSBFIRST) {
+        t.lsb = transfer(t.lsb);
+        t.msb = transfer(t.msb);
+    } else {
+        t.msb = transfer(t.msb);
+        t.lsb = transfer(t.lsb);
+    }
+    return t.val;
 }
 
 void arduino::MbedSPI::transfer(void *buf, size_t count) {