[rtems commit] bsp/imx: Add cs_change support to SPI

[Christian Mauderer]

Module:    rtems
Branch:    master
Commit:    1fc3f171270b651ae871e5131da55b5825a11686
Changeset: http://git.rtems.org/rtems/commit/?id=1fc3f171270b651ae871e5131da55b5825a11686

Author:    Christian Mauderer <christian.mauderer at embedded-brains.de>
Date:      Tue Sep 28 14:19:47 2021 +0200

bsp/imx: Add cs_change support to SPI

---

 bsps/arm/imx/spi/imx-ecspi.c | 10 ++++++----
 1 file changed, 6 insertions(+), 4 deletions(-)

diff --git a/bsps/arm/imx/spi/imx-ecspi.c b/bsps/arm/imx/spi/imx-ecspi.c
index 1ffc4d9..243f508 100644
--- a/bsps/arm/imx/spi/imx-ecspi.c
+++ b/bsps/arm/imx/spi/imx-ecspi.c
@@ -351,6 +351,9 @@ static void imx_ecspi_interrupt(void *arg)
   } else if (bus->in_transfer > 0) {
     regs->intreg = IMX_ECSPI_RR;
   } else {
+    if (bus->msg->cs_change) {
+      imx_ecspi_set_chipsel(bus, IMX_ECSPI_CS_NONE);
+    }
     --bus->msg_todo;
     ++bus->msg;
     imx_ecspi_next_msg(bus, regs);
@@ -377,9 +380,6 @@ static int imx_ecspi_check_messages(
         (msg->cs > IMX_ECSPI_MAX_CHIPSELECTS || !bus->cspins[msg->cs].valid)) {
       return -EINVAL;
     }
-    if (msg->cs_change != 0) {
-      return -EINVAL;
-    }
 
     ++msg;
     --size;
@@ -408,7 +408,9 @@ static int imx_ecspi_transfer(
 
     imx_ecspi_next_msg(bus, bus->regs);
     rtems_event_transient_receive(RTEMS_WAIT, RTEMS_NO_TIMEOUT);
-    imx_ecspi_set_chipsel(bus, IMX_ECSPI_CS_NONE);
+    if (msgs[n-1].cs_change) {
+      imx_ecspi_set_chipsel(bus, IMX_ECSPI_CS_NONE);
+    }
   }
   return rv;
 }