crypto: ccp - Clean up the LSB slot allocation code

Fix a few problems revealed by testing: verify consistent
units, especially in public slot allocation. Percolate
some common initialization code up to a common routine.
Add some comments.

Signed-off-by: Gary R Hook <gary.hook@amd.com>
Signed-off-by: Herbert Xu <herbert@gondor.apana.org.au>

1 files changed, 12 insertions, 8 deletions

diff --git a/drivers/crypto/ccp/ccp-dev-v5.c b/drivers/crypto/ccp/ccp-dev-v5.c
index faf3cb3ddce2..ff7816a2b8af 100644
--- a/drivers/crypto/ccp/ccp-dev-v5.c
+++ b/drivers/crypto/ccp/ccp-dev-v5.c
@@ -21,6 +21,12 @@
 
 #include "ccp-dev.h"
 
+/* Allocate the requested number of contiguous LSB slots
+ * from the LSB bitmap. Look in the private range for this
+ * queue first; failing that, check the public area.
+ * If no space is available, wait around.
+ * Return: first slot number
+ */
 static u32 ccp_lsb_alloc(struct ccp_cmd_queue *cmd_q, unsigned int count)
 {
         struct ccp_device *ccp;
@@ -50,7 +56,7 @@ static u32 ccp_lsb_alloc(struct ccp_cmd_queue *cmd_q, unsigned int count)
                         bitmap_set(ccp->lsbmap, start, count);
 
                         mutex_unlock(&ccp->sb_mutex);
-                        return start * LSB_ITEM_SIZE;
+                        return start;
                 }
 
                 ccp->sb_avail = 0;
@@ -63,17 +69,18 @@ static u32 ccp_lsb_alloc(struct ccp_cmd_queue *cmd_q, unsigned int count)
         }
 }
 
+/* Free a number of LSB slots from the bitmap, starting at
+ * the indicated starting slot number.
+ */
 static void ccp_lsb_free(struct ccp_cmd_queue *cmd_q, unsigned int start,
                          unsigned int count)
 {
-        int lsbno = start / LSB_SIZE;
-
         if (!start)
                 return;
 
-        if (cmd_q->lsb == lsbno) {
+        if (cmd_q->lsb == start) {
                 /* An entry from the private LSB */
-                bitmap_clear(cmd_q->lsbmap, start % LSB_SIZE, count);
+                bitmap_clear(cmd_q->lsbmap, start, count);
         } else {
                 /* From the shared LSBs */
                 struct ccp_device *ccp = cmd_q->ccp;
@@ -751,9 +758,6 @@ static int ccp5_init(struct ccp_device *ccp)
                 goto e_pool;
         }
 
-        /* Initialize the queue used to suspend */
-        init_waitqueue_head(&ccp->suspend_queue);
-
         dev_dbg(dev, "Loading LSB map...\n");
         /* Copy the private LSB mask to the public registers */
         status_lo = ioread32(ccp->io_regs + LSB_PRIVATE_MASK_LO_OFFSET);