blob: 899772108ee3f92d3d32027f250692c546500417 [file] [log] [blame]
Lennert Buytenhek91da11f2008-10-07 13:44:02 +00001/*
2 * net/dsa/dsa.c - Hardware switch handling
Lennert Buytenheke84665c2009-03-20 09:52:09 +00003 * Copyright (c) 2008-2009 Marvell Semiconductor
Florian Fainelli5e95329b2013-03-22 10:50:50 +00004 * Copyright (c) 2013 Florian Fainelli <florian@openwrt.org>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +00005 *
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
Guenter Roeck51579c32014-10-29 10:44:58 -070012#include <linux/ctype.h>
13#include <linux/device.h>
14#include <linux/hwmon.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000015#include <linux/list.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000016#include <linux/platform_device.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090017#include <linux/slab.h>
Paul Gortmaker3a9a2312011-05-27 09:12:25 -040018#include <linux/module.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000019#include <net/dsa.h>
Florian Fainelli5e95329b2013-03-22 10:50:50 +000020#include <linux/of.h>
21#include <linux/of_mdio.h>
22#include <linux/of_platform.h>
Florian Fainelli769a0202015-03-09 14:31:21 -070023#include <linux/of_net.h>
Guenter Roeck51579c32014-10-29 10:44:58 -070024#include <linux/sysfs.h>
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000025#include "dsa_priv.h"
26
27char dsa_driver_version[] = "0.1";
28
29
30/* switch driver registration ***********************************************/
31static DEFINE_MUTEX(dsa_switch_drivers_mutex);
32static LIST_HEAD(dsa_switch_drivers);
33
34void register_switch_driver(struct dsa_switch_driver *drv)
35{
36 mutex_lock(&dsa_switch_drivers_mutex);
37 list_add_tail(&drv->list, &dsa_switch_drivers);
38 mutex_unlock(&dsa_switch_drivers_mutex);
39}
Ben Hutchingsad293b82011-11-25 14:34:07 +000040EXPORT_SYMBOL_GPL(register_switch_driver);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000041
42void unregister_switch_driver(struct dsa_switch_driver *drv)
43{
44 mutex_lock(&dsa_switch_drivers_mutex);
45 list_del_init(&drv->list);
46 mutex_unlock(&dsa_switch_drivers_mutex);
47}
Ben Hutchingsad293b82011-11-25 14:34:07 +000048EXPORT_SYMBOL_GPL(unregister_switch_driver);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000049
50static struct dsa_switch_driver *
Alexander Duyckb4d23942014-09-15 13:00:27 -040051dsa_switch_probe(struct device *host_dev, int sw_addr, char **_name)
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000052{
53 struct dsa_switch_driver *ret;
54 struct list_head *list;
55 char *name;
56
57 ret = NULL;
58 name = NULL;
59
60 mutex_lock(&dsa_switch_drivers_mutex);
61 list_for_each(list, &dsa_switch_drivers) {
62 struct dsa_switch_driver *drv;
63
64 drv = list_entry(list, struct dsa_switch_driver, list);
65
Alexander Duyckb4d23942014-09-15 13:00:27 -040066 name = drv->probe(host_dev, sw_addr);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +000067 if (name != NULL) {
68 ret = drv;
69 break;
70 }
71 }
72 mutex_unlock(&dsa_switch_drivers_mutex);
73
74 *_name = name;
75
76 return ret;
77}
78
Guenter Roeck51579c32014-10-29 10:44:58 -070079/* hwmon support ************************************************************/
80
81#ifdef CONFIG_NET_DSA_HWMON
82
83static ssize_t temp1_input_show(struct device *dev,
84 struct device_attribute *attr, char *buf)
85{
86 struct dsa_switch *ds = dev_get_drvdata(dev);
87 int temp, ret;
88
89 ret = ds->drv->get_temp(ds, &temp);
90 if (ret < 0)
91 return ret;
92
93 return sprintf(buf, "%d\n", temp * 1000);
94}
95static DEVICE_ATTR_RO(temp1_input);
96
97static ssize_t temp1_max_show(struct device *dev,
98 struct device_attribute *attr, char *buf)
99{
100 struct dsa_switch *ds = dev_get_drvdata(dev);
101 int temp, ret;
102
103 ret = ds->drv->get_temp_limit(ds, &temp);
104 if (ret < 0)
105 return ret;
106
107 return sprintf(buf, "%d\n", temp * 1000);
108}
109
110static ssize_t temp1_max_store(struct device *dev,
111 struct device_attribute *attr, const char *buf,
112 size_t count)
113{
114 struct dsa_switch *ds = dev_get_drvdata(dev);
115 int temp, ret;
116
117 ret = kstrtoint(buf, 0, &temp);
118 if (ret < 0)
119 return ret;
120
121 ret = ds->drv->set_temp_limit(ds, DIV_ROUND_CLOSEST(temp, 1000));
122 if (ret < 0)
123 return ret;
124
125 return count;
126}
127static DEVICE_ATTR(temp1_max, S_IRUGO, temp1_max_show, temp1_max_store);
128
129static ssize_t temp1_max_alarm_show(struct device *dev,
130 struct device_attribute *attr, char *buf)
131{
132 struct dsa_switch *ds = dev_get_drvdata(dev);
133 bool alarm;
134 int ret;
135
136 ret = ds->drv->get_temp_alarm(ds, &alarm);
137 if (ret < 0)
138 return ret;
139
140 return sprintf(buf, "%d\n", alarm);
141}
142static DEVICE_ATTR_RO(temp1_max_alarm);
143
144static struct attribute *dsa_hwmon_attrs[] = {
145 &dev_attr_temp1_input.attr, /* 0 */
146 &dev_attr_temp1_max.attr, /* 1 */
147 &dev_attr_temp1_max_alarm.attr, /* 2 */
148 NULL
149};
150
151static umode_t dsa_hwmon_attrs_visible(struct kobject *kobj,
152 struct attribute *attr, int index)
153{
154 struct device *dev = container_of(kobj, struct device, kobj);
155 struct dsa_switch *ds = dev_get_drvdata(dev);
156 struct dsa_switch_driver *drv = ds->drv;
157 umode_t mode = attr->mode;
158
159 if (index == 1) {
160 if (!drv->get_temp_limit)
161 mode = 0;
162 else if (drv->set_temp_limit)
163 mode |= S_IWUSR;
164 } else if (index == 2 && !drv->get_temp_alarm) {
165 mode = 0;
166 }
167 return mode;
168}
169
170static const struct attribute_group dsa_hwmon_group = {
171 .attrs = dsa_hwmon_attrs,
172 .is_visible = dsa_hwmon_attrs_visible,
173};
174__ATTRIBUTE_GROUPS(dsa_hwmon);
175
176#endif /* CONFIG_NET_DSA_HWMON */
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000177
178/* basic switch operations **************************************************/
Florian Fainellidf197192015-03-05 12:35:06 -0800179static int dsa_switch_setup_one(struct dsa_switch *ds, struct device *parent)
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000180{
Florian Fainellidf197192015-03-05 12:35:06 -0800181 struct dsa_switch_driver *drv = ds->drv;
182 struct dsa_switch_tree *dst = ds->dst;
183 struct dsa_chip_data *pd = ds->pd;
Florian Fainellif9bf5a22013-01-21 09:58:51 +0000184 bool valid_name_found = false;
Florian Fainellidf197192015-03-05 12:35:06 -0800185 int index = ds->index;
186 int i, ret;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000187
188 /*
189 * Validate supplied switch configuration.
190 */
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000191 for (i = 0; i < DSA_MAX_PORTS; i++) {
192 char *name;
193
194 name = pd->port_names[i];
195 if (name == NULL)
196 continue;
197
198 if (!strcmp(name, "cpu")) {
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000199 if (dst->cpu_switch != -1) {
Joe Perchesa2ae6002014-11-09 16:32:46 -0800200 netdev_err(dst->master_netdev,
201 "multiple cpu ports?!\n");
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000202 ret = -EINVAL;
203 goto out;
204 }
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000205 dst->cpu_switch = index;
206 dst->cpu_port = i;
207 } else if (!strcmp(name, "dsa")) {
208 ds->dsa_port_mask |= 1 << i;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000209 } else {
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000210 ds->phys_port_mask |= 1 << i;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000211 }
Florian Fainellif9bf5a22013-01-21 09:58:51 +0000212 valid_name_found = true;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000213 }
214
Florian Fainellif9bf5a22013-01-21 09:58:51 +0000215 if (!valid_name_found && i == DSA_MAX_PORTS) {
216 ret = -EINVAL;
217 goto out;
218 }
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000219
Florian Fainelli0d8bcdd2014-08-27 17:04:51 -0700220 /* Make the built-in MII bus mask match the number of ports,
221 * switch drivers can override this later
222 */
223 ds->phys_mii_mask = ds->phys_port_mask;
224
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000225 /*
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000226 * If the CPU connects to this switch, set the switch tree
227 * tagging protocol to the preferred tagging format of this
228 * switch.
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000229 */
Alexander Duyck50753142014-09-15 13:00:19 -0400230 if (dst->cpu_switch == index) {
Florian Fainelli59299032015-03-05 12:35:07 -0800231 switch (ds->tag_protocol) {
Alexander Duyck50753142014-09-15 13:00:19 -0400232#ifdef CONFIG_NET_DSA_TAG_DSA
233 case DSA_TAG_PROTO_DSA:
234 dst->rcv = dsa_netdev_ops.rcv;
235 break;
236#endif
237#ifdef CONFIG_NET_DSA_TAG_EDSA
238 case DSA_TAG_PROTO_EDSA:
239 dst->rcv = edsa_netdev_ops.rcv;
240 break;
241#endif
242#ifdef CONFIG_NET_DSA_TAG_TRAILER
243 case DSA_TAG_PROTO_TRAILER:
244 dst->rcv = trailer_netdev_ops.rcv;
245 break;
246#endif
247#ifdef CONFIG_NET_DSA_TAG_BRCM
248 case DSA_TAG_PROTO_BRCM:
249 dst->rcv = brcm_netdev_ops.rcv;
250 break;
251#endif
Andrew Lunnae439282014-10-24 23:44:04 +0200252 case DSA_TAG_PROTO_NONE:
Alexander Duyck50753142014-09-15 13:00:19 -0400253 break;
Andrew Lunnae439282014-10-24 23:44:04 +0200254 default:
255 ret = -ENOPROTOOPT;
256 goto out;
Alexander Duyck50753142014-09-15 13:00:19 -0400257 }
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000258
Florian Fainelli59299032015-03-05 12:35:07 -0800259 dst->tag_protocol = ds->tag_protocol;
Alexander Duyck50753142014-09-15 13:00:19 -0400260 }
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000261
262 /*
263 * Do basic register setup.
264 */
265 ret = drv->setup(ds);
266 if (ret < 0)
267 goto out;
268
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000269 ret = drv->set_addr(ds, dst->master_netdev->dev_addr);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000270 if (ret < 0)
271 goto out;
272
273 ds->slave_mii_bus = mdiobus_alloc();
274 if (ds->slave_mii_bus == NULL) {
275 ret = -ENOMEM;
276 goto out;
277 }
278 dsa_slave_mii_bus_init(ds);
279
280 ret = mdiobus_register(ds->slave_mii_bus);
281 if (ret < 0)
282 goto out_free;
283
284
285 /*
286 * Create network devices for physical switch ports.
287 */
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000288 for (i = 0; i < DSA_MAX_PORTS; i++) {
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000289 if (!(ds->phys_port_mask & (1 << i)))
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000290 continue;
291
Guenter Roeckd87d6f42015-02-24 13:15:32 -0800292 ret = dsa_slave_create(ds, parent, i, pd->port_names[i]);
293 if (ret < 0) {
Joe Perchesa2ae6002014-11-09 16:32:46 -0800294 netdev_err(dst->master_netdev, "[%d]: can't create dsa slave device for port %d(%s)\n",
295 index, i, pd->port_names[i]);
Guenter Roeckd87d6f42015-02-24 13:15:32 -0800296 ret = 0;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000297 }
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000298 }
299
Guenter Roeck51579c32014-10-29 10:44:58 -0700300#ifdef CONFIG_NET_DSA_HWMON
301 /* If the switch provides a temperature sensor,
302 * register with hardware monitoring subsystem.
303 * Treat registration error as non-fatal and ignore it.
304 */
305 if (drv->get_temp) {
306 const char *netname = netdev_name(dst->master_netdev);
307 char hname[IFNAMSIZ + 1];
308 int i, j;
309
310 /* Create valid hwmon 'name' attribute */
311 for (i = j = 0; i < IFNAMSIZ && netname[i]; i++) {
312 if (isalnum(netname[i]))
313 hname[j++] = netname[i];
314 }
315 hname[j] = '\0';
316 scnprintf(ds->hwmon_name, sizeof(ds->hwmon_name), "%s_dsa%d",
317 hname, index);
318 ds->hwmon_dev = hwmon_device_register_with_groups(NULL,
319 ds->hwmon_name, ds, dsa_hwmon_groups);
320 if (IS_ERR(ds->hwmon_dev))
321 ds->hwmon_dev = NULL;
322 }
323#endif /* CONFIG_NET_DSA_HWMON */
324
Florian Fainellidf197192015-03-05 12:35:06 -0800325 return ret;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000326
327out_free:
328 mdiobus_free(ds->slave_mii_bus);
329out:
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000330 kfree(ds);
Florian Fainellidf197192015-03-05 12:35:06 -0800331 return ret;
332}
333
334static struct dsa_switch *
335dsa_switch_setup(struct dsa_switch_tree *dst, int index,
336 struct device *parent, struct device *host_dev)
337{
338 struct dsa_chip_data *pd = dst->pd->chip + index;
339 struct dsa_switch_driver *drv;
340 struct dsa_switch *ds;
341 int ret;
342 char *name;
343
344 /*
345 * Probe for switch model.
346 */
347 drv = dsa_switch_probe(host_dev, pd->sw_addr, &name);
348 if (drv == NULL) {
349 netdev_err(dst->master_netdev, "[%d]: could not detect attached switch\n",
350 index);
351 return ERR_PTR(-EINVAL);
352 }
353 netdev_info(dst->master_netdev, "[%d]: detected a %s switch\n",
354 index, name);
355
356
357 /*
358 * Allocate and initialise switch state.
359 */
360 ds = kzalloc(sizeof(*ds) + drv->priv_size, GFP_KERNEL);
361 if (ds == NULL)
362 return NULL;
363
364 ds->dst = dst;
365 ds->index = index;
366 ds->pd = pd;
367 ds->drv = drv;
Florian Fainelli59299032015-03-05 12:35:07 -0800368 ds->tag_protocol = drv->tag_protocol;
Florian Fainellidf197192015-03-05 12:35:06 -0800369 ds->master_dev = host_dev;
370
371 ret = dsa_switch_setup_one(ds, parent);
372 if (ret)
373 return NULL;
374
375 return ds;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000376}
377
378static void dsa_switch_destroy(struct dsa_switch *ds)
379{
Guenter Roeck51579c32014-10-29 10:44:58 -0700380#ifdef CONFIG_NET_DSA_HWMON
381 if (ds->hwmon_dev)
382 hwmon_device_unregister(ds->hwmon_dev);
383#endif
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000384}
385
Thierry Redinge506d402014-10-01 13:59:00 +0200386#ifdef CONFIG_PM_SLEEP
Florian Fainelli24462542014-09-18 17:31:22 -0700387static int dsa_switch_suspend(struct dsa_switch *ds)
388{
389 int i, ret = 0;
390
391 /* Suspend slave network devices */
392 for (i = 0; i < DSA_MAX_PORTS; i++) {
Guenter Roeckd79d2102015-02-24 23:02:02 -0800393 if (!dsa_is_port_initialized(ds, i))
Florian Fainelli24462542014-09-18 17:31:22 -0700394 continue;
395
396 ret = dsa_slave_suspend(ds->ports[i]);
397 if (ret)
398 return ret;
399 }
400
401 if (ds->drv->suspend)
402 ret = ds->drv->suspend(ds);
403
404 return ret;
405}
406
407static int dsa_switch_resume(struct dsa_switch *ds)
408{
409 int i, ret = 0;
410
411 if (ds->drv->resume)
412 ret = ds->drv->resume(ds);
413
414 if (ret)
415 return ret;
416
417 /* Resume slave network devices */
418 for (i = 0; i < DSA_MAX_PORTS; i++) {
Guenter Roeckd79d2102015-02-24 23:02:02 -0800419 if (!dsa_is_port_initialized(ds, i))
Florian Fainelli24462542014-09-18 17:31:22 -0700420 continue;
421
422 ret = dsa_slave_resume(ds->ports[i]);
423 if (ret)
424 return ret;
425 }
426
427 return 0;
428}
Thierry Redinge506d402014-10-01 13:59:00 +0200429#endif
Florian Fainelli24462542014-09-18 17:31:22 -0700430
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000431
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000432/* link polling *************************************************************/
433static void dsa_link_poll_work(struct work_struct *ugly)
434{
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000435 struct dsa_switch_tree *dst;
436 int i;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000437
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000438 dst = container_of(ugly, struct dsa_switch_tree, link_poll_work);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000439
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000440 for (i = 0; i < dst->pd->nr_chips; i++) {
441 struct dsa_switch *ds = dst->ds[i];
442
443 if (ds != NULL && ds->drv->poll_link != NULL)
444 ds->drv->poll_link(ds);
445 }
446
447 mod_timer(&dst->link_poll_timer, round_jiffies(jiffies + HZ));
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000448}
449
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000450static void dsa_link_poll_timer(unsigned long _dst)
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000451{
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000452 struct dsa_switch_tree *dst = (void *)_dst;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000453
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000454 schedule_work(&dst->link_poll_work);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000455}
456
457
458/* platform driver init and cleanup *****************************************/
459static int dev_is_class(struct device *dev, void *class)
460{
461 if (dev->class != NULL && !strcmp(dev->class->name, class))
462 return 1;
463
464 return 0;
465}
466
467static struct device *dev_find_class(struct device *parent, char *class)
468{
469 if (dev_is_class(parent, class)) {
470 get_device(parent);
471 return parent;
472 }
473
474 return device_find_child(parent, class, dev_is_class);
475}
476
Alexander Duyckb4d23942014-09-15 13:00:27 -0400477struct mii_bus *dsa_host_dev_to_mii_bus(struct device *dev)
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000478{
479 struct device *d;
480
481 d = dev_find_class(dev, "mdio_bus");
482 if (d != NULL) {
483 struct mii_bus *bus;
484
485 bus = to_mii_bus(d);
486 put_device(d);
487
488 return bus;
489 }
490
491 return NULL;
492}
Alexander Duyckb4d23942014-09-15 13:00:27 -0400493EXPORT_SYMBOL_GPL(dsa_host_dev_to_mii_bus);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000494
495static struct net_device *dev_to_net_device(struct device *dev)
496{
497 struct device *d;
498
499 d = dev_find_class(dev, "net");
500 if (d != NULL) {
501 struct net_device *nd;
502
503 nd = to_net_dev(d);
504 dev_hold(nd);
505 put_device(d);
506
507 return nd;
508 }
509
510 return NULL;
511}
512
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000513#ifdef CONFIG_OF
514static int dsa_of_setup_routing_table(struct dsa_platform_data *pd,
515 struct dsa_chip_data *cd,
516 int chip_index,
517 struct device_node *link)
518{
519 int ret;
520 const __be32 *reg;
521 int link_port_addr;
522 int link_sw_addr;
523 struct device_node *parent_sw;
524 int len;
525
526 parent_sw = of_get_parent(link);
527 if (!parent_sw)
528 return -EINVAL;
529
530 reg = of_get_property(parent_sw, "reg", &len);
531 if (!reg || (len != sizeof(*reg) * 2))
532 return -EINVAL;
533
534 link_sw_addr = be32_to_cpup(reg + 1);
535
536 if (link_sw_addr >= pd->nr_chips)
537 return -EINVAL;
538
539 /* First time routing table allocation */
540 if (!cd->rtable) {
Fabian Frederick5bc4b462014-11-14 19:36:42 +0100541 cd->rtable = kmalloc_array(pd->nr_chips, sizeof(s8),
542 GFP_KERNEL);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000543 if (!cd->rtable)
544 return -ENOMEM;
545
546 /* default to no valid uplink/downlink */
547 memset(cd->rtable, -1, pd->nr_chips * sizeof(s8));
548 }
549
550 reg = of_get_property(link, "reg", NULL);
551 if (!reg) {
552 ret = -EINVAL;
553 goto out;
554 }
555
556 link_port_addr = be32_to_cpup(reg);
557
558 cd->rtable[link_sw_addr] = link_port_addr;
559
560 return 0;
561out:
562 kfree(cd->rtable);
563 return ret;
564}
565
Florian Fainelli21168242013-03-25 05:03:39 +0000566static void dsa_of_free_platform_data(struct dsa_platform_data *pd)
567{
568 int i;
569 int port_index;
570
571 for (i = 0; i < pd->nr_chips; i++) {
572 port_index = 0;
Florian Fainelli5f64a7d2013-03-25 05:03:40 +0000573 while (port_index < DSA_MAX_PORTS) {
Fabian Frederick1f747142014-06-23 19:32:47 +0200574 kfree(pd->chip[i].port_names[port_index]);
Florian Fainelli5f64a7d2013-03-25 05:03:40 +0000575 port_index++;
576 }
Florian Fainelli21168242013-03-25 05:03:39 +0000577 kfree(pd->chip[i].rtable);
578 }
579 kfree(pd->chip);
580}
581
Florian Fainellif1a26a02015-03-05 12:35:04 -0800582static int dsa_of_probe(struct device *dev)
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000583{
Florian Fainellif1a26a02015-03-05 12:35:04 -0800584 struct device_node *np = dev->of_node;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000585 struct device_node *child, *mdio, *ethernet, *port, *link;
586 struct mii_bus *mdio_bus;
Florian Fainelli769a0202015-03-09 14:31:21 -0700587 struct net_device *ethernet_dev;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000588 struct dsa_platform_data *pd;
589 struct dsa_chip_data *cd;
590 const char *port_name;
591 int chip_index, port_index;
592 const unsigned int *sw_addr, *port_reg;
Guenter Roeck6793abb2014-10-29 10:45:01 -0700593 u32 eeprom_len;
Florian Fainelli21168242013-03-25 05:03:39 +0000594 int ret;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000595
596 mdio = of_parse_phandle(np, "dsa,mii-bus", 0);
597 if (!mdio)
598 return -EINVAL;
599
600 mdio_bus = of_mdio_find_bus(mdio);
601 if (!mdio_bus)
Florian Fainellib324c072015-03-05 12:35:05 -0800602 return -EPROBE_DEFER;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000603
604 ethernet = of_parse_phandle(np, "dsa,ethernet", 0);
605 if (!ethernet)
606 return -EINVAL;
607
Florian Fainelli769a0202015-03-09 14:31:21 -0700608 ethernet_dev = of_find_net_device_by_node(ethernet);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000609 if (!ethernet_dev)
Florian Fainellib324c072015-03-05 12:35:05 -0800610 return -EPROBE_DEFER;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000611
612 pd = kzalloc(sizeof(*pd), GFP_KERNEL);
613 if (!pd)
614 return -ENOMEM;
615
Florian Fainellif1a26a02015-03-05 12:35:04 -0800616 dev->platform_data = pd;
Florian Fainelli769a0202015-03-09 14:31:21 -0700617 pd->of_netdev = ethernet_dev;
Tobias Waldekranze04449f2015-02-05 14:54:09 +0100618 pd->nr_chips = of_get_available_child_count(np);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000619 if (pd->nr_chips > DSA_MAX_SWITCHES)
620 pd->nr_chips = DSA_MAX_SWITCHES;
621
Fabian Frederick6f2aed62014-11-14 19:38:23 +0100622 pd->chip = kcalloc(pd->nr_chips, sizeof(struct dsa_chip_data),
623 GFP_KERNEL);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000624 if (!pd->chip) {
625 ret = -ENOMEM;
626 goto out_free;
627 }
628
Fabian Godehardtd1c0b472014-05-16 06:21:44 +0200629 chip_index = -1;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000630 for_each_available_child_of_node(np, child) {
Fabian Godehardtd1c0b472014-05-16 06:21:44 +0200631 chip_index++;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000632 cd = &pd->chip[chip_index];
633
Florian Fainellifa981d92014-08-27 17:04:49 -0700634 cd->of_node = child;
Florian Fainellic1f570a2014-09-15 14:48:08 -0700635 cd->host_dev = &mdio_bus->dev;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000636
637 sw_addr = of_get_property(child, "reg", NULL);
638 if (!sw_addr)
639 continue;
640
641 cd->sw_addr = be32_to_cpup(sw_addr);
642 if (cd->sw_addr > PHY_MAX_ADDR)
643 continue;
644
Guenter Roeck6793abb2014-10-29 10:45:01 -0700645 if (!of_property_read_u32(np, "eeprom-length", &eeprom_len))
646 cd->eeprom_len = eeprom_len;
647
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000648 for_each_available_child_of_node(child, port) {
649 port_reg = of_get_property(port, "reg", NULL);
650 if (!port_reg)
651 continue;
652
653 port_index = be32_to_cpup(port_reg);
654
655 port_name = of_get_property(port, "label", NULL);
656 if (!port_name)
657 continue;
658
Florian Fainellibd474972014-08-27 17:04:50 -0700659 cd->port_dn[port_index] = port;
660
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000661 cd->port_names[port_index] = kstrdup(port_name,
662 GFP_KERNEL);
663 if (!cd->port_names[port_index]) {
664 ret = -ENOMEM;
665 goto out_free_chip;
666 }
667
668 link = of_parse_phandle(port, "link", 0);
669
670 if (!strcmp(port_name, "dsa") && link &&
671 pd->nr_chips > 1) {
672 ret = dsa_of_setup_routing_table(pd, cd,
673 chip_index, link);
674 if (ret)
675 goto out_free_chip;
676 }
677
678 if (port_index == DSA_MAX_PORTS)
679 break;
680 }
681 }
682
683 return 0;
684
685out_free_chip:
Florian Fainelli21168242013-03-25 05:03:39 +0000686 dsa_of_free_platform_data(pd);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000687out_free:
688 kfree(pd);
Florian Fainellif1a26a02015-03-05 12:35:04 -0800689 dev->platform_data = NULL;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000690 return ret;
691}
692
Florian Fainellif1a26a02015-03-05 12:35:04 -0800693static void dsa_of_remove(struct device *dev)
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000694{
Florian Fainellif1a26a02015-03-05 12:35:04 -0800695 struct dsa_platform_data *pd = dev->platform_data;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000696
Florian Fainellif1a26a02015-03-05 12:35:04 -0800697 if (!dev->of_node)
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000698 return;
699
Florian Fainelli21168242013-03-25 05:03:39 +0000700 dsa_of_free_platform_data(pd);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000701 kfree(pd);
702}
703#else
Florian Fainellif1a26a02015-03-05 12:35:04 -0800704static inline int dsa_of_probe(struct device *dev)
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000705{
706 return 0;
707}
708
Florian Fainellif1a26a02015-03-05 12:35:04 -0800709static inline void dsa_of_remove(struct device *dev)
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000710{
711}
712#endif
713
Florian Fainellic86e59b2015-03-05 12:35:08 -0800714static void dsa_setup_dst(struct dsa_switch_tree *dst, struct net_device *dev,
715 struct device *parent, struct dsa_platform_data *pd)
716{
717 int i;
718
719 dst->pd = pd;
720 dst->master_netdev = dev;
721 dst->cpu_switch = -1;
722 dst->cpu_port = -1;
723
724 for (i = 0; i < pd->nr_chips; i++) {
725 struct dsa_switch *ds;
726
727 ds = dsa_switch_setup(dst, i, parent, pd->chip[i].host_dev);
728 if (IS_ERR(ds)) {
729 netdev_err(dev, "[%d]: couldn't create dsa switch instance (error %ld)\n",
730 i, PTR_ERR(ds));
731 continue;
732 }
733
734 dst->ds[i] = ds;
735 if (ds->drv->poll_link != NULL)
736 dst->link_poll_needed = 1;
737 }
738
739 /*
740 * If we use a tagging format that doesn't have an ethertype
741 * field, make sure that all packets from this point on get
742 * sent to the tag format's receive function.
743 */
744 wmb();
745 dev->dsa_ptr = (void *)dst;
746
747 if (dst->link_poll_needed) {
748 INIT_WORK(&dst->link_poll_work, dsa_link_poll_work);
749 init_timer(&dst->link_poll_timer);
750 dst->link_poll_timer.data = (unsigned long)dst;
751 dst->link_poll_timer.function = dsa_link_poll_timer;
752 dst->link_poll_timer.expires = round_jiffies(jiffies + HZ);
753 add_timer(&dst->link_poll_timer);
754 }
755}
756
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000757static int dsa_probe(struct platform_device *pdev)
758{
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000759 struct dsa_platform_data *pd = pdev->dev.platform_data;
760 struct net_device *dev;
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000761 struct dsa_switch_tree *dst;
Florian Fainellic86e59b2015-03-05 12:35:08 -0800762 int ret;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000763
Joe Perchesa2ae6002014-11-09 16:32:46 -0800764 pr_notice_once("Distributed Switch Architecture driver version %s\n",
765 dsa_driver_version);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000766
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000767 if (pdev->dev.of_node) {
Florian Fainellif1a26a02015-03-05 12:35:04 -0800768 ret = dsa_of_probe(&pdev->dev);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000769 if (ret)
770 return ret;
771
772 pd = pdev->dev.platform_data;
773 }
774
Florian Fainelli769a0202015-03-09 14:31:21 -0700775 if (pd == NULL || (pd->netdev == NULL && pd->of_netdev == NULL))
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000776 return -EINVAL;
777
Florian Fainelli769a0202015-03-09 14:31:21 -0700778 if (pd->of_netdev) {
779 dev = pd->of_netdev;
780 dev_hold(dev);
781 } else {
782 dev = dev_to_net_device(pd->netdev);
783 }
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000784 if (dev == NULL) {
Florian Fainellib324c072015-03-05 12:35:05 -0800785 ret = -EPROBE_DEFER;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000786 goto out;
787 }
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000788
789 if (dev->dsa_ptr != NULL) {
790 dev_put(dev);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000791 ret = -EEXIST;
792 goto out;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000793 }
794
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000795 dst = kzalloc(sizeof(*dst), GFP_KERNEL);
796 if (dst == NULL) {
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000797 dev_put(dev);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000798 ret = -ENOMEM;
799 goto out;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000800 }
801
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000802 platform_set_drvdata(pdev, dst);
803
Florian Fainellic86e59b2015-03-05 12:35:08 -0800804 dsa_setup_dst(dst, dev, &pdev->dev, pd);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000805
806 return 0;
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000807
808out:
Florian Fainellif1a26a02015-03-05 12:35:04 -0800809 dsa_of_remove(&pdev->dev);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000810
811 return ret;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000812}
813
Florian Fainellic86e59b2015-03-05 12:35:08 -0800814static void dsa_remove_dst(struct dsa_switch_tree *dst)
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000815{
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000816 int i;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000817
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000818 if (dst->link_poll_needed)
819 del_timer_sync(&dst->link_poll_timer);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000820
Tejun Heo43829732012-08-20 14:51:24 -0700821 flush_work(&dst->link_poll_work);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000822
Lennert Buytenheke84665c2009-03-20 09:52:09 +0000823 for (i = 0; i < dst->pd->nr_chips; i++) {
824 struct dsa_switch *ds = dst->ds[i];
825
826 if (ds != NULL)
827 dsa_switch_destroy(ds);
828 }
Florian Fainellic86e59b2015-03-05 12:35:08 -0800829}
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000830
Florian Fainellic86e59b2015-03-05 12:35:08 -0800831static int dsa_remove(struct platform_device *pdev)
832{
833 struct dsa_switch_tree *dst = platform_get_drvdata(pdev);
834
835 dsa_remove_dst(dst);
Florian Fainellif1a26a02015-03-05 12:35:04 -0800836 dsa_of_remove(&pdev->dev);
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000837
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000838 return 0;
839}
840
841static void dsa_shutdown(struct platform_device *pdev)
842{
843}
844
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700845static int dsa_switch_rcv(struct sk_buff *skb, struct net_device *dev,
846 struct packet_type *pt, struct net_device *orig_dev)
847{
848 struct dsa_switch_tree *dst = dev->dsa_ptr;
849
850 if (unlikely(dst == NULL)) {
851 kfree_skb(skb);
852 return 0;
853 }
854
Alexander Duyck50753142014-09-15 13:00:19 -0400855 return dst->rcv(skb, dev, pt, orig_dev);
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700856}
857
Florian Fainelli61b73632014-08-29 12:42:07 -0700858static struct packet_type dsa_pack_type __read_mostly = {
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700859 .type = cpu_to_be16(ETH_P_XDSA),
860 .func = dsa_switch_rcv,
861};
862
Florian Fainellib73adef2015-02-24 13:15:33 -0800863static struct notifier_block dsa_netdevice_nb __read_mostly = {
864 .notifier_call = dsa_slave_netdevice_event,
865};
866
Florian Fainelli24462542014-09-18 17:31:22 -0700867#ifdef CONFIG_PM_SLEEP
868static int dsa_suspend(struct device *d)
869{
870 struct platform_device *pdev = to_platform_device(d);
871 struct dsa_switch_tree *dst = platform_get_drvdata(pdev);
872 int i, ret = 0;
873
874 for (i = 0; i < dst->pd->nr_chips; i++) {
875 struct dsa_switch *ds = dst->ds[i];
876
877 if (ds != NULL)
878 ret = dsa_switch_suspend(ds);
879 }
880
881 return ret;
882}
883
884static int dsa_resume(struct device *d)
885{
886 struct platform_device *pdev = to_platform_device(d);
887 struct dsa_switch_tree *dst = platform_get_drvdata(pdev);
888 int i, ret = 0;
889
890 for (i = 0; i < dst->pd->nr_chips; i++) {
891 struct dsa_switch *ds = dst->ds[i];
892
893 if (ds != NULL)
894 ret = dsa_switch_resume(ds);
895 }
896
897 return ret;
898}
899#endif
900
901static SIMPLE_DEV_PM_OPS(dsa_pm_ops, dsa_suspend, dsa_resume);
902
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000903static const struct of_device_id dsa_of_match_table[] = {
Florian Fainelli246d7f72014-08-27 17:04:56 -0700904 { .compatible = "brcm,bcm7445-switch-v4.0" },
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000905 { .compatible = "marvell,dsa", },
906 {}
907};
908MODULE_DEVICE_TABLE(of, dsa_of_match_table);
909
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000910static struct platform_driver dsa_driver = {
911 .probe = dsa_probe,
912 .remove = dsa_remove,
913 .shutdown = dsa_shutdown,
914 .driver = {
915 .name = "dsa",
Florian Fainelli5e95329b2013-03-22 10:50:50 +0000916 .of_match_table = dsa_of_match_table,
Florian Fainelli24462542014-09-18 17:31:22 -0700917 .pm = &dsa_pm_ops,
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000918 },
919};
920
921static int __init dsa_init_module(void)
922{
Ben Hutchings7df899c2011-11-25 14:35:02 +0000923 int rc;
924
Florian Fainellib73adef2015-02-24 13:15:33 -0800925 register_netdevice_notifier(&dsa_netdevice_nb);
926
Ben Hutchings7df899c2011-11-25 14:35:02 +0000927 rc = platform_driver_register(&dsa_driver);
928 if (rc)
929 return rc;
930
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700931 dev_add_pack(&dsa_pack_type);
932
Ben Hutchings7df899c2011-11-25 14:35:02 +0000933 return 0;
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000934}
935module_init(dsa_init_module);
936
937static void __exit dsa_cleanup_module(void)
938{
Florian Fainellib73adef2015-02-24 13:15:33 -0800939 unregister_netdevice_notifier(&dsa_netdevice_nb);
Florian Fainelli3e8a72d2014-08-27 17:04:46 -0700940 dev_remove_pack(&dsa_pack_type);
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000941 platform_driver_unregister(&dsa_driver);
942}
943module_exit(dsa_cleanup_module);
944
Rusty Russell577d6a72011-01-24 14:32:52 -0600945MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
Lennert Buytenhek91da11f2008-10-07 13:44:02 +0000946MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
947MODULE_LICENSE("GPL");
948MODULE_ALIAS("platform:dsa");