162306a36Sopenharmony_ci/***********************license start***************
262306a36Sopenharmony_ci * Author: Cavium Networks
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * Contact: support@caviumnetworks.com
562306a36Sopenharmony_ci * This file is part of the OCTEON SDK
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Copyright (c) 2003-2008 Cavium Networks
862306a36Sopenharmony_ci *
962306a36Sopenharmony_ci * This file is free software; you can redistribute it and/or modify
1062306a36Sopenharmony_ci * it under the terms of the GNU General Public License, Version 2, as
1162306a36Sopenharmony_ci * published by the Free Software Foundation.
1262306a36Sopenharmony_ci *
1362306a36Sopenharmony_ci * This file is distributed in the hope that it will be useful, but
1462306a36Sopenharmony_ci * AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty
1562306a36Sopenharmony_ci * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or
1662306a36Sopenharmony_ci * NONINFRINGEMENT.  See the GNU General Public License for more
1762306a36Sopenharmony_ci * details.
1862306a36Sopenharmony_ci *
1962306a36Sopenharmony_ci * You should have received a copy of the GNU General Public License
2062306a36Sopenharmony_ci * along with this file; if not, write to the Free Software
2162306a36Sopenharmony_ci * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
2262306a36Sopenharmony_ci * or visit http://www.gnu.org/licenses/.
2362306a36Sopenharmony_ci *
2462306a36Sopenharmony_ci * This file may also be available under a different license from Cavium.
2562306a36Sopenharmony_ci * Contact Cavium Networks for more information
2662306a36Sopenharmony_ci ***********************license end**************************************/
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci/**
2962306a36Sopenharmony_ci *
3062306a36Sopenharmony_ci * Interface to the hardware Input Packet Data unit.
3162306a36Sopenharmony_ci */
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_ci#ifndef __CVMX_IPD_H__
3462306a36Sopenharmony_ci#define __CVMX_IPD_H__
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci#include <asm/octeon/octeon-feature.h>
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci#include <asm/octeon/cvmx-ipd-defs.h>
3962306a36Sopenharmony_ci#include <asm/octeon/cvmx-pip-defs.h>
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_cienum cvmx_ipd_mode {
4262306a36Sopenharmony_ci   CVMX_IPD_OPC_MODE_STT = 0LL,	  /* All blocks DRAM, not cached in L2 */
4362306a36Sopenharmony_ci   CVMX_IPD_OPC_MODE_STF = 1LL,	  /* All blocks into  L2 */
4462306a36Sopenharmony_ci   CVMX_IPD_OPC_MODE_STF1_STT = 2LL,   /* 1st block L2, rest DRAM */
4562306a36Sopenharmony_ci   CVMX_IPD_OPC_MODE_STF2_STT = 3LL    /* 1st, 2nd blocks L2, rest DRAM */
4662306a36Sopenharmony_ci};
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci#ifndef CVMX_ENABLE_LEN_M8_FIX
4962306a36Sopenharmony_ci#define CVMX_ENABLE_LEN_M8_FIX 0
5062306a36Sopenharmony_ci#endif
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_ci/* CSR typedefs have been moved to cvmx-csr-*.h */
5362306a36Sopenharmony_citypedef union cvmx_ipd_1st_mbuff_skip cvmx_ipd_mbuff_first_skip_t;
5462306a36Sopenharmony_citypedef union cvmx_ipd_1st_next_ptr_back cvmx_ipd_first_next_ptr_back_t;
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_citypedef cvmx_ipd_mbuff_first_skip_t cvmx_ipd_mbuff_not_first_skip_t;
5762306a36Sopenharmony_citypedef cvmx_ipd_first_next_ptr_back_t cvmx_ipd_second_next_ptr_back_t;
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_ci/**
6062306a36Sopenharmony_ci * Configure IPD
6162306a36Sopenharmony_ci *
6262306a36Sopenharmony_ci * @mbuff_size: Packets buffer size in 8 byte words
6362306a36Sopenharmony_ci * @first_mbuff_skip:
6462306a36Sopenharmony_ci *		     Number of 8 byte words to skip in the first buffer
6562306a36Sopenharmony_ci * @not_first_mbuff_skip:
6662306a36Sopenharmony_ci *		     Number of 8 byte words to skip in each following buffer
6762306a36Sopenharmony_ci * @first_back: Must be same as first_mbuff_skip / 128
6862306a36Sopenharmony_ci * @second_back:
6962306a36Sopenharmony_ci *		     Must be same as not_first_mbuff_skip / 128
7062306a36Sopenharmony_ci * @wqe_fpa_pool:
7162306a36Sopenharmony_ci *		     FPA pool to get work entries from
7262306a36Sopenharmony_ci * @cache_mode:
7362306a36Sopenharmony_ci * @back_pres_enable_flag:
7462306a36Sopenharmony_ci *		     Enable or disable port back pressure
7562306a36Sopenharmony_ci */
7662306a36Sopenharmony_cistatic inline void cvmx_ipd_config(uint64_t mbuff_size,
7762306a36Sopenharmony_ci				   uint64_t first_mbuff_skip,
7862306a36Sopenharmony_ci				   uint64_t not_first_mbuff_skip,
7962306a36Sopenharmony_ci				   uint64_t first_back,
8062306a36Sopenharmony_ci				   uint64_t second_back,
8162306a36Sopenharmony_ci				   uint64_t wqe_fpa_pool,
8262306a36Sopenharmony_ci				   enum cvmx_ipd_mode cache_mode,
8362306a36Sopenharmony_ci				   uint64_t back_pres_enable_flag)
8462306a36Sopenharmony_ci{
8562306a36Sopenharmony_ci	cvmx_ipd_mbuff_first_skip_t first_skip;
8662306a36Sopenharmony_ci	cvmx_ipd_mbuff_not_first_skip_t not_first_skip;
8762306a36Sopenharmony_ci	union cvmx_ipd_packet_mbuff_size size;
8862306a36Sopenharmony_ci	cvmx_ipd_first_next_ptr_back_t first_back_struct;
8962306a36Sopenharmony_ci	cvmx_ipd_second_next_ptr_back_t second_back_struct;
9062306a36Sopenharmony_ci	union cvmx_ipd_wqe_fpa_queue wqe_pool;
9162306a36Sopenharmony_ci	union cvmx_ipd_ctl_status ipd_ctl_reg;
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci	first_skip.u64 = 0;
9462306a36Sopenharmony_ci	first_skip.s.skip_sz = first_mbuff_skip;
9562306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_1ST_MBUFF_SKIP, first_skip.u64);
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	not_first_skip.u64 = 0;
9862306a36Sopenharmony_ci	not_first_skip.s.skip_sz = not_first_mbuff_skip;
9962306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_NOT_1ST_MBUFF_SKIP, not_first_skip.u64);
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ci	size.u64 = 0;
10262306a36Sopenharmony_ci	size.s.mb_size = mbuff_size;
10362306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_PACKET_MBUFF_SIZE, size.u64);
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci	first_back_struct.u64 = 0;
10662306a36Sopenharmony_ci	first_back_struct.s.back = first_back;
10762306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_1st_NEXT_PTR_BACK, first_back_struct.u64);
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	second_back_struct.u64 = 0;
11062306a36Sopenharmony_ci	second_back_struct.s.back = second_back;
11162306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_2nd_NEXT_PTR_BACK, second_back_struct.u64);
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	wqe_pool.u64 = 0;
11462306a36Sopenharmony_ci	wqe_pool.s.wqe_pool = wqe_fpa_pool;
11562306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_WQE_FPA_QUEUE, wqe_pool.u64);
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	ipd_ctl_reg.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
11862306a36Sopenharmony_ci	ipd_ctl_reg.s.opc_mode = cache_mode;
11962306a36Sopenharmony_ci	ipd_ctl_reg.s.pbp_en = back_pres_enable_flag;
12062306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_ctl_reg.u64);
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci	/* Note: the example RED code that used to be here has been moved to
12362306a36Sopenharmony_ci	   cvmx_helper_setup_red */
12462306a36Sopenharmony_ci}
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_ci/**
12762306a36Sopenharmony_ci * Enable IPD
12862306a36Sopenharmony_ci */
12962306a36Sopenharmony_cistatic inline void cvmx_ipd_enable(void)
13062306a36Sopenharmony_ci{
13162306a36Sopenharmony_ci	union cvmx_ipd_ctl_status ipd_reg;
13262306a36Sopenharmony_ci	ipd_reg.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
13362306a36Sopenharmony_ci	if (ipd_reg.s.ipd_en) {
13462306a36Sopenharmony_ci		cvmx_dprintf
13562306a36Sopenharmony_ci		    ("Warning: Enabling IPD when IPD already enabled.\n");
13662306a36Sopenharmony_ci	}
13762306a36Sopenharmony_ci	ipd_reg.s.ipd_en = 1;
13862306a36Sopenharmony_ci#if  CVMX_ENABLE_LEN_M8_FIX
13962306a36Sopenharmony_ci	if (!OCTEON_IS_MODEL(OCTEON_CN38XX_PASS2))
14062306a36Sopenharmony_ci		ipd_reg.s.len_m8 = TRUE;
14162306a36Sopenharmony_ci#endif
14262306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_reg.u64);
14362306a36Sopenharmony_ci}
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci/**
14662306a36Sopenharmony_ci * Disable IPD
14762306a36Sopenharmony_ci */
14862306a36Sopenharmony_cistatic inline void cvmx_ipd_disable(void)
14962306a36Sopenharmony_ci{
15062306a36Sopenharmony_ci	union cvmx_ipd_ctl_status ipd_reg;
15162306a36Sopenharmony_ci	ipd_reg.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
15262306a36Sopenharmony_ci	ipd_reg.s.ipd_en = 0;
15362306a36Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_reg.u64);
15462306a36Sopenharmony_ci}
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci/**
15762306a36Sopenharmony_ci * Supportive function for cvmx_fpa_shutdown_pool.
15862306a36Sopenharmony_ci */
15962306a36Sopenharmony_cistatic inline void cvmx_ipd_free_ptr(void)
16062306a36Sopenharmony_ci{
16162306a36Sopenharmony_ci	/* Only CN38XXp{1,2} cannot read pointer out of the IPD */
16262306a36Sopenharmony_ci	if (!OCTEON_IS_MODEL(OCTEON_CN38XX_PASS1)
16362306a36Sopenharmony_ci	    && !OCTEON_IS_MODEL(OCTEON_CN38XX_PASS2)) {
16462306a36Sopenharmony_ci		int no_wptr = 0;
16562306a36Sopenharmony_ci		union cvmx_ipd_ptr_count ipd_ptr_count;
16662306a36Sopenharmony_ci		ipd_ptr_count.u64 = cvmx_read_csr(CVMX_IPD_PTR_COUNT);
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci		/* Handle Work Queue Entry in cn56xx and cn52xx */
16962306a36Sopenharmony_ci		if (octeon_has_feature(OCTEON_FEATURE_NO_WPTR)) {
17062306a36Sopenharmony_ci			union cvmx_ipd_ctl_status ipd_ctl_status;
17162306a36Sopenharmony_ci			ipd_ctl_status.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
17262306a36Sopenharmony_ci			if (ipd_ctl_status.s.no_wptr)
17362306a36Sopenharmony_ci				no_wptr = 1;
17462306a36Sopenharmony_ci		}
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_ci		/* Free the prefetched WQE */
17762306a36Sopenharmony_ci		if (ipd_ptr_count.s.wqev_cnt) {
17862306a36Sopenharmony_ci			union cvmx_ipd_wqe_ptr_valid ipd_wqe_ptr_valid;
17962306a36Sopenharmony_ci			ipd_wqe_ptr_valid.u64 =
18062306a36Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_WQE_PTR_VALID);
18162306a36Sopenharmony_ci			if (no_wptr)
18262306a36Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
18362306a36Sopenharmony_ci					      ((uint64_t) ipd_wqe_ptr_valid.s.
18462306a36Sopenharmony_ci					       ptr << 7), CVMX_FPA_PACKET_POOL,
18562306a36Sopenharmony_ci					      0);
18662306a36Sopenharmony_ci			else
18762306a36Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
18862306a36Sopenharmony_ci					      ((uint64_t) ipd_wqe_ptr_valid.s.
18962306a36Sopenharmony_ci					       ptr << 7), CVMX_FPA_WQE_POOL, 0);
19062306a36Sopenharmony_ci		}
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci		/* Free all WQE in the fifo */
19362306a36Sopenharmony_ci		if (ipd_ptr_count.s.wqe_pcnt) {
19462306a36Sopenharmony_ci			int i;
19562306a36Sopenharmony_ci			union cvmx_ipd_pwp_ptr_fifo_ctl ipd_pwp_ptr_fifo_ctl;
19662306a36Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.u64 =
19762306a36Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
19862306a36Sopenharmony_ci			for (i = 0; i < ipd_ptr_count.s.wqe_pcnt; i++) {
19962306a36Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.cena = 0;
20062306a36Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.raddr =
20162306a36Sopenharmony_ci				    ipd_pwp_ptr_fifo_ctl.s.max_cnts +
20262306a36Sopenharmony_ci				    (ipd_pwp_ptr_fifo_ctl.s.wraddr +
20362306a36Sopenharmony_ci				     i) % ipd_pwp_ptr_fifo_ctl.s.max_cnts;
20462306a36Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
20562306a36Sopenharmony_ci					       ipd_pwp_ptr_fifo_ctl.u64);
20662306a36Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.u64 =
20762306a36Sopenharmony_ci				    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
20862306a36Sopenharmony_ci				if (no_wptr)
20962306a36Sopenharmony_ci					cvmx_fpa_free(cvmx_phys_to_ptr
21062306a36Sopenharmony_ci						      ((uint64_t)
21162306a36Sopenharmony_ci						       ipd_pwp_ptr_fifo_ctl.s.
21262306a36Sopenharmony_ci						       ptr << 7),
21362306a36Sopenharmony_ci						      CVMX_FPA_PACKET_POOL, 0);
21462306a36Sopenharmony_ci				else
21562306a36Sopenharmony_ci					cvmx_fpa_free(cvmx_phys_to_ptr
21662306a36Sopenharmony_ci						      ((uint64_t)
21762306a36Sopenharmony_ci						       ipd_pwp_ptr_fifo_ctl.s.
21862306a36Sopenharmony_ci						       ptr << 7),
21962306a36Sopenharmony_ci						      CVMX_FPA_WQE_POOL, 0);
22062306a36Sopenharmony_ci			}
22162306a36Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.s.cena = 1;
22262306a36Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
22362306a36Sopenharmony_ci				       ipd_pwp_ptr_fifo_ctl.u64);
22462306a36Sopenharmony_ci		}
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_ci		/* Free the prefetched packet */
22762306a36Sopenharmony_ci		if (ipd_ptr_count.s.pktv_cnt) {
22862306a36Sopenharmony_ci			union cvmx_ipd_pkt_ptr_valid ipd_pkt_ptr_valid;
22962306a36Sopenharmony_ci			ipd_pkt_ptr_valid.u64 =
23062306a36Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PKT_PTR_VALID);
23162306a36Sopenharmony_ci			cvmx_fpa_free(cvmx_phys_to_ptr
23262306a36Sopenharmony_ci				      (ipd_pkt_ptr_valid.s.ptr << 7),
23362306a36Sopenharmony_ci				      CVMX_FPA_PACKET_POOL, 0);
23462306a36Sopenharmony_ci		}
23562306a36Sopenharmony_ci
23662306a36Sopenharmony_ci		/* Free the per port prefetched packets */
23762306a36Sopenharmony_ci		if (1) {
23862306a36Sopenharmony_ci			int i;
23962306a36Sopenharmony_ci			union cvmx_ipd_prc_port_ptr_fifo_ctl
24062306a36Sopenharmony_ci			    ipd_prc_port_ptr_fifo_ctl;
24162306a36Sopenharmony_ci			ipd_prc_port_ptr_fifo_ctl.u64 =
24262306a36Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL);
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci			for (i = 0; i < ipd_prc_port_ptr_fifo_ctl.s.max_pkt;
24562306a36Sopenharmony_ci			     i++) {
24662306a36Sopenharmony_ci				ipd_prc_port_ptr_fifo_ctl.s.cena = 0;
24762306a36Sopenharmony_ci				ipd_prc_port_ptr_fifo_ctl.s.raddr =
24862306a36Sopenharmony_ci				    i % ipd_prc_port_ptr_fifo_ctl.s.max_pkt;
24962306a36Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL,
25062306a36Sopenharmony_ci					       ipd_prc_port_ptr_fifo_ctl.u64);
25162306a36Sopenharmony_ci				ipd_prc_port_ptr_fifo_ctl.u64 =
25262306a36Sopenharmony_ci				    cvmx_read_csr
25362306a36Sopenharmony_ci				    (CVMX_IPD_PRC_PORT_PTR_FIFO_CTL);
25462306a36Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
25562306a36Sopenharmony_ci					      ((uint64_t)
25662306a36Sopenharmony_ci					       ipd_prc_port_ptr_fifo_ctl.s.
25762306a36Sopenharmony_ci					       ptr << 7), CVMX_FPA_PACKET_POOL,
25862306a36Sopenharmony_ci					      0);
25962306a36Sopenharmony_ci			}
26062306a36Sopenharmony_ci			ipd_prc_port_ptr_fifo_ctl.s.cena = 1;
26162306a36Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL,
26262306a36Sopenharmony_ci				       ipd_prc_port_ptr_fifo_ctl.u64);
26362306a36Sopenharmony_ci		}
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_ci		/* Free all packets in the holding fifo */
26662306a36Sopenharmony_ci		if (ipd_ptr_count.s.pfif_cnt) {
26762306a36Sopenharmony_ci			int i;
26862306a36Sopenharmony_ci			union cvmx_ipd_prc_hold_ptr_fifo_ctl
26962306a36Sopenharmony_ci			    ipd_prc_hold_ptr_fifo_ctl;
27062306a36Sopenharmony_ci
27162306a36Sopenharmony_ci			ipd_prc_hold_ptr_fifo_ctl.u64 =
27262306a36Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL);
27362306a36Sopenharmony_ci
27462306a36Sopenharmony_ci			for (i = 0; i < ipd_ptr_count.s.pfif_cnt; i++) {
27562306a36Sopenharmony_ci				ipd_prc_hold_ptr_fifo_ctl.s.cena = 0;
27662306a36Sopenharmony_ci				ipd_prc_hold_ptr_fifo_ctl.s.raddr =
27762306a36Sopenharmony_ci				    (ipd_prc_hold_ptr_fifo_ctl.s.praddr +
27862306a36Sopenharmony_ci				     i) % ipd_prc_hold_ptr_fifo_ctl.s.max_pkt;
27962306a36Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL,
28062306a36Sopenharmony_ci					       ipd_prc_hold_ptr_fifo_ctl.u64);
28162306a36Sopenharmony_ci				ipd_prc_hold_ptr_fifo_ctl.u64 =
28262306a36Sopenharmony_ci				    cvmx_read_csr
28362306a36Sopenharmony_ci				    (CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL);
28462306a36Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
28562306a36Sopenharmony_ci					      ((uint64_t)
28662306a36Sopenharmony_ci					       ipd_prc_hold_ptr_fifo_ctl.s.
28762306a36Sopenharmony_ci					       ptr << 7), CVMX_FPA_PACKET_POOL,
28862306a36Sopenharmony_ci					      0);
28962306a36Sopenharmony_ci			}
29062306a36Sopenharmony_ci			ipd_prc_hold_ptr_fifo_ctl.s.cena = 1;
29162306a36Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL,
29262306a36Sopenharmony_ci				       ipd_prc_hold_ptr_fifo_ctl.u64);
29362306a36Sopenharmony_ci		}
29462306a36Sopenharmony_ci
29562306a36Sopenharmony_ci		/* Free all packets in the fifo */
29662306a36Sopenharmony_ci		if (ipd_ptr_count.s.pkt_pcnt) {
29762306a36Sopenharmony_ci			int i;
29862306a36Sopenharmony_ci			union cvmx_ipd_pwp_ptr_fifo_ctl ipd_pwp_ptr_fifo_ctl;
29962306a36Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.u64 =
30062306a36Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
30162306a36Sopenharmony_ci
30262306a36Sopenharmony_ci			for (i = 0; i < ipd_ptr_count.s.pkt_pcnt; i++) {
30362306a36Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.cena = 0;
30462306a36Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.raddr =
30562306a36Sopenharmony_ci				    (ipd_pwp_ptr_fifo_ctl.s.praddr +
30662306a36Sopenharmony_ci				     i) % ipd_pwp_ptr_fifo_ctl.s.max_cnts;
30762306a36Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
30862306a36Sopenharmony_ci					       ipd_pwp_ptr_fifo_ctl.u64);
30962306a36Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.u64 =
31062306a36Sopenharmony_ci				    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
31162306a36Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
31262306a36Sopenharmony_ci					      ((uint64_t) ipd_pwp_ptr_fifo_ctl.
31362306a36Sopenharmony_ci					       s.ptr << 7),
31462306a36Sopenharmony_ci					      CVMX_FPA_PACKET_POOL, 0);
31562306a36Sopenharmony_ci			}
31662306a36Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.s.cena = 1;
31762306a36Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
31862306a36Sopenharmony_ci				       ipd_pwp_ptr_fifo_ctl.u64);
31962306a36Sopenharmony_ci		}
32062306a36Sopenharmony_ci
32162306a36Sopenharmony_ci		/* Reset the IPD to get all buffers out of it */
32262306a36Sopenharmony_ci		{
32362306a36Sopenharmony_ci			union cvmx_ipd_ctl_status ipd_ctl_status;
32462306a36Sopenharmony_ci			ipd_ctl_status.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
32562306a36Sopenharmony_ci			ipd_ctl_status.s.reset = 1;
32662306a36Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_ctl_status.u64);
32762306a36Sopenharmony_ci		}
32862306a36Sopenharmony_ci
32962306a36Sopenharmony_ci		/* Reset the PIP */
33062306a36Sopenharmony_ci		{
33162306a36Sopenharmony_ci			union cvmx_pip_sft_rst pip_sft_rst;
33262306a36Sopenharmony_ci			pip_sft_rst.u64 = cvmx_read_csr(CVMX_PIP_SFT_RST);
33362306a36Sopenharmony_ci			pip_sft_rst.s.rst = 1;
33462306a36Sopenharmony_ci			cvmx_write_csr(CVMX_PIP_SFT_RST, pip_sft_rst.u64);
33562306a36Sopenharmony_ci		}
33662306a36Sopenharmony_ci	}
33762306a36Sopenharmony_ci}
33862306a36Sopenharmony_ci
33962306a36Sopenharmony_ci#endif /*  __CVMX_IPD_H__ */
340