[PATCH] bsp/imx: Add cs_change support to SPI

[Christian Mauderer]

---
 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 26ba812f62..4732b84713 100644
--- a/bsps/arm/imx/spi/imx-ecspi.c
+++ b/bsps/arm/imx/spi/imx-ecspi.c
@@ -350,6 +350,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);
@@ -376,9 +379,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;
@@ -407,7 +407,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;
 }
-- 
2.31.1

_______________________________________________
devel mailing list
devel@rtems.org
http://lists.rtems.org/mailman/listinfo/devel