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