diff mbox

[v6] hw/ssi/imx_spi.c: fix CS handling during SPI access.

Message ID 20170111200019.31314-1-jcd@tribudubois.net
State New
Headers show

Commit Message

Jean-Christophe Dubois Jan. 11, 2017, 8 p.m. UTC
The i.MX SPI device was not de-asserting the CS line at the end of
memory access.

This triggered a SIGSEGV in Qemu when the sabrelite emulator was acessing
a SPI flash memory.

Whith this path the CS signal is correctly asserted and deasserted arround
memory access.

Assertion level is now based on SPI device configuration.

This was tested by:
* booting linux on Sabrelite Qemu emulator.
* booting xvisor on Sabrelite Qemu emultor.

Signed-off-by: Jean-Christophe Dubois <jcd@tribudubois.net>
Acked-by: Marcin Krzemiński <mar.krzeminski@gmail.com>
---

Changes since v1:
* Fix coding style issue.

Changes since v2:
* get SS line polarity from config reg.

Changes since v3:
* Fix imx_spi_channel_pol() after review

Changes since v4:
* Fix the handling of CS signal in case of multi master burst.
* added a field to the state object
* bump up version_if for state object
* Add a post_load handler

Changes since v5:
* make sure unused CS lines are deasserted during SPI tranfers.

 hw/ssi/imx_spi.c         | 148 ++++++++++++++++++++++++++++++++++++-----------
 include/hw/ssi/imx_spi.h |   4 ++
 2 files changed, 117 insertions(+), 35 deletions(-)

Comments

Peter Maydell Jan. 16, 2017, 5:22 p.m. UTC | #1
On 11 January 2017 at 20:00, Jean-Christophe Dubois <jcd@tribudubois.net> wrote:
> The i.MX SPI device was not de-asserting the CS line at the end of
> memory access.
>
> This triggered a SIGSEGV in Qemu when the sabrelite emulator was acessing
> a SPI flash memory.
>
> Whith this path the CS signal is correctly asserted and deasserted arround
> memory access.
>
> Assertion level is now based on SPI device configuration.
>
> This was tested by:
> * booting linux on Sabrelite Qemu emulator.
> * booting xvisor on Sabrelite Qemu emultor.
>
> Signed-off-by: Jean-Christophe Dubois <jcd@tribudubois.net>
> Acked-by: Marcin Krzemiński <mar.krzeminski@gmail.com>

