2 * net/dsa/dsa2.c - Hardware switch handling, binding version 2
3 * Copyright (c) 2008-2009 Marvell Semiconductor
4 * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org>
5 * Copyright (c) 2016 Andrew Lunn <andrew@lunn.ch>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
13 #include <linux/device.h>
14 #include <linux/err.h>
15 #include <linux/list.h>
16 #include <linux/slab.h>
17 #include <linux/rtnetlink.h>
20 #include <linux/of_net.h>
23 static LIST_HEAD(dsa_switch_trees
);
24 static DEFINE_MUTEX(dsa2_mutex
);
26 static struct dsa_switch_tree
*dsa_get_dst(u32 tree
)
28 struct dsa_switch_tree
*dst
;
30 list_for_each_entry(dst
, &dsa_switch_trees
, list
)
31 if (dst
->tree
== tree
) {
32 kref_get(&dst
->refcount
);
38 static void dsa_free_dst(struct kref
*ref
)
40 struct dsa_switch_tree
*dst
= container_of(ref
, struct dsa_switch_tree
,
47 static void dsa_put_dst(struct dsa_switch_tree
*dst
)
49 kref_put(&dst
->refcount
, dsa_free_dst
);
52 static struct dsa_switch_tree
*dsa_add_dst(u32 tree
)
54 struct dsa_switch_tree
*dst
;
56 dst
= kzalloc(sizeof(*dst
), GFP_KERNEL
);
60 INIT_LIST_HEAD(&dst
->list
);
61 list_add_tail(&dsa_switch_trees
, &dst
->list
);
62 kref_init(&dst
->refcount
);
67 static void dsa_dst_add_ds(struct dsa_switch_tree
*dst
,
68 struct dsa_switch
*ds
, u32 index
)
70 kref_get(&dst
->refcount
);
74 static void dsa_dst_del_ds(struct dsa_switch_tree
*dst
,
75 struct dsa_switch
*ds
, u32 index
)
77 dst
->ds
[index
] = NULL
;
78 kref_put(&dst
->refcount
, dsa_free_dst
);
81 /* For platform data configurations, we need to have a valid name argument to
82 * differentiate a disabled port from an enabled one
84 static bool dsa_port_is_valid(struct dsa_port
*port
)
86 return !!(port
->dn
|| port
->name
);
89 static bool dsa_port_is_dsa(struct dsa_port
*port
)
91 if (port
->name
&& !strcmp(port
->name
, "dsa"))
94 return !!of_parse_phandle(port
->dn
, "link", 0);
97 static bool dsa_port_is_cpu(struct dsa_port
*port
)
99 if (port
->name
&& !strcmp(port
->name
, "cpu"))
102 return !!of_parse_phandle(port
->dn
, "ethernet", 0);
105 static bool dsa_ds_find_port_dn(struct dsa_switch
*ds
,
106 struct device_node
*port
)
110 for (index
= 0; index
< ds
->num_ports
; index
++)
111 if (ds
->ports
[index
].dn
== port
)
116 static struct dsa_switch
*dsa_dst_find_port_dn(struct dsa_switch_tree
*dst
,
117 struct device_node
*port
)
119 struct dsa_switch
*ds
;
122 for (index
= 0; index
< DSA_MAX_SWITCHES
; index
++) {
127 if (dsa_ds_find_port_dn(ds
, port
))
134 static int dsa_port_complete(struct dsa_switch_tree
*dst
,
135 struct dsa_switch
*src_ds
,
136 struct dsa_port
*port
,
139 struct device_node
*link
;
141 struct dsa_switch
*dst_ds
;
143 for (index
= 0;; index
++) {
144 link
= of_parse_phandle(port
->dn
, "link", index
);
148 dst_ds
= dsa_dst_find_port_dn(dst
, link
);
154 src_ds
->rtable
[dst_ds
->index
] = src_port
;
160 /* A switch is complete if all the DSA ports phandles point to ports
161 * known in the tree. A return value of 1 means the tree is not
162 * complete. This is not an error condition. A value of 0 is
165 static int dsa_ds_complete(struct dsa_switch_tree
*dst
, struct dsa_switch
*ds
)
167 struct dsa_port
*port
;
171 for (index
= 0; index
< ds
->num_ports
; index
++) {
172 port
= &ds
->ports
[index
];
173 if (!dsa_port_is_valid(port
))
176 if (!dsa_port_is_dsa(port
))
179 err
= dsa_port_complete(dst
, ds
, port
, index
);
183 ds
->dsa_port_mask
|= BIT(index
);
189 /* A tree is complete if all the DSA ports phandles point to ports
190 * known in the tree. A return value of 1 means the tree is not
191 * complete. This is not an error condition. A value of 0 is
194 static int dsa_dst_complete(struct dsa_switch_tree
*dst
)
196 struct dsa_switch
*ds
;
200 for (index
= 0; index
< DSA_MAX_SWITCHES
; index
++) {
205 err
= dsa_ds_complete(dst
, ds
);
213 static int dsa_dsa_port_apply(struct dsa_port
*port
, u32 index
,
214 struct dsa_switch
*ds
)
218 err
= dsa_cpu_dsa_setup(ds
, ds
->dev
, port
, index
);
220 dev_warn(ds
->dev
, "Failed to setup dsa port %d: %d\n",
228 static void dsa_dsa_port_unapply(struct dsa_port
*port
, u32 index
,
229 struct dsa_switch
*ds
)
231 dsa_cpu_dsa_destroy(port
);
234 static int dsa_cpu_port_apply(struct dsa_port
*port
, u32 index
,
235 struct dsa_switch
*ds
)
239 err
= dsa_cpu_dsa_setup(ds
, ds
->dev
, port
, index
);
241 dev_warn(ds
->dev
, "Failed to setup cpu port %d: %d\n",
246 ds
->cpu_port_mask
|= BIT(index
);
251 static void dsa_cpu_port_unapply(struct dsa_port
*port
, u32 index
,
252 struct dsa_switch
*ds
)
254 dsa_cpu_dsa_destroy(port
);
255 ds
->cpu_port_mask
&= ~BIT(index
);
259 static int dsa_user_port_apply(struct dsa_port
*port
, u32 index
,
260 struct dsa_switch
*ds
)
262 const char *name
= port
->name
;
266 name
= of_get_property(port
->dn
, "label", NULL
);
270 err
= dsa_slave_create(ds
, ds
->dev
, index
, name
);
272 dev_warn(ds
->dev
, "Failed to create slave %d: %d\n",
274 ds
->ports
[index
].netdev
= NULL
;
281 static void dsa_user_port_unapply(struct dsa_port
*port
, u32 index
,
282 struct dsa_switch
*ds
)
284 if (ds
->ports
[index
].netdev
) {
285 dsa_slave_destroy(ds
->ports
[index
].netdev
);
286 ds
->ports
[index
].netdev
= NULL
;
287 ds
->enabled_port_mask
&= ~(1 << index
);
291 static int dsa_ds_apply(struct dsa_switch_tree
*dst
, struct dsa_switch
*ds
)
293 struct dsa_port
*port
;
297 /* Initialize ds->phys_mii_mask before registering the slave MDIO bus
298 * driver and before ops->setup() has run, since the switch drivers and
299 * the slave MDIO bus driver rely on these values for probing PHY
302 ds
->phys_mii_mask
= ds
->enabled_port_mask
;
304 err
= ds
->ops
->setup(ds
);
308 err
= dsa_switch_register_notifier(ds
);
312 if (ds
->ops
->set_addr
) {
313 err
= ds
->ops
->set_addr(ds
, dst
->master_netdev
->dev_addr
);
318 if (!ds
->slave_mii_bus
&& ds
->ops
->phy_read
) {
319 ds
->slave_mii_bus
= devm_mdiobus_alloc(ds
->dev
);
320 if (!ds
->slave_mii_bus
)
323 dsa_slave_mii_bus_init(ds
);
325 err
= mdiobus_register(ds
->slave_mii_bus
);
330 for (index
= 0; index
< ds
->num_ports
; index
++) {
331 port
= &ds
->ports
[index
];
332 if (!dsa_port_is_valid(port
))
335 if (dsa_port_is_dsa(port
)) {
336 err
= dsa_dsa_port_apply(port
, index
, ds
);
342 if (dsa_port_is_cpu(port
)) {
343 err
= dsa_cpu_port_apply(port
, index
, ds
);
349 err
= dsa_user_port_apply(port
, index
, ds
);
357 static void dsa_ds_unapply(struct dsa_switch_tree
*dst
, struct dsa_switch
*ds
)
359 struct dsa_port
*port
;
362 for (index
= 0; index
< ds
->num_ports
; index
++) {
363 port
= &ds
->ports
[index
];
364 if (!dsa_port_is_valid(port
))
367 if (dsa_port_is_dsa(port
)) {
368 dsa_dsa_port_unapply(port
, index
, ds
);
372 if (dsa_port_is_cpu(port
)) {
373 dsa_cpu_port_unapply(port
, index
, ds
);
377 dsa_user_port_unapply(port
, index
, ds
);
380 if (ds
->slave_mii_bus
&& ds
->ops
->phy_read
)
381 mdiobus_unregister(ds
->slave_mii_bus
);
383 dsa_switch_unregister_notifier(ds
);
386 static int dsa_dst_apply(struct dsa_switch_tree
*dst
)
388 struct dsa_switch
*ds
;
392 for (index
= 0; index
< DSA_MAX_SWITCHES
; index
++) {
397 err
= dsa_ds_apply(dst
, ds
);
402 if (dst
->cpu_switch
) {
403 err
= dsa_cpu_port_ethtool_setup(dst
->cpu_switch
);
408 /* If we use a tagging format that doesn't have an ethertype
409 * field, make sure that all packets from this point on get
410 * sent to the tag format's receive function.
413 dst
->master_netdev
->dsa_ptr
= (void *)dst
;
419 static void dsa_dst_unapply(struct dsa_switch_tree
*dst
)
421 struct dsa_switch
*ds
;
427 dst
->master_netdev
->dsa_ptr
= NULL
;
429 /* If we used a tagging format that doesn't have an ethertype
430 * field, make sure that all packets from this point get sent
431 * without the tag and go through the regular receive path.
435 for (index
= 0; index
< DSA_MAX_SWITCHES
; index
++) {
440 dsa_ds_unapply(dst
, ds
);
443 if (dst
->cpu_switch
) {
444 dsa_cpu_port_ethtool_restore(dst
->cpu_switch
);
445 dst
->cpu_switch
= NULL
;
448 pr_info("DSA: tree %d unapplied\n", dst
->tree
);
449 dst
->applied
= false;
452 static int dsa_cpu_parse(struct dsa_port
*port
, u32 index
,
453 struct dsa_switch_tree
*dst
,
454 struct dsa_switch
*ds
)
456 enum dsa_tag_protocol tag_protocol
;
457 struct net_device
*ethernet_dev
;
458 struct device_node
*ethernet
;
461 ethernet
= of_parse_phandle(port
->dn
, "ethernet", 0);
464 ethernet_dev
= of_find_net_device_by_node(ethernet
);
466 ethernet_dev
= dsa_dev_to_net_device(ds
->cd
->netdev
[index
]);
467 dev_put(ethernet_dev
);
471 return -EPROBE_DEFER
;
473 if (!ds
->master_netdev
)
474 ds
->master_netdev
= ethernet_dev
;
476 if (!dst
->master_netdev
)
477 dst
->master_netdev
= ethernet_dev
;
479 if (!dst
->cpu_switch
) {
480 dst
->cpu_switch
= ds
;
481 dst
->cpu_port
= index
;
484 tag_protocol
= ds
->ops
->get_tag_protocol(ds
);
485 dst
->tag_ops
= dsa_resolve_tag_protocol(tag_protocol
);
486 if (IS_ERR(dst
->tag_ops
)) {
487 dev_warn(ds
->dev
, "No tagger for this switch\n");
488 return PTR_ERR(dst
->tag_ops
);
491 dst
->rcv
= dst
->tag_ops
->rcv
;
496 static int dsa_ds_parse(struct dsa_switch_tree
*dst
, struct dsa_switch
*ds
)
498 struct dsa_port
*port
;
502 for (index
= 0; index
< ds
->num_ports
; index
++) {
503 port
= &ds
->ports
[index
];
504 if (!dsa_port_is_valid(port
))
507 if (dsa_port_is_cpu(port
)) {
508 err
= dsa_cpu_parse(port
, index
, dst
, ds
);
514 pr_info("DSA: switch %d %d parsed\n", dst
->tree
, ds
->index
);
519 static int dsa_dst_parse(struct dsa_switch_tree
*dst
)
521 struct dsa_switch
*ds
;
525 for (index
= 0; index
< DSA_MAX_SWITCHES
; index
++) {
530 err
= dsa_ds_parse(dst
, ds
);
535 if (!dst
->master_netdev
) {
536 pr_warn("Tree has no master device\n");
540 pr_info("DSA: tree %d parsed\n", dst
->tree
);
545 static int dsa_parse_ports_dn(struct device_node
*ports
, struct dsa_switch
*ds
)
547 struct device_node
*port
;
551 for_each_available_child_of_node(ports
, port
) {
552 err
= of_property_read_u32(port
, "reg", ®
);
556 if (reg
>= ds
->num_ports
)
559 ds
->ports
[reg
].dn
= port
;
561 /* Initialize enabled_port_mask now for ops->setup()
562 * to have access to a correct value, just like what
563 * net/dsa/dsa.c::dsa_switch_setup_one does.
565 if (!dsa_port_is_cpu(&ds
->ports
[reg
]))
566 ds
->enabled_port_mask
|= 1 << reg
;
572 static int dsa_parse_ports(struct dsa_chip_data
*cd
, struct dsa_switch
*ds
)
574 bool valid_name_found
= false;
577 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
578 if (!cd
->port_names
[i
])
581 ds
->ports
[i
].name
= cd
->port_names
[i
];
583 /* Initialize enabled_port_mask now for drv->setup()
584 * to have access to a correct value, just like what
585 * net/dsa/dsa.c::dsa_switch_setup_one does.
587 if (!dsa_port_is_cpu(&ds
->ports
[i
]))
588 ds
->enabled_port_mask
|= 1 << i
;
590 valid_name_found
= true;
593 if (!valid_name_found
&& i
== DSA_MAX_PORTS
)
599 static int dsa_parse_member_dn(struct device_node
*np
, u32
*tree
, u32
*index
)
605 err
= of_property_read_u32_index(np
, "dsa,member", 0, tree
);
607 /* Does not exist, but it is optional */
613 err
= of_property_read_u32_index(np
, "dsa,member", 1, index
);
617 if (*index
>= DSA_MAX_SWITCHES
)
623 static int dsa_parse_member(struct dsa_chip_data
*pd
, u32
*tree
, u32
*index
)
628 /* We do not support complex trees with dsa_chip_data */
635 static struct device_node
*dsa_get_ports(struct dsa_switch
*ds
,
636 struct device_node
*np
)
638 struct device_node
*ports
;
640 ports
= of_get_child_by_name(np
, "ports");
642 dev_err(ds
->dev
, "no ports child node found\n");
643 return ERR_PTR(-EINVAL
);
649 static int _dsa_register_switch(struct dsa_switch
*ds
, struct device
*dev
)
651 struct dsa_chip_data
*pdata
= dev
->platform_data
;
652 struct device_node
*np
= dev
->of_node
;
653 struct dsa_switch_tree
*dst
;
654 struct device_node
*ports
;
659 err
= dsa_parse_member_dn(np
, &tree
, &index
);
663 ports
= dsa_get_ports(ds
, np
);
665 return PTR_ERR(ports
);
667 err
= dsa_parse_ports_dn(ports
, ds
);
671 err
= dsa_parse_member(pdata
, &tree
, &index
);
675 err
= dsa_parse_ports(pdata
, ds
);
680 dst
= dsa_get_dst(tree
);
682 dst
= dsa_add_dst(tree
);
687 if (dst
->ds
[index
]) {
696 /* Initialize the routing table */
697 for (i
= 0; i
< DSA_MAX_SWITCHES
; ++i
)
698 ds
->rtable
[i
] = DSA_RTABLE_NONE
;
700 dsa_dst_add_ds(dst
, ds
, index
);
702 err
= dsa_dst_complete(dst
);
707 /* Not all switches registered yet */
713 pr_info("DSA: Disjoint trees?\n");
717 err
= dsa_dst_parse(dst
);
719 if (err
== -EPROBE_DEFER
) {
720 dsa_dst_del_ds(dst
, ds
, ds
->index
);
727 err
= dsa_dst_apply(dst
);
729 dsa_dst_unapply(dst
);
737 dsa_dst_del_ds(dst
, ds
, ds
->index
);
744 struct dsa_switch
*dsa_switch_alloc(struct device
*dev
, size_t n
)
746 size_t size
= sizeof(struct dsa_switch
) + n
* sizeof(struct dsa_port
);
747 struct dsa_switch
*ds
;
750 ds
= devm_kzalloc(dev
, size
, GFP_KERNEL
);
757 for (i
= 0; i
< ds
->num_ports
; ++i
) {
758 ds
->ports
[i
].index
= i
;
759 ds
->ports
[i
].ds
= ds
;
764 EXPORT_SYMBOL_GPL(dsa_switch_alloc
);
766 int dsa_register_switch(struct dsa_switch
*ds
, struct device
*dev
)
770 mutex_lock(&dsa2_mutex
);
771 err
= _dsa_register_switch(ds
, dev
);
772 mutex_unlock(&dsa2_mutex
);
776 EXPORT_SYMBOL_GPL(dsa_register_switch
);
778 static void _dsa_unregister_switch(struct dsa_switch
*ds
)
780 struct dsa_switch_tree
*dst
= ds
->dst
;
782 dsa_dst_unapply(dst
);
784 dsa_dst_del_ds(dst
, ds
, ds
->index
);
787 void dsa_unregister_switch(struct dsa_switch
*ds
)
789 mutex_lock(&dsa2_mutex
);
790 _dsa_unregister_switch(ds
);
791 mutex_unlock(&dsa2_mutex
);
793 EXPORT_SYMBOL_GPL(dsa_unregister_switch
);