2 * Distributed Switch Architecture loopback driver
4 * Copyright (C) 2016, Florian Fainelli <f.fainelli@gmail.com>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
12 #include <linux/platform_device.h>
13 #include <linux/netdevice.h>
14 #include <linux/phy.h>
15 #include <linux/phy_fixed.h>
16 #include <linux/export.h>
17 #include <linux/ethtool.h>
18 #include <linux/workqueue.h>
19 #include <linux/module.h>
20 #include <linux/if_bridge.h>
25 struct dsa_loop_vlan
{
30 struct dsa_loop_mib_entry
{
31 char name
[ETH_GSTRING_LEN
];
35 enum dsa_loop_mib_counters
{
37 DSA_LOOP_PHY_READ_ERR
,
38 DSA_LOOP_PHY_WRITE_OK
,
39 DSA_LOOP_PHY_WRITE_ERR
,
43 static struct dsa_loop_mib_entry dsa_loop_mibs
[] = {
44 [DSA_LOOP_PHY_READ_OK
] = { "phy_read_ok", },
45 [DSA_LOOP_PHY_READ_ERR
] = { "phy_read_err", },
46 [DSA_LOOP_PHY_WRITE_OK
] = { "phy_write_ok", },
47 [DSA_LOOP_PHY_WRITE_ERR
] = { "phy_write_err", },
50 struct dsa_loop_port
{
51 struct dsa_loop_mib_entry mib
[__DSA_LOOP_CNT_MAX
];
54 #define DSA_LOOP_VLANS 5
56 struct dsa_loop_priv
{
58 unsigned int port_base
;
59 struct dsa_loop_vlan vlans
[DSA_LOOP_VLANS
];
60 struct net_device
*netdev
;
61 struct dsa_loop_port ports
[DSA_MAX_PORTS
];
65 static struct phy_device
*phydevs
[PHY_MAX_ADDR
];
67 static enum dsa_tag_protocol
dsa_loop_get_protocol(struct dsa_switch
*ds
,
70 dev_dbg(ds
->dev
, "%s\n", __func__
);
72 return DSA_TAG_PROTO_NONE
;
75 static int dsa_loop_setup(struct dsa_switch
*ds
)
77 struct dsa_loop_priv
*ps
= ds
->priv
;
80 for (i
= 0; i
< ds
->num_ports
; i
++)
81 memcpy(ps
->ports
[i
].mib
, dsa_loop_mibs
,
82 sizeof(dsa_loop_mibs
));
84 dev_dbg(ds
->dev
, "%s\n", __func__
);
89 static int dsa_loop_get_sset_count(struct dsa_switch
*ds
)
91 return __DSA_LOOP_CNT_MAX
;
94 static void dsa_loop_get_strings(struct dsa_switch
*ds
, int port
, uint8_t *data
)
96 struct dsa_loop_priv
*ps
= ds
->priv
;
99 for (i
= 0; i
< __DSA_LOOP_CNT_MAX
; i
++)
100 memcpy(data
+ i
* ETH_GSTRING_LEN
,
101 ps
->ports
[port
].mib
[i
].name
, ETH_GSTRING_LEN
);
104 static void dsa_loop_get_ethtool_stats(struct dsa_switch
*ds
, int port
,
107 struct dsa_loop_priv
*ps
= ds
->priv
;
110 for (i
= 0; i
< __DSA_LOOP_CNT_MAX
; i
++)
111 data
[i
] = ps
->ports
[port
].mib
[i
].val
;
114 static int dsa_loop_phy_read(struct dsa_switch
*ds
, int port
, int regnum
)
116 struct dsa_loop_priv
*ps
= ds
->priv
;
117 struct mii_bus
*bus
= ps
->bus
;
120 dev_dbg(ds
->dev
, "%s\n", __func__
);
122 ret
= mdiobus_read_nested(bus
, ps
->port_base
+ port
, regnum
);
124 ps
->ports
[port
].mib
[DSA_LOOP_PHY_READ_ERR
].val
++;
126 ps
->ports
[port
].mib
[DSA_LOOP_PHY_READ_OK
].val
++;
131 static int dsa_loop_phy_write(struct dsa_switch
*ds
, int port
,
132 int regnum
, u16 value
)
134 struct dsa_loop_priv
*ps
= ds
->priv
;
135 struct mii_bus
*bus
= ps
->bus
;
138 dev_dbg(ds
->dev
, "%s\n", __func__
);
140 ret
= mdiobus_write_nested(bus
, ps
->port_base
+ port
, regnum
, value
);
142 ps
->ports
[port
].mib
[DSA_LOOP_PHY_WRITE_ERR
].val
++;
144 ps
->ports
[port
].mib
[DSA_LOOP_PHY_WRITE_OK
].val
++;
149 static int dsa_loop_port_bridge_join(struct dsa_switch
*ds
, int port
,
150 struct net_device
*bridge
)
152 dev_dbg(ds
->dev
, "%s\n", __func__
);
157 static void dsa_loop_port_bridge_leave(struct dsa_switch
*ds
, int port
,
158 struct net_device
*bridge
)
160 dev_dbg(ds
->dev
, "%s\n", __func__
);
163 static void dsa_loop_port_stp_state_set(struct dsa_switch
*ds
, int port
,
166 dev_dbg(ds
->dev
, "%s\n", __func__
);
169 static int dsa_loop_port_vlan_filtering(struct dsa_switch
*ds
, int port
,
172 dev_dbg(ds
->dev
, "%s\n", __func__
);
177 static int dsa_loop_port_vlan_prepare(struct dsa_switch
*ds
, int port
,
178 const struct switchdev_obj_port_vlan
*vlan
,
179 struct switchdev_trans
*trans
)
181 struct dsa_loop_priv
*ps
= ds
->priv
;
182 struct mii_bus
*bus
= ps
->bus
;
184 dev_dbg(ds
->dev
, "%s\n", __func__
);
186 /* Just do a sleeping operation to make lockdep checks effective */
187 mdiobus_read(bus
, ps
->port_base
+ port
, MII_BMSR
);
189 if (vlan
->vid_end
> DSA_LOOP_VLANS
)
195 static void dsa_loop_port_vlan_add(struct dsa_switch
*ds
, int port
,
196 const struct switchdev_obj_port_vlan
*vlan
,
197 struct switchdev_trans
*trans
)
199 bool untagged
= vlan
->flags
& BRIDGE_VLAN_INFO_UNTAGGED
;
200 bool pvid
= vlan
->flags
& BRIDGE_VLAN_INFO_PVID
;
201 struct dsa_loop_priv
*ps
= ds
->priv
;
202 struct mii_bus
*bus
= ps
->bus
;
203 struct dsa_loop_vlan
*vl
;
206 dev_dbg(ds
->dev
, "%s\n", __func__
);
208 /* Just do a sleeping operation to make lockdep checks effective */
209 mdiobus_read(bus
, ps
->port_base
+ port
, MII_BMSR
);
211 for (vid
= vlan
->vid_begin
; vid
<= vlan
->vid_end
; ++vid
) {
212 vl
= &ps
->vlans
[vid
];
214 vl
->members
|= BIT(port
);
216 vl
->untagged
|= BIT(port
);
218 vl
->untagged
&= ~BIT(port
);
225 static int dsa_loop_port_vlan_del(struct dsa_switch
*ds
, int port
,
226 const struct switchdev_obj_port_vlan
*vlan
)
228 bool untagged
= vlan
->flags
& BRIDGE_VLAN_INFO_UNTAGGED
;
229 struct dsa_loop_priv
*ps
= ds
->priv
;
230 struct mii_bus
*bus
= ps
->bus
;
231 struct dsa_loop_vlan
*vl
;
232 u16 vid
, pvid
= ps
->pvid
;
234 dev_dbg(ds
->dev
, "%s\n", __func__
);
236 /* Just do a sleeping operation to make lockdep checks effective */
237 mdiobus_read(bus
, ps
->port_base
+ port
, MII_BMSR
);
239 for (vid
= vlan
->vid_begin
; vid
<= vlan
->vid_end
; ++vid
) {
240 vl
= &ps
->vlans
[vid
];
242 vl
->members
&= ~BIT(port
);
244 vl
->untagged
&= ~BIT(port
);
254 static const struct dsa_switch_ops dsa_loop_driver
= {
255 .get_tag_protocol
= dsa_loop_get_protocol
,
256 .setup
= dsa_loop_setup
,
257 .get_strings
= dsa_loop_get_strings
,
258 .get_ethtool_stats
= dsa_loop_get_ethtool_stats
,
259 .get_sset_count
= dsa_loop_get_sset_count
,
260 .phy_read
= dsa_loop_phy_read
,
261 .phy_write
= dsa_loop_phy_write
,
262 .port_bridge_join
= dsa_loop_port_bridge_join
,
263 .port_bridge_leave
= dsa_loop_port_bridge_leave
,
264 .port_stp_state_set
= dsa_loop_port_stp_state_set
,
265 .port_vlan_filtering
= dsa_loop_port_vlan_filtering
,
266 .port_vlan_prepare
= dsa_loop_port_vlan_prepare
,
267 .port_vlan_add
= dsa_loop_port_vlan_add
,
268 .port_vlan_del
= dsa_loop_port_vlan_del
,
271 static int dsa_loop_drv_probe(struct mdio_device
*mdiodev
)
273 struct dsa_loop_pdata
*pdata
= mdiodev
->dev
.platform_data
;
274 struct dsa_loop_priv
*ps
;
275 struct dsa_switch
*ds
;
280 dev_info(&mdiodev
->dev
, "%s: 0x%0x\n",
281 pdata
->name
, pdata
->enabled_ports
);
283 ds
= dsa_switch_alloc(&mdiodev
->dev
, DSA_MAX_PORTS
);
287 ps
= devm_kzalloc(&mdiodev
->dev
, sizeof(*ps
), GFP_KERNEL
);
291 ps
->netdev
= dev_get_by_name(&init_net
, pdata
->netdev
);
293 return -EPROBE_DEFER
;
295 pdata
->cd
.netdev
[DSA_LOOP_CPU_PORT
] = &ps
->netdev
->dev
;
297 ds
->dev
= &mdiodev
->dev
;
298 ds
->ops
= &dsa_loop_driver
;
300 ps
->bus
= mdiodev
->bus
;
302 dev_set_drvdata(&mdiodev
->dev
, ds
);
304 return dsa_register_switch(ds
);
307 static void dsa_loop_drv_remove(struct mdio_device
*mdiodev
)
309 struct dsa_switch
*ds
= dev_get_drvdata(&mdiodev
->dev
);
310 struct dsa_loop_priv
*ps
= ds
->priv
;
312 dsa_unregister_switch(ds
);
316 static struct mdio_driver dsa_loop_drv
= {
320 .probe
= dsa_loop_drv_probe
,
321 .remove
= dsa_loop_drv_remove
,
324 #define NUM_FIXED_PHYS (DSA_LOOP_NUM_PORTS - 2)
326 static int __init
dsa_loop_init(void)
328 struct fixed_phy_status status
= {
331 .duplex
= DUPLEX_FULL
,
335 for (i
= 0; i
< NUM_FIXED_PHYS
; i
++)
336 phydevs
[i
] = fixed_phy_register(PHY_POLL
, &status
, -1, NULL
);
338 return mdio_driver_register(&dsa_loop_drv
);
340 module_init(dsa_loop_init
);
342 static void __exit
dsa_loop_exit(void)
346 mdio_driver_unregister(&dsa_loop_drv
);
347 for (i
= 0; i
< NUM_FIXED_PHYS
; i
++)
348 if (!IS_ERR(phydevs
[i
]))
349 fixed_phy_unregister(phydevs
[i
]);
351 module_exit(dsa_loop_exit
);
353 MODULE_LICENSE("GPL");
354 MODULE_AUTHOR("Florian Fainelli");
355 MODULE_DESCRIPTION("DSA loopback driver");