projects / openwrt.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
madwifi: add a small missing change to the tx power rework
[openwrt.git] / package / broadcom-57xx / src / bcmrobo.c
1 /*
2 * Broadcom BCM5325E/536x switch configuration module
3 *
4 * Copyright (C) 2007 Felix Fietkau <nbd@openwrt.org>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * Based on:
17 * Broadcom 53xx RoboSwitch device driver.
18 *
19 * Copyright 2007, Broadcom Corporation
20 * All Rights Reserved.
21 *
22 * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
23 * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
24 * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
25 * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
26 */
27
28
29 #include <linux/autoconf.h>
30 #include <linux/module.h>
31 #include <linux/init.h>
32 #include <asm/uaccess.h>
33
34 #include <typedefs.h>
35 #include <osl.h>
36 #include <sbutils.h>
37 #include <sbconfig.h>
38 #include <bcmendian.h>
39 #include "bcmparams.h"
40 #include <bcmnvram.h>
41 #include <bcmdevs.h>
42 #include "bcmrobo.h"
43 #include "proto/ethernet.h"
44 #include <switch-core.h>
45
46 #define DRIVER_NAME "bcm57xx"
47 #define DRIVER_VERSION "0.1"
48
49 #ifndef GPIO_PIN_NOTDEFINED
50 #define GPIO_PIN_NOTDEFINED 0x20
51 #endif
52
53 #ifdef BCMDBG
54 #define ET_ERROR(args) printk args
55 #else /* BCMDBG */
56 #define ET_ERROR(args)
57 #endif /* BCMDBG */
58 #define ET_MSG(args)
59
60 /*
61 * Switch can be programmed through SPI interface, which
62 * has a rreg and a wreg functions to read from and write to
63 * registers.
64 */
65
66 /* MII access registers */
67 #define PSEUDO_PHYAD 0x1E /* MII Pseudo PHY address */
68 #define REG_MII_PAGE 0x10 /* MII Page register */
69 #define REG_MII_ADDR 0x11 /* MII Address register */
70 #define REG_MII_DATA0 0x18 /* MII Data register 0 */
71 #define REG_MII_DATA1 0x19 /* MII Data register 1 */
72 #define REG_MII_DATA2 0x1a /* MII Data register 2 */
73 #define REG_MII_DATA3 0x1b /* MII Data register 3 */
74
75 /* Page numbers */
76 #define PAGE_CTRL 0x00 /* Control page */
77 #define PAGE_MMR 0x02 /* 5397 Management/Mirroring page */
78 #define PAGE_VTBL 0x05 /* ARL/VLAN Table access page */
79 #define PAGE_VLAN 0x34 /* VLAN page */
80
81 /* Control page registers */
82 #define REG_CTRL_PORT0 0x00 /* Port 0 traffic control register */
83 #define REG_CTRL_PORT1 0x01 /* Port 1 traffic control register */
84 #define REG_CTRL_PORT2 0x02 /* Port 2 traffic control register */
85 #define REG_CTRL_PORT3 0x03 /* Port 3 traffic control register */
86 #define REG_CTRL_PORT4 0x04 /* Port 4 traffic control register */
87 #define REG_CTRL_PORT5 0x05 /* Port 5 traffic control register */
88 #define REG_CTRL_PORT6 0x06 /* Port 6 traffic control register */
89 #define REG_CTRL_PORT7 0x07 /* Port 7 traffic control register */
90 #define REG_CTRL_MODE 0x0B /* Switch Mode register */
91 #define REG_CTRL_MIIPO 0x0E /* 5325: MII Port Override register */
92 #define REG_CTRL_SRST 0x79 /* Software reset control register */
93
94 #define REG_DEVICE_ID 0x30 /* 539x Device id: */
95 #define DEVID5325 0x25 /* 5325 (Not really be we fake it) */
96 #define DEVID5395 0x95 /* 5395 */
97 #define DEVID5397 0x97 /* 5397 */
98 #define DEVID5398 0x98 /* 5398 */
99
100 /* VLAN page registers */
101 #define REG_VLAN_CTRL0 0x00 /* VLAN Control 0 register */
102 #define REG_VLAN_CTRL1 0x01 /* VLAN Control 1 register */
103 #define REG_VLAN_CTRL4 0x04 /* VLAN Control 4 register */
104 #define REG_VLAN_CTRL5 0x05 /* VLAN Control 5 register */
105 #define REG_VLAN_ACCESS 0x06 /* VLAN Table Access register */
106 #define REG_VLAN_WRITE 0x08 /* VLAN Write register */
107 #define REG_VLAN_READ 0x0C /* VLAN Read register */
108 #define REG_VLAN_PTAG0 0x10 /* VLAN Default Port Tag register - port 0 */
109 #define REG_VLAN_PTAG1 0x12 /* VLAN Default Port Tag register - port 1 */
110 #define REG_VLAN_PTAG2 0x14 /* VLAN Default Port Tag register - port 2 */
111 #define REG_VLAN_PTAG3 0x16 /* VLAN Default Port Tag register - port 3 */
112 #define REG_VLAN_PTAG4 0x18 /* VLAN Default Port Tag register - port 4 */
113 #define REG_VLAN_PTAG5 0x1a /* VLAN Default Port Tag register - port 5 */
114 #define REG_VLAN_PTAG6 0x1c /* VLAN Default Port Tag register - port 6 */
115 #define REG_VLAN_PTAG7 0x1e /* VLAN Default Port Tag register - port 7 */
116 #define REG_VLAN_PTAG8 0x20 /* 539x: VLAN Default Port Tag register - IMP port */
117 #define REG_VLAN_PMAP 0x20 /* 5325: VLAN Priority Re-map register */
118
119 #define VLAN_NUMVLANS 16 /* # of VLANs */
120
121
122 /* ARL/VLAN Table Access page registers */
123 #define REG_VTBL_CTRL 0x00 /* ARL Read/Write Control */
124 #define REG_VTBL_MINDX 0x02 /* MAC Address Index */
125 #define REG_VTBL_VINDX 0x08 /* VID Table Index */
126 #define REG_VTBL_ARL_E0 0x10 /* ARL Entry 0 */
127 #define REG_VTBL_ARL_E1 0x18 /* ARL Entry 1 */
128 #define REG_VTBL_DAT_E0 0x18 /* ARL Table Data Entry 0 */
129 #define REG_VTBL_SCTRL 0x20 /* ARL Search Control */
130 #define REG_VTBL_SADDR 0x22 /* ARL Search Address */
131 #define REG_VTBL_SRES 0x24 /* ARL Search Result */
132 #define REG_VTBL_SREXT 0x2c /* ARL Search Result */
133 #define REG_VTBL_VID_E0 0x30 /* VID Entry 0 */
134 #define REG_VTBL_VID_E1 0x32 /* VID Entry 1 */
135 #define REG_VTBL_PREG 0xFF /* Page Register */
136 #define REG_VTBL_ACCESS 0x60 /* VLAN table access register */
137 #define REG_VTBL_INDX 0x61 /* VLAN table address index register */
138 #define REG_VTBL_ENTRY 0x63 /* VLAN table entry register */
139 #define REG_VTBL_ACCESS_5395 0x80 /* VLAN table access register */
140 #define REG_VTBL_INDX_5395 0x81 /* VLAN table address index register */
141 #define REG_VTBL_ENTRY_5395 0x83 /* VLAN table entry register */
142
143 /* SPI registers */
144 #define REG_SPI_PAGE 0xff /* SPI Page register */
145
146 /* Access switch registers through GPIO/SPI */
147
148 /* Minimum timing constants */
149 #define SCK_EDGE_TIME 2 /* clock edge duration - 2us */
150 #define MOSI_SETUP_TIME 1 /* input setup duration - 1us */
151 #define SS_SETUP_TIME 1 /* select setup duration - 1us */
152
153 /* misc. constants */
154 #define SPI_MAX_RETRY 100
155
156 static int config_attach(robo_info_t *robo);
157 static void config_detach(robo_info_t *robo);
158
159 /* Enable GPIO access to the chip */
160 static void
161 gpio_enable(robo_info_t *robo)
162 {
163 /* Enable GPIO outputs with SCK and MOSI low, SS high */
164 sb_gpioout(robo->sbh, robo->ss | robo->sck | robo->mosi, robo->ss, GPIO_DRV_PRIORITY);
165 sb_gpioouten(robo->sbh, robo->ss | robo->sck | robo->mosi,
166 robo->ss | robo->sck | robo->mosi, GPIO_DRV_PRIORITY);
167 }
168
169 /* Disable GPIO access to the chip */
170 static void
171 gpio_disable(robo_info_t *robo)
172 {
173 /* Disable GPIO outputs with all their current values */
174 sb_gpioouten(robo->sbh, robo->ss | robo->sck | robo->mosi, 0, GPIO_DRV_PRIORITY);
175 }
176
177 /* Write a byte stream to the chip thru SPI */
178 static int
179 spi_write(robo_info_t *robo, uint8 *buf, uint len)
180 {
181 uint i;
182 uint8 mask;
183
184 /* Byte bang from LSB to MSB */
185 for (i = 0; i < len; i++) {
186 /* Bit bang from MSB to LSB */
187 for (mask = 0x80; mask; mask >>= 1) {
188 /* Clock low */
189 sb_gpioout(robo->sbh, robo->sck, 0, GPIO_DRV_PRIORITY);
190 OSL_DELAY(SCK_EDGE_TIME);
191
192 /* Sample on rising edge */
193 if (mask & buf[i])
194 sb_gpioout(robo->sbh, robo->mosi, robo->mosi, GPIO_DRV_PRIORITY);
195 else
196 sb_gpioout(robo->sbh, robo->mosi, 0, GPIO_DRV_PRIORITY);
197 OSL_DELAY(MOSI_SETUP_TIME);
198
199 /* Clock high */
200 sb_gpioout(robo->sbh, robo->sck, robo->sck, GPIO_DRV_PRIORITY);
201 OSL_DELAY(SCK_EDGE_TIME);
202 }
203 }
204
205 return 0;
206 }
207
208 /* Read a byte stream from the chip thru SPI */
209 static int
210 spi_read(robo_info_t *robo, uint8 *buf, uint len)
211 {
212 uint i, timeout;
213 uint8 rack, mask, byte;
214
215 /* Timeout after 100 tries without RACK */
216 for (i = 0, rack = 0, timeout = SPI_MAX_RETRY; i < len && timeout;) {
217 /* Bit bang from MSB to LSB */
218 for (mask = 0x80, byte = 0; mask; mask >>= 1) {
219 /* Clock low */
220 sb_gpioout(robo->sbh, robo->sck, 0, GPIO_DRV_PRIORITY);
221 OSL_DELAY(SCK_EDGE_TIME);
222
223 /* Sample on falling edge */
224 if (sb_gpioin(robo->sbh) & robo->miso)
225 byte |= mask;
226
227 /* Clock high */
228 sb_gpioout(robo->sbh, robo->sck, robo->sck, GPIO_DRV_PRIORITY);
229 OSL_DELAY(SCK_EDGE_TIME);
230 }
231 /* RACK when bit 0 is high */
232 if (!rack) {
233 rack = (byte & 1);
234 timeout--;
235 continue;
236 }
237 /* Byte bang from LSB to MSB */
238 buf[i] = byte;
239 i++;
240 }
241
242 if (timeout == 0) {
243 ET_ERROR(("spi_read: timeout"));
244 return -1;
245 }
246
247 return 0;
248 }
249
250 /* Enable/disable SPI access */
251 static void
252 spi_select(robo_info_t *robo, uint8 spi)
253 {
254 if (spi) {
255 /* Enable SPI access */
256 sb_gpioout(robo->sbh, robo->ss, 0, GPIO_DRV_PRIORITY);
257 } else {
258 /* Disable SPI access */
259 sb_gpioout(robo->sbh, robo->ss, robo->ss, GPIO_DRV_PRIORITY);
260 }
261 OSL_DELAY(SS_SETUP_TIME);
262 }
263
264
265 /* Select chip and page */
266 static void
267 spi_goto(robo_info_t *robo, uint8 page)
268 {
269 uint8 reg8 = REG_SPI_PAGE; /* page select register */
270 uint8 cmd8;
271
272 /* Issue the command only when we are on a different page */
273 if (robo->page == page)
274 return;
275
276 robo->page = page;
277
278 /* Enable SPI access */
279 spi_select(robo, 1);
280
281 /* Select new page with CID 0 */
282 cmd8 = ((6 << 4) | /* normal SPI */
283 1); /* write */
284 spi_write(robo, &cmd8, 1);
285 spi_write(robo, &reg8, 1);
286 spi_write(robo, &page, 1);
287
288 /* Disable SPI access */
289 spi_select(robo, 0);
290 }
291
292 /* Write register thru SPI */
293 static int
294 spi_wreg(robo_info_t *robo, uint8 page, uint8 addr, void *val, int len)
295 {
296 int status = 0;
297 uint8 cmd8;
298 union {
299 uint8 val8;
300 uint16 val16;
301 uint32 val32;
302 } bytes;
303
304 /* validate value length and buffer address */
305 ASSERT(len == 1 || (len == 2 && !((int)val & 1)) ||
306 (len == 4 && !((int)val & 3)));
307
308 /* Select chip and page */
309 spi_goto(robo, page);
310
311 /* Enable SPI access */
312 spi_select(robo, 1);
313
314 /* Write with CID 0 */
315 cmd8 = ((6 << 4) | /* normal SPI */
316 1); /* write */
317 spi_write(robo, &cmd8, 1);
318 spi_write(robo, &addr, 1);
319 switch (len) {
320 case 1:
321 bytes.val8 = *(uint8 *)val;
322 break;
323 case 2:
324 bytes.val16 = htol16(*(uint16 *)val);
325 break;
326 case 4:
327 bytes.val32 = htol32(*(uint32 *)val);
328 break;
329 }
330 spi_write(robo, (uint8 *)val, len);
331
332 ET_MSG(("%s: [0x%x-0x%x] := 0x%x (len %d)\n", __FUNCTION__, page, addr,
333 *(uint16 *)val, len));
334 /* Disable SPI access */
335 spi_select(robo, 0);
336 return status;
337 }
338
339 /* Read register thru SPI in fast SPI mode */
340 static int
341 spi_rreg(robo_info_t *robo, uint8 page, uint8 addr, void *val, int len)
342 {
343 int status = 0;
344 uint8 cmd8;
345 union {
346 uint8 val8;
347 uint16 val16;
348 uint32 val32;
349 } bytes;
350
351 /* validate value length and buffer address */
352 ASSERT(len == 1 || (len == 2 && !((int)val & 1)) ||
353 (len == 4 && !((int)val & 3)));
354
355 /* Select chip and page */
356 spi_goto(robo, page);
357
358 /* Enable SPI access */
359 spi_select(robo, 1);
360
361 /* Fast SPI read with CID 0 and byte offset 0 */
362 cmd8 = (1 << 4); /* fast SPI */
363 spi_write(robo, &cmd8, 1);
364 spi_write(robo, &addr, 1);
365 status = spi_read(robo, (uint8 *)&bytes, len);
366 switch (len) {
367 case 1:
368 *(uint8 *)val = bytes.val8;
369 break;
370 case 2:
371 *(uint16 *)val = ltoh16(bytes.val16);
372 break;
373 case 4:
374 *(uint32 *)val = ltoh32(bytes.val32);
375 break;
376 }
377
378 ET_MSG(("%s: [0x%x-0x%x] => 0x%x (len %d)\n", __FUNCTION__, page, addr,
379 *(uint16 *)val, len));
380
381 /* Disable SPI access */
382 spi_select(robo, 0);
383 return status;
384 }
385
386 /* SPI/gpio interface functions */
387 static dev_ops_t spigpio = {
388 gpio_enable,
389 gpio_disable,
390 spi_wreg,
391 spi_rreg,
392 "SPI (GPIO)"
393 };
394
395
396 /* Access switch registers through MII (MDC/MDIO) */
397
398 #define MII_MAX_RETRY 100
399
400 /* Write register thru MDC/MDIO */
401 static int
402 mii_wreg(robo_info_t *robo, uint8 page, uint8 reg, void *val, int len)
403 {
404 uint16 cmd16, val16,val48[3];
405 void *h = robo->h;
406 uint32 val64[2];
407 memset(val48,0,6);
408 memset(val64,0,8);
409 int i;
410 uint8 *ptr = (uint8 *)val;
411
412 /* validate value length and buffer address */
413 ASSERT(len == 1 || len == 6 || len == 8 ||
414 ((len == 2) && !((int)val & 1)) || ((len == 4) && !((int)val & 3)));
415
416 ET_MSG(("%s: [0x%x-0x%x] := 0x%x (len %d)\n", __FUNCTION__, page, reg,
417 *(uint16 *)val, len));
418
419 /* set page number - MII register 0x10 */
420 if (robo->page != page) {
421 cmd16 = ((page << 8) | /* page number */
422 1); /* mdc/mdio access enable */
423 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_PAGE, cmd16);
424 robo->page = page;
425 }
426
427 switch (len) {
428 case 8:
429 val16 = ptr[7];
430 val16 = ((val16 << 8) | ptr[6]);
431 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA3, val16);
432 /* FALLTHRU */
433
434 case 6:
435 val16 = ptr[5];
436 val16 = ((val16 << 8) | ptr[4]);
437 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA2, val16);
438 val16 = ptr[3];
439 val16 = ((val16 << 8) | ptr[2]);
440 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA1, val16);
441 val16 = ptr[1];
442 val16 = ((val16 << 8) | ptr[0]);
443 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA0, val16);
444 break;
445
446 case 4:
447 val16 = (uint16)((*(uint32 *)val) >> 16);
448 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA1, val16);
449 val16 = (uint16)(*(uint32 *)val);
450 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA0, val16);
451 break;
452
453 case 2:
454 val16 = *(uint16 *)val;
455 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA0, val16);
456 break;
457
458 case 1:
459 val16 = *(uint8 *)val;
460 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_DATA0, val16);
461 break;
462 }
463
464 /* set register address - MII register 0x11 */
465 cmd16 = ((reg << 8) | /* register address */
466 1); /* opcode write */
467 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_ADDR, cmd16);
468
469 /* is operation finished? */
470 for (i = MII_MAX_RETRY; i > 0; i --) {
471 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_ADDR);
472 if ((val16 & 3) == 0)
473 break;
474 }
475
476 /* timed out */
477 if (!i) {
478 ET_ERROR(("mii_wreg: timeout"));
479 return -1;
480 }
481 return 0;
482 }
483
484 /* Read register thru MDC/MDIO */
485 static int
486 mii_rreg(robo_info_t *robo, uint8 page, uint8 reg, void *val, int len)
487 {
488 uint16 cmd16, val16;
489 void *h = robo->h;
490 int i;
491 uint8 *ptr = (uint8 *)val;
492
493 /* validate value length and buffer address */
494 ASSERT(len == 1 || len == 6 || len == 8 ||
495 ((len == 2) && !((int)val & 1)) || ((len == 4) && !((int)val & 3)));
496
497 /* set page number - MII register 0x10 */
498 if (robo->page != page) {
499 cmd16 = ((page << 8) | /* page number */
500 1); /* mdc/mdio access enable */
501 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_PAGE, cmd16);
502 robo->page = page;
503 }
504
505 /* set register address - MII register 0x11 */
506 cmd16 = ((reg << 8) | /* register address */
507 2); /* opcode read */
508 robo->miiwr(h, PSEUDO_PHYAD, REG_MII_ADDR, cmd16);
509
510 /* is operation finished? */
511 for (i = MII_MAX_RETRY; i > 0; i --) {
512 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_ADDR);
513 if ((val16 & 3) == 0)
514 break;
515 }
516 /* timed out */
517 if (!i) {
518 ET_ERROR(("mii_rreg: timeout"));
519 return -1;
520 }
521
522 ET_MSG(("%s: [0x%x-0x%x] => 0x%x (len %d)\n", __FUNCTION__, page, reg, val16, len));
523
524 switch (len) {
525 case 8:
526 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA3);
527 ptr[7] = (val16 >> 8);
528 ptr[6] = (val16 & 0xff);
529 /* FALLTHRU */
530
531 case 6:
532 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA2);
533 ptr[5] = (val16 >> 8);
534 ptr[4] = (val16 & 0xff);
535 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA1);
536 ptr[3] = (val16 >> 8);
537 ptr[2] = (val16 & 0xff);
538 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA0);
539 ptr[1] = (val16 >> 8);
540 ptr[0] = (val16 & 0xff);
541 break;
542
543 case 4:
544 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA1);
545 *(uint32 *)val = (((uint32)val16) << 16);
546 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA0);
547 *(uint32 *)val |= val16;
548 break;
549
550 case 2:
551 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA0);
552 *(uint16 *)val = val16;
553 break;
554 case 1:
555 val16 = robo->miird(h, PSEUDO_PHYAD, REG_MII_DATA0);
556 *(uint8 *)val = (uint8)(val16 & 0xff);
557 break;
558 }
559
560 return 0;
561 }
562
563 /* MII interface functions */
564 static dev_ops_t mdcmdio = {
565 NULL,
566 NULL,
567 mii_wreg,
568 mii_rreg,
569 "MII (MDC/MDIO)"
570 };
571
572 /* High level switch configuration functions. */
573
574 static int
575 findmatch(char *string, char *name)
576 {
577 uint len;
578 char *c;
579
580 len = strlen(name);
581 /* CSTYLED */
582 while ((c = strchr(string, ',')) != NULL) {
583 if (len == (uint)(c - string) && !strncmp(string, name, len))
584 return 1;
585 string = c + 1;
586 }
587
588 return (!strcmp(string, name));
589 }
590
591 static uint
592 getgpiopin(char *vars, char *pin_name, uint def_pin)
593 {
594 char name[] = "gpioXXXX";
595 char *val;
596 uint pin;
597
598 /* Go thru all possibilities till a match in pin name */
599 for (pin = 0; pin < GPIO_NUMPINS; pin ++) {
600 snprintf(name, sizeof(name), "gpio%d", pin);
601 val = getvar(vars, name);
602 if (val && findmatch(val, pin_name))
603 return pin;
604 }
605
606 if (def_pin != GPIO_PIN_NOTDEFINED) {
607 /* make sure the default pin is not used by someone else */
608 snprintf(name, sizeof(name), "gpio%d", def_pin);
609 if (getvar(vars, name)) {
610 def_pin = GPIO_PIN_NOTDEFINED;
611 }
612 }
613
614 return def_pin;
615 }
616
617
618 /* Port flags */
619 #define FLAG_TAGGED 't' /* output tagged (external ports only) */
620 #define FLAG_UNTAG 'u' /* input & output untagged (CPU port only, for OS (linux, ...) */
621 #define FLAG_LAN '*' /* input & output untagged (CPU port only, for CFE */
622
623 /* port descriptor */
624 typedef struct {
625 uint32 untag; /* untag enable bit (Page 0x05 Address 0x63-0x66 Bit[17:9]) */
626 uint32 member; /* vlan member bit (Page 0x05 Address 0x63-0x66 Bit[7:0]) */
627 uint8 ptagr; /* port tag register address (Page 0x34 Address 0x10-0x1F) */
628 uint8 cpu; /* is this cpu port? */
629 } pdesc_t;
630
631 pdesc_t pdesc97[] = {
632 /* 5395/5397/5398 is 0 ~ 7. port 8 is IMP port. */
633 /* port 0 */ {1 << 9, 1 << 0, REG_VLAN_PTAG0, 0},
634 /* port 1 */ {1 << 10, 1 << 1, REG_VLAN_PTAG1, 0},
635 /* port 2 */ {1 << 11, 1 << 2, REG_VLAN_PTAG2, 0},
636 /* port 3 */ {1 << 12, 1 << 3, REG_VLAN_PTAG3, 0},
637 /* port 4 */ {1 << 13, 1 << 4, REG_VLAN_PTAG4, 0},
638 /* port 5 */ {1 << 14, 1 << 5, REG_VLAN_PTAG5, 0},
639 /* port 6 */ {1 << 15, 1 << 6, REG_VLAN_PTAG6, 0},
640 /* port 7 */ {1 << 16, 1 << 7, REG_VLAN_PTAG7, 0},
641 /* mii port */ {1 << 17, 1 << 8, REG_VLAN_PTAG8, 1},
642 };
643
644 pdesc_t pdesc25[] = {
645 /* port 0 */ {1 << 6, 1 << 0, REG_VLAN_PTAG0, 0},
646 /* port 1 */ {1 << 7, 1 << 1, REG_VLAN_PTAG1, 0},
647 /* port 2 */ {1 << 8, 1 << 2, REG_VLAN_PTAG2, 0},
648 /* port 3 */ {1 << 9, 1 << 3, REG_VLAN_PTAG3, 0},
649 /* port 4 */ {1 << 10, 1 << 4, REG_VLAN_PTAG4, 0},
650 /* mii port */ {1 << 11, 1 << 5, REG_VLAN_PTAG5, 1},
651 };
652
653
654 #define to_robo(driver) ((robo_info_t *) ((switch_driver *) driver)->priv)
655 #define ROBO_START(driver) \
656 do { \
657 robo_info_t *robo = to_robo(driver); \
658 if (robo->ops->enable_mgmtif) \
659 robo->ops->enable_mgmtif(robo)
660
661 #define ROBO_END(driver) \
662 if (robo->ops->disable_mgmtif) \
663 robo->ops->disable_mgmtif(robo); \
664 } while (0)
665
666 int
667 bcm_robo_reset(robo_info_t *robo)
668 {
669 int i, max_port_ind;
670 uint8 val8;
671 uint16 val16;
672 uint32 val32;
673 pdesc_t *pdesc;
674 int pdescsz;
675
676 /* printk(KERN_WARNING "bcmrobo.c: bcm_robo_reset\n"); */
677
678 if (robo->ops->enable_mgmtif)
679 robo->ops->enable_mgmtif(robo);
680
681 /* setup global vlan configuration, FIXME: necessary? */
682 /* VLAN Control 0 Register (Page 0x34, Address 0) */
683 val8 = ((1 << 7) | /* enable 802.1Q VLAN */
684 (3 << 5)); /* individual VLAN learning mode */
685 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL0, &val8, sizeof(val8));
686
687 /* VLAN Control 1 Register (Page 0x34, Address 1) */
688 robo->ops->read_reg(robo, PAGE_VLAN, REG_VLAN_CTRL0, &val8, sizeof(val8));
689 val8 |= ((1 << 2) | /* enable RSV multicast V Fwdmap */
690 (1 << 3)); /* enable RSV multicast V Untagmap */
691 if (robo->devid == DEVID5325)
692 val8 |= (1 << 1); /* enable RSV multicast V Tagging */
693 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL1, &val8, sizeof(val8));
694
695 bcm_robo_set_macaddr(robo, NULL);
696
697 if (robo->devid == DEVID5325) {
698 /* VLAN Control 4 Register (Page 0x34, Address 4) */
699 val8 = (1 << 6); /* drop frame with VID violation */
700 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL4, &val8, sizeof(val8));
701
702 /* VLAN Control 5 Register (Page 0x34, Address 5) */
703 val8 = (1 << 3); /* drop frame when miss V table */
704 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL5, &val8, sizeof(val8));
705
706 pdesc = pdesc25;
707 pdescsz = sizeof(pdesc25) / sizeof(pdesc_t);
708 } else {
709 pdesc = pdesc97;
710 pdescsz = sizeof(pdesc97) / sizeof(pdesc_t);
711 }
712
713 if (robo->devid == DEVID5325) {
714 /* setup priority mapping - applies to tagged ingress frames */
715 /* Priority Re-map Register (Page 0x34, Address 0x20-0x23) */
716 /* FIXME: un-hardcode */
717 val32 = ((0 << 0) | /* 0 -> 0 */
718 (1 << 3) | /* 1 -> 1 */
719 (2 << 6) | /* 2 -> 2 */
720 (3 << 9) | /* 3 -> 3 */
721 (4 << 12) | /* 4 -> 4 */
722 (5 << 15) | /* 5 -> 5 */
723 (6 << 18) | /* 6 -> 6 */
724 (7 << 21)); /* 7 -> 7 */
725 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_PMAP, &val32, sizeof(val32));
726 }
727
728 /* Set unmanaged mode */
729 robo->ops->read_reg(robo, PAGE_CTRL, REG_CTRL_MODE, &val8, sizeof(val8));
730 val8 &= (~(1 << 0));
731 robo->ops->write_reg(robo, PAGE_CTRL, REG_CTRL_MODE, &val8, sizeof(val8));
732
733 /* No spanning tree for unmanaged mode */
734 val8 = 0;
735 max_port_ind = ((robo->devid == DEVID5398) ? REG_CTRL_PORT7 : REG_CTRL_PORT4);
736 for (i = REG_CTRL_PORT0; i <= max_port_ind; i++) {
737 robo->ops->write_reg(robo, PAGE_CTRL, i, &val8, sizeof(val8));
738 }
739
740 /* WAN port LED */
741 val16 = 0x1f;
742 robo->ops->write_reg(robo, PAGE_CTRL, 0x16, &val16, 2);
743
744 if (robo->ops->enable_mgmtif)
745 robo->ops->disable_mgmtif(robo);
746
747 return 0;
748 }
749
750 /* Get access to the RoboSwitch */
751 robo_info_t *
752 bcm_robo_attach(sb_t *sbh, void *h, char *name, char *vars, miird_f miird, miiwr_f miiwr)
753 {
754 robo_info_t *robo;
755 uint32 reset, idx;
756 uint8 val8;
757 uint16 val16;
758
759 /* Allocate and init private state */
760 if (!(robo = MALLOC(sb_osh(sbh), sizeof(robo_info_t)))) {
761 ET_ERROR(("robo_attach: out of memory, malloced %d bytes", MALLOCED(sb_osh(sbh))));
762 return NULL;
763 }
764 bzero(robo, sizeof(robo_info_t));
765
766 robo->h = h;
767 robo->sbh = sbh;
768 robo->vars = vars;
769 robo->miird = miird;
770 robo->miiwr = miiwr;
771 robo->page = -1;
772 robo->name = name;
773
774 /* Trigger external reset by nvram variable existance */
775 if ((reset = getgpiopin(robo->vars, "robo_reset", GPIO_PIN_NOTDEFINED)) !=
776 GPIO_PIN_NOTDEFINED) {
777 /*
778 * Reset sequence: RESET low(50ms)->high(20ms)
779 *
780 * We have to perform a full sequence for we don't know how long
781 * it has been from power on till now.
782 */
783 ET_MSG(("%s: Using external reset in gpio pin %d\n", __FUNCTION__, reset));
784 reset = 1 << reset;
785
786 /* Keep RESET low for 50 ms */
787 sb_gpioout(robo->sbh, reset, 0, GPIO_DRV_PRIORITY);
788 sb_gpioouten(robo->sbh, reset, reset, GPIO_DRV_PRIORITY);
789 bcm_mdelay(50);
790
791 if (robo->devid == DEVID5395)
792 nvram_set("switch_type", "BCM5395");
793 else if(robo->devid == DEVID5397)
794 nvram_set("switch_type", "BCM5397");
795 else
796 nvram_set("switch_type", "unknown");
797
798 /* Keep RESET high for at least 20 ms */
799 sb_gpioout(robo->sbh, reset, reset, GPIO_DRV_PRIORITY);
800 bcm_mdelay(20);
801 } else {
802 /* In case we need it */
803 idx = sb_coreidx(robo->sbh);
804
805 if (sb_setcore(robo->sbh, SB_ROBO, 0)) {
806 /* If we have an internal robo core, reset it using sb_core_reset */
807 ET_MSG(("%s: Resetting internal robo core\n", __FUNCTION__));
808 sb_core_reset(robo->sbh, 0, 0);
809 }
810
811 sb_setcoreidx(robo->sbh, idx);
812 }
813
814 if (miird && miiwr) {
815 uint16 tmp;
816 int rc, retry_count = 0;
817
818 /* Read the PHY ID */
819 tmp = miird(h, PSEUDO_PHYAD, 2);
820 if (tmp != 0xffff) {
821 do {
822 rc = mii_rreg(robo, PAGE_MMR, REG_DEVICE_ID, \
823 &robo->devid, sizeof(uint16));
824 if (rc != 0)
825 break;
826 retry_count++;
827 } while ((robo->devid == 0) && (retry_count < 10));
828
829 ET_MSG(("%s: devid read %ssuccesfully via mii: 0x%x\n", __FUNCTION__, \
830 rc ? "un" : "", robo->devid));
831 ET_MSG(("%s: mii access to switch works\n", __FUNCTION__));
832 robo->ops = &mdcmdio;
833 if ((rc != 0) || (robo->devid == 0)) {
834 ET_MSG(("%s: error reading devid, assuming 5325e\n", __FUNCTION__));
835 robo->devid = DEVID5325;
836 }
837 ET_MSG(("%s: devid: 0x%x\n", __FUNCTION__, robo->devid));
838 }
839 }
840
841 if ((robo->devid == DEVID5395) ||
842 (robo->devid == DEVID5397) ||
843 (robo->devid == DEVID5398)) {
844 uint8 srst_ctrl;
845
846 /* If it is a 539x switch, use the soft reset register */
847 ET_MSG(("%s: Resetting 539x robo switch\n", __FUNCTION__));
848
849 /* Reset the 539x switch core and register file */
850 srst_ctrl = 0x83;
851 mii_wreg(robo, PAGE_CTRL, REG_CTRL_SRST, &srst_ctrl, sizeof(uint8));
852
853 bcm_mdelay(500);
854
855 srst_ctrl = 0x00;
856 mii_wreg(robo, PAGE_CTRL, REG_CTRL_SRST, &srst_ctrl, sizeof(uint8));
857 }
858
859 if (!robo->ops) {
860 int mosi, miso, ss, sck;
861
862 robo->ops = &spigpio;
863 robo->devid = DEVID5325;
864
865 /* Init GPIO mapping. Default 2, 3, 4, 5 */
866 ss = getgpiopin(vars, "robo_ss", 2);
867 if (ss == GPIO_PIN_NOTDEFINED) {
868 ET_ERROR(("robo_attach: robo_ss gpio fail: GPIO 2 in use"));
869 goto error;
870 }
871 robo->ss = 1 << ss;
872 sck = getgpiopin(vars, "robo_sck", 3);
873 if (sck == GPIO_PIN_NOTDEFINED) {
874 ET_ERROR(("robo_attach: robo_sck gpio fail: GPIO 3 in use"));
875 goto error;
876 }
877 robo->sck = 1 << sck;
878 mosi = getgpiopin(vars, "robo_mosi", 4);
879 if (mosi == GPIO_PIN_NOTDEFINED) {
880 ET_ERROR(("robo_attach: robo_mosi gpio fail: GPIO 4 in use"));
881 goto error;
882 }
883 robo->mosi = 1 << mosi;
884 miso = getgpiopin(vars, "robo_miso", 5);
885 if (miso == GPIO_PIN_NOTDEFINED) {
886 ET_ERROR(("robo_attach: robo_miso gpio fail: GPIO 5 in use"));
887 goto error;
888 }
889 robo->miso = 1 << miso;
890 ET_MSG(("%s: ss %d sck %d mosi %d miso %d\n", __FUNCTION__,
891 ss, sck, mosi, miso));
892 }
893
894 /* sanity check */
895 ASSERT(robo->ops);
896 ASSERT(robo->ops->write_reg);
897 ASSERT(robo->ops->read_reg);
898 ASSERT((robo->devid == DEVID5325) ||
899 (robo->devid == DEVID5395) ||
900 (robo->devid == DEVID5397) ||
901 (robo->devid == DEVID5398));
902
903 bcm_robo_reset(robo);
904 config_attach(robo);
905
906 return robo;
907
908 error:
909 MFREE(sb_osh(robo->sbh), robo, sizeof(robo_info_t));
910 return NULL;
911 }
912
913 /* Release access to the RoboSwitch */
914 void
915 bcm_robo_detach(robo_info_t *robo)
916 {
917 config_detach(robo);
918 MFREE(sb_osh(robo->sbh), robo, sizeof(robo_info_t));
919 }
920
921 /* Enable the device and set it to a known good state */
922 int
923 bcm_robo_enable_device(robo_info_t *robo)
924 {
925 uint8 reg_offset, reg_val;
926 int ret = 0;
927
928 /* Enable management interface access */
929 if (robo->ops->enable_mgmtif)
930 robo->ops->enable_mgmtif(robo);
931
932 if (robo->devid == DEVID5398) {
933 /* Disable unused ports: port 6 and 7 */
934 for (reg_offset = REG_CTRL_PORT6; reg_offset <= REG_CTRL_PORT7; reg_offset ++) {
935 /* Set bits [1:0] to disable RX and TX */
936 reg_val = 0x03;
937 robo->ops->write_reg(robo, PAGE_CTRL, reg_offset, &reg_val,
938 sizeof(reg_val));
939 }
940 }
941
942 if (robo->devid == DEVID5325) {
943 /* Must put the switch into Reverse MII mode! */
944
945 /* MII port state override (page 0 register 14) */
946 robo->ops->read_reg(robo, PAGE_CTRL, REG_CTRL_MIIPO, &reg_val, sizeof(reg_val));
947
948 /* Bit 4 enables reverse MII mode */
949 if (!(reg_val & (1 << 4))) {
950 /* Enable RvMII */
951 reg_val |= (1 << 4);
952 robo->ops->write_reg(robo, PAGE_CTRL, REG_CTRL_MIIPO, &reg_val,
953 sizeof(reg_val));
954
955 /* Read back */
956 robo->ops->read_reg(robo, PAGE_CTRL, REG_CTRL_MIIPO, &reg_val,
957 sizeof(reg_val));
958 if (!(reg_val & (1 << 4))) {
959 ET_ERROR(("robo_enable_device: enabling RvMII mode failed\n"));
960 ret = -1;
961 }
962 }
963 }
964
965 /* Disable management interface access */
966 if (robo->ops->disable_mgmtif)
967 robo->ops->disable_mgmtif(robo);
968
969 return ret;
970 }
971
972
973 void bcm_robo_set_macaddr(robo_info_t *robo, char *mac_addr)
974 {
975 uint8 arl_entry[8] = { 0 }, arl_entry1[8] = { 0 };
976
977 if (mac_addr != NULL)
978 memcpy(robo->macaddr, mac_addr, 6);
979
980 mac_addr = robo->macaddr;
981
982 /* setup mac address */
983 arl_entry[0] = mac_addr[5];
984 arl_entry[1] = mac_addr[4];
985 arl_entry[2] = mac_addr[3];
986 arl_entry[3] = mac_addr[2];
987 arl_entry[4] = mac_addr[1];
988 arl_entry[5] = mac_addr[0];
989
990 if (robo->devid == DEVID5325) {
991 /* Init the entry 1 of the bin */
992 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_ARL_E1, \
993 arl_entry1, sizeof(arl_entry1));
994 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_VID_E1, \
995 arl_entry1, 1);
996
997 /* Init the entry 0 of the bin */
998 arl_entry[6] = 0x8; /* Port Id: MII */
999 arl_entry[7] = 0xc0; /* Static Entry, Valid */
1000
1001 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_ARL_E0, \
1002 arl_entry, sizeof(arl_entry));
1003 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_MINDX, \
1004 arl_entry, ETHER_ADDR_LEN);
1005
1006 } else {
1007 /* Initialize the MAC Addr Index Register */
1008 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_MINDX, \
1009 arl_entry, ETHER_ADDR_LEN);
1010 }
1011 }
1012
1013 static int handle_reset(void *driver, char *buf, int nr)
1014 {
1015 ROBO_START(driver);
1016 bcm_robo_reset(robo);
1017 ROBO_END(driver);
1018
1019 return 0;
1020 }
1021
1022
1023 static int handle_enable_read(void *driver, char *buf, int nr)
1024 {
1025 int ret;
1026 uint8 val8;
1027
1028 ROBO_START(driver);
1029 robo->ops->read_reg(robo, PAGE_CTRL, REG_CTRL_MODE, &val8, sizeof(val8));
1030 ret = sprintf(buf, "%d\n", !!(val8 & (1 << 1)));
1031 ROBO_END(driver);
1032
1033 return ret;
1034 }
1035
1036 static int handle_enable_write(void *driver, char *buf, int nr)
1037 {
1038 uint8 val8;
1039
1040 /* printk(KERN_WARNING "bcmrobo.c: handle_enable_write\n"); */
1041
1042 ROBO_START(driver);
1043 robo->ops->read_reg(robo, PAGE_CTRL, REG_CTRL_MODE, &val8, sizeof(val8));
1044 val8 &= ~(1 << 1);
1045 val8 |= ((buf[0] == '1') << 1);
1046 robo->ops->write_reg(robo, PAGE_CTRL, REG_CTRL_MODE, &val8, sizeof(val8));
1047 ROBO_END(driver);
1048
1049 return 0;
1050 }
1051
1052 static int handle_enable_vlan_read(void *driver, char *buf, int nr)
1053 {
1054 uint8 val8;
1055
1056 ROBO_START(driver);
1057 robo->ops->read_reg(robo, PAGE_VLAN, REG_VLAN_CTRL0, &val8, sizeof(val8));
1058 ROBO_END(driver);
1059
1060 return sprintf(buf, "%d\n", (((val8 & (1 << 7)) == (1 << 7)) ? 1 : 0));
1061 }
1062 static int handle_enable_vlan_write(void *driver, char *buf, int nr)
1063 {
1064 int disable = ((buf[0] != '1') ? 1 : 0);
1065
1066 uint8 val8;
1067 uint16 val16;
1068 pdesc_t *pdesc;
1069 int pdescsz;
1070 uint16 vid;
1071 uint8 arl_entry[8] = { 0 }, arl_entry1[8] = { 0 };
1072
1073 /* printk(KERN_WARNING "bcmrobo.c: handle_enable_vlan_write\n"); */
1074
1075 ROBO_START(driver);
1076
1077 /* setup global vlan configuration */
1078 /* VLAN Control 0 Register (Page 0x34, Address 0) */
1079 val8 = disable ? 0 :
1080 ((1 << 7) | /* enable/disable 802.1Q VLAN */
1081 (3 << 5)); /* individual VLAN learning mode */
1082 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL0, &val8, sizeof(val8));
1083
1084 /* VLAN Control 1 Register (Page 0x34, Address 1) */
1085 val8 = disable ? 0 :
1086 ((1 << 2) | /* enable/disable RSV multicast V Fwdmap */
1087 (1 << 3)); /* enable/disable RSV multicast V Untagmap */
1088 if (robo->devid == DEVID5325)
1089 val8 |= disable ? 0 : (1 << 1); /* enable/disable RSV multicast V Tagging */
1090 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL1, &val8, sizeof(val8));
1091
1092 if ( disable == 0 ) { /* FIXME: ok to stop here when disabling? */
1093 arl_entry[0] = robo->macaddr[5];
1094 arl_entry[1] = robo->macaddr[4];
1095 arl_entry[2] = robo->macaddr[3];
1096 arl_entry[3] = robo->macaddr[2];
1097 arl_entry[4] = robo->macaddr[1];
1098 arl_entry[5] = robo->macaddr[0];
1099
1100 if (robo->devid == DEVID5325) {
1101 /* Init the entry 1 of the bin */
1102 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_ARL_E1, \
1103 arl_entry1, sizeof(arl_entry1));
1104 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_VID_E1, \
1105 arl_entry1, 1);
1106
1107 /* Init the entry 0 of the bin */
1108 arl_entry[6] = 0x8; /* Port Id: MII */
1109 arl_entry[7] = 0xc0; /* Static Entry, Valid */
1110
1111 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_ARL_E0, \
1112 arl_entry, sizeof(arl_entry));
1113 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_MINDX, \
1114 arl_entry, ETHER_ADDR_LEN);
1115
1116 /* VLAN Control 4 Register (Page 0x34, Address 4) */
1117 val8 = (1 << 6); /* drop frame with VID violation */
1118 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL4, &val8, sizeof(val8));
1119
1120 /* VLAN Control 5 Register (Page 0x34, Address 5) */
1121 val8 = (1 << 3); /* drop frame when miss V table */
1122 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_CTRL5, &val8, sizeof(val8));
1123
1124 pdesc = pdesc25;
1125 pdescsz = sizeof(pdesc25) / sizeof(pdesc_t);
1126 } else {
1127 /* Initialize the MAC Addr Index Register */
1128 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_MINDX, \
1129 arl_entry, ETHER_ADDR_LEN);
1130
1131 pdesc = pdesc97;
1132 pdescsz = sizeof(pdesc97) / sizeof(pdesc_t);
1133 }
1134
1135 /* setup each vlan. max. 16 vlans. */
1136 /* force vlan id to be equal to vlan number */
1137 for (vid = 0; vid < VLAN_NUMVLANS; vid ++) {
1138
1139 /* Add static ARL entries */
1140 if (robo->devid == DEVID5325) {
1141 val8 = vid;
1142 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_VID_E0, \
1143 &val8, sizeof(val8));
1144 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_VINDX, \
1145 &val8, sizeof(val8));
1146
1147 /* Write the entry */
1148 val8 = 0x80;
1149 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_CTRL, \
1150 &val8, sizeof(val8));
1151 /* Wait for write to complete */
1152 SPINWAIT((robo->ops->read_reg(robo, PAGE_VTBL, REG_VTBL_CTRL, \
1153 &val8, sizeof(val8)), ((val8 & 0x80) != 0)),
1154 100 /* usec */);
1155 } else {
1156 /* Set the VLAN Id in VLAN ID Index Register */
1157 val8 = vid;
1158 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_VINDX, \
1159 &val8, sizeof(val8));
1160
1161 /* Set the MAC addr and VLAN Id in ARL Table MAC/VID Entry 0
1162 * Register.
1163 */
1164 arl_entry[6] = vid;
1165 arl_entry[7] = 0x0;
1166 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_ARL_E0, \
1167 arl_entry, sizeof(arl_entry));
1168
1169 /* Set the Static bit , Valid bit and Port ID fields in
1170 * ARL Table Data Entry 0 Register
1171 */
1172 val16 = 0xc008;
1173 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_DAT_E0, \
1174 &val16, sizeof(val16));
1175
1176 /* Clear the ARL_R/W bit and set the START/DONE bit in
1177 * the ARL Read/Write Control Register.
1178 */
1179 val8 = 0x80;
1180 robo->ops->write_reg(robo, PAGE_VTBL, REG_VTBL_CTRL, \
1181 &val8, sizeof(val8));
1182 /* Wait for write to complete */
1183 SPINWAIT((robo->ops->read_reg(robo, PAGE_VTBL, REG_VTBL_CTRL, \
1184 &val8, sizeof(val8)), ((val8 & 0x80) != 0)),
1185 100 /* usec */);
1186 }
1187 }
1188 }
1189
1190 ROBO_END(driver);
1191 return 0;
1192 }
1193
1194 static int handle_vlan_port_read(void *driver, char *buf, int nr)
1195 {
1196 /* FIXME: yeah, some work is missing here */
1197 return sprintf(buf, "bcmrobo.c: handle_vlan_port_read unimplimented\n");
1198 }
1199
1200 static int handle_vlan_port_write(void *driver, char *buf, int nr)
1201 {
1202
1203 switch_driver *d = (switch_driver *) driver;
1204 switch_vlan_config *c = switch_parse_vlan(d, buf);
1205
1206 uint8 val8;
1207 uint16 val16;
1208 uint32 val32;
1209 int j;
1210 pdesc_t *pdesc;
1211 int pdescsz;
1212
1213 /* printk(KERN_WARNING "bcmrobo.c: handle_vlan_port_write, nr %d\n", nr); */
1214
1215 if (c == NULL)
1216 return -EINVAL;
1217
1218 ROBO_START(driver);
1219
1220 if (robo->devid == DEVID5325) {
1221 pdesc = pdesc25;
1222 pdescsz = sizeof(pdesc25) / sizeof(pdesc_t);
1223 } else {
1224 pdesc = pdesc97;
1225 pdescsz = sizeof(pdesc97) / sizeof(pdesc_t);
1226 }
1227
1228
1229 for (j = 0; j < d->ports; j++) {
1230 if ((c->untag | c->pvid) & (1 << j))
1231 if ((j != d->cpuport) || (c->untag & (1 << j))) {
1232
1233 /* change default vlan tag */
1234
1235 /* printk(KERN_WARNING "bcmrobo.c: set default vlan tag, port %d -> vlan %d\n", j, nr); */
1236
1237 val16 = ((0 << 13) | /* priority - always 0 */
1238 nr); /* vlan id */
1239 robo->ops->write_reg(robo, PAGE_VLAN, pdesc[j].ptagr, &val16, sizeof(val16));
1240 }
1241 }
1242
1243
1244 if (robo->devid == DEVID5325) {
1245 val32 = ((c->untag << 6) | /* untag enable */
1246 c->port); /* vlan members */
1247 val32 |= ((1 << 20) | /* valid write */
1248 ((nr >> 4) << 12)); /* vlan id bit[11:4] */
1249 /* VLAN Write Register (Page 0x34, Address 0x08-0x0B) */
1250 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_WRITE, &val32,
1251 sizeof(val32));
1252 /* VLAN Table Access Register (Page 0x34, Address 0x06-0x07) */
1253 val16 = ((1 << 13) | /* start command */
1254 (1 << 12) | /* write state */
1255 nr); /* vlan id */
1256 robo->ops->write_reg(robo, PAGE_VLAN, REG_VLAN_ACCESS, &val16,
1257 sizeof(val16));
1258 } else {
1259 uint8 vtble, vtbli, vtbla;
1260 val32 = ((c->untag << 9) | /* untag enable */
1261 c->port); /* vlan members */
1262
1263 if (robo->devid == DEVID5395) {
1264 vtble = REG_VTBL_ENTRY_5395;
1265 vtbli = REG_VTBL_INDX_5395;
1266 vtbla = REG_VTBL_ACCESS_5395;
1267 } else {
1268 vtble = REG_VTBL_ENTRY;
1269 vtbli = REG_VTBL_INDX;
1270 vtbla = REG_VTBL_ACCESS;
1271 }
1272
1273 /* VLAN Table Entry Register (Page 0x05, Address 0x63-0x66/0x83-0x86) */
1274 robo->ops->write_reg(robo, PAGE_VTBL, vtble, &val32,
1275 sizeof(val32));
1276 /* VLAN Table Address Index Reg (Page 0x05, Address 0x61-0x62/0x81-0x82) */
1277 val16 = nr; /* vlan id */
1278 robo->ops->write_reg(robo, PAGE_VTBL, vtbli, &val16,
1279 sizeof(val16));
1280
1281 /* VLAN Table Access Register (Page 0x34, Address 0x60/0x80) */
1282 val8 = ((1 << 7) | /* start command */
1283 0); /* write */
1284 robo->ops->write_reg(robo, PAGE_VTBL, vtbla, &val8,
1285 sizeof(val8));
1286 }
1287
1288 ROBO_END(driver);
1289 return 0;
1290 }
1291
1292 static int __init config_attach(robo_info_t *robo)
1293 {
1294 switch_config cfg[] = {
1295 {"enable", handle_enable_read, handle_enable_write},
1296 {"reset", NULL, handle_reset},
1297 {"enable_vlan", handle_enable_vlan_read, handle_enable_vlan_write},
1298 {NULL, NULL, NULL}
1299 };
1300 switch_config vlan[] = {
1301 {"ports", handle_vlan_port_read, handle_vlan_port_write},
1302 {NULL, NULL, NULL}
1303 };
1304 switch_driver driver = {
1305 name: DRIVER_NAME,
1306 version: DRIVER_VERSION,
1307 interface: robo->name,
1308 cpuport: 8,
1309 ports: 9,
1310 vlans: 16,
1311 driver_handlers: cfg,
1312 port_handlers: NULL,
1313 vlan_handlers: vlan,
1314 };
1315 if (robo->devid == DEVID5325) {
1316 driver.ports = 6;
1317 driver.cpuport = 5;
1318 }
1319 driver.priv = (void *) robo;
1320
1321 return switch_register_driver(&driver);
1322 }
1323
1324 static void __exit config_detach(robo_info_t *robo)
1325 {
1326 switch_unregister_driver(DRIVER_NAME);
1327 }
1328
1329
Personal OpenWRT clone
This page took 0.122013 seconds and 5 git commands to generate.