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
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
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 *
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
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
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