From:   Yevhen Orlov <yevhen.orlov@plvision.eu>
To:     netdev@vger.kernel.org
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 6/6] net: marvell: prestera: Implement initial inetaddr notifiers
Date:   Fri, 17 Dec 2021 21:54:38 +0200
Message-Id: <20211217195440.29838-7-yevhen.orlov@plvision.eu>
In-Reply-To: <20211217195440.29838-1-yevhen.orlov@plvision.eu>
References: <20211217195440.29838-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?JyH+yzGEdvu1PI5dvfJOCWQxm9tIU2EDj+JPEXCoYE8VNVphFgrt+ELFSkw2?=
 =?us-ascii?Q?2Tq+10QA1qfrE3XByJhfxC8//0ILSfpJTlMTaYCpGAt49gGaeqXhdQGkMvNu?=
 =?us-ascii?Q?B9HK3QWSnTaxrHb+oT6Mi3coE9dMHAn2M/yA+h2iIZYm6Ei6SecpyPaqRGz+?=
 =?us-ascii?Q?zOB3M+7k0VK2j5JNOPdGxg26bwljBeeilNZDJt5cBSrl11zaE3Hf+5WhgsYv?=
 =?us-ascii?Q?lMZT517jDUrdTBKsLnUdGYhBSz5ujYUPuBpRsAwfXi/2YPkHQy7W0jFZlPpY?=
 =?us-ascii?Q?pDi31Q7ez6207gA18gCFqwIchXLbl13r6Pf8RawHmrQxstWRJRmO9J6eMzXO?=
 =?us-ascii?Q?UjMV//GSafHkxJ+9m08EwHTpDpgK5uELs//l6NLUKi5JsfdK/zcj1wAwm1an?=
 =?us-ascii?Q?GC+LgN8gP0qLf0NpksEnyAR9Gb1NNmhOGW8AxCLnPMYGDq8wz3LnMxoPBiT/?=
 =?us-ascii?Q?KL9Rk7oK+hDP5eZFJoOIwoq5tG/S4GIVWMfWaQRXsua1U1NkKvph4qH0yEi4?=
 =?us-ascii?Q?j8DpT1C9FdECpS/bIh/VwaFhhA0pvgvk6uKRp8vuM1mwmY27zkyUuU7+YB9U?=
 =?us-ascii?Q?3JlbjcyNZCBQjjdNYM31XDapHTY6dmFDZK1mEkEv3r63Vt1UEWLAvE41UnQd?=
 =?us-ascii?Q?Wxk/T+VB7z2WVJE9bI6EHRH5eAg7ctXvwx1ZeUpzVEyZH9aHPnU3Z4l1wETh?=
 =?us-ascii?Q?50D3Qu8Q0YV08zC/HgqMjceY004qDsOWr1RCTO00gSqv2eJ7sORvYXqfLhJZ?=
 =?us-ascii?Q?1p/6R+warp4UELCrfcs5HRBb//Xra6BowYBpTNzLFIdnKHxc5Uca2nHjBQyq?=
 =?us-ascii?Q?S7Q+PNp/9swTQm8X1bL3DiEpnM08A9M9fEVKY+zZltAOQl277VSrvMKIzHXs?=
 =?us-ascii?Q?WIftKrxmfMGYJLT7F4JtRuJcJNq8qlLGxBX/FymE/f1ff+0P7JSEZd6Ao7q1?=
 =?us-ascii?Q?rCYGI7n0wUcOVxYsi4Vy9WGB4pbSlRPNiQg2PPaZzWbizOwJSZf7ThwxomHh?=
 =?us-ascii?Q?l4qmgWQ0ncEmO5jjhKaCCSr0VD4mHYWWKDZdxNdUxuGyAHGbVKi8saHSyuQS?=
 =?us-ascii?Q?ragYqxAsFdB444GNNlMXOmlfcHAYxan/DQ6k1xXqD5ejbDvmGs06q4+Lq6m7?=
 =?us-ascii?Q?ORxgdwFvvYZiy9lSWI/meJMNrfor0NwnqNDtfHuikQ5BNccqN1NowoNKZKvc?=
 =?us-ascii?Q?OubzYOmhQMCDnqcPdlQP7eQBOiB1O/df8fQXQ40vQwJ7oPWTrsJ3WwMBjZeJ?=
 =?us-ascii?Q?NlT41EUez3Z7RZxKTIvxhY/xwkfmqMolyXEU0htomnEy85XhNLDxWPOfLOP7?=
 =?us-ascii?Q?/4ugMKP65ixuihuTCOOhGlL//N9T7ijkt0B8pPG2MsFx76fdzWySpbN1zqp/?=
 =?us-ascii?Q?VSPusJlllboxDwAH/gX1Esu5Ia1HUL2e9icBVL2M5sYTQDMsbXZVUJH81xCv?=
 =?us-ascii?Q?/3h84PyVws6m1frueviejLtFFzQrgec4z21OAevMcupnIadviZVoRaJIjuq7?=
 =?us-ascii?Q?B++r2YG71kRJ1L7TLF6ZpOZlcl5Ffk9xHoe/xi43pV6W6uMRuRVPxlsD7y2O?=
 =?us-ascii?Q?PLf0eJ1YEXYsh77dBg8MwD2tBkiciYV6biPOxPyl413dQ7zhivJ8TVYiKN29?=
 =?us-ascii?Q?cWs5dauQ4hWZ1rWw3RSfCsKlb94Z4gNk5wPvNw+MEb9M3NSrhRizQRruLaXI?=
 =?us-ascii?Q?lulHuw=3D=3D?=
