msm/qsd: smd: avoid race condition in smd channel allocation

[mv-sheeva.git] / arch / arm / mach-msm / smd.c

diff --git a/arch/arm/mach-msm/smd.c b/arch/arm/mach-msm/smd.c
index 3fbba444e99cba2720ca10869ea253313265cd1a..34bcc327aa889a526a4fec70e3dcc9caa9af67fd 100644 (file)
--- a/arch/arm/mach-msm/smd.c
+++ b/arch/arm/mach-msm/smd.c
@@ -153,7 +153,7 @@ LIST_HEAD(smd_ch_list_dsp);
 static unsigned char smd_ch_allocated[64];
 static struct work_struct probe_work;
 
-static void smd_alloc_channel(const char *name, uint32_t cid, uint32_t type);
+static int smd_alloc_channel(const char *name, uint32_t cid, uint32_t type);
 
 static void smd_channel_probe_worker(struct work_struct *work)
 {
@@ -186,8 +186,8 @@ static void smd_channel_probe_worker(struct work_struct *work)
                type = shared[n].ctype & SMD_TYPE_MASK;
                if ((type == SMD_TYPE_APPS_MODEM) ||
                    (type == SMD_TYPE_APPS_DSP))
-                       smd_alloc_channel(shared[n].name, shared[n].cid, ctype);
-               smd_ch_allocated[n] = 1;
+                       if (!smd_alloc_channel(shared[n].name, shared[n].cid, ctype))
+                               smd_ch_allocated[n] = 1;
        }
 }
 
@@ -641,20 +641,20 @@ static int smd_alloc_v1(struct smd_channel *ch)
 }
 
 
-static void smd_alloc_channel(const char *name, uint32_t cid, uint32_t type)
+static int smd_alloc_channel(const char *name, uint32_t cid, uint32_t type)
 {
        struct smd_channel *ch;
 
        ch = kzalloc(sizeof(struct smd_channel), GFP_KERNEL);
        if (ch == 0) {
                pr_err("smd_alloc_channel() out of memory\n");
-               return;
+               return -1;
        }
        ch->n = cid;
 
        if (smd_alloc_v2(ch) && smd_alloc_v1(ch)) {
                kfree(ch);
-               return;
+               return -1;
        }
 
        ch->fifo_mask = ch->fifo_size - 1;
@@ -696,6 +696,7 @@ static void smd_alloc_channel(const char *name, uint32_t cid, uint32_t type)
        mutex_unlock(&smd_creation_mutex);
 
        platform_device_register(&ch->pdev);
+       return 0;
 }
 
 static void do_nothing_notify(void *priv, unsigned flags)