>  hw/ssi/imx_spi.c         | 148 ++++++++++++++++++++++++++++++++++++-----------
>  include/hw/ssi/imx_spi.h |   4 ++
>  2 files changed, 117 insertions(+), 35 deletions(-)
>
> diff --git a/hw/ssi/imx_spi.c b/hw/ssi/imx_spi.c
> index e4e395f..d54c145 100644
> --- a/hw/ssi/imx_spi.c
> +++ b/hw/ssi/imx_spi.c
> @@ -56,19 +56,6 @@ static const char *imx_spi_reg_name(uint32_t reg)
>      }
>  }
>
> -static const VMStateDescription vmstate_imx_spi = {
> -    .name = TYPE_IMX_SPI,
> -    .version_id = 1,
> -    .minimum_version_id = 1,
> -    .fields = (VMStateField[]) {
> -        VMSTATE_FIFO32(tx_fifo, IMXSPIState),
> -        VMSTATE_FIFO32(rx_fifo, IMXSPIState),
> -        VMSTATE_INT16(burst_length, IMXSPIState),
> -        VMSTATE_UINT32_ARRAY(regs, IMXSPIState, ECSPI_MAX),
> -        VMSTATE_END_OF_LIST()
> -    },
> -};
> -
>  static void imx_spi_txfifo_reset(IMXSPIState *s)
>  {
>      fifo32_reset(&s->tx_fifo);
> @@ -119,6 +106,32 @@ static void imx_spi_update_irq(IMXSPIState *s)
>      DPRINTF("IRQ level is %d\n", level);
>  }
>
> +static int imx_spi_post_load(void *opaque, int version_id)
> +{
> +    IMXSPIState *s = (IMXSPIState *)opaque;
> +
> +    imx_spi_update_irq(s);
> +
> +    /* TODO: We should also restore the CS line level */

I don't think you should need to do anything here -- if
this device's state has been restored and the state at
the other end of the line has been restored, there's nothing
else to do. It's like reset, you don't want to be asserting
irq lines in post_load.

> +    if (imx_spi_is_multiple_master_burst(s)) {
> +        /*
> +         * If we are in multi master burst mode we need to call this
> +         * function at least 2 times before deselecting the CS line.
> +         * In practice the transfert ends (and the CS is deselected)
> +         * when the guest write 0 to the INT reg (according to linux
> +         * driver code).
> +         */
> +        s->txfifo_burst_count++;
> +    }

> @@ -380,6 +433,30 @@ static void imx_spi_write(void *opaque, hwaddr offset, uint64_t value,
>          }
>
>          break;
> +    case ECSPI_INTREG:
> +        s->regs[index] = value;
> +
> +        /* Disable CS lines */
> +        if ((value == 0) && (s->txfifo_burst_count > 1)) {
> +            /*
> +             * When 0 is writen to the INT register (disabling all
> +             * interrupts) we need to deselect the device CS line.
> +             * But only if the txfifo function has been called at
> +             * least twice.
> +             * Note: This seems a bit hacky and I would preffer to
> +             * rely on something else to deselect the CS line. But it
> +             * works correctly with the linux driver.
> +             */
> +
> +            /* Deactivate the current CS line */
> +            qemu_set_irq(s->cs_lines[imx_spi_selected_channel(s)],
> +                         !imx_spi_current_channel_pol(s));
> +
> +            /* reset the txfifo count to 0 */
> +            s->txfifo_burst_count = 0;
> +        }

I think this is a bad idea. We have one or two devices which have
similar kinds of hacky code in them that knows what the Linux
driver does. The problem is then twofold:
 (1) if the Linux driver changes then the hacks break
 (2) it's almost impossible to remove the hacks later, because
     the reasoning behind them (which guest kernels are affected,
     etc) gets lost and you don't know whether you're going to
     break previously-working setups if you try to remove the
     hack code

I think we really should try to get this right from the start
(ie "behave like the hardware does").

thanks
-- PMM
mar.krzeminski Jan. 16, 2017, 7:06 p.m. UTC | #2
W dniu 16.01.2017 o 18:22, Peter Maydell pisze:
> On 11 January 2017 at 20:00, Jean-Christophe Dubois <jcd@tribudubois.net> wrote:
>> The i.MX SPI device was not de-asserting the CS line at the end of
>> memory access.
>>
>> This triggered a SIGSEGV in Qemu when the sabrelite emulator was acessing
>> a SPI flash memory.
>>
>> Whith this path the CS signal is correctly asserted and deasserted arround
>> memory access.
>>
>> Assertion level is now based on SPI device configuration.
>>
>> This was tested by:
>> * booting linux on Sabrelite Qemu emulator.
>> * booting xvisor on Sabrelite Qemu emultor.
>>
>> Signed-off-by: Jean-Christophe Dubois <jcd@tribudubois.net>
>> Acked-by: Marcin Krzemiński <mar.krzeminski@gmail.com>
I think it could be nice to split this in two patches - one regarding CS 
line and one about multi master mode.
My Acked-By apply to the not handled CS line in model only.
>>   hw/ssi/imx_spi.c         | 148 ++++++++++++++++++++++++++++++++++++-----------
>>   include/hw/ssi/imx_spi.h |   4 ++
>>   2 files changed, 117 insertions(+), 35 deletions(-)
>>
>> diff --git a/hw/ssi/imx_spi.c b/hw/ssi/imx_spi.c
>> index e4e395f..d54c145 100644
>> --- a/hw/ssi/imx_spi.c
>> +++ b/hw/ssi/imx_spi.c
>> @@ -56,19 +56,6 @@ static const char *imx_spi_reg_name(uint32_t reg)
>>       }
>>   }
>>
>> -static const VMStateDescription vmstate_imx_spi = {
>> -    .name = TYPE_IMX_SPI,
>> -    .version_id = 1,
>> -    .minimum_version_id = 1,
>> -    .fields = (VMStateField[]) {
>> -        VMSTATE_FIFO32(tx_fifo, IMXSPIState),
>> -        VMSTATE_FIFO32(rx_fifo, IMXSPIState),
>> -        VMSTATE_INT16(burst_length, IMXSPIState),
>> -        VMSTATE_UINT32_ARRAY(regs, IMXSPIState, ECSPI_MAX),
>> -        VMSTATE_END_OF_LIST()
>> -    },
>> -};
>> -
>>   static void imx_spi_txfifo_reset(IMXSPIState *s)
>>   {
>>       fifo32_reset(&s->tx_fifo);
>> @@ -119,6 +106,32 @@ static void imx_spi_update_irq(IMXSPIState *s)
>>       DPRINTF("IRQ level is %d\n", level);
>>   }
>>
>> +static int imx_spi_post_load(void *opaque, int version_id)
>> +{
>> +    IMXSPIState *s = (IMXSPIState *)opaque;
>> +
>> +    imx_spi_update_irq(s);
>> +
>> +    /* TODO: We should also restore the CS line level */
> I don't think you should need to do anything here -- if
> this device's state has been restored and the state at
> the other end of the line has been restored, there's nothing
> else to do. It's like reset, you don't want to be asserting
> irq lines in post_load.
>
>> +    if (imx_spi_is_multiple_master_burst(s)) {
>> +        /*
>> +         * If we are in multi master burst mode we need to call this
>> +         * function at least 2 times before deselecting the CS line.
>> +         * In practice the transfert ends (and the CS is deselected)
>> +         * when the guest write 0 to the INT reg (according to linux
>> +         * driver code).
>> +         */
>> +        s->txfifo_burst_count++;
>> +    }
>> @@ -380,6 +433,30 @@ static void imx_spi_write(void *opaque, hwaddr offset, uint64_t value,
>>           }
>>
>>           break;
>> +    case ECSPI_INTREG:
>> +        s->regs[index] = value;
>> +
>> +        /* Disable CS lines */
>> +        if ((value == 0) && (s->txfifo_burst_count > 1)) {
>> +            /*
>> +             * When 0 is writen to the INT register (disabling all
>> +             * interrupts) we need to deselect the device CS line.
>> +             * But only if the txfifo function has been called at
>> +             * least twice.
>> +             * Note: This seems a bit hacky and I would preffer to
>> +             * rely on something else to deselect the CS line. But it
>> +             * works correctly with the linux driver.
>> +             */
I am not sure, but this hack is because Linux driver on real HW push 
data to FIFO when
transmission is ongoing?
>> +
>> +            /* Deactivate the current CS line */
>> +            qemu_set_irq(s->cs_lines[imx_spi_selected_channel(s)],
>> +                         !imx_spi_current_channel_pol(s));
>> +
>> +            /* reset the txfifo count to 0 */
>> +            s->txfifo_burst_count = 0;
>> +        }
> I think this is a bad idea. We have one or two devices which have
> similar kinds of hacky code in them that knows what the Linux
> driver does. The problem is then twofold:
>   (1) if the Linux driver changes then the hacks break
>   (2) it's almost impossible to remove the hacks later, because
>       the reasoning behind them (which guest kernels are affected,
>       etc) gets lost and you don't know whether you're going to
>       break previously-working setups if you try to remove the
>       hack code
>
> I think we really should try to get this right from the start
> (ie "behave like the hardware does").
Totally agree, I was also doing similar hacks at the beginning and it 
went exactly like
Peter said. Since every Linux driver update I needed to fix Qemu models.

Thanks,
Marcin
>
> thanks
> -- PMM
>
Jean-Christophe Dubois Jan. 19, 2017, 9:15 p.m. UTC | #3
Le 16/01/2017 à 20:06, mar.krzeminski a écrit :
> W dniu 16.01.2017 o 18:22, Peter Maydell pisze:
>> On 11 January 2017 at 20:00, Jean-Christophe Dubois 
>> <jcd@tribudubois.net> wrote:
>>> The i.MX SPI device was not de-asserting the CS line at the end of
>>> memory access.
>>>
>>> This triggered a SIGSEGV in Qemu when the sabrelite emulator was 
>>> acessing
>>> a SPI flash memory.
>>>
>>> Whith this path the CS signal is correctly asserted and deasserted 
>>> arround
>>> memory access.
>>>
>>> Assertion level is now based on SPI device configuration.
>>>
>>> This was tested by:
>>> * booting linux on Sabrelite Qemu emulator.
>>> * booting xvisor on Sabrelite Qemu emultor.
>>>
>>> Signed-off-by: Jean-Christophe Dubois <jcd@tribudubois.net>
>>> Acked-by: Marcin Krzemiński <mar.krzeminski@gmail.com>
> I think it could be nice to split this in two patches - one regarding 
> CS line and one about multi master mode.
> My Acked-By apply to the not handled CS line in model only.

But these 2 functions are tied together. The CS handling is dependent to 
the multi master burst. The CS signal need to be active during the all 
multi master burst.
>>>   hw/ssi/imx_spi.c         | 148 
>>> ++++++++++++++++++++++++++++++++++++-----------
>>>   include/hw/ssi/imx_spi.h |   4 ++
>>>   2 files changed, 117 insertions(+), 35 deletions(-)
>>>
>>> diff --git a/hw/ssi/imx_spi.c b/hw/ssi/imx_spi.c
>>> index e4e395f..d54c145 100644
>>> --- a/hw/ssi/imx_spi.c
>>> +++ b/hw/ssi/imx_spi.c
>>> @@ -56,19 +56,6 @@ static const char *imx_spi_reg_name(uint32_t reg)
>>>       }
>>>   }
>>>
>>> -static const VMStateDescription vmstate_imx_spi = {
>>> -    .name = TYPE_IMX_SPI,
>>> -    .version_id = 1,
>>> -    .minimum_version_id = 1,
>>> -    .fields = (VMStateField[]) {
>>> -        VMSTATE_FIFO32(tx_fifo, IMXSPIState),
>>> -        VMSTATE_FIFO32(rx_fifo, IMXSPIState),
>>> -        VMSTATE_INT16(burst_length, IMXSPIState),
>>> -        VMSTATE_UINT32_ARRAY(regs, IMXSPIState, ECSPI_MAX),
>>> -        VMSTATE_END_OF_LIST()
>>> -    },
>>> -};
>>> -
>>>   static void imx_spi_txfifo_reset(IMXSPIState *s)
>>>   {
>>>       fifo32_reset(&s->tx_fifo);
>>> @@ -119,6 +106,32 @@ static void imx_spi_update_irq(IMXSPIState *s)
>>>       DPRINTF("IRQ level is %d\n", level);
>>>   }
>>>
>>> +static int imx_spi_post_load(void *opaque, int version_id)
>>> +{
>>> +    IMXSPIState *s = (IMXSPIState *)opaque;
>>> +
>>> +    imx_spi_update_irq(s);
>>> +
>>> +    /* TODO: We should also restore the CS line level */
>> I don't think you should need to do anything here -- if
>> this device's state has been restored and the state at
>> the other end of the line has been restored, there's nothing
>> else to do. It's like reset, you don't want to be asserting
>> irq lines in post_load.

Ok, I'll remove the comment.

>>
>>> +    if (imx_spi_is_multiple_master_burst(s)) {
>>> +        /*
>>> +         * If we are in multi master burst mode we need to call this
>>> +         * function at least 2 times before deselecting the CS line.
>>> +         * In practice the transfert ends (and the CS is deselected)
>>> +         * when the guest write 0 to the INT reg (according to linux
>>> +         * driver code).
>>> +         */
>>> +        s->txfifo_burst_count++;
>>> +    }
>>> @@ -380,6 +433,30 @@ static void imx_spi_write(void *opaque, hwaddr 
>>> offset, uint64_t value,
>>>           }
>>>
>>>           break;
>>> +    case ECSPI_INTREG:
>>> +        s->regs[index] = value;
>>> +
>>> +        /* Disable CS lines */
>>> +        if ((value == 0) && (s->txfifo_burst_count > 1)) {
>>> +            /*
>>> +             * When 0 is writen to the INT register (disabling all
>>> +             * interrupts) we need to deselect the device CS line.
>>> +             * But only if the txfifo function has been called at
>>> +             * least twice.
>>> +             * Note: This seems a bit hacky and I would preffer to
>>> +             * rely on something else to deselect the CS line. But it
>>> +             * works correctly with the linux driver.
>>> +             */
> I am not sure, but this hack is because Linux driver on real HW push 
> data to FIFO when
> transmission is ongoing?

Well in fact not really. It is waiting for the TE interrupt handler 
(TXFIFO is empty so there is not really anymore data in flight) and in 
this handler it will empty the RXFIFO and refill the TXFIFO if there is 
more to write/read. When there is no more data to write to the TXFIFO, 
it will disable the interrupts (write 0 to INTREG). This is when (on 
only then) that the CS line needs to be deselected.

For example the driver might do a 4096 bytes read (64 * 64 bytes) on one 
burst (only one read instruction + address at the beginning).

>>> +
>>> +            /* Deactivate the current CS line */
>>> + qemu_set_irq(s->cs_lines[imx_spi_selected_channel(s)],
>>> +                         !imx_spi_current_channel_pol(s));
>>> +
>>> +            /* reset the txfifo count to 0 */
>>> +            s->txfifo_burst_count = 0;
>>> +        }
>> I think this is a bad idea. We have one or two devices which have
>> similar kinds of hacky code in them that knows what the Linux
>> driver does. The problem is then twofold:
>>   (1) if the Linux driver changes then the hacks break
>>   (2) it's almost impossible to remove the hacks later, because
>>       the reasoning behind them (which guest kernels are affected,
>>       etc) gets lost and you don't know whether you're going to
>>       break previously-working setups if you try to remove the
>>       hack code
>>
>> I think we really should try to get this right from the start
>> (ie "behave like the hardware does").
> Totally agree, I was also doing similar hacks at the beginning and it 
> went exactly like
> Peter said. Since every Linux driver update I needed to fix Qemu models.

Well, for now I have not found a better way to handle the CS signals 
correctly.

>
> Thanks,
> Marcin
>>
>> thanks
>> -- PMM
>>
>
>
>
diff mbox

Patch

diff --git a/hw/ssi/imx_spi.c b/hw/ssi/imx_spi.c
index e4e395f..d54c145 100644
--- a/hw/ssi/imx_spi.c
+++ b/hw/ssi/imx_spi.c
@@ -56,19 +56,6 @@  static const char *imx_spi_reg_name(uint32_t reg)
     }
 }
 
