From:   Yevhen Orlov <yevhen.orlov@plvision.eu>
To:     netdev@vger.kernel.org, stephen@networkplumber.org, andrew@lunn.ch
Cc:     Volodymyr Mytnyk <volodymyr.mytnyk@plvision.eu>,
        Taras Chornyi <taras.chornyi@plvision.eu>,
        Mickey Rachamim <mickeyr@marvell.com>,
        Serhiy Pshyk <serhiy.pshyk@plvision.eu>,
        Yevhen Orlov <yevhen.orlov@plvision.eu>,
        Taras Chornyi <tchornyi@marvell.com>,
        Oleksandr Mazur <oleksandr.mazur@plvision.eu>,
        "David S. Miller" <davem@davemloft.net>,
        Jakub Kicinski <kuba@kernel.org>, linux-kernel@vger.kernel.org
Subject: [PATCH net-next v2 3/6] net: marvell: prestera: Add prestera router infra
Date:   Mon, 27 Dec 2021 23:52:28 +0200
Message-Id: <20211227215233.31220-4-yevhen.orlov@plvision.eu>
In-Reply-To: <20211227215233.31220-1-yevhen.orlov@plvision.eu>
References: <20211227215233.31220-1-yevhen.orlov@plvision.eu>
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?VCi6fM1xdBzykh5kB0X0cy47VUXjQbbFoh/3VUynP9vo44SMD+I+X6q4QkR/?=
 =?us-ascii?Q?QWV9mQkDHfgXGJVQqDVCU1Bta5T6IU/v02RnPun4Qx7CTcik971nQ3FPhYYY?=
 =?us-ascii?Q?yIZpoot+8xYRxahkePLhxvq8t60ffKvGMVo3s264X1jBQH1o0RJ6lWMkgea9?=
 =?us-ascii?Q?wPBvvI1bzJvDWgCiVprfqZ1ZtgUi/GdKAJeXgMByaGAWo5fOYcwWZihFEOxi?=
 =?us-ascii?Q?fSt6n8ml+QlgExfGUk62XciWzc3BAvi0FY+AswKMAuB6qDwQC4OTkFZpFObz?=
 =?us-ascii?Q?4w405vHCsQO747peiZ4w7qXxoirrt0Dljkbvcn2ltozEnjEjSo8MEKe3TV9C?=
 =?us-ascii?Q?JGG0837WbaKgUHHf1HVOf33Se/wHbbWa1estwTTYtB4madPRIlMkZsvJUDB8?=
 =?us-ascii?Q?laocDqeOKwWjv9oO3CJDi3aHJWYCUqyQY5apQv/sDGG7SxITVQ4r1qW9DJaG?=
 =?us-ascii?Q?1qIqcD+KvahEW7l4/NbzvgjFjzp4baulyojPmjDIlaTn6MycgjnqAXZxH5JK?=
 =?us-ascii?Q?Hx6M/OQFs3vFWJbHw32+n5UsZJW0ccdKImVblI18/RcUY0y9BghoAhEqRF04?=
 =?us-ascii?Q?su5/lZ5XLhvQ6C/+fhkKHOxxcpREy05m8dFecm0LCLEG9XoQJuNA3cDDFhSC?=
 =?us-ascii?Q?EHRNCo3vZcw6uBExBm3LC5saYlSQuZbVqMwKf/TzPYaf1FSV9V6TxknpsbbL?=
 =?us-ascii?Q?J6aEKNJurwbJ7FkeTdTlDdONrhhUOkmL7l3irBATEHz0kQxpIuau7qNWfwtP?=
 =?us-ascii?Q?PQDMghep+0XtIgY7rdbwbpwLWthSv+D/Q5+I+zHORKgB0oKQXtgG/7WcHipB?=
 =?us-ascii?Q?s+VnWHf/SejqhG92F0p+7q/18FgMt9gHoaGpUDmeH72FqsDs3ZxcbiBpcJTm?=
 =?us-ascii?Q?E3RAmHl6ngqbZ8fSx5U1GCy8fx74ht6xdVnRsbb+KXRjdv2iAG69IDBF5w/+?=
 =?us-ascii?Q?muuxFfJxiG1296wc//d8MgrDxK/wEIg6jszcyBKBn3rpkpF5rWqzs0bTzmeV?=
 =?us-ascii?Q?+N5rRvjIffDgAHiKSav2DVj47uhmNJob7vdxoJX2RSTsWTjXiaHBgUnjwu9r?=
 =?us-ascii?Q?aH5tH1zRzK33R0NbRsOIgklL1oZTWBuSGVsaZAvS1AdzlbDF1afAFI8UcI1w?=
 =?us-ascii?Q?bKzN7QSvJTTEUqnHvBOTf5jP+YIzBaPakL2zyYQhG+JTdh4tPxdeDBR342lD?=
 =?us-ascii?Q?pGoYD9j2ZdmUaHYTdjH0Q7p5n22GYVzEPVerWfzyii1X4zDZl/uxMZqGQYUc?=
 =?us-ascii?Q?kDLNtPdxXKMb4Hnb4vILwJ7snffZx2SsaR+pHsUcJ+UqwdPwxSoSEAbUO8TO?=
 =?us-ascii?Q?PhVhLliJSc9S2jmFjeR2WRvuD8+lMrWcZetSDIb/OV2DAA7N5aK7rFJ4E9dQ?=
 =?us-ascii?Q?lby/93CMMy2wQEqbkg6JQCloizpAOH6USgHvs/1Q/CQY2vNlTz/XIFcSWziA?=
 =?us-ascii?Q?fMRM3BPru8VQmxsgIkm70DqlPkOYiRe82S52pmVVpmYMrrD2u4Dabs6kYjOw?=
 =?us-ascii?Q?ESrqKGfKbyPBtWTVqveVBehup0bQCBSsyT1NydJpmC+PO0GHvaY3LGRqsHQl?=
 =?us-ascii?Q?H2WwghO6n8IGsp51hXmAat4KlH+k+aB+JOeiKxnHK35Lxxjcot4AgIA2xsJZ?=
 =?us-ascii?Q?bt49USpSiN6pjvRmZpgCnOmYa+EjNnE12Idv75AjrUSYKezZ1LaB3DIzCAnM?=
 =?us-ascii?Q?ydZ0Uw=3D=3D?=
