1 /* 2 * net/dsa/dsa.c - Hardware switch handling 3 * Copyright (c) 2008-2009 Marvell Semiconductor 4 * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org> 5 * 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. 10 */ 11 12 #include <linux/device.h> 13 #include <linux/list.h> 14 #include <linux/platform_device.h> 15 #include <linux/slab.h> 16 #include <linux/module.h> 17 #include <linux/of.h> 18 #include <linux/of_mdio.h> 19 #include <linux/of_platform.h> 20 #include <linux/of_net.h> 21 #include <linux/of_gpio.h> 22 #include <linux/netdevice.h> 23 #include <linux/sysfs.h> 24 #include <linux/phy_fixed.h> 25 #include <linux/gpio/consumer.h> 26 #include <linux/etherdevice.h> 27 #include <net/dsa.h> 28 #include "dsa_priv.h" 29 30 static struct sk_buff *dsa_slave_notag_xmit(struct sk_buff *skb, 31 struct net_device *dev) 32 { 33 /* Just return the original SKB */ 34 return skb; 35 } 36 37 static const struct dsa_device_ops none_ops = { 38 .xmit = dsa_slave_notag_xmit, 39 .rcv = NULL, 40 }; 41 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, 45 #endif 46 #ifdef CONFIG_NET_DSA_TAG_EDSA 47 [DSA_TAG_PROTO_EDSA] = &edsa_netdev_ops, 48 #endif 49 #ifdef CONFIG_NET_DSA_TAG_TRAILER 50 [DSA_TAG_PROTO_TRAILER] = &trailer_netdev_ops, 51 #endif 52 #ifdef CONFIG_NET_DSA_TAG_BRCM 53 [DSA_TAG_PROTO_BRCM] = &brcm_netdev_ops, 54 #endif 55 #ifdef CONFIG_NET_DSA_TAG_QCA 56 [DSA_TAG_PROTO_QCA] = &qca_netdev_ops, 57 #endif 58 #ifdef CONFIG_NET_DSA_TAG_MTK 59 [DSA_TAG_PROTO_MTK] = &mtk_netdev_ops, 60 #endif 61 [DSA_TAG_PROTO_NONE] = &none_ops, 62 }; 63 64 int dsa_cpu_dsa_setup(struct dsa_switch *ds, struct device *dev, 65 struct dsa_port *dport, int port) 66 { 67 struct device_node *port_dn = dport->dn; 68 struct phy_device *phydev; 69 int ret, mode; 70 71 if (of_phy_is_fixed_link(port_dn)) { 72 ret = of_phy_register_fixed_link(port_dn); 73 if (ret) { 74 dev_err(dev, "failed to register fixed PHY\n"); 75 return ret; 76 } 77 phydev = of_phy_find_device(port_dn); 78 79 mode = of_get_phy_mode(port_dn); 80 if (mode < 0) 81 mode = PHY_INTERFACE_MODE_NA; 82 phydev->interface = mode; 83 84 genphy_config_init(phydev); 85 genphy_read_status(phydev); 86 if (ds->ops->adjust_link) 87 ds->ops->adjust_link(ds, port, phydev); 88 89 put_device(&phydev->mdio.dev); 90 } 91 92 return 0; 93 } 94 95 const struct dsa_device_ops *dsa_resolve_tag_protocol(int tag_protocol) 96 { 97 const struct dsa_device_ops *ops; 98 99 if (tag_protocol >= DSA_TAG_LAST) 100 return ERR_PTR(-EINVAL); 101 ops = dsa_device_ops[tag_protocol]; 102 103 if (!ops) 104 return ERR_PTR(-ENOPROTOOPT); 105 106 return ops; 107 } 108 109 int dsa_cpu_port_ethtool_setup(struct dsa_switch *ds) 110 { 111 struct net_device *master; 112 struct ethtool_ops *cpu_ops; 113 114 master = ds->dst->master_netdev; 115 if (ds->master_netdev) 116 master = ds->master_netdev; 117 118 cpu_ops = devm_kzalloc(ds->dev, sizeof(*cpu_ops), GFP_KERNEL); 119 if (!cpu_ops) 120 return -ENOMEM; 121 122 memcpy(&ds->dst->master_ethtool_ops, master->ethtool_ops, 123 sizeof(struct ethtool_ops)); 124 ds->dst->master_orig_ethtool_ops = master->ethtool_ops; 125 memcpy(cpu_ops, &ds->dst->master_ethtool_ops, 126 sizeof(struct ethtool_ops)); 127 dsa_cpu_port_ethtool_init(cpu_ops); 128 master->ethtool_ops = cpu_ops; 129 130 return 0; 131 } 132 133 void dsa_cpu_port_ethtool_restore(struct dsa_switch *ds) 134 { 135 struct net_device *master; 136 137 master = ds->dst->master_netdev; 138 if (ds->master_netdev) 139 master = ds->master_netdev; 140 141 master->ethtool_ops = ds->dst->master_orig_ethtool_ops; 142 } 143 144 void dsa_cpu_dsa_destroy(struct dsa_port *port) 145 { 146 struct device_node *port_dn = port->dn; 147 148 if (of_phy_is_fixed_link(port_dn)) 149 of_phy_deregister_fixed_link(port_dn); 150 } 151 152 static int dev_is_class(struct device *dev, void *class) 153 { 154 if (dev->class != NULL && !strcmp(dev->class->name, class)) 155 return 1; 156 157 return 0; 158 } 159 160 static struct device *dev_find_class(struct device *parent, char *class) 161 { 162 if (dev_is_class(parent, class)) { 163 get_device(parent); 164 return parent; 165 } 166 167 return device_find_child(parent, class, dev_is_class); 168 } 169 170 struct net_device *dsa_dev_to_net_device(struct device *dev) 171 { 172 struct device *d; 173 174 d = dev_find_class(dev, "net"); 175 if (d != NULL) { 176 struct net_device *nd; 177 178 nd = to_net_dev(d); 179 dev_hold(nd); 180 put_device(d); 181 182 return nd; 183 } 184 185 return NULL; 186 } 187 EXPORT_SYMBOL_GPL(dsa_dev_to_net_device); 188 189 static int dsa_switch_rcv(struct sk_buff *skb, struct net_device *dev, 190 struct packet_type *pt, struct net_device *orig_dev) 191 { 192 struct dsa_switch_tree *dst = dev->dsa_ptr; 193 struct sk_buff *nskb = NULL; 194 195 if (unlikely(dst == NULL)) { 196 kfree_skb(skb); 197 return 0; 198 } 199 200 skb = skb_unshare(skb, GFP_ATOMIC); 201 if (!skb) 202 return 0; 203 204 nskb = dst->rcv(skb, dev, pt, orig_dev); 205 if (!nskb) { 206 kfree_skb(skb); 207 return 0; 208 } 209 210 skb = nskb; 211 skb_push(skb, ETH_HLEN); 212 skb->pkt_type = PACKET_HOST; 213 skb->protocol = eth_type_trans(skb, skb->dev); 214 215 skb->dev->stats.rx_packets++; 216 skb->dev->stats.rx_bytes += skb->len; 217 218 netif_receive_skb(skb); 219 220 return 0; 221 } 222 223 static struct packet_type dsa_pack_type __read_mostly = { 224 .type = cpu_to_be16(ETH_P_XDSA), 225 .func = dsa_switch_rcv, 226 }; 227 228 static int __init dsa_init_module(void) 229 { 230 int rc; 231 232 rc = dsa_slave_register_notifier(); 233 if (rc) 234 return rc; 235 236 rc = dsa_legacy_register(); 237 if (rc) 238 return rc; 239 240 dev_add_pack(&dsa_pack_type); 241 242 return 0; 243 } 244 module_init(dsa_init_module); 245 246 static void __exit dsa_cleanup_module(void) 247 { 248 dsa_slave_unregister_notifier(); 249 dev_remove_pack(&dsa_pack_type); 250 dsa_legacy_unregister(); 251 } 252 module_exit(dsa_cleanup_module); 253 254 MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>"); 255 MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips"); 256 MODULE_LICENSE("GPL"); 257 MODULE_ALIAS("platform:dsa"); 258