release/src/router/shared/led.c

   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 <sys/types.h>
  12 #include <sys/stat.h>
  13 #include <fcntl.h>
  14 #include <bcmnvram.h>
  15
  16 #include "utils.h"
  17 #include "shutils.h"
  18 #include "shared.h"
  19
  20
  21 const char *led_names[] = { "wlan", "diag", "white", "amber", "dmz", "aoss", "bridge", "usb", "5g"};
  22
  23 #ifdef LINUX26
  24 #define GPIO_IOCTL
  25 #endif
  26
  27 // --- move begin ---
  28 #ifdef GPIO_IOCTL
  29
  30 #include <sys/ioctl.h>
  31 #include <linux_gpio.h>
  32
  33 static int _gpio_ioctl(int f, int gpioreg, unsigned int mask, unsigned int val)
  34 {
  35         struct gpio_ioctl gpio;
  36
  37         gpio.val = val;
  38         gpio.mask = mask;
  39
  40         if (ioctl(f, gpioreg, &gpio) < 0) {
  41                 _dprintf("Invalid gpioreg %d\n", gpioreg);
  42                 return -1;
  43         }
  44         return (gpio.val);
  45 }
  46
  47 static int _gpio_open()
  48 {
  49         int f = open("/dev/gpio", O_RDWR);
  50         if (f < 0)
  51                 _dprintf ("Failed to open /dev/gpio\n");
  52         return f;
  53 }
  54
  55 int gpio_open(uint32_t mask)
  56 {
  57         uint32_t bit;
  58         int i;
  59         int f = _gpio_open();
  60
  61         if ((f >= 0) && mask) {
  62                 for (i = 0; i <= 15; i++) {
  63                         bit = 1 << i;
  64                         if ((mask & bit) == bit) {
  65                                 _gpio_ioctl(f, GPIO_IOC_RESERVE, bit, bit);
  66                                 _gpio_ioctl(f, GPIO_IOC_OUTEN, bit, 0);
  67                         }
  68                 }
  69                 close(f);
  70                 f = _gpio_open();
  71         }
  72
  73         return f;
  74 }
  75
  76 void gpio_write(uint32_t bit, int en)
  77 {
  78         int f;
  79
  80         if ((f = gpio_open(0)) < 0) return;
  81
  82         _gpio_ioctl(f, GPIO_IOC_RESERVE, bit, bit);
  83         _gpio_ioctl(f, GPIO_IOC_OUTEN, bit, bit);
  84         _gpio_ioctl(f, GPIO_IOC_OUT, bit, en ? bit : 0);
  85         close(f);
  86 }
  87
  88 uint32_t _gpio_read(int f)
  89 {
  90         uint32_t r;
  91 //      r = _gpio_ioctl(f, GPIO_IOC_IN, 0xFFFF, 0);
  92         r = _gpio_ioctl(f, GPIO_IOC_IN, 0x07FF, 0);
  93         if (r < 0) r = ~0;
  94         return r;
  95 }
  96
  97 uint32_t gpio_read(void)
  98 {
  99         int f;
 100         uint32_t r;
 101
 102         if ((f = gpio_open(0)) < 0) return ~0;
 103         r = _gpio_read(f);
 104         close(f);
 105         return r;
 106 }
 107
 108 #else
 109
 110 int gpio_open(uint32_t mask)
 111 {
 112         int f = open(DEV_GPIO(in), O_RDONLY|O_SYNC);
 113         if (f < 0)
 114                 _dprintf ("Failed to open %s\n", DEV_GPIO(in));
 115         return f;
 116 }
 117
 118 void gpio_write(uint32_t bit, int en)
 119 {
 120         int f;
 121         uint32_t r;
 122
 123         if ((f = open(DEV_GPIO(control), O_RDWR)) < 0) return;
 124         read(f, &r, sizeof(r));
 125         r &= ~bit;
 126         write(f, &r, sizeof(r));
 127         close(f);
 128
 129         if ((f = open(DEV_GPIO(outen), O_RDWR)) < 0) return;
 130         read(f, &r, sizeof(r));
 131         r |= bit;
 132         write(f, &r, sizeof(r));
 133         close(f);
 134
 135         if ((f = open(DEV_GPIO(out), O_RDWR)) < 0) return;
 136         read(f, &r, sizeof(r));
 137         if (en) r |= bit;
 138                 else r &= ~bit;
 139         write(f, &r, sizeof(r));
 140         close(f);
 141 }
 142
 143 uint32_t _gpio_read(int f)
 144 {
 145         uint32_t v;
 146         return (read(f, &v, sizeof(v)) == sizeof(v)) ? v : ~0;
 147 }
 148
 149 uint32_t gpio_read(void)
 150 {
 151         int f;
 152         uint32_t r;
 153
 154         if ((f = open(DEV_GPIO(in), O_RDONLY)) < 0) return ~0;
 155         r = _gpio_read(f);
 156         close(f);
 157         return r;
 158 }
 159
 160 #endif
 161
 162 int nvget_gpio(const char *name, int *gpio, int *inv)
 163 {
 164         char *p;
 165         uint32_t n;
 166
 167         if (((p = nvram_get(name)) != NULL) && (*p)) {
 168                 n = strtoul(p, NULL, 0);
 169                 if ((n & 0xFFFFFF70) == 0) {
 170                         *gpio = (n & 15);
 171                         *inv = ((n & 0x80) != 0);
 172                         return 1;
 173                 }
 174         }
 175         return 0;
 176 }
 177 // --- move end ---
 178
 179
 180 int do_led(int which, int mode)
 181 {
 182 //                                  WLAN  DIAG  WHITE AMBER DMZ   AOSS  BRIDG MYST/USB 5G
 183 //                                  ----- ----- ----- ----- ----- ----- ----- -----    --
 184         static int wrt54g[]     = { 255,  1,    2,    3,    7,    255,  255,  255,    255};
 185         static int wrtsl[]      = { 255,  1,    5,    7,    0,    255,  255,  255,    255};
 186         static int whrg54[]     = { 2,    7,    255,  255,  255,  6,    1,    3  ,    255};
 187         static int wbr2g54[]    = { 255,  -1,   255,  255,  255,  -6,   255,  255,    255};
 188         static int wzrg54[]     = { 2,    7,    255,  255,  255,  6,    255,  255,    255};
 189         static int wr850g1[]    = { 7,    3,    255,  255,  255,  255,  255,  255,    255};
 190         static int wr850g2[]    = { 0,    1,    255,  255,  255,  255,  255,  255,    255};
 191         static int wtr54gs[]    = { 1,    -1,   255,  255,  255,  255,  255,  255,    255};
 192         static int dir320[]     = { -99,   1,     4,    3,  255,  255,  255,   -5,    255};
 193         static int h618b[]      = { 255,  -1,   255,  255,  255,   -5,   -3,   -4,    255};
 194         static int wl1600gl[]   = { 1,    -5,     0,  255,  255,  2,    255,  255,    255};
 195         static int wrt310nv1[]  = { 255,   1,     9,    3,  255,  255,  255,  255,    255};
 196         static int wrt160nv1[]  = { 255,   1,     5,    3,  255,  255,  255,  255,    255};
 197 #ifdef CONFIG_BCMWL5
 198         static int wnr3500[]    = { 255, 255,     2,  255,  255,   -1,  255,  255,    255};
 199         static int wnr2000v2[]  = { 255, 255,   255,  255,  255,   -7,  255,  255,    255};
 200         static int f7d[]        = { 255, 255,   255,  255,   12,   13,  255,   14,    255};
 201         static int wrt160nv3[]  = { 255,   1,     4,    2,  255,  255,  255,  255,    255};
 202         static int e900[]       = { 255,  -6,     8,  255,  255,  255,  255,  255,    255};
 203         static int e1000v2[]    = { 255,  -6,     8,    7,  255,  255,  255,  255,    255};
 204         static int e3200[]      = { 255,  -3,   255,  255,  255,  255,  255,  255,    255};
 205         static int wrt320n[]    = { 255,   2,     3,    4,  255,  255,  255,  255,    255};
 206         static int wrt610nv2[]  = { 255,   5,     3,    0,  255,  255,  255,   -7,    255};
 207         static int e4200[]      = { 255,   5,    -3,  255,  255,  255,  255,  255,    255};
 208         static int rtn10u[]     = { 255, 255,   255,  255,  255,   -7,  255,   -8,    255};
 209         static int rtn10p[]     = { 255,  -6,   255,  255,  255,   -7,  255,  255,    255};
 210         static int rtn12b1[]    = {  -5, 255,   255,  255,  255,  255,  255,  225,    255};
 211         static int rtn15u[]     = {   1, 255,     3,  255,  255,  255,  255,   -9,    255};
 212         static int rtn53[]      = {   0, -17,   255,  255,  255,  255,  255,  255,    255};
 213         static int l600n[]      = { 255, 255,   255,  255,  255,   -7,  255,   -8,    255};
 214         static int dir620c1[]   = {  -6,  -8,   255,  255,  255,   -7,  255,  255,    255};
 215         static int rtn66u[]     = { 255, -12,   255,  255,  255,  255,  255,   15,     13};
 216         static int w1800r[]     = { 255, -13,   255,  255,  255,  255,  255,  -12,     -5};
 217 #endif
 218
 219         char s[16];
 220         int n;
 221         int b = 255, c = 255;
 222         int ret = 255;
 223
 224         if ((which < 0) || (which >= LED_COUNT)) return ret;
 225
 226         switch (nvram_match("led_override", "1") ? MODEL_UNKNOWN : get_model()) {
 227         case MODEL_WRT54G:
 228                 if (check_hw_type() == HW_BCM4702) {
 229                         // G v1.x
 230                         if ((which != LED_DIAG) && (which != LED_DMZ)) return ret;
 231                         b = (which == LED_DMZ) ? 1 : 4;
 232                         if (mode != LED_PROBE) {
 233                                 if (f_read_string("/proc/sys/diag", s, sizeof(s)) > 0) {
 234                                         n = atoi(s);
 235                                         sprintf(s, "%u", mode ? (n | b) : (n & ~b));
 236                                         f_write_string("/proc/sys/diag", s, 0, 0);
 237                                 }
 238                         }
 239                         return b;
 240                 }
 241                 switch (which) {
 242                 case LED_AMBER:
 243                 case LED_WHITE:
 244                         if (!supports(SUP_WHAM_LED)) return ret;
 245                         break;
 246                 }
 247                 b = wrt54g[which];
 248                 break;
 249         case MODEL_WTR54GS:
 250                 b = wtr54gs[which];
 251                 break;
 252         case MODEL_WRTSL54GS:
 253                 b = wrtsl[which];
 254                 break;
 255         case MODEL_WHRG54S:
 256         case MODEL_WHRHPG54:
 257         case MODEL_WHRG125:
 258                 b = whrg54[which];
 259                 break;
 260         case MODEL_WZRG54:
 261         case MODEL_WZRHPG54:
 262         case MODEL_WZRRSG54:
 263         case MODEL_WZRRSG54HP:
 264         case MODEL_WVRG54NF:
 265         case MODEL_WHR2A54G54:
 266         case MODEL_WHR3AG54:
 267         case MODEL_WZRG108:
 268                 b = wzrg54[which];
 269                 break;
 270 /*
 271         case MODEL_WHR2A54G54:
 272                 if (which != LED_DIAG) return ret;
 273                 b = 7;
 274                 break;
 275 */
 276         case MODEL_WBRG54:
 277                 if (which != LED_DIAG) return ret;
 278                 b = 7;
 279                 break;
 280         case MODEL_WBR2G54:
 281                 b = wbr2g54[which];
 282                 break;
 283         case MODEL_WR850GV1:
 284                 b = wr850g1[which];
 285                 break;
 286         case MODEL_WR850GV2:
 287         case MODEL_WR100:
 288                 b = wr850g2[which];
 289                 break;
 290         case MODEL_WL500GP:
 291                 if (which != LED_DIAG) return ret;
 292                 b = -1; // power light
 293                 break;
 294         case MODEL_WL500W:
 295                 if (which != LED_DIAG) return ret;
 296                 b = -5; // power light
 297                 break;
 298         case MODEL_DIR320:
 299                 b = dir320[which];
 300                 break;
 301         case MODEL_H618B:
 302                 b = h618b[which];
 303                 break;
 304         case MODEL_WL1600GL:
 305                 b = wl1600gl[which];
 306                 break;
 307         case MODEL_WL500GPv2:
 308         case MODEL_WL500GD:
 309         case MODEL_WL520GU:
 310         case MODEL_WL330GE:
 311                 if (which != LED_DIAG) return ret;
 312                 b = -99;        // Invert power light as diag indicator
 313                 break;
 314 #ifdef CONFIG_BCMWL5
 315         case MODEL_RTN12:
 316                 if (which != LED_DIAG) return ret;
 317                 b = -2; // power light
 318                 break;
 319         case MODEL_RTN10:
 320         case MODEL_RTN16:
 321                 if (which != LED_DIAG) return ret;
 322                 b = -1; // power light
 323                 break;
 324         case MODEL_RTN15U:
 325                 b = rtn15u[which];
 326                 break;
 327         case MODEL_RTN53:
 328         case MODEL_RTN53A1:
 329                 b = rtn53[which];
 330                 break;
 331         case MODEL_RTN66U:
 332                 b = rtn66u[which];
 333                 break;
 334         case MODEL_W1800R:
 335                 b = w1800r[which];
 336                 break;
 337         case MODEL_WNR3500L:
 338         case MODEL_WNR3500LV2:
 339                 if (which == LED_DIAG) {
 340                         // power led gpio: 0x03 - green, 0x07 - amber
 341                         b = (mode) ? 7 : 3;
 342                         c = (mode) ? 3 : 7;
 343                 } else
 344                         b = wnr3500[which];
 345                 break;
 346         case MODEL_WNR2000v2:
 347                 if (which == LED_DIAG) {
 348                         // power led gpio: 0x01 - green, 0x02 - amber
 349                         b = (mode) ? 2 : 1;
 350                         c = (mode) ? 1 : 2;
 351                 } else
 352                         b = wnr2000v2[which];
 353                 break;
 354         case MODEL_F7D3301:
 355         case MODEL_F7D3302:
 356         case MODEL_F7D4301:
 357         case MODEL_F7D4302:
 358         case MODEL_F5D8235v3:
 359                 if (which == LED_DIAG) {
 360                         // power led gpio: 10 - green, 11 - red
 361                         b = (mode) ? 11 : -10;
 362                         c = (mode) ? -10 : 11;
 363                 } else
 364                         b = f7d[which];
 365                 break;
 366         case MODEL_E1000v2:
 367                 b = e1000v2[which];
 368                 break;
 369         case MODEL_E900:
 370         case MODEL_E1500:
 371         case MODEL_E1550:
 372         case MODEL_E2500:
 373                 b = e900[which];
 374                 break;
 375         case MODEL_E3200:
 376                 b = e3200[which];
 377                 break;
 378         case MODEL_WRT160Nv3:
 379                 b = wrt160nv3[which];
 380                 break;
 381         case MODEL_WRT320N:
 382                 b = wrt320n[which];
 383                 break;
 384         case MODEL_WRT610Nv2:
 385                 b = wrt610nv2[which];
 386                 break;
 387         case MODEL_E4200:
 388                 b = e4200[which];
 389                 break;
 390         case MODEL_RTN10U:
 391                 b = rtn10u[which];
 392                 break;
 393         case MODEL_RTN10P:
 394                 b = rtn10p[which];
 395                 break;
 396         case MODEL_RTN12B1:
 397                 b = rtn12b1[which];
 398                 break;
 399         case MODEL_L600N:
 400                 b = l600n[which];
 401                 break;
 402         case MODEL_DIR620C1:
 403                 b = dir620c1[which];
 404 #endif
 405 /*
 406         case MODEL_RT390W:
 407                 break;
 408 */
 409         case MODEL_MN700:
 410                 if (which != LED_DIAG) return ret;
 411                 b = 6;
 412                 break;
 413         case MODEL_WLA2G54L:
 414                 if (which != LED_DIAG) return ret;
 415                 b = 1;
 416                 break;
 417         case MODEL_WRT300N:
 418                 if (which != LED_DIAG) return ret;
 419                 b = 1;
 420                 break;
 421         case MODEL_WRT310Nv1:
 422                 b = wrt310nv1[which];
 423                 break;
 424         case MODEL_WRT160Nv1:
 425                 b = wrt160nv1[which];
 426                 break;
 427         default:
 428                 sprintf(s, "led_%s", led_names[which]);
 429                 if (nvget_gpio(s, &b, &n)) {
 430                         if ((mode != LED_PROBE) && (n)) mode = !mode;
 431                         ret = (n) ? b : ((b) ? -b : -99);
 432                         goto SET;
 433                 }
 434                 return ret;
 435         }
 436
 437         ret = b;
 438         if (b < 0) {
 439                 if (b == -99) b = 0; // -0 substitute
 440                         else b = -b;
 441         }
 442         else if (mode != LED_PROBE) {
 443                 mode = !mode;
 444         }
 445
 446 SET:
 447         if (b < 16) {
 448                 if (mode != LED_PROBE) {
 449                         gpio_write(1 << b, mode);
 450
 451                         if (c < 0) {
 452                                 if (c == -99) c = 0;
 453                                 else c = -c;
 454                         }
 455                         else mode = !mode;
 456                         if (c < 16) gpio_write(1 << c, mode);
 457                 }
 458         }
 459
 460         return ret;
 461 }