Annotation of embedtools/src/get1steth.c, revision 1.1.2.7

1.1.2.1   misho       1: #include "global.h"
1.1.2.2   misho       2: #include "get1steth.h"
1.1.2.1   misho       3: 
                      4: 
1.1.2.2   misho       5: char szIface[MAX_STR];
                      6: int Verbose;
                      7: extern char compiled[], compiledby[], compilehost[];
                      8: 
                      9: 
                     10: static void Usage()
1.1.2.1   misho      11: {
1.1.2.2   misho      12:        printf("-= GET_FIRST_ETHERNET =- Get First Ethernet Interface tool\n"
                     13:                "=== %s === %s@%s ===\n\n"
                     14:                "Syntax: get1steth [option] [custom_first_interface]\n\n"
                     15:                "\t-v\t\tVerbose (more -v more verbosity)\n"
                     16:                "\t-g\t\tOnly get first interface, print and exit ...\n"
                     17:                "\n", compiled, compiledby, compilehost);
                     18: }
                     19: 
1.1.2.5   misho      20: static int kldLoad()
                     21: {
                     22:        struct module_stat mstat;
                     23:        register int i, j;
                     24:        u_char flg = 0;
                     25: 
                     26:        memset(&mstat, 0, sizeof mstat);
                     27:        mstat.version = sizeof mstat;
                     28:        for (i = kldnext(0); i > 0; i = kldnext(i))
                     29:                for (j = kldfirstmod(i); j > 0; j = modfnext(j)) {
                     30:                        if (modstat(j, &mstat) == -1)
                     31:                                continue;
                     32: 
                     33:                        if (!strncmp(MODVLAN, mstat.name, sizeof MODVLAN)) {
                     34:                                flg = 1;
                     35:                                break;
                     36:                        }
                     37:                }
                     38:        if (flg)
                     39:                return 0;
                     40: 
                     41:        if (kldload(MODVLAN) == -1)
                     42:                return -1;
                     43: 
                     44:        return 1;
                     45: }
                     46: 
