[ARM] pxa: ensure SSP TX FIFO is empty instead of not full for pxa3xx

Signed-off-by: eric miao <eric.miao@marvell.com>
Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>

1 files changed, 10 insertions, 0 deletions

diff --git a/arch/arm/mach-pxa/ssp.c b/arch/arm/mach-pxa/ssp.c
index 575b662200a..4954da907d4 100644
--- a/arch/arm/mach-pxa/ssp.c
+++ b/arch/arm/mach-pxa/ssp.c
@@ -138,6 +138,16 @@ int ssp_flush(struct ssp_dev *dev)
         struct ssp_device *ssp = dev->ssp;
         int timeout = TIMEOUT * 2;
 
+        /* ensure TX FIFO is empty instead of not full */
+        if (cpu_is_pxa3xx()) {
+                while (__raw_readl(ssp->mmio_base + SSSR) & 0xf00) {
+                        if (!--timeout)
+                                return -ETIMEDOUT;
+                        cpu_relax();
+                }
+                timeout = TIMEOUT * 2;
+        }
+
         do {
                 while (__raw_readl(ssp->mmio_base + SSSR) & SSSR_RNE) {
                         if (!--timeout)