Commit | Line | Data |
---|---|---|
f931551b RC |
1 | /* |
2 | * Copyright (c) 2008, 2009, 2010 QLogic Corporation. All rights reserved. | |
3 | * | |
4 | * This software is available to you under a choice of one of two | |
5 | * licenses. You may choose to be licensed under the terms of the GNU | |
6 | * General Public License (GPL) Version 2, available from the file | |
7 | * COPYING in the main directory of this source tree, or the | |
8 | * OpenIB.org BSD license below: | |
9 | * | |
10 | * Redistribution and use in source and binary forms, with or | |
11 | * without modification, are permitted provided that the following | |
12 | * conditions are met: | |
13 | * | |
14 | * - Redistributions of source code must retain the above | |
15 | * copyright notice, this list of conditions and the following | |
16 | * disclaimer. | |
17 | * | |
18 | * - Redistributions in binary form must reproduce the above | |
19 | * copyright notice, this list of conditions and the following | |
20 | * disclaimer in the documentation and/or other materials | |
21 | * provided with the distribution. | |
22 | * | |
23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | |
24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | |
25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | |
26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | |
27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | |
28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | |
30 | * SOFTWARE. | |
31 | */ | |
32 | ||
33 | /* | |
34 | * This file contains all of the code that is specific to the | |
35 | * InfiniPath 7322 chip | |
36 | */ | |
37 | ||
38 | #include <linux/interrupt.h> | |
39 | #include <linux/pci.h> | |
40 | #include <linux/delay.h> | |
41 | #include <linux/io.h> | |
42 | #include <linux/jiffies.h> | |
43 | #include <rdma/ib_verbs.h> | |
44 | #include <rdma/ib_smi.h> | |
f931551b RC |
45 | |
46 | #include "qib.h" | |
47 | #include "qib_7322_regs.h" | |
48 | #include "qib_qsfp.h" | |
49 | ||
50 | #include "qib_mad.h" | |
51 | ||
52 | static void qib_setup_7322_setextled(struct qib_pportdata *, u32); | |
53 | static void qib_7322_handle_hwerrors(struct qib_devdata *, char *, size_t); | |
54 | static void sendctrl_7322_mod(struct qib_pportdata *ppd, u32 op); | |
55 | static irqreturn_t qib_7322intr(int irq, void *data); | |
56 | static irqreturn_t qib_7322bufavail(int irq, void *data); | |
57 | static irqreturn_t sdma_intr(int irq, void *data); | |
58 | static irqreturn_t sdma_idle_intr(int irq, void *data); | |
59 | static irqreturn_t sdma_progress_intr(int irq, void *data); | |
60 | static irqreturn_t sdma_cleanup_intr(int irq, void *data); | |
61 | static void qib_7322_txchk_change(struct qib_devdata *, u32, u32, u32, | |
62 | struct qib_ctxtdata *rcd); | |
63 | static u8 qib_7322_phys_portstate(u64); | |
64 | static u32 qib_7322_iblink_state(u64); | |
65 | static void qib_set_ib_7322_lstate(struct qib_pportdata *ppd, u16 linkcmd, | |
66 | u16 linitcmd); | |
67 | static void force_h1(struct qib_pportdata *); | |
68 | static void adj_tx_serdes(struct qib_pportdata *); | |
69 | static u32 qib_7322_setpbc_control(struct qib_pportdata *, u32, u8, u8); | |
70 | static void qib_7322_mini_pcs_reset(struct qib_pportdata *); | |
71 | ||
72 | static u32 ahb_mod(struct qib_devdata *, int, int, int, u32, u32); | |
73 | static void ibsd_wr_allchans(struct qib_pportdata *, int, unsigned, unsigned); | |
74 | ||
75 | #define BMASK(msb, lsb) (((1 << ((msb) + 1 - (lsb))) - 1) << (lsb)) | |
76 | ||
77 | /* LE2 serdes values for different cases */ | |
78 | #define LE2_DEFAULT 5 | |
79 | #define LE2_5m 4 | |
80 | #define LE2_QME 0 | |
81 | ||
82 | /* Below is special-purpose, so only really works for the IB SerDes blocks. */ | |
83 | #define IBSD(hw_pidx) (hw_pidx + 2) | |
84 | ||
85 | /* these are variables for documentation and experimentation purposes */ | |
86 | static const unsigned rcv_int_timeout = 375; | |
87 | static const unsigned rcv_int_count = 16; | |
88 | static const unsigned sdma_idle_cnt = 64; | |
89 | ||
90 | /* Time to stop altering Rx Equalization parameters, after link up. */ | |
91 | #define RXEQ_DISABLE_MSECS 2500 | |
92 | ||
93 | /* | |
94 | * Number of VLs we are configured to use (to allow for more | |
95 | * credits per vl, etc.) | |
96 | */ | |
97 | ushort qib_num_cfg_vls = 2; | |
98 | module_param_named(num_vls, qib_num_cfg_vls, ushort, S_IRUGO); | |
99 | MODULE_PARM_DESC(num_vls, "Set number of Virtual Lanes to use (1-8)"); | |
100 | ||
101 | static ushort qib_chase = 1; | |
102 | module_param_named(chase, qib_chase, ushort, S_IRUGO); | |
103 | MODULE_PARM_DESC(chase, "Enable state chase handling"); | |
104 | ||
105 | static ushort qib_long_atten = 10; /* 10 dB ~= 5m length */ | |
106 | module_param_named(long_attenuation, qib_long_atten, ushort, S_IRUGO); | |
107 | MODULE_PARM_DESC(long_attenuation, \ | |
108 | "attenuation cutoff (dB) for long copper cable setup"); | |
109 | ||
110 | static ushort qib_singleport; | |
111 | module_param_named(singleport, qib_singleport, ushort, S_IRUGO); | |
112 | MODULE_PARM_DESC(singleport, "Use only IB port 1; more per-port buffer space"); | |
113 | ||
0a43e117 MM |
114 | /* |
115 | * Receive header queue sizes | |
116 | */ | |
117 | static unsigned qib_rcvhdrcnt; | |
118 | module_param_named(rcvhdrcnt, qib_rcvhdrcnt, uint, S_IRUGO); | |
119 | MODULE_PARM_DESC(rcvhdrcnt, "receive header count"); | |
120 | ||
121 | static unsigned qib_rcvhdrsize; | |
122 | module_param_named(rcvhdrsize, qib_rcvhdrsize, uint, S_IRUGO); | |
123 | MODULE_PARM_DESC(rcvhdrsize, "receive header size in 32-bit words"); | |
124 | ||
125 | static unsigned qib_rcvhdrentsize; | |
126 | module_param_named(rcvhdrentsize, qib_rcvhdrentsize, uint, S_IRUGO); | |
127 | MODULE_PARM_DESC(rcvhdrentsize, "receive header entry size in 32-bit words"); | |
128 | ||
f931551b RC |
129 | #define MAX_ATTEN_LEN 64 /* plenty for any real system */ |
130 | /* for read back, default index is ~5m copper cable */ | |
a77fcf89 RC |
131 | static char txselect_list[MAX_ATTEN_LEN] = "10"; |
132 | static struct kparam_string kp_txselect = { | |
133 | .string = txselect_list, | |
f931551b RC |
134 | .maxlen = MAX_ATTEN_LEN |
135 | }; | |
a77fcf89 RC |
136 | static int setup_txselect(const char *, struct kernel_param *); |
137 | module_param_call(txselect, setup_txselect, param_get_string, | |
138 | &kp_txselect, S_IWUSR | S_IRUGO); | |
139 | MODULE_PARM_DESC(txselect, \ | |
140 | "Tx serdes indices (for no QSFP or invalid QSFP data)"); | |
f931551b RC |
141 | |
142 | #define BOARD_QME7342 5 | |
143 | #define BOARD_QMH7342 6 | |
144 | #define IS_QMH(dd) (SYM_FIELD((dd)->revision, Revision, BoardID) == \ | |
145 | BOARD_QMH7342) | |
146 | #define IS_QME(dd) (SYM_FIELD((dd)->revision, Revision, BoardID) == \ | |
147 | BOARD_QME7342) | |
148 | ||
149 | #define KREG_IDX(regname) (QIB_7322_##regname##_OFFS / sizeof(u64)) | |
150 | ||
151 | #define KREG_IBPORT_IDX(regname) ((QIB_7322_##regname##_0_OFFS / sizeof(u64))) | |
152 | ||
153 | #define MASK_ACROSS(lsb, msb) \ | |
154 | (((1ULL << ((msb) + 1 - (lsb))) - 1) << (lsb)) | |
155 | ||
156 | #define SYM_RMASK(regname, fldname) ((u64) \ | |
157 | QIB_7322_##regname##_##fldname##_RMASK) | |
158 | ||
159 | #define SYM_MASK(regname, fldname) ((u64) \ | |
160 | QIB_7322_##regname##_##fldname##_RMASK << \ | |
161 | QIB_7322_##regname##_##fldname##_LSB) | |
162 | ||
163 | #define SYM_FIELD(value, regname, fldname) ((u64) \ | |
164 | (((value) >> SYM_LSB(regname, fldname)) & \ | |
165 | SYM_RMASK(regname, fldname))) | |
166 | ||
167 | /* useful for things like LaFifoEmpty_0...7, TxCreditOK_0...7, etc. */ | |
168 | #define SYM_FIELD_ACROSS(value, regname, fldname, nbits) \ | |
169 | (((value) >> SYM_LSB(regname, fldname)) & MASK_ACROSS(0, nbits)) | |
170 | ||
171 | #define HWE_MASK(fldname) SYM_MASK(HwErrMask, fldname##Mask) | |
172 | #define ERR_MASK(fldname) SYM_MASK(ErrMask, fldname##Mask) | |
173 | #define ERR_MASK_N(fldname) SYM_MASK(ErrMask_0, fldname##Mask) | |
174 | #define INT_MASK(fldname) SYM_MASK(IntMask, fldname##IntMask) | |
175 | #define INT_MASK_P(fldname, port) SYM_MASK(IntMask, fldname##IntMask##_##port) | |
176 | /* Below because most, but not all, fields of IntMask have that full suffix */ | |
177 | #define INT_MASK_PM(fldname, port) SYM_MASK(IntMask, fldname##Mask##_##port) | |
178 | ||
179 | ||
180 | #define SYM_LSB(regname, fldname) (QIB_7322_##regname##_##fldname##_LSB) | |
181 | ||
182 | /* | |
183 | * the size bits give us 2^N, in KB units. 0 marks as invalid, | |
184 | * and 7 is reserved. We currently use only 2KB and 4KB | |
185 | */ | |
186 | #define IBA7322_TID_SZ_SHIFT QIB_7322_RcvTIDArray0_RT_BufSize_LSB | |
187 | #define IBA7322_TID_SZ_2K (1UL<<IBA7322_TID_SZ_SHIFT) /* 2KB */ | |
188 | #define IBA7322_TID_SZ_4K (2UL<<IBA7322_TID_SZ_SHIFT) /* 4KB */ | |
189 | #define IBA7322_TID_PA_SHIFT 11U /* TID addr in chip stored w/o low bits */ | |
190 | ||
191 | #define SendIBSLIDAssignMask \ | |
192 | QIB_7322_SendIBSLIDAssign_0_SendIBSLIDAssign_15_0_RMASK | |
193 | #define SendIBSLMCMask \ | |
194 | QIB_7322_SendIBSLIDMask_0_SendIBSLIDMask_15_0_RMASK | |
195 | ||
196 | #define ExtLED_IB1_YEL SYM_MASK(EXTCtrl, LEDPort0YellowOn) | |
197 | #define ExtLED_IB1_GRN SYM_MASK(EXTCtrl, LEDPort0GreenOn) | |
198 | #define ExtLED_IB2_YEL SYM_MASK(EXTCtrl, LEDPort1YellowOn) | |
199 | #define ExtLED_IB2_GRN SYM_MASK(EXTCtrl, LEDPort1GreenOn) | |
200 | #define ExtLED_IB1_MASK (ExtLED_IB1_YEL | ExtLED_IB1_GRN) | |
201 | #define ExtLED_IB2_MASK (ExtLED_IB2_YEL | ExtLED_IB2_GRN) | |
202 | ||
203 | #define _QIB_GPIO_SDA_NUM 1 | |
204 | #define _QIB_GPIO_SCL_NUM 0 | |
205 | #define QIB_EEPROM_WEN_NUM 14 | |
206 | #define QIB_TWSI_EEPROM_DEV 0xA2 /* All Production 7322 cards. */ | |
207 | ||
208 | /* HW counter clock is at 4nsec */ | |
209 | #define QIB_7322_PSXMITWAIT_CHECK_RATE 4000 | |
210 | ||
211 | /* full speed IB port 1 only */ | |
212 | #define PORT_SPD_CAP (QIB_IB_SDR | QIB_IB_DDR | QIB_IB_QDR) | |
213 | #define PORT_SPD_CAP_SHIFT 3 | |
214 | ||
215 | /* full speed featuremask, both ports */ | |
216 | #define DUAL_PORT_CAP (PORT_SPD_CAP | (PORT_SPD_CAP << PORT_SPD_CAP_SHIFT)) | |
217 | ||
218 | /* | |
219 | * This file contains almost all the chip-specific register information and | |
220 | * access functions for the FAKED QLogic InfiniPath 7322 PCI-Express chip. | |
221 | */ | |
222 | ||
223 | /* Use defines to tie machine-generated names to lower-case names */ | |
224 | #define kr_contextcnt KREG_IDX(ContextCnt) | |
225 | #define kr_control KREG_IDX(Control) | |
226 | #define kr_counterregbase KREG_IDX(CntrRegBase) | |
227 | #define kr_errclear KREG_IDX(ErrClear) | |
228 | #define kr_errmask KREG_IDX(ErrMask) | |
229 | #define kr_errstatus KREG_IDX(ErrStatus) | |
230 | #define kr_extctrl KREG_IDX(EXTCtrl) | |
231 | #define kr_extstatus KREG_IDX(EXTStatus) | |
232 | #define kr_gpio_clear KREG_IDX(GPIOClear) | |
233 | #define kr_gpio_mask KREG_IDX(GPIOMask) | |
234 | #define kr_gpio_out KREG_IDX(GPIOOut) | |
235 | #define kr_gpio_status KREG_IDX(GPIOStatus) | |
236 | #define kr_hwdiagctrl KREG_IDX(HwDiagCtrl) | |
237 | #define kr_debugportval KREG_IDX(DebugPortValueReg) | |
238 | #define kr_fmask KREG_IDX(feature_mask) | |
239 | #define kr_act_fmask KREG_IDX(active_feature_mask) | |
240 | #define kr_hwerrclear KREG_IDX(HwErrClear) | |
241 | #define kr_hwerrmask KREG_IDX(HwErrMask) | |
242 | #define kr_hwerrstatus KREG_IDX(HwErrStatus) | |
243 | #define kr_intclear KREG_IDX(IntClear) | |
244 | #define kr_intmask KREG_IDX(IntMask) | |
245 | #define kr_intredirect KREG_IDX(IntRedirect0) | |
246 | #define kr_intstatus KREG_IDX(IntStatus) | |
247 | #define kr_pagealign KREG_IDX(PageAlign) | |
248 | #define kr_rcvavailtimeout KREG_IDX(RcvAvailTimeOut0) | |
249 | #define kr_rcvctrl KREG_IDX(RcvCtrl) /* Common, but chip also has per-port */ | |
250 | #define kr_rcvegrbase KREG_IDX(RcvEgrBase) | |
251 | #define kr_rcvegrcnt KREG_IDX(RcvEgrCnt) | |
252 | #define kr_rcvhdrcnt KREG_IDX(RcvHdrCnt) | |
253 | #define kr_rcvhdrentsize KREG_IDX(RcvHdrEntSize) | |
254 | #define kr_rcvhdrsize KREG_IDX(RcvHdrSize) | |
255 | #define kr_rcvtidbase KREG_IDX(RcvTIDBase) | |
256 | #define kr_rcvtidcnt KREG_IDX(RcvTIDCnt) | |
257 | #define kr_revision KREG_IDX(Revision) | |
258 | #define kr_scratch KREG_IDX(Scratch) | |
259 | #define kr_sendbuffererror KREG_IDX(SendBufErr0) /* and base for 1 and 2 */ | |
260 | #define kr_sendcheckmask KREG_IDX(SendCheckMask0) /* and 1, 2 */ | |
261 | #define kr_sendctrl KREG_IDX(SendCtrl) | |
262 | #define kr_sendgrhcheckmask KREG_IDX(SendGRHCheckMask0) /* and 1, 2 */ | |
263 | #define kr_sendibpktmask KREG_IDX(SendIBPacketMask0) /* and 1, 2 */ | |
264 | #define kr_sendpioavailaddr KREG_IDX(SendBufAvailAddr) | |
265 | #define kr_sendpiobufbase KREG_IDX(SendBufBase) | |
266 | #define kr_sendpiobufcnt KREG_IDX(SendBufCnt) | |
267 | #define kr_sendpiosize KREG_IDX(SendBufSize) | |
268 | #define kr_sendregbase KREG_IDX(SendRegBase) | |
269 | #define kr_sendbufavail0 KREG_IDX(SendBufAvail0) | |
270 | #define kr_userregbase KREG_IDX(UserRegBase) | |
271 | #define kr_intgranted KREG_IDX(Int_Granted) | |
272 | #define kr_vecclr_wo_int KREG_IDX(vec_clr_without_int) | |
273 | #define kr_intblocked KREG_IDX(IntBlocked) | |
274 | #define kr_r_access KREG_IDX(SPC_JTAG_ACCESS_REG) | |
275 | ||
276 | /* | |
277 | * per-port kernel registers. Access only with qib_read_kreg_port() | |
278 | * or qib_write_kreg_port() | |
279 | */ | |
280 | #define krp_errclear KREG_IBPORT_IDX(ErrClear) | |
281 | #define krp_errmask KREG_IBPORT_IDX(ErrMask) | |
282 | #define krp_errstatus KREG_IBPORT_IDX(ErrStatus) | |
283 | #define krp_highprio_0 KREG_IBPORT_IDX(HighPriority0) | |
284 | #define krp_highprio_limit KREG_IBPORT_IDX(HighPriorityLimit) | |
285 | #define krp_hrtbt_guid KREG_IBPORT_IDX(HRTBT_GUID) | |
286 | #define krp_ib_pcsconfig KREG_IBPORT_IDX(IBPCSConfig) | |
287 | #define krp_ibcctrl_a KREG_IBPORT_IDX(IBCCtrlA) | |
288 | #define krp_ibcctrl_b KREG_IBPORT_IDX(IBCCtrlB) | |
289 | #define krp_ibcctrl_c KREG_IBPORT_IDX(IBCCtrlC) | |
290 | #define krp_ibcstatus_a KREG_IBPORT_IDX(IBCStatusA) | |
291 | #define krp_ibcstatus_b KREG_IBPORT_IDX(IBCStatusB) | |
292 | #define krp_txestatus KREG_IBPORT_IDX(TXEStatus) | |
293 | #define krp_lowprio_0 KREG_IBPORT_IDX(LowPriority0) | |
294 | #define krp_ncmodectrl KREG_IBPORT_IDX(IBNCModeCtrl) | |
295 | #define krp_partitionkey KREG_IBPORT_IDX(RcvPartitionKey) | |
296 | #define krp_psinterval KREG_IBPORT_IDX(PSInterval) | |
297 | #define krp_psstart KREG_IBPORT_IDX(PSStart) | |
298 | #define krp_psstat KREG_IBPORT_IDX(PSStat) | |
299 | #define krp_rcvbthqp KREG_IBPORT_IDX(RcvBTHQP) | |
300 | #define krp_rcvctrl KREG_IBPORT_IDX(RcvCtrl) | |
301 | #define krp_rcvpktledcnt KREG_IBPORT_IDX(RcvPktLEDCnt) | |
302 | #define krp_rcvqpmaptable KREG_IBPORT_IDX(RcvQPMapTableA) | |
303 | #define krp_rxcreditvl0 KREG_IBPORT_IDX(RxCreditVL0) | |
304 | #define krp_rxcreditvl15 (KREG_IBPORT_IDX(RxCreditVL0)+15) | |
305 | #define krp_sendcheckcontrol KREG_IBPORT_IDX(SendCheckControl) | |
306 | #define krp_sendctrl KREG_IBPORT_IDX(SendCtrl) | |
307 | #define krp_senddmabase KREG_IBPORT_IDX(SendDmaBase) | |
308 | #define krp_senddmabufmask0 KREG_IBPORT_IDX(SendDmaBufMask0) | |
309 | #define krp_senddmabufmask1 (KREG_IBPORT_IDX(SendDmaBufMask0) + 1) | |
310 | #define krp_senddmabufmask2 (KREG_IBPORT_IDX(SendDmaBufMask0) + 2) | |
311 | #define krp_senddmabuf_use0 KREG_IBPORT_IDX(SendDmaBufUsed0) | |
312 | #define krp_senddmabuf_use1 (KREG_IBPORT_IDX(SendDmaBufUsed0) + 1) | |
313 | #define krp_senddmabuf_use2 (KREG_IBPORT_IDX(SendDmaBufUsed0) + 2) | |
314 | #define krp_senddmadesccnt KREG_IBPORT_IDX(SendDmaDescCnt) | |
315 | #define krp_senddmahead KREG_IBPORT_IDX(SendDmaHead) | |
316 | #define krp_senddmaheadaddr KREG_IBPORT_IDX(SendDmaHeadAddr) | |
317 | #define krp_senddmaidlecnt KREG_IBPORT_IDX(SendDmaIdleCnt) | |
318 | #define krp_senddmalengen KREG_IBPORT_IDX(SendDmaLenGen) | |
319 | #define krp_senddmaprioritythld KREG_IBPORT_IDX(SendDmaPriorityThld) | |
320 | #define krp_senddmareloadcnt KREG_IBPORT_IDX(SendDmaReloadCnt) | |
321 | #define krp_senddmastatus KREG_IBPORT_IDX(SendDmaStatus) | |
322 | #define krp_senddmatail KREG_IBPORT_IDX(SendDmaTail) | |
323 | #define krp_sendhdrsymptom KREG_IBPORT_IDX(SendHdrErrSymptom) | |
324 | #define krp_sendslid KREG_IBPORT_IDX(SendIBSLIDAssign) | |
325 | #define krp_sendslidmask KREG_IBPORT_IDX(SendIBSLIDMask) | |
326 | #define krp_ibsdtestiftx KREG_IBPORT_IDX(IB_SDTEST_IF_TX) | |
327 | #define krp_adapt_dis_timer KREG_IBPORT_IDX(ADAPT_DISABLE_TIMER_THRESHOLD) | |
328 | #define krp_tx_deemph_override KREG_IBPORT_IDX(IBSD_TX_DEEMPHASIS_OVERRIDE) | |
329 | #define krp_serdesctrl KREG_IBPORT_IDX(IBSerdesCtrl) | |
330 | ||
331 | /* | |
332 | * Per-context kernel registers. Acess only with qib_read_kreg_ctxt() | |
333 | * or qib_write_kreg_ctxt() | |
334 | */ | |
335 | #define krc_rcvhdraddr KREG_IDX(RcvHdrAddr0) | |
336 | #define krc_rcvhdrtailaddr KREG_IDX(RcvHdrTailAddr0) | |
337 | ||
338 | /* | |
339 | * TID Flow table, per context. Reduces | |
340 | * number of hdrq updates to one per flow (or on errors). | |
341 | * context 0 and 1 share same memory, but have distinct | |
342 | * addresses. Since for now, we never use expected sends | |
343 | * on kernel contexts, we don't worry about that (we initialize | |
344 | * those entries for ctxt 0/1 on driver load twice, for example). | |
345 | */ | |
346 | #define NUM_TIDFLOWS_CTXT 0x20 /* 0x20 per context; have to hardcode */ | |
347 | #define ur_rcvflowtable (KREG_IDX(RcvTIDFlowTable0) - KREG_IDX(RcvHdrTail0)) | |
348 | ||
349 | /* these are the error bits in the tid flows, and are W1C */ | |
350 | #define TIDFLOW_ERRBITS ( \ | |
351 | (SYM_MASK(RcvTIDFlowTable0, GenMismatch) << \ | |
352 | SYM_LSB(RcvTIDFlowTable0, GenMismatch)) | \ | |
353 | (SYM_MASK(RcvTIDFlowTable0, SeqMismatch) << \ | |
354 | SYM_LSB(RcvTIDFlowTable0, SeqMismatch))) | |
355 | ||
356 | /* Most (not all) Counters are per-IBport. | |
357 | * Requires LBIntCnt is at offset 0 in the group | |
358 | */ | |
359 | #define CREG_IDX(regname) \ | |
360 | ((QIB_7322_##regname##_0_OFFS - QIB_7322_LBIntCnt_OFFS) / sizeof(u64)) | |
361 | ||
362 | #define crp_badformat CREG_IDX(RxVersionErrCnt) | |
363 | #define crp_err_rlen CREG_IDX(RxLenErrCnt) | |
364 | #define crp_erricrc CREG_IDX(RxICRCErrCnt) | |
365 | #define crp_errlink CREG_IDX(RxLinkMalformCnt) | |
366 | #define crp_errlpcrc CREG_IDX(RxLPCRCErrCnt) | |
367 | #define crp_errpkey CREG_IDX(RxPKeyMismatchCnt) | |
368 | #define crp_errvcrc CREG_IDX(RxVCRCErrCnt) | |
369 | #define crp_excessbufferovfl CREG_IDX(ExcessBufferOvflCnt) | |
370 | #define crp_iblinkdown CREG_IDX(IBLinkDownedCnt) | |
371 | #define crp_iblinkerrrecov CREG_IDX(IBLinkErrRecoveryCnt) | |
372 | #define crp_ibstatuschange CREG_IDX(IBStatusChangeCnt) | |
373 | #define crp_ibsymbolerr CREG_IDX(IBSymbolErrCnt) | |
374 | #define crp_invalidrlen CREG_IDX(RxMaxMinLenErrCnt) | |
375 | #define crp_locallinkintegrityerr CREG_IDX(LocalLinkIntegrityErrCnt) | |
376 | #define crp_pktrcv CREG_IDX(RxDataPktCnt) | |
377 | #define crp_pktrcvflowctrl CREG_IDX(RxFlowPktCnt) | |
378 | #define crp_pktsend CREG_IDX(TxDataPktCnt) | |
379 | #define crp_pktsendflow CREG_IDX(TxFlowPktCnt) | |
380 | #define crp_psrcvdatacount CREG_IDX(PSRcvDataCount) | |
381 | #define crp_psrcvpktscount CREG_IDX(PSRcvPktsCount) | |
382 | #define crp_psxmitdatacount CREG_IDX(PSXmitDataCount) | |
383 | #define crp_psxmitpktscount CREG_IDX(PSXmitPktsCount) | |
384 | #define crp_psxmitwaitcount CREG_IDX(PSXmitWaitCount) | |
385 | #define crp_rcvebp CREG_IDX(RxEBPCnt) | |
386 | #define crp_rcvflowctrlviol CREG_IDX(RxFlowCtrlViolCnt) | |
387 | #define crp_rcvovfl CREG_IDX(RxBufOvflCnt) | |
388 | #define crp_rxdlidfltr CREG_IDX(RxDlidFltrCnt) | |
389 | #define crp_rxdroppkt CREG_IDX(RxDroppedPktCnt) | |
390 | #define crp_rxotherlocalphyerr CREG_IDX(RxOtherLocalPhyErrCnt) | |
391 | #define crp_rxqpinvalidctxt CREG_IDX(RxQPInvalidContextCnt) | |
392 | #define crp_rxvlerr CREG_IDX(RxVlErrCnt) | |
393 | #define crp_sendstall CREG_IDX(TxFlowStallCnt) | |
394 | #define crp_txdroppedpkt CREG_IDX(TxDroppedPktCnt) | |
395 | #define crp_txhdrerr CREG_IDX(TxHeadersErrCnt) | |
396 | #define crp_txlenerr CREG_IDX(TxLenErrCnt) | |
397 | #define crp_txlenerr CREG_IDX(TxLenErrCnt) | |
398 | #define crp_txminmaxlenerr CREG_IDX(TxMaxMinLenErrCnt) | |
399 | #define crp_txsdmadesc CREG_IDX(TxSDmaDescCnt) | |
400 | #define crp_txunderrun CREG_IDX(TxUnderrunCnt) | |
401 | #define crp_txunsupvl CREG_IDX(TxUnsupVLErrCnt) | |
402 | #define crp_vl15droppedpkt CREG_IDX(RxVL15DroppedPktCnt) | |
403 | #define crp_wordrcv CREG_IDX(RxDwordCnt) | |
404 | #define crp_wordsend CREG_IDX(TxDwordCnt) | |
405 | #define crp_tx_creditstalls CREG_IDX(TxCreditUpToDateTimeOut) | |
406 | ||
407 | /* these are the (few) counters that are not port-specific */ | |
408 | #define CREG_DEVIDX(regname) ((QIB_7322_##regname##_OFFS - \ | |
409 | QIB_7322_LBIntCnt_OFFS) / sizeof(u64)) | |
410 | #define cr_base_egrovfl CREG_DEVIDX(RxP0HdrEgrOvflCnt) | |
411 | #define cr_lbint CREG_DEVIDX(LBIntCnt) | |
412 | #define cr_lbstall CREG_DEVIDX(LBFlowStallCnt) | |
413 | #define cr_pcieretrydiag CREG_DEVIDX(PcieRetryBufDiagQwordCnt) | |
414 | #define cr_rxtidflowdrop CREG_DEVIDX(RxTidFlowDropCnt) | |
415 | #define cr_tidfull CREG_DEVIDX(RxTIDFullErrCnt) | |
416 | #define cr_tidinvalid CREG_DEVIDX(RxTIDValidErrCnt) | |
417 | ||
418 | /* no chip register for # of IB ports supported, so define */ | |
419 | #define NUM_IB_PORTS 2 | |
420 | ||
421 | /* 1 VL15 buffer per hardware IB port, no register for this, so define */ | |
422 | #define NUM_VL15_BUFS NUM_IB_PORTS | |
423 | ||
424 | /* | |
425 | * context 0 and 1 are special, and there is no chip register that | |
426 | * defines this value, so we have to define it here. | |
427 | * These are all allocated to either 0 or 1 for single port | |
428 | * hardware configuration, otherwise each gets half | |
429 | */ | |
430 | #define KCTXT0_EGRCNT 2048 | |
431 | ||
432 | /* values for vl and port fields in PBC, 7322-specific */ | |
433 | #define PBC_PORT_SEL_LSB 26 | |
434 | #define PBC_PORT_SEL_RMASK 1 | |
435 | #define PBC_VL_NUM_LSB 27 | |
436 | #define PBC_VL_NUM_RMASK 7 | |
437 | #define PBC_7322_VL15_SEND (1ULL << 63) /* pbc; VL15, no credit check */ | |
438 | #define PBC_7322_VL15_SEND_CTRL (1ULL << 31) /* control version of same */ | |
439 | ||
440 | static u8 ib_rate_to_delay[IB_RATE_120_GBPS + 1] = { | |
441 | [IB_RATE_2_5_GBPS] = 16, | |
442 | [IB_RATE_5_GBPS] = 8, | |
443 | [IB_RATE_10_GBPS] = 4, | |
444 | [IB_RATE_20_GBPS] = 2, | |
445 | [IB_RATE_30_GBPS] = 2, | |
446 | [IB_RATE_40_GBPS] = 1 | |
447 | }; | |
448 | ||
449 | #define IBA7322_LINKSPEED_SHIFT SYM_LSB(IBCStatusA_0, LinkSpeedActive) | |
450 | #define IBA7322_LINKWIDTH_SHIFT SYM_LSB(IBCStatusA_0, LinkWidthActive) | |
451 | ||
452 | /* link training states, from IBC */ | |
453 | #define IB_7322_LT_STATE_DISABLED 0x00 | |
454 | #define IB_7322_LT_STATE_LINKUP 0x01 | |
455 | #define IB_7322_LT_STATE_POLLACTIVE 0x02 | |
456 | #define IB_7322_LT_STATE_POLLQUIET 0x03 | |
457 | #define IB_7322_LT_STATE_SLEEPDELAY 0x04 | |
458 | #define IB_7322_LT_STATE_SLEEPQUIET 0x05 | |
459 | #define IB_7322_LT_STATE_CFGDEBOUNCE 0x08 | |
460 | #define IB_7322_LT_STATE_CFGRCVFCFG 0x09 | |
461 | #define IB_7322_LT_STATE_CFGWAITRMT 0x0a | |
462 | #define IB_7322_LT_STATE_CFGIDLE 0x0b | |
463 | #define IB_7322_LT_STATE_RECOVERRETRAIN 0x0c | |
464 | #define IB_7322_LT_STATE_TXREVLANES 0x0d | |
465 | #define IB_7322_LT_STATE_RECOVERWAITRMT 0x0e | |
466 | #define IB_7322_LT_STATE_RECOVERIDLE 0x0f | |
467 | #define IB_7322_LT_STATE_CFGENH 0x10 | |
468 | #define IB_7322_LT_STATE_CFGTEST 0x11 | |
469 | ||
470 | /* link state machine states from IBC */ | |
471 | #define IB_7322_L_STATE_DOWN 0x0 | |
472 | #define IB_7322_L_STATE_INIT 0x1 | |
473 | #define IB_7322_L_STATE_ARM 0x2 | |
474 | #define IB_7322_L_STATE_ACTIVE 0x3 | |
475 | #define IB_7322_L_STATE_ACT_DEFER 0x4 | |
476 | ||
477 | static const u8 qib_7322_physportstate[0x20] = { | |
478 | [IB_7322_LT_STATE_DISABLED] = IB_PHYSPORTSTATE_DISABLED, | |
479 | [IB_7322_LT_STATE_LINKUP] = IB_PHYSPORTSTATE_LINKUP, | |
480 | [IB_7322_LT_STATE_POLLACTIVE] = IB_PHYSPORTSTATE_POLL, | |
481 | [IB_7322_LT_STATE_POLLQUIET] = IB_PHYSPORTSTATE_POLL, | |
482 | [IB_7322_LT_STATE_SLEEPDELAY] = IB_PHYSPORTSTATE_SLEEP, | |
483 | [IB_7322_LT_STATE_SLEEPQUIET] = IB_PHYSPORTSTATE_SLEEP, | |
484 | [IB_7322_LT_STATE_CFGDEBOUNCE] = IB_PHYSPORTSTATE_CFG_TRAIN, | |
485 | [IB_7322_LT_STATE_CFGRCVFCFG] = | |
486 | IB_PHYSPORTSTATE_CFG_TRAIN, | |
487 | [IB_7322_LT_STATE_CFGWAITRMT] = | |
488 | IB_PHYSPORTSTATE_CFG_TRAIN, | |
489 | [IB_7322_LT_STATE_CFGIDLE] = IB_PHYSPORTSTATE_CFG_IDLE, | |
490 | [IB_7322_LT_STATE_RECOVERRETRAIN] = | |
491 | IB_PHYSPORTSTATE_LINK_ERR_RECOVER, | |
492 | [IB_7322_LT_STATE_RECOVERWAITRMT] = | |
493 | IB_PHYSPORTSTATE_LINK_ERR_RECOVER, | |
494 | [IB_7322_LT_STATE_RECOVERIDLE] = | |
495 | IB_PHYSPORTSTATE_LINK_ERR_RECOVER, | |
496 | [IB_7322_LT_STATE_CFGENH] = IB_PHYSPORTSTATE_CFG_ENH, | |
497 | [IB_7322_LT_STATE_CFGTEST] = IB_PHYSPORTSTATE_CFG_TRAIN, | |
498 | [0x12] = IB_PHYSPORTSTATE_CFG_TRAIN, | |
499 | [0x13] = IB_PHYSPORTSTATE_CFG_WAIT_ENH, | |
500 | [0x14] = IB_PHYSPORTSTATE_CFG_TRAIN, | |
501 | [0x15] = IB_PHYSPORTSTATE_CFG_TRAIN, | |
502 | [0x16] = IB_PHYSPORTSTATE_CFG_TRAIN, | |
503 | [0x17] = IB_PHYSPORTSTATE_CFG_TRAIN | |
504 | }; | |
505 | ||
506 | struct qib_chip_specific { | |
507 | u64 __iomem *cregbase; | |
508 | u64 *cntrs; | |
509 | spinlock_t rcvmod_lock; /* protect rcvctrl shadow changes */ | |
510 | spinlock_t gpio_lock; /* RMW of shadows/regs for ExtCtrl and GPIO */ | |
511 | u64 main_int_mask; /* clear bits which have dedicated handlers */ | |
512 | u64 int_enable_mask; /* for per port interrupts in single port mode */ | |
513 | u64 errormask; | |
514 | u64 hwerrmask; | |
515 | u64 gpio_out; /* shadow of kr_gpio_out, for rmw ops */ | |
516 | u64 gpio_mask; /* shadow the gpio mask register */ | |
517 | u64 extctrl; /* shadow the gpio output enable, etc... */ | |
518 | u32 ncntrs; | |
519 | u32 nportcntrs; | |
520 | u32 cntrnamelen; | |
521 | u32 portcntrnamelen; | |
522 | u32 numctxts; | |
523 | u32 rcvegrcnt; | |
524 | u32 updthresh; /* current AvailUpdThld */ | |
525 | u32 updthresh_dflt; /* default AvailUpdThld */ | |
526 | u32 r1; | |
527 | int irq; | |
528 | u32 num_msix_entries; | |
529 | u32 sdmabufcnt; | |
530 | u32 lastbuf_for_pio; | |
531 | u32 stay_in_freeze; | |
532 | u32 recovery_ports_initted; | |
f931551b RC |
533 | struct msix_entry *msix_entries; |
534 | void **msix_arg; | |
535 | unsigned long *sendchkenable; | |
536 | unsigned long *sendgrhchk; | |
537 | unsigned long *sendibchk; | |
538 | u32 rcvavail_timeout[18]; | |
539 | char emsgbuf[128]; /* for device error interrupt msg buffer */ | |
540 | }; | |
541 | ||
542 | /* Table of entries in "human readable" form Tx Emphasis. */ | |
543 | struct txdds_ent { | |
544 | u8 amp; | |
545 | u8 pre; | |
546 | u8 main; | |
547 | u8 post; | |
548 | }; | |
549 | ||
550 | struct vendor_txdds_ent { | |
551 | u8 oui[QSFP_VOUI_LEN]; | |
552 | u8 *partnum; | |
553 | struct txdds_ent sdr; | |
554 | struct txdds_ent ddr; | |
555 | struct txdds_ent qdr; | |
556 | }; | |
557 | ||
558 | static void write_tx_serdes_param(struct qib_pportdata *, struct txdds_ent *); | |
559 | ||
560 | #define TXDDS_TABLE_SZ 16 /* number of entries per speed in onchip table */ | |
7c7a416e | 561 | #define TXDDS_EXTRA_SZ 13 /* number of extra tx settings entries */ |
f931551b RC |
562 | #define SERDES_CHANS 4 /* yes, it's obvious, but one less magic number */ |
563 | ||
564 | #define H1_FORCE_VAL 8 | |
a77fcf89 RC |
565 | #define H1_FORCE_QME 1 /* may be overridden via setup_txselect() */ |
566 | #define H1_FORCE_QMH 7 /* may be overridden via setup_txselect() */ | |
f931551b RC |
567 | |
568 | /* The static and dynamic registers are paired, and the pairs indexed by spd */ | |
569 | #define krp_static_adapt_dis(spd) (KREG_IBPORT_IDX(ADAPT_DISABLE_STATIC_SDR) \ | |
570 | + ((spd) * 2)) | |
571 | ||
572 | #define QDR_DFE_DISABLE_DELAY 4000 /* msec after LINKUP */ | |
573 | #define QDR_STATIC_ADAPT_DOWN 0xf0f0f0f0ULL /* link down, H1-H4 QDR adapts */ | |
574 | #define QDR_STATIC_ADAPT_DOWN_R1 0ULL /* r1 link down, H1-H4 QDR adapts */ | |
575 | #define QDR_STATIC_ADAPT_INIT 0xffffffffffULL /* up, disable H0,H1-8, LE */ | |
576 | #define QDR_STATIC_ADAPT_INIT_R1 0xf0ffffffffULL /* r1 up, disable H0,H1-8 */ | |
577 | ||
f931551b RC |
578 | struct qib_chippport_specific { |
579 | u64 __iomem *kpregbase; | |
580 | u64 __iomem *cpregbase; | |
581 | u64 *portcntrs; | |
582 | struct qib_pportdata *ppd; | |
583 | wait_queue_head_t autoneg_wait; | |
584 | struct delayed_work autoneg_work; | |
585 | struct delayed_work ipg_work; | |
586 | struct timer_list chase_timer; | |
587 | /* | |
588 | * these 5 fields are used to establish deltas for IB symbol | |
589 | * errors and linkrecovery errors. They can be reported on | |
590 | * some chips during link negotiation prior to INIT, and with | |
591 | * DDR when faking DDR negotiations with non-IBTA switches. | |
592 | * The chip counters are adjusted at driver unload if there is | |
593 | * a non-zero delta. | |
594 | */ | |
595 | u64 ibdeltainprog; | |
596 | u64 ibsymdelta; | |
597 | u64 ibsymsnap; | |
598 | u64 iblnkerrdelta; | |
599 | u64 iblnkerrsnap; | |
600 | u64 iblnkdownsnap; | |
601 | u64 iblnkdowndelta; | |
602 | u64 ibmalfdelta; | |
603 | u64 ibmalfsnap; | |
604 | u64 ibcctrl_a; /* krp_ibcctrl_a shadow */ | |
605 | u64 ibcctrl_b; /* krp_ibcctrl_b shadow */ | |
606 | u64 qdr_dfe_time; | |
607 | u64 chase_end; | |
608 | u32 autoneg_tries; | |
609 | u32 recovery_init; | |
610 | u32 qdr_dfe_on; | |
611 | u32 qdr_reforce; | |
612 | /* | |
613 | * Per-bay per-channel rcv QMH H1 values and Tx values for QDR. | |
614 | * entry zero is unused, to simplify indexing | |
615 | */ | |
a77fcf89 RC |
616 | u8 h1_val; |
617 | u8 no_eep; /* txselect table index to use if no qsfp info */ | |
f931551b RC |
618 | u8 ipg_tries; |
619 | u8 ibmalfusesnap; | |
620 | struct qib_qsfp_data qsfp_data; | |
621 | char epmsgbuf[192]; /* for port error interrupt msg buffer */ | |
622 | }; | |
623 | ||
624 | static struct { | |
625 | const char *name; | |
626 | irq_handler_t handler; | |
627 | int lsb; | |
628 | int port; /* 0 if not port-specific, else port # */ | |
629 | } irq_table[] = { | |
630 | { QIB_DRV_NAME, qib_7322intr, -1, 0 }, | |
631 | { QIB_DRV_NAME " (buf avail)", qib_7322bufavail, | |
632 | SYM_LSB(IntStatus, SendBufAvail), 0 }, | |
633 | { QIB_DRV_NAME " (sdma 0)", sdma_intr, | |
634 | SYM_LSB(IntStatus, SDmaInt_0), 1 }, | |
635 | { QIB_DRV_NAME " (sdma 1)", sdma_intr, | |
636 | SYM_LSB(IntStatus, SDmaInt_1), 2 }, | |
637 | { QIB_DRV_NAME " (sdmaI 0)", sdma_idle_intr, | |
638 | SYM_LSB(IntStatus, SDmaIdleInt_0), 1 }, | |
639 | { QIB_DRV_NAME " (sdmaI 1)", sdma_idle_intr, | |
640 | SYM_LSB(IntStatus, SDmaIdleInt_1), 2 }, | |
641 | { QIB_DRV_NAME " (sdmaP 0)", sdma_progress_intr, | |
642 | SYM_LSB(IntStatus, SDmaProgressInt_0), 1 }, | |
643 | { QIB_DRV_NAME " (sdmaP 1)", sdma_progress_intr, | |
644 | SYM_LSB(IntStatus, SDmaProgressInt_1), 2 }, | |
645 | { QIB_DRV_NAME " (sdmaC 0)", sdma_cleanup_intr, | |
646 | SYM_LSB(IntStatus, SDmaCleanupDone_0), 1 }, | |
647 | { QIB_DRV_NAME " (sdmaC 1)", sdma_cleanup_intr, | |
648 | SYM_LSB(IntStatus, SDmaCleanupDone_1), 2 }, | |
649 | }; | |
650 | ||
f931551b RC |
651 | /* ibcctrl bits */ |
652 | #define QLOGIC_IB_IBCC_LINKINITCMD_DISABLE 1 | |
653 | /* cycle through TS1/TS2 till OK */ | |
654 | #define QLOGIC_IB_IBCC_LINKINITCMD_POLL 2 | |
655 | /* wait for TS1, then go on */ | |
656 | #define QLOGIC_IB_IBCC_LINKINITCMD_SLEEP 3 | |
657 | #define QLOGIC_IB_IBCC_LINKINITCMD_SHIFT 16 | |
658 | ||
659 | #define QLOGIC_IB_IBCC_LINKCMD_DOWN 1 /* move to 0x11 */ | |
660 | #define QLOGIC_IB_IBCC_LINKCMD_ARMED 2 /* move to 0x21 */ | |
661 | #define QLOGIC_IB_IBCC_LINKCMD_ACTIVE 3 /* move to 0x31 */ | |
662 | ||
663 | #define BLOB_7322_IBCHG 0x101 | |
664 | ||
665 | static inline void qib_write_kreg(const struct qib_devdata *dd, | |
666 | const u32 regno, u64 value); | |
667 | static inline u32 qib_read_kreg32(const struct qib_devdata *, const u32); | |
668 | static void write_7322_initregs(struct qib_devdata *); | |
669 | static void write_7322_init_portregs(struct qib_pportdata *); | |
670 | static void setup_7322_link_recovery(struct qib_pportdata *, u32); | |
671 | static void check_7322_rxe_status(struct qib_pportdata *); | |
672 | static u32 __iomem *qib_7322_getsendbuf(struct qib_pportdata *, u64, u32 *); | |
673 | ||
674 | /** | |
675 | * qib_read_ureg32 - read 32-bit virtualized per-context register | |
676 | * @dd: device | |
677 | * @regno: register number | |
678 | * @ctxt: context number | |
679 | * | |
680 | * Return the contents of a register that is virtualized to be per context. | |
681 | * Returns -1 on errors (not distinguishable from valid contents at | |
682 | * runtime; we may add a separate error variable at some point). | |
683 | */ | |
684 | static inline u32 qib_read_ureg32(const struct qib_devdata *dd, | |
685 | enum qib_ureg regno, int ctxt) | |
686 | { | |
687 | if (!dd->kregbase || !(dd->flags & QIB_PRESENT)) | |
688 | return 0; | |
689 | return readl(regno + (u64 __iomem *)( | |
690 | (dd->ureg_align * ctxt) + (dd->userbase ? | |
691 | (char __iomem *)dd->userbase : | |
692 | (char __iomem *)dd->kregbase + dd->uregbase))); | |
693 | } | |
694 | ||
695 | /** | |
696 | * qib_read_ureg - read virtualized per-context register | |
697 | * @dd: device | |
698 | * @regno: register number | |
699 | * @ctxt: context number | |
700 | * | |
701 | * Return the contents of a register that is virtualized to be per context. | |
702 | * Returns -1 on errors (not distinguishable from valid contents at | |
703 | * runtime; we may add a separate error variable at some point). | |
704 | */ | |
705 | static inline u64 qib_read_ureg(const struct qib_devdata *dd, | |
706 | enum qib_ureg regno, int ctxt) | |
707 | { | |
708 | ||
709 | if (!dd->kregbase || !(dd->flags & QIB_PRESENT)) | |
710 | return 0; | |
711 | return readq(regno + (u64 __iomem *)( | |
712 | (dd->ureg_align * ctxt) + (dd->userbase ? | |
713 | (char __iomem *)dd->userbase : | |
714 | (char __iomem *)dd->kregbase + dd->uregbase))); | |
715 | } | |
716 | ||
717 | /** | |
718 | * qib_write_ureg - write virtualized per-context register | |
719 | * @dd: device | |
720 | * @regno: register number | |
721 | * @value: value | |
722 | * @ctxt: context | |
723 | * | |
724 | * Write the contents of a register that is virtualized to be per context. | |
725 | */ | |
726 | static inline void qib_write_ureg(const struct qib_devdata *dd, | |
727 | enum qib_ureg regno, u64 value, int ctxt) | |
728 | { | |
729 | u64 __iomem *ubase; | |
730 | if (dd->userbase) | |
731 | ubase = (u64 __iomem *) | |
732 | ((char __iomem *) dd->userbase + | |
733 | dd->ureg_align * ctxt); | |
734 | else | |
735 | ubase = (u64 __iomem *) | |
736 | (dd->uregbase + | |
737 | (char __iomem *) dd->kregbase + | |
738 | dd->ureg_align * ctxt); | |
739 | ||
740 | if (dd->kregbase && (dd->flags & QIB_PRESENT)) | |
741 | writeq(value, &ubase[regno]); | |
742 | } | |
743 | ||
744 | static inline u32 qib_read_kreg32(const struct qib_devdata *dd, | |
745 | const u32 regno) | |
746 | { | |
747 | if (!dd->kregbase || !(dd->flags & QIB_PRESENT)) | |
748 | return -1; | |
749 | return readl((u32 __iomem *) &dd->kregbase[regno]); | |
750 | } | |
751 | ||
752 | static inline u64 qib_read_kreg64(const struct qib_devdata *dd, | |
753 | const u32 regno) | |
754 | { | |
755 | if (!dd->kregbase || !(dd->flags & QIB_PRESENT)) | |
756 | return -1; | |
757 | return readq(&dd->kregbase[regno]); | |
758 | } | |
759 | ||
760 | static inline void qib_write_kreg(const struct qib_devdata *dd, | |
761 | const u32 regno, u64 value) | |
762 | { | |
763 | if (dd->kregbase && (dd->flags & QIB_PRESENT)) | |
764 | writeq(value, &dd->kregbase[regno]); | |
765 | } | |
766 | ||
767 | /* | |
768 | * not many sanity checks for the port-specific kernel register routines, | |
769 | * since they are only used when it's known to be safe. | |
770 | */ | |
771 | static inline u64 qib_read_kreg_port(const struct qib_pportdata *ppd, | |
772 | const u16 regno) | |
773 | { | |
774 | if (!ppd->cpspec->kpregbase || !(ppd->dd->flags & QIB_PRESENT)) | |
775 | return 0ULL; | |
776 | return readq(&ppd->cpspec->kpregbase[regno]); | |
777 | } | |
778 | ||
779 | static inline void qib_write_kreg_port(const struct qib_pportdata *ppd, | |
780 | const u16 regno, u64 value) | |
781 | { | |
782 | if (ppd->cpspec && ppd->dd && ppd->cpspec->kpregbase && | |
783 | (ppd->dd->flags & QIB_PRESENT)) | |
784 | writeq(value, &ppd->cpspec->kpregbase[regno]); | |
785 | } | |
786 | ||
787 | /** | |
788 | * qib_write_kreg_ctxt - write a device's per-ctxt 64-bit kernel register | |
789 | * @dd: the qlogic_ib device | |
790 | * @regno: the register number to write | |
791 | * @ctxt: the context containing the register | |
792 | * @value: the value to write | |
793 | */ | |
794 | static inline void qib_write_kreg_ctxt(const struct qib_devdata *dd, | |
795 | const u16 regno, unsigned ctxt, | |
796 | u64 value) | |
797 | { | |
798 | qib_write_kreg(dd, regno + ctxt, value); | |
799 | } | |
800 | ||
801 | static inline u64 read_7322_creg(const struct qib_devdata *dd, u16 regno) | |
802 | { | |
803 | if (!dd->cspec->cregbase || !(dd->flags & QIB_PRESENT)) | |
804 | return 0; | |
805 | return readq(&dd->cspec->cregbase[regno]); | |
806 | ||
807 | ||
808 | } | |
809 | ||
810 | static inline u32 read_7322_creg32(const struct qib_devdata *dd, u16 regno) | |
811 | { | |
812 | if (!dd->cspec->cregbase || !(dd->flags & QIB_PRESENT)) | |
813 | return 0; | |
814 | return readl(&dd->cspec->cregbase[regno]); | |
815 | ||
816 | ||
817 | } | |
818 | ||
819 | static inline void write_7322_creg_port(const struct qib_pportdata *ppd, | |
820 | u16 regno, u64 value) | |
821 | { | |
822 | if (ppd->cpspec && ppd->cpspec->cpregbase && | |
823 | (ppd->dd->flags & QIB_PRESENT)) | |
824 | writeq(value, &ppd->cpspec->cpregbase[regno]); | |
825 | } | |
826 | ||
827 | static inline u64 read_7322_creg_port(const struct qib_pportdata *ppd, | |
828 | u16 regno) | |
829 | { | |
830 | if (!ppd->cpspec || !ppd->cpspec->cpregbase || | |
831 | !(ppd->dd->flags & QIB_PRESENT)) | |
832 | return 0; | |
833 | return readq(&ppd->cpspec->cpregbase[regno]); | |
834 | } | |
835 | ||
836 | static inline u32 read_7322_creg32_port(const struct qib_pportdata *ppd, | |
837 | u16 regno) | |
838 | { | |
839 | if (!ppd->cpspec || !ppd->cpspec->cpregbase || | |
840 | !(ppd->dd->flags & QIB_PRESENT)) | |
841 | return 0; | |
842 | return readl(&ppd->cpspec->cpregbase[regno]); | |
843 | } | |
844 | ||
845 | /* bits in Control register */ | |
846 | #define QLOGIC_IB_C_RESET SYM_MASK(Control, SyncReset) | |
847 | #define QLOGIC_IB_C_SDMAFETCHPRIOEN SYM_MASK(Control, SDmaDescFetchPriorityEn) | |
848 | ||
849 | /* bits in general interrupt regs */ | |
850 | #define QIB_I_RCVURG_LSB SYM_LSB(IntMask, RcvUrg0IntMask) | |
851 | #define QIB_I_RCVURG_RMASK MASK_ACROSS(0, 17) | |
852 | #define QIB_I_RCVURG_MASK (QIB_I_RCVURG_RMASK << QIB_I_RCVURG_LSB) | |
853 | #define QIB_I_RCVAVAIL_LSB SYM_LSB(IntMask, RcvAvail0IntMask) | |
854 | #define QIB_I_RCVAVAIL_RMASK MASK_ACROSS(0, 17) | |
855 | #define QIB_I_RCVAVAIL_MASK (QIB_I_RCVAVAIL_RMASK << QIB_I_RCVAVAIL_LSB) | |
856 | #define QIB_I_C_ERROR INT_MASK(Err) | |
857 | ||
858 | #define QIB_I_SPIOSENT (INT_MASK_P(SendDone, 0) | INT_MASK_P(SendDone, 1)) | |
859 | #define QIB_I_SPIOBUFAVAIL INT_MASK(SendBufAvail) | |
860 | #define QIB_I_GPIO INT_MASK(AssertGPIO) | |
861 | #define QIB_I_P_SDMAINT(pidx) \ | |
862 | (INT_MASK_P(SDma, pidx) | INT_MASK_P(SDmaIdle, pidx) | \ | |
863 | INT_MASK_P(SDmaProgress, pidx) | \ | |
864 | INT_MASK_PM(SDmaCleanupDone, pidx)) | |
865 | ||
866 | /* Interrupt bits that are "per port" */ | |
867 | #define QIB_I_P_BITSEXTANT(pidx) \ | |
868 | (INT_MASK_P(Err, pidx) | INT_MASK_P(SendDone, pidx) | \ | |
869 | INT_MASK_P(SDma, pidx) | INT_MASK_P(SDmaIdle, pidx) | \ | |
870 | INT_MASK_P(SDmaProgress, pidx) | \ | |
871 | INT_MASK_PM(SDmaCleanupDone, pidx)) | |
872 | ||
873 | /* Interrupt bits that are common to a device */ | |
874 | /* currently unused: QIB_I_SPIOSENT */ | |
875 | #define QIB_I_C_BITSEXTANT \ | |
876 | (QIB_I_RCVURG_MASK | QIB_I_RCVAVAIL_MASK | \ | |
877 | QIB_I_SPIOSENT | \ | |
878 | QIB_I_C_ERROR | QIB_I_SPIOBUFAVAIL | QIB_I_GPIO) | |
879 | ||
880 | #define QIB_I_BITSEXTANT (QIB_I_C_BITSEXTANT | \ | |
881 | QIB_I_P_BITSEXTANT(0) | QIB_I_P_BITSEXTANT(1)) | |
882 | ||
883 | /* | |
884 | * Error bits that are "per port". | |
885 | */ | |
886 | #define QIB_E_P_IBSTATUSCHANGED ERR_MASK_N(IBStatusChanged) | |
887 | #define QIB_E_P_SHDR ERR_MASK_N(SHeadersErr) | |
888 | #define QIB_E_P_VL15_BUF_MISUSE ERR_MASK_N(VL15BufMisuseErr) | |
889 | #define QIB_E_P_SND_BUF_MISUSE ERR_MASK_N(SendBufMisuseErr) | |
890 | #define QIB_E_P_SUNSUPVL ERR_MASK_N(SendUnsupportedVLErr) | |
891 | #define QIB_E_P_SUNEXP_PKTNUM ERR_MASK_N(SendUnexpectedPktNumErr) | |
892 | #define QIB_E_P_SDROP_DATA ERR_MASK_N(SendDroppedDataPktErr) | |
893 | #define QIB_E_P_SDROP_SMP ERR_MASK_N(SendDroppedSmpPktErr) | |
894 | #define QIB_E_P_SPKTLEN ERR_MASK_N(SendPktLenErr) | |
895 | #define QIB_E_P_SUNDERRUN ERR_MASK_N(SendUnderRunErr) | |
896 | #define QIB_E_P_SMAXPKTLEN ERR_MASK_N(SendMaxPktLenErr) | |
897 | #define QIB_E_P_SMINPKTLEN ERR_MASK_N(SendMinPktLenErr) | |
898 | #define QIB_E_P_RIBLOSTLINK ERR_MASK_N(RcvIBLostLinkErr) | |
899 | #define QIB_E_P_RHDR ERR_MASK_N(RcvHdrErr) | |
900 | #define QIB_E_P_RHDRLEN ERR_MASK_N(RcvHdrLenErr) | |
901 | #define QIB_E_P_RBADTID ERR_MASK_N(RcvBadTidErr) | |
902 | #define QIB_E_P_RBADVERSION ERR_MASK_N(RcvBadVersionErr) | |
903 | #define QIB_E_P_RIBFLOW ERR_MASK_N(RcvIBFlowErr) | |
904 | #define QIB_E_P_REBP ERR_MASK_N(RcvEBPErr) | |
905 | #define QIB_E_P_RUNSUPVL ERR_MASK_N(RcvUnsupportedVLErr) | |
906 | #define QIB_E_P_RUNEXPCHAR ERR_MASK_N(RcvUnexpectedCharErr) | |
907 | #define QIB_E_P_RSHORTPKTLEN ERR_MASK_N(RcvShortPktLenErr) | |
908 | #define QIB_E_P_RLONGPKTLEN ERR_MASK_N(RcvLongPktLenErr) | |
909 | #define QIB_E_P_RMAXPKTLEN ERR_MASK_N(RcvMaxPktLenErr) | |
910 | #define QIB_E_P_RMINPKTLEN ERR_MASK_N(RcvMinPktLenErr) | |
911 | #define QIB_E_P_RICRC ERR_MASK_N(RcvICRCErr) | |
912 | #define QIB_E_P_RVCRC ERR_MASK_N(RcvVCRCErr) | |
913 | #define QIB_E_P_RFORMATERR ERR_MASK_N(RcvFormatErr) | |
914 | ||
915 | #define QIB_E_P_SDMA1STDESC ERR_MASK_N(SDma1stDescErr) | |
916 | #define QIB_E_P_SDMABASE ERR_MASK_N(SDmaBaseErr) | |
917 | #define QIB_E_P_SDMADESCADDRMISALIGN ERR_MASK_N(SDmaDescAddrMisalignErr) | |
918 | #define QIB_E_P_SDMADWEN ERR_MASK_N(SDmaDwEnErr) | |
919 | #define QIB_E_P_SDMAGENMISMATCH ERR_MASK_N(SDmaGenMismatchErr) | |
920 | #define QIB_E_P_SDMAHALT ERR_MASK_N(SDmaHaltErr) | |
921 | #define QIB_E_P_SDMAMISSINGDW ERR_MASK_N(SDmaMissingDwErr) | |
922 | #define QIB_E_P_SDMAOUTOFBOUND ERR_MASK_N(SDmaOutOfBoundErr) | |
923 | #define QIB_E_P_SDMARPYTAG ERR_MASK_N(SDmaRpyTagErr) | |
924 | #define QIB_E_P_SDMATAILOUTOFBOUND ERR_MASK_N(SDmaTailOutOfBoundErr) | |
925 | #define QIB_E_P_SDMAUNEXPDATA ERR_MASK_N(SDmaUnexpDataErr) | |
926 | ||
927 | /* Error bits that are common to a device */ | |
928 | #define QIB_E_RESET ERR_MASK(ResetNegated) | |
929 | #define QIB_E_HARDWARE ERR_MASK(HardwareErr) | |
930 | #define QIB_E_INVALIDADDR ERR_MASK(InvalidAddrErr) | |
931 | ||
932 | ||
933 | /* | |
934 | * Per chip (rather than per-port) errors. Most either do | |
935 | * nothing but trigger a print (because they self-recover, or | |
936 | * always occur in tandem with other errors that handle the | |
937 | * issue), or because they indicate errors with no recovery, | |
938 | * but we want to know that they happened. | |
939 | */ | |
940 | #define QIB_E_SBUF_VL15_MISUSE ERR_MASK(SBufVL15MisUseErr) | |
941 | #define QIB_E_BADEEP ERR_MASK(InvalidEEPCmd) | |
942 | #define QIB_E_VLMISMATCH ERR_MASK(SendVLMismatchErr) | |
943 | #define QIB_E_ARMLAUNCH ERR_MASK(SendArmLaunchErr) | |
944 | #define QIB_E_SPCLTRIG ERR_MASK(SendSpecialTriggerErr) | |
945 | #define QIB_E_RRCVHDRFULL ERR_MASK(RcvHdrFullErr) | |
946 | #define QIB_E_RRCVEGRFULL ERR_MASK(RcvEgrFullErr) | |
947 | #define QIB_E_RCVCTXTSHARE ERR_MASK(RcvContextShareErr) | |
948 | ||
949 | /* SDMA chip errors (not per port) | |
950 | * QIB_E_SDMA_BUF_DUP needs no special handling, because we will also get | |
951 | * the SDMAHALT error immediately, so we just print the dup error via the | |
952 | * E_AUTO mechanism. This is true of most of the per-port fatal errors | |
953 | * as well, but since this is port-independent, by definition, it's | |
954 | * handled a bit differently. SDMA_VL15 and SDMA_WRONG_PORT are per | |
955 | * packet send errors, and so are handled in the same manner as other | |
956 | * per-packet errors. | |
957 | */ | |
958 | #define QIB_E_SDMA_VL15 ERR_MASK(SDmaVL15Err) | |
959 | #define QIB_E_SDMA_WRONG_PORT ERR_MASK(SDmaWrongPortErr) | |
960 | #define QIB_E_SDMA_BUF_DUP ERR_MASK(SDmaBufMaskDuplicateErr) | |
961 | ||
962 | /* | |
963 | * Below functionally equivalent to legacy QLOGIC_IB_E_PKTERRS | |
964 | * it is used to print "common" packet errors. | |
965 | */ | |
966 | #define QIB_E_P_PKTERRS (QIB_E_P_SPKTLEN |\ | |
967 | QIB_E_P_SDROP_DATA | QIB_E_P_RVCRC |\ | |
968 | QIB_E_P_RICRC | QIB_E_P_RSHORTPKTLEN |\ | |
969 | QIB_E_P_VL15_BUF_MISUSE | QIB_E_P_SHDR | \ | |
970 | QIB_E_P_REBP) | |
971 | ||
972 | /* Error Bits that Packet-related (Receive, per-port) */ | |
973 | #define QIB_E_P_RPKTERRS (\ | |
974 | QIB_E_P_RHDRLEN | QIB_E_P_RBADTID | \ | |
975 | QIB_E_P_RBADVERSION | QIB_E_P_RHDR | \ | |
976 | QIB_E_P_RLONGPKTLEN | QIB_E_P_RSHORTPKTLEN |\ | |
977 | QIB_E_P_RMAXPKTLEN | QIB_E_P_RMINPKTLEN | \ | |
978 | QIB_E_P_RFORMATERR | QIB_E_P_RUNSUPVL | \ | |
979 | QIB_E_P_RUNEXPCHAR | QIB_E_P_RIBFLOW | QIB_E_P_REBP) | |
980 | ||
981 | /* | |
982 | * Error bits that are Send-related (per port) | |
983 | * (ARMLAUNCH excluded from E_SPKTERRS because it gets special handling). | |
984 | * All of these potentially need to have a buffer disarmed | |
985 | */ | |
986 | #define QIB_E_P_SPKTERRS (\ | |
987 | QIB_E_P_SUNEXP_PKTNUM |\ | |
988 | QIB_E_P_SDROP_DATA | QIB_E_P_SDROP_SMP |\ | |
989 | QIB_E_P_SMAXPKTLEN |\ | |
990 | QIB_E_P_VL15_BUF_MISUSE | QIB_E_P_SHDR | \ | |
991 | QIB_E_P_SMINPKTLEN | QIB_E_P_SPKTLEN | \ | |
992 | QIB_E_P_SND_BUF_MISUSE | QIB_E_P_SUNSUPVL) | |
993 | ||
994 | #define QIB_E_SPKTERRS ( \ | |
995 | QIB_E_SBUF_VL15_MISUSE | QIB_E_VLMISMATCH | \ | |
996 | ERR_MASK_N(SendUnsupportedVLErr) | \ | |
997 | QIB_E_SPCLTRIG | QIB_E_SDMA_VL15 | QIB_E_SDMA_WRONG_PORT) | |
998 | ||
999 | #define QIB_E_P_SDMAERRS ( \ | |
1000 | QIB_E_P_SDMAHALT | \ | |
1001 | QIB_E_P_SDMADESCADDRMISALIGN | \ | |
1002 | QIB_E_P_SDMAUNEXPDATA | \ | |
1003 | QIB_E_P_SDMAMISSINGDW | \ | |
1004 | QIB_E_P_SDMADWEN | \ | |
1005 | QIB_E_P_SDMARPYTAG | \ | |
1006 | QIB_E_P_SDMA1STDESC | \ | |
1007 | QIB_E_P_SDMABASE | \ | |
1008 | QIB_E_P_SDMATAILOUTOFBOUND | \ | |
1009 | QIB_E_P_SDMAOUTOFBOUND | \ | |
1010 | QIB_E_P_SDMAGENMISMATCH) | |
1011 | ||
1012 | /* | |
1013 | * This sets some bits more than once, but makes it more obvious which | |
1014 | * bits are not handled under other categories, and the repeat definition | |
1015 | * is not a problem. | |
1016 | */ | |
1017 | #define QIB_E_P_BITSEXTANT ( \ | |
1018 | QIB_E_P_SPKTERRS | QIB_E_P_PKTERRS | QIB_E_P_RPKTERRS | \ | |
1019 | QIB_E_P_RIBLOSTLINK | QIB_E_P_IBSTATUSCHANGED | \ | |
1020 | QIB_E_P_SND_BUF_MISUSE | QIB_E_P_SUNDERRUN | \ | |
1021 | QIB_E_P_SHDR | QIB_E_P_VL15_BUF_MISUSE | QIB_E_P_SDMAERRS \ | |
1022 | ) | |
1023 | ||
1024 | /* | |
1025 | * These are errors that can occur when the link | |
1026 | * changes state while a packet is being sent or received. This doesn't | |
1027 | * cover things like EBP or VCRC that can be the result of a sending | |
1028 | * having the link change state, so we receive a "known bad" packet. | |
1029 | * All of these are "per port", so renamed: | |
1030 | */ | |
1031 | #define QIB_E_P_LINK_PKTERRS (\ | |
1032 | QIB_E_P_SDROP_DATA | QIB_E_P_SDROP_SMP |\ | |
1033 | QIB_E_P_SMINPKTLEN | QIB_E_P_SPKTLEN |\ | |
1034 | QIB_E_P_RSHORTPKTLEN | QIB_E_P_RMINPKTLEN |\ | |
1035 | QIB_E_P_RUNEXPCHAR) | |
1036 | ||
1037 | /* | |
1038 | * This sets some bits more than once, but makes it more obvious which | |
1039 | * bits are not handled under other categories (such as QIB_E_SPKTERRS), | |
1040 | * and the repeat definition is not a problem. | |
1041 | */ | |
1042 | #define QIB_E_C_BITSEXTANT (\ | |
1043 | QIB_E_HARDWARE | QIB_E_INVALIDADDR | QIB_E_BADEEP |\ | |
1044 | QIB_E_ARMLAUNCH | QIB_E_VLMISMATCH | QIB_E_RRCVHDRFULL |\ | |
1045 | QIB_E_RRCVEGRFULL | QIB_E_RESET | QIB_E_SBUF_VL15_MISUSE) | |
1046 | ||
1047 | /* Likewise Neuter E_SPKT_ERRS_IGNORE */ | |
1048 | #define E_SPKT_ERRS_IGNORE 0 | |
1049 | ||
1050 | #define QIB_EXTS_MEMBIST_DISABLED \ | |
1051 | SYM_MASK(EXTStatus, MemBISTDisabled) | |
1052 | #define QIB_EXTS_MEMBIST_ENDTEST \ | |
1053 | SYM_MASK(EXTStatus, MemBISTEndTest) | |
1054 | ||
1055 | #define QIB_E_SPIOARMLAUNCH \ | |
1056 | ERR_MASK(SendArmLaunchErr) | |
1057 | ||
1058 | #define IBA7322_IBCC_LINKINITCMD_MASK SYM_RMASK(IBCCtrlA_0, LinkInitCmd) | |
1059 | #define IBA7322_IBCC_LINKCMD_SHIFT SYM_LSB(IBCCtrlA_0, LinkCmd) | |
1060 | ||
1061 | /* | |
1062 | * IBTA_1_2 is set when multiple speeds are enabled (normal), | |
1063 | * and also if forced QDR (only QDR enabled). It's enabled for the | |
1064 | * forced QDR case so that scrambling will be enabled by the TS3 | |
1065 | * exchange, when supported by both sides of the link. | |
1066 | */ | |
1067 | #define IBA7322_IBC_IBTA_1_2_MASK SYM_MASK(IBCCtrlB_0, IB_ENHANCED_MODE) | |
1068 | #define IBA7322_IBC_MAX_SPEED_MASK SYM_MASK(IBCCtrlB_0, SD_SPEED) | |
1069 | #define IBA7322_IBC_SPEED_QDR SYM_MASK(IBCCtrlB_0, SD_SPEED_QDR) | |
1070 | #define IBA7322_IBC_SPEED_DDR SYM_MASK(IBCCtrlB_0, SD_SPEED_DDR) | |
1071 | #define IBA7322_IBC_SPEED_SDR SYM_MASK(IBCCtrlB_0, SD_SPEED_SDR) | |
1072 | #define IBA7322_IBC_SPEED_MASK (SYM_MASK(IBCCtrlB_0, SD_SPEED_SDR) | \ | |
1073 | SYM_MASK(IBCCtrlB_0, SD_SPEED_DDR) | SYM_MASK(IBCCtrlB_0, SD_SPEED_QDR)) | |
1074 | #define IBA7322_IBC_SPEED_LSB SYM_LSB(IBCCtrlB_0, SD_SPEED_SDR) | |
1075 | ||
1076 | #define IBA7322_LEDBLINK_OFF_SHIFT SYM_LSB(RcvPktLEDCnt_0, OFFperiod) | |
1077 | #define IBA7322_LEDBLINK_ON_SHIFT SYM_LSB(RcvPktLEDCnt_0, ONperiod) | |
1078 | ||
1079 | #define IBA7322_IBC_WIDTH_AUTONEG SYM_MASK(IBCCtrlB_0, IB_NUM_CHANNELS) | |
1080 | #define IBA7322_IBC_WIDTH_4X_ONLY (1<<SYM_LSB(IBCCtrlB_0, IB_NUM_CHANNELS)) | |
1081 | #define IBA7322_IBC_WIDTH_1X_ONLY (0<<SYM_LSB(IBCCtrlB_0, IB_NUM_CHANNELS)) | |
1082 | ||
1083 | #define IBA7322_IBC_RXPOL_MASK SYM_MASK(IBCCtrlB_0, IB_POLARITY_REV_SUPP) | |
1084 | #define IBA7322_IBC_RXPOL_LSB SYM_LSB(IBCCtrlB_0, IB_POLARITY_REV_SUPP) | |
1085 | #define IBA7322_IBC_HRTBT_MASK (SYM_MASK(IBCCtrlB_0, HRTBT_AUTO) | \ | |
1086 | SYM_MASK(IBCCtrlB_0, HRTBT_ENB)) | |
1087 | #define IBA7322_IBC_HRTBT_RMASK (IBA7322_IBC_HRTBT_MASK >> \ | |
1088 | SYM_LSB(IBCCtrlB_0, HRTBT_ENB)) | |
1089 | #define IBA7322_IBC_HRTBT_LSB SYM_LSB(IBCCtrlB_0, HRTBT_ENB) | |
1090 | ||
1091 | #define IBA7322_REDIRECT_VEC_PER_REG 12 | |
1092 | ||
1093 | #define IBA7322_SENDCHK_PKEY SYM_MASK(SendCheckControl_0, PKey_En) | |
1094 | #define IBA7322_SENDCHK_BTHQP SYM_MASK(SendCheckControl_0, BTHQP_En) | |
1095 | #define IBA7322_SENDCHK_SLID SYM_MASK(SendCheckControl_0, SLID_En) | |
1096 | #define IBA7322_SENDCHK_RAW_IPV6 SYM_MASK(SendCheckControl_0, RawIPV6_En) | |
1097 | #define IBA7322_SENDCHK_MINSZ SYM_MASK(SendCheckControl_0, PacketTooSmall_En) | |
1098 | ||
1099 | #define AUTONEG_TRIES 3 /* sequential retries to negotiate DDR */ | |
1100 | ||
1101 | #define HWE_AUTO(fldname) { .mask = SYM_MASK(HwErrMask, fldname##Mask), \ | |
1102 | .msg = #fldname } | |
1103 | #define HWE_AUTO_P(fldname, port) { .mask = SYM_MASK(HwErrMask, \ | |
1104 | fldname##Mask##_##port), .msg = #fldname } | |
1105 | static const struct qib_hwerror_msgs qib_7322_hwerror_msgs[] = { | |
1106 | HWE_AUTO_P(IBSerdesPClkNotDetect, 1), | |
1107 | HWE_AUTO_P(IBSerdesPClkNotDetect, 0), | |
1108 | HWE_AUTO(PCIESerdesPClkNotDetect), | |
1109 | HWE_AUTO(PowerOnBISTFailed), | |
1110 | HWE_AUTO(TempsenseTholdReached), | |
1111 | HWE_AUTO(MemoryErr), | |
1112 | HWE_AUTO(PCIeBusParityErr), | |
1113 | HWE_AUTO(PcieCplTimeout), | |
1114 | HWE_AUTO(PciePoisonedTLP), | |
1115 | HWE_AUTO_P(SDmaMemReadErr, 1), | |
1116 | HWE_AUTO_P(SDmaMemReadErr, 0), | |
1117 | HWE_AUTO_P(IBCBusFromSPCParityErr, 1), | |
b9e03e04 | 1118 | HWE_AUTO_P(IBCBusToSPCParityErr, 1), |
f931551b | 1119 | HWE_AUTO_P(IBCBusFromSPCParityErr, 0), |
b9e03e04 | 1120 | HWE_AUTO(statusValidNoEop), |
f931551b RC |
1121 | HWE_AUTO(LATriggered), |
1122 | { .mask = 0 } | |
1123 | }; | |
1124 | ||
1125 | #define E_AUTO(fldname) { .mask = SYM_MASK(ErrMask, fldname##Mask), \ | |
1126 | .msg = #fldname } | |
1127 | #define E_P_AUTO(fldname) { .mask = SYM_MASK(ErrMask_0, fldname##Mask), \ | |
1128 | .msg = #fldname } | |
1129 | static const struct qib_hwerror_msgs qib_7322error_msgs[] = { | |
1130 | E_AUTO(ResetNegated), | |
1131 | E_AUTO(HardwareErr), | |
1132 | E_AUTO(InvalidAddrErr), | |
1133 | E_AUTO(SDmaVL15Err), | |
1134 | E_AUTO(SBufVL15MisUseErr), | |
1135 | E_AUTO(InvalidEEPCmd), | |
1136 | E_AUTO(RcvContextShareErr), | |
1137 | E_AUTO(SendVLMismatchErr), | |
1138 | E_AUTO(SendArmLaunchErr), | |
1139 | E_AUTO(SendSpecialTriggerErr), | |
1140 | E_AUTO(SDmaWrongPortErr), | |
1141 | E_AUTO(SDmaBufMaskDuplicateErr), | |
1142 | E_AUTO(RcvHdrFullErr), | |
1143 | E_AUTO(RcvEgrFullErr), | |
1144 | { .mask = 0 } | |
1145 | }; | |
1146 | ||
1147 | static const struct qib_hwerror_msgs qib_7322p_error_msgs[] = { | |
1148 | E_P_AUTO(IBStatusChanged), | |
1149 | E_P_AUTO(SHeadersErr), | |
1150 | E_P_AUTO(VL15BufMisuseErr), | |
1151 | /* | |
1152 | * SDmaHaltErr is not really an error, make it clearer; | |
1153 | */ | |
1154 | {.mask = SYM_MASK(ErrMask_0, SDmaHaltErrMask), .msg = "SDmaHalted"}, | |
1155 | E_P_AUTO(SDmaDescAddrMisalignErr), | |
1156 | E_P_AUTO(SDmaUnexpDataErr), | |
1157 | E_P_AUTO(SDmaMissingDwErr), | |
1158 | E_P_AUTO(SDmaDwEnErr), | |
1159 | E_P_AUTO(SDmaRpyTagErr), | |
1160 | E_P_AUTO(SDma1stDescErr), | |
1161 | E_P_AUTO(SDmaBaseErr), | |
1162 | E_P_AUTO(SDmaTailOutOfBoundErr), | |
1163 | E_P_AUTO(SDmaOutOfBoundErr), | |
1164 | E_P_AUTO(SDmaGenMismatchErr), | |
1165 | E_P_AUTO(SendBufMisuseErr), | |
1166 | E_P_AUTO(SendUnsupportedVLErr), | |
1167 | E_P_AUTO(SendUnexpectedPktNumErr), | |
1168 | E_P_AUTO(SendDroppedDataPktErr), | |
1169 | E_P_AUTO(SendDroppedSmpPktErr), | |
1170 | E_P_AUTO(SendPktLenErr), | |
1171 | E_P_AUTO(SendUnderRunErr), | |
1172 | E_P_AUTO(SendMaxPktLenErr), | |
1173 | E_P_AUTO(SendMinPktLenErr), | |
1174 | E_P_AUTO(RcvIBLostLinkErr), | |
1175 | E_P_AUTO(RcvHdrErr), | |
1176 | E_P_AUTO(RcvHdrLenErr), | |
1177 | E_P_AUTO(RcvBadTidErr), | |
1178 | E_P_AUTO(RcvBadVersionErr), | |
1179 | E_P_AUTO(RcvIBFlowErr), | |
1180 | E_P_AUTO(RcvEBPErr), | |
1181 | E_P_AUTO(RcvUnsupportedVLErr), | |
1182 | E_P_AUTO(RcvUnexpectedCharErr), | |
1183 | E_P_AUTO(RcvShortPktLenErr), | |
1184 | E_P_AUTO(RcvLongPktLenErr), | |
1185 | E_P_AUTO(RcvMaxPktLenErr), | |
1186 | E_P_AUTO(RcvMinPktLenErr), | |
1187 | E_P_AUTO(RcvICRCErr), | |
1188 | E_P_AUTO(RcvVCRCErr), | |
1189 | E_P_AUTO(RcvFormatErr), | |
1190 | { .mask = 0 } | |
1191 | }; | |
1192 | ||
1193 | /* | |
1194 | * Below generates "auto-message" for interrupts not specific to any port or | |
1195 | * context | |
1196 | */ | |
1197 | #define INTR_AUTO(fldname) { .mask = SYM_MASK(IntMask, fldname##Mask), \ | |
1198 | .msg = #fldname } | |
1199 | /* Below generates "auto-message" for interrupts specific to a port */ | |
1200 | #define INTR_AUTO_P(fldname) { .mask = MASK_ACROSS(\ | |
1201 | SYM_LSB(IntMask, fldname##Mask##_0), \ | |
1202 | SYM_LSB(IntMask, fldname##Mask##_1)), \ | |
1203 | .msg = #fldname "_P" } | |
1204 | /* For some reason, the SerDesTrimDone bits are reversed */ | |
1205 | #define INTR_AUTO_PI(fldname) { .mask = MASK_ACROSS(\ | |
1206 | SYM_LSB(IntMask, fldname##Mask##_1), \ | |
1207 | SYM_LSB(IntMask, fldname##Mask##_0)), \ | |
1208 | .msg = #fldname "_P" } | |
1209 | /* | |
1210 | * Below generates "auto-message" for interrupts specific to a context, | |
1211 | * with ctxt-number appended | |
1212 | */ | |
1213 | #define INTR_AUTO_C(fldname) { .mask = MASK_ACROSS(\ | |
1214 | SYM_LSB(IntMask, fldname##0IntMask), \ | |
1215 | SYM_LSB(IntMask, fldname##17IntMask)), \ | |
1216 | .msg = #fldname "_C"} | |
1217 | ||
1218 | static const struct qib_hwerror_msgs qib_7322_intr_msgs[] = { | |
1219 | INTR_AUTO_P(SDmaInt), | |
1220 | INTR_AUTO_P(SDmaProgressInt), | |
1221 | INTR_AUTO_P(SDmaIdleInt), | |
1222 | INTR_AUTO_P(SDmaCleanupDone), | |
1223 | INTR_AUTO_C(RcvUrg), | |
1224 | INTR_AUTO_P(ErrInt), | |
1225 | INTR_AUTO(ErrInt), /* non-port-specific errs */ | |
1226 | INTR_AUTO(AssertGPIOInt), | |
1227 | INTR_AUTO_P(SendDoneInt), | |
1228 | INTR_AUTO(SendBufAvailInt), | |
1229 | INTR_AUTO_C(RcvAvail), | |
1230 | { .mask = 0 } | |
1231 | }; | |
1232 | ||
1233 | #define TXSYMPTOM_AUTO_P(fldname) \ | |
1234 | { .mask = SYM_MASK(SendHdrErrSymptom_0, fldname), .msg = #fldname } | |
1235 | static const struct qib_hwerror_msgs hdrchk_msgs[] = { | |
1236 | TXSYMPTOM_AUTO_P(NonKeyPacket), | |
1237 | TXSYMPTOM_AUTO_P(GRHFail), | |
1238 | TXSYMPTOM_AUTO_P(PkeyFail), | |
1239 | TXSYMPTOM_AUTO_P(QPFail), | |
1240 | TXSYMPTOM_AUTO_P(SLIDFail), | |
1241 | TXSYMPTOM_AUTO_P(RawIPV6), | |
1242 | TXSYMPTOM_AUTO_P(PacketTooSmall), | |
1243 | { .mask = 0 } | |
1244 | }; | |
1245 | ||
1246 | #define IBA7322_HDRHEAD_PKTINT_SHIFT 32 /* interrupt cnt in upper 32 bits */ | |
1247 | ||
1248 | /* | |
1249 | * Called when we might have an error that is specific to a particular | |
1250 | * PIO buffer, and may need to cancel that buffer, so it can be re-used, | |
1251 | * because we don't need to force the update of pioavail | |
1252 | */ | |
1253 | static void qib_disarm_7322_senderrbufs(struct qib_pportdata *ppd) | |
1254 | { | |
1255 | struct qib_devdata *dd = ppd->dd; | |
1256 | u32 i; | |
1257 | int any; | |
1258 | u32 piobcnt = dd->piobcnt2k + dd->piobcnt4k + NUM_VL15_BUFS; | |
1259 | u32 regcnt = (piobcnt + BITS_PER_LONG - 1) / BITS_PER_LONG; | |
1260 | unsigned long sbuf[4]; | |
1261 | ||
1262 | /* | |
1263 | * It's possible that sendbuffererror could have bits set; might | |
1264 | * have already done this as a result of hardware error handling. | |
1265 | */ | |
1266 | any = 0; | |
1267 | for (i = 0; i < regcnt; ++i) { | |
1268 | sbuf[i] = qib_read_kreg64(dd, kr_sendbuffererror + i); | |
1269 | if (sbuf[i]) { | |
1270 | any = 1; | |
1271 | qib_write_kreg(dd, kr_sendbuffererror + i, sbuf[i]); | |
1272 | } | |
1273 | } | |
1274 | ||
1275 | if (any) | |
1276 | qib_disarm_piobufs_set(dd, sbuf, piobcnt); | |
1277 | } | |
1278 | ||
1279 | /* No txe_recover yet, if ever */ | |
1280 | ||
1281 | /* No decode__errors yet */ | |
1282 | static void err_decode(char *msg, size_t len, u64 errs, | |
1283 | const struct qib_hwerror_msgs *msp) | |
1284 | { | |
1285 | u64 these, lmask; | |
1286 | int took, multi, n = 0; | |
1287 | ||
1288 | while (msp && msp->mask) { | |
1289 | multi = (msp->mask & (msp->mask - 1)); | |
1290 | while (errs & msp->mask) { | |
1291 | these = (errs & msp->mask); | |
1292 | lmask = (these & (these - 1)) ^ these; | |
1293 | if (len) { | |
1294 | if (n++) { | |
1295 | /* separate the strings */ | |
1296 | *msg++ = ','; | |
1297 | len--; | |
1298 | } | |
1299 | took = scnprintf(msg, len, "%s", msp->msg); | |
1300 | len -= took; | |
1301 | msg += took; | |
1302 | } | |
1303 | errs &= ~lmask; | |
1304 | if (len && multi) { | |
1305 | /* More than one bit this mask */ | |
1306 | int idx = -1; | |
1307 | ||
1308 | while (lmask & msp->mask) { | |
1309 | ++idx; | |
1310 | lmask >>= 1; | |
1311 | } | |
1312 | took = scnprintf(msg, len, "_%d", idx); | |
1313 | len -= took; | |
1314 | msg += took; | |
1315 | } | |
1316 | } | |
1317 | ++msp; | |
1318 | } | |
1319 | /* If some bits are left, show in hex. */ | |
1320 | if (len && errs) | |
1321 | snprintf(msg, len, "%sMORE:%llX", n ? "," : "", | |
1322 | (unsigned long long) errs); | |
1323 | } | |
1324 | ||
1325 | /* only called if r1 set */ | |
1326 | static void flush_fifo(struct qib_pportdata *ppd) | |
1327 | { | |
1328 | struct qib_devdata *dd = ppd->dd; | |
1329 | u32 __iomem *piobuf; | |
1330 | u32 bufn; | |
1331 | u32 *hdr; | |
1332 | u64 pbc; | |
1333 | const unsigned hdrwords = 7; | |
1334 | static struct qib_ib_header ibhdr = { | |
1335 | .lrh[0] = cpu_to_be16(0xF000 | QIB_LRH_BTH), | |
1336 | .lrh[1] = IB_LID_PERMISSIVE, | |
1337 | .lrh[2] = cpu_to_be16(hdrwords + SIZE_OF_CRC), | |
1338 | .lrh[3] = IB_LID_PERMISSIVE, | |
1339 | .u.oth.bth[0] = cpu_to_be32( | |
1340 | (IB_OPCODE_UD_SEND_ONLY << 24) | QIB_DEFAULT_P_KEY), | |
1341 | .u.oth.bth[1] = cpu_to_be32(0), | |
1342 | .u.oth.bth[2] = cpu_to_be32(0), | |
1343 | .u.oth.u.ud.deth[0] = cpu_to_be32(0), | |
1344 | .u.oth.u.ud.deth[1] = cpu_to_be32(0), | |
1345 | }; | |
1346 | ||
1347 | /* | |
1348 | * Send a dummy VL15 packet to flush the launch FIFO. | |
1349 | * This will not actually be sent since the TxeBypassIbc bit is set. | |
1350 | */ | |
1351 | pbc = PBC_7322_VL15_SEND | | |
1352 | (((u64)ppd->hw_pidx) << (PBC_PORT_SEL_LSB + 32)) | | |
1353 | (hdrwords + SIZE_OF_CRC); | |
1354 | piobuf = qib_7322_getsendbuf(ppd, pbc, &bufn); | |
1355 | if (!piobuf) | |
1356 | return; | |
1357 | writeq(pbc, piobuf); | |
1358 | hdr = (u32 *) &ibhdr; | |
1359 | if (dd->flags & QIB_PIO_FLUSH_WC) { | |
1360 | qib_flush_wc(); | |
1361 | qib_pio_copy(piobuf + 2, hdr, hdrwords - 1); | |
1362 | qib_flush_wc(); | |
1363 | __raw_writel(hdr[hdrwords - 1], piobuf + hdrwords + 1); | |
1364 | qib_flush_wc(); | |
1365 | } else | |
1366 | qib_pio_copy(piobuf + 2, hdr, hdrwords); | |
1367 | qib_sendbuf_done(dd, bufn); | |
1368 | } | |
1369 | ||
1370 | /* | |
1371 | * This is called with interrupts disabled and sdma_lock held. | |
1372 | */ | |
1373 | static void qib_7322_sdma_sendctrl(struct qib_pportdata *ppd, unsigned op) | |
1374 | { | |
1375 | struct qib_devdata *dd = ppd->dd; | |
1376 | u64 set_sendctrl = 0; | |
1377 | u64 clr_sendctrl = 0; | |
1378 | ||
1379 | if (op & QIB_SDMA_SENDCTRL_OP_ENABLE) | |
1380 | set_sendctrl |= SYM_MASK(SendCtrl_0, SDmaEnable); | |
1381 | else | |
1382 | clr_sendctrl |= SYM_MASK(SendCtrl_0, SDmaEnable); | |
1383 | ||
1384 | if (op & QIB_SDMA_SENDCTRL_OP_INTENABLE) | |
1385 | set_sendctrl |= SYM_MASK(SendCtrl_0, SDmaIntEnable); | |
1386 | else | |
1387 | clr_sendctrl |= SYM_MASK(SendCtrl_0, SDmaIntEnable); | |
1388 | ||
1389 | if (op & QIB_SDMA_SENDCTRL_OP_HALT) | |
1390 | set_sendctrl |= SYM_MASK(SendCtrl_0, SDmaHalt); | |
1391 | else | |
1392 | clr_sendctrl |= SYM_MASK(SendCtrl_0, SDmaHalt); | |
1393 | ||
1394 | if (op & QIB_SDMA_SENDCTRL_OP_DRAIN) | |
1395 | set_sendctrl |= SYM_MASK(SendCtrl_0, TxeBypassIbc) | | |
1396 | SYM_MASK(SendCtrl_0, TxeAbortIbc) | | |
1397 | SYM_MASK(SendCtrl_0, TxeDrainRmFifo); | |
1398 | else | |
1399 | clr_sendctrl |= SYM_MASK(SendCtrl_0, TxeBypassIbc) | | |
1400 | SYM_MASK(SendCtrl_0, TxeAbortIbc) | | |
1401 | SYM_MASK(SendCtrl_0, TxeDrainRmFifo); | |
1402 | ||
1403 | spin_lock(&dd->sendctrl_lock); | |
1404 | ||
1405 | /* If we are draining everything, block sends first */ | |
1406 | if (op & QIB_SDMA_SENDCTRL_OP_DRAIN) { | |
1407 | ppd->p_sendctrl &= ~SYM_MASK(SendCtrl_0, SendEnable); | |
1408 | qib_write_kreg_port(ppd, krp_sendctrl, ppd->p_sendctrl); | |
1409 | qib_write_kreg(dd, kr_scratch, 0); | |
1410 | } | |
1411 | ||
1412 | ppd->p_sendctrl |= set_sendctrl; | |
1413 | ppd->p_sendctrl &= ~clr_sendctrl; | |
1414 | ||
1415 | if (op & QIB_SDMA_SENDCTRL_OP_CLEANUP) | |
1416 | qib_write_kreg_port(ppd, krp_sendctrl, | |
1417 | ppd->p_sendctrl | | |
1418 | SYM_MASK(SendCtrl_0, SDmaCleanup)); | |
1419 | else | |
1420 | qib_write_kreg_port(ppd, krp_sendctrl, ppd->p_sendctrl); | |
1421 | qib_write_kreg(dd, kr_scratch, 0); | |
1422 | ||
1423 | if (op & QIB_SDMA_SENDCTRL_OP_DRAIN) { | |
1424 | ppd->p_sendctrl |= SYM_MASK(SendCtrl_0, SendEnable); | |
1425 | qib_write_kreg_port(ppd, krp_sendctrl, ppd->p_sendctrl); | |
1426 | qib_write_kreg(dd, kr_scratch, 0); | |
1427 | } | |
1428 | ||
1429 | spin_unlock(&dd->sendctrl_lock); | |
1430 | ||
1431 | if ((op & QIB_SDMA_SENDCTRL_OP_DRAIN) && ppd->dd->cspec->r1) | |
1432 | flush_fifo(ppd); | |
1433 | } | |
1434 | ||
1435 | static void qib_7322_sdma_hw_clean_up(struct qib_pportdata *ppd) | |
1436 | { | |
1437 | __qib_sdma_process_event(ppd, qib_sdma_event_e50_hw_cleaned); | |
1438 | } | |
1439 | ||
1440 | static void qib_sdma_7322_setlengen(struct qib_pportdata *ppd) | |
1441 | { | |
1442 | /* | |
1443 | * Set SendDmaLenGen and clear and set | |
1444 | * the MSB of the generation count to enable generation checking | |
1445 | * and load the internal generation counter. | |
1446 | */ | |
1447 | qib_write_kreg_port(ppd, krp_senddmalengen, ppd->sdma_descq_cnt); | |
1448 | qib_write_kreg_port(ppd, krp_senddmalengen, | |
1449 | ppd->sdma_descq_cnt | | |
1450 | (1ULL << QIB_7322_SendDmaLenGen_0_Generation_MSB)); | |
1451 | } | |
1452 | ||
1453 | /* | |
1454 | * Must be called with sdma_lock held, or before init finished. | |
1455 | */ | |
1456 | static void qib_sdma_update_7322_tail(struct qib_pportdata *ppd, u16 tail) | |
1457 | { | |
1458 | /* Commit writes to memory and advance the tail on the chip */ | |
1459 | wmb(); | |
1460 | ppd->sdma_descq_tail = tail; | |
1461 | qib_write_kreg_port(ppd, krp_senddmatail, tail); | |
1462 | } | |
1463 | ||
1464 | /* | |
1465 | * This is called with interrupts disabled and sdma_lock held. | |
1466 | */ | |
1467 | static void qib_7322_sdma_hw_start_up(struct qib_pportdata *ppd) | |
1468 | { | |
1469 | /* | |
1470 | * Drain all FIFOs. | |
1471 | * The hardware doesn't require this but we do it so that verbs | |
1472 | * and user applications don't wait for link active to send stale | |
1473 | * data. | |
1474 | */ | |
1475 | sendctrl_7322_mod(ppd, QIB_SENDCTRL_FLUSH); | |
1476 | ||
1477 | qib_sdma_7322_setlengen(ppd); | |
1478 | qib_sdma_update_7322_tail(ppd, 0); /* Set SendDmaTail */ | |
1479 | ppd->sdma_head_dma[0] = 0; | |
1480 | qib_7322_sdma_sendctrl(ppd, | |
1481 | ppd->sdma_state.current_op | QIB_SDMA_SENDCTRL_OP_CLEANUP); | |
1482 | } | |
1483 | ||
1484 | #define DISABLES_SDMA ( \ | |
1485 | QIB_E_P_SDMAHALT | \ | |
1486 | QIB_E_P_SDMADESCADDRMISALIGN | \ | |
1487 | QIB_E_P_SDMAMISSINGDW | \ | |
1488 | QIB_E_P_SDMADWEN | \ | |
1489 | QIB_E_P_SDMARPYTAG | \ | |
1490 | QIB_E_P_SDMA1STDESC | \ | |
1491 | QIB_E_P_SDMABASE | \ | |
1492 | QIB_E_P_SDMATAILOUTOFBOUND | \ | |
1493 | QIB_E_P_SDMAOUTOFBOUND | \ | |
1494 | QIB_E_P_SDMAGENMISMATCH) | |
1495 | ||
1496 | static void sdma_7322_p_errors(struct qib_pportdata *ppd, u64 errs) | |
1497 | { | |
1498 | unsigned long flags; | |
1499 | struct qib_devdata *dd = ppd->dd; | |
1500 | ||
1501 | errs &= QIB_E_P_SDMAERRS; | |
1502 | ||
1503 | if (errs & QIB_E_P_SDMAUNEXPDATA) | |
1504 | qib_dev_err(dd, "IB%u:%u SDmaUnexpData\n", dd->unit, | |
1505 | ppd->port); | |
1506 | ||
1507 | spin_lock_irqsave(&ppd->sdma_lock, flags); | |
1508 | ||
1509 | switch (ppd->sdma_state.current_state) { | |
1510 | case qib_sdma_state_s00_hw_down: | |
1511 | break; | |
1512 | ||
1513 | case qib_sdma_state_s10_hw_start_up_wait: | |
1514 | if (errs & QIB_E_P_SDMAHALT) | |
1515 | __qib_sdma_process_event(ppd, | |
1516 | qib_sdma_event_e20_hw_started); | |
1517 | break; | |
1518 | ||
1519 | case qib_sdma_state_s20_idle: | |
1520 | break; | |
1521 | ||
1522 | case qib_sdma_state_s30_sw_clean_up_wait: | |
1523 | break; | |
1524 | ||
1525 | case qib_sdma_state_s40_hw_clean_up_wait: | |
1526 | if (errs & QIB_E_P_SDMAHALT) | |
1527 | __qib_sdma_process_event(ppd, | |
1528 | qib_sdma_event_e50_hw_cleaned); | |
1529 | break; | |
1530 | ||
1531 | case qib_sdma_state_s50_hw_halt_wait: | |
1532 | if (errs & QIB_E_P_SDMAHALT) | |
1533 | __qib_sdma_process_event(ppd, | |
1534 | qib_sdma_event_e60_hw_halted); | |
1535 | break; | |
1536 | ||
1537 | case qib_sdma_state_s99_running: | |
1538 | __qib_sdma_process_event(ppd, qib_sdma_event_e7322_err_halted); | |
1539 | __qib_sdma_process_event(ppd, qib_sdma_event_e60_hw_halted); | |
1540 | break; | |
1541 | } | |
1542 | ||
1543 | spin_unlock_irqrestore(&ppd->sdma_lock, flags); | |
1544 | } | |
1545 | ||
1546 | /* | |
1547 | * handle per-device errors (not per-port errors) | |
1548 | */ | |
1549 | static noinline void handle_7322_errors(struct qib_devdata *dd) | |
1550 | { | |
1551 | char *msg; | |
1552 | u64 iserr = 0; | |
1553 | u64 errs; | |
1554 | u64 mask; | |
1555 | int log_idx; | |
1556 | ||
1557 | qib_stats.sps_errints++; | |
1558 | errs = qib_read_kreg64(dd, kr_errstatus); | |
1559 | if (!errs) { | |
1560 | qib_devinfo(dd->pcidev, "device error interrupt, " | |
1561 | "but no error bits set!\n"); | |
1562 | goto done; | |
1563 | } | |
1564 | ||
1565 | /* don't report errors that are masked */ | |
1566 | errs &= dd->cspec->errormask; | |
1567 | msg = dd->cspec->emsgbuf; | |
1568 | ||
1569 | /* do these first, they are most important */ | |
1570 | if (errs & QIB_E_HARDWARE) { | |
1571 | *msg = '\0'; | |
1572 | qib_7322_handle_hwerrors(dd, msg, sizeof dd->cspec->emsgbuf); | |
1573 | } else | |
1574 | for (log_idx = 0; log_idx < QIB_EEP_LOG_CNT; ++log_idx) | |
1575 | if (errs & dd->eep_st_masks[log_idx].errs_to_log) | |
1576 | qib_inc_eeprom_err(dd, log_idx, 1); | |
1577 | ||
1578 | if (errs & QIB_E_SPKTERRS) { | |
1579 | qib_disarm_7322_senderrbufs(dd->pport); | |
1580 | qib_stats.sps_txerrs++; | |
1581 | } else if (errs & QIB_E_INVALIDADDR) | |
1582 | qib_stats.sps_txerrs++; | |
1583 | else if (errs & QIB_E_ARMLAUNCH) { | |
1584 | qib_stats.sps_txerrs++; | |
1585 | qib_disarm_7322_senderrbufs(dd->pport); | |
1586 | } | |
1587 | qib_write_kreg(dd, kr_errclear, errs); | |
1588 | ||
1589 | /* | |
1590 | * The ones we mask off are handled specially below | |
1591 | * or above. Also mask SDMADISABLED by default as it | |
1592 | * is too chatty. | |
1593 | */ | |
1594 | mask = QIB_E_HARDWARE; | |
1595 | *msg = '\0'; | |
1596 | ||
1597 | err_decode(msg, sizeof dd->cspec->emsgbuf, errs & ~mask, | |
1598 | qib_7322error_msgs); | |
1599 | ||
1600 | /* | |
1601 | * Getting reset is a tragedy for all ports. Mark the device | |
1602 | * _and_ the ports as "offline" in way meaningful to each. | |
1603 | */ | |
1604 | if (errs & QIB_E_RESET) { | |
1605 | int pidx; | |
1606 | ||
1607 | qib_dev_err(dd, "Got reset, requires re-init " | |
1608 | "(unload and reload driver)\n"); | |
1609 | dd->flags &= ~QIB_INITTED; /* needs re-init */ | |
1610 | /* mark as having had error */ | |
1611 | *dd->devstatusp |= QIB_STATUS_HWERROR; | |
1612 | for (pidx = 0; pidx < dd->num_pports; ++pidx) | |
1613 | if (dd->pport[pidx].link_speed_supported) | |
1614 | *dd->pport[pidx].statusp &= ~QIB_STATUS_IB_CONF; | |
1615 | } | |
1616 | ||
1617 | if (*msg && iserr) | |
1618 | qib_dev_err(dd, "%s error\n", msg); | |
1619 | ||
1620 | /* | |
1621 | * If there were hdrq or egrfull errors, wake up any processes | |
1622 | * waiting in poll. We used to try to check which contexts had | |
1623 | * the overflow, but given the cost of that and the chip reads | |
1624 | * to support it, it's better to just wake everybody up if we | |
1625 | * get an overflow; waiters can poll again if it's not them. | |
1626 | */ | |
1627 | if (errs & (ERR_MASK(RcvEgrFullErr) | ERR_MASK(RcvHdrFullErr))) { | |
1628 | qib_handle_urcv(dd, ~0U); | |
1629 | if (errs & ERR_MASK(RcvEgrFullErr)) | |
1630 | qib_stats.sps_buffull++; | |
1631 | else | |
1632 | qib_stats.sps_hdrfull++; | |
1633 | } | |
1634 | ||
1635 | done: | |
1636 | return; | |
1637 | } | |
1638 | ||
1639 | static void reenable_chase(unsigned long opaque) | |
1640 | { | |
1641 | struct qib_pportdata *ppd = (struct qib_pportdata *)opaque; | |
1642 | ||
1643 | ppd->cpspec->chase_timer.expires = 0; | |
1644 | qib_set_ib_7322_lstate(ppd, QLOGIC_IB_IBCC_LINKCMD_DOWN, | |
1645 | QLOGIC_IB_IBCC_LINKINITCMD_POLL); | |
1646 | } | |
1647 | ||
1648 | static void disable_chase(struct qib_pportdata *ppd, u64 tnow, u8 ibclt) | |
1649 | { | |
1650 | ppd->cpspec->chase_end = 0; | |
1651 | ||
1652 | if (!qib_chase) | |
1653 | return; | |
1654 | ||
1655 | qib_set_ib_7322_lstate(ppd, QLOGIC_IB_IBCC_LINKCMD_DOWN, | |
1656 | QLOGIC_IB_IBCC_LINKINITCMD_DISABLE); | |
1657 | ppd->cpspec->chase_timer.expires = jiffies + QIB_CHASE_DIS_TIME; | |
1658 | add_timer(&ppd->cpspec->chase_timer); | |
1659 | } | |
1660 | ||
1661 | static void handle_serdes_issues(struct qib_pportdata *ppd, u64 ibcst) | |
1662 | { | |
1663 | u8 ibclt; | |
1664 | u64 tnow; | |
1665 | ||
1666 | ibclt = (u8)SYM_FIELD(ibcst, IBCStatusA_0, LinkTrainingState); | |
1667 | ||
1668 | /* | |
1669 | * Detect and handle the state chase issue, where we can | |
1670 | * get stuck if we are unlucky on timing on both sides of | |
1671 | * the link. If we are, we disable, set a timer, and | |
1672 | * then re-enable. | |
1673 | */ | |
1674 | switch (ibclt) { | |
1675 | case IB_7322_LT_STATE_CFGRCVFCFG: | |
1676 | case IB_7322_LT_STATE_CFGWAITRMT: | |
1677 | case IB_7322_LT_STATE_TXREVLANES: | |
1678 | case IB_7322_LT_STATE_CFGENH: | |
1679 | tnow = get_jiffies_64(); | |
1680 | if (ppd->cpspec->chase_end && | |
1681 | time_after64(tnow, ppd->cpspec->chase_end)) | |
1682 | disable_chase(ppd, tnow, ibclt); | |
1683 | else if (!ppd->cpspec->chase_end) | |
1684 | ppd->cpspec->chase_end = tnow + QIB_CHASE_TIME; | |
1685 | break; | |
1686 | default: | |
1687 | ppd->cpspec->chase_end = 0; | |
1688 | break; | |
1689 | } | |
1690 | ||
1691 | if (ibclt == IB_7322_LT_STATE_CFGTEST && | |
1692 | (ibcst & SYM_MASK(IBCStatusA_0, LinkSpeedQDR))) { | |
1693 | force_h1(ppd); | |
1694 | ppd->cpspec->qdr_reforce = 1; | |
1695 | } else if (ppd->cpspec->qdr_reforce && | |
1696 | (ibcst & SYM_MASK(IBCStatusA_0, LinkSpeedQDR)) && | |
1697 | (ibclt == IB_7322_LT_STATE_CFGENH || | |
1698 | ibclt == IB_7322_LT_STATE_CFGIDLE || | |
1699 | ibclt == IB_7322_LT_STATE_LINKUP)) | |
1700 | force_h1(ppd); | |
1701 | ||
1702 | if ((IS_QMH(ppd->dd) || IS_QME(ppd->dd)) && | |
1703 | ppd->link_speed_enabled == QIB_IB_QDR && | |
1704 | (ibclt == IB_7322_LT_STATE_CFGTEST || | |
1705 | ibclt == IB_7322_LT_STATE_CFGENH || | |
1706 | (ibclt >= IB_7322_LT_STATE_POLLACTIVE && | |
1707 | ibclt <= IB_7322_LT_STATE_SLEEPQUIET))) | |
1708 | adj_tx_serdes(ppd); | |
1709 | ||
1710 | if (!ppd->cpspec->qdr_dfe_on && ibclt != IB_7322_LT_STATE_LINKUP && | |
1711 | ibclt <= IB_7322_LT_STATE_SLEEPQUIET) { | |
1712 | ppd->cpspec->qdr_dfe_on = 1; | |
1713 | ppd->cpspec->qdr_dfe_time = 0; | |
1714 | /* On link down, reenable QDR adaptation */ | |
1715 | qib_write_kreg_port(ppd, krp_static_adapt_dis(2), | |
1716 | ppd->dd->cspec->r1 ? | |
1717 | QDR_STATIC_ADAPT_DOWN_R1 : | |
1718 | QDR_STATIC_ADAPT_DOWN); | |
1719 | } | |
1720 | } | |
1721 | ||
1722 | /* | |
1723 | * This is per-pport error handling. | |
1724 | * will likely get it's own MSIx interrupt (one for each port, | |
1725 | * although just a single handler). | |
1726 | */ | |
1727 | static noinline void handle_7322_p_errors(struct qib_pportdata *ppd) | |
1728 | { | |
1729 | char *msg; | |
1730 | u64 ignore_this_time = 0, iserr = 0, errs, fmask; | |
1731 | struct qib_devdata *dd = ppd->dd; | |
1732 | ||
1733 | /* do this as soon as possible */ | |
1734 | fmask = qib_read_kreg64(dd, kr_act_fmask); | |
1735 | if (!fmask) | |
1736 | check_7322_rxe_status(ppd); | |
1737 | ||
1738 | errs = qib_read_kreg_port(ppd, krp_errstatus); | |
1739 | if (!errs) | |
1740 | qib_devinfo(dd->pcidev, | |
1741 | "Port%d error interrupt, but no error bits set!\n", | |
1742 | ppd->port); | |
1743 | if (!fmask) | |
1744 | errs &= ~QIB_E_P_IBSTATUSCHANGED; | |
1745 | if (!errs) | |
1746 | goto done; | |
1747 | ||
1748 | msg = ppd->cpspec->epmsgbuf; | |
1749 | *msg = '\0'; | |
1750 | ||
1751 | if (errs & ~QIB_E_P_BITSEXTANT) { | |
1752 | err_decode(msg, sizeof ppd->cpspec->epmsgbuf, | |
1753 | errs & ~QIB_E_P_BITSEXTANT, qib_7322p_error_msgs); | |
1754 | if (!*msg) | |
1755 | snprintf(msg, sizeof ppd->cpspec->epmsgbuf, | |
1756 | "no others"); | |
1757 | qib_dev_porterr(dd, ppd->port, "error interrupt with unknown" | |
1758 | " errors 0x%016Lx set (and %s)\n", | |
1759 | (errs & ~QIB_E_P_BITSEXTANT), msg); | |
1760 | *msg = '\0'; | |
1761 | } | |
1762 | ||
1763 | if (errs & QIB_E_P_SHDR) { | |
1764 | u64 symptom; | |
1765 | ||
1766 | /* determine cause, then write to clear */ | |
1767 | symptom = qib_read_kreg_port(ppd, krp_sendhdrsymptom); | |
1768 | qib_write_kreg_port(ppd, krp_sendhdrsymptom, 0); | |
1769 | err_decode(msg, sizeof ppd->cpspec->epmsgbuf, symptom, | |
1770 | hdrchk_msgs); | |
1771 | *msg = '\0'; | |
1772 | /* senderrbuf cleared in SPKTERRS below */ | |
1773 | } | |
1774 | ||
1775 | if (errs & QIB_E_P_SPKTERRS) { | |
1776 | if ((errs & QIB_E_P_LINK_PKTERRS) && | |
1777 | !(ppd->lflags & QIBL_LINKACTIVE)) { | |
1778 | /* | |
1779 | * This can happen when trying to bring the link | |
1780 | * up, but the IB link changes state at the "wrong" | |
1781 | * time. The IB logic then complains that the packet | |
1782 | * isn't valid. We don't want to confuse people, so | |
1783 | * we just don't print them, except at debug | |
1784 | */ | |
1785 | err_decode(msg, sizeof ppd->cpspec->epmsgbuf, | |
1786 | (errs & QIB_E_P_LINK_PKTERRS), | |
1787 | qib_7322p_error_msgs); | |
1788 | *msg = '\0'; | |
1789 | ignore_this_time = errs & QIB_E_P_LINK_PKTERRS; | |
1790 | } | |
1791 | qib_disarm_7322_senderrbufs(ppd); | |
1792 | } else if ((errs & QIB_E_P_LINK_PKTERRS) && | |
1793 | !(ppd->lflags & QIBL_LINKACTIVE)) { | |
1794 | /* | |
1795 | * This can happen when SMA is trying to bring the link | |
1796 | * up, but the IB link changes state at the "wrong" time. | |
1797 | * The IB logic then complains that the packet isn't | |
1798 | * valid. We don't want to confuse people, so we just | |
1799 | * don't print them, except at debug | |
1800 | */ | |
1801 | err_decode(msg, sizeof ppd->cpspec->epmsgbuf, errs, | |
1802 | qib_7322p_error_msgs); | |
1803 | ignore_this_time = errs & QIB_E_P_LINK_PKTERRS; | |
1804 | *msg = '\0'; | |
1805 | } | |
1806 | ||
1807 | qib_write_kreg_port(ppd, krp_errclear, errs); | |
1808 | ||
1809 | errs &= ~ignore_this_time; | |
1810 | if (!errs) | |
1811 | goto done; | |
1812 | ||
1813 | if (errs & QIB_E_P_RPKTERRS) | |
1814 | qib_stats.sps_rcverrs++; | |
1815 | if (errs & QIB_E_P_SPKTERRS) | |
1816 | qib_stats.sps_txerrs++; | |
1817 | ||
1818 | iserr = errs & ~(QIB_E_P_RPKTERRS | QIB_E_P_PKTERRS); | |
1819 | ||
1820 | if (errs & QIB_E_P_SDMAERRS) | |
1821 | sdma_7322_p_errors(ppd, errs); | |
1822 | ||
1823 | if (errs & QIB_E_P_IBSTATUSCHANGED) { | |
1824 | u64 ibcs; | |
1825 | u8 ltstate; | |
1826 | ||
1827 | ibcs = qib_read_kreg_port(ppd, krp_ibcstatus_a); | |
1828 | ltstate = qib_7322_phys_portstate(ibcs); | |
1829 | ||
1830 | if (!(ppd->lflags & QIBL_IB_AUTONEG_INPROG)) | |
1831 | handle_serdes_issues(ppd, ibcs); | |
1832 | if (!(ppd->cpspec->ibcctrl_a & | |
1833 | SYM_MASK(IBCCtrlA_0, IBStatIntReductionEn))) { | |
1834 | /* | |
1835 | * We got our interrupt, so init code should be | |
1836 | * happy and not try alternatives. Now squelch | |
1837 | * other "chatter" from link-negotiation (pre Init) | |
1838 | */ | |
1839 | ppd->cpspec->ibcctrl_a |= | |
1840 | SYM_MASK(IBCCtrlA_0, IBStatIntReductionEn); | |
1841 | qib_write_kreg_port(ppd, krp_ibcctrl_a, | |
1842 | ppd->cpspec->ibcctrl_a); | |
1843 | } | |
1844 | ||
1845 | /* Update our picture of width and speed from chip */ | |
1846 | ppd->link_width_active = | |
1847 | (ibcs & SYM_MASK(IBCStatusA_0, LinkWidthActive)) ? | |
1848 | IB_WIDTH_4X : IB_WIDTH_1X; | |
1849 | ppd->link_speed_active = (ibcs & SYM_MASK(IBCStatusA_0, | |
1850 | LinkSpeedQDR)) ? QIB_IB_QDR : (ibcs & | |
1851 | SYM_MASK(IBCStatusA_0, LinkSpeedActive)) ? | |
1852 | QIB_IB_DDR : QIB_IB_SDR; | |
1853 | ||
1854 | if ((ppd->lflags & QIBL_IB_LINK_DISABLED) && ltstate != | |
1855 | IB_PHYSPORTSTATE_DISABLED) | |
1856 | qib_set_ib_7322_lstate(ppd, 0, | |
1857 | QLOGIC_IB_IBCC_LINKINITCMD_DISABLE); | |
1858 | else | |
1859 | /* | |
1860 | * Since going into a recovery state causes the link | |
1861 | * state to go down and since recovery is transitory, | |
1862 | * it is better if we "miss" ever seeing the link | |
1863 | * training state go into recovery (i.e., ignore this | |
1864 | * transition for link state special handling purposes) | |
1865 | * without updating lastibcstat. | |
1866 | */ | |
1867 | if (ltstate != IB_PHYSPORTSTATE_LINK_ERR_RECOVER && | |
1868 | ltstate != IB_PHYSPORTSTATE_RECOVERY_RETRAIN && | |
1869 | ltstate != IB_PHYSPORTSTATE_RECOVERY_WAITRMT && | |
1870 | ltstate != IB_PHYSPORTSTATE_RECOVERY_IDLE) | |
1871 | qib_handle_e_ibstatuschanged(ppd, ibcs); | |
1872 | } | |
1873 | if (*msg && iserr) | |
1874 | qib_dev_porterr(dd, ppd->port, "%s error\n", msg); | |
1875 | ||
1876 | if (ppd->state_wanted & ppd->lflags) | |
1877 | wake_up_interruptible(&ppd->state_wait); | |
1878 | done: | |
1879 | return; | |
1880 | } | |
1881 | ||
1882 | /* enable/disable chip from delivering interrupts */ | |
1883 | static void qib_7322_set_intr_state(struct qib_devdata *dd, u32 enable) | |
1884 | { | |
1885 | if (enable) { | |
1886 | if (dd->flags & QIB_BADINTR) | |
1887 | return; | |
1888 | qib_write_kreg(dd, kr_intmask, dd->cspec->int_enable_mask); | |
1889 | /* cause any pending enabled interrupts to be re-delivered */ | |
1890 | qib_write_kreg(dd, kr_intclear, 0ULL); | |
1891 | if (dd->cspec->num_msix_entries) { | |
1892 | /* and same for MSIx */ | |
1893 | u64 val = qib_read_kreg64(dd, kr_intgranted); | |
1894 | if (val) | |
1895 | qib_write_kreg(dd, kr_intgranted, val); | |
1896 | } | |
1897 | } else | |
1898 | qib_write_kreg(dd, kr_intmask, 0ULL); | |
1899 | } | |
1900 | ||
1901 | /* | |
1902 | * Try to cleanup as much as possible for anything that might have gone | |
1903 | * wrong while in freeze mode, such as pio buffers being written by user | |
1904 | * processes (causing armlaunch), send errors due to going into freeze mode, | |
1905 | * etc., and try to avoid causing extra interrupts while doing so. | |
1906 | * Forcibly update the in-memory pioavail register copies after cleanup | |
1907 | * because the chip won't do it while in freeze mode (the register values | |
1908 | * themselves are kept correct). | |
1909 | * Make sure that we don't lose any important interrupts by using the chip | |
1910 | * feature that says that writing 0 to a bit in *clear that is set in | |
1911 | * *status will cause an interrupt to be generated again (if allowed by | |
1912 | * the *mask value). | |
1913 | * This is in chip-specific code because of all of the register accesses, | |
1914 | * even though the details are similar on most chips. | |
1915 | */ | |
1916 | static void qib_7322_clear_freeze(struct qib_devdata *dd) | |
1917 | { | |
1918 | int pidx; | |
1919 | ||
1920 | /* disable error interrupts, to avoid confusion */ | |
1921 | qib_write_kreg(dd, kr_errmask, 0ULL); | |
1922 | ||
1923 | for (pidx = 0; pidx < dd->num_pports; ++pidx) | |
1924 | if (dd->pport[pidx].link_speed_supported) | |
1925 | qib_write_kreg_port(dd->pport + pidx, krp_errmask, | |
1926 | 0ULL); | |
1927 | ||
1928 | /* also disable interrupts; errormask is sometimes overwriten */ | |
1929 | qib_7322_set_intr_state(dd, 0); | |
1930 | ||
1931 | /* clear the freeze, and be sure chip saw it */ | |
1932 | qib_write_kreg(dd, kr_control, dd->control); | |
1933 | qib_read_kreg32(dd, kr_scratch); | |
1934 | ||
1935 | /* | |
1936 | * Force new interrupt if any hwerr, error or interrupt bits are | |
1937 | * still set, and clear "safe" send packet errors related to freeze | |
1938 | * and cancelling sends. Re-enable error interrupts before possible | |
1939 | * force of re-interrupt on pending interrupts. | |
1940 | */ | |
1941 | qib_write_kreg(dd, kr_hwerrclear, 0ULL); | |
1942 | qib_write_kreg(dd, kr_errclear, E_SPKT_ERRS_IGNORE); | |
1943 | qib_write_kreg(dd, kr_errmask, dd->cspec->errormask); | |
1944 | /* We need to purge per-port errs and reset mask, too */ | |
1945 | for (pidx = 0; pidx < dd->num_pports; ++pidx) { | |
1946 | if (!dd->pport[pidx].link_speed_supported) | |
1947 | continue; | |
1948 | qib_write_kreg_port(dd->pport + pidx, krp_errclear, ~0Ull); | |
1949 | qib_write_kreg_port(dd->pport + pidx, krp_errmask, ~0Ull); | |
1950 | } | |
1951 | qib_7322_set_intr_state(dd, 1); | |
1952 | } | |
1953 | ||
1954 | /* no error handling to speak of */ | |
1955 | /** | |
1956 | * qib_7322_handle_hwerrors - display hardware errors. | |
1957 | * @dd: the qlogic_ib device | |
1958 | * @msg: the output buffer | |
1959 | * @msgl: the size of the output buffer | |
1960 | * | |
1961 | * Use same msg buffer as regular errors to avoid excessive stack | |
1962 | * use. Most hardware errors are catastrophic, but for right now, | |
1963 | * we'll print them and continue. We reuse the same message buffer as | |
1964 | * qib_handle_errors() to avoid excessive stack usage. | |
1965 | */ | |
1966 | static void qib_7322_handle_hwerrors(struct qib_devdata *dd, char *msg, | |
1967 | size_t msgl) | |
1968 | { | |
1969 | u64 hwerrs; | |
1970 | u32 ctrl; | |
1971 | int isfatal = 0; | |
1972 | ||
1973 | hwerrs = qib_read_kreg64(dd, kr_hwerrstatus); | |
1974 | if (!hwerrs) | |
1975 | goto bail; | |
1976 | if (hwerrs == ~0ULL) { | |
1977 | qib_dev_err(dd, "Read of hardware error status failed " | |
1978 | "(all bits set); ignoring\n"); | |
1979 | goto bail; | |
1980 | } | |
1981 | qib_stats.sps_hwerrs++; | |
1982 | ||
1983 | /* Always clear the error status register, except BIST fail */ | |
1984 | qib_write_kreg(dd, kr_hwerrclear, hwerrs & | |
1985 | ~HWE_MASK(PowerOnBISTFailed)); | |
1986 | ||
1987 | hwerrs &= dd->cspec->hwerrmask; | |
1988 | ||
1989 | /* no EEPROM logging, yet */ | |
1990 | ||
1991 | if (hwerrs) | |
1992 | qib_devinfo(dd->pcidev, "Hardware error: hwerr=0x%llx " | |
1993 | "(cleared)\n", (unsigned long long) hwerrs); | |
1994 | ||
1995 | ctrl = qib_read_kreg32(dd, kr_control); | |
1996 | if ((ctrl & SYM_MASK(Control, FreezeMode)) && !dd->diag_client) { | |
1997 | /* | |
1998 | * No recovery yet... | |
1999 | */ | |
2000 | if ((hwerrs & ~HWE_MASK(LATriggered)) || | |
2001 | dd->cspec->stay_in_freeze) { | |
2002 | /* | |
2003 | * If any set that we aren't ignoring only make the | |
2004 | * complaint once, in case it's stuck or recurring, | |
2005 | * and we get here multiple times | |
2006 | * Force link down, so switch knows, and | |
2007 | * LEDs are turned off. | |
2008 | */ | |
2009 | if (dd->flags & QIB_INITTED) | |
2010 | isfatal = 1; | |
2011 | } else | |
2012 | qib_7322_clear_freeze(dd); | |
2013 | } | |
2014 | ||
2015 | if (hwerrs & HWE_MASK(PowerOnBISTFailed)) { | |
2016 | isfatal = 1; | |
2017 | strlcpy(msg, "[Memory BIST test failed, " | |
2018 | "InfiniPath hardware unusable]", msgl); | |
2019 | /* ignore from now on, so disable until driver reloaded */ | |
2020 | dd->cspec->hwerrmask &= ~HWE_MASK(PowerOnBISTFailed); | |
2021 | qib_write_kreg(dd, kr_hwerrmask, dd->cspec->hwerrmask); | |
2022 | } | |
2023 | ||
2024 | err_decode(msg, msgl, hwerrs, qib_7322_hwerror_msgs); | |
2025 | ||
2026 | /* Ignore esoteric PLL failures et al. */ | |
2027 | ||
2028 | qib_dev_err(dd, "%s hardware error\n", msg); | |
2029 | ||
2030 | if (isfatal && !dd->diag_client) { | |
2031 | qib_dev_err(dd, "Fatal Hardware Error, no longer" | |
2032 | " usable, SN %.16s\n", dd->serial); | |
2033 | /* | |
2034 | * for /sys status file and user programs to print; if no | |
2035 | * trailing brace is copied, we'll know it was truncated. | |
2036 | */ | |
2037 | if (dd->freezemsg) | |
2038 | snprintf(dd->freezemsg, dd->freezelen, | |
2039 | "{%s}", msg); | |
2040 | qib_disable_after_error(dd); | |
2041 | } | |
2042 | bail:; | |
2043 | } | |
2044 | ||
2045 | /** | |
2046 | * qib_7322_init_hwerrors - enable hardware errors | |
2047 | * @dd: the qlogic_ib device | |
2048 | * | |
2049 | * now that we have finished initializing everything that might reasonably | |
2050 | * cause a hardware error, and cleared those errors bits as they occur, | |
2051 | * we can enable hardware errors in the mask (potentially enabling | |
2052 | * freeze mode), and enable hardware errors as errors (along with | |
2053 | * everything else) in errormask | |
2054 | */ | |
2055 | static void qib_7322_init_hwerrors(struct qib_devdata *dd) | |
2056 | { | |
2057 | int pidx; | |
2058 | u64 extsval; | |
2059 | ||
2060 | extsval = qib_read_kreg64(dd, kr_extstatus); | |
2061 | if (!(extsval & (QIB_EXTS_MEMBIST_DISABLED | | |
2062 | QIB_EXTS_MEMBIST_ENDTEST))) | |
2063 | qib_dev_err(dd, "MemBIST did not complete!\n"); | |
2064 | ||
2065 | /* never clear BIST failure, so reported on each driver load */ | |
2066 | qib_write_kreg(dd, kr_hwerrclear, ~HWE_MASK(PowerOnBISTFailed)); | |
2067 | qib_write_kreg(dd, kr_hwerrmask, dd->cspec->hwerrmask); | |
2068 | ||
2069 | /* clear all */ | |
2070 | qib_write_kreg(dd, kr_errclear, ~0ULL); | |
2071 | /* enable errors that are masked, at least this first time. */ | |
2072 | qib_write_kreg(dd, kr_errmask, ~0ULL); | |
2073 | dd->cspec->errormask = qib_read_kreg64(dd, kr_errmask); | |
2074 | for (pidx = 0; pidx < dd->num_pports; ++pidx) | |
2075 | if (dd->pport[pidx].link_speed_supported) | |
2076 | qib_write_kreg_port(dd->pport + pidx, krp_errmask, | |
2077 | ~0ULL); | |
2078 | } | |
2079 | ||
2080 | /* | |
2081 | * Disable and enable the armlaunch error. Used for PIO bandwidth testing | |
2082 | * on chips that are count-based, rather than trigger-based. There is no | |
2083 | * reference counting, but that's also fine, given the intended use. | |
2084 | * Only chip-specific because it's all register accesses | |
2085 | */ | |
2086 | static void qib_set_7322_armlaunch(struct qib_devdata *dd, u32 enable) | |
2087 | { | |
2088 | if (enable) { | |
2089 | qib_write_kreg(dd, kr_errclear, QIB_E_SPIOARMLAUNCH); | |
2090 | dd->cspec->errormask |= QIB_E_SPIOARMLAUNCH; | |
2091 | } else | |
2092 | dd->cspec->errormask &= ~QIB_E_SPIOARMLAUNCH; | |
2093 | qib_write_kreg(dd, kr_errmask, dd->cspec->errormask); | |
2094 | } | |
2095 | ||
2096 | /* | |
2097 | * Formerly took parameter <which> in pre-shifted, | |
2098 | * pre-merged form with LinkCmd and LinkInitCmd | |
2099 | * together, and assuming the zero was NOP. | |
2100 | */ | |
2101 | static void qib_set_ib_7322_lstate(struct qib_pportdata *ppd, u16 linkcmd, | |
2102 | u16 linitcmd) | |
2103 | { | |
2104 | u64 mod_wd; | |
2105 | struct qib_devdata *dd = ppd->dd; | |
2106 | unsigned long flags; | |
2107 | ||
2108 | if (linitcmd == QLOGIC_IB_IBCC_LINKINITCMD_DISABLE) { | |
2109 | /* | |
2110 | * If we are told to disable, note that so link-recovery | |
2111 | * code does not attempt to bring us back up. | |
2112 | * Also reset everything that we can, so we start | |
2113 | * completely clean when re-enabled (before we | |
2114 | * actually issue the disable to the IBC) | |
2115 | */ | |
2116 | qib_7322_mini_pcs_reset(ppd); | |
2117 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
2118 | ppd->lflags |= QIBL_IB_LINK_DISABLED; | |
2119 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
2120 | } else if (linitcmd || linkcmd == QLOGIC_IB_IBCC_LINKCMD_DOWN) { | |
2121 | /* | |
2122 | * Any other linkinitcmd will lead to LINKDOWN and then | |
2123 | * to INIT (if all is well), so clear flag to let | |
2124 | * link-recovery code attempt to bring us back up. | |
2125 | */ | |
2126 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
2127 | ppd->lflags &= ~QIBL_IB_LINK_DISABLED; | |
2128 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
2129 | /* | |
2130 | * Clear status change interrupt reduction so the | |
2131 | * new state is seen. | |
2132 | */ | |
2133 | ppd->cpspec->ibcctrl_a &= | |
2134 | ~SYM_MASK(IBCCtrlA_0, IBStatIntReductionEn); | |
2135 | } | |
2136 | ||
2137 | mod_wd = (linkcmd << IBA7322_IBCC_LINKCMD_SHIFT) | | |
2138 | (linitcmd << QLOGIC_IB_IBCC_LINKINITCMD_SHIFT); | |
2139 | ||
2140 | qib_write_kreg_port(ppd, krp_ibcctrl_a, ppd->cpspec->ibcctrl_a | | |
2141 | mod_wd); | |
2142 | /* write to chip to prevent back-to-back writes of ibc reg */ | |
2143 | qib_write_kreg(dd, kr_scratch, 0); | |
2144 | ||
2145 | } | |
2146 | ||
2147 | /* | |
2148 | * The total RCV buffer memory is 64KB, used for both ports, and is | |
2149 | * in units of 64 bytes (same as IB flow control credit unit). | |
2150 | * The consumedVL unit in the same registers are in 32 byte units! | |
2151 | * So, a VL15 packet needs 4.50 IB credits, and 9 rx buffer chunks, | |
2152 | * and we can therefore allocate just 9 IB credits for 2 VL15 packets | |
2153 | * in krp_rxcreditvl15, rather than 10. | |
2154 | */ | |
2155 | #define RCV_BUF_UNITSZ 64 | |
2156 | #define NUM_RCV_BUF_UNITS(dd) ((64 * 1024) / (RCV_BUF_UNITSZ * dd->num_pports)) | |
2157 | ||
2158 | static void set_vls(struct qib_pportdata *ppd) | |
2159 | { | |
2160 | int i, numvls, totcred, cred_vl, vl0extra; | |
2161 | struct qib_devdata *dd = ppd->dd; | |
2162 | u64 val; | |
2163 | ||
2164 | numvls = qib_num_vls(ppd->vls_operational); | |
2165 | ||
2166 | /* | |
2167 | * Set up per-VL credits. Below is kluge based on these assumptions: | |
2168 | * 1) port is disabled at the time early_init is called. | |
2169 | * 2) give VL15 17 credits, for two max-plausible packets. | |
2170 | * 3) Give VL0-N the rest, with any rounding excess used for VL0 | |
2171 | */ | |
2172 | /* 2 VL15 packets @ 288 bytes each (including IB headers) */ | |
2173 | totcred = NUM_RCV_BUF_UNITS(dd); | |
2174 | cred_vl = (2 * 288 + RCV_BUF_UNITSZ - 1) / RCV_BUF_UNITSZ; | |
2175 | totcred -= cred_vl; | |
2176 | qib_write_kreg_port(ppd, krp_rxcreditvl15, (u64) cred_vl); | |
2177 | cred_vl = totcred / numvls; | |
2178 | vl0extra = totcred - cred_vl * numvls; | |
2179 | qib_write_kreg_port(ppd, krp_rxcreditvl0, cred_vl + vl0extra); | |
2180 | for (i = 1; i < numvls; i++) | |
2181 | qib_write_kreg_port(ppd, krp_rxcreditvl0 + i, cred_vl); | |
2182 | for (; i < 8; i++) /* no buffer space for other VLs */ | |
2183 | qib_write_kreg_port(ppd, krp_rxcreditvl0 + i, 0); | |
2184 | ||
2185 | /* Notify IBC that credits need to be recalculated */ | |
2186 | val = qib_read_kreg_port(ppd, krp_ibsdtestiftx); | |
2187 | val |= SYM_MASK(IB_SDTEST_IF_TX_0, CREDIT_CHANGE); | |
2188 | qib_write_kreg_port(ppd, krp_ibsdtestiftx, val); | |
2189 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
2190 | val &= ~SYM_MASK(IB_SDTEST_IF_TX_0, CREDIT_CHANGE); | |
2191 | qib_write_kreg_port(ppd, krp_ibsdtestiftx, val); | |
2192 | ||
2193 | for (i = 0; i < numvls; i++) | |
2194 | val = qib_read_kreg_port(ppd, krp_rxcreditvl0 + i); | |
2195 | val = qib_read_kreg_port(ppd, krp_rxcreditvl15); | |
2196 | ||
2197 | /* Change the number of operational VLs */ | |
2198 | ppd->cpspec->ibcctrl_a = (ppd->cpspec->ibcctrl_a & | |
2199 | ~SYM_MASK(IBCCtrlA_0, NumVLane)) | | |
2200 | ((u64)(numvls - 1) << SYM_LSB(IBCCtrlA_0, NumVLane)); | |
2201 | qib_write_kreg_port(ppd, krp_ibcctrl_a, ppd->cpspec->ibcctrl_a); | |
2202 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
2203 | } | |
2204 | ||
2205 | /* | |
2206 | * The code that deals with actual SerDes is in serdes_7322_init(). | |
2207 | * Compared to the code for iba7220, it is minimal. | |
2208 | */ | |
2209 | static int serdes_7322_init(struct qib_pportdata *ppd); | |
2210 | ||
2211 | /** | |
2212 | * qib_7322_bringup_serdes - bring up the serdes | |
2213 | * @ppd: physical port on the qlogic_ib device | |
2214 | */ | |
2215 | static int qib_7322_bringup_serdes(struct qib_pportdata *ppd) | |
2216 | { | |
2217 | struct qib_devdata *dd = ppd->dd; | |
2218 | u64 val, guid, ibc; | |
2219 | unsigned long flags; | |
2220 | int ret = 0; | |
2221 | ||
2222 | /* | |
2223 | * SerDes model not in Pd, but still need to | |
2224 | * set up much of IBCCtrl and IBCDDRCtrl; move elsewhere | |
2225 | * eventually. | |
2226 | */ | |
2227 | /* Put IBC in reset, sends disabled (should be in reset already) */ | |
2228 | ppd->cpspec->ibcctrl_a &= ~SYM_MASK(IBCCtrlA_0, IBLinkEn); | |
2229 | qib_write_kreg_port(ppd, krp_ibcctrl_a, ppd->cpspec->ibcctrl_a); | |
2230 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
2231 | ||
2232 | if (qib_compat_ddr_negotiate) { | |
2233 | ppd->cpspec->ibdeltainprog = 1; | |
2234 | ppd->cpspec->ibsymsnap = read_7322_creg32_port(ppd, | |
2235 | crp_ibsymbolerr); | |
2236 | ppd->cpspec->iblnkerrsnap = read_7322_creg32_port(ppd, | |
2237 | crp_iblinkerrrecov); | |
2238 | } | |
2239 | ||
2240 | /* flowcontrolwatermark is in units of KBytes */ | |
2241 | ibc = 0x5ULL << SYM_LSB(IBCCtrlA_0, FlowCtrlWaterMark); | |
2242 | /* | |
2243 | * Flow control is sent this often, even if no changes in | |
2244 | * buffer space occur. Units are 128ns for this chip. | |
2245 | * Set to 3usec. | |
2246 | */ | |
2247 | ibc |= 24ULL << SYM_LSB(IBCCtrlA_0, FlowCtrlPeriod); | |
2248 | /* max error tolerance */ | |
2249 | ibc |= 0xfULL << SYM_LSB(IBCCtrlA_0, PhyerrThreshold); | |
2250 | /* IB credit flow control. */ | |
2251 | ibc |= 0xfULL << SYM_LSB(IBCCtrlA_0, OverrunThreshold); | |
2252 | /* | |
2253 | * set initial max size pkt IBC will send, including ICRC; it's the | |
2254 | * PIO buffer size in dwords, less 1; also see qib_set_mtu() | |
2255 | */ | |
2256 | ibc |= ((u64)(ppd->ibmaxlen >> 2) + 1) << | |
2257 | SYM_LSB(IBCCtrlA_0, MaxPktLen); | |
2258 | ppd->cpspec->ibcctrl_a = ibc; /* without linkcmd or linkinitcmd! */ | |
2259 | ||
2260 | /* initially come up waiting for TS1, without sending anything. */ | |
2261 | val = ppd->cpspec->ibcctrl_a | (QLOGIC_IB_IBCC_LINKINITCMD_DISABLE << | |
2262 | QLOGIC_IB_IBCC_LINKINITCMD_SHIFT); | |
2263 | ||
2264 | /* | |
2265 | * Reset the PCS interface to the serdes (and also ibc, which is still | |
2266 | * in reset from above). Writes new value of ibcctrl_a as last step. | |
2267 | */ | |
2268 | qib_7322_mini_pcs_reset(ppd); | |
2269 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
2270 | ||
2271 | if (!ppd->cpspec->ibcctrl_b) { | |
2272 | unsigned lse = ppd->link_speed_enabled; | |
2273 | ||
2274 | /* | |
2275 | * Not on re-init after reset, establish shadow | |
2276 | * and force initial config. | |
2277 | */ | |
2278 | ppd->cpspec->ibcctrl_b = qib_read_kreg_port(ppd, | |
2279 | krp_ibcctrl_b); | |
2280 | ppd->cpspec->ibcctrl_b &= ~(IBA7322_IBC_SPEED_QDR | | |
2281 | IBA7322_IBC_SPEED_DDR | | |
2282 | IBA7322_IBC_SPEED_SDR | | |
2283 | IBA7322_IBC_WIDTH_AUTONEG | | |
2284 | SYM_MASK(IBCCtrlB_0, IB_LANE_REV_SUPPORTED)); | |
2285 | if (lse & (lse - 1)) /* Muliple speeds enabled */ | |
2286 | ppd->cpspec->ibcctrl_b |= | |
2287 | (lse << IBA7322_IBC_SPEED_LSB) | | |
2288 | IBA7322_IBC_IBTA_1_2_MASK | | |
2289 | IBA7322_IBC_MAX_SPEED_MASK; | |
2290 | else | |
2291 | ppd->cpspec->ibcctrl_b |= (lse == QIB_IB_QDR) ? | |
2292 | IBA7322_IBC_SPEED_QDR | | |
2293 | IBA7322_IBC_IBTA_1_2_MASK : | |
2294 | (lse == QIB_IB_DDR) ? | |
2295 | IBA7322_IBC_SPEED_DDR : | |
2296 | IBA7322_IBC_SPEED_SDR; | |
2297 | if ((ppd->link_width_enabled & (IB_WIDTH_1X | IB_WIDTH_4X)) == | |
2298 | (IB_WIDTH_1X | IB_WIDTH_4X)) | |
2299 | ppd->cpspec->ibcctrl_b |= IBA7322_IBC_WIDTH_AUTONEG; | |
2300 | else | |
2301 | ppd->cpspec->ibcctrl_b |= | |
2302 | ppd->link_width_enabled == IB_WIDTH_4X ? | |
2303 | IBA7322_IBC_WIDTH_4X_ONLY : | |
2304 | IBA7322_IBC_WIDTH_1X_ONLY; | |
2305 | ||
2306 | /* always enable these on driver reload, not sticky */ | |
2307 | ppd->cpspec->ibcctrl_b |= (IBA7322_IBC_RXPOL_MASK | | |
2308 | IBA7322_IBC_HRTBT_MASK); | |
2309 | } | |
2310 | qib_write_kreg_port(ppd, krp_ibcctrl_b, ppd->cpspec->ibcctrl_b); | |
2311 | ||
2312 | /* setup so we have more time at CFGTEST to change H1 */ | |
2313 | val = qib_read_kreg_port(ppd, krp_ibcctrl_c); | |
2314 | val &= ~SYM_MASK(IBCCtrlC_0, IB_FRONT_PORCH); | |
2315 | val |= 0xfULL << SYM_LSB(IBCCtrlC_0, IB_FRONT_PORCH); | |
2316 | qib_write_kreg_port(ppd, krp_ibcctrl_c, val); | |
2317 | ||
2318 | serdes_7322_init(ppd); | |
2319 | ||
2320 | guid = be64_to_cpu(ppd->guid); | |
2321 | if (!guid) { | |
2322 | if (dd->base_guid) | |
2323 | guid = be64_to_cpu(dd->base_guid) + ppd->port - 1; | |
2324 | ppd->guid = cpu_to_be64(guid); | |
2325 | } | |
2326 | ||
2327 | qib_write_kreg_port(ppd, krp_hrtbt_guid, guid); | |
2328 | /* write to chip to prevent back-to-back writes of ibc reg */ | |
2329 | qib_write_kreg(dd, kr_scratch, 0); | |
2330 | ||
2331 | /* Enable port */ | |
2332 | ppd->cpspec->ibcctrl_a |= SYM_MASK(IBCCtrlA_0, IBLinkEn); | |
2333 | set_vls(ppd); | |
2334 | ||
2335 | /* be paranoid against later code motion, etc. */ | |
2336 | spin_lock_irqsave(&dd->cspec->rcvmod_lock, flags); | |
2337 | ppd->p_rcvctrl |= SYM_MASK(RcvCtrl_0, RcvIBPortEnable); | |
2338 | qib_write_kreg_port(ppd, krp_rcvctrl, ppd->p_rcvctrl); | |
2339 | spin_unlock_irqrestore(&dd->cspec->rcvmod_lock, flags); | |
2340 | ||
2341 | /* Also enable IBSTATUSCHG interrupt. */ | |
2342 | val = qib_read_kreg_port(ppd, krp_errmask); | |
2343 | qib_write_kreg_port(ppd, krp_errmask, | |
2344 | val | ERR_MASK_N(IBStatusChanged)); | |
2345 | ||
2346 | /* Always zero until we start messing with SerDes for real */ | |
2347 | return ret; | |
2348 | } | |
2349 | ||
2350 | /** | |
2351 | * qib_7322_quiet_serdes - set serdes to txidle | |
2352 | * @dd: the qlogic_ib device | |
2353 | * Called when driver is being unloaded | |
2354 | */ | |
2355 | static void qib_7322_mini_quiet_serdes(struct qib_pportdata *ppd) | |
2356 | { | |
2357 | u64 val; | |
2358 | unsigned long flags; | |
2359 | ||
2360 | qib_set_ib_7322_lstate(ppd, 0, QLOGIC_IB_IBCC_LINKINITCMD_DISABLE); | |
2361 | ||
2362 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
2363 | ppd->lflags &= ~QIBL_IB_AUTONEG_INPROG; | |
2364 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
2365 | wake_up(&ppd->cpspec->autoneg_wait); | |
2366 | cancel_delayed_work(&ppd->cpspec->autoneg_work); | |
2367 | if (ppd->dd->cspec->r1) | |
2368 | cancel_delayed_work(&ppd->cpspec->ipg_work); | |
2369 | flush_scheduled_work(); | |
2370 | ||
2371 | ppd->cpspec->chase_end = 0; | |
2372 | if (ppd->cpspec->chase_timer.data) /* if initted */ | |
2373 | del_timer_sync(&ppd->cpspec->chase_timer); | |
2374 | ||
2375 | /* | |
2376 | * Despite the name, actually disables IBC as well. Do it when | |
2377 | * we are as sure as possible that no more packets can be | |
2378 | * received, following the down and the PCS reset. | |
2379 | * The actual disabling happens in qib_7322_mini_pci_reset(), | |
2380 | * along with the PCS being reset. | |
2381 | */ | |
2382 | ppd->cpspec->ibcctrl_a &= ~SYM_MASK(IBCCtrlA_0, IBLinkEn); | |
2383 | qib_7322_mini_pcs_reset(ppd); | |
2384 | ||
2385 | /* | |
2386 | * Update the adjusted counters so the adjustment persists | |
2387 | * across driver reload. | |
2388 | */ | |
2389 | if (ppd->cpspec->ibsymdelta || ppd->cpspec->iblnkerrdelta || | |
2390 | ppd->cpspec->ibdeltainprog || ppd->cpspec->iblnkdowndelta) { | |
2391 | struct qib_devdata *dd = ppd->dd; | |
2392 | u64 diagc; | |
2393 | ||
2394 | /* enable counter writes */ | |
2395 | diagc = qib_read_kreg64(dd, kr_hwdiagctrl); | |
2396 | qib_write_kreg(dd, kr_hwdiagctrl, | |
2397 | diagc | SYM_MASK(HwDiagCtrl, CounterWrEnable)); | |
2398 | ||
2399 | if (ppd->cpspec->ibsymdelta || ppd->cpspec->ibdeltainprog) { | |
2400 | val = read_7322_creg32_port(ppd, crp_ibsymbolerr); | |
2401 | if (ppd->cpspec->ibdeltainprog) | |
2402 | val -= val - ppd->cpspec->ibsymsnap; | |
2403 | val -= ppd->cpspec->ibsymdelta; | |
2404 | write_7322_creg_port(ppd, crp_ibsymbolerr, val); | |
2405 | } | |
2406 | if (ppd->cpspec->iblnkerrdelta || ppd->cpspec->ibdeltainprog) { | |
2407 | val = read_7322_creg32_port(ppd, crp_iblinkerrrecov); | |
2408 | if (ppd->cpspec->ibdeltainprog) | |
2409 | val -= val - ppd->cpspec->iblnkerrsnap; | |
2410 | val -= ppd->cpspec->iblnkerrdelta; | |
2411 | write_7322_creg_port(ppd, crp_iblinkerrrecov, val); | |
2412 | } | |
2413 | if (ppd->cpspec->iblnkdowndelta) { | |
2414 | val = read_7322_creg32_port(ppd, crp_iblinkdown); | |
2415 | val += ppd->cpspec->iblnkdowndelta; | |
2416 | write_7322_creg_port(ppd, crp_iblinkdown, val); | |
2417 | } | |
2418 | /* | |
2419 | * No need to save ibmalfdelta since IB perfcounters | |
2420 | * are cleared on driver reload. | |
2421 | */ | |
2422 | ||
2423 | /* and disable counter writes */ | |
2424 | qib_write_kreg(dd, kr_hwdiagctrl, diagc); | |
2425 | } | |
2426 | } | |
2427 | ||
2428 | /** | |
2429 | * qib_setup_7322_setextled - set the state of the two external LEDs | |
2430 | * @ppd: physical port on the qlogic_ib device | |
2431 | * @on: whether the link is up or not | |
2432 | * | |
2433 | * The exact combo of LEDs if on is true is determined by looking | |
2434 | * at the ibcstatus. | |
2435 | * | |
2436 | * These LEDs indicate the physical and logical state of IB link. | |
2437 | * For this chip (at least with recommended board pinouts), LED1 | |
2438 | * is Yellow (logical state) and LED2 is Green (physical state), | |
2439 | * | |
2440 | * Note: We try to match the Mellanox HCA LED behavior as best | |
2441 | * we can. Green indicates physical link state is OK (something is | |
2442 | * plugged in, and we can train). | |
2443 | * Amber indicates the link is logically up (ACTIVE). | |
2444 | * Mellanox further blinks the amber LED to indicate data packet | |
2445 | * activity, but we have no hardware support for that, so it would | |
2446 | * require waking up every 10-20 msecs and checking the counters | |
2447 | * on the chip, and then turning the LED off if appropriate. That's | |
2448 | * visible overhead, so not something we will do. | |
2449 | */ | |
2450 | static void qib_setup_7322_setextled(struct qib_pportdata *ppd, u32 on) | |
2451 | { | |
2452 | struct qib_devdata *dd = ppd->dd; | |
2453 | u64 extctl, ledblink = 0, val; | |
2454 | unsigned long flags; | |
2455 | int yel, grn; | |
2456 | ||
2457 | /* | |
2458 | * The diags use the LED to indicate diag info, so we leave | |
2459 | * the external LED alone when the diags are running. | |
2460 | */ | |
2461 | if (dd->diag_client) | |
2462 | return; | |
2463 | ||
2464 | /* Allow override of LED display for, e.g. Locating system in rack */ | |
2465 | if (ppd->led_override) { | |
2466 | grn = (ppd->led_override & QIB_LED_PHYS); | |
2467 | yel = (ppd->led_override & QIB_LED_LOG); | |
2468 | } else if (on) { | |
2469 | val = qib_read_kreg_port(ppd, krp_ibcstatus_a); | |
2470 | grn = qib_7322_phys_portstate(val) == | |
2471 | IB_PHYSPORTSTATE_LINKUP; | |
2472 | yel = qib_7322_iblink_state(val) == IB_PORT_ACTIVE; | |
2473 | } else { | |
2474 | grn = 0; | |
2475 | yel = 0; | |
2476 | } | |
2477 | ||
2478 | spin_lock_irqsave(&dd->cspec->gpio_lock, flags); | |
2479 | extctl = dd->cspec->extctrl & (ppd->port == 1 ? | |
2480 | ~ExtLED_IB1_MASK : ~ExtLED_IB2_MASK); | |
2481 | if (grn) { | |
2482 | extctl |= ppd->port == 1 ? ExtLED_IB1_GRN : ExtLED_IB2_GRN; | |
2483 | /* | |
2484 | * Counts are in chip clock (4ns) periods. | |
2485 | * This is 1/16 sec (66.6ms) on, | |
2486 | * 3/16 sec (187.5 ms) off, with packets rcvd. | |
2487 | */ | |
2488 | ledblink = ((66600 * 1000UL / 4) << IBA7322_LEDBLINK_ON_SHIFT) | | |
2489 | ((187500 * 1000UL / 4) << IBA7322_LEDBLINK_OFF_SHIFT); | |
2490 | } | |
2491 | if (yel) | |
2492 | extctl |= ppd->port == 1 ? ExtLED_IB1_YEL : ExtLED_IB2_YEL; | |
2493 | dd->cspec->extctrl = extctl; | |
2494 | qib_write_kreg(dd, kr_extctrl, dd->cspec->extctrl); | |
2495 | spin_unlock_irqrestore(&dd->cspec->gpio_lock, flags); | |
2496 | ||
2497 | if (ledblink) /* blink the LED on packet receive */ | |
2498 | qib_write_kreg_port(ppd, krp_rcvpktledcnt, ledblink); | |
2499 | } | |
2500 | ||
f931551b RC |
2501 | /* |
2502 | * Disable MSIx interrupt if enabled, call generic MSIx code | |
2503 | * to cleanup, and clear pending MSIx interrupts. | |
2504 | * Used for fallback to INTx, after reset, and when MSIx setup fails. | |
2505 | */ | |
2506 | static void qib_7322_nomsix(struct qib_devdata *dd) | |
2507 | { | |
2508 | u64 intgranted; | |
2509 | int n; | |
2510 | ||
2511 | dd->cspec->main_int_mask = ~0ULL; | |
2512 | n = dd->cspec->num_msix_entries; | |
2513 | if (n) { | |
2514 | int i; | |
2515 | ||
2516 | dd->cspec->num_msix_entries = 0; | |
2517 | for (i = 0; i < n; i++) | |
2518 | free_irq(dd->cspec->msix_entries[i].vector, | |
2519 | dd->cspec->msix_arg[i]); | |
2520 | qib_nomsix(dd); | |
2521 | } | |
2522 | /* make sure no MSIx interrupts are left pending */ | |
2523 | intgranted = qib_read_kreg64(dd, kr_intgranted); | |
2524 | if (intgranted) | |
2525 | qib_write_kreg(dd, kr_intgranted, intgranted); | |
2526 | } | |
2527 | ||
2528 | static void qib_7322_free_irq(struct qib_devdata *dd) | |
2529 | { | |
2530 | if (dd->cspec->irq) { | |
2531 | free_irq(dd->cspec->irq, dd); | |
2532 | dd->cspec->irq = 0; | |
2533 | } | |
2534 | qib_7322_nomsix(dd); | |
2535 | } | |
2536 | ||
2537 | static void qib_setup_7322_cleanup(struct qib_devdata *dd) | |
2538 | { | |
2539 | int i; | |
2540 | ||
f931551b RC |
2541 | qib_7322_free_irq(dd); |
2542 | kfree(dd->cspec->cntrs); | |
2543 | kfree(dd->cspec->sendchkenable); | |
2544 | kfree(dd->cspec->sendgrhchk); | |
2545 | kfree(dd->cspec->sendibchk); | |
2546 | kfree(dd->cspec->msix_entries); | |
2547 | kfree(dd->cspec->msix_arg); | |
2548 | for (i = 0; i < dd->num_pports; i++) { | |
2549 | unsigned long flags; | |
2550 | u32 mask = QSFP_GPIO_MOD_PRS_N | | |
2551 | (QSFP_GPIO_MOD_PRS_N << QSFP_GPIO_PORT2_SHIFT); | |
2552 | ||
2553 | kfree(dd->pport[i].cpspec->portcntrs); | |
2554 | if (dd->flags & QIB_HAS_QSFP) { | |
2555 | spin_lock_irqsave(&dd->cspec->gpio_lock, flags); | |
2556 | dd->cspec->gpio_mask &= ~mask; | |
2557 | qib_write_kreg(dd, kr_gpio_mask, dd->cspec->gpio_mask); | |
2558 | spin_unlock_irqrestore(&dd->cspec->gpio_lock, flags); | |
2559 | qib_qsfp_deinit(&dd->pport[i].cpspec->qsfp_data); | |
2560 | } | |
2561 | if (dd->pport[i].ibport_data.smi_ah) | |
2562 | ib_destroy_ah(&dd->pport[i].ibport_data.smi_ah->ibah); | |
2563 | } | |
2564 | } | |
2565 | ||
2566 | /* handle SDMA interrupts */ | |
2567 | static void sdma_7322_intr(struct qib_devdata *dd, u64 istat) | |
2568 | { | |
2569 | struct qib_pportdata *ppd0 = &dd->pport[0]; | |
2570 | struct qib_pportdata *ppd1 = &dd->pport[1]; | |
2571 | u64 intr0 = istat & (INT_MASK_P(SDma, 0) | | |
2572 | INT_MASK_P(SDmaIdle, 0) | INT_MASK_P(SDmaProgress, 0)); | |
2573 | u64 intr1 = istat & (INT_MASK_P(SDma, 1) | | |
2574 | INT_MASK_P(SDmaIdle, 1) | INT_MASK_P(SDmaProgress, 1)); | |
2575 | ||
2576 | if (intr0) | |
2577 | qib_sdma_intr(ppd0); | |
2578 | if (intr1) | |
2579 | qib_sdma_intr(ppd1); | |
2580 | ||
2581 | if (istat & INT_MASK_PM(SDmaCleanupDone, 0)) | |
2582 | qib_sdma_process_event(ppd0, qib_sdma_event_e20_hw_started); | |
2583 | if (istat & INT_MASK_PM(SDmaCleanupDone, 1)) | |
2584 | qib_sdma_process_event(ppd1, qib_sdma_event_e20_hw_started); | |
2585 | } | |
2586 | ||
2587 | /* | |
2588 | * Set or clear the Send buffer available interrupt enable bit. | |
2589 | */ | |
2590 | static void qib_wantpiobuf_7322_intr(struct qib_devdata *dd, u32 needint) | |
2591 | { | |
2592 | unsigned long flags; | |
2593 | ||
2594 | spin_lock_irqsave(&dd->sendctrl_lock, flags); | |
2595 | if (needint) | |
2596 | dd->sendctrl |= SYM_MASK(SendCtrl, SendIntBufAvail); | |
2597 | else | |
2598 | dd->sendctrl &= ~SYM_MASK(SendCtrl, SendIntBufAvail); | |
2599 | qib_write_kreg(dd, kr_sendctrl, dd->sendctrl); | |
2600 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
2601 | spin_unlock_irqrestore(&dd->sendctrl_lock, flags); | |
2602 | } | |
2603 | ||
2604 | /* | |
2605 | * Somehow got an interrupt with reserved bits set in interrupt status. | |
2606 | * Print a message so we know it happened, then clear them. | |
2607 | * keep mainline interrupt handler cache-friendly | |
2608 | */ | |
2609 | static noinline void unknown_7322_ibits(struct qib_devdata *dd, u64 istat) | |
2610 | { | |
2611 | u64 kills; | |
2612 | char msg[128]; | |
2613 | ||
2614 | kills = istat & ~QIB_I_BITSEXTANT; | |
2615 | qib_dev_err(dd, "Clearing reserved interrupt(s) 0x%016llx:" | |
2616 | " %s\n", (unsigned long long) kills, msg); | |
2617 | qib_write_kreg(dd, kr_intmask, (dd->cspec->int_enable_mask & ~kills)); | |
2618 | } | |
2619 | ||
2620 | /* keep mainline interrupt handler cache-friendly */ | |
2621 | static noinline void unknown_7322_gpio_intr(struct qib_devdata *dd) | |
2622 | { | |
2623 | u32 gpiostatus; | |
2624 | int handled = 0; | |
2625 | int pidx; | |
2626 | ||
2627 | /* | |
2628 | * Boards for this chip currently don't use GPIO interrupts, | |
2629 | * so clear by writing GPIOstatus to GPIOclear, and complain | |
2630 | * to developer. To avoid endless repeats, clear | |
2631 | * the bits in the mask, since there is some kind of | |
2632 | * programming error or chip problem. | |
2633 | */ | |
2634 | gpiostatus = qib_read_kreg32(dd, kr_gpio_status); | |
2635 | /* | |
2636 | * In theory, writing GPIOstatus to GPIOclear could | |
2637 | * have a bad side-effect on some diagnostic that wanted | |
2638 | * to poll for a status-change, but the various shadows | |
2639 | * make that problematic at best. Diags will just suppress | |
2640 | * all GPIO interrupts during such tests. | |
2641 | */ | |
2642 | qib_write_kreg(dd, kr_gpio_clear, gpiostatus); | |
2643 | /* | |
2644 | * Check for QSFP MOD_PRS changes | |
2645 | * only works for single port if IB1 != pidx1 | |
2646 | */ | |
2647 | for (pidx = 0; pidx < dd->num_pports && (dd->flags & QIB_HAS_QSFP); | |
2648 | ++pidx) { | |
2649 | struct qib_pportdata *ppd; | |
2650 | struct qib_qsfp_data *qd; | |
2651 | u32 mask; | |
2652 | if (!dd->pport[pidx].link_speed_supported) | |
2653 | continue; | |
2654 | mask = QSFP_GPIO_MOD_PRS_N; | |
2655 | ppd = dd->pport + pidx; | |
2656 | mask <<= (QSFP_GPIO_PORT2_SHIFT * ppd->hw_pidx); | |
2657 | if (gpiostatus & dd->cspec->gpio_mask & mask) { | |
2658 | u64 pins; | |
2659 | qd = &ppd->cpspec->qsfp_data; | |
2660 | gpiostatus &= ~mask; | |
2661 | pins = qib_read_kreg64(dd, kr_extstatus); | |
2662 | pins >>= SYM_LSB(EXTStatus, GPIOIn); | |
2663 | if (!(pins & mask)) { | |
2664 | ++handled; | |
2665 | qd->t_insert = get_jiffies_64(); | |
2666 | schedule_work(&qd->work); | |
2667 | } | |
2668 | } | |
2669 | } | |
2670 | ||
2671 | if (gpiostatus && !handled) { | |
2672 | const u32 mask = qib_read_kreg32(dd, kr_gpio_mask); | |
2673 | u32 gpio_irq = mask & gpiostatus; | |
2674 | ||
2675 | /* | |
2676 | * Clear any troublemakers, and update chip from shadow | |
2677 | */ | |
2678 | dd->cspec->gpio_mask &= ~gpio_irq; | |
2679 | qib_write_kreg(dd, kr_gpio_mask, dd->cspec->gpio_mask); | |
2680 | } | |
2681 | } | |
2682 | ||
2683 | /* | |
2684 | * Handle errors and unusual events first, separate function | |
2685 | * to improve cache hits for fast path interrupt handling. | |
2686 | */ | |
2687 | static noinline void unlikely_7322_intr(struct qib_devdata *dd, u64 istat) | |
2688 | { | |
2689 | if (istat & ~QIB_I_BITSEXTANT) | |
2690 | unknown_7322_ibits(dd, istat); | |
2691 | if (istat & QIB_I_GPIO) | |
2692 | unknown_7322_gpio_intr(dd); | |
2693 | if (istat & QIB_I_C_ERROR) | |
2694 | handle_7322_errors(dd); | |
2695 | if (istat & INT_MASK_P(Err, 0) && dd->rcd[0]) | |
2696 | handle_7322_p_errors(dd->rcd[0]->ppd); | |
2697 | if (istat & INT_MASK_P(Err, 1) && dd->rcd[1]) | |
2698 | handle_7322_p_errors(dd->rcd[1]->ppd); | |
2699 | } | |
2700 | ||
2701 | /* | |
2702 | * Dynamically adjust the rcv int timeout for a context based on incoming | |
2703 | * packet rate. | |
2704 | */ | |
2705 | static void adjust_rcv_timeout(struct qib_ctxtdata *rcd, int npkts) | |
2706 | { | |
2707 | struct qib_devdata *dd = rcd->dd; | |
2708 | u32 timeout = dd->cspec->rcvavail_timeout[rcd->ctxt]; | |
2709 | ||
2710 | /* | |
2711 | * Dynamically adjust idle timeout on chip | |
2712 | * based on number of packets processed. | |
2713 | */ | |
2714 | if (npkts < rcv_int_count && timeout > 2) | |
2715 | timeout >>= 1; | |
2716 | else if (npkts >= rcv_int_count && timeout < rcv_int_timeout) | |
2717 | timeout = min(timeout << 1, rcv_int_timeout); | |
2718 | else | |
2719 | return; | |
2720 | ||
2721 | dd->cspec->rcvavail_timeout[rcd->ctxt] = timeout; | |
2722 | qib_write_kreg(dd, kr_rcvavailtimeout + rcd->ctxt, timeout); | |
2723 | } | |
2724 | ||
2725 | /* | |
2726 | * This is the main interrupt handler. | |
2727 | * It will normally only be used for low frequency interrupts but may | |
2728 | * have to handle all interrupts if INTx is enabled or fewer than normal | |
2729 | * MSIx interrupts were allocated. | |
2730 | * This routine should ignore the interrupt bits for any of the | |
2731 | * dedicated MSIx handlers. | |
2732 | */ | |
2733 | static irqreturn_t qib_7322intr(int irq, void *data) | |
2734 | { | |
2735 | struct qib_devdata *dd = data; | |
2736 | irqreturn_t ret; | |
2737 | u64 istat; | |
2738 | u64 ctxtrbits; | |
2739 | u64 rmask; | |
2740 | unsigned i; | |
2741 | u32 npkts; | |
2742 | ||
2743 | if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) { | |
2744 | /* | |
2745 | * This return value is not great, but we do not want the | |
2746 | * interrupt core code to remove our interrupt handler | |
2747 | * because we don't appear to be handling an interrupt | |
2748 | * during a chip reset. | |
2749 | */ | |
2750 | ret = IRQ_HANDLED; | |
2751 | goto bail; | |
2752 | } | |
2753 | ||
2754 | istat = qib_read_kreg64(dd, kr_intstatus); | |
2755 | ||
2756 | if (unlikely(istat == ~0ULL)) { | |
2757 | qib_bad_intrstatus(dd); | |
2758 | qib_dev_err(dd, "Interrupt status all f's, skipping\n"); | |
2759 | /* don't know if it was our interrupt or not */ | |
2760 | ret = IRQ_NONE; | |
2761 | goto bail; | |
2762 | } | |
2763 | ||
2764 | istat &= dd->cspec->main_int_mask; | |
2765 | if (unlikely(!istat)) { | |
2766 | /* already handled, or shared and not us */ | |
2767 | ret = IRQ_NONE; | |
2768 | goto bail; | |
2769 | } | |
2770 | ||
2771 | qib_stats.sps_ints++; | |
2772 | if (dd->int_counter != (u32) -1) | |
2773 | dd->int_counter++; | |
2774 | ||
2775 | /* handle "errors" of various kinds first, device ahead of port */ | |
2776 | if (unlikely(istat & (~QIB_I_BITSEXTANT | QIB_I_GPIO | | |
2777 | QIB_I_C_ERROR | INT_MASK_P(Err, 0) | | |
2778 | INT_MASK_P(Err, 1)))) | |
2779 | unlikely_7322_intr(dd, istat); | |
2780 | ||
2781 | /* | |
2782 | * Clear the interrupt bits we found set, relatively early, so we | |
2783 | * "know" know the chip will have seen this by the time we process | |
2784 | * the queue, and will re-interrupt if necessary. The processor | |
2785 | * itself won't take the interrupt again until we return. | |
2786 | */ | |
2787 | qib_write_kreg(dd, kr_intclear, istat); | |
2788 | ||
2789 | /* | |
2790 | * Handle kernel receive queues before checking for pio buffers | |
2791 | * available since receives can overflow; piobuf waiters can afford | |
2792 | * a few extra cycles, since they were waiting anyway. | |
2793 | */ | |
2794 | ctxtrbits = istat & (QIB_I_RCVAVAIL_MASK | QIB_I_RCVURG_MASK); | |
2795 | if (ctxtrbits) { | |
2796 | rmask = (1ULL << QIB_I_RCVAVAIL_LSB) | | |
2797 | (1ULL << QIB_I_RCVURG_LSB); | |
2798 | for (i = 0; i < dd->first_user_ctxt; i++) { | |
2799 | if (ctxtrbits & rmask) { | |
2800 | ctxtrbits &= ~rmask; | |
2801 | if (dd->rcd[i]) { | |
2802 | qib_kreceive(dd->rcd[i], NULL, &npkts); | |
2803 | adjust_rcv_timeout(dd->rcd[i], npkts); | |
2804 | } | |
2805 | } | |
2806 | rmask <<= 1; | |
2807 | } | |
2808 | if (ctxtrbits) { | |
2809 | ctxtrbits = (ctxtrbits >> QIB_I_RCVAVAIL_LSB) | | |
2810 | (ctxtrbits >> QIB_I_RCVURG_LSB); | |
2811 | qib_handle_urcv(dd, ctxtrbits); | |
2812 | } | |
2813 | } | |
2814 | ||
2815 | if (istat & (QIB_I_P_SDMAINT(0) | QIB_I_P_SDMAINT(1))) | |
2816 | sdma_7322_intr(dd, istat); | |
2817 | ||
2818 | if ((istat & QIB_I_SPIOBUFAVAIL) && (dd->flags & QIB_INITTED)) | |
2819 | qib_ib_piobufavail(dd); | |
2820 | ||
2821 | ret = IRQ_HANDLED; | |
2822 | bail: | |
2823 | return ret; | |
2824 | } | |
2825 | ||
2826 | /* | |
2827 | * Dedicated receive packet available interrupt handler. | |
2828 | */ | |
2829 | static irqreturn_t qib_7322pintr(int irq, void *data) | |
2830 | { | |
2831 | struct qib_ctxtdata *rcd = data; | |
2832 | struct qib_devdata *dd = rcd->dd; | |
2833 | u32 npkts; | |
2834 | ||
2835 | if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) | |
2836 | /* | |
2837 | * This return value is not great, but we do not want the | |
2838 | * interrupt core code to remove our interrupt handler | |
2839 | * because we don't appear to be handling an interrupt | |
2840 | * during a chip reset. | |
2841 | */ | |
2842 | return IRQ_HANDLED; | |
2843 | ||
2844 | qib_stats.sps_ints++; | |
2845 | if (dd->int_counter != (u32) -1) | |
2846 | dd->int_counter++; | |
2847 | ||
f931551b RC |
2848 | /* Clear the interrupt bit we expect to be set. */ |
2849 | qib_write_kreg(dd, kr_intclear, ((1ULL << QIB_I_RCVAVAIL_LSB) | | |
2850 | (1ULL << QIB_I_RCVURG_LSB)) << rcd->ctxt); | |
2851 | ||
2852 | qib_kreceive(rcd, NULL, &npkts); | |
2853 | adjust_rcv_timeout(rcd, npkts); | |
2854 | ||
2855 | return IRQ_HANDLED; | |
2856 | } | |
2857 | ||
2858 | /* | |
2859 | * Dedicated Send buffer available interrupt handler. | |
2860 | */ | |
2861 | static irqreturn_t qib_7322bufavail(int irq, void *data) | |
2862 | { | |
2863 | struct qib_devdata *dd = data; | |
2864 | ||
2865 | if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) | |
2866 | /* | |
2867 | * This return value is not great, but we do not want the | |
2868 | * interrupt core code to remove our interrupt handler | |
2869 | * because we don't appear to be handling an interrupt | |
2870 | * during a chip reset. | |
2871 | */ | |
2872 | return IRQ_HANDLED; | |
2873 | ||
2874 | qib_stats.sps_ints++; | |
2875 | if (dd->int_counter != (u32) -1) | |
2876 | dd->int_counter++; | |
2877 | ||
2878 | /* Clear the interrupt bit we expect to be set. */ | |
2879 | qib_write_kreg(dd, kr_intclear, QIB_I_SPIOBUFAVAIL); | |
2880 | ||
2881 | /* qib_ib_piobufavail() will clear the want PIO interrupt if needed */ | |
2882 | if (dd->flags & QIB_INITTED) | |
2883 | qib_ib_piobufavail(dd); | |
2884 | else | |
2885 | qib_wantpiobuf_7322_intr(dd, 0); | |
2886 | ||
2887 | return IRQ_HANDLED; | |
2888 | } | |
2889 | ||
2890 | /* | |
2891 | * Dedicated Send DMA interrupt handler. | |
2892 | */ | |
2893 | static irqreturn_t sdma_intr(int irq, void *data) | |
2894 | { | |
2895 | struct qib_pportdata *ppd = data; | |
2896 | struct qib_devdata *dd = ppd->dd; | |
2897 | ||
2898 | if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) | |
2899 | /* | |
2900 | * This return value is not great, but we do not want the | |
2901 | * interrupt core code to remove our interrupt handler | |
2902 | * because we don't appear to be handling an interrupt | |
2903 | * during a chip reset. | |
2904 | */ | |
2905 | return IRQ_HANDLED; | |
2906 | ||
2907 | qib_stats.sps_ints++; | |
2908 | if (dd->int_counter != (u32) -1) | |
2909 | dd->int_counter++; | |
2910 | ||
f931551b RC |
2911 | /* Clear the interrupt bit we expect to be set. */ |
2912 | qib_write_kreg(dd, kr_intclear, ppd->hw_pidx ? | |
2913 | INT_MASK_P(SDma, 1) : INT_MASK_P(SDma, 0)); | |
2914 | qib_sdma_intr(ppd); | |
2915 | ||
2916 | return IRQ_HANDLED; | |
2917 | } | |
2918 | ||
2919 | /* | |
2920 | * Dedicated Send DMA idle interrupt handler. | |
2921 | */ | |
2922 | static irqreturn_t sdma_idle_intr(int irq, void *data) | |
2923 | { | |
2924 | struct qib_pportdata *ppd = data; | |
2925 | struct qib_devdata *dd = ppd->dd; | |
2926 | ||
2927 | if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) | |
2928 | /* | |
2929 | * This return value is not great, but we do not want the | |
2930 | * interrupt core code to remove our interrupt handler | |
2931 | * because we don't appear to be handling an interrupt | |
2932 | * during a chip reset. | |
2933 | */ | |
2934 | return IRQ_HANDLED; | |
2935 | ||
2936 | qib_stats.sps_ints++; | |
2937 | if (dd->int_counter != (u32) -1) | |
2938 | dd->int_counter++; | |
2939 | ||
f931551b RC |
2940 | /* Clear the interrupt bit we expect to be set. */ |
2941 | qib_write_kreg(dd, kr_intclear, ppd->hw_pidx ? | |
2942 | INT_MASK_P(SDmaIdle, 1) : INT_MASK_P(SDmaIdle, 0)); | |
2943 | qib_sdma_intr(ppd); | |
2944 | ||
2945 | return IRQ_HANDLED; | |
2946 | } | |
2947 | ||
2948 | /* | |
2949 | * Dedicated Send DMA progress interrupt handler. | |
2950 | */ | |
2951 | static irqreturn_t sdma_progress_intr(int irq, void *data) | |
2952 | { | |
2953 | struct qib_pportdata *ppd = data; | |
2954 | struct qib_devdata *dd = ppd->dd; | |
2955 | ||
2956 | if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) | |
2957 | /* | |
2958 | * This return value is not great, but we do not want the | |
2959 | * interrupt core code to remove our interrupt handler | |
2960 | * because we don't appear to be handling an interrupt | |
2961 | * during a chip reset. | |
2962 | */ | |
2963 | return IRQ_HANDLED; | |
2964 | ||
2965 | qib_stats.sps_ints++; | |
2966 | if (dd->int_counter != (u32) -1) | |
2967 | dd->int_counter++; | |
2968 | ||
f931551b RC |
2969 | /* Clear the interrupt bit we expect to be set. */ |
2970 | qib_write_kreg(dd, kr_intclear, ppd->hw_pidx ? | |
2971 | INT_MASK_P(SDmaProgress, 1) : | |
2972 | INT_MASK_P(SDmaProgress, 0)); | |
2973 | qib_sdma_intr(ppd); | |
2974 | ||
2975 | return IRQ_HANDLED; | |
2976 | } | |
2977 | ||
2978 | /* | |
2979 | * Dedicated Send DMA cleanup interrupt handler. | |
2980 | */ | |
2981 | static irqreturn_t sdma_cleanup_intr(int irq, void *data) | |
2982 | { | |
2983 | struct qib_pportdata *ppd = data; | |
2984 | struct qib_devdata *dd = ppd->dd; | |
2985 | ||
2986 | if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) | |
2987 | /* | |
2988 | * This return value is not great, but we do not want the | |
2989 | * interrupt core code to remove our interrupt handler | |
2990 | * because we don't appear to be handling an interrupt | |
2991 | * during a chip reset. | |
2992 | */ | |
2993 | return IRQ_HANDLED; | |
2994 | ||
2995 | qib_stats.sps_ints++; | |
2996 | if (dd->int_counter != (u32) -1) | |
2997 | dd->int_counter++; | |
2998 | ||
f931551b RC |
2999 | /* Clear the interrupt bit we expect to be set. */ |
3000 | qib_write_kreg(dd, kr_intclear, ppd->hw_pidx ? | |
3001 | INT_MASK_PM(SDmaCleanupDone, 1) : | |
3002 | INT_MASK_PM(SDmaCleanupDone, 0)); | |
3003 | qib_sdma_process_event(ppd, qib_sdma_event_e20_hw_started); | |
3004 | ||
3005 | return IRQ_HANDLED; | |
3006 | } | |
3007 | ||
3008 | /* | |
3009 | * Set up our chip-specific interrupt handler. | |
3010 | * The interrupt type has already been setup, so | |
3011 | * we just need to do the registration and error checking. | |
3012 | * If we are using MSIx interrupts, we may fall back to | |
3013 | * INTx later, if the interrupt handler doesn't get called | |
3014 | * within 1/2 second (see verify_interrupt()). | |
3015 | */ | |
3016 | static void qib_setup_7322_interrupt(struct qib_devdata *dd, int clearpend) | |
3017 | { | |
3018 | int ret, i, msixnum; | |
3019 | u64 redirect[6]; | |
3020 | u64 mask; | |
3021 | ||
3022 | if (!dd->num_pports) | |
3023 | return; | |
3024 | ||
3025 | if (clearpend) { | |
3026 | /* | |
3027 | * if not switching interrupt types, be sure interrupts are | |
3028 | * disabled, and then clear anything pending at this point, | |
3029 | * because we are starting clean. | |
3030 | */ | |
3031 | qib_7322_set_intr_state(dd, 0); | |
3032 | ||
3033 | /* clear the reset error, init error/hwerror mask */ | |
3034 | qib_7322_init_hwerrors(dd); | |
3035 | ||
3036 | /* clear any interrupt bits that might be set */ | |
3037 | qib_write_kreg(dd, kr_intclear, ~0ULL); | |
3038 | ||
3039 | /* make sure no pending MSIx intr, and clear diag reg */ | |
3040 | qib_write_kreg(dd, kr_intgranted, ~0ULL); | |
3041 | qib_write_kreg(dd, kr_vecclr_wo_int, ~0ULL); | |
3042 | } | |
3043 | ||
3044 | if (!dd->cspec->num_msix_entries) { | |
3045 | /* Try to get INTx interrupt */ | |
3046 | try_intx: | |
3047 | if (!dd->pcidev->irq) { | |
3048 | qib_dev_err(dd, "irq is 0, BIOS error? " | |
3049 | "Interrupts won't work\n"); | |
3050 | goto bail; | |
3051 | } | |
3052 | ret = request_irq(dd->pcidev->irq, qib_7322intr, | |
3053 | IRQF_SHARED, QIB_DRV_NAME, dd); | |
3054 | if (ret) { | |
3055 | qib_dev_err(dd, "Couldn't setup INTx " | |
3056 | "interrupt (irq=%d): %d\n", | |
3057 | dd->pcidev->irq, ret); | |
3058 | goto bail; | |
3059 | } | |
3060 | dd->cspec->irq = dd->pcidev->irq; | |
3061 | dd->cspec->main_int_mask = ~0ULL; | |
3062 | goto bail; | |
3063 | } | |
3064 | ||
3065 | /* Try to get MSIx interrupts */ | |
3066 | memset(redirect, 0, sizeof redirect); | |
3067 | mask = ~0ULL; | |
3068 | msixnum = 0; | |
3069 | for (i = 0; msixnum < dd->cspec->num_msix_entries; i++) { | |
3070 | irq_handler_t handler; | |
3071 | const char *name; | |
3072 | void *arg; | |
3073 | u64 val; | |
3074 | int lsb, reg, sh; | |
3075 | ||
3076 | if (i < ARRAY_SIZE(irq_table)) { | |
3077 | if (irq_table[i].port) { | |
3078 | /* skip if for a non-configured port */ | |
3079 | if (irq_table[i].port > dd->num_pports) | |
3080 | continue; | |
3081 | arg = dd->pport + irq_table[i].port - 1; | |
3082 | } else | |
3083 | arg = dd; | |
3084 | lsb = irq_table[i].lsb; | |
3085 | handler = irq_table[i].handler; | |
3086 | name = irq_table[i].name; | |
3087 | } else { | |
3088 | unsigned ctxt; | |
3089 | ||
3090 | ctxt = i - ARRAY_SIZE(irq_table); | |
3091 | /* per krcvq context receive interrupt */ | |
3092 | arg = dd->rcd[ctxt]; | |
3093 | if (!arg) | |
3094 | continue; | |
3095 | lsb = QIB_I_RCVAVAIL_LSB + ctxt; | |
3096 | handler = qib_7322pintr; | |
3097 | name = QIB_DRV_NAME " (kctx)"; | |
3098 | } | |
3099 | ret = request_irq(dd->cspec->msix_entries[msixnum].vector, | |
3100 | handler, 0, name, arg); | |
3101 | if (ret) { | |
3102 | /* | |
3103 | * Shouldn't happen since the enable said we could | |
3104 | * have as many as we are trying to setup here. | |
3105 | */ | |
3106 | qib_dev_err(dd, "Couldn't setup MSIx " | |
3107 | "interrupt (vec=%d, irq=%d): %d\n", msixnum, | |
3108 | dd->cspec->msix_entries[msixnum].vector, | |
3109 | ret); | |
3110 | qib_7322_nomsix(dd); | |
3111 | goto try_intx; | |
3112 | } | |
3113 | dd->cspec->msix_arg[msixnum] = arg; | |
3114 | if (lsb >= 0) { | |
3115 | reg = lsb / IBA7322_REDIRECT_VEC_PER_REG; | |
3116 | sh = (lsb % IBA7322_REDIRECT_VEC_PER_REG) * | |
3117 | SYM_LSB(IntRedirect0, vec1); | |
3118 | mask &= ~(1ULL << lsb); | |
3119 | redirect[reg] |= ((u64) msixnum) << sh; | |
3120 | } | |
3121 | val = qib_read_kreg64(dd, 2 * msixnum + 1 + | |
3122 | (QIB_7322_MsixTable_OFFS / sizeof(u64))); | |
3123 | msixnum++; | |
3124 | } | |
3125 | /* Initialize the vector mapping */ | |
3126 | for (i = 0; i < ARRAY_SIZE(redirect); i++) | |
3127 | qib_write_kreg(dd, kr_intredirect + i, redirect[i]); | |
3128 | dd->cspec->main_int_mask = mask; | |
3129 | bail:; | |
3130 | } | |
3131 | ||
3132 | /** | |
3133 | * qib_7322_boardname - fill in the board name and note features | |
3134 | * @dd: the qlogic_ib device | |
3135 | * | |
3136 | * info will be based on the board revision register | |
3137 | */ | |
3138 | static unsigned qib_7322_boardname(struct qib_devdata *dd) | |
3139 | { | |
3140 | /* Will need enumeration of board-types here */ | |
3141 | char *n; | |
3142 | u32 boardid, namelen; | |
3143 | unsigned features = DUAL_PORT_CAP; | |
3144 | ||
3145 | boardid = SYM_FIELD(dd->revision, Revision, BoardID); | |
3146 | ||
3147 | switch (boardid) { | |
3148 | case 0: | |
3149 | n = "InfiniPath_QLE7342_Emulation"; | |
3150 | break; | |
3151 | case 1: | |
3152 | n = "InfiniPath_QLE7340"; | |
3153 | dd->flags |= QIB_HAS_QSFP; | |
3154 | features = PORT_SPD_CAP; | |
3155 | break; | |
3156 | case 2: | |
3157 | n = "InfiniPath_QLE7342"; | |
3158 | dd->flags |= QIB_HAS_QSFP; | |
3159 | break; | |
3160 | case 3: | |
3161 | n = "InfiniPath_QMI7342"; | |
3162 | break; | |
3163 | case 4: | |
3164 | n = "InfiniPath_Unsupported7342"; | |
3165 | qib_dev_err(dd, "Unsupported version of QMH7342\n"); | |
3166 | features = 0; | |
3167 | break; | |
3168 | case BOARD_QMH7342: | |
3169 | n = "InfiniPath_QMH7342"; | |
3170 | features = 0x24; | |
3171 | break; | |
3172 | case BOARD_QME7342: | |
3173 | n = "InfiniPath_QME7342"; | |
3174 | break; | |
3175 | case 15: | |
3176 | n = "InfiniPath_QLE7342_TEST"; | |
3177 | dd->flags |= QIB_HAS_QSFP; | |
3178 | break; | |
3179 | default: | |
3180 | n = "InfiniPath_QLE73xy_UNKNOWN"; | |
3181 | qib_dev_err(dd, "Unknown 7322 board type %u\n", boardid); | |
3182 | break; | |
3183 | } | |
3184 | dd->board_atten = 1; /* index into txdds_Xdr */ | |
3185 | ||
3186 | namelen = strlen(n) + 1; | |
3187 | dd->boardname = kmalloc(namelen, GFP_KERNEL); | |
3188 | if (!dd->boardname) | |
3189 | qib_dev_err(dd, "Failed allocation for board name: %s\n", n); | |
3190 | else | |
3191 | snprintf(dd->boardname, namelen, "%s", n); | |
3192 | ||
3193 | snprintf(dd->boardversion, sizeof(dd->boardversion), | |
3194 | "ChipABI %u.%u, %s, InfiniPath%u %u.%u, SW Compat %u\n", | |
3195 | QIB_CHIP_VERS_MAJ, QIB_CHIP_VERS_MIN, dd->boardname, | |
3196 | (unsigned)SYM_FIELD(dd->revision, Revision_R, Arch), | |
3197 | dd->majrev, dd->minrev, | |
3198 | (unsigned)SYM_FIELD(dd->revision, Revision_R, SW)); | |
3199 | ||
3200 | if (qib_singleport && (features >> PORT_SPD_CAP_SHIFT) & PORT_SPD_CAP) { | |
3201 | qib_devinfo(dd->pcidev, "IB%u: Forced to single port mode" | |
3202 | " by module parameter\n", dd->unit); | |
3203 | features &= PORT_SPD_CAP; | |
3204 | } | |
3205 | ||
3206 | return features; | |
3207 | } | |
3208 | ||
3209 | /* | |
3210 | * This routine sleeps, so it can only be called from user context, not | |
3211 | * from interrupt context. | |
3212 | */ | |
3213 | static int qib_do_7322_reset(struct qib_devdata *dd) | |
3214 | { | |
3215 | u64 val; | |
3216 | u64 *msix_vecsave; | |
3217 | int i, msix_entries, ret = 1; | |
3218 | u16 cmdval; | |
3219 | u8 int_line, clinesz; | |
3220 | unsigned long flags; | |
3221 | ||
3222 | /* Use dev_err so it shows up in logs, etc. */ | |
3223 | qib_dev_err(dd, "Resetting InfiniPath unit %u\n", dd->unit); | |
3224 | ||
3225 | qib_pcie_getcmd(dd, &cmdval, &int_line, &clinesz); | |
3226 | ||
3227 | msix_entries = dd->cspec->num_msix_entries; | |
3228 | ||
3229 | /* no interrupts till re-initted */ | |
3230 | qib_7322_set_intr_state(dd, 0); | |
3231 | ||
3232 | if (msix_entries) { | |
3233 | qib_7322_nomsix(dd); | |
3234 | /* can be up to 512 bytes, too big for stack */ | |
3235 | msix_vecsave = kmalloc(2 * dd->cspec->num_msix_entries * | |
3236 | sizeof(u64), GFP_KERNEL); | |
3237 | if (!msix_vecsave) | |
3238 | qib_dev_err(dd, "No mem to save MSIx data\n"); | |
3239 | } else | |
3240 | msix_vecsave = NULL; | |
3241 | ||
3242 | /* | |
3243 | * Core PCI (as of 2.6.18) doesn't save or rewrite the full vector | |
3244 | * info that is set up by the BIOS, so we have to save and restore | |
3245 | * it ourselves. There is some risk something could change it, | |
3246 | * after we save it, but since we have disabled the MSIx, it | |
3247 | * shouldn't be touched... | |
3248 | */ | |
3249 | for (i = 0; i < msix_entries; i++) { | |
3250 | u64 vecaddr, vecdata; | |
3251 | vecaddr = qib_read_kreg64(dd, 2 * i + | |
3252 | (QIB_7322_MsixTable_OFFS / sizeof(u64))); | |
3253 | vecdata = qib_read_kreg64(dd, 1 + 2 * i + | |
3254 | (QIB_7322_MsixTable_OFFS / sizeof(u64))); | |
3255 | if (msix_vecsave) { | |
3256 | msix_vecsave[2 * i] = vecaddr; | |
3257 | /* save it without the masked bit set */ | |
3258 | msix_vecsave[1 + 2 * i] = vecdata & ~0x100000000ULL; | |
3259 | } | |
3260 | } | |
3261 | ||
3262 | dd->pport->cpspec->ibdeltainprog = 0; | |
3263 | dd->pport->cpspec->ibsymdelta = 0; | |
3264 | dd->pport->cpspec->iblnkerrdelta = 0; | |
3265 | dd->pport->cpspec->ibmalfdelta = 0; | |
3266 | dd->int_counter = 0; /* so we check interrupts work again */ | |
3267 | ||
3268 | /* | |
3269 | * Keep chip from being accessed until we are ready. Use | |
3270 | * writeq() directly, to allow the write even though QIB_PRESENT | |
3271 | * isnt' set. | |
3272 | */ | |
3273 | dd->flags &= ~(QIB_INITTED | QIB_PRESENT | QIB_BADINTR); | |
3274 | dd->flags |= QIB_DOING_RESET; | |
3275 | val = dd->control | QLOGIC_IB_C_RESET; | |
3276 | writeq(val, &dd->kregbase[kr_control]); | |
3277 | ||
3278 | for (i = 1; i <= 5; i++) { | |
3279 | /* | |
3280 | * Allow MBIST, etc. to complete; longer on each retry. | |
3281 | * We sometimes get machine checks from bus timeout if no | |
3282 | * response, so for now, make it *really* long. | |
3283 | */ | |
3284 | msleep(1000 + (1 + i) * 3000); | |
3285 | ||
3286 | qib_pcie_reenable(dd, cmdval, int_line, clinesz); | |
3287 | ||
3288 | /* | |
3289 | * Use readq directly, so we don't need to mark it as PRESENT | |
3290 | * until we get a successful indication that all is well. | |
3291 | */ | |
3292 | val = readq(&dd->kregbase[kr_revision]); | |
3293 | if (val == dd->revision) | |
3294 | break; | |
3295 | if (i == 5) { | |
3296 | qib_dev_err(dd, "Failed to initialize after reset, " | |
3297 | "unusable\n"); | |
3298 | ret = 0; | |
3299 | goto bail; | |
3300 | } | |
3301 | } | |
3302 | ||
3303 | dd->flags |= QIB_PRESENT; /* it's back */ | |
3304 | ||
3305 | if (msix_entries) { | |
3306 | /* restore the MSIx vector address and data if saved above */ | |
3307 | for (i = 0; i < msix_entries; i++) { | |
3308 | dd->cspec->msix_entries[i].entry = i; | |
3309 | if (!msix_vecsave || !msix_vecsave[2 * i]) | |
3310 | continue; | |
3311 | qib_write_kreg(dd, 2 * i + | |
3312 | (QIB_7322_MsixTable_OFFS / sizeof(u64)), | |
3313 | msix_vecsave[2 * i]); | |
3314 | qib_write_kreg(dd, 1 + 2 * i + | |
3315 | (QIB_7322_MsixTable_OFFS / sizeof(u64)), | |
3316 | msix_vecsave[1 + 2 * i]); | |
3317 | } | |
3318 | } | |
3319 | ||
3320 | /* initialize the remaining registers. */ | |
3321 | for (i = 0; i < dd->num_pports; ++i) | |
3322 | write_7322_init_portregs(&dd->pport[i]); | |
3323 | write_7322_initregs(dd); | |
3324 | ||
3325 | if (qib_pcie_params(dd, dd->lbus_width, | |
3326 | &dd->cspec->num_msix_entries, | |
3327 | dd->cspec->msix_entries)) | |
3328 | qib_dev_err(dd, "Reset failed to setup PCIe or interrupts; " | |
3329 | "continuing anyway\n"); | |
3330 | ||
3331 | qib_setup_7322_interrupt(dd, 1); | |
3332 | ||
3333 | for (i = 0; i < dd->num_pports; ++i) { | |
3334 | struct qib_pportdata *ppd = &dd->pport[i]; | |
3335 | ||
3336 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
3337 | ppd->lflags |= QIBL_IB_FORCE_NOTIFY; | |
3338 | ppd->lflags &= ~QIBL_IB_AUTONEG_FAILED; | |
3339 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
3340 | } | |
3341 | ||
3342 | bail: | |
3343 | dd->flags &= ~QIB_DOING_RESET; /* OK or not, no longer resetting */ | |
3344 | kfree(msix_vecsave); | |
3345 | return ret; | |
3346 | } | |
3347 | ||
3348 | /** | |
3349 | * qib_7322_put_tid - write a TID to the chip | |
3350 | * @dd: the qlogic_ib device | |
3351 | * @tidptr: pointer to the expected TID (in chip) to update | |
3352 | * @tidtype: 0 for eager, 1 for expected | |
3353 | * @pa: physical address of in memory buffer; tidinvalid if freeing | |
3354 | */ | |
3355 | static void qib_7322_put_tid(struct qib_devdata *dd, u64 __iomem *tidptr, | |
3356 | u32 type, unsigned long pa) | |
3357 | { | |
3358 | if (!(dd->flags & QIB_PRESENT)) | |
3359 | return; | |
3360 | if (pa != dd->tidinvalid) { | |
3361 | u64 chippa = pa >> IBA7322_TID_PA_SHIFT; | |
3362 | ||
3363 | /* paranoia checks */ | |
3364 | if (pa != (chippa << IBA7322_TID_PA_SHIFT)) { | |
3365 | qib_dev_err(dd, "Physaddr %lx not 2KB aligned!\n", | |
3366 | pa); | |
3367 | return; | |
3368 | } | |
3369 | if (chippa >= (1UL << IBA7322_TID_SZ_SHIFT)) { | |
3370 | qib_dev_err(dd, "Physical page address 0x%lx " | |
3371 | "larger than supported\n", pa); | |
3372 | return; | |
3373 | } | |
3374 | ||
3375 | if (type == RCVHQ_RCV_TYPE_EAGER) | |
3376 | chippa |= dd->tidtemplate; | |
3377 | else /* for now, always full 4KB page */ | |
3378 | chippa |= IBA7322_TID_SZ_4K; | |
3379 | pa = chippa; | |
3380 | } | |
3381 | writeq(pa, tidptr); | |
3382 | mmiowb(); | |
3383 | } | |
3384 | ||
3385 | /** | |
3386 | * qib_7322_clear_tids - clear all TID entries for a ctxt, expected and eager | |
3387 | * @dd: the qlogic_ib device | |
3388 | * @ctxt: the ctxt | |
3389 | * | |
3390 | * clear all TID entries for a ctxt, expected and eager. | |
3391 | * Used from qib_close(). | |
3392 | */ | |
3393 | static void qib_7322_clear_tids(struct qib_devdata *dd, | |
3394 | struct qib_ctxtdata *rcd) | |
3395 | { | |
3396 | u64 __iomem *tidbase; | |
3397 | unsigned long tidinv; | |
3398 | u32 ctxt; | |
3399 | int i; | |
3400 | ||
3401 | if (!dd->kregbase || !rcd) | |
3402 | return; | |
3403 | ||
3404 | ctxt = rcd->ctxt; | |
3405 | ||
3406 | tidinv = dd->tidinvalid; | |
3407 | tidbase = (u64 __iomem *) | |
3408 | ((char __iomem *) dd->kregbase + | |
3409 | dd->rcvtidbase + | |
3410 | ctxt * dd->rcvtidcnt * sizeof(*tidbase)); | |
3411 | ||
3412 | for (i = 0; i < dd->rcvtidcnt; i++) | |
3413 | qib_7322_put_tid(dd, &tidbase[i], RCVHQ_RCV_TYPE_EXPECTED, | |
3414 | tidinv); | |
3415 | ||
3416 | tidbase = (u64 __iomem *) | |
3417 | ((char __iomem *) dd->kregbase + | |
3418 | dd->rcvegrbase + | |
3419 | rcd->rcvegr_tid_base * sizeof(*tidbase)); | |
3420 | ||
3421 | for (i = 0; i < rcd->rcvegrcnt; i++) | |
3422 | qib_7322_put_tid(dd, &tidbase[i], RCVHQ_RCV_TYPE_EAGER, | |
3423 | tidinv); | |
3424 | } | |
3425 | ||
3426 | /** | |
3427 | * qib_7322_tidtemplate - setup constants for TID updates | |
3428 | * @dd: the qlogic_ib device | |
3429 | * | |
3430 | * We setup stuff that we use a lot, to avoid calculating each time | |
3431 | */ | |
3432 | static void qib_7322_tidtemplate(struct qib_devdata *dd) | |
3433 | { | |
3434 | /* | |
3435 | * For now, we always allocate 4KB buffers (at init) so we can | |
3436 | * receive max size packets. We may want a module parameter to | |
3437 | * specify 2KB or 4KB and/or make it per port instead of per device | |
3438 | * for those who want to reduce memory footprint. Note that the | |
3439 | * rcvhdrentsize size must be large enough to hold the largest | |
3440 | * IB header (currently 96 bytes) that we expect to handle (plus of | |
3441 | * course the 2 dwords of RHF). | |
3442 | */ | |
3443 | if (dd->rcvegrbufsize == 2048) | |
3444 | dd->tidtemplate = IBA7322_TID_SZ_2K; | |
3445 | else if (dd->rcvegrbufsize == 4096) | |
3446 | dd->tidtemplate = IBA7322_TID_SZ_4K; | |
3447 | dd->tidinvalid = 0; | |
3448 | } | |
3449 | ||
3450 | /** | |
3451 | * qib_init_7322_get_base_info - set chip-specific flags for user code | |
3452 | * @rcd: the qlogic_ib ctxt | |
3453 | * @kbase: qib_base_info pointer | |
3454 | * | |
3455 | * We set the PCIE flag because the lower bandwidth on PCIe vs | |
3456 | * HyperTransport can affect some user packet algorithims. | |
3457 | */ | |
3458 | ||
3459 | static int qib_7322_get_base_info(struct qib_ctxtdata *rcd, | |
3460 | struct qib_base_info *kinfo) | |
3461 | { | |
3462 | kinfo->spi_runtime_flags |= QIB_RUNTIME_CTXT_MSB_IN_QP | | |
3463 | QIB_RUNTIME_PCIE | QIB_RUNTIME_NODMA_RTAIL | | |
3464 | QIB_RUNTIME_HDRSUPP | QIB_RUNTIME_SDMA; | |
3465 | if (rcd->dd->cspec->r1) | |
3466 | kinfo->spi_runtime_flags |= QIB_RUNTIME_RCHK; | |
3467 | if (rcd->dd->flags & QIB_USE_SPCL_TRIG) | |
3468 | kinfo->spi_runtime_flags |= QIB_RUNTIME_SPECIAL_TRIGGER; | |
3469 | ||
3470 | return 0; | |
3471 | } | |
3472 | ||
3473 | static struct qib_message_header * | |
3474 | qib_7322_get_msgheader(struct qib_devdata *dd, __le32 *rhf_addr) | |
3475 | { | |
3476 | u32 offset = qib_hdrget_offset(rhf_addr); | |
3477 | ||
3478 | return (struct qib_message_header *) | |
3479 | (rhf_addr - dd->rhf_offset + offset); | |
3480 | } | |
3481 | ||
3482 | /* | |
3483 | * Configure number of contexts. | |
3484 | */ | |
3485 | static void qib_7322_config_ctxts(struct qib_devdata *dd) | |
3486 | { | |
3487 | unsigned long flags; | |
3488 | u32 nchipctxts; | |
3489 | ||
3490 | nchipctxts = qib_read_kreg32(dd, kr_contextcnt); | |
3491 | dd->cspec->numctxts = nchipctxts; | |
3492 | if (qib_n_krcv_queues > 1 && dd->num_pports) { | |
3493 | /* | |
3494 | * Set the mask for which bits from the QPN are used | |
3495 | * to select a context number. | |
3496 | */ | |
3497 | dd->qpn_mask = 0x3f; | |
3498 | dd->first_user_ctxt = NUM_IB_PORTS + | |
3499 | (qib_n_krcv_queues - 1) * dd->num_pports; | |
3500 | if (dd->first_user_ctxt > nchipctxts) | |
3501 | dd->first_user_ctxt = nchipctxts; | |
3502 | dd->n_krcv_queues = dd->first_user_ctxt / dd->num_pports; | |
3503 | } else { | |
3504 | dd->first_user_ctxt = NUM_IB_PORTS; | |
3505 | dd->n_krcv_queues = 1; | |
3506 | } | |
3507 | ||
3508 | if (!qib_cfgctxts) { | |
3509 | int nctxts = dd->first_user_ctxt + num_online_cpus(); | |
3510 | ||
3511 | if (nctxts <= 6) | |
3512 | dd->ctxtcnt = 6; | |
3513 | else if (nctxts <= 10) | |
3514 | dd->ctxtcnt = 10; | |
3515 | else if (nctxts <= nchipctxts) | |
3516 | dd->ctxtcnt = nchipctxts; | |
3517 | } else if (qib_cfgctxts < dd->num_pports) | |
3518 | dd->ctxtcnt = dd->num_pports; | |
3519 | else if (qib_cfgctxts <= nchipctxts) | |
3520 | dd->ctxtcnt = qib_cfgctxts; | |
3521 | if (!dd->ctxtcnt) /* none of the above, set to max */ | |
3522 | dd->ctxtcnt = nchipctxts; | |
3523 | ||
3524 | /* | |
3525 | * Chip can be configured for 6, 10, or 18 ctxts, and choice | |
3526 | * affects number of eager TIDs per ctxt (1K, 2K, 4K). | |
3527 | * Lock to be paranoid about later motion, etc. | |
3528 | */ | |
3529 | spin_lock_irqsave(&dd->cspec->rcvmod_lock, flags); | |
3530 | if (dd->ctxtcnt > 10) | |
3531 | dd->rcvctrl |= 2ULL << SYM_LSB(RcvCtrl, ContextCfg); | |
3532 | else if (dd->ctxtcnt > 6) | |
3533 | dd->rcvctrl |= 1ULL << SYM_LSB(RcvCtrl, ContextCfg); | |
3534 | /* else configure for default 6 receive ctxts */ | |
3535 | ||
3536 | /* The XRC opcode is 5. */ | |
3537 | dd->rcvctrl |= 5ULL << SYM_LSB(RcvCtrl, XrcTypeCode); | |
3538 | ||
3539 | /* | |
3540 | * RcvCtrl *must* be written here so that the | |
3541 | * chip understands how to change rcvegrcnt below. | |
3542 | */ | |
3543 | qib_write_kreg(dd, kr_rcvctrl, dd->rcvctrl); | |
3544 | spin_unlock_irqrestore(&dd->cspec->rcvmod_lock, flags); | |
3545 | ||
3546 | /* kr_rcvegrcnt changes based on the number of contexts enabled */ | |
3547 | dd->cspec->rcvegrcnt = qib_read_kreg32(dd, kr_rcvegrcnt); | |
0a43e117 MM |
3548 | if (qib_rcvhdrcnt) |
3549 | dd->rcvhdrcnt = max(dd->cspec->rcvegrcnt, qib_rcvhdrcnt); | |
3550 | else | |
3551 | dd->rcvhdrcnt = max(dd->cspec->rcvegrcnt, | |
3552 | dd->num_pports > 1 ? 1024U : 2048U); | |
f931551b RC |
3553 | } |
3554 | ||
3555 | static int qib_7322_get_ib_cfg(struct qib_pportdata *ppd, int which) | |
3556 | { | |
3557 | ||
3558 | int lsb, ret = 0; | |
3559 | u64 maskr; /* right-justified mask */ | |
3560 | ||
3561 | switch (which) { | |
3562 | ||
3563 | case QIB_IB_CFG_LWID_ENB: /* Get allowed Link-width */ | |
3564 | ret = ppd->link_width_enabled; | |
3565 | goto done; | |
3566 | ||
3567 | case QIB_IB_CFG_LWID: /* Get currently active Link-width */ | |
3568 | ret = ppd->link_width_active; | |
3569 | goto done; | |
3570 | ||
3571 | case QIB_IB_CFG_SPD_ENB: /* Get allowed Link speeds */ | |
3572 | ret = ppd->link_speed_enabled; | |
3573 | goto done; | |
3574 | ||
3575 | case QIB_IB_CFG_SPD: /* Get current Link spd */ | |
3576 | ret = ppd->link_speed_active; | |
3577 | goto done; | |
3578 | ||
3579 | case QIB_IB_CFG_RXPOL_ENB: /* Get Auto-RX-polarity enable */ | |
3580 | lsb = SYM_LSB(IBCCtrlB_0, IB_POLARITY_REV_SUPP); | |
3581 | maskr = SYM_RMASK(IBCCtrlB_0, IB_POLARITY_REV_SUPP); | |
3582 | break; | |
3583 | ||
3584 | case QIB_IB_CFG_LREV_ENB: /* Get Auto-Lane-reversal enable */ | |
3585 | lsb = SYM_LSB(IBCCtrlB_0, IB_LANE_REV_SUPPORTED); | |
3586 | maskr = SYM_RMASK(IBCCtrlB_0, IB_LANE_REV_SUPPORTED); | |
3587 | break; | |
3588 | ||
3589 | case QIB_IB_CFG_LINKLATENCY: | |
3590 | ret = qib_read_kreg_port(ppd, krp_ibcstatus_b) & | |
3591 | SYM_MASK(IBCStatusB_0, LinkRoundTripLatency); | |
3592 | goto done; | |
3593 | ||
3594 | case QIB_IB_CFG_OP_VLS: | |
3595 | ret = ppd->vls_operational; | |
3596 | goto done; | |
3597 | ||
3598 | case QIB_IB_CFG_VL_HIGH_CAP: | |
3599 | ret = 16; | |
3600 | goto done; | |
3601 | ||
3602 | case QIB_IB_CFG_VL_LOW_CAP: | |
3603 | ret = 16; | |
3604 | goto done; | |
3605 | ||
3606 | case QIB_IB_CFG_OVERRUN_THRESH: /* IB overrun threshold */ | |
3607 | ret = SYM_FIELD(ppd->cpspec->ibcctrl_a, IBCCtrlA_0, | |
3608 | OverrunThreshold); | |
3609 | goto done; | |
3610 | ||
3611 | case QIB_IB_CFG_PHYERR_THRESH: /* IB PHY error threshold */ | |
3612 | ret = SYM_FIELD(ppd->cpspec->ibcctrl_a, IBCCtrlA_0, | |
3613 | PhyerrThreshold); | |
3614 | goto done; | |
3615 | ||
3616 | case QIB_IB_CFG_LINKDEFAULT: /* IB link default (sleep/poll) */ | |
3617 | /* will only take effect when the link state changes */ | |
3618 | ret = (ppd->cpspec->ibcctrl_a & | |
3619 | SYM_MASK(IBCCtrlA_0, LinkDownDefaultState)) ? | |
3620 | IB_LINKINITCMD_SLEEP : IB_LINKINITCMD_POLL; | |
3621 | goto done; | |
3622 | ||
3623 | case QIB_IB_CFG_HRTBT: /* Get Heartbeat off/enable/auto */ | |
3624 | lsb = IBA7322_IBC_HRTBT_LSB; | |
3625 | maskr = IBA7322_IBC_HRTBT_RMASK; /* OR of AUTO and ENB */ | |
3626 | break; | |
3627 | ||
3628 | case QIB_IB_CFG_PMA_TICKS: | |
3629 | /* | |
3630 | * 0x00 = 10x link transfer rate or 4 nsec. for 2.5Gbs | |
3631 | * Since the clock is always 250MHz, the value is 3, 1 or 0. | |
3632 | */ | |
3633 | if (ppd->link_speed_active == QIB_IB_QDR) | |
3634 | ret = 3; | |
3635 | else if (ppd->link_speed_active == QIB_IB_DDR) | |
3636 | ret = 1; | |
3637 | else | |
3638 | ret = 0; | |
3639 | goto done; | |
3640 | ||
3641 | default: | |
3642 | ret = -EINVAL; | |
3643 | goto done; | |
3644 | } | |
3645 | ret = (int)((ppd->cpspec->ibcctrl_b >> lsb) & maskr); | |
3646 | done: | |
3647 | return ret; | |
3648 | } | |
3649 | ||
3650 | /* | |
3651 | * Below again cribbed liberally from older version. Do not lean | |
3652 | * heavily on it. | |
3653 | */ | |
3654 | #define IBA7322_IBC_DLIDLMC_SHIFT QIB_7322_IBCCtrlB_0_IB_DLID_LSB | |
3655 | #define IBA7322_IBC_DLIDLMC_MASK (QIB_7322_IBCCtrlB_0_IB_DLID_RMASK \ | |
3656 | | (QIB_7322_IBCCtrlB_0_IB_DLID_MASK_RMASK << 16)) | |
3657 | ||
3658 | static int qib_7322_set_ib_cfg(struct qib_pportdata *ppd, int which, u32 val) | |
3659 | { | |
3660 | struct qib_devdata *dd = ppd->dd; | |
3661 | u64 maskr; /* right-justified mask */ | |
3662 | int lsb, ret = 0; | |
3663 | u16 lcmd, licmd; | |
3664 | unsigned long flags; | |
3665 | ||
3666 | switch (which) { | |
3667 | case QIB_IB_CFG_LIDLMC: | |
3668 | /* | |
3669 | * Set LID and LMC. Combined to avoid possible hazard | |
3670 | * caller puts LMC in 16MSbits, DLID in 16LSbits of val | |
3671 | */ | |
3672 | lsb = IBA7322_IBC_DLIDLMC_SHIFT; | |
3673 | maskr = IBA7322_IBC_DLIDLMC_MASK; | |
3674 | /* | |
3675 | * For header-checking, the SLID in the packet will | |
3676 | * be masked with SendIBSLMCMask, and compared | |
3677 | * with SendIBSLIDAssignMask. Make sure we do not | |
3678 | * set any bits not covered by the mask, or we get | |
3679 | * false-positives. | |
3680 | */ | |
3681 | qib_write_kreg_port(ppd, krp_sendslid, | |
3682 | val & (val >> 16) & SendIBSLIDAssignMask); | |
3683 | qib_write_kreg_port(ppd, krp_sendslidmask, | |
3684 | (val >> 16) & SendIBSLMCMask); | |
3685 | break; | |
3686 | ||
3687 | case QIB_IB_CFG_LWID_ENB: /* set allowed Link-width */ | |
3688 | ppd->link_width_enabled = val; | |
3689 | /* convert IB value to chip register value */ | |
3690 | if (val == IB_WIDTH_1X) | |
3691 | val = 0; | |
3692 | else if (val == IB_WIDTH_4X) | |
3693 | val = 1; | |
3694 | else | |
3695 | val = 3; | |
3696 | maskr = SYM_RMASK(IBCCtrlB_0, IB_NUM_CHANNELS); | |
3697 | lsb = SYM_LSB(IBCCtrlB_0, IB_NUM_CHANNELS); | |
3698 | break; | |
3699 | ||
3700 | case QIB_IB_CFG_SPD_ENB: /* set allowed Link speeds */ | |
3701 | /* | |
3702 | * As with width, only write the actual register if the | |
3703 | * link is currently down, otherwise takes effect on next | |
3704 | * link change. Since setting is being explictly requested | |
3705 | * (via MAD or sysfs), clear autoneg failure status if speed | |
3706 | * autoneg is enabled. | |
3707 | */ | |
3708 | ppd->link_speed_enabled = val; | |
3709 | val <<= IBA7322_IBC_SPEED_LSB; | |
3710 | maskr = IBA7322_IBC_SPEED_MASK | IBA7322_IBC_IBTA_1_2_MASK | | |
3711 | IBA7322_IBC_MAX_SPEED_MASK; | |
3712 | if (val & (val - 1)) { | |
3713 | /* Muliple speeds enabled */ | |
3714 | val |= IBA7322_IBC_IBTA_1_2_MASK | | |
3715 | IBA7322_IBC_MAX_SPEED_MASK; | |
3716 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
3717 | ppd->lflags &= ~QIBL_IB_AUTONEG_FAILED; | |
3718 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
3719 | } else if (val & IBA7322_IBC_SPEED_QDR) | |
3720 | val |= IBA7322_IBC_IBTA_1_2_MASK; | |
3721 | /* IBTA 1.2 mode + min/max + speed bits are contiguous */ | |
3722 | lsb = SYM_LSB(IBCCtrlB_0, IB_ENHANCED_MODE); | |
3723 | break; | |
3724 | ||
3725 | case QIB_IB_CFG_RXPOL_ENB: /* set Auto-RX-polarity enable */ | |
3726 | lsb = SYM_LSB(IBCCtrlB_0, IB_POLARITY_REV_SUPP); | |
3727 | maskr = SYM_RMASK(IBCCtrlB_0, IB_POLARITY_REV_SUPP); | |
3728 | break; | |
3729 | ||
3730 | case QIB_IB_CFG_LREV_ENB: /* set Auto-Lane-reversal enable */ | |
3731 | lsb = SYM_LSB(IBCCtrlB_0, IB_LANE_REV_SUPPORTED); | |
3732 | maskr = SYM_RMASK(IBCCtrlB_0, IB_LANE_REV_SUPPORTED); | |
3733 | break; | |
3734 | ||
3735 | case QIB_IB_CFG_OVERRUN_THRESH: /* IB overrun threshold */ | |
3736 | maskr = SYM_FIELD(ppd->cpspec->ibcctrl_a, IBCCtrlA_0, | |
3737 | OverrunThreshold); | |
3738 | if (maskr != val) { | |
3739 | ppd->cpspec->ibcctrl_a &= | |
3740 | ~SYM_MASK(IBCCtrlA_0, OverrunThreshold); | |
3741 | ppd->cpspec->ibcctrl_a |= (u64) val << | |
3742 | SYM_LSB(IBCCtrlA_0, OverrunThreshold); | |
3743 | qib_write_kreg_port(ppd, krp_ibcctrl_a, | |
3744 | ppd->cpspec->ibcctrl_a); | |
3745 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
3746 | } | |
3747 | goto bail; | |
3748 | ||
3749 | case QIB_IB_CFG_PHYERR_THRESH: /* IB PHY error threshold */ | |
3750 | maskr = SYM_FIELD(ppd->cpspec->ibcctrl_a, IBCCtrlA_0, | |
3751 | PhyerrThreshold); | |
3752 | if (maskr != val) { | |
3753 | ppd->cpspec->ibcctrl_a &= | |
3754 | ~SYM_MASK(IBCCtrlA_0, PhyerrThreshold); | |
3755 | ppd->cpspec->ibcctrl_a |= (u64) val << | |
3756 | SYM_LSB(IBCCtrlA_0, PhyerrThreshold); | |
3757 | qib_write_kreg_port(ppd, krp_ibcctrl_a, | |
3758 | ppd->cpspec->ibcctrl_a); | |
3759 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
3760 | } | |
3761 | goto bail; | |
3762 | ||
3763 | case QIB_IB_CFG_PKEYS: /* update pkeys */ | |
3764 | maskr = (u64) ppd->pkeys[0] | ((u64) ppd->pkeys[1] << 16) | | |
3765 | ((u64) ppd->pkeys[2] << 32) | | |
3766 | ((u64) ppd->pkeys[3] << 48); | |
3767 | qib_write_kreg_port(ppd, krp_partitionkey, maskr); | |
3768 | goto bail; | |
3769 | ||
3770 | case QIB_IB_CFG_LINKDEFAULT: /* IB link default (sleep/poll) */ | |
3771 | /* will only take effect when the link state changes */ | |
3772 | if (val == IB_LINKINITCMD_POLL) | |
3773 | ppd->cpspec->ibcctrl_a &= | |
3774 | ~SYM_MASK(IBCCtrlA_0, LinkDownDefaultState); | |
3775 | else /* SLEEP */ | |
3776 | ppd->cpspec->ibcctrl_a |= | |
3777 | SYM_MASK(IBCCtrlA_0, LinkDownDefaultState); | |
3778 | qib_write_kreg_port(ppd, krp_ibcctrl_a, ppd->cpspec->ibcctrl_a); | |
3779 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
3780 | goto bail; | |
3781 | ||
3782 | case QIB_IB_CFG_MTU: /* update the MTU in IBC */ | |
3783 | /* | |
3784 | * Update our housekeeping variables, and set IBC max | |
3785 | * size, same as init code; max IBC is max we allow in | |
3786 | * buffer, less the qword pbc, plus 1 for ICRC, in dwords | |
3787 | * Set even if it's unchanged, print debug message only | |
3788 | * on changes. | |
3789 | */ | |
3790 | val = (ppd->ibmaxlen >> 2) + 1; | |
3791 | ppd->cpspec->ibcctrl_a &= ~SYM_MASK(IBCCtrlA_0, MaxPktLen); | |
3792 | ppd->cpspec->ibcctrl_a |= (u64)val << | |
3793 | SYM_LSB(IBCCtrlA_0, MaxPktLen); | |
3794 | qib_write_kreg_port(ppd, krp_ibcctrl_a, | |
3795 | ppd->cpspec->ibcctrl_a); | |
3796 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
3797 | goto bail; | |
3798 | ||
3799 | case QIB_IB_CFG_LSTATE: /* set the IB link state */ | |
3800 | switch (val & 0xffff0000) { | |
3801 | case IB_LINKCMD_DOWN: | |
3802 | lcmd = QLOGIC_IB_IBCC_LINKCMD_DOWN; | |
3803 | ppd->cpspec->ibmalfusesnap = 1; | |
3804 | ppd->cpspec->ibmalfsnap = read_7322_creg32_port(ppd, | |
3805 | crp_errlink); | |
3806 | if (!ppd->cpspec->ibdeltainprog && | |
3807 | qib_compat_ddr_negotiate) { | |
3808 | ppd->cpspec->ibdeltainprog = 1; | |
3809 | ppd->cpspec->ibsymsnap = | |
3810 | read_7322_creg32_port(ppd, | |
3811 | crp_ibsymbolerr); | |
3812 | ppd->cpspec->iblnkerrsnap = | |
3813 | read_7322_creg32_port(ppd, | |
3814 | crp_iblinkerrrecov); | |
3815 | } | |
3816 | break; | |
3817 | ||
3818 | case IB_LINKCMD_ARMED: | |
3819 | lcmd = QLOGIC_IB_IBCC_LINKCMD_ARMED; | |
3820 | if (ppd->cpspec->ibmalfusesnap) { | |
3821 | ppd->cpspec->ibmalfusesnap = 0; | |
3822 | ppd->cpspec->ibmalfdelta += | |
3823 | read_7322_creg32_port(ppd, | |
3824 | crp_errlink) - | |
3825 | ppd->cpspec->ibmalfsnap; | |
3826 | } | |
3827 | break; | |
3828 | ||
3829 | case IB_LINKCMD_ACTIVE: | |
3830 | lcmd = QLOGIC_IB_IBCC_LINKCMD_ACTIVE; | |
3831 | break; | |
3832 | ||
3833 | default: | |
3834 | ret = -EINVAL; | |
3835 | qib_dev_err(dd, "bad linkcmd req 0x%x\n", val >> 16); | |
3836 | goto bail; | |
3837 | } | |
3838 | switch (val & 0xffff) { | |
3839 | case IB_LINKINITCMD_NOP: | |
3840 | licmd = 0; | |
3841 | break; | |
3842 | ||
3843 | case IB_LINKINITCMD_POLL: | |
3844 | licmd = QLOGIC_IB_IBCC_LINKINITCMD_POLL; | |
3845 | break; | |
3846 | ||
3847 | case IB_LINKINITCMD_SLEEP: | |
3848 | licmd = QLOGIC_IB_IBCC_LINKINITCMD_SLEEP; | |
3849 | break; | |
3850 | ||
3851 | case IB_LINKINITCMD_DISABLE: | |
3852 | licmd = QLOGIC_IB_IBCC_LINKINITCMD_DISABLE; | |
3853 | ppd->cpspec->chase_end = 0; | |
3854 | /* | |
3855 | * stop state chase counter and timer, if running. | |
3856 | * wait forpending timer, but don't clear .data (ppd)! | |
3857 | */ | |
3858 | if (ppd->cpspec->chase_timer.expires) { | |
3859 | del_timer_sync(&ppd->cpspec->chase_timer); | |
3860 | ppd->cpspec->chase_timer.expires = 0; | |
3861 | } | |
3862 | break; | |
3863 | ||
3864 | default: | |
3865 | ret = -EINVAL; | |
3866 | qib_dev_err(dd, "bad linkinitcmd req 0x%x\n", | |
3867 | val & 0xffff); | |
3868 | goto bail; | |
3869 | } | |
3870 | qib_set_ib_7322_lstate(ppd, lcmd, licmd); | |
3871 | goto bail; | |
3872 | ||
3873 | case QIB_IB_CFG_OP_VLS: | |
3874 | if (ppd->vls_operational != val) { | |
3875 | ppd->vls_operational = val; | |
3876 | set_vls(ppd); | |
3877 | } | |
3878 | goto bail; | |
3879 | ||
3880 | case QIB_IB_CFG_VL_HIGH_LIMIT: | |
3881 | qib_write_kreg_port(ppd, krp_highprio_limit, val); | |
3882 | goto bail; | |
3883 | ||
3884 | case QIB_IB_CFG_HRTBT: /* set Heartbeat off/enable/auto */ | |
3885 | if (val > 3) { | |
3886 | ret = -EINVAL; | |
3887 | goto bail; | |
3888 | } | |
3889 | lsb = IBA7322_IBC_HRTBT_LSB; | |
3890 | maskr = IBA7322_IBC_HRTBT_RMASK; /* OR of AUTO and ENB */ | |
3891 | break; | |
3892 | ||
3893 | case QIB_IB_CFG_PORT: | |
3894 | /* val is the port number of the switch we are connected to. */ | |
3895 | if (ppd->dd->cspec->r1) { | |
3896 | cancel_delayed_work(&ppd->cpspec->ipg_work); | |
3897 | ppd->cpspec->ipg_tries = 0; | |
3898 | } | |
3899 | goto bail; | |
3900 | ||
3901 | default: | |
3902 | ret = -EINVAL; | |
3903 | goto bail; | |
3904 | } | |
3905 | ppd->cpspec->ibcctrl_b &= ~(maskr << lsb); | |
3906 | ppd->cpspec->ibcctrl_b |= (((u64) val & maskr) << lsb); | |
3907 | qib_write_kreg_port(ppd, krp_ibcctrl_b, ppd->cpspec->ibcctrl_b); | |
3908 | qib_write_kreg(dd, kr_scratch, 0); | |
3909 | bail: | |
3910 | return ret; | |
3911 | } | |
3912 | ||
3913 | static int qib_7322_set_loopback(struct qib_pportdata *ppd, const char *what) | |
3914 | { | |
3915 | int ret = 0; | |
3916 | u64 val, ctrlb; | |
3917 | ||
3918 | /* only IBC loopback, may add serdes and xgxs loopbacks later */ | |
3919 | if (!strncmp(what, "ibc", 3)) { | |
3920 | ppd->cpspec->ibcctrl_a |= SYM_MASK(IBCCtrlA_0, | |
3921 | Loopback); | |
3922 | val = 0; /* disable heart beat, so link will come up */ | |
3923 | qib_devinfo(ppd->dd->pcidev, "Enabling IB%u:%u IBC loopback\n", | |
3924 | ppd->dd->unit, ppd->port); | |
3925 | } else if (!strncmp(what, "off", 3)) { | |
3926 | ppd->cpspec->ibcctrl_a &= ~SYM_MASK(IBCCtrlA_0, | |
3927 | Loopback); | |
3928 | /* enable heart beat again */ | |
3929 | val = IBA7322_IBC_HRTBT_RMASK << IBA7322_IBC_HRTBT_LSB; | |
3930 | qib_devinfo(ppd->dd->pcidev, "Disabling IB%u:%u IBC loopback " | |
3931 | "(normal)\n", ppd->dd->unit, ppd->port); | |
3932 | } else | |
3933 | ret = -EINVAL; | |
3934 | if (!ret) { | |
3935 | qib_write_kreg_port(ppd, krp_ibcctrl_a, | |
3936 | ppd->cpspec->ibcctrl_a); | |
3937 | ctrlb = ppd->cpspec->ibcctrl_b & ~(IBA7322_IBC_HRTBT_MASK | |
3938 | << IBA7322_IBC_HRTBT_LSB); | |
3939 | ppd->cpspec->ibcctrl_b = ctrlb | val; | |
3940 | qib_write_kreg_port(ppd, krp_ibcctrl_b, | |
3941 | ppd->cpspec->ibcctrl_b); | |
3942 | qib_write_kreg(ppd->dd, kr_scratch, 0); | |
3943 | } | |
3944 | return ret; | |
3945 | } | |
3946 | ||
3947 | static void get_vl_weights(struct qib_pportdata *ppd, unsigned regno, | |
3948 | struct ib_vl_weight_elem *vl) | |
3949 | { | |
3950 | unsigned i; | |
3951 | ||
3952 | for (i = 0; i < 16; i++, regno++, vl++) { | |
3953 | u32 val = qib_read_kreg_port(ppd, regno); | |
3954 | ||
3955 | vl->vl = (val >> SYM_LSB(LowPriority0_0, VirtualLane)) & | |
3956 | SYM_RMASK(LowPriority0_0, VirtualLane); | |
3957 | vl->weight = (val >> SYM_LSB(LowPriority0_0, Weight)) & | |
3958 | SYM_RMASK(LowPriority0_0, Weight); | |
3959 | } | |
3960 | } | |
3961 | ||
3962 | static void set_vl_weights(struct qib_pportdata *ppd, unsigned regno, | |
3963 | struct ib_vl_weight_elem *vl) | |
3964 | { | |
3965 | unsigned i; | |
3966 | ||
3967 | for (i = 0; i < 16; i++, regno++, vl++) { | |
3968 | u64 val; | |
3969 | ||
3970 | val = ((vl->vl & SYM_RMASK(LowPriority0_0, VirtualLane)) << | |
3971 | SYM_LSB(LowPriority0_0, VirtualLane)) | | |
3972 | ((vl->weight & SYM_RMASK(LowPriority0_0, Weight)) << | |
3973 | SYM_LSB(LowPriority0_0, Weight)); | |
3974 | qib_write_kreg_port(ppd, regno, val); | |
3975 | } | |
3976 | if (!(ppd->p_sendctrl & SYM_MASK(SendCtrl_0, IBVLArbiterEn))) { | |
3977 | struct qib_devdata *dd = ppd->dd; | |
3978 | unsigned long flags; | |
3979 | ||
3980 | spin_lock_irqsave(&dd->sendctrl_lock, flags); | |
3981 | ppd->p_sendctrl |= SYM_MASK(SendCtrl_0, IBVLArbiterEn); | |
3982 | qib_write_kreg_port(ppd, krp_sendctrl, ppd->p_sendctrl); | |
3983 | qib_write_kreg(dd, kr_scratch, 0); | |
3984 | spin_unlock_irqrestore(&dd->sendctrl_lock, flags); | |
3985 | } | |
3986 | } | |
3987 | ||
3988 | static int qib_7322_get_ib_table(struct qib_pportdata *ppd, int which, void *t) | |
3989 | { | |
3990 | switch (which) { | |
3991 | case QIB_IB_TBL_VL_HIGH_ARB: | |
3992 | get_vl_weights(ppd, krp_highprio_0, t); | |
3993 | break; | |
3994 | ||
3995 | case QIB_IB_TBL_VL_LOW_ARB: | |
3996 | get_vl_weights(ppd, krp_lowprio_0, t); | |
3997 | break; | |
3998 | ||
3999 | default: | |
4000 | return -EINVAL; | |
4001 | } | |
4002 | return 0; | |
4003 | } | |
4004 | ||
4005 | static int qib_7322_set_ib_table(struct qib_pportdata *ppd, int which, void *t) | |
4006 | { | |
4007 | switch (which) { | |
4008 | case QIB_IB_TBL_VL_HIGH_ARB: | |
4009 | set_vl_weights(ppd, krp_highprio_0, t); | |
4010 | break; | |
4011 | ||
4012 | case QIB_IB_TBL_VL_LOW_ARB: | |
4013 | set_vl_weights(ppd, krp_lowprio_0, t); | |
4014 | break; | |
4015 | ||
4016 | default: | |
4017 | return -EINVAL; | |
4018 | } | |
4019 | return 0; | |
4020 | } | |
4021 | ||
4022 | static void qib_update_7322_usrhead(struct qib_ctxtdata *rcd, u64 hd, | |
4023 | u32 updegr, u32 egrhd) | |
4024 | { | |
4025 | qib_write_ureg(rcd->dd, ur_rcvhdrhead, hd, rcd->ctxt); | |
4026 | qib_write_ureg(rcd->dd, ur_rcvhdrhead, hd, rcd->ctxt); | |
4027 | if (updegr) | |
4028 | qib_write_ureg(rcd->dd, ur_rcvegrindexhead, egrhd, rcd->ctxt); | |
4029 | } | |
4030 | ||
4031 | static u32 qib_7322_hdrqempty(struct qib_ctxtdata *rcd) | |
4032 | { | |
4033 | u32 head, tail; | |
4034 | ||
4035 | head = qib_read_ureg32(rcd->dd, ur_rcvhdrhead, rcd->ctxt); | |
4036 | if (rcd->rcvhdrtail_kvaddr) | |
4037 | tail = qib_get_rcvhdrtail(rcd); | |
4038 | else | |
4039 | tail = qib_read_ureg32(rcd->dd, ur_rcvhdrtail, rcd->ctxt); | |
4040 | return head == tail; | |
4041 | } | |
4042 | ||
4043 | #define RCVCTRL_COMMON_MODS (QIB_RCVCTRL_CTXT_ENB | \ | |
4044 | QIB_RCVCTRL_CTXT_DIS | \ | |
4045 | QIB_RCVCTRL_TIDFLOW_ENB | \ | |
4046 | QIB_RCVCTRL_TIDFLOW_DIS | \ | |
4047 | QIB_RCVCTRL_TAILUPD_ENB | \ | |
4048 | QIB_RCVCTRL_TAILUPD_DIS | \ | |
4049 | QIB_RCVCTRL_INTRAVAIL_ENB | \ | |
4050 | QIB_RCVCTRL_INTRAVAIL_DIS | \ | |
4051 | QIB_RCVCTRL_BP_ENB | \ | |
4052 | QIB_RCVCTRL_BP_DIS) | |
4053 | ||
4054 | #define RCVCTRL_PORT_MODS (QIB_RCVCTRL_CTXT_ENB | \ | |
4055 | QIB_RCVCTRL_CTXT_DIS | \ | |
4056 | QIB_RCVCTRL_PKEY_DIS | \ | |
4057 | QIB_RCVCTRL_PKEY_ENB) | |
4058 | ||
4059 | /* | |
4060 | * Modify the RCVCTRL register in chip-specific way. This | |
4061 | * is a function because bit positions and (future) register | |
4062 | * location is chip-specifc, but the needed operations are | |
4063 | * generic. <op> is a bit-mask because we often want to | |
4064 | * do multiple modifications. | |
4065 | */ | |
4066 | static void rcvctrl_7322_mod(struct qib_pportdata *ppd, unsigned int op, | |
4067 | int ctxt) | |
4068 | { | |
4069 | struct qib_devdata *dd = ppd->dd; | |
4070 | struct qib_ctxtdata *rcd; | |
4071 | u64 mask, val; | |
4072 | unsigned long flags; | |
4073 | ||
4074 | spin_lock_irqsave(&dd->cspec->rcvmod_lock, flags); | |
4075 | ||
4076 | if (op & QIB_RCVCTRL_TIDFLOW_ENB) | |
4077 | dd->rcvctrl |= SYM_MASK(RcvCtrl, TidFlowEnable); | |
4078 | if (op & QIB_RCVCTRL_TIDFLOW_DIS) | |
4079 | dd->rcvctrl &= ~SYM_MASK(RcvCtrl, TidFlowEnable); | |
4080 | if (op & QIB_RCVCTRL_TAILUPD_ENB) | |
4081 | dd->rcvctrl |= SYM_MASK(RcvCtrl, TailUpd); | |
4082 | if (op & QIB_RCVCTRL_TAILUPD_DIS) | |
4083 | dd->rcvctrl &= ~SYM_MASK(RcvCtrl, TailUpd); | |
4084 | if (op & QIB_RCVCTRL_PKEY_ENB) | |
4085 | ppd->p_rcvctrl &= ~SYM_MASK(RcvCtrl_0, RcvPartitionKeyDisable); | |
4086 | if (op & QIB_RCVCTRL_PKEY_DIS) | |
4087 | ppd->p_rcvctrl |= SYM_MASK(RcvCtrl_0, RcvPartitionKeyDisable); | |
4088 | if (ctxt < 0) { | |
4089 | mask = (1ULL << dd->ctxtcnt) - 1; | |
4090 | rcd = NULL; | |
4091 | } else { | |
4092 | mask = (1ULL << ctxt); | |
4093 | rcd = dd->rcd[ctxt]; | |
4094 | } | |
4095 | if ((op & QIB_RCVCTRL_CTXT_ENB) && rcd) { | |
4096 | ppd->p_rcvctrl |= | |
4097 | (mask << SYM_LSB(RcvCtrl_0, ContextEnableKernel)); | |
4098 | if (!(dd->flags & QIB_NODMA_RTAIL)) { | |
4099 | op |= QIB_RCVCTRL_TAILUPD_ENB; /* need reg write */ | |
4100 | dd->rcvctrl |= SYM_MASK(RcvCtrl, TailUpd); | |
4101 | } | |
4102 | /* Write these registers before the context is enabled. */ | |
4103 | qib_write_kreg_ctxt(dd, krc_rcvhdrtailaddr, ctxt, | |
4104 | rcd->rcvhdrqtailaddr_phys); | |
4105 | qib_write_kreg_ctxt(dd, krc_rcvhdraddr, ctxt, | |
4106 | rcd->rcvhdrq_phys); | |
4107 | rcd->seq_cnt = 1; | |
f931551b RC |
4108 | } |
4109 | if (op & QIB_RCVCTRL_CTXT_DIS) | |
4110 | ppd->p_rcvctrl &= | |
4111 | ~(mask << SYM_LSB(RcvCtrl_0, ContextEnableKernel)); | |
4112 | if (op & QIB_RCVCTRL_BP_ENB) | |
4113 | dd->rcvctrl |= mask << SYM_LSB(RcvCtrl, dontDropRHQFull); | |
4114 | if (op & QIB_RCVCTRL_BP_DIS) | |
4115 | dd->rcvctrl &= ~(mask << SYM_LSB(RcvCtrl, dontDropRHQFull)); | |
4116 | if (op & QIB_RCVCTRL_INTRAVAIL_ENB) | |
4117 | dd->rcvctrl |= (mask << SYM_LSB(RcvCtrl, IntrAvail)); | |
4118 | if (op & QIB_RCVCTRL_INTRAVAIL_DIS) | |
4119 | dd->rcvctrl &= ~(mask << SYM_LSB(RcvCtrl, IntrAvail)); | |
4120 | /* | |
4121 | * Decide which registers to write depending on the ops enabled. | |
4122 | * Special case is "flush" (no bits set at all) | |
4123 | * which needs to write both. | |
4124 | */ | |
4125 | if (op == 0 || (op & RCVCTRL_COMMON_MODS)) | |
4126 | qib_write_kreg(dd, kr_rcvctrl, dd->rcvctrl); | |
4127 | if (op == 0 || (op & RCVCTRL_PORT_MODS)) | |
4128 | qib_write_kreg_port(ppd, krp_rcvctrl, ppd->p_rcvctrl); | |
4129 | if ((op & QIB_RCVCTRL_CTXT_ENB) && dd->rcd[ctxt]) { | |
4130 | /* | |
4131 | * Init the context registers also; if we were | |
4132 | * disabled, tail and head should both be zero | |
4133 | * already from the enable, but since we don't | |
4134 | * know, we have to do it explictly. | |
4135 | */ | |
4136 | val = qib_read_ureg32(dd, ur_rcvegrindextail, ctxt); | |
4137 | qib_write_ureg(dd, ur_rcvegrindexhead, val, ctxt); | |
4138 | ||
4139 | /* be sure enabling write seen; hd/tl should be 0 */ | |
4140 | (void) qib_read_kreg32(dd, kr_scratch); | |
4141 | val = qib_read_ureg32(dd, ur_rcvhdrtail, ctxt); | |
4142 | dd->rcd[ctxt]->head = val; | |
4143 | /* If kctxt, interrupt on next receive. */ | |
4144 | if (ctxt < dd->first_user_ctxt) | |
4145 | val |= dd->rhdrhead_intr_off; | |
4146 | qib_write_ureg(dd, ur_rcvhdrhead, val, ctxt); | |
4147 | } else if ((op & QIB_RCVCTRL_INTRAVAIL_ENB) && | |
4148 | dd->rcd[ctxt] && dd->rhdrhead_intr_off) { | |
4149 | /* arm rcv interrupt */ | |
4150 | val = dd->rcd[ctxt]->head | dd->rhdrhead_intr_off; | |
4151 | qib_write_ureg(dd, ur_rcvhdrhead, val, ctxt); | |
4152 | } | |
4153 | if (op & QIB_RCVCTRL_CTXT_DIS) { | |
4154 | unsigned f; | |
4155 | ||
4156 | /* Now that the context is disabled, clear these registers. */ | |
4157 | if (ctxt >= 0) { | |
4158 | qib_write_kreg_ctxt(dd, krc_rcvhdrtailaddr, ctxt, 0); | |
4159 | qib_write_kreg_ctxt(dd, krc_rcvhdraddr, ctxt, 0); | |
4160 | for (f = 0; f < NUM_TIDFLOWS_CTXT; f++) | |
4161 | qib_write_ureg(dd, ur_rcvflowtable + f, | |
4162 | TIDFLOW_ERRBITS, ctxt); | |
4163 | } else { | |
4164 | unsigned i; | |
4165 | ||
4166 | for (i = 0; i < dd->cfgctxts; i++) { | |
4167 | qib_write_kreg_ctxt(dd, krc_rcvhdrtailaddr, | |
4168 | i, 0); | |
4169 | qib_write_kreg_ctxt(dd, krc_rcvhdraddr, i, 0); | |
4170 | for (f = 0; f < NUM_TIDFLOWS_CTXT; f++) | |
4171 | qib_write_ureg(dd, ur_rcvflowtable + f, | |
4172 | TIDFLOW_ERRBITS, i); | |
4173 | } | |
4174 | } | |
4175 | } | |
4176 | spin_unlock_irqrestore(&dd->cspec->rcvmod_lock, flags); | |
4177 | } | |
4178 | ||
4179 | /* | |
4180 | * Modify the SENDCTRL register in chip-specific way. This | |
4181 | * is a function where there are multiple such registers with | |
4182 | * slightly different layouts. | |
4183 | * The chip doesn't allow back-to-back sendctrl writes, so write | |
4184 | * the scratch register after writing sendctrl. | |
4185 | * | |
4186 | * Which register is written depends on the operation. | |
4187 | * Most operate on the common register, while | |
4188 | * SEND_ENB and SEND_DIS operate on the per-port ones. | |
4189 | * SEND_ENB is included in common because it can change SPCL_TRIG | |
4190 | */ | |
4191 | #define SENDCTRL_COMMON_MODS (\ | |
4192 | QIB_SENDCTRL_CLEAR | \ | |
4193 | QIB_SENDCTRL_AVAIL_DIS | \ | |
4194 | QIB_SENDCTRL_AVAIL_ENB | \ | |
4195 | QIB_SENDCTRL_AVAIL_BLIP | \ | |
4196 | QIB_SENDCTRL_DISARM | \ | |
4197 | QIB_SENDCTRL_DISARM_ALL | \ | |
4198 | QIB_SENDCTRL_SEND_ENB) | |
4199 | ||
4200 | #define SENDCTRL_PORT_MODS (\ | |
4201 | QIB_SENDCTRL_CLEAR | \ | |
4202 | QIB_SENDCTRL_SEND_ENB | \ | |
4203 | QIB_SENDCTRL_SEND_DIS | \ | |
4204 | QIB_SENDCTRL_FLUSH) | |
4205 | ||
4206 | static void sendctrl_7322_mod(struct qib_pportdata *ppd, u32 op) | |
4207 | { | |
4208 | struct qib_devdata *dd = ppd->dd; | |
4209 | u64 tmp_dd_sendctrl; | |
4210 | unsigned long flags; | |
4211 | ||
4212 | spin_lock_irqsave(&dd->sendctrl_lock, flags); | |
4213 | ||
4214 | /* First the dd ones that are "sticky", saved in shadow */ | |
4215 | if (op & QIB_SENDCTRL_CLEAR) | |
4216 | dd->sendctrl = 0; | |
4217 | if (op & QIB_SENDCTRL_AVAIL_DIS) | |
4218 | dd->sendctrl &= ~SYM_MASK(SendCtrl, SendBufAvailUpd); | |
4219 | else if (op & QIB_SENDCTRL_AVAIL_ENB) { | |
4220 | dd->sendctrl |= SYM_MASK(SendCtrl, SendBufAvailUpd); | |
4221 | if (dd->flags & QIB_USE_SPCL_TRIG) | |
4222 | dd->sendctrl |= SYM_MASK(SendCtrl, SpecialTriggerEn); | |
4223 | } | |
4224 | ||
4225 | /* Then the ppd ones that are "sticky", saved in shadow */ | |
4226 | if (op & QIB_SENDCTRL_SEND_DIS) | |
4227 | ppd->p_sendctrl &= ~SYM_MASK(SendCtrl_0, SendEnable); | |
4228 | else if (op & QIB_SENDCTRL_SEND_ENB) | |
4229 | ppd->p_sendctrl |= SYM_MASK(SendCtrl_0, SendEnable); | |
4230 | ||
4231 | if (op & QIB_SENDCTRL_DISARM_ALL) { | |
4232 | u32 i, last; | |
4233 | ||
4234 | tmp_dd_sendctrl = dd->sendctrl; | |
4235 | last = dd->piobcnt2k + dd->piobcnt4k + NUM_VL15_BUFS; | |
4236 | /* | |
4237 | * Disarm any buffers that are not yet launched, | |
4238 | * disabling updates until done. | |
4239 | */ | |
4240 | tmp_dd_sendctrl &= ~SYM_MASK(SendCtrl, SendBufAvailUpd); | |
4241 | for (i = 0; i < last; i++) { | |
4242 | qib_write_kreg(dd, kr_sendctrl, | |
4243 | tmp_dd_sendctrl | | |
4244 | SYM_MASK(SendCtrl, Disarm) | i); | |
4245 | qib_write_kreg(dd, kr_scratch, 0); | |
4246 | } | |
4247 | } | |
4248 | ||
4249 | if (op & QIB_SENDCTRL_FLUSH) { | |
4250 | u64 tmp_ppd_sendctrl = ppd->p_sendctrl; | |
4251 | ||
4252 | /* | |
4253 | * Now drain all the fifos. The Abort bit should never be | |
4254 | * needed, so for now, at least, we don't use it. | |
4255 | */ | |
4256 | tmp_ppd_sendctrl |= | |
4257 | SYM_MASK(SendCtrl_0, TxeDrainRmFifo) | | |
4258 | SYM_MASK(SendCtrl_0, TxeDrainLaFifo) | | |
4259 | SYM_MASK(SendCtrl_0, TxeBypassIbc); | |
4260 | qib_write_kreg_port(ppd, krp_sendctrl, tmp_ppd_sendctrl); | |
4261 | qib_write_kreg(dd, kr_scratch, 0); | |
4262 | } | |
4263 | ||
4264 | tmp_dd_sendctrl = dd->sendctrl; | |
4265 | ||
4266 | if (op & QIB_SENDCTRL_DISARM) | |
4267 | tmp_dd_sendctrl |= SYM_MASK(SendCtrl, Disarm) | | |
4268 | ((op & QIB_7322_SendCtrl_DisarmSendBuf_RMASK) << | |
4269 | SYM_LSB(SendCtrl, DisarmSendBuf)); | |
4270 | if ((op & QIB_SENDCTRL_AVAIL_BLIP) && | |
4271 | (dd->sendctrl & SYM_MASK(SendCtrl, SendBufAvailUpd))) | |
4272 | tmp_dd_sendctrl &= ~SYM_MASK(SendCtrl, SendBufAvailUpd); | |
4273 | ||
4274 | if (op == 0 || (op & SENDCTRL_COMMON_MODS)) { | |
4275 | qib_write_kreg(dd, kr_sendctrl, tmp_dd_sendctrl); | |
4276 | qib_write_kreg(dd, kr_scratch, 0); | |
4277 | } | |
4278 | ||
4279 | if (op == 0 || (op & SENDCTRL_PORT_MODS)) { | |
4280 | qib_write_kreg_port(ppd, krp_sendctrl, ppd->p_sendctrl); | |
4281 | qib_write_kreg(dd, kr_scratch, 0); | |
4282 | } | |
4283 | ||
4284 | if (op & QIB_SENDCTRL_AVAIL_BLIP) { | |
4285 | qib_write_kreg(dd, kr_sendctrl, dd->sendctrl); | |
4286 | qib_write_kreg(dd, kr_scratch, 0); | |
4287 | } | |
4288 | ||
4289 | spin_unlock_irqrestore(&dd->sendctrl_lock, flags); | |
4290 | ||
4291 | if (op & QIB_SENDCTRL_FLUSH) { | |
4292 | u32 v; | |
4293 | /* | |
4294 | * ensure writes have hit chip, then do a few | |
4295 | * more reads, to allow DMA of pioavail registers | |
4296 | * to occur, so in-memory copy is in sync with | |
4297 | * the chip. Not always safe to sleep. | |
4298 | */ | |
4299 | v = qib_read_kreg32(dd, kr_scratch); | |
4300 | qib_write_kreg(dd, kr_scratch, v); | |
4301 | v = qib_read_kreg32(dd, kr_scratch); | |
4302 | qib_write_kreg(dd, kr_scratch, v); | |
4303 | qib_read_kreg32(dd, kr_scratch); | |
4304 | } | |
4305 | } | |
4306 | ||
4307 | #define _PORT_VIRT_FLAG 0x8000U /* "virtual", need adjustments */ | |
4308 | #define _PORT_64BIT_FLAG 0x10000U /* not "virtual", but 64bit */ | |
4309 | #define _PORT_CNTR_IDXMASK 0x7fffU /* mask off flags above */ | |
4310 | ||
4311 | /** | |
4312 | * qib_portcntr_7322 - read a per-port chip counter | |
4313 | * @ppd: the qlogic_ib pport | |
4314 | * @creg: the counter to read (not a chip offset) | |
4315 | */ | |
4316 | static u64 qib_portcntr_7322(struct qib_pportdata *ppd, u32 reg) | |
4317 | { | |
4318 | struct qib_devdata *dd = ppd->dd; | |
4319 | u64 ret = 0ULL; | |
4320 | u16 creg; | |
4321 | /* 0xffff for unimplemented or synthesized counters */ | |
4322 | static const u32 xlator[] = { | |
4323 | [QIBPORTCNTR_PKTSEND] = crp_pktsend | _PORT_64BIT_FLAG, | |
4324 | [QIBPORTCNTR_WORDSEND] = crp_wordsend | _PORT_64BIT_FLAG, | |
4325 | [QIBPORTCNTR_PSXMITDATA] = crp_psxmitdatacount, | |
4326 | [QIBPORTCNTR_PSXMITPKTS] = crp_psxmitpktscount, | |
4327 | [QIBPORTCNTR_PSXMITWAIT] = crp_psxmitwaitcount, | |
4328 | [QIBPORTCNTR_SENDSTALL] = crp_sendstall, | |
4329 | [QIBPORTCNTR_PKTRCV] = crp_pktrcv | _PORT_64BIT_FLAG, | |
4330 | [QIBPORTCNTR_PSRCVDATA] = crp_psrcvdatacount, | |
4331 | [QIBPORTCNTR_PSRCVPKTS] = crp_psrcvpktscount, | |
4332 | [QIBPORTCNTR_RCVEBP] = crp_rcvebp, | |
4333 | [QIBPORTCNTR_RCVOVFL] = crp_rcvovfl, | |
4334 | [QIBPORTCNTR_WORDRCV] = crp_wordrcv | _PORT_64BIT_FLAG, | |
4335 | [QIBPORTCNTR_RXDROPPKT] = 0xffff, /* not needed for 7322 */ | |
4336 | [QIBPORTCNTR_RXLOCALPHYERR] = crp_rxotherlocalphyerr, | |
4337 | [QIBPORTCNTR_RXVLERR] = crp_rxvlerr, | |
4338 | [QIBPORTCNTR_ERRICRC] = crp_erricrc, | |
4339 | [QIBPORTCNTR_ERRVCRC] = crp_errvcrc, | |
4340 | [QIBPORTCNTR_ERRLPCRC] = crp_errlpcrc, | |
4341 | [QIBPORTCNTR_BADFORMAT] = crp_badformat, | |
4342 | [QIBPORTCNTR_ERR_RLEN] = crp_err_rlen, | |
4343 | [QIBPORTCNTR_IBSYMBOLERR] = crp_ibsymbolerr, | |
4344 | [QIBPORTCNTR_INVALIDRLEN] = crp_invalidrlen, | |
4345 | [QIBPORTCNTR_UNSUPVL] = crp_txunsupvl, | |
4346 | [QIBPORTCNTR_EXCESSBUFOVFL] = crp_excessbufferovfl, | |
4347 | [QIBPORTCNTR_ERRLINK] = crp_errlink, | |
4348 | [QIBPORTCNTR_IBLINKDOWN] = crp_iblinkdown, | |
4349 | [QIBPORTCNTR_IBLINKERRRECOV] = crp_iblinkerrrecov, | |
4350 | [QIBPORTCNTR_LLI] = crp_locallinkintegrityerr, | |
4351 | [QIBPORTCNTR_VL15PKTDROP] = crp_vl15droppedpkt, | |
4352 | [QIBPORTCNTR_ERRPKEY] = crp_errpkey, | |
4353 | /* | |
4354 | * the next 3 aren't really counters, but were implemented | |
4355 | * as counters in older chips, so still get accessed as | |
4356 | * though they were counters from this code. | |
4357 | */ | |
4358 | [QIBPORTCNTR_PSINTERVAL] = krp_psinterval, | |
4359 | [QIBPORTCNTR_PSSTART] = krp_psstart, | |
4360 | [QIBPORTCNTR_PSSTAT] = krp_psstat, | |
4361 | /* pseudo-counter, summed for all ports */ | |
4362 | [QIBPORTCNTR_KHDROVFL] = 0xffff, | |
4363 | }; | |
4364 | ||
4365 | if (reg >= ARRAY_SIZE(xlator)) { | |
4366 | qib_devinfo(ppd->dd->pcidev, | |
4367 | "Unimplemented portcounter %u\n", reg); | |
4368 | goto done; | |
4369 | } | |
4370 | creg = xlator[reg] & _PORT_CNTR_IDXMASK; | |
4371 | ||
4372 | /* handle non-counters and special cases first */ | |
4373 | if (reg == QIBPORTCNTR_KHDROVFL) { | |
4374 | int i; | |
4375 | ||
4376 | /* sum over all kernel contexts (skip if mini_init) */ | |
4377 | for (i = 0; dd->rcd && i < dd->first_user_ctxt; i++) { | |
4378 | struct qib_ctxtdata *rcd = dd->rcd[i]; | |
4379 | ||
4380 | if (!rcd || rcd->ppd != ppd) | |
4381 | continue; | |
4382 | ret += read_7322_creg32(dd, cr_base_egrovfl + i); | |
4383 | } | |
4384 | goto done; | |
4385 | } else if (reg == QIBPORTCNTR_RXDROPPKT) { | |
4386 | /* | |
4387 | * Used as part of the synthesis of port_rcv_errors | |
4388 | * in the verbs code for IBTA counters. Not needed for 7322, | |
4389 | * because all the errors are already counted by other cntrs. | |
4390 | */ | |
4391 | goto done; | |
4392 | } else if (reg == QIBPORTCNTR_PSINTERVAL || | |
4393 | reg == QIBPORTCNTR_PSSTART || reg == QIBPORTCNTR_PSSTAT) { | |
4394 | /* were counters in older chips, now per-port kernel regs */ | |
4395 | ret = qib_read_kreg_port(ppd, creg); | |
4396 | goto done; | |
4397 | } | |
4398 | ||
4399 | /* | |
4400 | * Only fast increment counters are 64 bits; use 32 bit reads to | |
4401 | * avoid two independent reads when on Opteron. | |
4402 | */ | |
4403 | if (xlator[reg] & _PORT_64BIT_FLAG) | |
4404 | ret = read_7322_creg_port(ppd, creg); | |
4405 | else | |
4406 | ret = read_7322_creg32_port(ppd, creg); | |
4407 | if (creg == crp_ibsymbolerr) { | |
4408 | if (ppd->cpspec->ibdeltainprog) | |
4409 | ret -= ret - ppd->cpspec->ibsymsnap; | |
4410 | ret -= ppd->cpspec->ibsymdelta; | |
4411 | } else if (creg == crp_iblinkerrrecov) { | |
4412 | if (ppd->cpspec->ibdeltainprog) | |
4413 | ret -= ret - ppd->cpspec->iblnkerrsnap; | |
4414 | ret -= ppd->cpspec->iblnkerrdelta; | |
4415 | } else if (creg == crp_errlink) | |
4416 | ret -= ppd->cpspec->ibmalfdelta; | |
4417 | else if (creg == crp_iblinkdown) | |
4418 | ret += ppd->cpspec->iblnkdowndelta; | |
4419 | done: | |
4420 | return ret; | |
4421 | } | |
4422 | ||
4423 | /* | |
4424 | * Device counter names (not port-specific), one line per stat, | |
4425 | * single string. Used by utilities like ipathstats to print the stats | |
4426 | * in a way which works for different versions of drivers, without changing | |
4427 | * the utility. Names need to be 12 chars or less (w/o newline), for proper | |
4428 | * display by utility. | |
4429 | * Non-error counters are first. | |
4430 | * Start of "error" conters is indicated by a leading "E " on the first | |
4431 | * "error" counter, and doesn't count in label length. | |
4432 | * The EgrOvfl list needs to be last so we truncate them at the configured | |
4433 | * context count for the device. | |
4434 | * cntr7322indices contains the corresponding register indices. | |
4435 | */ | |
4436 | static const char cntr7322names[] = | |
4437 | "Interrupts\n" | |
4438 | "HostBusStall\n" | |
4439 | "E RxTIDFull\n" | |
4440 | "RxTIDInvalid\n" | |
4441 | "RxTIDFloDrop\n" /* 7322 only */ | |
4442 | "Ctxt0EgrOvfl\n" | |
4443 | "Ctxt1EgrOvfl\n" | |
4444 | "Ctxt2EgrOvfl\n" | |
4445 | "Ctxt3EgrOvfl\n" | |
4446 | "Ctxt4EgrOvfl\n" | |
4447 | "Ctxt5EgrOvfl\n" | |
4448 | "Ctxt6EgrOvfl\n" | |
4449 | "Ctxt7EgrOvfl\n" | |
4450 | "Ctxt8EgrOvfl\n" | |
4451 | "Ctxt9EgrOvfl\n" | |
4452 | "Ctx10EgrOvfl\n" | |
4453 | "Ctx11EgrOvfl\n" | |
4454 | "Ctx12EgrOvfl\n" | |
4455 | "Ctx13EgrOvfl\n" | |
4456 | "Ctx14EgrOvfl\n" | |
4457 | "Ctx15EgrOvfl\n" | |
4458 | "Ctx16EgrOvfl\n" | |
4459 | "Ctx17EgrOvfl\n" | |
4460 | ; | |
4461 | ||
4462 | static const u32 cntr7322indices[] = { | |
4463 | cr_lbint | _PORT_64BIT_FLAG, | |
4464 | cr_lbstall | _PORT_64BIT_FLAG, | |
4465 | cr_tidfull, | |
4466 | cr_tidinvalid, | |
4467 | cr_rxtidflowdrop, | |
4468 | cr_base_egrovfl + 0, | |
4469 | cr_base_egrovfl + 1, | |
4470 | cr_base_egrovfl + 2, | |
4471 | cr_base_egrovfl + 3, | |
4472 | cr_base_egrovfl + 4, | |
4473 | cr_base_egrovfl + 5, | |
4474 | cr_base_egrovfl + 6, | |
4475 | cr_base_egrovfl + 7, | |
4476 | cr_base_egrovfl + 8, | |
4477 | cr_base_egrovfl + 9, | |
4478 | cr_base_egrovfl + 10, | |
4479 | cr_base_egrovfl + 11, | |
4480 | cr_base_egrovfl + 12, | |
4481 | cr_base_egrovfl + 13, | |
4482 | cr_base_egrovfl + 14, | |
4483 | cr_base_egrovfl + 15, | |
4484 | cr_base_egrovfl + 16, | |
4485 | cr_base_egrovfl + 17, | |
4486 | }; | |
4487 | ||
4488 | /* | |
4489 | * same as cntr7322names and cntr7322indices, but for port-specific counters. | |
4490 | * portcntr7322indices is somewhat complicated by some registers needing | |
4491 | * adjustments of various kinds, and those are ORed with _PORT_VIRT_FLAG | |
4492 | */ | |
4493 | static const char portcntr7322names[] = | |
4494 | "TxPkt\n" | |
4495 | "TxFlowPkt\n" | |
4496 | "TxWords\n" | |
4497 | "RxPkt\n" | |
4498 | "RxFlowPkt\n" | |
4499 | "RxWords\n" | |
4500 | "TxFlowStall\n" | |
4501 | "TxDmaDesc\n" /* 7220 and 7322-only */ | |
4502 | "E RxDlidFltr\n" /* 7220 and 7322-only */ | |
4503 | "IBStatusChng\n" | |
4504 | "IBLinkDown\n" | |
4505 | "IBLnkRecov\n" | |
4506 | "IBRxLinkErr\n" | |
4507 | "IBSymbolErr\n" | |
4508 | "RxLLIErr\n" | |
4509 | "RxBadFormat\n" | |
4510 | "RxBadLen\n" | |
4511 | "RxBufOvrfl\n" | |
4512 | "RxEBP\n" | |
4513 | "RxFlowCtlErr\n" | |
4514 | "RxICRCerr\n" | |
4515 | "RxLPCRCerr\n" | |
4516 | "RxVCRCerr\n" | |
4517 | "RxInvalLen\n" | |
4518 | "RxInvalPKey\n" | |
4519 | "RxPktDropped\n" | |
4520 | "TxBadLength\n" | |
4521 | "TxDropped\n" | |
4522 | "TxInvalLen\n" | |
4523 | "TxUnderrun\n" | |
4524 | "TxUnsupVL\n" | |
4525 | "RxLclPhyErr\n" /* 7220 and 7322-only from here down */ | |
4526 | "RxVL15Drop\n" | |
4527 | "RxVlErr\n" | |
4528 | "XcessBufOvfl\n" | |
4529 | "RxQPBadCtxt\n" /* 7322-only from here down */ | |
4530 | "TXBadHeader\n" | |
4531 | ; | |
4532 | ||
4533 | static const u32 portcntr7322indices[] = { | |
4534 | QIBPORTCNTR_PKTSEND | _PORT_VIRT_FLAG, | |
4535 | crp_pktsendflow, | |
4536 | QIBPORTCNTR_WORDSEND | _PORT_VIRT_FLAG, | |
4537 | QIBPORTCNTR_PKTRCV | _PORT_VIRT_FLAG, | |
4538 | crp_pktrcvflowctrl, | |
4539 | QIBPORTCNTR_WORDRCV | _PORT_VIRT_FLAG, | |
4540 | QIBPORTCNTR_SENDSTALL | _PORT_VIRT_FLAG, | |
4541 | crp_txsdmadesc | _PORT_64BIT_FLAG, | |
4542 | crp_rxdlidfltr, | |
4543 | crp_ibstatuschange, | |
4544 | QIBPORTCNTR_IBLINKDOWN | _PORT_VIRT_FLAG, | |
4545 | QIBPORTCNTR_IBLINKERRRECOV | _PORT_VIRT_FLAG, | |
4546 | QIBPORTCNTR_ERRLINK | _PORT_VIRT_FLAG, | |
4547 | QIBPORTCNTR_IBSYMBOLERR | _PORT_VIRT_FLAG, | |
4548 | QIBPORTCNTR_LLI | _PORT_VIRT_FLAG, | |
4549 | QIBPORTCNTR_BADFORMAT | _PORT_VIRT_FLAG, | |
4550 | QIBPORTCNTR_ERR_RLEN | _PORT_VIRT_FLAG, | |
4551 | QIBPORTCNTR_RCVOVFL | _PORT_VIRT_FLAG, | |
4552 | QIBPORTCNTR_RCVEBP | _PORT_VIRT_FLAG, | |
4553 | crp_rcvflowctrlviol, | |
4554 | QIBPORTCNTR_ERRICRC | _PORT_VIRT_FLAG, | |
4555 | QIBPORTCNTR_ERRLPCRC | _PORT_VIRT_FLAG, | |
4556 | QIBPORTCNTR_ERRVCRC | _PORT_VIRT_FLAG, | |
4557 | QIBPORTCNTR_INVALIDRLEN | _PORT_VIRT_FLAG, | |
4558 | QIBPORTCNTR_ERRPKEY | _PORT_VIRT_FLAG, | |
4559 | QIBPORTCNTR_RXDROPPKT | _PORT_VIRT_FLAG, | |
4560 | crp_txminmaxlenerr, | |
4561 | crp_txdroppedpkt, | |
4562 | crp_txlenerr, | |
4563 | crp_txunderrun, | |
4564 | crp_txunsupvl, | |
4565 | QIBPORTCNTR_RXLOCALPHYERR | _PORT_VIRT_FLAG, | |
4566 | QIBPORTCNTR_VL15PKTDROP | _PORT_VIRT_FLAG, | |
4567 | QIBPORTCNTR_RXVLERR | _PORT_VIRT_FLAG, | |
4568 | QIBPORTCNTR_EXCESSBUFOVFL | _PORT_VIRT_FLAG, | |
4569 | crp_rxqpinvalidctxt, | |
4570 | crp_txhdrerr, | |
4571 | }; | |
4572 | ||
4573 | /* do all the setup to make the counter reads efficient later */ | |
4574 | static void init_7322_cntrnames(struct qib_devdata *dd) | |
4575 | { | |
4576 | int i, j = 0; | |
4577 | char *s; | |
4578 | ||
4579 | for (i = 0, s = (char *)cntr7322names; s && j <= dd->cfgctxts; | |
4580 | i++) { | |
4581 | /* we always have at least one counter before the egrovfl */ | |
4582 | if (!j && !strncmp("Ctxt0EgrOvfl", s + 1, 12)) | |
4583 | j = 1; | |
4584 | s = strchr(s + 1, '\n'); | |
4585 | if (s && j) | |
4586 | j++; | |
4587 | } | |
4588 | dd->cspec->ncntrs = i; | |
4589 | if (!s) | |
4590 | /* full list; size is without terminating null */ | |
4591 | dd->cspec->cntrnamelen = sizeof(cntr7322names) - 1; | |
4592 | else | |
4593 | dd->cspec->cntrnamelen = 1 + s - cntr7322names; | |
4594 | dd->cspec->cntrs = kmalloc(dd->cspec->ncntrs | |
4595 | * sizeof(u64), GFP_KERNEL); | |
4596 | if (!dd->cspec->cntrs) | |
4597 | qib_dev_err(dd, "Failed allocation for counters\n"); | |
4598 | ||
4599 | for (i = 0, s = (char *)portcntr7322names; s; i++) | |
4600 | s = strchr(s + 1, '\n'); | |
4601 | dd->cspec->nportcntrs = i - 1; | |
4602 | dd->cspec->portcntrnamelen = sizeof(portcntr7322names) - 1; | |
4603 | for (i = 0; i < dd->num_pports; ++i) { | |
4604 | dd->pport[i].cpspec->portcntrs = kmalloc(dd->cspec->nportcntrs | |
4605 | * sizeof(u64), GFP_KERNEL); | |
4606 | if (!dd->pport[i].cpspec->portcntrs) | |
4607 | qib_dev_err(dd, "Failed allocation for" | |
4608 | " portcounters\n"); | |
4609 | } | |
4610 | } | |
4611 | ||
4612 | static u32 qib_read_7322cntrs(struct qib_devdata *dd, loff_t pos, char **namep, | |
4613 | u64 **cntrp) | |
4614 | { | |
4615 | u32 ret; | |
4616 | ||
4617 | if (namep) { | |
4618 | ret = dd->cspec->cntrnamelen; | |
4619 | if (pos >= ret) | |
4620 | ret = 0; /* final read after getting everything */ | |
4621 | else | |
4622 | *namep = (char *) cntr7322names; | |
4623 | } else { | |
4624 | u64 *cntr = dd->cspec->cntrs; | |
4625 | int i; | |
4626 | ||
4627 | ret = dd->cspec->ncntrs * sizeof(u64); | |
4628 | if (!cntr || pos >= ret) { | |
4629 | /* everything read, or couldn't get memory */ | |
4630 | ret = 0; | |
4631 | goto done; | |
4632 | } | |
4633 | *cntrp = cntr; | |
4634 | for (i = 0; i < dd->cspec->ncntrs; i++) | |
4635 | if (cntr7322indices[i] & _PORT_64BIT_FLAG) | |
4636 | *cntr++ = read_7322_creg(dd, | |
4637 | cntr7322indices[i] & | |
4638 | _PORT_CNTR_IDXMASK); | |
4639 | else | |
4640 | *cntr++ = read_7322_creg32(dd, | |
4641 | cntr7322indices[i]); | |
4642 | } | |
4643 | done: | |
4644 | return ret; | |
4645 | } | |
4646 | ||
4647 | static u32 qib_read_7322portcntrs(struct qib_devdata *dd, loff_t pos, u32 port, | |
4648 | char **namep, u64 **cntrp) | |
4649 | { | |
4650 | u32 ret; | |
4651 | ||
4652 | if (namep) { | |
4653 | ret = dd->cspec->portcntrnamelen; | |
4654 | if (pos >= ret) | |
4655 | ret = 0; /* final read after getting everything */ | |
4656 | else | |
4657 | *namep = (char *)portcntr7322names; | |
4658 | } else { | |
4659 | struct qib_pportdata *ppd = &dd->pport[port]; | |
4660 | u64 *cntr = ppd->cpspec->portcntrs; | |
4661 | int i; | |
4662 | ||
4663 | ret = dd->cspec->nportcntrs * sizeof(u64); | |
4664 | if (!cntr || pos >= ret) { | |
4665 | /* everything read, or couldn't get memory */ | |
4666 | ret = 0; | |
4667 | goto done; | |
4668 | } | |
4669 | *cntrp = cntr; | |
4670 | for (i = 0; i < dd->cspec->nportcntrs; i++) { | |
4671 | if (portcntr7322indices[i] & _PORT_VIRT_FLAG) | |
4672 | *cntr++ = qib_portcntr_7322(ppd, | |
4673 | portcntr7322indices[i] & | |
4674 | _PORT_CNTR_IDXMASK); | |
4675 | else if (portcntr7322indices[i] & _PORT_64BIT_FLAG) | |
4676 | *cntr++ = read_7322_creg_port(ppd, | |
4677 | portcntr7322indices[i] & | |
4678 | _PORT_CNTR_IDXMASK); | |
4679 | else | |
4680 | *cntr++ = read_7322_creg32_port(ppd, | |
4681 | portcntr7322indices[i]); | |
4682 | } | |
4683 | } | |
4684 | done: | |
4685 | return ret; | |
4686 | } | |
4687 | ||
4688 | /** | |
4689 | * qib_get_7322_faststats - get word counters from chip before they overflow | |
4690 | * @opaque - contains a pointer to the qlogic_ib device qib_devdata | |
4691 | * | |
4692 | * VESTIGIAL IBA7322 has no "small fast counters", so the only | |
4693 | * real purpose of this function is to maintain the notion of | |
4694 | * "active time", which in turn is only logged into the eeprom, | |
4695 | * which we don;t have, yet, for 7322-based boards. | |
4696 | * | |
4697 | * called from add_timer | |
4698 | */ | |
4699 | static void qib_get_7322_faststats(unsigned long opaque) | |
4700 | { | |
4701 | struct qib_devdata *dd = (struct qib_devdata *) opaque; | |
4702 | struct qib_pportdata *ppd; | |
4703 | unsigned long flags; | |
4704 | u64 traffic_wds; | |
4705 | int pidx; | |
4706 | ||
4707 | for (pidx = 0; pidx < dd->num_pports; ++pidx) { | |
4708 | ppd = dd->pport + pidx; | |
4709 | ||
4710 | /* | |
4711 | * If port isn't enabled or not operational ports, or | |
4712 | * diags is running (can cause memory diags to fail) | |
4713 | * skip this port this time. | |
4714 | */ | |
4715 | if (!ppd->link_speed_supported || !(dd->flags & QIB_INITTED) | |
4716 | || dd->diag_client) | |
4717 | continue; | |
4718 | ||
4719 | /* | |
4720 | * Maintain an activity timer, based on traffic | |
4721 | * exceeding a threshold, so we need to check the word-counts | |
4722 | * even if they are 64-bit. | |
4723 | */ | |
4724 | traffic_wds = qib_portcntr_7322(ppd, QIBPORTCNTR_WORDRCV) + | |
4725 | qib_portcntr_7322(ppd, QIBPORTCNTR_WORDSEND); | |
4726 | spin_lock_irqsave(&ppd->dd->eep_st_lock, flags); | |
4727 | traffic_wds -= ppd->dd->traffic_wds; | |
4728 | ppd->dd->traffic_wds += traffic_wds; | |
4729 | if (traffic_wds >= QIB_TRAFFIC_ACTIVE_THRESHOLD) | |
4730 | atomic_add(ACTIVITY_TIMER, &ppd->dd->active_time); | |
4731 | spin_unlock_irqrestore(&ppd->dd->eep_st_lock, flags); | |
4732 | if (ppd->cpspec->qdr_dfe_on && (ppd->link_speed_active & | |
4733 | QIB_IB_QDR) && | |
4734 | (ppd->lflags & (QIBL_LINKINIT | QIBL_LINKARMED | | |
4735 | QIBL_LINKACTIVE)) && | |
4736 | ppd->cpspec->qdr_dfe_time && | |
4737 | time_after64(get_jiffies_64(), ppd->cpspec->qdr_dfe_time)) { | |
4738 | ppd->cpspec->qdr_dfe_on = 0; | |
4739 | ||
4740 | qib_write_kreg_port(ppd, krp_static_adapt_dis(2), | |
4741 | ppd->dd->cspec->r1 ? | |
4742 | QDR_STATIC_ADAPT_INIT_R1 : | |
4743 | QDR_STATIC_ADAPT_INIT); | |
4744 | force_h1(ppd); | |
4745 | } | |
4746 | } | |
4747 | mod_timer(&dd->stats_timer, jiffies + HZ * ACTIVITY_TIMER); | |
4748 | } | |
4749 | ||
4750 | /* | |
4751 | * If we were using MSIx, try to fallback to INTx. | |
4752 | */ | |
4753 | static int qib_7322_intr_fallback(struct qib_devdata *dd) | |
4754 | { | |
4755 | if (!dd->cspec->num_msix_entries) | |
4756 | return 0; /* already using INTx */ | |
4757 | ||
4758 | qib_devinfo(dd->pcidev, "MSIx interrupt not detected," | |
4759 | " trying INTx interrupts\n"); | |
4760 | qib_7322_nomsix(dd); | |
4761 | qib_enable_intx(dd->pcidev); | |
4762 | qib_setup_7322_interrupt(dd, 0); | |
4763 | return 1; | |
4764 | } | |
4765 | ||
4766 | /* | |
4767 | * Reset the XGXS (between serdes and IBC). Slightly less intrusive | |
4768 | * than resetting the IBC or external link state, and useful in some | |
4769 | * cases to cause some retraining. To do this right, we reset IBC | |
4770 | * as well, then return to previous state (which may be still in reset) | |
4771 | * NOTE: some callers of this "know" this writes the current value | |
4772 | * of cpspec->ibcctrl_a as part of it's operation, so if that changes, | |
4773 | * check all callers. | |
4774 | */ | |
4775 | static void qib_7322_mini_pcs_reset(struct qib_pportdata *ppd) | |
4776 | { | |
4777 | u64 val; | |
4778 | struct qib_devdata *dd = ppd->dd; | |
4779 | const u64 reset_bits = SYM_MASK(IBPCSConfig_0, xcv_rreset) | | |
4780 | SYM_MASK(IBPCSConfig_0, xcv_treset) | | |
4781 | SYM_MASK(IBPCSConfig_0, tx_rx_reset); | |
4782 | ||
4783 | val = qib_read_kreg_port(ppd, krp_ib_pcsconfig); | |
b9e03e04 RC |
4784 | qib_write_kreg(dd, kr_hwerrmask, |
4785 | dd->cspec->hwerrmask & ~HWE_MASK(statusValidNoEop)); | |
f931551b RC |
4786 | qib_write_kreg_port(ppd, krp_ibcctrl_a, |
4787 | ppd->cpspec->ibcctrl_a & | |
4788 | ~SYM_MASK(IBCCtrlA_0, IBLinkEn)); | |
4789 | ||
4790 | qib_write_kreg_port(ppd, krp_ib_pcsconfig, val | reset_bits); | |
4791 | qib_read_kreg32(dd, kr_scratch); | |
4792 | qib_write_kreg_port(ppd, krp_ib_pcsconfig, val & ~reset_bits); | |
4793 | qib_write_kreg_port(ppd, krp_ibcctrl_a, ppd->cpspec->ibcctrl_a); | |
4794 | qib_write_kreg(dd, kr_scratch, 0ULL); | |
b9e03e04 RC |
4795 | qib_write_kreg(dd, kr_hwerrclear, |
4796 | SYM_MASK(HwErrClear, statusValidNoEopClear)); | |
4797 | qib_write_kreg(dd, kr_hwerrmask, dd->cspec->hwerrmask); | |
f931551b RC |
4798 | } |
4799 | ||
4800 | /* | |
4801 | * This code for non-IBTA-compliant IB speed negotiation is only known to | |
4802 | * work for the SDR to DDR transition, and only between an HCA and a switch | |
4803 | * with recent firmware. It is based on observed heuristics, rather than | |
4804 | * actual knowledge of the non-compliant speed negotiation. | |
4805 | * It has a number of hard-coded fields, since the hope is to rewrite this | |
4806 | * when a spec is available on how the negoation is intended to work. | |
4807 | */ | |
4808 | static void autoneg_7322_sendpkt(struct qib_pportdata *ppd, u32 *hdr, | |
4809 | u32 dcnt, u32 *data) | |
4810 | { | |
4811 | int i; | |
4812 | u64 pbc; | |
4813 | u32 __iomem *piobuf; | |
4814 | u32 pnum, control, len; | |
4815 | struct qib_devdata *dd = ppd->dd; | |
4816 | ||
4817 | i = 0; | |
4818 | len = 7 + dcnt + 1; /* 7 dword header, dword data, icrc */ | |
4819 | control = qib_7322_setpbc_control(ppd, len, 0, 15); | |
4820 | pbc = ((u64) control << 32) | len; | |
4821 | while (!(piobuf = qib_7322_getsendbuf(ppd, pbc, &pnum))) { | |
4822 | if (i++ > 15) | |
4823 | return; | |
4824 | udelay(2); | |
4825 | } | |
4826 | /* disable header check on this packet, since it can't be valid */ | |
4827 | dd->f_txchk_change(dd, pnum, 1, TXCHK_CHG_TYPE_DIS1, NULL); | |
4828 | writeq(pbc, piobuf); | |
4829 | qib_flush_wc(); | |
4830 | qib_pio_copy(piobuf + 2, hdr, 7); | |
4831 | qib_pio_copy(piobuf + 9, data, dcnt); | |
4832 | if (dd->flags & QIB_USE_SPCL_TRIG) { | |
4833 | u32 spcl_off = (pnum >= dd->piobcnt2k) ? 2047 : 1023; | |
4834 | ||
4835 | qib_flush_wc(); | |
4836 | __raw_writel(0xaebecede, piobuf + spcl_off); | |
4837 | } | |
4838 | qib_flush_wc(); | |
4839 | qib_sendbuf_done(dd, pnum); | |
4840 | /* and re-enable hdr check */ | |
4841 | dd->f_txchk_change(dd, pnum, 1, TXCHK_CHG_TYPE_ENAB1, NULL); | |
4842 | } | |
4843 | ||
4844 | /* | |
4845 | * _start packet gets sent twice at start, _done gets sent twice at end | |
4846 | */ | |
4847 | static void qib_autoneg_7322_send(struct qib_pportdata *ppd, int which) | |
4848 | { | |
4849 | struct qib_devdata *dd = ppd->dd; | |
4850 | static u32 swapped; | |
4851 | u32 dw, i, hcnt, dcnt, *data; | |
4852 | static u32 hdr[7] = { 0xf002ffff, 0x48ffff, 0x6400abba }; | |
4853 | static u32 madpayload_start[0x40] = { | |
4854 | 0x1810103, 0x1, 0x0, 0x0, 0x2c90000, 0x2c9, 0x0, 0x0, | |
4855 | 0xffffffff, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, | |
4856 | 0x1, 0x1388, 0x15e, 0x1, /* rest 0's */ | |
4857 | }; | |
4858 | static u32 madpayload_done[0x40] = { | |
4859 | 0x1810103, 0x1, 0x0, 0x0, 0x2c90000, 0x2c9, 0x0, 0x0, | |
4860 | 0xffffffff, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, | |
4861 | 0x40000001, 0x1388, 0x15e, /* rest 0's */ | |
4862 | }; | |
4863 | ||
4864 | dcnt = ARRAY_SIZE(madpayload_start); | |
4865 | hcnt = ARRAY_SIZE(hdr); | |
4866 | if (!swapped) { | |
4867 | /* for maintainability, do it at runtime */ | |
4868 | for (i = 0; i < hcnt; i++) { | |
4869 | dw = (__force u32) cpu_to_be32(hdr[i]); | |
4870 | hdr[i] = dw; | |
4871 | } | |
4872 | for (i = 0; i < dcnt; i++) { | |
4873 | dw = (__force u32) cpu_to_be32(madpayload_start[i]); | |
4874 | madpayload_start[i] = dw; | |
4875 | dw = (__force u32) cpu_to_be32(madpayload_done[i]); | |
4876 | madpayload_done[i] = dw; | |
4877 | } | |
4878 | swapped = 1; | |
4879 | } | |
4880 | ||
4881 | data = which ? madpayload_done : madpayload_start; | |
4882 | ||
4883 | autoneg_7322_sendpkt(ppd, hdr, dcnt, data); | |
4884 | qib_read_kreg64(dd, kr_scratch); | |
4885 | udelay(2); | |
4886 | autoneg_7322_sendpkt(ppd, hdr, dcnt, data); | |
4887 | qib_read_kreg64(dd, kr_scratch); | |
4888 | udelay(2); | |
4889 | } | |
4890 | ||
4891 | /* | |
4892 | * Do the absolute minimum to cause an IB speed change, and make it | |
4893 | * ready, but don't actually trigger the change. The caller will | |
4894 | * do that when ready (if link is in Polling training state, it will | |
4895 | * happen immediately, otherwise when link next goes down) | |
4896 | * | |
4897 | * This routine should only be used as part of the DDR autonegotation | |
4898 | * code for devices that are not compliant with IB 1.2 (or code that | |
4899 | * fixes things up for same). | |
4900 | * | |
4901 | * When link has gone down, and autoneg enabled, or autoneg has | |
4902 | * failed and we give up until next time we set both speeds, and | |
4903 | * then we want IBTA enabled as well as "use max enabled speed. | |
4904 | */ | |
4905 | static void set_7322_ibspeed_fast(struct qib_pportdata *ppd, u32 speed) | |
4906 | { | |
4907 | u64 newctrlb; | |
4908 | newctrlb = ppd->cpspec->ibcctrl_b & ~(IBA7322_IBC_SPEED_MASK | | |
4909 | IBA7322_IBC_IBTA_1_2_MASK | | |
4910 | IBA7322_IBC_MAX_SPEED_MASK); | |
4911 | ||
4912 | if (speed & (speed - 1)) /* multiple speeds */ | |
4913 | newctrlb |= (speed << IBA7322_IBC_SPEED_LSB) | | |
4914 | IBA7322_IBC_IBTA_1_2_MASK | | |
4915 | IBA7322_IBC_MAX_SPEED_MASK; | |
4916 | else | |
4917 | newctrlb |= speed == QIB_IB_QDR ? | |
4918 | IBA7322_IBC_SPEED_QDR | IBA7322_IBC_IBTA_1_2_MASK : | |
4919 | ((speed == QIB_IB_DDR ? | |
4920 | IBA7322_IBC_SPEED_DDR : IBA7322_IBC_SPEED_SDR)); | |
4921 | ||
4922 | if (newctrlb == ppd->cpspec->ibcctrl_b) | |
4923 | return; | |
4924 | ||
4925 | ppd->cpspec->ibcctrl_b = newctrlb; | |
4926 | qib_write_kreg_port(ppd, krp_ibcctrl_b, ppd->cpspec->ibcctrl_b); | |
4927 | qib_write_kreg(ppd->dd, kr_scratch, 0); | |
4928 | } | |
4929 | ||
4930 | /* | |
4931 | * This routine is only used when we are not talking to another | |
4932 | * IB 1.2-compliant device that we think can do DDR. | |
4933 | * (This includes all existing switch chips as of Oct 2007.) | |
4934 | * 1.2-compliant devices go directly to DDR prior to reaching INIT | |
4935 | */ | |
4936 | static void try_7322_autoneg(struct qib_pportdata *ppd) | |
4937 | { | |
4938 | unsigned long flags; | |
4939 | ||
4940 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
4941 | ppd->lflags |= QIBL_IB_AUTONEG_INPROG; | |
4942 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
4943 | qib_autoneg_7322_send(ppd, 0); | |
4944 | set_7322_ibspeed_fast(ppd, QIB_IB_DDR); | |
4945 | qib_7322_mini_pcs_reset(ppd); | |
4946 | /* 2 msec is minimum length of a poll cycle */ | |
4947 | schedule_delayed_work(&ppd->cpspec->autoneg_work, | |
4948 | msecs_to_jiffies(2)); | |
4949 | } | |
4950 | ||
4951 | /* | |
4952 | * Handle the empirically determined mechanism for auto-negotiation | |
4953 | * of DDR speed with switches. | |
4954 | */ | |
4955 | static void autoneg_7322_work(struct work_struct *work) | |
4956 | { | |
4957 | struct qib_pportdata *ppd; | |
4958 | struct qib_devdata *dd; | |
4959 | u64 startms; | |
4960 | u32 i; | |
4961 | unsigned long flags; | |
4962 | ||
4963 | ppd = container_of(work, struct qib_chippport_specific, | |
4964 | autoneg_work.work)->ppd; | |
4965 | dd = ppd->dd; | |
4966 | ||
4967 | startms = jiffies_to_msecs(jiffies); | |
4968 | ||
4969 | /* | |
4970 | * Busy wait for this first part, it should be at most a | |
4971 | * few hundred usec, since we scheduled ourselves for 2msec. | |
4972 | */ | |
4973 | for (i = 0; i < 25; i++) { | |
4974 | if (SYM_FIELD(ppd->lastibcstat, IBCStatusA_0, LinkState) | |
4975 | == IB_7322_LT_STATE_POLLQUIET) { | |
4976 | qib_set_linkstate(ppd, QIB_IB_LINKDOWN_DISABLE); | |
4977 | break; | |
4978 | } | |
4979 | udelay(100); | |
4980 | } | |
4981 | ||
4982 | if (!(ppd->lflags & QIBL_IB_AUTONEG_INPROG)) | |
4983 | goto done; /* we got there early or told to stop */ | |
4984 | ||
4985 | /* we expect this to timeout */ | |
4986 | if (wait_event_timeout(ppd->cpspec->autoneg_wait, | |
4987 | !(ppd->lflags & QIBL_IB_AUTONEG_INPROG), | |
4988 | msecs_to_jiffies(90))) | |
4989 | goto done; | |
4990 | qib_7322_mini_pcs_reset(ppd); | |
4991 | ||
4992 | /* we expect this to timeout */ | |
4993 | if (wait_event_timeout(ppd->cpspec->autoneg_wait, | |
4994 | !(ppd->lflags & QIBL_IB_AUTONEG_INPROG), | |
4995 | msecs_to_jiffies(1700))) | |
4996 | goto done; | |
4997 | qib_7322_mini_pcs_reset(ppd); | |
4998 | ||
4999 | set_7322_ibspeed_fast(ppd, QIB_IB_SDR); | |
5000 | ||
5001 | /* | |
5002 | * Wait up to 250 msec for link to train and get to INIT at DDR; | |
5003 | * this should terminate early. | |
5004 | */ | |
5005 | wait_event_timeout(ppd->cpspec->autoneg_wait, | |
5006 | !(ppd->lflags & QIBL_IB_AUTONEG_INPROG), | |
5007 | msecs_to_jiffies(250)); | |
5008 | done: | |
5009 | if (ppd->lflags & QIBL_IB_AUTONEG_INPROG) { | |
5010 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
5011 | ppd->lflags &= ~QIBL_IB_AUTONEG_INPROG; | |
5012 | if (ppd->cpspec->autoneg_tries == AUTONEG_TRIES) { | |
5013 | ppd->lflags |= QIBL_IB_AUTONEG_FAILED; | |
5014 | ppd->cpspec->autoneg_tries = 0; | |
5015 | } | |
5016 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
5017 | set_7322_ibspeed_fast(ppd, ppd->link_speed_enabled); | |
5018 | } | |
5019 | } | |
5020 | ||
5021 | /* | |
5022 | * This routine is used to request IPG set in the QLogic switch. | |
5023 | * Only called if r1. | |
5024 | */ | |
5025 | static void try_7322_ipg(struct qib_pportdata *ppd) | |
5026 | { | |
5027 | struct qib_ibport *ibp = &ppd->ibport_data; | |
5028 | struct ib_mad_send_buf *send_buf; | |
5029 | struct ib_mad_agent *agent; | |
5030 | struct ib_smp *smp; | |
5031 | unsigned delay; | |
5032 | int ret; | |
5033 | ||
5034 | agent = ibp->send_agent; | |
5035 | if (!agent) | |
5036 | goto retry; | |
5037 | ||
5038 | send_buf = ib_create_send_mad(agent, 0, 0, 0, IB_MGMT_MAD_HDR, | |
5039 | IB_MGMT_MAD_DATA, GFP_ATOMIC); | |
5040 | if (IS_ERR(send_buf)) | |
5041 | goto retry; | |
5042 | ||
5043 | if (!ibp->smi_ah) { | |
5044 | struct ib_ah_attr attr; | |
5045 | struct ib_ah *ah; | |
5046 | ||
5047 | memset(&attr, 0, sizeof attr); | |
5048 | attr.dlid = be16_to_cpu(IB_LID_PERMISSIVE); | |
5049 | attr.port_num = ppd->port; | |
5050 | ah = ib_create_ah(ibp->qp0->ibqp.pd, &attr); | |
5051 | if (IS_ERR(ah)) | |
5052 | ret = -EINVAL; | |
5053 | else { | |
5054 | send_buf->ah = ah; | |
5055 | ibp->smi_ah = to_iah(ah); | |
5056 | ret = 0; | |
5057 | } | |
5058 | } else { | |
5059 | send_buf->ah = &ibp->smi_ah->ibah; | |
5060 | ret = 0; | |
5061 | } | |
5062 | ||
5063 | smp = send_buf->mad; | |
5064 | smp->base_version = IB_MGMT_BASE_VERSION; | |
5065 | smp->mgmt_class = IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE; | |
5066 | smp->class_version = 1; | |
5067 | smp->method = IB_MGMT_METHOD_SEND; | |
5068 | smp->hop_cnt = 1; | |
5069 | smp->attr_id = QIB_VENDOR_IPG; | |
5070 | smp->attr_mod = 0; | |
5071 | ||
5072 | if (!ret) | |
5073 | ret = ib_post_send_mad(send_buf, NULL); | |
5074 | if (ret) | |
5075 | ib_free_send_mad(send_buf); | |
5076 | retry: | |
5077 | delay = 2 << ppd->cpspec->ipg_tries; | |
5078 | schedule_delayed_work(&ppd->cpspec->ipg_work, msecs_to_jiffies(delay)); | |
5079 | } | |
5080 | ||
5081 | /* | |
5082 | * Timeout handler for setting IPG. | |
5083 | * Only called if r1. | |
5084 | */ | |
5085 | static void ipg_7322_work(struct work_struct *work) | |
5086 | { | |
5087 | struct qib_pportdata *ppd; | |
5088 | ||
5089 | ppd = container_of(work, struct qib_chippport_specific, | |
5090 | ipg_work.work)->ppd; | |
5091 | if ((ppd->lflags & (QIBL_LINKINIT | QIBL_LINKARMED | QIBL_LINKACTIVE)) | |
5092 | && ++ppd->cpspec->ipg_tries <= 10) | |
5093 | try_7322_ipg(ppd); | |
5094 | } | |
5095 | ||
5096 | static u32 qib_7322_iblink_state(u64 ibcs) | |
5097 | { | |
5098 | u32 state = (u32)SYM_FIELD(ibcs, IBCStatusA_0, LinkState); | |
5099 | ||
5100 | switch (state) { | |
5101 | case IB_7322_L_STATE_INIT: | |
5102 | state = IB_PORT_INIT; | |
5103 | break; | |
5104 | case IB_7322_L_STATE_ARM: | |
5105 | state = IB_PORT_ARMED; | |
5106 | break; | |
5107 | case IB_7322_L_STATE_ACTIVE: | |
5108 | /* fall through */ | |
5109 | case IB_7322_L_STATE_ACT_DEFER: | |
5110 | state = IB_PORT_ACTIVE; | |
5111 | break; | |
5112 | default: /* fall through */ | |
5113 | case IB_7322_L_STATE_DOWN: | |
5114 | state = IB_PORT_DOWN; | |
5115 | break; | |
5116 | } | |
5117 | return state; | |
5118 | } | |
5119 | ||
5120 | /* returns the IBTA port state, rather than the IBC link training state */ | |
5121 | static u8 qib_7322_phys_portstate(u64 ibcs) | |
5122 | { | |
5123 | u8 state = (u8)SYM_FIELD(ibcs, IBCStatusA_0, LinkTrainingState); | |
5124 | return qib_7322_physportstate[state]; | |
5125 | } | |
5126 | ||
5127 | static int qib_7322_ib_updown(struct qib_pportdata *ppd, int ibup, u64 ibcs) | |
5128 | { | |
5129 | int ret = 0, symadj = 0; | |
5130 | unsigned long flags; | |
5131 | int mult; | |
5132 | ||
5133 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
5134 | ppd->lflags &= ~QIBL_IB_FORCE_NOTIFY; | |
5135 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
5136 | ||
5137 | /* Update our picture of width and speed from chip */ | |
5138 | if (ibcs & SYM_MASK(IBCStatusA_0, LinkSpeedQDR)) { | |
5139 | ppd->link_speed_active = QIB_IB_QDR; | |
5140 | mult = 4; | |
5141 | } else if (ibcs & SYM_MASK(IBCStatusA_0, LinkSpeedActive)) { | |
5142 | ppd->link_speed_active = QIB_IB_DDR; | |
5143 | mult = 2; | |
5144 | } else { | |
5145 | ppd->link_speed_active = QIB_IB_SDR; | |
5146 | mult = 1; | |
5147 | } | |
5148 | if (ibcs & SYM_MASK(IBCStatusA_0, LinkWidthActive)) { | |
5149 | ppd->link_width_active = IB_WIDTH_4X; | |
5150 | mult *= 4; | |
5151 | } else | |
5152 | ppd->link_width_active = IB_WIDTH_1X; | |
5153 | ppd->delay_mult = ib_rate_to_delay[mult_to_ib_rate(mult)]; | |
5154 | ||
5155 | if (!ibup) { | |
5156 | u64 clr; | |
5157 | ||
5158 | /* Link went down. */ | |
5159 | /* do IPG MAD again after linkdown, even if last time failed */ | |
5160 | ppd->cpspec->ipg_tries = 0; | |
5161 | clr = qib_read_kreg_port(ppd, krp_ibcstatus_b) & | |
5162 | (SYM_MASK(IBCStatusB_0, heartbeat_timed_out) | | |
5163 | SYM_MASK(IBCStatusB_0, heartbeat_crosstalk)); | |
5164 | if (clr) | |
5165 | qib_write_kreg_port(ppd, krp_ibcstatus_b, clr); | |
5166 | if (!(ppd->lflags & (QIBL_IB_AUTONEG_FAILED | | |
5167 | QIBL_IB_AUTONEG_INPROG))) | |
5168 | set_7322_ibspeed_fast(ppd, ppd->link_speed_enabled); | |
5169 | if (!(ppd->lflags & QIBL_IB_AUTONEG_INPROG)) { | |
a77fcf89 RC |
5170 | /* unlock the Tx settings, speed may change */ |
5171 | qib_write_kreg_port(ppd, krp_tx_deemph_override, | |
5172 | SYM_MASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
5173 | reset_tx_deemphasis_override)); | |
f931551b | 5174 | qib_cancel_sends(ppd); |
a77fcf89 RC |
5175 | /* on link down, ensure sane pcs state */ |
5176 | qib_7322_mini_pcs_reset(ppd); | |
f931551b RC |
5177 | spin_lock_irqsave(&ppd->sdma_lock, flags); |
5178 | if (__qib_sdma_running(ppd)) | |
5179 | __qib_sdma_process_event(ppd, | |
5180 | qib_sdma_event_e70_go_idle); | |
5181 | spin_unlock_irqrestore(&ppd->sdma_lock, flags); | |
5182 | } | |
5183 | clr = read_7322_creg32_port(ppd, crp_iblinkdown); | |
5184 | if (clr == ppd->cpspec->iblnkdownsnap) | |
5185 | ppd->cpspec->iblnkdowndelta++; | |
5186 | } else { | |
5187 | if (qib_compat_ddr_negotiate && | |
5188 | !(ppd->lflags & (QIBL_IB_AUTONEG_FAILED | | |
5189 | QIBL_IB_AUTONEG_INPROG)) && | |
5190 | ppd->link_speed_active == QIB_IB_SDR && | |
5191 | (ppd->link_speed_enabled & QIB_IB_DDR) | |
5192 | && ppd->cpspec->autoneg_tries < AUTONEG_TRIES) { | |
5193 | /* we are SDR, and auto-negotiation enabled */ | |
5194 | ++ppd->cpspec->autoneg_tries; | |
5195 | if (!ppd->cpspec->ibdeltainprog) { | |
5196 | ppd->cpspec->ibdeltainprog = 1; | |
5197 | ppd->cpspec->ibsymdelta += | |
5198 | read_7322_creg32_port(ppd, | |
5199 | crp_ibsymbolerr) - | |
5200 | ppd->cpspec->ibsymsnap; | |
5201 | ppd->cpspec->iblnkerrdelta += | |
5202 | read_7322_creg32_port(ppd, | |
5203 | crp_iblinkerrrecov) - | |
5204 | ppd->cpspec->iblnkerrsnap; | |
5205 | } | |
5206 | try_7322_autoneg(ppd); | |
5207 | ret = 1; /* no other IB status change processing */ | |
5208 | } else if ((ppd->lflags & QIBL_IB_AUTONEG_INPROG) && | |
5209 | ppd->link_speed_active == QIB_IB_SDR) { | |
5210 | qib_autoneg_7322_send(ppd, 1); | |
5211 | set_7322_ibspeed_fast(ppd, QIB_IB_DDR); | |
5212 | qib_7322_mini_pcs_reset(ppd); | |
5213 | udelay(2); | |
5214 | ret = 1; /* no other IB status change processing */ | |
5215 | } else if ((ppd->lflags & QIBL_IB_AUTONEG_INPROG) && | |
5216 | (ppd->link_speed_active & QIB_IB_DDR)) { | |
5217 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
5218 | ppd->lflags &= ~(QIBL_IB_AUTONEG_INPROG | | |
5219 | QIBL_IB_AUTONEG_FAILED); | |
5220 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
5221 | ppd->cpspec->autoneg_tries = 0; | |
5222 | /* re-enable SDR, for next link down */ | |
5223 | set_7322_ibspeed_fast(ppd, ppd->link_speed_enabled); | |
5224 | wake_up(&ppd->cpspec->autoneg_wait); | |
5225 | symadj = 1; | |
5226 | } else if (ppd->lflags & QIBL_IB_AUTONEG_FAILED) { | |
5227 | /* | |
5228 | * Clear autoneg failure flag, and do setup | |
5229 | * so we'll try next time link goes down and | |
5230 | * back to INIT (possibly connected to a | |
5231 | * different device). | |
5232 | */ | |
5233 | spin_lock_irqsave(&ppd->lflags_lock, flags); | |
5234 | ppd->lflags &= ~QIBL_IB_AUTONEG_FAILED; | |
5235 | spin_unlock_irqrestore(&ppd->lflags_lock, flags); | |
5236 | ppd->cpspec->ibcctrl_b |= IBA7322_IBC_IBTA_1_2_MASK; | |
5237 | symadj = 1; | |
5238 | } | |
5239 | if (!(ppd->lflags & QIBL_IB_AUTONEG_INPROG)) { | |
5240 | symadj = 1; | |
5241 | if (ppd->dd->cspec->r1 && ppd->cpspec->ipg_tries <= 10) | |
5242 | try_7322_ipg(ppd); | |
5243 | if (!ppd->cpspec->recovery_init) | |
5244 | setup_7322_link_recovery(ppd, 0); | |
5245 | ppd->cpspec->qdr_dfe_time = jiffies + | |
5246 | msecs_to_jiffies(QDR_DFE_DISABLE_DELAY); | |
5247 | } | |
5248 | ppd->cpspec->ibmalfusesnap = 0; | |
5249 | ppd->cpspec->ibmalfsnap = read_7322_creg32_port(ppd, | |
5250 | crp_errlink); | |
5251 | } | |
5252 | if (symadj) { | |
5253 | ppd->cpspec->iblnkdownsnap = | |
5254 | read_7322_creg32_port(ppd, crp_iblinkdown); | |
5255 | if (ppd->cpspec->ibdeltainprog) { | |
5256 | ppd->cpspec->ibdeltainprog = 0; | |
5257 | ppd->cpspec->ibsymdelta += read_7322_creg32_port(ppd, | |
5258 | crp_ibsymbolerr) - ppd->cpspec->ibsymsnap; | |
5259 | ppd->cpspec->iblnkerrdelta += read_7322_creg32_port(ppd, | |
5260 | crp_iblinkerrrecov) - ppd->cpspec->iblnkerrsnap; | |
5261 | } | |
5262 | } else if (!ibup && qib_compat_ddr_negotiate && | |
5263 | !ppd->cpspec->ibdeltainprog && | |
5264 | !(ppd->lflags & QIBL_IB_AUTONEG_INPROG)) { | |
5265 | ppd->cpspec->ibdeltainprog = 1; | |
5266 | ppd->cpspec->ibsymsnap = read_7322_creg32_port(ppd, | |
5267 | crp_ibsymbolerr); | |
5268 | ppd->cpspec->iblnkerrsnap = read_7322_creg32_port(ppd, | |
5269 | crp_iblinkerrrecov); | |
5270 | } | |
5271 | ||
5272 | if (!ret) | |
5273 | qib_setup_7322_setextled(ppd, ibup); | |
5274 | return ret; | |
5275 | } | |
5276 | ||
5277 | /* | |
5278 | * Does read/modify/write to appropriate registers to | |
5279 | * set output and direction bits selected by mask. | |
5280 | * these are in their canonical postions (e.g. lsb of | |
5281 | * dir will end up in D48 of extctrl on existing chips). | |
5282 | * returns contents of GP Inputs. | |
5283 | */ | |
5284 | static int gpio_7322_mod(struct qib_devdata *dd, u32 out, u32 dir, u32 mask) | |
5285 | { | |
5286 | u64 read_val, new_out; | |
5287 | unsigned long flags; | |
5288 | ||
5289 | if (mask) { | |
5290 | /* some bits being written, lock access to GPIO */ | |
5291 | dir &= mask; | |
5292 | out &= mask; | |
5293 | spin_lock_irqsave(&dd->cspec->gpio_lock, flags); | |
5294 | dd->cspec->extctrl &= ~((u64)mask << SYM_LSB(EXTCtrl, GPIOOe)); | |
5295 | dd->cspec->extctrl |= ((u64) dir << SYM_LSB(EXTCtrl, GPIOOe)); | |
5296 | new_out = (dd->cspec->gpio_out & ~mask) | out; | |
5297 | ||
5298 | qib_write_kreg(dd, kr_extctrl, dd->cspec->extctrl); | |
5299 | qib_write_kreg(dd, kr_gpio_out, new_out); | |
5300 | dd->cspec->gpio_out = new_out; | |
5301 | spin_unlock_irqrestore(&dd->cspec->gpio_lock, flags); | |
5302 | } | |
5303 | /* | |
5304 | * It is unlikely that a read at this time would get valid | |
5305 | * data on a pin whose direction line was set in the same | |
5306 | * call to this function. We include the read here because | |
5307 | * that allows us to potentially combine a change on one pin with | |
5308 | * a read on another, and because the old code did something like | |
5309 | * this. | |
5310 | */ | |
5311 | read_val = qib_read_kreg64(dd, kr_extstatus); | |
5312 | return SYM_FIELD(read_val, EXTStatus, GPIOIn); | |
5313 | } | |
5314 | ||
5315 | /* Enable writes to config EEPROM, if possible. Returns previous state */ | |
5316 | static int qib_7322_eeprom_wen(struct qib_devdata *dd, int wen) | |
5317 | { | |
5318 | int prev_wen; | |
5319 | u32 mask; | |
5320 | ||
5321 | mask = 1 << QIB_EEPROM_WEN_NUM; | |
5322 | prev_wen = ~gpio_7322_mod(dd, 0, 0, 0) >> QIB_EEPROM_WEN_NUM; | |
5323 | gpio_7322_mod(dd, wen ? 0 : mask, mask, mask); | |
5324 | ||
5325 | return prev_wen & 1; | |
5326 | } | |
5327 | ||
5328 | /* | |
5329 | * Read fundamental info we need to use the chip. These are | |
5330 | * the registers that describe chip capabilities, and are | |
5331 | * saved in shadow registers. | |
5332 | */ | |
5333 | static void get_7322_chip_params(struct qib_devdata *dd) | |
5334 | { | |
5335 | u64 val; | |
5336 | u32 piobufs; | |
5337 | int mtu; | |
5338 | ||
5339 | dd->palign = qib_read_kreg32(dd, kr_pagealign); | |
5340 | ||
5341 | dd->uregbase = qib_read_kreg32(dd, kr_userregbase); | |
5342 | ||
5343 | dd->rcvtidcnt = qib_read_kreg32(dd, kr_rcvtidcnt); | |
5344 | dd->rcvtidbase = qib_read_kreg32(dd, kr_rcvtidbase); | |
5345 | dd->rcvegrbase = qib_read_kreg32(dd, kr_rcvegrbase); | |
5346 | dd->piobufbase = qib_read_kreg64(dd, kr_sendpiobufbase); | |
5347 | dd->pio2k_bufbase = dd->piobufbase & 0xffffffff; | |
5348 | ||
5349 | val = qib_read_kreg64(dd, kr_sendpiobufcnt); | |
5350 | dd->piobcnt2k = val & ~0U; | |
5351 | dd->piobcnt4k = val >> 32; | |
5352 | val = qib_read_kreg64(dd, kr_sendpiosize); | |
5353 | dd->piosize2k = val & ~0U; | |
5354 | dd->piosize4k = val >> 32; | |
5355 | ||
5356 | mtu = ib_mtu_enum_to_int(qib_ibmtu); | |
5357 | if (mtu == -1) | |
5358 | mtu = QIB_DEFAULT_MTU; | |
5359 | dd->pport[0].ibmtu = (u32)mtu; | |
5360 | dd->pport[1].ibmtu = (u32)mtu; | |
5361 | ||
5362 | /* these may be adjusted in init_chip_wc_pat() */ | |
5363 | dd->pio2kbase = (u32 __iomem *) | |
5364 | ((char __iomem *) dd->kregbase + dd->pio2k_bufbase); | |
5365 | dd->pio4kbase = (u32 __iomem *) | |
5366 | ((char __iomem *) dd->kregbase + | |
5367 | (dd->piobufbase >> 32)); | |
5368 | /* | |
5369 | * 4K buffers take 2 pages; we use roundup just to be | |
5370 | * paranoid; we calculate it once here, rather than on | |
5371 | * ever buf allocate | |
5372 | */ | |
5373 | dd->align4k = ALIGN(dd->piosize4k, dd->palign); | |
5374 | ||
5375 | piobufs = dd->piobcnt4k + dd->piobcnt2k + NUM_VL15_BUFS; | |
5376 | ||
5377 | dd->pioavregs = ALIGN(piobufs, sizeof(u64) * BITS_PER_BYTE / 2) / | |
5378 | (sizeof(u64) * BITS_PER_BYTE / 2); | |
5379 | } | |
5380 | ||
5381 | /* | |
5382 | * The chip base addresses in cspec and cpspec have to be set | |
5383 | * after possible init_chip_wc_pat(), rather than in | |
5384 | * get_7322_chip_params(), so split out as separate function | |
5385 | */ | |
5386 | static void qib_7322_set_baseaddrs(struct qib_devdata *dd) | |
5387 | { | |
5388 | u32 cregbase; | |
5389 | cregbase = qib_read_kreg32(dd, kr_counterregbase); | |
5390 | ||
5391 | dd->cspec->cregbase = (u64 __iomem *)(cregbase + | |
5392 | (char __iomem *)dd->kregbase); | |
5393 | ||
5394 | dd->egrtidbase = (u64 __iomem *) | |
5395 | ((char __iomem *) dd->kregbase + dd->rcvegrbase); | |
5396 | ||
5397 | /* port registers are defined as relative to base of chip */ | |
5398 | dd->pport[0].cpspec->kpregbase = | |
5399 | (u64 __iomem *)((char __iomem *)dd->kregbase); | |
5400 | dd->pport[1].cpspec->kpregbase = | |
5401 | (u64 __iomem *)(dd->palign + | |
5402 | (char __iomem *)dd->kregbase); | |
5403 | dd->pport[0].cpspec->cpregbase = | |
5404 | (u64 __iomem *)(qib_read_kreg_port(&dd->pport[0], | |
5405 | kr_counterregbase) + (char __iomem *)dd->kregbase); | |
5406 | dd->pport[1].cpspec->cpregbase = | |
5407 | (u64 __iomem *)(qib_read_kreg_port(&dd->pport[1], | |
5408 | kr_counterregbase) + (char __iomem *)dd->kregbase); | |
5409 | } | |
5410 | ||
5411 | /* | |
5412 | * This is a fairly special-purpose observer, so we only support | |
5413 | * the port-specific parts of SendCtrl | |
5414 | */ | |
5415 | ||
5416 | #define SENDCTRL_SHADOWED (SYM_MASK(SendCtrl_0, SendEnable) | \ | |
5417 | SYM_MASK(SendCtrl_0, SDmaEnable) | \ | |
5418 | SYM_MASK(SendCtrl_0, SDmaIntEnable) | \ | |
5419 | SYM_MASK(SendCtrl_0, SDmaSingleDescriptor) | \ | |
5420 | SYM_MASK(SendCtrl_0, SDmaHalt) | \ | |
5421 | SYM_MASK(SendCtrl_0, IBVLArbiterEn) | \ | |
5422 | SYM_MASK(SendCtrl_0, ForceCreditUpToDate)) | |
5423 | ||
5424 | static int sendctrl_hook(struct qib_devdata *dd, | |
5425 | const struct diag_observer *op, u32 offs, | |
5426 | u64 *data, u64 mask, int only_32) | |
5427 | { | |
5428 | unsigned long flags; | |
5429 | unsigned idx; | |
5430 | unsigned pidx; | |
5431 | struct qib_pportdata *ppd = NULL; | |
5432 | u64 local_data, all_bits; | |
5433 | ||
5434 | /* | |
5435 | * The fixed correspondence between Physical ports and pports is | |
5436 | * severed. We need to hunt for the ppd that corresponds | |
5437 | * to the offset we got. And we have to do that without admitting | |
5438 | * we know the stride, apparently. | |
5439 | */ | |
5440 | for (pidx = 0; pidx < dd->num_pports; ++pidx) { | |
5441 | u64 __iomem *psptr; | |
5442 | u32 psoffs; | |
5443 | ||
5444 | ppd = dd->pport + pidx; | |
5445 | if (!ppd->cpspec->kpregbase) | |
5446 | continue; | |
5447 | ||
5448 | psptr = ppd->cpspec->kpregbase + krp_sendctrl; | |
5449 | psoffs = (u32) (psptr - dd->kregbase) * sizeof(*psptr); | |
5450 | if (psoffs == offs) | |
5451 | break; | |
5452 | } | |
5453 | ||
5454 | /* If pport is not being managed by driver, just avoid shadows. */ | |
5455 | if (pidx >= dd->num_pports) | |
5456 | ppd = NULL; | |
5457 | ||
5458 | /* In any case, "idx" is flat index in kreg space */ | |
5459 | idx = offs / sizeof(u64); | |
5460 | ||
5461 | all_bits = ~0ULL; | |
5462 | if (only_32) | |
5463 | all_bits >>= 32; | |
5464 | ||
5465 | spin_lock_irqsave(&dd->sendctrl_lock, flags); | |
5466 | if (!ppd || (mask & all_bits) != all_bits) { | |
5467 | /* | |
5468 | * At least some mask bits are zero, so we need | |
5469 | * to read. The judgement call is whether from | |
5470 | * reg or shadow. First-cut: read reg, and complain | |
5471 | * if any bits which should be shadowed are different | |
5472 | * from their shadowed value. | |
5473 | */ | |
5474 | if (only_32) | |
5475 | local_data = (u64)qib_read_kreg32(dd, idx); | |
5476 | else | |
5477 | local_data = qib_read_kreg64(dd, idx); | |
5478 | *data = (local_data & ~mask) | (*data & mask); | |
5479 | } | |
5480 | if (mask) { | |
5481 | /* | |
5482 | * At least some mask bits are one, so we need | |
5483 | * to write, but only shadow some bits. | |
5484 | */ | |
5485 | u64 sval, tval; /* Shadowed, transient */ | |
5486 | ||
5487 | /* | |
5488 | * New shadow val is bits we don't want to touch, | |
5489 | * ORed with bits we do, that are intended for shadow. | |
5490 | */ | |
5491 | if (ppd) { | |
5492 | sval = ppd->p_sendctrl & ~mask; | |
5493 | sval |= *data & SENDCTRL_SHADOWED & mask; | |
5494 | ppd->p_sendctrl = sval; | |
5495 | } else | |
5496 | sval = *data & SENDCTRL_SHADOWED & mask; | |
5497 | tval = sval | (*data & ~SENDCTRL_SHADOWED & mask); | |
5498 | qib_write_kreg(dd, idx, tval); | |
5499 | qib_write_kreg(dd, kr_scratch, 0Ull); | |
5500 | } | |
5501 | spin_unlock_irqrestore(&dd->sendctrl_lock, flags); | |
5502 | return only_32 ? 4 : 8; | |
5503 | } | |
5504 | ||
5505 | static const struct diag_observer sendctrl_0_observer = { | |
5506 | sendctrl_hook, KREG_IDX(SendCtrl_0) * sizeof(u64), | |
5507 | KREG_IDX(SendCtrl_0) * sizeof(u64) | |
5508 | }; | |
5509 | ||
5510 | static const struct diag_observer sendctrl_1_observer = { | |
5511 | sendctrl_hook, KREG_IDX(SendCtrl_1) * sizeof(u64), | |
5512 | KREG_IDX(SendCtrl_1) * sizeof(u64) | |
5513 | }; | |
5514 | ||
5515 | static ushort sdma_fetch_prio = 8; | |
5516 | module_param_named(sdma_fetch_prio, sdma_fetch_prio, ushort, S_IRUGO); | |
5517 | MODULE_PARM_DESC(sdma_fetch_prio, "SDMA descriptor fetch priority"); | |
5518 | ||
5519 | /* Besides logging QSFP events, we set appropriate TxDDS values */ | |
5520 | static void init_txdds_table(struct qib_pportdata *ppd, int override); | |
5521 | ||
5522 | static void qsfp_7322_event(struct work_struct *work) | |
5523 | { | |
5524 | struct qib_qsfp_data *qd; | |
5525 | struct qib_pportdata *ppd; | |
5526 | u64 pwrup; | |
5527 | int ret; | |
5528 | u32 le2; | |
5529 | ||
5530 | qd = container_of(work, struct qib_qsfp_data, work); | |
5531 | ppd = qd->ppd; | |
5532 | pwrup = qd->t_insert + msecs_to_jiffies(QSFP_PWR_LAG_MSEC); | |
5533 | ||
5534 | /* | |
5535 | * Some QSFP's not only do not respond until the full power-up | |
5536 | * time, but may behave badly if we try. So hold off responding | |
5537 | * to insertion. | |
5538 | */ | |
5539 | while (1) { | |
5540 | u64 now = get_jiffies_64(); | |
5541 | if (time_after64(now, pwrup)) | |
5542 | break; | |
5543 | msleep(1); | |
5544 | } | |
5545 | ret = qib_refresh_qsfp_cache(ppd, &qd->cache); | |
5546 | /* | |
5547 | * Need to change LE2 back to defaults if we couldn't | |
5548 | * read the cable type (to handle cable swaps), so do this | |
5549 | * even on failure to read cable information. We don't | |
5550 | * get here for QME, so IS_QME check not needed here. | |
5551 | */ | |
5552 | le2 = (!ret && qd->cache.atten[1] >= qib_long_atten && | |
5553 | !ppd->dd->cspec->r1 && QSFP_IS_CU(qd->cache.tech)) ? | |
5554 | LE2_5m : LE2_DEFAULT; | |
5555 | ibsd_wr_allchans(ppd, 13, (le2 << 7), BMASK(9, 7)); | |
5556 | init_txdds_table(ppd, 0); | |
5557 | } | |
5558 | ||
5559 | /* | |
5560 | * There is little we can do but complain to the user if QSFP | |
5561 | * initialization fails. | |
5562 | */ | |
5563 | static void qib_init_7322_qsfp(struct qib_pportdata *ppd) | |
5564 | { | |
5565 | unsigned long flags; | |
5566 | struct qib_qsfp_data *qd = &ppd->cpspec->qsfp_data; | |
5567 | struct qib_devdata *dd = ppd->dd; | |
5568 | u64 mod_prs_bit = QSFP_GPIO_MOD_PRS_N; | |
5569 | ||
5570 | mod_prs_bit <<= (QSFP_GPIO_PORT2_SHIFT * ppd->hw_pidx); | |
5571 | qd->ppd = ppd; | |
5572 | qib_qsfp_init(qd, qsfp_7322_event); | |
5573 | spin_lock_irqsave(&dd->cspec->gpio_lock, flags); | |
5574 | dd->cspec->extctrl |= (mod_prs_bit << SYM_LSB(EXTCtrl, GPIOInvert)); | |
5575 | dd->cspec->gpio_mask |= mod_prs_bit; | |
5576 | qib_write_kreg(dd, kr_extctrl, dd->cspec->extctrl); | |
5577 | qib_write_kreg(dd, kr_gpio_mask, dd->cspec->gpio_mask); | |
5578 | spin_unlock_irqrestore(&dd->cspec->gpio_lock, flags); | |
5579 | } | |
5580 | ||
5581 | /* | |
a77fcf89 | 5582 | * called at device initialization time, and also if the txselect |
f931551b RC |
5583 | * module parameter is changed. This is used for cables that don't |
5584 | * have valid QSFP EEPROMs (not present, or attenuation is zero). | |
5585 | * We initialize to the default, then if there is a specific | |
a77fcf89 RC |
5586 | * unit,port match, we use that (and set it immediately, for the |
5587 | * current speed, if the link is at INIT or better). | |
f931551b | 5588 | * String format is "default# unit#,port#=# ... u,p=#", separators must |
a77fcf89 RC |
5589 | * be a SPACE character. A newline terminates. The u,p=# tuples may |
5590 | * optionally have "u,p=#,#", where the final # is the H1 value | |
f931551b RC |
5591 | * The last specific match is used (actually, all are used, but last |
5592 | * one is the one that winds up set); if none at all, fall back on default. | |
5593 | */ | |
5594 | static void set_no_qsfp_atten(struct qib_devdata *dd, int change) | |
5595 | { | |
5596 | char *nxt, *str; | |
a77fcf89 | 5597 | u32 pidx, unit, port, deflt, h1; |
f931551b | 5598 | unsigned long val; |
a77fcf89 | 5599 | int any = 0, seth1; |
f931551b | 5600 | |
a77fcf89 | 5601 | str = txselect_list; |
f931551b | 5602 | |
a77fcf89 | 5603 | /* default number is validated in setup_txselect() */ |
f931551b RC |
5604 | deflt = simple_strtoul(str, &nxt, 0); |
5605 | for (pidx = 0; pidx < dd->num_pports; ++pidx) | |
5606 | dd->pport[pidx].cpspec->no_eep = deflt; | |
5607 | ||
5608 | while (*nxt && nxt[1]) { | |
5609 | str = ++nxt; | |
5610 | unit = simple_strtoul(str, &nxt, 0); | |
5611 | if (nxt == str || !*nxt || *nxt != ',') { | |
5612 | while (*nxt && *nxt++ != ' ') /* skip to next, if any */ | |
5613 | ; | |
5614 | continue; | |
5615 | } | |
5616 | str = ++nxt; | |
5617 | port = simple_strtoul(str, &nxt, 0); | |
5618 | if (nxt == str || *nxt != '=') { | |
5619 | while (*nxt && *nxt++ != ' ') /* skip to next, if any */ | |
5620 | ; | |
5621 | continue; | |
5622 | } | |
5623 | str = ++nxt; | |
5624 | val = simple_strtoul(str, &nxt, 0); | |
5625 | if (nxt == str) { | |
5626 | while (*nxt && *nxt++ != ' ') /* skip to next, if any */ | |
5627 | ; | |
5628 | continue; | |
5629 | } | |
a77fcf89 | 5630 | if (val >= TXDDS_TABLE_SZ + TXDDS_EXTRA_SZ) |
f931551b | 5631 | continue; |
a77fcf89 RC |
5632 | seth1 = 0; |
5633 | h1 = 0; /* gcc thinks it might be used uninitted */ | |
5634 | if (*nxt == ',' && nxt[1]) { | |
5635 | str = ++nxt; | |
5636 | h1 = (u32)simple_strtoul(str, &nxt, 0); | |
5637 | if (nxt == str) | |
5638 | while (*nxt && *nxt++ != ' ') /* skip */ | |
5639 | ; | |
5640 | else | |
5641 | seth1 = 1; | |
5642 | } | |
f931551b RC |
5643 | for (pidx = 0; dd->unit == unit && pidx < dd->num_pports; |
5644 | ++pidx) { | |
a77fcf89 RC |
5645 | struct qib_pportdata *ppd = &dd->pport[pidx]; |
5646 | ||
5647 | if (ppd->port != port || !ppd->link_speed_supported) | |
f931551b | 5648 | continue; |
a77fcf89 | 5649 | ppd->cpspec->no_eep = val; |
7c7a416e RC |
5650 | if (seth1) |
5651 | ppd->cpspec->h1_val = h1; | |
f931551b | 5652 | /* now change the IBC and serdes, overriding generic */ |
a77fcf89 | 5653 | init_txdds_table(ppd, 1); |
f931551b RC |
5654 | any++; |
5655 | } | |
5656 | if (*nxt == '\n') | |
5657 | break; /* done */ | |
5658 | } | |
5659 | if (change && !any) { | |
5660 | /* no specific setting, use the default. | |
5661 | * Change the IBC and serdes, but since it's | |
5662 | * general, don't override specific settings. | |
5663 | */ | |
a77fcf89 RC |
5664 | for (pidx = 0; pidx < dd->num_pports; ++pidx) |
5665 | if (dd->pport[pidx].link_speed_supported) | |
5666 | init_txdds_table(&dd->pport[pidx], 0); | |
f931551b RC |
5667 | } |
5668 | } | |
5669 | ||
a77fcf89 RC |
5670 | /* handle the txselect parameter changing */ |
5671 | static int setup_txselect(const char *str, struct kernel_param *kp) | |
f931551b RC |
5672 | { |
5673 | struct qib_devdata *dd; | |
5674 | unsigned long val; | |
5675 | char *n; | |
5676 | if (strlen(str) >= MAX_ATTEN_LEN) { | |
a77fcf89 | 5677 | printk(KERN_INFO QIB_DRV_NAME " txselect_values string " |
f931551b RC |
5678 | "too long\n"); |
5679 | return -ENOSPC; | |
5680 | } | |
5681 | val = simple_strtoul(str, &n, 0); | |
a77fcf89 | 5682 | if (n == str || val >= (TXDDS_TABLE_SZ + TXDDS_EXTRA_SZ)) { |
f931551b | 5683 | printk(KERN_INFO QIB_DRV_NAME |
a77fcf89 RC |
5684 | "txselect_values must start with a number < %d\n", |
5685 | TXDDS_TABLE_SZ + TXDDS_EXTRA_SZ); | |
f931551b RC |
5686 | return -EINVAL; |
5687 | } | |
a77fcf89 | 5688 | strcpy(txselect_list, str); |
f931551b RC |
5689 | |
5690 | list_for_each_entry(dd, &qib_dev_list, list) | |
a77fcf89 RC |
5691 | if (dd->deviceid == PCI_DEVICE_ID_QLOGIC_IB_7322) |
5692 | set_no_qsfp_atten(dd, 1); | |
f931551b RC |
5693 | return 0; |
5694 | } | |
5695 | ||
5696 | /* | |
5697 | * Write the final few registers that depend on some of the | |
5698 | * init setup. Done late in init, just before bringing up | |
5699 | * the serdes. | |
5700 | */ | |
5701 | static int qib_late_7322_initreg(struct qib_devdata *dd) | |
5702 | { | |
5703 | int ret = 0, n; | |
5704 | u64 val; | |
5705 | ||
5706 | qib_write_kreg(dd, kr_rcvhdrentsize, dd->rcvhdrentsize); | |
5707 | qib_write_kreg(dd, kr_rcvhdrsize, dd->rcvhdrsize); | |
5708 | qib_write_kreg(dd, kr_rcvhdrcnt, dd->rcvhdrcnt); | |
5709 | qib_write_kreg(dd, kr_sendpioavailaddr, dd->pioavailregs_phys); | |
5710 | val = qib_read_kreg64(dd, kr_sendpioavailaddr); | |
5711 | if (val != dd->pioavailregs_phys) { | |
5712 | qib_dev_err(dd, "Catastrophic software error, " | |
5713 | "SendPIOAvailAddr written as %lx, " | |
5714 | "read back as %llx\n", | |
5715 | (unsigned long) dd->pioavailregs_phys, | |
5716 | (unsigned long long) val); | |
5717 | ret = -EINVAL; | |
5718 | } | |
5719 | ||
5720 | n = dd->piobcnt2k + dd->piobcnt4k + NUM_VL15_BUFS; | |
5721 | qib_7322_txchk_change(dd, 0, n, TXCHK_CHG_TYPE_KERN, NULL); | |
5722 | /* driver sends get pkey, lid, etc. checking also, to catch bugs */ | |
5723 | qib_7322_txchk_change(dd, 0, n, TXCHK_CHG_TYPE_ENAB1, NULL); | |
5724 | ||
5725 | qib_register_observer(dd, &sendctrl_0_observer); | |
5726 | qib_register_observer(dd, &sendctrl_1_observer); | |
5727 | ||
5728 | dd->control &= ~QLOGIC_IB_C_SDMAFETCHPRIOEN; | |
5729 | qib_write_kreg(dd, kr_control, dd->control); | |
5730 | /* | |
5731 | * Set SendDmaFetchPriority and init Tx params, including | |
5732 | * QSFP handler on boards that have QSFP. | |
5733 | * First set our default attenuation entry for cables that | |
5734 | * don't have valid attenuation. | |
5735 | */ | |
5736 | set_no_qsfp_atten(dd, 0); | |
5737 | for (n = 0; n < dd->num_pports; ++n) { | |
5738 | struct qib_pportdata *ppd = dd->pport + n; | |
5739 | ||
5740 | qib_write_kreg_port(ppd, krp_senddmaprioritythld, | |
5741 | sdma_fetch_prio & 0xf); | |
5742 | /* Initialize qsfp if present on board. */ | |
5743 | if (dd->flags & QIB_HAS_QSFP) | |
5744 | qib_init_7322_qsfp(ppd); | |
5745 | } | |
5746 | dd->control |= QLOGIC_IB_C_SDMAFETCHPRIOEN; | |
5747 | qib_write_kreg(dd, kr_control, dd->control); | |
5748 | ||
5749 | return ret; | |
5750 | } | |
5751 | ||
5752 | /* per IB port errors. */ | |
5753 | #define SENDCTRL_PIBP (MASK_ACROSS(0, 1) | MASK_ACROSS(3, 3) | \ | |
5754 | MASK_ACROSS(8, 15)) | |
5755 | #define RCVCTRL_PIBP (MASK_ACROSS(0, 17) | MASK_ACROSS(39, 41)) | |
5756 | #define ERRS_PIBP (MASK_ACROSS(57, 58) | MASK_ACROSS(54, 54) | \ | |
5757 | MASK_ACROSS(36, 49) | MASK_ACROSS(29, 34) | MASK_ACROSS(14, 17) | \ | |
5758 | MASK_ACROSS(0, 11)) | |
5759 | ||
5760 | /* | |
5761 | * Write the initialization per-port registers that need to be done at | |
5762 | * driver load and after reset completes (i.e., that aren't done as part | |
5763 | * of other init procedures called from qib_init.c). | |
5764 | * Some of these should be redundant on reset, but play safe. | |
5765 | */ | |
5766 | static void write_7322_init_portregs(struct qib_pportdata *ppd) | |
5767 | { | |
5768 | u64 val; | |
5769 | int i; | |
5770 | ||
5771 | if (!ppd->link_speed_supported) { | |
5772 | /* no buffer credits for this port */ | |
5773 | for (i = 1; i < 8; i++) | |
5774 | qib_write_kreg_port(ppd, krp_rxcreditvl0 + i, 0); | |
5775 | qib_write_kreg_port(ppd, krp_ibcctrl_b, 0); | |
5776 | qib_write_kreg(ppd->dd, kr_scratch, 0); | |
5777 | return; | |
5778 | } | |
5779 | ||
5780 | /* | |
5781 | * Set the number of supported virtual lanes in IBC, | |
5782 | * for flow control packet handling on unsupported VLs | |
5783 | */ | |
5784 | val = qib_read_kreg_port(ppd, krp_ibsdtestiftx); | |
5785 | val &= ~SYM_MASK(IB_SDTEST_IF_TX_0, VL_CAP); | |
5786 | val |= (u64)(ppd->vls_supported - 1) << | |
5787 | SYM_LSB(IB_SDTEST_IF_TX_0, VL_CAP); | |
5788 | qib_write_kreg_port(ppd, krp_ibsdtestiftx, val); | |
5789 | ||
5790 | qib_write_kreg_port(ppd, krp_rcvbthqp, QIB_KD_QP); | |
5791 | ||
5792 | /* enable tx header checking */ | |
5793 | qib_write_kreg_port(ppd, krp_sendcheckcontrol, IBA7322_SENDCHK_PKEY | | |
5794 | IBA7322_SENDCHK_BTHQP | IBA7322_SENDCHK_SLID | | |
5795 | IBA7322_SENDCHK_RAW_IPV6 | IBA7322_SENDCHK_MINSZ); | |
5796 | ||
5797 | qib_write_kreg_port(ppd, krp_ncmodectrl, | |
5798 | SYM_MASK(IBNCModeCtrl_0, ScrambleCapLocal)); | |
5799 | ||
5800 | /* | |
5801 | * Unconditionally clear the bufmask bits. If SDMA is | |
5802 | * enabled, we'll set them appropriately later. | |
5803 | */ | |
5804 | qib_write_kreg_port(ppd, krp_senddmabufmask0, 0); | |
5805 | qib_write_kreg_port(ppd, krp_senddmabufmask1, 0); | |
5806 | qib_write_kreg_port(ppd, krp_senddmabufmask2, 0); | |
5807 | if (ppd->dd->cspec->r1) | |
5808 | ppd->p_sendctrl |= SYM_MASK(SendCtrl_0, ForceCreditUpToDate); | |
5809 | } | |
5810 | ||
5811 | /* | |
5812 | * Write the initialization per-device registers that need to be done at | |
5813 | * driver load and after reset completes (i.e., that aren't done as part | |
5814 | * of other init procedures called from qib_init.c). Also write per-port | |
5815 | * registers that are affected by overall device config, such as QP mapping | |
5816 | * Some of these should be redundant on reset, but play safe. | |
5817 | */ | |
5818 | static void write_7322_initregs(struct qib_devdata *dd) | |
5819 | { | |
5820 | struct qib_pportdata *ppd; | |
5821 | int i, pidx; | |
5822 | u64 val; | |
5823 | ||
5824 | /* Set Multicast QPs received by port 2 to map to context one. */ | |
5825 | qib_write_kreg(dd, KREG_IDX(RcvQPMulticastContext_1), 1); | |
5826 | ||
5827 | for (pidx = 0; pidx < dd->num_pports; ++pidx) { | |
5828 | unsigned n, regno; | |
5829 | unsigned long flags; | |
5830 | ||
5831 | if (!dd->qpn_mask || !dd->pport[pidx].link_speed_supported) | |
5832 | continue; | |
5833 | ||
5834 | ppd = &dd->pport[pidx]; | |
5835 | ||
5836 | /* be paranoid against later code motion, etc. */ | |
5837 | spin_lock_irqsave(&dd->cspec->rcvmod_lock, flags); | |
5838 | ppd->p_rcvctrl |= SYM_MASK(RcvCtrl_0, RcvQPMapEnable); | |
5839 | spin_unlock_irqrestore(&dd->cspec->rcvmod_lock, flags); | |
5840 | ||
5841 | /* Initialize QP to context mapping */ | |
5842 | regno = krp_rcvqpmaptable; | |
5843 | val = 0; | |
5844 | if (dd->num_pports > 1) | |
5845 | n = dd->first_user_ctxt / dd->num_pports; | |
5846 | else | |
5847 | n = dd->first_user_ctxt - 1; | |
5848 | for (i = 0; i < 32; ) { | |
5849 | unsigned ctxt; | |
5850 | ||
5851 | if (dd->num_pports > 1) | |
5852 | ctxt = (i % n) * dd->num_pports + pidx; | |
5853 | else if (i % n) | |
5854 | ctxt = (i % n) + 1; | |
5855 | else | |
5856 | ctxt = ppd->hw_pidx; | |
5857 | val |= ctxt << (5 * (i % 6)); | |
5858 | i++; | |
5859 | if (i % 6 == 0) { | |
5860 | qib_write_kreg_port(ppd, regno, val); | |
5861 | val = 0; | |
5862 | regno++; | |
5863 | } | |
5864 | } | |
5865 | qib_write_kreg_port(ppd, regno, val); | |
5866 | } | |
5867 | ||
5868 | /* | |
5869 | * Setup up interrupt mitigation for kernel contexts, but | |
5870 | * not user contexts (user contexts use interrupts when | |
5871 | * stalled waiting for any packet, so want those interrupts | |
5872 | * right away). | |
5873 | */ | |
5874 | for (i = 0; i < dd->first_user_ctxt; i++) { | |
5875 | dd->cspec->rcvavail_timeout[i] = rcv_int_timeout; | |
5876 | qib_write_kreg(dd, kr_rcvavailtimeout + i, rcv_int_timeout); | |
5877 | } | |
5878 | ||
5879 | /* | |
5880 | * Initialize as (disabled) rcvflow tables. Application code | |
5881 | * will setup each flow as it uses the flow. | |
5882 | * Doesn't clear any of the error bits that might be set. | |
5883 | */ | |
5884 | val = TIDFLOW_ERRBITS; /* these are W1C */ | |
0502f94c | 5885 | for (i = 0; i < dd->cfgctxts; i++) { |
f931551b RC |
5886 | int flow; |
5887 | for (flow = 0; flow < NUM_TIDFLOWS_CTXT; flow++) | |
5888 | qib_write_ureg(dd, ur_rcvflowtable+flow, val, i); | |
5889 | } | |
5890 | ||
5891 | /* | |
5892 | * dual cards init to dual port recovery, single port cards to | |
5893 | * the one port. Dual port cards may later adjust to 1 port, | |
5894 | * and then back to dual port if both ports are connected | |
5895 | * */ | |
5896 | if (dd->num_pports) | |
5897 | setup_7322_link_recovery(dd->pport, dd->num_pports > 1); | |
5898 | } | |
5899 | ||
5900 | static int qib_init_7322_variables(struct qib_devdata *dd) | |
5901 | { | |
5902 | struct qib_pportdata *ppd; | |
5903 | unsigned features, pidx, sbufcnt; | |
5904 | int ret, mtu; | |
5905 | u32 sbufs, updthresh; | |
5906 | ||
5907 | /* pport structs are contiguous, allocated after devdata */ | |
5908 | ppd = (struct qib_pportdata *)(dd + 1); | |
5909 | dd->pport = ppd; | |
5910 | ppd[0].dd = dd; | |
5911 | ppd[1].dd = dd; | |
5912 | ||
5913 | dd->cspec = (struct qib_chip_specific *)(ppd + 2); | |
5914 | ||
5915 | ppd[0].cpspec = (struct qib_chippport_specific *)(dd->cspec + 1); | |
5916 | ppd[1].cpspec = &ppd[0].cpspec[1]; | |
5917 | ppd[0].cpspec->ppd = &ppd[0]; /* for autoneg_7322_work() */ | |
5918 | ppd[1].cpspec->ppd = &ppd[1]; /* for autoneg_7322_work() */ | |
5919 | ||
5920 | spin_lock_init(&dd->cspec->rcvmod_lock); | |
5921 | spin_lock_init(&dd->cspec->gpio_lock); | |
5922 | ||
5923 | /* we haven't yet set QIB_PRESENT, so use read directly */ | |
5924 | dd->revision = readq(&dd->kregbase[kr_revision]); | |
5925 | ||
5926 | if ((dd->revision & 0xffffffffU) == 0xffffffffU) { | |
5927 | qib_dev_err(dd, "Revision register read failure, " | |
5928 | "giving up initialization\n"); | |
5929 | ret = -ENODEV; | |
5930 | goto bail; | |
5931 | } | |
5932 | dd->flags |= QIB_PRESENT; /* now register routines work */ | |
5933 | ||
5934 | dd->majrev = (u8) SYM_FIELD(dd->revision, Revision_R, ChipRevMajor); | |
5935 | dd->minrev = (u8) SYM_FIELD(dd->revision, Revision_R, ChipRevMinor); | |
5936 | dd->cspec->r1 = dd->minrev == 1; | |
5937 | ||
5938 | get_7322_chip_params(dd); | |
5939 | features = qib_7322_boardname(dd); | |
5940 | ||
5941 | /* now that piobcnt2k and 4k set, we can allocate these */ | |
5942 | sbufcnt = dd->piobcnt2k + dd->piobcnt4k + | |
5943 | NUM_VL15_BUFS + BITS_PER_LONG - 1; | |
5944 | sbufcnt /= BITS_PER_LONG; | |
5945 | dd->cspec->sendchkenable = kmalloc(sbufcnt * | |
5946 | sizeof(*dd->cspec->sendchkenable), GFP_KERNEL); | |
5947 | dd->cspec->sendgrhchk = kmalloc(sbufcnt * | |
5948 | sizeof(*dd->cspec->sendgrhchk), GFP_KERNEL); | |
5949 | dd->cspec->sendibchk = kmalloc(sbufcnt * | |
5950 | sizeof(*dd->cspec->sendibchk), GFP_KERNEL); | |
5951 | if (!dd->cspec->sendchkenable || !dd->cspec->sendgrhchk || | |
5952 | !dd->cspec->sendibchk) { | |
5953 | qib_dev_err(dd, "Failed allocation for hdrchk bitmaps\n"); | |
5954 | ret = -ENOMEM; | |
5955 | goto bail; | |
5956 | } | |
5957 | ||
5958 | ppd = dd->pport; | |
5959 | ||
5960 | /* | |
5961 | * GPIO bits for TWSI data and clock, | |
5962 | * used for serial EEPROM. | |
5963 | */ | |
5964 | dd->gpio_sda_num = _QIB_GPIO_SDA_NUM; | |
5965 | dd->gpio_scl_num = _QIB_GPIO_SCL_NUM; | |
5966 | dd->twsi_eeprom_dev = QIB_TWSI_EEPROM_DEV; | |
5967 | ||
5968 | dd->flags |= QIB_HAS_INTX | QIB_HAS_LINK_LATENCY | | |
5969 | QIB_NODMA_RTAIL | QIB_HAS_VLSUPP | QIB_HAS_HDRSUPP | | |
5970 | QIB_HAS_THRESH_UPDATE | | |
5971 | (sdma_idle_cnt ? QIB_HAS_SDMA_TIMEOUT : 0); | |
5972 | dd->flags |= qib_special_trigger ? | |
5973 | QIB_USE_SPCL_TRIG : QIB_HAS_SEND_DMA; | |
5974 | ||
5975 | /* | |
5976 | * Setup initial values. These may change when PAT is enabled, but | |
5977 | * we need these to do initial chip register accesses. | |
5978 | */ | |
5979 | qib_7322_set_baseaddrs(dd); | |
5980 | ||
5981 | mtu = ib_mtu_enum_to_int(qib_ibmtu); | |
5982 | if (mtu == -1) | |
5983 | mtu = QIB_DEFAULT_MTU; | |
5984 | ||
5985 | dd->cspec->int_enable_mask = QIB_I_BITSEXTANT; | |
5986 | /* all hwerrors become interrupts, unless special purposed */ | |
5987 | dd->cspec->hwerrmask = ~0ULL; | |
5988 | /* link_recovery setup causes these errors, so ignore them, | |
5989 | * other than clearing them when they occur */ | |
5990 | dd->cspec->hwerrmask &= | |
5991 | ~(SYM_MASK(HwErrMask, IBSerdesPClkNotDetectMask_0) | | |
5992 | SYM_MASK(HwErrMask, IBSerdesPClkNotDetectMask_1) | | |
5993 | HWE_MASK(LATriggered)); | |
5994 | ||
5995 | for (pidx = 0; pidx < NUM_IB_PORTS; ++pidx) { | |
5996 | struct qib_chippport_specific *cp = ppd->cpspec; | |
5997 | ppd->link_speed_supported = features & PORT_SPD_CAP; | |
5998 | features >>= PORT_SPD_CAP_SHIFT; | |
5999 | if (!ppd->link_speed_supported) { | |
6000 | /* single port mode (7340, or configured) */ | |
6001 | dd->skip_kctxt_mask |= 1 << pidx; | |
6002 | if (pidx == 0) { | |
6003 | /* Make sure port is disabled. */ | |
6004 | qib_write_kreg_port(ppd, krp_rcvctrl, 0); | |
6005 | qib_write_kreg_port(ppd, krp_ibcctrl_a, 0); | |
6006 | ppd[0] = ppd[1]; | |
6007 | dd->cspec->hwerrmask &= ~(SYM_MASK(HwErrMask, | |
6008 | IBSerdesPClkNotDetectMask_0) | |
6009 | | SYM_MASK(HwErrMask, | |
6010 | SDmaMemReadErrMask_0)); | |
6011 | dd->cspec->int_enable_mask &= ~( | |
6012 | SYM_MASK(IntMask, SDmaCleanupDoneMask_0) | | |
6013 | SYM_MASK(IntMask, SDmaIdleIntMask_0) | | |
6014 | SYM_MASK(IntMask, SDmaProgressIntMask_0) | | |
6015 | SYM_MASK(IntMask, SDmaIntMask_0) | | |
6016 | SYM_MASK(IntMask, ErrIntMask_0) | | |
6017 | SYM_MASK(IntMask, SendDoneIntMask_0)); | |
6018 | } else { | |
6019 | /* Make sure port is disabled. */ | |
6020 | qib_write_kreg_port(ppd, krp_rcvctrl, 0); | |
6021 | qib_write_kreg_port(ppd, krp_ibcctrl_a, 0); | |
6022 | dd->cspec->hwerrmask &= ~(SYM_MASK(HwErrMask, | |
6023 | IBSerdesPClkNotDetectMask_1) | |
6024 | | SYM_MASK(HwErrMask, | |
6025 | SDmaMemReadErrMask_1)); | |
6026 | dd->cspec->int_enable_mask &= ~( | |
6027 | SYM_MASK(IntMask, SDmaCleanupDoneMask_1) | | |
6028 | SYM_MASK(IntMask, SDmaIdleIntMask_1) | | |
6029 | SYM_MASK(IntMask, SDmaProgressIntMask_1) | | |
6030 | SYM_MASK(IntMask, SDmaIntMask_1) | | |
6031 | SYM_MASK(IntMask, ErrIntMask_1) | | |
6032 | SYM_MASK(IntMask, SendDoneIntMask_1)); | |
6033 | } | |
6034 | continue; | |
6035 | } | |
6036 | ||
6037 | dd->num_pports++; | |
6038 | qib_init_pportdata(ppd, dd, pidx, dd->num_pports); | |
6039 | ||
6040 | ppd->link_width_supported = IB_WIDTH_1X | IB_WIDTH_4X; | |
6041 | ppd->link_width_enabled = IB_WIDTH_4X; | |
6042 | ppd->link_speed_enabled = ppd->link_speed_supported; | |
6043 | /* | |
6044 | * Set the initial values to reasonable default, will be set | |
6045 | * for real when link is up. | |
6046 | */ | |
6047 | ppd->link_width_active = IB_WIDTH_4X; | |
6048 | ppd->link_speed_active = QIB_IB_SDR; | |
6049 | ppd->delay_mult = ib_rate_to_delay[IB_RATE_10_GBPS]; | |
6050 | switch (qib_num_cfg_vls) { | |
6051 | case 1: | |
6052 | ppd->vls_supported = IB_VL_VL0; | |
6053 | break; | |
6054 | case 2: | |
6055 | ppd->vls_supported = IB_VL_VL0_1; | |
6056 | break; | |
6057 | default: | |
6058 | qib_devinfo(dd->pcidev, | |
6059 | "Invalid num_vls %u, using 4 VLs\n", | |
6060 | qib_num_cfg_vls); | |
6061 | qib_num_cfg_vls = 4; | |
6062 | /* fall through */ | |
6063 | case 4: | |
6064 | ppd->vls_supported = IB_VL_VL0_3; | |
6065 | break; | |
6066 | case 8: | |
6067 | if (mtu <= 2048) | |
6068 | ppd->vls_supported = IB_VL_VL0_7; | |
6069 | else { | |
6070 | qib_devinfo(dd->pcidev, | |
6071 | "Invalid num_vls %u for MTU %d " | |
6072 | ", using 4 VLs\n", | |
6073 | qib_num_cfg_vls, mtu); | |
6074 | ppd->vls_supported = IB_VL_VL0_3; | |
6075 | qib_num_cfg_vls = 4; | |
6076 | } | |
6077 | break; | |
6078 | } | |
6079 | ppd->vls_operational = ppd->vls_supported; | |
6080 | ||
6081 | init_waitqueue_head(&cp->autoneg_wait); | |
6082 | INIT_DELAYED_WORK(&cp->autoneg_work, | |
6083 | autoneg_7322_work); | |
6084 | if (ppd->dd->cspec->r1) | |
6085 | INIT_DELAYED_WORK(&cp->ipg_work, ipg_7322_work); | |
6086 | ||
6087 | /* | |
6088 | * For Mez and similar cards, no qsfp info, so do | |
6089 | * the "cable info" setup here. Can be overridden | |
6090 | * in adapter-specific routines. | |
6091 | */ | |
7c7a416e RC |
6092 | if (!(dd->flags & QIB_HAS_QSFP)) { |
6093 | if (!IS_QMH(dd) && !IS_QME(dd)) | |
6094 | qib_devinfo(dd->pcidev, "IB%u:%u: " | |
f931551b | 6095 | "Unknown mezzanine card type\n", |
a77fcf89 RC |
6096 | dd->unit, ppd->port); |
6097 | cp->h1_val = IS_QMH(dd) ? H1_FORCE_QMH : H1_FORCE_QME; | |
f931551b | 6098 | /* |
a77fcf89 RC |
6099 | * Choose center value as default tx serdes setting |
6100 | * until changed through module parameter. | |
f931551b | 6101 | */ |
a77fcf89 RC |
6102 | ppd->cpspec->no_eep = IS_QMH(dd) ? |
6103 | TXDDS_TABLE_SZ + 2 : TXDDS_TABLE_SZ + 4; | |
f931551b RC |
6104 | } else |
6105 | cp->h1_val = H1_FORCE_VAL; | |
6106 | ||
6107 | /* Avoid writes to chip for mini_init */ | |
6108 | if (!qib_mini_init) | |
6109 | write_7322_init_portregs(ppd); | |
6110 | ||
6111 | init_timer(&cp->chase_timer); | |
6112 | cp->chase_timer.function = reenable_chase; | |
6113 | cp->chase_timer.data = (unsigned long)ppd; | |
6114 | ||
6115 | ppd++; | |
6116 | } | |
6117 | ||
0a43e117 MM |
6118 | dd->rcvhdrentsize = qib_rcvhdrentsize ? |
6119 | qib_rcvhdrentsize : QIB_RCVHDR_ENTSIZE; | |
6120 | dd->rcvhdrsize = qib_rcvhdrsize ? | |
6121 | qib_rcvhdrsize : QIB_DFLT_RCVHDRSIZE; | |
a77fcf89 | 6122 | dd->rhf_offset = dd->rcvhdrentsize - sizeof(u64) / sizeof(u32); |
f931551b RC |
6123 | |
6124 | /* we always allocate at least 2048 bytes for eager buffers */ | |
6125 | dd->rcvegrbufsize = max(mtu, 2048); | |
6126 | ||
6127 | qib_7322_tidtemplate(dd); | |
6128 | ||
6129 | /* | |
6130 | * We can request a receive interrupt for 1 or | |
6131 | * more packets from current offset. | |
6132 | */ | |
6133 | dd->rhdrhead_intr_off = | |
6134 | (u64) rcv_int_count << IBA7322_HDRHEAD_PKTINT_SHIFT; | |
6135 | ||
6136 | /* setup the stats timer; the add_timer is done at end of init */ | |
6137 | init_timer(&dd->stats_timer); | |
6138 | dd->stats_timer.function = qib_get_7322_faststats; | |
6139 | dd->stats_timer.data = (unsigned long) dd; | |
6140 | ||
6141 | dd->ureg_align = 0x10000; /* 64KB alignment */ | |
6142 | ||
6143 | dd->piosize2kmax_dwords = dd->piosize2k >> 2; | |
6144 | ||
6145 | qib_7322_config_ctxts(dd); | |
6146 | qib_set_ctxtcnt(dd); | |
6147 | ||
6148 | if (qib_wc_pat) { | |
fce24a9d DO |
6149 | resource_size_t vl15off; |
6150 | /* | |
6151 | * We do not set WC on the VL15 buffers to avoid | |
6152 | * a rare problem with unaligned writes from | |
6153 | * interrupt-flushed store buffers, so we need | |
6154 | * to map those separately here. We can't solve | |
6155 | * this for the rarely used mtrr case. | |
6156 | */ | |
6157 | ret = init_chip_wc_pat(dd, 0); | |
f931551b RC |
6158 | if (ret) |
6159 | goto bail; | |
fce24a9d DO |
6160 | |
6161 | /* vl15 buffers start just after the 4k buffers */ | |
6162 | vl15off = dd->physaddr + (dd->piobufbase >> 32) + | |
6163 | dd->piobcnt4k * dd->align4k; | |
6164 | dd->piovl15base = ioremap_nocache(vl15off, | |
6165 | NUM_VL15_BUFS * dd->align4k); | |
6166 | if (!dd->piovl15base) | |
6167 | goto bail; | |
f931551b RC |
6168 | } |
6169 | qib_7322_set_baseaddrs(dd); /* set chip access pointers now */ | |
6170 | ||
6171 | ret = 0; | |
6172 | if (qib_mini_init) | |
6173 | goto bail; | |
6174 | if (!dd->num_pports) { | |
6175 | qib_dev_err(dd, "No ports enabled, giving up initialization\n"); | |
6176 | goto bail; /* no error, so can still figure out why err */ | |
6177 | } | |
6178 | ||
6179 | write_7322_initregs(dd); | |
6180 | ret = qib_create_ctxts(dd); | |
6181 | init_7322_cntrnames(dd); | |
6182 | ||
6183 | updthresh = 8U; /* update threshold */ | |
6184 | ||
6185 | /* use all of 4KB buffers for the kernel SDMA, zero if !SDMA. | |
6186 | * reserve the update threshold amount for other kernel use, such | |
6187 | * as sending SMI, MAD, and ACKs, or 3, whichever is greater, | |
6188 | * unless we aren't enabling SDMA, in which case we want to use | |
6189 | * all the 4k bufs for the kernel. | |
6190 | * if this was less than the update threshold, we could wait | |
6191 | * a long time for an update. Coded this way because we | |
6192 | * sometimes change the update threshold for various reasons, | |
6193 | * and we want this to remain robust. | |
6194 | */ | |
6195 | if (dd->flags & QIB_HAS_SEND_DMA) { | |
6196 | dd->cspec->sdmabufcnt = dd->piobcnt4k; | |
6197 | sbufs = updthresh > 3 ? updthresh : 3; | |
6198 | } else { | |
6199 | dd->cspec->sdmabufcnt = 0; | |
6200 | sbufs = dd->piobcnt4k; | |
6201 | } | |
6202 | dd->cspec->lastbuf_for_pio = dd->piobcnt2k + dd->piobcnt4k - | |
6203 | dd->cspec->sdmabufcnt; | |
6204 | dd->lastctxt_piobuf = dd->cspec->lastbuf_for_pio - sbufs; | |
6205 | dd->cspec->lastbuf_for_pio--; /* range is <= , not < */ | |
6206 | dd->pbufsctxt = (dd->cfgctxts > dd->first_user_ctxt) ? | |
6207 | dd->lastctxt_piobuf / (dd->cfgctxts - dd->first_user_ctxt) : 0; | |
6208 | ||
6209 | /* | |
6210 | * If we have 16 user contexts, we will have 7 sbufs | |
6211 | * per context, so reduce the update threshold to match. We | |
6212 | * want to update before we actually run out, at low pbufs/ctxt | |
6213 | * so give ourselves some margin. | |
6214 | */ | |
6215 | if (dd->pbufsctxt >= 2 && dd->pbufsctxt - 2 < updthresh) | |
6216 | updthresh = dd->pbufsctxt - 2; | |
6217 | dd->cspec->updthresh_dflt = updthresh; | |
6218 | dd->cspec->updthresh = updthresh; | |
6219 | ||
6220 | /* before full enable, no interrupts, no locking needed */ | |
6221 | dd->sendctrl |= ((updthresh & SYM_RMASK(SendCtrl, AvailUpdThld)) | |
6222 | << SYM_LSB(SendCtrl, AvailUpdThld)) | | |
6223 | SYM_MASK(SendCtrl, SendBufAvailPad64Byte); | |
6224 | ||
6225 | dd->psxmitwait_supported = 1; | |
6226 | dd->psxmitwait_check_rate = QIB_7322_PSXMITWAIT_CHECK_RATE; | |
6227 | bail: | |
6228 | if (!dd->ctxtcnt) | |
6229 | dd->ctxtcnt = 1; /* for other initialization code */ | |
6230 | ||
6231 | return ret; | |
6232 | } | |
6233 | ||
6234 | static u32 __iomem *qib_7322_getsendbuf(struct qib_pportdata *ppd, u64 pbc, | |
6235 | u32 *pbufnum) | |
6236 | { | |
6237 | u32 first, last, plen = pbc & QIB_PBC_LENGTH_MASK; | |
6238 | struct qib_devdata *dd = ppd->dd; | |
6239 | ||
6240 | /* last is same for 2k and 4k, because we use 4k if all 2k busy */ | |
6241 | if (pbc & PBC_7322_VL15_SEND) { | |
6242 | first = dd->piobcnt2k + dd->piobcnt4k + ppd->hw_pidx; | |
6243 | last = first; | |
6244 | } else { | |
6245 | if ((plen + 1) > dd->piosize2kmax_dwords) | |
6246 | first = dd->piobcnt2k; | |
6247 | else | |
6248 | first = 0; | |
6249 | last = dd->cspec->lastbuf_for_pio; | |
6250 | } | |
6251 | return qib_getsendbuf_range(dd, pbufnum, first, last); | |
6252 | } | |
6253 | ||
6254 | static void qib_set_cntr_7322_sample(struct qib_pportdata *ppd, u32 intv, | |
6255 | u32 start) | |
6256 | { | |
6257 | qib_write_kreg_port(ppd, krp_psinterval, intv); | |
6258 | qib_write_kreg_port(ppd, krp_psstart, start); | |
6259 | } | |
6260 | ||
6261 | /* | |
6262 | * Must be called with sdma_lock held, or before init finished. | |
6263 | */ | |
6264 | static void qib_sdma_set_7322_desc_cnt(struct qib_pportdata *ppd, unsigned cnt) | |
6265 | { | |
6266 | qib_write_kreg_port(ppd, krp_senddmadesccnt, cnt); | |
6267 | } | |
6268 | ||
6269 | static struct sdma_set_state_action sdma_7322_action_table[] = { | |
6270 | [qib_sdma_state_s00_hw_down] = { | |
6271 | .go_s99_running_tofalse = 1, | |
6272 | .op_enable = 0, | |
6273 | .op_intenable = 0, | |
6274 | .op_halt = 0, | |
6275 | .op_drain = 0, | |
6276 | }, | |
6277 | [qib_sdma_state_s10_hw_start_up_wait] = { | |
6278 | .op_enable = 0, | |
6279 | .op_intenable = 1, | |
6280 | .op_halt = 1, | |
6281 | .op_drain = 0, | |
6282 | }, | |
6283 | [qib_sdma_state_s20_idle] = { | |
6284 | .op_enable = 1, | |
6285 | .op_intenable = 1, | |
6286 | .op_halt = 1, | |
6287 | .op_drain = 0, | |
6288 | }, | |
6289 | [qib_sdma_state_s30_sw_clean_up_wait] = { | |
6290 | .op_enable = 0, | |
6291 | .op_intenable = 1, | |
6292 | .op_halt = 1, | |
6293 | .op_drain = 0, | |
6294 | }, | |
6295 | [qib_sdma_state_s40_hw_clean_up_wait] = { | |
6296 | .op_enable = 1, | |
6297 | .op_intenable = 1, | |
6298 | .op_halt = 1, | |
6299 | .op_drain = 0, | |
6300 | }, | |
6301 | [qib_sdma_state_s50_hw_halt_wait] = { | |
6302 | .op_enable = 1, | |
6303 | .op_intenable = 1, | |
6304 | .op_halt = 1, | |
6305 | .op_drain = 1, | |
6306 | }, | |
6307 | [qib_sdma_state_s99_running] = { | |
6308 | .op_enable = 1, | |
6309 | .op_intenable = 1, | |
6310 | .op_halt = 0, | |
6311 | .op_drain = 0, | |
6312 | .go_s99_running_totrue = 1, | |
6313 | }, | |
6314 | }; | |
6315 | ||
6316 | static void qib_7322_sdma_init_early(struct qib_pportdata *ppd) | |
6317 | { | |
6318 | ppd->sdma_state.set_state_action = sdma_7322_action_table; | |
6319 | } | |
6320 | ||
6321 | static int init_sdma_7322_regs(struct qib_pportdata *ppd) | |
6322 | { | |
6323 | struct qib_devdata *dd = ppd->dd; | |
6324 | unsigned lastbuf, erstbuf; | |
6325 | u64 senddmabufmask[3] = { 0 }; | |
6326 | int n, ret = 0; | |
6327 | ||
6328 | qib_write_kreg_port(ppd, krp_senddmabase, ppd->sdma_descq_phys); | |
6329 | qib_sdma_7322_setlengen(ppd); | |
6330 | qib_sdma_update_7322_tail(ppd, 0); /* Set SendDmaTail */ | |
6331 | qib_write_kreg_port(ppd, krp_senddmareloadcnt, sdma_idle_cnt); | |
6332 | qib_write_kreg_port(ppd, krp_senddmadesccnt, 0); | |
6333 | qib_write_kreg_port(ppd, krp_senddmaheadaddr, ppd->sdma_head_phys); | |
6334 | ||
6335 | if (dd->num_pports) | |
6336 | n = dd->cspec->sdmabufcnt / dd->num_pports; /* no remainder */ | |
6337 | else | |
6338 | n = dd->cspec->sdmabufcnt; /* failsafe for init */ | |
6339 | erstbuf = (dd->piobcnt2k + dd->piobcnt4k) - | |
6340 | ((dd->num_pports == 1 || ppd->port == 2) ? n : | |
6341 | dd->cspec->sdmabufcnt); | |
6342 | lastbuf = erstbuf + n; | |
6343 | ||
6344 | ppd->sdma_state.first_sendbuf = erstbuf; | |
6345 | ppd->sdma_state.last_sendbuf = lastbuf; | |
6346 | for (; erstbuf < lastbuf; ++erstbuf) { | |
6347 | unsigned word = erstbuf / BITS_PER_LONG; | |
6348 | unsigned bit = erstbuf & (BITS_PER_LONG - 1); | |
6349 | ||
6350 | BUG_ON(word >= 3); | |
6351 | senddmabufmask[word] |= 1ULL << bit; | |
6352 | } | |
6353 | qib_write_kreg_port(ppd, krp_senddmabufmask0, senddmabufmask[0]); | |
6354 | qib_write_kreg_port(ppd, krp_senddmabufmask1, senddmabufmask[1]); | |
6355 | qib_write_kreg_port(ppd, krp_senddmabufmask2, senddmabufmask[2]); | |
6356 | return ret; | |
6357 | } | |
6358 | ||
6359 | /* sdma_lock must be held */ | |
6360 | static u16 qib_sdma_7322_gethead(struct qib_pportdata *ppd) | |
6361 | { | |
6362 | struct qib_devdata *dd = ppd->dd; | |
6363 | int sane; | |
6364 | int use_dmahead; | |
6365 | u16 swhead; | |
6366 | u16 swtail; | |
6367 | u16 cnt; | |
6368 | u16 hwhead; | |
6369 | ||
6370 | use_dmahead = __qib_sdma_running(ppd) && | |
6371 | (dd->flags & QIB_HAS_SDMA_TIMEOUT); | |
6372 | retry: | |
6373 | hwhead = use_dmahead ? | |
6374 | (u16) le64_to_cpu(*ppd->sdma_head_dma) : | |
6375 | (u16) qib_read_kreg_port(ppd, krp_senddmahead); | |
6376 | ||
6377 | swhead = ppd->sdma_descq_head; | |
6378 | swtail = ppd->sdma_descq_tail; | |
6379 | cnt = ppd->sdma_descq_cnt; | |
6380 | ||
6381 | if (swhead < swtail) | |
6382 | /* not wrapped */ | |
6383 | sane = (hwhead >= swhead) & (hwhead <= swtail); | |
6384 | else if (swhead > swtail) | |
6385 | /* wrapped around */ | |
6386 | sane = ((hwhead >= swhead) && (hwhead < cnt)) || | |
6387 | (hwhead <= swtail); | |
6388 | else | |
6389 | /* empty */ | |
6390 | sane = (hwhead == swhead); | |
6391 | ||
6392 | if (unlikely(!sane)) { | |
6393 | if (use_dmahead) { | |
6394 | /* try one more time, directly from the register */ | |
6395 | use_dmahead = 0; | |
6396 | goto retry; | |
6397 | } | |
6398 | /* proceed as if no progress */ | |
6399 | hwhead = swhead; | |
6400 | } | |
6401 | ||
6402 | return hwhead; | |
6403 | } | |
6404 | ||
6405 | static int qib_sdma_7322_busy(struct qib_pportdata *ppd) | |
6406 | { | |
6407 | u64 hwstatus = qib_read_kreg_port(ppd, krp_senddmastatus); | |
6408 | ||
6409 | return (hwstatus & SYM_MASK(SendDmaStatus_0, ScoreBoardDrainInProg)) || | |
6410 | (hwstatus & SYM_MASK(SendDmaStatus_0, HaltInProg)) || | |
6411 | !(hwstatus & SYM_MASK(SendDmaStatus_0, InternalSDmaHalt)) || | |
6412 | !(hwstatus & SYM_MASK(SendDmaStatus_0, ScbEmpty)); | |
6413 | } | |
6414 | ||
6415 | /* | |
6416 | * Compute the amount of delay before sending the next packet if the | |
6417 | * port's send rate differs from the static rate set for the QP. | |
6418 | * The delay affects the next packet and the amount of the delay is | |
6419 | * based on the length of the this packet. | |
6420 | */ | |
6421 | static u32 qib_7322_setpbc_control(struct qib_pportdata *ppd, u32 plen, | |
6422 | u8 srate, u8 vl) | |
6423 | { | |
6424 | u8 snd_mult = ppd->delay_mult; | |
6425 | u8 rcv_mult = ib_rate_to_delay[srate]; | |
6426 | u32 ret; | |
6427 | ||
6428 | ret = rcv_mult > snd_mult ? ((plen + 1) >> 1) * snd_mult : 0; | |
6429 | ||
6430 | /* Indicate VL15, else set the VL in the control word */ | |
6431 | if (vl == 15) | |
6432 | ret |= PBC_7322_VL15_SEND_CTRL; | |
6433 | else | |
6434 | ret |= vl << PBC_VL_NUM_LSB; | |
6435 | ret |= ((u32)(ppd->hw_pidx)) << PBC_PORT_SEL_LSB; | |
6436 | ||
6437 | return ret; | |
6438 | } | |
6439 | ||
6440 | /* | |
6441 | * Enable the per-port VL15 send buffers for use. | |
6442 | * They follow the rest of the buffers, without a config parameter. | |
6443 | * This was in initregs, but that is done before the shadow | |
6444 | * is set up, and this has to be done after the shadow is | |
6445 | * set up. | |
6446 | */ | |
6447 | static void qib_7322_initvl15_bufs(struct qib_devdata *dd) | |
6448 | { | |
6449 | unsigned vl15bufs; | |
6450 | ||
6451 | vl15bufs = dd->piobcnt2k + dd->piobcnt4k; | |
6452 | qib_chg_pioavailkernel(dd, vl15bufs, NUM_VL15_BUFS, | |
6453 | TXCHK_CHG_TYPE_KERN, NULL); | |
6454 | } | |
6455 | ||
6456 | static void qib_7322_init_ctxt(struct qib_ctxtdata *rcd) | |
6457 | { | |
6458 | if (rcd->ctxt < NUM_IB_PORTS) { | |
6459 | if (rcd->dd->num_pports > 1) { | |
6460 | rcd->rcvegrcnt = KCTXT0_EGRCNT / 2; | |
6461 | rcd->rcvegr_tid_base = rcd->ctxt ? rcd->rcvegrcnt : 0; | |
6462 | } else { | |
6463 | rcd->rcvegrcnt = KCTXT0_EGRCNT; | |
6464 | rcd->rcvegr_tid_base = 0; | |
6465 | } | |
6466 | } else { | |
6467 | rcd->rcvegrcnt = rcd->dd->cspec->rcvegrcnt; | |
6468 | rcd->rcvegr_tid_base = KCTXT0_EGRCNT + | |
6469 | (rcd->ctxt - NUM_IB_PORTS) * rcd->rcvegrcnt; | |
6470 | } | |
6471 | } | |
6472 | ||
6473 | #define QTXSLEEPS 5000 | |
6474 | static void qib_7322_txchk_change(struct qib_devdata *dd, u32 start, | |
6475 | u32 len, u32 which, struct qib_ctxtdata *rcd) | |
6476 | { | |
6477 | int i; | |
6478 | const int last = start + len - 1; | |
6479 | const int lastr = last / BITS_PER_LONG; | |
6480 | u32 sleeps = 0; | |
6481 | int wait = rcd != NULL; | |
6482 | unsigned long flags; | |
6483 | ||
6484 | while (wait) { | |
6485 | unsigned long shadow; | |
6486 | int cstart, previ = -1; | |
6487 | ||
6488 | /* | |
6489 | * when flipping from kernel to user, we can't change | |
6490 | * the checking type if the buffer is allocated to the | |
6491 | * driver. It's OK the other direction, because it's | |
6492 | * from close, and we have just disarm'ed all the | |
6493 | * buffers. All the kernel to kernel changes are also | |
6494 | * OK. | |
6495 | */ | |
6496 | for (cstart = start; cstart <= last; cstart++) { | |
6497 | i = ((2 * cstart) + QLOGIC_IB_SENDPIOAVAIL_BUSY_SHIFT) | |
6498 | / BITS_PER_LONG; | |
6499 | if (i != previ) { | |
6500 | shadow = (unsigned long) | |
6501 | le64_to_cpu(dd->pioavailregs_dma[i]); | |
6502 | previ = i; | |
6503 | } | |
6504 | if (test_bit(((2 * cstart) + | |
6505 | QLOGIC_IB_SENDPIOAVAIL_BUSY_SHIFT) | |
6506 | % BITS_PER_LONG, &shadow)) | |
6507 | break; | |
6508 | } | |
6509 | ||
6510 | if (cstart > last) | |
6511 | break; | |
6512 | ||
6513 | if (sleeps == QTXSLEEPS) | |
6514 | break; | |
6515 | /* make sure we see an updated copy next time around */ | |
6516 | sendctrl_7322_mod(dd->pport, QIB_SENDCTRL_AVAIL_BLIP); | |
6517 | sleeps++; | |
6518 | msleep(1); | |
6519 | } | |
6520 | ||
6521 | switch (which) { | |
6522 | case TXCHK_CHG_TYPE_DIS1: | |
6523 | /* | |
6524 | * disable checking on a range; used by diags; just | |
6525 | * one buffer, but still written generically | |
6526 | */ | |
6527 | for (i = start; i <= last; i++) | |
6528 | clear_bit(i, dd->cspec->sendchkenable); | |
6529 | break; | |
6530 | ||
6531 | case TXCHK_CHG_TYPE_ENAB1: | |
6532 | /* | |
6533 | * (re)enable checking on a range; used by diags; just | |
6534 | * one buffer, but still written generically; read | |
6535 | * scratch to be sure buffer actually triggered, not | |
6536 | * just flushed from processor. | |
6537 | */ | |
6538 | qib_read_kreg32(dd, kr_scratch); | |
6539 | for (i = start; i <= last; i++) | |
6540 | set_bit(i, dd->cspec->sendchkenable); | |
6541 | break; | |
6542 | ||
6543 | case TXCHK_CHG_TYPE_KERN: | |
6544 | /* usable by kernel */ | |
6545 | for (i = start; i <= last; i++) { | |
6546 | set_bit(i, dd->cspec->sendibchk); | |
6547 | clear_bit(i, dd->cspec->sendgrhchk); | |
6548 | } | |
6549 | spin_lock_irqsave(&dd->uctxt_lock, flags); | |
6550 | /* see if we need to raise avail update threshold */ | |
6551 | for (i = dd->first_user_ctxt; | |
6552 | dd->cspec->updthresh != dd->cspec->updthresh_dflt | |
6553 | && i < dd->cfgctxts; i++) | |
6554 | if (dd->rcd[i] && dd->rcd[i]->subctxt_cnt && | |
6555 | ((dd->rcd[i]->piocnt / dd->rcd[i]->subctxt_cnt) - 1) | |
6556 | < dd->cspec->updthresh_dflt) | |
6557 | break; | |
6558 | spin_unlock_irqrestore(&dd->uctxt_lock, flags); | |
6559 | if (i == dd->cfgctxts) { | |
6560 | spin_lock_irqsave(&dd->sendctrl_lock, flags); | |
6561 | dd->cspec->updthresh = dd->cspec->updthresh_dflt; | |
6562 | dd->sendctrl &= ~SYM_MASK(SendCtrl, AvailUpdThld); | |
6563 | dd->sendctrl |= (dd->cspec->updthresh & | |
6564 | SYM_RMASK(SendCtrl, AvailUpdThld)) << | |
6565 | SYM_LSB(SendCtrl, AvailUpdThld); | |
6566 | spin_unlock_irqrestore(&dd->sendctrl_lock, flags); | |
6567 | sendctrl_7322_mod(dd->pport, QIB_SENDCTRL_AVAIL_BLIP); | |
6568 | } | |
6569 | break; | |
6570 | ||
6571 | case TXCHK_CHG_TYPE_USER: | |
6572 | /* for user process */ | |
6573 | for (i = start; i <= last; i++) { | |
6574 | clear_bit(i, dd->cspec->sendibchk); | |
6575 | set_bit(i, dd->cspec->sendgrhchk); | |
6576 | } | |
6577 | spin_lock_irqsave(&dd->sendctrl_lock, flags); | |
6578 | if (rcd && rcd->subctxt_cnt && ((rcd->piocnt | |
6579 | / rcd->subctxt_cnt) - 1) < dd->cspec->updthresh) { | |
6580 | dd->cspec->updthresh = (rcd->piocnt / | |
6581 | rcd->subctxt_cnt) - 1; | |
6582 | dd->sendctrl &= ~SYM_MASK(SendCtrl, AvailUpdThld); | |
6583 | dd->sendctrl |= (dd->cspec->updthresh & | |
6584 | SYM_RMASK(SendCtrl, AvailUpdThld)) | |
6585 | << SYM_LSB(SendCtrl, AvailUpdThld); | |
6586 | spin_unlock_irqrestore(&dd->sendctrl_lock, flags); | |
6587 | sendctrl_7322_mod(dd->pport, QIB_SENDCTRL_AVAIL_BLIP); | |
6588 | } else | |
6589 | spin_unlock_irqrestore(&dd->sendctrl_lock, flags); | |
6590 | break; | |
6591 | ||
6592 | default: | |
6593 | break; | |
6594 | } | |
6595 | ||
6596 | for (i = start / BITS_PER_LONG; which >= 2 && i <= lastr; ++i) | |
6597 | qib_write_kreg(dd, kr_sendcheckmask + i, | |
6598 | dd->cspec->sendchkenable[i]); | |
6599 | ||
6600 | for (i = start / BITS_PER_LONG; which < 2 && i <= lastr; ++i) { | |
6601 | qib_write_kreg(dd, kr_sendgrhcheckmask + i, | |
6602 | dd->cspec->sendgrhchk[i]); | |
6603 | qib_write_kreg(dd, kr_sendibpktmask + i, | |
6604 | dd->cspec->sendibchk[i]); | |
6605 | } | |
6606 | ||
6607 | /* | |
6608 | * Be sure whatever we did was seen by the chip and acted upon, | |
6609 | * before we return. Mostly important for which >= 2. | |
6610 | */ | |
6611 | qib_read_kreg32(dd, kr_scratch); | |
6612 | } | |
6613 | ||
6614 | ||
6615 | /* useful for trigger analyzers, etc. */ | |
6616 | static void writescratch(struct qib_devdata *dd, u32 val) | |
6617 | { | |
6618 | qib_write_kreg(dd, kr_scratch, val); | |
6619 | } | |
6620 | ||
6621 | /* Dummy for now, use chip regs soon */ | |
6622 | static int qib_7322_tempsense_rd(struct qib_devdata *dd, int regnum) | |
6623 | { | |
6624 | return -ENXIO; | |
6625 | } | |
6626 | ||
6627 | /** | |
6628 | * qib_init_iba7322_funcs - set up the chip-specific function pointers | |
6629 | * @dev: the pci_dev for qlogic_ib device | |
6630 | * @ent: pci_device_id struct for this dev | |
6631 | * | |
6632 | * Also allocates, inits, and returns the devdata struct for this | |
6633 | * device instance | |
6634 | * | |
6635 | * This is global, and is called directly at init to set up the | |
6636 | * chip-specific function pointers for later use. | |
6637 | */ | |
6638 | struct qib_devdata *qib_init_iba7322_funcs(struct pci_dev *pdev, | |
6639 | const struct pci_device_id *ent) | |
6640 | { | |
6641 | struct qib_devdata *dd; | |
6642 | int ret, i; | |
6643 | u32 tabsize, actual_cnt = 0; | |
6644 | ||
6645 | dd = qib_alloc_devdata(pdev, | |
6646 | NUM_IB_PORTS * sizeof(struct qib_pportdata) + | |
6647 | sizeof(struct qib_chip_specific) + | |
6648 | NUM_IB_PORTS * sizeof(struct qib_chippport_specific)); | |
6649 | if (IS_ERR(dd)) | |
6650 | goto bail; | |
6651 | ||
6652 | dd->f_bringup_serdes = qib_7322_bringup_serdes; | |
6653 | dd->f_cleanup = qib_setup_7322_cleanup; | |
6654 | dd->f_clear_tids = qib_7322_clear_tids; | |
6655 | dd->f_free_irq = qib_7322_free_irq; | |
6656 | dd->f_get_base_info = qib_7322_get_base_info; | |
6657 | dd->f_get_msgheader = qib_7322_get_msgheader; | |
6658 | dd->f_getsendbuf = qib_7322_getsendbuf; | |
6659 | dd->f_gpio_mod = gpio_7322_mod; | |
6660 | dd->f_eeprom_wen = qib_7322_eeprom_wen; | |
6661 | dd->f_hdrqempty = qib_7322_hdrqempty; | |
6662 | dd->f_ib_updown = qib_7322_ib_updown; | |
6663 | dd->f_init_ctxt = qib_7322_init_ctxt; | |
6664 | dd->f_initvl15_bufs = qib_7322_initvl15_bufs; | |
6665 | dd->f_intr_fallback = qib_7322_intr_fallback; | |
6666 | dd->f_late_initreg = qib_late_7322_initreg; | |
6667 | dd->f_setpbc_control = qib_7322_setpbc_control; | |
6668 | dd->f_portcntr = qib_portcntr_7322; | |
6669 | dd->f_put_tid = qib_7322_put_tid; | |
6670 | dd->f_quiet_serdes = qib_7322_mini_quiet_serdes; | |
6671 | dd->f_rcvctrl = rcvctrl_7322_mod; | |
6672 | dd->f_read_cntrs = qib_read_7322cntrs; | |
6673 | dd->f_read_portcntrs = qib_read_7322portcntrs; | |
6674 | dd->f_reset = qib_do_7322_reset; | |
6675 | dd->f_init_sdma_regs = init_sdma_7322_regs; | |
6676 | dd->f_sdma_busy = qib_sdma_7322_busy; | |
6677 | dd->f_sdma_gethead = qib_sdma_7322_gethead; | |
6678 | dd->f_sdma_sendctrl = qib_7322_sdma_sendctrl; | |
6679 | dd->f_sdma_set_desc_cnt = qib_sdma_set_7322_desc_cnt; | |
6680 | dd->f_sdma_update_tail = qib_sdma_update_7322_tail; | |
6681 | dd->f_sendctrl = sendctrl_7322_mod; | |
6682 | dd->f_set_armlaunch = qib_set_7322_armlaunch; | |
6683 | dd->f_set_cntr_sample = qib_set_cntr_7322_sample; | |
6684 | dd->f_iblink_state = qib_7322_iblink_state; | |
6685 | dd->f_ibphys_portstate = qib_7322_phys_portstate; | |
6686 | dd->f_get_ib_cfg = qib_7322_get_ib_cfg; | |
6687 | dd->f_set_ib_cfg = qib_7322_set_ib_cfg; | |
6688 | dd->f_set_ib_loopback = qib_7322_set_loopback; | |
6689 | dd->f_get_ib_table = qib_7322_get_ib_table; | |
6690 | dd->f_set_ib_table = qib_7322_set_ib_table; | |
6691 | dd->f_set_intr_state = qib_7322_set_intr_state; | |
6692 | dd->f_setextled = qib_setup_7322_setextled; | |
6693 | dd->f_txchk_change = qib_7322_txchk_change; | |
6694 | dd->f_update_usrhead = qib_update_7322_usrhead; | |
6695 | dd->f_wantpiobuf_intr = qib_wantpiobuf_7322_intr; | |
6696 | dd->f_xgxs_reset = qib_7322_mini_pcs_reset; | |
6697 | dd->f_sdma_hw_clean_up = qib_7322_sdma_hw_clean_up; | |
6698 | dd->f_sdma_hw_start_up = qib_7322_sdma_hw_start_up; | |
6699 | dd->f_sdma_init_early = qib_7322_sdma_init_early; | |
6700 | dd->f_writescratch = writescratch; | |
6701 | dd->f_tempsense_rd = qib_7322_tempsense_rd; | |
6702 | /* | |
6703 | * Do remaining PCIe setup and save PCIe values in dd. | |
6704 | * Any error printing is already done by the init code. | |
6705 | * On return, we have the chip mapped, but chip registers | |
6706 | * are not set up until start of qib_init_7322_variables. | |
6707 | */ | |
6708 | ret = qib_pcie_ddinit(dd, pdev, ent); | |
6709 | if (ret < 0) | |
6710 | goto bail_free; | |
6711 | ||
6712 | /* initialize chip-specific variables */ | |
6713 | ret = qib_init_7322_variables(dd); | |
6714 | if (ret) | |
6715 | goto bail_cleanup; | |
6716 | ||
6717 | if (qib_mini_init || !dd->num_pports) | |
6718 | goto bail; | |
6719 | ||
6720 | /* | |
6721 | * Determine number of vectors we want; depends on port count | |
6722 | * and number of configured kernel receive queues actually used. | |
6723 | * Should also depend on whether sdma is enabled or not, but | |
6724 | * that's such a rare testing case it's not worth worrying about. | |
6725 | */ | |
6726 | tabsize = dd->first_user_ctxt + ARRAY_SIZE(irq_table); | |
6727 | for (i = 0; i < tabsize; i++) | |
6728 | if ((i < ARRAY_SIZE(irq_table) && | |
6729 | irq_table[i].port <= dd->num_pports) || | |
6730 | (i >= ARRAY_SIZE(irq_table) && | |
6731 | dd->rcd[i - ARRAY_SIZE(irq_table)])) | |
6732 | actual_cnt++; | |
6733 | tabsize = actual_cnt; | |
6734 | dd->cspec->msix_entries = kmalloc(tabsize * | |
6735 | sizeof(struct msix_entry), GFP_KERNEL); | |
6736 | dd->cspec->msix_arg = kmalloc(tabsize * | |
6737 | sizeof(void *), GFP_KERNEL); | |
6738 | if (!dd->cspec->msix_entries || !dd->cspec->msix_arg) { | |
6739 | qib_dev_err(dd, "No memory for MSIx table\n"); | |
6740 | tabsize = 0; | |
6741 | } | |
6742 | for (i = 0; i < tabsize; i++) | |
6743 | dd->cspec->msix_entries[i].entry = i; | |
6744 | ||
6745 | if (qib_pcie_params(dd, 8, &tabsize, dd->cspec->msix_entries)) | |
6746 | qib_dev_err(dd, "Failed to setup PCIe or interrupts; " | |
6747 | "continuing anyway\n"); | |
6748 | /* may be less than we wanted, if not enough available */ | |
6749 | dd->cspec->num_msix_entries = tabsize; | |
6750 | ||
6751 | /* setup interrupt handler */ | |
6752 | qib_setup_7322_interrupt(dd, 1); | |
6753 | ||
6754 | /* clear diagctrl register, in case diags were running and crashed */ | |
6755 | qib_write_kreg(dd, kr_hwdiagctrl, 0); | |
6756 | ||
f931551b RC |
6757 | goto bail; |
6758 | ||
6759 | bail_cleanup: | |
6760 | qib_pcie_ddcleanup(dd); | |
6761 | bail_free: | |
6762 | qib_free_devdata(dd); | |
6763 | dd = ERR_PTR(ret); | |
6764 | bail: | |
6765 | return dd; | |
6766 | } | |
6767 | ||
6768 | /* | |
6769 | * Set the table entry at the specified index from the table specifed. | |
6770 | * There are 3 * TXDDS_TABLE_SZ entries in all per port, with the first | |
6771 | * TXDDS_TABLE_SZ for SDR, the next for DDR, and the last for QDR. | |
6772 | * 'idx' below addresses the correct entry, while its 4 LSBs select the | |
6773 | * corresponding entry (one of TXDDS_TABLE_SZ) from the selected table. | |
6774 | */ | |
6775 | #define DDS_ENT_AMP_LSB 14 | |
6776 | #define DDS_ENT_MAIN_LSB 9 | |
6777 | #define DDS_ENT_POST_LSB 5 | |
6778 | #define DDS_ENT_PRE_XTRA_LSB 3 | |
6779 | #define DDS_ENT_PRE_LSB 0 | |
6780 | ||
6781 | /* | |
6782 | * Set one entry in the TxDDS table for spec'd port | |
6783 | * ridx picks one of the entries, while tp points | |
6784 | * to the appropriate table entry. | |
6785 | */ | |
6786 | static void set_txdds(struct qib_pportdata *ppd, int ridx, | |
6787 | const struct txdds_ent *tp) | |
6788 | { | |
6789 | struct qib_devdata *dd = ppd->dd; | |
6790 | u32 pack_ent; | |
6791 | int regidx; | |
6792 | ||
6793 | /* Get correct offset in chip-space, and in source table */ | |
6794 | regidx = KREG_IBPORT_IDX(IBSD_DDS_MAP_TABLE) + ridx; | |
6795 | /* | |
6796 | * We do not use qib_write_kreg_port() because it was intended | |
6797 | * only for registers in the lower "port specific" pages. | |
6798 | * So do index calculation by hand. | |
6799 | */ | |
6800 | if (ppd->hw_pidx) | |
6801 | regidx += (dd->palign / sizeof(u64)); | |
6802 | ||
6803 | pack_ent = tp->amp << DDS_ENT_AMP_LSB; | |
6804 | pack_ent |= tp->main << DDS_ENT_MAIN_LSB; | |
6805 | pack_ent |= tp->pre << DDS_ENT_PRE_LSB; | |
6806 | pack_ent |= tp->post << DDS_ENT_POST_LSB; | |
6807 | qib_write_kreg(dd, regidx, pack_ent); | |
6808 | /* Prevent back-to-back writes by hitting scratch */ | |
6809 | qib_write_kreg(ppd->dd, kr_scratch, 0); | |
6810 | } | |
6811 | ||
6812 | static const struct vendor_txdds_ent vendor_txdds[] = { | |
6813 | { /* Amphenol 1m 30awg NoEq */ | |
6814 | { 0x41, 0x50, 0x48 }, "584470002 ", | |
6815 | { 10, 0, 0, 5 }, { 10, 0, 0, 9 }, { 7, 1, 0, 13 }, | |
6816 | }, | |
6817 | { /* Amphenol 3m 28awg NoEq */ | |
6818 | { 0x41, 0x50, 0x48 }, "584470004 ", | |
6819 | { 0, 0, 0, 8 }, { 0, 0, 0, 11 }, { 0, 1, 7, 15 }, | |
6820 | }, | |
6821 | { /* Finisar 3m OM2 Optical */ | |
6822 | { 0x00, 0x90, 0x65 }, "FCBG410QB1C03-QL", | |
6823 | { 0, 0, 0, 3 }, { 0, 0, 0, 4 }, { 0, 0, 0, 13 }, | |
6824 | }, | |
6825 | { /* Finisar 30m OM2 Optical */ | |
6826 | { 0x00, 0x90, 0x65 }, "FCBG410QB1C30-QL", | |
6827 | { 0, 0, 0, 1 }, { 0, 0, 0, 5 }, { 0, 0, 0, 11 }, | |
6828 | }, | |
6829 | { /* Finisar Default OM2 Optical */ | |
6830 | { 0x00, 0x90, 0x65 }, NULL, | |
6831 | { 0, 0, 0, 2 }, { 0, 0, 0, 5 }, { 0, 0, 0, 12 }, | |
6832 | }, | |
6833 | { /* Gore 1m 30awg NoEq */ | |
6834 | { 0x00, 0x21, 0x77 }, "QSN3300-1 ", | |
6835 | { 0, 0, 0, 6 }, { 0, 0, 0, 9 }, { 0, 1, 0, 15 }, | |
6836 | }, | |
6837 | { /* Gore 2m 30awg NoEq */ | |
6838 | { 0x00, 0x21, 0x77 }, "QSN3300-2 ", | |
6839 | { 0, 0, 0, 8 }, { 0, 0, 0, 10 }, { 0, 1, 7, 15 }, | |
6840 | }, | |
6841 | { /* Gore 1m 28awg NoEq */ | |
6842 | { 0x00, 0x21, 0x77 }, "QSN3800-1 ", | |
6843 | { 0, 0, 0, 6 }, { 0, 0, 0, 8 }, { 0, 1, 0, 15 }, | |
6844 | }, | |
6845 | { /* Gore 3m 28awg NoEq */ | |
6846 | { 0x00, 0x21, 0x77 }, "QSN3800-3 ", | |
6847 | { 0, 0, 0, 9 }, { 0, 0, 0, 13 }, { 0, 1, 7, 15 }, | |
6848 | }, | |
6849 | { /* Gore 5m 24awg Eq */ | |
6850 | { 0x00, 0x21, 0x77 }, "QSN7000-5 ", | |
6851 | { 0, 0, 0, 7 }, { 0, 0, 0, 9 }, { 0, 1, 3, 15 }, | |
6852 | }, | |
6853 | { /* Gore 7m 24awg Eq */ | |
6854 | { 0x00, 0x21, 0x77 }, "QSN7000-7 ", | |
6855 | { 0, 0, 0, 9 }, { 0, 0, 0, 11 }, { 0, 2, 6, 15 }, | |
6856 | }, | |
6857 | { /* Gore 5m 26awg Eq */ | |
6858 | { 0x00, 0x21, 0x77 }, "QSN7600-5 ", | |
6859 | { 0, 0, 0, 8 }, { 0, 0, 0, 11 }, { 0, 1, 9, 13 }, | |
6860 | }, | |
6861 | { /* Gore 7m 26awg Eq */ | |
6862 | { 0x00, 0x21, 0x77 }, "QSN7600-7 ", | |
6863 | { 0, 0, 0, 8 }, { 0, 0, 0, 11 }, { 10, 1, 8, 15 }, | |
6864 | }, | |
6865 | { /* Intersil 12m 24awg Active */ | |
6866 | { 0x00, 0x30, 0xB4 }, "QLX4000CQSFP1224", | |
6867 | { 0, 0, 0, 2 }, { 0, 0, 0, 5 }, { 0, 3, 0, 9 }, | |
6868 | }, | |
6869 | { /* Intersil 10m 28awg Active */ | |
6870 | { 0x00, 0x30, 0xB4 }, "QLX4000CQSFP1028", | |
6871 | { 0, 0, 0, 6 }, { 0, 0, 0, 4 }, { 0, 2, 0, 2 }, | |
6872 | }, | |
6873 | { /* Intersil 7m 30awg Active */ | |
6874 | { 0x00, 0x30, 0xB4 }, "QLX4000CQSFP0730", | |
6875 | { 0, 0, 0, 6 }, { 0, 0, 0, 4 }, { 0, 1, 0, 3 }, | |
6876 | }, | |
6877 | { /* Intersil 5m 32awg Active */ | |
6878 | { 0x00, 0x30, 0xB4 }, "QLX4000CQSFP0532", | |
6879 | { 0, 0, 0, 6 }, { 0, 0, 0, 6 }, { 0, 2, 0, 8 }, | |
6880 | }, | |
6881 | { /* Intersil Default Active */ | |
6882 | { 0x00, 0x30, 0xB4 }, NULL, | |
6883 | { 0, 0, 0, 6 }, { 0, 0, 0, 5 }, { 0, 2, 0, 5 }, | |
6884 | }, | |
6885 | { /* Luxtera 20m Active Optical */ | |
6886 | { 0x00, 0x25, 0x63 }, NULL, | |
6887 | { 0, 0, 0, 5 }, { 0, 0, 0, 8 }, { 0, 2, 0, 12 }, | |
6888 | }, | |
6889 | { /* Molex 1M Cu loopback */ | |
6890 | { 0x00, 0x09, 0x3A }, "74763-0025 ", | |
6891 | { 2, 2, 6, 15 }, { 2, 2, 6, 15 }, { 2, 2, 6, 15 }, | |
6892 | }, | |
6893 | { /* Molex 2m 28awg NoEq */ | |
6894 | { 0x00, 0x09, 0x3A }, "74757-2201 ", | |
6895 | { 0, 0, 0, 6 }, { 0, 0, 0, 9 }, { 0, 1, 1, 15 }, | |
6896 | }, | |
6897 | }; | |
6898 | ||
6899 | static const struct txdds_ent txdds_sdr[TXDDS_TABLE_SZ] = { | |
6900 | /* amp, pre, main, post */ | |
6901 | { 2, 2, 15, 6 }, /* Loopback */ | |
6902 | { 0, 0, 0, 1 }, /* 2 dB */ | |
6903 | { 0, 0, 0, 2 }, /* 3 dB */ | |
6904 | { 0, 0, 0, 3 }, /* 4 dB */ | |
6905 | { 0, 0, 0, 4 }, /* 5 dB */ | |
6906 | { 0, 0, 0, 5 }, /* 6 dB */ | |
6907 | { 0, 0, 0, 6 }, /* 7 dB */ | |
6908 | { 0, 0, 0, 7 }, /* 8 dB */ | |
6909 | { 0, 0, 0, 8 }, /* 9 dB */ | |
6910 | { 0, 0, 0, 9 }, /* 10 dB */ | |
6911 | { 0, 0, 0, 10 }, /* 11 dB */ | |
6912 | { 0, 0, 0, 11 }, /* 12 dB */ | |
6913 | { 0, 0, 0, 12 }, /* 13 dB */ | |
6914 | { 0, 0, 0, 13 }, /* 14 dB */ | |
6915 | { 0, 0, 0, 14 }, /* 15 dB */ | |
6916 | { 0, 0, 0, 15 }, /* 16 dB */ | |
6917 | }; | |
6918 | ||
6919 | static const struct txdds_ent txdds_ddr[TXDDS_TABLE_SZ] = { | |
6920 | /* amp, pre, main, post */ | |
6921 | { 2, 2, 15, 6 }, /* Loopback */ | |
6922 | { 0, 0, 0, 8 }, /* 2 dB */ | |
6923 | { 0, 0, 0, 8 }, /* 3 dB */ | |
6924 | { 0, 0, 0, 9 }, /* 4 dB */ | |
6925 | { 0, 0, 0, 9 }, /* 5 dB */ | |
6926 | { 0, 0, 0, 10 }, /* 6 dB */ | |
6927 | { 0, 0, 0, 10 }, /* 7 dB */ | |
6928 | { 0, 0, 0, 11 }, /* 8 dB */ | |
6929 | { 0, 0, 0, 11 }, /* 9 dB */ | |
6930 | { 0, 0, 0, 12 }, /* 10 dB */ | |
6931 | { 0, 0, 0, 12 }, /* 11 dB */ | |
6932 | { 0, 0, 0, 13 }, /* 12 dB */ | |
6933 | { 0, 0, 0, 13 }, /* 13 dB */ | |
6934 | { 0, 0, 0, 14 }, /* 14 dB */ | |
6935 | { 0, 0, 0, 14 }, /* 15 dB */ | |
6936 | { 0, 0, 0, 15 }, /* 16 dB */ | |
6937 | }; | |
6938 | ||
6939 | static const struct txdds_ent txdds_qdr[TXDDS_TABLE_SZ] = { | |
6940 | /* amp, pre, main, post */ | |
6941 | { 2, 2, 15, 6 }, /* Loopback */ | |
a77fcf89 RC |
6942 | { 0, 1, 0, 7 }, /* 2 dB (also QMH7342) */ |
6943 | { 0, 1, 0, 9 }, /* 3 dB (also QMH7342) */ | |
f931551b RC |
6944 | { 0, 1, 0, 11 }, /* 4 dB */ |
6945 | { 0, 1, 0, 13 }, /* 5 dB */ | |
6946 | { 0, 1, 0, 15 }, /* 6 dB */ | |
6947 | { 0, 1, 3, 15 }, /* 7 dB */ | |
6948 | { 0, 1, 7, 15 }, /* 8 dB */ | |
6949 | { 0, 1, 7, 15 }, /* 9 dB */ | |
6950 | { 0, 1, 8, 15 }, /* 10 dB */ | |
6951 | { 0, 1, 9, 15 }, /* 11 dB */ | |
6952 | { 0, 1, 10, 15 }, /* 12 dB */ | |
6953 | { 0, 2, 6, 15 }, /* 13 dB */ | |
6954 | { 0, 2, 7, 15 }, /* 14 dB */ | |
6955 | { 0, 2, 8, 15 }, /* 15 dB */ | |
6956 | { 0, 2, 9, 15 }, /* 16 dB */ | |
6957 | }; | |
6958 | ||
a77fcf89 RC |
6959 | /* |
6960 | * extra entries for use with txselect, for indices >= TXDDS_TABLE_SZ. | |
6961 | * These are mostly used for mez cards going through connectors | |
6962 | * and backplane traces, but can be used to add other "unusual" | |
6963 | * table values as well. | |
6964 | */ | |
6965 | static const struct txdds_ent txdds_extra_sdr[TXDDS_EXTRA_SZ] = { | |
6966 | /* amp, pre, main, post */ | |
6967 | { 0, 0, 0, 1 }, /* QMH7342 backplane settings */ | |
6968 | { 0, 0, 0, 1 }, /* QMH7342 backplane settings */ | |
6969 | { 0, 0, 0, 2 }, /* QMH7342 backplane settings */ | |
6970 | { 0, 0, 0, 2 }, /* QMH7342 backplane settings */ | |
6971 | { 0, 0, 0, 11 }, /* QME7342 backplane settings */ | |
6972 | { 0, 0, 0, 11 }, /* QME7342 backplane settings */ | |
6973 | { 0, 0, 0, 11 }, /* QME7342 backplane settings */ | |
6974 | { 0, 0, 0, 11 }, /* QME7342 backplane settings */ | |
6975 | { 0, 0, 0, 11 }, /* QME7342 backplane settings */ | |
6976 | { 0, 0, 0, 11 }, /* QME7342 backplane settings */ | |
6977 | { 0, 0, 0, 11 }, /* QME7342 backplane settings */ | |
7c7a416e RC |
6978 | { 0, 0, 0, 3 }, /* QMH7342 backplane settings */ |
6979 | { 0, 0, 0, 4 }, /* QMH7342 backplane settings */ | |
a77fcf89 RC |
6980 | }; |
6981 | ||
6982 | static const struct txdds_ent txdds_extra_ddr[TXDDS_EXTRA_SZ] = { | |
6983 | /* amp, pre, main, post */ | |
6984 | { 0, 0, 0, 7 }, /* QMH7342 backplane settings */ | |
6985 | { 0, 0, 0, 7 }, /* QMH7342 backplane settings */ | |
6986 | { 0, 0, 0, 8 }, /* QMH7342 backplane settings */ | |
6987 | { 0, 0, 0, 8 }, /* QMH7342 backplane settings */ | |
6988 | { 0, 0, 0, 13 }, /* QME7342 backplane settings */ | |
6989 | { 0, 0, 0, 13 }, /* QME7342 backplane settings */ | |
6990 | { 0, 0, 0, 13 }, /* QME7342 backplane settings */ | |
6991 | { 0, 0, 0, 13 }, /* QME7342 backplane settings */ | |
6992 | { 0, 0, 0, 13 }, /* QME7342 backplane settings */ | |
6993 | { 0, 0, 0, 13 }, /* QME7342 backplane settings */ | |
6994 | { 0, 0, 0, 13 }, /* QME7342 backplane settings */ | |
7c7a416e RC |
6995 | { 0, 0, 0, 9 }, /* QMH7342 backplane settings */ |
6996 | { 0, 0, 0, 10 }, /* QMH7342 backplane settings */ | |
a77fcf89 RC |
6997 | }; |
6998 | ||
6999 | static const struct txdds_ent txdds_extra_qdr[TXDDS_EXTRA_SZ] = { | |
7000 | /* amp, pre, main, post */ | |
7001 | { 0, 1, 0, 4 }, /* QMH7342 backplane settings */ | |
7002 | { 0, 1, 0, 5 }, /* QMH7342 backplane settings */ | |
7003 | { 0, 1, 0, 6 }, /* QMH7342 backplane settings */ | |
7004 | { 0, 1, 0, 8 }, /* QMH7342 backplane settings */ | |
7005 | { 0, 1, 12, 10 }, /* QME7342 backplane setting */ | |
7006 | { 0, 1, 12, 11 }, /* QME7342 backplane setting */ | |
7007 | { 0, 1, 12, 12 }, /* QME7342 backplane setting */ | |
7008 | { 0, 1, 12, 14 }, /* QME7342 backplane setting */ | |
7009 | { 0, 1, 12, 6 }, /* QME7342 backplane setting */ | |
7010 | { 0, 1, 12, 7 }, /* QME7342 backplane setting */ | |
7011 | { 0, 1, 12, 8 }, /* QME7342 backplane setting */ | |
7c7a416e RC |
7012 | { 0, 1, 0, 10 }, /* QMH7342 backplane settings */ |
7013 | { 0, 1, 0, 12 }, /* QMH7342 backplane settings */ | |
a77fcf89 RC |
7014 | }; |
7015 | ||
f931551b RC |
7016 | static const struct txdds_ent *get_atten_table(const struct txdds_ent *txdds, |
7017 | unsigned atten) | |
7018 | { | |
7019 | /* | |
7020 | * The attenuation table starts at 2dB for entry 1, | |
7021 | * with entry 0 being the loopback entry. | |
7022 | */ | |
7023 | if (atten <= 2) | |
7024 | atten = 1; | |
7025 | else if (atten > TXDDS_TABLE_SZ) | |
7026 | atten = TXDDS_TABLE_SZ - 1; | |
7027 | else | |
7028 | atten--; | |
7029 | return txdds + atten; | |
7030 | } | |
7031 | ||
7032 | /* | |
a77fcf89 | 7033 | * if override is set, the module parameter txselect has a value |
f931551b RC |
7034 | * for this specific port, so use it, rather than our normal mechanism. |
7035 | */ | |
7036 | static void find_best_ent(struct qib_pportdata *ppd, | |
7037 | const struct txdds_ent **sdr_dds, | |
7038 | const struct txdds_ent **ddr_dds, | |
7039 | const struct txdds_ent **qdr_dds, int override) | |
7040 | { | |
7041 | struct qib_qsfp_cache *qd = &ppd->cpspec->qsfp_data.cache; | |
7042 | int idx; | |
7043 | ||
7044 | /* Search table of known cables */ | |
7045 | for (idx = 0; !override && idx < ARRAY_SIZE(vendor_txdds); ++idx) { | |
7046 | const struct vendor_txdds_ent *v = vendor_txdds + idx; | |
7047 | ||
7048 | if (!memcmp(v->oui, qd->oui, QSFP_VOUI_LEN) && | |
7049 | (!v->partnum || | |
7050 | !memcmp(v->partnum, qd->partnum, QSFP_PN_LEN))) { | |
7051 | *sdr_dds = &v->sdr; | |
7052 | *ddr_dds = &v->ddr; | |
7053 | *qdr_dds = &v->qdr; | |
7054 | return; | |
7055 | } | |
7056 | } | |
7057 | ||
7058 | /* Lookup serdes setting by cable type and attenuation */ | |
7059 | if (!override && QSFP_IS_ACTIVE(qd->tech)) { | |
7060 | *sdr_dds = txdds_sdr + ppd->dd->board_atten; | |
7061 | *ddr_dds = txdds_ddr + ppd->dd->board_atten; | |
7062 | *qdr_dds = txdds_qdr + ppd->dd->board_atten; | |
7063 | return; | |
7064 | } | |
7065 | ||
7066 | if (!override && QSFP_HAS_ATTEN(qd->tech) && (qd->atten[0] || | |
7067 | qd->atten[1])) { | |
7068 | *sdr_dds = get_atten_table(txdds_sdr, qd->atten[0]); | |
7069 | *ddr_dds = get_atten_table(txdds_ddr, qd->atten[0]); | |
7070 | *qdr_dds = get_atten_table(txdds_qdr, qd->atten[1]); | |
7071 | return; | |
a77fcf89 | 7072 | } else if (ppd->cpspec->no_eep < TXDDS_TABLE_SZ) { |
f931551b RC |
7073 | /* |
7074 | * If we have no (or incomplete) data from the cable | |
a77fcf89 RC |
7075 | * EEPROM, or no QSFP, or override is set, use the |
7076 | * module parameter value to index into the attentuation | |
7077 | * table. | |
f931551b | 7078 | */ |
a77fcf89 RC |
7079 | idx = ppd->cpspec->no_eep; |
7080 | *sdr_dds = &txdds_sdr[idx]; | |
7081 | *ddr_dds = &txdds_ddr[idx]; | |
7082 | *qdr_dds = &txdds_qdr[idx]; | |
7083 | } else if (ppd->cpspec->no_eep < (TXDDS_TABLE_SZ + TXDDS_EXTRA_SZ)) { | |
7084 | /* similar to above, but index into the "extra" table. */ | |
7085 | idx = ppd->cpspec->no_eep - TXDDS_TABLE_SZ; | |
7086 | *sdr_dds = &txdds_extra_sdr[idx]; | |
7087 | *ddr_dds = &txdds_extra_ddr[idx]; | |
7088 | *qdr_dds = &txdds_extra_qdr[idx]; | |
7089 | } else { | |
7090 | /* this shouldn't happen, it's range checked */ | |
7091 | *sdr_dds = txdds_sdr + qib_long_atten; | |
7092 | *ddr_dds = txdds_ddr + qib_long_atten; | |
7093 | *qdr_dds = txdds_qdr + qib_long_atten; | |
f931551b RC |
7094 | } |
7095 | } | |
7096 | ||
7097 | static void init_txdds_table(struct qib_pportdata *ppd, int override) | |
7098 | { | |
7099 | const struct txdds_ent *sdr_dds, *ddr_dds, *qdr_dds; | |
7100 | struct txdds_ent *dds; | |
7101 | int idx; | |
7102 | int single_ent = 0; | |
7103 | ||
a77fcf89 RC |
7104 | find_best_ent(ppd, &sdr_dds, &ddr_dds, &qdr_dds, override); |
7105 | ||
7106 | /* for mez cards or override, use the selected value for all entries */ | |
7107 | if (!(ppd->dd->flags & QIB_HAS_QSFP) || override) | |
f931551b | 7108 | single_ent = 1; |
f931551b RC |
7109 | |
7110 | /* Fill in the first entry with the best entry found. */ | |
7111 | set_txdds(ppd, 0, sdr_dds); | |
7112 | set_txdds(ppd, TXDDS_TABLE_SZ, ddr_dds); | |
7113 | set_txdds(ppd, 2 * TXDDS_TABLE_SZ, qdr_dds); | |
a77fcf89 RC |
7114 | if (ppd->lflags & (QIBL_LINKINIT | QIBL_LINKARMED | |
7115 | QIBL_LINKACTIVE)) { | |
7116 | dds = (struct txdds_ent *)(ppd->link_speed_active == | |
7117 | QIB_IB_QDR ? qdr_dds : | |
7118 | (ppd->link_speed_active == | |
7119 | QIB_IB_DDR ? ddr_dds : sdr_dds)); | |
7120 | write_tx_serdes_param(ppd, dds); | |
7121 | } | |
f931551b RC |
7122 | |
7123 | /* Fill in the remaining entries with the default table values. */ | |
7124 | for (idx = 1; idx < ARRAY_SIZE(txdds_sdr); ++idx) { | |
7125 | set_txdds(ppd, idx, single_ent ? sdr_dds : txdds_sdr + idx); | |
7126 | set_txdds(ppd, idx + TXDDS_TABLE_SZ, | |
7127 | single_ent ? ddr_dds : txdds_ddr + idx); | |
7128 | set_txdds(ppd, idx + 2 * TXDDS_TABLE_SZ, | |
7129 | single_ent ? qdr_dds : txdds_qdr + idx); | |
7130 | } | |
7131 | } | |
7132 | ||
7133 | #define KR_AHB_ACC KREG_IDX(ahb_access_ctrl) | |
7134 | #define KR_AHB_TRANS KREG_IDX(ahb_transaction_reg) | |
7135 | #define AHB_TRANS_RDY SYM_MASK(ahb_transaction_reg, ahb_rdy) | |
7136 | #define AHB_ADDR_LSB SYM_LSB(ahb_transaction_reg, ahb_address) | |
7137 | #define AHB_DATA_LSB SYM_LSB(ahb_transaction_reg, ahb_data) | |
7138 | #define AHB_WR SYM_MASK(ahb_transaction_reg, write_not_read) | |
7139 | #define AHB_TRANS_TRIES 10 | |
7140 | ||
7141 | /* | |
7142 | * The chan argument is 0=chan0, 1=chan1, 2=pll, 3=chan2, 4=chan4, | |
7143 | * 5=subsystem which is why most calls have "chan + chan >> 1" | |
7144 | * for the channel argument. | |
7145 | */ | |
7146 | static u32 ahb_mod(struct qib_devdata *dd, int quad, int chan, int addr, | |
7147 | u32 data, u32 mask) | |
7148 | { | |
7149 | u32 rd_data, wr_data, sz_mask; | |
7150 | u64 trans, acc, prev_acc; | |
7151 | u32 ret = 0xBAD0BAD; | |
7152 | int tries; | |
7153 | ||
7154 | prev_acc = qib_read_kreg64(dd, KR_AHB_ACC); | |
7155 | /* From this point on, make sure we return access */ | |
7156 | acc = (quad << 1) | 1; | |
7157 | qib_write_kreg(dd, KR_AHB_ACC, acc); | |
7158 | ||
7159 | for (tries = 1; tries < AHB_TRANS_TRIES; ++tries) { | |
7160 | trans = qib_read_kreg64(dd, KR_AHB_TRANS); | |
7161 | if (trans & AHB_TRANS_RDY) | |
7162 | break; | |
7163 | } | |
7164 | if (tries >= AHB_TRANS_TRIES) { | |
7165 | qib_dev_err(dd, "No ahb_rdy in %d tries\n", AHB_TRANS_TRIES); | |
7166 | goto bail; | |
7167 | } | |
7168 | ||
7169 | /* If mask is not all 1s, we need to read, but different SerDes | |
7170 | * entities have different sizes | |
7171 | */ | |
7172 | sz_mask = (1UL << ((quad == 1) ? 32 : 16)) - 1; | |
7173 | wr_data = data & mask & sz_mask; | |
7174 | if ((~mask & sz_mask) != 0) { | |
7175 | trans = ((chan << 6) | addr) << (AHB_ADDR_LSB + 1); | |
7176 | qib_write_kreg(dd, KR_AHB_TRANS, trans); | |
7177 | ||
7178 | for (tries = 1; tries < AHB_TRANS_TRIES; ++tries) { | |
7179 | trans = qib_read_kreg64(dd, KR_AHB_TRANS); | |
7180 | if (trans & AHB_TRANS_RDY) | |
7181 | break; | |
7182 | } | |
7183 | if (tries >= AHB_TRANS_TRIES) { | |
7184 | qib_dev_err(dd, "No Rd ahb_rdy in %d tries\n", | |
7185 | AHB_TRANS_TRIES); | |
7186 | goto bail; | |
7187 | } | |
7188 | /* Re-read in case host split reads and read data first */ | |
7189 | trans = qib_read_kreg64(dd, KR_AHB_TRANS); | |
7190 | rd_data = (uint32_t)(trans >> AHB_DATA_LSB); | |
7191 | wr_data |= (rd_data & ~mask & sz_mask); | |
7192 | } | |
7193 | ||
7194 | /* If mask is not zero, we need to write. */ | |
7195 | if (mask & sz_mask) { | |
7196 | trans = ((chan << 6) | addr) << (AHB_ADDR_LSB + 1); | |
7197 | trans |= ((uint64_t)wr_data << AHB_DATA_LSB); | |
7198 | trans |= AHB_WR; | |
7199 | qib_write_kreg(dd, KR_AHB_TRANS, trans); | |
7200 | ||
7201 | for (tries = 1; tries < AHB_TRANS_TRIES; ++tries) { | |
7202 | trans = qib_read_kreg64(dd, KR_AHB_TRANS); | |
7203 | if (trans & AHB_TRANS_RDY) | |
7204 | break; | |
7205 | } | |
7206 | if (tries >= AHB_TRANS_TRIES) { | |
7207 | qib_dev_err(dd, "No Wr ahb_rdy in %d tries\n", | |
7208 | AHB_TRANS_TRIES); | |
7209 | goto bail; | |
7210 | } | |
7211 | } | |
7212 | ret = wr_data; | |
7213 | bail: | |
7214 | qib_write_kreg(dd, KR_AHB_ACC, prev_acc); | |
7215 | return ret; | |
7216 | } | |
7217 | ||
7218 | static void ibsd_wr_allchans(struct qib_pportdata *ppd, int addr, unsigned data, | |
7219 | unsigned mask) | |
7220 | { | |
7221 | struct qib_devdata *dd = ppd->dd; | |
7222 | int chan; | |
7223 | u32 rbc; | |
7224 | ||
7225 | for (chan = 0; chan < SERDES_CHANS; ++chan) { | |
7226 | ahb_mod(dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), addr, | |
7227 | data, mask); | |
7228 | rbc = ahb_mod(dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7229 | addr, 0, 0); | |
7230 | } | |
7231 | } | |
7232 | ||
7233 | static int serdes_7322_init(struct qib_pportdata *ppd) | |
7234 | { | |
7235 | u64 data; | |
7236 | u32 le_val; | |
7237 | ||
7238 | /* | |
7239 | * Initialize the Tx DDS tables. Also done every QSFP event, | |
7240 | * for adapters with QSFP | |
7241 | */ | |
7242 | init_txdds_table(ppd, 0); | |
7243 | ||
a77fcf89 RC |
7244 | /* ensure no tx overrides from earlier driver loads */ |
7245 | qib_write_kreg_port(ppd, krp_tx_deemph_override, | |
7246 | SYM_MASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7247 | reset_tx_deemphasis_override)); | |
7248 | ||
f931551b RC |
7249 | /* Patch some SerDes defaults to "Better for IB" */ |
7250 | /* Timing Loop Bandwidth: cdr_timing[11:9] = 0 */ | |
7251 | ibsd_wr_allchans(ppd, 2, 0, BMASK(11, 9)); | |
7252 | ||
7253 | /* Termination: rxtermctrl_r2d addr 11 bits [12:11] = 1 */ | |
7254 | ibsd_wr_allchans(ppd, 11, (1 << 11), BMASK(12, 11)); | |
7255 | /* Enable LE2: rxle2en_r2a addr 13 bit [6] = 1 */ | |
7256 | ibsd_wr_allchans(ppd, 13, (1 << 6), (1 << 6)); | |
7257 | ||
7258 | /* May be overridden in qsfp_7322_event */ | |
7259 | le_val = IS_QME(ppd->dd) ? LE2_QME : LE2_DEFAULT; | |
7260 | ibsd_wr_allchans(ppd, 13, (le_val << 7), BMASK(9, 7)); | |
7261 | ||
7262 | /* enable LE1 adaptation for all but QME, which is disabled */ | |
7263 | le_val = IS_QME(ppd->dd) ? 0 : 1; | |
7264 | ibsd_wr_allchans(ppd, 13, (le_val << 5), (1 << 5)); | |
7265 | ||
7266 | /* Clear cmode-override, may be set from older driver */ | |
7267 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 10, 0 << 14, 1 << 14); | |
7268 | ||
7269 | /* Timing Recovery: rxtapsel addr 5 bits [9:8] = 0 */ | |
7270 | ibsd_wr_allchans(ppd, 5, (0 << 8), BMASK(9, 8)); | |
7271 | ||
7272 | /* setup LoS params; these are subsystem, so chan == 5 */ | |
7273 | /* LoS filter threshold_count on, ch 0-3, set to 8 */ | |
7274 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 5, 8 << 11, BMASK(14, 11)); | |
7275 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 7, 8 << 4, BMASK(7, 4)); | |
7276 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 8, 8 << 11, BMASK(14, 11)); | |
7277 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 10, 8 << 4, BMASK(7, 4)); | |
7278 | ||
7279 | /* LoS filter threshold_count off, ch 0-3, set to 4 */ | |
7280 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 6, 4 << 0, BMASK(3, 0)); | |
7281 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 7, 4 << 8, BMASK(11, 8)); | |
7282 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 9, 4 << 0, BMASK(3, 0)); | |
7283 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 10, 4 << 8, BMASK(11, 8)); | |
7284 | ||
7285 | /* LoS filter select enabled */ | |
7286 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), 5, 9, 1 << 15, 1 << 15); | |
7287 | ||
7288 | /* LoS target data: SDR=4, DDR=2, QDR=1 */ | |
7289 | ibsd_wr_allchans(ppd, 14, (1 << 3), BMASK(5, 3)); /* QDR */ | |
7290 | ibsd_wr_allchans(ppd, 20, (2 << 10), BMASK(12, 10)); /* DDR */ | |
7291 | ibsd_wr_allchans(ppd, 20, (4 << 13), BMASK(15, 13)); /* SDR */ | |
7292 | ||
7293 | data = qib_read_kreg_port(ppd, krp_serdesctrl); | |
7294 | qib_write_kreg_port(ppd, krp_serdesctrl, data | | |
7295 | SYM_MASK(IBSerdesCtrl_0, RXLOSEN)); | |
7296 | ||
7297 | /* rxbistena; set 0 to avoid effects of it switch later */ | |
7298 | ibsd_wr_allchans(ppd, 9, 0 << 15, 1 << 15); | |
7299 | ||
7300 | /* Configure 4 DFE taps, and only they adapt */ | |
7301 | ibsd_wr_allchans(ppd, 16, 0 << 0, BMASK(1, 0)); | |
7302 | ||
7303 | /* gain hi stop 32 (22) (6:1) lo stop 7 (10:7) target 22 (13) (15:11) */ | |
7304 | le_val = (ppd->dd->cspec->r1 || IS_QME(ppd->dd)) ? 0xb6c0 : 0x6bac; | |
7305 | ibsd_wr_allchans(ppd, 21, le_val, 0xfffe); | |
7306 | ||
7307 | /* | |
7308 | * Set receive adaptation mode. SDR and DDR adaptation are | |
7309 | * always on, and QDR is initially enabled; later disabled. | |
7310 | */ | |
7311 | qib_write_kreg_port(ppd, krp_static_adapt_dis(0), 0ULL); | |
7312 | qib_write_kreg_port(ppd, krp_static_adapt_dis(1), 0ULL); | |
7313 | qib_write_kreg_port(ppd, krp_static_adapt_dis(2), | |
7314 | ppd->dd->cspec->r1 ? | |
7315 | QDR_STATIC_ADAPT_DOWN_R1 : QDR_STATIC_ADAPT_DOWN); | |
7316 | ppd->cpspec->qdr_dfe_on = 1; | |
7317 | ||
a77fcf89 | 7318 | /* FLoop LOS gate: PPM filter enabled */ |
f931551b RC |
7319 | ibsd_wr_allchans(ppd, 38, 0 << 10, 1 << 10); |
7320 | ||
7321 | /* rx offset center enabled */ | |
7322 | ibsd_wr_allchans(ppd, 12, 1 << 4, 1 << 4); | |
7323 | ||
7324 | if (!ppd->dd->cspec->r1) { | |
7325 | ibsd_wr_allchans(ppd, 12, 1 << 12, 1 << 12); | |
7326 | ibsd_wr_allchans(ppd, 12, 2 << 8, 0x0f << 8); | |
7327 | } | |
7328 | ||
7329 | /* Set the frequency loop bandwidth to 15 */ | |
7330 | ibsd_wr_allchans(ppd, 2, 15 << 5, BMASK(8, 5)); | |
7331 | ||
7332 | return 0; | |
7333 | } | |
7334 | ||
7335 | /* start adjust QMH serdes parameters */ | |
7336 | ||
7337 | static void set_man_code(struct qib_pportdata *ppd, int chan, int code) | |
7338 | { | |
7339 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7340 | 9, code << 9, 0x3f << 9); | |
7341 | } | |
7342 | ||
7343 | static void set_man_mode_h1(struct qib_pportdata *ppd, int chan, | |
7344 | int enable, u32 tapenable) | |
7345 | { | |
7346 | if (enable) | |
7347 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7348 | 1, 3 << 10, 0x1f << 10); | |
7349 | else | |
7350 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7351 | 1, 0, 0x1f << 10); | |
7352 | } | |
7353 | ||
7354 | /* Set clock to 1, 0, 1, 0 */ | |
7355 | static void clock_man(struct qib_pportdata *ppd, int chan) | |
7356 | { | |
7357 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7358 | 4, 0x4000, 0x4000); | |
7359 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7360 | 4, 0, 0x4000); | |
7361 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7362 | 4, 0x4000, 0x4000); | |
7363 | ahb_mod(ppd->dd, IBSD(ppd->hw_pidx), (chan + (chan >> 1)), | |
7364 | 4, 0, 0x4000); | |
7365 | } | |
7366 | ||
7367 | /* | |
7368 | * write the current Tx serdes pre,post,main,amp settings into the serdes. | |
7369 | * The caller must pass the settings appropriate for the current speed, | |
7370 | * or not care if they are correct for the current speed. | |
7371 | */ | |
7372 | static void write_tx_serdes_param(struct qib_pportdata *ppd, | |
7373 | struct txdds_ent *txdds) | |
7374 | { | |
7375 | u64 deemph; | |
7376 | ||
7377 | deemph = qib_read_kreg_port(ppd, krp_tx_deemph_override); | |
7378 | /* field names for amp, main, post, pre, respectively */ | |
7379 | deemph &= ~(SYM_MASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, txampcntl_d2a) | | |
7380 | SYM_MASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, txc0_ena) | | |
7381 | SYM_MASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, txcp1_ena) | | |
7382 | SYM_MASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, txcn1_ena)); | |
a77fcf89 RC |
7383 | |
7384 | deemph |= SYM_MASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7385 | tx_override_deemphasis_select); | |
7386 | deemph |= (txdds->amp & SYM_RMASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7387 | txampcntl_d2a)) << SYM_LSB(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7388 | txampcntl_d2a); | |
7389 | deemph |= (txdds->main & SYM_RMASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7390 | txc0_ena)) << SYM_LSB(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7391 | txc0_ena); | |
7392 | deemph |= (txdds->post & SYM_RMASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7393 | txcp1_ena)) << SYM_LSB(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7394 | txcp1_ena); | |
7395 | deemph |= (txdds->pre & SYM_RMASK(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
7396 | txcn1_ena)) << SYM_LSB(IBSD_TX_DEEMPHASIS_OVERRIDE_0, | |
f931551b RC |
7397 | txcn1_ena); |
7398 | qib_write_kreg_port(ppd, krp_tx_deemph_override, deemph); | |
7399 | } | |
7400 | ||
7401 | /* | |
a77fcf89 RC |
7402 | * Set the parameters for mez cards on link bounce, so they are |
7403 | * always exactly what was requested. Similar logic to init_txdds | |
7404 | * but does just the serdes. | |
f931551b RC |
7405 | */ |
7406 | static void adj_tx_serdes(struct qib_pportdata *ppd) | |
7407 | { | |
a77fcf89 RC |
7408 | const struct txdds_ent *sdr_dds, *ddr_dds, *qdr_dds; |
7409 | struct txdds_ent *dds; | |
f931551b | 7410 | |
a77fcf89 RC |
7411 | find_best_ent(ppd, &sdr_dds, &ddr_dds, &qdr_dds, 1); |
7412 | dds = (struct txdds_ent *)(ppd->link_speed_active == QIB_IB_QDR ? | |
7413 | qdr_dds : (ppd->link_speed_active == QIB_IB_DDR ? | |
7414 | ddr_dds : sdr_dds)); | |
7415 | write_tx_serdes_param(ppd, dds); | |
f931551b RC |
7416 | } |
7417 | ||
7418 | /* set QDR forced value for H1, if needed */ | |
7419 | static void force_h1(struct qib_pportdata *ppd) | |
7420 | { | |
7421 | int chan; | |
7422 | ||
7423 | ppd->cpspec->qdr_reforce = 0; | |
7424 | if (!ppd->dd->cspec->r1) | |
7425 | return; | |
7426 | ||
7427 | for (chan = 0; chan < SERDES_CHANS; chan++) { | |
7428 | set_man_mode_h1(ppd, chan, 1, 0); | |
7429 | set_man_code(ppd, chan, ppd->cpspec->h1_val); | |
7430 | clock_man(ppd, chan); | |
7431 | set_man_mode_h1(ppd, chan, 0, 0); | |
7432 | } | |
7433 | } | |
7434 | ||
f931551b RC |
7435 | #define SJA_EN SYM_MASK(SPC_JTAG_ACCESS_REG, SPC_JTAG_ACCESS_EN) |
7436 | #define BISTEN_LSB SYM_LSB(SPC_JTAG_ACCESS_REG, bist_en) | |
7437 | ||
7438 | #define R_OPCODE_LSB 3 | |
7439 | #define R_OP_NOP 0 | |
7440 | #define R_OP_SHIFT 2 | |
7441 | #define R_OP_UPDATE 3 | |
7442 | #define R_TDI_LSB 2 | |
7443 | #define R_TDO_LSB 1 | |
7444 | #define R_RDY 1 | |
7445 | ||
7446 | static int qib_r_grab(struct qib_devdata *dd) | |
7447 | { | |
7448 | u64 val; | |
7449 | val = SJA_EN; | |
7450 | qib_write_kreg(dd, kr_r_access, val); | |
7451 | qib_read_kreg32(dd, kr_scratch); | |
7452 | return 0; | |
7453 | } | |
7454 | ||
7455 | /* qib_r_wait_for_rdy() not only waits for the ready bit, it | |
7456 | * returns the current state of R_TDO | |
7457 | */ | |
7458 | static int qib_r_wait_for_rdy(struct qib_devdata *dd) | |
7459 | { | |
7460 | u64 val; | |
7461 | int timeout; | |
7462 | for (timeout = 0; timeout < 100 ; ++timeout) { | |
7463 | val = qib_read_kreg32(dd, kr_r_access); | |
7464 | if (val & R_RDY) | |
7465 | return (val >> R_TDO_LSB) & 1; | |
7466 | } | |
7467 | return -1; | |
7468 | } | |
7469 | ||
7470 | static int qib_r_shift(struct qib_devdata *dd, int bisten, | |
7471 | int len, u8 *inp, u8 *outp) | |
7472 | { | |
7473 | u64 valbase, val; | |
7474 | int ret, pos; | |
7475 | ||
7476 | valbase = SJA_EN | (bisten << BISTEN_LSB) | | |
7477 | (R_OP_SHIFT << R_OPCODE_LSB); | |
7478 | ret = qib_r_wait_for_rdy(dd); | |
7479 | if (ret < 0) | |
7480 | goto bail; | |
7481 | for (pos = 0; pos < len; ++pos) { | |
7482 | val = valbase; | |
7483 | if (outp) { | |
7484 | outp[pos >> 3] &= ~(1 << (pos & 7)); | |
7485 | outp[pos >> 3] |= (ret << (pos & 7)); | |
7486 | } | |
7487 | if (inp) { | |
7488 | int tdi = inp[pos >> 3] >> (pos & 7); | |
7489 | val |= ((tdi & 1) << R_TDI_LSB); | |
7490 | } | |
7491 | qib_write_kreg(dd, kr_r_access, val); | |
7492 | qib_read_kreg32(dd, kr_scratch); | |
7493 | ret = qib_r_wait_for_rdy(dd); | |
7494 | if (ret < 0) | |
7495 | break; | |
7496 | } | |
7497 | /* Restore to NOP between operations. */ | |
7498 | val = SJA_EN | (bisten << BISTEN_LSB); | |
7499 | qib_write_kreg(dd, kr_r_access, val); | |
7500 | qib_read_kreg32(dd, kr_scratch); | |
7501 | ret = qib_r_wait_for_rdy(dd); | |
7502 | ||
7503 | if (ret >= 0) | |
7504 | ret = pos; | |
7505 | bail: | |
7506 | return ret; | |
7507 | } | |
7508 | ||
7509 | static int qib_r_update(struct qib_devdata *dd, int bisten) | |
7510 | { | |
7511 | u64 val; | |
7512 | int ret; | |
7513 | ||
7514 | val = SJA_EN | (bisten << BISTEN_LSB) | (R_OP_UPDATE << R_OPCODE_LSB); | |
7515 | ret = qib_r_wait_for_rdy(dd); | |
7516 | if (ret >= 0) { | |
7517 | qib_write_kreg(dd, kr_r_access, val); | |
7518 | qib_read_kreg32(dd, kr_scratch); | |
7519 | } | |
7520 | return ret; | |
7521 | } | |
7522 | ||
7523 | #define BISTEN_PORT_SEL 15 | |
7524 | #define LEN_PORT_SEL 625 | |
7525 | #define BISTEN_AT 17 | |
7526 | #define LEN_AT 156 | |
7527 | #define BISTEN_ETM 16 | |
7528 | #define LEN_ETM 632 | |
7529 | ||
7530 | #define BIT2BYTE(x) (((x) + BITS_PER_BYTE - 1) / BITS_PER_BYTE) | |
7531 | ||
7532 | /* these are common for all IB port use cases. */ | |
7533 | static u8 reset_at[BIT2BYTE(LEN_AT)] = { | |
7534 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7535 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x00, | |
7536 | }; | |
7537 | static u8 reset_atetm[BIT2BYTE(LEN_ETM)] = { | |
7538 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7539 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7540 | 0x00, 0x00, 0x00, 0x80, 0xe3, 0x81, 0x73, 0x3c, 0x70, 0x8e, | |
7541 | 0x07, 0xce, 0xf1, 0xc0, 0x39, 0x1e, 0x38, 0xc7, 0x03, 0xe7, | |
7542 | 0x78, 0xe0, 0x1c, 0x0f, 0x9c, 0x7f, 0x80, 0x73, 0x0f, 0x70, | |
7543 | 0xde, 0x01, 0xce, 0x39, 0xc0, 0xf9, 0x06, 0x38, 0xd7, 0x00, | |
7544 | 0xe7, 0x19, 0xe0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7545 | 0x00, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, | |
7546 | }; | |
7547 | static u8 at[BIT2BYTE(LEN_AT)] = { | |
7548 | 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, | |
7549 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x00, | |
7550 | }; | |
7551 | ||
7552 | /* used for IB1 or IB2, only one in use */ | |
7553 | static u8 atetm_1port[BIT2BYTE(LEN_ETM)] = { | |
7554 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7555 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7556 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7557 | 0x00, 0x10, 0xf2, 0x80, 0x83, 0x1e, 0x38, 0x00, 0x00, 0x00, | |
7558 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7559 | 0x00, 0x00, 0x50, 0xf4, 0x41, 0x00, 0x18, 0x78, 0xc8, 0x03, | |
7560 | 0x07, 0x7b, 0xa0, 0x3e, 0x00, 0x02, 0x00, 0x00, 0x18, 0x00, | |
7561 | 0x18, 0x00, 0x00, 0x00, 0x00, 0x4b, 0x00, 0x00, 0x00, | |
7562 | }; | |
7563 | ||
7564 | /* used when both IB1 and IB2 are in use */ | |
7565 | static u8 atetm_2port[BIT2BYTE(LEN_ETM)] = { | |
7566 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7567 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x79, | |
7568 | 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7569 | 0x00, 0x00, 0xf8, 0x80, 0x83, 0x1e, 0x38, 0xe0, 0x03, 0x05, | |
7570 | 0x7b, 0xa0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, | |
7571 | 0xa2, 0x0f, 0x50, 0xf4, 0x41, 0x00, 0x18, 0x78, 0xd1, 0x07, | |
7572 | 0x02, 0x7c, 0x80, 0x3e, 0x00, 0x02, 0x00, 0x00, 0x3e, 0x00, | |
7573 | 0x02, 0x00, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, 0x00, | |
7574 | }; | |
7575 | ||
7576 | /* used when only IB1 is in use */ | |
7577 | static u8 portsel_port1[BIT2BYTE(LEN_PORT_SEL)] = { | |
7578 | 0x32, 0x65, 0xa4, 0x7b, 0x10, 0x98, 0xdc, 0xfe, 0x13, 0x13, | |
7579 | 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x73, 0x0c, 0x0c, 0x0c, | |
7580 | 0x0c, 0x0c, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, | |
7581 | 0x13, 0x78, 0x78, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, | |
7582 | 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x74, 0x32, | |
7583 | 0x32, 0x32, 0x32, 0x32, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, | |
7584 | 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, | |
7585 | 0x14, 0x14, 0x9f, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7586 | }; | |
7587 | ||
7588 | /* used when only IB2 is in use */ | |
7589 | static u8 portsel_port2[BIT2BYTE(LEN_PORT_SEL)] = { | |
7590 | 0x32, 0x65, 0xa4, 0x7b, 0x10, 0x98, 0xdc, 0xfe, 0x39, 0x39, | |
7591 | 0x39, 0x39, 0x39, 0x39, 0x39, 0x39, 0x73, 0x32, 0x32, 0x32, | |
7592 | 0x32, 0x32, 0x39, 0x39, 0x39, 0x39, 0x39, 0x39, 0x39, 0x39, | |
7593 | 0x39, 0x78, 0x78, 0x39, 0x39, 0x39, 0x39, 0x39, 0x39, 0x39, | |
7594 | 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x74, 0x32, | |
7595 | 0x32, 0x32, 0x32, 0x32, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, | |
7596 | 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, 0x3a, | |
7597 | 0x3a, 0x3a, 0x9f, 0x01, 0x00, 0x00, 0x00, 0x00, 0x01, | |
7598 | }; | |
7599 | ||
7600 | /* used when both IB1 and IB2 are in use */ | |
7601 | static u8 portsel_2port[BIT2BYTE(LEN_PORT_SEL)] = { | |
7602 | 0x32, 0xba, 0x54, 0x76, 0x10, 0x98, 0xdc, 0xfe, 0x13, 0x13, | |
7603 | 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x73, 0x0c, 0x0c, 0x0c, | |
7604 | 0x0c, 0x0c, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, | |
7605 | 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, 0x13, | |
7606 | 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x74, 0x32, | |
7607 | 0x32, 0x32, 0x32, 0x32, 0x14, 0x14, 0x14, 0x14, 0x14, 0x3a, | |
7608 | 0x3a, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, | |
7609 | 0x14, 0x14, 0x9f, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, | |
7610 | }; | |
7611 | ||
7612 | /* | |
7613 | * Do setup to properly handle IB link recovery; if port is zero, we | |
7614 | * are initializing to cover both ports; otherwise we are initializing | |
7615 | * to cover a single port card, or the port has reached INIT and we may | |
7616 | * need to switch coverage types. | |
7617 | */ | |
7618 | static void setup_7322_link_recovery(struct qib_pportdata *ppd, u32 both) | |
7619 | { | |
7620 | u8 *portsel, *etm; | |
7621 | struct qib_devdata *dd = ppd->dd; | |
7622 | ||
7623 | if (!ppd->dd->cspec->r1) | |
7624 | return; | |
7625 | if (!both) { | |
7626 | dd->cspec->recovery_ports_initted++; | |
7627 | ppd->cpspec->recovery_init = 1; | |
7628 | } | |
7629 | if (!both && dd->cspec->recovery_ports_initted == 1) { | |
7630 | portsel = ppd->port == 1 ? portsel_port1 : portsel_port2; | |
7631 | etm = atetm_1port; | |
7632 | } else { | |
7633 | portsel = portsel_2port; | |
7634 | etm = atetm_2port; | |
7635 | } | |
7636 | ||
7637 | if (qib_r_grab(dd) < 0 || | |
7638 | qib_r_shift(dd, BISTEN_ETM, LEN_ETM, reset_atetm, NULL) < 0 || | |
7639 | qib_r_update(dd, BISTEN_ETM) < 0 || | |
7640 | qib_r_shift(dd, BISTEN_AT, LEN_AT, reset_at, NULL) < 0 || | |
7641 | qib_r_update(dd, BISTEN_AT) < 0 || | |
7642 | qib_r_shift(dd, BISTEN_PORT_SEL, LEN_PORT_SEL, | |
7643 | portsel, NULL) < 0 || | |
7644 | qib_r_update(dd, BISTEN_PORT_SEL) < 0 || | |
7645 | qib_r_shift(dd, BISTEN_AT, LEN_AT, at, NULL) < 0 || | |
7646 | qib_r_update(dd, BISTEN_AT) < 0 || | |
7647 | qib_r_shift(dd, BISTEN_ETM, LEN_ETM, etm, NULL) < 0 || | |
7648 | qib_r_update(dd, BISTEN_ETM) < 0) | |
7649 | qib_dev_err(dd, "Failed IB link recovery setup\n"); | |
7650 | } | |
7651 | ||
7652 | static void check_7322_rxe_status(struct qib_pportdata *ppd) | |
7653 | { | |
7654 | struct qib_devdata *dd = ppd->dd; | |
7655 | u64 fmask; | |
7656 | ||
7657 | if (dd->cspec->recovery_ports_initted != 1) | |
7658 | return; /* rest doesn't apply to dualport */ | |
7659 | qib_write_kreg(dd, kr_control, dd->control | | |
7660 | SYM_MASK(Control, FreezeMode)); | |
7661 | (void)qib_read_kreg64(dd, kr_scratch); | |
7662 | udelay(3); /* ibcreset asserted 400ns, be sure that's over */ | |
7663 | fmask = qib_read_kreg64(dd, kr_act_fmask); | |
7664 | if (!fmask) { | |
7665 | /* | |
7666 | * require a powercycle before we'll work again, and make | |
7667 | * sure we get no more interrupts, and don't turn off | |
7668 | * freeze. | |
7669 | */ | |
7670 | ppd->dd->cspec->stay_in_freeze = 1; | |
7671 | qib_7322_set_intr_state(ppd->dd, 0); | |
7672 | qib_write_kreg(dd, kr_fmask, 0ULL); | |
7673 | qib_dev_err(dd, "HCA unusable until powercycled\n"); | |
7674 | return; /* eventually reset */ | |
7675 | } | |
7676 | ||
7677 | qib_write_kreg(ppd->dd, kr_hwerrclear, | |
7678 | SYM_MASK(HwErrClear, IBSerdesPClkNotDetectClear_1)); | |
7679 | ||
7680 | /* don't do the full clear_freeze(), not needed for this */ | |
7681 | qib_write_kreg(dd, kr_control, dd->control); | |
7682 | qib_read_kreg32(dd, kr_scratch); | |
7683 | /* take IBC out of reset */ | |
7684 | if (ppd->link_speed_supported) { | |
7685 | ppd->cpspec->ibcctrl_a &= | |
7686 | ~SYM_MASK(IBCCtrlA_0, IBStatIntReductionEn); | |
7687 | qib_write_kreg_port(ppd, krp_ibcctrl_a, | |
7688 | ppd->cpspec->ibcctrl_a); | |
7689 | qib_read_kreg32(dd, kr_scratch); | |
7690 | if (ppd->lflags & QIBL_IB_LINK_DISABLED) | |
7691 | qib_set_ib_7322_lstate(ppd, 0, | |
7692 | QLOGIC_IB_IBCC_LINKINITCMD_DISABLE); | |
7693 | } | |
7694 | } |