1 From 4473f30809eed09037e1932a0c1805172cd997f7 Mon Sep 17 00:00:00 2001
2 From: John Crispin <blogic@openwrt.org>
3 Date: Mon, 14 Dec 2015 22:07:31 +0100
4 Subject: [PATCH 512/513] net: mediatek: add swconfig driver for esw_rt3050
6 Signed-off-by: John Crispin <blogic@openwrt.org>
8 drivers/net/ethernet/mediatek/esw_rt3050.c | 805 ++++++++++++++++++++++++++++
9 1 file changed, 805 insertions(+)
11 --- a/drivers/net/ethernet/mediatek/esw_rt3050.c
12 +++ b/drivers/net/ethernet/mediatek/esw_rt3050.c
14 #include <linux/platform_device.h>
15 #include <asm/mach-ralink/ralink_regs.h>
17 +#include <linux/switch.h>
19 #include "mtk_eth_soc.h"
21 /* HW limitations for this switch:
23 #define RT305X_ESW_PORT5 5
24 #define RT305X_ESW_PORT6 6
26 +#define RT305X_ESW_PORTS_NONE 0
28 #define RT305X_ESW_PMAP_LLLLLL 0x3f
29 #define RT305X_ESW_PMAP_LLLLWL 0x2f
30 #define RT305X_ESW_PMAP_WLLLLL 0x3e
32 #define RT305X_ESW_PORTS_ALL \
33 (RT305X_ESW_PORTS_NOCPU | RT305X_ESW_PORTS_CPU)
35 +#define RT305X_ESW_NUM_VLANS 16
36 +#define RT305X_ESW_NUM_VIDS 4096
37 #define RT305X_ESW_NUM_PORTS 7
38 +#define RT305X_ESW_NUM_LANWAN 6
39 #define RT305X_ESW_NUM_LEDS 5
41 +#define RT5350_ESW_REG_PXTPC(_x) (0x150 + (4 * _x))
42 #define RT5350_EWS_REG_LED_POLARITY 0x168
43 #define RT5350_RESET_EPHY BIT(24)
46 + /* Global attributes. */
47 + RT305X_ESW_ATTR_ENABLE_VLAN,
48 + RT305X_ESW_ATTR_ALT_VLAN_DISABLE,
49 + RT305X_ESW_ATTR_BC_STATUS,
50 + RT305X_ESW_ATTR_LED_FREQ,
51 + /* Port attributes. */
52 + RT305X_ESW_ATTR_PORT_DISABLE,
53 + RT305X_ESW_ATTR_PORT_DOUBLETAG,
54 + RT305X_ESW_ATTR_PORT_UNTAG,
55 + RT305X_ESW_ATTR_PORT_LED,
56 + RT305X_ESW_ATTR_PORT_LAN,
57 + RT305X_ESW_ATTR_PORT_RECV_BAD,
58 + RT305X_ESW_ATTR_PORT_RECV_GOOD,
59 + RT5350_ESW_ATTR_PORT_TR_BAD,
60 + RT5350_ESW_ATTR_PORT_TR_GOOD,
77 + RT305X_ESW_VLAN_CONFIG_NONE = 0,
78 + RT305X_ESW_VLAN_CONFIG_LLLLW,
79 + RT305X_ESW_VLAN_CONFIG_WLLLL,
83 @@ -180,6 +220,12 @@ struct rt305x_esw {
84 unsigned char port_map;
85 unsigned int reg_led_polarity;
87 + struct switch_dev swdev;
88 + bool global_vlan_enable;
89 + bool alt_vlan_disable;
90 + int bc_storm_protect;
92 + struct esw_vlan vlans[RT305X_ESW_NUM_VLANS];
93 struct esw_port ports[RT305X_ESW_NUM_PORTS];
96 @@ -252,6 +298,71 @@ out:
100 +static unsigned esw_get_vlan_id(struct rt305x_esw *esw, unsigned vlan)
105 + s = RT305X_ESW_VLANI_VID_S * (vlan % 2);
106 + val = esw_r32(esw, RT305X_ESW_REG_VLANI(vlan / 2));
107 + val = (val >> s) & RT305X_ESW_VLANI_VID_M;
112 +static void esw_set_vlan_id(struct rt305x_esw *esw, unsigned vlan, unsigned vid)
116 + s = RT305X_ESW_VLANI_VID_S * (vlan % 2);
118 + RT305X_ESW_REG_VLANI(vlan / 2),
119 + RT305X_ESW_VLANI_VID_M << s,
120 + (vid & RT305X_ESW_VLANI_VID_M) << s);
123 +static unsigned esw_get_pvid(struct rt305x_esw *esw, unsigned port)
127 + s = RT305X_ESW_PVIDC_PVID_S * (port % 2);
128 + val = esw_r32(esw, RT305X_ESW_REG_PVIDC(port / 2));
129 + return (val >> s) & RT305X_ESW_PVIDC_PVID_M;
132 +static void esw_set_pvid(struct rt305x_esw *esw, unsigned port, unsigned pvid)
136 + s = RT305X_ESW_PVIDC_PVID_S * (port % 2);
138 + RT305X_ESW_REG_PVIDC(port / 2),
139 + RT305X_ESW_PVIDC_PVID_M << s,
140 + (pvid & RT305X_ESW_PVIDC_PVID_M) << s);
143 +static unsigned esw_get_vmsc(struct rt305x_esw *esw, unsigned vlan)
147 + s = RT305X_ESW_VMSC_MSC_S * (vlan % 4);
148 + val = esw_r32(esw, RT305X_ESW_REG_VMSC(vlan / 4));
149 + val = (val >> s) & RT305X_ESW_VMSC_MSC_M;
154 +static void esw_set_vmsc(struct rt305x_esw *esw, unsigned vlan, unsigned msc)
158 + s = RT305X_ESW_VMSC_MSC_S * (vlan % 4);
160 + RT305X_ESW_REG_VMSC(vlan / 4),
161 + RT305X_ESW_VMSC_MSC_M << s,
162 + (msc & RT305X_ESW_VMSC_MSC_M) << s);
165 static unsigned esw_get_port_disable(struct rt305x_esw *esw)
168 @@ -261,6 +372,59 @@ static unsigned esw_get_port_disable(str
169 RT305X_ESW_POC0_DIS_PORT_M;
172 +static void esw_set_port_disable(struct rt305x_esw *esw, unsigned disable_mask)
175 + unsigned enable_mask;
179 + old_mask = esw_get_port_disable(esw);
180 + changed = old_mask ^ disable_mask;
181 + enable_mask = old_mask & disable_mask;
183 + /* enable before writing to MII */
184 + esw_rmw(esw, RT305X_ESW_REG_POC0,
185 + (RT305X_ESW_POC0_DIS_PORT_M <<
186 + RT305X_ESW_POC0_DIS_PORT_S),
187 + enable_mask << RT305X_ESW_POC0_DIS_PORT_S);
189 + for (i = 0; i < RT305X_ESW_NUM_LEDS; i++) {
190 + if (!(changed & (1 << i)))
192 + if (disable_mask & (1 << i)) {
194 + rt305x_mii_write(esw, i, MII_BMCR,
198 + rt305x_mii_write(esw, i, MII_BMCR,
206 + /* disable after writing to MII */
207 + esw_rmw(esw, RT305X_ESW_REG_POC0,
208 + (RT305X_ESW_POC0_DIS_PORT_M <<
209 + RT305X_ESW_POC0_DIS_PORT_S),
210 + disable_mask << RT305X_ESW_POC0_DIS_PORT_S);
213 +static void esw_set_gsc(struct rt305x_esw *esw)
215 + esw_rmw(esw, RT305X_ESW_REG_SGC,
216 + RT305X_ESW_GSC_BC_STROM_MASK << RT305X_ESW_GSC_BC_STROM_SHIFT,
217 + esw->bc_storm_protect << RT305X_ESW_GSC_BC_STROM_SHIFT);
218 + esw_rmw(esw, RT305X_ESW_REG_SGC,
219 + RT305X_ESW_GSC_LED_FREQ_MASK << RT305X_ESW_GSC_LED_FREQ_SHIFT,
220 + esw->led_frequency << RT305X_ESW_GSC_LED_FREQ_SHIFT);
223 +static int esw_apply_config(struct switch_dev *dev);
225 static void esw_hw_init(struct rt305x_esw *esw)
228 @@ -519,6 +683,9 @@ static void esw_hw_init(struct rt305x_es
229 for (i = 0; i < RT305X_ESW_NUM_LEDS; i++)
230 esw->ports[i].led = 0x05;
232 + /* Apply the empty config. */
233 + esw_apply_config(&esw->swdev);
235 /* Only unmask the port change interrupt */
236 esw_w32(esw, ~RT305X_ESW_PORT_ST_CHG, RT305X_ESW_REG_IMR);
238 @@ -541,11 +708,629 @@ static irqreturn_t esw_interrupt(int irq
242 +static int esw_apply_config(struct switch_dev *dev)
244 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
251 + for (i = 0; i < RT305X_ESW_NUM_VLANS; i++) {
253 + if (esw->global_vlan_enable) {
254 + vid = esw->vlans[i].vid;
255 + vmsc = esw->vlans[i].ports;
257 + vid = RT305X_ESW_VLAN_NONE;
258 + vmsc = RT305X_ESW_PORTS_NONE;
260 + esw_set_vlan_id(esw, i, vid);
261 + esw_set_vmsc(esw, i, vmsc);
264 + for (i = 0; i < RT305X_ESW_NUM_PORTS; i++) {
266 + disable |= esw->ports[i].disable << i;
267 + if (esw->global_vlan_enable) {
268 + doubletag |= esw->ports[i].doubletag << i;
270 + untag |= esw->ports[i].untag << i;
271 + pvid = esw->ports[i].pvid;
273 + int x = esw->alt_vlan_disable ? 0 : 1;
274 + doubletag |= x << i;
279 + esw_set_pvid(esw, i, pvid);
280 + if (i < RT305X_ESW_NUM_LEDS)
281 + esw_w32(esw, esw->ports[i].led,
282 + RT305X_ESW_REG_P0LED + 4*i);
286 + esw_set_port_disable(esw, disable);
287 + esw_rmw(esw, RT305X_ESW_REG_SGC2,
288 + (RT305X_ESW_SGC2_DOUBLE_TAG_M <<
289 + RT305X_ESW_SGC2_DOUBLE_TAG_S),
290 + doubletag << RT305X_ESW_SGC2_DOUBLE_TAG_S);
291 + esw_rmw(esw, RT305X_ESW_REG_PFC1,
292 + RT305X_ESW_PFC1_EN_VLAN_M << RT305X_ESW_PFC1_EN_VLAN_S,
293 + en_vlan << RT305X_ESW_PFC1_EN_VLAN_S);
294 + esw_rmw(esw, RT305X_ESW_REG_POC2,
295 + RT305X_ESW_POC2_UNTAG_EN_M << RT305X_ESW_POC2_UNTAG_EN_S,
296 + untag << RT305X_ESW_POC2_UNTAG_EN_S);
298 + if (!esw->global_vlan_enable) {
300 + * Still need to put all ports into vlan 0 or they'll be
302 + * NOTE: vlan 0 is special, no vlan tag is prepended
304 + esw_set_vlan_id(esw, 0, 0);
305 + esw_set_vmsc(esw, 0, RT305X_ESW_PORTS_ALL);
311 +static int esw_reset_switch(struct switch_dev *dev)
313 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
315 + esw->global_vlan_enable = 0;
316 + memset(esw->ports, 0, sizeof(esw->ports));
317 + memset(esw->vlans, 0, sizeof(esw->vlans));
323 +static int esw_get_vlan_enable(struct switch_dev *dev,
324 + const struct switch_attr *attr,
325 + struct switch_val *val)
327 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
329 + val->value.i = esw->global_vlan_enable;
334 +static int esw_set_vlan_enable(struct switch_dev *dev,
335 + const struct switch_attr *attr,
336 + struct switch_val *val)
338 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
340 + esw->global_vlan_enable = val->value.i != 0;
345 +static int esw_get_alt_vlan_disable(struct switch_dev *dev,
346 + const struct switch_attr *attr,
347 + struct switch_val *val)
349 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
351 + val->value.i = esw->alt_vlan_disable;
356 +static int esw_set_alt_vlan_disable(struct switch_dev *dev,
357 + const struct switch_attr *attr,
358 + struct switch_val *val)
360 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
362 + esw->alt_vlan_disable = val->value.i != 0;
368 +rt305x_esw_set_bc_status(struct switch_dev *dev,
369 + const struct switch_attr *attr,
370 + struct switch_val *val)
372 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
374 + esw->bc_storm_protect = val->value.i & RT305X_ESW_GSC_BC_STROM_MASK;
380 +rt305x_esw_get_bc_status(struct switch_dev *dev,
381 + const struct switch_attr *attr,
382 + struct switch_val *val)
384 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
386 + val->value.i = esw->bc_storm_protect;
392 +rt305x_esw_set_led_freq(struct switch_dev *dev,
393 + const struct switch_attr *attr,
394 + struct switch_val *val)
396 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
398 + esw->led_frequency = val->value.i & RT305X_ESW_GSC_LED_FREQ_MASK;
404 +rt305x_esw_get_led_freq(struct switch_dev *dev,
405 + const struct switch_attr *attr,
406 + struct switch_val *val)
408 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
410 + val->value.i = esw->led_frequency;
415 +static int esw_get_port_link(struct switch_dev *dev,
417 + struct switch_port_link *link)
419 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
422 + if (port < 0 || port >= RT305X_ESW_NUM_PORTS)
425 + poa = esw_r32(esw, RT305X_ESW_REG_POA) >> port;
427 + link->link = (poa >> RT305X_ESW_LINK_S) & 1;
428 + link->duplex = (poa >> RT305X_ESW_DUPLEX_S) & 1;
429 + if (port < RT305X_ESW_NUM_LEDS) {
430 + speed = (poa >> RT305X_ESW_SPD_S) & 1;
432 + if (port == RT305X_ESW_NUM_PORTS - 1)
434 + speed = (poa >> RT305X_ESW_SPD_S) & 3;
438 + link->speed = SWITCH_PORT_SPEED_10;
441 + link->speed = SWITCH_PORT_SPEED_100;
444 + case 3: /* forced gige speed can be 2 or 3 */
445 + link->speed = SWITCH_PORT_SPEED_1000;
448 + link->speed = SWITCH_PORT_SPEED_UNKNOWN;
455 +static int esw_get_port_bool(struct switch_dev *dev,
456 + const struct switch_attr *attr,
457 + struct switch_val *val)
459 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
460 + int idx = val->port_vlan;
463 + if (idx < 0 || idx >= RT305X_ESW_NUM_PORTS)
466 + switch (attr->id) {
467 + case RT305X_ESW_ATTR_PORT_DISABLE:
468 + reg = RT305X_ESW_REG_POC0;
469 + shift = RT305X_ESW_POC0_DIS_PORT_S;
471 + case RT305X_ESW_ATTR_PORT_DOUBLETAG:
472 + reg = RT305X_ESW_REG_SGC2;
473 + shift = RT305X_ESW_SGC2_DOUBLE_TAG_S;
475 + case RT305X_ESW_ATTR_PORT_UNTAG:
476 + reg = RT305X_ESW_REG_POC2;
477 + shift = RT305X_ESW_POC2_UNTAG_EN_S;
479 + case RT305X_ESW_ATTR_PORT_LAN:
480 + reg = RT305X_ESW_REG_SGC2;
481 + shift = RT305X_ESW_SGC2_LAN_PMAP_S;
482 + if (idx >= RT305X_ESW_NUM_LANWAN)
489 + x = esw_r32(esw, reg);
490 + val->value.i = (x >> (idx + shift)) & 1;
495 +static int esw_set_port_bool(struct switch_dev *dev,
496 + const struct switch_attr *attr,
497 + struct switch_val *val)
499 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
500 + int idx = val->port_vlan;
502 + if (idx < 0 || idx >= RT305X_ESW_NUM_PORTS ||
503 + val->value.i < 0 || val->value.i > 1)
506 + switch (attr->id) {
507 + case RT305X_ESW_ATTR_PORT_DISABLE:
508 + esw->ports[idx].disable = val->value.i;
510 + case RT305X_ESW_ATTR_PORT_DOUBLETAG:
511 + esw->ports[idx].doubletag = val->value.i;
513 + case RT305X_ESW_ATTR_PORT_UNTAG:
514 + esw->ports[idx].untag = val->value.i;
523 +static int esw_get_port_recv_badgood(struct switch_dev *dev,
524 + const struct switch_attr *attr,
525 + struct switch_val *val)
527 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
528 + int idx = val->port_vlan;
529 + int shift = attr->id == RT305X_ESW_ATTR_PORT_RECV_GOOD ? 0 : 16;
532 + if (idx < 0 || idx >= RT305X_ESW_NUM_LANWAN)
534 + reg = esw_r32(esw, RT305X_ESW_REG_PXPC(idx));
535 + val->value.i = (reg >> shift) & 0xffff;
541 +esw_get_port_tr_badgood(struct switch_dev *dev,
542 + const struct switch_attr *attr,
543 + struct switch_val *val)
545 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
547 + int idx = val->port_vlan;
548 + int shift = attr->id == RT5350_ESW_ATTR_PORT_TR_GOOD ? 0 : 16;
551 + if ((ralink_soc != RT305X_SOC_RT5350) && (ralink_soc != MT762X_SOC_MT7628AN) && (ralink_soc != MT762X_SOC_MT7688))
554 + if (idx < 0 || idx >= RT305X_ESW_NUM_LANWAN)
557 + reg = esw_r32(esw, RT5350_ESW_REG_PXTPC(idx));
558 + val->value.i = (reg >> shift) & 0xffff;
563 +static int esw_get_port_led(struct switch_dev *dev,
564 + const struct switch_attr *attr,
565 + struct switch_val *val)
567 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
568 + int idx = val->port_vlan;
570 + if (idx < 0 || idx >= RT305X_ESW_NUM_PORTS ||
571 + idx >= RT305X_ESW_NUM_LEDS)
574 + val->value.i = esw_r32(esw, RT305X_ESW_REG_P0LED + 4*idx);
579 +static int esw_set_port_led(struct switch_dev *dev,
580 + const struct switch_attr *attr,
581 + struct switch_val *val)
583 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
584 + int idx = val->port_vlan;
586 + if (idx < 0 || idx >= RT305X_ESW_NUM_LEDS)
589 + esw->ports[idx].led = val->value.i;
594 +static int esw_get_port_pvid(struct switch_dev *dev, int port, int *val)
596 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
598 + if (port >= RT305X_ESW_NUM_PORTS)
601 + *val = esw_get_pvid(esw, port);
606 +static int esw_set_port_pvid(struct switch_dev *dev, int port, int val)
608 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
610 + if (port >= RT305X_ESW_NUM_PORTS)
613 + esw->ports[port].pvid = val;
618 +static int esw_get_vlan_ports(struct switch_dev *dev, struct switch_val *val)
620 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
627 + if (val->port_vlan < 0 || val->port_vlan >= RT305X_ESW_NUM_VIDS)
631 + for (i = 0; i < RT305X_ESW_NUM_VLANS; i++) {
632 + if (esw_get_vlan_id(esw, i) == val->port_vlan &&
633 + esw_get_vmsc(esw, i) != RT305X_ESW_PORTS_NONE) {
639 + if (vlan_idx == -1)
642 + vmsc = esw_get_vmsc(esw, vlan_idx);
643 + poc2 = esw_r32(esw, RT305X_ESW_REG_POC2);
645 + for (i = 0; i < RT305X_ESW_NUM_PORTS; i++) {
646 + struct switch_port *p;
647 + int port_mask = 1 << i;
649 + if (!(vmsc & port_mask))
652 + p = &val->value.ports[val->len++];
654 + if (poc2 & (port_mask << RT305X_ESW_POC2_UNTAG_EN_S))
657 + p->flags = 1 << SWITCH_PORT_FLAG_TAGGED;
663 +static int esw_set_vlan_ports(struct switch_dev *dev, struct switch_val *val)
665 + struct rt305x_esw *esw = container_of(dev, struct rt305x_esw, swdev);
670 + if (val->port_vlan < 0 || val->port_vlan >= RT305X_ESW_NUM_VIDS ||
671 + val->len > RT305X_ESW_NUM_PORTS)
674 + /* one of the already defined vlans? */
675 + for (i = 0; i < RT305X_ESW_NUM_VLANS; i++) {
676 + if (esw->vlans[i].vid == val->port_vlan &&
677 + esw->vlans[i].ports != RT305X_ESW_PORTS_NONE) {
683 + /* select a free slot */
684 + for (i = 0; vlan_idx == -1 && i < RT305X_ESW_NUM_VLANS; i++) {
685 + if (esw->vlans[i].ports == RT305X_ESW_PORTS_NONE)
689 + /* bail if all slots are in use */
690 + if (vlan_idx == -1)
693 + ports = RT305X_ESW_PORTS_NONE;
694 + for (i = 0; i < val->len; i++) {
695 + struct switch_port *p = &val->value.ports[i];
696 + int port_mask = 1 << p->id;
697 + bool untagged = !(p->flags & (1 << SWITCH_PORT_FLAG_TAGGED));
699 + if (p->id >= RT305X_ESW_NUM_PORTS)
702 + ports |= port_mask;
703 + esw->ports[p->id].untag = untagged;
705 + esw->vlans[vlan_idx].ports = ports;
706 + if (ports == RT305X_ESW_PORTS_NONE)
707 + esw->vlans[vlan_idx].vid = RT305X_ESW_VLAN_NONE;
709 + esw->vlans[vlan_idx].vid = val->port_vlan;
714 +static const struct switch_attr esw_global[] = {
716 + .type = SWITCH_TYPE_INT,
717 + .name = "enable_vlan",
718 + .description = "VLAN mode (1:enabled)",
720 + .id = RT305X_ESW_ATTR_ENABLE_VLAN,
721 + .get = esw_get_vlan_enable,
722 + .set = esw_set_vlan_enable,
725 + .type = SWITCH_TYPE_INT,
726 + .name = "alternate_vlan_disable",
727 + .description = "Use en_vlan instead of doubletag to disable"
730 + .id = RT305X_ESW_ATTR_ALT_VLAN_DISABLE,
731 + .get = esw_get_alt_vlan_disable,
732 + .set = esw_set_alt_vlan_disable,
735 + .type = SWITCH_TYPE_INT,
736 + .name = "bc_storm_protect",
737 + .description = "Global broadcast storm protection (0:Disable, 1:64 blocks, 2:96 blocks, 3:128 blocks)",
739 + .id = RT305X_ESW_ATTR_BC_STATUS,
740 + .get = rt305x_esw_get_bc_status,
741 + .set = rt305x_esw_set_bc_status,
744 + .type = SWITCH_TYPE_INT,
745 + .name = "led_frequency",
746 + .description = "LED Flash frequency (0:30mS, 1:60mS, 2:240mS, 3:480mS)",
748 + .id = RT305X_ESW_ATTR_LED_FREQ,
749 + .get = rt305x_esw_get_led_freq,
750 + .set = rt305x_esw_set_led_freq,
754 +static const struct switch_attr esw_port[] = {
756 + .type = SWITCH_TYPE_INT,
758 + .description = "Port state (1:disabled)",
760 + .id = RT305X_ESW_ATTR_PORT_DISABLE,
761 + .get = esw_get_port_bool,
762 + .set = esw_set_port_bool,
765 + .type = SWITCH_TYPE_INT,
766 + .name = "doubletag",
767 + .description = "Double tagging for incoming vlan packets "
770 + .id = RT305X_ESW_ATTR_PORT_DOUBLETAG,
771 + .get = esw_get_port_bool,
772 + .set = esw_set_port_bool,
775 + .type = SWITCH_TYPE_INT,
777 + .description = "Untag (1:strip outgoing vlan tag)",
779 + .id = RT305X_ESW_ATTR_PORT_UNTAG,
780 + .get = esw_get_port_bool,
781 + .set = esw_set_port_bool,
784 + .type = SWITCH_TYPE_INT,
786 + .description = "LED mode (0:link, 1:100m, 2:duplex, 3:activity,"
787 + " 4:collision, 5:linkact, 6:duplcoll, 7:10mact,"
788 + " 8:100mact, 10:blink, 11:off, 12:on)",
790 + .id = RT305X_ESW_ATTR_PORT_LED,
791 + .get = esw_get_port_led,
792 + .set = esw_set_port_led,
795 + .type = SWITCH_TYPE_INT,
797 + .description = "HW port group (0:wan, 1:lan)",
799 + .id = RT305X_ESW_ATTR_PORT_LAN,
800 + .get = esw_get_port_bool,
803 + .type = SWITCH_TYPE_INT,
804 + .name = "recv_bad",
805 + .description = "Receive bad packet counter",
806 + .id = RT305X_ESW_ATTR_PORT_RECV_BAD,
807 + .get = esw_get_port_recv_badgood,
810 + .type = SWITCH_TYPE_INT,
811 + .name = "recv_good",
812 + .description = "Receive good packet counter",
813 + .id = RT305X_ESW_ATTR_PORT_RECV_GOOD,
814 + .get = esw_get_port_recv_badgood,
817 + .type = SWITCH_TYPE_INT,
820 + .description = "Transmit bad packet counter. rt5350 only",
821 + .id = RT5350_ESW_ATTR_PORT_TR_BAD,
822 + .get = esw_get_port_tr_badgood,
825 + .type = SWITCH_TYPE_INT,
828 + .description = "Transmit good packet counter. rt5350 only",
829 + .id = RT5350_ESW_ATTR_PORT_TR_GOOD,
830 + .get = esw_get_port_tr_badgood,
834 +static const struct switch_attr esw_vlan[] = {
837 +static const struct switch_dev_ops esw_ops = {
839 + .attr = esw_global,
840 + .n_attr = ARRAY_SIZE(esw_global),
844 + .n_attr = ARRAY_SIZE(esw_port),
848 + .n_attr = ARRAY_SIZE(esw_vlan),
850 + .get_vlan_ports = esw_get_vlan_ports,
851 + .set_vlan_ports = esw_set_vlan_ports,
852 + .get_port_pvid = esw_get_port_pvid,
853 + .set_port_pvid = esw_set_port_pvid,
854 + .get_port_link = esw_get_port_link,
855 + .apply_config = esw_apply_config,
856 + .reset_switch = esw_reset_switch,
859 static int esw_probe(struct platform_device *pdev)
861 struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
862 struct device_node *np = pdev->dev.of_node;
863 const __be32 *port_map, *reg_init;
864 + struct switch_dev *swdev;
865 struct rt305x_esw *esw;
866 struct resource *irq;
868 @@ -568,6 +1353,21 @@ static int esw_probe(struct platform_dev
870 esw->reg_led_polarity = be32_to_cpu(*reg_init);
872 + swdev = &esw->swdev;
873 + swdev->of_node = pdev->dev.of_node;
874 + swdev->name = "rt305x-esw";
875 + swdev->alias = "rt305x";
876 + swdev->cpu_port = RT305X_ESW_PORT6;
877 + swdev->ports = RT305X_ESW_NUM_PORTS;
878 + swdev->vlans = RT305X_ESW_NUM_VIDS;
879 + swdev->ops = &esw_ops;
881 + ret = register_switch(swdev, NULL);
883 + dev_err(&pdev->dev, "register_switch failed\n");
887 platform_set_drvdata(pdev, esw);
889 spin_lock_init(&esw->reg_rw_lock);
890 @@ -583,6 +1383,11 @@ static int esw_probe(struct platform_dev
896 + iounmap(esw->base);
901 static int esw_remove(struct platform_device *pdev)