X-OriginatorOrg: plvision.eu
X-MS-Exchange-CrossTenant-Network-Message-Id: 25ec3fcc-35db-4656-68e5-08d9c9835fcf
X-MS-Exchange-CrossTenant-AuthSource: AM9P190MB1122.EURP190.PROD.OUTLOOK.COM
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 27 Dec 2021 21:53:53.6056
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: 03707b74-30f3-46b6-a0e0-ff0a7438c9c4
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: useLh25c8Fl+7w3W7snGCZD+tIfo7PF427NFc49ulnvumTiMt6QHP6Hg6ax6urz3HhLoqNRvmX8C0doXemys0yrc+1jqYcs8RP8GE9rbgpo=
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM4P190MB0145
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

Add prestera_router.c, which contains code to subscribe/unsubscribe on
kernel notifiers for router. This handle kernel notifications,
parse structures to make key to manipulate prestera_router_hw's objects.

Also prestera_router is container for router's objects database.

Co-developed-by: Taras Chornyi <tchornyi@marvell.com>
Signed-off-by: Taras Chornyi <tchornyi@marvell.com>
Co-developed-by: Oleksandr Mazur <oleksandr.mazur@plvision.eu>
Signed-off-by: Oleksandr Mazur <oleksandr.mazur@plvision.eu>
Signed-off-by: Yevhen Orlov <yevhen.orlov@plvision.eu>
---
v1-->v2
* No changes
---
 .../net/ethernet/marvell/prestera/Makefile    |  3 +-
 .../net/ethernet/marvell/prestera/prestera.h  | 11 ++++++++
 .../ethernet/marvell/prestera/prestera_main.c |  6 ++++
 .../marvell/prestera/prestera_router.c        | 28 +++++++++++++++++++
 4 files changed, 47 insertions(+), 1 deletion(-)
 create mode 100644 drivers/net/ethernet/marvell/prestera/prestera_router.c

