1 /*
2 * QLogic Fibre Channel HBA Driver
3 * Copyright (c) 2003-2010 QLogic Corporation
4 *
5 * See LICENSE.qla2xxx for copyright and licensing details.
6 */
7
8 /*
9 * qla2x00_debounce_register
10 * Debounce register.
11 *
12 * Input:
13 * port = register address.
14 *
15 * Returns:
16 * register value.
17 */
18 static __inline__ uint16_t
qla2x00_debounce_register(volatile uint16_t __iomem * addr)19 qla2x00_debounce_register(volatile uint16_t __iomem *addr)
20 {
21 volatile uint16_t first;
22 volatile uint16_t second;
23
24 do {
25 first = RD_REG_WORD(addr);
26 barrier();
27 cpu_relax();
28 second = RD_REG_WORD(addr);
29 } while (first != second);
30
31 return (first);
32 }
33
34 static inline void
qla2x00_poll(struct rsp_que * rsp)35 qla2x00_poll(struct rsp_que *rsp)
36 {
37 unsigned long flags;
38 struct qla_hw_data *ha = rsp->hw;
39 local_irq_save(flags);
40 if (IS_QLA82XX(ha))
41 qla82xx_poll(0, rsp);
42 else
43 ha->isp_ops->intr_handler(0, rsp);
44 local_irq_restore(flags);
45 }
46
47 static inline uint8_t *
host_to_fcp_swap(uint8_t * fcp,uint32_t bsize)48 host_to_fcp_swap(uint8_t *fcp, uint32_t bsize)
49 {
50 uint32_t *ifcp = (uint32_t *) fcp;
51 uint32_t *ofcp = (uint32_t *) fcp;
52 uint32_t iter = bsize >> 2;
53
54 for (; iter ; iter--)
55 *ofcp++ = swab32(*ifcp++);
56
57 return fcp;
58 }
59
60 static inline int
qla2x00_is_reserved_id(scsi_qla_host_t * vha,uint16_t loop_id)61 qla2x00_is_reserved_id(scsi_qla_host_t *vha, uint16_t loop_id)
62 {
63 struct qla_hw_data *ha = vha->hw;
64 if (IS_FWI2_CAPABLE(ha))
65 return (loop_id > NPH_LAST_HANDLE);
66
67 return ((loop_id > ha->max_loop_id && loop_id < SNS_FIRST_LOOP_ID) ||
68 loop_id == MANAGEMENT_SERVER || loop_id == BROADCAST);
69 }
70
71 static inline void
qla2x00_clean_dsd_pool(struct qla_hw_data * ha,srb_t * sp)72 qla2x00_clean_dsd_pool(struct qla_hw_data *ha, srb_t *sp)
73 {
74 struct dsd_dma *dsd_ptr, *tdsd_ptr;
75
76 /* clean up allocated prev pool */
77 list_for_each_entry_safe(dsd_ptr, tdsd_ptr,
78 &((struct crc_context *)sp->ctx)->dsd_list, list) {
79 dma_pool_free(ha->dl_dma_pool, dsd_ptr->dsd_addr,
80 dsd_ptr->dsd_list_dma);
81 list_del(&dsd_ptr->list);
82 kfree(dsd_ptr);
83 }
84 INIT_LIST_HEAD(&((struct crc_context *)sp->ctx)->dsd_list);
85 }
86