18c2ecf20Sopenharmony_ci/***********************license start***************
28c2ecf20Sopenharmony_ci * Author: Cavium Networks
38c2ecf20Sopenharmony_ci *
48c2ecf20Sopenharmony_ci * Contact: support@caviumnetworks.com
58c2ecf20Sopenharmony_ci * This file is part of the OCTEON SDK
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * Copyright (c) 2003-2008 Cavium Networks
88c2ecf20Sopenharmony_ci *
98c2ecf20Sopenharmony_ci * This file is free software; you can redistribute it and/or modify
108c2ecf20Sopenharmony_ci * it under the terms of the GNU General Public License, Version 2, as
118c2ecf20Sopenharmony_ci * published by the Free Software Foundation.
128c2ecf20Sopenharmony_ci *
138c2ecf20Sopenharmony_ci * This file is distributed in the hope that it will be useful, but
148c2ecf20Sopenharmony_ci * AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty
158c2ecf20Sopenharmony_ci * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or
168c2ecf20Sopenharmony_ci * NONINFRINGEMENT.  See the GNU General Public License for more
178c2ecf20Sopenharmony_ci * details.
188c2ecf20Sopenharmony_ci *
198c2ecf20Sopenharmony_ci * You should have received a copy of the GNU General Public License
208c2ecf20Sopenharmony_ci * along with this file; if not, write to the Free Software
218c2ecf20Sopenharmony_ci * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
228c2ecf20Sopenharmony_ci * or visit http://www.gnu.org/licenses/.
238c2ecf20Sopenharmony_ci *
248c2ecf20Sopenharmony_ci * This file may also be available under a different license from Cavium.
258c2ecf20Sopenharmony_ci * Contact Cavium Networks for more information
268c2ecf20Sopenharmony_ci ***********************license end**************************************/
278c2ecf20Sopenharmony_ci
288c2ecf20Sopenharmony_ci/**
298c2ecf20Sopenharmony_ci *
308c2ecf20Sopenharmony_ci * Interface to the hardware Input Packet Data unit.
318c2ecf20Sopenharmony_ci */
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci#ifndef __CVMX_IPD_H__
348c2ecf20Sopenharmony_ci#define __CVMX_IPD_H__
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_ci#include <asm/octeon/octeon-feature.h>
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_ci#include <asm/octeon/cvmx-ipd-defs.h>
398c2ecf20Sopenharmony_ci#include <asm/octeon/cvmx-pip-defs.h>
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_cienum cvmx_ipd_mode {
428c2ecf20Sopenharmony_ci   CVMX_IPD_OPC_MODE_STT = 0LL,	  /* All blocks DRAM, not cached in L2 */
438c2ecf20Sopenharmony_ci   CVMX_IPD_OPC_MODE_STF = 1LL,	  /* All blocks into  L2 */
448c2ecf20Sopenharmony_ci   CVMX_IPD_OPC_MODE_STF1_STT = 2LL,   /* 1st block L2, rest DRAM */
458c2ecf20Sopenharmony_ci   CVMX_IPD_OPC_MODE_STF2_STT = 3LL    /* 1st, 2nd blocks L2, rest DRAM */
468c2ecf20Sopenharmony_ci};
478c2ecf20Sopenharmony_ci
488c2ecf20Sopenharmony_ci#ifndef CVMX_ENABLE_LEN_M8_FIX
498c2ecf20Sopenharmony_ci#define CVMX_ENABLE_LEN_M8_FIX 0
508c2ecf20Sopenharmony_ci#endif
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci/* CSR typedefs have been moved to cvmx-csr-*.h */
538c2ecf20Sopenharmony_citypedef union cvmx_ipd_1st_mbuff_skip cvmx_ipd_mbuff_first_skip_t;
548c2ecf20Sopenharmony_citypedef union cvmx_ipd_1st_next_ptr_back cvmx_ipd_first_next_ptr_back_t;
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_citypedef cvmx_ipd_mbuff_first_skip_t cvmx_ipd_mbuff_not_first_skip_t;
578c2ecf20Sopenharmony_citypedef cvmx_ipd_first_next_ptr_back_t cvmx_ipd_second_next_ptr_back_t;
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci/**
608c2ecf20Sopenharmony_ci * Configure IPD
618c2ecf20Sopenharmony_ci *
628c2ecf20Sopenharmony_ci * @mbuff_size: Packets buffer size in 8 byte words
638c2ecf20Sopenharmony_ci * @first_mbuff_skip:
648c2ecf20Sopenharmony_ci *		     Number of 8 byte words to skip in the first buffer
658c2ecf20Sopenharmony_ci * @not_first_mbuff_skip:
668c2ecf20Sopenharmony_ci *		     Number of 8 byte words to skip in each following buffer
678c2ecf20Sopenharmony_ci * @first_back: Must be same as first_mbuff_skip / 128
688c2ecf20Sopenharmony_ci * @second_back:
698c2ecf20Sopenharmony_ci *		     Must be same as not_first_mbuff_skip / 128
708c2ecf20Sopenharmony_ci * @wqe_fpa_pool:
718c2ecf20Sopenharmony_ci *		     FPA pool to get work entries from
728c2ecf20Sopenharmony_ci * @cache_mode:
738c2ecf20Sopenharmony_ci * @back_pres_enable_flag:
748c2ecf20Sopenharmony_ci *		     Enable or disable port back pressure
758c2ecf20Sopenharmony_ci */
768c2ecf20Sopenharmony_cistatic inline void cvmx_ipd_config(uint64_t mbuff_size,
778c2ecf20Sopenharmony_ci				   uint64_t first_mbuff_skip,
788c2ecf20Sopenharmony_ci				   uint64_t not_first_mbuff_skip,
798c2ecf20Sopenharmony_ci				   uint64_t first_back,
808c2ecf20Sopenharmony_ci				   uint64_t second_back,
818c2ecf20Sopenharmony_ci				   uint64_t wqe_fpa_pool,
828c2ecf20Sopenharmony_ci				   enum cvmx_ipd_mode cache_mode,
838c2ecf20Sopenharmony_ci				   uint64_t back_pres_enable_flag)
848c2ecf20Sopenharmony_ci{
858c2ecf20Sopenharmony_ci	cvmx_ipd_mbuff_first_skip_t first_skip;
868c2ecf20Sopenharmony_ci	cvmx_ipd_mbuff_not_first_skip_t not_first_skip;
878c2ecf20Sopenharmony_ci	union cvmx_ipd_packet_mbuff_size size;
888c2ecf20Sopenharmony_ci	cvmx_ipd_first_next_ptr_back_t first_back_struct;
898c2ecf20Sopenharmony_ci	cvmx_ipd_second_next_ptr_back_t second_back_struct;
908c2ecf20Sopenharmony_ci	union cvmx_ipd_wqe_fpa_queue wqe_pool;
918c2ecf20Sopenharmony_ci	union cvmx_ipd_ctl_status ipd_ctl_reg;
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci	first_skip.u64 = 0;
948c2ecf20Sopenharmony_ci	first_skip.s.skip_sz = first_mbuff_skip;
958c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_1ST_MBUFF_SKIP, first_skip.u64);
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci	not_first_skip.u64 = 0;
988c2ecf20Sopenharmony_ci	not_first_skip.s.skip_sz = not_first_mbuff_skip;
998c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_NOT_1ST_MBUFF_SKIP, not_first_skip.u64);
1008c2ecf20Sopenharmony_ci
1018c2ecf20Sopenharmony_ci	size.u64 = 0;
1028c2ecf20Sopenharmony_ci	size.s.mb_size = mbuff_size;
1038c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_PACKET_MBUFF_SIZE, size.u64);
1048c2ecf20Sopenharmony_ci
1058c2ecf20Sopenharmony_ci	first_back_struct.u64 = 0;
1068c2ecf20Sopenharmony_ci	first_back_struct.s.back = first_back;
1078c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_1st_NEXT_PTR_BACK, first_back_struct.u64);
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ci	second_back_struct.u64 = 0;
1108c2ecf20Sopenharmony_ci	second_back_struct.s.back = second_back;
1118c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_2nd_NEXT_PTR_BACK, second_back_struct.u64);
1128c2ecf20Sopenharmony_ci
1138c2ecf20Sopenharmony_ci	wqe_pool.u64 = 0;
1148c2ecf20Sopenharmony_ci	wqe_pool.s.wqe_pool = wqe_fpa_pool;
1158c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_WQE_FPA_QUEUE, wqe_pool.u64);
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci	ipd_ctl_reg.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
1188c2ecf20Sopenharmony_ci	ipd_ctl_reg.s.opc_mode = cache_mode;
1198c2ecf20Sopenharmony_ci	ipd_ctl_reg.s.pbp_en = back_pres_enable_flag;
1208c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_ctl_reg.u64);
1218c2ecf20Sopenharmony_ci
1228c2ecf20Sopenharmony_ci	/* Note: the example RED code that used to be here has been moved to
1238c2ecf20Sopenharmony_ci	   cvmx_helper_setup_red */
1248c2ecf20Sopenharmony_ci}
1258c2ecf20Sopenharmony_ci
1268c2ecf20Sopenharmony_ci/**
1278c2ecf20Sopenharmony_ci * Enable IPD
1288c2ecf20Sopenharmony_ci */
1298c2ecf20Sopenharmony_cistatic inline void cvmx_ipd_enable(void)
1308c2ecf20Sopenharmony_ci{
1318c2ecf20Sopenharmony_ci	union cvmx_ipd_ctl_status ipd_reg;
1328c2ecf20Sopenharmony_ci	ipd_reg.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
1338c2ecf20Sopenharmony_ci	if (ipd_reg.s.ipd_en) {
1348c2ecf20Sopenharmony_ci		cvmx_dprintf
1358c2ecf20Sopenharmony_ci		    ("Warning: Enabling IPD when IPD already enabled.\n");
1368c2ecf20Sopenharmony_ci	}
1378c2ecf20Sopenharmony_ci	ipd_reg.s.ipd_en = 1;
1388c2ecf20Sopenharmony_ci#if  CVMX_ENABLE_LEN_M8_FIX
1398c2ecf20Sopenharmony_ci	if (!OCTEON_IS_MODEL(OCTEON_CN38XX_PASS2))
1408c2ecf20Sopenharmony_ci		ipd_reg.s.len_m8 = TRUE;
1418c2ecf20Sopenharmony_ci#endif
1428c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_reg.u64);
1438c2ecf20Sopenharmony_ci}
1448c2ecf20Sopenharmony_ci
1458c2ecf20Sopenharmony_ci/**
1468c2ecf20Sopenharmony_ci * Disable IPD
1478c2ecf20Sopenharmony_ci */
1488c2ecf20Sopenharmony_cistatic inline void cvmx_ipd_disable(void)
1498c2ecf20Sopenharmony_ci{
1508c2ecf20Sopenharmony_ci	union cvmx_ipd_ctl_status ipd_reg;
1518c2ecf20Sopenharmony_ci	ipd_reg.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
1528c2ecf20Sopenharmony_ci	ipd_reg.s.ipd_en = 0;
1538c2ecf20Sopenharmony_ci	cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_reg.u64);
1548c2ecf20Sopenharmony_ci}
1558c2ecf20Sopenharmony_ci
1568c2ecf20Sopenharmony_ci/**
1578c2ecf20Sopenharmony_ci * Supportive function for cvmx_fpa_shutdown_pool.
1588c2ecf20Sopenharmony_ci */
1598c2ecf20Sopenharmony_cistatic inline void cvmx_ipd_free_ptr(void)
1608c2ecf20Sopenharmony_ci{
1618c2ecf20Sopenharmony_ci	/* Only CN38XXp{1,2} cannot read pointer out of the IPD */
1628c2ecf20Sopenharmony_ci	if (!OCTEON_IS_MODEL(OCTEON_CN38XX_PASS1)
1638c2ecf20Sopenharmony_ci	    && !OCTEON_IS_MODEL(OCTEON_CN38XX_PASS2)) {
1648c2ecf20Sopenharmony_ci		int no_wptr = 0;
1658c2ecf20Sopenharmony_ci		union cvmx_ipd_ptr_count ipd_ptr_count;
1668c2ecf20Sopenharmony_ci		ipd_ptr_count.u64 = cvmx_read_csr(CVMX_IPD_PTR_COUNT);
1678c2ecf20Sopenharmony_ci
1688c2ecf20Sopenharmony_ci		/* Handle Work Queue Entry in cn56xx and cn52xx */
1698c2ecf20Sopenharmony_ci		if (octeon_has_feature(OCTEON_FEATURE_NO_WPTR)) {
1708c2ecf20Sopenharmony_ci			union cvmx_ipd_ctl_status ipd_ctl_status;
1718c2ecf20Sopenharmony_ci			ipd_ctl_status.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
1728c2ecf20Sopenharmony_ci			if (ipd_ctl_status.s.no_wptr)
1738c2ecf20Sopenharmony_ci				no_wptr = 1;
1748c2ecf20Sopenharmony_ci		}
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci		/* Free the prefetched WQE */
1778c2ecf20Sopenharmony_ci		if (ipd_ptr_count.s.wqev_cnt) {
1788c2ecf20Sopenharmony_ci			union cvmx_ipd_wqe_ptr_valid ipd_wqe_ptr_valid;
1798c2ecf20Sopenharmony_ci			ipd_wqe_ptr_valid.u64 =
1808c2ecf20Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_WQE_PTR_VALID);
1818c2ecf20Sopenharmony_ci			if (no_wptr)
1828c2ecf20Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
1838c2ecf20Sopenharmony_ci					      ((uint64_t) ipd_wqe_ptr_valid.s.
1848c2ecf20Sopenharmony_ci					       ptr << 7), CVMX_FPA_PACKET_POOL,
1858c2ecf20Sopenharmony_ci					      0);
1868c2ecf20Sopenharmony_ci			else
1878c2ecf20Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
1888c2ecf20Sopenharmony_ci					      ((uint64_t) ipd_wqe_ptr_valid.s.
1898c2ecf20Sopenharmony_ci					       ptr << 7), CVMX_FPA_WQE_POOL, 0);
1908c2ecf20Sopenharmony_ci		}
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ci		/* Free all WQE in the fifo */
1938c2ecf20Sopenharmony_ci		if (ipd_ptr_count.s.wqe_pcnt) {
1948c2ecf20Sopenharmony_ci			int i;
1958c2ecf20Sopenharmony_ci			union cvmx_ipd_pwp_ptr_fifo_ctl ipd_pwp_ptr_fifo_ctl;
1968c2ecf20Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.u64 =
1978c2ecf20Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
1988c2ecf20Sopenharmony_ci			for (i = 0; i < ipd_ptr_count.s.wqe_pcnt; i++) {
1998c2ecf20Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.cena = 0;
2008c2ecf20Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.raddr =
2018c2ecf20Sopenharmony_ci				    ipd_pwp_ptr_fifo_ctl.s.max_cnts +
2028c2ecf20Sopenharmony_ci				    (ipd_pwp_ptr_fifo_ctl.s.wraddr +
2038c2ecf20Sopenharmony_ci				     i) % ipd_pwp_ptr_fifo_ctl.s.max_cnts;
2048c2ecf20Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
2058c2ecf20Sopenharmony_ci					       ipd_pwp_ptr_fifo_ctl.u64);
2068c2ecf20Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.u64 =
2078c2ecf20Sopenharmony_ci				    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
2088c2ecf20Sopenharmony_ci				if (no_wptr)
2098c2ecf20Sopenharmony_ci					cvmx_fpa_free(cvmx_phys_to_ptr
2108c2ecf20Sopenharmony_ci						      ((uint64_t)
2118c2ecf20Sopenharmony_ci						       ipd_pwp_ptr_fifo_ctl.s.
2128c2ecf20Sopenharmony_ci						       ptr << 7),
2138c2ecf20Sopenharmony_ci						      CVMX_FPA_PACKET_POOL, 0);
2148c2ecf20Sopenharmony_ci				else
2158c2ecf20Sopenharmony_ci					cvmx_fpa_free(cvmx_phys_to_ptr
2168c2ecf20Sopenharmony_ci						      ((uint64_t)
2178c2ecf20Sopenharmony_ci						       ipd_pwp_ptr_fifo_ctl.s.
2188c2ecf20Sopenharmony_ci						       ptr << 7),
2198c2ecf20Sopenharmony_ci						      CVMX_FPA_WQE_POOL, 0);
2208c2ecf20Sopenharmony_ci			}
2218c2ecf20Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.s.cena = 1;
2228c2ecf20Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
2238c2ecf20Sopenharmony_ci				       ipd_pwp_ptr_fifo_ctl.u64);
2248c2ecf20Sopenharmony_ci		}
2258c2ecf20Sopenharmony_ci
2268c2ecf20Sopenharmony_ci		/* Free the prefetched packet */
2278c2ecf20Sopenharmony_ci		if (ipd_ptr_count.s.pktv_cnt) {
2288c2ecf20Sopenharmony_ci			union cvmx_ipd_pkt_ptr_valid ipd_pkt_ptr_valid;
2298c2ecf20Sopenharmony_ci			ipd_pkt_ptr_valid.u64 =
2308c2ecf20Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PKT_PTR_VALID);
2318c2ecf20Sopenharmony_ci			cvmx_fpa_free(cvmx_phys_to_ptr
2328c2ecf20Sopenharmony_ci				      (ipd_pkt_ptr_valid.s.ptr << 7),
2338c2ecf20Sopenharmony_ci				      CVMX_FPA_PACKET_POOL, 0);
2348c2ecf20Sopenharmony_ci		}
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_ci		/* Free the per port prefetched packets */
2378c2ecf20Sopenharmony_ci		if (1) {
2388c2ecf20Sopenharmony_ci			int i;
2398c2ecf20Sopenharmony_ci			union cvmx_ipd_prc_port_ptr_fifo_ctl
2408c2ecf20Sopenharmony_ci			    ipd_prc_port_ptr_fifo_ctl;
2418c2ecf20Sopenharmony_ci			ipd_prc_port_ptr_fifo_ctl.u64 =
2428c2ecf20Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL);
2438c2ecf20Sopenharmony_ci
2448c2ecf20Sopenharmony_ci			for (i = 0; i < ipd_prc_port_ptr_fifo_ctl.s.max_pkt;
2458c2ecf20Sopenharmony_ci			     i++) {
2468c2ecf20Sopenharmony_ci				ipd_prc_port_ptr_fifo_ctl.s.cena = 0;
2478c2ecf20Sopenharmony_ci				ipd_prc_port_ptr_fifo_ctl.s.raddr =
2488c2ecf20Sopenharmony_ci				    i % ipd_prc_port_ptr_fifo_ctl.s.max_pkt;
2498c2ecf20Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL,
2508c2ecf20Sopenharmony_ci					       ipd_prc_port_ptr_fifo_ctl.u64);
2518c2ecf20Sopenharmony_ci				ipd_prc_port_ptr_fifo_ctl.u64 =
2528c2ecf20Sopenharmony_ci				    cvmx_read_csr
2538c2ecf20Sopenharmony_ci				    (CVMX_IPD_PRC_PORT_PTR_FIFO_CTL);
2548c2ecf20Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
2558c2ecf20Sopenharmony_ci					      ((uint64_t)
2568c2ecf20Sopenharmony_ci					       ipd_prc_port_ptr_fifo_ctl.s.
2578c2ecf20Sopenharmony_ci					       ptr << 7), CVMX_FPA_PACKET_POOL,
2588c2ecf20Sopenharmony_ci					      0);
2598c2ecf20Sopenharmony_ci			}
2608c2ecf20Sopenharmony_ci			ipd_prc_port_ptr_fifo_ctl.s.cena = 1;
2618c2ecf20Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL,
2628c2ecf20Sopenharmony_ci				       ipd_prc_port_ptr_fifo_ctl.u64);
2638c2ecf20Sopenharmony_ci		}
2648c2ecf20Sopenharmony_ci
2658c2ecf20Sopenharmony_ci		/* Free all packets in the holding fifo */
2668c2ecf20Sopenharmony_ci		if (ipd_ptr_count.s.pfif_cnt) {
2678c2ecf20Sopenharmony_ci			int i;
2688c2ecf20Sopenharmony_ci			union cvmx_ipd_prc_hold_ptr_fifo_ctl
2698c2ecf20Sopenharmony_ci			    ipd_prc_hold_ptr_fifo_ctl;
2708c2ecf20Sopenharmony_ci
2718c2ecf20Sopenharmony_ci			ipd_prc_hold_ptr_fifo_ctl.u64 =
2728c2ecf20Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL);
2738c2ecf20Sopenharmony_ci
2748c2ecf20Sopenharmony_ci			for (i = 0; i < ipd_ptr_count.s.pfif_cnt; i++) {
2758c2ecf20Sopenharmony_ci				ipd_prc_hold_ptr_fifo_ctl.s.cena = 0;
2768c2ecf20Sopenharmony_ci				ipd_prc_hold_ptr_fifo_ctl.s.raddr =
2778c2ecf20Sopenharmony_ci				    (ipd_prc_hold_ptr_fifo_ctl.s.praddr +
2788c2ecf20Sopenharmony_ci				     i) % ipd_prc_hold_ptr_fifo_ctl.s.max_pkt;
2798c2ecf20Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL,
2808c2ecf20Sopenharmony_ci					       ipd_prc_hold_ptr_fifo_ctl.u64);
2818c2ecf20Sopenharmony_ci				ipd_prc_hold_ptr_fifo_ctl.u64 =
2828c2ecf20Sopenharmony_ci				    cvmx_read_csr
2838c2ecf20Sopenharmony_ci				    (CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL);
2848c2ecf20Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
2858c2ecf20Sopenharmony_ci					      ((uint64_t)
2868c2ecf20Sopenharmony_ci					       ipd_prc_hold_ptr_fifo_ctl.s.
2878c2ecf20Sopenharmony_ci					       ptr << 7), CVMX_FPA_PACKET_POOL,
2888c2ecf20Sopenharmony_ci					      0);
2898c2ecf20Sopenharmony_ci			}
2908c2ecf20Sopenharmony_ci			ipd_prc_hold_ptr_fifo_ctl.s.cena = 1;
2918c2ecf20Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL,
2928c2ecf20Sopenharmony_ci				       ipd_prc_hold_ptr_fifo_ctl.u64);
2938c2ecf20Sopenharmony_ci		}
2948c2ecf20Sopenharmony_ci
2958c2ecf20Sopenharmony_ci		/* Free all packets in the fifo */
2968c2ecf20Sopenharmony_ci		if (ipd_ptr_count.s.pkt_pcnt) {
2978c2ecf20Sopenharmony_ci			int i;
2988c2ecf20Sopenharmony_ci			union cvmx_ipd_pwp_ptr_fifo_ctl ipd_pwp_ptr_fifo_ctl;
2998c2ecf20Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.u64 =
3008c2ecf20Sopenharmony_ci			    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
3018c2ecf20Sopenharmony_ci
3028c2ecf20Sopenharmony_ci			for (i = 0; i < ipd_ptr_count.s.pkt_pcnt; i++) {
3038c2ecf20Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.cena = 0;
3048c2ecf20Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.s.raddr =
3058c2ecf20Sopenharmony_ci				    (ipd_pwp_ptr_fifo_ctl.s.praddr +
3068c2ecf20Sopenharmony_ci				     i) % ipd_pwp_ptr_fifo_ctl.s.max_cnts;
3078c2ecf20Sopenharmony_ci				cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
3088c2ecf20Sopenharmony_ci					       ipd_pwp_ptr_fifo_ctl.u64);
3098c2ecf20Sopenharmony_ci				ipd_pwp_ptr_fifo_ctl.u64 =
3108c2ecf20Sopenharmony_ci				    cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
3118c2ecf20Sopenharmony_ci				cvmx_fpa_free(cvmx_phys_to_ptr
3128c2ecf20Sopenharmony_ci					      ((uint64_t) ipd_pwp_ptr_fifo_ctl.
3138c2ecf20Sopenharmony_ci					       s.ptr << 7),
3148c2ecf20Sopenharmony_ci					      CVMX_FPA_PACKET_POOL, 0);
3158c2ecf20Sopenharmony_ci			}
3168c2ecf20Sopenharmony_ci			ipd_pwp_ptr_fifo_ctl.s.cena = 1;
3178c2ecf20Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL,
3188c2ecf20Sopenharmony_ci				       ipd_pwp_ptr_fifo_ctl.u64);
3198c2ecf20Sopenharmony_ci		}
3208c2ecf20Sopenharmony_ci
3218c2ecf20Sopenharmony_ci		/* Reset the IPD to get all buffers out of it */
3228c2ecf20Sopenharmony_ci		{
3238c2ecf20Sopenharmony_ci			union cvmx_ipd_ctl_status ipd_ctl_status;
3248c2ecf20Sopenharmony_ci			ipd_ctl_status.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
3258c2ecf20Sopenharmony_ci			ipd_ctl_status.s.reset = 1;
3268c2ecf20Sopenharmony_ci			cvmx_write_csr(CVMX_IPD_CTL_STATUS, ipd_ctl_status.u64);
3278c2ecf20Sopenharmony_ci		}
3288c2ecf20Sopenharmony_ci
3298c2ecf20Sopenharmony_ci		/* Reset the PIP */
3308c2ecf20Sopenharmony_ci		{
3318c2ecf20Sopenharmony_ci			union cvmx_pip_sft_rst pip_sft_rst;
3328c2ecf20Sopenharmony_ci			pip_sft_rst.u64 = cvmx_read_csr(CVMX_PIP_SFT_RST);
3338c2ecf20Sopenharmony_ci			pip_sft_rst.s.rst = 1;
3348c2ecf20Sopenharmony_ci			cvmx_write_csr(CVMX_PIP_SFT_RST, pip_sft_rst.u64);
3358c2ecf20Sopenharmony_ci		}
3368c2ecf20Sopenharmony_ci	}
3378c2ecf20Sopenharmony_ci}
3388c2ecf20Sopenharmony_ci
3398c2ecf20Sopenharmony_ci#endif /*  __CVMX_IPD_H__ */
340