-static const VMStateDescription vmstate_imx_spi = {
-    .name = TYPE_IMX_SPI,
-    .version_id = 1,
-    .minimum_version_id = 1,
-    .fields = (VMStateField[]) {
-        VMSTATE_FIFO32(tx_fifo, IMXSPIState),
-        VMSTATE_FIFO32(rx_fifo, IMXSPIState),
-        VMSTATE_INT16(burst_length, IMXSPIState),
-        VMSTATE_UINT32_ARRAY(regs, IMXSPIState, ECSPI_MAX),
-        VMSTATE_END_OF_LIST()
-    },
-};
-
 static void imx_spi_txfifo_reset(IMXSPIState *s)
 {
     fifo32_reset(&s->tx_fifo);
@@ -119,6 +106,32 @@  static void imx_spi_update_irq(IMXSPIState *s)
     DPRINTF("IRQ level is %d\n", level);
 }
 
+static int imx_spi_post_load(void *opaque, int version_id)
+{
+    IMXSPIState *s = (IMXSPIState *)opaque;
+
+    imx_spi_update_irq(s);
+
+    /* TODO: We should also restore the CS line level */
+
+    return 0;
+}
+
+static const VMStateDescription vmstate_imx_spi = {
+    .name = TYPE_IMX_SPI,
+    .version_id = 2,
+    .minimum_version_id = 2,
+    .fields = (VMStateField[]) {
+        VMSTATE_FIFO32(tx_fifo, IMXSPIState),
+        VMSTATE_FIFO32(rx_fifo, IMXSPIState),
+        VMSTATE_INT16(burst_length, IMXSPIState),
+        VMSTATE_UINT32_ARRAY(regs, IMXSPIState, ECSPI_MAX),
+        VMSTATE_INT16(txfifo_burst_count, IMXSPIState),
+        VMSTATE_END_OF_LIST()
+    },
+    .post_load = imx_spi_post_load,
+};
+
 static uint8_t imx_spi_selected_channel(IMXSPIState *s)
 {
     return EXTRACT(s->regs[ECSPI_CONREG], ECSPI_CONREG_CHANNEL_SELECT);
@@ -141,6 +154,18 @@  static bool imx_spi_channel_is_master(IMXSPIState *s)
     return (mode & (1 << imx_spi_selected_channel(s))) ? true : false;
 }
 
