package/switch/src/switch-adm.c

   1 /*
   2  * ADMTEK Adm6996 switch configuration module
   3  *
   4  * Copyright (C) 2005 Felix Fietkau <nbd@nbd.name>
   5  *
   6  * Partially based on Broadcom Home Networking Division 10/100 Mbit/s
   7  * Ethernet Device Driver (from Montavista 2.4.20_mvl31 Kernel).
   8  * Copyright (C) 2004 Broadcom Corporation
   9  *
  10  * adm_rreg function from adm6996
  11  * Copyright (C) 2004 Nikki Chumakov <nikki@gattaca.ru>
  12  *
  13  * This program is free software; you can redistribute it and/or
  14  * modify it under the terms of the GNU General Public License
  15  * as published by the Free Software Foundation; either version 2
  16  * of the License, or (at your option) any later version.
  17  *
  18  * This program is distributed in the hope that it will be useful,
  19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  21  * GNU General Public License for more details.
  22  *
  23  * You should have received a copy of the GNU General Public License
  24  * along with this program; if not, write to the Free Software
  25  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  26  * 02110-1301, USA.
  27  */
  28
  29 #include <linux/module.h>
  30 #include <linux/init.h>
  31 #include <linux/if.h>
  32 #include <linux/if_arp.h>
  33 #include <linux/sockios.h>
  34 #include <linux/delay.h>
  35 #include <asm/uaccess.h>
  36
  37 #include "switch-core.h"
  38 #include "gpio.h"
  39
  40 #ifdef CONFIG_BCM47XX
  41 #include <nvram.h>
  42 #endif
  43
  44 #define DRIVER_NAME "adm6996"
  45 #define DRIVER_VERSION "0.01"
  46
  47 static int eecs = 0;
  48 static int eesk = 0;
  49 static int eedi = 0;
  50 static int eerc = 0;
  51 static int force = 0;
  52
  53 MODULE_AUTHOR("Felix Fietkau <openwrt@nbd.name>");
  54 MODULE_LICENSE("GPL");
  55 module_param(eecs, int, 0);
  56 module_param(eesk, int, 0);
  57 module_param(eedi, int, 0);
  58 module_param(eerc, int, 0);
  59 module_param(force, int, 0);
  60
  61 /* Minimum timing constants */
  62 #define EECK_EDGE_TIME  3   /* 3us - max(adm 2.5us, 93c 1us) */
  63 #define EEDI_SETUP_TIME 1   /* 1us - max(adm 10ns, 93c 400ns) */
  64 #define EECS_SETUP_TIME 1   /* 1us - max(adm no, 93c 200ns) */
  65
  66 /* Handy macros for writing fixed length values */
  67 #define adm_write8(cs, b) { __u8 val = (__u8) (b); adm_write(cs, &val, sizeof(val)*8); }
  68 #define adm_write16(cs, w) { __u16 val = hton16(w); adm_write(cs, (__u8 *)&val, sizeof(val)*8); }
  69 #define adm_write32(cs, i) { uint32 val = hton32(i); adm_write(cs, (__u8 *)&val, sizeof(val)*8); }
  70
  71 #define atoi(str) simple_strtoul(((str != NULL) ? str : ""), NULL, 0)
  72
  73 #ifdef CONFIG_BCM47XX
  74
  75 /* Return gpio pin number assigned to the named pin */
  76 /*
  77 * Variable should be in format:
  78 *
  79 *       gpio<N>=pin_name
  80 *
  81 * 'def_pin' is returned if there is no such variable found.
  82 */
  83 static unsigned int get_gpiopin(char *pin_name, unsigned int def_pin)
  84 {
  85         char name[] = "gpioXXXX";
  86         char val[10];
  87         unsigned int pin;
  88
  89         /* Go thru all possibilities till a match in pin name */
  90         for (pin = 0; pin < 16; pin ++) {
  91                 sprintf(name, "gpio%d", pin);
  92                 if (nvram_getenv(name, val, sizeof(val)) >= 0) {
  93                         if (!strcmp(val, pin_name))
  94                                 return pin;
  95                 }
  96         }
  97         return def_pin;
  98 }
  99 #endif
 100
 101
 102 static void adm_write(int cs, char *buf, unsigned int bits)
 103 {
 104         int i, len = (bits + 7) / 8;
 105         __u8 mask;
 106
 107         gpio_out(eecs, (cs ? eecs : 0));
 108         udelay(EECK_EDGE_TIME);
 109
 110         /* Byte assemble from MSB to LSB */
 111         for (i = 0; i < len; i++) {
 112                 /* Bit bang from MSB to LSB */
 113                 for (mask = 0x80; mask && bits > 0; mask >>= 1, bits --) {
 114                         /* Clock low */
 115                         gpio_out(eesk, 0);
 116                         udelay(EECK_EDGE_TIME);
 117
 118                         /* Output on rising edge */
 119                         gpio_out(eedi, ((mask & buf[i]) ? eedi : 0));
 120                         udelay(EEDI_SETUP_TIME);
 121
 122                         /* Clock high */
 123                         gpio_out(eesk, eesk);
 124                         udelay(EECK_EDGE_TIME);
 125                 }
 126         }
 127
 128         /* Clock low */
 129         gpio_out(eesk, 0);
 130         udelay(EECK_EDGE_TIME);
 131
 132         if (cs)
 133                 gpio_out(eecs, 0);
 134 }
 135
 136
 137 static void adm_read(int cs, char *buf, unsigned int bits)
 138 {
 139         int i, len = (bits + 7) / 8;
 140         __u8 mask;
 141
 142         gpio_out(eecs, (cs ? eecs : 0));
 143         udelay(EECK_EDGE_TIME);
 144
 145         /* Byte assemble from MSB to LSB */
 146         for (i = 0; i < len; i++) {
 147                 __u8 byte;
 148
 149                 /* Bit bang from MSB to LSB */
 150                 for (mask = 0x80, byte = 0; mask && bits > 0; mask >>= 1, bits --) {
 151                         __u8 gp;
 152
 153                         /* Clock low */
 154                         gpio_out(eesk, 0);
 155                         udelay(EECK_EDGE_TIME);
 156
 157                         /* Input on rising edge */
 158                         gp = gpio_in();
 159                         if (gp & eedi)
 160                                 byte |= mask;
 161
 162                         /* Clock high */
 163                         gpio_out(eesk, eesk);
 164                         udelay(EECK_EDGE_TIME);
 165                 }
 166
 167                 *buf++ = byte;
 168         }
 169
 170         /* Clock low */
 171         gpio_out(eesk, 0);
 172         udelay(EECK_EDGE_TIME);
 173
 174         if (cs)
 175                 gpio_out(eecs, 0);
 176 }
 177
 178
 179 /* Enable outputs with specified value to the chip */
 180 static void adm_enout(__u8 pins, __u8 val)
 181 {
 182         /* Prepare GPIO output value */
 183         gpio_out(pins, val);
 184
 185         /* Enable GPIO outputs */
 186         gpio_outen(pins, pins);
 187         udelay(EECK_EDGE_TIME);
 188 }
 189
 190
 191 /* Disable outputs to the chip */
 192 static void adm_disout(__u8 pins)
 193 {
 194         /* Disable GPIO outputs */
 195         gpio_outen(pins, 0);
 196         udelay(EECK_EDGE_TIME);
 197 }
 198
 199
 200 /* Advance clock(s) */
 201 static void adm_adclk(int clocks)
 202 {
 203         int i;
 204         for (i = 0; i < clocks; i++) {
 205                 /* Clock high */
 206                 gpio_out(eesk, eesk);
 207                 udelay(EECK_EDGE_TIME);
 208
 209                 /* Clock low */
 210                 gpio_out(eesk, 0);
 211                 udelay(EECK_EDGE_TIME);
 212         }
 213 }
 214
 215 static __u32 adm_rreg(__u8 table, __u8 addr)
 216 {
 217         /* cmd: 01 10 T DD R RRRRRR */
 218         __u8 bits[6] = {
 219                 0xFF, 0xFF, 0xFF, 0xFF,
 220                 (0x06 << 4) | ((table & 0x01) << 3 | (addr&64)>>6),
 221                 ((addr&63)<<2)
 222         };
 223
 224         __u8 rbits[4];
 225
 226         /* Enable GPIO outputs with all pins to 0 */
 227         adm_enout((__u8)(eecs | eesk | eedi), 0);
 228
 229         adm_write(0, bits, 46);
 230         adm_disout((__u8)(eedi));
 231         adm_adclk(2);
 232         adm_read (0, rbits, 32);
 233
 234         /* Extra clock(s) required per datasheet */
 235         adm_adclk(2);
 236
 237         /* Disable GPIO outputs */
 238         adm_disout((__u8)(eecs | eesk));
 239
 240         if (!table) /* EEPROM has 16-bit registers, but pumps out two registers in one request */
 241                 return (addr & 0x01 ?  (rbits[0]<<8) | rbits[1] : (rbits[2]<<8) | (rbits[3]));
 242         else
 243                 return (rbits[0]<<24) | (rbits[1]<<16) | (rbits[2]<<8) | rbits[3];
 244 }
 245
 246
 247
 248 /* Write chip configuration register */
 249 /* Follow 93c66 timing and chip's min EEPROM timing requirement */
 250 void
 251 adm_wreg(__u8 addr, __u16 val)
 252 {
 253         /* cmd(27bits): sb(1) + opc(01) + addr(bbbbbbbb) + data(bbbbbbbbbbbbbbbb) */
 254         __u8 bits[4] = {
 255                 (0x05 << 5) | (addr >> 3),
 256                 (addr << 5) | (__u8)(val >> 11),
 257                 (__u8)(val >> 3),
 258                 (__u8)(val << 5)
 259         };
 260
 261         /* Enable GPIO outputs with all pins to 0 */
 262         adm_enout((__u8)(eecs | eesk | eedi), 0);
 263
 264         /* Write cmd. Total 27 bits */
 265         adm_write(1, bits, 27);
 266
 267         /* Extra clock(s) required per datasheet */
 268         adm_adclk(2);
 269
 270         /* Disable GPIO outputs */
 271         adm_disout((__u8)(eecs | eesk | eedi));
 272 }
 273
 274
 275 /* Port configuration registers */
 276 static int port_conf[] = { 0x01, 0x03, 0x05, 0x07, 0x08, 0x09 };
 277
 278 /* Bits in VLAN port mapping */
 279 static int vlan_ports[] = { 1 << 0, 1 << 2, 1 << 4, 1 << 6, 1 << 7, 1 << 8 };
 280
 281 static int handle_vlan_port_read(void *driver, char *buf, int nr)
 282 {
 283         int ports, i, c, len = 0;
 284
 285         if ((nr < 0) || (nr > 15))
 286                 return 0;
 287
 288         /* Get VLAN port map */
 289         ports = adm_rreg(0, 0x13 + nr);
 290
 291         for (i = 0; i <= 5; i++) {
 292                 if (ports & vlan_ports[i]) {
 293                         c = adm_rreg(0, port_conf[i]);
 294
 295                         len += sprintf(buf + len, "%d", i);
 296                         if (c & (1 << 4)) {
 297                                 buf[len++] = 't';
 298                                 if (((c & (0xf << 10)) >> 10) == nr)
 299                                         buf[len++] = '*';
 300                         } else if (i == 5)
 301                                 buf[len++] = 'u';
 302
 303                         buf[len++] = '\t';
 304                 }
 305         }
 306         len += sprintf(buf + len, "\n");
 307
 308         return len;
 309 }
 310
 311 static int handle_vlan_port_write(void *driver, char *buf, int nr)
 312 {
 313         int i, cfg, ports;
 314         switch_driver *d = (switch_driver *) driver;
 315         switch_vlan_config *c = switch_parse_vlan(d, buf);
 316
 317         if (c == NULL)
 318                 return -1;
 319
 320         ports = adm_rreg(0, 0x13 + nr);
 321         for (i = 0; i < d->ports; i++) {
 322                 if (c->port & (1 << i)) {
 323                         ports |= vlan_ports[i];
 324
 325                         cfg = adm_rreg(0, port_conf[i]);
 326
 327                         /* Tagging */
 328                         if (c->untag & (1 << i))
 329                                 cfg &= ~(1 << 4);
 330                         else
 331                                 cfg |= (1 << 4);
 332
 333                         if ((c->untag | c->pvid) & (1 << i)) {
 334                                 cfg = (cfg & ~(0xf << 10)) | (nr << 10);
 335                         }
 336
 337                         adm_wreg(port_conf[i], (__u16) cfg);
 338                 } else {
 339                         ports &= ~(vlan_ports[i]);
 340                 }
 341         }
 342         adm_wreg(0x13 + nr, (__u16) ports);
 343
 344         return 0;
 345 }
 346
 347 static int handle_port_enable_read(void *driver, char *buf, int nr)
 348 {
 349         return sprintf(buf, "%d\n", ((adm_rreg(0, port_conf[nr]) & (1 << 5)) ? 0 : 1));
 350 }
 351
 352 static int handle_port_enable_write(void *driver, char *buf, int nr)
 353 {
 354         int reg = adm_rreg(0, port_conf[nr]);
 355
 356         if (buf[0] == '0')
 357                 reg |= (1 << 5);
 358         else if (buf[0] == '1')
 359                 reg &= ~(1 << 5);
 360         else return -1;
 361
 362         adm_wreg(port_conf[nr], (__u16) reg);
 363         return 0;
 364 }
 365
 366 static int handle_port_media_read(void *driver, char *buf, int nr)
 367 {
 368         int len;
 369         int media = 0;
 370         int reg = adm_rreg(0, port_conf[nr]);
 371
 372         if (reg & (1 << 1))
 373                 media |= SWITCH_MEDIA_AUTO;
 374         if (reg & (1 << 2))
 375                 media |= SWITCH_MEDIA_100;
 376         if (reg & (1 << 3))
 377                 media |= SWITCH_MEDIA_FD;
 378
 379         len = switch_print_media(buf, media);
 380         return len + sprintf(buf + len, "\n");
 381 }
 382
 383 static int handle_port_media_write(void *driver, char *buf, int nr)
 384 {
 385         int media = switch_parse_media(buf);
 386         int reg = adm_rreg(0, port_conf[nr]);
 387
 388         if (media < 0)
 389                 return -1;
 390
 391         reg &= ~((1 << 1) | (1 << 2) | (1 << 3));
 392         if (media & SWITCH_MEDIA_AUTO)
 393                 reg |= 1 << 1;
 394         if (media & SWITCH_MEDIA_100)
 395                 reg |= 1 << 2;
 396         if (media & SWITCH_MEDIA_FD)
 397                 reg |= 1 << 3;
 398
 399         adm_wreg(port_conf[nr], reg);
 400
 401         return 0;
 402 }
 403
 404 static int handle_vlan_enable_read(void *driver, char *buf, int nr)
 405 {
 406         return sprintf(buf, "%d\n", ((adm_rreg(0, 0x11) & (1 << 5)) ? 1 : 0));
 407 }
 408
 409 static int handle_vlan_enable_write(void *driver, char *buf, int nr)
 410 {
 411         int reg = adm_rreg(0, 0x11);
 412
 413         if (buf[0] == '1')
 414                 reg |= (1 << 5);
 415         else if (buf[0] == '0')
 416                 reg &= ~(1 << 5);
 417         else return -1;
 418
 419         adm_wreg(0x11, (__u16) reg);
 420         return 0;
 421 }
 422
 423 static int handle_reset(void *driver, char *buf, int nr)
 424 {
 425         int i;
 426         u32 cfg;
 427
 428         /*
 429          * Reset sequence: RC high->low(100ms)->high(30ms)
 430          *
 431          * WAR: Certain boards don't have the correct power on
 432          * reset logic therefore we must explicitly perform the
 433          * sequence in software.
 434          */
 435         if (eerc) {
 436                 /* Keep RC high for at least 20ms */
 437                 adm_enout(eerc, eerc);
 438                 for (i = 0; i < 20; i ++)
 439                         udelay(1000);
 440                 /* Keep RC low for at least 100ms */
 441                 adm_enout(eerc, 0);
 442                 for (i = 0; i < 100; i++)
 443                         udelay(1000);
 444                 /* Set default configuration */
 445                 adm_enout((__u8)(eesk | eedi), eesk);
 446                 /* Keep RC high for at least 30ms */
 447                 adm_enout(eerc, eerc);
 448                 for (i = 0; i < 30; i++)
 449                         udelay(1000);
 450                 /* Leave RC high and disable GPIO outputs */
 451                 adm_disout((__u8)(eecs | eesk | eedi));
 452
 453         }
 454
 455         /* set up initial configuration for cpu port */
 456         cfg = (0x8000 | /* Auto MDIX */
 457               (0xf << 10) | /* PVID */
 458                   (1 << 4) | /* Tagging */
 459                   0xf); /* full duplex, 100Mbps, auto neg, flow ctrl */
 460         adm_wreg(port_conf[5], cfg);
 461
 462         /* vlan mode select register (0x11): vlan on, mac clone */
 463         adm_wreg(0x11, 0xff30);
 464
 465         return 0;
 466 }
 467
 468 static int handle_registers(void *driver, char *buf, int nr)
 469 {
 470         int i, len = 0;
 471
 472         for (i = 0; i <= 0x33; i++) {
 473                 len += sprintf(buf + len, "0x%02x: 0x%04x\n", i, adm_rreg(0, i));
 474         }
 475
 476         return len;
 477 }
 478
 479 static int handle_counters(void *driver, char *buf, int nr)
 480 {
 481         int i, len = 0;
 482
 483         for (i = 0; i <= 0x3c; i++) {
 484                 len += sprintf(buf + len, "0x%02x: 0x%08x\n", i, adm_rreg(1, i));
 485         }
 486
 487         return len;
 488 }
 489
 490 static int detect_adm(void)
 491 {
 492         int ret = 0;
 493
 494 #ifdef CONFIG_BCM47XX
 495         char buf[20];
 496         int boardflags = 0;
 497         int boardnum = 0;
 498
 499         if (nvram_getenv("boardflags", buf, sizeof(buf)) >= 0)
 500                 boardflags = simple_strtoul(buf, NULL, 0);
 501
 502         if (nvram_getenv("boardnum", buf, sizeof(buf)) >= 0)
 503                 boardnum = simple_strtoul(buf, NULL, 0);
 504
 505         if ((boardnum == 44) && (boardflags == 0x0388)) {  /* Trendware TEW-411BRP+ */
 506                 ret = 1;
 507
 508                 eecs = get_gpiopin("adm_eecs", 2);
 509                 eesk = get_gpiopin("adm_eesk", 3);
 510                 eedi = get_gpiopin("adm_eedi", 4);
 511                 eerc = get_gpiopin("adm_rc", 5);
 512
 513         } else if ((boardflags & 0x80) || force) {
 514                 ret = 1;
 515
 516                 eecs = get_gpiopin("adm_eecs", 2);
 517                 eesk = get_gpiopin("adm_eesk", 3);
 518                 eedi = get_gpiopin("adm_eedi", 4);
 519                 eerc = get_gpiopin("adm_rc", 0);
 520
 521         } else if (nvram_getenv("boardtype", buf, sizeof(buf)) >= 0) {
 522                 if (strcmp(buf, "bcm94710dev") == 0) {
 523                         if (nvram_getenv("boardnum", buf, sizeof(buf)) >= 0) {
 524                                 if (strncmp(buf, "42", 2) == 0) {
 525                                         /* WRT54G v1.1 hack */
 526                                         eecs = 2;
 527                                         eesk = 3;
 528                                         eedi = 5;
 529
 530                                         ret = 1;
 531                                 }
 532                         }
 533                 }
 534         }
 535
 536         if (eecs)
 537                 eecs = (1 << eecs);
 538         if (eesk)
 539                 eesk = (1 << eesk);
 540         if (eedi)
 541                 eedi = (1 << eedi);
 542         if (eerc)
 543                 eerc = (1 << eerc);
 544 #else
 545         ret = 1;
 546 #endif
 547
 548         return ret;
 549 }
 550
 551 static int __init adm_init(void)
 552 {
 553         switch_config cfg[] = {
 554                 {"registers", handle_registers, NULL},
 555                 {"counters", handle_counters, NULL},
 556                 {"reset", NULL, handle_reset},
 557                 {"enable_vlan", handle_vlan_enable_read, handle_vlan_enable_write},
 558                 {NULL, NULL, NULL}
 559         };
 560         switch_config port[] = {
 561                 {"enable", handle_port_enable_read, handle_port_enable_write},
 562                 {"media", handle_port_media_read, handle_port_media_write},
 563                 {NULL, NULL, NULL}
 564         };
 565         switch_config vlan[] = {
 566                 {"ports", handle_vlan_port_read, handle_vlan_port_write},
 567                 {NULL, NULL, NULL}
 568         };
 569         switch_driver driver = {
 570                 name: DRIVER_NAME,
 571                 version: DRIVER_VERSION,
 572                 interface: "eth0",
 573                 ports: 6,
 574                 cpuport: 5,
 575                 vlans: 16,
 576                 driver_handlers: cfg,
 577                 port_handlers: port,
 578                 vlan_handlers: vlan,
 579         };
 580
 581         if (!detect_adm())
 582                 return -ENODEV;
 583
 584         return switch_register_driver(&driver);
 585 }
 586
 587 static void __exit adm_exit(void)
 588 {
 589         switch_unregister_driver(DRIVER_NAME);
 590 }
 591
 592
 593 module_init(adm_init);
 594 module_exit(adm_exit);