1 /*
2  * QLogic Fibre Channel HBA Driver
3  * Copyright (c)  2003-2008 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(scsi_qla_host_t *ha)
36 {
37 	unsigned long flags;
38 
39 	local_irq_save(flags);
40 	ha->isp_ops->intr_handler(0, ha);
41 	local_irq_restore(flags);
42 }
43 
44 static __inline__ scsi_qla_host_t *
45 to_qla_parent(scsi_qla_host_t *ha)
46 {
47 	return ha->parent ? ha->parent : ha;
48 }
49 
50 /**
51  * qla2x00_issue_marker() - Issue a Marker IOCB if necessary.
52  * @ha: HA context
53  * @ha_locked: is function called with the hardware lock
54  *
55  * Returns non-zero if a failure occured, else zero.
56  */
57 static inline int
58 qla2x00_issue_marker(scsi_qla_host_t *ha, int ha_locked)
59 {
60 	/* Send marker if required */
61 	if (ha->marker_needed != 0) {
62 		if (ha_locked) {
63 			if (__qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) !=
64 			    QLA_SUCCESS)
65 				return (QLA_FUNCTION_FAILED);
66 		} else {
67 			if (qla2x00_marker(ha, 0, 0, MK_SYNC_ALL) !=
68 			    QLA_SUCCESS)
69 				return (QLA_FUNCTION_FAILED);
70 		}
71 		ha->marker_needed = 0;
72 	}
73 	return (QLA_SUCCESS);
74 }
75 
76 static inline uint8_t *
77 host_to_fcp_swap(uint8_t *fcp, uint32_t bsize)
78 {
79        uint32_t *ifcp = (uint32_t *) fcp;
80        uint32_t *ofcp = (uint32_t *) fcp;
81        uint32_t iter = bsize >> 2;
82 
83        for (; iter ; iter--)
84                *ofcp++ = swab32(*ifcp++);
85 
86        return fcp;
87 }
88 
89 static inline int
90 qla2x00_is_reserved_id(scsi_qla_host_t *ha, uint16_t loop_id)
91 {
92 	if (IS_FWI2_CAPABLE(ha))
93 		return (loop_id > NPH_LAST_HANDLE);
94 
95 	return ((loop_id > ha->last_loop_id && loop_id < SNS_FIRST_LOOP_ID) ||
96 	    loop_id == MANAGEMENT_SERVER || loop_id == BROADCAST);
97 };
98