1
2
3
4
5
6
7
8#include "qla_target.h"
9
10
11
12
13
14
15
16
17
18static inline uint16_t
19qla24xx_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
34
35
36
37
38
39
40
41
42static __inline__ uint16_t
43qla2x00_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
58static inline void
59qla2x00_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
69static inline uint8_t *
70host_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
82static inline void
83host_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
93static inline void
94qla2x00_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
107static inline int
108qla2x00_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
118static inline void
119qla2x00_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
130static inline void
131qla2x00_clean_dsd_pool(struct qla_hw_data *ha, struct crc_context *ctx)
132{
133 struct dsd_dma *dsd, *tdsd;
134
135
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
145static inline void
146qla2x00_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
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
164static inline int
165qla2x00_hba_err_chk_enabled(srb_t *sp)
166{
167
168
169
170
171
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
192static inline int
193qla2x00_reset_active(scsi_qla_host_t *vha)
194{
195 scsi_qla_host_t *base_vha = pci_get_drvdata(vha->hw->pdev);
196
197
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
205static inline int
206qla2x00_chip_is_down(scsi_qla_host_t *vha)
207{
208 return (qla2x00_reset_active(vha) || !vha->hw->flags.fw_started);
209}
210
211static inline srb_t *
212qla2xxx_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
231done:
232 if (!sp)
233 QLA_QPAIR_MARK_NOT_BUSY(qpair);
234 return sp;
235}
236
237static inline void
238qla2xxx_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
244static inline srb_t *
245qla2x00_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;
263done:
264 if (!sp)
265 QLA_VHA_MARK_NOT_BUSY(vha);
266 return sp;
267}
268
269static inline void
270qla2x00_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
276static inline void
277qla2x00_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
288static inline int
289qla2x00_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
297static inline void
298qla2x00_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
308static inline void
309qla2x00_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
316static inline bool
317qla_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
332static inline void
333qla_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
345static inline struct qla_qpair_hint *
346qla_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
360static inline void
361qla_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
