hush/networking/ifenslave.c
2008-05-20 18:57:35 +00:00

628 lines
17 KiB
C

/* Mode: C;
*
* Mini ifenslave implementation for busybox
* Copyright (C) 2005 by Marc Leeman <marc.leeman@barco.com>
*
* ifenslave.c: Configure network interfaces for parallel routing.
*
* This program controls the Linux implementation of running multiple
* network interfaces in parallel.
*
* Author: Donald Becker <becker@cesdis.gsfc.nasa.gov>
* Copyright 1994-1996 Donald Becker
*
* 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.
*
* The author may be reached as becker@CESDIS.gsfc.nasa.gov, or C/O
* Center of Excellence in Space Data and Information Sciences
* Code 930.5, Goddard Space Flight Center, Greenbelt MD 20771
*
* Changes :
* - 2000/10/02 Willy Tarreau <willy at meta-x.org> :
* - few fixes. Master's MAC address is now correctly taken from
* the first device when not previously set ;
* - detach support : call BOND_RELEASE to detach an enslaved interface.
* - give a mini-howto from command-line help : # ifenslave -h
*
* - 2001/02/16 Chad N. Tindel <ctindel at ieee dot org> :
* - Master is now brought down before setting the MAC address. In
* the 2.4 kernel you can't change the MAC address while the device is
* up because you get EBUSY.
*
* - 2001/09/13 Takao Indoh <indou dot takao at jp dot fujitsu dot com>
* - Added the ability to change the active interface on a mode 1 bond
* at runtime.
*
* - 2001/10/23 Chad N. Tindel <ctindel at ieee dot org> :
* - No longer set the MAC address of the master. The bond device will
* take care of this itself
* - Try the SIOC*** versions of the bonding ioctls before using the
* old versions
* - 2002/02/18 Erik Habbinga <erik_habbinga @ hp dot com> :
* - ifr2.ifr_flags was not initialized in the hwaddr_notset case,
* SIOCGIFFLAGS now called before hwaddr_notset test
*
* - 2002/10/31 Tony Cureington <tony.cureington * hp_com> :
* - If the master does not have a hardware address when the first slave
* is enslaved, the master is assigned the hardware address of that
* slave - there is a comment in bonding.c stating "ifenslave takes
* care of this now." This corrects the problem of slaves having
* different hardware addresses in active-backup mode when
* multiple interfaces are specified on a single ifenslave command
* (ifenslave bond0 eth0 eth1).
*
* - 2003/03/18 - Tsippy Mendelson <tsippy.mendelson at intel dot com> and
* Shmulik Hen <shmulik.hen at intel dot com>
* - Moved setting the slave's mac address and openning it, from
* the application to the driver. This enables support of modes
* that need to use the unique mac address of each slave.
* The driver also takes care of closing the slave and restoring its
* original mac address upon release.
* In addition, block possibility of enslaving before the master is up.
* This prevents putting the system in an undefined state.
*
* - 2003/05/01 - Amir Noam <amir.noam at intel dot com>
* - Added ABI version control to restore compatibility between
* new/old ifenslave and new/old bonding.
* - Prevent adding an adapter that is already a slave.
* Fixes the problem of stalling the transmission and leaving
* the slave in a down state.
*
* - 2003/05/01 - Shmulik Hen <shmulik.hen at intel dot com>
* - Prevent enslaving if the bond device is down.
* Fixes the problem of leaving the system in unstable state and
* halting when trying to remove the module.
* - Close socket on all abnormal exists.
* - Add versioning scheme that follows that of the bonding driver.
* current version is 1.0.0 as a base line.
*
* - 2003/05/22 - Jay Vosburgh <fubar at us dot ibm dot com>
* - ifenslave -c was broken; it's now fixed
* - Fixed problem with routes vanishing from master during enslave
* processing.
*
* - 2003/05/27 - Amir Noam <amir.noam at intel dot com>
* - Fix backward compatibility issues:
* For drivers not using ABI versions, slave was set down while
* it should be left up before enslaving.
* Also, master was not set down and the default set_mac_address()
* would fail and generate an error message in the system log.
* - For opt_c: slave should not be set to the master's setting
* while it is running. It was already set during enslave. To
* simplify things, it is now handeled separately.
*
* - 2003/12/01 - Shmulik Hen <shmulik.hen at intel dot com>
* - Code cleanup and style changes
* set version to 1.1.0
*/
#include "libbb.h"
#include <net/if_arp.h>
#include <linux/if_bonding.h>
#include <linux/sockios.h>
typedef unsigned long long u64; /* hack, so we may include kernel's ethtool.h */
typedef uint32_t u32; /* ditto */
typedef uint16_t u16; /* ditto */
typedef uint8_t u8; /* ditto */
#include <linux/ethtool.h>
struct dev_data {
struct ifreq mtu, flags, hwaddr;
};
enum { skfd = 3 }; /* AF_INET socket for ioctl() calls.*/
struct globals {
unsigned abi_ver; /* userland - kernel ABI version */
smallint hwaddr_set; /* Master's hwaddr is set */
struct dev_data master;
struct dev_data slave;
};
#define G (*ptr_to_globals)
#define abi_ver (G.abi_ver )
#define hwaddr_set (G.hwaddr_set)
#define master (G.master )
#define slave (G.slave )
#define INIT_G() do { \
SET_PTR_TO_GLOBALS(xzalloc(sizeof(G))); \
} while (0)
static void get_drv_info(char *master_ifname);
static int get_if_settings(char *ifname, struct dev_data *dd);
static int get_slave_flags(char *slave_ifname);
static int set_master_hwaddr(char *master_ifname, struct sockaddr *hwaddr);
static int set_slave_hwaddr(char *slave_ifname, struct sockaddr *hwaddr);
static int set_slave_mtu(char *slave_ifname, int mtu);
static int set_if_flags(char *ifname, short flags);
static int set_if_up(char *ifname, short flags);
static int set_if_down(char *ifname, short flags);
static int clear_if_addr(char *ifname);
static int set_if_addr(char *master_ifname, char *slave_ifname);
static void change_active(char *master_ifname, char *slave_ifname);
static int enslave(char *master_ifname, char *slave_ifname);
static int release(char *master_ifname, char *slave_ifname);
static void strncpy_IFNAMSIZ(char *dst, const char *src)
{
strncpy(dst, src, IFNAMSIZ);
}
int ifenslave_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
int ifenslave_main(int argc ATTRIBUTE_UNUSED, char **argv)
{
char *master_ifname, *slave_ifname;
int rv;
int res;
unsigned opt;
enum {
OPT_c = (1 << 0),
OPT_d = (1 << 1),
OPT_f = (1 << 2),
};
#if ENABLE_GETOPT_LONG
static const char ifenslave_longopts[] ALIGN1 =
"change-active" No_argument "c"
"detach" No_argument "d"
"force" No_argument "f"
;
applet_long_options = ifenslave_longopts;
#endif
INIT_G();
opt = getopt32(argv, "cdf");
argv += optind;
if (opt & (opt-1)) /* options check */
bb_show_usage();
/* Copy the interface name */
master_ifname = *argv++;
/* No remaining args means show all interfaces. */
if (!master_ifname) {
display_interfaces(NULL);
return EXIT_SUCCESS;
}
/* Open a basic socket */
xmove_fd(xsocket(AF_INET, SOCK_DGRAM, 0), skfd);
/* exchange abi version with bonding module */
get_drv_info(master_ifname);
slave_ifname = *argv++;
if (!slave_ifname) {
if (opt & (OPT_d|OPT_c)) {
display_interfaces(slave_ifname);
return 2; /* why? */
}
/* A single arg means show the
* configuration for this interface
*/
display_interfaces(master_ifname);
return EXIT_SUCCESS;
}
res = get_if_settings(master_ifname, &master);
if (res) {
/* Probably a good reason not to go on */
bb_perror_msg_and_die("%s: can't get settings", master_ifname);
}
/* check if master is indeed a master;
* if not then fail any operation
*/
if (!(master.flags.ifr_flags & IFF_MASTER))
bb_error_msg_and_die("%s is not a master", master_ifname);
/* check if master is up; if not then fail any operation */
if (!(master.flags.ifr_flags & IFF_UP))
bb_error_msg_and_die("%s is not up", master_ifname);
/* Only for enslaving */
if (!(opt & (OPT_c|OPT_d))) {
sa_family_t master_family = master.hwaddr.ifr_hwaddr.sa_family;
/* The family '1' is ARPHRD_ETHER for ethernet. */
if (master_family != 1 && !(opt & OPT_f)) {
bb_error_msg_and_die(
"%s is not ethernet-like (-f overrides)",
master_ifname);
}
}
/* Accepts only one slave */
if (opt & OPT_c) {
/* change active slave */
res = get_slave_flags(slave_ifname);
if (res) {
bb_perror_msg_and_die(
"%s: can't get flags", slave_ifname);
}
change_active(master_ifname, slave_ifname);
return EXIT_SUCCESS;
}
/* Accept multiple slaves */
res = 0;
do {
if (opt & OPT_d) {
/* detach a slave interface from the master */
rv = get_slave_flags(slave_ifname);
if (rv) {
/* Can't work with this slave. */
/* remember the error and skip it*/
bb_perror_msg(
"skipping %s: can't get flags",
slave_ifname);
res = rv;
continue;
}
rv = release(master_ifname, slave_ifname);
if (rv) {
bb_perror_msg(
"master %s, slave %s: "
"can't release",
master_ifname, slave_ifname);
res = rv;
}
} else {
/* attach a slave interface to the master */
rv = get_if_settings(slave_ifname, &slave);
if (rv) {
/* Can't work with this slave. */
/* remember the error and skip it*/
bb_perror_msg(
"skipping %s: can't get settings",
slave_ifname);
res = rv;
continue;
}
rv = enslave(master_ifname, slave_ifname);
if (rv) {
bb_perror_msg(
"master %s, slave %s: "
"can't enslave",
master_ifname, slave_ifname);
res = rv;
}
}
} while ((slave_ifname = *argv++) != NULL);
if (ENABLE_FEATURE_CLEAN_UP) {
close(skfd);
}
return res;
}
static void get_drv_info(char *master_ifname)
{
struct ifreq ifr;
struct ethtool_drvinfo info;
memset(&ifr, 0, sizeof(ifr));
strncpy_IFNAMSIZ(ifr.ifr_name, master_ifname);
ifr.ifr_data = (caddr_t)&info;
info.cmd = ETHTOOL_GDRVINFO;
strncpy(info.driver, "ifenslave", 32);
snprintf(info.fw_version, 32, "%d", BOND_ABI_VERSION);
if (ioctl(skfd, SIOCETHTOOL, &ifr) < 0) {
if (errno == EOPNOTSUPP)
return;
bb_perror_msg_and_die("%s: SIOCETHTOOL error", master_ifname);
}
abi_ver = bb_strtou(info.fw_version, NULL, 0);
if (errno)
bb_error_msg_and_die("%s: SIOCETHTOOL error", master_ifname);
return;
}
static void change_active(char *master_ifname, char *slave_ifname)
{
struct ifreq ifr;
if (!(slave.flags.ifr_flags & IFF_SLAVE)) {
bb_error_msg_and_die(
"%s is not a slave",
slave_ifname);
}
strncpy_IFNAMSIZ(ifr.ifr_name, master_ifname);
strncpy_IFNAMSIZ(ifr.ifr_slave, slave_ifname);
if (ioctl(skfd, SIOCBONDCHANGEACTIVE, &ifr) < 0
&& ioctl(skfd, BOND_CHANGE_ACTIVE_OLD, &ifr) < 0
) {
bb_perror_msg_and_die(
"master %s, slave %s: can't "
"change active",
master_ifname, slave_ifname);
}
}
static int enslave(char *master_ifname, char *slave_ifname)
{
struct ifreq ifr;
int res;
if (slave.flags.ifr_flags & IFF_SLAVE) {
bb_error_msg(
"%s is already a slave",
slave_ifname);
return 1;
}
res = set_if_down(slave_ifname, slave.flags.ifr_flags);
if (res)
return res;
if (abi_ver < 2) {
/* Older bonding versions would panic if the slave has no IP
* address, so get the IP setting from the master.
*/
res = set_if_addr(master_ifname, slave_ifname);
if (res) {
bb_perror_msg("%s: can't set address", slave_ifname);
return res;
}
} else {
res = clear_if_addr(slave_ifname);
if (res) {
bb_perror_msg("%s: can't clear address", slave_ifname);
return res;
}
}
if (master.mtu.ifr_mtu != slave.mtu.ifr_mtu) {
res = set_slave_mtu(slave_ifname, master.mtu.ifr_mtu);
if (res) {
bb_perror_msg("%s: can't set MTU", slave_ifname);
return res;
}
}
if (hwaddr_set) {
/* Master already has an hwaddr
* so set it's hwaddr to the slave
*/
if (abi_ver < 1) {
/* The driver is using an old ABI, so
* the application sets the slave's
* hwaddr
*/
res = set_slave_hwaddr(slave_ifname,
&(master.hwaddr.ifr_hwaddr));
if (res) {
bb_perror_msg("%s: can't set hw address",
slave_ifname);
goto undo_mtu;
}
/* For old ABI the application needs to bring the
* slave back up
*/
res = set_if_up(slave_ifname, slave.flags.ifr_flags);
if (res)
goto undo_slave_mac;
}
/* The driver is using a new ABI,
* so the driver takes care of setting
* the slave's hwaddr and bringing
* it up again
*/
} else {
/* No hwaddr for master yet, so
* set the slave's hwaddr to it
*/
if (abi_ver < 1) {
/* For old ABI, the master needs to be
* down before setting it's hwaddr
*/
res = set_if_down(master_ifname, master.flags.ifr_flags);
if (res)
goto undo_mtu;
}
res = set_master_hwaddr(master_ifname,
&(slave.hwaddr.ifr_hwaddr));
if (res) {
bb_error_msg("%s: can't set hw address",
master_ifname);
goto undo_mtu;
}
if (abi_ver < 1) {
/* For old ABI, bring the master
* back up
*/
res = set_if_up(master_ifname, master.flags.ifr_flags);
if (res)
goto undo_master_mac;
}
hwaddr_set = 1;
}
/* Do the real thing */
strncpy_IFNAMSIZ(ifr.ifr_name, master_ifname);
strncpy_IFNAMSIZ(ifr.ifr_slave, slave_ifname);
if (ioctl(skfd, SIOCBONDENSLAVE, &ifr) < 0
&& ioctl(skfd, BOND_ENSLAVE_OLD, &ifr) < 0
) {
res = 1;
}
if (res)
goto undo_master_mac;
return 0;
/* rollback (best effort) */
undo_master_mac:
set_master_hwaddr(master_ifname, &(master.hwaddr.ifr_hwaddr));
hwaddr_set = 0;
goto undo_mtu;
undo_slave_mac:
set_slave_hwaddr(slave_ifname, &(slave.hwaddr.ifr_hwaddr));
undo_mtu:
set_slave_mtu(slave_ifname, slave.mtu.ifr_mtu);
return res;
}
static int release(char *master_ifname, char *slave_ifname)
{
struct ifreq ifr;
int res = 0;
if (!(slave.flags.ifr_flags & IFF_SLAVE)) {
bb_error_msg("%s is not a slave",
slave_ifname);
return 1;
}
strncpy_IFNAMSIZ(ifr.ifr_name, master_ifname);
strncpy_IFNAMSIZ(ifr.ifr_slave, slave_ifname);
if (ioctl(skfd, SIOCBONDRELEASE, &ifr) < 0
&& ioctl(skfd, BOND_RELEASE_OLD, &ifr) < 0
) {
return 1;
}
if (abi_ver < 1) {
/* The driver is using an old ABI, so we'll set the interface
* down to avoid any conflicts due to same MAC/IP
*/
res = set_if_down(slave_ifname, slave.flags.ifr_flags);
}
/* set to default mtu */
set_slave_mtu(slave_ifname, 1500);
return res;
}
static int get_if_settings(char *ifname, struct dev_data *dd)
{
int res;
strncpy_IFNAMSIZ(dd->mtu.ifr_name, ifname);
res = ioctl(skfd, SIOCGIFMTU, &dd->mtu);
strncpy_IFNAMSIZ(dd->flags.ifr_name, ifname);
res |= ioctl(skfd, SIOCGIFFLAGS, &dd->flags);
strncpy_IFNAMSIZ(dd->hwaddr.ifr_name, ifname);
res |= ioctl(skfd, SIOCGIFHWADDR, &dd->hwaddr);
return res;
}
static int get_slave_flags(char *slave_ifname)
{
strncpy_IFNAMSIZ(slave.flags.ifr_name, slave_ifname);
return ioctl(skfd, SIOCGIFFLAGS, &slave.flags);
}
static int set_master_hwaddr(char *master_ifname, struct sockaddr *hwaddr)
{
struct ifreq ifr;
strncpy_IFNAMSIZ(ifr.ifr_name, master_ifname);
memcpy(&(ifr.ifr_hwaddr), hwaddr, sizeof(struct sockaddr));
return ioctl(skfd, SIOCSIFHWADDR, &ifr);
}
static int set_slave_hwaddr(char *slave_ifname, struct sockaddr *hwaddr)
{
struct ifreq ifr;
strncpy_IFNAMSIZ(ifr.ifr_name, slave_ifname);
memcpy(&(ifr.ifr_hwaddr), hwaddr, sizeof(struct sockaddr));
return ioctl(skfd, SIOCSIFHWADDR, &ifr);
}
static int set_slave_mtu(char *slave_ifname, int mtu)
{
struct ifreq ifr;
ifr.ifr_mtu = mtu;
strncpy_IFNAMSIZ(ifr.ifr_name, slave_ifname);
return ioctl(skfd, SIOCSIFMTU, &ifr);
}
static int set_if_flags(char *ifname, short flags)
{
struct ifreq ifr;
ifr.ifr_flags = flags;
strncpy_IFNAMSIZ(ifr.ifr_name, ifname);
return ioctl(skfd, SIOCSIFFLAGS, &ifr);
}
static int set_if_up(char *ifname, short flags)
{
int res = set_if_flags(ifname, flags | IFF_UP);
if (res)
bb_perror_msg("%s: can't up", ifname);
return res;
}
static int set_if_down(char *ifname, short flags)
{
int res = set_if_flags(ifname, flags & ~IFF_UP);
if (res)
bb_perror_msg("%s: can't down", ifname);
return res;
}
static int clear_if_addr(char *ifname)
{
struct ifreq ifr;
strncpy_IFNAMSIZ(ifr.ifr_name, ifname);
ifr.ifr_addr.sa_family = AF_INET;
memset(ifr.ifr_addr.sa_data, 0, sizeof(ifr.ifr_addr.sa_data));
return ioctl(skfd, SIOCSIFADDR, &ifr);
}
static int set_if_addr(char *master_ifname, char *slave_ifname)
{
static const struct {
int g_ioctl;
int s_ioctl;
} ifra[] = {
{ SIOCGIFADDR, SIOCSIFADDR },
{ SIOCGIFDSTADDR, SIOCSIFDSTADDR },
{ SIOCGIFBRDADDR, SIOCSIFBRDADDR },
{ SIOCGIFNETMASK, SIOCSIFNETMASK },
};
struct ifreq ifr;
int res;
unsigned i;
for (i = 0; i < ARRAY_SIZE(ifra); i++) {
strncpy_IFNAMSIZ(ifr.ifr_name, master_ifname);
res = ioctl(skfd, ifra[i].g_ioctl, &ifr);
if (res < 0) {
ifr.ifr_addr.sa_family = AF_INET;
memset(ifr.ifr_addr.sa_data, 0,
sizeof(ifr.ifr_addr.sa_data));
}
strncpy_IFNAMSIZ(ifr.ifr_name, slave_ifname);
res = ioctl(skfd, ifra[i].s_ioctl, &ifr);
if (res < 0)
return res;
}
return 0;
}