root/src/router/services/sysinit/sysinit-gateworx.c

/*
 * sysinit-gateworx.c
 *
 * Copyright (C) 2006 Sebastian Gottschall <gottschall@dd-wrt.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
 *
 * $Id:
 * 
 * System Initialisation for Avila Gateworks and compatible Routers
 */

#include <stdio.h>
#include <stdlib.h>
#include <limits.h>
#include <time.h>
#include <unistd.h>
#include <errno.h>
#include <syslog.h>
#include <signal.h>
#include <string.h>
#include <termios.h>
#include <sys/klog.h>
#include <sys/types.h>
#include <sys/mount.h>
#include <sys/reboot.h>
#include <sys/stat.h>
#include <sys/sysmacros.h>
#include <sys/time.h>
#include <sys/utsname.h>
#include <sys/wait.h>

#include <bcmnvram.h>
#include <shutils.h>
#include <utils.h>
#include <arpa/inet.h>
#include <sys/socket.h>
#include <linux/if.h>
#include <linux/sockios.h>
#include <linux/mii.h>

static int detect(char *devicename)
{
        char devcall[128];
        int res;

        sprintf(devcall, "/sbin/lspci|/bin/grep \"%s\"|/bin/wc -l", devicename);
        FILE *in = popen(devcall, "rb");

        fscanf(in, "%d", &res);
        pclose(in);
        return res > 0 ? 1 : 0;
}

#ifndef HAVE_TONZE
#ifndef HAVE_NOP8670

