SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/scsi/qla2xxx/qla_iocb.c

   1 /*
   2  * QLogic Fibre Channel HBA Driver
   3  * Copyright (c)  2003-2008 QLogic Corporation
   4  *
   5  * See LICENSE.qla2xxx for copyright and licensing details.
   6  */
   7 #include "qla_def.h"
   8
   9 #include <linux/blkdev.h>
  10 #include <linux/delay.h>
  11
  12 #include <scsi/scsi_tcq.h>
  13
  14 static request_t *qla2x00_req_pkt(struct scsi_qla_host *, struct req_que *,
  15                                                         struct rsp_que *rsp);
  16 static void qla2x00_isp_cmd(struct scsi_qla_host *, struct req_que *);
  17
  18 static void qla25xx_set_que(srb_t *, struct req_que **, struct rsp_que **);
  19 /**
  20  * qla2x00_get_cmd_direction() - Determine control_flag data direction.
  21  * @cmd: SCSI command
  22  *
  23  * Returns the proper CF_* direction based on CDB.
  24  */
  25 static inline uint16_t
  26 qla2x00_get_cmd_direction(srb_t *sp)
  27 {
  28         uint16_t cflags;
  29
  30         cflags = 0;
  31
  32         /* Set transfer direction */
  33         if (sp->cmd->sc_data_direction == DMA_TO_DEVICE) {
  34                 cflags = CF_WRITE;
  35                 sp->fcport->vha->hw->qla_stats.output_bytes +=
  36                     scsi_bufflen(sp->cmd);
  37         } else if (sp->cmd->sc_data_direction == DMA_FROM_DEVICE) {
  38                 cflags = CF_READ;
  39                 sp->fcport->vha->hw->qla_stats.input_bytes +=
  40                     scsi_bufflen(sp->cmd);
  41         }
  42         return (cflags);
  43 }
  44
  45 /**
  46  * qla2x00_calc_iocbs_32() - Determine number of Command Type 2 and
  47  * Continuation Type 0 IOCBs to allocate.
  48  *
  49  * @dsds: number of data segment decriptors needed
  50  *
  51  * Returns the number of IOCB entries needed to store @dsds.
  52  */
  53 uint16_t
  54 qla2x00_calc_iocbs_32(uint16_t dsds)
  55 {
  56         uint16_t iocbs;
  57
  58         iocbs = 1;
  59         if (dsds > 3) {
  60                 iocbs += (dsds - 3) / 7;
  61                 if ((dsds - 3) % 7)
  62                         iocbs++;
  63         }
  64         return (iocbs);
  65 }
  66
  67 /**
  68  * qla2x00_calc_iocbs_64() - Determine number of Command Type 3 and
  69  * Continuation Type 1 IOCBs to allocate.
  70  *
  71  * @dsds: number of data segment decriptors needed
  72  *
  73  * Returns the number of IOCB entries needed to store @dsds.
  74  */
  75 uint16_t
  76 qla2x00_calc_iocbs_64(uint16_t dsds)
  77 {
  78         uint16_t iocbs;
  79
  80         iocbs = 1;
  81         if (dsds > 2) {
  82                 iocbs += (dsds - 2) / 5;
  83                 if ((dsds - 2) % 5)
  84                         iocbs++;
  85         }
  86         return (iocbs);
  87 }
  88
  89 /**
  90  * qla2x00_prep_cont_type0_iocb() - Initialize a Continuation Type 0 IOCB.
  91  * @ha: HA context
  92  *
  93  * Returns a pointer to the Continuation Type 0 IOCB packet.
  94  */
  95 static inline cont_entry_t *
  96 qla2x00_prep_cont_type0_iocb(struct req_que *req, struct scsi_qla_host *vha)
  97 {
  98         cont_entry_t *cont_pkt;
  99         /* Adjust ring index. */
 100         req->ring_index++;
 101         if (req->ring_index == req->length) {
 102                 req->ring_index = 0;
 103                 req->ring_ptr = req->ring;
 104         } else {
 105                 req->ring_ptr++;
 106         }
 107
 108         cont_pkt = (cont_entry_t *)req->ring_ptr;
 109
 110         /* Load packet defaults. */
 111         *((uint32_t *)(&cont_pkt->entry_type)) =
 112             __constant_cpu_to_le32(CONTINUE_TYPE);
 113
 114         return (cont_pkt);
 115 }
 116
 117 /**
 118  * qla2x00_prep_cont_type1_iocb() - Initialize a Continuation Type 1 IOCB.
 119  * @ha: HA context
 120  *
 121  * Returns a pointer to the continuation type 1 IOCB packet.
 122  */
 123 static inline cont_a64_entry_t *
 124 qla2x00_prep_cont_type1_iocb(struct req_que *req, scsi_qla_host_t *vha)
 125 {
 126         cont_a64_entry_t *cont_pkt;
 127
 128         /* Adjust ring index. */
 129         req->ring_index++;
 130         if (req->ring_index == req->length) {
 131                 req->ring_index = 0;
 132                 req->ring_ptr = req->ring;
 133         } else {
 134                 req->ring_ptr++;
 135         }
 136
 137         cont_pkt = (cont_a64_entry_t *)req->ring_ptr;
 138
 139         /* Load packet defaults. */
 140         *((uint32_t *)(&cont_pkt->entry_type)) =
 141             __constant_cpu_to_le32(CONTINUE_A64_TYPE);
 142
 143         return (cont_pkt);
 144 }
 145
 146 /**
 147  * qla2x00_build_scsi_iocbs_32() - Build IOCB command utilizing 32bit
 148  * capable IOCB types.
 149  *
 150  * @sp: SRB command to process
 151  * @cmd_pkt: Command type 2 IOCB
 152  * @tot_dsds: Total number of segments to transfer
 153  */
 154 void qla2x00_build_scsi_iocbs_32(srb_t *sp, cmd_entry_t *cmd_pkt,
 155     uint16_t tot_dsds)
 156 {
 157         uint16_t        avail_dsds;
 158         uint32_t        *cur_dsd;
 159         scsi_qla_host_t *vha;
 160         struct scsi_cmnd *cmd;
 161         struct scatterlist *sg;
 162         int i;
 163         struct req_que *req;
 164
 165         cmd = sp->cmd;
 166
 167         /* Update entry type to indicate Command Type 2 IOCB */
 168         *((uint32_t *)(&cmd_pkt->entry_type)) =
 169             __constant_cpu_to_le32(COMMAND_TYPE);
 170
 171         /* No data transfer */
 172         if (!scsi_bufflen(cmd) || cmd->sc_data_direction == DMA_NONE) {
 173                 cmd_pkt->byte_count = __constant_cpu_to_le32(0);
 174                 return;
 175         }
 176
 177         vha = sp->fcport->vha;
 178         req = sp->que;
 179
 180         cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(sp));
 181
 182         /* Three DSDs are available in the Command Type 2 IOCB */
 183         avail_dsds = 3;
 184         cur_dsd = (uint32_t *)&cmd_pkt->dseg_0_address;
 185
 186         /* Load data segments */
 187         scsi_for_each_sg(cmd, sg, tot_dsds, i) {
 188                 cont_entry_t *cont_pkt;
 189
 190                 /* Allocate additional continuation packets? */
 191                 if (avail_dsds == 0) {
 192                         /*
 193                          * Seven DSDs are available in the Continuation
 194                          * Type 0 IOCB.
 195                          */
 196                         cont_pkt = qla2x00_prep_cont_type0_iocb(req, vha);
 197                         cur_dsd = (uint32_t *)&cont_pkt->dseg_0_address;
 198                         avail_dsds = 7;
 199                 }
 200
 201                 *cur_dsd++ = cpu_to_le32(sg_dma_address(sg));
 202                 *cur_dsd++ = cpu_to_le32(sg_dma_len(sg));
 203                 avail_dsds--;
 204         }
 205 }
 206
 207 /**
 208  * qla2x00_build_scsi_iocbs_64() - Build IOCB command utilizing 64bit
 209  * capable IOCB types.
 210  *
 211  * @sp: SRB command to process
 212  * @cmd_pkt: Command type 3 IOCB
 213  * @tot_dsds: Total number of segments to transfer
 214  */
 215 void qla2x00_build_scsi_iocbs_64(srb_t *sp, cmd_entry_t *cmd_pkt,
 216     uint16_t tot_dsds)
 217 {
 218         uint16_t        avail_dsds;
 219         uint32_t        *cur_dsd;
 220         scsi_qla_host_t *vha;
 221         struct scsi_cmnd *cmd;
 222         struct scatterlist *sg;
 223         int i;
 224         struct req_que *req;
 225
 226         cmd = sp->cmd;
 227
 228         /* Update entry type to indicate Command Type 3 IOCB */
 229         *((uint32_t *)(&cmd_pkt->entry_type)) =
 230             __constant_cpu_to_le32(COMMAND_A64_TYPE);
 231
 232         /* No data transfer */
 233         if (!scsi_bufflen(cmd) || cmd->sc_data_direction == DMA_NONE) {
 234                 cmd_pkt->byte_count = __constant_cpu_to_le32(0);
 235                 return;
 236         }
 237
 238         vha = sp->fcport->vha;
 239         req = sp->que;
 240
 241         cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(sp));
 242
 243         /* Two DSDs are available in the Command Type 3 IOCB */
 244         avail_dsds = 2;
 245         cur_dsd = (uint32_t *)&cmd_pkt->dseg_0_address;
 246
 247         /* Load data segments */
 248         scsi_for_each_sg(cmd, sg, tot_dsds, i) {
 249                 dma_addr_t      sle_dma;
 250                 cont_a64_entry_t *cont_pkt;
 251
 252                 /* Allocate additional continuation packets? */
 253                 if (avail_dsds == 0) {
 254                         /*
 255                          * Five DSDs are available in the Continuation
 256                          * Type 1 IOCB.
 257                          */
 258                         cont_pkt = qla2x00_prep_cont_type1_iocb(req, vha);
 259                         cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
 260                         avail_dsds = 5;
 261                 }
 262
 263                 sle_dma = sg_dma_address(sg);
 264                 *cur_dsd++ = cpu_to_le32(LSD(sle_dma));
 265                 *cur_dsd++ = cpu_to_le32(MSD(sle_dma));
 266                 *cur_dsd++ = cpu_to_le32(sg_dma_len(sg));
 267                 avail_dsds--;
 268         }
 269 }
 270
 271 /**
 272  * qla2x00_start_scsi() - Send a SCSI command to the ISP
 273  * @sp: command to send to the ISP
 274  *
 275  * Returns non-zero if a failure occurred, else zero.
 276  */
 277 int
 278 qla2x00_start_scsi(srb_t *sp)
 279 {
 280         int             ret, nseg;
 281         unsigned long   flags;
 282         scsi_qla_host_t *vha;
 283         struct scsi_cmnd *cmd;
 284         uint32_t        *clr_ptr;
 285         uint32_t        index;
 286         uint32_t        handle;
 287         cmd_entry_t     *cmd_pkt;
 288         uint16_t        cnt;
 289         uint16_t        req_cnt;
 290         uint16_t        tot_dsds;
 291         struct device_reg_2xxx __iomem *reg;
 292         struct qla_hw_data *ha;
 293         struct req_que *req;
 294         struct rsp_que *rsp;
 295
 296         /* Setup device pointers. */
 297         ret = 0;
 298         vha = sp->fcport->vha;
 299         ha = vha->hw;
 300         reg = &ha->iobase->isp;
 301         cmd = sp->cmd;
 302         req = ha->req_q_map[0];
 303         rsp = ha->rsp_q_map[0];
 304         /* So we know we haven't pci_map'ed anything yet */
 305         tot_dsds = 0;
 306
 307         /* Send marker if required */
 308         if (vha->marker_needed != 0) {
 309                 if (qla2x00_marker(vha, req, rsp, 0, 0, MK_SYNC_ALL)
 310                                                         != QLA_SUCCESS)
 311                         return (QLA_FUNCTION_FAILED);
 312                 vha->marker_needed = 0;
 313         }
 314
 315         /* Acquire ring specific lock */
 316         spin_lock_irqsave(&ha->hardware_lock, flags);
 317
 318         /* Check for room in outstanding command list. */
 319         handle = req->current_outstanding_cmd;
 320         for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
 321                 handle++;
 322                 if (handle == MAX_OUTSTANDING_COMMANDS)
 323                         handle = 1;
 324                 if (!req->outstanding_cmds[handle])
 325                         break;
 326         }
 327         if (index == MAX_OUTSTANDING_COMMANDS)
 328                 goto queuing_error;
 329
 330         /* Map the sg table so we have an accurate count of sg entries needed */
 331         if (scsi_sg_count(cmd)) {
 332                 nseg = dma_map_sg(&ha->pdev->dev, scsi_sglist(cmd),
 333                     scsi_sg_count(cmd), cmd->sc_data_direction);
 334                 if (unlikely(!nseg))
 335                         goto queuing_error;
 336         } else
 337                 nseg = 0;
 338
 339         tot_dsds = nseg;
 340
 341         /* Calculate the number of request entries needed. */
 342         req_cnt = ha->isp_ops->calc_req_entries(tot_dsds);
 343         if (req->cnt < (req_cnt + 2)) {
 344                 cnt = RD_REG_WORD_RELAXED(ISP_REQ_Q_OUT(ha, reg));
 345                 if (req->ring_index < cnt)
 346                         req->cnt = cnt - req->ring_index;
 347                 else
 348                         req->cnt = req->length -
 349                             (req->ring_index - cnt);
 350         }
 351         if (req->cnt < (req_cnt + 2))
 352                 goto queuing_error;
 353
 354         /* Build command packet */
 355         req->current_outstanding_cmd = handle;
 356         req->outstanding_cmds[handle] = sp;
 357         sp->que = req;
 358         sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
 359         req->cnt -= req_cnt;
 360
 361         cmd_pkt = (cmd_entry_t *)req->ring_ptr;
 362         cmd_pkt->handle = handle;
 363         /* Zero out remaining portion of packet. */
 364         clr_ptr = (uint32_t *)cmd_pkt + 2;
 365         memset(clr_ptr, 0, REQUEST_ENTRY_SIZE - 8);
 366         cmd_pkt->dseg_count = cpu_to_le16(tot_dsds);
 367
 368         /* Set target ID and LUN number*/
 369         SET_TARGET_ID(ha, cmd_pkt->target, sp->fcport->loop_id);
 370         cmd_pkt->lun = cpu_to_le16(sp->cmd->device->lun);
 371
 372         /* Update tagged queuing modifier */
 373         cmd_pkt->control_flags = __constant_cpu_to_le16(CF_SIMPLE_TAG);
 374
 375         /* Load SCSI command packet. */
 376         memcpy(cmd_pkt->scsi_cdb, cmd->cmnd, cmd->cmd_len);
 377         cmd_pkt->byte_count = cpu_to_le32((uint32_t)scsi_bufflen(cmd));
 378
 379         /* Build IOCB segments */
 380         ha->isp_ops->build_iocbs(sp, cmd_pkt, tot_dsds);
 381
 382         /* Set total data segment count. */
 383         cmd_pkt->entry_count = (uint8_t)req_cnt;
 384         wmb();
 385
 386         /* Adjust ring index. */
 387         req->ring_index++;
 388         if (req->ring_index == req->length) {
 389                 req->ring_index = 0;
 390                 req->ring_ptr = req->ring;
 391         } else
 392                 req->ring_ptr++;
 393
 394         sp->flags |= SRB_DMA_VALID;
 395
 396         /* Set chip new ring index. */
 397         WRT_REG_WORD(ISP_REQ_Q_IN(ha, reg), req->ring_index);
 398         RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, reg));     /* PCI Posting. */
 399
 400         /* Manage unprocessed RIO/ZIO commands in response queue. */
 401         if (vha->flags.process_response_queue &&
 402             rsp->ring_ptr->signature != RESPONSE_PROCESSED)
 403                 qla2x00_process_response_queue(rsp);
 404
 405         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 406         return (QLA_SUCCESS);
 407
 408 queuing_error:
 409         if (tot_dsds)
 410                 scsi_dma_unmap(cmd);
 411
 412         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 413
 414         return (QLA_FUNCTION_FAILED);
 415 }
 416
 417 /**
 418  * qla2x00_marker() - Send a marker IOCB to the firmware.
 419  * @ha: HA context
 420  * @loop_id: loop ID
 421  * @lun: LUN
 422  * @type: marker modifier
 423  *
 424  * Can be called from both normal and interrupt context.
 425  *
 426  * Returns non-zero if a failure occurred, else zero.
 427  */
 428 int
 429 __qla2x00_marker(struct scsi_qla_host *vha, struct req_que *req,
 430                         struct rsp_que *rsp, uint16_t loop_id,
 431                         uint16_t lun, uint8_t type)
 432 {
 433         mrk_entry_t *mrk;
 434         struct mrk_entry_24xx *mrk24;
 435         struct qla_hw_data *ha = vha->hw;
 436         scsi_qla_host_t *base_vha = pci_get_drvdata(ha->pdev);
 437
 438         mrk24 = NULL;
 439         mrk = (mrk_entry_t *)qla2x00_req_pkt(vha, req, rsp);
 440         if (mrk == NULL) {
 441                 DEBUG2_3(printk("%s(%ld): failed to allocate Marker IOCB.\n",
 442                     __func__, base_vha->host_no));
 443
 444                 return (QLA_FUNCTION_FAILED);
 445         }
 446
 447         mrk->entry_type = MARKER_TYPE;
 448         mrk->modifier = type;
 449         if (type != MK_SYNC_ALL) {
 450                 if (IS_FWI2_CAPABLE(ha)) {
 451                         mrk24 = (struct mrk_entry_24xx *) mrk;
 452                         mrk24->nport_handle = cpu_to_le16(loop_id);
 453                         mrk24->lun[1] = LSB(lun);
 454                         mrk24->lun[2] = MSB(lun);
 455                         host_to_fcp_swap(mrk24->lun, sizeof(mrk24->lun));
 456                         mrk24->vp_index = vha->vp_idx;
 457                         mrk24->handle = MAKE_HANDLE(req->id, mrk24->handle);
 458                 } else {
 459                         SET_TARGET_ID(ha, mrk->target, loop_id);
 460                         mrk->lun = cpu_to_le16(lun);
 461                 }
 462         }
 463         wmb();
 464
 465         qla2x00_isp_cmd(vha, req);
 466
 467         return (QLA_SUCCESS);
 468 }
 469
 470 int
 471 qla2x00_marker(struct scsi_qla_host *vha, struct req_que *req,
 472                 struct rsp_que *rsp, uint16_t loop_id, uint16_t lun,
 473                 uint8_t type)
 474 {
 475         int ret;
 476         unsigned long flags = 0;
 477
 478         spin_lock_irqsave(&vha->hw->hardware_lock, flags);
 479         ret = __qla2x00_marker(vha, req, rsp, loop_id, lun, type);
 480         spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
 481
 482         return (ret);
 483 }
 484
 485 /**
 486  * qla2x00_req_pkt() - Retrieve a request packet from the request ring.
 487  * @ha: HA context
 488  *
 489  * Note: The caller must hold the hardware lock before calling this routine.
 490  *
 491  * Returns NULL if function failed, else, a pointer to the request packet.
 492  */
 493 static request_t *
 494 qla2x00_req_pkt(struct scsi_qla_host *vha, struct req_que *req,
 495                 struct rsp_que *rsp)
 496 {
 497         struct qla_hw_data *ha = vha->hw;
 498         device_reg_t __iomem *reg = ISP_QUE_REG(ha, req->id);
 499         request_t       *pkt = NULL;
 500         uint16_t        cnt;
 501         uint32_t        *dword_ptr;
 502         uint32_t        timer;
 503         uint16_t        req_cnt = 1;
 504
 505         /* Wait 1 second for slot. */
 506         for (timer = HZ; timer; timer--) {
 507                 if ((req_cnt + 2) >= req->cnt) {
 508                         /* Calculate number of free request entries. */
 509                         if (ha->mqenable)
 510                                 cnt = (uint16_t)
 511                                         RD_REG_DWORD(&reg->isp25mq.req_q_out);
 512                         else {
 513                                 if (IS_FWI2_CAPABLE(ha))
 514                                         cnt = (uint16_t)RD_REG_DWORD(
 515                                                 &reg->isp24.req_q_out);
 516                                 else
 517                                         cnt = qla2x00_debounce_register(
 518                                                 ISP_REQ_Q_OUT(ha, &reg->isp));
 519                         }
 520                         if  (req->ring_index < cnt)
 521                                 req->cnt = cnt - req->ring_index;
 522                         else
 523                                 req->cnt = req->length -
 524                                     (req->ring_index - cnt);
 525                 }
 526                 /* If room for request in request ring. */
 527                 if ((req_cnt + 2) < req->cnt) {
 528                         req->cnt--;
 529                         pkt = req->ring_ptr;
 530
 531                         /* Zero out packet. */
 532                         dword_ptr = (uint32_t *)pkt;
 533                         for (cnt = 0; cnt < REQUEST_ENTRY_SIZE / 4; cnt++)
 534                                 *dword_ptr++ = 0;
 535
 536                         /* Set entry count. */
 537                         pkt->entry_count = 1;
 538
 539                         break;
 540                 }
 541
 542                 /* Release ring specific lock */
 543                 spin_unlock_irq(&ha->hardware_lock);
 544
 545                 udelay(2);   /* 2 us */
 546
 547                 /* Check for pending interrupts. */
 548                 /* During init we issue marker directly */
 549                 if (!vha->marker_needed && !vha->flags.init_done)
 550                         qla2x00_poll(rsp);
 551                 spin_lock_irq(&ha->hardware_lock);
 552         }
 553         if (!pkt) {
 554                 DEBUG2_3(printk("%s(): **** FAILED ****\n", __func__));
 555         }
 556
 557         return (pkt);
 558 }
 559
 560 /**
 561  * qla2x00_isp_cmd() - Modify the request ring pointer.
 562  * @ha: HA context
 563  *
 564  * Note: The caller must hold the hardware lock before calling this routine.
 565  */
 566 static void
 567 qla2x00_isp_cmd(struct scsi_qla_host *vha, struct req_que *req)
 568 {
 569         struct qla_hw_data *ha = vha->hw;
 570         device_reg_t __iomem *reg = ISP_QUE_REG(ha, req->id);
 571         struct device_reg_2xxx __iomem *ioreg = &ha->iobase->isp;
 572
 573         DEBUG5(printk("%s(): IOCB data:\n", __func__));
 574         DEBUG5(qla2x00_dump_buffer(
 575             (uint8_t *)req->ring_ptr, REQUEST_ENTRY_SIZE));
 576
 577         /* Adjust ring index. */
 578         req->ring_index++;
 579         if (req->ring_index == req->length) {
 580                 req->ring_index = 0;
 581                 req->ring_ptr = req->ring;
 582         } else
 583                 req->ring_ptr++;
 584
 585         /* Set chip new ring index. */
 586         if (ha->mqenable) {
 587                 WRT_REG_DWORD(&reg->isp25mq.req_q_in, req->ring_index);
 588                 RD_REG_DWORD(&ioreg->hccr);
 589         }
 590         else {
 591                 if (IS_FWI2_CAPABLE(ha)) {
 592                         WRT_REG_DWORD(&reg->isp24.req_q_in, req->ring_index);
 593                         RD_REG_DWORD_RELAXED(&reg->isp24.req_q_in);
 594                 } else {
 595                         WRT_REG_WORD(ISP_REQ_Q_IN(ha, &reg->isp),
 596                                 req->ring_index);
 597                         RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, &reg->isp));
 598                 }
 599         }
 600
 601 }
 602
 603 /**
 604  * qla24xx_calc_iocbs() - Determine number of Command Type 3 and
 605  * Continuation Type 1 IOCBs to allocate.
 606  *
 607  * @dsds: number of data segment decriptors needed
 608  *
 609  * Returns the number of IOCB entries needed to store @dsds.
 610  */
 611 static inline uint16_t
 612 qla24xx_calc_iocbs(uint16_t dsds)
 613 {
 614         uint16_t iocbs;
 615
 616         iocbs = 1;
 617         if (dsds > 1) {
 618                 iocbs += (dsds - 1) / 5;
 619                 if ((dsds - 1) % 5)
 620                         iocbs++;
 621         }
 622         return iocbs;
 623 }
 624
 625 /**
 626  * qla24xx_build_scsi_iocbs() - Build IOCB command utilizing Command Type 7
 627  * IOCB types.
 628  *
 629  * @sp: SRB command to process
 630  * @cmd_pkt: Command type 3 IOCB
 631  * @tot_dsds: Total number of segments to transfer
 632  */
 633 static inline void
 634 qla24xx_build_scsi_iocbs(srb_t *sp, struct cmd_type_7 *cmd_pkt,
 635     uint16_t tot_dsds)
 636 {
 637         uint16_t        avail_dsds;
 638         uint32_t        *cur_dsd;
 639         scsi_qla_host_t *vha;
 640         struct scsi_cmnd *cmd;
 641         struct scatterlist *sg;
 642         int i;
 643         struct req_que *req;
 644
 645         cmd = sp->cmd;
 646
 647         /* Update entry type to indicate Command Type 3 IOCB */
 648         *((uint32_t *)(&cmd_pkt->entry_type)) =
 649             __constant_cpu_to_le32(COMMAND_TYPE_7);
 650
 651         /* No data transfer */
 652         if (!scsi_bufflen(cmd) || cmd->sc_data_direction == DMA_NONE) {
 653                 cmd_pkt->byte_count = __constant_cpu_to_le32(0);
 654                 return;
 655         }
 656
 657         vha = sp->fcport->vha;
 658         req = sp->que;
 659
 660         /* Set transfer direction */
 661         if (cmd->sc_data_direction == DMA_TO_DEVICE) {
 662                 cmd_pkt->task_mgmt_flags =
 663                     __constant_cpu_to_le16(TMF_WRITE_DATA);
 664                 sp->fcport->vha->hw->qla_stats.output_bytes +=
 665                     scsi_bufflen(sp->cmd);
 666         } else if (cmd->sc_data_direction == DMA_FROM_DEVICE) {
 667                 cmd_pkt->task_mgmt_flags =
 668                     __constant_cpu_to_le16(TMF_READ_DATA);
 669                 sp->fcport->vha->hw->qla_stats.input_bytes +=
 670                     scsi_bufflen(sp->cmd);
 671         }
 672
 673         /* One DSD is available in the Command Type 3 IOCB */
 674         avail_dsds = 1;
 675         cur_dsd = (uint32_t *)&cmd_pkt->dseg_0_address;
 676
 677         /* Load data segments */
 678
 679         scsi_for_each_sg(cmd, sg, tot_dsds, i) {
 680                 dma_addr_t      sle_dma;
 681                 cont_a64_entry_t *cont_pkt;
 682
 683                 /* Allocate additional continuation packets? */
 684                 if (avail_dsds == 0) {
 685                         /*
 686                          * Five DSDs are available in the Continuation
 687                          * Type 1 IOCB.
 688                          */
 689                         cont_pkt = qla2x00_prep_cont_type1_iocb(req, vha);
 690                         cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
 691                         avail_dsds = 5;
 692                 }
 693
 694                 sle_dma = sg_dma_address(sg);
 695                 *cur_dsd++ = cpu_to_le32(LSD(sle_dma));
 696                 *cur_dsd++ = cpu_to_le32(MSD(sle_dma));
 697                 *cur_dsd++ = cpu_to_le32(sg_dma_len(sg));
 698                 avail_dsds--;
 699         }
 700 }
 701
 702
 703 /**
 704  * qla24xx_start_scsi() - Send a SCSI command to the ISP
 705  * @sp: command to send to the ISP
 706  *
 707  * Returns non-zero if a failure occurred, else zero.
 708  */
 709 int
 710 qla24xx_start_scsi(srb_t *sp)
 711 {
 712         int             ret, nseg;
 713         unsigned long   flags;
 714         uint32_t        *clr_ptr;
 715         uint32_t        index;
 716         uint32_t        handle;
 717         struct cmd_type_7 *cmd_pkt;
 718         uint16_t        cnt;
 719         uint16_t        req_cnt;
 720         uint16_t        tot_dsds;
 721         struct req_que *req = NULL;
 722         struct rsp_que *rsp = NULL;
 723         struct scsi_cmnd *cmd = sp->cmd;
 724         struct scsi_qla_host *vha = sp->fcport->vha;
 725         struct qla_hw_data *ha = vha->hw;
 726
 727         /* Setup device pointers. */
 728         ret = 0;
 729
 730         qla25xx_set_que(sp, &req, &rsp);
 731         sp->que = req;
 732
 733         /* So we know we haven't pci_map'ed anything yet */
 734         tot_dsds = 0;
 735
 736         /* Send marker if required */
 737         if (vha->marker_needed != 0) {
 738                 if (qla2x00_marker(vha, req, rsp, 0, 0, MK_SYNC_ALL)
 739                                                         != QLA_SUCCESS)
 740                         return QLA_FUNCTION_FAILED;
 741                 vha->marker_needed = 0;
 742         }
 743
 744         /* Acquire ring specific lock */
 745         spin_lock_irqsave(&ha->hardware_lock, flags);
 746
 747         /* Check for room in outstanding command list. */
 748         handle = req->current_outstanding_cmd;
 749         for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
 750                 handle++;
 751                 if (handle == MAX_OUTSTANDING_COMMANDS)
 752                         handle = 1;
 753                 if (!req->outstanding_cmds[handle])
 754                         break;
 755         }
 756         if (index == MAX_OUTSTANDING_COMMANDS)
 757                 goto queuing_error;
 758
 759         /* Map the sg table so we have an accurate count of sg entries needed */
 760         if (scsi_sg_count(cmd)) {
 761                 nseg = dma_map_sg(&ha->pdev->dev, scsi_sglist(cmd),
 762                     scsi_sg_count(cmd), cmd->sc_data_direction);
 763                 if (unlikely(!nseg))
 764                         goto queuing_error;
 765         } else
 766                 nseg = 0;
 767
 768         tot_dsds = nseg;
 769
 770         req_cnt = qla24xx_calc_iocbs(tot_dsds);
 771         if (req->cnt < (req_cnt + 2)) {
 772                 cnt = RD_REG_DWORD_RELAXED(req->req_q_out);
 773
 774                 if (req->ring_index < cnt)
 775                         req->cnt = cnt - req->ring_index;
 776                 else
 777                         req->cnt = req->length -
 778                                 (req->ring_index - cnt);
 779         }
 780         if (req->cnt < (req_cnt + 2))
 781                 goto queuing_error;
 782
 783         /* Build command packet. */
 784         req->current_outstanding_cmd = handle;
 785         req->outstanding_cmds[handle] = sp;
 786         sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
 787         req->cnt -= req_cnt;
 788
 789         cmd_pkt = (struct cmd_type_7 *)req->ring_ptr;
 790         cmd_pkt->handle = MAKE_HANDLE(req->id, handle);
 791
 792         /* Zero out remaining portion of packet. */
 793         /*    tagged queuing modifier -- default is TSK_SIMPLE (0). */
 794         clr_ptr = (uint32_t *)cmd_pkt + 2;
 795         memset(clr_ptr, 0, REQUEST_ENTRY_SIZE - 8);
 796         cmd_pkt->dseg_count = cpu_to_le16(tot_dsds);
 797
 798         /* Set NPORT-ID and LUN number*/
 799         cmd_pkt->nport_handle = cpu_to_le16(sp->fcport->loop_id);
 800         cmd_pkt->port_id[0] = sp->fcport->d_id.b.al_pa;
 801         cmd_pkt->port_id[1] = sp->fcport->d_id.b.area;
 802         cmd_pkt->port_id[2] = sp->fcport->d_id.b.domain;
 803         cmd_pkt->vp_index = sp->fcport->vp_idx;
 804
 805         int_to_scsilun(sp->cmd->device->lun, &cmd_pkt->lun);
 806         host_to_fcp_swap((uint8_t *)&cmd_pkt->lun, sizeof(cmd_pkt->lun));
 807
 808         /* Load SCSI command packet. */
 809         memcpy(cmd_pkt->fcp_cdb, cmd->cmnd, cmd->cmd_len);
 810         host_to_fcp_swap(cmd_pkt->fcp_cdb, sizeof(cmd_pkt->fcp_cdb));
 811
 812         cmd_pkt->byte_count = cpu_to_le32((uint32_t)scsi_bufflen(cmd));
 813
 814         /* Build IOCB segments */
 815         qla24xx_build_scsi_iocbs(sp, cmd_pkt, tot_dsds);
 816
 817         /* Set total data segment count. */
 818         cmd_pkt->entry_count = (uint8_t)req_cnt;
 819         /* Specify response queue number where completion should happen */
 820         cmd_pkt->entry_status = (uint8_t) rsp->id;
 821         wmb();
 822
 823         /* Adjust ring index. */
 824         req->ring_index++;
 825         if (req->ring_index == req->length) {
 826                 req->ring_index = 0;
 827                 req->ring_ptr = req->ring;
 828         } else
 829                 req->ring_ptr++;
 830
 831         sp->flags |= SRB_DMA_VALID;
 832
 833         /* Set chip new ring index. */
 834         WRT_REG_DWORD(req->req_q_in, req->ring_index);
 835         RD_REG_DWORD_RELAXED(&ha->iobase->isp24.hccr);
 836
 837         /* Manage unprocessed RIO/ZIO commands in response queue. */
 838         if (vha->flags.process_response_queue &&
 839                 rsp->ring_ptr->signature != RESPONSE_PROCESSED)
 840                 qla24xx_process_response_queue(vha, rsp);
 841
 842         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 843         return QLA_SUCCESS;
 844
 845 queuing_error:
 846         if (tot_dsds)
 847                 scsi_dma_unmap(cmd);
 848
 849         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 850
 851         return QLA_FUNCTION_FAILED;
 852 }
 853
 854 static void qla25xx_set_que(srb_t *sp, struct req_que **req,
 855         struct rsp_que **rsp)
 856 {
 857         struct scsi_cmnd *cmd = sp->cmd;
 858         struct scsi_qla_host *vha = sp->fcport->vha;
 859         struct qla_hw_data *ha = sp->fcport->vha->hw;
 860         int affinity = cmd->request->cpu;
 861
 862         if (ql2xmultique_tag && affinity >= 0 &&
 863                 affinity < ha->max_rsp_queues - 1) {
 864                 *rsp = ha->rsp_q_map[affinity + 1];
 865                 *req = ha->req_q_map[1];
 866         } else {
 867                 *req = vha->req;
 868                 *rsp = ha->rsp_q_map[0];
 869         }
 870 }