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
)
69 dev_dbg(ds
->dev
, "%s\n", __func__
);
71 return DSA_TAG_PROTO_NONE
;
74 static int dsa_loop_setup(struct dsa_switch
*ds
)
76 struct dsa_loop_priv
*ps
= ds
->priv
;
79 for (i
= 0; i
< ds
->num_ports
; i
++)
80 memcpy(ps
->ports
[i
].mib
, dsa_loop_mibs
,
81 sizeof(dsa_loop_mibs
));
83 dev_dbg(ds
->dev
, "%s\n", __func__
);
88 static int dsa_loop_get_sset_count(struct dsa_switch
*ds
)
90 return __DSA_LOOP_CNT_MAX
;
93 static void dsa_loop_get_strings(struct dsa_switch
*ds
, int port
, uint8_t *data
)
95 struct dsa_loop_priv
*ps
= ds
->priv
;
98 for (i
= 0; i
< __DSA_LOOP_CNT_MAX
; i
++)
99 memcpy(data
+ i
* ETH_GSTRING_LEN
,
100 ps
->ports
[port
].mib
[i
].name
, ETH_GSTRING_LEN
);
103 static void dsa_loop_get_ethtool_stats(struct dsa_switch
*ds
, int port
,
106 struct dsa_loop_priv
*ps
= ds
->priv
;
109 for (i
= 0; i
< __DSA_LOOP_CNT_MAX
; i
++)
110 data
[i
] = ps
->ports
[port
].mib
[i
].val
;
113 static int dsa_loop_set_addr(struct dsa_switch
*ds
, u8
*addr
)
115 dev_dbg(ds
->dev
, "%s\n", __func__
);
120 static int dsa_loop_phy_read(struct dsa_switch
*ds
, int port
, int regnum
)
122 struct dsa_loop_priv
*ps
= ds
->priv
;
123 struct mii_bus
*bus
= ps
->bus
;
126 dev_dbg(ds
->dev
, "%s\n", __func__
);
128 ret
= mdiobus_read_nested(bus
, ps
->port_base
+ port
, regnum
);
130 ps
->ports
[port
].mib
[DSA_LOOP_PHY_READ_ERR
].val
++;
132 ps
->ports
[port
].mib
[DSA_LOOP_PHY_READ_OK
].val
++;
137 static int dsa_loop_phy_write(struct dsa_switch
*ds
, int port
,
138 int regnum
, u16 value
)
140 struct dsa_loop_priv
*ps
= ds
->priv
;
141 struct mii_bus
*bus
= ps
->bus
;
144 dev_dbg(ds
->dev
, "%s\n", __func__
);
146 ret
= mdiobus_write_nested(bus
, ps
->port_base
+ port
, regnum
, value
);
148 ps
->ports
[port
].mib
[DSA_LOOP_PHY_WRITE_ERR
].val
++;
150 ps
->ports
[port
].mib
[DSA_LOOP_PHY_WRITE_OK
].val
++;
155 static int dsa_loop_port_bridge_join(struct dsa_switch
*ds
, int port
,
156 struct net_device
*bridge
)
158 dev_dbg(ds
->dev
, "%s\n", __func__
);
163 static void dsa_loop_port_bridge_leave(struct dsa_switch
*ds
, int port
,
164 struct net_device
*bridge
)
166 dev_dbg(ds
->dev
, "%s\n", __func__
);
169 static void dsa_loop_port_stp_state_set(struct dsa_switch
*ds
, int port
,
172 dev_dbg(ds
->dev
, "%s\n", __func__
);
175 static int dsa_loop_port_vlan_filtering(struct dsa_switch
*ds
, int port
,
178 dev_dbg(ds
->dev
, "%s\n", __func__
);
183 static int dsa_loop_port_vlan_prepare(struct dsa_switch
*ds
, int port
,
184 const struct switchdev_obj_port_vlan
*vlan
,
185 struct switchdev_trans
*trans
)
187 struct dsa_loop_priv
*ps
= ds
->priv
;
188 struct mii_bus
*bus
= ps
->bus
;
190 dev_dbg(ds
->dev
, "%s\n", __func__
);
192 /* Just do a sleeping operation to make lockdep checks effective */
193 mdiobus_read(bus
, ps
->port_base
+ port
, MII_BMSR
);
195 if (vlan
->vid_end
> DSA_LOOP_VLANS
)
201 static void dsa_loop_port_vlan_add(struct dsa_switch
*ds
, int port
,
202 const struct switchdev_obj_port_vlan
*vlan
,
203 struct switchdev_trans
*trans
)
205 bool untagged
= vlan
->flags
& BRIDGE_VLAN_INFO_UNTAGGED
;
206 bool pvid
= vlan
->flags
& BRIDGE_VLAN_INFO_PVID
;
207 struct dsa_loop_priv
*ps
= ds
->priv
;
208 struct mii_bus
*bus
= ps
->bus
;
209 struct dsa_loop_vlan
*vl
;
212 dev_dbg(ds
->dev
, "%s\n", __func__
);
214 /* Just do a sleeping operation to make lockdep checks effective */
215 mdiobus_read(bus
, ps
->port_base
+ port
, MII_BMSR
);
217 for (vid
= vlan
->vid_begin
; vid
<= vlan
->vid_end
; ++vid
) {
218 vl
= &ps
->vlans
[vid
];
220 vl
->members
|= BIT(port
);
222 vl
->untagged
|= BIT(port
);
224 vl
->untagged
&= ~BIT(port
);
231 static int dsa_loop_port_vlan_del(struct dsa_switch
*ds
, int port
,
232 const struct switchdev_obj_port_vlan
*vlan
)
234 bool untagged
= vlan
->flags
& BRIDGE_VLAN_INFO_UNTAGGED
;
235 struct dsa_loop_priv
*ps
= ds
->priv
;
236 struct mii_bus
*bus
= ps
->bus
;
237 struct dsa_loop_vlan
*vl
;
238 u16 vid
, pvid
= ps
->pvid
;
240 dev_dbg(ds
->dev
, "%s\n", __func__
);
242 /* Just do a sleeping operation to make lockdep checks effective */
243 mdiobus_read(bus
, ps
->port_base
+ port
, MII_BMSR
);
245 for (vid
= vlan
->vid_begin
; vid
<= vlan
->vid_end
; ++vid
) {
246 vl
= &ps
->vlans
[vid
];
248 vl
->members
&= ~BIT(port
);
250 vl
->untagged
&= ~BIT(port
);
260 static const struct dsa_switch_ops dsa_loop_driver
= {
261 .get_tag_protocol
= dsa_loop_get_protocol
,
262 .setup
= dsa_loop_setup
,
263 .get_strings
= dsa_loop_get_strings
,
264 .get_ethtool_stats
= dsa_loop_get_ethtool_stats
,
265 .get_sset_count
= dsa_loop_get_sset_count
,
266 .set_addr
= dsa_loop_set_addr
,
267 .phy_read
= dsa_loop_phy_read
,
268 .phy_write
= dsa_loop_phy_write
,
269 .port_bridge_join
= dsa_loop_port_bridge_join
,
270 .port_bridge_leave
= dsa_loop_port_bridge_leave
,
271 .port_stp_state_set
= dsa_loop_port_stp_state_set
,
272 .port_vlan_filtering
= dsa_loop_port_vlan_filtering
,
273 .port_vlan_prepare
= dsa_loop_port_vlan_prepare
,
274 .port_vlan_add
= dsa_loop_port_vlan_add
,
275 .port_vlan_del
= dsa_loop_port_vlan_del
,
278 static int dsa_loop_drv_probe(struct mdio_device
*mdiodev
)
280 struct dsa_loop_pdata
*pdata
= mdiodev
->dev
.platform_data
;
281 struct dsa_loop_priv
*ps
;
282 struct dsa_switch
*ds
;
287 dev_info(&mdiodev
->dev
, "%s: 0x%0x\n",
288 pdata
->name
, pdata
->enabled_ports
);
290 ds
= dsa_switch_alloc(&mdiodev
->dev
, DSA_MAX_PORTS
);
294 ps
= devm_kzalloc(&mdiodev
->dev
, sizeof(*ps
), GFP_KERNEL
);
298 ps
->netdev
= dev_get_by_name(&init_net
, pdata
->netdev
);
300 return -EPROBE_DEFER
;
302 pdata
->cd
.netdev
[DSA_LOOP_CPU_PORT
] = &ps
->netdev
->dev
;
304 ds
->dev
= &mdiodev
->dev
;
305 ds
->ops
= &dsa_loop_driver
;
307 ps
->bus
= mdiodev
->bus
;
309 dev_set_drvdata(&mdiodev
->dev
, ds
);
311 return dsa_register_switch(ds
);
314 static void dsa_loop_drv_remove(struct mdio_device
*mdiodev
)
316 struct dsa_switch
*ds
= dev_get_drvdata(&mdiodev
->dev
);
317 struct dsa_loop_priv
*ps
= ds
->priv
;
319 dsa_unregister_switch(ds
);
323 static struct mdio_driver dsa_loop_drv
= {
327 .probe
= dsa_loop_drv_probe
,
328 .remove
= dsa_loop_drv_remove
,
331 #define NUM_FIXED_PHYS (DSA_LOOP_NUM_PORTS - 2)
333 static int __init
dsa_loop_init(void)
335 struct fixed_phy_status status
= {
338 .duplex
= DUPLEX_FULL
,
342 for (i
= 0; i
< NUM_FIXED_PHYS
; i
++)
343 phydevs
[i
] = fixed_phy_register(PHY_POLL
, &status
, -1, NULL
);
345 return mdio_driver_register(&dsa_loop_drv
);
347 module_init(dsa_loop_init
);
349 static void __exit
dsa_loop_exit(void)
353 mdio_driver_unregister(&dsa_loop_drv
);
354 for (i
= 0; i
< NUM_FIXED_PHYS
; i
++)
355 if (!IS_ERR(phydevs
[i
]))
356 fixed_phy_unregister(phydevs
[i
]);
358 module_exit(dsa_loop_exit
);
360 MODULE_LICENSE("GPL");
361 MODULE_AUTHOR("Florian Fainelli");
362 MODULE_DESCRIPTION("DSA loopback driver");