/*void checkupdate( void )
{
    int res, res2 = 0;
    FILE *in =
        popen( "/bin/cat /dev/mtdblock/0|/bin/grep NewMedia|wc -l", "rb" );
    fscanf( in, "%d", &res );
    pclose( in );
    if( res == 0 )
    {
        in = popen( "/bin/cat /dev/mtdblock/0|/bin/grep \"2\\.02\"|wc -l",
                    "rb" );
        fscanf( in, "%d", &res2 );
        pclose( in );
        if( res2 == 0 )
        {
            in = popen( "/bin/cat /dev/mtdblock/0|/bin/grep \"2\\.04\"|wc -l",
                        "rb" );
            fscanf( in, "%d", &res2 );
            pclose( in );
            if( res2 == 1 || res2 == 7 )        // 7 is the result for debug
                // info enabled reboot builds
            {
                fprintf( stderr, "updating avila type 2 redboot\n" );
                eval( "tar", "-xaf", "/usr/lib/firmware/redboot.tg7", "-C",
                      "/tmp" );
                eval( "mtd", "-r", "-f", "write", "/tmp/avila-rb.bin",
                      "RedBoot" );
                return;
            }
        }
    }
    if( res == 1 )
    {
        in = popen( "/bin/cat /dev/mtdblock/0|/bin/grep \"2\\.03\"|wc -l",
                    "rb" );
        fscanf( in, "%d", &res2 );
        pclose( in );
    }
    if( res2 == 1 )             // redboot update is needed
    {
        in = popen( "/bin/dmesg|/bin/grep \"Memory: 64MB\"|wc -l", "rb" );
        fscanf( in, "%d", &res );
        pclose( in );
        if( res == 1 )
            res2 = 64;
        in = popen( "/bin/dmesg|/bin/grep \"Memory: 32MB\"|wc -l", "rb" );
        fscanf( in, "%d", &res );
        pclose( in );
        if( res == 1 )
            res2 = 32;
        in = popen( "/bin/dmesg|/bin/grep \"Memory: 128MB\"|wc -l", "rb" );
        fscanf( in, "%d", &res );
        pclose( in );
        if( res == 1 )
            res2 = 128;
        in = popen( "/bin/dmesg|/bin/grep \"Memory: 256MB\"|wc -l", "rb" );
        fscanf( in, "%d", &res );
        pclose( in );
        if( res == 1 )
            res2 = 256;
        fprintf( stderr, "updating redboot %d MB\n", res2 );
        char fname[64];

        sprintf( fname, "/tmp/rb-%d.bin", res2 );
        eval( "tar", "-xaf", "/usr/lib/firmware/redboot.tg7", "-C", "/tmp" );
        eval( "mtd", "-r", "-f", "write", fname, "RedBoot" );
    }
}
*/
#endif
#endif
void start_sysinit(void)
{
        struct utsname name;
        struct stat tmp_stat;
        time_t tm = 0;

        unlink("/etc/nvram/.lock");
        cprintf("sysinit() proc\n");
        /*
         * /proc 
         */
        mount("proc", "/proc", "proc", MS_MGC_VAL, NULL);
        // system2 ("/etc/convert");
        mount("sysfs", "/sys", "sysfs", MS_MGC_VAL, NULL);
        cprintf("sysinit() tmp\n");

        /*
         * /tmp 
         */
        mount("ramfs", "/tmp", "ramfs", MS_MGC_VAL, NULL);
        mount("devpts", "/dev/pts", "devpts", MS_MGC_VAL, NULL);
        mount("devpts", "/proc/bus/usb", "usbfs", MS_MGC_VAL, NULL);
        /*
         * eval("mount","/etc/www.fs","/www","-t","squashfs","-o","loop");
         * eval("mount","/etc/modules.fs","/lib/modules","-t","squashfs","-o","loop");
         * eval("mount","/etc/usr.fs","/usr","-t","squashfs","-o","loop"); 
         */
        eval("mkdir", "/tmp/www");
        eval("mknod", "/dev/gpio", "c", "127", "0");
        eval("ledtool", "1", "1");      // blink the led 4 times
        eval("mknod", "/dev/nvram", "c", "229", "0");
        eval("mknod", "/dev/ppp", "c", "108", "0");
        eval("mknod", "/dev/rtc", "c", "254", "0");
        eval("mknod", "/dev/crypto", "c", "10", "70");
        eval("mount", "-o", "remount,rw", "/");

        unlink("/tmp/nvram/.lock");
        eval("mkdir", "/tmp/nvram");
        // #ifdef HAVE_REGISTER
        // #else
        // eval ("/bin/tar", "-xzf", "/dev/mtdblock/3", "-C", "/");
        // #endif
        // mkdir ("/usr/local/nvram", 0777);
        // unlink ("/tmp/nvram/.lock");
        // eval ("mkdir", "/tmp/nvram");
        // eval ("cp", "/etc/nvram/nvram.db", "/tmp/nvram");
        // eval ("cp", "/etc/nvram/offsets.db", "/tmp/nvram");
        cprintf("sysinit() var\n");

        /*
         * /var 
         */
        mkdir("/tmp/var", 0777);
        mkdir("/var/lock", 0777);
        mkdir("/var/log", 0777);
        mkdir("/var/run", 0777);
        mkdir("/var/tmp", 0777);

        if (!nvram_match("disable_watchdog", "1"))
                eval("watchdog");       // system watchdog

        cprintf("sysinit() setup console\n");

        /*
         * Setup console 
         */

        cprintf("sysinit() klogctl\n");
        klogctl(8, NULL, atoi(nvram_safe_get("console_loglevel")));
        cprintf("sysinit() get router\n");

        /*
         * Modules 
         */
        uname(&name);
#ifndef HAVE_TONZE
#ifndef HAVE_NOP8670
//    checkupdate(  );
#endif
#endif
        nvram_set("intel_eth", "0");
        if (detect("82541"))    // Intel Gigabit
        {
                nvram_set("intel_eth", "1");
                insmod("e1000");
        }
#ifndef HAVE_NOWIFI
        insmod("ath_hal");
        if (nvram_get("rate_control") != NULL) {
                char rate[64];

                sprintf(rate, "ratectl=%s", nvram_safe_get("rate_control"));
                eval("insmod", "ath_pci", rate);
        } else {
                insmod("ath_pci");
        }
#endif
#ifdef HAVE_MADWIFI_MIMO
        insmod("ath_mimo_pci");
#endif

#if 1
        insmod("ixp400th");
        insmod("ixp400");
        system2("cat /usr/lib/firmware/IxNpeMicrocode.dat > /dev/IxNpe");
        insmod("ixp400_eth");
        eval("ifconfig", "ixp0", "0.0.0.0", "up");
        eval("ifconfig", "ixp1", "0.0.0.0", "up");
        insmod("ocf");
        insmod("cryptodev");
        // insmod("ixp4xx", "init_crypto=0");
#else
        // eval ("mknod", "/dev/IxNpe","c","10","184");
        system2("cat /usr/lib/firmware/NPE-B > /dev/misc/ixp4xx_ucode");
        system2("cat /usr/lib/firmware/NPE-C > /dev/misc/ixp4xx_ucode");
#endif

        // insmod("ath_pci", "rfkill=0", "autocreate=none");

        /*
         * if (ifexists ("wifi0")) eval ("ifconfig", "wifi0", "up"); if (ifexists 
         * ("wifi1")) eval ("ifconfig", "wifi1", "up"); if (ifexists ("wifi2"))
         * eval ("ifconfig", "wifi2", "up"); if (ifexists ("wifi3")) eval
         * ("ifconfig", "wifi3", "up"); if (ifexists ("wifi4")) eval ("ifconfig", 
         * "wifi4", "up"); if (ifexists ("wifi5")) eval ("ifconfig", "wifi5",
         * "up"); 
         */

        // insmod("ipv6");

        insmod("ad7418");       // temp / voltage sensor
        /*
         * Configure mac addresses by reading data from eeprom 
         */
        // char *filename =
        // "/sys/devices/platform/IXP4XX-I2C.0/i2c-0/0-0051/eeprom"; /*
        // bank2=0x100 */
#ifdef HAVE_NOP8670

        char filename[64];

        sprintf(filename, "/dev/mtdblock/%d", getMTD("RedBoot config"));
        FILE *file = fopen(filename, "r");

        if (file) {
                eval("ifconfig", "ixp0", "0.0.0.0", "down");
                eval("ifconfig", "ixp1", "0.0.0.0", "down");
                unsigned char buf[16];
                int i;

                fseek(file, 0x422, SEEK_SET);
                fread(&buf[0], 6, 1, file);
                char mac[16];
                unsigned int copy[16];

                for (i = 0; i < 6; i++)
                        copy[i] = buf[i] & 0xff;
                sprintf(mac, "%02x:%02x:%02x:%02x:%02x:%02x", copy[0], copy[1],
                        copy[2], copy[3], copy[4], copy[5]);
                fprintf(stderr, "configure IXP0 to %s\n", mac);
                eval("ifconfig", "ixp0", "hw", "ether", mac);
                fseek(file, 0x43b, SEEK_SET);
                fread(&buf[6], 6, 1, file);
                for (i = 0; i < 12; i++)
                        copy[i] = buf[i] & 0xff;
                sprintf(mac, "%02x:%02x:%02x:%02x:%02x:%02x", copy[6], copy[7],
                        copy[8], copy[9], copy[10], copy[11]);
                fprintf(stderr, "configure IXP1 to %s\n", mac);
                eval("ifconfig", "ixp1", "hw", "ether", mac);
                fclose(file);
                eval("ifconfig", "ixp0", "0.0.0.0", "up");
                eval("ifconfig", "ixp1", "0.0.0.0", "up");
        }
#else
        char *filename = "/sys/devices/platform/IXP4XX-I2C.0/i2c-adapter:i2c-0/0-0051/eeprom";  /* bank2=0x100 
                                                                                                 */
        FILE *file = fopen(filename, "r");

        if (file) {
                unsigned char buf[16];

                fread(&buf[0], 16, 1, file);
                char mac[16];

                unsigned int copy[16];
                int i;

                for (i = 0; i < 12; i++)
                        copy[i] = buf[i] & 0xff;
                sprintf(mac, "%02x:%02x:%02x:%02x:%02x:%02x", copy[0], copy[1],
                        copy[2], copy[3], copy[4], copy[5]);
                eval("ifconfig", "ixp0", "hw", "ether", mac);
                sprintf(mac, "%02x:%02x:%02x:%02x:%02x:%02x", copy[6], copy[7],
                        copy[8], copy[9], copy[10], copy[11]);
                eval("ifconfig", "ixp1", "hw", "ether", mac);

                fclose(file);
        }
#endif
        eval("ifconfig", "ixp0", "0.0.0.0", "up");
        eval("ifconfig", "ixp1", "0.0.0.0", "up");
        if (getRouterBrand() == ROUTER_BOARD_GATEWORX_GW2345)   // lets load
                // the spi
                // drivers
                // for this
                // switch
        {
                insmod("spi-algo-bit");
                if (nvram_match("DD_BOARD", "Avila GW2355"))
                        insmod("spi-ixp4xx-gw2355");
                else
                        insmod("spi-ixp4xx");
                insmod("ks8995m");
                sleep(1);
                system2("echo R01=01 > /proc/driver/KS8995M");  // enable switch 
        }

        char filename2[64];

        sprintf(filename2, "/dev/mtdblock/%d", getMTD("RedBoot"));
        file = fopen(filename2, "r");
        if (file) {
                fseek(file, 0x1f800, SEEK_SET);
                unsigned int signature;

                fread(&signature, 4, 1, file);
                if (signature == 0x20021103) {
                        fprintf(stderr, "Compex WP188 detected\n");
                        eval("ifconfig", "ixp0", "0.0.0.0", "down");
                        eval("ifconfig", "ixp1", "0.0.0.0", "down");
                        unsigned char buf[16];

                        fseek(file, 0x1f810, SEEK_SET);
                        fread(&buf[0], 6, 1, file);
                        char mac[16];
                        int i;

                        unsigned int copy[16];

                        for (i = 0; i < 12; i++)
                                copy[i] = buf[i] & 0xff;

                        sprintf(mac, "%02x:%02x:%02x:%02x:%02x:%02x", copy[0],
                                copy[1], copy[2], copy[3], copy[4], copy[5]);
                        fprintf(stderr, "configure IXP0 to %s\n", mac);
                        eval("ifconfig", "ixp0", "hw", "ether", mac);
                        fseek(file, 0x1f818, SEEK_SET);
                        fread(&buf[6], 6, 1, file);
                        for (i = 0; i < 12; i++)
                                copy[i] = buf[i] & 0xff;
                        sprintf(mac, "%02x:%02x:%02x:%02x:%02x:%02x", copy[6],
                                copy[7], copy[8], copy[9], copy[10], copy[11]);
                        fprintf(stderr, "configure IXP1 to %s\n", mac);
                        eval("ifconfig", "ixp1", "hw", "ether", mac);
                        eval("ifconfig", "ixp0", "0.0.0.0", "up");
                        eval("ifconfig", "ixp1", "0.0.0.0", "up");
                } else {
                        eval("insmod", "avila-ide");
                }
                fclose(file);
        }
#ifdef HAVE_MAKSAT
        if (nvram_match("DD_BOARD2", "ADI Engineering Pronghorn Metro"))
#else
        if (nvram_match("DD_BOARD", "ADI Engineering Pronghorn Metro"))
#endif
        {
                fprintf(stderr, "Pronghorn Metro detected\n");
                eval("setmac", "-f", "/dev/mtdblock/7", "-n", "1", "-i", "0",
                     "-r", "npe_eth0_esa");
                eval("setmac", "-f", "/dev/mtdblock/7", "-n", "1", "-i", "1",
                     "-r", "npe_eth1_esa");
                struct ifreq ifr;
                int s;

                if ((s = socket(AF_INET, SOCK_RAW, IPPROTO_RAW))) {
                        char eabuf[32];

                        strncpy(ifr.ifr_name, "ixp0", IFNAMSIZ);
                        ioctl(s, SIOCGIFHWADDR, &ifr);
                        nvram_set("et0macaddr_safe",
                                  ether_etoa((unsigned char *)ifr.ifr_hwaddr.
                                             sa_data, eabuf));
                        close(s);
                }
        }
#ifdef HAVE_WG302V1
        eval("setmac", "-f", "/dev/mtdblock/7", "-n", "1", "-i", "0", "-r",
             "zcom_npe_esa");
        struct ifreq ifr;
        int s;

        if ((s = socket(AF_INET, SOCK_RAW, IPPROTO_RAW))) {
                char eabuf[32];

                strncpy(ifr.ifr_name, "ixp0", IFNAMSIZ);
                ioctl(s, SIOCGIFHWADDR, &ifr);
                nvram_set("et0macaddr_safe",
                          ether_etoa((unsigned char *)ifr.ifr_hwaddr.sa_data,
                                     eabuf));
                close(s);
        }
#else
#ifdef HAVE_WG302
        eval("setmac", "-f", "/dev/mtdblock/7", "-n", "1", "-i", "0", "-r",
             "npe_eth0_esa");
        struct ifreq ifr;
        int s;

        if ((s = socket(AF_INET, SOCK_RAW, IPPROTO_RAW))) {
                char eabuf[32];

                strncpy(ifr.ifr_name, "ixp0", IFNAMSIZ);
                ioctl(s, SIOCGIFHWADDR, &ifr);
                nvram_set("et0macaddr_safe",
                          ether_etoa((unsigned char *)ifr.ifr_hwaddr.sa_data,
                                     eabuf));
                close(s);
        }
#endif
#endif
#ifdef HAVE_TONZE
        {
                struct ifreq ifr;
                int s;

                if ((s = socket(AF_INET, SOCK_RAW, IPPROTO_RAW))) {
                        char eabuf[32];

                        strncpy(ifr.ifr_name, "ixp0", IFNAMSIZ);
                        ioctl(s, SIOCGIFHWADDR, &ifr);
                        nvram_set("et0macaddr_safe",
                                  ether_etoa((unsigned char *)ifr.ifr_hwaddr.
                                             sa_data, eabuf));
                        close(s);
                }
        }
#endif

#ifdef HAVE_CAMBRIA
        if (nvram_match("DD_BOARD", "Cambria GW2358-4")
            || nvram_match("DD_BOARD2", "Cambria GW2358-4")) {
                insmod("8250_gw2358");
                system2("echo 0 >/proc/sys/dev/wifi0/ledpin");
                system2("echo 1 >/proc/sys/dev/wifi0/softled");
                system2("echo 1 >/proc/sys/dev/wifi1/ledpin");
                system2("echo 1 >/proc/sys/dev/wifi1/softled");
                system2("echo 2 >/proc/sys/dev/wifi2/ledpin");
                system2("echo 1 >/proc/sys/dev/wifi2/softled");
                system2("echo 3 >/proc/sys/dev/wifi3/ledpin");
                system2("echo 1 >/proc/sys/dev/wifi3/softled");
        }
        if (nvram_match("DD_BOARD", "Cambria GW2350")
            || nvram_match("DD_BOARD2", "Cambria GW2350")) {
                insmod("8250_gw2350");
        }
#endif

        /*
         * Set a sane date 
         */
        stime(&tm);
        nvram_set("wl0_ifname", "ath0");
#ifndef HAVE_NOP8670
        eval("hwclock", "-s");
#endif
        nvram_set("use_crypto", "0");
        cprintf("done\n");
        eval("/bin/tar", "-xzf", "/dev/mtdblock/4", "-C", "/");
        FILE *in = fopen("/tmp/nvram/nvram.db", "rb");

        if (in != NULL) {
                fclose(in);
                eval("/usr/sbin/convertnvram");
                eval("/sbin/mtd", "erase", "nvram");
                nvram_commit();
        }
        return;
}

int check_cfe_nv(void)
{
        nvram_set("portprio_support", "0");
        return 0;
}

int check_pmon_nv(void)
{
        return 0;
}

void start_overclocking(void)
{
}

void enable_dtag_vlan(int enable)
{

}