diff --git a/drivers/net/ethernet/marvell/prestera/Makefile b/drivers/net/ethernet/marvell/prestera/Makefile
index 48dbcb2baf8f..ec69fc564a9f 100644
--- a/drivers/net/ethernet/marvell/prestera/Makefile
+++ b/drivers/net/ethernet/marvell/prestera/Makefile
@@ -3,6 +3,7 @@ obj-$(CONFIG_PRESTERA)	+= prestera.o
 prestera-objs		:= prestera_main.o prestera_hw.o prestera_dsa.o \
 			   prestera_rxtx.o prestera_devlink.o prestera_ethtool.o \
 			   prestera_switchdev.o prestera_acl.o prestera_flow.o \
-			   prestera_flower.o prestera_span.o prestera_counter.o
+			   prestera_flower.o prestera_span.o prestera_counter.o \
+			   prestera_router.o
 
 obj-$(CONFIG_PRESTERA_PCI)	+= prestera_pci.o
diff --git a/drivers/net/ethernet/marvell/prestera/prestera.h b/drivers/net/ethernet/marvell/prestera/prestera.h
index 636caf492531..7160da678457 100644
--- a/drivers/net/ethernet/marvell/prestera/prestera.h
+++ b/drivers/net/ethernet/marvell/prestera/prestera.h
@@ -270,12 +270,20 @@ struct prestera_switch {
 	u32 mtu_min;
 	u32 mtu_max;
 	u8 id;
+	struct prestera_router *router;
 	struct prestera_lag *lags;
 	struct prestera_counter *counter;
 	u8 lag_member_max;
 	u8 lag_max;
 };
 
+struct prestera_router {
+	struct prestera_switch *sw;
+	struct list_head vr_list;
+	struct list_head rif_entry_list;
+	bool aborted;
+};
+
 struct prestera_rxtx_params {
 	bool use_sdma;
 	u32 map_addr;
@@ -303,6 +311,9 @@ struct prestera_port *prestera_port_find_by_hwid(struct prestera_switch *sw,
 
 int prestera_port_autoneg_set(struct prestera_port *port, u64 link_modes);
 
+int prestera_router_init(struct prestera_switch *sw);
+void prestera_router_fini(struct prestera_switch *sw);
+
 struct prestera_port *prestera_find_port(struct prestera_switch *sw, u32 id);
 
 int prestera_port_cfg_mac_read(struct prestera_port *port,
diff --git a/drivers/net/ethernet/marvell/prestera/prestera_main.c b/drivers/net/ethernet/marvell/prestera/prestera_main.c
index a0dbad5cb88d..242904fcd866 100644
--- a/drivers/net/ethernet/marvell/prestera/prestera_main.c
+++ b/drivers/net/ethernet/marvell/prestera/prestera_main.c
@@ -893,6 +893,10 @@ static int prestera_switch_init(struct prestera_switch *sw)
 	if (err)
 		return err;
 
+	err = prestera_router_init(sw);
+	if (err)
+		goto err_router_init;
+
 	err = prestera_switchdev_init(sw);
 	if (err)
 		goto err_swdev_register;
@@ -949,6 +953,8 @@ static int prestera_switch_init(struct prestera_switch *sw)
 err_rxtx_register:
 	prestera_switchdev_fini(sw);
 err_swdev_register:
+	prestera_router_fini(sw);
+err_router_init:
 	prestera_netdev_event_handler_unregister(sw);
 	prestera_hw_switch_fini(sw);
 
diff --git a/drivers/net/ethernet/marvell/prestera/prestera_router.c b/drivers/net/ethernet/marvell/prestera/prestera_router.c
new file mode 100644
index 000000000000..f3980d10eb29
--- /dev/null
+++ b/drivers/net/ethernet/marvell/prestera/prestera_router.c
@@ -0,0 +1,28 @@
+// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
+/* Copyright (c) 2019-2021 Marvell International Ltd. All rights reserved */
+
+#include <linux/kernel.h>
+#include <linux/types.h>
+
+#include "prestera.h"
+
+int prestera_router_init(struct prestera_switch *sw)
+{
+	struct prestera_router *router;
+
+	router = kzalloc(sizeof(*sw->router), GFP_KERNEL);
+	if (!router)
+		return -ENOMEM;
+
+	sw->router = router;
+	router->sw = sw;
+
+	return 0;
+}
+
+void prestera_router_fini(struct prestera_switch *sw)
+{
+	kfree(sw->router);
+	sw->router = NULL;
+}
+
-- 
2.17.1