]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/dev/liquidio/base/cn23xx_pf_device.c
MFV r328323,328324:
[FreeBSD/FreeBSD.git] / sys / dev / liquidio / base / cn23xx_pf_device.c
1 /*
2  *   BSD LICENSE
3  *
4  *   Copyright(c) 2017 Cavium, Inc.. All rights reserved.
5  *   All rights reserved.
6  *
7  *   Redistribution and use in source and binary forms, with or without
8  *   modification, are permitted provided that the following conditions
9  *   are met:
10  *
11  *     * Redistributions of source code must retain the above copyright
12  *       notice, this list of conditions and the following disclaimer.
13  *     * Redistributions in binary form must reproduce the above copyright
14  *       notice, this list of conditions and the following disclaimer in
15  *       the documentation and/or other materials provided with the
16  *       distribution.
17  *     * Neither the name of Cavium, Inc. nor the names of its
18  *       contributors may be used to endorse or promote products derived
19  *       from this software without specific prior written permission.
20  *
21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25  *   OWNER(S) OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  */
33 /*$FreeBSD$*/
34
35 #include "lio_bsd.h"
36 #include "lio_common.h"
37 #include "lio_droq.h"
38 #include "lio_iq.h"
39 #include "lio_response_manager.h"
40 #include "lio_device.h"
41 #include "cn23xx_pf_device.h"
42 #include "lio_main.h"
43 #include "lio_rss.h"
44
45 static int
46 lio_cn23xx_pf_soft_reset(struct octeon_device *oct)
47 {
48
49         lio_write_csr64(oct, LIO_CN23XX_SLI_WIN_WR_MASK_REG, 0xFF);
50
51         lio_dev_dbg(oct, "BIST enabled for CN23XX soft reset\n");
52
53         lio_write_csr64(oct, LIO_CN23XX_SLI_SCRATCH1, 0x1234ULL);
54
55         /* Initiate chip-wide soft reset */
56         lio_pci_readq(oct, LIO_CN23XX_RST_SOFT_RST);
57         lio_pci_writeq(oct, 1, LIO_CN23XX_RST_SOFT_RST);
58
59         /* Wait for 100ms as Octeon resets. */
60         lio_mdelay(100);
61
62         if (lio_read_csr64(oct, LIO_CN23XX_SLI_SCRATCH1)) {
63                 lio_dev_err(oct, "Soft reset failed\n");
64                 return (1);
65         }
66
67         lio_dev_dbg(oct, "Reset completed\n");
68
69         /* restore the  reset value */
70         lio_write_csr64(oct, LIO_CN23XX_SLI_WIN_WR_MASK_REG, 0xFF);
71
72         return (0);
73 }
74
75 static void
76 lio_cn23xx_pf_enable_error_reporting(struct octeon_device *oct)
77 {
78         uint32_t        corrtable_err_status, uncorrectable_err_mask, regval;
79
80         regval = lio_read_pci_cfg(oct, LIO_CN23XX_CFG_PCIE_DEVCTL);
81         if (regval & LIO_CN23XX_CFG_PCIE_DEVCTL_MASK) {
82                 uncorrectable_err_mask = 0;
83                 corrtable_err_status = 0;
84                 uncorrectable_err_mask =
85                     lio_read_pci_cfg(oct,
86                                      LIO_CN23XX_CFG_PCIE_UNCORRECT_ERR_MASK);
87                 corrtable_err_status =
88                     lio_read_pci_cfg(oct,
89                                      LIO_CN23XX_CFG_PCIE_CORRECT_ERR_STATUS);
90                 lio_dev_err(oct, "PCI-E Fatal error detected;\n"
91                             "\tdev_ctl_status_reg = 0x%08x\n"
92                             "\tuncorrectable_error_mask_reg = 0x%08x\n"
93                             "\tcorrectable_error_status_reg = 0x%08x\n",
94                             regval, uncorrectable_err_mask,
95                             corrtable_err_status);
96         }
97
98         regval |= 0xf;  /* Enable Link error reporting */
99
100         lio_dev_dbg(oct, "Enabling PCI-E error reporting..\n");
101         lio_write_pci_cfg(oct, LIO_CN23XX_CFG_PCIE_DEVCTL, regval);
102 }
103
104 static uint32_t
105 lio_cn23xx_pf_coprocessor_clock(struct octeon_device *oct)
106 {
107         /*
108          * Bits 29:24 of RST_BOOT[PNR_MUL] holds the ref.clock MULTIPLIER
109          * for SLI.
110          */
111
112         /* TBD: get the info in Hand-shake */
113         return (((lio_pci_readq(oct, LIO_CN23XX_RST_BOOT) >> 24) & 0x3f) * 50);
114 }
115
116 uint32_t
117 lio_cn23xx_pf_get_oq_ticks(struct octeon_device *oct, uint32_t time_intr_in_us)
118 {
119         /* This gives the SLI clock per microsec */
120         uint32_t        oqticks_per_us = lio_cn23xx_pf_coprocessor_clock(oct);
121
122         oct->pfvf_hsword.coproc_tics_per_us = oqticks_per_us;
123
124         /* This gives the clock cycles per millisecond */
125         oqticks_per_us *= 1000;
126
127         /* This gives the oq ticks (1024 core clock cycles) per millisecond */
128         oqticks_per_us /= 1024;
129
130         /*
131          * time_intr is in microseconds. The next 2 steps gives the oq ticks
132          * corresponding to time_intr.
133          */
134         oqticks_per_us *= time_intr_in_us;
135         oqticks_per_us /= 1000;
136
137         return (oqticks_per_us);
138 }
139
140 static void
141 lio_cn23xx_pf_setup_global_mac_regs(struct octeon_device *oct)
142 {
143         uint64_t        reg_val;
144         uint16_t        mac_no = oct->pcie_port;
145         uint16_t        pf_num = oct->pf_num;
146         /* programming SRN and TRS for each MAC(0..3)  */
147
148         lio_dev_dbg(oct, "%s: Using pcie port %d\n", __func__, mac_no);
149         /* By default, mapping all 64 IOQs to  a single MACs */
150
151         reg_val =
152             lio_read_csr64(oct, LIO_CN23XX_SLI_PKT_MAC_RINFO64(mac_no, pf_num));
153
154         /* setting SRN <6:0>  */
155         reg_val = pf_num * LIO_CN23XX_PF_MAX_RINGS;
156
157         /* setting TRS <23:16> */
158         reg_val = reg_val |
159             (oct->sriov_info.trs << LIO_CN23XX_PKT_MAC_CTL_RINFO_TRS_BIT_POS);
160
161         /* write these settings to MAC register */
162         lio_write_csr64(oct, LIO_CN23XX_SLI_PKT_MAC_RINFO64(mac_no, pf_num),
163                         reg_val);
164
165         lio_dev_dbg(oct, "SLI_PKT_MAC(%d)_PF(%d)_RINFO : 0x%016llx\n", mac_no,
166                     pf_num,
167                     LIO_CAST64(lio_read_csr64(oct,
168                                    LIO_CN23XX_SLI_PKT_MAC_RINFO64(mac_no,
169                                                                   pf_num))));
170 }
171
172 static int
173 lio_cn23xx_pf_reset_io_queues(struct octeon_device *oct)
174 {
175         uint64_t        d64;
176         uint32_t        ern, loop = BUSY_READING_REG_PF_LOOP_COUNT;
177         uint32_t        q_no, srn;
178         int             ret_val = 0;
179
180         srn = oct->sriov_info.pf_srn;
181         ern = srn + oct->sriov_info.num_pf_rings;
182
183         /* As per HRM reg description, s/w cant write 0 to ENB. */
184         /* to make the queue off, need to set the RST bit. */
185
186         /* Reset the Enable bit for all the 64 IQs.  */
187         for (q_no = srn; q_no < ern; q_no++) {
188                 /* set RST bit to 1. This bit applies to both IQ and OQ */
189                 d64 = lio_read_csr64(oct,
190                                      LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
191                 d64 = d64 | LIO_CN23XX_PKT_INPUT_CTL_RST;
192                 lio_write_csr64(oct,
193                                 LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no), d64);
194         }
195
196         /* wait until the RST bit is clear or the RST and quiet bits are set */
197         for (q_no = srn; q_no < ern; q_no++) {
198                 volatile uint64_t reg_val =
199                         lio_read_csr64(oct,
200                                        LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
201                 while ((reg_val & LIO_CN23XX_PKT_INPUT_CTL_RST) &&
202                        !(reg_val & LIO_CN23XX_PKT_INPUT_CTL_QUIET) &&
203                        loop) {
204                         reg_val = lio_read_csr64(oct,
205                                        LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
206                         loop--;
207                 }
208
209                 if (!loop) {
210                         lio_dev_err(oct,
211                                     "clearing the reset reg failed or setting the quiet reg failed for qno: %u\n",
212                                     q_no);
213                         return (-1);
214                 }
215
216                 reg_val &= ~LIO_CN23XX_PKT_INPUT_CTL_RST;
217                 lio_write_csr64(oct, LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
218                                 reg_val);
219
220                 reg_val = lio_read_csr64(oct,
221                                          LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
222                 if (reg_val & LIO_CN23XX_PKT_INPUT_CTL_RST) {
223                         lio_dev_err(oct, "clearing the reset failed for qno: %u\n",
224                                     q_no);
225                         ret_val = -1;
226                 }
227         }
228
229         return (ret_val);
230 }
231
232 static int
233 lio_cn23xx_pf_setup_global_input_regs(struct octeon_device *oct)
234 {
235         struct lio_cn23xx_pf    *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
236         struct lio_instr_queue  *iq;
237         uint64_t                intr_threshold;
238         uint64_t                pf_num, reg_val;
239         uint32_t                q_no, ern, srn;
240
241         pf_num = oct->pf_num;
242
243         srn = oct->sriov_info.pf_srn;
244         ern = srn + oct->sriov_info.num_pf_rings;
245
246         if (lio_cn23xx_pf_reset_io_queues(oct))
247                 return (-1);
248
249         /*
250          * Set the MAC_NUM and PVF_NUM in IQ_PKT_CONTROL reg
251          * for all queues.Only PF can set these bits.
252          * bits 29:30 indicate the MAC num.
253          * bits 32:47 indicate the PVF num.
254          */
255         for (q_no = 0; q_no < ern; q_no++) {
256                 reg_val = oct->pcie_port <<
257                         LIO_CN23XX_PKT_INPUT_CTL_MAC_NUM_POS;
258
259                 reg_val |= pf_num << LIO_CN23XX_PKT_INPUT_CTL_PF_NUM_POS;
260
261                 lio_write_csr64(oct, LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
262                                 reg_val);
263         }
264
265         /*
266          * Select ES, RO, NS, RDSIZE,DPTR Fomat#0 for
267          * pf queues
268          */
269         for (q_no = srn; q_no < ern; q_no++) {
270                 uint32_t        inst_cnt_reg;
271
272                 iq = oct->instr_queue[q_no];
273                 if (iq != NULL)
274                         inst_cnt_reg = iq->inst_cnt_reg;
275                 else
276                         inst_cnt_reg = LIO_CN23XX_SLI_IQ_INSTR_COUNT64(q_no);
277
278                 reg_val =
279                     lio_read_csr64(oct, LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
280
281                 reg_val |= LIO_CN23XX_PKT_INPUT_CTL_MASK;
282
283                 lio_write_csr64(oct, LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
284                                 reg_val);
285
286                 /* Set WMARK level for triggering PI_INT */
287                 /* intr_threshold = LIO_CN23XX_DEF_IQ_INTR_THRESHOLD & */
288                 intr_threshold = LIO_GET_IQ_INTR_PKT_CFG(cn23xx->conf) &
289                     LIO_CN23XX_PKT_IN_DONE_WMARK_MASK;
290
291                 lio_write_csr64(oct, inst_cnt_reg,
292                                 (lio_read_csr64(oct, inst_cnt_reg) &
293                                  ~(LIO_CN23XX_PKT_IN_DONE_WMARK_MASK <<
294                                    LIO_CN23XX_PKT_IN_DONE_WMARK_BIT_POS)) |
295                                 (intr_threshold <<
296                                  LIO_CN23XX_PKT_IN_DONE_WMARK_BIT_POS));
297         }
298         return (0);
299 }
300
301 static void
302 lio_cn23xx_pf_setup_global_output_regs(struct octeon_device *oct)
303 {
304         struct lio_cn23xx_pf *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
305         uint64_t        time_threshold;
306         uint32_t        ern, q_no, reg_val, srn;
307
308         srn = oct->sriov_info.pf_srn;
309         ern = srn + oct->sriov_info.num_pf_rings;
310
311         if (LIO_GET_IS_SLI_BP_ON_CFG(cn23xx->conf)) {
312                 lio_write_csr64(oct, LIO_CN23XX_SLI_OQ_WMARK, 32);
313         } else {
314                 /* Set Output queue watermark to 0 to disable backpressure */
315                 lio_write_csr64(oct, LIO_CN23XX_SLI_OQ_WMARK, 0);
316         }
317
318         for (q_no = srn; q_no < ern; q_no++) {
319                 reg_val = lio_read_csr32(oct,
320                                          LIO_CN23XX_SLI_OQ_PKT_CONTROL(q_no));
321
322                 /* set IPTR & DPTR */
323                 reg_val |= LIO_CN23XX_PKT_OUTPUT_CTL_DPTR;
324
325                 /* reset BMODE */
326                 reg_val &= ~(LIO_CN23XX_PKT_OUTPUT_CTL_BMODE);
327
328                 /*
329                  * No Relaxed Ordering, No Snoop, 64-bit Byte swap for
330                  * Output Queue ScatterList reset ROR_P, NSR_P
331                  */
332                 reg_val &= ~(LIO_CN23XX_PKT_OUTPUT_CTL_ROR_P);
333                 reg_val &= ~(LIO_CN23XX_PKT_OUTPUT_CTL_NSR_P);
334
335 #if BYTE_ORDER == LITTLE_ENDIAN
336                 reg_val &= ~(LIO_CN23XX_PKT_OUTPUT_CTL_ES_P);
337 #else   /* BYTE_ORDER != LITTLE_ENDIAN  */
338                 reg_val |= (LIO_CN23XX_PKT_OUTPUT_CTL_ES_P);
339 #endif  /* BYTE_ORDER == LITTLE_ENDIAN */
340
341                 /*
342                  * No Relaxed Ordering, No Snoop, 64-bit Byte swap for
343                  * Output Queue Data reset ROR, NSR
344                  */
345                 reg_val &= ~(LIO_CN23XX_PKT_OUTPUT_CTL_ROR);
346                 reg_val &= ~(LIO_CN23XX_PKT_OUTPUT_CTL_NSR);
347                 /* set the ES bit */
348                 reg_val |= (LIO_CN23XX_PKT_OUTPUT_CTL_ES);
349
350                 /* write all the selected settings */
351                 lio_write_csr32(oct, LIO_CN23XX_SLI_OQ_PKT_CONTROL(q_no),
352                                 reg_val);
353
354                 /*
355                  * Enabling these interrupt in oct->fn_list.enable_interrupt()
356                  * routine which called after IOQ init.
357                  * Set up interrupt packet and time thresholds
358                  * for all the OQs
359                  */
360                 time_threshold =lio_cn23xx_pf_get_oq_ticks(
361                        oct, (uint32_t)LIO_GET_OQ_INTR_TIME_CFG(cn23xx->conf));
362
363                 lio_write_csr64(oct, LIO_CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no),
364                                 (LIO_GET_OQ_INTR_PKT_CFG(cn23xx->conf) |
365                                  (time_threshold << 32)));
366         }
367
368         /* Setting the water mark level for pko back pressure * */
369         lio_write_csr64(oct, LIO_CN23XX_SLI_OQ_WMARK, 0x40);
370
371         /* Enable channel-level backpressure */
372         if (oct->pf_num)
373                 lio_write_csr64(oct, LIO_CN23XX_SLI_OUT_BP_EN2_W1S,
374                                 0xffffffffffffffffULL);
375         else
376                 lio_write_csr64(oct, LIO_CN23XX_SLI_OUT_BP_EN_W1S,
377                                 0xffffffffffffffffULL);
378 }
379
380 static int
381 lio_cn23xx_pf_setup_device_regs(struct octeon_device *oct)
382 {
383
384         lio_cn23xx_pf_enable_error_reporting(oct);
385
386         /* program the MAC(0..3)_RINFO before setting up input/output regs */
387         lio_cn23xx_pf_setup_global_mac_regs(oct);
388
389         if (lio_cn23xx_pf_setup_global_input_regs(oct))
390                 return (-1);
391
392         lio_cn23xx_pf_setup_global_output_regs(oct);
393
394         /*
395          * Default error timeout value should be 0x200000 to avoid host hang
396          * when reads invalid register
397          */
398         lio_write_csr64(oct, LIO_CN23XX_SLI_WINDOW_CTL,
399                         LIO_CN23XX_SLI_WINDOW_CTL_DEFAULT);
400
401         /* set SLI_PKT_IN_JABBER to handle large VXLAN packets */
402         lio_write_csr64(oct, LIO_CN23XX_SLI_PKT_IN_JABBER,
403                         LIO_CN23XX_MAX_INPUT_JABBER);
404         return (0);
405 }
406
407 static void
408 lio_cn23xx_pf_setup_iq_regs(struct octeon_device *oct, uint32_t iq_no)
409 {
410         struct lio_instr_queue  *iq = oct->instr_queue[iq_no];
411         uint64_t                pkt_in_done;
412
413         iq_no += oct->sriov_info.pf_srn;
414
415         /* Write the start of the input queue's ring and its size  */
416         lio_write_csr64(oct, LIO_CN23XX_SLI_IQ_BASE_ADDR64(iq_no),
417                         iq->base_addr_dma);
418         lio_write_csr32(oct, LIO_CN23XX_SLI_IQ_SIZE(iq_no), iq->max_count);
419
420         /*
421          * Remember the doorbell & instruction count register addr
422          * for this queue
423          */
424         iq->doorbell_reg = LIO_CN23XX_SLI_IQ_DOORBELL(iq_no);
425         iq->inst_cnt_reg = LIO_CN23XX_SLI_IQ_INSTR_COUNT64(iq_no);
426         lio_dev_dbg(oct, "InstQ[%d]:dbell reg @ 0x%x instcnt_reg @ 0x%x\n",
427                     iq_no, iq->doorbell_reg, iq->inst_cnt_reg);
428
429         /*
430          * Store the current instruction counter (used in flush_iq
431          * calculation)
432          */
433         pkt_in_done = lio_read_csr64(oct, iq->inst_cnt_reg);
434
435         if (oct->msix_on) {
436                 /* Set CINT_ENB to enable IQ interrupt   */
437                 lio_write_csr64(oct, iq->inst_cnt_reg,
438                                 (pkt_in_done | LIO_CN23XX_INTR_CINT_ENB));
439         } else {
440                 /*
441                  * Clear the count by writing back what we read, but don't
442                  * enable interrupts
443                  */
444                 lio_write_csr64(oct, iq->inst_cnt_reg, pkt_in_done);
445         }
446
447         iq->reset_instr_cnt = 0;
448 }
449
450 static void
451 lio_cn23xx_pf_setup_oq_regs(struct octeon_device *oct, uint32_t oq_no)
452 {
453         struct lio_droq         *droq = oct->droq[oq_no];
454         struct lio_cn23xx_pf    *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
455         uint64_t                cnt_threshold;
456         uint64_t                time_threshold;
457         uint32_t                reg_val;
458
459         oq_no += oct->sriov_info.pf_srn;
460
461         lio_write_csr64(oct, LIO_CN23XX_SLI_OQ_BASE_ADDR64(oq_no),
462                         droq->desc_ring_dma);
463         lio_write_csr32(oct, LIO_CN23XX_SLI_OQ_SIZE(oq_no), droq->max_count);
464
465         lio_write_csr32(oct, LIO_CN23XX_SLI_OQ_BUFF_INFO_SIZE(oq_no),
466                         droq->buffer_size);
467
468         /* pkt_sent and pkts_credit regs */
469         droq->pkts_sent_reg = LIO_CN23XX_SLI_OQ_PKTS_SENT(oq_no);
470         droq->pkts_credit_reg = LIO_CN23XX_SLI_OQ_PKTS_CREDIT(oq_no);
471
472         if (!oct->msix_on) {
473                 /*
474                  * Enable this output queue to generate Packet Timer
475                  * Interrupt
476                  */
477                 reg_val =
478                     lio_read_csr32(oct, LIO_CN23XX_SLI_OQ_PKT_CONTROL(oq_no));
479                 reg_val |= LIO_CN23XX_PKT_OUTPUT_CTL_TENB;
480                 lio_write_csr32(oct, LIO_CN23XX_SLI_OQ_PKT_CONTROL(oq_no),
481                                 reg_val);
482
483                 /*
484                  * Enable this output queue to generate Packet Count
485                  * Interrupt
486                  */
487                 reg_val =
488                     lio_read_csr32(oct, LIO_CN23XX_SLI_OQ_PKT_CONTROL(oq_no));
489                 reg_val |= LIO_CN23XX_PKT_OUTPUT_CTL_CENB;
490                 lio_write_csr32(oct, LIO_CN23XX_SLI_OQ_PKT_CONTROL(oq_no),
491                                 reg_val);
492         } else {
493                 time_threshold = lio_cn23xx_pf_get_oq_ticks(oct,
494                         (uint32_t)LIO_GET_OQ_INTR_TIME_CFG(cn23xx->conf));
495                 cnt_threshold = (uint32_t)LIO_GET_OQ_INTR_PKT_CFG(cn23xx->conf);
496
497                 lio_write_csr64(oct, LIO_CN23XX_SLI_OQ_PKT_INT_LEVELS(oq_no),
498                                 ((time_threshold << 32 | cnt_threshold)));
499         }
500 }
501
502
503 static int
504 lio_cn23xx_pf_enable_io_queues(struct octeon_device *oct)
505 {
506         uint64_t        reg_val;
507         uint32_t        ern, loop = BUSY_READING_REG_PF_LOOP_COUNT;
508         uint32_t        q_no, srn;
509
510         srn = oct->sriov_info.pf_srn;
511         ern = srn + oct->num_iqs;
512
513         for (q_no = srn; q_no < ern; q_no++) {
514                 /* set the corresponding IQ IS_64B bit */
515                 if (oct->io_qmask.iq64B & BIT_ULL(q_no - srn)) {
516                         reg_val = lio_read_csr64(oct,
517                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
518                         reg_val = reg_val | LIO_CN23XX_PKT_INPUT_CTL_IS_64B;
519                         lio_write_csr64(oct,
520                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
521                                         reg_val);
522                 }
523                 /* set the corresponding IQ ENB bit */
524                 if (oct->io_qmask.iq & BIT_ULL(q_no - srn)) {
525                         /*
526                          * IOQs are in reset by default in PEM2 mode,
527                          * clearing reset bit
528                          */
529                         reg_val = lio_read_csr64(oct,
530                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
531
532                         if (reg_val & LIO_CN23XX_PKT_INPUT_CTL_RST) {
533                                 while ((reg_val &
534                                         LIO_CN23XX_PKT_INPUT_CTL_RST) &&
535                                        !(reg_val &
536                                          LIO_CN23XX_PKT_INPUT_CTL_QUIET) &&
537                                        loop) {
538                                         reg_val = lio_read_csr64(oct,
539                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
540                                         loop--;
541                                 }
542                                 if (!loop) {
543                                         lio_dev_err(oct, "clearing the reset reg failed or setting the quiet reg failed for qno: %u\n",
544                                                     q_no);
545                                         return (-1);
546                                 }
547                                 reg_val = reg_val &
548                                         ~LIO_CN23XX_PKT_INPUT_CTL_RST;
549                                 lio_write_csr64(oct,
550                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
551                                         reg_val);
552
553                                 reg_val = lio_read_csr64(oct,
554                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
555                                 if (reg_val & LIO_CN23XX_PKT_INPUT_CTL_RST) {
556                                         lio_dev_err(oct, "clearing the reset failed for qno: %u\n",
557                                                     q_no);
558                                         return (-1);
559                                 }
560                         }
561                         reg_val = lio_read_csr64(oct,
562                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
563                         reg_val = reg_val | LIO_CN23XX_PKT_INPUT_CTL_RING_ENB;
564                         lio_write_csr64(oct,
565                                         LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
566                                         reg_val);
567                 }
568         }
569         for (q_no = srn; q_no < ern; q_no++) {
570                 uint32_t        reg_val;
571                 /* set the corresponding OQ ENB bit */
572                 if (oct->io_qmask.oq & BIT_ULL(q_no - srn)) {
573                         reg_val = lio_read_csr32(oct,
574                                         LIO_CN23XX_SLI_OQ_PKT_CONTROL(q_no));
575                         reg_val = reg_val | LIO_CN23XX_PKT_OUTPUT_CTL_RING_ENB;
576                         lio_write_csr32(oct,
577                                         LIO_CN23XX_SLI_OQ_PKT_CONTROL(q_no),
578                                         reg_val);
579                 }
580         }
581         return (0);
582 }
583
584 static void
585 lio_cn23xx_pf_disable_io_queues(struct octeon_device *oct)
586 {
587         volatile uint64_t       d64;
588         volatile uint32_t       d32;
589         int                     loop;
590         unsigned int            q_no;
591         uint32_t                ern, srn;
592
593         srn = oct->sriov_info.pf_srn;
594         ern = srn + oct->num_iqs;
595
596         /* Disable Input Queues. */
597         for (q_no = srn; q_no < ern; q_no++) {
598                 loop = lio_ms_to_ticks(1000);
599
600                 /* start the Reset for a particular ring */
601                 d64 = lio_read_csr64(oct,
602                                      LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
603                 d64 &= ~LIO_CN23XX_PKT_INPUT_CTL_RING_ENB;
604                 d64 |= LIO_CN23XX_PKT_INPUT_CTL_RST;
605                 lio_write_csr64(oct, LIO_CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
606                                 d64);
607
608                 /*
609                  * Wait until hardware indicates that the particular IQ
610                  * is out of reset.
611                  */
612                 d64 = lio_read_csr64(oct, LIO_CN23XX_SLI_PKT_IOQ_RING_RST);
613                 while (!(d64 & BIT_ULL(q_no)) && loop--) {
614                         d64 = lio_read_csr64(oct,
615                                              LIO_CN23XX_SLI_PKT_IOQ_RING_RST);
616                         lio_sleep_timeout(1);
617                         loop--;
618                 }
619
620                 /* Reset the doorbell register for this Input Queue. */
621                 lio_write_csr32(oct, LIO_CN23XX_SLI_IQ_DOORBELL(q_no),
622                                 0xFFFFFFFF);
623                 while (((lio_read_csr64(oct,
624                                         LIO_CN23XX_SLI_IQ_DOORBELL(q_no))) !=
625                         0ULL) && loop--) {
626                         lio_sleep_timeout(1);
627                 }
628         }
629
630         /* Disable Output Queues. */
631         for (q_no = srn; q_no < ern; q_no++) {
632                 loop = lio_ms_to_ticks(1000);
633
634                 /*
635                  * Wait until hardware indicates that the particular IQ
636                  * is out of reset.It given that SLI_PKT_RING_RST is
637                  * common for both IQs and OQs
638                  */
639                 d64 = lio_read_csr64(oct, LIO_CN23XX_SLI_PKT_IOQ_RING_RST);
640                 while (!(d64 & BIT_ULL(q_no)) && loop--) {
641                         d64 = lio_read_csr64(oct,
642                                              LIO_CN23XX_SLI_PKT_IOQ_RING_RST);
643                         lio_sleep_timeout(1);
644                         loop--;
645                 }
646
647                 /* Reset the doorbell register for this Output Queue. */
648                 lio_write_csr32(oct, LIO_CN23XX_SLI_OQ_PKTS_CREDIT(q_no),
649                                 0xFFFFFFFF);
650                 while ((lio_read_csr64(oct,
651                                        LIO_CN23XX_SLI_OQ_PKTS_CREDIT(q_no)) !=
652                         0ULL) && loop--) {
653                         lio_sleep_timeout(1);
654                 }
655
656                 /* clear the SLI_PKT(0..63)_CNTS[CNT] reg value */
657                 d32 = lio_read_csr32(oct, LIO_CN23XX_SLI_OQ_PKTS_SENT(q_no));
658                 lio_write_csr32(oct, LIO_CN23XX_SLI_OQ_PKTS_SENT(q_no), d32);
659         }
660 }
661
662 static uint64_t
663 lio_cn23xx_pf_msix_interrupt_handler(void *dev)
664 {
665         struct lio_ioq_vector   *ioq_vector = (struct lio_ioq_vector *)dev;
666         struct octeon_device    *oct = ioq_vector->oct_dev;
667         struct lio_droq         *droq = oct->droq[ioq_vector->droq_index];
668         uint64_t                pkts_sent;
669         uint64_t                ret = 0;
670
671         if (droq == NULL) {
672                 lio_dev_err(oct, "23XX bringup FIXME: oct pfnum:%d ioq_vector->ioq_num :%d droq is NULL\n",
673                             oct->pf_num, ioq_vector->ioq_num);
674                 return (0);
675         }
676         pkts_sent = lio_read_csr64(oct, droq->pkts_sent_reg);
677
678         /*
679          * If our device has interrupted, then proceed. Also check
680          * for all f's if interrupt was triggered on an error
681          * and the PCI read fails.
682          */
683         if (!pkts_sent || (pkts_sent == 0xFFFFFFFFFFFFFFFFULL))
684                 return (ret);
685
686         /* Write count reg in sli_pkt_cnts to clear these int. */
687         if (pkts_sent & LIO_CN23XX_INTR_PO_INT)
688                 ret |= LIO_MSIX_PO_INT;
689
690         if (pkts_sent & LIO_CN23XX_INTR_PI_INT)
691                 /* We will clear the count when we update the read_index. */
692                 ret |= LIO_MSIX_PI_INT;
693
694         /*
695          * Never need to handle msix mbox intr for pf. They arrive on the last
696          * msix
697          */
698         return (ret);
699 }
700
701 static void
702 lio_cn23xx_pf_interrupt_handler(void *dev)
703 {
704         struct octeon_device    *oct = (struct octeon_device *)dev;
705         struct lio_cn23xx_pf    *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
706         uint64_t                intr64;
707
708         lio_dev_dbg(oct, "In %s octeon_dev @ %p\n", __func__, oct);
709         intr64 = lio_read_csr64(oct, cn23xx->intr_sum_reg64);
710
711         oct->int_status = 0;
712
713         if (intr64 & LIO_CN23XX_INTR_ERR)
714                 lio_dev_err(oct, "Error Intr: 0x%016llx\n",
715                             LIO_CAST64(intr64));
716
717         if (oct->msix_on != LIO_FLAG_MSIX_ENABLED) {
718                 if (intr64 & LIO_CN23XX_INTR_PKT_DATA)
719                         oct->int_status |= LIO_DEV_INTR_PKT_DATA;
720         }
721
722         if (intr64 & (LIO_CN23XX_INTR_DMA0_FORCE))
723                 oct->int_status |= LIO_DEV_INTR_DMA0_FORCE;
724
725         if (intr64 & (LIO_CN23XX_INTR_DMA1_FORCE))
726                 oct->int_status |= LIO_DEV_INTR_DMA1_FORCE;
727
728         /* Clear the current interrupts */
729         lio_write_csr64(oct, cn23xx->intr_sum_reg64, intr64);
730 }
731
732 static void
733 lio_cn23xx_pf_bar1_idx_setup(struct octeon_device *oct, uint64_t core_addr,
734                              uint32_t idx, int valid)
735 {
736         volatile uint64_t       bar1;
737         uint64_t                reg_adr;
738
739         if (!valid) {
740                 reg_adr = lio_pci_readq(oct,
741                                 LIO_CN23XX_PEM_BAR1_INDEX_REG(oct->pcie_port,
742                                                               idx));
743                 bar1 = reg_adr;
744                 lio_pci_writeq(oct, (bar1 & 0xFFFFFFFEULL),
745                                LIO_CN23XX_PEM_BAR1_INDEX_REG(oct->pcie_port,
746                                                              idx));
747                 reg_adr = lio_pci_readq(oct,
748                                 LIO_CN23XX_PEM_BAR1_INDEX_REG(oct->pcie_port,
749                                                               idx));
750                 bar1 = reg_adr;
751                 return;
752         }
753         /*
754          *  The PEM(0..3)_BAR1_INDEX(0..15)[ADDR_IDX]<23:4> stores
755          *  bits <41:22> of the Core Addr
756          */
757         lio_pci_writeq(oct, (((core_addr >> 22) << 4) | LIO_PCI_BAR1_MASK),
758                        LIO_CN23XX_PEM_BAR1_INDEX_REG(oct->pcie_port, idx));
759
760         bar1 = lio_pci_readq(oct, LIO_CN23XX_PEM_BAR1_INDEX_REG(oct->pcie_port,
761                                                                 idx));
762 }
763
764 static void
765 lio_cn23xx_pf_bar1_idx_write(struct octeon_device *oct, uint32_t idx,
766                              uint32_t mask)
767 {
768
769         lio_pci_writeq(oct, mask,
770                        LIO_CN23XX_PEM_BAR1_INDEX_REG(oct->pcie_port, idx));
771 }
772
773 static uint32_t
774 lio_cn23xx_pf_bar1_idx_read(struct octeon_device *oct, uint32_t idx)
775 {
776
777         return ((uint32_t)lio_pci_readq(oct,
778                                 LIO_CN23XX_PEM_BAR1_INDEX_REG(oct->pcie_port,
779                                                               idx)));
780 }
781
782 /* always call with lock held */
783 static uint32_t
784 lio_cn23xx_pf_update_read_index(struct lio_instr_queue *iq)
785 {
786         struct octeon_device    *oct = iq->oct_dev;
787         uint32_t        new_idx;
788         uint32_t        last_done;
789         uint32_t        pkt_in_done = lio_read_csr32(oct, iq->inst_cnt_reg);
790
791         last_done = pkt_in_done - iq->pkt_in_done;
792         iq->pkt_in_done = pkt_in_done;
793
794         /*
795          * Modulo of the new index with the IQ size will give us
796          * the new index.  The iq->reset_instr_cnt is always zero for
797          * cn23xx, so no extra adjustments are needed.
798          */
799         new_idx = (iq->octeon_read_index +
800                    ((uint32_t)(last_done & LIO_CN23XX_PKT_IN_DONE_CNT_MASK))) %
801             iq->max_count;
802
803         return (new_idx);
804 }
805
806 static void
807 lio_cn23xx_pf_enable_interrupt(struct octeon_device *oct, uint8_t intr_flag)
808 {
809         struct lio_cn23xx_pf    *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
810         uint64_t                intr_val = 0;
811
812         /* Divide the single write to multiple writes based on the flag. */
813         /* Enable Interrupt */
814         if (intr_flag == OCTEON_ALL_INTR) {
815                 lio_write_csr64(oct, cn23xx->intr_enb_reg64,
816                                 cn23xx->intr_mask64);
817         } else if (intr_flag & OCTEON_OUTPUT_INTR) {
818                 intr_val = lio_read_csr64(oct, cn23xx->intr_enb_reg64);
819                 intr_val |= LIO_CN23XX_INTR_PKT_DATA;
820                 lio_write_csr64(oct, cn23xx->intr_enb_reg64, intr_val);
821         }
822 }
823
824 static void
825 lio_cn23xx_pf_disable_interrupt(struct octeon_device *oct, uint8_t intr_flag)
826 {
827         struct lio_cn23xx_pf    *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
828         uint64_t                intr_val = 0;
829
830         /* Disable Interrupts */
831         if (intr_flag == OCTEON_ALL_INTR) {
832                 lio_write_csr64(oct, cn23xx->intr_enb_reg64, 0);
833         } else if (intr_flag & OCTEON_OUTPUT_INTR) {
834                 intr_val = lio_read_csr64(oct, cn23xx->intr_enb_reg64);
835                 intr_val &= ~LIO_CN23XX_INTR_PKT_DATA;
836                 lio_write_csr64(oct, cn23xx->intr_enb_reg64, intr_val);
837         }
838 }
839
840 static void
841 lio_cn23xx_pf_get_pcie_qlmport(struct octeon_device *oct)
842 {
843         oct->pcie_port = (lio_read_csr32(oct,
844                                          LIO_CN23XX_SLI_MAC_NUMBER)) & 0xff;
845
846         lio_dev_dbg(oct, "CN23xx uses PCIE Port %d\n",
847                     oct->pcie_port);
848 }
849
850 static void
851 lio_cn23xx_pf_get_pf_num(struct octeon_device *oct)
852 {
853         uint32_t        fdl_bit;
854
855         /* Read Function Dependency Link reg to get the function number */
856         fdl_bit = lio_read_pci_cfg(oct, LIO_CN23XX_PCIE_SRIOV_FDL);
857         oct->pf_num = ((fdl_bit >> LIO_CN23XX_PCIE_SRIOV_FDL_BIT_POS) &
858                        LIO_CN23XX_PCIE_SRIOV_FDL_MASK);
859 }
860
861 static void
862 lio_cn23xx_pf_setup_reg_address(struct octeon_device *oct)
863 {
864         struct lio_cn23xx_pf    *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
865
866         oct->reg_list.pci_win_wr_addr = LIO_CN23XX_SLI_WIN_WR_ADDR64;
867
868         oct->reg_list.pci_win_rd_addr_hi = LIO_CN23XX_SLI_WIN_RD_ADDR_HI;
869         oct->reg_list.pci_win_rd_addr_lo = LIO_CN23XX_SLI_WIN_RD_ADDR64;
870         oct->reg_list.pci_win_rd_addr = LIO_CN23XX_SLI_WIN_RD_ADDR64;
871
872         oct->reg_list.pci_win_wr_data_hi = LIO_CN23XX_SLI_WIN_WR_DATA_HI;
873         oct->reg_list.pci_win_wr_data_lo = LIO_CN23XX_SLI_WIN_WR_DATA_LO;
874         oct->reg_list.pci_win_wr_data = LIO_CN23XX_SLI_WIN_WR_DATA64;
875
876         oct->reg_list.pci_win_rd_data = LIO_CN23XX_SLI_WIN_RD_DATA64;
877
878         lio_cn23xx_pf_get_pcie_qlmport(oct);
879
880         cn23xx->intr_mask64 = LIO_CN23XX_INTR_MASK;
881         if (!oct->msix_on)
882                 cn23xx->intr_mask64 |= LIO_CN23XX_INTR_PKT_TIME;
883
884         cn23xx->intr_sum_reg64 =
885             LIO_CN23XX_SLI_MAC_PF_INT_SUM64(oct->pcie_port, oct->pf_num);
886         cn23xx->intr_enb_reg64 =
887             LIO_CN23XX_SLI_MAC_PF_INT_ENB64(oct->pcie_port, oct->pf_num);
888 }
889
890 static int
891 lio_cn23xx_pf_sriov_config(struct octeon_device *oct)
892 {
893         struct lio_cn23xx_pf    *cn23xx = (struct lio_cn23xx_pf *)oct->chip;
894         uint32_t                num_pf_rings, total_rings, max_rings;
895         cn23xx->conf = (struct lio_config *)lio_get_config_info(oct, LIO_23XX);
896
897         max_rings = LIO_CN23XX_PF_MAX_RINGS;
898
899         if (oct->sriov_info.num_pf_rings) {
900                 num_pf_rings = oct->sriov_info.num_pf_rings;
901                 if (num_pf_rings > max_rings) {
902                         num_pf_rings = min(mp_ncpus, max_rings);
903                         lio_dev_warn(oct, "num_queues_per_pf requested %u is more than available rings (%u). Reducing to %u\n",
904                                      oct->sriov_info.num_pf_rings,
905                                      max_rings, num_pf_rings);
906                 }
907         } else {
908 #ifdef RSS
909                 num_pf_rings = min(rss_getnumbuckets(), mp_ncpus);
910 #else
911                 num_pf_rings = min(mp_ncpus, max_rings);
912 #endif
913
914         }
915
916         total_rings = num_pf_rings;
917         oct->sriov_info.trs = total_rings;
918         oct->sriov_info.pf_srn = total_rings - num_pf_rings;
919         oct->sriov_info.num_pf_rings = num_pf_rings;
920
921         lio_dev_dbg(oct, "trs:%d pf_srn:%d num_pf_rings:%d\n",
922                     oct->sriov_info.trs, oct->sriov_info.pf_srn,
923                     oct->sriov_info.num_pf_rings);
924
925         return (0);
926 }
927
928 int
929 lio_cn23xx_pf_setup_device(struct octeon_device *oct)
930 {
931         uint64_t        BAR0, BAR1;
932         uint32_t        data32;
933
934         data32 = lio_read_pci_cfg(oct, 0x10);
935         BAR0 = (uint64_t)(data32 & ~0xf);
936         data32 = lio_read_pci_cfg(oct, 0x14);
937         BAR0 |= ((uint64_t)data32 << 32);
938         data32 = lio_read_pci_cfg(oct, 0x18);
939         BAR1 = (uint64_t)(data32 & ~0xf);
940         data32 = lio_read_pci_cfg(oct, 0x1c);
941         BAR1 |= ((uint64_t)data32 << 32);
942
943         if (!BAR0 || !BAR1) {
944                 if (!BAR0)
945                         lio_dev_err(oct, "Device BAR0 unassigned\n");
946
947                 if (!BAR1)
948                         lio_dev_err(oct, "Device BAR1 unassigned\n");
949
950                 return (1);
951         }
952
953         if (lio_map_pci_barx(oct, 0))
954                 return (1);
955
956         if (lio_map_pci_barx(oct, 1)) {
957                 lio_dev_err(oct, "%s CN23XX BAR1 map failed\n", __func__);
958                 lio_unmap_pci_barx(oct, 0);
959                 return (1);
960         }
961
962         lio_cn23xx_pf_get_pf_num(oct); 
963
964         if (lio_cn23xx_pf_sriov_config(oct)) {
965                 lio_unmap_pci_barx(oct, 0);
966                 lio_unmap_pci_barx(oct, 1);
967                 return (1);
968         }
969         lio_write_csr64(oct, LIO_CN23XX_SLI_MAC_CREDIT_CNT,
970                         0x3F802080802080ULL);
971
972         oct->fn_list.setup_iq_regs = lio_cn23xx_pf_setup_iq_regs;
973         oct->fn_list.setup_oq_regs = lio_cn23xx_pf_setup_oq_regs;
974         oct->fn_list.process_interrupt_regs = lio_cn23xx_pf_interrupt_handler;
975         oct->fn_list.msix_interrupt_handler =
976                 lio_cn23xx_pf_msix_interrupt_handler;
977
978         oct->fn_list.soft_reset = lio_cn23xx_pf_soft_reset;
979         oct->fn_list.setup_device_regs = lio_cn23xx_pf_setup_device_regs;
980         oct->fn_list.update_iq_read_idx = lio_cn23xx_pf_update_read_index;
981
982         oct->fn_list.bar1_idx_setup = lio_cn23xx_pf_bar1_idx_setup;
983         oct->fn_list.bar1_idx_write = lio_cn23xx_pf_bar1_idx_write;
984         oct->fn_list.bar1_idx_read = lio_cn23xx_pf_bar1_idx_read;
985
986         oct->fn_list.enable_interrupt = lio_cn23xx_pf_enable_interrupt;
987         oct->fn_list.disable_interrupt = lio_cn23xx_pf_disable_interrupt;
988
989         oct->fn_list.enable_io_queues = lio_cn23xx_pf_enable_io_queues;
990         oct->fn_list.disable_io_queues = lio_cn23xx_pf_disable_io_queues;
991
992         lio_cn23xx_pf_setup_reg_address(oct);
993
994         oct->coproc_clock_rate = 1000000ULL *
995                 lio_cn23xx_pf_coprocessor_clock(oct);
996
997         return (0);
998 }
999
1000 int
1001 lio_cn23xx_pf_fw_loaded(struct octeon_device *oct)
1002 {
1003         uint64_t        val;
1004
1005         val = lio_read_csr64(oct, LIO_CN23XX_SLI_SCRATCH2);
1006         return ((val >> SCR2_BIT_FW_LOADED) & 1ULL);
1007 }
1008