Received-SPF: pass (google.com: domain of linux-wireless-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20;
From:   viktor.barna@celeno.com
To:     linux-wireless@vger.kernel.org
Cc:     Kalle Valo <kvalo@codeaurora.org>,
        "David S . Miller" <davem@davemloft.net>,
        Jakub Kicinski <kuba@kernel.org>,
        Aviad Brikman <aviad.brikman@celeno.com>,
        Eliav Farber <eliav.farber@gmail.com>,
        Maksym Kokhan <maksym.kokhan@celeno.com>,
        Oleksandr Savchenko <oleksandr.savchenko@celeno.com>,
        Shay Bar <shay.bar@celeno.com>,
        Viktor Barna <viktor.barna@celeno.com>
Subject: [RFC v2 90/96] cl8k: add vif.c
Date:   Tue, 24 May 2022 14:34:56 +0300
Message-Id: <20220524113502.1094459-91-viktor.barna@celeno.com>
In-Reply-To: <20220524113502.1094459-1-viktor.barna@celeno.com>
References: <20220524113502.1094459-1-viktor.barna@celeno.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?VUFoLcq97JpYjjkYKYMmYBYmXt8gUiFTAeTP2wTpXeKKQu4fdgrpdQ1qww0F?=
 =?us-ascii?Q?MdwJnXIQ+8Fn+RbRK7mSkMdR+UztRELCufi8Udki1TGxyYYASZw8P3T2Yd5x?=
 =?us-ascii?Q?pxkTw3FE3K9bIespb4czCMfQfvVKhXUKPF5KsMt9p/roDJcWsxWEZzaQsAQ2?=
 =?us-ascii?Q?RXhTbSIYa9RDQG7I28/LSnXwmuIrVxvJPDt2A5XHWWAr7PjNJ69i5Zr5m53w?=
 =?us-ascii?Q?NlMHIeXFLOpMArK9GoNuA4GasuWfndGcZDM3dfzYq1brQ/mJNYxLiOELfO3w?=
 =?us-ascii?Q?9PcYSztJBAgNvR/escH49za5womAIExDHdvhgbIy5RA79enEjSLilD4bEk9x?=
 =?us-ascii?Q?EH8V0RpffgPjeUzzPhwy5R8KLjIpZNJgXvULctSCfINh27Ct0/TSJghxA3ue?=
 =?us-ascii?Q?ETGC6ps3LNjvZUNmOxFRm6rfs/bqFF5DO1VrjgE9oYLan1oWbNnkfCI7/9fb?=
 =?us-ascii?Q?uphYx6+fr5G7Xc87Xcg/ulEqHLe9lIY3y7rr+qo0fOIiWFBOMZy1L48bRFdb?=
 =?us-ascii?Q?/4VThOOYylZjzPnQTLaIhfYFnSf76DoZFkjRPD4HHRTABaNgEAmmNylQtH10?=
 =?us-ascii?Q?K7eqX1rW7Fu8NWjIUyQ8gS/RTnUeId/kwyNEkJwfuOAk4M1mPvwiV75Rb75L?=
 =?us-ascii?Q?34lQHU0koXQiAgNOJpjK9TZvqFxkEmAMGG2DX5NPOOWFXpkF4lxgMgAkwvdY?=
 =?us-ascii?Q?NN7J0e1Hb5tHqtrsPV2bcS0SkYuFsvBV+++zu8YD390OuCwIQu3MjQmbEIL6?=
 =?us-ascii?Q?l4/k7t89rwrpvp/R/Zc0M6yL+Ozhu9/y3gtb17Cy3KBlyvU0t7MvTZwP3LvR?=
 =?us-ascii?Q?UQHWVtuTIblpDrH754JFbWLh8LhND+/5Zps2BFKm9zm4ZtTunOTIghRdK1vl?=
 =?us-ascii?Q?GJLYEMD1801kc+iZes5J/BvM6YVAEhc9Z3TJamnkK33LfCwyrPT8vTVfm2LS?=
 =?us-ascii?Q?aeZHvseBhVbaRYHdW994WRZd4SRHmUmG7CN/8ZMf/sNWTm5qpYhSJt+PeA6i?=
 =?us-ascii?Q?qQPWk13PIhmwXTiTlXKBQoWqWiwJKQIffynHzPdN4fOqGBKacozK6U5glzM4?=
 =?us-ascii?Q?oatQJ/Fq99Qfchc34EHW94+Fg2cBLMUJKUqn2k/DrRpTa9rBqQQT2tWkwPhy?=
 =?us-ascii?Q?x3P0jCFL9WFDaAsdq7QiKbYNxauZy097I+7XaGsJdXzk5freqQGl1W1lLhvQ?=
 =?us-ascii?Q?Vve+s+s/zImpzjvuMR3HPWtdAZWMJ1F6JQjrA5nrAohN90C1K5absqPOTPaS?=
 =?us-ascii?Q?Omw8PX5oGSAFfH3fl9VckhK1NnsrAHHjj/+wyuVt3v1IiHoNEvPIL8pxwhqP?=
 =?us-ascii?Q?7oqrym6gHjuKk4QKs1qhvehVjAVg9HaLYpYysKrY4EdPJgMeQ1/V1GCNPPfQ?=
 =?us-ascii?Q?d5HOZFgg6Ieyod1QR9ferp/zF+nEKSZVLTpuKuKtaNScqhXYwUGQl+fORQg+?=
 =?us-ascii?Q?/gPL3z+ouEecU94ooGNXU1d63DBUza+RJGFxSXs1l1NwFEdjlUshBDUHg1Nw?=
 =?us-ascii?Q?t0ZVjTInxX7c642M3hCMjDHVsdjjAcDivuwVaORbO3JxNuPt7krFZ9/naTQE?=
 =?us-ascii?Q?/Zm44431jjYEkDyIvFoP/Nr6xZM/9ptzRyFnditN7E9472z6oNyhg+Ze90Py?=
 =?us-ascii?Q?vppXuoGXh16+irEjqWZdMm8KZMrqw4fxf0WC74hfCl1L6ZD9u6J4GT2ZOfBL?=
 =?us-ascii?Q?3Lrq1jUuRGm9Gv/wcABGoPOGoy8ix2B09cj0JVOeeCelOEsusm0RbOx2obtB?=
 =?us-ascii?Q?UyfTD+NFlwbQHinSD8V6V0ontdluL8Q=3D?=
X-OriginatorOrg: celeno.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 23069032-f7a0-4314-1747-08da3d79ffad
X-MS-Exchange-CrossTenant-AuthSource: AM9P192MB1412.EURP192.PROD.OUTLOOK.COM
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 24 May 2022 11:39:01.7623
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: f313103b-4c9f-4fd3-b5cf-b97f91c4afa8
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: Nx4vHKcaHMToXQa6jBmBvK4zTJd3h/b8gBVkkw1uuXtZuQFvBYuzAdSLWfkgZnFBeAxfI9Wh7OZgr0QojoWD0w==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: VE1P192MB0669
X-Spam-Status: No, score=-2.1 required=5.0 tests=BAYES_00,DKIM_SIGNED,
        DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,RCVD_IN_DNSWL_NONE,
        RCVD_IN_MSPIKE_H2,SPF_HELO_PASS,SPF_PASS,T_SCC_BODY_TEXT_LINE
        autolearn=ham autolearn_force=no version=3.4.6
X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on
        lindbergh.monkeyblade.net
Precedence: bulk
List-ID: <linux-wireless.vger.kernel.org>
X-Mailing-List: linux-wireless@vger.kernel.org

From: Viktor Barna <viktor.barna@celeno.com>

(Part of the split. Please, take a look at the cover letter for more
details).

Signed-off-by: Viktor Barna <viktor.barna@celeno.com>
---
 drivers/net/wireless/celeno/cl8k/vif.c | 162 +++++++++++++++++++++++++
 1 file changed, 162 insertions(+)
 create mode 100644 drivers/net/wireless/celeno/cl8k/vif.c

diff --git a/drivers/net/wireless/celeno/cl8k/vif.c b/drivers/net/wireless/celeno/cl8k/vif.c
new file mode 100644
index 000000000000..7592f0d32e7a
--- /dev/null
+++ b/drivers/net/wireless/celeno/cl8k/vif.c
@@ -0,0 +1,162 @@
+// SPDX-License-Identifier: GPL-2.0 OR BSD-2-Clause
+/* Copyright(c) 2019-2022, Celeno Communications Ltd. */
+
+#include <linux/list.h>
+
+#include "hw.h"
+#include "mac_addr.h"
+#include "vif.h"
+
+void cl_vif_init(struct cl_hw *cl_hw)
+{
+	rwlock_init(&cl_hw->vif_db.lock);
+	INIT_LIST_HEAD(&cl_hw->vif_db.head);
+}
+
+void cl_vif_add(struct cl_hw *cl_hw, struct cl_vif *cl_vif)
+{
+	struct cl_vif_db *vif_db = &cl_hw->vif_db;
+
+	write_lock_bh(&vif_db->lock);
+	list_add_tail(&cl_vif->list, &vif_db->head);
+
+	if (cl_vif->vif->type != NL80211_IFTYPE_STATION)
+		vif_db->num_iface_bcn++;
+
+	/* Multicast vif set */
+	cl_hw->mc_vif = cl_vif;
+
+	write_unlock_bh(&vif_db->lock);
+}
+
+void cl_vif_remove(struct cl_hw *cl_hw, struct cl_vif *cl_vif)
+{
+	struct cl_vif_db *vif_db = &cl_hw->vif_db;
+
+	write_lock_bh(&vif_db->lock);
+	/* Multicast vif unset */
+	if (cl_hw->mc_vif == cl_vif)
+		cl_hw->mc_vif = cl_vif_get_next(cl_hw, cl_hw->mc_vif);
+
+	list_del(&cl_vif->list);
+
+	if (cl_vif->vif->type != NL80211_IFTYPE_STATION)
+		vif_db->num_iface_bcn--;
+	write_unlock_bh(&vif_db->lock);
+
+	cl_bcmc_cfm_poll_empty_per_vif(cl_hw, cl_vif);
+}
+
+struct cl_vif *cl_vif_get_next(struct cl_hw *cl_hw, struct cl_vif *cl_vif)
+{
+	if (list_is_last(&cl_vif->list, &cl_hw->vif_db.head))
+		return list_first_entry_or_null(&cl_hw->vif_db.head,
+						struct cl_vif, list);
+	else
+		return list_next_entry(cl_vif, list);
+}
+
+struct cl_vif *cl_vif_get_by_dev(struct cl_hw *cl_hw, struct net_device *dev)
+{
+	struct cl_vif *cl_vif = NULL, *cl_vif_ret = NULL;
+
+	read_lock_bh(&cl_hw->vif_db.lock);
+	list_for_each_entry(cl_vif, &cl_hw->vif_db.head, list)
+		if (cl_vif->dev == dev) {
+			cl_vif_ret = cl_vif;
+			goto unlock;
+		}
+
+unlock:
+	read_unlock_bh(&cl_hw->vif_db.lock);
+	return cl_vif_ret;
+}
+
+struct cl_vif *cl_vif_get_by_mac(struct cl_hw *cl_hw, u8 *mac_addr)
+{
+	struct cl_vif *cl_vif, *cl_vif_ret = NULL;
+
+	read_lock(&cl_hw->vif_db.lock);
+	list_for_each_entry(cl_vif, &cl_hw->vif_db.head, list)
+		if (cl_mac_addr_compare(cl_vif->vif->addr, mac_addr)) {
+			cl_vif_ret = cl_vif;
+			goto unlock;
+		}
+
+unlock:
+	read_unlock(&cl_hw->vif_db.lock);
+	return cl_vif_ret;
+}
+
+struct cl_vif *cl_vif_get_first(struct cl_hw *cl_hw)
+{
+	return list_first_entry_or_null(&cl_hw->vif_db.head, struct cl_vif, list);
+}
+
+struct cl_vif *cl_vif_get_first_ap(struct cl_hw *cl_hw)
+{
+	struct cl_vif *cl_vif, *cl_vif_ret = NULL;
+
+	read_lock_bh(&cl_hw->vif_db.lock);
+	list_for_each_entry(cl_vif, &cl_hw->vif_db.head, list)
+		if (cl_vif->vif->type == NL80211_IFTYPE_AP ||
+		    cl_vif->vif->type == NL80211_IFTYPE_MESH_POINT ||
+		    cl_hw->conf->ce_listener_en) {
+			cl_vif_ret = cl_vif;
+			goto unlock;
+		}
+
+unlock:
+	read_unlock_bh(&cl_hw->vif_db.lock);
+	return cl_vif_ret;
+}
+
+struct net_device *cl_vif_get_first_net_device(struct cl_hw *cl_hw)
+{
+	struct cl_vif *cl_vif = NULL;
+	struct net_device *dev = NULL;
+
+	read_lock_bh(&cl_hw->vif_db.lock);
+	cl_vif = list_first_entry_or_null(&cl_hw->vif_db.head, struct cl_vif, list);
+	if (cl_vif)
+		dev = cl_vif->dev;
+	read_unlock_bh(&cl_hw->vif_db.lock);
+
+	return dev;
+}
+
+struct net_device *cl_vif_get_dev_by_index(struct cl_hw *cl_hw, u8 index)
+{
+	struct cl_vif *cl_vif = NULL;
+	struct net_device *dev = NULL;
+
+	read_lock_bh(&cl_hw->vif_db.lock);
+	list_for_each_entry(cl_vif, &cl_hw->vif_db.head, list)
+		if (cl_vif->vif_index == index) {
+			dev = cl_vif->dev;
+			goto unlock;
+		}
+
+unlock:
+	read_unlock_bh(&cl_hw->vif_db.lock);
+	return dev;
+}
+
+void cl_vif_ap_tx_enable(struct cl_hw *cl_hw, bool enable)
+{
+	struct cl_vif *cl_vif;
+	struct ieee80211_vif *vif;
+
+	read_lock_bh(&cl_hw->vif_db.lock);
+	list_for_each_entry(cl_vif, &cl_hw->vif_db.head, list) {
+		vif = cl_vif->vif;
+
+		if (vif->type != NL80211_IFTYPE_AP)
+			continue;
+
+		cl_vif->tx_en = enable;
+		cl_dbg_verbose(cl_hw, "Set tx_en=%u for vif_index=%u\n",
+			       enable, cl_vif->vif_index);
+	}
+	read_unlock_bh(&cl_hw->vif_db.lock);
+}
-- 
2.36.1