?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Initial Changes for WNDR3400v2 (WIP)
[tomato.git] / release / src / router / shared / led.c
blobf36dba8befa9aa77d1364b94b25e8e5ee6364303
1 /*
2
3 Tomato Firmware
4 Copyright (C) 2006-2009 Jonathan Zarate
5
6 */
7 #include <stdio.h>
8 #include <stdlib.h>
9 #include <string.h>
10 #include <unistd.h>
11 #include <syslog.h>
12 #include <sys/types.h>
13 #include <sys/stat.h>
14 #include <fcntl.h>
15 #include <bcmnvram.h>
16
17 #include "utils.h"
18 #include "shutils.h"
19 #include "shared.h"
20
21
22 const char *led_names[] = { "wlan", "diag", "white", "amber", "dmz", "aoss", "bridge", "usb", "5g"};
23 const char *led_modes[] = { "Off", "On", "Blink", "Probe"};
24
25 #ifdef LINUX26
26 #define GPIO_IOCTL
27 #endif
28
29 // --- move begin ---
30 #ifdef GPIO_IOCTL
31
32 #include <sys/ioctl.h>
33 #include <linux_gpio.h>
34
35 static int _gpio_ioctl(int f, int gpioreg, unsigned int mask, unsigned int val)
36 {
37 struct gpio_ioctl gpio;
38
39 gpio.val = val;
40 gpio.mask = mask;
41
42 if (ioctl(f, gpioreg, &gpio) < 0) {
43 _dprintf("Invalid gpioreg %d\n", gpioreg);
44 return -1;
45 }
46 return (gpio.val);
47 }
48
49 static int _gpio_open()
50 {
51 int f = open("/dev/gpio", O_RDWR);
52 if (f < 0)
53 _dprintf ("Failed to open /dev/gpio\n");
54 return f;
55 }
56
57 int gpio_open(uint32_t mask)
58 {
59 uint32_t bit;
60 int i;
61 int f = _gpio_open();
62
63 if ((f >= 0) && mask) {
64 for (i = 0; i <= 15; i++) {
65 bit = 1 << i;
66 if ((mask & bit) == bit) {
67 _gpio_ioctl(f, GPIO_IOC_RESERVE, bit, bit);
68 _gpio_ioctl(f, GPIO_IOC_OUTEN, bit, 0);
69 }
70 }
71 close(f);
72 f = _gpio_open();
73 }
74
75 return f;
76 }
77
78 void gpio_write(uint32_t bit, int en)
79 {
80 int f;
81
82 if ((f = gpio_open(0)) < 0) return;
83
84 _gpio_ioctl(f, GPIO_IOC_RESERVE, bit, bit);
85 _gpio_ioctl(f, GPIO_IOC_OUTEN, bit, bit);
86 _gpio_ioctl(f, GPIO_IOC_OUT, bit, en ? bit : 0);
87 close(f);
88 }
89
90 uint32_t _gpio_read(int f)
91 {
92 uint32_t r;
93 // r = _gpio_ioctl(f, GPIO_IOC_IN, 0xFFFF, 0);
94 r = _gpio_ioctl(f, GPIO_IOC_IN, 0x07FF, 0);
95 if (r < 0) r = ~0;
96 return r;
97 }
98
99 uint32_t gpio_read(void)
100 {
101 int f;
102 uint32_t r;
103
104 if ((f = gpio_open(0)) < 0) return ~0;
105 r = _gpio_read(f);
106 close(f);
107 return r;
108 }
109
110 #else
111
112 int gpio_open(uint32_t mask)
113 {
114 int f = open(DEV_GPIO(in), O_RDONLY|O_SYNC);
115 if (f < 0)
116 _dprintf ("Failed to open %s\n", DEV_GPIO(in));
117 return f;
118 }
119
120 void gpio_write(uint32_t bit, int en)
121 {
122 int f;
123 uint32_t r;
124
125 if ((f = open(DEV_GPIO(control), O_RDWR)) < 0) return;
126 read(f, &r, sizeof(r));
127 r &= ~bit;
128 write(f, &r, sizeof(r));
129 close(f);
130
131 if ((f = open(DEV_GPIO(outen), O_RDWR)) < 0) return;
132 read(f, &r, sizeof(r));
133 r |= bit;
134 write(f, &r, sizeof(r));
135 close(f);
136
137 if ((f = open(DEV_GPIO(out), O_RDWR)) < 0) return;
138 read(f, &r, sizeof(r));
139 if (en) r |= bit;
140 else r &= ~bit;
141 write(f, &r, sizeof(r));
142 close(f);
143 }
144
145 uint32_t _gpio_read(int f)
146 {
147 uint32_t v;
148 return (read(f, &v, sizeof(v)) == sizeof(v)) ? v : ~0;
149 }
150
151 uint32_t gpio_read(void)
152 {
153 int f;
154 uint32_t r;
155
156 if ((f = open(DEV_GPIO(in), O_RDONLY)) < 0) return ~0;
157 r = _gpio_read(f);
158 close(f);
159 return r;
160 }
161
162 #endif
163
164 int nvget_gpio(const char *name, int *gpio, int *inv)
165 {
166 char *p;
167 uint32_t n;
168
169 if (((p = nvram_get(name)) != NULL) && (*p)) {
170 n = strtoul(p, NULL, 0);
171 if ((n & 0xFFFFFF70) == 0) {
172 *gpio = (n & 15);
173 *inv = ((n & 0x80) != 0);
174 return 1;
175 }
176 }
177 return 0;
178 }
179 // --- move end ---
180
181 // Routine to write to shift register
182 // Note that the controls are active low, but input as high = on
183 void gpio_write_shiftregister(unsigned int led_status, int clk, int data, int max_shifts)
184 {
185 int i;
186
187 gpio_write(1 << data, 1); /* set data to 1 to start (disable) */
188 gpio_write(1 << clk, 0); /* and clear clock ... */
189
190 for (i = max_shifts; i >= 0; i--) {
191 if (led_status & (1 << i))
192 gpio_write(1 << data, 0); /* on, pull low (active low) */
193 else
194 gpio_write(1 << data, 1); /* off, pull high (active low) */
195
196 gpio_write(1 << clk, 1); /* pull high to trigger */
197 gpio_write(1 << clk, 0); /* reset to low -> finish clock cycle*/
198 }
199
200 }
201
202 /* strBits: convert binary value to string (binary file representation) */
203 char strConvert[33];
204 char * strBits(int input, int binarySize)
205 {
206
207 int i;
208
209 if (binarySize > 0) {
210
211 if (binarySize > 32)
212 binarySize = 32;
213
214 for(i = 0; i < binarySize ; i++) {
215 if (input & (1 << ((binarySize-1)-i)))
216 strConvert[i] = '1';
217 else
218 strConvert[i] = '0';
219 }
220
221 strConvert[binarySize] = '\0';
222 return (char *)strConvert;
223
224 } else
225 return (char *)NULL;
226 }
227
228 // All bit positions start at zero, given shifts (and shift logic). 255 means a particular LED is not avaiable / accessible
229 int do_led(int which, int mode)
230 {
231 // WLAN DIAG WHITE AMBER DMZ AOSS BRIDG MYST/USB 5G
232 // ----- ----- ----- ----- ----- ----- ----- ----- --
233 static int wrt54g[] = { 255, 1, 2, 3, 7, 255, 255, 255, 255};
234 static int wrtsl[] = { 255, 1, 5, 7, 0, 255, 255, 255, 255};
235 static int whrg54[] = { 2, 7, 255, 255, 255, 6, 1, 3 , 255};
236 static int wbr2g54[] = { 255, -1, 255, 255, 255, -6, 255, 255, 255};
237 static int wzrg54[] = { 2, 7, 255, 255, 255, 6, 255, 255, 255};
238 static int wr850g1[] = { 7, 3, 255, 255, 255, 255, 255, 255, 255};
239 static int wr850g2[] = { 0, 1, 255, 255, 255, 255, 255, 255, 255};
240 static int wtr54gs[] = { 1, -1, 255, 255, 255, 255, 255, 255, 255};
241 static int dir320[] = { -99, 1, 4, 3, 255, 255, 255, -5, 255};
242 static int h618b[] = { 255, -1, 255, 255, 255, -5, -3, -4, 255};
243 static int wl1600gl[] = { 1, -5, 0, 255, 255, 2, 255, 255, 255};
244 static int wrt310nv1[] = { 255, 1, 9, 3, 255, 255, 255, 255, 255};
245 static int wrt160nv1[] = { 255, 1, 5, 3, 255, 255, 255, 255, 255};
246 #ifdef CONFIG_BCMWL5
247 static int wnr3500[] = { 255, 255, 2, 255, 255, -1, 255, 255, 255};
248 static int wnr2000v2[] = { 255, 255, 255, 255, 255, -7, 255, 255, 255};
249 static int wndr4000[] = { 3, 1, 0, 1, 255, 7, 255, 5, 4};
250 static int wndr3400[] = { -9, -7, -3, -7, 255, 255, 255, 2, -99}; // Note: 5 = Switch, 4 = Reset button, 8 = SES button
251 static int f7d[] = { 255, 255, 255, 255, 12, 13, 255, 14, 255};
252 static int wrt160nv3[] = { 255, 1, 4, 2, 255, 255, 255, 255, 255};
253 static int e900[] = { 255, -6, 8, 255, 255, 255, 255, 255, 255};
254 static int e1000v2[] = { 255, -6, 8, 7, 255, 255, 255, 255, 255};
255 static int e3200[] = { 255, -3, 255, 255, 255, 255, 255, 255, 255};
256 static int wrt320n[] = { 255, 2, 3, 4, 255, 255, 255, 255, 255};
257 static int wrt610nv2[] = { 255, 5, 3, 0, 255, 255, 255, -7, 255};
258 static int e4200[] = { 255, 5, -3, 255, 255, 255, 255, 255, 255};
259 static int rtn10u[] = { 255, 255, 255, 255, 255, -7, 255, -8, 255};
260 static int rtn10p[] = { 255, -6, 255, 255, 255, -7, 255, 255, 255};
261 static int rtn12b1[] = { -5, 255, 255, 255, 255, 255, 255, 225, 255};
262 static int rtn15u[] = { 1, 255, 3, 255, 255, 255, 255, -9, 255};
263 static int rtn53[] = { 0, -17, 255, 255, 255, 255, 255, 255, 255};
264 static int l600n[] = { 255, 255, 255, 255, 255, -7, 255, -8, 255};
265 static int dir620c1[] = { -6, -8, 255, 255, 255, -7, 255, 255, 255};
266 static int rtn66u[] = { 255, -12, 255, 255, 255, 255, 255, 15, 13};
267 static int w1800r[] = { 255, -13, 255, 255, 255, 255, 255, -12, -5};
268 static int d1800h[] = { -12, -13, 8, 255, 255, -10, 255, 15, 11};
269 static int tdn6[] = { 255, -6, 8, 255, 255, 255, 255, 255, 255};
270 // WLAN DIAG WHITE AMBER DMZ AOSS BRIDG MYST/USB 5G
271
272 FILE *fileExtGPIOstatus; // For WNDR4000, keep track of extended bit status (shift register), as cannot read from HW!
273 unsigned int intExtendedLEDStatus; // Status of Extended LED's (shift register on WNDR4000) ... and WNDR3700v3, it's the same!
274 #endif
275
276 char s[16];
277 int n;
278 int b = 255, c = 255;
279 int ret = 255;
280
281 if ((which < 0) || (which >= LED_COUNT)) return ret;
282
283 switch (nvram_match("led_override", "1") ? MODEL_UNKNOWN : get_model()) {
284 case MODEL_WRT54G:
285 if (check_hw_type() == HW_BCM4702) {
286 // G v1.x
287 if ((which != LED_DIAG) && (which != LED_DMZ)) return ret;
288 b = (which == LED_DMZ) ? 1 : 4;
289 if (mode != LED_PROBE) {
290 if (f_read_string("/proc/sys/diag", s, sizeof(s)) > 0) {
291 n = atoi(s);
292 sprintf(s, "%u", mode ? (n | b) : (n & ~b));
293 f_write_string("/proc/sys/diag", s, 0, 0);
294 }
295 }
296 return b;
297 }
298 switch (which) {
299 case LED_AMBER:
300 case LED_WHITE:
301 if (!supports(SUP_WHAM_LED)) return ret;
302 break;
303 }
304 b = wrt54g[which];
305 break;
306 case MODEL_WTR54GS:
307 b = wtr54gs[which];
308 break;
309 case MODEL_WRTSL54GS:
310 b = wrtsl[which];
311 break;
312 case MODEL_WHRG54S:
313 case MODEL_WHRHPG54:
314 case MODEL_WHRG125:
315 b = whrg54[which];
316 break;
317 case MODEL_WZRG54:
318 case MODEL_WZRHPG54:
319 case MODEL_WZRRSG54:
320 case MODEL_WZRRSG54HP:
321 case MODEL_WVRG54NF:
322 case MODEL_WHR2A54G54:
323 case MODEL_WHR3AG54:
324 case MODEL_WZRG108:
325 b = wzrg54[which];
326 break;
327 /*
328 case MODEL_WHR2A54G54:
329 if (which != LED_DIAG) return ret;
330 b = 7;
331 break;
332 */
333 case MODEL_WBRG54:
334 if (which != LED_DIAG) return ret;
335 b = 7;
336 break;
337 case MODEL_WBR2G54:
338 b = wbr2g54[which];
339 break;
340 case MODEL_WR850GV1:
341 b = wr850g1[which];
342 break;
343 case MODEL_WR850GV2:
344 case MODEL_WR100:
345 b = wr850g2[which];
346 break;
347 case MODEL_WL500GP:
348 if (which != LED_DIAG) return ret;
349 b = -1; // power light
350 break;
351 case MODEL_WL500W:
352 if (which != LED_DIAG) return ret;
353 b = -5; // power light
354 break;
355 case MODEL_DIR320:
356 b = dir320[which];
357 break;
358 case MODEL_H618B:
359 b = h618b[which];
360 break;
361 case MODEL_WL1600GL:
362 b = wl1600gl[which];
363 break;
364 case MODEL_WL500GPv2:
365 case MODEL_WL500GD:
366 case MODEL_WL520GU:
367 case MODEL_WL330GE:
368 if (which != LED_DIAG) return ret;
369 b = -99; // Invert power light as diag indicator
370 break;
371 #ifdef CONFIG_BCMWL5
372 case MODEL_RTN12:
373 if (which != LED_DIAG) return ret;
374 b = -2; // power light
375 break;
376 case MODEL_RTN10:
377 case MODEL_RTN16:
378 if (which != LED_DIAG) return ret;
379 b = -1; // power light
380 break;
381 case MODEL_RTN15U:
382 b = rtn15u[which];
383 break;
384 case MODEL_RTN53:
385 case MODEL_RTN53A1:
386 b = rtn53[which];
387 break;
388 case MODEL_RTN66U:
389 b = rtn66u[which];
390 break;
391 case MODEL_W1800R:
392 b = w1800r[which];
393 break;
394 case MODEL_D1800H:
395 if (which == LED_DIAG) {
396 // power led gpio: 0x02 - white, 0x13 - red
397 b = (mode) ? 13 : 2;
398 c = (mode) ? 2 : 13;
399 } else
400 b = d1800h[which];
401 break;
402 case MODEL_WNR3500L:
403 case MODEL_WNR3500LV2:
404 if (which == LED_DIAG) {
405 // power led gpio: 0x03 - green, 0x07 - amber
406 b = (mode) ? 7 : 3;
407 c = (mode) ? 3 : 7;
408 } else
409 b = wnr3500[which];
410 break;
411 case MODEL_WNR2000v2:
412 if (which == LED_DIAG) {
413 // power led gpio: 0x01 - green, 0x02 - amber
414 b = (mode) ? 2 : 1;
415 c = (mode) ? 1 : 2;
416 } else
417 b = wnr2000v2[which];
418 break;
419 case MODEL_WNDR4000:
420 case MODEL_WNDR3700v3:
421 // Special Case, shift register control ... so write accordingly. Syslog below for debugging, turn back on if needed.
422 b = wndr4000[which];
423 //syslog(LOG_INFO, "WNDR4000 Shift Register (do_led): Bit Name = %s, which = %d, b = %d, Mode = %s\n", led_names[which], which, b, led_modes[mode]);
424 if ((mode == LED_ON) || (mode == LED_OFF)) {
425 if (b < 16) {
426 // Read bit-mask from file, for tracking / updates (as this process is called clean each LED update, so cannot use static variable!)
427 if (fileExtGPIOstatus = fopen("/tmp/.ext_led_value", "rb")) {
428 fscanf(fileExtGPIOstatus, "Shift Register Status: 0x%x\n", &intExtendedLEDStatus);
429 fclose(fileExtGPIOstatus);
430 //syslog(LOG_INFO, "WNDR4000 Shift Register (do_led): Read Shift Register status from file, intExtendedLEDStatus = %s\n", strBits(intExtendedLEDStatus, 8));
431 } else {
432 // Read Error (tracking file) - set all LED's to off
433 syslog(LOG_INFO, "WNDR4000 Shift Register (do_led): Error Reading /tmp/.ext_led_value, set state to all OFF\n");
434 intExtendedLEDStatus = 0x00;
435 }
436
437 if (mode == LED_ON) {
438 // Bitwise OR, turn corresponding bit on
439 intExtendedLEDStatus |= (1 << b);
440 //syslog(LOG_INFO, "WNDR4000 Shift Register (do_led): Mode = LED_ON (%d), Bitwise OR = %s\n", mode, strBits((1 << b), 8));
441 } else {
442 // Bitwise AND, with bitwise inverted shift ... so turn bit off
443 intExtendedLEDStatus &= (~(1 << b));
444 //syslog(LOG_INFO, "WNDR4000 Shift Register (do_led): Mode = LED_OFF (%d), Bitwise AND = %s\n", mode, strBits((~(1 << b)), 8));
445 }
446
447 // And write to LEDs (Shift Register)
448 //syslog(LOG_INFO, "WNDR4000 Shift Register (do_led): Writing to Shift Register, intExtendedLEDStatus = %s\n", strBits(intExtendedLEDStatus, 8));
449 gpio_write_shiftregister(intExtendedLEDStatus, 7, 6, 7);
450 // Write bit-mask to file, for tracking / updates (as this process is called clean each LED update, so cannot use static variable!)
451 if (fileExtGPIOstatus = fopen("/tmp/.ext_led_value", "wb")) {
452 fprintf(fileExtGPIOstatus, "Shift Register Status: 0x%x\n", intExtendedLEDStatus);
453 fprintf(fileExtGPIOstatus, "Shift Register Status: 0b%s\n", strBits(intExtendedLEDStatus, 8));
454 fclose(fileExtGPIOstatus);
455 }
456 }
457 }
458 // Return GPIO "pin" (shift register location)
459 return b;
460 break;
461 case MODEL_WNDR3400:
462 case MODEL_WNDR3400v2:
463 b = wndr3400[which];
464 break;
465 case MODEL_F7D3301:
466 case MODEL_F7D3302:
467 case MODEL_F7D4301:
468 case MODEL_F7D4302:
469 case MODEL_F5D8235v3:
470 if (which == LED_DIAG) {
471 // power led gpio: 10 - green, 11 - red
472 b = (mode) ? 11 : -10;
473 c = (mode) ? -10 : 11;
474 } else
475 b = f7d[which];
476 break;
477 case MODEL_E1000v2:
478 b = e1000v2[which];
479 break;
480 case MODEL_E900:
481 case MODEL_E1500:
482 case MODEL_E1550:
483 case MODEL_E2500:
484 b = e900[which];
485 break;
486 case MODEL_E3200:
487 b = e3200[which];
488 break;
489 case MODEL_WRT160Nv3:
490 b = wrt160nv3[which];
491 break;
492 case MODEL_WRT320N:
493 b = wrt320n[which];
494 break;
495 case MODEL_WRT610Nv2:
496 b = wrt610nv2[which];
497 break;
498 case MODEL_E4200:
499 b = e4200[which];
500 break;
501 case MODEL_RTN10U:
502 b = rtn10u[which];
503 break;
504 case MODEL_RTN10P:
505 b = rtn10p[which];
506 break;
507 case MODEL_RTN12B1:
508 b = rtn12b1[which];
509 break;
510 case MODEL_L600N:
511 b = l600n[which];
512 break;
513 case MODEL_DIR620C1:
514 b = dir620c1[which];
515 case MODEL_TDN60: //bwq518
516 case MODEL_TDN6:
517 b = tdn6[which];
518 break;
519 #endif
520 /*
521 case MODEL_RT390W:
522 break;
523 */
524 case MODEL_MN700:
525 if (which != LED_DIAG) return ret;
526 b = 6;
527 break;
528 case MODEL_WLA2G54L:
529 if (which != LED_DIAG) return ret;
530 b = 1;
531 break;
532 case MODEL_WRT300N:
533 if (which != LED_DIAG) return ret;
534 b = 1;
535 break;
536 case MODEL_WRT310Nv1:
537 b = wrt310nv1[which];
538 break;
539 case MODEL_WRT160Nv1:
540 b = wrt160nv1[which];
541 break;
542 default:
543 sprintf(s, "led_%s", led_names[which]);
544 if (nvget_gpio(s, &b, &n)) {
545 if ((mode != LED_PROBE) && (n)) mode = !mode;
546 ret = (n) ? b : ((b) ? -b : -99);
547 goto SET;
548 }
549 return ret;
550 }
551
552 ret = b;
553 if (b < 0) {
554 if (b == -99) b = 0; // -0 substitute
555 else b = -b;
556 }
557 else if (mode != LED_PROBE) {
558 mode = !mode;
559 }
560
561 SET:
562 if (b < 16) {
563 if (mode != LED_PROBE) {
564 gpio_write(1 << b, mode);
565
566 if (c < 0) {
567 if (c == -99) c = 0;
568 else c = -c;
569 }
570 else mode = !mode;
571 if (c < 16) gpio_write(1 << c, mode);
572 }
573 }
574
575 return ret;
576 }
Tomato firmware and modifications.