1.1.2.2   misho      47: // -------------------------------
                     48: 
                     49: int main(int argc, char **argv)
                     50: {
                     51:        char ch, GetOnly = 0;
                     52:        struct ifaddrs *ifa, *ifp;
                     53:        struct sockaddr_dl *sdl;
1.1.2.4   misho      54:        struct sockaddr_in *sin;
1.1.2.2   misho      55:        struct ifreq ifr;
1.1.2.3   misho      56:        struct vlanreq vlr;
1.1.2.4   misho      57:        struct ifaliasreq ifra;
1.1.2.6   misho      58:        struct ifmediareq ifmr;
1.1.2.2   misho      59:        int s;
                     60: 
                     61:        while ((ch = getopt(argc, argv, "hvg")) != -1)
                     62:                switch (ch) {
                     63:                        case 'g':
                     64:                                GetOnly = 1;
                     65:                                break;
                     66:                        case 'v':
                     67:                                Verbose++;
                     68:                                break;
                     69:                        case 'h':
                     70:                        default:
                     71:                                Usage();
                     72:                                return 1;
                     73:                }
                     74:        argc -= optind;
                     75:        argv += optind;
                     76: 
1.1.2.3   misho      77:        openlog("get1steth", LOG_CONS | LOG_PERROR, LOG_CONSOLE | LOG_USER);
1.1.2.2   misho      78: 
1.1.2.7 ! misho      79:        s = socket(AF_LOCAL, SOCK_DGRAM, 0);
1.1.2.6   misho      80:        if (-1 == s) {
1.1.2.7 ! misho      81:                syslog(LOG_ERR, "Error:: socket(LOCAL) #%d - %s\n", errno, strerror(errno));
1.1.2.6   misho      82:                closelog();
                     83:                return 1;
                     84:        }
1.1.2.2   misho      85:        if (argc) {
                     86:                strlcpy(szIface, *argv, MAX_STR);
                     87:                VERB(1) syslog(LOG_NOTICE, "Info:: Get CUSTOM first interface %s\n", szIface);
                     88:        } else {
1.1.2.7 ! misho      89:                s = socket(PF_INET, SOCK_DGRAM, 0);
        !            90:                if (-1 == s) {
        !            91:                        syslog(LOG_ERR, "Error:: socket(INET) #%d - %s\n", errno, strerror(errno));
        !            92:                        closelog();
        !            93:                        return 1;
        !            94:                }
        !            95: 
1.1.2.2   misho      96:                getifaddrs(&ifa);
                     97:                for (ifp = ifa; ifp; ifp = ifp->ifa_next) {
                     98:                        if (PF_LINK == ifp->ifa_addr->sa_family && 
                     99:                                        IFT_ETHER == ((struct sockaddr_dl*) ifp->ifa_addr)->sdl_type) {
1.1.2.6   misho     100:                                memset(&ifmr, 0, sizeof ifmr);
                    101:                                strlcpy(ifmr.ifm_name, ifp->ifa_name, IFNAMSIZ);
                    102:                                if (ioctl(s, SIOCGIFMEDIA, &ifmr) == -1) {
                    103:                                        syslog(LOG_ERR, "Error:: media interface=%s ioctl(SIOCGIFMEDIA) #%d - %s\n", 
                    104:                                                        ifmr.ifm_name, errno, strerror(errno));
                    105:                                        close(s);
                    106:                                        closelog();
                    107:                                        return 1;
                    108:                                }
                    109: 
                    110:                                if (IFM_ETHER == IFM_TYPE(ifmr.ifm_current)) {
                    111:                                        strlcpy(szIface, ifp->ifa_name, MAX_STR);
                    112:                                        sdl = (struct sockaddr_dl*) ifp->ifa_addr;
                    113:                                        VERB(2) syslog(LOG_NOTICE, "Info:: Get first interface=%s MAC=%s\n", szIface, 
                    114:                                                        ether_ntoa((struct ether_addr*) LLADDR(sdl)));
                    115:                                        break;
                    116:                                }
1.1.2.2   misho     117:                        }
                    118:                }
                    119:                freeifaddrs(ifa);
1.1.2.7 ! misho     120: 
        !           121:                close(s);
1.1.2.2   misho     122:        }
1.1.2.6   misho     123:        if (!*szIface) {
                    124:                syslog(LOG_NOTICE, "Info:: Ethernet interface not found!!!\n");
                    125: 
                    126:                closelog();
                    127:                return 1;
                    128:        }
                    129: 
1.1.2.2   misho     130:        if (GetOnly) {
                    131:                printf("%s\n", szIface);
                    132: 
                    133:                closelog();
                    134:                return 0;
                    135:        }
                    136: 
1.1.2.5   misho     137:        s = kldLoad();
                    138:        if (s == -1) {
1.1.2.6   misho     139:                syslog(LOG_ERR, "Error:: kldload(if_vlan) Can`t operate with vlans ...\n");
1.1.2.5   misho     140:                return 1;
                    141:        } else
1.1.2.6   misho     142:                VERB(1) syslog(LOG_NOTICE, "VLAN module ... %s\n", s ? "Loaded" : "Already loaded");
1.1.2.5   misho     143: 
1.1.2.3   misho     144:        // create vlan
1.1.2.2   misho     145:        memset(&ifr, 0, sizeof ifr);
1.1.2.3   misho     146:        strlcpy(vlr.vlr_parent, szIface, IFNAMSIZ);
                    147:        vlr.vlr_tag = MGMT_VTAG;
                    148: 
                    149:        strlcpy(ifr.ifr_name, MGMT_IFACE, IFNAMSIZ);
                    150:        ifr.ifr_data = (void *) &vlr;
1.1.2.2   misho     151: 
1.1.2.7 ! misho     152:        s = socket(PF_INET, SOCK_DGRAM, 0);
        !           153:        if (-1 == s) {
        !           154:                syslog(LOG_ERR, "Error:: socket(INET) #%d - %s\n", errno, strerror(errno));
        !           155:                closelog();
        !           156:                return 2;
        !           157:        }
1.1.2.4   misho     158:        if (ioctl(s, SIOCIFCREATE2, &ifr) == -1 && errno != EEXIST) {
1.1.2.3   misho     159:                syslog(LOG_ERR, "Error:: Create interface=%s ioctl(SIOCIFCREATE2) #%d - %s\n", 
                    160:                                MGMT_IFACE, errno, strerror(errno));
1.1.2.2   misho     161:                close(s);
                    162:                return 2;
1.1.2.3   misho     163:        } else
                    164:                VERB(2) syslog(LOG_NOTICE, "Info:: Created interface=%s\n", MGMT_IFACE);
                    165:        // rename iface
                    166:        ifr.ifr_data = MGMT_NAME;
1.1.2.4   misho     167:        if (errno != EEXIST && ioctl(s, SIOCSIFNAME, &ifr) == -1) {
1.1.2.3   misho     168:                syslog(LOG_ERR, "Error:: Managment interface=%s ioctl(SIOCSIFNAME) #%d - %s\n", 
                    169:                                MGMT_NAME, errno, strerror(errno));
                    170:                close(s);
                    171:                return 2;
                    172:        } else
                    173:                VERB(2) syslog(LOG_NOTICE, "Info:: Managment interface=%s\n", MGMT_NAME);
1.1.2.4   misho     174: 
1.1.2.3   misho     175:        // assign address & up
1.1.2.4   misho     176:        memset(&ifra, 0, sizeof ifra);
                    177:        strlcpy(ifra.ifra_name, MGMT_NAME, IFNAMSIZ);
                    178:        sin = (struct sockaddr_in*) &ifra.ifra_addr;
                    179:        sin->sin_len = sizeof ifra.ifra_addr;
                    180:        sin->sin_family = AF_INET;
                    181:        sin->sin_addr.s_addr = inet_addr(MGMT_ADDR);
                    182:        sin = (struct sockaddr_in*) &ifra.ifra_mask;
                    183:        sin->sin_len = sizeof ifra.ifra_mask;
                    184:        sin->sin_family = AF_INET;
                    185:        sin->sin_addr.s_addr = inet_addr(MGMT_MASK);
                    186:        if (ioctl(s, SIOCAIFADDR, &ifra) == -1) {
                    187:                syslog(LOG_ERR, "Error:: IP %s ioctl(SIOCAIFADDR) #%d - %s\n", 
                    188:                                MGMT_ADDR, errno, strerror(errno));
                    189:                close(s);
                    190:                return 2;
                    191:        } else
                    192:                VERB(2) syslog(LOG_NOTICE, "Info:: IP %s\n", MGMT_ADDR);
1.1.2.2   misho     193: 
                    194:        close(s);
                    195:        closelog();
1.1.2.1   misho     196:        return 0;
                    197: }

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>