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