net: lan969x: add lan969x ops to match data

Add a bunch of small lan969x ops in bulk. These ops are explained in
detail in a previous series [1].

[1] https://lore.kernel.org/netdev/20241004-b4-sparx5-lan969x-switch-driver-v2-8-d3290f581663@microchip.com/

Reviewed-by: Steen Hegelund <Steen.Hegelund@microchip.com>
Signed-off-by: Daniel Machon <daniel.machon@microchip.com>
Link: https://patch.msgid.link/20241024-sparx5-lan969x-switch-driver-2-v2-9-a0b5fae88a0f@microchip.com
Signed-off-by: Jakub Kicinski <kuba@kernel.org>

diff --git a/drivers/net/ethernet/microchip/lan969x/lan969x.c b/drivers/net/ethernet/microchip/lan969x/lan969x.c
index 19f91e4a9f3e869812bca0c698eb2edd845ac26c..2c2b86f9144e8f29a88e628d9245291d976522ac 100644 (file)
--- a/drivers/net/ethernet/microchip/lan969x/lan969x.c
+++ b/drivers/net/ethernet/microchip/lan969x/lan969x.c
@@ -6,6 +6,9 @@
 
 #include "lan969x.h"
 
+#define LAN969X_SDLB_GRP_CNT 5
+#define LAN969X_HSCH_LEAK_GRP_CNT 4
+
 static const struct sparx5_main_io_resource lan969x_main_iomap[] =  {
        { TARGET_CPU,                   0xc0000, 0 }, /* 0xe00c0000 */
        { TARGET_FDMA,                  0xc0400, 0 }, /* 0xe00c0400 */
@@ -92,6 +95,112 @@ static const struct sparx5_main_io_resource lan969x_main_iomap[] =  {
        { TARGET_ASM,                 0x3200000, 1 }, /* 0xe3200000 */
 };
 
+static struct sparx5_sdlb_group lan969x_sdlb_groups[LAN969X_SDLB_GRP_CNT] = {
+       { 1000000000,  8192 / 2, 64 }, /*    1 G */
+       {  500000000,  8192 / 2, 64 }, /*  500 M */
+       {  100000000,  8192 / 4, 64 }, /*  100 M */
+       {   50000000,  8192 / 4, 64 }, /*   50 M */
+       {    5000000,  8192 / 8, 64 }, /*   10 M */
+};
+
+static u32 lan969x_hsch_max_group_rate[LAN969X_HSCH_LEAK_GRP_CNT] = {
+       655355, 1048568, 6553550, 10485680
+};
+
+static struct sparx5_sdlb_group *lan969x_get_sdlb_group(int idx)
+{
+       return &lan969x_sdlb_groups[idx];
+}
+
+static u32 lan969x_get_hsch_max_group_rate(int grp)
+{
+       return lan969x_hsch_max_group_rate[grp];
+}
+
+static u32 lan969x_get_dev_mode_bit(struct sparx5 *sparx5, int port)
+{
+       if (lan969x_port_is_2g5(port) || lan969x_port_is_5g(port))
+               return port;
+
+       /* 10G */
+       switch (port) {
+       case 0:
+               return 12;
+       case 4:
+               return 13;
+       case 8:
+               return 14;
+       case 12:
+               return 0;
+       default:
+               return port;
+       }
+}
+
+static u32 lan969x_port_dev_mapping(struct sparx5 *sparx5, int port)
+{
+       if (lan969x_port_is_5g(port)) {
+               switch (port) {
+               case 9:
+                       return 0;
+               case 13:
+                       return 1;
+               case 17:
+                       return 2;
+               case 21:
+                       return 3;
+               }
+       }
+
+       if (lan969x_port_is_10g(port)) {
+               switch (port) {
+               case 0:
+                       return 0;
+               case 4:
+                       return 1;
+               case 8:
+                       return 2;
+               case 12:
+                       return 3;
+               case 16:
+                       return 4;
+               case 20:
+                       return 5;
+               case 24:
+                       return 6;
+               case 25:
+                       return 7;
+               case 26:
+                       return 8;
+               case 27:
+                       return 9;
+               }
+       }
+
+       /* 2g5 port */
+       return port;
+}
+
+static int lan969x_port_mux_set(struct sparx5 *sparx5, struct sparx5_port *port,
+                               struct sparx5_port_config *conf)
+{
+       u32 portno = port->portno;
+       u32 inst;
+
+       if (port->conf.portmode == conf->portmode)
+               return 0; /* Nothing to do */
+
+       switch (conf->portmode) {
+       case PHY_INTERFACE_MODE_QSGMII: /* QSGMII: 4x2G5 devices. Mode Q'  */
+               inst = (portno - portno % 4) / 4;
+               spx5_rmw(BIT(inst), BIT(inst), sparx5, PORT_CONF_QSGMII_ENA);
+               break;
+       default:
+               break;
+       }
+       return 0;
+}
+
 static const struct sparx5_regs lan969x_regs = {
        .tsize = lan969x_tsize,
        .gaddr = lan969x_gaddr,
@@ -123,12 +232,25 @@ static const struct sparx5_consts lan969x_consts = {
        .tod_pin             = 4,
 };
 
+static const struct sparx5_ops lan969x_ops = {
+       .is_port_2g5             = &lan969x_port_is_2g5,
+       .is_port_5g              = &lan969x_port_is_5g,
+       .is_port_10g             = &lan969x_port_is_10g,
+       .is_port_25g             = &lan969x_port_is_25g,
+       .get_port_dev_index      = &lan969x_port_dev_mapping,
+       .get_port_dev_bit        = &lan969x_get_dev_mode_bit,
+       .get_hsch_max_group_rate = &lan969x_get_hsch_max_group_rate,
+       .get_sdlb_group          = &lan969x_get_sdlb_group,
+       .set_port_mux            = &lan969x_port_mux_set,
+};
+
 const struct sparx5_match_data lan969x_desc = {
        .iomap      = lan969x_main_iomap,
        .iomap_size = ARRAY_SIZE(lan969x_main_iomap),
        .ioranges   = 2,
        .regs       = &lan969x_regs,
        .consts     = &lan969x_consts,
+       .ops        = &lan969x_ops,
 };
 EXPORT_SYMBOL_GPL(lan969x_desc);
 

diff --git a/drivers/net/ethernet/microchip/lan969x/lan969x.h b/drivers/net/ethernet/microchip/lan969x/lan969x.h
index 3b4c9ea300719e9f86f21d95316949dd69efe2da..ee890b26ea7926b200fbd8a1fabc9be78864de77 100644 (file)
--- a/drivers/net/ethernet/microchip/lan969x/lan969x.h
+++ b/drivers/net/ethernet/microchip/lan969x/lan969x.h
@@ -23,4 +23,32 @@ extern const unsigned int lan969x_gsize[GSIZE_LAST];
 extern const unsigned int lan969x_fpos[FPOS_LAST];
 extern const unsigned int lan969x_fsize[FSIZE_LAST];
 
+static inline bool lan969x_port_is_2g5(int portno)
+{
+       return portno == 1  || portno == 2  || portno == 3  ||
+              portno == 5  || portno == 6  || portno == 7  ||
+              portno == 10 || portno == 11 || portno == 14 ||
+              portno == 15 || portno == 18 || portno == 19 ||
+              portno == 22 || portno == 23;
+}
+
+static inline bool lan969x_port_is_5g(int portno)
+{
+       return portno == 9 || portno == 13 || portno == 17 ||
+              portno == 21;
+}
+
+static inline bool lan969x_port_is_10g(int portno)
+{
+       return portno == 0  || portno == 4  || portno == 8  ||
+              portno == 12 || portno == 16 || portno == 20 ||
+              portno == 24 || portno == 25 || portno == 26 ||
+              portno == 27;
+}
+
+static inline bool lan969x_port_is_25g(int portno)
+{
+       return false;
+}
+
 #endif