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