[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20220906063450.3698671-3-mattias.forsblad@gmail.com>
Date: Tue, 6 Sep 2022 08:34:46 +0200
From: Mattias Forsblad <mattias.forsblad@...il.com>
To: netdev@...r.kernel.org
Cc: Andrew Lunn <andrew@...n.ch>,
Vivien Didelot <vivien.didelot@...il.com>,
Florian Fainelli <f.fainelli@...il.com>,
Vladimir Oltean <olteanv@...il.com>,
"David S . Miller" <davem@...emloft.net>,
Eric Dumazet <edumazet@...gle.com>,
Jakub Kicinski <kuba@...nel.org>,
Paolo Abeni <pabeni@...hat.com>,
Mattias Forsblad <mattias.forsblad@...il.com>
Subject: [PATCH net-next v4 2/6] net: dsa: Add convenience functions for frame handling
Add common control functions for drivers that need
to send and wait for control frames.
Signed-off-by: Mattias Forsblad <mattias.forsblad@...il.com>
---
include/net/dsa.h | 13 +++++++++++++
net/dsa/dsa.c | 28 ++++++++++++++++++++++++++++
net/dsa/dsa2.c | 2 ++
3 files changed, 43 insertions(+)
diff --git a/include/net/dsa.h b/include/net/dsa.h
index f2ce12860546..70a358641235 100644
--- a/include/net/dsa.h
+++ b/include/net/dsa.h
@@ -495,6 +495,8 @@ struct dsa_switch {
unsigned int max_num_bridges;
unsigned int num_ports;
+
+ struct completion inband_done;
};
static inline struct dsa_port *dsa_to_port(struct dsa_switch *ds, int p)
@@ -1390,6 +1392,17 @@ void dsa_tag_drivers_register(struct dsa_tag_driver *dsa_tag_driver_array[],
void dsa_tag_drivers_unregister(struct dsa_tag_driver *dsa_tag_driver_array[],
unsigned int count);
+int dsa_switch_inband_tx(struct dsa_switch *ds, struct sk_buff *skb,
+ struct completion *completion, unsigned long timeout);
+static inline void dsa_switch_inband_complete(struct dsa_switch *ds, struct completion *completion)
+{
+ /* Custom completion? */
+ if (completion)
+ complete(completion);
+ else
+ complete(&ds->inband_done);
+}
+
#define dsa_tag_driver_module_drivers(__dsa_tag_drivers_array, __count) \
static int __init dsa_tag_driver_module_init(void) \
{ \
diff --git a/net/dsa/dsa.c b/net/dsa/dsa.c
index be7b320cda76..2d7add779b6f 100644
--- a/net/dsa/dsa.c
+++ b/net/dsa/dsa.c
@@ -324,6 +324,34 @@ int dsa_switch_resume(struct dsa_switch *ds)
EXPORT_SYMBOL_GPL(dsa_switch_resume);
#endif
+int dsa_switch_inband_tx(struct dsa_switch *ds, struct sk_buff *skb,
+ struct completion *completion, unsigned long timeout)
+{
+ int ret;
+ struct completion *com;
+
+ /* Custom completion? */
+ if (completion)
+ com = completion;
+ else
+ com = &ds->inband_done;
+
+ reinit_completion(com);
+
+ if (skb)
+ dev_queue_xmit(skb);
+
+ ret = wait_for_completion_timeout(com, msecs_to_jiffies(timeout));
+ if (ret <= 0) {
+ dev_dbg(ds->dev, "DSA inband: timeout waiting for answer\n");
+
+ return -ETIMEDOUT;
+ }
+
+ return ret;
+}
+EXPORT_SYMBOL_GPL(dsa_switch_inband_tx);
+
static struct packet_type dsa_pack_type __read_mostly = {
.type = cpu_to_be16(ETH_P_XDSA),
.func = dsa_switch_rcv,
diff --git a/net/dsa/dsa2.c b/net/dsa/dsa2.c
index ed56c7a554b8..a1b3ecfdffb8 100644
--- a/net/dsa/dsa2.c
+++ b/net/dsa/dsa2.c
@@ -1746,6 +1746,8 @@ static int dsa_switch_probe(struct dsa_switch *ds)
dsa_tree_put(dst);
}
+ init_completion(&ds->inband_done);
+
return err;
}
--
2.25.1
Powered by blists - more mailing lists