1a9083016SGiridhar Malavali /* 2a9083016SGiridhar Malavali * QLogic Fibre Channel HBA Driver 3a9083016SGiridhar Malavali * Copyright (c) 2003-2008 QLogic Corporation 4a9083016SGiridhar Malavali * 5a9083016SGiridhar Malavali * See LICENSE.qla2xxx for copyright and licensing details. 6a9083016SGiridhar Malavali */ 7a9083016SGiridhar Malavali #include "qla_def.h" 8a9083016SGiridhar Malavali #include <linux/delay.h> 9a9083016SGiridhar Malavali #include <linux/pci.h> 10a9083016SGiridhar Malavali 11a9083016SGiridhar Malavali #define MASK(n) ((1ULL<<(n))-1) 12a9083016SGiridhar Malavali #define MN_WIN(addr) (((addr & 0x1fc0000) >> 1) | \ 13a9083016SGiridhar Malavali ((addr >> 25) & 0x3ff)) 14a9083016SGiridhar Malavali #define OCM_WIN(addr) (((addr & 0x1ff0000) >> 1) | \ 15a9083016SGiridhar Malavali ((addr >> 25) & 0x3ff)) 16a9083016SGiridhar Malavali #define MS_WIN(addr) (addr & 0x0ffc0000) 17a9083016SGiridhar Malavali #define QLA82XX_PCI_MN_2M (0) 18a9083016SGiridhar Malavali #define QLA82XX_PCI_MS_2M (0x80000) 19a9083016SGiridhar Malavali #define QLA82XX_PCI_OCM0_2M (0xc0000) 20a9083016SGiridhar Malavali #define VALID_OCM_ADDR(addr) (((addr) & 0x3f800) != 0x3f800) 21a9083016SGiridhar Malavali #define GET_MEM_OFFS_2M(addr) (addr & MASK(18)) 22a9083016SGiridhar Malavali 23a9083016SGiridhar Malavali /* CRB window related */ 24a9083016SGiridhar Malavali #define CRB_BLK(off) ((off >> 20) & 0x3f) 25a9083016SGiridhar Malavali #define CRB_SUBBLK(off) ((off >> 16) & 0xf) 26a9083016SGiridhar Malavali #define CRB_WINDOW_2M (0x130060) 27a9083016SGiridhar Malavali #define QLA82XX_PCI_CAMQM_2M_END (0x04800800UL) 28a9083016SGiridhar Malavali #define CRB_HI(off) ((qla82xx_crb_hub_agt[CRB_BLK(off)] << 20) | \ 29a9083016SGiridhar Malavali ((off) & 0xf0000)) 30a9083016SGiridhar Malavali #define QLA82XX_PCI_CAMQM_2M_BASE (0x000ff800UL) 31a9083016SGiridhar Malavali #define CRB_INDIRECT_2M (0x1e0000UL) 32a9083016SGiridhar Malavali 33a9083016SGiridhar Malavali static inline void *qla82xx_pci_base_offsetfset(struct qla_hw_data *ha, 34a9083016SGiridhar Malavali unsigned long off) 35a9083016SGiridhar Malavali { 36a9083016SGiridhar Malavali if ((off < ha->first_page_group_end) && 37a9083016SGiridhar Malavali (off >= ha->first_page_group_start)) 38a9083016SGiridhar Malavali return (void *)(ha->nx_pcibase + off); 39a9083016SGiridhar Malavali 40a9083016SGiridhar Malavali return NULL; 41a9083016SGiridhar Malavali } 42a9083016SGiridhar Malavali 43a9083016SGiridhar Malavali #define MAX_CRB_XFORM 60 44a9083016SGiridhar Malavali static unsigned long crb_addr_xform[MAX_CRB_XFORM]; 45a9083016SGiridhar Malavali int qla82xx_crb_table_initialized; 46a9083016SGiridhar Malavali 47a9083016SGiridhar Malavali #define qla82xx_crb_addr_transform(name) \ 48a9083016SGiridhar Malavali (crb_addr_xform[QLA82XX_HW_PX_MAP_CRB_##name] = \ 49a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_##name << 20) 50a9083016SGiridhar Malavali 51a9083016SGiridhar Malavali static void qla82xx_crb_addr_transform_setup(void) 52a9083016SGiridhar Malavali { 53a9083016SGiridhar Malavali qla82xx_crb_addr_transform(XDMA); 54a9083016SGiridhar Malavali qla82xx_crb_addr_transform(TIMR); 55a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SRE); 56a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQN3); 57a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQN2); 58a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQN1); 59a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQN0); 60a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQS3); 61a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQS2); 62a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQS1); 63a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SQS0); 64a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX7); 65a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX6); 66a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX5); 67a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX4); 68a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX3); 69a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX2); 70a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX1); 71a9083016SGiridhar Malavali qla82xx_crb_addr_transform(RPMX0); 72a9083016SGiridhar Malavali qla82xx_crb_addr_transform(ROMUSB); 73a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SN); 74a9083016SGiridhar Malavali qla82xx_crb_addr_transform(QMN); 75a9083016SGiridhar Malavali qla82xx_crb_addr_transform(QMS); 76a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGNI); 77a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGND); 78a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGN3); 79a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGN2); 80a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGN1); 81a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGN0); 82a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGSI); 83a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGSD); 84a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGS3); 85a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGS2); 86a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGS1); 87a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PGS0); 88a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PS); 89a9083016SGiridhar Malavali qla82xx_crb_addr_transform(PH); 90a9083016SGiridhar Malavali qla82xx_crb_addr_transform(NIU); 91a9083016SGiridhar Malavali qla82xx_crb_addr_transform(I2Q); 92a9083016SGiridhar Malavali qla82xx_crb_addr_transform(EG); 93a9083016SGiridhar Malavali qla82xx_crb_addr_transform(MN); 94a9083016SGiridhar Malavali qla82xx_crb_addr_transform(MS); 95a9083016SGiridhar Malavali qla82xx_crb_addr_transform(CAS2); 96a9083016SGiridhar Malavali qla82xx_crb_addr_transform(CAS1); 97a9083016SGiridhar Malavali qla82xx_crb_addr_transform(CAS0); 98a9083016SGiridhar Malavali qla82xx_crb_addr_transform(CAM); 99a9083016SGiridhar Malavali qla82xx_crb_addr_transform(C2C1); 100a9083016SGiridhar Malavali qla82xx_crb_addr_transform(C2C0); 101a9083016SGiridhar Malavali qla82xx_crb_addr_transform(SMB); 102a9083016SGiridhar Malavali qla82xx_crb_addr_transform(OCM0); 103a9083016SGiridhar Malavali /* 104a9083016SGiridhar Malavali * Used only in P3 just define it for P2 also. 105a9083016SGiridhar Malavali */ 106a9083016SGiridhar Malavali qla82xx_crb_addr_transform(I2C0); 107a9083016SGiridhar Malavali 108a9083016SGiridhar Malavali qla82xx_crb_table_initialized = 1; 109a9083016SGiridhar Malavali } 110a9083016SGiridhar Malavali 111a9083016SGiridhar Malavali struct crb_128M_2M_block_map crb_128M_2M_map[64] = { 112a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 113a9083016SGiridhar Malavali {{{1, 0x0100000, 0x0102000, 0x120000}, 114a9083016SGiridhar Malavali {1, 0x0110000, 0x0120000, 0x130000}, 115a9083016SGiridhar Malavali {1, 0x0120000, 0x0122000, 0x124000}, 116a9083016SGiridhar Malavali {1, 0x0130000, 0x0132000, 0x126000}, 117a9083016SGiridhar Malavali {1, 0x0140000, 0x0142000, 0x128000}, 118a9083016SGiridhar Malavali {1, 0x0150000, 0x0152000, 0x12a000}, 119a9083016SGiridhar Malavali {1, 0x0160000, 0x0170000, 0x110000}, 120a9083016SGiridhar Malavali {1, 0x0170000, 0x0172000, 0x12e000}, 121a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 122a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 123a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 124a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 125a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 126a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 127a9083016SGiridhar Malavali {1, 0x01e0000, 0x01e0800, 0x122000}, 128a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000} } } , 129a9083016SGiridhar Malavali {{{1, 0x0200000, 0x0210000, 0x180000} } }, 130a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 131a9083016SGiridhar Malavali {{{1, 0x0400000, 0x0401000, 0x169000} } }, 132a9083016SGiridhar Malavali {{{1, 0x0500000, 0x0510000, 0x140000} } }, 133a9083016SGiridhar Malavali {{{1, 0x0600000, 0x0610000, 0x1c0000} } }, 134a9083016SGiridhar Malavali {{{1, 0x0700000, 0x0704000, 0x1b8000} } }, 135a9083016SGiridhar Malavali {{{1, 0x0800000, 0x0802000, 0x170000}, 136a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 137a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 138a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 139a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 140a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 141a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 142a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 143a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 144a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 145a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 146a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 147a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 148a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 149a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 150a9083016SGiridhar Malavali {1, 0x08f0000, 0x08f2000, 0x172000} } }, 151a9083016SGiridhar Malavali {{{1, 0x0900000, 0x0902000, 0x174000}, 152a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 153a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 154a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 155a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 156a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 157a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 158a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 159a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 160a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 161a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 162a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 163a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 164a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 165a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 166a9083016SGiridhar Malavali {1, 0x09f0000, 0x09f2000, 0x176000} } }, 167a9083016SGiridhar Malavali {{{0, 0x0a00000, 0x0a02000, 0x178000}, 168a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 169a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 170a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 171a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 172a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 173a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 174a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 175a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 176a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 177a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 178a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 179a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 180a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 181a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 182a9083016SGiridhar Malavali {1, 0x0af0000, 0x0af2000, 0x17a000} } }, 183a9083016SGiridhar Malavali {{{0, 0x0b00000, 0x0b02000, 0x17c000}, 184a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 185a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 186a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 187a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 188a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 189a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 190a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 191a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 192a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 193a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 194a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 195a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 196a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 197a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 198a9083016SGiridhar Malavali {1, 0x0bf0000, 0x0bf2000, 0x17e000} } }, 199a9083016SGiridhar Malavali {{{1, 0x0c00000, 0x0c04000, 0x1d4000} } }, 200a9083016SGiridhar Malavali {{{1, 0x0d00000, 0x0d04000, 0x1a4000} } }, 201a9083016SGiridhar Malavali {{{1, 0x0e00000, 0x0e04000, 0x1a0000} } }, 202a9083016SGiridhar Malavali {{{1, 0x0f00000, 0x0f01000, 0x164000} } }, 203a9083016SGiridhar Malavali {{{0, 0x1000000, 0x1004000, 0x1a8000} } }, 204a9083016SGiridhar Malavali {{{1, 0x1100000, 0x1101000, 0x160000} } }, 205a9083016SGiridhar Malavali {{{1, 0x1200000, 0x1201000, 0x161000} } }, 206a9083016SGiridhar Malavali {{{1, 0x1300000, 0x1301000, 0x162000} } }, 207a9083016SGiridhar Malavali {{{1, 0x1400000, 0x1401000, 0x163000} } }, 208a9083016SGiridhar Malavali {{{1, 0x1500000, 0x1501000, 0x165000} } }, 209a9083016SGiridhar Malavali {{{1, 0x1600000, 0x1601000, 0x166000} } }, 210a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 211a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 212a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 213a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 214a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 215a9083016SGiridhar Malavali {{{0, 0, 0, 0} } }, 216a9083016SGiridhar Malavali {{{1, 0x1d00000, 0x1d10000, 0x190000} } }, 217a9083016SGiridhar Malavali {{{1, 0x1e00000, 0x1e01000, 0x16a000} } }, 218a9083016SGiridhar Malavali {{{1, 0x1f00000, 0x1f10000, 0x150000} } }, 219a9083016SGiridhar Malavali {{{0} } }, 220a9083016SGiridhar Malavali {{{1, 0x2100000, 0x2102000, 0x120000}, 221a9083016SGiridhar Malavali {1, 0x2110000, 0x2120000, 0x130000}, 222a9083016SGiridhar Malavali {1, 0x2120000, 0x2122000, 0x124000}, 223a9083016SGiridhar Malavali {1, 0x2130000, 0x2132000, 0x126000}, 224a9083016SGiridhar Malavali {1, 0x2140000, 0x2142000, 0x128000}, 225a9083016SGiridhar Malavali {1, 0x2150000, 0x2152000, 0x12a000}, 226a9083016SGiridhar Malavali {1, 0x2160000, 0x2170000, 0x110000}, 227a9083016SGiridhar Malavali {1, 0x2170000, 0x2172000, 0x12e000}, 228a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 229a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 230a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 231a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 232a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 233a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 234a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000}, 235a9083016SGiridhar Malavali {0, 0x0000000, 0x0000000, 0x000000} } }, 236a9083016SGiridhar Malavali {{{1, 0x2200000, 0x2204000, 0x1b0000} } }, 237a9083016SGiridhar Malavali {{{0} } }, 238a9083016SGiridhar Malavali {{{0} } }, 239a9083016SGiridhar Malavali {{{0} } }, 240a9083016SGiridhar Malavali {{{0} } }, 241a9083016SGiridhar Malavali {{{0} } }, 242a9083016SGiridhar Malavali {{{1, 0x2800000, 0x2804000, 0x1a4000} } }, 243a9083016SGiridhar Malavali {{{1, 0x2900000, 0x2901000, 0x16b000} } }, 244a9083016SGiridhar Malavali {{{1, 0x2a00000, 0x2a00400, 0x1ac400} } }, 245a9083016SGiridhar Malavali {{{1, 0x2b00000, 0x2b00400, 0x1ac800} } }, 246a9083016SGiridhar Malavali {{{1, 0x2c00000, 0x2c00400, 0x1acc00} } }, 247a9083016SGiridhar Malavali {{{1, 0x2d00000, 0x2d00400, 0x1ad000} } }, 248a9083016SGiridhar Malavali {{{1, 0x2e00000, 0x2e00400, 0x1ad400} } }, 249a9083016SGiridhar Malavali {{{1, 0x2f00000, 0x2f00400, 0x1ad800} } }, 250a9083016SGiridhar Malavali {{{1, 0x3000000, 0x3000400, 0x1adc00} } }, 251a9083016SGiridhar Malavali {{{0, 0x3100000, 0x3104000, 0x1a8000} } }, 252a9083016SGiridhar Malavali {{{1, 0x3200000, 0x3204000, 0x1d4000} } }, 253a9083016SGiridhar Malavali {{{1, 0x3300000, 0x3304000, 0x1a0000} } }, 254a9083016SGiridhar Malavali {{{0} } }, 255a9083016SGiridhar Malavali {{{1, 0x3500000, 0x3500400, 0x1ac000} } }, 256a9083016SGiridhar Malavali {{{1, 0x3600000, 0x3600400, 0x1ae000} } }, 257a9083016SGiridhar Malavali {{{1, 0x3700000, 0x3700400, 0x1ae400} } }, 258a9083016SGiridhar Malavali {{{1, 0x3800000, 0x3804000, 0x1d0000} } }, 259a9083016SGiridhar Malavali {{{1, 0x3900000, 0x3904000, 0x1b4000} } }, 260a9083016SGiridhar Malavali {{{1, 0x3a00000, 0x3a04000, 0x1d8000} } }, 261a9083016SGiridhar Malavali {{{0} } }, 262a9083016SGiridhar Malavali {{{0} } }, 263a9083016SGiridhar Malavali {{{1, 0x3d00000, 0x3d04000, 0x1dc000} } }, 264a9083016SGiridhar Malavali {{{1, 0x3e00000, 0x3e01000, 0x167000} } }, 265a9083016SGiridhar Malavali {{{1, 0x3f00000, 0x3f01000, 0x168000} } } 266a9083016SGiridhar Malavali }; 267a9083016SGiridhar Malavali 268a9083016SGiridhar Malavali /* 269a9083016SGiridhar Malavali * top 12 bits of crb internal address (hub, agent) 270a9083016SGiridhar Malavali */ 271a9083016SGiridhar Malavali unsigned qla82xx_crb_hub_agt[64] = { 272a9083016SGiridhar Malavali 0, 273a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PS, 274a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_MN, 275a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_MS, 276a9083016SGiridhar Malavali 0, 277a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_SRE, 278a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_NIU, 279a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_QMN, 280a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_SQN0, 281a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_SQN1, 282a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_SQN2, 283a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_SQN3, 284a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_I2Q, 285a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_TIMR, 286a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_ROMUSB, 287a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGN4, 288a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_XDMA, 289a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGN0, 290a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGN1, 291a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGN2, 292a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGN3, 293a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGND, 294a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGNI, 295a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGS0, 296a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGS1, 297a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGS2, 298a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGS3, 299a9083016SGiridhar Malavali 0, 300a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGSI, 301a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_SN, 302a9083016SGiridhar Malavali 0, 303a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_EG, 304a9083016SGiridhar Malavali 0, 305a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PS, 306a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_CAM, 307a9083016SGiridhar Malavali 0, 308a9083016SGiridhar Malavali 0, 309a9083016SGiridhar Malavali 0, 310a9083016SGiridhar Malavali 0, 311a9083016SGiridhar Malavali 0, 312a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_TIMR, 313a9083016SGiridhar Malavali 0, 314a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX1, 315a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX2, 316a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX3, 317a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX4, 318a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX5, 319a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX6, 320a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX7, 321a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_XDMA, 322a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_I2Q, 323a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_ROMUSB, 324a9083016SGiridhar Malavali 0, 325a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX0, 326a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX8, 327a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_RPMX9, 328a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_OCM0, 329a9083016SGiridhar Malavali 0, 330a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_SMB, 331a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_I2C0, 332a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_I2C1, 333a9083016SGiridhar Malavali 0, 334a9083016SGiridhar Malavali QLA82XX_HW_CRB_HUB_AGT_ADR_PGNC, 335a9083016SGiridhar Malavali 0, 336a9083016SGiridhar Malavali }; 337a9083016SGiridhar Malavali 338a9083016SGiridhar Malavali /* 339a9083016SGiridhar Malavali * In: 'off' is offset from CRB space in 128M pci map 340a9083016SGiridhar Malavali * Out: 'off' is 2M pci map addr 341a9083016SGiridhar Malavali * side effect: lock crb window 342a9083016SGiridhar Malavali */ 343a9083016SGiridhar Malavali static void 344a9083016SGiridhar Malavali qla82xx_pci_set_crbwindow_2M(struct qla_hw_data *ha, ulong *off) 345a9083016SGiridhar Malavali { 346a9083016SGiridhar Malavali u32 win_read; 347a9083016SGiridhar Malavali 348a9083016SGiridhar Malavali ha->crb_win = CRB_HI(*off); 349a9083016SGiridhar Malavali writel(ha->crb_win, 350a9083016SGiridhar Malavali (void *)(CRB_WINDOW_2M + ha->nx_pcibase)); 351a9083016SGiridhar Malavali 352a9083016SGiridhar Malavali /* Read back value to make sure write has gone through before trying 353a9083016SGiridhar Malavali * to use it. 354a9083016SGiridhar Malavali */ 355a9083016SGiridhar Malavali win_read = RD_REG_DWORD((void *)(CRB_WINDOW_2M + ha->nx_pcibase)); 356a9083016SGiridhar Malavali if (win_read != ha->crb_win) { 357a9083016SGiridhar Malavali DEBUG2(qla_printk(KERN_INFO, ha, 358a9083016SGiridhar Malavali "%s: Written crbwin (0x%x) != Read crbwin (0x%x), " 359a9083016SGiridhar Malavali "off=0x%lx\n", __func__, ha->crb_win, win_read, *off)); 360a9083016SGiridhar Malavali } 361a9083016SGiridhar Malavali *off = (*off & MASK(16)) + CRB_INDIRECT_2M + ha->nx_pcibase; 362a9083016SGiridhar Malavali } 363a9083016SGiridhar Malavali 364a9083016SGiridhar Malavali static inline unsigned long 365a9083016SGiridhar Malavali qla82xx_pci_set_crbwindow(struct qla_hw_data *ha, u64 off) 366a9083016SGiridhar Malavali { 367a9083016SGiridhar Malavali /* See if we are currently pointing to the region we want to use next */ 368a9083016SGiridhar Malavali if ((off >= QLA82XX_CRB_PCIX_HOST) && (off < QLA82XX_CRB_DDR_NET)) { 369a9083016SGiridhar Malavali /* No need to change window. PCIX and PCIEregs are in both 370a9083016SGiridhar Malavali * regs are in both windows. 371a9083016SGiridhar Malavali */ 372a9083016SGiridhar Malavali return off; 373a9083016SGiridhar Malavali } 374a9083016SGiridhar Malavali 375a9083016SGiridhar Malavali if ((off >= QLA82XX_CRB_PCIX_HOST) && (off < QLA82XX_CRB_PCIX_HOST2)) { 376a9083016SGiridhar Malavali /* We are in first CRB window */ 377a9083016SGiridhar Malavali if (ha->curr_window != 0) 378a9083016SGiridhar Malavali WARN_ON(1); 379a9083016SGiridhar Malavali return off; 380a9083016SGiridhar Malavali } 381a9083016SGiridhar Malavali 382a9083016SGiridhar Malavali if ((off > QLA82XX_CRB_PCIX_HOST2) && (off < QLA82XX_CRB_MAX)) { 383a9083016SGiridhar Malavali /* We are in second CRB window */ 384a9083016SGiridhar Malavali off = off - QLA82XX_CRB_PCIX_HOST2 + QLA82XX_CRB_PCIX_HOST; 385a9083016SGiridhar Malavali 386a9083016SGiridhar Malavali if (ha->curr_window != 1) 387a9083016SGiridhar Malavali return off; 388a9083016SGiridhar Malavali 389a9083016SGiridhar Malavali /* We are in the QM or direct access 390a9083016SGiridhar Malavali * register region - do nothing 391a9083016SGiridhar Malavali */ 392a9083016SGiridhar Malavali if ((off >= QLA82XX_PCI_DIRECT_CRB) && 393a9083016SGiridhar Malavali (off < QLA82XX_PCI_CAMQM_MAX)) 394a9083016SGiridhar Malavali return off; 395a9083016SGiridhar Malavali } 396a9083016SGiridhar Malavali /* strange address given */ 397a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 398a9083016SGiridhar Malavali "%s: Warning: unm_nic_pci_set_crbwindow called with" 399a9083016SGiridhar Malavali " an unknown address(%llx)\n", QLA2XXX_DRIVER_NAME, off); 400a9083016SGiridhar Malavali return off; 401a9083016SGiridhar Malavali } 402a9083016SGiridhar Malavali 403a9083016SGiridhar Malavali int 404a9083016SGiridhar Malavali qla82xx_wr_32(struct qla_hw_data *ha, ulong off, u32 data) 405a9083016SGiridhar Malavali { 406a9083016SGiridhar Malavali unsigned long flags = 0; 407a9083016SGiridhar Malavali int rv; 408a9083016SGiridhar Malavali 409a9083016SGiridhar Malavali rv = qla82xx_pci_get_crb_addr_2M(ha, &off); 410a9083016SGiridhar Malavali 411a9083016SGiridhar Malavali BUG_ON(rv == -1); 412a9083016SGiridhar Malavali 413a9083016SGiridhar Malavali if (rv == 1) { 414a9083016SGiridhar Malavali write_lock_irqsave(&ha->hw_lock, flags); 415a9083016SGiridhar Malavali qla82xx_crb_win_lock(ha); 416a9083016SGiridhar Malavali qla82xx_pci_set_crbwindow_2M(ha, &off); 417a9083016SGiridhar Malavali } 418a9083016SGiridhar Malavali 419a9083016SGiridhar Malavali writel(data, (void __iomem *)off); 420a9083016SGiridhar Malavali 421a9083016SGiridhar Malavali if (rv == 1) { 422a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM7_UNLOCK)); 423a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 424a9083016SGiridhar Malavali } 425a9083016SGiridhar Malavali return 0; 426a9083016SGiridhar Malavali } 427a9083016SGiridhar Malavali 428a9083016SGiridhar Malavali int 429a9083016SGiridhar Malavali qla82xx_rd_32(struct qla_hw_data *ha, ulong off) 430a9083016SGiridhar Malavali { 431a9083016SGiridhar Malavali unsigned long flags = 0; 432a9083016SGiridhar Malavali int rv; 433a9083016SGiridhar Malavali u32 data; 434a9083016SGiridhar Malavali 435a9083016SGiridhar Malavali rv = qla82xx_pci_get_crb_addr_2M(ha, &off); 436a9083016SGiridhar Malavali 437a9083016SGiridhar Malavali BUG_ON(rv == -1); 438a9083016SGiridhar Malavali 439a9083016SGiridhar Malavali if (rv == 1) { 440a9083016SGiridhar Malavali write_lock_irqsave(&ha->hw_lock, flags); 441a9083016SGiridhar Malavali qla82xx_crb_win_lock(ha); 442a9083016SGiridhar Malavali qla82xx_pci_set_crbwindow_2M(ha, &off); 443a9083016SGiridhar Malavali } 444a9083016SGiridhar Malavali data = RD_REG_DWORD((void __iomem *)off); 445a9083016SGiridhar Malavali 446a9083016SGiridhar Malavali if (rv == 1) { 447a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM7_UNLOCK)); 448a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 449a9083016SGiridhar Malavali } 450a9083016SGiridhar Malavali return data; 451a9083016SGiridhar Malavali } 452a9083016SGiridhar Malavali 453a9083016SGiridhar Malavali #define CRB_WIN_LOCK_TIMEOUT 100000000 454a9083016SGiridhar Malavali int qla82xx_crb_win_lock(struct qla_hw_data *ha) 455a9083016SGiridhar Malavali { 456a9083016SGiridhar Malavali int done = 0, timeout = 0; 457a9083016SGiridhar Malavali 458a9083016SGiridhar Malavali while (!done) { 459a9083016SGiridhar Malavali /* acquire semaphore3 from PCI HW block */ 460a9083016SGiridhar Malavali done = qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM7_LOCK)); 461a9083016SGiridhar Malavali if (done == 1) 462a9083016SGiridhar Malavali break; 463a9083016SGiridhar Malavali if (timeout >= CRB_WIN_LOCK_TIMEOUT) 464a9083016SGiridhar Malavali return -1; 465a9083016SGiridhar Malavali timeout++; 466a9083016SGiridhar Malavali } 467a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_WIN_LOCK_ID, ha->portnum); 468a9083016SGiridhar Malavali return 0; 469a9083016SGiridhar Malavali } 470a9083016SGiridhar Malavali 471a9083016SGiridhar Malavali #define IDC_LOCK_TIMEOUT 100000000 472a9083016SGiridhar Malavali int qla82xx_idc_lock(struct qla_hw_data *ha) 473a9083016SGiridhar Malavali { 474a9083016SGiridhar Malavali int i; 475a9083016SGiridhar Malavali int done = 0, timeout = 0; 476a9083016SGiridhar Malavali 477a9083016SGiridhar Malavali while (!done) { 478a9083016SGiridhar Malavali /* acquire semaphore5 from PCI HW block */ 479a9083016SGiridhar Malavali done = qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM5_LOCK)); 480a9083016SGiridhar Malavali if (done == 1) 481a9083016SGiridhar Malavali break; 482a9083016SGiridhar Malavali if (timeout >= IDC_LOCK_TIMEOUT) 483a9083016SGiridhar Malavali return -1; 484a9083016SGiridhar Malavali 485a9083016SGiridhar Malavali timeout++; 486a9083016SGiridhar Malavali 487a9083016SGiridhar Malavali /* Yield CPU */ 488a9083016SGiridhar Malavali if (!in_interrupt()) 489a9083016SGiridhar Malavali schedule(); 490a9083016SGiridhar Malavali else { 491a9083016SGiridhar Malavali for (i = 0; i < 20; i++) 492a9083016SGiridhar Malavali cpu_relax(); 493a9083016SGiridhar Malavali } 494a9083016SGiridhar Malavali } 495a9083016SGiridhar Malavali 496a9083016SGiridhar Malavali return 0; 497a9083016SGiridhar Malavali } 498a9083016SGiridhar Malavali 499a9083016SGiridhar Malavali void qla82xx_idc_unlock(struct qla_hw_data *ha) 500a9083016SGiridhar Malavali { 501a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM5_UNLOCK)); 502a9083016SGiridhar Malavali } 503a9083016SGiridhar Malavali 504a9083016SGiridhar Malavali int 505a9083016SGiridhar Malavali qla82xx_pci_get_crb_addr_2M(struct qla_hw_data *ha, ulong *off) 506a9083016SGiridhar Malavali { 507a9083016SGiridhar Malavali struct crb_128M_2M_sub_block_map *m; 508a9083016SGiridhar Malavali 509a9083016SGiridhar Malavali if (*off >= QLA82XX_CRB_MAX) 510a9083016SGiridhar Malavali return -1; 511a9083016SGiridhar Malavali 512a9083016SGiridhar Malavali if (*off >= QLA82XX_PCI_CAMQM && (*off < QLA82XX_PCI_CAMQM_2M_END)) { 513a9083016SGiridhar Malavali *off = (*off - QLA82XX_PCI_CAMQM) + 514a9083016SGiridhar Malavali QLA82XX_PCI_CAMQM_2M_BASE + ha->nx_pcibase; 515a9083016SGiridhar Malavali return 0; 516a9083016SGiridhar Malavali } 517a9083016SGiridhar Malavali 518a9083016SGiridhar Malavali if (*off < QLA82XX_PCI_CRBSPACE) 519a9083016SGiridhar Malavali return -1; 520a9083016SGiridhar Malavali 521a9083016SGiridhar Malavali *off -= QLA82XX_PCI_CRBSPACE; 522a9083016SGiridhar Malavali 523a9083016SGiridhar Malavali /* Try direct map */ 524a9083016SGiridhar Malavali m = &crb_128M_2M_map[CRB_BLK(*off)].sub_block[CRB_SUBBLK(*off)]; 525a9083016SGiridhar Malavali 526a9083016SGiridhar Malavali if (m->valid && (m->start_128M <= *off) && (m->end_128M > *off)) { 527a9083016SGiridhar Malavali *off = *off + m->start_2M - m->start_128M + ha->nx_pcibase; 528a9083016SGiridhar Malavali return 0; 529a9083016SGiridhar Malavali } 530a9083016SGiridhar Malavali /* Not in direct map, use crb window */ 531a9083016SGiridhar Malavali return 1; 532a9083016SGiridhar Malavali } 533a9083016SGiridhar Malavali 534a9083016SGiridhar Malavali /* PCI Windowing for DDR regions. */ 535a9083016SGiridhar Malavali #define QLA82XX_ADDR_IN_RANGE(addr, low, high) \ 536a9083016SGiridhar Malavali (((addr) <= (high)) && ((addr) >= (low))) 537a9083016SGiridhar Malavali /* 538a9083016SGiridhar Malavali * check memory access boundary. 539a9083016SGiridhar Malavali * used by test agent. support ddr access only for now 540a9083016SGiridhar Malavali */ 541a9083016SGiridhar Malavali static unsigned long 542a9083016SGiridhar Malavali qla82xx_pci_mem_bound_check(struct qla_hw_data *ha, 543a9083016SGiridhar Malavali unsigned long long addr, int size) 544a9083016SGiridhar Malavali { 545a9083016SGiridhar Malavali if (!QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_DDR_NET, 546a9083016SGiridhar Malavali QLA82XX_ADDR_DDR_NET_MAX) || 547a9083016SGiridhar Malavali !QLA82XX_ADDR_IN_RANGE(addr + size - 1, QLA82XX_ADDR_DDR_NET, 548a9083016SGiridhar Malavali QLA82XX_ADDR_DDR_NET_MAX) || 549a9083016SGiridhar Malavali ((size != 1) && (size != 2) && (size != 4) && (size != 8))) 550a9083016SGiridhar Malavali return 0; 551a9083016SGiridhar Malavali else 552a9083016SGiridhar Malavali return 1; 553a9083016SGiridhar Malavali } 554a9083016SGiridhar Malavali 555a9083016SGiridhar Malavali int qla82xx_pci_set_window_warning_count; 556a9083016SGiridhar Malavali 557a9083016SGiridhar Malavali unsigned long 558a9083016SGiridhar Malavali qla82xx_pci_set_window(struct qla_hw_data *ha, unsigned long long addr) 559a9083016SGiridhar Malavali { 560a9083016SGiridhar Malavali int window; 561a9083016SGiridhar Malavali u32 win_read; 562a9083016SGiridhar Malavali 563a9083016SGiridhar Malavali if (QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_DDR_NET, 564a9083016SGiridhar Malavali QLA82XX_ADDR_DDR_NET_MAX)) { 565a9083016SGiridhar Malavali /* DDR network side */ 566a9083016SGiridhar Malavali window = MN_WIN(addr); 567a9083016SGiridhar Malavali ha->ddr_mn_window = window; 568a9083016SGiridhar Malavali qla82xx_wr_32(ha, 569a9083016SGiridhar Malavali ha->mn_win_crb | QLA82XX_PCI_CRBSPACE, window); 570a9083016SGiridhar Malavali win_read = qla82xx_rd_32(ha, 571a9083016SGiridhar Malavali ha->mn_win_crb | QLA82XX_PCI_CRBSPACE); 572a9083016SGiridhar Malavali if ((win_read << 17) != window) { 573a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 574a9083016SGiridhar Malavali "%s: Written MNwin (0x%x) != Read MNwin (0x%x)\n", 575a9083016SGiridhar Malavali __func__, window, win_read); 576a9083016SGiridhar Malavali } 577a9083016SGiridhar Malavali addr = GET_MEM_OFFS_2M(addr) + QLA82XX_PCI_DDR_NET; 578a9083016SGiridhar Malavali } else if (QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_OCM0, 579a9083016SGiridhar Malavali QLA82XX_ADDR_OCM0_MAX)) { 580a9083016SGiridhar Malavali unsigned int temp1; 581a9083016SGiridhar Malavali if ((addr & 0x00ff800) == 0xff800) { 582a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 583a9083016SGiridhar Malavali "%s: QM access not handled.\n", __func__); 584a9083016SGiridhar Malavali addr = -1UL; 585a9083016SGiridhar Malavali } 586a9083016SGiridhar Malavali window = OCM_WIN(addr); 587a9083016SGiridhar Malavali ha->ddr_mn_window = window; 588a9083016SGiridhar Malavali qla82xx_wr_32(ha, 589a9083016SGiridhar Malavali ha->mn_win_crb | QLA82XX_PCI_CRBSPACE, window); 590a9083016SGiridhar Malavali win_read = qla82xx_rd_32(ha, 591a9083016SGiridhar Malavali ha->mn_win_crb | QLA82XX_PCI_CRBSPACE); 592a9083016SGiridhar Malavali temp1 = ((window & 0x1FF) << 7) | 593a9083016SGiridhar Malavali ((window & 0x0FFFE0000) >> 17); 594a9083016SGiridhar Malavali if (win_read != temp1) { 595a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 596a9083016SGiridhar Malavali "%s: Written OCMwin (0x%x) != Read OCMwin (0x%x)\n", 597a9083016SGiridhar Malavali __func__, temp1, win_read); 598a9083016SGiridhar Malavali } 599a9083016SGiridhar Malavali addr = GET_MEM_OFFS_2M(addr) + QLA82XX_PCI_OCM0_2M; 600a9083016SGiridhar Malavali 601a9083016SGiridhar Malavali } else if (QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_QDR_NET, 602a9083016SGiridhar Malavali QLA82XX_P3_ADDR_QDR_NET_MAX)) { 603a9083016SGiridhar Malavali /* QDR network side */ 604a9083016SGiridhar Malavali window = MS_WIN(addr); 605a9083016SGiridhar Malavali ha->qdr_sn_window = window; 606a9083016SGiridhar Malavali qla82xx_wr_32(ha, 607a9083016SGiridhar Malavali ha->ms_win_crb | QLA82XX_PCI_CRBSPACE, window); 608a9083016SGiridhar Malavali win_read = qla82xx_rd_32(ha, 609a9083016SGiridhar Malavali ha->ms_win_crb | QLA82XX_PCI_CRBSPACE); 610a9083016SGiridhar Malavali if (win_read != window) { 611a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 612a9083016SGiridhar Malavali "%s: Written MSwin (0x%x) != Read MSwin (0x%x)\n", 613a9083016SGiridhar Malavali __func__, window, win_read); 614a9083016SGiridhar Malavali } 615a9083016SGiridhar Malavali addr = GET_MEM_OFFS_2M(addr) + QLA82XX_PCI_QDR_NET; 616a9083016SGiridhar Malavali } else { 617a9083016SGiridhar Malavali /* 618a9083016SGiridhar Malavali * peg gdb frequently accesses memory that doesn't exist, 619a9083016SGiridhar Malavali * this limits the chit chat so debugging isn't slowed down. 620a9083016SGiridhar Malavali */ 621a9083016SGiridhar Malavali if ((qla82xx_pci_set_window_warning_count++ < 8) || 622a9083016SGiridhar Malavali (qla82xx_pci_set_window_warning_count%64 == 0)) { 623a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 624a9083016SGiridhar Malavali "%s: Warning:%s Unknown address range!\n", __func__, 625a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME); 626a9083016SGiridhar Malavali } 627a9083016SGiridhar Malavali addr = -1UL; 628a9083016SGiridhar Malavali } 629a9083016SGiridhar Malavali return addr; 630a9083016SGiridhar Malavali } 631a9083016SGiridhar Malavali 632a9083016SGiridhar Malavali /* check if address is in the same windows as the previous access */ 633a9083016SGiridhar Malavali static int qla82xx_pci_is_same_window(struct qla_hw_data *ha, 634a9083016SGiridhar Malavali unsigned long long addr) 635a9083016SGiridhar Malavali { 636a9083016SGiridhar Malavali int window; 637a9083016SGiridhar Malavali unsigned long long qdr_max; 638a9083016SGiridhar Malavali 639a9083016SGiridhar Malavali qdr_max = QLA82XX_P3_ADDR_QDR_NET_MAX; 640a9083016SGiridhar Malavali 641a9083016SGiridhar Malavali /* DDR network side */ 642a9083016SGiridhar Malavali if (QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_DDR_NET, 643a9083016SGiridhar Malavali QLA82XX_ADDR_DDR_NET_MAX)) 644a9083016SGiridhar Malavali BUG(); 645a9083016SGiridhar Malavali else if (QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_OCM0, 646a9083016SGiridhar Malavali QLA82XX_ADDR_OCM0_MAX)) 647a9083016SGiridhar Malavali return 1; 648a9083016SGiridhar Malavali else if (QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_OCM1, 649a9083016SGiridhar Malavali QLA82XX_ADDR_OCM1_MAX)) 650a9083016SGiridhar Malavali return 1; 651a9083016SGiridhar Malavali else if (QLA82XX_ADDR_IN_RANGE(addr, QLA82XX_ADDR_QDR_NET, qdr_max)) { 652a9083016SGiridhar Malavali /* QDR network side */ 653a9083016SGiridhar Malavali window = ((addr - QLA82XX_ADDR_QDR_NET) >> 22) & 0x3f; 654a9083016SGiridhar Malavali if (ha->qdr_sn_window == window) 655a9083016SGiridhar Malavali return 1; 656a9083016SGiridhar Malavali } 657a9083016SGiridhar Malavali return 0; 658a9083016SGiridhar Malavali } 659a9083016SGiridhar Malavali 660a9083016SGiridhar Malavali static int qla82xx_pci_mem_read_direct(struct qla_hw_data *ha, 661a9083016SGiridhar Malavali u64 off, void *data, int size) 662a9083016SGiridhar Malavali { 663a9083016SGiridhar Malavali unsigned long flags; 664a9083016SGiridhar Malavali void *addr; 665a9083016SGiridhar Malavali int ret = 0; 666a9083016SGiridhar Malavali u64 start; 667a9083016SGiridhar Malavali uint8_t *mem_ptr = NULL; 668a9083016SGiridhar Malavali unsigned long mem_base; 669a9083016SGiridhar Malavali unsigned long mem_page; 670a9083016SGiridhar Malavali 671a9083016SGiridhar Malavali write_lock_irqsave(&ha->hw_lock, flags); 672a9083016SGiridhar Malavali 673a9083016SGiridhar Malavali /* 674a9083016SGiridhar Malavali * If attempting to access unknown address or straddle hw windows, 675a9083016SGiridhar Malavali * do not access. 676a9083016SGiridhar Malavali */ 677a9083016SGiridhar Malavali start = qla82xx_pci_set_window(ha, off); 678a9083016SGiridhar Malavali if ((start == -1UL) || 679a9083016SGiridhar Malavali (qla82xx_pci_is_same_window(ha, off + size - 1) == 0)) { 680a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 681a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 682a9083016SGiridhar Malavali "%s out of bound pci memory access. " 683a9083016SGiridhar Malavali "offset is 0x%llx\n", QLA2XXX_DRIVER_NAME, off); 684a9083016SGiridhar Malavali return -1; 685a9083016SGiridhar Malavali } 686a9083016SGiridhar Malavali 687a9083016SGiridhar Malavali addr = qla82xx_pci_base_offsetfset(ha, start); 688a9083016SGiridhar Malavali if (!addr) { 689a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 690a9083016SGiridhar Malavali mem_base = pci_resource_start(ha->pdev, 0); 691a9083016SGiridhar Malavali mem_page = start & PAGE_MASK; 692a9083016SGiridhar Malavali /* Map two pages whenever user tries to access addresses in two 693a9083016SGiridhar Malavali * consecutive pages. 694a9083016SGiridhar Malavali */ 695a9083016SGiridhar Malavali if (mem_page != ((start + size - 1) & PAGE_MASK)) 696a9083016SGiridhar Malavali mem_ptr = ioremap(mem_base + mem_page, PAGE_SIZE * 2); 697a9083016SGiridhar Malavali else 698a9083016SGiridhar Malavali mem_ptr = ioremap(mem_base + mem_page, PAGE_SIZE); 699a9083016SGiridhar Malavali if (mem_ptr == 0UL) { 700a9083016SGiridhar Malavali *(u8 *)data = 0; 701a9083016SGiridhar Malavali return -1; 702a9083016SGiridhar Malavali } 703a9083016SGiridhar Malavali addr = mem_ptr; 704a9083016SGiridhar Malavali addr += start & (PAGE_SIZE - 1); 705a9083016SGiridhar Malavali write_lock_irqsave(&ha->hw_lock, flags); 706a9083016SGiridhar Malavali } 707a9083016SGiridhar Malavali 708a9083016SGiridhar Malavali switch (size) { 709a9083016SGiridhar Malavali case 1: 710a9083016SGiridhar Malavali *(u8 *)data = readb(addr); 711a9083016SGiridhar Malavali break; 712a9083016SGiridhar Malavali case 2: 713a9083016SGiridhar Malavali *(u16 *)data = readw(addr); 714a9083016SGiridhar Malavali break; 715a9083016SGiridhar Malavali case 4: 716a9083016SGiridhar Malavali *(u32 *)data = readl(addr); 717a9083016SGiridhar Malavali break; 718a9083016SGiridhar Malavali case 8: 719a9083016SGiridhar Malavali *(u64 *)data = readq(addr); 720a9083016SGiridhar Malavali break; 721a9083016SGiridhar Malavali default: 722a9083016SGiridhar Malavali ret = -1; 723a9083016SGiridhar Malavali break; 724a9083016SGiridhar Malavali } 725a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 726a9083016SGiridhar Malavali 727a9083016SGiridhar Malavali if (mem_ptr) 728a9083016SGiridhar Malavali iounmap(mem_ptr); 729a9083016SGiridhar Malavali return ret; 730a9083016SGiridhar Malavali } 731a9083016SGiridhar Malavali 732a9083016SGiridhar Malavali static int 733a9083016SGiridhar Malavali qla82xx_pci_mem_write_direct(struct qla_hw_data *ha, 734a9083016SGiridhar Malavali u64 off, void *data, int size) 735a9083016SGiridhar Malavali { 736a9083016SGiridhar Malavali unsigned long flags; 737a9083016SGiridhar Malavali void *addr; 738a9083016SGiridhar Malavali int ret = 0; 739a9083016SGiridhar Malavali u64 start; 740a9083016SGiridhar Malavali uint8_t *mem_ptr = NULL; 741a9083016SGiridhar Malavali unsigned long mem_base; 742a9083016SGiridhar Malavali unsigned long mem_page; 743a9083016SGiridhar Malavali 744a9083016SGiridhar Malavali write_lock_irqsave(&ha->hw_lock, flags); 745a9083016SGiridhar Malavali 746a9083016SGiridhar Malavali /* 747a9083016SGiridhar Malavali * If attempting to access unknown address or straddle hw windows, 748a9083016SGiridhar Malavali * do not access. 749a9083016SGiridhar Malavali */ 750a9083016SGiridhar Malavali start = qla82xx_pci_set_window(ha, off); 751a9083016SGiridhar Malavali if ((start == -1UL) || 752a9083016SGiridhar Malavali (qla82xx_pci_is_same_window(ha, off + size - 1) == 0)) { 753a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 754a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 755a9083016SGiridhar Malavali "%s out of bound pci memory access. " 756a9083016SGiridhar Malavali "offset is 0x%llx\n", QLA2XXX_DRIVER_NAME, off); 757a9083016SGiridhar Malavali return -1; 758a9083016SGiridhar Malavali } 759a9083016SGiridhar Malavali 760a9083016SGiridhar Malavali addr = qla82xx_pci_base_offsetfset(ha, start); 761a9083016SGiridhar Malavali if (!addr) { 762a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 763a9083016SGiridhar Malavali mem_base = pci_resource_start(ha->pdev, 0); 764a9083016SGiridhar Malavali mem_page = start & PAGE_MASK; 765a9083016SGiridhar Malavali /* Map two pages whenever user tries to access addresses in two 766a9083016SGiridhar Malavali * consecutive pages. 767a9083016SGiridhar Malavali */ 768a9083016SGiridhar Malavali if (mem_page != ((start + size - 1) & PAGE_MASK)) 769a9083016SGiridhar Malavali mem_ptr = ioremap(mem_base + mem_page, PAGE_SIZE*2); 770a9083016SGiridhar Malavali else 771a9083016SGiridhar Malavali mem_ptr = ioremap(mem_base + mem_page, PAGE_SIZE); 772a9083016SGiridhar Malavali if (mem_ptr == 0UL) 773a9083016SGiridhar Malavali return -1; 774a9083016SGiridhar Malavali 775a9083016SGiridhar Malavali addr = mem_ptr; 776a9083016SGiridhar Malavali addr += start & (PAGE_SIZE - 1); 777a9083016SGiridhar Malavali write_lock_irqsave(&ha->hw_lock, flags); 778a9083016SGiridhar Malavali } 779a9083016SGiridhar Malavali 780a9083016SGiridhar Malavali switch (size) { 781a9083016SGiridhar Malavali case 1: 782a9083016SGiridhar Malavali writeb(*(u8 *)data, addr); 783a9083016SGiridhar Malavali break; 784a9083016SGiridhar Malavali case 2: 785a9083016SGiridhar Malavali writew(*(u16 *)data, addr); 786a9083016SGiridhar Malavali break; 787a9083016SGiridhar Malavali case 4: 788a9083016SGiridhar Malavali writel(*(u32 *)data, addr); 789a9083016SGiridhar Malavali break; 790a9083016SGiridhar Malavali case 8: 791a9083016SGiridhar Malavali writeq(*(u64 *)data, addr); 792a9083016SGiridhar Malavali break; 793a9083016SGiridhar Malavali default: 794a9083016SGiridhar Malavali ret = -1; 795a9083016SGiridhar Malavali break; 796a9083016SGiridhar Malavali } 797a9083016SGiridhar Malavali write_unlock_irqrestore(&ha->hw_lock, flags); 798a9083016SGiridhar Malavali if (mem_ptr) 799a9083016SGiridhar Malavali iounmap(mem_ptr); 800a9083016SGiridhar Malavali return ret; 801a9083016SGiridhar Malavali } 802a9083016SGiridhar Malavali 803a9083016SGiridhar Malavali int 804a9083016SGiridhar Malavali qla82xx_wrmem(struct qla_hw_data *ha, u64 off, void *data, int size) 805a9083016SGiridhar Malavali { 806a9083016SGiridhar Malavali int i, j, ret = 0, loop, sz[2], off0; 807a9083016SGiridhar Malavali u32 temp; 808a9083016SGiridhar Malavali u64 off8, mem_crb, tmpw, word[2] = {0, 0}; 809a9083016SGiridhar Malavali #define MAX_CTL_CHECK 1000 810a9083016SGiridhar Malavali /* 811a9083016SGiridhar Malavali * If not MN, go check for MS or invalid. 812a9083016SGiridhar Malavali */ 813a9083016SGiridhar Malavali if (off >= QLA82XX_ADDR_QDR_NET && off <= QLA82XX_P3_ADDR_QDR_NET_MAX) { 814a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_QDR_NET; 815a9083016SGiridhar Malavali } else { 816a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_DDR_NET; 817a9083016SGiridhar Malavali if (qla82xx_pci_mem_bound_check(ha, off, size) == 0) 818a9083016SGiridhar Malavali return qla82xx_pci_mem_write_direct(ha, off, 819a9083016SGiridhar Malavali data, size); 820a9083016SGiridhar Malavali } 821a9083016SGiridhar Malavali 822a9083016SGiridhar Malavali off8 = off & 0xfffffff8; 823a9083016SGiridhar Malavali off0 = off & 0x7; 824a9083016SGiridhar Malavali sz[0] = (size < (8 - off0)) ? size : (8 - off0); 825a9083016SGiridhar Malavali sz[1] = size - sz[0]; 826a9083016SGiridhar Malavali loop = ((off0 + size - 1) >> 3) + 1; 827a9083016SGiridhar Malavali 828a9083016SGiridhar Malavali if ((size != 8) || (off0 != 0)) { 829a9083016SGiridhar Malavali for (i = 0; i < loop; i++) { 830a9083016SGiridhar Malavali if (qla82xx_rdmem(ha, off8 + (i << 3), &word[i], 8)) 831a9083016SGiridhar Malavali return -1; 832a9083016SGiridhar Malavali } 833a9083016SGiridhar Malavali } 834a9083016SGiridhar Malavali 835a9083016SGiridhar Malavali switch (size) { 836a9083016SGiridhar Malavali case 1: 837a9083016SGiridhar Malavali tmpw = *((u8 *)data); 838a9083016SGiridhar Malavali break; 839a9083016SGiridhar Malavali case 2: 840a9083016SGiridhar Malavali tmpw = *((u16 *)data); 841a9083016SGiridhar Malavali break; 842a9083016SGiridhar Malavali case 4: 843a9083016SGiridhar Malavali tmpw = *((u32 *)data); 844a9083016SGiridhar Malavali break; 845a9083016SGiridhar Malavali case 8: 846a9083016SGiridhar Malavali default: 847a9083016SGiridhar Malavali tmpw = *((u64 *)data); 848a9083016SGiridhar Malavali break; 849a9083016SGiridhar Malavali } 850a9083016SGiridhar Malavali 851a9083016SGiridhar Malavali word[0] &= ~((~(~0ULL << (sz[0] * 8))) << (off0 * 8)); 852a9083016SGiridhar Malavali word[0] |= tmpw << (off0 * 8); 853a9083016SGiridhar Malavali 854a9083016SGiridhar Malavali if (loop == 2) { 855a9083016SGiridhar Malavali word[1] &= ~(~0ULL << (sz[1] * 8)); 856a9083016SGiridhar Malavali word[1] |= tmpw >> (sz[0] * 8); 857a9083016SGiridhar Malavali } 858a9083016SGiridhar Malavali 859a9083016SGiridhar Malavali for (i = 0; i < loop; i++) { 860a9083016SGiridhar Malavali temp = off8 + (i << 3); 861a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_ADDR_LO, temp); 862a9083016SGiridhar Malavali temp = 0; 863a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_ADDR_HI, temp); 864a9083016SGiridhar Malavali temp = word[i] & 0xffffffff; 865a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_WRDATA_LO, temp); 866a9083016SGiridhar Malavali temp = (word[i] >> 32) & 0xffffffff; 867a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_WRDATA_HI, temp); 868a9083016SGiridhar Malavali temp = MIU_TA_CTL_ENABLE | MIU_TA_CTL_WRITE; 869a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_CTRL, temp); 870a9083016SGiridhar Malavali temp = MIU_TA_CTL_START | MIU_TA_CTL_ENABLE | MIU_TA_CTL_WRITE; 871a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_CTRL, temp); 872a9083016SGiridhar Malavali 873a9083016SGiridhar Malavali for (j = 0; j < MAX_CTL_CHECK; j++) { 874a9083016SGiridhar Malavali temp = qla82xx_rd_32(ha, mem_crb + MIU_TEST_AGT_CTRL); 875a9083016SGiridhar Malavali if ((temp & MIU_TA_CTL_BUSY) == 0) 876a9083016SGiridhar Malavali break; 877a9083016SGiridhar Malavali } 878a9083016SGiridhar Malavali 879a9083016SGiridhar Malavali if (j >= MAX_CTL_CHECK) { 880a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 881a9083016SGiridhar Malavali "%s: Fail to write through agent\n", 882a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME); 883a9083016SGiridhar Malavali ret = -1; 884a9083016SGiridhar Malavali break; 885a9083016SGiridhar Malavali } 886a9083016SGiridhar Malavali } 887a9083016SGiridhar Malavali return ret; 888a9083016SGiridhar Malavali } 889a9083016SGiridhar Malavali 890a9083016SGiridhar Malavali int 891a9083016SGiridhar Malavali qla82xx_rdmem(struct qla_hw_data *ha, u64 off, void *data, int size) 892a9083016SGiridhar Malavali { 893a9083016SGiridhar Malavali int i, j = 0, k, start, end, loop, sz[2], off0[2]; 894a9083016SGiridhar Malavali u32 temp; 895a9083016SGiridhar Malavali u64 off8, val, mem_crb, word[2] = {0, 0}; 896a9083016SGiridhar Malavali #define MAX_CTL_CHECK 1000 897a9083016SGiridhar Malavali 898a9083016SGiridhar Malavali /* 899a9083016SGiridhar Malavali * If not MN, go check for MS or invalid. 900a9083016SGiridhar Malavali */ 901a9083016SGiridhar Malavali if (off >= QLA82XX_ADDR_QDR_NET && off <= QLA82XX_P3_ADDR_QDR_NET_MAX) 902a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_QDR_NET; 903a9083016SGiridhar Malavali else { 904a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_DDR_NET; 905a9083016SGiridhar Malavali if (qla82xx_pci_mem_bound_check(ha, off, size) == 0) 906a9083016SGiridhar Malavali return qla82xx_pci_mem_read_direct(ha, off, 907a9083016SGiridhar Malavali data, size); 908a9083016SGiridhar Malavali } 909a9083016SGiridhar Malavali 910a9083016SGiridhar Malavali off8 = off & 0xfffffff8; 911a9083016SGiridhar Malavali off0[0] = off & 0x7; 912a9083016SGiridhar Malavali off0[1] = 0; 913a9083016SGiridhar Malavali sz[0] = (size < (8 - off0[0])) ? size : (8 - off0[0]); 914a9083016SGiridhar Malavali sz[1] = size - sz[0]; 915a9083016SGiridhar Malavali loop = ((off0[0] + size - 1) >> 3) + 1; 916a9083016SGiridhar Malavali 917a9083016SGiridhar Malavali for (i = 0; i < loop; i++) { 918a9083016SGiridhar Malavali temp = off8 + (i << 3); 919a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_ADDR_LO, temp); 920a9083016SGiridhar Malavali temp = 0; 921a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_ADDR_HI, temp); 922a9083016SGiridhar Malavali temp = MIU_TA_CTL_ENABLE; 923a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_CTRL, temp); 924a9083016SGiridhar Malavali temp = MIU_TA_CTL_START | MIU_TA_CTL_ENABLE; 925a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_CTRL, temp); 926a9083016SGiridhar Malavali 927a9083016SGiridhar Malavali for (j = 0; j < MAX_CTL_CHECK; j++) { 928a9083016SGiridhar Malavali temp = qla82xx_rd_32(ha, mem_crb + MIU_TEST_AGT_CTRL); 929a9083016SGiridhar Malavali if ((temp & MIU_TA_CTL_BUSY) == 0) 930a9083016SGiridhar Malavali break; 931a9083016SGiridhar Malavali } 932a9083016SGiridhar Malavali 933a9083016SGiridhar Malavali if (j >= MAX_CTL_CHECK) { 934a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 935a9083016SGiridhar Malavali "%s: Fail to read through agent\n", 936a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME); 937a9083016SGiridhar Malavali break; 938a9083016SGiridhar Malavali } 939a9083016SGiridhar Malavali 940a9083016SGiridhar Malavali start = off0[i] >> 2; 941a9083016SGiridhar Malavali end = (off0[i] + sz[i] - 1) >> 2; 942a9083016SGiridhar Malavali for (k = start; k <= end; k++) { 943a9083016SGiridhar Malavali temp = qla82xx_rd_32(ha, 944a9083016SGiridhar Malavali mem_crb + MIU_TEST_AGT_RDDATA(k)); 945a9083016SGiridhar Malavali word[i] |= ((u64)temp << (32 * k)); 946a9083016SGiridhar Malavali } 947a9083016SGiridhar Malavali } 948a9083016SGiridhar Malavali 949a9083016SGiridhar Malavali if (j >= MAX_CTL_CHECK) 950a9083016SGiridhar Malavali return -1; 951a9083016SGiridhar Malavali 952a9083016SGiridhar Malavali if (sz[0] == 8) { 953a9083016SGiridhar Malavali val = word[0]; 954a9083016SGiridhar Malavali } else { 955a9083016SGiridhar Malavali val = ((word[0] >> (off0[0] * 8)) & (~(~0ULL << (sz[0] * 8)))) | 956a9083016SGiridhar Malavali ((word[1] & (~(~0ULL << (sz[1] * 8)))) << (sz[0] * 8)); 957a9083016SGiridhar Malavali } 958a9083016SGiridhar Malavali 959a9083016SGiridhar Malavali switch (size) { 960a9083016SGiridhar Malavali case 1: 961a9083016SGiridhar Malavali *(u8 *)data = val; 962a9083016SGiridhar Malavali break; 963a9083016SGiridhar Malavali case 2: 964a9083016SGiridhar Malavali *(u16 *)data = val; 965a9083016SGiridhar Malavali break; 966a9083016SGiridhar Malavali case 4: 967a9083016SGiridhar Malavali *(u32 *)data = val; 968a9083016SGiridhar Malavali break; 969a9083016SGiridhar Malavali case 8: 970a9083016SGiridhar Malavali *(u64 *)data = val; 971a9083016SGiridhar Malavali break; 972a9083016SGiridhar Malavali } 973a9083016SGiridhar Malavali return 0; 974a9083016SGiridhar Malavali } 975a9083016SGiridhar Malavali 976a9083016SGiridhar Malavali #define MTU_FUDGE_FACTOR 100 977a9083016SGiridhar Malavali unsigned long qla82xx_decode_crb_addr(unsigned long addr) 978a9083016SGiridhar Malavali { 979a9083016SGiridhar Malavali int i; 980a9083016SGiridhar Malavali unsigned long base_addr, offset, pci_base; 981a9083016SGiridhar Malavali 982a9083016SGiridhar Malavali if (!qla82xx_crb_table_initialized) 983a9083016SGiridhar Malavali qla82xx_crb_addr_transform_setup(); 984a9083016SGiridhar Malavali 985a9083016SGiridhar Malavali pci_base = ADDR_ERROR; 986a9083016SGiridhar Malavali base_addr = addr & 0xfff00000; 987a9083016SGiridhar Malavali offset = addr & 0x000fffff; 988a9083016SGiridhar Malavali 989a9083016SGiridhar Malavali for (i = 0; i < MAX_CRB_XFORM; i++) { 990a9083016SGiridhar Malavali if (crb_addr_xform[i] == base_addr) { 991a9083016SGiridhar Malavali pci_base = i << 20; 992a9083016SGiridhar Malavali break; 993a9083016SGiridhar Malavali } 994a9083016SGiridhar Malavali } 995a9083016SGiridhar Malavali if (pci_base == ADDR_ERROR) 996a9083016SGiridhar Malavali return pci_base; 997a9083016SGiridhar Malavali return pci_base + offset; 998a9083016SGiridhar Malavali } 999a9083016SGiridhar Malavali 1000a9083016SGiridhar Malavali static long rom_max_timeout = 100; 1001a9083016SGiridhar Malavali static long qla82xx_rom_lock_timeout = 100; 1002a9083016SGiridhar Malavali 1003a9083016SGiridhar Malavali int 1004a9083016SGiridhar Malavali qla82xx_rom_lock(struct qla_hw_data *ha) 1005a9083016SGiridhar Malavali { 1006a9083016SGiridhar Malavali int done = 0, timeout = 0; 1007a9083016SGiridhar Malavali 1008a9083016SGiridhar Malavali while (!done) { 1009a9083016SGiridhar Malavali /* acquire semaphore2 from PCI HW block */ 1010a9083016SGiridhar Malavali done = qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM2_LOCK)); 1011a9083016SGiridhar Malavali if (done == 1) 1012a9083016SGiridhar Malavali break; 1013a9083016SGiridhar Malavali if (timeout >= qla82xx_rom_lock_timeout) 1014a9083016SGiridhar Malavali return -1; 1015a9083016SGiridhar Malavali timeout++; 1016a9083016SGiridhar Malavali } 1017a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROM_LOCK_ID, ROM_LOCK_DRIVER); 1018a9083016SGiridhar Malavali return 0; 1019a9083016SGiridhar Malavali } 1020a9083016SGiridhar Malavali 1021a9083016SGiridhar Malavali int 1022a9083016SGiridhar Malavali qla82xx_wait_rom_busy(struct qla_hw_data *ha) 1023a9083016SGiridhar Malavali { 1024a9083016SGiridhar Malavali long timeout = 0; 1025a9083016SGiridhar Malavali long done = 0 ; 1026a9083016SGiridhar Malavali 1027a9083016SGiridhar Malavali while (done == 0) { 1028a9083016SGiridhar Malavali done = qla82xx_rd_32(ha, QLA82XX_ROMUSB_GLB_STATUS); 1029a9083016SGiridhar Malavali done &= 4; 1030a9083016SGiridhar Malavali timeout++; 1031a9083016SGiridhar Malavali if (timeout >= rom_max_timeout) { 1032a9083016SGiridhar Malavali DEBUG(qla_printk(KERN_INFO, ha, 1033a9083016SGiridhar Malavali "%s: Timeout reached waiting for rom busy", 1034a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME)); 1035a9083016SGiridhar Malavali return -1; 1036a9083016SGiridhar Malavali } 1037a9083016SGiridhar Malavali } 1038a9083016SGiridhar Malavali return 0; 1039a9083016SGiridhar Malavali } 1040a9083016SGiridhar Malavali 1041a9083016SGiridhar Malavali int 1042a9083016SGiridhar Malavali qla82xx_wait_rom_done(struct qla_hw_data *ha) 1043a9083016SGiridhar Malavali { 1044a9083016SGiridhar Malavali long timeout = 0; 1045a9083016SGiridhar Malavali long done = 0 ; 1046a9083016SGiridhar Malavali 1047a9083016SGiridhar Malavali while (done == 0) { 1048a9083016SGiridhar Malavali done = qla82xx_rd_32(ha, QLA82XX_ROMUSB_GLB_STATUS); 1049a9083016SGiridhar Malavali done &= 2; 1050a9083016SGiridhar Malavali timeout++; 1051a9083016SGiridhar Malavali if (timeout >= rom_max_timeout) { 1052a9083016SGiridhar Malavali DEBUG(qla_printk(KERN_INFO, ha, 1053a9083016SGiridhar Malavali "%s: Timeout reached waiting for rom done", 1054a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME)); 1055a9083016SGiridhar Malavali return -1; 1056a9083016SGiridhar Malavali } 1057a9083016SGiridhar Malavali } 1058a9083016SGiridhar Malavali return 0; 1059a9083016SGiridhar Malavali } 1060a9083016SGiridhar Malavali 1061a9083016SGiridhar Malavali int 1062a9083016SGiridhar Malavali qla82xx_do_rom_fast_read(struct qla_hw_data *ha, int addr, int *valp) 1063a9083016SGiridhar Malavali { 1064a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ADDRESS, addr); 1065a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_DUMMY_BYTE_CNT, 0); 1066a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ABYTE_CNT, 3); 1067a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_INSTR_OPCODE, 0xb); 1068a9083016SGiridhar Malavali qla82xx_wait_rom_busy(ha); 1069a9083016SGiridhar Malavali if (qla82xx_wait_rom_done(ha)) { 1070a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1071a9083016SGiridhar Malavali "%s: Error waiting for rom done\n", 1072a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME); 1073a9083016SGiridhar Malavali return -1; 1074a9083016SGiridhar Malavali } 1075a9083016SGiridhar Malavali /* Reset abyte_cnt and dummy_byte_cnt */ 1076a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_DUMMY_BYTE_CNT, 0); 1077a9083016SGiridhar Malavali udelay(10); 1078a9083016SGiridhar Malavali cond_resched(); 1079a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ABYTE_CNT, 0); 1080a9083016SGiridhar Malavali *valp = qla82xx_rd_32(ha, QLA82XX_ROMUSB_ROM_RDATA); 1081a9083016SGiridhar Malavali return 0; 1082a9083016SGiridhar Malavali } 1083a9083016SGiridhar Malavali 1084a9083016SGiridhar Malavali int 1085a9083016SGiridhar Malavali qla82xx_rom_fast_read(struct qla_hw_data *ha, int addr, int *valp) 1086a9083016SGiridhar Malavali { 1087a9083016SGiridhar Malavali int ret, loops = 0; 1088a9083016SGiridhar Malavali 1089a9083016SGiridhar Malavali while ((qla82xx_rom_lock(ha) != 0) && (loops < 50000)) { 1090a9083016SGiridhar Malavali udelay(100); 1091a9083016SGiridhar Malavali schedule(); 1092a9083016SGiridhar Malavali loops++; 1093a9083016SGiridhar Malavali } 1094a9083016SGiridhar Malavali if (loops >= 50000) { 1095a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 1096a9083016SGiridhar Malavali "%s: qla82xx_rom_lock failed\n", 1097a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME); 1098a9083016SGiridhar Malavali return -1; 1099a9083016SGiridhar Malavali } 1100a9083016SGiridhar Malavali ret = qla82xx_do_rom_fast_read(ha, addr, valp); 1101a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM2_UNLOCK)); 1102a9083016SGiridhar Malavali return ret; 1103a9083016SGiridhar Malavali } 1104a9083016SGiridhar Malavali 1105a9083016SGiridhar Malavali int 1106a9083016SGiridhar Malavali qla82xx_read_status_reg(struct qla_hw_data *ha, uint32_t *val) 1107a9083016SGiridhar Malavali { 1108a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_INSTR_OPCODE, M25P_INSTR_RDSR); 1109a9083016SGiridhar Malavali qla82xx_wait_rom_busy(ha); 1110a9083016SGiridhar Malavali if (qla82xx_wait_rom_done(ha)) { 1111a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1112a9083016SGiridhar Malavali "Error waiting for rom done\n"); 1113a9083016SGiridhar Malavali return -1; 1114a9083016SGiridhar Malavali } 1115a9083016SGiridhar Malavali *val = qla82xx_rd_32(ha, QLA82XX_ROMUSB_ROM_RDATA); 1116a9083016SGiridhar Malavali return 0; 1117a9083016SGiridhar Malavali } 1118a9083016SGiridhar Malavali 1119a9083016SGiridhar Malavali int 1120a9083016SGiridhar Malavali qla82xx_flash_wait_write_finish(struct qla_hw_data *ha) 1121a9083016SGiridhar Malavali { 1122a9083016SGiridhar Malavali long timeout = 0; 1123a9083016SGiridhar Malavali uint32_t done = 1 ; 1124a9083016SGiridhar Malavali uint32_t val; 1125a9083016SGiridhar Malavali int ret = 0; 1126a9083016SGiridhar Malavali 1127a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ABYTE_CNT, 0); 1128a9083016SGiridhar Malavali while ((done != 0) && (ret == 0)) { 1129a9083016SGiridhar Malavali ret = qla82xx_read_status_reg(ha, &val); 1130a9083016SGiridhar Malavali done = val & 1; 1131a9083016SGiridhar Malavali timeout++; 1132a9083016SGiridhar Malavali udelay(10); 1133a9083016SGiridhar Malavali cond_resched(); 1134a9083016SGiridhar Malavali if (timeout >= 50000) { 1135a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1136a9083016SGiridhar Malavali "Timeout reached waiting for write finish"); 1137a9083016SGiridhar Malavali return -1; 1138a9083016SGiridhar Malavali } 1139a9083016SGiridhar Malavali } 1140a9083016SGiridhar Malavali return ret; 1141a9083016SGiridhar Malavali } 1142a9083016SGiridhar Malavali 1143a9083016SGiridhar Malavali int 1144a9083016SGiridhar Malavali qla82xx_flash_set_write_enable(struct qla_hw_data *ha) 1145a9083016SGiridhar Malavali { 1146a9083016SGiridhar Malavali uint32_t val; 1147a9083016SGiridhar Malavali qla82xx_wait_rom_busy(ha); 1148a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ABYTE_CNT, 0); 1149a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_INSTR_OPCODE, M25P_INSTR_WREN); 1150a9083016SGiridhar Malavali qla82xx_wait_rom_busy(ha); 1151a9083016SGiridhar Malavali if (qla82xx_wait_rom_done(ha)) 1152a9083016SGiridhar Malavali return -1; 1153a9083016SGiridhar Malavali if (qla82xx_read_status_reg(ha, &val) != 0) 1154a9083016SGiridhar Malavali return -1; 1155a9083016SGiridhar Malavali if ((val & 2) != 2) 1156a9083016SGiridhar Malavali return -1; 1157a9083016SGiridhar Malavali return 0; 1158a9083016SGiridhar Malavali } 1159a9083016SGiridhar Malavali 1160a9083016SGiridhar Malavali int 1161a9083016SGiridhar Malavali qla82xx_write_status_reg(struct qla_hw_data *ha, uint32_t val) 1162a9083016SGiridhar Malavali { 1163a9083016SGiridhar Malavali if (qla82xx_flash_set_write_enable(ha)) 1164a9083016SGiridhar Malavali return -1; 1165a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_WDATA, val); 1166a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_INSTR_OPCODE, 0x1); 1167a9083016SGiridhar Malavali if (qla82xx_wait_rom_done(ha)) { 1168a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1169a9083016SGiridhar Malavali "Error waiting for rom done\n"); 1170a9083016SGiridhar Malavali return -1; 1171a9083016SGiridhar Malavali } 1172a9083016SGiridhar Malavali return qla82xx_flash_wait_write_finish(ha); 1173a9083016SGiridhar Malavali } 1174a9083016SGiridhar Malavali 1175a9083016SGiridhar Malavali int 1176a9083016SGiridhar Malavali qla82xx_write_disable_flash(struct qla_hw_data *ha) 1177a9083016SGiridhar Malavali { 1178a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_INSTR_OPCODE, M25P_INSTR_WRDI); 1179a9083016SGiridhar Malavali if (qla82xx_wait_rom_done(ha)) { 1180a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1181a9083016SGiridhar Malavali "Error waiting for rom done\n"); 1182a9083016SGiridhar Malavali return -1; 1183a9083016SGiridhar Malavali } 1184a9083016SGiridhar Malavali return 0; 1185a9083016SGiridhar Malavali } 1186a9083016SGiridhar Malavali 1187a9083016SGiridhar Malavali int 1188a9083016SGiridhar Malavali ql82xx_rom_lock_d(struct qla_hw_data *ha) 1189a9083016SGiridhar Malavali { 1190a9083016SGiridhar Malavali int loops = 0; 1191a9083016SGiridhar Malavali while ((qla82xx_rom_lock(ha) != 0) && (loops < 50000)) { 1192a9083016SGiridhar Malavali udelay(100); 1193a9083016SGiridhar Malavali cond_resched(); 1194a9083016SGiridhar Malavali loops++; 1195a9083016SGiridhar Malavali } 1196a9083016SGiridhar Malavali if (loops >= 50000) { 1197a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "ROM lock failed\n"); 1198a9083016SGiridhar Malavali return -1; 1199a9083016SGiridhar Malavali } 1200a9083016SGiridhar Malavali return 0;; 1201a9083016SGiridhar Malavali } 1202a9083016SGiridhar Malavali 1203a9083016SGiridhar Malavali int 1204a9083016SGiridhar Malavali qla82xx_write_flash_dword(struct qla_hw_data *ha, uint32_t flashaddr, 1205a9083016SGiridhar Malavali uint32_t data) 1206a9083016SGiridhar Malavali { 1207a9083016SGiridhar Malavali int ret = 0; 1208a9083016SGiridhar Malavali 1209a9083016SGiridhar Malavali ret = ql82xx_rom_lock_d(ha); 1210a9083016SGiridhar Malavali if (ret < 0) { 1211a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "ROM Lock failed\n"); 1212a9083016SGiridhar Malavali return ret; 1213a9083016SGiridhar Malavali } 1214a9083016SGiridhar Malavali 1215a9083016SGiridhar Malavali if (qla82xx_flash_set_write_enable(ha)) 1216a9083016SGiridhar Malavali goto done_write; 1217a9083016SGiridhar Malavali 1218a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_WDATA, data); 1219a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ADDRESS, flashaddr); 1220a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ABYTE_CNT, 3); 1221a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_INSTR_OPCODE, M25P_INSTR_PP); 1222a9083016SGiridhar Malavali qla82xx_wait_rom_busy(ha); 1223a9083016SGiridhar Malavali if (qla82xx_wait_rom_done(ha)) { 1224a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1225a9083016SGiridhar Malavali "Error waiting for rom done\n"); 1226a9083016SGiridhar Malavali ret = -1; 1227a9083016SGiridhar Malavali goto done_write; 1228a9083016SGiridhar Malavali } 1229a9083016SGiridhar Malavali 1230a9083016SGiridhar Malavali ret = qla82xx_flash_wait_write_finish(ha); 1231a9083016SGiridhar Malavali 1232a9083016SGiridhar Malavali done_write: 1233a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM2_UNLOCK)); 1234a9083016SGiridhar Malavali return ret; 1235a9083016SGiridhar Malavali } 1236a9083016SGiridhar Malavali 1237a9083016SGiridhar Malavali /* This routine does CRB initialize sequence 1238a9083016SGiridhar Malavali * to put the ISP into operational state 1239a9083016SGiridhar Malavali */ 1240a9083016SGiridhar Malavali int qla82xx_pinit_from_rom(scsi_qla_host_t *vha) 1241a9083016SGiridhar Malavali { 1242a9083016SGiridhar Malavali int addr, val; 1243a9083016SGiridhar Malavali int i ; 1244a9083016SGiridhar Malavali struct crb_addr_pair *buf; 1245a9083016SGiridhar Malavali unsigned long off; 1246a9083016SGiridhar Malavali unsigned offset, n; 1247a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 1248a9083016SGiridhar Malavali 1249a9083016SGiridhar Malavali struct crb_addr_pair { 1250a9083016SGiridhar Malavali long addr; 1251a9083016SGiridhar Malavali long data; 1252a9083016SGiridhar Malavali }; 1253a9083016SGiridhar Malavali 1254a9083016SGiridhar Malavali /* Halt all the indiviual PEGs and other blocks of the ISP */ 1255a9083016SGiridhar Malavali qla82xx_rom_lock(ha); 1256a9083016SGiridhar Malavali if (test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags)) 1257a9083016SGiridhar Malavali /* don't reset CAM block on reset */ 1258a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET, 0xfeffffff); 1259a9083016SGiridhar Malavali else 1260a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET, 0xffffffff); 1261a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM2_UNLOCK)); 1262a9083016SGiridhar Malavali 1263a9083016SGiridhar Malavali /* Read the signature value from the flash. 1264a9083016SGiridhar Malavali * Offset 0: Contain signature (0xcafecafe) 1265a9083016SGiridhar Malavali * Offset 4: Offset and number of addr/value pairs 1266a9083016SGiridhar Malavali * that present in CRB initialize sequence 1267a9083016SGiridhar Malavali */ 1268a9083016SGiridhar Malavali if (qla82xx_rom_fast_read(ha, 0, &n) != 0 || n != 0xcafecafeUL || 1269a9083016SGiridhar Malavali qla82xx_rom_fast_read(ha, 4, &n) != 0) { 1270a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1271a9083016SGiridhar Malavali "[ERROR] Reading crb_init area: n: %08x\n", n); 1272a9083016SGiridhar Malavali return -1; 1273a9083016SGiridhar Malavali } 1274a9083016SGiridhar Malavali 1275a9083016SGiridhar Malavali /* Offset in flash = lower 16 bits 1276a9083016SGiridhar Malavali * Number of enteries = upper 16 bits 1277a9083016SGiridhar Malavali */ 1278a9083016SGiridhar Malavali offset = n & 0xffffU; 1279a9083016SGiridhar Malavali n = (n >> 16) & 0xffffU; 1280a9083016SGiridhar Malavali 1281a9083016SGiridhar Malavali /* number of addr/value pair should not exceed 1024 enteries */ 1282a9083016SGiridhar Malavali if (n >= 1024) { 1283a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1284a9083016SGiridhar Malavali "%s: %s:n=0x%x [ERROR] Card flash not initialized.\n", 1285a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME, __func__, n); 1286a9083016SGiridhar Malavali return -1; 1287a9083016SGiridhar Malavali } 1288a9083016SGiridhar Malavali 1289a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 1290a9083016SGiridhar Malavali "%s: %d CRB init values found in ROM.\n", QLA2XXX_DRIVER_NAME, n); 1291a9083016SGiridhar Malavali 1292a9083016SGiridhar Malavali buf = kmalloc(n * sizeof(struct crb_addr_pair), GFP_KERNEL); 1293a9083016SGiridhar Malavali if (buf == NULL) { 1294a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1295a9083016SGiridhar Malavali "%s: [ERROR] Unable to malloc memory.\n", 1296a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME); 1297a9083016SGiridhar Malavali return -1; 1298a9083016SGiridhar Malavali } 1299a9083016SGiridhar Malavali 1300a9083016SGiridhar Malavali for (i = 0; i < n; i++) { 1301a9083016SGiridhar Malavali if (qla82xx_rom_fast_read(ha, 8*i + 4*offset, &val) != 0 || 1302a9083016SGiridhar Malavali qla82xx_rom_fast_read(ha, 8*i + 4*offset + 4, &addr) != 0) { 1303a9083016SGiridhar Malavali kfree(buf); 1304a9083016SGiridhar Malavali return -1; 1305a9083016SGiridhar Malavali } 1306a9083016SGiridhar Malavali 1307a9083016SGiridhar Malavali buf[i].addr = addr; 1308a9083016SGiridhar Malavali buf[i].data = val; 1309a9083016SGiridhar Malavali } 1310a9083016SGiridhar Malavali 1311a9083016SGiridhar Malavali for (i = 0; i < n; i++) { 1312a9083016SGiridhar Malavali /* Translate internal CRB initialization 1313a9083016SGiridhar Malavali * address to PCI bus address 1314a9083016SGiridhar Malavali */ 1315a9083016SGiridhar Malavali off = qla82xx_decode_crb_addr((unsigned long)buf[i].addr) + 1316a9083016SGiridhar Malavali QLA82XX_PCI_CRBSPACE; 1317a9083016SGiridhar Malavali /* Not all CRB addr/value pair to be written, 1318a9083016SGiridhar Malavali * some of them are skipped 1319a9083016SGiridhar Malavali */ 1320a9083016SGiridhar Malavali 1321a9083016SGiridhar Malavali /* skipping cold reboot MAGIC */ 1322a9083016SGiridhar Malavali if (off == QLA82XX_CAM_RAM(0x1fc)) 1323a9083016SGiridhar Malavali continue; 1324a9083016SGiridhar Malavali 1325a9083016SGiridhar Malavali /* do not reset PCI */ 1326a9083016SGiridhar Malavali if (off == (ROMUSB_GLB + 0xbc)) 1327a9083016SGiridhar Malavali continue; 1328a9083016SGiridhar Malavali 1329a9083016SGiridhar Malavali /* skip core clock, so that firmware can increase the clock */ 1330a9083016SGiridhar Malavali if (off == (ROMUSB_GLB + 0xc8)) 1331a9083016SGiridhar Malavali continue; 1332a9083016SGiridhar Malavali 1333a9083016SGiridhar Malavali /* skip the function enable register */ 1334a9083016SGiridhar Malavali if (off == QLA82XX_PCIE_REG(PCIE_SETUP_FUNCTION)) 1335a9083016SGiridhar Malavali continue; 1336a9083016SGiridhar Malavali 1337a9083016SGiridhar Malavali if (off == QLA82XX_PCIE_REG(PCIE_SETUP_FUNCTION2)) 1338a9083016SGiridhar Malavali continue; 1339a9083016SGiridhar Malavali 1340a9083016SGiridhar Malavali if ((off & 0x0ff00000) == QLA82XX_CRB_SMB) 1341a9083016SGiridhar Malavali continue; 1342a9083016SGiridhar Malavali 1343a9083016SGiridhar Malavali if ((off & 0x0ff00000) == QLA82XX_CRB_DDR_NET) 1344a9083016SGiridhar Malavali continue; 1345a9083016SGiridhar Malavali 1346a9083016SGiridhar Malavali if (off == ADDR_ERROR) { 1347a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1348a9083016SGiridhar Malavali "%s: [ERROR] Unknown addr: 0x%08lx\n", 1349a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME, buf[i].addr); 1350a9083016SGiridhar Malavali continue; 1351a9083016SGiridhar Malavali } 1352a9083016SGiridhar Malavali 1353a9083016SGiridhar Malavali if (off == (QLA82XX_CRB_PEG_NET_1 + 0x18)) { 1354a9083016SGiridhar Malavali if (!QLA82XX_IS_REVISION_P3PLUS(ha->chip_revision)) 1355a9083016SGiridhar Malavali buf[i].data = 0x1020; 1356a9083016SGiridhar Malavali } 1357a9083016SGiridhar Malavali 1358a9083016SGiridhar Malavali qla82xx_wr_32(ha, off, buf[i].data); 1359a9083016SGiridhar Malavali 1360a9083016SGiridhar Malavali /* ISP requires much bigger delay to settle down, 1361a9083016SGiridhar Malavali * else crb_window returns 0xffffffff 1362a9083016SGiridhar Malavali */ 1363a9083016SGiridhar Malavali if (off == QLA82XX_ROMUSB_GLB_SW_RESET) 1364a9083016SGiridhar Malavali msleep(1000); 1365a9083016SGiridhar Malavali 1366a9083016SGiridhar Malavali /* ISP requires millisec delay between 1367a9083016SGiridhar Malavali * successive CRB register updation 1368a9083016SGiridhar Malavali */ 1369a9083016SGiridhar Malavali msleep(1); 1370a9083016SGiridhar Malavali } 1371a9083016SGiridhar Malavali 1372a9083016SGiridhar Malavali kfree(buf); 1373a9083016SGiridhar Malavali 1374a9083016SGiridhar Malavali /* Resetting the data and instruction cache */ 1375a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_D+0xec, 0x1e); 1376a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_D+0x4c, 8); 1377a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_I+0x4c, 8); 1378a9083016SGiridhar Malavali 1379a9083016SGiridhar Malavali /* Clear all protocol processing engines */ 1380a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_0+0x8, 0); 1381a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_0+0xc, 0); 1382a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_1+0x8, 0); 1383a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_1+0xc, 0); 1384a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_2+0x8, 0); 1385a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_2+0xc, 0); 1386a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_3+0x8, 0); 1387a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_3+0xc, 0); 1388a9083016SGiridhar Malavali return 0; 1389a9083016SGiridhar Malavali } 1390a9083016SGiridhar Malavali 1391a9083016SGiridhar Malavali int qla82xx_check_for_bad_spd(struct qla_hw_data *ha) 1392a9083016SGiridhar Malavali { 1393a9083016SGiridhar Malavali u32 val = 0; 1394a9083016SGiridhar Malavali val = qla82xx_rd_32(ha, BOOT_LOADER_DIMM_STATUS); 1395a9083016SGiridhar Malavali val &= QLA82XX_BOOT_LOADER_MN_ISSUE; 1396a9083016SGiridhar Malavali if (val & QLA82XX_PEG_TUNE_MN_SPD_ZEROED) { 1397a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 1398a9083016SGiridhar Malavali "Memory DIMM SPD not programmed. " 1399a9083016SGiridhar Malavali " Assumed valid.\n"); 1400a9083016SGiridhar Malavali return 1; 1401a9083016SGiridhar Malavali } else if (val) { 1402a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 1403a9083016SGiridhar Malavali "Memory DIMM type incorrect.Info:%08X.\n", val); 1404a9083016SGiridhar Malavali return 2; 1405a9083016SGiridhar Malavali } 1406a9083016SGiridhar Malavali return 0; 1407a9083016SGiridhar Malavali } 1408a9083016SGiridhar Malavali 1409a9083016SGiridhar Malavali int 1410a9083016SGiridhar Malavali qla82xx_fw_load_from_flash(struct qla_hw_data *ha) 1411a9083016SGiridhar Malavali { 1412a9083016SGiridhar Malavali int i; 1413a9083016SGiridhar Malavali long size = 0; 1414a9083016SGiridhar Malavali long flashaddr = BOOTLD_START, memaddr = BOOTLD_START; 1415a9083016SGiridhar Malavali u64 data; 1416a9083016SGiridhar Malavali u32 high, low; 1417a9083016SGiridhar Malavali size = (IMAGE_START - BOOTLD_START) / 8; 1418a9083016SGiridhar Malavali 1419a9083016SGiridhar Malavali for (i = 0; i < size; i++) { 1420a9083016SGiridhar Malavali if ((qla82xx_rom_fast_read(ha, flashaddr, (int *)&low)) || 1421a9083016SGiridhar Malavali (qla82xx_rom_fast_read(ha, flashaddr + 4, (int *)&high))) { 1422a9083016SGiridhar Malavali return -1; 1423a9083016SGiridhar Malavali } 1424a9083016SGiridhar Malavali data = ((u64)high << 32) | low ; 1425a9083016SGiridhar Malavali qla82xx_pci_mem_write_2M(ha, memaddr, &data, 8); 1426a9083016SGiridhar Malavali flashaddr += 8; 1427a9083016SGiridhar Malavali memaddr += 8; 1428a9083016SGiridhar Malavali 1429a9083016SGiridhar Malavali if (i % 0x1000 == 0) 1430a9083016SGiridhar Malavali msleep(1); 1431a9083016SGiridhar Malavali } 1432a9083016SGiridhar Malavali udelay(100); 1433a9083016SGiridhar Malavali read_lock(&ha->hw_lock); 1434a9083016SGiridhar Malavali if (QLA82XX_IS_REVISION_P3PLUS(ha->chip_revision)) { 1435a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_0 + 0x18, 0x1020); 1436a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET, 0x80001e); 1437a9083016SGiridhar Malavali } else { 1438a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET, 0x80001d); 1439a9083016SGiridhar Malavali } 1440a9083016SGiridhar Malavali read_unlock(&ha->hw_lock); 1441a9083016SGiridhar Malavali return 0; 1442a9083016SGiridhar Malavali } 1443a9083016SGiridhar Malavali 1444a9083016SGiridhar Malavali int 1445a9083016SGiridhar Malavali qla82xx_pci_mem_read_2M(struct qla_hw_data *ha, 1446a9083016SGiridhar Malavali u64 off, void *data, int size) 1447a9083016SGiridhar Malavali { 1448a9083016SGiridhar Malavali int i, j = 0, k, start, end, loop, sz[2], off0[2]; 1449a9083016SGiridhar Malavali int shift_amount; 1450a9083016SGiridhar Malavali uint32_t temp; 1451a9083016SGiridhar Malavali uint64_t off8, val, mem_crb, word[2] = {0, 0}; 1452a9083016SGiridhar Malavali 1453a9083016SGiridhar Malavali /* 1454a9083016SGiridhar Malavali * If not MN, go check for MS or invalid. 1455a9083016SGiridhar Malavali */ 1456a9083016SGiridhar Malavali 1457a9083016SGiridhar Malavali if (off >= QLA82XX_ADDR_QDR_NET && off <= QLA82XX_P3_ADDR_QDR_NET_MAX) 1458a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_QDR_NET; 1459a9083016SGiridhar Malavali else { 1460a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_DDR_NET; 1461a9083016SGiridhar Malavali if (qla82xx_pci_mem_bound_check(ha, off, size) == 0) 1462a9083016SGiridhar Malavali return qla82xx_pci_mem_read_direct(ha, 1463a9083016SGiridhar Malavali off, data, size); 1464a9083016SGiridhar Malavali } 1465a9083016SGiridhar Malavali 1466a9083016SGiridhar Malavali if (QLA82XX_IS_REVISION_P3PLUS(ha->chip_revision)) { 1467a9083016SGiridhar Malavali off8 = off & 0xfffffff0; 1468a9083016SGiridhar Malavali off0[0] = off & 0xf; 1469a9083016SGiridhar Malavali sz[0] = (size < (16 - off0[0])) ? size : (16 - off0[0]); 1470a9083016SGiridhar Malavali shift_amount = 4; 1471a9083016SGiridhar Malavali } else { 1472a9083016SGiridhar Malavali off8 = off & 0xfffffff8; 1473a9083016SGiridhar Malavali off0[0] = off & 0x7; 1474a9083016SGiridhar Malavali sz[0] = (size < (8 - off0[0])) ? size : (8 - off0[0]); 1475a9083016SGiridhar Malavali shift_amount = 4; 1476a9083016SGiridhar Malavali } 1477a9083016SGiridhar Malavali loop = ((off0[0] + size - 1) >> shift_amount) + 1; 1478a9083016SGiridhar Malavali off0[1] = 0; 1479a9083016SGiridhar Malavali sz[1] = size - sz[0]; 1480a9083016SGiridhar Malavali 1481a9083016SGiridhar Malavali /* 1482a9083016SGiridhar Malavali * don't lock here - write_wx gets the lock if each time 1483a9083016SGiridhar Malavali * write_lock_irqsave(&adapter->adapter_lock, flags); 1484a9083016SGiridhar Malavali * netxen_nic_pci_change_crbwindow_128M(adapter, 0); 1485a9083016SGiridhar Malavali */ 1486a9083016SGiridhar Malavali 1487a9083016SGiridhar Malavali for (i = 0; i < loop; i++) { 1488a9083016SGiridhar Malavali temp = off8 + (i << shift_amount); 1489a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_ADDR_LO, temp); 1490a9083016SGiridhar Malavali temp = 0; 1491a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_ADDR_HI, temp); 1492a9083016SGiridhar Malavali temp = MIU_TA_CTL_ENABLE; 1493a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_CTRL, temp); 1494a9083016SGiridhar Malavali temp = MIU_TA_CTL_START | MIU_TA_CTL_ENABLE; 1495a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_CTRL, temp); 1496a9083016SGiridhar Malavali 1497a9083016SGiridhar Malavali for (j = 0; j < MAX_CTL_CHECK; j++) { 1498a9083016SGiridhar Malavali temp = qla82xx_rd_32(ha, mem_crb + MIU_TEST_AGT_CTRL); 1499a9083016SGiridhar Malavali if ((temp & MIU_TA_CTL_BUSY) == 0) 1500a9083016SGiridhar Malavali break; 1501a9083016SGiridhar Malavali } 1502a9083016SGiridhar Malavali 1503a9083016SGiridhar Malavali if (j >= MAX_CTL_CHECK) { 1504a9083016SGiridhar Malavali if (printk_ratelimit()) 1505a9083016SGiridhar Malavali dev_err(&ha->pdev->dev, 1506a9083016SGiridhar Malavali "failed to read through agent\n"); 1507a9083016SGiridhar Malavali break; 1508a9083016SGiridhar Malavali } 1509a9083016SGiridhar Malavali 1510a9083016SGiridhar Malavali start = off0[i] >> 2; 1511a9083016SGiridhar Malavali end = (off0[i] + sz[i] - 1) >> 2; 1512a9083016SGiridhar Malavali for (k = start; k <= end; k++) { 1513a9083016SGiridhar Malavali temp = qla82xx_rd_32(ha, 1514a9083016SGiridhar Malavali mem_crb + MIU_TEST_AGT_RDDATA(k)); 1515a9083016SGiridhar Malavali word[i] |= ((uint64_t)temp << (32 * (k & 1))); 1516a9083016SGiridhar Malavali } 1517a9083016SGiridhar Malavali } 1518a9083016SGiridhar Malavali 1519a9083016SGiridhar Malavali /* 1520a9083016SGiridhar Malavali * netxen_nic_pci_change_crbwindow_128M(adapter, 1); 1521a9083016SGiridhar Malavali * write_unlock_irqrestore(&adapter->adapter_lock, flags); 1522a9083016SGiridhar Malavali */ 1523a9083016SGiridhar Malavali 1524a9083016SGiridhar Malavali if (j >= MAX_CTL_CHECK) 1525a9083016SGiridhar Malavali return -1; 1526a9083016SGiridhar Malavali 1527a9083016SGiridhar Malavali if ((off0[0] & 7) == 0) { 1528a9083016SGiridhar Malavali val = word[0]; 1529a9083016SGiridhar Malavali } else { 1530a9083016SGiridhar Malavali val = ((word[0] >> (off0[0] * 8)) & (~(~0ULL << (sz[0] * 8)))) | 1531a9083016SGiridhar Malavali ((word[1] & (~(~0ULL << (sz[1] * 8)))) << (sz[0] * 8)); 1532a9083016SGiridhar Malavali } 1533a9083016SGiridhar Malavali 1534a9083016SGiridhar Malavali switch (size) { 1535a9083016SGiridhar Malavali case 1: 1536a9083016SGiridhar Malavali *(uint8_t *)data = val; 1537a9083016SGiridhar Malavali break; 1538a9083016SGiridhar Malavali case 2: 1539a9083016SGiridhar Malavali *(uint16_t *)data = val; 1540a9083016SGiridhar Malavali break; 1541a9083016SGiridhar Malavali case 4: 1542a9083016SGiridhar Malavali *(uint32_t *)data = val; 1543a9083016SGiridhar Malavali break; 1544a9083016SGiridhar Malavali case 8: 1545a9083016SGiridhar Malavali *(uint64_t *)data = val; 1546a9083016SGiridhar Malavali break; 1547a9083016SGiridhar Malavali } 1548a9083016SGiridhar Malavali return 0; 1549a9083016SGiridhar Malavali } 1550a9083016SGiridhar Malavali 1551a9083016SGiridhar Malavali int 1552a9083016SGiridhar Malavali qla82xx_pci_mem_write_2M(struct qla_hw_data *ha, 1553a9083016SGiridhar Malavali u64 off, void *data, int size) 1554a9083016SGiridhar Malavali { 1555a9083016SGiridhar Malavali int i, j, ret = 0, loop, sz[2], off0; 1556a9083016SGiridhar Malavali int scale, shift_amount, p3p, startword; 1557a9083016SGiridhar Malavali uint32_t temp; 1558a9083016SGiridhar Malavali uint64_t off8, mem_crb, tmpw, word[2] = {0, 0}; 1559a9083016SGiridhar Malavali 1560a9083016SGiridhar Malavali /* 1561a9083016SGiridhar Malavali * If not MN, go check for MS or invalid. 1562a9083016SGiridhar Malavali */ 1563a9083016SGiridhar Malavali if (off >= QLA82XX_ADDR_QDR_NET && off <= QLA82XX_P3_ADDR_QDR_NET_MAX) 1564a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_QDR_NET; 1565a9083016SGiridhar Malavali else { 1566a9083016SGiridhar Malavali mem_crb = QLA82XX_CRB_DDR_NET; 1567a9083016SGiridhar Malavali if (qla82xx_pci_mem_bound_check(ha, off, size) == 0) 1568a9083016SGiridhar Malavali return qla82xx_pci_mem_write_direct(ha, 1569a9083016SGiridhar Malavali off, data, size); 1570a9083016SGiridhar Malavali } 1571a9083016SGiridhar Malavali 1572a9083016SGiridhar Malavali off0 = off & 0x7; 1573a9083016SGiridhar Malavali sz[0] = (size < (8 - off0)) ? size : (8 - off0); 1574a9083016SGiridhar Malavali sz[1] = size - sz[0]; 1575a9083016SGiridhar Malavali 1576a9083016SGiridhar Malavali if (QLA82XX_IS_REVISION_P3PLUS(ha->chip_revision)) { 1577a9083016SGiridhar Malavali off8 = off & 0xfffffff0; 1578a9083016SGiridhar Malavali loop = (((off & 0xf) + size - 1) >> 4) + 1; 1579a9083016SGiridhar Malavali shift_amount = 4; 1580a9083016SGiridhar Malavali scale = 2; 1581a9083016SGiridhar Malavali p3p = 1; 1582a9083016SGiridhar Malavali startword = (off & 0xf)/8; 1583a9083016SGiridhar Malavali } else { 1584a9083016SGiridhar Malavali off8 = off & 0xfffffff8; 1585a9083016SGiridhar Malavali loop = ((off0 + size - 1) >> 3) + 1; 1586a9083016SGiridhar Malavali shift_amount = 3; 1587a9083016SGiridhar Malavali scale = 1; 1588a9083016SGiridhar Malavali p3p = 0; 1589a9083016SGiridhar Malavali startword = 0; 1590a9083016SGiridhar Malavali } 1591a9083016SGiridhar Malavali 1592a9083016SGiridhar Malavali if (p3p || (size != 8) || (off0 != 0)) { 1593a9083016SGiridhar Malavali for (i = 0; i < loop; i++) { 1594a9083016SGiridhar Malavali if (qla82xx_pci_mem_read_2M(ha, off8 + 1595a9083016SGiridhar Malavali (i << shift_amount), &word[i * scale], 8)) 1596a9083016SGiridhar Malavali return -1; 1597a9083016SGiridhar Malavali } 1598a9083016SGiridhar Malavali } 1599a9083016SGiridhar Malavali 1600a9083016SGiridhar Malavali switch (size) { 1601a9083016SGiridhar Malavali case 1: 1602a9083016SGiridhar Malavali tmpw = *((uint8_t *)data); 1603a9083016SGiridhar Malavali break; 1604a9083016SGiridhar Malavali case 2: 1605a9083016SGiridhar Malavali tmpw = *((uint16_t *)data); 1606a9083016SGiridhar Malavali break; 1607a9083016SGiridhar Malavali case 4: 1608a9083016SGiridhar Malavali tmpw = *((uint32_t *)data); 1609a9083016SGiridhar Malavali break; 1610a9083016SGiridhar Malavali case 8: 1611a9083016SGiridhar Malavali default: 1612a9083016SGiridhar Malavali tmpw = *((uint64_t *)data); 1613a9083016SGiridhar Malavali break; 1614a9083016SGiridhar Malavali } 1615a9083016SGiridhar Malavali 1616a9083016SGiridhar Malavali if (QLA82XX_IS_REVISION_P3PLUS(ha->chip_revision)) { 1617a9083016SGiridhar Malavali if (sz[0] == 8) { 1618a9083016SGiridhar Malavali word[startword] = tmpw; 1619a9083016SGiridhar Malavali } else { 1620a9083016SGiridhar Malavali word[startword] &= 1621a9083016SGiridhar Malavali ~((~(~0ULL << (sz[0] * 8))) << (off0 * 8)); 1622a9083016SGiridhar Malavali word[startword] |= tmpw << (off0 * 8); 1623a9083016SGiridhar Malavali } 1624a9083016SGiridhar Malavali if (sz[1] != 0) { 1625a9083016SGiridhar Malavali word[startword+1] &= ~(~0ULL << (sz[1] * 8)); 1626a9083016SGiridhar Malavali word[startword+1] |= tmpw >> (sz[0] * 8); 1627a9083016SGiridhar Malavali } 1628a9083016SGiridhar Malavali } else { 1629a9083016SGiridhar Malavali word[startword] &= ~((~(~0ULL << (sz[0] * 8))) << (off0 * 8)); 1630a9083016SGiridhar Malavali word[startword] |= tmpw << (off0 * 8); 1631a9083016SGiridhar Malavali 1632a9083016SGiridhar Malavali if (loop == 2) { 1633a9083016SGiridhar Malavali word[1] &= ~(~0ULL << (sz[1] * 8)); 1634a9083016SGiridhar Malavali word[1] |= tmpw >> (sz[0] * 8); 1635a9083016SGiridhar Malavali } 1636a9083016SGiridhar Malavali } 1637a9083016SGiridhar Malavali 1638a9083016SGiridhar Malavali /* 1639a9083016SGiridhar Malavali * don't lock here - write_wx gets the lock if each time 1640a9083016SGiridhar Malavali * write_lock_irqsave(&adapter->adapter_lock, flags); 1641a9083016SGiridhar Malavali * netxen_nic_pci_change_crbwindow_128M(adapter, 0); 1642a9083016SGiridhar Malavali */ 1643a9083016SGiridhar Malavali for (i = 0; i < loop; i++) { 1644a9083016SGiridhar Malavali temp = off8 + (i << shift_amount); 1645a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_ADDR_LO, temp); 1646a9083016SGiridhar Malavali temp = 0; 1647a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_ADDR_HI, temp); 1648a9083016SGiridhar Malavali temp = word[i * scale] & 0xffffffff; 1649a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_WRDATA_LO, temp); 1650a9083016SGiridhar Malavali temp = (word[i * scale] >> 32) & 0xffffffff; 1651a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb+MIU_TEST_AGT_WRDATA_HI, temp); 1652a9083016SGiridhar Malavali if (QLA82XX_IS_REVISION_P3PLUS(ha->chip_revision)) { 1653a9083016SGiridhar Malavali temp = word[i*scale + 1] & 0xffffffff; 1654a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + 1655a9083016SGiridhar Malavali MIU_TEST_AGT_WRDATA_UPPER_LO, temp); 1656a9083016SGiridhar Malavali temp = (word[i*scale + 1] >> 32) & 0xffffffff; 1657a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + 1658a9083016SGiridhar Malavali MIU_TEST_AGT_WRDATA_UPPER_HI, temp); 1659a9083016SGiridhar Malavali } 1660a9083016SGiridhar Malavali 1661a9083016SGiridhar Malavali temp = MIU_TA_CTL_ENABLE | MIU_TA_CTL_WRITE; 1662a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_CTRL, temp); 1663a9083016SGiridhar Malavali temp = MIU_TA_CTL_START | MIU_TA_CTL_ENABLE | MIU_TA_CTL_WRITE; 1664a9083016SGiridhar Malavali qla82xx_wr_32(ha, mem_crb + MIU_TEST_AGT_CTRL, temp); 1665a9083016SGiridhar Malavali 1666a9083016SGiridhar Malavali for (j = 0; j < MAX_CTL_CHECK; j++) { 1667a9083016SGiridhar Malavali temp = qla82xx_rd_32(ha, mem_crb + MIU_TEST_AGT_CTRL); 1668a9083016SGiridhar Malavali if ((temp & MIU_TA_CTL_BUSY) == 0) 1669a9083016SGiridhar Malavali break; 1670a9083016SGiridhar Malavali } 1671a9083016SGiridhar Malavali 1672a9083016SGiridhar Malavali if (j >= MAX_CTL_CHECK) { 1673a9083016SGiridhar Malavali if (printk_ratelimit()) 1674a9083016SGiridhar Malavali dev_err(&ha->pdev->dev, 1675a9083016SGiridhar Malavali "failed to write through agent\n"); 1676a9083016SGiridhar Malavali ret = -1; 1677a9083016SGiridhar Malavali break; 1678a9083016SGiridhar Malavali } 1679a9083016SGiridhar Malavali } 1680a9083016SGiridhar Malavali 1681a9083016SGiridhar Malavali return ret; 1682a9083016SGiridhar Malavali } 1683a9083016SGiridhar Malavali 1684a9083016SGiridhar Malavali /* PCI related functions */ 1685a9083016SGiridhar Malavali char * 1686a9083016SGiridhar Malavali qla82xx_pci_info_str(struct scsi_qla_host *vha, char *str) 1687a9083016SGiridhar Malavali { 1688a9083016SGiridhar Malavali int pcie_reg; 1689a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 1690a9083016SGiridhar Malavali char lwstr[6]; 1691a9083016SGiridhar Malavali uint16_t lnk; 1692a9083016SGiridhar Malavali 1693a9083016SGiridhar Malavali pcie_reg = pci_find_capability(ha->pdev, PCI_CAP_ID_EXP); 1694a9083016SGiridhar Malavali pci_read_config_word(ha->pdev, pcie_reg + PCI_EXP_LNKSTA, &lnk); 1695a9083016SGiridhar Malavali ha->link_width = (lnk >> 4) & 0x3f; 1696a9083016SGiridhar Malavali 1697a9083016SGiridhar Malavali strcpy(str, "PCIe ("); 1698a9083016SGiridhar Malavali strcat(str, "2.5Gb/s "); 1699a9083016SGiridhar Malavali snprintf(lwstr, sizeof(lwstr), "x%d)", ha->link_width); 1700a9083016SGiridhar Malavali strcat(str, lwstr); 1701a9083016SGiridhar Malavali return str; 1702a9083016SGiridhar Malavali } 1703a9083016SGiridhar Malavali 1704a9083016SGiridhar Malavali int qla82xx_pci_region_offset(struct pci_dev *pdev, int region) 1705a9083016SGiridhar Malavali { 1706a9083016SGiridhar Malavali unsigned long val = 0; 1707a9083016SGiridhar Malavali u32 control; 1708a9083016SGiridhar Malavali 1709a9083016SGiridhar Malavali switch (region) { 1710a9083016SGiridhar Malavali case 0: 1711a9083016SGiridhar Malavali val = 0; 1712a9083016SGiridhar Malavali break; 1713a9083016SGiridhar Malavali case 1: 1714a9083016SGiridhar Malavali pci_read_config_dword(pdev, QLA82XX_PCI_REG_MSIX_TBL, &control); 1715a9083016SGiridhar Malavali val = control + QLA82XX_MSIX_TBL_SPACE; 1716a9083016SGiridhar Malavali break; 1717a9083016SGiridhar Malavali } 1718a9083016SGiridhar Malavali return val; 1719a9083016SGiridhar Malavali } 1720a9083016SGiridhar Malavali 1721a9083016SGiridhar Malavali int qla82xx_pci_region_len(struct pci_dev *pdev, int region) 1722a9083016SGiridhar Malavali { 1723a9083016SGiridhar Malavali unsigned long val = 0; 1724a9083016SGiridhar Malavali u32 control; 1725a9083016SGiridhar Malavali switch (region) { 1726a9083016SGiridhar Malavali case 0: 1727a9083016SGiridhar Malavali pci_read_config_dword(pdev, QLA82XX_PCI_REG_MSIX_TBL, &control); 1728a9083016SGiridhar Malavali val = control; 1729a9083016SGiridhar Malavali break; 1730a9083016SGiridhar Malavali case 1: 1731a9083016SGiridhar Malavali val = pci_resource_len(pdev, 0) - 1732a9083016SGiridhar Malavali qla82xx_pci_region_offset(pdev, 1); 1733a9083016SGiridhar Malavali break; 1734a9083016SGiridhar Malavali } 1735a9083016SGiridhar Malavali return val; 1736a9083016SGiridhar Malavali } 1737a9083016SGiridhar Malavali 1738a9083016SGiridhar Malavali int 1739a9083016SGiridhar Malavali qla82xx_iospace_config(struct qla_hw_data *ha) 1740a9083016SGiridhar Malavali { 1741a9083016SGiridhar Malavali uint32_t len = 0; 1742a9083016SGiridhar Malavali 1743a9083016SGiridhar Malavali if (pci_request_regions(ha->pdev, QLA2XXX_DRIVER_NAME)) { 1744a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1745a9083016SGiridhar Malavali "Failed to reserve selected regions (%s)\n", 1746a9083016SGiridhar Malavali pci_name(ha->pdev)); 1747a9083016SGiridhar Malavali goto iospace_error_exit; 1748a9083016SGiridhar Malavali } 1749a9083016SGiridhar Malavali 1750a9083016SGiridhar Malavali /* Use MMIO operations for all accesses. */ 1751a9083016SGiridhar Malavali if (!(pci_resource_flags(ha->pdev, 0) & IORESOURCE_MEM)) { 1752a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 1753a9083016SGiridhar Malavali "region #0 not an MMIO resource (%s), aborting\n", 1754a9083016SGiridhar Malavali pci_name(ha->pdev)); 1755a9083016SGiridhar Malavali goto iospace_error_exit; 1756a9083016SGiridhar Malavali } 1757a9083016SGiridhar Malavali 1758a9083016SGiridhar Malavali len = pci_resource_len(ha->pdev, 0); 1759a9083016SGiridhar Malavali ha->nx_pcibase = 1760a9083016SGiridhar Malavali (unsigned long)ioremap(pci_resource_start(ha->pdev, 0), len); 1761a9083016SGiridhar Malavali if (!ha->nx_pcibase) { 1762a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 1763a9083016SGiridhar Malavali "cannot remap pcibase MMIO (%s), aborting\n", 1764a9083016SGiridhar Malavali pci_name(ha->pdev)); 1765a9083016SGiridhar Malavali pci_release_regions(ha->pdev); 1766a9083016SGiridhar Malavali goto iospace_error_exit; 1767a9083016SGiridhar Malavali } 1768a9083016SGiridhar Malavali 1769a9083016SGiridhar Malavali /* Mapping of IO base pointer */ 1770a9083016SGiridhar Malavali ha->iobase = (device_reg_t __iomem *)((uint8_t *)ha->nx_pcibase + 1771a9083016SGiridhar Malavali 0xbc000 + (ha->pdev->devfn << 11)); 1772a9083016SGiridhar Malavali 1773a9083016SGiridhar Malavali if (!ql2xdbwr) { 1774a9083016SGiridhar Malavali ha->nxdb_wr_ptr = 1775a9083016SGiridhar Malavali (unsigned long)ioremap((pci_resource_start(ha->pdev, 4) + 1776a9083016SGiridhar Malavali (ha->pdev->devfn << 12)), 4); 1777a9083016SGiridhar Malavali if (!ha->nxdb_wr_ptr) { 1778a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 1779a9083016SGiridhar Malavali "cannot remap MMIO (%s), aborting\n", 1780a9083016SGiridhar Malavali pci_name(ha->pdev)); 1781a9083016SGiridhar Malavali pci_release_regions(ha->pdev); 1782a9083016SGiridhar Malavali goto iospace_error_exit; 1783a9083016SGiridhar Malavali } 1784a9083016SGiridhar Malavali 1785a9083016SGiridhar Malavali /* Mapping of IO base pointer, 1786a9083016SGiridhar Malavali * door bell read and write pointer 1787a9083016SGiridhar Malavali */ 1788a9083016SGiridhar Malavali ha->nxdb_rd_ptr = (uint8_t *) ha->nx_pcibase + (512 * 1024) + 1789a9083016SGiridhar Malavali (ha->pdev->devfn * 8); 1790a9083016SGiridhar Malavali } else { 1791a9083016SGiridhar Malavali ha->nxdb_wr_ptr = (ha->pdev->devfn == 6 ? 1792a9083016SGiridhar Malavali QLA82XX_CAMRAM_DB1 : 1793a9083016SGiridhar Malavali QLA82XX_CAMRAM_DB2); 1794a9083016SGiridhar Malavali } 1795a9083016SGiridhar Malavali 1796a9083016SGiridhar Malavali ha->max_req_queues = ha->max_rsp_queues = 1; 1797a9083016SGiridhar Malavali ha->msix_count = ha->max_rsp_queues + 1; 1798a9083016SGiridhar Malavali return 0; 1799a9083016SGiridhar Malavali 1800a9083016SGiridhar Malavali iospace_error_exit: 1801a9083016SGiridhar Malavali return -ENOMEM; 1802a9083016SGiridhar Malavali } 1803a9083016SGiridhar Malavali 1804a9083016SGiridhar Malavali /* GS related functions */ 1805a9083016SGiridhar Malavali 1806a9083016SGiridhar Malavali /* Initialization related functions */ 1807a9083016SGiridhar Malavali 1808a9083016SGiridhar Malavali /** 1809a9083016SGiridhar Malavali * qla82xx_pci_config() - Setup ISP82xx PCI configuration registers. 1810a9083016SGiridhar Malavali * @ha: HA context 1811a9083016SGiridhar Malavali * 1812a9083016SGiridhar Malavali * Returns 0 on success. 1813a9083016SGiridhar Malavali */ 1814a9083016SGiridhar Malavali int 1815a9083016SGiridhar Malavali qla82xx_pci_config(scsi_qla_host_t *vha) 1816a9083016SGiridhar Malavali { 1817a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 1818a9083016SGiridhar Malavali int ret; 1819a9083016SGiridhar Malavali 1820a9083016SGiridhar Malavali pci_set_master(ha->pdev); 1821a9083016SGiridhar Malavali ret = pci_set_mwi(ha->pdev); 1822a9083016SGiridhar Malavali ha->chip_revision = ha->pdev->revision; 1823a9083016SGiridhar Malavali return 0; 1824a9083016SGiridhar Malavali } 1825a9083016SGiridhar Malavali 1826a9083016SGiridhar Malavali /** 1827a9083016SGiridhar Malavali * qla82xx_reset_chip() - Setup ISP82xx PCI configuration registers. 1828a9083016SGiridhar Malavali * @ha: HA context 1829a9083016SGiridhar Malavali * 1830a9083016SGiridhar Malavali * Returns 0 on success. 1831a9083016SGiridhar Malavali */ 1832a9083016SGiridhar Malavali void 1833a9083016SGiridhar Malavali qla82xx_reset_chip(scsi_qla_host_t *vha) 1834a9083016SGiridhar Malavali { 1835a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 1836a9083016SGiridhar Malavali ha->isp_ops->disable_intrs(ha); 1837a9083016SGiridhar Malavali } 1838a9083016SGiridhar Malavali 1839a9083016SGiridhar Malavali void qla82xx_config_rings(struct scsi_qla_host *vha) 1840a9083016SGiridhar Malavali { 1841a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 1842a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg = &ha->iobase->isp82; 1843a9083016SGiridhar Malavali struct init_cb_81xx *icb; 1844a9083016SGiridhar Malavali struct req_que *req = ha->req_q_map[0]; 1845a9083016SGiridhar Malavali struct rsp_que *rsp = ha->rsp_q_map[0]; 1846a9083016SGiridhar Malavali 1847a9083016SGiridhar Malavali /* Setup ring parameters in initialization control block. */ 1848a9083016SGiridhar Malavali icb = (struct init_cb_81xx *)ha->init_cb; 1849a9083016SGiridhar Malavali icb->request_q_outpointer = __constant_cpu_to_le16(0); 1850a9083016SGiridhar Malavali icb->response_q_inpointer = __constant_cpu_to_le16(0); 1851a9083016SGiridhar Malavali icb->request_q_length = cpu_to_le16(req->length); 1852a9083016SGiridhar Malavali icb->response_q_length = cpu_to_le16(rsp->length); 1853a9083016SGiridhar Malavali icb->request_q_address[0] = cpu_to_le32(LSD(req->dma)); 1854a9083016SGiridhar Malavali icb->request_q_address[1] = cpu_to_le32(MSD(req->dma)); 1855a9083016SGiridhar Malavali icb->response_q_address[0] = cpu_to_le32(LSD(rsp->dma)); 1856a9083016SGiridhar Malavali icb->response_q_address[1] = cpu_to_le32(MSD(rsp->dma)); 1857a9083016SGiridhar Malavali 1858a9083016SGiridhar Malavali icb->version = 1; 1859a9083016SGiridhar Malavali icb->frame_payload_size = 2112; 1860a9083016SGiridhar Malavali icb->execution_throttle = 8; 1861a9083016SGiridhar Malavali icb->exchange_count = 128; 1862a9083016SGiridhar Malavali icb->login_retry_count = 8; 1863a9083016SGiridhar Malavali 1864a9083016SGiridhar Malavali WRT_REG_DWORD((unsigned long __iomem *)®->req_q_out[0], 0); 1865a9083016SGiridhar Malavali WRT_REG_DWORD((unsigned long __iomem *)®->rsp_q_in[0], 0); 1866a9083016SGiridhar Malavali WRT_REG_DWORD((unsigned long __iomem *)®->rsp_q_out[0], 0); 1867a9083016SGiridhar Malavali } 1868a9083016SGiridhar Malavali 1869a9083016SGiridhar Malavali int qla82xx_fw_load_from_blob(struct qla_hw_data *ha) 1870a9083016SGiridhar Malavali { 1871a9083016SGiridhar Malavali u64 *ptr64; 1872a9083016SGiridhar Malavali u32 i, flashaddr, size; 1873a9083016SGiridhar Malavali __le64 data; 1874a9083016SGiridhar Malavali 1875a9083016SGiridhar Malavali size = (IMAGE_START - BOOTLD_START) / 8; 1876a9083016SGiridhar Malavali 1877a9083016SGiridhar Malavali ptr64 = (u64 *)&ha->hablob->fw->data[BOOTLD_START]; 1878a9083016SGiridhar Malavali flashaddr = BOOTLD_START; 1879a9083016SGiridhar Malavali 1880a9083016SGiridhar Malavali for (i = 0; i < size; i++) { 1881a9083016SGiridhar Malavali data = cpu_to_le64(ptr64[i]); 1882a9083016SGiridhar Malavali qla82xx_pci_mem_write_2M(ha, flashaddr, &data, 8); 1883a9083016SGiridhar Malavali flashaddr += 8; 1884a9083016SGiridhar Malavali } 1885a9083016SGiridhar Malavali 1886a9083016SGiridhar Malavali size = *(u32 *)&ha->hablob->fw->data[FW_SIZE_OFFSET]; 1887a9083016SGiridhar Malavali size = (__force u32)cpu_to_le32(size) / 8; 1888a9083016SGiridhar Malavali ptr64 = (u64 *)&ha->hablob->fw->data[IMAGE_START]; 1889a9083016SGiridhar Malavali flashaddr = FLASH_ADDR_START; 1890a9083016SGiridhar Malavali 1891a9083016SGiridhar Malavali for (i = 0; i < size; i++) { 1892a9083016SGiridhar Malavali data = cpu_to_le64(ptr64[i]); 1893a9083016SGiridhar Malavali 1894a9083016SGiridhar Malavali if (qla82xx_pci_mem_write_2M(ha, flashaddr, &data, 8)) 1895a9083016SGiridhar Malavali return -EIO; 1896a9083016SGiridhar Malavali flashaddr += 8; 1897a9083016SGiridhar Malavali } 1898a9083016SGiridhar Malavali 1899a9083016SGiridhar Malavali /* Write a magic value to CAMRAM register 1900a9083016SGiridhar Malavali * at a specified offset to indicate 1901a9083016SGiridhar Malavali * that all data is written and 1902a9083016SGiridhar Malavali * ready for firmware to initialize. 1903a9083016SGiridhar Malavali */ 1904a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CAM_RAM(0x1fc), 0x12345678); 1905a9083016SGiridhar Malavali 1906a9083016SGiridhar Malavali if (QLA82XX_IS_REVISION_P3PLUS(ha->chip_revision)) { 1907a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_PEG_NET_0 + 0x18, 0x1020); 1908a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET, 0x80001e); 1909a9083016SGiridhar Malavali } else 1910a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET, 0x80001d); 1911a9083016SGiridhar Malavali return 0; 1912a9083016SGiridhar Malavali } 1913a9083016SGiridhar Malavali 1914a9083016SGiridhar Malavali int qla82xx_check_cmdpeg_state(struct qla_hw_data *ha) 1915a9083016SGiridhar Malavali { 1916a9083016SGiridhar Malavali u32 val = 0; 1917a9083016SGiridhar Malavali int retries = 60; 1918a9083016SGiridhar Malavali 1919a9083016SGiridhar Malavali do { 1920a9083016SGiridhar Malavali read_lock(&ha->hw_lock); 1921a9083016SGiridhar Malavali val = qla82xx_rd_32(ha, CRB_CMDPEG_STATE); 1922a9083016SGiridhar Malavali read_unlock(&ha->hw_lock); 1923a9083016SGiridhar Malavali 1924a9083016SGiridhar Malavali switch (val) { 1925a9083016SGiridhar Malavali case PHAN_INITIALIZE_COMPLETE: 1926a9083016SGiridhar Malavali case PHAN_INITIALIZE_ACK: 1927a9083016SGiridhar Malavali return QLA_SUCCESS; 1928a9083016SGiridhar Malavali case PHAN_INITIALIZE_FAILED: 1929a9083016SGiridhar Malavali break; 1930a9083016SGiridhar Malavali default: 1931a9083016SGiridhar Malavali break; 1932a9083016SGiridhar Malavali } 1933a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1934a9083016SGiridhar Malavali "CRB_CMDPEG_STATE: 0x%x and retries: 0x%x\n", 1935a9083016SGiridhar Malavali val, retries); 1936a9083016SGiridhar Malavali 1937a9083016SGiridhar Malavali msleep(500); 1938a9083016SGiridhar Malavali 1939a9083016SGiridhar Malavali } while (--retries); 1940a9083016SGiridhar Malavali 1941a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 1942a9083016SGiridhar Malavali "Cmd Peg initialization failed: 0x%x.\n", val); 1943a9083016SGiridhar Malavali 1944a9083016SGiridhar Malavali qla82xx_check_for_bad_spd(ha); 1945a9083016SGiridhar Malavali val = qla82xx_rd_32(ha, QLA82XX_ROMUSB_GLB_PEGTUNE_DONE); 1946a9083016SGiridhar Malavali read_lock(&ha->hw_lock); 1947a9083016SGiridhar Malavali qla82xx_wr_32(ha, CRB_CMDPEG_STATE, PHAN_INITIALIZE_FAILED); 1948a9083016SGiridhar Malavali read_unlock(&ha->hw_lock); 1949a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 1950a9083016SGiridhar Malavali } 1951a9083016SGiridhar Malavali 1952a9083016SGiridhar Malavali int qla82xx_check_rcvpeg_state(struct qla_hw_data *ha) 1953a9083016SGiridhar Malavali { 1954a9083016SGiridhar Malavali u32 val = 0; 1955a9083016SGiridhar Malavali int retries = 60; 1956a9083016SGiridhar Malavali 1957a9083016SGiridhar Malavali do { 1958a9083016SGiridhar Malavali read_lock(&ha->hw_lock); 1959a9083016SGiridhar Malavali val = qla82xx_rd_32(ha, CRB_RCVPEG_STATE); 1960a9083016SGiridhar Malavali read_unlock(&ha->hw_lock); 1961a9083016SGiridhar Malavali 1962a9083016SGiridhar Malavali switch (val) { 1963a9083016SGiridhar Malavali case PHAN_INITIALIZE_COMPLETE: 1964a9083016SGiridhar Malavali case PHAN_INITIALIZE_ACK: 1965a9083016SGiridhar Malavali return QLA_SUCCESS; 1966a9083016SGiridhar Malavali case PHAN_INITIALIZE_FAILED: 1967a9083016SGiridhar Malavali break; 1968a9083016SGiridhar Malavali default: 1969a9083016SGiridhar Malavali break; 1970a9083016SGiridhar Malavali } 1971a9083016SGiridhar Malavali 1972a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 1973a9083016SGiridhar Malavali "CRB_RCVPEG_STATE: 0x%x and retries: 0x%x\n", 1974a9083016SGiridhar Malavali val, retries); 1975a9083016SGiridhar Malavali 1976a9083016SGiridhar Malavali msleep(500); 1977a9083016SGiridhar Malavali 1978a9083016SGiridhar Malavali } while (--retries); 1979a9083016SGiridhar Malavali 1980a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 1981a9083016SGiridhar Malavali "Rcv Peg initialization failed: 0x%x.\n", val); 1982a9083016SGiridhar Malavali read_lock(&ha->hw_lock); 1983a9083016SGiridhar Malavali qla82xx_wr_32(ha, CRB_RCVPEG_STATE, PHAN_INITIALIZE_FAILED); 1984a9083016SGiridhar Malavali read_unlock(&ha->hw_lock); 1985a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 1986a9083016SGiridhar Malavali } 1987a9083016SGiridhar Malavali 1988a9083016SGiridhar Malavali /* ISR related functions */ 1989a9083016SGiridhar Malavali uint32_t qla82xx_isr_int_target_mask_enable[8] = { 1990a9083016SGiridhar Malavali ISR_INT_TARGET_MASK, ISR_INT_TARGET_MASK_F1, 1991a9083016SGiridhar Malavali ISR_INT_TARGET_MASK_F2, ISR_INT_TARGET_MASK_F3, 1992a9083016SGiridhar Malavali ISR_INT_TARGET_MASK_F4, ISR_INT_TARGET_MASK_F5, 1993a9083016SGiridhar Malavali ISR_INT_TARGET_MASK_F7, ISR_INT_TARGET_MASK_F7 1994a9083016SGiridhar Malavali }; 1995a9083016SGiridhar Malavali 1996a9083016SGiridhar Malavali uint32_t qla82xx_isr_int_target_status[8] = { 1997a9083016SGiridhar Malavali ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1, 1998a9083016SGiridhar Malavali ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3, 1999a9083016SGiridhar Malavali ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5, 2000a9083016SGiridhar Malavali ISR_INT_TARGET_STATUS_F7, ISR_INT_TARGET_STATUS_F7 2001a9083016SGiridhar Malavali }; 2002a9083016SGiridhar Malavali 2003a9083016SGiridhar Malavali static struct qla82xx_legacy_intr_set legacy_intr[] = \ 2004a9083016SGiridhar Malavali QLA82XX_LEGACY_INTR_CONFIG; 2005a9083016SGiridhar Malavali 2006a9083016SGiridhar Malavali /* 2007a9083016SGiridhar Malavali * qla82xx_mbx_completion() - Process mailbox command completions. 2008a9083016SGiridhar Malavali * @ha: SCSI driver HA context 2009a9083016SGiridhar Malavali * @mb0: Mailbox0 register 2010a9083016SGiridhar Malavali */ 2011a9083016SGiridhar Malavali void 2012a9083016SGiridhar Malavali qla82xx_mbx_completion(scsi_qla_host_t *vha, uint16_t mb0) 2013a9083016SGiridhar Malavali { 2014a9083016SGiridhar Malavali uint16_t cnt; 2015a9083016SGiridhar Malavali uint16_t __iomem *wptr; 2016a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 2017a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg = &ha->iobase->isp82; 2018a9083016SGiridhar Malavali wptr = (uint16_t __iomem *)®->mailbox_out[1]; 2019a9083016SGiridhar Malavali 2020a9083016SGiridhar Malavali /* Load return mailbox registers. */ 2021a9083016SGiridhar Malavali ha->flags.mbox_int = 1; 2022a9083016SGiridhar Malavali ha->mailbox_out[0] = mb0; 2023a9083016SGiridhar Malavali 2024a9083016SGiridhar Malavali for (cnt = 1; cnt < ha->mbx_count; cnt++) { 2025a9083016SGiridhar Malavali ha->mailbox_out[cnt] = RD_REG_WORD(wptr); 2026a9083016SGiridhar Malavali wptr++; 2027a9083016SGiridhar Malavali } 2028a9083016SGiridhar Malavali 2029a9083016SGiridhar Malavali if (ha->mcp) { 2030a9083016SGiridhar Malavali DEBUG3_11(printk(KERN_INFO "%s(%ld): " 2031a9083016SGiridhar Malavali "Got mailbox completion. cmd=%x.\n", 2032a9083016SGiridhar Malavali __func__, vha->host_no, ha->mcp->mb[0])); 2033a9083016SGiridhar Malavali } else { 2034a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 2035a9083016SGiridhar Malavali "%s(%ld): MBX pointer ERROR!\n", 2036a9083016SGiridhar Malavali __func__, vha->host_no); 2037a9083016SGiridhar Malavali } 2038a9083016SGiridhar Malavali } 2039a9083016SGiridhar Malavali 2040a9083016SGiridhar Malavali /* 2041a9083016SGiridhar Malavali * qla82xx_intr_handler() - Process interrupts for the ISP23xx and ISP63xx. 2042a9083016SGiridhar Malavali * @irq: 2043a9083016SGiridhar Malavali * @dev_id: SCSI driver HA context 2044a9083016SGiridhar Malavali * @regs: 2045a9083016SGiridhar Malavali * 2046a9083016SGiridhar Malavali * Called by system whenever the host adapter generates an interrupt. 2047a9083016SGiridhar Malavali * 2048a9083016SGiridhar Malavali * Returns handled flag. 2049a9083016SGiridhar Malavali */ 2050a9083016SGiridhar Malavali irqreturn_t 2051a9083016SGiridhar Malavali qla82xx_intr_handler(int irq, void *dev_id) 2052a9083016SGiridhar Malavali { 2053a9083016SGiridhar Malavali scsi_qla_host_t *vha; 2054a9083016SGiridhar Malavali struct qla_hw_data *ha; 2055a9083016SGiridhar Malavali struct rsp_que *rsp; 2056a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg; 2057a9083016SGiridhar Malavali int status = 0, status1 = 0; 2058a9083016SGiridhar Malavali unsigned long flags; 2059a9083016SGiridhar Malavali unsigned long iter; 2060a9083016SGiridhar Malavali uint32_t stat; 2061a9083016SGiridhar Malavali uint16_t mb[4]; 2062a9083016SGiridhar Malavali 2063a9083016SGiridhar Malavali rsp = (struct rsp_que *) dev_id; 2064a9083016SGiridhar Malavali if (!rsp) { 2065a9083016SGiridhar Malavali printk(KERN_INFO 2066a9083016SGiridhar Malavali "%s(): NULL response queue pointer\n", __func__); 2067a9083016SGiridhar Malavali return IRQ_NONE; 2068a9083016SGiridhar Malavali } 2069a9083016SGiridhar Malavali ha = rsp->hw; 2070a9083016SGiridhar Malavali 2071a9083016SGiridhar Malavali if (!ha->flags.msi_enabled) { 2072a9083016SGiridhar Malavali status = qla82xx_rd_32(ha, ISR_INT_VECTOR); 2073a9083016SGiridhar Malavali if (!(status & ha->nx_legacy_intr.int_vec_bit)) 2074a9083016SGiridhar Malavali return IRQ_NONE; 2075a9083016SGiridhar Malavali 2076a9083016SGiridhar Malavali status1 = qla82xx_rd_32(ha, ISR_INT_STATE_REG); 2077a9083016SGiridhar Malavali if (!ISR_IS_LEGACY_INTR_TRIGGERED(status1)) 2078a9083016SGiridhar Malavali return IRQ_NONE; 2079a9083016SGiridhar Malavali } 2080a9083016SGiridhar Malavali 2081a9083016SGiridhar Malavali /* clear the interrupt */ 2082a9083016SGiridhar Malavali qla82xx_wr_32(ha, ha->nx_legacy_intr.tgt_status_reg, 0xffffffff); 2083a9083016SGiridhar Malavali 2084a9083016SGiridhar Malavali /* read twice to ensure write is flushed */ 2085a9083016SGiridhar Malavali qla82xx_rd_32(ha, ISR_INT_VECTOR); 2086a9083016SGiridhar Malavali qla82xx_rd_32(ha, ISR_INT_VECTOR); 2087a9083016SGiridhar Malavali 2088a9083016SGiridhar Malavali reg = &ha->iobase->isp82; 2089a9083016SGiridhar Malavali 2090a9083016SGiridhar Malavali spin_lock_irqsave(&ha->hardware_lock, flags); 2091a9083016SGiridhar Malavali vha = pci_get_drvdata(ha->pdev); 2092a9083016SGiridhar Malavali for (iter = 1; iter--; ) { 2093a9083016SGiridhar Malavali 2094a9083016SGiridhar Malavali if (RD_REG_DWORD(®->host_int)) { 2095a9083016SGiridhar Malavali stat = RD_REG_DWORD(®->host_status); 2096a9083016SGiridhar Malavali if (stat & HSRX_RISC_PAUSED) { 2097a9083016SGiridhar Malavali if (pci_channel_offline(ha->pdev)) 2098a9083016SGiridhar Malavali break; 2099a9083016SGiridhar Malavali 2100a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "RISC paused\n"); 2101a9083016SGiridhar Malavali set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags); 2102a9083016SGiridhar Malavali qla2xxx_wake_dpc(vha); 2103a9083016SGiridhar Malavali break; 2104a9083016SGiridhar Malavali } else if ((stat & HSRX_RISC_INT) == 0) 2105a9083016SGiridhar Malavali break; 2106a9083016SGiridhar Malavali 2107a9083016SGiridhar Malavali switch (stat & 0xff) { 2108a9083016SGiridhar Malavali case 0x1: 2109a9083016SGiridhar Malavali case 0x2: 2110a9083016SGiridhar Malavali case 0x10: 2111a9083016SGiridhar Malavali case 0x11: 2112a9083016SGiridhar Malavali qla82xx_mbx_completion(vha, MSW(stat)); 2113a9083016SGiridhar Malavali status |= MBX_INTERRUPT; 2114a9083016SGiridhar Malavali break; 2115a9083016SGiridhar Malavali case 0x12: 2116a9083016SGiridhar Malavali mb[0] = MSW(stat); 2117a9083016SGiridhar Malavali mb[1] = RD_REG_WORD(®->mailbox_out[1]); 2118a9083016SGiridhar Malavali mb[2] = RD_REG_WORD(®->mailbox_out[2]); 2119a9083016SGiridhar Malavali mb[3] = RD_REG_WORD(®->mailbox_out[3]); 2120a9083016SGiridhar Malavali qla2x00_async_event(vha, rsp, mb); 2121a9083016SGiridhar Malavali break; 2122a9083016SGiridhar Malavali case 0x13: 2123a9083016SGiridhar Malavali qla24xx_process_response_queue(vha, rsp); 2124a9083016SGiridhar Malavali break; 2125a9083016SGiridhar Malavali default: 2126a9083016SGiridhar Malavali DEBUG2(printk("scsi(%ld): " 2127a9083016SGiridhar Malavali " Unrecognized interrupt type (%d).\n", 2128a9083016SGiridhar Malavali vha->host_no, stat & 0xff)); 2129a9083016SGiridhar Malavali break; 2130a9083016SGiridhar Malavali } 2131a9083016SGiridhar Malavali } 2132a9083016SGiridhar Malavali WRT_REG_DWORD(®->host_int, 0); 2133a9083016SGiridhar Malavali } 2134a9083016SGiridhar Malavali spin_unlock_irqrestore(&ha->hardware_lock, flags); 2135a9083016SGiridhar Malavali if (!ha->flags.msi_enabled) 2136a9083016SGiridhar Malavali qla82xx_wr_32(ha, ha->nx_legacy_intr.tgt_mask_reg, 0xfbff); 2137a9083016SGiridhar Malavali 2138a9083016SGiridhar Malavali #ifdef QL_DEBUG_LEVEL_17 2139a9083016SGiridhar Malavali if (!irq && ha->flags.eeh_busy) 2140a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 2141a9083016SGiridhar Malavali "isr: status %x, cmd_flags %lx, mbox_int %x, stat %x\n", 2142a9083016SGiridhar Malavali status, ha->mbx_cmd_flags, ha->flags.mbox_int, stat); 2143a9083016SGiridhar Malavali #endif 2144a9083016SGiridhar Malavali 2145a9083016SGiridhar Malavali if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) && 2146a9083016SGiridhar Malavali (status & MBX_INTERRUPT) && ha->flags.mbox_int) { 2147a9083016SGiridhar Malavali set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags); 2148a9083016SGiridhar Malavali complete(&ha->mbx_intr_comp); 2149a9083016SGiridhar Malavali } 2150a9083016SGiridhar Malavali return IRQ_HANDLED; 2151a9083016SGiridhar Malavali } 2152a9083016SGiridhar Malavali 2153a9083016SGiridhar Malavali irqreturn_t 2154a9083016SGiridhar Malavali qla82xx_msix_default(int irq, void *dev_id) 2155a9083016SGiridhar Malavali { 2156a9083016SGiridhar Malavali scsi_qla_host_t *vha; 2157a9083016SGiridhar Malavali struct qla_hw_data *ha; 2158a9083016SGiridhar Malavali struct rsp_que *rsp; 2159a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg; 2160a9083016SGiridhar Malavali int status = 0; 2161a9083016SGiridhar Malavali unsigned long flags; 2162a9083016SGiridhar Malavali uint32_t stat; 2163a9083016SGiridhar Malavali uint16_t mb[4]; 2164a9083016SGiridhar Malavali 2165a9083016SGiridhar Malavali rsp = (struct rsp_que *) dev_id; 2166a9083016SGiridhar Malavali if (!rsp) { 2167a9083016SGiridhar Malavali printk(KERN_INFO 2168a9083016SGiridhar Malavali "%s(): NULL response queue pointer\n", __func__); 2169a9083016SGiridhar Malavali return IRQ_NONE; 2170a9083016SGiridhar Malavali } 2171a9083016SGiridhar Malavali ha = rsp->hw; 2172a9083016SGiridhar Malavali 2173a9083016SGiridhar Malavali reg = &ha->iobase->isp82; 2174a9083016SGiridhar Malavali 2175a9083016SGiridhar Malavali spin_lock_irqsave(&ha->hardware_lock, flags); 2176a9083016SGiridhar Malavali vha = pci_get_drvdata(ha->pdev); 2177a9083016SGiridhar Malavali do { 2178a9083016SGiridhar Malavali if (RD_REG_DWORD(®->host_int)) { 2179a9083016SGiridhar Malavali stat = RD_REG_DWORD(®->host_status); 2180a9083016SGiridhar Malavali if (stat & HSRX_RISC_PAUSED) { 2181a9083016SGiridhar Malavali if (pci_channel_offline(ha->pdev)) 2182a9083016SGiridhar Malavali break; 2183a9083016SGiridhar Malavali 2184a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "RISC paused\n"); 2185a9083016SGiridhar Malavali set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags); 2186a9083016SGiridhar Malavali qla2xxx_wake_dpc(vha); 2187a9083016SGiridhar Malavali break; 2188a9083016SGiridhar Malavali } else if ((stat & HSRX_RISC_INT) == 0) 2189a9083016SGiridhar Malavali break; 2190a9083016SGiridhar Malavali 2191a9083016SGiridhar Malavali switch (stat & 0xff) { 2192a9083016SGiridhar Malavali case 0x1: 2193a9083016SGiridhar Malavali case 0x2: 2194a9083016SGiridhar Malavali case 0x10: 2195a9083016SGiridhar Malavali case 0x11: 2196a9083016SGiridhar Malavali qla82xx_mbx_completion(vha, MSW(stat)); 2197a9083016SGiridhar Malavali status |= MBX_INTERRUPT; 2198a9083016SGiridhar Malavali break; 2199a9083016SGiridhar Malavali case 0x12: 2200a9083016SGiridhar Malavali mb[0] = MSW(stat); 2201a9083016SGiridhar Malavali mb[1] = RD_REG_WORD(®->mailbox_out[1]); 2202a9083016SGiridhar Malavali mb[2] = RD_REG_WORD(®->mailbox_out[2]); 2203a9083016SGiridhar Malavali mb[3] = RD_REG_WORD(®->mailbox_out[3]); 2204a9083016SGiridhar Malavali qla2x00_async_event(vha, rsp, mb); 2205a9083016SGiridhar Malavali break; 2206a9083016SGiridhar Malavali case 0x13: 2207a9083016SGiridhar Malavali qla24xx_process_response_queue(vha, rsp); 2208a9083016SGiridhar Malavali break; 2209a9083016SGiridhar Malavali default: 2210a9083016SGiridhar Malavali DEBUG2(printk("scsi(%ld): " 2211a9083016SGiridhar Malavali " Unrecognized interrupt type (%d).\n", 2212a9083016SGiridhar Malavali vha->host_no, stat & 0xff)); 2213a9083016SGiridhar Malavali break; 2214a9083016SGiridhar Malavali } 2215a9083016SGiridhar Malavali } 2216a9083016SGiridhar Malavali WRT_REG_DWORD(®->host_int, 0); 2217a9083016SGiridhar Malavali } while (0); 2218a9083016SGiridhar Malavali 2219a9083016SGiridhar Malavali spin_unlock_irqrestore(&ha->hardware_lock, flags); 2220a9083016SGiridhar Malavali 2221a9083016SGiridhar Malavali #ifdef QL_DEBUG_LEVEL_17 2222a9083016SGiridhar Malavali if (!irq && ha->flags.eeh_busy) 2223a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 2224a9083016SGiridhar Malavali "isr: status %x, cmd_flags %lx, mbox_int %x, stat %x\n", 2225a9083016SGiridhar Malavali status, ha->mbx_cmd_flags, ha->flags.mbox_int, stat); 2226a9083016SGiridhar Malavali #endif 2227a9083016SGiridhar Malavali 2228a9083016SGiridhar Malavali if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) && 2229a9083016SGiridhar Malavali (status & MBX_INTERRUPT) && ha->flags.mbox_int) { 2230a9083016SGiridhar Malavali set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags); 2231a9083016SGiridhar Malavali complete(&ha->mbx_intr_comp); 2232a9083016SGiridhar Malavali } 2233a9083016SGiridhar Malavali return IRQ_HANDLED; 2234a9083016SGiridhar Malavali } 2235a9083016SGiridhar Malavali 2236a9083016SGiridhar Malavali irqreturn_t 2237a9083016SGiridhar Malavali qla82xx_msix_rsp_q(int irq, void *dev_id) 2238a9083016SGiridhar Malavali { 2239a9083016SGiridhar Malavali scsi_qla_host_t *vha; 2240a9083016SGiridhar Malavali struct qla_hw_data *ha; 2241a9083016SGiridhar Malavali struct rsp_que *rsp; 2242a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg; 2243a9083016SGiridhar Malavali 2244a9083016SGiridhar Malavali rsp = (struct rsp_que *) dev_id; 2245a9083016SGiridhar Malavali if (!rsp) { 2246a9083016SGiridhar Malavali printk(KERN_INFO 2247a9083016SGiridhar Malavali "%s(): NULL response queue pointer\n", __func__); 2248a9083016SGiridhar Malavali return IRQ_NONE; 2249a9083016SGiridhar Malavali } 2250a9083016SGiridhar Malavali 2251a9083016SGiridhar Malavali ha = rsp->hw; 2252a9083016SGiridhar Malavali reg = &ha->iobase->isp82; 2253a9083016SGiridhar Malavali spin_lock_irq(&ha->hardware_lock); 2254a9083016SGiridhar Malavali vha = pci_get_drvdata(ha->pdev); 2255a9083016SGiridhar Malavali qla24xx_process_response_queue(vha, rsp); 2256a9083016SGiridhar Malavali WRT_REG_DWORD(®->host_int, 0); 2257a9083016SGiridhar Malavali spin_unlock_irq(&ha->hardware_lock); 2258a9083016SGiridhar Malavali return IRQ_HANDLED; 2259a9083016SGiridhar Malavali } 2260a9083016SGiridhar Malavali 2261a9083016SGiridhar Malavali void 2262a9083016SGiridhar Malavali qla82xx_poll(int irq, void *dev_id) 2263a9083016SGiridhar Malavali { 2264a9083016SGiridhar Malavali scsi_qla_host_t *vha; 2265a9083016SGiridhar Malavali struct qla_hw_data *ha; 2266a9083016SGiridhar Malavali struct rsp_que *rsp; 2267a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg; 2268a9083016SGiridhar Malavali int status = 0; 2269a9083016SGiridhar Malavali uint32_t stat; 2270a9083016SGiridhar Malavali uint16_t mb[4]; 2271a9083016SGiridhar Malavali unsigned long flags; 2272a9083016SGiridhar Malavali 2273a9083016SGiridhar Malavali rsp = (struct rsp_que *) dev_id; 2274a9083016SGiridhar Malavali if (!rsp) { 2275a9083016SGiridhar Malavali printk(KERN_INFO 2276a9083016SGiridhar Malavali "%s(): NULL response queue pointer\n", __func__); 2277a9083016SGiridhar Malavali return; 2278a9083016SGiridhar Malavali } 2279a9083016SGiridhar Malavali ha = rsp->hw; 2280a9083016SGiridhar Malavali 2281a9083016SGiridhar Malavali reg = &ha->iobase->isp82; 2282a9083016SGiridhar Malavali spin_lock_irqsave(&ha->hardware_lock, flags); 2283a9083016SGiridhar Malavali vha = pci_get_drvdata(ha->pdev); 2284a9083016SGiridhar Malavali 2285a9083016SGiridhar Malavali if (RD_REG_DWORD(®->host_int)) { 2286a9083016SGiridhar Malavali stat = RD_REG_DWORD(®->host_status); 2287a9083016SGiridhar Malavali switch (stat & 0xff) { 2288a9083016SGiridhar Malavali case 0x1: 2289a9083016SGiridhar Malavali case 0x2: 2290a9083016SGiridhar Malavali case 0x10: 2291a9083016SGiridhar Malavali case 0x11: 2292a9083016SGiridhar Malavali qla82xx_mbx_completion(vha, MSW(stat)); 2293a9083016SGiridhar Malavali status |= MBX_INTERRUPT; 2294a9083016SGiridhar Malavali break; 2295a9083016SGiridhar Malavali case 0x12: 2296a9083016SGiridhar Malavali mb[0] = MSW(stat); 2297a9083016SGiridhar Malavali mb[1] = RD_REG_WORD(®->mailbox_out[1]); 2298a9083016SGiridhar Malavali mb[2] = RD_REG_WORD(®->mailbox_out[2]); 2299a9083016SGiridhar Malavali mb[3] = RD_REG_WORD(®->mailbox_out[3]); 2300a9083016SGiridhar Malavali qla2x00_async_event(vha, rsp, mb); 2301a9083016SGiridhar Malavali break; 2302a9083016SGiridhar Malavali case 0x13: 2303a9083016SGiridhar Malavali qla24xx_process_response_queue(vha, rsp); 2304a9083016SGiridhar Malavali break; 2305a9083016SGiridhar Malavali default: 2306a9083016SGiridhar Malavali DEBUG2(printk("scsi(%ld): Unrecognized interrupt type " 2307a9083016SGiridhar Malavali "(%d).\n", 2308a9083016SGiridhar Malavali vha->host_no, stat & 0xff)); 2309a9083016SGiridhar Malavali break; 2310a9083016SGiridhar Malavali } 2311a9083016SGiridhar Malavali } 2312a9083016SGiridhar Malavali WRT_REG_DWORD(®->host_int, 0); 2313a9083016SGiridhar Malavali spin_unlock_irqrestore(&ha->hardware_lock, flags); 2314a9083016SGiridhar Malavali } 2315a9083016SGiridhar Malavali 2316a9083016SGiridhar Malavali void 2317a9083016SGiridhar Malavali qla82xx_enable_intrs(struct qla_hw_data *ha) 2318a9083016SGiridhar Malavali { 2319a9083016SGiridhar Malavali scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev); 2320a9083016SGiridhar Malavali qla82xx_mbx_intr_enable(vha); 2321a9083016SGiridhar Malavali spin_lock_irq(&ha->hardware_lock); 2322a9083016SGiridhar Malavali qla82xx_wr_32(ha, ha->nx_legacy_intr.tgt_mask_reg, 0xfbff); 2323a9083016SGiridhar Malavali spin_unlock_irq(&ha->hardware_lock); 2324a9083016SGiridhar Malavali ha->interrupts_on = 1; 2325a9083016SGiridhar Malavali } 2326a9083016SGiridhar Malavali 2327a9083016SGiridhar Malavali void 2328a9083016SGiridhar Malavali qla82xx_disable_intrs(struct qla_hw_data *ha) 2329a9083016SGiridhar Malavali { 2330a9083016SGiridhar Malavali scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev); 2331a9083016SGiridhar Malavali qla82xx_mbx_intr_disable(vha); 2332a9083016SGiridhar Malavali spin_lock_irq(&ha->hardware_lock); 2333a9083016SGiridhar Malavali qla82xx_wr_32(ha, ha->nx_legacy_intr.tgt_mask_reg, 0x0400); 2334a9083016SGiridhar Malavali spin_unlock_irq(&ha->hardware_lock); 2335a9083016SGiridhar Malavali ha->interrupts_on = 0; 2336a9083016SGiridhar Malavali } 2337a9083016SGiridhar Malavali 2338a9083016SGiridhar Malavali void qla82xx_init_flags(struct qla_hw_data *ha) 2339a9083016SGiridhar Malavali { 2340a9083016SGiridhar Malavali struct qla82xx_legacy_intr_set *nx_legacy_intr; 2341a9083016SGiridhar Malavali 2342a9083016SGiridhar Malavali /* ISP 8021 initializations */ 2343a9083016SGiridhar Malavali rwlock_init(&ha->hw_lock); 2344a9083016SGiridhar Malavali ha->qdr_sn_window = -1; 2345a9083016SGiridhar Malavali ha->ddr_mn_window = -1; 2346a9083016SGiridhar Malavali ha->curr_window = 255; 2347a9083016SGiridhar Malavali ha->portnum = PCI_FUNC(ha->pdev->devfn); 2348a9083016SGiridhar Malavali nx_legacy_intr = &legacy_intr[ha->portnum]; 2349a9083016SGiridhar Malavali ha->nx_legacy_intr.int_vec_bit = nx_legacy_intr->int_vec_bit; 2350a9083016SGiridhar Malavali ha->nx_legacy_intr.tgt_status_reg = nx_legacy_intr->tgt_status_reg; 2351a9083016SGiridhar Malavali ha->nx_legacy_intr.tgt_mask_reg = nx_legacy_intr->tgt_mask_reg; 2352a9083016SGiridhar Malavali ha->nx_legacy_intr.pci_int_reg = nx_legacy_intr->pci_int_reg; 2353a9083016SGiridhar Malavali } 2354a9083016SGiridhar Malavali 2355a9083016SGiridhar Malavali static inline void 2356a9083016SGiridhar Malavali qla82xx_set_drv_active(scsi_qla_host_t *vha) 2357a9083016SGiridhar Malavali { 2358a9083016SGiridhar Malavali uint32_t drv_active; 2359a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 2360a9083016SGiridhar Malavali 2361a9083016SGiridhar Malavali drv_active = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_ACTIVE); 2362a9083016SGiridhar Malavali 2363a9083016SGiridhar Malavali /* If reset value is all FF's, initialize DRV_ACTIVE */ 2364a9083016SGiridhar Malavali if (drv_active == 0xffffffff) { 2365a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_ACTIVE, 0); 2366a9083016SGiridhar Malavali drv_active = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_ACTIVE); 2367a9083016SGiridhar Malavali } 2368a9083016SGiridhar Malavali drv_active |= (1 << (ha->portnum * 4)); 2369a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_ACTIVE, drv_active); 2370a9083016SGiridhar Malavali } 2371a9083016SGiridhar Malavali 2372a9083016SGiridhar Malavali inline void 2373a9083016SGiridhar Malavali qla82xx_clear_drv_active(struct qla_hw_data *ha) 2374a9083016SGiridhar Malavali { 2375a9083016SGiridhar Malavali uint32_t drv_active; 2376a9083016SGiridhar Malavali 2377a9083016SGiridhar Malavali drv_active = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_ACTIVE); 2378a9083016SGiridhar Malavali drv_active &= ~(1 << (ha->portnum * 4)); 2379a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_ACTIVE, drv_active); 2380a9083016SGiridhar Malavali } 2381a9083016SGiridhar Malavali 2382a9083016SGiridhar Malavali static inline int 2383a9083016SGiridhar Malavali qla82xx_need_reset(struct qla_hw_data *ha) 2384a9083016SGiridhar Malavali { 2385a9083016SGiridhar Malavali uint32_t drv_state; 2386a9083016SGiridhar Malavali int rval; 2387a9083016SGiridhar Malavali 2388a9083016SGiridhar Malavali drv_state = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_STATE); 2389a9083016SGiridhar Malavali rval = drv_state & (1 << (ha->portnum * 4)); 2390a9083016SGiridhar Malavali return rval; 2391a9083016SGiridhar Malavali } 2392a9083016SGiridhar Malavali 2393a9083016SGiridhar Malavali static inline void 2394a9083016SGiridhar Malavali qla82xx_set_rst_ready(struct qla_hw_data *ha) 2395a9083016SGiridhar Malavali { 2396a9083016SGiridhar Malavali uint32_t drv_state; 2397a9083016SGiridhar Malavali scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev); 2398a9083016SGiridhar Malavali 2399a9083016SGiridhar Malavali drv_state = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_STATE); 2400a9083016SGiridhar Malavali 2401a9083016SGiridhar Malavali /* If reset value is all FF's, initialize DRV_STATE */ 2402a9083016SGiridhar Malavali if (drv_state == 0xffffffff) { 2403a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_STATE, 0); 2404a9083016SGiridhar Malavali drv_state = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_STATE); 2405a9083016SGiridhar Malavali } 2406a9083016SGiridhar Malavali drv_state |= (QLA82XX_DRVST_RST_RDY << (ha->portnum * 4)); 2407a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 2408a9083016SGiridhar Malavali "%s(%ld):drv_state = 0x%x\n", 2409a9083016SGiridhar Malavali __func__, vha->host_no, drv_state); 2410a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_STATE, drv_state); 2411a9083016SGiridhar Malavali } 2412a9083016SGiridhar Malavali 2413a9083016SGiridhar Malavali static inline void 2414a9083016SGiridhar Malavali qla82xx_clear_rst_ready(struct qla_hw_data *ha) 2415a9083016SGiridhar Malavali { 2416a9083016SGiridhar Malavali uint32_t drv_state; 2417a9083016SGiridhar Malavali 2418a9083016SGiridhar Malavali drv_state = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_STATE); 2419a9083016SGiridhar Malavali drv_state &= ~(QLA82XX_DRVST_RST_RDY << (ha->portnum * 4)); 2420a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_STATE, drv_state); 2421a9083016SGiridhar Malavali } 2422a9083016SGiridhar Malavali 2423a9083016SGiridhar Malavali static inline void 2424a9083016SGiridhar Malavali qla82xx_set_qsnt_ready(struct qla_hw_data *ha) 2425a9083016SGiridhar Malavali { 2426a9083016SGiridhar Malavali uint32_t qsnt_state; 2427a9083016SGiridhar Malavali 2428a9083016SGiridhar Malavali qsnt_state = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_STATE); 2429a9083016SGiridhar Malavali qsnt_state |= (QLA82XX_DRVST_QSNT_RDY << (ha->portnum * 4)); 2430a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_STATE, qsnt_state); 2431a9083016SGiridhar Malavali } 2432a9083016SGiridhar Malavali 2433a9083016SGiridhar Malavali int qla82xx_load_fw(scsi_qla_host_t *vha) 2434a9083016SGiridhar Malavali { 2435a9083016SGiridhar Malavali int rst; 2436a9083016SGiridhar Malavali struct fw_blob *blob; 2437a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 2438a9083016SGiridhar Malavali 2439a9083016SGiridhar Malavali /* Put both the PEG CMD and RCV PEG to default state 2440a9083016SGiridhar Malavali * of 0 before resetting the hardware 2441a9083016SGiridhar Malavali */ 2442a9083016SGiridhar Malavali qla82xx_wr_32(ha, CRB_CMDPEG_STATE, 0); 2443a9083016SGiridhar Malavali qla82xx_wr_32(ha, CRB_RCVPEG_STATE, 0); 2444a9083016SGiridhar Malavali 2445a9083016SGiridhar Malavali if (qla82xx_pinit_from_rom(vha) != QLA_SUCCESS) { 2446a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 2447a9083016SGiridhar Malavali "%s: Error during CRB Initialization\n", __func__); 2448a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 2449a9083016SGiridhar Malavali } 2450a9083016SGiridhar Malavali udelay(500); 2451a9083016SGiridhar Malavali 2452a9083016SGiridhar Malavali /* Bring QM and CAMRAM out of reset */ 2453a9083016SGiridhar Malavali rst = qla82xx_rd_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET); 2454a9083016SGiridhar Malavali rst &= ~((1 << 28) | (1 << 24)); 2455a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_GLB_SW_RESET, rst); 2456a9083016SGiridhar Malavali 2457a9083016SGiridhar Malavali /* 2458a9083016SGiridhar Malavali * FW Load priority: 2459a9083016SGiridhar Malavali * 1) Operational firmware residing in flash. 2460a9083016SGiridhar Malavali * 2) Firmware via request-firmware interface (.bin file). 2461a9083016SGiridhar Malavali */ 2462a9083016SGiridhar Malavali if (ql2xfwloadbin == 2) 2463a9083016SGiridhar Malavali goto try_blob_fw; 2464a9083016SGiridhar Malavali 2465a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 2466a9083016SGiridhar Malavali "Attempting to load firmware from flash\n"); 2467a9083016SGiridhar Malavali 2468a9083016SGiridhar Malavali if (qla82xx_fw_load_from_flash(ha) == QLA_SUCCESS) { 2469a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 2470a9083016SGiridhar Malavali "Firmware loaded successfully from flash\n"); 2471a9083016SGiridhar Malavali return QLA_SUCCESS; 2472a9083016SGiridhar Malavali } 2473a9083016SGiridhar Malavali try_blob_fw: 2474a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 2475a9083016SGiridhar Malavali "Attempting to load firmware from blob\n"); 2476a9083016SGiridhar Malavali 2477a9083016SGiridhar Malavali /* Load firmware blob. */ 2478a9083016SGiridhar Malavali blob = ha->hablob = qla2x00_request_firmware(vha); 2479a9083016SGiridhar Malavali if (!blob) { 2480a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 2481a9083016SGiridhar Malavali "Firmware image not present.\n"); 2482a9083016SGiridhar Malavali goto fw_load_failed; 2483a9083016SGiridhar Malavali } 2484a9083016SGiridhar Malavali 2485a9083016SGiridhar Malavali if (qla82xx_fw_load_from_blob(ha) == QLA_SUCCESS) { 2486a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 2487a9083016SGiridhar Malavali "%s: Firmware loaded successfully " 2488a9083016SGiridhar Malavali " from binary blob\n", __func__); 2489a9083016SGiridhar Malavali return QLA_SUCCESS; 2490a9083016SGiridhar Malavali } else { 2491a9083016SGiridhar Malavali qla_printk(KERN_ERR, ha, 2492a9083016SGiridhar Malavali "Firmware load failed from binary blob\n"); 2493a9083016SGiridhar Malavali blob->fw = NULL; 2494a9083016SGiridhar Malavali blob = NULL; 2495a9083016SGiridhar Malavali goto fw_load_failed; 2496a9083016SGiridhar Malavali } 2497a9083016SGiridhar Malavali return QLA_SUCCESS; 2498a9083016SGiridhar Malavali 2499a9083016SGiridhar Malavali fw_load_failed: 2500a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 2501a9083016SGiridhar Malavali } 2502a9083016SGiridhar Malavali 2503a9083016SGiridhar Malavali static int 2504a9083016SGiridhar Malavali qla82xx_start_firmware(scsi_qla_host_t *vha) 2505a9083016SGiridhar Malavali { 2506a9083016SGiridhar Malavali int pcie_cap; 2507a9083016SGiridhar Malavali uint16_t lnk; 2508a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 2509a9083016SGiridhar Malavali 2510a9083016SGiridhar Malavali /* scrub dma mask expansion register */ 2511a9083016SGiridhar Malavali qla82xx_wr_32(ha, CRB_DMA_SHIFT, 0x55555555); 2512a9083016SGiridhar Malavali 2513a9083016SGiridhar Malavali /* Overwrite stale initialization register values */ 2514a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_PEG_HALT_STATUS1, 0); 2515a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_PEG_HALT_STATUS2, 0); 2516a9083016SGiridhar Malavali 2517a9083016SGiridhar Malavali if (qla82xx_load_fw(vha) != QLA_SUCCESS) { 2518a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 2519a9083016SGiridhar Malavali "%s: Error trying to start fw!\n", __func__); 2520a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 2521a9083016SGiridhar Malavali } 2522a9083016SGiridhar Malavali 2523a9083016SGiridhar Malavali /* Handshake with the card before we register the devices. */ 2524a9083016SGiridhar Malavali if (qla82xx_check_cmdpeg_state(ha) != QLA_SUCCESS) { 2525a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 2526a9083016SGiridhar Malavali "%s: Error during card handshake!\n", __func__); 2527a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 2528a9083016SGiridhar Malavali } 2529a9083016SGiridhar Malavali 2530a9083016SGiridhar Malavali /* Negotiated Link width */ 2531a9083016SGiridhar Malavali pcie_cap = pci_find_capability(ha->pdev, PCI_CAP_ID_EXP); 2532a9083016SGiridhar Malavali pci_read_config_word(ha->pdev, pcie_cap + PCI_EXP_LNKSTA, &lnk); 2533a9083016SGiridhar Malavali ha->link_width = (lnk >> 4) & 0x3f; 2534a9083016SGiridhar Malavali 2535a9083016SGiridhar Malavali /* Synchronize with Receive peg */ 2536a9083016SGiridhar Malavali return qla82xx_check_rcvpeg_state(ha); 2537a9083016SGiridhar Malavali } 2538a9083016SGiridhar Malavali 2539a9083016SGiridhar Malavali static inline int 2540a9083016SGiridhar Malavali qla2xx_build_scsi_type_6_iocbs(srb_t *sp, struct cmd_type_6 *cmd_pkt, 2541a9083016SGiridhar Malavali uint16_t tot_dsds) 2542a9083016SGiridhar Malavali { 2543a9083016SGiridhar Malavali uint32_t *cur_dsd = NULL; 2544a9083016SGiridhar Malavali scsi_qla_host_t *vha; 2545a9083016SGiridhar Malavali struct qla_hw_data *ha; 2546a9083016SGiridhar Malavali struct scsi_cmnd *cmd; 2547a9083016SGiridhar Malavali struct scatterlist *cur_seg; 2548a9083016SGiridhar Malavali uint32_t *dsd_seg; 2549a9083016SGiridhar Malavali void *next_dsd; 2550a9083016SGiridhar Malavali uint8_t avail_dsds; 2551a9083016SGiridhar Malavali uint8_t first_iocb = 1; 2552a9083016SGiridhar Malavali uint32_t dsd_list_len; 2553a9083016SGiridhar Malavali struct dsd_dma *dsd_ptr; 2554a9083016SGiridhar Malavali struct ct6_dsd *ctx; 2555a9083016SGiridhar Malavali 2556a9083016SGiridhar Malavali cmd = sp->cmd; 2557a9083016SGiridhar Malavali 2558a9083016SGiridhar Malavali /* Update entry type to indicate Command Type 3 IOCB */ 2559a9083016SGiridhar Malavali *((uint32_t *)(&cmd_pkt->entry_type)) = 2560a9083016SGiridhar Malavali __constant_cpu_to_le32(COMMAND_TYPE_6); 2561a9083016SGiridhar Malavali 2562a9083016SGiridhar Malavali /* No data transfer */ 2563a9083016SGiridhar Malavali if (!scsi_bufflen(cmd) || cmd->sc_data_direction == DMA_NONE) { 2564a9083016SGiridhar Malavali cmd_pkt->byte_count = __constant_cpu_to_le32(0); 2565a9083016SGiridhar Malavali return 0; 2566a9083016SGiridhar Malavali } 2567a9083016SGiridhar Malavali 2568a9083016SGiridhar Malavali vha = sp->fcport->vha; 2569a9083016SGiridhar Malavali ha = vha->hw; 2570a9083016SGiridhar Malavali 2571a9083016SGiridhar Malavali /* Set transfer direction */ 2572a9083016SGiridhar Malavali if (cmd->sc_data_direction == DMA_TO_DEVICE) { 2573a9083016SGiridhar Malavali cmd_pkt->control_flags = 2574a9083016SGiridhar Malavali __constant_cpu_to_le16(CF_WRITE_DATA); 2575a9083016SGiridhar Malavali ha->qla_stats.output_bytes += scsi_bufflen(cmd); 2576a9083016SGiridhar Malavali } else if (cmd->sc_data_direction == DMA_FROM_DEVICE) { 2577a9083016SGiridhar Malavali cmd_pkt->control_flags = 2578a9083016SGiridhar Malavali __constant_cpu_to_le16(CF_READ_DATA); 2579a9083016SGiridhar Malavali ha->qla_stats.input_bytes += scsi_bufflen(cmd); 2580a9083016SGiridhar Malavali } 2581a9083016SGiridhar Malavali 2582a9083016SGiridhar Malavali cur_seg = scsi_sglist(cmd); 2583a9083016SGiridhar Malavali ctx = sp->ctx; 2584a9083016SGiridhar Malavali 2585a9083016SGiridhar Malavali while (tot_dsds) { 2586a9083016SGiridhar Malavali avail_dsds = (tot_dsds > QLA_DSDS_PER_IOCB) ? 2587a9083016SGiridhar Malavali QLA_DSDS_PER_IOCB : tot_dsds; 2588a9083016SGiridhar Malavali tot_dsds -= avail_dsds; 2589a9083016SGiridhar Malavali dsd_list_len = (avail_dsds + 1) * QLA_DSD_SIZE; 2590a9083016SGiridhar Malavali 2591a9083016SGiridhar Malavali dsd_ptr = list_first_entry(&ha->gbl_dsd_list, 2592a9083016SGiridhar Malavali struct dsd_dma, list); 2593a9083016SGiridhar Malavali next_dsd = dsd_ptr->dsd_addr; 2594a9083016SGiridhar Malavali list_del(&dsd_ptr->list); 2595a9083016SGiridhar Malavali ha->gbl_dsd_avail--; 2596a9083016SGiridhar Malavali list_add_tail(&dsd_ptr->list, &ctx->dsd_list); 2597a9083016SGiridhar Malavali ctx->dsd_use_cnt++; 2598a9083016SGiridhar Malavali ha->gbl_dsd_inuse++; 2599a9083016SGiridhar Malavali 2600a9083016SGiridhar Malavali if (first_iocb) { 2601a9083016SGiridhar Malavali first_iocb = 0; 2602a9083016SGiridhar Malavali dsd_seg = (uint32_t *)&cmd_pkt->fcp_data_dseg_address; 2603a9083016SGiridhar Malavali *dsd_seg++ = cpu_to_le32(LSD(dsd_ptr->dsd_list_dma)); 2604a9083016SGiridhar Malavali *dsd_seg++ = cpu_to_le32(MSD(dsd_ptr->dsd_list_dma)); 2605a9083016SGiridhar Malavali *dsd_seg++ = dsd_list_len; 2606a9083016SGiridhar Malavali } else { 2607a9083016SGiridhar Malavali *cur_dsd++ = cpu_to_le32(LSD(dsd_ptr->dsd_list_dma)); 2608a9083016SGiridhar Malavali *cur_dsd++ = cpu_to_le32(MSD(dsd_ptr->dsd_list_dma)); 2609a9083016SGiridhar Malavali *cur_dsd++ = dsd_list_len; 2610a9083016SGiridhar Malavali } 2611a9083016SGiridhar Malavali cur_dsd = (uint32_t *)next_dsd; 2612a9083016SGiridhar Malavali while (avail_dsds) { 2613a9083016SGiridhar Malavali dma_addr_t sle_dma; 2614a9083016SGiridhar Malavali 2615a9083016SGiridhar Malavali sle_dma = sg_dma_address(cur_seg); 2616a9083016SGiridhar Malavali *cur_dsd++ = cpu_to_le32(LSD(sle_dma)); 2617a9083016SGiridhar Malavali *cur_dsd++ = cpu_to_le32(MSD(sle_dma)); 2618a9083016SGiridhar Malavali *cur_dsd++ = cpu_to_le32(sg_dma_len(cur_seg)); 2619a9083016SGiridhar Malavali cur_seg++; 2620a9083016SGiridhar Malavali avail_dsds--; 2621a9083016SGiridhar Malavali } 2622a9083016SGiridhar Malavali } 2623a9083016SGiridhar Malavali 2624a9083016SGiridhar Malavali /* Null termination */ 2625a9083016SGiridhar Malavali *cur_dsd++ = 0; 2626a9083016SGiridhar Malavali *cur_dsd++ = 0; 2627a9083016SGiridhar Malavali *cur_dsd++ = 0; 2628a9083016SGiridhar Malavali cmd_pkt->control_flags |= CF_DATA_SEG_DESCR_ENABLE; 2629a9083016SGiridhar Malavali return 0; 2630a9083016SGiridhar Malavali } 2631a9083016SGiridhar Malavali 2632a9083016SGiridhar Malavali /* 2633a9083016SGiridhar Malavali * qla82xx_calc_dsd_lists() - Determine number of DSD list required 2634a9083016SGiridhar Malavali * for Command Type 6. 2635a9083016SGiridhar Malavali * 2636a9083016SGiridhar Malavali * @dsds: number of data segment decriptors needed 2637a9083016SGiridhar Malavali * 2638a9083016SGiridhar Malavali * Returns the number of dsd list needed to store @dsds. 2639a9083016SGiridhar Malavali */ 2640a9083016SGiridhar Malavali inline uint16_t 2641a9083016SGiridhar Malavali qla82xx_calc_dsd_lists(uint16_t dsds) 2642a9083016SGiridhar Malavali { 2643a9083016SGiridhar Malavali uint16_t dsd_lists = 0; 2644a9083016SGiridhar Malavali 2645a9083016SGiridhar Malavali dsd_lists = (dsds/QLA_DSDS_PER_IOCB); 2646a9083016SGiridhar Malavali if (dsds % QLA_DSDS_PER_IOCB) 2647a9083016SGiridhar Malavali dsd_lists++; 2648a9083016SGiridhar Malavali return dsd_lists; 2649a9083016SGiridhar Malavali } 2650a9083016SGiridhar Malavali 2651a9083016SGiridhar Malavali /* 2652a9083016SGiridhar Malavali * qla82xx_start_scsi() - Send a SCSI command to the ISP 2653a9083016SGiridhar Malavali * @sp: command to send to the ISP 2654a9083016SGiridhar Malavali * 2655a9083016SGiridhar Malavali * Returns non-zero if a failure occured, else zero. 2656a9083016SGiridhar Malavali */ 2657a9083016SGiridhar Malavali int 2658a9083016SGiridhar Malavali qla82xx_start_scsi(srb_t *sp) 2659a9083016SGiridhar Malavali { 2660a9083016SGiridhar Malavali int ret, nseg; 2661a9083016SGiridhar Malavali unsigned long flags; 2662a9083016SGiridhar Malavali struct scsi_cmnd *cmd; 2663a9083016SGiridhar Malavali uint32_t *clr_ptr; 2664a9083016SGiridhar Malavali uint32_t index; 2665a9083016SGiridhar Malavali uint32_t handle; 2666a9083016SGiridhar Malavali uint16_t cnt; 2667a9083016SGiridhar Malavali uint16_t req_cnt; 2668a9083016SGiridhar Malavali uint16_t tot_dsds; 2669a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg; 2670a9083016SGiridhar Malavali uint32_t dbval; 2671a9083016SGiridhar Malavali uint32_t *fcp_dl; 2672a9083016SGiridhar Malavali uint8_t additional_cdb_len; 2673a9083016SGiridhar Malavali struct ct6_dsd *ctx; 2674a9083016SGiridhar Malavali struct scsi_qla_host *vha = sp->fcport->vha; 2675a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 2676a9083016SGiridhar Malavali struct req_que *req = NULL; 2677a9083016SGiridhar Malavali struct rsp_que *rsp = NULL; 2678a9083016SGiridhar Malavali 2679a9083016SGiridhar Malavali /* Setup device pointers. */ 2680a9083016SGiridhar Malavali ret = 0; 2681a9083016SGiridhar Malavali reg = &ha->iobase->isp82; 2682a9083016SGiridhar Malavali cmd = sp->cmd; 2683a9083016SGiridhar Malavali req = vha->req; 2684a9083016SGiridhar Malavali rsp = ha->rsp_q_map[0]; 2685a9083016SGiridhar Malavali 2686a9083016SGiridhar Malavali /* So we know we haven't pci_map'ed anything yet */ 2687a9083016SGiridhar Malavali tot_dsds = 0; 2688a9083016SGiridhar Malavali 2689a9083016SGiridhar Malavali dbval = 0x04 | (ha->portnum << 5); 2690a9083016SGiridhar Malavali 2691a9083016SGiridhar Malavali /* Send marker if required */ 2692a9083016SGiridhar Malavali if (vha->marker_needed != 0) { 2693a9083016SGiridhar Malavali if (qla2x00_marker(vha, req, 2694a9083016SGiridhar Malavali rsp, 0, 0, MK_SYNC_ALL) != QLA_SUCCESS) 2695a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 2696a9083016SGiridhar Malavali vha->marker_needed = 0; 2697a9083016SGiridhar Malavali } 2698a9083016SGiridhar Malavali 2699a9083016SGiridhar Malavali /* Acquire ring specific lock */ 2700a9083016SGiridhar Malavali spin_lock_irqsave(&ha->hardware_lock, flags); 2701a9083016SGiridhar Malavali 2702a9083016SGiridhar Malavali /* Check for room in outstanding command list. */ 2703a9083016SGiridhar Malavali handle = req->current_outstanding_cmd; 2704a9083016SGiridhar Malavali for (index = 1; index < MAX_OUTSTANDING_COMMANDS; index++) { 2705a9083016SGiridhar Malavali handle++; 2706a9083016SGiridhar Malavali if (handle == MAX_OUTSTANDING_COMMANDS) 2707a9083016SGiridhar Malavali handle = 1; 2708a9083016SGiridhar Malavali if (!req->outstanding_cmds[handle]) 2709a9083016SGiridhar Malavali break; 2710a9083016SGiridhar Malavali } 2711a9083016SGiridhar Malavali if (index == MAX_OUTSTANDING_COMMANDS) 2712a9083016SGiridhar Malavali goto queuing_error; 2713a9083016SGiridhar Malavali 2714a9083016SGiridhar Malavali /* Map the sg table so we have an accurate count of sg entries needed */ 2715a9083016SGiridhar Malavali if (scsi_sg_count(cmd)) { 2716a9083016SGiridhar Malavali nseg = dma_map_sg(&ha->pdev->dev, scsi_sglist(cmd), 2717a9083016SGiridhar Malavali scsi_sg_count(cmd), cmd->sc_data_direction); 2718a9083016SGiridhar Malavali if (unlikely(!nseg)) 2719a9083016SGiridhar Malavali goto queuing_error; 2720a9083016SGiridhar Malavali } else 2721a9083016SGiridhar Malavali nseg = 0; 2722a9083016SGiridhar Malavali 2723a9083016SGiridhar Malavali tot_dsds = nseg; 2724a9083016SGiridhar Malavali 2725a9083016SGiridhar Malavali if (tot_dsds > ql2xshiftctondsd) { 2726a9083016SGiridhar Malavali struct cmd_type_6 *cmd_pkt; 2727a9083016SGiridhar Malavali uint16_t more_dsd_lists = 0; 2728a9083016SGiridhar Malavali struct dsd_dma *dsd_ptr; 2729a9083016SGiridhar Malavali uint16_t i; 2730a9083016SGiridhar Malavali 2731a9083016SGiridhar Malavali more_dsd_lists = qla82xx_calc_dsd_lists(tot_dsds); 2732a9083016SGiridhar Malavali if ((more_dsd_lists + ha->gbl_dsd_inuse) >= NUM_DSD_CHAIN) 2733a9083016SGiridhar Malavali goto queuing_error; 2734a9083016SGiridhar Malavali 2735a9083016SGiridhar Malavali if (more_dsd_lists <= ha->gbl_dsd_avail) 2736a9083016SGiridhar Malavali goto sufficient_dsds; 2737a9083016SGiridhar Malavali else 2738a9083016SGiridhar Malavali more_dsd_lists -= ha->gbl_dsd_avail; 2739a9083016SGiridhar Malavali 2740a9083016SGiridhar Malavali for (i = 0; i < more_dsd_lists; i++) { 2741a9083016SGiridhar Malavali dsd_ptr = kzalloc(sizeof(struct dsd_dma), GFP_ATOMIC); 2742a9083016SGiridhar Malavali if (!dsd_ptr) 2743a9083016SGiridhar Malavali goto queuing_error; 2744a9083016SGiridhar Malavali 2745a9083016SGiridhar Malavali dsd_ptr->dsd_addr = dma_pool_alloc(ha->dl_dma_pool, 2746a9083016SGiridhar Malavali GFP_ATOMIC, &dsd_ptr->dsd_list_dma); 2747a9083016SGiridhar Malavali if (!dsd_ptr->dsd_addr) { 2748a9083016SGiridhar Malavali kfree(dsd_ptr); 2749a9083016SGiridhar Malavali goto queuing_error; 2750a9083016SGiridhar Malavali } 2751a9083016SGiridhar Malavali list_add_tail(&dsd_ptr->list, &ha->gbl_dsd_list); 2752a9083016SGiridhar Malavali ha->gbl_dsd_avail++; 2753a9083016SGiridhar Malavali } 2754a9083016SGiridhar Malavali 2755a9083016SGiridhar Malavali sufficient_dsds: 2756a9083016SGiridhar Malavali req_cnt = 1; 2757a9083016SGiridhar Malavali 2758a9083016SGiridhar Malavali ctx = sp->ctx = mempool_alloc(ha->ctx_mempool, GFP_ATOMIC); 2759a9083016SGiridhar Malavali if (!sp->ctx) { 2760a9083016SGiridhar Malavali DEBUG(printk(KERN_INFO 2761a9083016SGiridhar Malavali "%s(%ld): failed to allocate" 2762a9083016SGiridhar Malavali " ctx.\n", __func__, vha->host_no)); 2763a9083016SGiridhar Malavali goto queuing_error; 2764a9083016SGiridhar Malavali } 2765a9083016SGiridhar Malavali memset(ctx, 0, sizeof(struct ct6_dsd)); 2766a9083016SGiridhar Malavali ctx->fcp_cmnd = dma_pool_alloc(ha->fcp_cmnd_dma_pool, 2767a9083016SGiridhar Malavali GFP_ATOMIC, &ctx->fcp_cmnd_dma); 2768a9083016SGiridhar Malavali if (!ctx->fcp_cmnd) { 2769a9083016SGiridhar Malavali DEBUG2_3(printk("%s(%ld): failed to allocate" 2770a9083016SGiridhar Malavali " fcp_cmnd.\n", __func__, vha->host_no)); 2771a9083016SGiridhar Malavali goto queuing_error_fcp_cmnd; 2772a9083016SGiridhar Malavali } 2773a9083016SGiridhar Malavali 2774a9083016SGiridhar Malavali /* Initialize the DSD list and dma handle */ 2775a9083016SGiridhar Malavali INIT_LIST_HEAD(&ctx->dsd_list); 2776a9083016SGiridhar Malavali ctx->dsd_use_cnt = 0; 2777a9083016SGiridhar Malavali 2778a9083016SGiridhar Malavali if (cmd->cmd_len > 16) { 2779a9083016SGiridhar Malavali additional_cdb_len = cmd->cmd_len - 16; 2780a9083016SGiridhar Malavali if ((cmd->cmd_len % 4) != 0) { 2781a9083016SGiridhar Malavali /* SCSI command bigger than 16 bytes must be 2782a9083016SGiridhar Malavali * multiple of 4 2783a9083016SGiridhar Malavali */ 2784a9083016SGiridhar Malavali goto queuing_error_fcp_cmnd; 2785a9083016SGiridhar Malavali } 2786a9083016SGiridhar Malavali ctx->fcp_cmnd_len = 12 + cmd->cmd_len + 4; 2787a9083016SGiridhar Malavali } else { 2788a9083016SGiridhar Malavali additional_cdb_len = 0; 2789a9083016SGiridhar Malavali ctx->fcp_cmnd_len = 12 + 16 + 4; 2790a9083016SGiridhar Malavali } 2791a9083016SGiridhar Malavali 2792a9083016SGiridhar Malavali cmd_pkt = (struct cmd_type_6 *)req->ring_ptr; 2793a9083016SGiridhar Malavali cmd_pkt->handle = MAKE_HANDLE(req->id, handle); 2794a9083016SGiridhar Malavali 2795a9083016SGiridhar Malavali /* Zero out remaining portion of packet. */ 2796a9083016SGiridhar Malavali /* tagged queuing modifier -- default is TSK_SIMPLE (0). */ 2797a9083016SGiridhar Malavali clr_ptr = (uint32_t *)cmd_pkt + 2; 2798a9083016SGiridhar Malavali memset(clr_ptr, 0, REQUEST_ENTRY_SIZE - 8); 2799a9083016SGiridhar Malavali cmd_pkt->dseg_count = cpu_to_le16(tot_dsds); 2800a9083016SGiridhar Malavali 2801a9083016SGiridhar Malavali /* Set NPORT-ID and LUN number*/ 2802a9083016SGiridhar Malavali cmd_pkt->nport_handle = cpu_to_le16(sp->fcport->loop_id); 2803a9083016SGiridhar Malavali cmd_pkt->port_id[0] = sp->fcport->d_id.b.al_pa; 2804a9083016SGiridhar Malavali cmd_pkt->port_id[1] = sp->fcport->d_id.b.area; 2805a9083016SGiridhar Malavali cmd_pkt->port_id[2] = sp->fcport->d_id.b.domain; 2806a9083016SGiridhar Malavali cmd_pkt->vp_index = sp->fcport->vp_idx; 2807a9083016SGiridhar Malavali 2808a9083016SGiridhar Malavali /* Build IOCB segments */ 2809a9083016SGiridhar Malavali if (qla2xx_build_scsi_type_6_iocbs(sp, cmd_pkt, tot_dsds)) 2810a9083016SGiridhar Malavali goto queuing_error_fcp_cmnd; 2811a9083016SGiridhar Malavali 2812a9083016SGiridhar Malavali int_to_scsilun(sp->cmd->device->lun, &cmd_pkt->lun); 2813a9083016SGiridhar Malavali 2814a9083016SGiridhar Malavali /* build FCP_CMND IU */ 2815a9083016SGiridhar Malavali memset(ctx->fcp_cmnd, 0, sizeof(struct fcp_cmnd)); 2816a9083016SGiridhar Malavali int_to_scsilun(sp->cmd->device->lun, &ctx->fcp_cmnd->lun); 2817a9083016SGiridhar Malavali ctx->fcp_cmnd->additional_cdb_len = additional_cdb_len; 2818a9083016SGiridhar Malavali 2819a9083016SGiridhar Malavali if (cmd->sc_data_direction == DMA_TO_DEVICE) 2820a9083016SGiridhar Malavali ctx->fcp_cmnd->additional_cdb_len |= 1; 2821a9083016SGiridhar Malavali else if (cmd->sc_data_direction == DMA_FROM_DEVICE) 2822a9083016SGiridhar Malavali ctx->fcp_cmnd->additional_cdb_len |= 2; 2823a9083016SGiridhar Malavali 2824a9083016SGiridhar Malavali memcpy(ctx->fcp_cmnd->cdb, cmd->cmnd, cmd->cmd_len); 2825a9083016SGiridhar Malavali 2826a9083016SGiridhar Malavali fcp_dl = (uint32_t *)(ctx->fcp_cmnd->cdb + 16 + 2827a9083016SGiridhar Malavali additional_cdb_len); 2828a9083016SGiridhar Malavali *fcp_dl = htonl((uint32_t)scsi_bufflen(cmd)); 2829a9083016SGiridhar Malavali 2830a9083016SGiridhar Malavali cmd_pkt->fcp_cmnd_dseg_len = cpu_to_le16(ctx->fcp_cmnd_len); 2831a9083016SGiridhar Malavali cmd_pkt->fcp_cmnd_dseg_address[0] = 2832a9083016SGiridhar Malavali cpu_to_le32(LSD(ctx->fcp_cmnd_dma)); 2833a9083016SGiridhar Malavali cmd_pkt->fcp_cmnd_dseg_address[1] = 2834a9083016SGiridhar Malavali cpu_to_le32(MSD(ctx->fcp_cmnd_dma)); 2835a9083016SGiridhar Malavali 2836a9083016SGiridhar Malavali sp->flags |= SRB_FCP_CMND_DMA_VALID; 2837a9083016SGiridhar Malavali cmd_pkt->byte_count = cpu_to_le32((uint32_t)scsi_bufflen(cmd)); 2838a9083016SGiridhar Malavali /* Set total data segment count. */ 2839a9083016SGiridhar Malavali cmd_pkt->entry_count = (uint8_t)req_cnt; 2840a9083016SGiridhar Malavali /* Specify response queue number where 2841a9083016SGiridhar Malavali * completion should happen 2842a9083016SGiridhar Malavali */ 2843a9083016SGiridhar Malavali cmd_pkt->entry_status = (uint8_t) rsp->id; 2844a9083016SGiridhar Malavali } else { 2845a9083016SGiridhar Malavali struct cmd_type_7 *cmd_pkt; 2846a9083016SGiridhar Malavali req_cnt = qla24xx_calc_iocbs(tot_dsds); 2847a9083016SGiridhar Malavali if (req->cnt < (req_cnt + 2)) { 2848a9083016SGiridhar Malavali cnt = (uint16_t)RD_REG_DWORD_RELAXED( 2849a9083016SGiridhar Malavali ®->req_q_out[0]); 2850a9083016SGiridhar Malavali if (req->ring_index < cnt) 2851a9083016SGiridhar Malavali req->cnt = cnt - req->ring_index; 2852a9083016SGiridhar Malavali else 2853a9083016SGiridhar Malavali req->cnt = req->length - 2854a9083016SGiridhar Malavali (req->ring_index - cnt); 2855a9083016SGiridhar Malavali } 2856a9083016SGiridhar Malavali if (req->cnt < (req_cnt + 2)) 2857a9083016SGiridhar Malavali goto queuing_error; 2858a9083016SGiridhar Malavali 2859a9083016SGiridhar Malavali cmd_pkt = (struct cmd_type_7 *)req->ring_ptr; 2860a9083016SGiridhar Malavali cmd_pkt->handle = MAKE_HANDLE(req->id, handle); 2861a9083016SGiridhar Malavali 2862a9083016SGiridhar Malavali /* Zero out remaining portion of packet. */ 2863a9083016SGiridhar Malavali /* tagged queuing modifier -- default is TSK_SIMPLE (0).*/ 2864a9083016SGiridhar Malavali clr_ptr = (uint32_t *)cmd_pkt + 2; 2865a9083016SGiridhar Malavali memset(clr_ptr, 0, REQUEST_ENTRY_SIZE - 8); 2866a9083016SGiridhar Malavali cmd_pkt->dseg_count = cpu_to_le16(tot_dsds); 2867a9083016SGiridhar Malavali 2868a9083016SGiridhar Malavali /* Set NPORT-ID and LUN number*/ 2869a9083016SGiridhar Malavali cmd_pkt->nport_handle = cpu_to_le16(sp->fcport->loop_id); 2870a9083016SGiridhar Malavali cmd_pkt->port_id[0] = sp->fcport->d_id.b.al_pa; 2871a9083016SGiridhar Malavali cmd_pkt->port_id[1] = sp->fcport->d_id.b.area; 2872a9083016SGiridhar Malavali cmd_pkt->port_id[2] = sp->fcport->d_id.b.domain; 2873a9083016SGiridhar Malavali cmd_pkt->vp_index = sp->fcport->vp_idx; 2874a9083016SGiridhar Malavali 2875a9083016SGiridhar Malavali int_to_scsilun(sp->cmd->device->lun, &cmd_pkt->lun); 2876a9083016SGiridhar Malavali host_to_fcp_swap((uint8_t *)&cmd_pkt->lun, 2877a9083016SGiridhar Malavali sizeof(cmd_pkt->lun)); 2878a9083016SGiridhar Malavali 2879a9083016SGiridhar Malavali /* Load SCSI command packet. */ 2880a9083016SGiridhar Malavali memcpy(cmd_pkt->fcp_cdb, cmd->cmnd, cmd->cmd_len); 2881a9083016SGiridhar Malavali host_to_fcp_swap(cmd_pkt->fcp_cdb, sizeof(cmd_pkt->fcp_cdb)); 2882a9083016SGiridhar Malavali 2883a9083016SGiridhar Malavali cmd_pkt->byte_count = cpu_to_le32((uint32_t)scsi_bufflen(cmd)); 2884a9083016SGiridhar Malavali 2885a9083016SGiridhar Malavali /* Build IOCB segments */ 2886a9083016SGiridhar Malavali qla24xx_build_scsi_iocbs(sp, cmd_pkt, tot_dsds); 2887a9083016SGiridhar Malavali 2888a9083016SGiridhar Malavali /* Set total data segment count. */ 2889a9083016SGiridhar Malavali cmd_pkt->entry_count = (uint8_t)req_cnt; 2890a9083016SGiridhar Malavali /* Specify response queue number where 2891a9083016SGiridhar Malavali * completion should happen. 2892a9083016SGiridhar Malavali */ 2893a9083016SGiridhar Malavali cmd_pkt->entry_status = (uint8_t) rsp->id; 2894a9083016SGiridhar Malavali 2895a9083016SGiridhar Malavali } 2896a9083016SGiridhar Malavali /* Build command packet. */ 2897a9083016SGiridhar Malavali req->current_outstanding_cmd = handle; 2898a9083016SGiridhar Malavali req->outstanding_cmds[handle] = sp; 2899a9083016SGiridhar Malavali sp->handle = handle; 2900a9083016SGiridhar Malavali sp->cmd->host_scribble = (unsigned char *)(unsigned long)handle; 2901a9083016SGiridhar Malavali req->cnt -= req_cnt; 2902a9083016SGiridhar Malavali wmb(); 2903a9083016SGiridhar Malavali 2904a9083016SGiridhar Malavali /* Adjust ring index. */ 2905a9083016SGiridhar Malavali req->ring_index++; 2906a9083016SGiridhar Malavali if (req->ring_index == req->length) { 2907a9083016SGiridhar Malavali req->ring_index = 0; 2908a9083016SGiridhar Malavali req->ring_ptr = req->ring; 2909a9083016SGiridhar Malavali } else 2910a9083016SGiridhar Malavali req->ring_ptr++; 2911a9083016SGiridhar Malavali 2912a9083016SGiridhar Malavali sp->flags |= SRB_DMA_VALID; 2913a9083016SGiridhar Malavali 2914a9083016SGiridhar Malavali /* Set chip new ring index. */ 2915a9083016SGiridhar Malavali /* write, read and verify logic */ 2916a9083016SGiridhar Malavali dbval = dbval | (req->id << 8) | (req->ring_index << 16); 2917a9083016SGiridhar Malavali if (ql2xdbwr) 2918a9083016SGiridhar Malavali qla82xx_wr_32(ha, ha->nxdb_wr_ptr, dbval); 2919a9083016SGiridhar Malavali else { 2920a9083016SGiridhar Malavali WRT_REG_DWORD( 2921a9083016SGiridhar Malavali (unsigned long __iomem *)ha->nxdb_wr_ptr, 2922a9083016SGiridhar Malavali dbval); 2923a9083016SGiridhar Malavali wmb(); 2924a9083016SGiridhar Malavali while (RD_REG_DWORD(ha->nxdb_rd_ptr) != dbval) { 2925a9083016SGiridhar Malavali WRT_REG_DWORD( 2926a9083016SGiridhar Malavali (unsigned long __iomem *)ha->nxdb_wr_ptr, 2927a9083016SGiridhar Malavali dbval); 2928a9083016SGiridhar Malavali wmb(); 2929a9083016SGiridhar Malavali } 2930a9083016SGiridhar Malavali } 2931a9083016SGiridhar Malavali 2932a9083016SGiridhar Malavali /* Manage unprocessed RIO/ZIO commands in response queue. */ 2933a9083016SGiridhar Malavali if (vha->flags.process_response_queue && 2934a9083016SGiridhar Malavali rsp->ring_ptr->signature != RESPONSE_PROCESSED) 2935a9083016SGiridhar Malavali qla24xx_process_response_queue(vha, rsp); 2936a9083016SGiridhar Malavali 2937a9083016SGiridhar Malavali spin_unlock_irqrestore(&ha->hardware_lock, flags); 2938a9083016SGiridhar Malavali return QLA_SUCCESS; 2939a9083016SGiridhar Malavali 2940a9083016SGiridhar Malavali queuing_error_fcp_cmnd: 2941a9083016SGiridhar Malavali dma_pool_free(ha->fcp_cmnd_dma_pool, ctx->fcp_cmnd, ctx->fcp_cmnd_dma); 2942a9083016SGiridhar Malavali queuing_error: 2943a9083016SGiridhar Malavali if (tot_dsds) 2944a9083016SGiridhar Malavali scsi_dma_unmap(cmd); 2945a9083016SGiridhar Malavali 2946a9083016SGiridhar Malavali if (sp->ctx) { 2947a9083016SGiridhar Malavali mempool_free(sp->ctx, ha->ctx_mempool); 2948a9083016SGiridhar Malavali sp->ctx = NULL; 2949a9083016SGiridhar Malavali } 2950a9083016SGiridhar Malavali spin_unlock_irqrestore(&ha->hardware_lock, flags); 2951a9083016SGiridhar Malavali 2952a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 2953a9083016SGiridhar Malavali } 2954a9083016SGiridhar Malavali 2955a9083016SGiridhar Malavali uint32_t * 2956a9083016SGiridhar Malavali qla82xx_read_flash_data(scsi_qla_host_t *vha, uint32_t *dwptr, uint32_t faddr, 2957a9083016SGiridhar Malavali uint32_t length) 2958a9083016SGiridhar Malavali { 2959a9083016SGiridhar Malavali uint32_t i; 2960a9083016SGiridhar Malavali uint32_t val; 2961a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 2962a9083016SGiridhar Malavali 2963a9083016SGiridhar Malavali /* Dword reads to flash. */ 2964a9083016SGiridhar Malavali for (i = 0; i < length/4; i++, faddr += 4) { 2965a9083016SGiridhar Malavali if (qla82xx_rom_fast_read(ha, faddr, &val)) { 2966a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 2967a9083016SGiridhar Malavali "Do ROM fast read failed\n"); 2968a9083016SGiridhar Malavali goto done_read; 2969a9083016SGiridhar Malavali } 2970a9083016SGiridhar Malavali dwptr[i] = __constant_cpu_to_le32(val); 2971a9083016SGiridhar Malavali } 2972a9083016SGiridhar Malavali done_read: 2973a9083016SGiridhar Malavali return dwptr; 2974a9083016SGiridhar Malavali } 2975a9083016SGiridhar Malavali 2976a9083016SGiridhar Malavali int 2977a9083016SGiridhar Malavali qla82xx_unprotect_flash(struct qla_hw_data *ha) 2978a9083016SGiridhar Malavali { 2979a9083016SGiridhar Malavali int ret; 2980a9083016SGiridhar Malavali uint32_t val; 2981a9083016SGiridhar Malavali 2982a9083016SGiridhar Malavali ret = ql82xx_rom_lock_d(ha); 2983a9083016SGiridhar Malavali if (ret < 0) { 2984a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "ROM Lock failed\n"); 2985a9083016SGiridhar Malavali return ret; 2986a9083016SGiridhar Malavali } 2987a9083016SGiridhar Malavali 2988a9083016SGiridhar Malavali ret = qla82xx_read_status_reg(ha, &val); 2989a9083016SGiridhar Malavali if (ret < 0) 2990a9083016SGiridhar Malavali goto done_unprotect; 2991a9083016SGiridhar Malavali 2992a9083016SGiridhar Malavali val &= ~(0x7 << 2); 2993a9083016SGiridhar Malavali ret = qla82xx_write_status_reg(ha, val); 2994a9083016SGiridhar Malavali if (ret < 0) { 2995a9083016SGiridhar Malavali val |= (0x7 << 2); 2996a9083016SGiridhar Malavali qla82xx_write_status_reg(ha, val); 2997a9083016SGiridhar Malavali } 2998a9083016SGiridhar Malavali 2999a9083016SGiridhar Malavali if (qla82xx_write_disable_flash(ha) != 0) 3000a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "Write disable failed\n"); 3001a9083016SGiridhar Malavali 3002a9083016SGiridhar Malavali done_unprotect: 3003a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM2_UNLOCK)); 3004a9083016SGiridhar Malavali return ret; 3005a9083016SGiridhar Malavali } 3006a9083016SGiridhar Malavali 3007a9083016SGiridhar Malavali int 3008a9083016SGiridhar Malavali qla82xx_protect_flash(struct qla_hw_data *ha) 3009a9083016SGiridhar Malavali { 3010a9083016SGiridhar Malavali int ret; 3011a9083016SGiridhar Malavali uint32_t val; 3012a9083016SGiridhar Malavali 3013a9083016SGiridhar Malavali ret = ql82xx_rom_lock_d(ha); 3014a9083016SGiridhar Malavali if (ret < 0) { 3015a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "ROM Lock failed\n"); 3016a9083016SGiridhar Malavali return ret; 3017a9083016SGiridhar Malavali } 3018a9083016SGiridhar Malavali 3019a9083016SGiridhar Malavali ret = qla82xx_read_status_reg(ha, &val); 3020a9083016SGiridhar Malavali if (ret < 0) 3021a9083016SGiridhar Malavali goto done_protect; 3022a9083016SGiridhar Malavali 3023a9083016SGiridhar Malavali val |= (0x7 << 2); 3024a9083016SGiridhar Malavali /* LOCK all sectors */ 3025a9083016SGiridhar Malavali ret = qla82xx_write_status_reg(ha, val); 3026a9083016SGiridhar Malavali if (ret < 0) 3027a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "Write status register failed\n"); 3028a9083016SGiridhar Malavali 3029a9083016SGiridhar Malavali if (qla82xx_write_disable_flash(ha) != 0) 3030a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "Write disable failed\n"); 3031a9083016SGiridhar Malavali done_protect: 3032a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM2_UNLOCK)); 3033a9083016SGiridhar Malavali return ret; 3034a9083016SGiridhar Malavali } 3035a9083016SGiridhar Malavali 3036a9083016SGiridhar Malavali int 3037a9083016SGiridhar Malavali qla82xx_erase_sector(struct qla_hw_data *ha, int addr) 3038a9083016SGiridhar Malavali { 3039a9083016SGiridhar Malavali int ret = 0; 3040a9083016SGiridhar Malavali 3041a9083016SGiridhar Malavali ret = ql82xx_rom_lock_d(ha); 3042a9083016SGiridhar Malavali if (ret < 0) { 3043a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, "ROM Lock failed\n"); 3044a9083016SGiridhar Malavali return ret; 3045a9083016SGiridhar Malavali } 3046a9083016SGiridhar Malavali 3047a9083016SGiridhar Malavali qla82xx_flash_set_write_enable(ha); 3048a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ADDRESS, addr); 3049a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_ABYTE_CNT, 3); 3050a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_ROMUSB_ROM_INSTR_OPCODE, M25P_INSTR_SE); 3051a9083016SGiridhar Malavali 3052a9083016SGiridhar Malavali if (qla82xx_wait_rom_done(ha)) { 3053a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 3054a9083016SGiridhar Malavali "Error waiting for rom done\n"); 3055a9083016SGiridhar Malavali ret = -1; 3056a9083016SGiridhar Malavali goto done; 3057a9083016SGiridhar Malavali } 3058a9083016SGiridhar Malavali ret = qla82xx_flash_wait_write_finish(ha); 3059a9083016SGiridhar Malavali done: 3060a9083016SGiridhar Malavali qla82xx_rd_32(ha, QLA82XX_PCIE_REG(PCIE_SEM2_UNLOCK)); 3061a9083016SGiridhar Malavali return ret; 3062a9083016SGiridhar Malavali } 3063a9083016SGiridhar Malavali 3064a9083016SGiridhar Malavali /* 3065a9083016SGiridhar Malavali * Address and length are byte address 3066a9083016SGiridhar Malavali */ 3067a9083016SGiridhar Malavali uint8_t * 3068a9083016SGiridhar Malavali qla82xx_read_optrom_data(struct scsi_qla_host *vha, uint8_t *buf, 3069a9083016SGiridhar Malavali uint32_t offset, uint32_t length) 3070a9083016SGiridhar Malavali { 3071a9083016SGiridhar Malavali scsi_block_requests(vha->host); 3072a9083016SGiridhar Malavali qla82xx_read_flash_data(vha, (uint32_t *)buf, offset, length); 3073a9083016SGiridhar Malavali scsi_unblock_requests(vha->host); 3074a9083016SGiridhar Malavali return buf; 3075a9083016SGiridhar Malavali } 3076a9083016SGiridhar Malavali 3077a9083016SGiridhar Malavali static int 3078a9083016SGiridhar Malavali qla82xx_write_flash_data(struct scsi_qla_host *vha, uint32_t *dwptr, 3079a9083016SGiridhar Malavali uint32_t faddr, uint32_t dwords) 3080a9083016SGiridhar Malavali { 3081a9083016SGiridhar Malavali int ret; 3082a9083016SGiridhar Malavali uint32_t liter; 3083a9083016SGiridhar Malavali uint32_t sec_mask, rest_addr; 3084a9083016SGiridhar Malavali dma_addr_t optrom_dma; 3085a9083016SGiridhar Malavali void *optrom = NULL; 3086a9083016SGiridhar Malavali int page_mode = 0; 3087a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3088a9083016SGiridhar Malavali 3089a9083016SGiridhar Malavali ret = -1; 3090a9083016SGiridhar Malavali 3091a9083016SGiridhar Malavali /* Prepare burst-capable write on supported ISPs. */ 3092a9083016SGiridhar Malavali if (page_mode && !(faddr & 0xfff) && 3093a9083016SGiridhar Malavali dwords > OPTROM_BURST_DWORDS) { 3094a9083016SGiridhar Malavali optrom = dma_alloc_coherent(&ha->pdev->dev, OPTROM_BURST_SIZE, 3095a9083016SGiridhar Malavali &optrom_dma, GFP_KERNEL); 3096a9083016SGiridhar Malavali if (!optrom) { 3097a9083016SGiridhar Malavali qla_printk(KERN_DEBUG, ha, 3098a9083016SGiridhar Malavali "Unable to allocate memory for optrom " 3099a9083016SGiridhar Malavali "burst write (%x KB).\n", 3100a9083016SGiridhar Malavali OPTROM_BURST_SIZE / 1024); 3101a9083016SGiridhar Malavali } 3102a9083016SGiridhar Malavali } 3103a9083016SGiridhar Malavali 3104a9083016SGiridhar Malavali rest_addr = ha->fdt_block_size - 1; 3105a9083016SGiridhar Malavali sec_mask = ~rest_addr; 3106a9083016SGiridhar Malavali 3107a9083016SGiridhar Malavali ret = qla82xx_unprotect_flash(ha); 3108a9083016SGiridhar Malavali if (ret) { 3109a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 3110a9083016SGiridhar Malavali "Unable to unprotect flash for update.\n"); 3111a9083016SGiridhar Malavali goto write_done; 3112a9083016SGiridhar Malavali } 3113a9083016SGiridhar Malavali 3114a9083016SGiridhar Malavali for (liter = 0; liter < dwords; liter++, faddr += 4, dwptr++) { 3115a9083016SGiridhar Malavali /* Are we at the beginning of a sector? */ 3116a9083016SGiridhar Malavali if ((faddr & rest_addr) == 0) { 3117a9083016SGiridhar Malavali 3118a9083016SGiridhar Malavali ret = qla82xx_erase_sector(ha, faddr); 3119a9083016SGiridhar Malavali if (ret) { 3120a9083016SGiridhar Malavali DEBUG9(qla_printk(KERN_ERR, ha, 3121a9083016SGiridhar Malavali "Unable to erase sector: " 3122a9083016SGiridhar Malavali "address=%x.\n", faddr)); 3123a9083016SGiridhar Malavali break; 3124a9083016SGiridhar Malavali } 3125a9083016SGiridhar Malavali } 3126a9083016SGiridhar Malavali 3127a9083016SGiridhar Malavali /* Go with burst-write. */ 3128a9083016SGiridhar Malavali if (optrom && (liter + OPTROM_BURST_DWORDS) <= dwords) { 3129a9083016SGiridhar Malavali /* Copy data to DMA'ble buffer. */ 3130a9083016SGiridhar Malavali memcpy(optrom, dwptr, OPTROM_BURST_SIZE); 3131a9083016SGiridhar Malavali 3132a9083016SGiridhar Malavali ret = qla2x00_load_ram(vha, optrom_dma, 3133a9083016SGiridhar Malavali (ha->flash_data_off | faddr), 3134a9083016SGiridhar Malavali OPTROM_BURST_DWORDS); 3135a9083016SGiridhar Malavali if (ret != QLA_SUCCESS) { 3136a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 3137a9083016SGiridhar Malavali "Unable to burst-write optrom segment " 3138a9083016SGiridhar Malavali "(%x/%x/%llx).\n", ret, 3139a9083016SGiridhar Malavali (ha->flash_data_off | faddr), 3140a9083016SGiridhar Malavali (unsigned long long)optrom_dma); 3141a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 3142a9083016SGiridhar Malavali "Reverting to slow-write.\n"); 3143a9083016SGiridhar Malavali 3144a9083016SGiridhar Malavali dma_free_coherent(&ha->pdev->dev, 3145a9083016SGiridhar Malavali OPTROM_BURST_SIZE, optrom, optrom_dma); 3146a9083016SGiridhar Malavali optrom = NULL; 3147a9083016SGiridhar Malavali } else { 3148a9083016SGiridhar Malavali liter += OPTROM_BURST_DWORDS - 1; 3149a9083016SGiridhar Malavali faddr += OPTROM_BURST_DWORDS - 1; 3150a9083016SGiridhar Malavali dwptr += OPTROM_BURST_DWORDS - 1; 3151a9083016SGiridhar Malavali continue; 3152a9083016SGiridhar Malavali } 3153a9083016SGiridhar Malavali } 3154a9083016SGiridhar Malavali 3155a9083016SGiridhar Malavali ret = qla82xx_write_flash_dword(ha, faddr, 3156a9083016SGiridhar Malavali cpu_to_le32(*dwptr)); 3157a9083016SGiridhar Malavali if (ret) { 3158a9083016SGiridhar Malavali DEBUG9(printk(KERN_DEBUG "%s(%ld) Unable to program" 3159a9083016SGiridhar Malavali "flash address=%x data=%x.\n", __func__, 3160a9083016SGiridhar Malavali ha->host_no, faddr, *dwptr)); 3161a9083016SGiridhar Malavali break; 3162a9083016SGiridhar Malavali } 3163a9083016SGiridhar Malavali } 3164a9083016SGiridhar Malavali 3165a9083016SGiridhar Malavali ret = qla82xx_protect_flash(ha); 3166a9083016SGiridhar Malavali if (ret) 3167a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 3168a9083016SGiridhar Malavali "Unable to protect flash after update.\n"); 3169a9083016SGiridhar Malavali write_done: 3170a9083016SGiridhar Malavali if (optrom) 3171a9083016SGiridhar Malavali dma_free_coherent(&ha->pdev->dev, 3172a9083016SGiridhar Malavali OPTROM_BURST_SIZE, optrom, optrom_dma); 3173a9083016SGiridhar Malavali return ret; 3174a9083016SGiridhar Malavali } 3175a9083016SGiridhar Malavali 3176a9083016SGiridhar Malavali int 3177a9083016SGiridhar Malavali qla82xx_write_optrom_data(struct scsi_qla_host *vha, uint8_t *buf, 3178a9083016SGiridhar Malavali uint32_t offset, uint32_t length) 3179a9083016SGiridhar Malavali { 3180a9083016SGiridhar Malavali int rval; 3181a9083016SGiridhar Malavali 3182a9083016SGiridhar Malavali /* Suspend HBA. */ 3183a9083016SGiridhar Malavali scsi_block_requests(vha->host); 3184a9083016SGiridhar Malavali rval = qla82xx_write_flash_data(vha, (uint32_t *)buf, offset, 3185a9083016SGiridhar Malavali length >> 2); 3186a9083016SGiridhar Malavali scsi_unblock_requests(vha->host); 3187a9083016SGiridhar Malavali 3188a9083016SGiridhar Malavali /* Convert return ISP82xx to generic */ 3189a9083016SGiridhar Malavali if (rval) 3190a9083016SGiridhar Malavali rval = QLA_FUNCTION_FAILED; 3191a9083016SGiridhar Malavali else 3192a9083016SGiridhar Malavali rval = QLA_SUCCESS; 3193a9083016SGiridhar Malavali return rval; 3194a9083016SGiridhar Malavali } 3195a9083016SGiridhar Malavali 3196a9083016SGiridhar Malavali void 3197a9083016SGiridhar Malavali qla82xx_start_iocbs(srb_t *sp) 3198a9083016SGiridhar Malavali { 3199a9083016SGiridhar Malavali struct qla_hw_data *ha = sp->fcport->vha->hw; 3200a9083016SGiridhar Malavali struct req_que *req = ha->req_q_map[0]; 3201a9083016SGiridhar Malavali struct device_reg_82xx __iomem *reg; 3202a9083016SGiridhar Malavali uint32_t dbval; 3203a9083016SGiridhar Malavali 3204a9083016SGiridhar Malavali /* Adjust ring index. */ 3205a9083016SGiridhar Malavali req->ring_index++; 3206a9083016SGiridhar Malavali if (req->ring_index == req->length) { 3207a9083016SGiridhar Malavali req->ring_index = 0; 3208a9083016SGiridhar Malavali req->ring_ptr = req->ring; 3209a9083016SGiridhar Malavali } else 3210a9083016SGiridhar Malavali req->ring_ptr++; 3211a9083016SGiridhar Malavali 3212a9083016SGiridhar Malavali reg = &ha->iobase->isp82; 3213a9083016SGiridhar Malavali dbval = 0x04 | (ha->portnum << 5); 3214a9083016SGiridhar Malavali 3215a9083016SGiridhar Malavali dbval = dbval | (req->id << 8) | (req->ring_index << 16); 3216a9083016SGiridhar Malavali WRT_REG_DWORD((unsigned long __iomem *)ha->nxdb_wr_ptr, dbval); 3217a9083016SGiridhar Malavali wmb(); 3218a9083016SGiridhar Malavali while (RD_REG_DWORD(ha->nxdb_rd_ptr) != dbval) { 3219a9083016SGiridhar Malavali WRT_REG_DWORD((unsigned long __iomem *)ha->nxdb_wr_ptr, dbval); 3220a9083016SGiridhar Malavali wmb(); 3221a9083016SGiridhar Malavali } 3222a9083016SGiridhar Malavali } 3223a9083016SGiridhar Malavali 3224a9083016SGiridhar Malavali /* 3225a9083016SGiridhar Malavali * qla82xx_device_bootstrap 3226a9083016SGiridhar Malavali * Initialize device, set DEV_READY, start fw 3227a9083016SGiridhar Malavali * 3228a9083016SGiridhar Malavali * Note: 3229a9083016SGiridhar Malavali * IDC lock must be held upon entry 3230a9083016SGiridhar Malavali * 3231a9083016SGiridhar Malavali * Return: 3232a9083016SGiridhar Malavali * Success : 0 3233a9083016SGiridhar Malavali * Failed : 1 3234a9083016SGiridhar Malavali */ 3235a9083016SGiridhar Malavali static int 3236a9083016SGiridhar Malavali qla82xx_device_bootstrap(scsi_qla_host_t *vha) 3237a9083016SGiridhar Malavali { 3238a9083016SGiridhar Malavali int rval, i, timeout; 3239a9083016SGiridhar Malavali uint32_t old_count, count; 3240a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3241a9083016SGiridhar Malavali 3242a9083016SGiridhar Malavali if (qla82xx_need_reset(ha)) 3243a9083016SGiridhar Malavali goto dev_initialize; 3244a9083016SGiridhar Malavali 3245a9083016SGiridhar Malavali old_count = qla82xx_rd_32(ha, QLA82XX_PEG_ALIVE_COUNTER); 3246a9083016SGiridhar Malavali 3247a9083016SGiridhar Malavali for (i = 0; i < 10; i++) { 3248a9083016SGiridhar Malavali timeout = msleep_interruptible(200); 3249a9083016SGiridhar Malavali if (timeout) { 3250a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DEV_STATE, 3251a9083016SGiridhar Malavali QLA82XX_DEV_FAILED); 3252a9083016SGiridhar Malavali return QLA_FUNCTION_FAILED; 3253a9083016SGiridhar Malavali } 3254a9083016SGiridhar Malavali 3255a9083016SGiridhar Malavali count = qla82xx_rd_32(ha, QLA82XX_PEG_ALIVE_COUNTER); 3256a9083016SGiridhar Malavali if (count != old_count) 3257a9083016SGiridhar Malavali goto dev_ready; 3258a9083016SGiridhar Malavali } 3259a9083016SGiridhar Malavali 3260a9083016SGiridhar Malavali dev_initialize: 3261a9083016SGiridhar Malavali /* set to DEV_INITIALIZING */ 3262a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "HW State: INITIALIZING\n"); 3263a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DEV_STATE, QLA82XX_DEV_INITIALIZING); 3264a9083016SGiridhar Malavali 3265a9083016SGiridhar Malavali /* Driver that sets device state to initializating sets IDC version */ 3266a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DRV_IDC_VERSION, QLA82XX_IDC_VERSION); 3267a9083016SGiridhar Malavali 3268a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3269a9083016SGiridhar Malavali rval = qla82xx_start_firmware(vha); 3270a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3271a9083016SGiridhar Malavali 3272a9083016SGiridhar Malavali if (rval != QLA_SUCCESS) { 3273a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "HW State: FAILED\n"); 3274a9083016SGiridhar Malavali qla82xx_clear_drv_active(ha); 3275a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DEV_STATE, QLA82XX_DEV_FAILED); 3276a9083016SGiridhar Malavali return rval; 3277a9083016SGiridhar Malavali } 3278a9083016SGiridhar Malavali 3279a9083016SGiridhar Malavali dev_ready: 3280a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "HW State: READY\n"); 3281a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DEV_STATE, QLA82XX_DEV_READY); 3282a9083016SGiridhar Malavali 3283a9083016SGiridhar Malavali return QLA_SUCCESS; 3284a9083016SGiridhar Malavali } 3285a9083016SGiridhar Malavali 3286a9083016SGiridhar Malavali static void 3287a9083016SGiridhar Malavali qla82xx_dev_failed_handler(scsi_qla_host_t *vha) 3288a9083016SGiridhar Malavali { 3289a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3290a9083016SGiridhar Malavali 3291a9083016SGiridhar Malavali /* Disable the board */ 3292a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "Disabling the board\n"); 3293a9083016SGiridhar Malavali 3294a9083016SGiridhar Malavali /* Set DEV_FAILED flag to disable timer */ 3295a9083016SGiridhar Malavali vha->device_flags |= DFLG_DEV_FAILED; 3296a9083016SGiridhar Malavali qla2x00_abort_all_cmds(vha, DID_NO_CONNECT << 16); 3297a9083016SGiridhar Malavali qla2x00_mark_all_devices_lost(vha, 0); 3298a9083016SGiridhar Malavali vha->flags.online = 0; 3299a9083016SGiridhar Malavali vha->flags.init_done = 0; 3300a9083016SGiridhar Malavali } 3301a9083016SGiridhar Malavali 3302a9083016SGiridhar Malavali /* 3303a9083016SGiridhar Malavali * qla82xx_need_reset_handler 3304a9083016SGiridhar Malavali * Code to start reset sequence 3305a9083016SGiridhar Malavali * 3306a9083016SGiridhar Malavali * Note: 3307a9083016SGiridhar Malavali * IDC lock must be held upon entry 3308a9083016SGiridhar Malavali * 3309a9083016SGiridhar Malavali * Return: 3310a9083016SGiridhar Malavali * Success : 0 3311a9083016SGiridhar Malavali * Failed : 1 3312a9083016SGiridhar Malavali */ 3313a9083016SGiridhar Malavali static void 3314a9083016SGiridhar Malavali qla82xx_need_reset_handler(scsi_qla_host_t *vha) 3315a9083016SGiridhar Malavali { 3316a9083016SGiridhar Malavali uint32_t dev_state, drv_state, drv_active; 3317a9083016SGiridhar Malavali unsigned long reset_timeout; 3318a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3319a9083016SGiridhar Malavali struct req_que *req = ha->req_q_map[0]; 3320a9083016SGiridhar Malavali 3321a9083016SGiridhar Malavali if (vha->flags.online) { 3322a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3323a9083016SGiridhar Malavali qla2x00_abort_isp_cleanup(vha); 3324a9083016SGiridhar Malavali ha->isp_ops->get_flash_version(vha, req->ring); 3325a9083016SGiridhar Malavali ha->isp_ops->nvram_config(vha); 3326a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3327a9083016SGiridhar Malavali } 3328a9083016SGiridhar Malavali 3329a9083016SGiridhar Malavali qla82xx_set_rst_ready(ha); 3330a9083016SGiridhar Malavali 3331a9083016SGiridhar Malavali /* wait for 10 seconds for reset ack from all functions */ 3332a9083016SGiridhar Malavali reset_timeout = jiffies + (ha->nx_reset_timeout * HZ); 3333a9083016SGiridhar Malavali 3334a9083016SGiridhar Malavali drv_state = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_STATE); 3335a9083016SGiridhar Malavali drv_active = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_ACTIVE); 3336a9083016SGiridhar Malavali 3337a9083016SGiridhar Malavali while (drv_state != drv_active) { 3338a9083016SGiridhar Malavali if (time_after_eq(jiffies, reset_timeout)) { 3339a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 3340a9083016SGiridhar Malavali "%s: RESET TIMEOUT!\n", QLA2XXX_DRIVER_NAME); 3341a9083016SGiridhar Malavali break; 3342a9083016SGiridhar Malavali } 3343a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3344a9083016SGiridhar Malavali msleep(1000); 3345a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3346a9083016SGiridhar Malavali drv_state = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_STATE); 3347a9083016SGiridhar Malavali drv_active = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_ACTIVE); 3348a9083016SGiridhar Malavali } 3349a9083016SGiridhar Malavali 3350a9083016SGiridhar Malavali dev_state = qla82xx_rd_32(ha, QLA82XX_CRB_DEV_STATE); 3351a9083016SGiridhar Malavali /* Force to DEV_COLD unless someone else is starting a reset */ 3352a9083016SGiridhar Malavali if (dev_state != QLA82XX_DEV_INITIALIZING) { 3353a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "HW State: COLD/RE-INIT\n"); 3354a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DEV_STATE, QLA82XX_DEV_COLD); 3355a9083016SGiridhar Malavali } 3356a9083016SGiridhar Malavali } 3357a9083016SGiridhar Malavali 3358a9083016SGiridhar Malavali static void 3359a9083016SGiridhar Malavali qla82xx_check_fw_alive(scsi_qla_host_t *vha) 3360a9083016SGiridhar Malavali { 3361a9083016SGiridhar Malavali uint32_t fw_heartbeat_counter, halt_status; 3362a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3363a9083016SGiridhar Malavali 3364a9083016SGiridhar Malavali fw_heartbeat_counter = qla82xx_rd_32(ha, QLA82XX_PEG_ALIVE_COUNTER); 3365a9083016SGiridhar Malavali if (vha->fw_heartbeat_counter == fw_heartbeat_counter) { 3366a9083016SGiridhar Malavali vha->seconds_since_last_heartbeat++; 3367a9083016SGiridhar Malavali /* FW not alive after 2 seconds */ 3368a9083016SGiridhar Malavali if (vha->seconds_since_last_heartbeat == 2) { 3369a9083016SGiridhar Malavali vha->seconds_since_last_heartbeat = 0; 3370a9083016SGiridhar Malavali halt_status = qla82xx_rd_32(ha, 3371a9083016SGiridhar Malavali QLA82XX_PEG_HALT_STATUS1); 3372a9083016SGiridhar Malavali if (halt_status & HALT_STATUS_UNRECOVERABLE) { 3373a9083016SGiridhar Malavali set_bit(ISP_UNRECOVERABLE, &vha->dpc_flags); 3374a9083016SGiridhar Malavali } else { 3375a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 3376a9083016SGiridhar Malavali "scsi(%ld): %s - detect abort needed\n", 3377a9083016SGiridhar Malavali vha->host_no, __func__); 3378a9083016SGiridhar Malavali set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags); 3379a9083016SGiridhar Malavali } 3380a9083016SGiridhar Malavali qla2xxx_wake_dpc(vha); 3381a9083016SGiridhar Malavali } 3382a9083016SGiridhar Malavali } 3383a9083016SGiridhar Malavali vha->fw_heartbeat_counter = fw_heartbeat_counter; 3384a9083016SGiridhar Malavali } 3385a9083016SGiridhar Malavali 3386a9083016SGiridhar Malavali /* 3387a9083016SGiridhar Malavali * qla82xx_device_state_handler 3388a9083016SGiridhar Malavali * Main state handler 3389a9083016SGiridhar Malavali * 3390a9083016SGiridhar Malavali * Note: 3391a9083016SGiridhar Malavali * IDC lock must be held upon entry 3392a9083016SGiridhar Malavali * 3393a9083016SGiridhar Malavali * Return: 3394a9083016SGiridhar Malavali * Success : 0 3395a9083016SGiridhar Malavali * Failed : 1 3396a9083016SGiridhar Malavali */ 3397a9083016SGiridhar Malavali int 3398a9083016SGiridhar Malavali qla82xx_device_state_handler(scsi_qla_host_t *vha) 3399a9083016SGiridhar Malavali { 3400a9083016SGiridhar Malavali uint32_t dev_state; 3401a9083016SGiridhar Malavali uint32_t drv_active; 3402a9083016SGiridhar Malavali int rval = QLA_SUCCESS; 3403a9083016SGiridhar Malavali unsigned long dev_init_timeout; 3404a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3405a9083016SGiridhar Malavali 3406a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3407a9083016SGiridhar Malavali if (!vha->flags.init_done) 3408a9083016SGiridhar Malavali qla82xx_set_drv_active(vha); 3409a9083016SGiridhar Malavali 3410a9083016SGiridhar Malavali /* Set cold state*/ 3411a9083016SGiridhar Malavali if (!PCI_FUNC(ha->pdev->devfn & 1)) { 3412a9083016SGiridhar Malavali 3413a9083016SGiridhar Malavali /* Check if other functions alive, else set dev state 3414a9083016SGiridhar Malavali * to cold 3415a9083016SGiridhar Malavali */ 3416a9083016SGiridhar Malavali drv_active = qla82xx_rd_32(ha, QLA82XX_CRB_DRV_ACTIVE); 3417a9083016SGiridhar Malavali drv_active &= ~(1 << (ha->portnum * 4)); 3418a9083016SGiridhar Malavali drv_active &= ~(1 << ((ha->portnum + 1) * 4)); 3419a9083016SGiridhar Malavali 3420a9083016SGiridhar Malavali dev_state = qla82xx_rd_32(ha, QLA82XX_CRB_DEV_STATE); 3421a9083016SGiridhar Malavali if (!drv_active) { 3422a9083016SGiridhar Malavali 3423a9083016SGiridhar Malavali switch (dev_state) { 3424a9083016SGiridhar Malavali case QLA82XX_DEV_COLD: 3425a9083016SGiridhar Malavali case QLA82XX_DEV_READY: 3426a9083016SGiridhar Malavali case QLA82XX_DEV_INITIALIZING: 3427a9083016SGiridhar Malavali case QLA82XX_DEV_NEED_RESET: 3428a9083016SGiridhar Malavali case QLA82XX_DEV_NEED_QUIESCENT: 3429a9083016SGiridhar Malavali case QLA82XX_DEV_QUIESCENT: 3430a9083016SGiridhar Malavali case QLA82XX_DEV_FAILED: 3431a9083016SGiridhar Malavali break; 3432a9083016SGiridhar Malavali default: 3433a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, 3434a9083016SGiridhar Malavali "No other function exist," 3435a9083016SGiridhar Malavali " resetting dev state to COLD\n"); 3436a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DEV_STATE, 3437a9083016SGiridhar Malavali QLA82XX_DEV_COLD); 3438a9083016SGiridhar Malavali break; 3439a9083016SGiridhar Malavali } 3440a9083016SGiridhar Malavali } 3441a9083016SGiridhar Malavali } 3442a9083016SGiridhar Malavali 3443a9083016SGiridhar Malavali /* wait for 30 seconds for device to go ready */ 3444a9083016SGiridhar Malavali dev_init_timeout = jiffies + (ha->nx_dev_init_timeout * HZ); 3445a9083016SGiridhar Malavali 3446a9083016SGiridhar Malavali while (1) { 3447a9083016SGiridhar Malavali 3448a9083016SGiridhar Malavali if (time_after_eq(jiffies, dev_init_timeout)) { 3449a9083016SGiridhar Malavali DEBUG(qla_printk(KERN_INFO, ha, 3450a9083016SGiridhar Malavali "%s: device init failed!\n", 3451a9083016SGiridhar Malavali QLA2XXX_DRIVER_NAME)); 3452a9083016SGiridhar Malavali rval = QLA_FUNCTION_FAILED; 3453a9083016SGiridhar Malavali break; 3454a9083016SGiridhar Malavali } 3455a9083016SGiridhar Malavali dev_state = qla82xx_rd_32(ha, QLA82XX_CRB_DEV_STATE); 3456a9083016SGiridhar Malavali switch (dev_state) { 3457a9083016SGiridhar Malavali case QLA82XX_DEV_READY: 3458a9083016SGiridhar Malavali goto exit; 3459a9083016SGiridhar Malavali case QLA82XX_DEV_COLD: 3460a9083016SGiridhar Malavali rval = qla82xx_device_bootstrap(vha); 3461a9083016SGiridhar Malavali goto exit; 3462a9083016SGiridhar Malavali case QLA82XX_DEV_INITIALIZING: 3463a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3464a9083016SGiridhar Malavali msleep(1000); 3465a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3466a9083016SGiridhar Malavali break; 3467a9083016SGiridhar Malavali case QLA82XX_DEV_NEED_RESET: 3468a9083016SGiridhar Malavali if (!ql2xdontresethba) 3469a9083016SGiridhar Malavali qla82xx_need_reset_handler(vha); 3470a9083016SGiridhar Malavali break; 3471a9083016SGiridhar Malavali case QLA82XX_DEV_NEED_QUIESCENT: 3472a9083016SGiridhar Malavali qla82xx_set_qsnt_ready(ha); 3473a9083016SGiridhar Malavali case QLA82XX_DEV_QUIESCENT: 3474a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3475a9083016SGiridhar Malavali msleep(1000); 3476a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3477a9083016SGiridhar Malavali break; 3478a9083016SGiridhar Malavali case QLA82XX_DEV_FAILED: 3479a9083016SGiridhar Malavali qla82xx_dev_failed_handler(vha); 3480a9083016SGiridhar Malavali rval = QLA_FUNCTION_FAILED; 3481a9083016SGiridhar Malavali goto exit; 3482a9083016SGiridhar Malavali default: 3483a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3484a9083016SGiridhar Malavali msleep(1000); 3485a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3486a9083016SGiridhar Malavali } 3487a9083016SGiridhar Malavali } 3488a9083016SGiridhar Malavali exit: 3489a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3490a9083016SGiridhar Malavali return rval; 3491a9083016SGiridhar Malavali } 3492a9083016SGiridhar Malavali 3493a9083016SGiridhar Malavali void qla82xx_watchdog(scsi_qla_host_t *vha) 3494a9083016SGiridhar Malavali { 3495a9083016SGiridhar Malavali uint32_t dev_state; 3496a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3497a9083016SGiridhar Malavali 3498a9083016SGiridhar Malavali dev_state = qla82xx_rd_32(ha, QLA82XX_CRB_DEV_STATE); 3499a9083016SGiridhar Malavali 3500a9083016SGiridhar Malavali /* don't poll if reset is going on */ 3501a9083016SGiridhar Malavali if (!(test_bit(ISP_ABORT_NEEDED, &vha->dpc_flags) || 3502a9083016SGiridhar Malavali test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags) || 3503a9083016SGiridhar Malavali test_bit(ISP_ABORT_RETRY, &vha->dpc_flags))) { 3504a9083016SGiridhar Malavali if (dev_state == QLA82XX_DEV_NEED_RESET) { 3505a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 3506a9083016SGiridhar Malavali "%s(): Adapter reset needed!\n", __func__); 3507a9083016SGiridhar Malavali set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags); 3508a9083016SGiridhar Malavali qla2xxx_wake_dpc(vha); 3509a9083016SGiridhar Malavali } else { 3510a9083016SGiridhar Malavali qla82xx_check_fw_alive(vha); 3511a9083016SGiridhar Malavali } 3512a9083016SGiridhar Malavali } 3513a9083016SGiridhar Malavali } 3514a9083016SGiridhar Malavali 3515a9083016SGiridhar Malavali int qla82xx_load_risc(scsi_qla_host_t *vha, uint32_t *srisc_addr) 3516a9083016SGiridhar Malavali { 3517a9083016SGiridhar Malavali int rval; 3518a9083016SGiridhar Malavali rval = qla82xx_device_state_handler(vha); 3519a9083016SGiridhar Malavali return rval; 3520a9083016SGiridhar Malavali } 3521a9083016SGiridhar Malavali 3522a9083016SGiridhar Malavali /* 3523a9083016SGiridhar Malavali * qla82xx_abort_isp 3524a9083016SGiridhar Malavali * Resets ISP and aborts all outstanding commands. 3525a9083016SGiridhar Malavali * 3526a9083016SGiridhar Malavali * Input: 3527a9083016SGiridhar Malavali * ha = adapter block pointer. 3528a9083016SGiridhar Malavali * 3529a9083016SGiridhar Malavali * Returns: 3530a9083016SGiridhar Malavali * 0 = success 3531a9083016SGiridhar Malavali */ 3532a9083016SGiridhar Malavali int 3533a9083016SGiridhar Malavali qla82xx_abort_isp(scsi_qla_host_t *vha) 3534a9083016SGiridhar Malavali { 3535a9083016SGiridhar Malavali int rval; 3536a9083016SGiridhar Malavali struct qla_hw_data *ha = vha->hw; 3537a9083016SGiridhar Malavali uint32_t dev_state; 3538a9083016SGiridhar Malavali 3539a9083016SGiridhar Malavali if (vha->device_flags & DFLG_DEV_FAILED) { 3540a9083016SGiridhar Malavali qla_printk(KERN_WARNING, ha, 3541a9083016SGiridhar Malavali "%s(%ld): Device in failed state, " 3542a9083016SGiridhar Malavali "Exiting.\n", __func__, vha->host_no); 3543a9083016SGiridhar Malavali return QLA_SUCCESS; 3544a9083016SGiridhar Malavali } 3545a9083016SGiridhar Malavali 3546a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3547a9083016SGiridhar Malavali dev_state = qla82xx_rd_32(ha, QLA82XX_CRB_DEV_STATE); 3548a9083016SGiridhar Malavali if (dev_state != QLA82XX_DEV_INITIALIZING) { 3549a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "HW State: NEED RESET\n"); 3550a9083016SGiridhar Malavali qla82xx_wr_32(ha, QLA82XX_CRB_DEV_STATE, 3551a9083016SGiridhar Malavali QLA82XX_DEV_NEED_RESET); 3552a9083016SGiridhar Malavali } else 3553a9083016SGiridhar Malavali qla_printk(KERN_INFO, ha, "HW State: DEVICE INITIALIZING\n"); 3554a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3555a9083016SGiridhar Malavali 3556a9083016SGiridhar Malavali rval = qla82xx_device_state_handler(vha); 3557a9083016SGiridhar Malavali 3558a9083016SGiridhar Malavali qla82xx_idc_lock(ha); 3559a9083016SGiridhar Malavali qla82xx_clear_rst_ready(ha); 3560a9083016SGiridhar Malavali qla82xx_idc_unlock(ha); 3561a9083016SGiridhar Malavali 3562a9083016SGiridhar Malavali if (rval == QLA_SUCCESS) 3563a9083016SGiridhar Malavali qla82xx_restart_isp(vha); 3564a9083016SGiridhar Malavali return rval; 3565a9083016SGiridhar Malavali } 3566a9083016SGiridhar Malavali 3567a9083016SGiridhar Malavali /* 3568a9083016SGiridhar Malavali * qla82xx_fcoe_ctx_reset 3569a9083016SGiridhar Malavali * Perform a quick reset and aborts all outstanding commands. 3570a9083016SGiridhar Malavali * This will only perform an FCoE context reset and avoids a full blown 3571a9083016SGiridhar Malavali * chip reset. 3572a9083016SGiridhar Malavali * 3573a9083016SGiridhar Malavali * Input: 3574a9083016SGiridhar Malavali * ha = adapter block pointer. 3575a9083016SGiridhar Malavali * is_reset_path = flag for identifying the reset path. 3576a9083016SGiridhar Malavali * 3577a9083016SGiridhar Malavali * Returns: 3578a9083016SGiridhar Malavali * 0 = success 3579a9083016SGiridhar Malavali */ 3580a9083016SGiridhar Malavali int qla82xx_fcoe_ctx_reset(scsi_qla_host_t *vha) 3581a9083016SGiridhar Malavali { 3582a9083016SGiridhar Malavali int rval = QLA_FUNCTION_FAILED; 3583a9083016SGiridhar Malavali 3584a9083016SGiridhar Malavali if (vha->flags.online) { 3585a9083016SGiridhar Malavali /* Abort all outstanding commands, so as to be requeued later */ 3586a9083016SGiridhar Malavali qla2x00_abort_isp_cleanup(vha); 3587a9083016SGiridhar Malavali } 3588a9083016SGiridhar Malavali 3589a9083016SGiridhar Malavali /* Stop currently executing firmware. 3590a9083016SGiridhar Malavali * This will destroy existing FCoE context at the F/W end. 3591a9083016SGiridhar Malavali */ 3592a9083016SGiridhar Malavali qla2x00_try_to_stop_firmware(vha); 3593a9083016SGiridhar Malavali 3594a9083016SGiridhar Malavali /* Restart. Creates a new FCoE context on INIT_FIRMWARE. */ 3595a9083016SGiridhar Malavali rval = qla82xx_restart_isp(vha); 3596a9083016SGiridhar Malavali 3597a9083016SGiridhar Malavali return rval; 3598a9083016SGiridhar Malavali } 3599a9083016SGiridhar Malavali 3600a9083016SGiridhar Malavali /* 3601a9083016SGiridhar Malavali * qla2x00_wait_for_fcoe_ctx_reset 3602a9083016SGiridhar Malavali * Wait till the FCoE context is reset. 3603a9083016SGiridhar Malavali * 3604a9083016SGiridhar Malavali * Note: 3605a9083016SGiridhar Malavali * Does context switching here. 3606a9083016SGiridhar Malavali * Release SPIN_LOCK (if any) before calling this routine. 3607a9083016SGiridhar Malavali * 3608a9083016SGiridhar Malavali * Return: 3609a9083016SGiridhar Malavali * Success (fcoe_ctx reset is done) : 0 3610a9083016SGiridhar Malavali * Failed (fcoe_ctx reset not completed within max loop timout ) : 1 3611a9083016SGiridhar Malavali */ 3612a9083016SGiridhar Malavali int qla2x00_wait_for_fcoe_ctx_reset(scsi_qla_host_t *vha) 3613a9083016SGiridhar Malavali { 3614a9083016SGiridhar Malavali int status = QLA_FUNCTION_FAILED; 3615a9083016SGiridhar Malavali unsigned long wait_reset; 3616a9083016SGiridhar Malavali 3617a9083016SGiridhar Malavali wait_reset = jiffies + (MAX_LOOP_TIMEOUT * HZ); 3618a9083016SGiridhar Malavali while ((test_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags) || 3619a9083016SGiridhar Malavali test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags)) 3620a9083016SGiridhar Malavali && time_before(jiffies, wait_reset)) { 3621a9083016SGiridhar Malavali 3622a9083016SGiridhar Malavali set_current_state(TASK_UNINTERRUPTIBLE); 3623a9083016SGiridhar Malavali schedule_timeout(HZ); 3624a9083016SGiridhar Malavali 3625a9083016SGiridhar Malavali if (!test_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags) && 3626a9083016SGiridhar Malavali !test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags)) { 3627a9083016SGiridhar Malavali status = QLA_SUCCESS; 3628a9083016SGiridhar Malavali break; 3629a9083016SGiridhar Malavali } 3630a9083016SGiridhar Malavali } 3631a9083016SGiridhar Malavali DEBUG2(printk(KERN_INFO 3632a9083016SGiridhar Malavali "%s status=%d\n", __func__, status)); 3633a9083016SGiridhar Malavali 3634a9083016SGiridhar Malavali return status; 3635a9083016SGiridhar Malavali } 3636