scsi_host_put(mvi->shost);
        list_for_each_entry(mwq, &mvi->wq_list, entry)
                cancel_delayed_work(&mwq->work_q);
-       kfree(mvi->tags);
+       kfree(mvi->rsvd_tags);
        kfree(mvi);
 }
 
                        printk(KERN_DEBUG "failed to create dma pool %s.\n", pool_name);
                        goto err_out;
        }
-       mvi->tags_num = slot_nr;
 
        return 0;
 err_out:
        mvi->sas = sha;
        mvi->shost = shost;
 
-       mvi->tags = kzalloc(MVS_CHIP_SLOT_SZ>>3, GFP_KERNEL);
-       if (!mvi->tags)
+       mvi->rsvd_tags = bitmap_zalloc(MVS_RSVD_SLOTS, GFP_KERNEL);
+       if (!mvi->rsvd_tags)
                goto err_out;
 
        if (MVS_CHIP_DISP->chip_ioremap(mvi))
        else
                can_queue = MVS_CHIP_SLOT_SZ;
 
+       can_queue -= MVS_RSVD_SLOTS;
+
        shost->sg_tablesize = min_t(u16, SG_ALL, MVS_MAX_SG);
        shost->can_queue = can_queue;
        mvi->shost->cmd_per_lun = MVS_QUEUE_SIZE;
 
        return 0;
 }
 
-void mvs_tag_clear(struct mvs_info *mvi, u32 tag)
+static void mvs_tag_clear(struct mvs_info *mvi, u32 tag)
 {
-       void *bitmap = mvi->tags;
+       void *bitmap = mvi->rsvd_tags;
        clear_bit(tag, bitmap);
 }
 
-void mvs_tag_free(struct mvs_info *mvi, u32 tag)
+static void mvs_tag_free(struct mvs_info *mvi, u32 tag)
 {
+       if (tag >= MVS_RSVD_SLOTS)
+               return;
+
        mvs_tag_clear(mvi, tag);
 }
 
-void mvs_tag_set(struct mvs_info *mvi, unsigned int tag)
+static void mvs_tag_set(struct mvs_info *mvi, unsigned int tag)
 {
-       void *bitmap = mvi->tags;
+       void *bitmap = mvi->rsvd_tags;
        set_bit(tag, bitmap);
 }
 
-inline int mvs_tag_alloc(struct mvs_info *mvi, u32 *tag_out)
+static int mvs_tag_alloc(struct mvs_info *mvi, u32 *tag_out)
 {
        unsigned int index, tag;
-       void *bitmap = mvi->tags;
+       void *bitmap = mvi->rsvd_tags;
 
-       index = find_first_zero_bit(bitmap, mvi->tags_num);
+       index = find_first_zero_bit(bitmap, MVS_RSVD_SLOTS);
        tag = index;
-       if (tag >= mvi->tags_num)
+       if (tag >= MVS_RSVD_SLOTS)
                return -SAS_QUEUE_FULL;
        mvs_tag_set(mvi, tag);
        *tag_out = tag;
        struct mvs_task_exec_info tei;
        struct mvs_slot_info *slot;
        u32 tag = 0xdeadbeef, n_elem = 0;
+       struct request *rq;
        int rc = 0;
 
        if (!dev->port) {
                n_elem = task->num_scatter;
        }
 
-       rc = mvs_tag_alloc(mvi, &tag);
-       if (rc)
-               goto err_out;
+       rq = sas_task_find_rq(task);
+       if (rq) {
+               tag = rq->tag + MVS_RSVD_SLOTS;
+       } else {
+               rc = mvs_tag_alloc(mvi, &tag);
+               if (rc)
+                       goto err_out;
+       }
 
        slot = &mvi->slot_info[tag];
 
 static void mvs_slot_free(struct mvs_info *mvi, u32 rx_desc)
 {
        u32 slot_idx = rx_desc & RXQ_SLOT_MASK;
-       mvs_tag_clear(mvi, slot_idx);
+       mvs_tag_free(mvi, slot_idx);
 }
 
 static void mvs_slot_task_free(struct mvs_info *mvi, struct sas_task *task,
 
        u32 chip_id;
        const struct mvs_chip_info *chip;
 
-       int tags_num;
-       unsigned long *tags;
+       unsigned long *rsvd_tags;
        /* further per-slot information */
        struct mvs_phy phy[MVS_MAX_PHYS];
        struct mvs_port port[MVS_MAX_PHYS];
 
 /******************** function prototype *********************/
 void mvs_get_sas_addr(void *buf, u32 buflen);
-void mvs_tag_clear(struct mvs_info *mvi, u32 tag);
-void mvs_tag_free(struct mvs_info *mvi, u32 tag);
-void mvs_tag_set(struct mvs_info *mvi, unsigned int tag);
-int mvs_tag_alloc(struct mvs_info *mvi, u32 *tag_out);
 void mvs_iounmap(void __iomem *regs);
 int mvs_ioremap(struct mvs_info *mvi, int bar, int bar_ex);
 void mvs_phys_reset(struct mvs_info *mvi, u32 phy_mask, int hard);