+static uint8_t imx_spi_channel_pol(IMXSPIState *s, uint8_t channel)
+{
+    uint8_t pol = EXTRACT(s->regs[ECSPI_CONFIGREG], ECSPI_CONFIGREG_SS_POL);
+
+    return pol & (1 << channel) ? 1 : 0;
+}
+
+static uint8_t imx_spi_current_channel_pol(IMXSPIState *s)
+{
+    return imx_spi_channel_pol(s, imx_spi_selected_channel(s));
+}
+
 static bool imx_spi_is_multiple_master_burst(IMXSPIState *s)
 {
     uint8_t wave = EXTRACT(s->regs[ECSPI_CONFIGREG], ECSPI_CONFIGREG_SS_CTL);
@@ -152,24 +177,49 @@  static bool imx_spi_is_multiple_master_burst(IMXSPIState *s)
 
 static void imx_spi_flush_txfifo(IMXSPIState *s)
 {
-    uint32_t tx;
-    uint32_t rx;
+    uint32_t index;
 
     DPRINTF("Begin: TX Fifo Size = %d, RX Fifo Size = %d\n",
             fifo32_num_used(&s->tx_fifo), fifo32_num_used(&s->rx_fifo));
 
+    /* make sure all unused CS lines are deasserted */
+    for (index = 0; index < 4; index++) {
+        if (index != imx_spi_selected_channel(s)) {
+            /* Deselect all Device CS line but the current one */
+            qemu_set_irq(s->cs_lines[index],
+                         !imx_spi_channel_pol(s, index));
+            /*
+             * Note: the current one will be asserted a bit later
+             * in the while loop below.
+             */
+        }
+    }
+
+    if (imx_spi_is_multiple_master_burst(s)) {
+        /*
+         * If we are in multi master burst mode we need to call this
+         * function at least 2 times before deselecting the CS line.
+         * In practice the transfert ends (and the CS is deselected)
+         * when the guest write 0 to the INT reg (according to linux
+         * driver code).
+         */
+        s->txfifo_burst_count++;
+    }
+
     while (!fifo32_is_empty(&s->tx_fifo)) {
-        int tx_burst = 0;
-        int index = 0;
+        uint32_t tx;
+        uint32_t rx = 0;
+        uint32_t tx_burst = 0;
+        uint32_t index = 0;
 
         if (s->burst_length <= 0) {
             s->burst_length = imx_spi_burst_length(s);
 
             DPRINTF("Burst length = %d\n", s->burst_length);
 
-            if (imx_spi_is_multiple_master_burst(s)) {
-                s->regs[ECSPI_CONREG] |= ECSPI_CONREG_XCH;
-            }
+            /* Activate the requested CS line if not already active */
+            qemu_set_irq(s->cs_lines[imx_spi_selected_channel(s)],
+                         imx_spi_current_channel_pol(s));
         }
 
         tx = fifo32_pop(&s->tx_fifo);
@@ -178,8 +228,6 @@  static void imx_spi_flush_txfifo(IMXSPIState *s)
 
         tx_burst = MIN(s->burst_length, 32);
 
-        rx = 0;
-
         while (tx_burst) {
             uint8_t byte = tx & 0xff;
 
@@ -208,17 +256,20 @@  static void imx_spi_flush_txfifo(IMXSPIState *s)
         }
 
         if (s->burst_length <= 0) {
-            s->regs[ECSPI_CONREG] &= ~ECSPI_CONREG_XCH;
-
             if (!imx_spi_is_multiple_master_burst(s)) {
-                s->regs[ECSPI_STATREG] |= ECSPI_STATREG_TC;
-                break;
+                /*
+                 * If we are not in muti master mode we need to
+                 * deselect SS lines at each burst
+                 */
+                qemu_set_irq(s->cs_lines[imx_spi_selected_channel(s)],
+                            !imx_spi_current_channel_pol(s));
             }
         }
     }
 
     if (fifo32_is_empty(&s->tx_fifo)) {
         s->regs[ECSPI_STATREG] |= ECSPI_STATREG_TC;
+        s->regs[ECSPI_CONREG] &= ~ECSPI_CONREG_XCH;
     }
 
     /* TODO: We should also use TDR and RDR bits */
@@ -243,6 +294,7 @@  static void imx_spi_reset(DeviceState *dev)
     imx_spi_update_irq(s);
 
     s->burst_length = 0;
+    s->txfifo_burst_count = 0;
 }
 
 static uint64_t imx_spi_read(void *opaque, hwaddr offset, unsigned size)
@@ -346,28 +398,29 @@  static void imx_spi_write(void *opaque, hwaddr offset, uint64_t value,
     case ECSPI_STATREG:
         /* the RO and TC bits are write-one-to-clear */
         value &= ECSPI_STATREG_RO | ECSPI_STATREG_TC;
-        s->regs[ECSPI_STATREG] &= ~value;
+        s->regs[index] &= ~value;
 
         break;
     case ECSPI_CONREG:
-        s->regs[ECSPI_CONREG] = value;
+        s->regs[index] = value;
 
         if (!imx_spi_is_enabled(s)) {
+            uint32_t i;
+
             /* device is disabled, so this is a reset */
             imx_spi_reset(DEVICE(s));
+
+            /* Disable all CS lines */
+            for (i = 0; i < 4; i++) {
+                qemu_set_irq(s->cs_lines[i], !imx_spi_channel_pol(s, i));
+            }
+
             return;
         }
 
         if (imx_spi_channel_is_master(s)) {
-            int i;
-
             /* We are in master mode */
 
-            for (i = 0; i < 4; i++) {
-                qemu_set_irq(s->cs_lines[i],
-                             i == imx_spi_selected_channel(s) ? 0 : 1);
-            }
-
             if ((value & change_mask & ECSPI_CONREG_SMC) &&
                 !fifo32_is_empty(&s->tx_fifo)) {
                 /* SMC bit is set and TX FIFO has some slots filled in */
@@ -380,6 +433,30 @@  static void imx_spi_write(void *opaque, hwaddr offset, uint64_t value,
         }
 
         break;
+    case ECSPI_INTREG:
+        s->regs[index] = value;
+
+        /* Disable CS lines */
+        if ((value == 0) && (s->txfifo_burst_count > 1)) {
+            /*
+             * When 0 is writen to the INT register (disabling all
+             * interrupts) we need to deselect the device CS line.
+             * But only if the txfifo function has been called at
+             * least twice.
+             * Note: This seems a bit hacky and I would preffer to
+             * rely on something else to deselect the CS line. But it
+             * works correctly with the linux driver.
+             */
+
+            /* Deactivate the current CS line */
+            qemu_set_irq(s->cs_lines[imx_spi_selected_channel(s)],
+                         !imx_spi_current_channel_pol(s));
+
+            /* reset the txfifo count to 0 */
+            s->txfifo_burst_count = 0;
+        }
+
+        break;
     default:
         s->regs[index] = value;
 
@@ -425,6 +502,7 @@  static void imx_spi_realize(DeviceState *dev, Error **errp)
     }
 
     s->burst_length = 0;
+    s->txfifo_burst_count = 0;
 
     fifo32_create(&s->tx_fifo, ECSPI_FIFO_SIZE);
     fifo32_create(&s->rx_fifo, ECSPI_FIFO_SIZE);
diff --git a/include/hw/ssi/imx_spi.h b/include/hw/ssi/imx_spi.h
index 7103953..cfebd07 100644
--- a/include/hw/ssi/imx_spi.h
+++ b/include/hw/ssi/imx_spi.h
@@ -46,6 +46,8 @@ 
 /* ECSPI_CONFIGREG */
 #define ECSPI_CONFIGREG_SS_CTL_SHIFT 8
 #define ECSPI_CONFIGREG_SS_CTL_LENGTH 4
+#define ECSPI_CONFIGREG_SS_POL_SHIFT 12
+#define ECSPI_CONFIGREG_SS_POL_LENGTH 4
 
 /* ECSPI_INTREG */
 #define ECSPI_INTREG_TEEN (1 << 0)
@@ -98,6 +100,8 @@  typedef struct IMXSPIState {
     Fifo32 tx_fifo;
 
     int16_t burst_length;
+
+    int16_t txfifo_burst_count;
 } IMXSPIState;
 
 #endif /* IMX_SPI_H */