From mboxrd@z Thu Jan  1 00:00:00 1970
Return-Path: <dev-bounces@dpdk.org>
Received: from dpdk.org (dpdk.org [92.243.14.124])
	by inbox.dpdk.org (Postfix) with ESMTP id F0FDCA04B1;
	Fri,  4 Sep 2020 10:36:06 +0200 (CEST)
Received: from [92.243.14.124] (localhost [127.0.0.1])
	by dpdk.org (Postfix) with ESMTP id 5DD1A1C10E;
	Fri,  4 Sep 2020 10:35:41 +0200 (CEST)
Received: from inva021.nxp.com (inva021.nxp.com [92.121.34.21])
 by dpdk.org (Postfix) with ESMTP id BF7B81C0BF
 for <dev@dpdk.org>; Fri,  4 Sep 2020 10:35:36 +0200 (CEST)
Received: from inva021.nxp.com (localhost [127.0.0.1])
 by inva021.eu-rdc02.nxp.com (Postfix) with ESMTP id 923CF201689;
 Fri,  4 Sep 2020 10:35:36 +0200 (CEST)
Received: from invc005.ap-rdc01.nxp.com (invc005.ap-rdc01.nxp.com
 [165.114.16.14])
 by inva021.eu-rdc02.nxp.com (Postfix) with ESMTP id F165620192B;
 Fri,  4 Sep 2020 10:35:34 +0200 (CEST)
Received: from bf-netperf1.ap.freescale.net (bf-netperf1.ap.freescale.net
 [10.232.133.63])
 by invc005.ap-rdc01.nxp.com (Postfix) with ESMTP id 78281402EB;
 Fri,  4 Sep 2020 10:35:32 +0200 (CEST)
From: Hemant Agrawal <hemant.agrawal@nxp.com>
To: dev@dpdk.org
Cc: ferruh.yigit@intel.com
Date: Fri,  4 Sep 2020 13:59:18 +0530
Message-Id: <20200904082921.17400-4-hemant.agrawal@nxp.com>
X-Mailer: git-send-email 2.17.1
In-Reply-To: <20200904082921.17400-1-hemant.agrawal@nxp.com>
References: <20200901123650.29908-1-hemant.agrawal@nxp.com>
 <20200904082921.17400-1-hemant.agrawal@nxp.com>
X-Virus-Scanned: ClamAV using ClamSMTP
Subject: [dpdk-dev] [PATCH v7 4/7] bus/dpaa: add Virtual Storage Profile
	port init
X-BeenThere: dev@dpdk.org
X-Mailman-Version: 2.1.15
Precedence: list
List-Id: DPDK patches and discussions <dev.dpdk.org>
List-Unsubscribe: <https://mails.dpdk.org/options/dev>,
 <mailto:dev-request@dpdk.org?subject=unsubscribe>
List-Archive: <http://mails.dpdk.org/archives/dev/>
List-Post: <mailto:dev@dpdk.org>
List-Help: <mailto:dev-request@dpdk.org?subject=help>
List-Subscribe: <https://mails.dpdk.org/listinfo/dev>,
 <mailto:dev-request@dpdk.org?subject=subscribe>
Errors-To: dev-bounces@dpdk.org
Sender: "dev" <dev-bounces@dpdk.org>

This patch add support to initialize the VSP ports
in the FMAN library.

Signed-off-by: Hemant Agrawal <hemant.agrawal@nxp.com>
---
 drivers/bus/dpaa/base/fman/fman.c | 57 +++++++++++++++++++++++++++++++
 drivers/bus/dpaa/include/fman.h   |  3 ++
 2 files changed, 60 insertions(+)

diff --git a/drivers/bus/dpaa/base/fman/fman.c b/drivers/bus/dpaa/base/fman/fman.c
index 3ae29bf06..39102bc1f 100644
--- a/drivers/bus/dpaa/base/fman/fman.c
+++ b/drivers/bus/dpaa/base/fman/fman.c
@@ -145,6 +145,61 @@ fman_get_mac_index(uint64_t regs_addr_host, uint8_t *mac_idx)
 	return ret;
 }
 
+static void fman_if_vsp_init(struct __fman_if *__if)
+{
+	const phandle *prop;
+	int cell_index;
+	const struct device_node *dev;
+	size_t lenp;
+	const uint8_t mac_idx[] = {-1, 0, 1, 2, 3, 4, 5, 6, 7, 0, 1};
+
+	if (__if->__if.mac_type == fman_mac_1g) {
+		for_each_compatible_node(dev, NULL,
+			"fsl,fman-port-1g-rx-extended-args") {
+			prop = of_get_property(dev, "cell-index", &lenp);
+			if (prop) {
+				cell_index = of_read_number(
+						&prop[0],
+						lenp / sizeof(phandle));
+				if (cell_index == mac_idx[__if->__if.mac_idx]) {
+					prop = of_get_property(
+							dev,
+							"vsp-window", &lenp);
+					if (prop) {
+						__if->__if.num_profiles =
+							of_read_number(
+								&prop[0], 1);
+						__if->__if.base_profile_id =
+							of_read_number(
+								&prop[1], 1);
+					}
+				}
+			}
+		}
+	} else if (__if->__if.mac_type == fman_mac_10g) {
+		for_each_compatible_node(dev, NULL,
+			"fsl,fman-port-10g-rx-extended-args") {
+			prop = of_get_property(dev, "cell-index", &lenp);
+			if (prop) {
+				cell_index = of_read_number(
+					&prop[0], lenp / sizeof(phandle));
+				if (cell_index == mac_idx[__if->__if.mac_idx]) {
+					prop = of_get_property(
+						dev, "vsp-window", &lenp);
+					if (prop) {
+						__if->__if.num_profiles =
+							of_read_number(
+								&prop[0], 1);
+						__if->__if.base_profile_id =
+							of_read_number(
+								&prop[1], 1);
+					}
+				}
+			}
+		}
+	}
+}
+
 static int
 fman_if_init(const struct device_node *dpa_node)
 {
@@ -519,6 +574,8 @@ fman_if_init(const struct device_node *dpa_node)
 	if (is_shared)
 		__if->__if.is_shared_mac = 1;
 
+	fman_if_vsp_init(__if);
+
 	/* Parsing of the network interface is complete, add it to the list */
 	DPAA_BUS_LOG(DEBUG, "Found %s, Tx Channel = %x, FMAN = %x,"
 		    "Port ID = %x",
diff --git a/drivers/bus/dpaa/include/fman.h b/drivers/bus/dpaa/include/fman.h
index cb7f18ca2..dcf408372 100644
--- a/drivers/bus/dpaa/include/fman.h
+++ b/drivers/bus/dpaa/include/fman.h
@@ -321,6 +321,9 @@ struct fman_if {
 	/* The Qman channel to schedule Tx FQs to */
 	u16 tx_channel_id;
 
+	uint8_t base_profile_id;
+	uint8_t num_profiles;
+
 	uint8_t is_shared_mac;
 	/* The hard-coded FQIDs for this interface. Note: this doesn't cover
 	 * the PCD nor the "Rx default" FQIDs, which are configured via FMC
-- 
2.17.1