mpm: Enabled selection of SPI mode

2 files changed, 10 insertions, 6 deletions

diff --git a/mpm/lib/spi/spi_regs_iface.cpp b/mpm/lib/spi/spi_regs_iface.cpp
index a84a14997..ab9e089f8 100644
--- a/mpm/lib/spi/spi_regs_iface.cpp
+++ b/mpm/lib/spi/spi_regs_iface.cpp
@@ -102,13 +102,14 @@ regs_iface::sptr mpm::spi::make_spi_regs_iface(
 mpm::types::regs_iface::sptr mpm::spi::make_spidev_regs_iface(
     const std::string &device,
     const int speed_hz,
+    const int spi_mode,
     uint32_t addr_shift,
     uint32_t data_shift,
     uint32_t read_flags,
     uint32_t write_flags
 ) {
     auto spi_iface_sptr = mpm::spi::spi_iface::make_spidev(
-        device, speed_hz
+        device, speed_hz, spi_mode
     );
     return std::make_shared<spi_regs_iface_impl>(
         spi_iface_sptr,
diff --git a/mpm/lib/spi/spidev_iface.cpp b/mpm/lib/spi/spidev_iface.cpp
index fe37f16d5..74cb6bc88 100644
--- a/mpm/lib/spi/spidev_iface.cpp
+++ b/mpm/lib/spi/spidev_iface.cpp
@@ -37,8 +37,10 @@ public:
 
     spidev_iface_impl(
             const std::string &device,
-            const int max_speed_hz
-    ) : _speed(max_speed_hz)
+            const int max_speed_hz,
+            const int spi_mode
+    ) : _speed(max_speed_hz),
+        _mode(spi_mode)
     {
 
         if (!init_spi(
@@ -94,7 +96,7 @@ public:
 
 private:
     int _fd;
-    uint32_t _mode = SPI_CPHA | SPI_CPOL;
+    const uint32_t _mode;
     uint32_t _speed = 2000000;
     uint8_t _bits = 8;
     uint16_t _delay = 0;
@@ -105,10 +107,11 @@ private:
  *****************************************************************************/
 spi_iface::sptr spi_iface::make_spidev(
     const std::string &device,
-    const int speed_hz
+    const int speed_hz,
+    const int spi_mode
 ) {
     return std::make_shared<spidev_iface_impl>(
-        device, speed_hz
+        device, speed_hz, spi_mode
     );
 }