X-OriginatorOrg: plvision.eu
X-MS-Exchange-CrossTenant-Network-Message-Id: eccbed4b-6133-40ec-6dad-08d9c1973f5c
X-MS-Exchange-CrossTenant-AuthSource: AM9P190MB1122.EURP190.PROD.OUTLOOK.COM
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 17 Dec 2021 19:55:59.7661
 (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: F5vWoCGNMIbkZ4MUBVKDgCyUz1wIj52nlhmjZuTI6ZLVu4ok29lYJQcB926rsRvrRZr+SnULfs5O89pWtbYEIW4uTGOYwROdSRYBWwA8ssM=
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM9P190MB1058
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

Add inetaddr notifiers to support add/del IPv4 address on switchdev
port. We create TRAP on first address, added on port and delete TRAP,
when last address removed.
Currently, driver supports only regular port to became routed.
Other port type support will be added later

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>
---
 .../marvell/prestera/prestera_router.c        | 40 +++++++++++++++++++
 1 file changed, 40 insertions(+)

diff --git a/drivers/net/ethernet/marvell/prestera/prestera_router.c b/drivers/net/ethernet/marvell/prestera/prestera_router.c
index 33aba94efafd..ca9fcec3ef69 100644
--- a/drivers/net/ethernet/marvell/prestera/prestera_router.c
+++ b/drivers/net/ethernet/marvell/prestera/prestera_router.c
@@ -4,16 +4,31 @@
 #include <linux/kernel.h>
 #include <linux/types.h>
 #include <linux/inetdevice.h>
+#include <net/switchdev.h>
 
 #include "prestera.h"
 #include "prestera_router_hw.h"
 
+/* This util to be used, to convert kernel rules for default vr in hw_vr */
+static u32 prestera_fix_tb_id(u32 tb_id)
+{
+	if (tb_id == RT_TABLE_UNSPEC ||
+	    tb_id == RT_TABLE_LOCAL ||
+	    tb_id == RT_TABLE_DEFAULT)
+		return tb_id = RT_TABLE_MAIN;
+
+	return tb_id;
+}
+
 static int __prestera_inetaddr_port_event(struct net_device *port_dev,
 					  unsigned long event,
 					  struct netlink_ext_ack *extack)
 {
 	struct prestera_port *port = netdev_priv(port_dev);
 	int err;
+	struct prestera_rif_entry *re;
+	struct prestera_rif_entry_key re_key = {};
+	u32 kern_tb_id;
 
 	err = prestera_is_valid_mac_addr(port, port_dev->dev_addr);
 	if (err) {
@@ -21,9 +36,34 @@ static int __prestera_inetaddr_port_event(struct net_device *port_dev,
 		return err;
 	}
 
+	kern_tb_id = l3mdev_fib_table(port_dev);
+	re_key.iface.type = PRESTERA_IF_PORT_E;
+	re_key.iface.dev_port.hw_dev_num  = port->dev_id;
+	re_key.iface.dev_port.port_num  = port->hw_id;
+	re = prestera_rif_entry_find(port->sw, &re_key);
+
 	switch (event) {
 	case NETDEV_UP:
+		if (re) {
+			NL_SET_ERR_MSG_MOD(extack, "rif_entry already exist");
+			return -EEXIST;
+		}
+		re = prestera_rif_entry_create(port->sw, &re_key,
+					       prestera_fix_tb_id(kern_tb_id),
+					       port_dev->dev_addr);
+		if (!re) {
+			NL_SET_ERR_MSG_MOD(extack, "Can't create rif_entry");
+			return -EINVAL;
+		}
+		dev_hold(port_dev);
+		break;
 	case NETDEV_DOWN:
+		if (!re) {
+			NL_SET_ERR_MSG_MOD(extack, "rif_entry not exist");
+			return -EEXIST;
+		}
+		prestera_rif_entry_destroy(port->sw, re);
+		dev_put(port_dev);
 		break;
 	}
 
-- 
2.17.1