2 * QLogic Fibre Channel HBA Driver
3 * Copyright (c) 2003-2005 QLogic Corporation
5 * See LICENSE.qla2xxx for copyright and licensing details.
9 #include <linux/blkdev.h>
10 #include <linux/delay.h>
12 #include <scsi/scsi_tcq.h>
14 static inline uint16_t qla2x00_get_cmd_direction(struct scsi_cmnd *cmd);
15 static inline cont_entry_t *qla2x00_prep_cont_type0_iocb(scsi_qla_host_t *);
16 static inline cont_a64_entry_t *qla2x00_prep_cont_type1_iocb(scsi_qla_host_t *);
17 static request_t *qla2x00_req_pkt(scsi_qla_host_t *ha);
20 * qla2x00_get_cmd_direction() - Determine control_flag data direction.
23 * Returns the proper CF_* direction based on CDB.
25 static inline uint16_t
26 qla2x00_get_cmd_direction(struct scsi_cmnd *cmd)
32 /* Set transfer direction */
33 if (cmd->sc_data_direction == DMA_TO_DEVICE)
35 else if (cmd->sc_data_direction == DMA_FROM_DEVICE)
41 * qla2x00_calc_iocbs_32() - Determine number of Command Type 2 and
42 * Continuation Type 0 IOCBs to allocate.
44 * @dsds: number of data segment decriptors needed
46 * Returns the number of IOCB entries needed to store @dsds.
49 qla2x00_calc_iocbs_32(uint16_t dsds)
55 iocbs += (dsds - 3) / 7;
63 * qla2x00_calc_iocbs_64() - Determine number of Command Type 3 and
64 * Continuation Type 1 IOCBs to allocate.
66 * @dsds: number of data segment decriptors needed
68 * Returns the number of IOCB entries needed to store @dsds.
71 qla2x00_calc_iocbs_64(uint16_t dsds)
77 iocbs += (dsds - 2) / 5;
85 * qla2x00_prep_cont_type0_iocb() - Initialize a Continuation Type 0 IOCB.
88 * Returns a pointer to the Continuation Type 0 IOCB packet.
90 static inline cont_entry_t *
91 qla2x00_prep_cont_type0_iocb(scsi_qla_host_t *ha)
93 cont_entry_t *cont_pkt;
95 /* Adjust ring index. */
97 if (ha->req_ring_index == ha->request_q_length) {
98 ha->req_ring_index = 0;
99 ha->request_ring_ptr = ha->request_ring;
101 ha->request_ring_ptr++;
104 cont_pkt = (cont_entry_t *)ha->request_ring_ptr;
106 /* Load packet defaults. */
107 *((uint32_t *)(&cont_pkt->entry_type)) =
108 __constant_cpu_to_le32(CONTINUE_TYPE);
114 * qla2x00_prep_cont_type1_iocb() - Initialize a Continuation Type 1 IOCB.
117 * Returns a pointer to the continuation type 1 IOCB packet.
119 static inline cont_a64_entry_t *
120 qla2x00_prep_cont_type1_iocb(scsi_qla_host_t *ha)
122 cont_a64_entry_t *cont_pkt;
124 /* Adjust ring index. */
125 ha->req_ring_index++;
126 if (ha->req_ring_index == ha->request_q_length) {
127 ha->req_ring_index = 0;
128 ha->request_ring_ptr = ha->request_ring;
130 ha->request_ring_ptr++;
133 cont_pkt = (cont_a64_entry_t *)ha->request_ring_ptr;
135 /* Load packet defaults. */
136 *((uint32_t *)(&cont_pkt->entry_type)) =
137 __constant_cpu_to_le32(CONTINUE_A64_TYPE);
143 * qla2x00_build_scsi_iocbs_32() - Build IOCB command utilizing 32bit
144 * capable IOCB types.
146 * @sp: SRB command to process
147 * @cmd_pkt: Command type 2 IOCB
148 * @tot_dsds: Total number of segments to transfer
150 void qla2x00_build_scsi_iocbs_32(srb_t *sp, cmd_entry_t *cmd_pkt,
156 struct scsi_cmnd *cmd;
160 /* Update entry type to indicate Command Type 2 IOCB */
161 *((uint32_t *)(&cmd_pkt->entry_type)) =
162 __constant_cpu_to_le32(COMMAND_TYPE);
164 /* No data transfer */
165 if (cmd->request_bufflen == 0 || cmd->sc_data_direction == DMA_NONE) {
166 cmd_pkt->byte_count = __constant_cpu_to_le32(0);
172 cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(cmd));
174 /* Three DSDs are available in the Command Type 2 IOCB */
176 cur_dsd = (uint32_t *)&cmd_pkt->dseg_0_address;
178 /* Load data segments */
179 if (cmd->use_sg != 0) {
180 struct scatterlist *cur_seg;
181 struct scatterlist *end_seg;
183 cur_seg = (struct scatterlist *)cmd->request_buffer;
184 end_seg = cur_seg + tot_dsds;
185 while (cur_seg < end_seg) {
186 cont_entry_t *cont_pkt;
188 /* Allocate additional continuation packets? */
189 if (avail_dsds == 0) {
191 * Seven DSDs are available in the Continuation
194 cont_pkt = qla2x00_prep_cont_type0_iocb(ha);
195 cur_dsd = (uint32_t *)&cont_pkt->dseg_0_address;
199 *cur_dsd++ = cpu_to_le32(sg_dma_address(cur_seg));
200 *cur_dsd++ = cpu_to_le32(sg_dma_len(cur_seg));
206 *cur_dsd++ = cpu_to_le32(sp->dma_handle);
207 *cur_dsd++ = cpu_to_le32(cmd->request_bufflen);
212 * qla2x00_build_scsi_iocbs_64() - Build IOCB command utilizing 64bit
213 * capable IOCB types.
215 * @sp: SRB command to process
216 * @cmd_pkt: Command type 3 IOCB
217 * @tot_dsds: Total number of segments to transfer
219 void qla2x00_build_scsi_iocbs_64(srb_t *sp, cmd_entry_t *cmd_pkt,
225 struct scsi_cmnd *cmd;
229 /* Update entry type to indicate Command Type 3 IOCB */
230 *((uint32_t *)(&cmd_pkt->entry_type)) =
231 __constant_cpu_to_le32(COMMAND_A64_TYPE);
233 /* No data transfer */
234 if (cmd->request_bufflen == 0 || cmd->sc_data_direction == DMA_NONE) {
235 cmd_pkt->byte_count = __constant_cpu_to_le32(0);
241 cmd_pkt->control_flags |= cpu_to_le16(qla2x00_get_cmd_direction(cmd));
243 /* Two DSDs are available in the Command Type 3 IOCB */
245 cur_dsd = (uint32_t *)&cmd_pkt->dseg_0_address;
247 /* Load data segments */
248 if (cmd->use_sg != 0) {
249 struct scatterlist *cur_seg;
250 struct scatterlist *end_seg;
252 cur_seg = (struct scatterlist *)cmd->request_buffer;
253 end_seg = cur_seg + tot_dsds;
254 while (cur_seg < end_seg) {
256 cont_a64_entry_t *cont_pkt;
258 /* Allocate additional continuation packets? */
259 if (avail_dsds == 0) {
261 * Five DSDs are available in the Continuation
264 cont_pkt = qla2x00_prep_cont_type1_iocb(ha);
265 cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
269 sle_dma = sg_dma_address(cur_seg);
270 *cur_dsd++ = cpu_to_le32(LSD(sle_dma));
271 *cur_dsd++ = cpu_to_le32(MSD(sle_dma));
272 *cur_dsd++ = cpu_to_le32(sg_dma_len(cur_seg));
278 *cur_dsd++ = cpu_to_le32(LSD(sp->dma_handle));
279 *cur_dsd++ = cpu_to_le32(MSD(sp->dma_handle));
280 *cur_dsd++ = cpu_to_le32(cmd->request_bufflen);
285 * qla2x00_start_scsi() - Send a SCSI command to the ISP
286 * @sp: command to send to the ISP
288 * Returns non-zero if a failure occured, else zero.
291 qla2x00_start_scsi(srb_t *sp)
296 struct scsi_cmnd *cmd;
300 cmd_entry_t *cmd_pkt;
301 struct scatterlist *sg;
305 struct device_reg_2xxx __iomem *reg;
307 /* Setup device pointers. */
310 reg = &ha->iobase->isp;
312 /* So we know we haven't pci_map'ed anything yet */
315 /* Send marker if required */
316 if (ha->marker_needed != 0) {
317 if (qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS) {
318 return (QLA_FUNCTION_FAILED);
320 ha->marker_needed = 0;
323 /* Acquire ring specific lock */
324 spin_lock_irqsave(&ha->hardware_lock, flags);
326 /* Check for room in outstanding command list. */
327 handle = ha->current_outstanding_cmd;
328 for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
330 if (handle == MAX_OUTSTANDING_COMMANDS)
332 if (ha->outstanding_cmds[handle] == 0)
335 if (index == MAX_OUTSTANDING_COMMANDS)
338 /* Map the sg table so we have an accurate count of sg entries needed */
340 sg = (struct scatterlist *) cmd->request_buffer;
341 tot_dsds = pci_map_sg(ha->pdev, sg, cmd->use_sg,
342 cmd->sc_data_direction);
345 } else if (cmd->request_bufflen) {
348 req_dma = pci_map_single(ha->pdev, cmd->request_buffer,
349 cmd->request_bufflen, cmd->sc_data_direction);
350 if (dma_mapping_error(req_dma))
353 sp->dma_handle = req_dma;
357 /* Calculate the number of request entries needed. */
358 req_cnt = ha->isp_ops.calc_req_entries(tot_dsds);
359 if (ha->req_q_cnt < (req_cnt + 2)) {
360 cnt = RD_REG_WORD_RELAXED(ISP_REQ_Q_OUT(ha, reg));
361 if (ha->req_ring_index < cnt)
362 ha->req_q_cnt = cnt - ha->req_ring_index;
364 ha->req_q_cnt = ha->request_q_length -
365 (ha->req_ring_index - cnt);
367 if (ha->req_q_cnt < (req_cnt + 2))
370 /* Build command packet */
371 ha->current_outstanding_cmd = handle;
372 ha->outstanding_cmds[handle] = sp;
374 sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
375 ha->req_q_cnt -= req_cnt;
377 cmd_pkt = (cmd_entry_t *)ha->request_ring_ptr;
378 cmd_pkt->handle = handle;
379 /* Zero out remaining portion of packet. */
380 clr_ptr = (uint32_t *)cmd_pkt + 2;
381 memset(clr_ptr, 0, REQUEST_ENTRY_SIZE - 8);
382 cmd_pkt->dseg_count = cpu_to_le16(tot_dsds);
384 /* Set target ID and LUN number*/
385 SET_TARGET_ID(ha, cmd_pkt->target, sp->fcport->loop_id);
386 cmd_pkt->lun = cpu_to_le16(sp->cmd->device->lun);
388 /* Update tagged queuing modifier */
389 cmd_pkt->control_flags = __constant_cpu_to_le16(CF_SIMPLE_TAG);
391 /* Load SCSI command packet. */
392 memcpy(cmd_pkt->scsi_cdb, cmd->cmnd, cmd->cmd_len);
393 cmd_pkt->byte_count = cpu_to_le32((uint32_t)cmd->request_bufflen);
395 /* Build IOCB segments */
396 ha->isp_ops.build_iocbs(sp, cmd_pkt, tot_dsds);
398 /* Set total data segment count. */
399 cmd_pkt->entry_count = (uint8_t)req_cnt;
402 /* Adjust ring index. */
403 ha->req_ring_index++;
404 if (ha->req_ring_index == ha->request_q_length) {
405 ha->req_ring_index = 0;
406 ha->request_ring_ptr = ha->request_ring;
408 ha->request_ring_ptr++;
410 sp->flags |= SRB_DMA_VALID;
412 /* Set chip new ring index. */
413 WRT_REG_WORD(ISP_REQ_Q_IN(ha, reg), ha->req_ring_index);
414 RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, reg)); /* PCI Posting. */
416 /* Manage unprocessed RIO/ZIO commands in response queue. */
417 if (ha->flags.process_response_queue &&
418 ha->response_ring_ptr->signature != RESPONSE_PROCESSED)
419 qla2x00_process_response_queue(ha);
421 spin_unlock_irqrestore(&ha->hardware_lock, flags);
422 return (QLA_SUCCESS);
425 if (cmd->use_sg && tot_dsds) {
426 sg = (struct scatterlist *) cmd->request_buffer;
427 pci_unmap_sg(ha->pdev, sg, cmd->use_sg,
428 cmd->sc_data_direction);
429 } else if (tot_dsds) {
430 pci_unmap_single(ha->pdev, sp->dma_handle,
431 cmd->request_bufflen, cmd->sc_data_direction);
433 spin_unlock_irqrestore(&ha->hardware_lock, flags);
435 return (QLA_FUNCTION_FAILED);
439 * qla2x00_marker() - Send a marker IOCB to the firmware.
443 * @type: marker modifier
445 * Can be called from both normal and interrupt context.
447 * Returns non-zero if a failure occured, else zero.
450 __qla2x00_marker(scsi_qla_host_t *ha, uint16_t loop_id, uint16_t lun,
454 struct mrk_entry_24xx *mrk24;
457 mrk = (mrk_entry_t *)qla2x00_req_pkt(ha);
459 DEBUG2_3(printk("%s(%ld): failed to allocate Marker IOCB.\n",
460 __func__, ha->host_no));
462 return (QLA_FUNCTION_FAILED);
465 mrk->entry_type = MARKER_TYPE;
466 mrk->modifier = type;
467 if (type != MK_SYNC_ALL) {
468 if (IS_QLA24XX(ha) || IS_QLA54XX(ha)) {
469 mrk24 = (struct mrk_entry_24xx *) mrk;
470 mrk24->nport_handle = cpu_to_le16(loop_id);
471 mrk24->lun[1] = LSB(lun);
472 mrk24->lun[2] = MSB(lun);
474 SET_TARGET_ID(ha, mrk->target, loop_id);
475 mrk->lun = cpu_to_le16(lun);
482 return (QLA_SUCCESS);
486 qla2x00_marker(scsi_qla_host_t *ha, uint16_t loop_id, uint16_t lun,
490 unsigned long flags = 0;
492 spin_lock_irqsave(&ha->hardware_lock, flags);
493 ret = __qla2x00_marker(ha, loop_id, lun, type);
494 spin_unlock_irqrestore(&ha->hardware_lock, flags);
500 * qla2x00_req_pkt() - Retrieve a request packet from the request ring.
503 * Note: The caller must hold the hardware lock before calling this routine.
505 * Returns NULL if function failed, else, a pointer to the request packet.
508 qla2x00_req_pkt(scsi_qla_host_t *ha)
510 device_reg_t __iomem *reg = ha->iobase;
511 request_t *pkt = NULL;
515 uint16_t req_cnt = 1;
517 /* Wait 1 second for slot. */
518 for (timer = HZ; timer; timer--) {
519 if ((req_cnt + 2) >= ha->req_q_cnt) {
520 /* Calculate number of free request entries. */
521 if (IS_QLA24XX(ha) || IS_QLA54XX(ha))
522 cnt = (uint16_t)RD_REG_DWORD(
523 ®->isp24.req_q_out);
525 cnt = qla2x00_debounce_register(
526 ISP_REQ_Q_OUT(ha, ®->isp));
527 if (ha->req_ring_index < cnt)
528 ha->req_q_cnt = cnt - ha->req_ring_index;
530 ha->req_q_cnt = ha->request_q_length -
531 (ha->req_ring_index - cnt);
533 /* If room for request in request ring. */
534 if ((req_cnt + 2) < ha->req_q_cnt) {
536 pkt = ha->request_ring_ptr;
538 /* Zero out packet. */
539 dword_ptr = (uint32_t *)pkt;
540 for (cnt = 0; cnt < REQUEST_ENTRY_SIZE / 4; cnt++)
543 /* Set system defined field. */
544 pkt->sys_define = (uint8_t)ha->req_ring_index;
546 /* Set entry count. */
547 pkt->entry_count = 1;
552 /* Release ring specific lock */
553 spin_unlock(&ha->hardware_lock);
555 udelay(2); /* 2 us */
557 /* Check for pending interrupts. */
558 /* During init we issue marker directly */
559 if (!ha->marker_needed)
562 spin_lock_irq(&ha->hardware_lock);
565 DEBUG2_3(printk("%s(): **** FAILED ****\n", __func__));
572 * qla2x00_isp_cmd() - Modify the request ring pointer.
575 * Note: The caller must hold the hardware lock before calling this routine.
578 qla2x00_isp_cmd(scsi_qla_host_t *ha)
580 device_reg_t __iomem *reg = ha->iobase;
582 DEBUG5(printk("%s(): IOCB data:\n", __func__));
583 DEBUG5(qla2x00_dump_buffer(
584 (uint8_t *)ha->request_ring_ptr, REQUEST_ENTRY_SIZE));
586 /* Adjust ring index. */
587 ha->req_ring_index++;
588 if (ha->req_ring_index == ha->request_q_length) {
589 ha->req_ring_index = 0;
590 ha->request_ring_ptr = ha->request_ring;
592 ha->request_ring_ptr++;
594 /* Set chip new ring index. */
595 if (IS_QLA24XX(ha) || IS_QLA54XX(ha)) {
596 WRT_REG_DWORD(®->isp24.req_q_in, ha->req_ring_index);
597 RD_REG_DWORD_RELAXED(®->isp24.req_q_in);
599 WRT_REG_WORD(ISP_REQ_Q_IN(ha, ®->isp), ha->req_ring_index);
600 RD_REG_WORD_RELAXED(ISP_REQ_Q_IN(ha, ®->isp));
606 * qla24xx_calc_iocbs() - Determine number of Command Type 3 and
607 * Continuation Type 1 IOCBs to allocate.
609 * @dsds: number of data segment decriptors needed
611 * Returns the number of IOCB entries needed to store @dsds.
613 static inline uint16_t
614 qla24xx_calc_iocbs(uint16_t dsds)
620 iocbs += (dsds - 1) / 5;
628 * qla24xx_build_scsi_iocbs() - Build IOCB command utilizing Command Type 7
631 * @sp: SRB command to process
632 * @cmd_pkt: Command type 3 IOCB
633 * @tot_dsds: Total number of segments to transfer
636 qla24xx_build_scsi_iocbs(srb_t *sp, struct cmd_type_7 *cmd_pkt,
642 struct scsi_cmnd *cmd;
646 /* Update entry type to indicate Command Type 3 IOCB */
647 *((uint32_t *)(&cmd_pkt->entry_type)) =
648 __constant_cpu_to_le32(COMMAND_TYPE_7);
650 /* No data transfer */
651 if (cmd->request_bufflen == 0 || cmd->sc_data_direction == DMA_NONE) {
652 cmd_pkt->byte_count = __constant_cpu_to_le32(0);
658 /* Set transfer direction */
659 if (cmd->sc_data_direction == DMA_TO_DEVICE)
660 cmd_pkt->task_mgmt_flags =
661 __constant_cpu_to_le16(TMF_WRITE_DATA);
662 else if (cmd->sc_data_direction == DMA_FROM_DEVICE)
663 cmd_pkt->task_mgmt_flags =
664 __constant_cpu_to_le16(TMF_READ_DATA);
666 /* One DSD is available in the Command Type 3 IOCB */
668 cur_dsd = (uint32_t *)&cmd_pkt->dseg_0_address;
670 /* Load data segments */
671 if (cmd->use_sg != 0) {
672 struct scatterlist *cur_seg;
673 struct scatterlist *end_seg;
675 cur_seg = (struct scatterlist *)cmd->request_buffer;
676 end_seg = cur_seg + tot_dsds;
677 while (cur_seg < end_seg) {
679 cont_a64_entry_t *cont_pkt;
681 /* Allocate additional continuation packets? */
682 if (avail_dsds == 0) {
684 * Five DSDs are available in the Continuation
687 cont_pkt = qla2x00_prep_cont_type1_iocb(ha);
688 cur_dsd = (uint32_t *)cont_pkt->dseg_0_address;
692 sle_dma = sg_dma_address(cur_seg);
693 *cur_dsd++ = cpu_to_le32(LSD(sle_dma));
694 *cur_dsd++ = cpu_to_le32(MSD(sle_dma));
695 *cur_dsd++ = cpu_to_le32(sg_dma_len(cur_seg));
701 *cur_dsd++ = cpu_to_le32(LSD(sp->dma_handle));
702 *cur_dsd++ = cpu_to_le32(MSD(sp->dma_handle));
703 *cur_dsd++ = cpu_to_le32(cmd->request_bufflen);
709 * qla24xx_start_scsi() - Send a SCSI command to the ISP
710 * @sp: command to send to the ISP
712 * Returns non-zero if a failure occured, else zero.
715 qla24xx_start_scsi(srb_t *sp)
720 struct scsi_cmnd *cmd;
724 struct cmd_type_7 *cmd_pkt;
725 struct scatterlist *sg;
729 struct device_reg_24xx __iomem *reg;
731 /* Setup device pointers. */
734 reg = &ha->iobase->isp24;
736 /* So we know we haven't pci_map'ed anything yet */
739 /* Send marker if required */
740 if (ha->marker_needed != 0) {
741 if (qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS) {
742 return QLA_FUNCTION_FAILED;
744 ha->marker_needed = 0;
747 /* Acquire ring specific lock */
748 spin_lock_irqsave(&ha->hardware_lock, flags);
750 /* Check for room in outstanding command list. */
751 handle = ha->current_outstanding_cmd;
752 for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) {
754 if (handle == MAX_OUTSTANDING_COMMANDS)
756 if (ha->outstanding_cmds[handle] == 0)
759 if (index == MAX_OUTSTANDING_COMMANDS)
762 /* Map the sg table so we have an accurate count of sg entries needed */
764 sg = (struct scatterlist *) cmd->request_buffer;
765 tot_dsds = pci_map_sg(ha->pdev, sg, cmd->use_sg,
766 cmd->sc_data_direction);
769 } else if (cmd->request_bufflen) {
772 req_dma = pci_map_single(ha->pdev, cmd->request_buffer,
773 cmd->request_bufflen, cmd->sc_data_direction);
774 if (dma_mapping_error(req_dma))
777 sp->dma_handle = req_dma;
781 req_cnt = qla24xx_calc_iocbs(tot_dsds);
782 if (ha->req_q_cnt < (req_cnt + 2)) {
783 cnt = (uint16_t)RD_REG_DWORD_RELAXED(®->req_q_out);
784 if (ha->req_ring_index < cnt)
785 ha->req_q_cnt = cnt - ha->req_ring_index;
787 ha->req_q_cnt = ha->request_q_length -
788 (ha->req_ring_index - cnt);
790 if (ha->req_q_cnt < (req_cnt + 2))
793 /* Build command packet. */
794 ha->current_outstanding_cmd = handle;
795 ha->outstanding_cmds[handle] = sp;
797 sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle;
798 ha->req_q_cnt -= req_cnt;
800 cmd_pkt = (struct cmd_type_7 *)ha->request_ring_ptr;
801 cmd_pkt->handle = handle;
803 /* Zero out remaining portion of packet. */
804 /* tagged queuing modifier -- default is TSK_SIMPLE (0). */
805 clr_ptr = (uint32_t *)cmd_pkt + 2;
806 memset(clr_ptr, 0, REQUEST_ENTRY_SIZE - 8);
807 cmd_pkt->dseg_count = cpu_to_le16(tot_dsds);
809 /* Set NPORT-ID and LUN number*/
810 cmd_pkt->nport_handle = cpu_to_le16(sp->fcport->loop_id);
811 cmd_pkt->port_id[0] = sp->fcport->d_id.b.al_pa;
812 cmd_pkt->port_id[1] = sp->fcport->d_id.b.area;
813 cmd_pkt->port_id[2] = sp->fcport->d_id.b.domain;
815 int_to_scsilun(sp->cmd->device->lun, &cmd_pkt->lun);
816 host_to_fcp_swap((uint8_t *)&cmd_pkt->lun, sizeof(cmd_pkt->lun));
818 /* Load SCSI command packet. */
819 memcpy(cmd_pkt->fcp_cdb, cmd->cmnd, cmd->cmd_len);
820 host_to_fcp_swap(cmd_pkt->fcp_cdb, sizeof(cmd_pkt->fcp_cdb));
822 cmd_pkt->byte_count = cpu_to_le32((uint32_t)cmd->request_bufflen);
824 /* Build IOCB segments */
825 qla24xx_build_scsi_iocbs(sp, cmd_pkt, tot_dsds);
827 /* Set total data segment count. */
828 cmd_pkt->entry_count = (uint8_t)req_cnt;
831 /* Adjust ring index. */
832 ha->req_ring_index++;
833 if (ha->req_ring_index == ha->request_q_length) {
834 ha->req_ring_index = 0;
835 ha->request_ring_ptr = ha->request_ring;
837 ha->request_ring_ptr++;
839 sp->flags |= SRB_DMA_VALID;
841 /* Set chip new ring index. */
842 WRT_REG_DWORD(®->req_q_in, ha->req_ring_index);
843 RD_REG_DWORD_RELAXED(®->req_q_in); /* PCI Posting. */
845 /* Manage unprocessed RIO/ZIO commands in response queue. */
846 if (ha->flags.process_response_queue &&
847 ha->response_ring_ptr->signature != RESPONSE_PROCESSED)
848 qla24xx_process_response_queue(ha);
850 spin_unlock_irqrestore(&ha->hardware_lock, flags);
854 if (cmd->use_sg && tot_dsds) {
855 sg = (struct scatterlist *) cmd->request_buffer;
856 pci_unmap_sg(ha->pdev, sg, cmd->use_sg,
857 cmd->sc_data_direction);
858 } else if (tot_dsds) {
859 pci_unmap_single(ha->pdev, sp->dma_handle,
860 cmd->request_bufflen, cmd->sc_data_direction);
862 spin_unlock_irqrestore(&ha->hardware_lock, flags);
864 return QLA_FUNCTION_FAILED;