2 * Copyright (c) 2003-2012 Broadcom Corporation
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in
13 * the documentation and/or other materials provided with the
16 * THIS SOFTWARE IS PROVIDED BY BROADCOM ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
18 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL BROADCOM OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
23 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
25 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
26 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31 #include <sys/types.h>
32 #include <sys/systm.h>
34 #include <mips/nlm/hal/mips-extns.h>
35 #include <mips/nlm/hal/haldefs.h>
36 #include <mips/nlm/hal/iomap.h>
37 #include <mips/nlm/hal/sys.h>
38 #include <mips/nlm/hal/nae.h>
39 #include <mips/nlm/hal/mdio.h>
40 #include <mips/nlm/hal/sgmii.h>
41 #include <mips/nlm/hal/xaui.h>
43 #include <mips/nlm/board.h>
44 #include <mips/nlm/xlp.h>
47 nlm_nae_flush_free_fifo(uint64_t nae_base, int nblocks)
49 uint32_t data, fifo_mask;
51 fifo_mask = (1 << (4 * nblocks)) - 1;
53 nlm_write_nae_reg(nae_base, NAE_RX_FREE_FIFO_POP, fifo_mask);
55 data = nlm_read_nae_reg(nae_base, NAE_RX_FREE_FIFO_POP);
56 } while (data != fifo_mask);
58 nlm_write_nae_reg(nae_base, NAE_RX_FREE_FIFO_POP, 0);
62 nlm_program_nae_parser_seq_fifo(uint64_t nae_base, int maxports,
63 struct nae_port_config *cfg)
66 int start = 0, size, i;
68 for (i = 0; i < maxports; i++) {
69 size = cfg[i].pseq_fifo_size;
70 val = (((size & 0x1fff) << 17) |
71 ((start & 0xfff) << 5) |
73 nlm_write_nae_reg(nae_base, NAE_PARSER_SEQ_FIFO_CFG, val);
79 nlm_setup_rx_cal_cfg(uint64_t nae_base, int total_num_ports,
80 struct nae_port_config *cfg)
82 int rx_slots = 0, port;
83 int cal_len, cal = 0, last_free = 0;
86 for (port = 0; port < total_num_ports; port++) {
87 if (cfg[port].rx_slots_reqd)
88 rx_slots += cfg[port].rx_slots_reqd;
89 if (rx_slots > MAX_CAL_SLOTS) {
90 rx_slots = MAX_CAL_SLOTS;
95 cal_len = rx_slots - 1;
98 if (cal >= MAX_CAL_SLOTS)
101 for (port = 0; port < total_num_ports; port++) {
102 if (cfg[port].rx_slots_reqd > 0) {
103 val = (cal_len << 16) | (port << 8) | cal;
104 nlm_write_nae_reg(nae_base,
105 NAE_RX_IF_SLOT_CAL, val);
107 cfg[port].rx_slots_reqd--;
110 if (last_free == cal)
116 nlm_setup_tx_cal_cfg(uint64_t nae_base, int total_num_ports,
117 struct nae_port_config *cfg)
119 int tx_slots = 0, port;
120 int cal = 0, last_free = 0;
123 for (port = 0; port < total_num_ports; port++) {
124 if (cfg[port].tx_slots_reqd)
125 tx_slots += cfg[port].tx_slots_reqd;
126 if (tx_slots > MAX_CAL_SLOTS) {
127 tx_slots = MAX_CAL_SLOTS;
132 nlm_write_nae_reg(nae_base, NAE_EGR_NIOR_CAL_LEN_REG, tx_slots - 1);
134 if (cal >= MAX_CAL_SLOTS)
137 for (port = 0; port < total_num_ports; port++) {
138 if (cfg[port].tx_slots_reqd > 0) {
139 val = (port << 7) | (cal << 1) | 1;
140 nlm_write_nae_reg(nae_base,
141 NAE_EGR_NIOR_CRDT_CAL_PROG, val);
143 cfg[port].tx_slots_reqd--;
146 if (last_free == cal)
152 nlm_deflate_frin_fifo_carving(uint64_t nae_base, int total_num_ports)
154 const int minimum_size = 8;
158 for (intf = 0; intf < total_num_ports; intf++) {
159 start = minimum_size * intf;
160 value = (minimum_size << 20) | (start << 8) | (intf);
161 nlm_write_nae_reg(nae_base, NAE_FREE_IN_FIFO_CFG, value);
166 nlm_reset_nae(int node)
170 uint64_t nae_pcibase;
175 sysbase = nlm_get_sys_regbase(node);
176 nae_base = nlm_get_nae_regbase(node);
177 nae_pcibase = nlm_get_nae_pcibase(node);
179 bar0 = nlm_read_pci_reg(nae_pcibase, XLP_PCI_CFGREG4);
181 #if BYTE_ORDER == LITTLE_ENDIAN
182 if (nlm_is_xlp8xx_ax()) {
185 val = (bar0 >> 24) & 0xff;
186 bar0 = (val << 24) | (val << 16) | (val << 8) | val;
196 nlm_write_sys_reg(sysbase, SYS_RESET, (1 << reset_bit));
198 /* XXXJC - 1s delay here may be too high */
200 nlm_write_sys_reg(sysbase, SYS_RESET, (0 << reset_bit));
203 rx_config = nlm_read_nae_reg(nae_base, NAE_RX_CONFIG);
204 nlm_write_pci_reg(nae_pcibase, XLP_PCI_CFGREG4, bar0);
208 nlm_setup_poe_class_config(uint64_t nae_base, int max_poe_classes,
209 int num_contexts, int *poe_cl_tbl)
212 int i, max_poe_class_ctxt_tbl_sz;
214 max_poe_class_ctxt_tbl_sz = num_contexts/max_poe_classes;
215 for (i = 0; i < max_poe_class_ctxt_tbl_sz; i++) {
216 val = (poe_cl_tbl[(i/max_poe_classes) & 0x7] << 8) | i;
217 nlm_write_nae_reg(nae_base, NAE_POE_CLASS_SETUP_CFG, val);
222 nlm_setup_vfbid_mapping(uint64_t nae_base)
227 /* 127 is max vfbid */
228 for (vfbid = 127; vfbid >= 0; vfbid--) {
229 dest_vc = nlm_get_vfbid_mapping(vfbid);
232 val = (dest_vc << 16) | (vfbid << 4) | 1;
233 nlm_write_nae_reg(nae_base, NAE_VFBID_DESTMAP_CMD, val);
238 nlm_setup_flow_crc_poly(uint64_t nae_base, uint32_t poly)
240 nlm_write_nae_reg(nae_base, NAE_FLOW_CRC16_POLY_CFG, poly);
244 nlm_setup_iface_fifo_cfg(uint64_t nae_base, int maxports,
245 struct nae_port_config *cfg)
248 int fifo_xoff_thresh = 12;
250 int cur_iface_start = 0;
252 for (i = 0; i < maxports; i++) {
253 size = cfg[i].iface_fifo_size;
254 reg = ((fifo_xoff_thresh << 25) |
255 ((size & 0x1ff) << 16) |
256 ((cur_iface_start & 0xff) << 8) |
258 nlm_write_nae_reg(nae_base, NAE_IFACE_FIFO_CFG, reg);
259 cur_iface_start += size;
264 nlm_setup_rx_base_config(uint64_t nae_base, int maxports,
265 struct nae_port_config *cfg)
272 for (i = 0; i < (maxports/2); i++) {
273 id = 0x12 + i; /* RX_IF_BASE_CONFIG0 */
275 val = (base & 0x3ff);
276 base += cfg[(i * 2)].num_channels;
278 val |= ((base & 0x3ff) << 16);
279 base += cfg[(i * 2) + 1].num_channels;
281 nlm_write_nae_reg(nae_base, NAE_REG(7, 0, id), val);
286 nlm_setup_rx_buf_config(uint64_t nae_base, int maxports,
287 struct nae_port_config *cfg)
294 for (i = 0; i < maxports; i++) {
295 if (cfg[i].type == UNKNOWN)
297 for (k = 0; k < cfg[i].num_channels; k++) {
298 /* write index (context num) */
299 nlm_write_nae_reg(nae_base, NAE_RXBUF_BASE_DPTH_ADDR,
302 /* write value (rx buf sizes) */
303 sz = cfg[i].rxbuf_size;
304 val = 0x80000000 | ((base << 2) & 0x3fff); /* base */
305 val |= (((sz << 2) & 0x3fff) << 16); /* size */
307 nlm_write_nae_reg(nae_base, NAE_RXBUF_BASE_DPTH, val);
308 nlm_write_nae_reg(nae_base, NAE_RXBUF_BASE_DPTH,
312 context += cfg[i].num_channels;
317 nlm_setup_freein_fifo_cfg(uint64_t nae_base, struct nae_port_config *cfg)
321 int start = 0, maxbufpool;
324 maxbufpool = MAX_FREE_FIFO_POOL_8XX;
326 maxbufpool = MAX_FREE_FIFO_POOL_3XX;
327 for (i = 0; i < maxbufpool; i++) {
328 /* Each entry represents 2 descs; hence division by 2 */
329 size = (cfg[i].num_free_descs / 2);
332 reg = ((size & 0x3ff ) << 20) | /* fcSize */
333 ((start & 0x1ff) << 8) | /* fcStart */
336 nlm_write_nae_reg(nae_base, NAE_FREE_IN_FIFO_CFG, reg);
341 /* XXX function name */
343 nlm_get_flow_mask(int num_ports)
345 const int max_bits = 5; /* upto 32 ports */
348 /* Compute the number of bits to needed to
349 * represent all the ports */
350 for (i = 0; i < max_bits; i++) {
351 if (num_ports <= (2 << i))
358 nlm_program_flow_cfg(uint64_t nae_base, int port,
359 uint32_t cur_flow_base, uint32_t flow_mask)
363 val = (cur_flow_base << 16) | port;
364 val |= ((flow_mask & 0x1f) << 8);
365 nlm_write_nae_reg(nae_base, NAE_FLOW_BASEMASK_CFG, val);
369 xlp_ax_nae_lane_reset_txpll(uint64_t nae_base, int block, int lane_ctrl,
372 uint32_t val = 0, saved_data;
375 val = PHY_LANE_CTRL_RST |
376 PHY_LANE_CTRL_PWRDOWN |
377 (mode << PHY_LANE_CTRL_PHYMODE_POS);
379 /* set comma bypass for XAUI */
380 if (mode != PHYMODE_SGMII)
381 val |= PHY_LANE_CTRL_BPC_XAUI;
383 nlm_write_nae_reg(nae_base, NAE_REG(block, PHY, lane_ctrl), val);
385 if (lane_ctrl != 4) {
386 rext_sel = (1 << 23);
387 if (mode != PHYMODE_SGMII)
388 rext_sel |= PHY_LANE_CTRL_BPC_XAUI;
390 val = nlm_read_nae_reg(nae_base,
391 NAE_REG(block, PHY, lane_ctrl));
392 val &= ~PHY_LANE_CTRL_RST;
395 /* Resetting PMA for non-zero lanes */
396 nlm_write_nae_reg(nae_base,
397 NAE_REG(block, PHY, lane_ctrl), val);
399 DELAY(20000); /* 20 ms delay, XXXJC: needed? */
401 val |= PHY_LANE_CTRL_RST;
402 nlm_write_nae_reg(nae_base,
403 NAE_REG(block, PHY, lane_ctrl), val);
408 /* Come out of reset for TXPLL */
409 saved_data = nlm_read_nae_reg(nae_base,
410 NAE_REG(block, PHY, lane_ctrl)) & 0xFFC00000;
412 nlm_write_nae_reg(nae_base,
413 NAE_REG(block, PHY, lane_ctrl),
414 (0x66 << PHY_LANE_CTRL_ADDR_POS)
415 | PHY_LANE_CTRL_CMD_READ
416 | PHY_LANE_CTRL_CMD_START
421 while (((val = nlm_read_nae_reg(nae_base,
422 NAE_REG(block, PHY, lane_ctrl))) &
423 PHY_LANE_CTRL_CMD_PENDING));
426 /* set bit[4] to 0 */
428 nlm_write_nae_reg(nae_base,
429 NAE_REG(block, PHY, lane_ctrl),
430 (0x66 << PHY_LANE_CTRL_ADDR_POS)
431 | PHY_LANE_CTRL_CMD_WRITE
432 | PHY_LANE_CTRL_CMD_START
433 | (0x0 << 19) /* (0x4 << 19) */
439 nlm_write_nae_reg(nae_base,
440 NAE_REG(block, PHY, lane_ctrl),
441 (0x66 << PHY_LANE_CTRL_ADDR_POS)
442 | PHY_LANE_CTRL_CMD_WRITE
443 | PHY_LANE_CTRL_CMD_START
444 | (0x0 << 19) /* (0x4 << 19) */
449 while (!((val = nlm_read_nae_reg(nae_base,
450 NAE_REG(block, PHY, (lane_ctrl - PHY_LANE_0_CTRL)))) &
453 /* Clear the Power Down bit */
454 val = nlm_read_nae_reg(nae_base, NAE_REG(block, PHY, lane_ctrl));
455 val &= ~((1 << 29) | (0x7ffff));
456 nlm_write_nae_reg(nae_base, NAE_REG(block, PHY, lane_ctrl),
461 xlp_nae_lane_reset_txpll(uint64_t nae_base, int block, int lane_ctrl,
468 rext_sel = (1 << 23);
470 val = nlm_read_nae_reg(nae_base,
471 NAE_REG(block, PHY, lane_ctrl));
473 /* set comma bypass for XAUI */
474 if (mode != PHYMODE_SGMII)
475 val |= PHY_LANE_CTRL_BPC_XAUI;
477 val |= (mode << PHY_LANE_CTRL_PHYMODE_POS);
479 nlm_write_nae_reg(nae_base,
480 NAE_REG(block, PHY, lane_ctrl), val);
482 val = nlm_read_nae_reg(nae_base,
483 NAE_REG(block, PHY, lane_ctrl));
485 nlm_write_nae_reg(nae_base,
486 NAE_REG(block, PHY, lane_ctrl), val);
488 /* clear the power down bit */
489 val = nlm_read_nae_reg(nae_base,
490 NAE_REG(block, PHY, lane_ctrl));
491 val &= ~( (1 << 29) | (0x7ffff));
492 nlm_write_nae_reg(nae_base,
493 NAE_REG(block, PHY, lane_ctrl), rext_sel | val);
497 xlp_nae_config_lane_gmac(uint64_t nae_base, int cplx_mask)
499 int block, lane_ctrl;
500 int cplx_lane_enable;
503 cplx_lane_enable = LM_SGMII |
508 /* Lane mode progamming */
513 lane_enable |= cplx_lane_enable;
516 lane_enable |= (cplx_lane_enable << 16);
519 nlm_write_nae_reg(nae_base,
520 NAE_REG(block, LANE_CFG, LANE_CFG_CPLX_0_1),
526 lane_enable |= cplx_lane_enable;
529 lane_enable |= (cplx_lane_enable << 16);
531 nlm_write_nae_reg(nae_base,
532 NAE_REG(block, LANE_CFG, LANE_CFG_CPLX_2_3),
536 /* XXXJC : fix duplicate code */
537 if (cplx_mask & 0x10) {
538 nlm_write_nae_reg(nae_base,
539 NAE_REG(block, LANE_CFG, LANE_CFG_CPLX_4),
540 ((LM_SGMII << 4) | LM_SGMII));
541 for (lane_ctrl = PHY_LANE_0_CTRL;
542 lane_ctrl <= PHY_LANE_1_CTRL; lane_ctrl++) {
543 if (!nlm_is_xlp8xx_ax())
544 xlp_nae_lane_reset_txpll(nae_base,
545 4, lane_ctrl, PHYMODE_SGMII);
547 xlp_ax_nae_lane_reset_txpll(nae_base, 4,
548 lane_ctrl, PHYMODE_SGMII);
552 for (block = 0; block < 4; block++) {
553 if ((cplx_mask & (1 << block)) == 0)
556 for (lane_ctrl = PHY_LANE_0_CTRL;
557 lane_ctrl <= PHY_LANE_3_CTRL; lane_ctrl++) {
558 if (!nlm_is_xlp8xx_ax())
559 xlp_nae_lane_reset_txpll(nae_base,
560 block, lane_ctrl, PHYMODE_SGMII);
562 xlp_ax_nae_lane_reset_txpll(nae_base, block,
563 lane_ctrl, PHYMODE_SGMII);
569 config_egress_fifo_carvings(uint64_t nae_base, int hwport, int start_ctxt,
570 int num_ctxts, int max_ctxts, struct nae_port_config *cfg)
572 static uint32_t cur_start[6] = {0, 0, 0, 0, 0, 0};
574 uint32_t start = 0, size, offset;
577 limit = start_ctxt + num_ctxts;
579 start = cur_start[0];
580 for (i = start_ctxt; i < limit; i++) {
581 size = cfg[hwport].stg2_fifo_size / max_ctxts;
586 if (offset > cfg[hwport].max_stg2_offset)
587 offset = cfg[hwport].max_stg2_offset;
588 data = offset << 23 |
592 nlm_write_nae_reg(nae_base, NAE_STG2_PMEM_PROG, data);
595 cur_start[0] = start;
598 start = cur_start[1];
599 for (i = start_ctxt; i < limit; i++) {
600 size = cfg[hwport].eh_fifo_size / max_ctxts;
605 if (offset > cfg[hwport].max_eh_offset)
606 offset = cfg[hwport].max_eh_offset;
607 data = offset << 23 |
611 nlm_write_nae_reg(nae_base, NAE_EH_PMEM_PROG, data);
614 cur_start[1] = start;
617 start = cur_start[2];
618 for (i = start_ctxt; i < limit; i++) {
619 size = cfg[hwport].frout_fifo_size / max_ctxts;
624 if (offset > cfg[hwport].max_frout_offset)
625 offset = cfg[hwport].max_frout_offset;
626 data = offset << 23 |
630 nlm_write_nae_reg(nae_base, NAE_FREE_PMEM_PROG, data);
633 cur_start[2] = start;
636 start = cur_start[3];
637 for (i = start_ctxt; i < limit; i++) {
638 size = cfg[hwport].ms_fifo_size / max_ctxts;
643 if (offset > cfg[hwport].max_ms_offset)
644 offset = cfg[hwport].max_ms_offset;
645 data = offset << 22 | /* FIXME in PRM */
649 nlm_write_nae_reg(nae_base, NAE_STR_PMEM_CMD, data);
652 cur_start[3] = start;
655 start = cur_start[4];
656 for (i = start_ctxt; i < limit; i++) {
657 size = cfg[hwport].pkt_fifo_size / max_ctxts;
662 if (offset > cfg[hwport].max_pmem_offset)
663 offset = cfg[hwport].max_pmem_offset;
664 nlm_write_nae_reg(nae_base, NAE_TX_PKT_PMEM_CMD1, offset);
669 nlm_write_nae_reg(nae_base, NAE_TX_PKT_PMEM_CMD0, data);
672 cur_start[4] = start;
675 start = cur_start[5];
676 for (i = start_ctxt; i < limit; i++) {
677 size = cfg[hwport].pktlen_fifo_size / max_ctxts;
682 data = offset << 22 |
686 nlm_write_nae_reg(nae_base, NAE_TX_PKTLEN_PMEM_CMD, data);
689 cur_start[5] = start;
693 config_egress_fifo_credits(uint64_t nae_base, int hwport, int start_ctxt,
694 int num_ctxts, int max_ctxts, struct nae_port_config *cfg)
696 uint32_t data, credit, max_credit;
699 limit = start_ctxt + num_ctxts;
700 /* Stage1 -> Stage2 */
701 max_credit = cfg[hwport].max_stg2_offset + 1;
702 for (i = start_ctxt; i < limit; i++) {
703 credit = cfg[hwport].stg1_2_credit / max_ctxts;
704 if (credit > max_credit)
706 data = credit << 16 |
709 nlm_write_nae_reg(nae_base, NAE_STG1_STG2CRDT_CMD, data);
713 max_credit = cfg[hwport].max_eh_offset + 1;
714 for (i = start_ctxt; i < limit; i++) {
715 credit = cfg[hwport].stg2_eh_credit / max_ctxts;
716 if (credit > max_credit)
718 data = credit << 16 |
721 nlm_write_nae_reg(nae_base, NAE_STG2_EHCRDT_CMD, data);
724 /* Stage2 -> Frout */
725 max_credit = cfg[hwport].max_frout_offset + 1;
726 for (i = start_ctxt; i < limit; i++) {
727 credit = cfg[hwport].stg2_frout_credit / max_ctxts;
728 if (credit > max_credit)
730 data = credit << 16 |
733 nlm_write_nae_reg(nae_base, NAE_EH_FREECRDT_CMD, data);
737 max_credit = cfg[hwport].max_ms_offset + 1;
738 for (i = start_ctxt; i < limit; i++) {
739 credit = cfg[hwport].stg2_ms_credit / max_ctxts;
740 if (credit > max_credit)
742 data = credit << 16 |
745 nlm_write_nae_reg(nae_base, NAE_STG2_STRCRDT_CMD, data);
750 nlm_config_freein_fifo_uniq_cfg(uint64_t nae_base, int port,
751 int nblock_free_desc)
756 size_in_clines = (nblock_free_desc / NAE_CACHELINE_SIZE);
757 val = (size_in_clines << 8) | (port & 0x1f);
758 nlm_write_nae_reg(nae_base, NAE_FREEIN_FIFO_UNIQ_SZ_CFG, val);
761 /* XXXJC: redundant, see ucore_spray_config() */
763 nlm_config_ucore_iface_mask_cfg(uint64_t nae_base, int port,
764 int nblock_ucore_mask)
768 val = ( 0x1U << 31) | ((nblock_ucore_mask & 0xffff) << 8) |
770 nlm_write_nae_reg(nae_base, NAE_UCORE_IFACEMASK_CFG, val);
774 nlm_nae_init_netior(uint64_t nae_base, int nblocks)
776 uint32_t ctrl1, ctrl2, ctrl3;
794 printf("WARNING: unsupported blocks %d\n", nblocks);
798 nlm_write_nae_reg(nae_base, NAE_LANE_CFG_SOFTRESET, 0);
799 nlm_write_nae_reg(nae_base, NAE_NETIOR_MISC_CTRL3, ctrl3);
800 nlm_write_nae_reg(nae_base, NAE_NETIOR_MISC_CTRL2, ctrl2);
801 nlm_write_nae_reg(nae_base, NAE_NETIOR_MISC_CTRL1, ctrl1);
802 nlm_write_nae_reg(nae_base, NAE_NETIOR_MISC_CTRL1, 0x0);
807 nlm_nae_init_ingress(uint64_t nae_base, uint32_t desc_size)
810 uint32_t parser_threshold = 384;
812 rx_cfg = nlm_read_nae_reg(nae_base, NAE_RX_CONFIG);
813 rx_cfg &= ~(0x3 << 1); /* reset max message size */
814 rx_cfg &= ~(0xff << 4); /* clear freein desc cluster size */
815 rx_cfg &= ~(0x3f << 24); /* reset rx status mask */ /*XXX: why not 7f */
817 rx_cfg |= 1; /* rx enable */
818 rx_cfg |= (0x0 << 1); /* max message size */
819 rx_cfg |= (0x43 & 0x7f) << 24; /* rx status mask */
820 rx_cfg |= ((desc_size / 64) & 0xff) << 4; /* freein desc cluster size */
821 nlm_write_nae_reg(nae_base, NAE_RX_CONFIG, rx_cfg);
822 nlm_write_nae_reg(nae_base, NAE_PARSER_CONFIG,
823 (parser_threshold & 0x3ff) |
824 (((parser_threshold / desc_size) + 1) & 0xff) << 12 |
825 (((parser_threshold / 64) % desc_size) & 0xff) << 20);
827 /*nlm_write_nae_reg(nae_base, NAE_RX_FREE_FIFO_THRESH, 33);*/
831 nlm_nae_init_egress(uint64_t nae_base)
835 tx_cfg = nlm_read_nae_reg(nae_base, NAE_TX_CONFIG);
836 if (!nlm_is_xlp8xx_ax()) {
837 nlm_write_nae_reg(nae_base, NAE_TX_CONFIG,
839 0x1 | /* tx enable */
841 0x4 | /* tx compatible */
844 nlm_write_nae_reg(nae_base, NAE_TX_CONFIG,
846 0x1 | /* tx enable */
852 ucore_spray_config(uint32_t interface, uint32_t ucore_mask, int cmd)
854 return ((cmd & 0x1) << 31) | ((ucore_mask & 0xffff) << 8) |
859 nlm_nae_init_ucore(uint64_t nae_base, int if_num, u_int ucore_mask)
863 ucfg = ucore_spray_config(if_num, ucore_mask, 1); /* 1 : write */
864 nlm_write_nae_reg(nae_base, NAE_UCORE_IFACEMASK_CFG, ucfg);
868 nae_tx_desc(u_int type, u_int rdex, u_int fbid, u_int len, uint64_t addr)
870 return ((uint64_t)type << 62) |
871 ((uint64_t)rdex << 61) |
872 ((uint64_t)fbid << 54) |
873 ((uint64_t)len << 40) | addr;
877 nlm_setup_l2type(uint64_t nae_base, int hwport, uint32_t l2extlen,
878 uint32_t l2extoff, uint32_t extra_hdrsize, uint32_t proto_offset,
879 uint32_t fixed_hdroff, uint32_t l2proto)
883 val = ((l2extlen & 0x3f) << 26) |
884 ((l2extoff & 0x3f) << 20) |
885 ((extra_hdrsize & 0x3f) << 14) |
886 ((proto_offset & 0x3f) << 8) |
887 ((fixed_hdroff & 0x3f) << 2) |
889 nlm_write_nae_reg(nae_base, (NAE_L2_TYPE_PORT0 + hwport), val);
893 nlm_setup_l3ctable_mask(uint64_t nae_base, int hwport, uint32_t ptmask,
898 val = ((ptmask & 0x1) << 6) |
899 ((l3portmask & 0x1) << 5) |
901 nlm_write_nae_reg(nae_base, NAE_L3_CTABLE_MASK0, val);
905 nlm_setup_l3ctable_even(uint64_t nae_base, int entry, uint32_t l3hdroff,
906 uint32_t ipcsum_en, uint32_t l4protooff,
907 uint32_t l2proto, uint32_t eth_type)
911 val = ((l3hdroff & 0x3f) << 26) |
912 ((l4protooff & 0x3f) << 20) |
913 ((ipcsum_en & 0x1) << 18) |
914 ((l2proto & 0x3) << 16) |
916 nlm_write_nae_reg(nae_base, (NAE_L3CTABLE0 + (entry * 2)), val);
920 nlm_setup_l3ctable_odd(uint64_t nae_base, int entry, uint32_t l3off0,
921 uint32_t l3len0, uint32_t l3off1, uint32_t l3len1,
922 uint32_t l3off2, uint32_t l3len2)
926 val = ((l3off0 & 0x3f) << 26) |
927 ((l3len0 & 0x1f) << 21) |
928 ((l3off1 & 0x3f) << 15) |
929 ((l3len1 & 0x1f) << 10) |
930 ((l3off2 & 0x3f) << 4) |
932 nlm_write_nae_reg(nae_base, (NAE_L3CTABLE0 + ((entry * 2) + 1)), val);
936 nlm_setup_l4ctable_even(uint64_t nae_base, int entry, uint32_t im,
937 uint32_t l3cm, uint32_t l4pm, uint32_t port,
938 uint32_t l3camaddr, uint32_t l4proto)
942 val = ((im & 0x1) << 19) |
943 ((l3cm & 0x1) << 18) |
944 ((l4pm & 0x1) << 17) |
945 ((port & 0x1f) << 12) |
946 ((l3camaddr & 0xf) << 8) |
948 nlm_write_nae_reg(nae_base, (NAE_L4CTABLE0 + (entry * 2)), val);
952 nlm_setup_l4ctable_odd(uint64_t nae_base, int entry, uint32_t l4off0,
953 uint32_t l4len0, uint32_t l4off1, uint32_t l4len1)
957 val = ((l4off0 & 0x3f) << 21) |
958 ((l4len0 & 0xf) << 17) |
959 ((l4off1 & 0x3f) << 11) |
961 nlm_write_nae_reg(nae_base, (NAE_L4CTABLE0 + ((entry * 2) + 1)), val);
965 nlm_enable_hardware_parser(uint64_t nae_base)
969 val = nlm_read_nae_reg(nae_base, NAE_RX_CONFIG);
970 val |= (1 << 12); /* hardware parser enable */
971 nlm_write_nae_reg(nae_base, NAE_RX_CONFIG, val);
973 /***********************************************
974 * program L3 CAM table
975 ***********************************************/
978 * entry-0 is ipv4 MPLS type 1 label
980 /* l3hdroff = 4 bytes, ether_type = 0x8847 for MPLS_type1 */
981 nlm_setup_l3ctable_even(nae_base, 0, 4, 1, 9, 1, 0x8847);
982 /* l3off0 (8 bytes) -> l3len0 (1 byte) := ip proto
983 * l3off1 (12 bytes) -> l3len1 (4 bytes) := src ip
984 * l3off2 (16 bytes) -> l3len2 (4 bytes) := dst ip
986 nlm_setup_l3ctable_odd(nae_base, 0, 9, 1, 12, 4, 16, 4);
989 * entry-1 is for ethernet IPv4 packets
991 nlm_setup_l3ctable_even(nae_base, 1, 0, 1, 9, 1, 0x0800);
992 /* l3off0 (8 bytes) -> l3len0 (1 byte) := ip proto
993 * l3off1 (12 bytes) -> l3len1 (4 bytes) := src ip
994 * l3off2 (16 bytes) -> l3len2 (4 bytes) := dst ip
996 nlm_setup_l3ctable_odd(nae_base, 1, 9, 1, 12, 4, 16, 4);
999 * entry-2 is for ethernet IPv6 packets
1001 nlm_setup_l3ctable_even(nae_base, 2, 0, 1, 6, 1, 0x86dd);
1002 /* l3off0 (6 bytes) -> l3len0 (1 byte) := next header (ip proto)
1003 * l3off1 (8 bytes) -> l3len1 (16 bytes) := src ip
1004 * l3off2 (24 bytes) -> l3len2 (16 bytes) := dst ip
1006 nlm_setup_l3ctable_odd(nae_base, 2, 6, 1, 8, 16, 24, 16);
1009 * entry-3 is for ethernet ARP packets
1011 nlm_setup_l3ctable_even(nae_base, 3, 0, 0, 9, 1, 0x0806);
1012 /* extract 30 bytes from packet start */
1013 nlm_setup_l3ctable_odd(nae_base, 3, 0, 30, 0, 0, 0, 0);
1016 * entry-4 is for ethernet FCoE packets
1018 nlm_setup_l3ctable_even(nae_base, 4, 0, 0, 9, 1, 0x8906);
1019 /* FCoE packet consists of 4 byte start-of-frame,
1020 * and 24 bytes of frame header, followed by
1021 * 64 bytes of optional-header (ESP, network..),
1022 * 2048 bytes of payload, 36 bytes of optional
1023 * "fill bytes" or ESP trailer, 4 bytes of CRC,
1024 * and 4 bytes of end-of-frame
1025 * We extract the first 4 + 24 = 28 bytes
1027 nlm_setup_l3ctable_odd(nae_base, 4, 0, 28, 0, 0, 0, 0);
1030 * entry-5 is for vlan tagged frames (0x8100)
1032 nlm_setup_l3ctable_even(nae_base, 5, 0, 0, 9, 1, 0x8100);
1033 /* we extract 31 bytes from the payload */
1034 nlm_setup_l3ctable_odd(nae_base, 5, 0, 31, 0, 0, 0, 0);
1037 * entry-6 is for ieee 802.1ad provider bridging
1038 * tagged frames (0x88a8)
1040 nlm_setup_l3ctable_even(nae_base, 6, 0, 0, 9, 1, 0x88a8);
1041 /* we extract 31 bytes from the payload */
1042 nlm_setup_l3ctable_odd(nae_base, 6, 0, 31, 0, 0, 0, 0);
1045 * entry-7 is for Cisco's Q-in-Q tagged frames (0x9100)
1047 nlm_setup_l3ctable_even(nae_base, 7, 0, 0, 9, 1, 0x9100);
1048 /* we extract 31 bytes from the payload */
1049 nlm_setup_l3ctable_odd(nae_base, 7, 0, 31, 0, 0, 0, 0);
1052 * entry-8 is for Ethernet Jumbo frames (0x8870)
1054 nlm_setup_l3ctable_even(nae_base, 8, 0, 0, 9, 1, 0x8870);
1055 /* we extract 31 bytes from the payload */
1056 nlm_setup_l3ctable_odd(nae_base, 8, 0, 31, 0, 0, 0, 0);
1059 * entry-9 is for MPLS Multicast frames (0x8848)
1061 nlm_setup_l3ctable_even(nae_base, 9, 0, 0, 9, 1, 0x8848);
1062 /* we extract 31 bytes from the payload */
1063 nlm_setup_l3ctable_odd(nae_base, 9, 0, 31, 0, 0, 0, 0);
1066 * entry-10 is for IEEE 802.1ae MAC Security frames (0x88e5)
1068 nlm_setup_l3ctable_even(nae_base, 10, 0, 0, 9, 1, 0x88e5);
1069 /* we extract 31 bytes from the payload */
1070 nlm_setup_l3ctable_odd(nae_base, 10, 0, 31, 0, 0, 0, 0);
1073 * entry-11 is for PTP frames (0x88f7)
1075 nlm_setup_l3ctable_even(nae_base, 11, 0, 0, 9, 1, 0x88f7);
1076 /* PTP messages can be sent as UDP messages over
1077 * IPv4 or IPv6; and as a raw ethernet message
1078 * with ethertype 0x88f7. The message contents
1079 * are the same for UDP or ethernet based encapsulations
1080 * The header is 34 bytes long, and we extract
1083 nlm_setup_l3ctable_odd(nae_base, 11, 0, 31, 31, 2, 0, 0);
1086 * entry-12 is for ethernet Link Control Protocol (LCP)
1089 nlm_setup_l3ctable_even(nae_base, 12, 0, 0, 9, 1, 0xc021);
1090 /* LCP packet consists of 1 byte of code, 1 byte of
1091 * identifier and two bytes of length followed by
1092 * data (upto length bytes).
1093 * We extract 4 bytes from start of packet
1095 nlm_setup_l3ctable_odd(nae_base, 12, 0, 4, 0, 0, 0, 0);
1098 * entry-13 is for ethernet Link Quality Report (0xc025)
1101 nlm_setup_l3ctable_even(nae_base, 13, 0, 0, 9, 1, 0xc025);
1102 /* We extract 31 bytes from packet start */
1103 nlm_setup_l3ctable_odd(nae_base, 13, 0, 31, 0, 0, 0, 0);
1106 * entry-14 is for PPPoE Session (0x8864)
1108 nlm_setup_l3ctable_even(nae_base, 14, 0, 0, 9, 1, 0x8864);
1109 /* We extract 31 bytes from packet start */
1110 nlm_setup_l3ctable_odd(nae_base, 14, 0, 31, 0, 0, 0, 0);
1113 * entry-15 - default entry
1115 nlm_setup_l3ctable_even(nae_base, 15, 0, 0, 0, 0, 0x0000);
1116 /* We extract 31 bytes from packet start */
1117 nlm_setup_l3ctable_odd(nae_base, 15, 0, 31, 0, 0, 0, 0);
1119 /***********************************************
1120 * program L4 CAM table
1121 ***********************************************/
1124 * entry-0 - tcp packets (0x6)
1126 nlm_setup_l4ctable_even(nae_base, 0, 0, 0, 1, 0, 0, 0x6);
1127 /* tcp header is 20 bytes without tcp options
1128 * We extract 20 bytes from tcp start */
1129 nlm_setup_l4ctable_odd(nae_base, 0, 0, 15, 15, 5);
1132 * entry-1 - udp packets (0x11)
1134 nlm_setup_l4ctable_even(nae_base, 1, 0, 0, 1, 0, 0, 0x11);
1135 /* udp header is 8 bytes in size.
1136 * We extract 8 bytes from udp start */
1137 nlm_setup_l4ctable_odd(nae_base, 1, 0, 8, 0, 0);
1140 * entry-2 - sctp packets (0x84)
1142 nlm_setup_l4ctable_even(nae_base, 2, 0, 0, 1, 0, 0, 0x84);
1143 /* sctp packets have a 12 byte generic header
1144 * and various chunks.
1145 * We extract 12 bytes from sctp start */
1146 nlm_setup_l4ctable_odd(nae_base, 2, 0, 12, 0, 0);
1149 * entry-3 - RDP packets (0x1b)
1151 nlm_setup_l4ctable_even(nae_base, 3, 0, 0, 1, 0, 0, 0x1b);
1152 /* RDP packets have 18 bytes of generic header
1153 * before variable header starts.
1154 * We extract 18 bytes from rdp start */
1155 nlm_setup_l4ctable_odd(nae_base, 3, 0, 15, 15, 3);
1158 * entry-4 - DCCP packets (0x21)
1160 nlm_setup_l4ctable_even(nae_base, 4, 0, 0, 1, 0, 0, 0x21);
1161 /* DCCP has two types of generic headers of
1162 * sizes 16 bytes and 12 bytes if X = 1.
1163 * We extract 16 bytes from dccp start */
1164 nlm_setup_l4ctable_odd(nae_base, 4, 0, 15, 15, 1);
1167 * entry-5 - ipv6 encapsulated in ipv4 packets (0x29)
1169 nlm_setup_l4ctable_even(nae_base, 5, 0, 0, 1, 0, 0, 0x29);
1170 /* ipv4 header is 20 bytes excluding IP options.
1171 * We extract 20 bytes from IPv4 start */
1172 nlm_setup_l4ctable_odd(nae_base, 5, 0, 15, 15, 5);
1175 * entry-6 - ip in ip encapsulation packets (0x04)
1177 nlm_setup_l4ctable_even(nae_base, 6, 0, 0, 1, 0, 0, 0x04);
1178 /* ipv4 header is 20 bytes excluding IP options.
1179 * We extract 20 bytes from ipv4 start */
1180 nlm_setup_l4ctable_odd(nae_base, 6, 0, 15, 15, 5);
1183 * entry-7 - default entry (0x0)
1185 nlm_setup_l4ctable_even(nae_base, 7, 0, 0, 1, 0, 0, 0x0);
1186 /* We extract 20 bytes from packet start */
1187 nlm_setup_l4ctable_odd(nae_base, 7, 0, 15, 15, 5);
1191 nlm_enable_hardware_parser_per_port(uint64_t nae_base, int block, int port)
1193 int hwport = (block * 4) + (port & 0x3);
1195 /* program L2 and L3 header extraction for each port */
1196 /* enable ethernet L2 mode on port */
1197 nlm_setup_l2type(nae_base, hwport, 0, 0, 0, 0, 0, 1);
1199 /* l2proto and ethtype included in l3cam */
1200 nlm_setup_l3ctable_mask(nae_base, hwport, 1, 0);
1204 nlm_prepad_enable(uint64_t nae_base, int size)
1208 val = nlm_read_nae_reg(nae_base, NAE_RX_CONFIG);
1209 val |= (1 << 13); /* prepad enable */
1210 val |= ((size & 0x3) << 22); /* prepad size */
1211 nlm_write_nae_reg(nae_base, NAE_RX_CONFIG, val);
1215 nlm_setup_1588_timer(uint64_t nae_base, struct nae_port_config *cfg)
1217 uint32_t hi, lo, val;
1219 hi = cfg[0].ieee1588_userval >> 32;
1220 lo = cfg[0].ieee1588_userval & 0xffffffff;
1221 nlm_write_nae_reg(nae_base, NAE_1588_PTP_USER_VALUE_HI, hi);
1222 nlm_write_nae_reg(nae_base, NAE_1588_PTP_USER_VALUE_LO, lo);
1224 hi = cfg[0].ieee1588_ptpoff >> 32;
1225 lo = cfg[0].ieee1588_ptpoff & 0xffffffff;
1226 nlm_write_nae_reg(nae_base, NAE_1588_PTP_OFFSET_HI, hi);
1227 nlm_write_nae_reg(nae_base, NAE_1588_PTP_OFFSET_LO, lo);
1229 hi = cfg[0].ieee1588_tmr1 >> 32;
1230 lo = cfg[0].ieee1588_tmr1 & 0xffffffff;
1231 nlm_write_nae_reg(nae_base, NAE_1588_PTP_TMR1_HI, hi);
1232 nlm_write_nae_reg(nae_base, NAE_1588_PTP_TMR1_LO, lo);
1234 hi = cfg[0].ieee1588_tmr2 >> 32;
1235 lo = cfg[0].ieee1588_tmr2 & 0xffffffff;
1236 nlm_write_nae_reg(nae_base, NAE_1588_PTP_TMR2_HI, hi);
1237 nlm_write_nae_reg(nae_base, NAE_1588_PTP_TMR2_LO, lo);
1239 hi = cfg[0].ieee1588_tmr3 >> 32;
1240 lo = cfg[0].ieee1588_tmr3 & 0xffffffff;
1241 nlm_write_nae_reg(nae_base, NAE_1588_PTP_TMR3_HI, hi);
1242 nlm_write_nae_reg(nae_base, NAE_1588_PTP_TMR3_LO, lo);
1244 nlm_write_nae_reg(nae_base, NAE_1588_PTP_INC_INTG,
1245 cfg[0].ieee1588_inc_intg);
1246 nlm_write_nae_reg(nae_base, NAE_1588_PTP_INC_NUM,
1247 cfg[0].ieee1588_inc_num);
1248 nlm_write_nae_reg(nae_base, NAE_1588_PTP_INC_DEN,
1249 cfg[0].ieee1588_inc_den);
1251 val = nlm_read_nae_reg(nae_base, NAE_1588_PTP_CONTROL);
1252 /* set and clear freq_mul = 1 */
1253 nlm_write_nae_reg(nae_base, NAE_1588_PTP_CONTROL, val | (0x1 << 1));
1254 nlm_write_nae_reg(nae_base, NAE_1588_PTP_CONTROL, val);
1255 /* set and clear load_user_val = 1 */
1256 nlm_write_nae_reg(nae_base, NAE_1588_PTP_CONTROL, val | (0x1 << 6));
1257 nlm_write_nae_reg(nae_base, NAE_1588_PTP_CONTROL, val);
1261 nlm_mac_enable(uint64_t nae_base, int nblock, int port_type, int port)
1263 uint32_t mac_cfg1, xaui_cfg;
1265 int iface = port & 0x3;
1269 netwk_inf = nlm_read_nae_reg(nae_base,
1270 SGMII_NET_IFACE_CTRL(nblock, iface));
1271 nlm_write_nae_reg(nae_base,
1272 SGMII_NET_IFACE_CTRL(nblock, iface),
1274 (1 << 2)); /* enable tx */
1275 mac_cfg1 = nlm_read_nae_reg(nae_base,
1276 SGMII_MAC_CONF1(nblock, iface));
1277 nlm_write_nae_reg(nae_base,
1278 SGMII_MAC_CONF1(nblock, iface),
1280 (1 << 2) | /* rx enable */
1284 xaui_cfg = nlm_read_nae_reg(nae_base,
1285 XAUI_CONFIG1(nblock));
1286 nlm_write_nae_reg(nae_base,
1287 XAUI_CONFIG1(nblock),
1298 nlm_mac_disable(uint64_t nae_base, int nblock, int port_type, int port)
1300 uint32_t mac_cfg1, xaui_cfg;
1302 int iface = port & 0x3;
1306 mac_cfg1 = nlm_read_nae_reg(nae_base,
1307 SGMII_MAC_CONF1(nblock, iface));
1308 nlm_write_nae_reg(nae_base,
1309 SGMII_MAC_CONF1(nblock, iface),
1311 ~((1 << 2) | /* rx enable */
1312 1)); /* tx enable */
1313 netwk_inf = nlm_read_nae_reg(nae_base,
1314 SGMII_NET_IFACE_CTRL(nblock, iface));
1315 nlm_write_nae_reg(nae_base,
1316 SGMII_NET_IFACE_CTRL(nblock, iface),
1318 ~(1 << 2)); /* enable tx */
1321 xaui_cfg = nlm_read_nae_reg(nae_base,
1322 XAUI_CONFIG1(nblock));
1323 nlm_write_nae_reg(nae_base,
1324 XAUI_CONFIG1(nblock),
1326 ~(XAUI_CONFIG_TFEN |
1335 * Set IOR credits for the ports in ifmask to valmask
1338 nlm_nae_set_ior_credit(uint64_t nae_base, uint32_t ifmask, uint32_t valmask)
1340 uint32_t tx_config, tx_ior_credit;
1342 tx_ior_credit = nlm_read_nae_reg(nae_base, NAE_TX_IORCRDT_INIT);
1343 tx_ior_credit &= ~ifmask;
1344 tx_ior_credit |= valmask;
1345 nlm_write_nae_reg(nae_base, NAE_TX_IORCRDT_INIT, tx_ior_credit);
1347 tx_config = nlm_read_nae_reg(nae_base, NAE_TX_CONFIG);
1348 /* need to toggle these bits for credits to be loaded */
1349 nlm_write_nae_reg(nae_base, NAE_TX_CONFIG,
1350 tx_config | (TXINITIORCR(ifmask)));
1351 nlm_write_nae_reg(nae_base, NAE_TX_CONFIG,
1352 tx_config & ~(TXINITIORCR(ifmask)));
1356 nlm_nae_open_if(uint64_t nae_base, int nblock, int port_type,
1357 int port, uint32_t desc_size)
1360 uint32_t mac_cfg1, netior_ctrl3;
1361 int iface, iface_ctrl_reg, iface_ctrl3_reg, conf1_reg, conf2_reg;
1363 switch (port_type) {
1365 netwk_inf = nlm_read_nae_reg(nae_base,
1366 XAUI_NETIOR_XGMAC_CTRL1(nblock));
1367 netwk_inf |= (1 << NETIOR_XGMAC_STATS_CLR_POS);
1368 nlm_write_nae_reg(nae_base,
1369 XAUI_NETIOR_XGMAC_CTRL1(nblock), netwk_inf);
1371 nlm_nae_set_ior_credit(nae_base, 0xf << port, 0xf << port);
1375 nlm_nae_set_ior_credit(nae_base, 0xff << port, 0xff << port);
1379 nlm_nae_set_ior_credit(nae_base, 0x1 << port, 0);
1382 * XXXJC: split this and merge to sgmii.c
1383 * some of this is duplicated from there.
1385 /* init phy id to access internal PCS */
1387 iface_ctrl_reg = SGMII_NET_IFACE_CTRL(nblock, iface);
1388 conf1_reg = SGMII_MAC_CONF1(nblock, iface);
1389 conf2_reg = SGMII_MAC_CONF2(nblock, iface);
1391 netwk_inf = nlm_read_nae_reg(nae_base, iface_ctrl_reg);
1392 netwk_inf &= 0x7ffffff;
1393 netwk_inf |= (port << 27);
1394 nlm_write_nae_reg(nae_base, iface_ctrl_reg, netwk_inf);
1396 /* Sofreset sgmii port - set bit 11 to 0 */
1397 netwk_inf &= 0xfffff7ff;
1398 nlm_write_nae_reg(nae_base, iface_ctrl_reg, netwk_inf);
1401 mac_cfg1 = nlm_read_nae_reg(nae_base, conf1_reg);
1402 nlm_write_nae_reg(nae_base, conf1_reg,
1404 (1 << 31) | /* soft reset */
1405 (1 << 2) | /* rx enable */
1406 (1)); /* tx enable */
1409 nlm_write_nae_reg(nae_base,
1411 (0x7 << 12) | /* interface preamble length */
1412 (0x2 << 8) | /* interface mode */
1413 (0x1 << 2) | /* pad crc enable */
1414 (0x1)); /* full duplex */
1416 /* clear gmac reset */
1417 mac_cfg1 = nlm_read_nae_reg(nae_base, conf1_reg);
1418 nlm_write_nae_reg(nae_base, conf1_reg, mac_cfg1 & ~(1 << 31));
1420 /* clear speed debug bit */
1421 iface_ctrl3_reg = SGMII_NET_IFACE_CTRL3(nblock, iface);
1422 netior_ctrl3 = nlm_read_nae_reg(nae_base, iface_ctrl3_reg);
1423 nlm_write_nae_reg(nae_base, iface_ctrl3_reg,
1424 netior_ctrl3 & ~(1 << 6));
1426 /* disable TX, RX for now */
1427 mac_cfg1 = nlm_read_nae_reg(nae_base, conf1_reg);
1428 nlm_write_nae_reg(nae_base, conf1_reg, mac_cfg1 & ~(0x5));
1429 netwk_inf = nlm_read_nae_reg(nae_base, iface_ctrl_reg);
1430 nlm_write_nae_reg(nae_base, iface_ctrl_reg,
1431 netwk_inf & ~(0x1 << 2));
1433 /* clear stats counters */
1434 netwk_inf = nlm_read_nae_reg(nae_base, iface_ctrl_reg);
1435 nlm_write_nae_reg(nae_base, iface_ctrl_reg,
1436 netwk_inf | (1 << 15));
1438 /* enable stats counters */
1439 netwk_inf = nlm_read_nae_reg(nae_base, iface_ctrl_reg);
1440 nlm_write_nae_reg(nae_base, iface_ctrl_reg,
1441 (netwk_inf & ~(1 << 15)) | (1 << 16));
1444 mac_cfg1 = nlm_read_nae_reg(nae_base, conf1_reg);
1445 nlm_write_nae_reg(nae_base, conf1_reg,
1446 mac_cfg1 | (0x3 << 4));
1450 nlm_nae_init_ingress(nae_base, desc_size);
1451 nlm_nae_init_egress(nae_base);