1 /* 2 * QLogic Fibre Channel HBA Driver 3 * Copyright (c) 2003-2014 QLogic Corporation 4 * 5 * See LICENSE.qla2xxx for copyright and licensing details. 6 */ 7 8 #include "qla_target.h" 9 /** 10 * qla24xx_calc_iocbs() - Determine number of Command Type 3 and 11 * Continuation Type 1 IOCBs to allocate. 12 * 13 * @vha: HA context 14 * @dsds: number of data segment decriptors needed 15 * 16 * Returns the number of IOCB entries needed to store @dsds. 17 */ 18 static inline uint16_t 19 qla24xx_calc_iocbs(scsi_qla_host_t *vha, uint16_t dsds) 20 { 21 uint16_t iocbs; 22 23 iocbs = 1; 24 if (dsds > 1) { 25 iocbs += (dsds - 1) / 5; 26 if ((dsds - 1) % 5) 27 iocbs++; 28 } 29 return iocbs; 30 } 31 32 /* 33 * qla2x00_debounce_register 34 * Debounce register. 35 * 36 * Input: 37 * port = register address. 38 * 39 * Returns: 40 * register value. 41 */ 42 static __inline__ uint16_t 43 qla2x00_debounce_register(volatile uint16_t __iomem *addr) 44 { 45 volatile uint16_t first; 46 volatile uint16_t second; 47 48 do { 49 first = RD_REG_WORD(addr); 50 barrier(); 51 cpu_relax(); 52 second = RD_REG_WORD(addr); 53 } while (first != second); 54 55 return (first); 56 } 57 58 static inline void 59 qla2x00_poll(struct rsp_que *rsp) 60 { 61 struct qla_hw_data *ha = rsp->hw; 62 63 if (IS_P3P_TYPE(ha)) 64 qla82xx_poll(0, rsp); 65 else 66 ha->isp_ops->intr_handler(0, rsp); 67 } 68 69 static inline uint8_t * 70 host_to_fcp_swap(uint8_t *fcp, uint32_t bsize) 71 { 72 uint32_t *ifcp = (uint32_t *) fcp; 73 uint32_t *ofcp = (uint32_t *) fcp; 74 uint32_t iter = bsize >> 2; 75 76 for (; iter ; iter--) 77 *ofcp++ = swab32(*ifcp++); 78 79 return fcp; 80 } 81 82 static inline void 83 host_to_adap(uint8_t *src, uint8_t *dst, uint32_t bsize) 84 { 85 uint32_t *isrc = (uint32_t *) src; 86 __le32 *odest = (__le32 *) dst; 87 uint32_t iter = bsize >> 2; 88 89 for ( ; iter--; isrc++) 90 *odest++ = cpu_to_le32(*isrc); 91 } 92 93 static inline void 94 qla2x00_set_reserved_loop_ids(struct qla_hw_data *ha) 95 { 96 int i; 97 98 if (IS_FWI2_CAPABLE(ha)) 99 return; 100 101 for (i = 0; i < SNS_FIRST_LOOP_ID; i++) 102 set_bit(i, ha->loop_id_map); 103 set_bit(MANAGEMENT_SERVER, ha->loop_id_map); 104 set_bit(BROADCAST, ha->loop_id_map); 105 } 106 107 static inline int 108 qla2x00_is_reserved_id(scsi_qla_host_t *vha, uint16_t loop_id) 109 { 110 struct qla_hw_data *ha = vha->hw; 111 if (IS_FWI2_CAPABLE(ha)) 112 return (loop_id > NPH_LAST_HANDLE); 113 114 return ((loop_id > ha->max_loop_id && loop_id < SNS_FIRST_LOOP_ID) || 115 loop_id == MANAGEMENT_SERVER || loop_id == BROADCAST); 116 } 117 118 static inline void 119 qla2x00_clear_loop_id(fc_port_t *fcport) { 120 struct qla_hw_data *ha = fcport->vha->hw; 121 122 if (fcport->loop_id == FC_NO_LOOP_ID || 123 qla2x00_is_reserved_id(fcport->vha, fcport->loop_id)) 124 return; 125 126 clear_bit(fcport->loop_id, ha->loop_id_map); 127 fcport->loop_id = FC_NO_LOOP_ID; 128 } 129 130 static inline void 131 qla2x00_clean_dsd_pool(struct qla_hw_data *ha, struct crc_context *ctx) 132 { 133 struct dsd_dma *dsd, *tdsd; 134 135 /* clean up allocated prev pool */ 136 list_for_each_entry_safe(dsd, tdsd, &ctx->dsd_list, list) { 137 dma_pool_free(ha->dl_dma_pool, dsd->dsd_addr, 138 dsd->dsd_list_dma); 139 list_del(&dsd->list); 140 kfree(dsd); 141 } 142 INIT_LIST_HEAD(&ctx->dsd_list); 143 } 144 145 static inline void 146 qla2x00_set_fcport_state(fc_port_t *fcport, int state) 147 { 148 int old_state; 149 150 old_state = atomic_read(&fcport->state); 151 atomic_set(&fcport->state, state); 152 153 /* Don't print state transitions during initial allocation of fcport */ 154 if (old_state && old_state != state) { 155 ql_dbg(ql_dbg_disc, fcport->vha, 0x207d, 156 "FCPort %8phC state transitioned from %s to %s - " 157 "portid=%02x%02x%02x.\n", fcport->port_name, 158 port_state_str[old_state], port_state_str[state], 159 fcport->d_id.b.domain, fcport->d_id.b.area, 160 fcport->d_id.b.al_pa); 161 } 162 } 163 164 static inline int 165 qla2x00_hba_err_chk_enabled(srb_t *sp) 166 { 167 /* 168 * Uncomment when corresponding SCSI changes are done. 169 * 170 if (!sp->cmd->prot_chk) 171 return 0; 172 * 173 */ 174 switch (scsi_get_prot_op(GET_CMD_SP(sp))) { 175 case SCSI_PROT_READ_STRIP: 176 case SCSI_PROT_WRITE_INSERT: 177 if (ql2xenablehba_err_chk >= 1) 178 return 1; 179 break; 180 case SCSI_PROT_READ_PASS: 181 case SCSI_PROT_WRITE_PASS: 182 if (ql2xenablehba_err_chk >= 2) 183 return 1; 184 break; 185 case SCSI_PROT_READ_INSERT: 186 case SCSI_PROT_WRITE_STRIP: 187 return 1; 188 } 189 return 0; 190 } 191 192 static inline int 193 qla2x00_reset_active(scsi_qla_host_t *vha) 194 { 195 scsi_qla_host_t *base_vha = pci_get_drvdata(vha->hw->pdev); 196 197 /* Test appropriate base-vha and vha flags. */ 198 return test_bit(ISP_ABORT_NEEDED, &base_vha->dpc_flags) || 199 test_bit(ABORT_ISP_ACTIVE, &base_vha->dpc_flags) || 200 test_bit(ISP_ABORT_RETRY, &base_vha->dpc_flags) || 201 test_bit(ISP_ABORT_NEEDED, &vha->dpc_flags) || 202 test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags); 203 } 204 205 static inline int 206 qla2x00_chip_is_down(scsi_qla_host_t *vha) 207 { 208 return (qla2x00_reset_active(vha) || !vha->hw->flags.fw_started); 209 } 210 211 static inline srb_t * 212 qla2xxx_get_qpair_sp(struct qla_qpair *qpair, fc_port_t *fcport, gfp_t flag) 213 { 214 srb_t *sp = NULL; 215 uint8_t bail; 216 217 QLA_QPAIR_MARK_BUSY(qpair, bail); 218 if (unlikely(bail)) 219 return NULL; 220 221 sp = mempool_alloc(qpair->srb_mempool, flag); 222 if (!sp) 223 goto done; 224 225 memset(sp, 0, sizeof(*sp)); 226 sp->fcport = fcport; 227 sp->iocbs = 1; 228 sp->vha = qpair->vha; 229 INIT_LIST_HEAD(&sp->elem); 230 231 done: 232 if (!sp) 233 QLA_QPAIR_MARK_NOT_BUSY(qpair); 234 return sp; 235 } 236 237 static inline void 238 qla2xxx_rel_qpair_sp(struct qla_qpair *qpair, srb_t *sp) 239 { 240 mempool_free(sp, qpair->srb_mempool); 241 QLA_QPAIR_MARK_NOT_BUSY(qpair); 242 } 243 244 static inline srb_t * 245 qla2x00_get_sp(scsi_qla_host_t *vha, fc_port_t *fcport, gfp_t flag) 246 { 247 srb_t *sp = NULL; 248 uint8_t bail; 249 250 QLA_VHA_MARK_BUSY(vha, bail); 251 if (unlikely(bail)) 252 return NULL; 253 254 sp = mempool_alloc(vha->hw->srb_mempool, flag); 255 if (!sp) 256 goto done; 257 258 memset(sp, 0, sizeof(*sp)); 259 sp->fcport = fcport; 260 sp->cmd_type = TYPE_SRB; 261 sp->iocbs = 1; 262 sp->vha = vha; 263 done: 264 if (!sp) 265 QLA_VHA_MARK_NOT_BUSY(vha); 266 return sp; 267 } 268 269 static inline void 270 qla2x00_rel_sp(srb_t *sp) 271 { 272 QLA_VHA_MARK_NOT_BUSY(sp->vha); 273 mempool_free(sp, sp->vha->hw->srb_mempool); 274 } 275 276 static inline void 277 qla2x00_init_timer(srb_t *sp, unsigned long tmo) 278 { 279 timer_setup(&sp->u.iocb_cmd.timer, qla2x00_sp_timeout, 0); 280 sp->u.iocb_cmd.timer.expires = jiffies + tmo * HZ; 281 sp->free = qla2x00_sp_free; 282 init_completion(&sp->comp); 283 if (IS_QLAFX00(sp->vha->hw) && (sp->type == SRB_FXIOCB_DCMD)) 284 init_completion(&sp->u.iocb_cmd.u.fxiocb.fxiocb_comp); 285 add_timer(&sp->u.iocb_cmd.timer); 286 } 287 288 static inline int 289 qla2x00_gid_list_size(struct qla_hw_data *ha) 290 { 291 if (IS_QLAFX00(ha)) 292 return sizeof(uint32_t) * 32; 293 else 294 return sizeof(struct gid_list_info) * ha->max_fibre_devices; 295 } 296 297 static inline void 298 qla2x00_handle_mbx_completion(struct qla_hw_data *ha, int status) 299 { 300 if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) && 301 (status & MBX_INTERRUPT) && ha->flags.mbox_int) { 302 set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags); 303 clear_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags); 304 complete(&ha->mbx_intr_comp); 305 } 306 } 307 308 static inline void 309 qla2x00_set_retry_delay_timestamp(fc_port_t *fcport, uint16_t retry_delay) 310 { 311 if (retry_delay) 312 fcport->retry_delay_timestamp = jiffies + 313 (retry_delay * HZ / 10); 314 } 315 316 static inline bool 317 qla_is_exch_offld_enabled(struct scsi_qla_host *vha) 318 { 319 if (qla_ini_mode_enabled(vha) && 320 (ql2xiniexchg > FW_DEF_EXCHANGES_CNT)) 321 return true; 322 else if (qla_tgt_mode_enabled(vha) && 323 (ql2xexchoffld > FW_DEF_EXCHANGES_CNT)) 324 return true; 325 else if (qla_dual_mode_enabled(vha) && 326 ((ql2xiniexchg + ql2xexchoffld) > FW_DEF_EXCHANGES_CNT)) 327 return true; 328 else 329 return false; 330 } 331 332 static inline void 333 qla_cpu_update(struct qla_qpair *qpair, uint16_t cpuid) 334 { 335 qpair->cpuid = cpuid; 336 337 if (!list_empty(&qpair->hints_list)) { 338 struct qla_qpair_hint *h; 339 340 list_for_each_entry(h, &qpair->hints_list, hint_elem) 341 h->cpuid = qpair->cpuid; 342 } 343 } 344 345 static inline struct qla_qpair_hint * 346 qla_qpair_to_hint(struct qla_tgt *tgt, struct qla_qpair *qpair) 347 { 348 struct qla_qpair_hint *h; 349 u16 i; 350 351 for (i = 0; i < tgt->ha->max_qpairs + 1; i++) { 352 h = &tgt->qphints[i]; 353 if (h->qpair == qpair) 354 return h; 355 } 356 357 return NULL; 358 } 359 360 static inline void 361 qla_83xx_start_iocbs(struct qla_qpair *qpair) 362 { 363 struct req_que *req = qpair->req; 364 365 req->ring_index++; 366 if (req->ring_index == req->length) { 367 req->ring_index = 0; 368 req->ring_ptr = req->ring; 369 } else 370 req->ring_ptr++; 371 372 WRT_REG_DWORD(req->req_q_in, req->ring_index); 373 } 374