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 static struct sk_buff
*dsa_slave_notag_xmit(struct sk_buff
*skb
,
31 struct net_device
*dev
)
33 /* Just return the original SKB */
37 static const struct dsa_device_ops none_ops
= {
38 .xmit
= dsa_slave_notag_xmit
,
42 const struct dsa_device_ops
*dsa_device_ops
[DSA_TAG_LAST
] = {
43 #ifdef CONFIG_NET_DSA_TAG_DSA
44 [DSA_TAG_PROTO_DSA
] = &dsa_netdev_ops
,
46 #ifdef CONFIG_NET_DSA_TAG_EDSA
47 [DSA_TAG_PROTO_EDSA
] = &edsa_netdev_ops
,
49 #ifdef CONFIG_NET_DSA_TAG_TRAILER
50 [DSA_TAG_PROTO_TRAILER
] = &trailer_netdev_ops
,
52 #ifdef CONFIG_NET_DSA_TAG_BRCM
53 [DSA_TAG_PROTO_BRCM
] = &brcm_netdev_ops
,
55 #ifdef CONFIG_NET_DSA_TAG_QCA
56 [DSA_TAG_PROTO_QCA
] = &qca_netdev_ops
,
58 [DSA_TAG_PROTO_NONE
] = &none_ops
,
61 /* switch driver registration ***********************************************/
62 static DEFINE_MUTEX(dsa_switch_drivers_mutex
);
63 static LIST_HEAD(dsa_switch_drivers
);
65 void register_switch_driver(struct dsa_switch_ops
*ops
)
67 mutex_lock(&dsa_switch_drivers_mutex
);
68 list_add_tail(&ops
->list
, &dsa_switch_drivers
);
69 mutex_unlock(&dsa_switch_drivers_mutex
);
71 EXPORT_SYMBOL_GPL(register_switch_driver
);
73 void unregister_switch_driver(struct dsa_switch_ops
*ops
)
75 mutex_lock(&dsa_switch_drivers_mutex
);
76 list_del_init(&ops
->list
);
77 mutex_unlock(&dsa_switch_drivers_mutex
);
79 EXPORT_SYMBOL_GPL(unregister_switch_driver
);
81 static struct dsa_switch_ops
*
82 dsa_switch_probe(struct device
*parent
, struct device
*host_dev
, int sw_addr
,
83 const char **_name
, void **priv
)
85 struct dsa_switch_ops
*ret
;
86 struct list_head
*list
;
92 mutex_lock(&dsa_switch_drivers_mutex
);
93 list_for_each(list
, &dsa_switch_drivers
) {
94 struct dsa_switch_ops
*ops
;
96 ops
= list_entry(list
, struct dsa_switch_ops
, list
);
98 name
= ops
->probe(parent
, host_dev
, sw_addr
, priv
);
104 mutex_unlock(&dsa_switch_drivers_mutex
);
111 /* hwmon support ************************************************************/
113 #ifdef CONFIG_NET_DSA_HWMON
115 static ssize_t
temp1_input_show(struct device
*dev
,
116 struct device_attribute
*attr
, char *buf
)
118 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
121 ret
= ds
->ops
->get_temp(ds
, &temp
);
125 return sprintf(buf
, "%d\n", temp
* 1000);
127 static DEVICE_ATTR_RO(temp1_input
);
129 static ssize_t
temp1_max_show(struct device
*dev
,
130 struct device_attribute
*attr
, char *buf
)
132 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
135 ret
= ds
->ops
->get_temp_limit(ds
, &temp
);
139 return sprintf(buf
, "%d\n", temp
* 1000);
142 static ssize_t
temp1_max_store(struct device
*dev
,
143 struct device_attribute
*attr
, const char *buf
,
146 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
149 ret
= kstrtoint(buf
, 0, &temp
);
153 ret
= ds
->ops
->set_temp_limit(ds
, DIV_ROUND_CLOSEST(temp
, 1000));
159 static DEVICE_ATTR_RW(temp1_max
);
161 static ssize_t
temp1_max_alarm_show(struct device
*dev
,
162 struct device_attribute
*attr
, char *buf
)
164 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
168 ret
= ds
->ops
->get_temp_alarm(ds
, &alarm
);
172 return sprintf(buf
, "%d\n", alarm
);
174 static DEVICE_ATTR_RO(temp1_max_alarm
);
176 static struct attribute
*dsa_hwmon_attrs
[] = {
177 &dev_attr_temp1_input
.attr
, /* 0 */
178 &dev_attr_temp1_max
.attr
, /* 1 */
179 &dev_attr_temp1_max_alarm
.attr
, /* 2 */
183 static umode_t
dsa_hwmon_attrs_visible(struct kobject
*kobj
,
184 struct attribute
*attr
, int index
)
186 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
187 struct dsa_switch
*ds
= dev_get_drvdata(dev
);
188 struct dsa_switch_ops
*ops
= ds
->ops
;
189 umode_t mode
= attr
->mode
;
192 if (!ops
->get_temp_limit
)
194 else if (!ops
->set_temp_limit
)
196 } else if (index
== 2 && !ops
->get_temp_alarm
) {
202 static const struct attribute_group dsa_hwmon_group
= {
203 .attrs
= dsa_hwmon_attrs
,
204 .is_visible
= dsa_hwmon_attrs_visible
,
206 __ATTRIBUTE_GROUPS(dsa_hwmon
);
208 #endif /* CONFIG_NET_DSA_HWMON */
210 /* basic switch operations **************************************************/
211 int dsa_cpu_dsa_setup(struct dsa_switch
*ds
, struct device
*dev
,
212 struct device_node
*port_dn
, int port
)
214 struct phy_device
*phydev
;
217 if (of_phy_is_fixed_link(port_dn
)) {
218 ret
= of_phy_register_fixed_link(port_dn
);
220 dev_err(dev
, "failed to register fixed PHY\n");
223 phydev
= of_phy_find_device(port_dn
);
225 mode
= of_get_phy_mode(port_dn
);
227 mode
= PHY_INTERFACE_MODE_NA
;
228 phydev
->interface
= mode
;
230 genphy_config_init(phydev
);
231 genphy_read_status(phydev
);
232 if (ds
->ops
->adjust_link
)
233 ds
->ops
->adjust_link(ds
, port
, phydev
);
235 put_device(&phydev
->mdio
.dev
);
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");
332 dst
->cpu_switch
= index
;
334 ds
->cpu_port_mask
|= 1 << i
;
335 } else if (!strcmp(name
, "dsa")) {
336 ds
->dsa_port_mask
|= 1 << i
;
338 ds
->enabled_port_mask
|= 1 << i
;
340 valid_name_found
= true;
343 if (!valid_name_found
&& i
== DSA_MAX_PORTS
)
346 /* Make the built-in MII bus mask match the number of ports,
347 * switch drivers can override this later
349 ds
->phys_mii_mask
= ds
->enabled_port_mask
;
352 * If the CPU connects to this switch, set the switch tree
353 * tagging protocol to the preferred tagging format of this
356 if (dst
->cpu_switch
== index
) {
357 enum dsa_tag_protocol tag_protocol
;
359 tag_protocol
= ops
->get_tag_protocol(ds
);
360 dst
->tag_ops
= dsa_resolve_tag_protocol(tag_protocol
);
361 if (IS_ERR(dst
->tag_ops
))
362 return PTR_ERR(dst
->tag_ops
);
364 dst
->rcv
= dst
->tag_ops
->rcv
;
367 memcpy(ds
->rtable
, cd
->rtable
, sizeof(ds
->rtable
));
370 * Do basic register setup.
372 ret
= ops
->setup(ds
);
377 ret
= ops
->set_addr(ds
, dst
->master_netdev
->dev_addr
);
382 if (!ds
->slave_mii_bus
&& ops
->phy_read
) {
383 ds
->slave_mii_bus
= devm_mdiobus_alloc(parent
);
384 if (!ds
->slave_mii_bus
)
386 dsa_slave_mii_bus_init(ds
);
388 ret
= mdiobus_register(ds
->slave_mii_bus
);
394 * Create network devices for physical switch ports.
396 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
397 ds
->ports
[i
].dn
= cd
->port_dn
[i
];
399 if (!(ds
->enabled_port_mask
& (1 << i
)))
402 ret
= dsa_slave_create(ds
, parent
, i
, cd
->port_names
[i
]);
404 netdev_err(dst
->master_netdev
, "[%d]: can't create dsa slave device for port %d(%s): %d\n",
405 index
, i
, cd
->port_names
[i
], ret
);
408 /* Perform configuration of the CPU and DSA ports */
409 ret
= dsa_cpu_dsa_setups(ds
, parent
);
411 netdev_err(dst
->master_netdev
, "[%d] : can't configure CPU and DSA ports\n",
414 ret
= dsa_cpu_port_ethtool_setup(ds
);
418 #ifdef CONFIG_NET_DSA_HWMON
419 /* If the switch provides a temperature sensor,
420 * register with hardware monitoring subsystem.
421 * Treat registration error as non-fatal and ignore it.
424 const char *netname
= netdev_name(dst
->master_netdev
);
425 char hname
[IFNAMSIZ
+ 1];
428 /* Create valid hwmon 'name' attribute */
429 for (i
= j
= 0; i
< IFNAMSIZ
&& netname
[i
]; i
++) {
430 if (isalnum(netname
[i
]))
431 hname
[j
++] = netname
[i
];
434 scnprintf(ds
->hwmon_name
, sizeof(ds
->hwmon_name
), "%s_dsa%d",
436 ds
->hwmon_dev
= hwmon_device_register_with_groups(NULL
,
437 ds
->hwmon_name
, ds
, dsa_hwmon_groups
);
438 if (IS_ERR(ds
->hwmon_dev
))
439 ds
->hwmon_dev
= NULL
;
441 #endif /* CONFIG_NET_DSA_HWMON */
446 static struct dsa_switch
*
447 dsa_switch_setup(struct dsa_switch_tree
*dst
, int index
,
448 struct device
*parent
, struct device
*host_dev
)
450 struct dsa_chip_data
*cd
= dst
->pd
->chip
+ index
;
451 struct dsa_switch_ops
*ops
;
452 struct dsa_switch
*ds
;
458 * Probe for switch model.
460 ops
= dsa_switch_probe(parent
, host_dev
, cd
->sw_addr
, &name
, &priv
);
462 netdev_err(dst
->master_netdev
, "[%d]: could not detect attached switch\n",
464 return ERR_PTR(-EINVAL
);
466 netdev_info(dst
->master_netdev
, "[%d]: detected a %s switch\n",
471 * Allocate and initialise switch state.
473 ds
= devm_kzalloc(parent
, sizeof(*ds
), GFP_KERNEL
);
475 return ERR_PTR(-ENOMEM
);
484 ret
= dsa_switch_setup_one(ds
, parent
);
491 void dsa_cpu_dsa_destroy(struct device_node
*port_dn
)
493 if (of_phy_is_fixed_link(port_dn
))
494 of_phy_deregister_fixed_link(port_dn
);
497 static void dsa_switch_destroy(struct dsa_switch
*ds
)
501 #ifdef CONFIG_NET_DSA_HWMON
503 hwmon_device_unregister(ds
->hwmon_dev
);
506 /* Destroy network devices for physical switch ports. */
507 for (port
= 0; port
< DSA_MAX_PORTS
; port
++) {
508 if (!(ds
->enabled_port_mask
& (1 << port
)))
511 if (!ds
->ports
[port
].netdev
)
514 dsa_slave_destroy(ds
->ports
[port
].netdev
);
517 /* Disable configuration of the CPU and DSA ports */
518 for (port
= 0; port
< DSA_MAX_PORTS
; port
++) {
519 if (!(dsa_is_cpu_port(ds
, port
) || dsa_is_dsa_port(ds
, port
)))
521 dsa_cpu_dsa_destroy(ds
->ports
[port
].dn
);
523 /* Clearing a bit which is not set does no harm */
524 ds
->cpu_port_mask
|= ~(1 << port
);
525 ds
->dsa_port_mask
|= ~(1 << port
);
528 if (ds
->slave_mii_bus
&& ds
->ops
->phy_read
)
529 mdiobus_unregister(ds
->slave_mii_bus
);
532 #ifdef CONFIG_PM_SLEEP
533 int dsa_switch_suspend(struct dsa_switch
*ds
)
537 /* Suspend slave network devices */
538 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
539 if (!dsa_is_port_initialized(ds
, i
))
542 ret
= dsa_slave_suspend(ds
->ports
[i
].netdev
);
547 if (ds
->ops
->suspend
)
548 ret
= ds
->ops
->suspend(ds
);
552 EXPORT_SYMBOL_GPL(dsa_switch_suspend
);
554 int dsa_switch_resume(struct dsa_switch
*ds
)
559 ret
= ds
->ops
->resume(ds
);
564 /* Resume slave network devices */
565 for (i
= 0; i
< DSA_MAX_PORTS
; i
++) {
566 if (!dsa_is_port_initialized(ds
, i
))
569 ret
= dsa_slave_resume(ds
->ports
[i
].netdev
);
576 EXPORT_SYMBOL_GPL(dsa_switch_resume
);
579 /* platform driver init and cleanup *****************************************/
580 static int dev_is_class(struct device
*dev
, void *class)
582 if (dev
->class != NULL
&& !strcmp(dev
->class->name
, class))
588 static struct device
*dev_find_class(struct device
*parent
, char *class)
590 if (dev_is_class(parent
, class)) {
595 return device_find_child(parent
, class, dev_is_class
);
598 struct mii_bus
*dsa_host_dev_to_mii_bus(struct device
*dev
)
602 d
= dev_find_class(dev
, "mdio_bus");
614 EXPORT_SYMBOL_GPL(dsa_host_dev_to_mii_bus
);
616 static struct net_device
*dev_to_net_device(struct device
*dev
)
620 d
= dev_find_class(dev
, "net");
622 struct net_device
*nd
;
635 static int dsa_of_setup_routing_table(struct dsa_platform_data
*pd
,
636 struct dsa_chip_data
*cd
,
637 int chip_index
, int port_index
,
638 struct device_node
*link
)
642 struct device_node
*parent_sw
;
645 parent_sw
= of_get_parent(link
);
649 reg
= of_get_property(parent_sw
, "reg", &len
);
650 if (!reg
|| (len
!= sizeof(*reg
) * 2))
654 * Get the destination switch number from the second field of its 'reg'
655 * property, i.e. for "reg = <0x19 1>" sw_addr is '1'.
657 link_sw_addr
= be32_to_cpup(reg
+ 1);
659 if (link_sw_addr
>= pd
->nr_chips
)
662 cd
->rtable
[link_sw_addr
] = port_index
;
667 static int dsa_of_probe_links(struct dsa_platform_data
*pd
,
668 struct dsa_chip_data
*cd
,
669 int chip_index
, int port_index
,
670 struct device_node
*port
,
671 const char *port_name
)
673 struct device_node
*link
;
677 for (link_index
= 0;; link_index
++) {
678 link
= of_parse_phandle(port
, "link", link_index
);
682 if (!strcmp(port_name
, "dsa") && pd
->nr_chips
> 1) {
683 ret
= dsa_of_setup_routing_table(pd
, cd
, chip_index
,
692 static void dsa_of_free_platform_data(struct dsa_platform_data
*pd
)
697 for (i
= 0; i
< pd
->nr_chips
; i
++) {
699 while (port_index
< DSA_MAX_PORTS
) {
700 kfree(pd
->chip
[i
].port_names
[port_index
]);
704 /* Drop our reference to the MDIO bus device */
705 if (pd
->chip
[i
].host_dev
)
706 put_device(pd
->chip
[i
].host_dev
);
711 static int dsa_of_probe(struct device
*dev
)
713 struct device_node
*np
= dev
->of_node
;
714 struct device_node
*child
, *mdio
, *ethernet
, *port
;
715 struct mii_bus
*mdio_bus
, *mdio_bus_switch
;
716 struct net_device
*ethernet_dev
;
717 struct dsa_platform_data
*pd
;
718 struct dsa_chip_data
*cd
;
719 const char *port_name
;
720 int chip_index
, port_index
;
721 const unsigned int *sw_addr
, *port_reg
;
725 mdio
= of_parse_phandle(np
, "dsa,mii-bus", 0);
729 mdio_bus
= of_mdio_find_bus(mdio
);
731 return -EPROBE_DEFER
;
733 ethernet
= of_parse_phandle(np
, "dsa,ethernet", 0);
739 ethernet_dev
= of_find_net_device_by_node(ethernet
);
745 pd
= kzalloc(sizeof(*pd
), GFP_KERNEL
);
748 goto out_put_ethernet
;
751 dev
->platform_data
= pd
;
752 pd
->of_netdev
= ethernet_dev
;
753 pd
->nr_chips
= of_get_available_child_count(np
);
754 if (pd
->nr_chips
> DSA_MAX_SWITCHES
)
755 pd
->nr_chips
= DSA_MAX_SWITCHES
;
757 pd
->chip
= kcalloc(pd
->nr_chips
, sizeof(struct dsa_chip_data
),
765 for_each_available_child_of_node(np
, child
) {
769 cd
= &pd
->chip
[chip_index
];
773 /* Initialize the routing table */
774 for (i
= 0; i
< DSA_MAX_SWITCHES
; ++i
)
775 cd
->rtable
[i
] = DSA_RTABLE_NONE
;
777 /* When assigning the host device, increment its refcount */
778 cd
->host_dev
= get_device(&mdio_bus
->dev
);
780 sw_addr
= of_get_property(child
, "reg", NULL
);
784 cd
->sw_addr
= be32_to_cpup(sw_addr
);
785 if (cd
->sw_addr
>= PHY_MAX_ADDR
)
788 if (!of_property_read_u32(child
, "eeprom-length", &eeprom_len
))
789 cd
->eeprom_len
= eeprom_len
;
791 mdio
= of_parse_phandle(child
, "mii-bus", 0);
793 mdio_bus_switch
= of_mdio_find_bus(mdio
);
794 if (!mdio_bus_switch
) {
799 /* Drop the mdio_bus device ref, replacing the host
800 * device with the mdio_bus_switch device, keeping
801 * the refcount from of_mdio_find_bus() above.
803 put_device(cd
->host_dev
);
804 cd
->host_dev
= &mdio_bus_switch
->dev
;
807 for_each_available_child_of_node(child
, port
) {
808 port_reg
= of_get_property(port
, "reg", NULL
);
812 port_index
= be32_to_cpup(port_reg
);
813 if (port_index
>= DSA_MAX_PORTS
)
816 port_name
= of_get_property(port
, "label", NULL
);
820 cd
->port_dn
[port_index
] = port
;
822 cd
->port_names
[port_index
] = kstrdup(port_name
,
824 if (!cd
->port_names
[port_index
]) {
829 ret
= dsa_of_probe_links(pd
, cd
, chip_index
,
830 port_index
, port
, port_name
);
837 /* The individual chips hold their own refcount on the mdio bus,
839 put_device(&mdio_bus
->dev
);
844 dsa_of_free_platform_data(pd
);
847 dev
->platform_data
= NULL
;
849 put_device(ðernet_dev
->dev
);
851 put_device(&mdio_bus
->dev
);
855 static void dsa_of_remove(struct device
*dev
)
857 struct dsa_platform_data
*pd
= dev
->platform_data
;
862 dsa_of_free_platform_data(pd
);
863 put_device(&pd
->of_netdev
->dev
);
867 static inline int dsa_of_probe(struct device
*dev
)
872 static inline void dsa_of_remove(struct device
*dev
)
877 static int dsa_setup_dst(struct dsa_switch_tree
*dst
, struct net_device
*dev
,
878 struct device
*parent
, struct dsa_platform_data
*pd
)
881 unsigned configured
= 0;
884 dst
->master_netdev
= dev
;
885 dst
->cpu_switch
= -1;
888 for (i
= 0; i
< pd
->nr_chips
; i
++) {
889 struct dsa_switch
*ds
;
891 ds
= dsa_switch_setup(dst
, i
, parent
, pd
->chip
[i
].host_dev
);
893 netdev_err(dev
, "[%d]: couldn't create dsa switch instance (error %ld)\n",
904 * If no switch was found, exit cleanly
907 return -EPROBE_DEFER
;
910 * If we use a tagging format that doesn't have an ethertype
911 * field, make sure that all packets from this point on get
912 * sent to the tag format's receive function.
915 dev
->dsa_ptr
= (void *)dst
;
920 static int dsa_probe(struct platform_device
*pdev
)
922 struct dsa_platform_data
*pd
= pdev
->dev
.platform_data
;
923 struct net_device
*dev
;
924 struct dsa_switch_tree
*dst
;
927 if (pdev
->dev
.of_node
) {
928 ret
= dsa_of_probe(&pdev
->dev
);
932 pd
= pdev
->dev
.platform_data
;
935 if (pd
== NULL
|| (pd
->netdev
== NULL
&& pd
->of_netdev
== NULL
))
942 dev
= dev_to_net_device(pd
->netdev
);
949 if (dev
->dsa_ptr
!= NULL
) {
955 dst
= devm_kzalloc(&pdev
->dev
, sizeof(*dst
), GFP_KERNEL
);
962 platform_set_drvdata(pdev
, dst
);
964 ret
= dsa_setup_dst(dst
, dev
, &pdev
->dev
, pd
);
973 dsa_of_remove(&pdev
->dev
);
978 static void dsa_remove_dst(struct dsa_switch_tree
*dst
)
982 dst
->master_netdev
->dsa_ptr
= NULL
;
984 /* If we used a tagging format that doesn't have an ethertype
985 * field, make sure that all packets from this point get sent
986 * without the tag and go through the regular receive path.
990 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
991 struct dsa_switch
*ds
= dst
->ds
[i
];
994 dsa_switch_destroy(ds
);
997 dsa_cpu_port_ethtool_restore(dst
->ds
[0]);
999 dev_put(dst
->master_netdev
);
1002 static int dsa_remove(struct platform_device
*pdev
)
1004 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
1006 dsa_remove_dst(dst
);
1007 dsa_of_remove(&pdev
->dev
);
1012 static void dsa_shutdown(struct platform_device
*pdev
)
1016 static int dsa_switch_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
1017 struct packet_type
*pt
, struct net_device
*orig_dev
)
1019 struct dsa_switch_tree
*dst
= dev
->dsa_ptr
;
1021 if (unlikely(dst
== NULL
)) {
1026 return dst
->rcv(skb
, dev
, pt
, orig_dev
);
1029 static struct packet_type dsa_pack_type __read_mostly
= {
1030 .type
= cpu_to_be16(ETH_P_XDSA
),
1031 .func
= dsa_switch_rcv
,
1034 static struct notifier_block dsa_netdevice_nb __read_mostly
= {
1035 .notifier_call
= dsa_slave_netdevice_event
,
1038 #ifdef CONFIG_PM_SLEEP
1039 static int dsa_suspend(struct device
*d
)
1041 struct platform_device
*pdev
= to_platform_device(d
);
1042 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
1045 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
1046 struct dsa_switch
*ds
= dst
->ds
[i
];
1049 ret
= dsa_switch_suspend(ds
);
1055 static int dsa_resume(struct device
*d
)
1057 struct platform_device
*pdev
= to_platform_device(d
);
1058 struct dsa_switch_tree
*dst
= platform_get_drvdata(pdev
);
1061 for (i
= 0; i
< dst
->pd
->nr_chips
; i
++) {
1062 struct dsa_switch
*ds
= dst
->ds
[i
];
1065 ret
= dsa_switch_resume(ds
);
1072 static SIMPLE_DEV_PM_OPS(dsa_pm_ops
, dsa_suspend
, dsa_resume
);
1074 static const struct of_device_id dsa_of_match_table
[] = {
1075 { .compatible
= "marvell,dsa", },
1078 MODULE_DEVICE_TABLE(of
, dsa_of_match_table
);
1080 static struct platform_driver dsa_driver
= {
1082 .remove
= dsa_remove
,
1083 .shutdown
= dsa_shutdown
,
1086 .of_match_table
= dsa_of_match_table
,
1091 static int __init
dsa_init_module(void)
1095 register_netdevice_notifier(&dsa_netdevice_nb
);
1097 rc
= platform_driver_register(&dsa_driver
);
1101 dev_add_pack(&dsa_pack_type
);
1105 module_init(dsa_init_module
);
1107 static void __exit
dsa_cleanup_module(void)
1109 unregister_netdevice_notifier(&dsa_netdevice_nb
);
1110 dev_remove_pack(&dsa_pack_type
);
1111 platform_driver_unregister(&dsa_driver
);
1113 module_exit(dsa_cleanup_module
);
1115 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
1116 MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
1117 MODULE_LICENSE("GPL");
1118 MODULE_ALIAS("platform:dsa");