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 #ifdef CONFIG_PM_SLEEP
242 static int dsa_switch_suspend(struct dsa_switch
*ds
)
246 /* Suspend slave network devices */
247 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
248 if (!(ds
->phys_port_mask
& (1 << i
)))
251 ret
= dsa_slave_suspend(ds
->ports
[i
]);
256 if (ds
->drv
->suspend
)
257 ret
= ds
->drv
->suspend(ds
);
262 static int dsa_switch_resume(struct dsa_switch
*ds
)
267 ret
= ds
->drv
->resume(ds
);
272 /* Resume slave network devices */
273 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
274 if (!(ds
->phys_port_mask
& (1 << i
)))
277 ret
= dsa_slave_resume(ds
->ports
[i
]);
287 /* link polling *************************************************************/
288 static void dsa_link_poll_work(struct work_struct
*ugly
)
290 struct dsa_switch_tree
*dst
;
293 dst
= container_of(ugly
, struct dsa_switch_tree
, link_poll_work
);
295 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
296 struct dsa_switch
*ds
= dst
->ds
[i
];
298 if (ds
!= NULL
&& ds
->drv
->poll_link
!= NULL
)
299 ds
->drv
->poll_link(ds
);
302 mod_timer(&dst
->link_poll_timer
, round_jiffies(jiffies
+ HZ
));
305 static void dsa_link_poll_timer(unsigned long _dst
)
307 struct dsa_switch_tree
*dst
= (void *)_dst
;
309 schedule_work(&dst
->link_poll_work
);
313 /* platform driver init and cleanup *****************************************/
314 static int dev_is_class(struct device
*dev
, void *class)
316 if (dev
->class != NULL
&& !strcmp(dev
->class->name
, class))
322 static struct device
*dev_find_class(struct device
*parent
, char *class)
324 if (dev_is_class(parent
, class)) {
329 return device_find_child(parent
, class, dev_is_class
);
332 struct mii_bus
*dsa_host_dev_to_mii_bus(struct device
*dev
)
336 d
= dev_find_class(dev
, "mdio_bus");
348 EXPORT_SYMBOL_GPL(dsa_host_dev_to_mii_bus
);
350 static struct net_device
*dev_to_net_device(struct device
*dev
)
354 d
= dev_find_class(dev
, "net");
356 struct net_device
*nd
;
369 static int dsa_of_setup_routing_table(struct dsa_platform_data
*pd
,
370 struct dsa_chip_data
*cd
,
372 struct device_node
*link
)
378 struct device_node
*parent_sw
;
381 parent_sw
= of_get_parent(link
);
385 reg
= of_get_property(parent_sw
, "reg", &len
);
386 if (!reg
|| (len
!= sizeof(*reg
) * 2))
389 link_sw_addr
= be32_to_cpup(reg
+ 1);
391 if (link_sw_addr
>= pd
->nr_chips
)
394 /* First time routing table allocation */
396 cd
->rtable
= kmalloc(pd
->nr_chips
* sizeof(s8
), GFP_KERNEL
);
400 /* default to no valid uplink/downlink */
401 memset(cd
->rtable
, -1, pd
->nr_chips
* sizeof(s8
));
404 reg
= of_get_property(link
, "reg", NULL
);
410 link_port_addr
= be32_to_cpup(reg
);
412 cd
->rtable
[link_sw_addr
] = link_port_addr
;
420 static void dsa_of_free_platform_data(struct dsa_platform_data
*pd
)
425 for (i
= 0; i
< pd
->nr_chips
; i
++) {
427 while (port_index
< DSA_MAX_PORTS
) {
428 kfree(pd
->chip
[i
].port_names
[port_index
]);
431 kfree(pd
->chip
[i
].rtable
);
436 static int dsa_of_probe(struct platform_device
*pdev
)
438 struct device_node
*np
= pdev
->dev
.of_node
;
439 struct device_node
*child
, *mdio
, *ethernet
, *port
, *link
;
440 struct mii_bus
*mdio_bus
;
441 struct platform_device
*ethernet_dev
;
442 struct dsa_platform_data
*pd
;
443 struct dsa_chip_data
*cd
;
444 const char *port_name
;
445 int chip_index
, port_index
;
446 const unsigned int *sw_addr
, *port_reg
;
449 mdio
= of_parse_phandle(np
, "dsa,mii-bus", 0);
453 mdio_bus
= of_mdio_find_bus(mdio
);
457 ethernet
= of_parse_phandle(np
, "dsa,ethernet", 0);
461 ethernet_dev
= of_find_device_by_node(ethernet
);
465 pd
= kzalloc(sizeof(*pd
), GFP_KERNEL
);
469 pdev
->dev
.platform_data
= pd
;
470 pd
->netdev
= ðernet_dev
->dev
;
471 pd
->nr_chips
= of_get_child_count(np
);
472 if (pd
->nr_chips
> DSA_MAX_SWITCHES
)
473 pd
->nr_chips
= DSA_MAX_SWITCHES
;
475 pd
->chip
= kzalloc(pd
->nr_chips
* sizeof(struct dsa_chip_data
),
483 for_each_available_child_of_node(np
, child
) {
485 cd
= &pd
->chip
[chip_index
];
488 cd
->host_dev
= &mdio_bus
->dev
;
490 sw_addr
= of_get_property(child
, "reg", NULL
);
494 cd
->sw_addr
= be32_to_cpup(sw_addr
);
495 if (cd
->sw_addr
> PHY_MAX_ADDR
)
498 for_each_available_child_of_node(child
, port
) {
499 port_reg
= of_get_property(port
, "reg", NULL
);
503 port_index
= be32_to_cpup(port_reg
);
505 port_name
= of_get_property(port
, "label", NULL
);
509 cd
->port_dn
[port_index
] = port
;
511 cd
->port_names
[port_index
] = kstrdup(port_name
,
513 if (!cd
->port_names
[port_index
]) {
518 link
= of_parse_phandle(port
, "link", 0);
520 if (!strcmp(port_name
, "dsa") && link
&&
522 ret
= dsa_of_setup_routing_table(pd
, cd
,
528 if (port_index
== DSA_MAX_PORTS
)
536 dsa_of_free_platform_data(pd
);
539 pdev
->dev
.platform_data
= NULL
;
543 static void dsa_of_remove(struct platform_device
*pdev
)
545 struct dsa_platform_data
*pd
= pdev
->dev
.platform_data
;
547 if (!pdev
->dev
.of_node
)
550 dsa_of_free_platform_data(pd
);
554 static inline int dsa_of_probe(struct platform_device
*pdev
)
559 static inline void dsa_of_remove(struct platform_device
*pdev
)
564 static int dsa_probe(struct platform_device
*pdev
)
566 static int dsa_version_printed
;
567 struct dsa_platform_data
*pd
= pdev
->dev
.platform_data
;
568 struct net_device
*dev
;
569 struct dsa_switch_tree
*dst
;
572 if (!dsa_version_printed
++)
573 printk(KERN_NOTICE
"Distributed Switch Architecture "
574 "driver version %s\n", dsa_driver_version
);
576 if (pdev
->dev
.of_node
) {
577 ret
= dsa_of_probe(pdev
);
581 pd
= pdev
->dev
.platform_data
;
584 if (pd
== NULL
|| pd
->netdev
== NULL
)
587 dev
= dev_to_net_device(pd
->netdev
);
593 if (dev
->dsa_ptr
!= NULL
) {
599 dst
= kzalloc(sizeof(*dst
), GFP_KERNEL
);
606 platform_set_drvdata(pdev
, dst
);
609 dst
->master_netdev
= dev
;
610 dst
->cpu_switch
= -1;
613 for (i
= 0; i
< pd
->nr_chips
; i
++) {
614 struct dsa_switch
*ds
;
616 ds
= dsa_switch_setup(dst
, i
, &pdev
->dev
, pd
->chip
[i
].host_dev
);
618 printk(KERN_ERR
"%s[%d]: couldn't create dsa switch "
619 "instance (error %ld)\n", dev
->name
, i
,
625 if (ds
->drv
->poll_link
!= NULL
)
626 dst
->link_poll_needed
= 1;
630 * If we use a tagging format that doesn't have an ethertype
631 * field, make sure that all packets from this point on get
632 * sent to the tag format's receive function.
635 dev
->dsa_ptr
= (void *)dst
;
637 if (dst
->link_poll_needed
) {
638 INIT_WORK(&dst
->link_poll_work
, dsa_link_poll_work
);
639 init_timer(&dst
->link_poll_timer
);
640 dst
->link_poll_timer
.data
= (unsigned long)dst
;
641 dst
->link_poll_timer
.function
= dsa_link_poll_timer
;
642 dst
->link_poll_timer
.expires
= round_jiffies(jiffies
+ HZ
);
643 add_timer(&dst
->link_poll_timer
);
654 static int dsa_remove(struct platform_device
*pdev
)
656 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
659 if (dst
->link_poll_needed
)
660 del_timer_sync(&dst
->link_poll_timer
);
662 flush_work(&dst
->link_poll_work
);
664 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
665 struct dsa_switch
*ds
= dst
->ds
[i
];
668 dsa_switch_destroy(ds
);
676 static void dsa_shutdown(struct platform_device
*pdev
)
680 static int dsa_switch_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
681 struct packet_type
*pt
, struct net_device
*orig_dev
)
683 struct dsa_switch_tree
*dst
= dev
->dsa_ptr
;
685 if (unlikely(dst
== NULL
)) {
690 return dst
->rcv(skb
, dev
, pt
, orig_dev
);
693 static struct packet_type dsa_pack_type __read_mostly
= {
694 .type
= cpu_to_be16(ETH_P_XDSA
),
695 .func
= dsa_switch_rcv
,
698 #ifdef CONFIG_PM_SLEEP
699 static int dsa_suspend(struct device
*d
)
701 struct platform_device
*pdev
= to_platform_device(d
);
702 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
705 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
706 struct dsa_switch
*ds
= dst
->ds
[i
];
709 ret
= dsa_switch_suspend(ds
);
715 static int dsa_resume(struct device
*d
)
717 struct platform_device
*pdev
= to_platform_device(d
);
718 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
721 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
722 struct dsa_switch
*ds
= dst
->ds
[i
];
725 ret
= dsa_switch_resume(ds
);
732 static SIMPLE_DEV_PM_OPS(dsa_pm_ops
, dsa_suspend
, dsa_resume
);
734 static const struct of_device_id dsa_of_match_table
[] = {
735 { .compatible
= "brcm,bcm7445-switch-v4.0" },
736 { .compatible
= "marvell,dsa", },
739 MODULE_DEVICE_TABLE(of
, dsa_of_match_table
);
741 static struct platform_driver dsa_driver
= {
743 .remove
= dsa_remove
,
744 .shutdown
= dsa_shutdown
,
747 .owner
= THIS_MODULE
,
748 .of_match_table
= dsa_of_match_table
,
753 static int __init
dsa_init_module(void)
757 rc
= platform_driver_register(&dsa_driver
);
761 dev_add_pack(&dsa_pack_type
);
765 module_init(dsa_init_module
);
767 static void __exit
dsa_cleanup_module(void)
769 dev_remove_pack(&dsa_pack_type
);
770 platform_driver_unregister(&dsa_driver
);
772 module_exit(dsa_cleanup_module
);
774 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
775 MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
776 MODULE_LICENSE("GPL");
777 MODULE_ALIAS("platform:dsa");