File:  [ELWIX - Embedded LightWeight unIX -] / embedtools / src / get1steth.c
Revision 1.4.2.2: download - view: text, annotated - select for diffs - revision graph
Mon Oct 14 07:21:38 2013 UTC (10 years, 8 months ago) by misho
Branches: tools2_0
Diff to: branchpoint 1.4: preferred, unified
add feature for up parent interface of mgmt vlan

    1: /*************************************************************************
    2:  * (C) 2010 AITNET - Sofia/Bulgaria - <office@aitbg.com>
    3:  *  by Michael Pounov <misho@aitbg.com>
    4:  *
    5:  * $Author: misho $
    6:  * $Id: get1steth.c,v 1.4.2.2 2013/10/14 07:21:38 misho Exp $
    7:  *
    8:  *************************************************************************
    9: The ELWIX and AITNET software is distributed under the following
   10: terms:
   11: 
   12: All of the documentation and software included in the ELWIX and AITNET
   13: Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
   14: 
   15: Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013
   16: 	by Michael Pounov <misho@elwix.org>.  All rights reserved.
   17: 
   18: Redistribution and use in source and binary forms, with or without
   19: modification, are permitted provided that the following conditions
   20: are met:
   21: 1. Redistributions of source code must retain the above copyright
   22:    notice, this list of conditions and the following disclaimer.
   23: 2. Redistributions in binary form must reproduce the above copyright
   24:    notice, this list of conditions and the following disclaimer in the
   25:    documentation and/or other materials provided with the distribution.
   26: 3. All advertising materials mentioning features or use of this software
   27:    must display the following acknowledgement:
   28: This product includes software developed by Michael Pounov <misho@elwix.org>
   29: ELWIX - Embedded LightWeight unIX and its contributors.
   30: 4. Neither the name of AITNET nor the names of its contributors
   31:    may be used to endorse or promote products derived from this software
   32:    without specific prior written permission.
   33: 
   34: THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
   35: ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   36: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   37: ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
   38: FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   39: DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   40: OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   41: HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   42: LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   43: OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   44: SUCH DAMAGE.
   45: */
   46: #include "global.h"
   47: #include "get1steth.h"
   48: 
   49: 
   50: char szIface[STRSIZ];
   51: int Verbose;
   52: extern char compiled[], compiledby[], compilehost[];
   53: 
   54: 
   55: static void
   56: Usage()
   57: {
   58: 	printf("-= GET_FIRST_ETHERNET =- Get First Ethernet Interface tool\n"
   59: 		"=== %s === %s@%s ===\n\n"
   60: 		"Syntax: get1steth [option] [custom_first_interface]\n\n"
   61: 		"\t-v\t\tVerbose (more -v more verbosity)\n"
   62: 		"\t-g\t\tOnly get first interface, print and exit ...\n"
   63: 		"\n", compiled, compiledby, compilehost);
   64: }
   65: 
   66: #ifdef HAVE_KLDNEXT
   67: static int
   68: kldLoad()
   69: {
   70: 	struct module_stat mstat;
   71: 	register int i, j;
   72: 	u_char flg = 0;
   73: 
   74: 	memset(&mstat, 0, sizeof mstat);
   75: 	mstat.version = sizeof mstat;
   76: 	for (i = kldnext(0); i > 0; i = kldnext(i))
   77: 		for (j = kldfirstmod(i); j > 0; j = modfnext(j)) {
   78: 			if (modstat(j, &mstat) == -1)
   79: 				continue;
   80: 
   81: 			if (!strncmp(MODVLAN, mstat.name, sizeof MODVLAN)) {
   82: 				flg = 1;
   83: 				break;
   84: 			}
   85: 		}
   86: 	if (flg)
   87: 		return 0;
   88: 
   89: 	if (kldload(MODVLAN) == -1)
   90: 		return -1;
   91: 
   92: 	return 1;
   93: }
   94: #endif
   95: 
   96: // -------------------------------
   97: 
   98: int
   99: main(int argc, char **argv)
  100: {
  101: 	char ch, GetOnly = 0;
  102: 	struct ifaddrs *ifa, *ifp;
  103: 	struct sockaddr_dl *sdl;
  104: 	struct sockaddr_in *sin;
  105: 	struct ifreq ifr;
  106: 	struct vlanreq vlr;
  107: 	struct ifaliasreq ifra;
  108: 	struct ifmediareq ifmr;
  109: 	int s;
  110: 
  111: 	while ((ch = getopt(argc, argv, "hvg")) != -1)
  112: 		switch (ch) {
  113: 			case 'g':
  114: 				GetOnly = 1;
  115: 				break;
  116: 			case 'v':
  117: 				Verbose++;
  118: 				break;
  119: 			case 'h':
  120: 			default:
  121: 				Usage();
  122: 				return 1;
  123: 		}
  124: 	argc -= optind;
  125: 	argv += optind;
  126: 
  127: 	openlog("get1steth", LOG_CONS | LOG_PERROR, LOG_USER);
  128: 
  129: 	if (argc) {
  130: 		strlcpy(szIface, *argv, sizeof szIface);
  131: 		VERB(1) syslog(LOG_NOTICE, "Info:: Get CUSTOM first interface %s\n", szIface);
  132: 	} else {
  133: 		s = socket(PF_INET, SOCK_DGRAM, 0);
  134: 		if (-1 == s) {
  135: 			syslog(LOG_ERR, "Error:: socket(INET) #%d - %s\n", errno, strerror(errno));
  136: 			closelog();
  137: 			return 1;
  138: 		}
  139: 
  140: 		getifaddrs(&ifa);
  141: 		for (ifp = ifa; ifp; ifp = ifp->ifa_next) {
  142: 			if (PF_LINK == ifp->ifa_addr->sa_family && 
  143: 					IFT_ETHER == ((struct sockaddr_dl*) ifp->ifa_addr)->sdl_type) {
  144: 				memset(&ifmr, 0, sizeof ifmr);
  145: 				strlcpy(ifmr.ifm_name, ifp->ifa_name, IFNAMSIZ);
  146: 				if (ioctl(s, SIOCGIFMEDIA, &ifmr) == -1) {
  147: 					syslog(LOG_ERR, "Error:: media interface=%s ioctl(SIOCGIFMEDIA) #%d - %s\n", 
  148: 							ifmr.ifm_name, errno, strerror(errno));
  149: 					close(s);
  150: 					closelog();
  151: 					return 1;
  152: 				}
  153: 
  154: 				if (IFM_ETHER == IFM_TYPE(ifmr.ifm_current)) {
  155: 					strlcpy(szIface, ifp->ifa_name, sizeof szIface);
  156: 					sdl = (struct sockaddr_dl*) ifp->ifa_addr;
  157: 					VERB(2) syslog(LOG_NOTICE, "Info:: Get first interface=%s MAC=%s\n", szIface, 
  158: 							ether_ntoa((struct ether_addr*) LLADDR(sdl)));
  159: 					break;
  160: 				}
  161: 			}
  162: 		}
  163: 		freeifaddrs(ifa);
  164: 
  165: 		close(s);
  166: 	}
  167: 	if (!*szIface) {
  168: 		syslog(LOG_NOTICE, "Info:: Ethernet interface not found!!!\n");
  169: 
  170: 		closelog();
  171: 		return 1;
  172: 	}
  173: 
  174: 	if (GetOnly) {
  175: 		printf("%s\n", szIface);
  176: 
  177: 		closelog();
  178: 		return 0;
  179: 	}
  180: 
  181: #ifdef HAVE_KLDNEXT
  182: 	s = kldLoad();
  183: 	if (s == -1) {
  184: 		syslog(LOG_ERR, "Error:: kldload(if_vlan) Can`t operate with vlans ...\n");
  185: 		return 1;
  186: 	} else
  187: 		VERB(3) syslog(LOG_NOTICE, "VLAN module ... %s\n", s ? "Loaded" : "Already loaded");
  188: #endif
  189: 
  190: 	s = socket(PF_INET, SOCK_DGRAM, 0);
  191: 	if (-1 == s) {
  192: 		syslog(LOG_ERR, "Error:: socket(INET) #%d - %s\n", errno, strerror(errno));
  193: 		closelog();
  194: 		return 2;
  195: 	}
  196: 
  197: 	/* up parent interface */
  198: 	memset(&ifr, 0, sizeof ifr);
  199: 	strlcpy(ifr.ifr_name, szIface, IFNAMSIZ);
  200: 	ifr.ifr_flags |= IFF_UP;
  201: 
  202: 	if (ioctl(s, SIOCSIFFLAGS, &ifr) == -1 && errno != EEXIST) {
  203: 		syslog(LOG_ERR, "Error:: UP interface=%s ioctl(SIOCSIFFLAGS) #%d - %s\n", 
  204: 				szIface, errno, strerror(errno));
  205: 		close(s);
  206: 		return 2;
  207: 	}
  208: 
  209: 	/* create vlan */
  210: 	memset(&ifr, 0, sizeof ifr);
  211: 	strlcpy(vlr.vlr_parent, szIface, IFNAMSIZ);
  212: 	vlr.vlr_tag = MGMT_VTAG;
  213: 
  214: 	strlcpy(ifr.ifr_name, MGMT_IFACE, IFNAMSIZ);
  215: 	ifr.ifr_data = (void *) &vlr;
  216: 
  217: #ifdef SIOCIFCREATE2
  218: 	if (ioctl(s, SIOCIFCREATE2, &ifr) == -1 && errno != EEXIST) {
  219: #else
  220: 	if (ioctl(s, SIOCIFCREATE, &ifr) == -1 && errno != EEXIST) {
  221: #endif
  222: 		syslog(LOG_ERR, "Error:: Create interface=%s ioctl(SIOCIFCREATE2) #%d - %s\n", 
  223: 				MGMT_IFACE, errno, strerror(errno));
  224: 		close(s);
  225: 		return 2;
  226: 	}
  227: 
  228: 	memset(&ifra, 0, sizeof ifra);
  229: #if defined(__FreeBSD__)
  230: 	/* rename iface */
  231: 	VERB(2) syslog(LOG_NOTICE, "Info:: Created interface=%s\n", MGMT_IFACE);
  232: 	ifr.ifr_data = MGMT_NAME;
  233: 	if (errno != EEXIST && ioctl(s, SIOCSIFNAME, &ifr) == -1) {
  234: 		syslog(LOG_ERR, "Error:: Managment interface=%s ioctl(SIOCSIFNAME) #%d - %s\n", 
  235: 				MGMT_NAME, errno, strerror(errno));
  236: 		close(s);
  237: 		return 2;
  238: 	} else
  239: 		VERB(2) syslog(LOG_NOTICE, "Info:: Managment interface=%s\n", MGMT_NAME);
  240: 	strlcpy(ifra.ifra_name, MGMT_NAME, IFNAMSIZ);
  241: #else
  242: 	strlcpy(ifra.ifra_name, MGMT_IFACE, IFNAMSIZ);
  243: #endif
  244: 
  245: 	/* assign address & up */
  246: 	sin = (struct sockaddr_in*) &ifra.ifra_addr;
  247: 	sin->sin_len = sizeof ifra.ifra_addr;
  248: 	sin->sin_family = AF_INET;
  249: 	sin->sin_addr.s_addr = inet_addr(MGMT_ADDR);
  250: 	sin = (struct sockaddr_in*) &ifra.ifra_mask;
  251: 	sin->sin_len = sizeof ifra.ifra_mask;
  252: 	sin->sin_family = AF_INET;
  253: 	sin->sin_addr.s_addr = inet_addr(MGMT_MASK);
  254: 	if (ioctl(s, SIOCAIFADDR, &ifra) == -1) {
  255: 		syslog(LOG_ERR, "Error:: IP %s ioctl(SIOCAIFADDR) #%d - %s\n", 
  256: 				MGMT_ADDR, errno, strerror(errno));
  257: 		close(s);
  258: 		return 2;
  259: 	} else
  260: 		VERB(2) syslog(LOG_NOTICE, "Info:: IP %s\n", MGMT_ADDR);
  261: 
  262: 	close(s);
  263: 	closelog();
  264: 	return 0;
  265: }

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