Loading...
1// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
2/* QLogic qed NIC Driver
3 * Copyright (c) 2015-2017 QLogic Corporation
4 * Copyright (c) 2019-2020 Marvell International Ltd.
5 */
6
7#include <linux/types.h>
8#include <linux/io.h>
9#include <linux/delay.h>
10#include <linux/errno.h>
11#include <linux/kernel.h>
12#include <linux/slab.h>
13#include <linux/string.h>
14#include "qed.h"
15#include "qed_hsi.h"
16#include "qed_hw.h"
17#include "qed_init_ops.h"
18#include "qed_iro_hsi.h"
19#include "qed_reg_addr.h"
20#include "qed_sriov.h"
21
22#define QED_INIT_MAX_POLL_COUNT 100
23#define QED_INIT_POLL_PERIOD_US 500
24
25static u32 pxp_global_win[] = {
26 0,
27 0,
28 0x1c02, /* win 2: addr=0x1c02000, size=4096 bytes */
29 0x1c80, /* win 3: addr=0x1c80000, size=4096 bytes */
30 0x1d00, /* win 4: addr=0x1d00000, size=4096 bytes */
31 0x1d01, /* win 5: addr=0x1d01000, size=4096 bytes */
32 0x1d02, /* win 6: addr=0x1d02000, size=4096 bytes */
33 0x1d80, /* win 7: addr=0x1d80000, size=4096 bytes */
34 0x1d81, /* win 8: addr=0x1d81000, size=4096 bytes */
35 0x1d82, /* win 9: addr=0x1d82000, size=4096 bytes */
36 0x1e00, /* win 10: addr=0x1e00000, size=4096 bytes */
37 0x1e01, /* win 11: addr=0x1e01000, size=4096 bytes */
38 0x1e80, /* win 12: addr=0x1e80000, size=4096 bytes */
39 0x1f00, /* win 13: addr=0x1f00000, size=4096 bytes */
40 0x1c08, /* win 14: addr=0x1c08000, size=4096 bytes */
41 0,
42 0,
43 0,
44 0,
45};
46
47/* IRO Array */
48static const u32 iro_arr[] = {
49 0x00000000, 0x00000000, 0x00080000,
50 0x00004478, 0x00000008, 0x00080000,
51 0x00003288, 0x00000088, 0x00880000,
52 0x000058a8, 0x00000020, 0x00200000,
53 0x00003188, 0x00000008, 0x00080000,
54 0x00000b00, 0x00000008, 0x00040000,
55 0x00000a80, 0x00000008, 0x00040000,
56 0x00000000, 0x00000008, 0x00020000,
57 0x00000080, 0x00000008, 0x00040000,
58 0x00000084, 0x00000008, 0x00020000,
59 0x00005798, 0x00000004, 0x00040000,
60 0x00004e50, 0x00000000, 0x00780000,
61 0x00003e40, 0x00000000, 0x00780000,
62 0x00004500, 0x00000000, 0x00780000,
63 0x00003210, 0x00000000, 0x00780000,
64 0x00003b50, 0x00000000, 0x00780000,
65 0x00007f58, 0x00000000, 0x00780000,
66 0x00005fd8, 0x00000000, 0x00080000,
67 0x00007100, 0x00000000, 0x00080000,
68 0x0000af20, 0x00000000, 0x00080000,
69 0x00004398, 0x00000000, 0x00080000,
70 0x0000a5a0, 0x00000000, 0x00080000,
71 0x0000bde8, 0x00000000, 0x00080000,
72 0x00000020, 0x00000004, 0x00040000,
73 0x00005688, 0x00000010, 0x00100000,
74 0x0000c210, 0x00000030, 0x00300000,
75 0x0000b108, 0x00000038, 0x00380000,
76 0x00003d20, 0x00000080, 0x00400000,
77 0x0000bf60, 0x00000000, 0x00040000,
78 0x00004560, 0x00040080, 0x00040000,
79 0x000001f8, 0x00000004, 0x00040000,
80 0x00003d60, 0x00000080, 0x00200000,
81 0x00008960, 0x00000040, 0x00300000,
82 0x0000e840, 0x00000060, 0x00600000,
83 0x00004698, 0x00000080, 0x00380000,
84 0x000107b8, 0x000000c0, 0x00c00000,
85 0x000001f8, 0x00000002, 0x00020000,
86 0x0000a260, 0x00000000, 0x01080000,
87 0x0000a368, 0x00000008, 0x00080000,
88 0x000001c0, 0x00000008, 0x00080000,
89 0x000001f8, 0x00000008, 0x00080000,
90 0x00000ac0, 0x00000008, 0x00080000,
91 0x00002578, 0x00000008, 0x00080000,
92 0x000024f8, 0x00000008, 0x00080000,
93 0x00000280, 0x00000008, 0x00080000,
94 0x00000680, 0x00080018, 0x00080000,
95 0x00000b78, 0x00080018, 0x00020000,
96 0x0000c600, 0x00000058, 0x003c0000,
97 0x00012038, 0x00000020, 0x00100000,
98 0x00011b00, 0x00000048, 0x00180000,
99 0x00009650, 0x00000050, 0x00200000,
100 0x00008b10, 0x00000040, 0x00280000,
101 0x000116c0, 0x00000018, 0x00100000,
102 0x0000c808, 0x00000048, 0x00380000,
103 0x00011790, 0x00000020, 0x00200000,
104 0x000046d0, 0x00000080, 0x00100000,
105 0x00003618, 0x00000010, 0x00100000,
106 0x0000a9e8, 0x00000008, 0x00010000,
107 0x000097a0, 0x00000008, 0x00010000,
108 0x00011a10, 0x00000008, 0x00010000,
109 0x0000e9f8, 0x00000008, 0x00010000,
110 0x00012648, 0x00000008, 0x00010000,
111 0x000121c8, 0x00000008, 0x00010000,
112 0x0000af08, 0x00000030, 0x00100000,
113 0x0000d748, 0x00000028, 0x00280000,
114 0x00009e68, 0x00000018, 0x00180000,
115 0x00009fe8, 0x00000008, 0x00080000,
116 0x00013ea8, 0x00000008, 0x00080000,
117 0x00012f18, 0x00000018, 0x00180000,
118 0x0000dfe8, 0x00500288, 0x00100000,
119 0x000131a0, 0x00000138, 0x00280000,
120};
121
122void qed_init_iro_array(struct qed_dev *cdev)
123{
124 cdev->iro_arr = iro_arr + E4_IRO_ARR_OFFSET;
125}
126
127void qed_init_store_rt_reg(struct qed_hwfn *p_hwfn, u32 rt_offset, u32 val)
128{
129 if (rt_offset >= RUNTIME_ARRAY_SIZE) {
130 DP_ERR(p_hwfn,
131 "Avoid storing %u in rt_data at index %u!\n",
132 val, rt_offset);
133 return;
134 }
135
136 p_hwfn->rt_data.init_val[rt_offset] = val;
137 p_hwfn->rt_data.b_valid[rt_offset] = true;
138}
139
140void qed_init_store_rt_agg(struct qed_hwfn *p_hwfn,
141 u32 rt_offset, u32 *p_val, size_t size)
142{
143 size_t i;
144
145 if ((rt_offset + size - 1) >= RUNTIME_ARRAY_SIZE) {
146 DP_ERR(p_hwfn,
147 "Avoid storing values in rt_data at indices %u-%u!\n",
148 rt_offset,
149 (u32)(rt_offset + size - 1));
150 return;
151 }
152
153 for (i = 0; i < size / sizeof(u32); i++) {
154 p_hwfn->rt_data.init_val[rt_offset + i] = p_val[i];
155 p_hwfn->rt_data.b_valid[rt_offset + i] = true;
156 }
157}
158
159static int qed_init_rt(struct qed_hwfn *p_hwfn,
160 struct qed_ptt *p_ptt,
161 u32 addr, u16 rt_offset, u16 size, bool b_must_dmae)
162{
163 u32 *p_init_val = &p_hwfn->rt_data.init_val[rt_offset];
164 bool *p_valid = &p_hwfn->rt_data.b_valid[rt_offset];
165 u16 i, j, segment;
166 int rc = 0;
167
168 /* Since not all RT entries are initialized, go over the RT and
169 * for each segment of initialized values use DMA.
170 */
171 for (i = 0; i < size; i++) {
172 if (!p_valid[i])
173 continue;
174
175 /* In case there isn't any wide-bus configuration here,
176 * simply write the data instead of using dmae.
177 */
178 if (!b_must_dmae) {
179 qed_wr(p_hwfn, p_ptt, addr + (i << 2), p_init_val[i]);
180 p_valid[i] = false;
181 continue;
182 }
183
184 /* Start of a new segment */
185 for (segment = 1; i + segment < size; segment++)
186 if (!p_valid[i + segment])
187 break;
188
189 rc = qed_dmae_host2grc(p_hwfn, p_ptt,
190 (uintptr_t)(p_init_val + i),
191 addr + (i << 2), segment, NULL);
192 if (rc)
193 return rc;
194
195 /* invalidate after writing */
196 for (j = i; j < (u32)(i + segment); j++)
197 p_valid[j] = false;
198
199 /* Jump over the entire segment, including invalid entry */
200 i += segment;
201 }
202
203 return rc;
204}
205
206int qed_init_alloc(struct qed_hwfn *p_hwfn)
207{
208 struct qed_rt_data *rt_data = &p_hwfn->rt_data;
209
210 if (IS_VF(p_hwfn->cdev))
211 return 0;
212
213 rt_data->b_valid = kcalloc(RUNTIME_ARRAY_SIZE, sizeof(bool),
214 GFP_KERNEL);
215 if (!rt_data->b_valid)
216 return -ENOMEM;
217
218 rt_data->init_val = kcalloc(RUNTIME_ARRAY_SIZE, sizeof(u32),
219 GFP_KERNEL);
220 if (!rt_data->init_val) {
221 kfree(rt_data->b_valid);
222 rt_data->b_valid = NULL;
223 return -ENOMEM;
224 }
225
226 return 0;
227}
228
229void qed_init_free(struct qed_hwfn *p_hwfn)
230{
231 kfree(p_hwfn->rt_data.init_val);
232 p_hwfn->rt_data.init_val = NULL;
233 kfree(p_hwfn->rt_data.b_valid);
234 p_hwfn->rt_data.b_valid = NULL;
235}
236
237static int qed_init_array_dmae(struct qed_hwfn *p_hwfn,
238 struct qed_ptt *p_ptt,
239 u32 addr,
240 u32 dmae_data_offset,
241 u32 size,
242 const u32 *buf,
243 bool b_must_dmae,
244 bool b_can_dmae)
245{
246 int rc = 0;
247
248 /* Perform DMAE only for lengthy enough sections or for wide-bus */
249 if (!b_can_dmae || (!b_must_dmae && (size < 16))) {
250 const u32 *data = buf + dmae_data_offset;
251 u32 i;
252
253 for (i = 0; i < size; i++)
254 qed_wr(p_hwfn, p_ptt, addr + (i << 2), data[i]);
255 } else {
256 rc = qed_dmae_host2grc(p_hwfn, p_ptt,
257 (uintptr_t)(buf + dmae_data_offset),
258 addr, size, NULL);
259 }
260
261 return rc;
262}
263
264static int qed_init_fill_dmae(struct qed_hwfn *p_hwfn,
265 struct qed_ptt *p_ptt,
266 u32 addr, u32 fill_count)
267{
268 static u32 zero_buffer[DMAE_MAX_RW_SIZE];
269 struct qed_dmae_params params = {};
270
271 memset(zero_buffer, 0, sizeof(u32) * DMAE_MAX_RW_SIZE);
272
273 /* invoke the DMAE virtual/physical buffer API with
274 * 1. DMAE init channel
275 * 2. addr,
276 * 3. p_hwfb->temp_data,
277 * 4. fill_count
278 */
279 SET_FIELD(params.flags, QED_DMAE_PARAMS_RW_REPL_SRC, 0x1);
280 return qed_dmae_host2grc(p_hwfn, p_ptt,
281 (uintptr_t)(&zero_buffer[0]),
282 addr, fill_count, ¶ms);
283}
284
285static void qed_init_fill(struct qed_hwfn *p_hwfn,
286 struct qed_ptt *p_ptt,
287 u32 addr, u32 fill, u32 fill_count)
288{
289 u32 i;
290
291 for (i = 0; i < fill_count; i++, addr += sizeof(u32))
292 qed_wr(p_hwfn, p_ptt, addr, fill);
293}
294
295static int qed_init_cmd_array(struct qed_hwfn *p_hwfn,
296 struct qed_ptt *p_ptt,
297 struct init_write_op *cmd,
298 bool b_must_dmae, bool b_can_dmae)
299{
300 u32 dmae_array_offset = le32_to_cpu(cmd->args.array_offset);
301 u32 data = le32_to_cpu(cmd->data);
302 u32 addr = GET_FIELD(data, INIT_WRITE_OP_ADDRESS) << 2;
303
304 u32 offset, output_len, input_len, max_size;
305 struct qed_dev *cdev = p_hwfn->cdev;
306 union init_array_hdr *hdr;
307 const u32 *array_data;
308 int rc = 0;
309 u32 size;
310
311 array_data = cdev->fw_data->arr_data;
312
313 hdr = (union init_array_hdr *)(array_data + dmae_array_offset);
314 data = le32_to_cpu(hdr->raw.data);
315 switch (GET_FIELD(data, INIT_ARRAY_RAW_HDR_TYPE)) {
316 case INIT_ARR_ZIPPED:
317 offset = dmae_array_offset + 1;
318 input_len = GET_FIELD(data,
319 INIT_ARRAY_ZIPPED_HDR_ZIPPED_SIZE);
320 max_size = MAX_ZIPPED_SIZE * 4;
321 memset(p_hwfn->unzip_buf, 0, max_size);
322
323 output_len = qed_unzip_data(p_hwfn, input_len,
324 (u8 *)&array_data[offset],
325 max_size, (u8 *)p_hwfn->unzip_buf);
326 if (output_len) {
327 rc = qed_init_array_dmae(p_hwfn, p_ptt, addr, 0,
328 output_len,
329 p_hwfn->unzip_buf,
330 b_must_dmae, b_can_dmae);
331 } else {
332 DP_NOTICE(p_hwfn, "Failed to unzip dmae data\n");
333 rc = -EINVAL;
334 }
335 break;
336 case INIT_ARR_PATTERN:
337 {
338 u32 repeats = GET_FIELD(data,
339 INIT_ARRAY_PATTERN_HDR_REPETITIONS);
340 u32 i;
341
342 size = GET_FIELD(data, INIT_ARRAY_PATTERN_HDR_PATTERN_SIZE);
343
344 for (i = 0; i < repeats; i++, addr += size << 2) {
345 rc = qed_init_array_dmae(p_hwfn, p_ptt, addr,
346 dmae_array_offset + 1,
347 size, array_data,
348 b_must_dmae, b_can_dmae);
349 if (rc)
350 break;
351 }
352 break;
353 }
354 case INIT_ARR_STANDARD:
355 size = GET_FIELD(data, INIT_ARRAY_STANDARD_HDR_SIZE);
356 rc = qed_init_array_dmae(p_hwfn, p_ptt, addr,
357 dmae_array_offset + 1,
358 size, array_data,
359 b_must_dmae, b_can_dmae);
360 break;
361 }
362
363 return rc;
364}
365
366/* init_ops write command */
367static int qed_init_cmd_wr(struct qed_hwfn *p_hwfn,
368 struct qed_ptt *p_ptt,
369 struct init_write_op *p_cmd, bool b_can_dmae)
370{
371 u32 data = le32_to_cpu(p_cmd->data);
372 bool b_must_dmae = GET_FIELD(data, INIT_WRITE_OP_WIDE_BUS);
373 u32 addr = GET_FIELD(data, INIT_WRITE_OP_ADDRESS) << 2;
374 union init_write_args *arg = &p_cmd->args;
375 int rc = 0;
376
377 /* Sanitize */
378 if (b_must_dmae && !b_can_dmae) {
379 DP_NOTICE(p_hwfn,
380 "Need to write to %08x for Wide-bus but DMAE isn't allowed\n",
381 addr);
382 return -EINVAL;
383 }
384
385 switch (GET_FIELD(data, INIT_WRITE_OP_SOURCE)) {
386 case INIT_SRC_INLINE:
387 data = le32_to_cpu(p_cmd->args.inline_val);
388 qed_wr(p_hwfn, p_ptt, addr, data);
389 break;
390 case INIT_SRC_ZEROS:
391 data = le32_to_cpu(p_cmd->args.zeros_count);
392 if (b_must_dmae || (b_can_dmae && (data >= 64)))
393 rc = qed_init_fill_dmae(p_hwfn, p_ptt, addr, data);
394 else
395 qed_init_fill(p_hwfn, p_ptt, addr, 0, data);
396 break;
397 case INIT_SRC_ARRAY:
398 rc = qed_init_cmd_array(p_hwfn, p_ptt, p_cmd,
399 b_must_dmae, b_can_dmae);
400 break;
401 case INIT_SRC_RUNTIME:
402 qed_init_rt(p_hwfn, p_ptt, addr,
403 le16_to_cpu(arg->runtime.offset),
404 le16_to_cpu(arg->runtime.size),
405 b_must_dmae);
406 break;
407 }
408
409 return rc;
410}
411
412static inline bool comp_eq(u32 val, u32 expected_val)
413{
414 return val == expected_val;
415}
416
417static inline bool comp_and(u32 val, u32 expected_val)
418{
419 return (val & expected_val) == expected_val;
420}
421
422static inline bool comp_or(u32 val, u32 expected_val)
423{
424 return (val | expected_val) > 0;
425}
426
427/* init_ops read/poll commands */
428static void qed_init_cmd_rd(struct qed_hwfn *p_hwfn,
429 struct qed_ptt *p_ptt, struct init_read_op *cmd)
430{
431 bool (*comp_check)(u32 val, u32 expected_val);
432 u32 delay = QED_INIT_POLL_PERIOD_US, val;
433 u32 data, addr, poll;
434 int i;
435
436 data = le32_to_cpu(cmd->op_data);
437 addr = GET_FIELD(data, INIT_READ_OP_ADDRESS) << 2;
438 poll = GET_FIELD(data, INIT_READ_OP_POLL_TYPE);
439
440 val = qed_rd(p_hwfn, p_ptt, addr);
441
442 if (poll == INIT_POLL_NONE)
443 return;
444
445 switch (poll) {
446 case INIT_POLL_EQ:
447 comp_check = comp_eq;
448 break;
449 case INIT_POLL_OR:
450 comp_check = comp_or;
451 break;
452 case INIT_POLL_AND:
453 comp_check = comp_and;
454 break;
455 default:
456 DP_ERR(p_hwfn, "Invalid poll comparison type %08x\n",
457 cmd->op_data);
458 return;
459 }
460
461 data = le32_to_cpu(cmd->expected_val);
462 for (i = 0;
463 i < QED_INIT_MAX_POLL_COUNT && !comp_check(val, data);
464 i++) {
465 udelay(delay);
466 val = qed_rd(p_hwfn, p_ptt, addr);
467 }
468
469 if (i == QED_INIT_MAX_POLL_COUNT) {
470 DP_ERR(p_hwfn,
471 "Timeout when polling reg: 0x%08x [ Waiting-for: %08x Got: %08x (comparison %08x)]\n",
472 addr, le32_to_cpu(cmd->expected_val),
473 val, le32_to_cpu(cmd->op_data));
474 }
475}
476
477/* init_ops callbacks entry point */
478static int qed_init_cmd_cb(struct qed_hwfn *p_hwfn,
479 struct qed_ptt *p_ptt,
480 struct init_callback_op *p_cmd)
481{
482 int rc;
483
484 switch (p_cmd->callback_id) {
485 case DMAE_READY_CB:
486 rc = qed_dmae_sanity(p_hwfn, p_ptt, "engine_phase");
487 break;
488 default:
489 DP_NOTICE(p_hwfn, "Unexpected init op callback ID %d\n",
490 p_cmd->callback_id);
491 return -EINVAL;
492 }
493
494 return rc;
495}
496
497static u8 qed_init_cmd_mode_match(struct qed_hwfn *p_hwfn,
498 u16 *p_offset, int modes)
499{
500 struct qed_dev *cdev = p_hwfn->cdev;
501 const u8 *modes_tree_buf;
502 u8 arg1, arg2, tree_val;
503
504 modes_tree_buf = cdev->fw_data->modes_tree_buf;
505 tree_val = modes_tree_buf[(*p_offset)++];
506 switch (tree_val) {
507 case INIT_MODE_OP_NOT:
508 return qed_init_cmd_mode_match(p_hwfn, p_offset, modes) ^ 1;
509 case INIT_MODE_OP_OR:
510 arg1 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
511 arg2 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
512 return arg1 | arg2;
513 case INIT_MODE_OP_AND:
514 arg1 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
515 arg2 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
516 return arg1 & arg2;
517 default:
518 tree_val -= MAX_INIT_MODE_OPS;
519 return (modes & BIT(tree_val)) ? 1 : 0;
520 }
521}
522
523static u32 qed_init_cmd_mode(struct qed_hwfn *p_hwfn,
524 struct init_if_mode_op *p_cmd, int modes)
525{
526 u16 offset = le16_to_cpu(p_cmd->modes_buf_offset);
527
528 if (qed_init_cmd_mode_match(p_hwfn, &offset, modes))
529 return 0;
530 else
531 return GET_FIELD(le32_to_cpu(p_cmd->op_data),
532 INIT_IF_MODE_OP_CMD_OFFSET);
533}
534
535static u32 qed_init_cmd_phase(struct init_if_phase_op *p_cmd,
536 u32 phase, u32 phase_id)
537{
538 u32 data = le32_to_cpu(p_cmd->phase_data);
539 u32 op_data = le32_to_cpu(p_cmd->op_data);
540
541 if (!(GET_FIELD(data, INIT_IF_PHASE_OP_PHASE) == phase &&
542 (GET_FIELD(data, INIT_IF_PHASE_OP_PHASE_ID) == ANY_PHASE_ID ||
543 GET_FIELD(data, INIT_IF_PHASE_OP_PHASE_ID) == phase_id)))
544 return GET_FIELD(op_data, INIT_IF_PHASE_OP_CMD_OFFSET);
545 else
546 return 0;
547}
548
549int qed_init_run(struct qed_hwfn *p_hwfn,
550 struct qed_ptt *p_ptt, int phase, int phase_id, int modes)
551{
552 bool b_dmae = (phase != PHASE_ENGINE);
553 struct qed_dev *cdev = p_hwfn->cdev;
554 u32 cmd_num, num_init_ops;
555 union init_op *init_ops;
556 int rc = 0;
557
558 num_init_ops = cdev->fw_data->init_ops_size;
559 init_ops = cdev->fw_data->init_ops;
560
561 p_hwfn->unzip_buf = kzalloc(MAX_ZIPPED_SIZE * 4, GFP_ATOMIC);
562 if (!p_hwfn->unzip_buf)
563 return -ENOMEM;
564
565 for (cmd_num = 0; cmd_num < num_init_ops; cmd_num++) {
566 union init_op *cmd = &init_ops[cmd_num];
567 u32 data = le32_to_cpu(cmd->raw.op_data);
568
569 switch (GET_FIELD(data, INIT_CALLBACK_OP_OP)) {
570 case INIT_OP_WRITE:
571 rc = qed_init_cmd_wr(p_hwfn, p_ptt, &cmd->write,
572 b_dmae);
573 break;
574 case INIT_OP_READ:
575 qed_init_cmd_rd(p_hwfn, p_ptt, &cmd->read);
576 break;
577 case INIT_OP_IF_MODE:
578 cmd_num += qed_init_cmd_mode(p_hwfn, &cmd->if_mode,
579 modes);
580 break;
581 case INIT_OP_IF_PHASE:
582 cmd_num += qed_init_cmd_phase(&cmd->if_phase,
583 phase, phase_id);
584 break;
585 case INIT_OP_DELAY:
586 /* qed_init_run is always invoked from
587 * sleep-able context
588 */
589 udelay(le32_to_cpu(cmd->delay.delay));
590 break;
591
592 case INIT_OP_CALLBACK:
593 rc = qed_init_cmd_cb(p_hwfn, p_ptt, &cmd->callback);
594 if (phase == PHASE_ENGINE &&
595 cmd->callback.callback_id == DMAE_READY_CB)
596 b_dmae = true;
597 break;
598 }
599
600 if (rc)
601 break;
602 }
603
604 kfree(p_hwfn->unzip_buf);
605 p_hwfn->unzip_buf = NULL;
606 return rc;
607}
608
609void qed_gtt_init(struct qed_hwfn *p_hwfn)
610{
611 u32 gtt_base;
612 u32 i;
613
614 /* Set the global windows */
615 gtt_base = PXP_PF_WINDOW_ADMIN_START + PXP_PF_WINDOW_ADMIN_GLOBAL_START;
616
617 for (i = 0; i < ARRAY_SIZE(pxp_global_win); i++)
618 if (pxp_global_win[i])
619 REG_WR(p_hwfn, gtt_base + i * PXP_GLOBAL_ENTRY_SIZE,
620 pxp_global_win[i]);
621}
622
623int qed_init_fw_data(struct qed_dev *cdev, const u8 *data)
624{
625 struct qed_fw_data *fw = cdev->fw_data;
626 struct bin_buffer_hdr *buf_hdr;
627 u32 offset, len;
628
629 if (!data) {
630 DP_NOTICE(cdev, "Invalid fw data\n");
631 return -EINVAL;
632 }
633
634 /* First Dword contains metadata and should be skipped */
635 buf_hdr = (struct bin_buffer_hdr *)data;
636
637 offset = buf_hdr[BIN_BUF_INIT_FW_VER_INFO].offset;
638 fw->fw_ver_info = (struct fw_ver_info *)(data + offset);
639
640 offset = buf_hdr[BIN_BUF_INIT_CMD].offset;
641 fw->init_ops = (union init_op *)(data + offset);
642
643 offset = buf_hdr[BIN_BUF_INIT_VAL].offset;
644 fw->arr_data = (u32 *)(data + offset);
645
646 offset = buf_hdr[BIN_BUF_INIT_MODE_TREE].offset;
647 fw->modes_tree_buf = (u8 *)(data + offset);
648 len = buf_hdr[BIN_BUF_INIT_CMD].length;
649 fw->init_ops_size = len / sizeof(struct init_raw_op);
650
651 offset = buf_hdr[BIN_BUF_INIT_OVERLAYS].offset;
652 fw->fw_overlays = (u32 *)(data + offset);
653 len = buf_hdr[BIN_BUF_INIT_OVERLAYS].length;
654 fw->fw_overlays_len = len;
655
656 return 0;
657}
1/* QLogic qed NIC Driver
2 * Copyright (c) 2015 QLogic Corporation
3 *
4 * This software is available under the terms of the GNU General Public License
5 * (GPL) Version 2, available from the file COPYING in the main directory of
6 * this source tree.
7 */
8
9#include <linux/types.h>
10#include <linux/io.h>
11#include <linux/delay.h>
12#include <linux/errno.h>
13#include <linux/kernel.h>
14#include <linux/slab.h>
15#include <linux/string.h>
16#include "qed.h"
17#include "qed_hsi.h"
18#include "qed_hw.h"
19#include "qed_init_ops.h"
20#include "qed_reg_addr.h"
21#include "qed_sriov.h"
22
23#define QED_INIT_MAX_POLL_COUNT 100
24#define QED_INIT_POLL_PERIOD_US 500
25
26static u32 pxp_global_win[] = {
27 0,
28 0,
29 0x1c02, /* win 2: addr=0x1c02000, size=4096 bytes */
30 0x1c80, /* win 3: addr=0x1c80000, size=4096 bytes */
31 0x1d00, /* win 4: addr=0x1d00000, size=4096 bytes */
32 0x1d01, /* win 5: addr=0x1d01000, size=4096 bytes */
33 0x1d80, /* win 6: addr=0x1d80000, size=4096 bytes */
34 0x1d81, /* win 7: addr=0x1d81000, size=4096 bytes */
35 0x1d82, /* win 8: addr=0x1d82000, size=4096 bytes */
36 0x1e00, /* win 9: addr=0x1e00000, size=4096 bytes */
37 0x1e80, /* win 10: addr=0x1e80000, size=4096 bytes */
38 0x1f00, /* win 11: addr=0x1f00000, size=4096 bytes */
39 0,
40 0,
41 0,
42 0,
43 0,
44 0,
45 0,
46};
47
48void qed_init_iro_array(struct qed_dev *cdev)
49{
50 cdev->iro_arr = iro_arr;
51}
52
53/* Runtime configuration helpers */
54void qed_init_clear_rt_data(struct qed_hwfn *p_hwfn)
55{
56 int i;
57
58 for (i = 0; i < RUNTIME_ARRAY_SIZE; i++)
59 p_hwfn->rt_data.b_valid[i] = false;
60}
61
62void qed_init_store_rt_reg(struct qed_hwfn *p_hwfn, u32 rt_offset, u32 val)
63{
64 p_hwfn->rt_data.init_val[rt_offset] = val;
65 p_hwfn->rt_data.b_valid[rt_offset] = true;
66}
67
68void qed_init_store_rt_agg(struct qed_hwfn *p_hwfn,
69 u32 rt_offset, u32 *p_val, size_t size)
70{
71 size_t i;
72
73 for (i = 0; i < size / sizeof(u32); i++) {
74 p_hwfn->rt_data.init_val[rt_offset + i] = p_val[i];
75 p_hwfn->rt_data.b_valid[rt_offset + i] = true;
76 }
77}
78
79static int qed_init_rt(struct qed_hwfn *p_hwfn,
80 struct qed_ptt *p_ptt,
81 u32 addr, u16 rt_offset, u16 size, bool b_must_dmae)
82{
83 u32 *p_init_val = &p_hwfn->rt_data.init_val[rt_offset];
84 bool *p_valid = &p_hwfn->rt_data.b_valid[rt_offset];
85 u16 i, segment;
86 int rc = 0;
87
88 /* Since not all RT entries are initialized, go over the RT and
89 * for each segment of initialized values use DMA.
90 */
91 for (i = 0; i < size; i++) {
92 if (!p_valid[i])
93 continue;
94
95 /* In case there isn't any wide-bus configuration here,
96 * simply write the data instead of using dmae.
97 */
98 if (!b_must_dmae) {
99 qed_wr(p_hwfn, p_ptt, addr + (i << 2), p_init_val[i]);
100 continue;
101 }
102
103 /* Start of a new segment */
104 for (segment = 1; i + segment < size; segment++)
105 if (!p_valid[i + segment])
106 break;
107
108 rc = qed_dmae_host2grc(p_hwfn, p_ptt,
109 (uintptr_t)(p_init_val + i),
110 addr + (i << 2), segment, 0);
111 if (rc)
112 return rc;
113
114 /* Jump over the entire segment, including invalid entry */
115 i += segment;
116 }
117
118 return rc;
119}
120
121int qed_init_alloc(struct qed_hwfn *p_hwfn)
122{
123 struct qed_rt_data *rt_data = &p_hwfn->rt_data;
124
125 if (IS_VF(p_hwfn->cdev))
126 return 0;
127
128 rt_data->b_valid = kzalloc(sizeof(bool) * RUNTIME_ARRAY_SIZE,
129 GFP_KERNEL);
130 if (!rt_data->b_valid)
131 return -ENOMEM;
132
133 rt_data->init_val = kzalloc(sizeof(u32) * RUNTIME_ARRAY_SIZE,
134 GFP_KERNEL);
135 if (!rt_data->init_val) {
136 kfree(rt_data->b_valid);
137 return -ENOMEM;
138 }
139
140 return 0;
141}
142
143void qed_init_free(struct qed_hwfn *p_hwfn)
144{
145 kfree(p_hwfn->rt_data.init_val);
146 kfree(p_hwfn->rt_data.b_valid);
147}
148
149static int qed_init_array_dmae(struct qed_hwfn *p_hwfn,
150 struct qed_ptt *p_ptt,
151 u32 addr,
152 u32 dmae_data_offset,
153 u32 size,
154 const u32 *buf,
155 bool b_must_dmae,
156 bool b_can_dmae)
157{
158 int rc = 0;
159
160 /* Perform DMAE only for lengthy enough sections or for wide-bus */
161 if (!b_can_dmae || (!b_must_dmae && (size < 16))) {
162 const u32 *data = buf + dmae_data_offset;
163 u32 i;
164
165 for (i = 0; i < size; i++)
166 qed_wr(p_hwfn, p_ptt, addr + (i << 2), data[i]);
167 } else {
168 rc = qed_dmae_host2grc(p_hwfn, p_ptt,
169 (uintptr_t)(buf + dmae_data_offset),
170 addr, size, 0);
171 }
172
173 return rc;
174}
175
176static int qed_init_fill_dmae(struct qed_hwfn *p_hwfn,
177 struct qed_ptt *p_ptt,
178 u32 addr, u32 fill, u32 fill_count)
179{
180 static u32 zero_buffer[DMAE_MAX_RW_SIZE];
181
182 memset(zero_buffer, 0, sizeof(u32) * DMAE_MAX_RW_SIZE);
183
184 /* invoke the DMAE virtual/physical buffer API with
185 * 1. DMAE init channel
186 * 2. addr,
187 * 3. p_hwfb->temp_data,
188 * 4. fill_count
189 */
190
191 return qed_dmae_host2grc(p_hwfn, p_ptt,
192 (uintptr_t)(&zero_buffer[0]),
193 addr, fill_count, QED_DMAE_FLAG_RW_REPL_SRC);
194}
195
196static void qed_init_fill(struct qed_hwfn *p_hwfn,
197 struct qed_ptt *p_ptt,
198 u32 addr, u32 fill, u32 fill_count)
199{
200 u32 i;
201
202 for (i = 0; i < fill_count; i++, addr += sizeof(u32))
203 qed_wr(p_hwfn, p_ptt, addr, fill);
204}
205
206static int qed_init_cmd_array(struct qed_hwfn *p_hwfn,
207 struct qed_ptt *p_ptt,
208 struct init_write_op *cmd,
209 bool b_must_dmae, bool b_can_dmae)
210{
211 u32 dmae_array_offset = le32_to_cpu(cmd->args.array_offset);
212 u32 data = le32_to_cpu(cmd->data);
213 u32 addr = GET_FIELD(data, INIT_WRITE_OP_ADDRESS) << 2;
214
215 u32 offset, output_len, input_len, max_size;
216 struct qed_dev *cdev = p_hwfn->cdev;
217 union init_array_hdr *hdr;
218 const u32 *array_data;
219 int rc = 0;
220 u32 size;
221
222 array_data = cdev->fw_data->arr_data;
223
224 hdr = (union init_array_hdr *)(array_data + dmae_array_offset);
225 data = le32_to_cpu(hdr->raw.data);
226 switch (GET_FIELD(data, INIT_ARRAY_RAW_HDR_TYPE)) {
227 case INIT_ARR_ZIPPED:
228 offset = dmae_array_offset + 1;
229 input_len = GET_FIELD(data,
230 INIT_ARRAY_ZIPPED_HDR_ZIPPED_SIZE);
231 max_size = MAX_ZIPPED_SIZE * 4;
232 memset(p_hwfn->unzip_buf, 0, max_size);
233
234 output_len = qed_unzip_data(p_hwfn, input_len,
235 (u8 *)&array_data[offset],
236 max_size, (u8 *)p_hwfn->unzip_buf);
237 if (output_len) {
238 rc = qed_init_array_dmae(p_hwfn, p_ptt, addr, 0,
239 output_len,
240 p_hwfn->unzip_buf,
241 b_must_dmae, b_can_dmae);
242 } else {
243 DP_NOTICE(p_hwfn, "Failed to unzip dmae data\n");
244 rc = -EINVAL;
245 }
246 break;
247 case INIT_ARR_PATTERN:
248 {
249 u32 repeats = GET_FIELD(data,
250 INIT_ARRAY_PATTERN_HDR_REPETITIONS);
251 u32 i;
252
253 size = GET_FIELD(data, INIT_ARRAY_PATTERN_HDR_PATTERN_SIZE);
254
255 for (i = 0; i < repeats; i++, addr += size << 2) {
256 rc = qed_init_array_dmae(p_hwfn, p_ptt, addr,
257 dmae_array_offset + 1,
258 size, array_data,
259 b_must_dmae, b_can_dmae);
260 if (rc)
261 break;
262 }
263 break;
264 }
265 case INIT_ARR_STANDARD:
266 size = GET_FIELD(data, INIT_ARRAY_STANDARD_HDR_SIZE);
267 rc = qed_init_array_dmae(p_hwfn, p_ptt, addr,
268 dmae_array_offset + 1,
269 size, array_data,
270 b_must_dmae, b_can_dmae);
271 break;
272 }
273
274 return rc;
275}
276
277/* init_ops write command */
278static int qed_init_cmd_wr(struct qed_hwfn *p_hwfn,
279 struct qed_ptt *p_ptt,
280 struct init_write_op *p_cmd, bool b_can_dmae)
281{
282 u32 data = le32_to_cpu(p_cmd->data);
283 bool b_must_dmae = GET_FIELD(data, INIT_WRITE_OP_WIDE_BUS);
284 u32 addr = GET_FIELD(data, INIT_WRITE_OP_ADDRESS) << 2;
285 union init_write_args *arg = &p_cmd->args;
286 int rc = 0;
287
288 /* Sanitize */
289 if (b_must_dmae && !b_can_dmae) {
290 DP_NOTICE(p_hwfn,
291 "Need to write to %08x for Wide-bus but DMAE isn't allowed\n",
292 addr);
293 return -EINVAL;
294 }
295
296 switch (GET_FIELD(data, INIT_WRITE_OP_SOURCE)) {
297 case INIT_SRC_INLINE:
298 data = le32_to_cpu(p_cmd->args.inline_val);
299 qed_wr(p_hwfn, p_ptt, addr, data);
300 break;
301 case INIT_SRC_ZEROS:
302 data = le32_to_cpu(p_cmd->args.zeros_count);
303 if (b_must_dmae || (b_can_dmae && (data >= 64)))
304 rc = qed_init_fill_dmae(p_hwfn, p_ptt, addr, 0, data);
305 else
306 qed_init_fill(p_hwfn, p_ptt, addr, 0, data);
307 break;
308 case INIT_SRC_ARRAY:
309 rc = qed_init_cmd_array(p_hwfn, p_ptt, p_cmd,
310 b_must_dmae, b_can_dmae);
311 break;
312 case INIT_SRC_RUNTIME:
313 qed_init_rt(p_hwfn, p_ptt, addr,
314 le16_to_cpu(arg->runtime.offset),
315 le16_to_cpu(arg->runtime.size),
316 b_must_dmae);
317 break;
318 }
319
320 return rc;
321}
322
323static inline bool comp_eq(u32 val, u32 expected_val)
324{
325 return val == expected_val;
326}
327
328static inline bool comp_and(u32 val, u32 expected_val)
329{
330 return (val & expected_val) == expected_val;
331}
332
333static inline bool comp_or(u32 val, u32 expected_val)
334{
335 return (val | expected_val) > 0;
336}
337
338/* init_ops read/poll commands */
339static void qed_init_cmd_rd(struct qed_hwfn *p_hwfn,
340 struct qed_ptt *p_ptt, struct init_read_op *cmd)
341{
342 bool (*comp_check)(u32 val, u32 expected_val);
343 u32 delay = QED_INIT_POLL_PERIOD_US, val;
344 u32 data, addr, poll;
345 int i;
346
347 data = le32_to_cpu(cmd->op_data);
348 addr = GET_FIELD(data, INIT_READ_OP_ADDRESS) << 2;
349 poll = GET_FIELD(data, INIT_READ_OP_POLL_TYPE);
350
351
352 val = qed_rd(p_hwfn, p_ptt, addr);
353
354 if (poll == INIT_POLL_NONE)
355 return;
356
357 switch (poll) {
358 case INIT_POLL_EQ:
359 comp_check = comp_eq;
360 break;
361 case INIT_POLL_OR:
362 comp_check = comp_or;
363 break;
364 case INIT_POLL_AND:
365 comp_check = comp_and;
366 break;
367 default:
368 DP_ERR(p_hwfn, "Invalid poll comparison type %08x\n",
369 cmd->op_data);
370 return;
371 }
372
373 data = le32_to_cpu(cmd->expected_val);
374 for (i = 0;
375 i < QED_INIT_MAX_POLL_COUNT && !comp_check(val, data);
376 i++) {
377 udelay(delay);
378 val = qed_rd(p_hwfn, p_ptt, addr);
379 }
380
381 if (i == QED_INIT_MAX_POLL_COUNT) {
382 DP_ERR(p_hwfn,
383 "Timeout when polling reg: 0x%08x [ Waiting-for: %08x Got: %08x (comparsion %08x)]\n",
384 addr, le32_to_cpu(cmd->expected_val),
385 val, le32_to_cpu(cmd->op_data));
386 }
387}
388
389/* init_ops callbacks entry point */
390static void qed_init_cmd_cb(struct qed_hwfn *p_hwfn,
391 struct qed_ptt *p_ptt,
392 struct init_callback_op *p_cmd)
393{
394 DP_NOTICE(p_hwfn, "Currently init values have no need of callbacks\n");
395}
396
397static u8 qed_init_cmd_mode_match(struct qed_hwfn *p_hwfn,
398 u16 *p_offset, int modes)
399{
400 struct qed_dev *cdev = p_hwfn->cdev;
401 const u8 *modes_tree_buf;
402 u8 arg1, arg2, tree_val;
403
404 modes_tree_buf = cdev->fw_data->modes_tree_buf;
405 tree_val = modes_tree_buf[(*p_offset)++];
406 switch (tree_val) {
407 case INIT_MODE_OP_NOT:
408 return qed_init_cmd_mode_match(p_hwfn, p_offset, modes) ^ 1;
409 case INIT_MODE_OP_OR:
410 arg1 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
411 arg2 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
412 return arg1 | arg2;
413 case INIT_MODE_OP_AND:
414 arg1 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
415 arg2 = qed_init_cmd_mode_match(p_hwfn, p_offset, modes);
416 return arg1 & arg2;
417 default:
418 tree_val -= MAX_INIT_MODE_OPS;
419 return (modes & BIT(tree_val)) ? 1 : 0;
420 }
421}
422
423static u32 qed_init_cmd_mode(struct qed_hwfn *p_hwfn,
424 struct init_if_mode_op *p_cmd, int modes)
425{
426 u16 offset = le16_to_cpu(p_cmd->modes_buf_offset);
427
428 if (qed_init_cmd_mode_match(p_hwfn, &offset, modes))
429 return 0;
430 else
431 return GET_FIELD(le32_to_cpu(p_cmd->op_data),
432 INIT_IF_MODE_OP_CMD_OFFSET);
433}
434
435static u32 qed_init_cmd_phase(struct qed_hwfn *p_hwfn,
436 struct init_if_phase_op *p_cmd,
437 u32 phase, u32 phase_id)
438{
439 u32 data = le32_to_cpu(p_cmd->phase_data);
440 u32 op_data = le32_to_cpu(p_cmd->op_data);
441
442 if (!(GET_FIELD(data, INIT_IF_PHASE_OP_PHASE) == phase &&
443 (GET_FIELD(data, INIT_IF_PHASE_OP_PHASE_ID) == ANY_PHASE_ID ||
444 GET_FIELD(data, INIT_IF_PHASE_OP_PHASE_ID) == phase_id)))
445 return GET_FIELD(op_data, INIT_IF_PHASE_OP_CMD_OFFSET);
446 else
447 return 0;
448}
449
450int qed_init_run(struct qed_hwfn *p_hwfn,
451 struct qed_ptt *p_ptt, int phase, int phase_id, int modes)
452{
453 struct qed_dev *cdev = p_hwfn->cdev;
454 u32 cmd_num, num_init_ops;
455 union init_op *init_ops;
456 bool b_dmae = false;
457 int rc = 0;
458
459 num_init_ops = cdev->fw_data->init_ops_size;
460 init_ops = cdev->fw_data->init_ops;
461
462 p_hwfn->unzip_buf = kzalloc(MAX_ZIPPED_SIZE * 4, GFP_ATOMIC);
463 if (!p_hwfn->unzip_buf)
464 return -ENOMEM;
465
466 for (cmd_num = 0; cmd_num < num_init_ops; cmd_num++) {
467 union init_op *cmd = &init_ops[cmd_num];
468 u32 data = le32_to_cpu(cmd->raw.op_data);
469
470 switch (GET_FIELD(data, INIT_CALLBACK_OP_OP)) {
471 case INIT_OP_WRITE:
472 rc = qed_init_cmd_wr(p_hwfn, p_ptt, &cmd->write,
473 b_dmae);
474 break;
475 case INIT_OP_READ:
476 qed_init_cmd_rd(p_hwfn, p_ptt, &cmd->read);
477 break;
478 case INIT_OP_IF_MODE:
479 cmd_num += qed_init_cmd_mode(p_hwfn, &cmd->if_mode,
480 modes);
481 break;
482 case INIT_OP_IF_PHASE:
483 cmd_num += qed_init_cmd_phase(p_hwfn, &cmd->if_phase,
484 phase, phase_id);
485 b_dmae = GET_FIELD(data, INIT_IF_PHASE_OP_DMAE_ENABLE);
486 break;
487 case INIT_OP_DELAY:
488 /* qed_init_run is always invoked from
489 * sleep-able context
490 */
491 udelay(le32_to_cpu(cmd->delay.delay));
492 break;
493
494 case INIT_OP_CALLBACK:
495 qed_init_cmd_cb(p_hwfn, p_ptt, &cmd->callback);
496 break;
497 }
498
499 if (rc)
500 break;
501 }
502
503 kfree(p_hwfn->unzip_buf);
504 return rc;
505}
506
507void qed_gtt_init(struct qed_hwfn *p_hwfn)
508{
509 u32 gtt_base;
510 u32 i;
511
512 /* Set the global windows */
513 gtt_base = PXP_PF_WINDOW_ADMIN_START + PXP_PF_WINDOW_ADMIN_GLOBAL_START;
514
515 for (i = 0; i < ARRAY_SIZE(pxp_global_win); i++)
516 if (pxp_global_win[i])
517 REG_WR(p_hwfn, gtt_base + i * PXP_GLOBAL_ENTRY_SIZE,
518 pxp_global_win[i]);
519}
520
521int qed_init_fw_data(struct qed_dev *cdev, const u8 *data)
522{
523 struct qed_fw_data *fw = cdev->fw_data;
524 struct bin_buffer_hdr *buf_hdr;
525 u32 offset, len;
526
527 if (!data) {
528 DP_NOTICE(cdev, "Invalid fw data\n");
529 return -EINVAL;
530 }
531
532 /* First Dword contains metadata and should be skipped */
533 buf_hdr = (struct bin_buffer_hdr *)(data + sizeof(u32));
534
535 offset = buf_hdr[BIN_BUF_INIT_FW_VER_INFO].offset;
536 fw->fw_ver_info = (struct fw_ver_info *)(data + offset);
537
538 offset = buf_hdr[BIN_BUF_INIT_CMD].offset;
539 fw->init_ops = (union init_op *)(data + offset);
540
541 offset = buf_hdr[BIN_BUF_INIT_VAL].offset;
542 fw->arr_data = (u32 *)(data + offset);
543
544 offset = buf_hdr[BIN_BUF_INIT_MODE_TREE].offset;
545 fw->modes_tree_buf = (u8 *)(data + offset);
546 len = buf_hdr[BIN_BUF_INIT_CMD].length;
547 fw->init_ops_size = len / sizeof(struct init_raw_op);
548
549 return 0;
550}