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/ctype.h>
13 #include <linux/device.h>
14 #include <linux/hwmon.h>
15 #include <linux/list.h>
16 #include <linux/platform_device.h>
17 #include <linux/slab.h>
18 #include <linux/module.h>
21 #include <linux/of_mdio.h>
22 #include <linux/of_platform.h>
23 #include <linux/of_net.h>
24 #include <linux/of_gpio.h>
25 #include <linux/sysfs.h>
26 #include <linux/phy_fixed.h>
27 #include <linux/gpio/consumer.h>
30 char dsa_driver_version
[] = "0.1";
32 static struct sk_buff
*dsa_slave_notag_xmit(struct sk_buff
*skb
,
33 struct net_device
*dev
)
35 /* Just return the original SKB */
39 static const struct dsa_device_ops none_ops
= {
40 .xmit
= dsa_slave_notag_xmit
,
44 const struct dsa_device_ops
*dsa_device_ops
[DSA_TAG_LAST
] = {
45 #ifdef CONFIG_NET_DSA_TAG_DSA
46 [DSA_TAG_PROTO_DSA
] = &dsa_netdev_ops
,
48 #ifdef CONFIG_NET_DSA_TAG_EDSA
49 [DSA_TAG_PROTO_EDSA
] = &edsa_netdev_ops
,
51 #ifdef CONFIG_NET_DSA_TAG_TRAILER
52 [DSA_TAG_PROTO_TRAILER
] = &trailer_netdev_ops
,
54 #ifdef CONFIG_NET_DSA_TAG_BRCM
55 [DSA_TAG_PROTO_BRCM
] = &brcm_netdev_ops
,
57 #ifdef CONFIG_NET_DSA_TAG_QCA
58 [DSA_TAG_PROTO_QCA
] = &qca_netdev_ops
,
60 [DSA_TAG_PROTO_NONE
] = &none_ops
,
63 /* switch driver registration ***********************************************/
64 static DEFINE_MUTEX(dsa_switch_drivers_mutex
);
65 static LIST_HEAD(dsa_switch_drivers
);
67 void register_switch_driver(struct dsa_switch_ops
*ops
)
69 mutex_lock(&dsa_switch_drivers_mutex
);
70 list_add_tail(&ops
->list
, &dsa_switch_drivers
);
71 mutex_unlock(&dsa_switch_drivers_mutex
);
73 EXPORT_SYMBOL_GPL(register_switch_driver
);
75 void unregister_switch_driver(struct dsa_switch_ops
*ops
)
77 mutex_lock(&dsa_switch_drivers_mutex
);
78 list_del_init(&ops
->list
);
79 mutex_unlock(&dsa_switch_drivers_mutex
);
81 EXPORT_SYMBOL_GPL(unregister_switch_driver
);
83 static struct dsa_switch_ops
*
84 dsa_switch_probe(struct device
*parent
, struct device
*host_dev
, int sw_addr
,
85 const char **_name
, void **priv
)
87 struct dsa_switch_ops
*ret
;
88 struct list_head
*list
;
94 mutex_lock(&dsa_switch_drivers_mutex
);
95 list_for_each(list
, &dsa_switch_drivers
) {
96 struct dsa_switch_ops
*ops
;
98 ops
= list_entry(list
, struct dsa_switch_ops
, list
);
100 name
= ops
->probe(parent
, host_dev
, sw_addr
, priv
);
106 mutex_unlock(&dsa_switch_drivers_mutex
);
113 /* hwmon support ************************************************************/
115 #ifdef CONFIG_NET_DSA_HWMON
117 static ssize_t
temp1_input_show(struct device
*dev
,
118 struct device_attribute
*attr
, char *buf
)
120 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
123 ret
= ds
->ops
->get_temp(ds
, &temp
);
127 return sprintf(buf
, "%d\n", temp
* 1000);
129 static DEVICE_ATTR_RO(temp1_input
);
131 static ssize_t
temp1_max_show(struct device
*dev
,
132 struct device_attribute
*attr
, char *buf
)
134 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
137 ret
= ds
->ops
->get_temp_limit(ds
, &temp
);
141 return sprintf(buf
, "%d\n", temp
* 1000);
144 static ssize_t
temp1_max_store(struct device
*dev
,
145 struct device_attribute
*attr
, const char *buf
,
148 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
151 ret
= kstrtoint(buf
, 0, &temp
);
155 ret
= ds
->ops
->set_temp_limit(ds
, DIV_ROUND_CLOSEST(temp
, 1000));
161 static DEVICE_ATTR_RW(temp1_max
);
163 static ssize_t
temp1_max_alarm_show(struct device
*dev
,
164 struct device_attribute
*attr
, char *buf
)
166 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
170 ret
= ds
->ops
->get_temp_alarm(ds
, &alarm
);
174 return sprintf(buf
, "%d\n", alarm
);
176 static DEVICE_ATTR_RO(temp1_max_alarm
);
178 static struct attribute
*dsa_hwmon_attrs
[] = {
179 &dev_attr_temp1_input
.attr
, /* 0 */
180 &dev_attr_temp1_max
.attr
, /* 1 */
181 &dev_attr_temp1_max_alarm
.attr
, /* 2 */
185 static umode_t
dsa_hwmon_attrs_visible(struct kobject
*kobj
,
186 struct attribute
*attr
, int index
)
188 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
189 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
190 struct dsa_switch_ops
*ops
= ds
->ops
;
191 umode_t mode
= attr
->mode
;
194 if (!ops
->get_temp_limit
)
196 else if (!ops
->set_temp_limit
)
198 } else if (index
== 2 && !ops
->get_temp_alarm
) {
204 static const struct attribute_group dsa_hwmon_group
= {
205 .attrs
= dsa_hwmon_attrs
,
206 .is_visible
= dsa_hwmon_attrs_visible
,
208 __ATTRIBUTE_GROUPS(dsa_hwmon
);
210 #endif /* CONFIG_NET_DSA_HWMON */
212 /* basic switch operations **************************************************/
213 int dsa_cpu_dsa_setup(struct dsa_switch
*ds
, struct device
*dev
,
214 struct device_node
*port_dn
, int port
)
216 struct phy_device
*phydev
;
219 if (of_phy_is_fixed_link(port_dn
)) {
220 ret
= of_phy_register_fixed_link(port_dn
);
222 dev_err(dev
, "failed to register fixed PHY\n");
225 phydev
= of_phy_find_device(port_dn
);
227 mode
= of_get_phy_mode(port_dn
);
229 mode
= PHY_INTERFACE_MODE_NA
;
230 phydev
->interface
= mode
;
232 genphy_config_init(phydev
);
233 genphy_read_status(phydev
);
234 if (ds
->ops
->adjust_link
)
235 ds
->ops
->adjust_link(ds
, port
, phydev
);
241 static int dsa_cpu_dsa_setups(struct dsa_switch
*ds
, struct device
*dev
)
243 struct device_node
*port_dn
;
246 for (port
= 0; port
< DSA_MAX_PORTS
; port
++) {
247 if (!(dsa_is_cpu_port(ds
, port
) || dsa_is_dsa_port(ds
, port
)))
250 port_dn
= ds
->ports
[port
].dn
;
251 ret
= dsa_cpu_dsa_setup(ds
, dev
, port_dn
, port
);
258 const struct dsa_device_ops
*dsa_resolve_tag_protocol(int tag_protocol
)
260 const struct dsa_device_ops
*ops
;
262 if (tag_protocol
>= DSA_TAG_LAST
)
263 return ERR_PTR(-EINVAL
);
264 ops
= dsa_device_ops
[tag_protocol
];
267 return ERR_PTR(-ENOPROTOOPT
);
272 int dsa_cpu_port_ethtool_setup(struct dsa_switch
*ds
)
274 struct net_device
*master
;
275 struct ethtool_ops
*cpu_ops
;
277 master
= ds
->dst
->master_netdev
;
278 if (ds
->master_netdev
)
279 master
= ds
->master_netdev
;
281 cpu_ops
= devm_kzalloc(ds
->dev
, sizeof(*cpu_ops
), GFP_KERNEL
);
285 memcpy(&ds
->dst
->master_ethtool_ops
, master
->ethtool_ops
,
286 sizeof(struct ethtool_ops
));
287 ds
->dst
->master_orig_ethtool_ops
= master
->ethtool_ops
;
288 memcpy(cpu_ops
, &ds
->dst
->master_ethtool_ops
,
289 sizeof(struct ethtool_ops
));
290 dsa_cpu_port_ethtool_init(cpu_ops
);
291 master
->ethtool_ops
= cpu_ops
;
296 void dsa_cpu_port_ethtool_restore(struct dsa_switch
*ds
)
298 struct net_device
*master
;
300 master
= ds
->dst
->master_netdev
;
301 if (ds
->master_netdev
)
302 master
= ds
->master_netdev
;
304 master
->ethtool_ops
= ds
->dst
->master_orig_ethtool_ops
;
307 static int dsa_switch_setup_one(struct dsa_switch
*ds
, struct device
*parent
)
309 struct dsa_switch_ops
*ops
= ds
->ops
;
310 struct dsa_switch_tree
*dst
= ds
->dst
;
311 struct dsa_chip_data
*cd
= ds
->cd
;
312 bool valid_name_found
= false;
313 int index
= ds
->index
;
317 * Validate supplied switch configuration.
319 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
322 name
= cd
->port_names
[i
];
326 if (!strcmp(name
, "cpu")) {
327 if (dst
->cpu_switch
!= -1) {
328 netdev_err(dst
->master_netdev
,
329 "multiple cpu ports?!\n");
333 dst
->cpu_switch
= index
;
335 ds
->cpu_port_mask
|= 1 << i
;
336 } else if (!strcmp(name
, "dsa")) {
337 ds
->dsa_port_mask
|= 1 << i
;
339 ds
->enabled_port_mask
|= 1 << i
;
341 valid_name_found
= true;
344 if (!valid_name_found
&& i
== DSA_MAX_PORTS
) {
349 /* Make the built-in MII bus mask match the number of ports,
350 * switch drivers can override this later
352 ds
->phys_mii_mask
= ds
->enabled_port_mask
;
355 * If the CPU connects to this switch, set the switch tree
356 * tagging protocol to the preferred tagging format of this
359 if (dst
->cpu_switch
== index
) {
360 enum dsa_tag_protocol tag_protocol
;
362 tag_protocol
= ops
->get_tag_protocol(ds
);
363 dst
->tag_ops
= dsa_resolve_tag_protocol(tag_protocol
);
364 if (IS_ERR(dst
->tag_ops
)) {
365 ret
= PTR_ERR(dst
->tag_ops
);
369 dst
->rcv
= dst
->tag_ops
->rcv
;
372 memcpy(ds
->rtable
, cd
->rtable
, sizeof(ds
->rtable
));
375 * Do basic register setup.
377 ret
= ops
->setup(ds
);
382 ret
= ops
->set_addr(ds
, dst
->master_netdev
->dev_addr
);
387 if (!ds
->slave_mii_bus
&& ops
->phy_read
) {
388 ds
->slave_mii_bus
= devm_mdiobus_alloc(parent
);
389 if (!ds
->slave_mii_bus
) {
393 dsa_slave_mii_bus_init(ds
);
395 ret
= mdiobus_register(ds
->slave_mii_bus
);
401 * Create network devices for physical switch ports.
403 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
404 ds
->ports
[i
].dn
= cd
->port_dn
[i
];
406 if (!(ds
->enabled_port_mask
& (1 << i
)))
409 ret
= dsa_slave_create(ds
, parent
, i
, cd
->port_names
[i
]);
411 netdev_err(dst
->master_netdev
, "[%d]: can't create dsa slave device for port %d(%s): %d\n",
412 index
, i
, cd
->port_names
[i
], ret
);
417 /* Perform configuration of the CPU and DSA ports */
418 ret
= dsa_cpu_dsa_setups(ds
, parent
);
420 netdev_err(dst
->master_netdev
, "[%d] : can't configure CPU and DSA ports\n",
425 ret
= dsa_cpu_port_ethtool_setup(ds
);
429 #ifdef CONFIG_NET_DSA_HWMON
430 /* If the switch provides a temperature sensor,
431 * register with hardware monitoring subsystem.
432 * Treat registration error as non-fatal and ignore it.
435 const char *netname
= netdev_name(dst
->master_netdev
);
436 char hname
[IFNAMSIZ
+ 1];
439 /* Create valid hwmon 'name' attribute */
440 for (i
= j
= 0; i
< IFNAMSIZ
&& netname
[i
]; i
++) {
441 if (isalnum(netname
[i
]))
442 hname
[j
++] = netname
[i
];
445 scnprintf(ds
->hwmon_name
, sizeof(ds
->hwmon_name
), "%s_dsa%d",
447 ds
->hwmon_dev
= hwmon_device_register_with_groups(NULL
,
448 ds
->hwmon_name
, ds
, dsa_hwmon_groups
);
449 if (IS_ERR(ds
->hwmon_dev
))
450 ds
->hwmon_dev
= NULL
;
452 #endif /* CONFIG_NET_DSA_HWMON */
460 static struct dsa_switch
*
461 dsa_switch_setup(struct dsa_switch_tree
*dst
, int index
,
462 struct device
*parent
, struct device
*host_dev
)
464 struct dsa_chip_data
*cd
= dst
->pd
->chip
+ index
;
465 struct dsa_switch_ops
*ops
;
466 struct dsa_switch
*ds
;
472 * Probe for switch model.
474 ops
= dsa_switch_probe(parent
, host_dev
, cd
->sw_addr
, &name
, &priv
);
476 netdev_err(dst
->master_netdev
, "[%d]: could not detect attached switch\n",
478 return ERR_PTR(-EINVAL
);
480 netdev_info(dst
->master_netdev
, "[%d]: detected a %s switch\n",
485 * Allocate and initialise switch state.
487 ds
= devm_kzalloc(parent
, sizeof(*ds
), GFP_KERNEL
);
489 return ERR_PTR(-ENOMEM
);
498 ret
= dsa_switch_setup_one(ds
, parent
);
505 void dsa_cpu_dsa_destroy(struct device_node
*port_dn
)
507 struct phy_device
*phydev
;
509 if (of_phy_is_fixed_link(port_dn
)) {
510 phydev
= of_phy_find_device(port_dn
);
512 phy_device_free(phydev
);
513 fixed_phy_unregister(phydev
);
518 static void dsa_switch_destroy(struct dsa_switch
*ds
)
522 #ifdef CONFIG_NET_DSA_HWMON
524 hwmon_device_unregister(ds
->hwmon_dev
);
527 /* Destroy network devices for physical switch ports. */
528 for (port
= 0; port
< DSA_MAX_PORTS
; port
++) {
529 if (!(ds
->enabled_port_mask
& (1 << port
)))
532 if (!ds
->ports
[port
].netdev
)
535 dsa_slave_destroy(ds
->ports
[port
].netdev
);
538 /* Disable configuration of the CPU and DSA ports */
539 for (port
= 0; port
< DSA_MAX_PORTS
; port
++) {
540 if (!(dsa_is_cpu_port(ds
, port
) || dsa_is_dsa_port(ds
, port
)))
542 dsa_cpu_dsa_destroy(ds
->ports
[port
].dn
);
544 /* Clearing a bit which is not set does no harm */
545 ds
->cpu_port_mask
|= ~(1 << port
);
546 ds
->dsa_port_mask
|= ~(1 << port
);
549 if (ds
->slave_mii_bus
&& ds
->ops
->phy_read
)
550 mdiobus_unregister(ds
->slave_mii_bus
);
553 #ifdef CONFIG_PM_SLEEP
554 int dsa_switch_suspend(struct dsa_switch
*ds
)
558 /* Suspend slave network devices */
559 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
560 if (!dsa_is_port_initialized(ds
, i
))
563 ret
= dsa_slave_suspend(ds
->ports
[i
].netdev
);
568 if (ds
->ops
->suspend
)
569 ret
= ds
->ops
->suspend(ds
);
573 EXPORT_SYMBOL_GPL(dsa_switch_suspend
);
575 int dsa_switch_resume(struct dsa_switch
*ds
)
580 ret
= ds
->ops
->resume(ds
);
585 /* Resume slave network devices */
586 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
587 if (!dsa_is_port_initialized(ds
, i
))
590 ret
= dsa_slave_resume(ds
->ports
[i
].netdev
);
597 EXPORT_SYMBOL_GPL(dsa_switch_resume
);
600 /* platform driver init and cleanup *****************************************/
601 static int dev_is_class(struct device
*dev
, void *class)
603 if (dev
->class != NULL
&& !strcmp(dev
->class->name
, class))
609 static struct device
*dev_find_class(struct device
*parent
, char *class)
611 if (dev_is_class(parent
, class)) {
616 return device_find_child(parent
, class, dev_is_class
);
619 struct mii_bus
*dsa_host_dev_to_mii_bus(struct device
*dev
)
623 d
= dev_find_class(dev
, "mdio_bus");
635 EXPORT_SYMBOL_GPL(dsa_host_dev_to_mii_bus
);
637 static struct net_device
*dev_to_net_device(struct device
*dev
)
641 d
= dev_find_class(dev
, "net");
643 struct net_device
*nd
;
656 static int dsa_of_setup_routing_table(struct dsa_platform_data
*pd
,
657 struct dsa_chip_data
*cd
,
658 int chip_index
, int port_index
,
659 struct device_node
*link
)
663 struct device_node
*parent_sw
;
666 parent_sw
= of_get_parent(link
);
670 reg
= of_get_property(parent_sw
, "reg", &len
);
671 if (!reg
|| (len
!= sizeof(*reg
) * 2))
675 * Get the destination switch number from the second field of its 'reg'
676 * property, i.e. for "reg = <0x19 1>" sw_addr is '1'.
678 link_sw_addr
= be32_to_cpup(reg
+ 1);
680 if (link_sw_addr
>= pd
->nr_chips
)
683 cd
->rtable
[link_sw_addr
] = port_index
;
688 static int dsa_of_probe_links(struct dsa_platform_data
*pd
,
689 struct dsa_chip_data
*cd
,
690 int chip_index
, int port_index
,
691 struct device_node
*port
,
692 const char *port_name
)
694 struct device_node
*link
;
698 for (link_index
= 0;; link_index
++) {
699 link
= of_parse_phandle(port
, "link", link_index
);
703 if (!strcmp(port_name
, "dsa") && pd
->nr_chips
> 1) {
704 ret
= dsa_of_setup_routing_table(pd
, cd
, chip_index
,
713 static void dsa_of_free_platform_data(struct dsa_platform_data
*pd
)
718 for (i
= 0; i
< pd
->nr_chips
; i
++) {
720 while (port_index
< DSA_MAX_PORTS
) {
721 kfree(pd
->chip
[i
].port_names
[port_index
]);
725 /* Drop our reference to the MDIO bus device */
726 if (pd
->chip
[i
].host_dev
)
727 put_device(pd
->chip
[i
].host_dev
);
732 static int dsa_of_probe(struct device
*dev
)
734 struct device_node
*np
= dev
->of_node
;
735 struct device_node
*child
, *mdio
, *ethernet
, *port
;
736 struct mii_bus
*mdio_bus
, *mdio_bus_switch
;
737 struct net_device
*ethernet_dev
;
738 struct dsa_platform_data
*pd
;
739 struct dsa_chip_data
*cd
;
740 const char *port_name
;
741 int chip_index
, port_index
;
742 const unsigned int *sw_addr
, *port_reg
;
746 mdio
= of_parse_phandle(np
, "dsa,mii-bus", 0);
750 mdio_bus
= of_mdio_find_bus(mdio
);
752 return -EPROBE_DEFER
;
754 ethernet
= of_parse_phandle(np
, "dsa,ethernet", 0);
760 ethernet_dev
= of_find_net_device_by_node(ethernet
);
766 pd
= kzalloc(sizeof(*pd
), GFP_KERNEL
);
769 goto out_put_ethernet
;
772 dev
->platform_data
= pd
;
773 pd
->of_netdev
= ethernet_dev
;
774 pd
->nr_chips
= of_get_available_child_count(np
);
775 if (pd
->nr_chips
> DSA_MAX_SWITCHES
)
776 pd
->nr_chips
= DSA_MAX_SWITCHES
;
778 pd
->chip
= kcalloc(pd
->nr_chips
, sizeof(struct dsa_chip_data
),
786 for_each_available_child_of_node(np
, child
) {
790 cd
= &pd
->chip
[chip_index
];
794 /* Initialize the routing table */
795 for (i
= 0; i
< DSA_MAX_SWITCHES
; ++i
)
796 cd
->rtable
[i
] = DSA_RTABLE_NONE
;
798 /* When assigning the host device, increment its refcount */
799 cd
->host_dev
= get_device(&mdio_bus
->dev
);
801 sw_addr
= of_get_property(child
, "reg", NULL
);
805 cd
->sw_addr
= be32_to_cpup(sw_addr
);
806 if (cd
->sw_addr
>= PHY_MAX_ADDR
)
809 if (!of_property_read_u32(child
, "eeprom-length", &eeprom_len
))
810 cd
->eeprom_len
= eeprom_len
;
812 mdio
= of_parse_phandle(child
, "mii-bus", 0);
814 mdio_bus_switch
= of_mdio_find_bus(mdio
);
815 if (!mdio_bus_switch
) {
820 /* Drop the mdio_bus device ref, replacing the host
821 * device with the mdio_bus_switch device, keeping
822 * the refcount from of_mdio_find_bus() above.
824 put_device(cd
->host_dev
);
825 cd
->host_dev
= &mdio_bus_switch
->dev
;
828 for_each_available_child_of_node(child
, port
) {
829 port_reg
= of_get_property(port
, "reg", NULL
);
833 port_index
= be32_to_cpup(port_reg
);
834 if (port_index
>= DSA_MAX_PORTS
)
837 port_name
= of_get_property(port
, "label", NULL
);
841 cd
->port_dn
[port_index
] = port
;
843 cd
->port_names
[port_index
] = kstrdup(port_name
,
845 if (!cd
->port_names
[port_index
]) {
850 ret
= dsa_of_probe_links(pd
, cd
, chip_index
,
851 port_index
, port
, port_name
);
858 /* The individual chips hold their own refcount on the mdio bus,
860 put_device(&mdio_bus
->dev
);
865 dsa_of_free_platform_data(pd
);
868 dev
->platform_data
= NULL
;
870 put_device(ðernet_dev
->dev
);
872 put_device(&mdio_bus
->dev
);
876 static void dsa_of_remove(struct device
*dev
)
878 struct dsa_platform_data
*pd
= dev
->platform_data
;
883 dsa_of_free_platform_data(pd
);
884 put_device(&pd
->of_netdev
->dev
);
888 static inline int dsa_of_probe(struct device
*dev
)
893 static inline void dsa_of_remove(struct device
*dev
)
898 static int dsa_setup_dst(struct dsa_switch_tree
*dst
, struct net_device
*dev
,
899 struct device
*parent
, struct dsa_platform_data
*pd
)
902 unsigned configured
= 0;
905 dst
->master_netdev
= dev
;
906 dst
->cpu_switch
= -1;
909 for (i
= 0; i
< pd
->nr_chips
; i
++) {
910 struct dsa_switch
*ds
;
912 ds
= dsa_switch_setup(dst
, i
, parent
, pd
->chip
[i
].host_dev
);
914 netdev_err(dev
, "[%d]: couldn't create dsa switch instance (error %ld)\n",
925 * If no switch was found, exit cleanly
928 return -EPROBE_DEFER
;
931 * If we use a tagging format that doesn't have an ethertype
932 * field, make sure that all packets from this point on get
933 * sent to the tag format's receive function.
936 dev
->dsa_ptr
= (void *)dst
;
941 static int dsa_probe(struct platform_device
*pdev
)
943 struct dsa_platform_data
*pd
= pdev
->dev
.platform_data
;
944 struct net_device
*dev
;
945 struct dsa_switch_tree
*dst
;
948 pr_notice_once("Distributed Switch Architecture driver version %s\n",
951 if (pdev
->dev
.of_node
) {
952 ret
= dsa_of_probe(&pdev
->dev
);
956 pd
= pdev
->dev
.platform_data
;
959 if (pd
== NULL
|| (pd
->netdev
== NULL
&& pd
->of_netdev
== NULL
))
966 dev
= dev_to_net_device(pd
->netdev
);
973 if (dev
->dsa_ptr
!= NULL
) {
979 dst
= devm_kzalloc(&pdev
->dev
, sizeof(*dst
), GFP_KERNEL
);
986 platform_set_drvdata(pdev
, dst
);
988 ret
= dsa_setup_dst(dst
, dev
, &pdev
->dev
, pd
);
997 dsa_of_remove(&pdev
->dev
);
1002 static void dsa_remove_dst(struct dsa_switch_tree
*dst
)
1006 dst
->master_netdev
->dsa_ptr
= NULL
;
1008 /* If we used a tagging format that doesn't have an ethertype
1009 * field, make sure that all packets from this point get sent
1010 * without the tag and go through the regular receive path.
1014 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
1015 struct dsa_switch
*ds
= dst
->ds
[i
];
1018 dsa_switch_destroy(ds
);
1021 dsa_cpu_port_ethtool_restore(dst
->ds
[0]);
1023 dev_put(dst
->master_netdev
);
1026 static int dsa_remove(struct platform_device
*pdev
)
1028 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
1030 dsa_remove_dst(dst
);
1031 dsa_of_remove(&pdev
->dev
);
1036 static void dsa_shutdown(struct platform_device
*pdev
)
1040 static int dsa_switch_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
1041 struct packet_type
*pt
, struct net_device
*orig_dev
)
1043 struct dsa_switch_tree
*dst
= dev
->dsa_ptr
;
1045 if (unlikely(dst
== NULL
)) {
1050 return dst
->rcv(skb
, dev
, pt
, orig_dev
);
1053 static struct packet_type dsa_pack_type __read_mostly
= {
1054 .type
= cpu_to_be16(ETH_P_XDSA
),
1055 .func
= dsa_switch_rcv
,
1058 static struct notifier_block dsa_netdevice_nb __read_mostly
= {
1059 .notifier_call
= dsa_slave_netdevice_event
,
1062 #ifdef CONFIG_PM_SLEEP
1063 static int dsa_suspend(struct device
*d
)
1065 struct platform_device
*pdev
= to_platform_device(d
);
1066 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
1069 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
1070 struct dsa_switch
*ds
= dst
->ds
[i
];
1073 ret
= dsa_switch_suspend(ds
);
1079 static int dsa_resume(struct device
*d
)
1081 struct platform_device
*pdev
= to_platform_device(d
);
1082 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
1085 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
1086 struct dsa_switch
*ds
= dst
->ds
[i
];
1089 ret
= dsa_switch_resume(ds
);
1096 static SIMPLE_DEV_PM_OPS(dsa_pm_ops
, dsa_suspend
, dsa_resume
);
1098 static const struct of_device_id dsa_of_match_table
[] = {
1099 { .compatible
= "marvell,dsa", },
1102 MODULE_DEVICE_TABLE(of
, dsa_of_match_table
);
1104 static struct platform_driver dsa_driver
= {
1106 .remove
= dsa_remove
,
1107 .shutdown
= dsa_shutdown
,
1110 .of_match_table
= dsa_of_match_table
,
1115 static int __init
dsa_init_module(void)
1119 register_netdevice_notifier(&dsa_netdevice_nb
);
1121 rc
= platform_driver_register(&dsa_driver
);
1125 dev_add_pack(&dsa_pack_type
);
1129 module_init(dsa_init_module
);
1131 static void __exit
dsa_cleanup_module(void)
1133 unregister_netdevice_notifier(&dsa_netdevice_nb
);
1134 dev_remove_pack(&dsa_pack_type
);
1135 platform_driver_unregister(&dsa_driver
);
1137 module_exit(dsa_cleanup_module
);
1139 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
1140 MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
1141 MODULE_LICENSE("GPL");
1142 MODULE_ALIAS("platform:dsa");