crypto: s5p-sss - Look for the next request in the queue

Currently, the driver enqueues a request only if the busy bit is
false. And every request initiates a dequeue. If 2 requests arrive
simultaneously, only one of them will be dequeued.

To avoid this senario, we will enqueue the next request irrespective
of the system condition (that is what queue is here for). Also
schedule at a tasklet immediatly after the current request is done.
The tasklet will dequeue the next request in the queue, giving
continuous loop. tasklet will exit if there are no requests in the
queue.

Signed-off-by: Naveen Krishna Chatradhi <ch.naveen@samsung.com>
CC: David S. Miller <davem@davemloft.net>
CC: <linux-samsung-soc@vger.kernel.org>
Acked-by: Vladimir Zapolskiy <vz@mleia.com>
Signed-off-by: Herbert Xu <herbert@gondor.apana.org.au>

diff --git a/drivers/crypto/s5p-sss.c b/drivers/crypto/s5p-sss.c
index ea7d4788f3111fa0011520194434fe7294f4ec98..47c568ec2474cc6c7899250b1cdb0e39974af34d 100644 (file)
--- a/drivers/crypto/s5p-sss.c
+++ b/drivers/crypto/s5p-sss.c
@@ -330,8 +330,12 @@ static void s5p_aes_tx(struct s5p_aes_dev *dev)
                }
 
                s5p_set_dma_outdata(dev, dev->sg_dst);
-       } else
+       } else {
                s5p_aes_complete(dev, err);
+
+               dev->busy = true;
+               tasklet_schedule(&dev->tasklet);
+       }
 }
 
 static void s5p_aes_rx(struct s5p_aes_dev *dev)
@@ -469,10 +473,13 @@ static void s5p_tasklet_cb(unsigned long data)
        spin_lock_irqsave(&dev->lock, flags);
        backlog   = crypto_get_backlog(&dev->queue);
        async_req = crypto_dequeue_request(&dev->queue);
-       spin_unlock_irqrestore(&dev->lock, flags);
 
-       if (!async_req)
+       if (!async_req) {
+               dev->busy = false;
+               spin_unlock_irqrestore(&dev->lock, flags);
                return;
+       }
+       spin_unlock_irqrestore(&dev->lock, flags);
 
        if (backlog)
                backlog->complete(backlog, -EINPROGRESS);
@@ -491,14 +498,13 @@ static int s5p_aes_handle_req(struct s5p_aes_dev *dev,
        int err;
 
        spin_lock_irqsave(&dev->lock, flags);
+       err = ablkcipher_enqueue_request(&dev->queue, req);
        if (dev->busy) {
-               err = -EAGAIN;
                spin_unlock_irqrestore(&dev->lock, flags);
                goto exit;
        }
        dev->busy = true;
 
-       err = ablkcipher_enqueue_request(&dev->queue, req);
        spin_unlock_irqrestore(&dev->lock, flags);
 
        tasklet_schedule(&dev->tasklet);
@@ -683,6 +689,7 @@ static int s5p_aes_probe(struct platform_device *pdev)
                }
        }
 
+       pdata->busy = false;
        pdata->variant = variant;
        pdata->dev = dev;
        platform_set_drvdata(pdev, pdata);