2 * net/dsa/dsa.c - Hardware switch handling
3 * Copyright (c) 2008-2009 Marvell Semiconductor
4 * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org>
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/list.h>
13 #include <linux/platform_device.h>
14 #include <linux/slab.h>
15 #include <linux/module.h>
18 #include <linux/of_mdio.h>
19 #include <linux/of_platform.h>
22 char dsa_driver_version
[] = "0.1";
25 /* switch driver registration ***********************************************/
26 static DEFINE_MUTEX(dsa_switch_drivers_mutex
);
27 static LIST_HEAD(dsa_switch_drivers
);
29 void register_switch_driver(struct dsa_switch_driver
*drv
)
31 mutex_lock(&dsa_switch_drivers_mutex
);
32 list_add_tail(&drv
->list
, &dsa_switch_drivers
);
33 mutex_unlock(&dsa_switch_drivers_mutex
);
35 EXPORT_SYMBOL_GPL(register_switch_driver
);
37 void unregister_switch_driver(struct dsa_switch_driver
*drv
)
39 mutex_lock(&dsa_switch_drivers_mutex
);
40 list_del_init(&drv
->list
);
41 mutex_unlock(&dsa_switch_drivers_mutex
);
43 EXPORT_SYMBOL_GPL(unregister_switch_driver
);
45 static struct dsa_switch_driver
*
46 dsa_switch_probe(struct device
*host_dev
, int sw_addr
, char **_name
)
48 struct dsa_switch_driver
*ret
;
49 struct list_head
*list
;
55 mutex_lock(&dsa_switch_drivers_mutex
);
56 list_for_each(list
, &dsa_switch_drivers
) {
57 struct dsa_switch_driver
*drv
;
59 drv
= list_entry(list
, struct dsa_switch_driver
, list
);
61 name
= drv
->probe(host_dev
, sw_addr
);
67 mutex_unlock(&dsa_switch_drivers_mutex
);
75 /* basic switch operations **************************************************/
76 static struct dsa_switch
*
77 dsa_switch_setup(struct dsa_switch_tree
*dst
, int index
,
78 struct device
*parent
, struct device
*host_dev
)
80 struct dsa_chip_data
*pd
= dst
->pd
->chip
+ index
;
81 struct dsa_switch_driver
*drv
;
82 struct dsa_switch
*ds
;
86 bool valid_name_found
= false;
89 * Probe for switch model.
91 drv
= dsa_switch_probe(host_dev
, pd
->sw_addr
, &name
);
93 printk(KERN_ERR
"%s[%d]: could not detect attached switch\n",
94 dst
->master_netdev
->name
, index
);
95 return ERR_PTR(-EINVAL
);
97 printk(KERN_INFO
"%s[%d]: detected a %s switch\n",
98 dst
->master_netdev
->name
, index
, name
);
102 * Allocate and initialise switch state.
104 ds
= kzalloc(sizeof(*ds
) + drv
->priv_size
, GFP_KERNEL
);
106 return ERR_PTR(-ENOMEM
);
110 ds
->pd
= dst
->pd
->chip
+ index
;
112 ds
->master_dev
= host_dev
;
115 * Validate supplied switch configuration.
117 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
120 name
= pd
->port_names
[i
];
124 if (!strcmp(name
, "cpu")) {
125 if (dst
->cpu_switch
!= -1) {
126 printk(KERN_ERR
"multiple cpu ports?!\n");
130 dst
->cpu_switch
= index
;
132 } else if (!strcmp(name
, "dsa")) {
133 ds
->dsa_port_mask
|= 1 << i
;
135 ds
->phys_port_mask
|= 1 << i
;
137 valid_name_found
= true;
140 if (!valid_name_found
&& i
== DSA_MAX_PORTS
) {
145 /* Make the built-in MII bus mask match the number of ports,
146 * switch drivers can override this later
148 ds
->phys_mii_mask
= ds
->phys_port_mask
;
151 * If the CPU connects to this switch, set the switch tree
152 * tagging protocol to the preferred tagging format of this
155 if (dst
->cpu_switch
== index
) {
156 switch (drv
->tag_protocol
) {
157 #ifdef CONFIG_NET_DSA_TAG_DSA
158 case DSA_TAG_PROTO_DSA
:
159 dst
->rcv
= dsa_netdev_ops
.rcv
;
162 #ifdef CONFIG_NET_DSA_TAG_EDSA
163 case DSA_TAG_PROTO_EDSA
:
164 dst
->rcv
= edsa_netdev_ops
.rcv
;
167 #ifdef CONFIG_NET_DSA_TAG_TRAILER
168 case DSA_TAG_PROTO_TRAILER
:
169 dst
->rcv
= trailer_netdev_ops
.rcv
;
172 #ifdef CONFIG_NET_DSA_TAG_BRCM
173 case DSA_TAG_PROTO_BRCM
:
174 dst
->rcv
= brcm_netdev_ops
.rcv
;
181 dst
->tag_protocol
= drv
->tag_protocol
;
185 * Do basic register setup.
187 ret
= drv
->setup(ds
);
191 ret
= drv
->set_addr(ds
, dst
->master_netdev
->dev_addr
);
195 ds
->slave_mii_bus
= mdiobus_alloc();
196 if (ds
->slave_mii_bus
== NULL
) {
200 dsa_slave_mii_bus_init(ds
);
202 ret
= mdiobus_register(ds
->slave_mii_bus
);
208 * Create network devices for physical switch ports.
210 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
211 struct net_device
*slave_dev
;
213 if (!(ds
->phys_port_mask
& (1 << i
)))
216 slave_dev
= dsa_slave_create(ds
, parent
, i
, pd
->port_names
[i
]);
217 if (slave_dev
== NULL
) {
218 printk(KERN_ERR
"%s[%d]: can't create dsa "
219 "slave device for port %d(%s)\n",
220 dst
->master_netdev
->name
,
221 index
, i
, pd
->port_names
[i
]);
225 ds
->ports
[i
] = slave_dev
;
231 mdiobus_free(ds
->slave_mii_bus
);
237 static void dsa_switch_destroy(struct dsa_switch
*ds
)
241 static int dsa_switch_suspend(struct dsa_switch
*ds
)
245 /* Suspend slave network devices */
246 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
247 if (!(ds
->phys_port_mask
& (1 << i
)))
250 ret
= dsa_slave_suspend(ds
->ports
[i
]);
255 if (ds
->drv
->suspend
)
256 ret
= ds
->drv
->suspend(ds
);
261 static int dsa_switch_resume(struct dsa_switch
*ds
)
266 ret
= ds
->drv
->resume(ds
);
271 /* Resume slave network devices */
272 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
273 if (!(ds
->phys_port_mask
& (1 << i
)))
276 ret
= dsa_slave_resume(ds
->ports
[i
]);
285 /* link polling *************************************************************/
286 static void dsa_link_poll_work(struct work_struct
*ugly
)
288 struct dsa_switch_tree
*dst
;
291 dst
= container_of(ugly
, struct dsa_switch_tree
, link_poll_work
);
293 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
294 struct dsa_switch
*ds
= dst
->ds
[i
];
296 if (ds
!= NULL
&& ds
->drv
->poll_link
!= NULL
)
297 ds
->drv
->poll_link(ds
);
300 mod_timer(&dst
->link_poll_timer
, round_jiffies(jiffies
+ HZ
));
303 static void dsa_link_poll_timer(unsigned long _dst
)
305 struct dsa_switch_tree
*dst
= (void *)_dst
;
307 schedule_work(&dst
->link_poll_work
);
311 /* platform driver init and cleanup *****************************************/
312 static int dev_is_class(struct device
*dev
, void *class)
314 if (dev
->class != NULL
&& !strcmp(dev
->class->name
, class))
320 static struct device
*dev_find_class(struct device
*parent
, char *class)
322 if (dev_is_class(parent
, class)) {
327 return device_find_child(parent
, class, dev_is_class
);
330 struct mii_bus
*dsa_host_dev_to_mii_bus(struct device
*dev
)
334 d
= dev_find_class(dev
, "mdio_bus");
346 EXPORT_SYMBOL_GPL(dsa_host_dev_to_mii_bus
);
348 static struct net_device
*dev_to_net_device(struct device
*dev
)
352 d
= dev_find_class(dev
, "net");
354 struct net_device
*nd
;
367 static int dsa_of_setup_routing_table(struct dsa_platform_data
*pd
,
368 struct dsa_chip_data
*cd
,
370 struct device_node
*link
)
376 struct device_node
*parent_sw
;
379 parent_sw
= of_get_parent(link
);
383 reg
= of_get_property(parent_sw
, "reg", &len
);
384 if (!reg
|| (len
!= sizeof(*reg
) * 2))
387 link_sw_addr
= be32_to_cpup(reg
+ 1);
389 if (link_sw_addr
>= pd
->nr_chips
)
392 /* First time routing table allocation */
394 cd
->rtable
= kmalloc(pd
->nr_chips
* sizeof(s8
), GFP_KERNEL
);
398 /* default to no valid uplink/downlink */
399 memset(cd
->rtable
, -1, pd
->nr_chips
* sizeof(s8
));
402 reg
= of_get_property(link
, "reg", NULL
);
408 link_port_addr
= be32_to_cpup(reg
);
410 cd
->rtable
[link_sw_addr
] = link_port_addr
;
418 static void dsa_of_free_platform_data(struct dsa_platform_data
*pd
)
423 for (i
= 0; i
< pd
->nr_chips
; i
++) {
425 while (port_index
< DSA_MAX_PORTS
) {
426 kfree(pd
->chip
[i
].port_names
[port_index
]);
429 kfree(pd
->chip
[i
].rtable
);
434 static int dsa_of_probe(struct platform_device
*pdev
)
436 struct device_node
*np
= pdev
->dev
.of_node
;
437 struct device_node
*child
, *mdio
, *ethernet
, *port
, *link
;
438 struct mii_bus
*mdio_bus
;
439 struct platform_device
*ethernet_dev
;
440 struct dsa_platform_data
*pd
;
441 struct dsa_chip_data
*cd
;
442 const char *port_name
;
443 int chip_index
, port_index
;
444 const unsigned int *sw_addr
, *port_reg
;
447 mdio
= of_parse_phandle(np
, "dsa,mii-bus", 0);
451 mdio_bus
= of_mdio_find_bus(mdio
);
455 ethernet
= of_parse_phandle(np
, "dsa,ethernet", 0);
459 ethernet_dev
= of_find_device_by_node(ethernet
);
463 pd
= kzalloc(sizeof(*pd
), GFP_KERNEL
);
467 pdev
->dev
.platform_data
= pd
;
468 pd
->netdev
= ðernet_dev
->dev
;
469 pd
->nr_chips
= of_get_child_count(np
);
470 if (pd
->nr_chips
> DSA_MAX_SWITCHES
)
471 pd
->nr_chips
= DSA_MAX_SWITCHES
;
473 pd
->chip
= kzalloc(pd
->nr_chips
* sizeof(struct dsa_chip_data
),
481 for_each_available_child_of_node(np
, child
) {
483 cd
= &pd
->chip
[chip_index
];
486 cd
->host_dev
= &mdio_bus
->dev
;
488 sw_addr
= of_get_property(child
, "reg", NULL
);
492 cd
->sw_addr
= be32_to_cpup(sw_addr
);
493 if (cd
->sw_addr
> PHY_MAX_ADDR
)
496 for_each_available_child_of_node(child
, port
) {
497 port_reg
= of_get_property(port
, "reg", NULL
);
501 port_index
= be32_to_cpup(port_reg
);
503 port_name
= of_get_property(port
, "label", NULL
);
507 cd
->port_dn
[port_index
] = port
;
509 cd
->port_names
[port_index
] = kstrdup(port_name
,
511 if (!cd
->port_names
[port_index
]) {
516 link
= of_parse_phandle(port
, "link", 0);
518 if (!strcmp(port_name
, "dsa") && link
&&
520 ret
= dsa_of_setup_routing_table(pd
, cd
,
526 if (port_index
== DSA_MAX_PORTS
)
534 dsa_of_free_platform_data(pd
);
537 pdev
->dev
.platform_data
= NULL
;
541 static void dsa_of_remove(struct platform_device
*pdev
)
543 struct dsa_platform_data
*pd
= pdev
->dev
.platform_data
;
545 if (!pdev
->dev
.of_node
)
548 dsa_of_free_platform_data(pd
);
552 static inline int dsa_of_probe(struct platform_device
*pdev
)
557 static inline void dsa_of_remove(struct platform_device
*pdev
)
562 static int dsa_probe(struct platform_device
*pdev
)
564 static int dsa_version_printed
;
565 struct dsa_platform_data
*pd
= pdev
->dev
.platform_data
;
566 struct net_device
*dev
;
567 struct dsa_switch_tree
*dst
;
570 if (!dsa_version_printed
++)
571 printk(KERN_NOTICE
"Distributed Switch Architecture "
572 "driver version %s\n", dsa_driver_version
);
574 if (pdev
->dev
.of_node
) {
575 ret
= dsa_of_probe(pdev
);
579 pd
= pdev
->dev
.platform_data
;
582 if (pd
== NULL
|| pd
->netdev
== NULL
)
585 dev
= dev_to_net_device(pd
->netdev
);
591 if (dev
->dsa_ptr
!= NULL
) {
597 dst
= kzalloc(sizeof(*dst
), GFP_KERNEL
);
604 platform_set_drvdata(pdev
, dst
);
607 dst
->master_netdev
= dev
;
608 dst
->cpu_switch
= -1;
611 for (i
= 0; i
< pd
->nr_chips
; i
++) {
612 struct dsa_switch
*ds
;
614 ds
= dsa_switch_setup(dst
, i
, &pdev
->dev
, pd
->chip
[i
].host_dev
);
616 printk(KERN_ERR
"%s[%d]: couldn't create dsa switch "
617 "instance (error %ld)\n", dev
->name
, i
,
623 if (ds
->drv
->poll_link
!= NULL
)
624 dst
->link_poll_needed
= 1;
628 * If we use a tagging format that doesn't have an ethertype
629 * field, make sure that all packets from this point on get
630 * sent to the tag format's receive function.
633 dev
->dsa_ptr
= (void *)dst
;
635 if (dst
->link_poll_needed
) {
636 INIT_WORK(&dst
->link_poll_work
, dsa_link_poll_work
);
637 init_timer(&dst
->link_poll_timer
);
638 dst
->link_poll_timer
.data
= (unsigned long)dst
;
639 dst
->link_poll_timer
.function
= dsa_link_poll_timer
;
640 dst
->link_poll_timer
.expires
= round_jiffies(jiffies
+ HZ
);
641 add_timer(&dst
->link_poll_timer
);
652 static int dsa_remove(struct platform_device
*pdev
)
654 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
657 if (dst
->link_poll_needed
)
658 del_timer_sync(&dst
->link_poll_timer
);
660 flush_work(&dst
->link_poll_work
);
662 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
663 struct dsa_switch
*ds
= dst
->ds
[i
];
666 dsa_switch_destroy(ds
);
674 static void dsa_shutdown(struct platform_device
*pdev
)
678 static int dsa_switch_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
679 struct packet_type
*pt
, struct net_device
*orig_dev
)
681 struct dsa_switch_tree
*dst
= dev
->dsa_ptr
;
683 if (unlikely(dst
== NULL
)) {
688 return dst
->rcv(skb
, dev
, pt
, orig_dev
);
691 static struct packet_type dsa_pack_type __read_mostly
= {
692 .type
= cpu_to_be16(ETH_P_XDSA
),
693 .func
= dsa_switch_rcv
,
696 #ifdef CONFIG_PM_SLEEP
697 static int dsa_suspend(struct device
*d
)
699 struct platform_device
*pdev
= to_platform_device(d
);
700 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
703 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
704 struct dsa_switch
*ds
= dst
->ds
[i
];
707 ret
= dsa_switch_suspend(ds
);
713 static int dsa_resume(struct device
*d
)
715 struct platform_device
*pdev
= to_platform_device(d
);
716 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
719 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
720 struct dsa_switch
*ds
= dst
->ds
[i
];
723 ret
= dsa_switch_resume(ds
);
730 static SIMPLE_DEV_PM_OPS(dsa_pm_ops
, dsa_suspend
, dsa_resume
);
732 static const struct of_device_id dsa_of_match_table
[] = {
733 { .compatible
= "brcm,bcm7445-switch-v4.0" },
734 { .compatible
= "marvell,dsa", },
737 MODULE_DEVICE_TABLE(of
, dsa_of_match_table
);
739 static struct platform_driver dsa_driver
= {
741 .remove
= dsa_remove
,
742 .shutdown
= dsa_shutdown
,
745 .owner
= THIS_MODULE
,
746 .of_match_table
= dsa_of_match_table
,
751 static int __init
dsa_init_module(void)
755 rc
= platform_driver_register(&dsa_driver
);
759 dev_add_pack(&dsa_pack_type
);
763 module_init(dsa_init_module
);
765 static void __exit
dsa_cleanup_module(void)
767 dev_remove_pack(&dsa_pack_type
);
768 platform_driver_unregister(&dsa_driver
);
770 module_exit(dsa_cleanup_module
);
772 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
773 MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
774 MODULE_LICENSE("GPL");
775 MODULE_ALIAS("platform:dsa");