2019-04-28 17:37:10 +00:00
|
|
|
// SPDX-License-Identifier: GPL-2.0
|
2016-09-15 14:26:40 +00:00
|
|
|
/*
|
|
|
|
* Copyright (c) 2015, The Linux Foundation. All rights reserved.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/etherdevice.h>
|
2022-02-02 00:03:22 +00:00
|
|
|
#include <linux/bitfield.h>
|
2022-02-02 00:03:27 +00:00
|
|
|
#include <net/dsa.h>
|
2022-02-02 00:03:23 +00:00
|
|
|
#include <linux/dsa/tag_qca.h>
|
2017-05-17 19:46:03 +00:00
|
|
|
|
2022-11-21 13:55:47 +00:00
|
|
|
#include "tag.h"
|
2016-09-15 14:26:40 +00:00
|
|
|
|
net: dsa: provide a second modalias to tag proto drivers based on their name
Currently, tagging protocol drivers have a modalias of
"dsa_tag:id-<number>", where the number is one of DSA_TAG_PROTO_*_VALUE.
This modalias makes it possible for the request_module() call in
dsa_tag_driver_get() to work, given the input it has - an integer
returned by ds->ops->get_tag_protocol().
It is also possible to change tagging protocols at (pseudo-)runtime, via
sysfs or via device tree, and this works via the name string of the
tagging protocol rather than via its id (DSA_TAG_PROTO_*_VALUE).
In the latter case, there is no request_module() call, because there is
no association that the DSA core has between the string name and the ID,
to construct the modalias. The module is simply assumed to have been
inserted. This is actually slightly problematic when the tagging
protocol change should take place at probe time, since it's expected
that the dependency module should get autoloaded.
For this purpose, let's introduce a second modalias, so that the DSA
core can call request_module() by name. There is no reason to make the
modalias by name optional, so just modify the MODULE_ALIAS_DSA_TAG_DRIVER()
macro to take both the ID and the name as arguments, and generate two
modaliases behind the scenes.
Suggested-by: Michael Walle <michael@walle.cc>
Signed-off-by: Vladimir Oltean <vladimir.oltean@nxp.com>
Tested-by: Michael Walle <michael@walle.cc> # on kontron-sl28 w/ ocelot_8021q
Tested-by: Michael Walle <michael@walle.cc>
Signed-off-by: Jakub Kicinski <kuba@kernel.org>
2022-11-15 01:18:44 +00:00
|
|
|
#define QCA_NAME "qca"
|
|
|
|
|
2016-09-15 14:26:40 +00:00
|
|
|
static struct sk_buff *qca_tag_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
|
|
{
|
2023-10-23 18:17:28 +00:00
|
|
|
struct dsa_port *dp = dsa_user_to_port(dev);
|
2020-07-05 19:30:08 +00:00
|
|
|
__be16 *phdr;
|
|
|
|
u16 hdr;
|
2016-09-15 14:26:40 +00:00
|
|
|
|
|
|
|
skb_push(skb, QCA_HDR_LEN);
|
|
|
|
|
2021-08-10 13:13:54 +00:00
|
|
|
dsa_alloc_etype_header(skb, QCA_HDR_LEN);
|
2021-08-10 13:13:56 +00:00
|
|
|
phdr = dsa_etype_header_pos_tx(skb);
|
2016-09-15 14:26:40 +00:00
|
|
|
|
|
|
|
/* Set the version field, and set destination port information */
|
2022-02-02 00:03:22 +00:00
|
|
|
hdr = FIELD_PREP(QCA_HDR_XMIT_VERSION, QCA_HDR_VERSION);
|
|
|
|
hdr |= QCA_HDR_XMIT_FROM_CPU;
|
|
|
|
hdr |= FIELD_PREP(QCA_HDR_XMIT_DP_BIT, BIT(dp->index));
|
2016-09-15 14:26:40 +00:00
|
|
|
|
|
|
|
*phdr = htons(hdr);
|
|
|
|
|
|
|
|
return skb;
|
|
|
|
}
|
|
|
|
|
2021-07-31 14:14:32 +00:00
|
|
|
static struct sk_buff *qca_tag_rcv(struct sk_buff *skb, struct net_device *dev)
|
2016-09-15 14:26:40 +00:00
|
|
|
{
|
2022-02-02 00:03:27 +00:00
|
|
|
struct qca_tagger_data *tagger_data;
|
|
|
|
struct dsa_port *dp = dev->dsa_ptr;
|
|
|
|
struct dsa_switch *ds = dp->ds;
|
2022-02-02 00:03:25 +00:00
|
|
|
u8 ver, pk_type;
|
2020-07-05 19:30:08 +00:00
|
|
|
__be16 *phdr;
|
2022-02-02 00:03:25 +00:00
|
|
|
int port;
|
|
|
|
u16 hdr;
|
|
|
|
|
|
|
|
BUILD_BUG_ON(sizeof(struct qca_mgmt_ethhdr) != QCA_HDR_MGMT_HEADER_LEN + QCA_HDR_LEN);
|
2016-09-15 14:26:40 +00:00
|
|
|
|
2022-02-02 00:03:27 +00:00
|
|
|
tagger_data = ds->tagger_data;
|
|
|
|
|
2016-09-15 14:26:40 +00:00
|
|
|
if (unlikely(!pskb_may_pull(skb, QCA_HDR_LEN)))
|
2017-06-01 20:07:14 +00:00
|
|
|
return NULL;
|
2016-09-15 14:26:40 +00:00
|
|
|
|
2021-08-10 13:13:55 +00:00
|
|
|
phdr = dsa_etype_header_pos_rx(skb);
|
2016-09-15 14:26:40 +00:00
|
|
|
hdr = ntohs(*phdr);
|
|
|
|
|
|
|
|
/* Make sure the version is correct */
|
2022-02-02 00:03:22 +00:00
|
|
|
ver = FIELD_GET(QCA_HDR_RECV_VERSION, hdr);
|
2016-09-15 14:26:40 +00:00
|
|
|
if (unlikely(ver != QCA_HDR_VERSION))
|
2017-06-01 20:07:14 +00:00
|
|
|
return NULL;
|
2016-09-15 14:26:40 +00:00
|
|
|
|
2022-02-02 00:03:25 +00:00
|
|
|
/* Get pk type */
|
|
|
|
pk_type = FIELD_GET(QCA_HDR_RECV_TYPE, hdr);
|
|
|
|
|
2022-02-02 00:03:27 +00:00
|
|
|
/* Ethernet mgmt read/write packet */
|
|
|
|
if (pk_type == QCA_HDR_RECV_TYPE_RW_REG_ACK) {
|
|
|
|
if (likely(tagger_data->rw_reg_ack_handler))
|
|
|
|
tagger_data->rw_reg_ack_handler(ds, skb);
|
2022-02-02 00:03:25 +00:00
|
|
|
return NULL;
|
2022-02-02 00:03:27 +00:00
|
|
|
}
|
2022-02-02 00:03:25 +00:00
|
|
|
|
2022-02-02 00:03:26 +00:00
|
|
|
/* Ethernet MIB counter packet */
|
2022-02-02 00:03:27 +00:00
|
|
|
if (pk_type == QCA_HDR_RECV_TYPE_MIB) {
|
|
|
|
if (likely(tagger_data->mib_autocast_handler))
|
|
|
|
tagger_data->mib_autocast_handler(ds, skb);
|
2022-02-02 00:03:26 +00:00
|
|
|
return NULL;
|
2022-02-02 00:03:27 +00:00
|
|
|
}
|
2022-02-02 00:03:26 +00:00
|
|
|
|
2016-09-15 14:26:40 +00:00
|
|
|
/* Get source port information */
|
2022-02-02 00:03:22 +00:00
|
|
|
port = FIELD_GET(QCA_HDR_RECV_SOURCE_PORT, hdr);
|
2016-09-15 14:26:40 +00:00
|
|
|
|
2023-10-23 18:17:28 +00:00
|
|
|
skb->dev = dsa_conduit_find_user(dev, 0, port);
|
2017-09-29 21:19:15 +00:00
|
|
|
if (!skb->dev)
|
|
|
|
return NULL;
|
2016-09-15 14:26:40 +00:00
|
|
|
|
2023-07-30 07:41:09 +00:00
|
|
|
/* Remove QCA tag and recalculate checksum */
|
|
|
|
skb_pull_rcsum(skb, QCA_HDR_LEN);
|
|
|
|
dsa_strip_etype_header(skb, QCA_HDR_LEN);
|
|
|
|
|
2017-04-08 15:55:23 +00:00
|
|
|
return skb;
|
2016-09-15 14:26:40 +00:00
|
|
|
}
|
|
|
|
|
2022-02-02 00:03:27 +00:00
|
|
|
static int qca_tag_connect(struct dsa_switch *ds)
|
|
|
|
{
|
|
|
|
struct qca_tagger_data *tagger_data;
|
|
|
|
|
|
|
|
tagger_data = kzalloc(sizeof(*tagger_data), GFP_KERNEL);
|
|
|
|
if (!tagger_data)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
ds->tagger_data = tagger_data;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void qca_tag_disconnect(struct dsa_switch *ds)
|
|
|
|
{
|
|
|
|
kfree(ds->tagger_data);
|
|
|
|
ds->tagger_data = NULL;
|
|
|
|
}
|
|
|
|
|
2019-04-28 17:37:21 +00:00
|
|
|
static const struct dsa_device_ops qca_netdev_ops = {
|
net: dsa: provide a second modalias to tag proto drivers based on their name
Currently, tagging protocol drivers have a modalias of
"dsa_tag:id-<number>", where the number is one of DSA_TAG_PROTO_*_VALUE.
This modalias makes it possible for the request_module() call in
dsa_tag_driver_get() to work, given the input it has - an integer
returned by ds->ops->get_tag_protocol().
It is also possible to change tagging protocols at (pseudo-)runtime, via
sysfs or via device tree, and this works via the name string of the
tagging protocol rather than via its id (DSA_TAG_PROTO_*_VALUE).
In the latter case, there is no request_module() call, because there is
no association that the DSA core has between the string name and the ID,
to construct the modalias. The module is simply assumed to have been
inserted. This is actually slightly problematic when the tagging
protocol change should take place at probe time, since it's expected
that the dependency module should get autoloaded.
For this purpose, let's introduce a second modalias, so that the DSA
core can call request_module() by name. There is no reason to make the
modalias by name optional, so just modify the MODULE_ALIAS_DSA_TAG_DRIVER()
macro to take both the ID and the name as arguments, and generate two
modaliases behind the scenes.
Suggested-by: Michael Walle <michael@walle.cc>
Signed-off-by: Vladimir Oltean <vladimir.oltean@nxp.com>
Tested-by: Michael Walle <michael@walle.cc> # on kontron-sl28 w/ ocelot_8021q
Tested-by: Michael Walle <michael@walle.cc>
Signed-off-by: Jakub Kicinski <kuba@kernel.org>
2022-11-15 01:18:44 +00:00
|
|
|
.name = QCA_NAME,
|
2019-04-28 17:37:14 +00:00
|
|
|
.proto = DSA_TAG_PROTO_QCA,
|
2022-02-02 00:03:27 +00:00
|
|
|
.connect = qca_tag_connect,
|
|
|
|
.disconnect = qca_tag_disconnect,
|
2016-09-15 14:26:40 +00:00
|
|
|
.xmit = qca_tag_xmit,
|
|
|
|
.rcv = qca_tag_rcv,
|
2021-06-11 19:01:24 +00:00
|
|
|
.needed_headroom = QCA_HDR_LEN,
|
2023-10-23 18:17:28 +00:00
|
|
|
.promisc_on_conduit = true,
|
2016-09-15 14:26:40 +00:00
|
|
|
};
|
2019-04-28 17:37:12 +00:00
|
|
|
|
2024-01-04 14:37:59 +00:00
|
|
|
MODULE_DESCRIPTION("DSA tag driver for Qualcomm Atheros QCA8K switches");
|
2019-04-28 17:37:13 +00:00
|
|
|
MODULE_LICENSE("GPL");
|
net: dsa: provide a second modalias to tag proto drivers based on their name
Currently, tagging protocol drivers have a modalias of
"dsa_tag:id-<number>", where the number is one of DSA_TAG_PROTO_*_VALUE.
This modalias makes it possible for the request_module() call in
dsa_tag_driver_get() to work, given the input it has - an integer
returned by ds->ops->get_tag_protocol().
It is also possible to change tagging protocols at (pseudo-)runtime, via
sysfs or via device tree, and this works via the name string of the
tagging protocol rather than via its id (DSA_TAG_PROTO_*_VALUE).
In the latter case, there is no request_module() call, because there is
no association that the DSA core has between the string name and the ID,
to construct the modalias. The module is simply assumed to have been
inserted. This is actually slightly problematic when the tagging
protocol change should take place at probe time, since it's expected
that the dependency module should get autoloaded.
For this purpose, let's introduce a second modalias, so that the DSA
core can call request_module() by name. There is no reason to make the
modalias by name optional, so just modify the MODULE_ALIAS_DSA_TAG_DRIVER()
macro to take both the ID and the name as arguments, and generate two
modaliases behind the scenes.
Suggested-by: Michael Walle <michael@walle.cc>
Signed-off-by: Vladimir Oltean <vladimir.oltean@nxp.com>
Tested-by: Michael Walle <michael@walle.cc> # on kontron-sl28 w/ ocelot_8021q
Tested-by: Michael Walle <michael@walle.cc>
Signed-off-by: Jakub Kicinski <kuba@kernel.org>
2022-11-15 01:18:44 +00:00
|
|
|
MODULE_ALIAS_DSA_TAG_DRIVER(DSA_TAG_PROTO_QCA, QCA_NAME);
|
2019-04-28 17:37:15 +00:00
|
|
|
|
|
|
|
module_dsa_tag_driver(qca_netdev_ops);
|