libnetutils/dhcpclient.c - platform/system/core - Gitiles

 /*
  * Copyright 2008, The Android Open Source Project
  *
  * Licensed under the Apache License, Version 2.0 (the "License");
  * you may not use this file except in compliance with the License.
  * You may obtain a copy of the License at
  *
  *     http://www.apache.org/licenses/LICENSE-2.0
  *
  * Unless required by applicable law or agreed to in writing, software
  * distributed under the License is distributed on an "AS IS" BASIS,
  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  * See the License for the specific language governing permissions and
  * limitations under the License.
  */

 #define LOG_TAG "DHCP"

 #include <dirent.h>
 #include <errno.h>
 #include <poll.h>
 #include <netinet/in.h>
 #include <stdarg.h>
 #include <stdlib.h>
 #include <stdio.h>
 #include <string.h>
 #include <sys/select.h>
 #include <sys/socket.h>
 #include <sys/time.h>
 #include <sys/types.h>
 #include <time.h>
 #include <unistd.h>

 #include <android/log.h>
 #include <cutils/properties.h>

 #include <netutils/ifc.h>
 #include "dhcpmsg.h"
 #include "packet.h"

 #define VERBOSE 2

 static int verbose = 1;
 static char errmsg[2048];

 typedef unsigned long long msecs_t;
 #if VERBOSE
 void dump_dhcp_msg();
 #endif

 msecs_t get_msecs(void)
 {
     struct timespec ts;

     if (clock_gettime(CLOCK_MONOTONIC, &ts)) {
         return 0;
     } else {
         return (((msecs_t) ts.tv_sec) * ((msecs_t) 1000)) +
             (((msecs_t) ts.tv_nsec) / ((msecs_t) 1000000));
     }
 }

 void printerr(char *fmt, ...)
 {
     va_list ap;

     va_start(ap, fmt);
     vsnprintf(errmsg, sizeof(errmsg), fmt, ap);
     va_end(ap);

     ALOGD("%s", errmsg);
 }

 const char *dhcp_lasterror()
 {
     return errmsg;
 }

 int fatal(const char *reason)
 {
     printerr("%s: %s\n", reason, strerror(errno));
     return -1;
 //    exit(1);
 }

 const char *ipaddr(in_addr_t addr)
 {
     struct in_addr in_addr;

     in_addr.s_addr = addr;
     return inet_ntoa(in_addr);
 }

 extern int ipv4NetmaskToPrefixLength(in_addr_t mask);

 typedef struct dhcp_info dhcp_info;

 struct dhcp_info {
     uint32_t type;

     uint32_t ipaddr;
     uint32_t gateway;
     uint32_t prefixLength;

     uint32_t dns1;
     uint32_t dns2;

     uint32_t serveraddr;
     uint32_t lease;
 };

 dhcp_info last_good_info;

 void get_dhcp_info(uint32_t *ipaddr, uint32_t *gateway, uint32_t *prefixLength,
                    uint32_t *dns1, uint32_t *dns2, uint32_t *server,
                    uint32_t *lease)
 {
     *ipaddr = last_good_info.ipaddr;
     *gateway = last_good_info.gateway;
     *prefixLength = last_good_info.prefixLength;
     *dns1 = last_good_info.dns1;
     *dns2 = last_good_info.dns2;
     *server = last_good_info.serveraddr;
     *lease = last_good_info.lease;
 }

 static int dhcp_configure(const char *ifname, dhcp_info *info)
 {
     last_good_info = *info;
     return ifc_configure(ifname, info->ipaddr, info->prefixLength, info->gateway,
                          info->dns1, info->dns2);
 }

 static const char *dhcp_type_to_name(uint32_t type)
 {
     switch(type) {
     case DHCPDISCOVER: return "discover";
     case DHCPOFFER:    return "offer";
     case DHCPREQUEST:  return "request";
     case DHCPDECLINE:  return "decline";
     case DHCPACK:      return "ack";
     case DHCPNAK:      return "nak";
     case DHCPRELEASE:  return "release";
     case DHCPINFORM:   return "inform";
     default:           return "???";
     }
 }

 void dump_dhcp_info(dhcp_info *info)
 {
     char addr[20], gway[20];
     ALOGD("--- dhcp %s (%d) ---",
             dhcp_type_to_name(info->type), info->type);
     strcpy(addr, ipaddr(info->ipaddr));
     strcpy(gway, ipaddr(info->gateway));
     ALOGD("ip %s gw %s prefixLength %d", addr, gway, info->prefixLength);
     if (info->dns1) ALOGD("dns1: %s", ipaddr(info->dns1));
     if (info->dns2) ALOGD("dns2: %s", ipaddr(info->dns2));
     ALOGD("server %s, lease %d seconds",
             ipaddr(info->serveraddr), info->lease);
 }


 int decode_dhcp_msg(dhcp_msg *msg, int len, dhcp_info *info)
 {
     uint8_t *x;
     unsigned int opt;
     int optlen;

     memset(info, 0, sizeof(dhcp_info));
     if (len < (DHCP_MSG_FIXED_SIZE + 4)) return -1;

     len -= (DHCP_MSG_FIXED_SIZE + 4);

     if (msg->options[0] != OPT_COOKIE1) return -1;
     if (msg->options[1] != OPT_COOKIE2) return -1;
     if (msg->options[2] != OPT_COOKIE3) return -1;
     if (msg->options[3] != OPT_COOKIE4) return -1;

     x = msg->options + 4;

     while (len > 2) {
         opt = *x++;
         if (opt == OPT_PAD) {
             len--;
             continue;
         }
         if (opt == OPT_END) {
             break;
         }
         optlen = *x++;
         len -= 2;
         if (optlen > len) {
             break;
         }
         switch(opt) {
         case OPT_SUBNET_MASK:
             if (optlen >= 4) {
                 in_addr_t mask;
                 memcpy(&mask, x, 4);
                 info->prefixLength = ipv4NetmaskToPrefixLength(mask);
             }
             break;
         case OPT_GATEWAY:
             if (optlen >= 4) memcpy(&info->gateway, x, 4);
             break;
         case OPT_DNS:
             if (optlen >= 4) memcpy(&info->dns1, x + 0, 4);
             if (optlen >= 8) memcpy(&info->dns2, x + 4, 4);
             break;
         case OPT_LEASE_TIME:
             if (optlen >= 4) {
                 memcpy(&info->lease, x, 4);
                 info->lease = ntohl(info->lease);
             }
             break;
         case OPT_SERVER_ID:
             if (optlen >= 4) memcpy(&info->serveraddr, x, 4);
             break;
         case OPT_MESSAGE_TYPE:
             info->type = *x;
             break;
         default:
             break;
         }
         x += optlen;
         len -= optlen;
     }

     info->ipaddr = msg->yiaddr;

     return 0;
 }

 #if VERBOSE

 static void hex2str(char *buf, size_t buf_size, const unsigned char *array, int len)
 {
     int i;
     char *cp = buf;
     char *buf_end = buf + buf_size;
     for (i = 0; i < len; i++) {
         cp += snprintf(cp, buf_end - cp, " %02x ", array[i]);
     }
 }

 void dump_dhcp_msg(dhcp_msg *msg, int len)
 {
     unsigned char *x;
     unsigned int n,c;
     int optsz;
     const char *name;
     char buf[2048];

     ALOGD("===== DHCP message:");
     if (len < DHCP_MSG_FIXED_SIZE) {
         ALOGD("Invalid length %d, should be %d", len, DHCP_MSG_FIXED_SIZE);
         return;
     }

     len -= DHCP_MSG_FIXED_SIZE;

     if (msg->op == OP_BOOTREQUEST)
         name = "BOOTREQUEST";
     else if (msg->op == OP_BOOTREPLY)
         name = "BOOTREPLY";
     else
         name = "????";
     ALOGD("op = %s (%d), htype = %d, hlen = %d, hops = %d",
            name, msg->op, msg->htype, msg->hlen, msg->hops);
     ALOGD("xid = 0x%08x secs = %d, flags = 0x%04x optlen = %d",
            ntohl(msg->xid), ntohs(msg->secs), ntohs(msg->flags), len);
     ALOGD("ciaddr = %s", ipaddr(msg->ciaddr));
     ALOGD("yiaddr = %s", ipaddr(msg->yiaddr));
     ALOGD("siaddr = %s", ipaddr(msg->siaddr));
     ALOGD("giaddr = %s", ipaddr(msg->giaddr));

     c = msg->hlen > 16 ? 16 : msg->hlen;
     hex2str(buf, sizeof(buf), msg->chaddr, c);
     ALOGD("chaddr = {%s}", buf);

     for (n = 0; n < 64; n++) {
         unsigned char x = msg->sname[n];
         if ((x < ' ') || (x > 127)) {
             if (x == 0) break;
             msg->sname[n] = '.';
         }
     }
     msg->sname[63] = 0;

     for (n = 0; n < 128; n++) {
         unsigned char x = msg->file[n];
         if ((x < ' ') || (x > 127)) {
             if (x == 0) break;
             msg->file[n] = '.';
         }
     }
     msg->file[127] = 0;

     ALOGD("sname = '%s'", msg->sname);
     ALOGD("file = '%s'", msg->file);

     if (len < 4) return;
     len -= 4;
     x = msg->options + 4;

     while (len > 2) {
         if (*x == 0) {
             x++;
             len--;
             continue;
         }
         if (*x == OPT_END) {
             break;
         }
         len -= 2;
         optsz = x[1];
         if (optsz > len) break;
         if (x[0] == OPT_DOMAIN_NAME || x[0] == OPT_MESSAGE) {
             if ((unsigned int)optsz < sizeof(buf) - 1) {
                 n = optsz;
             } else {
                 n = sizeof(buf) - 1;
             }
             memcpy(buf, &x[2], n);
             buf[n] = '\0';
         } else {
             hex2str(buf, sizeof(buf), &x[2], optsz);
         }
         if (x[0] == OPT_MESSAGE_TYPE)
             name = dhcp_type_to_name(x[2]);
         else
             name = NULL;
         ALOGD("op %d len %d {%s} %s", x[0], optsz, buf, name == NULL ? "" : name);
         len -= optsz;
         x = x + optsz + 2;
     }
 }

 #endif

 static int send_message(int sock, int if_index, dhcp_msg  *msg, int size)
 {
 #if VERBOSE > 1
     dump_dhcp_msg(msg, size);
 #endif
     return send_packet(sock, if_index, msg, size, INADDR_ANY, INADDR_BROADCAST,
                        PORT_BOOTP_CLIENT, PORT_BOOTP_SERVER);
 }

 static int is_valid_reply(dhcp_msg *msg, dhcp_msg *reply, int sz)
 {
     if (sz < DHCP_MSG_FIXED_SIZE) {
         if (verbose) ALOGD("Wrong size %d != %d\n", sz, DHCP_MSG_FIXED_SIZE);
         return 0;
     }
     if (reply->op != OP_BOOTREPLY) {
         if (verbose) ALOGD("Wrong Op %d != %d\n", reply->op, OP_BOOTREPLY);
         return 0;
     }
     if (reply->xid != msg->xid) {
         if (verbose) ALOGD("Wrong Xid 0x%x != 0x%x\n", ntohl(reply->xid),
                            ntohl(msg->xid));
         return 0;
     }
     if (reply->htype != msg->htype) {
         if (verbose) ALOGD("Wrong Htype %d != %d\n", reply->htype, msg->htype);
         return 0;
     }
     if (reply->hlen != msg->hlen) {
         if (verbose) ALOGD("Wrong Hlen %d != %d\n", reply->hlen, msg->hlen);
         return 0;
     }
     if (memcmp(msg->chaddr, reply->chaddr, msg->hlen)) {
         if (verbose) ALOGD("Wrong chaddr %x != %x\n", *(reply->chaddr),*(msg->chaddr));
         return 0;
     }
     return 1;
 }

 #define STATE_SELECTING  1
 #define STATE_REQUESTING 2

 #define TIMEOUT_INITIAL   4000
 #define TIMEOUT_MAX      32000

 int dhcp_init_ifc(const char *ifname)
 {
     dhcp_msg discover_msg;
     dhcp_msg request_msg;
     dhcp_msg reply;
     dhcp_msg *msg;
     dhcp_info info;
     int s, r, size;
     int valid_reply;
     uint32_t xid;
     unsigned char hwaddr[6];
     struct pollfd pfd;
     unsigned int state;
     unsigned int timeout;
     int if_index;

     xid = (uint32_t) get_msecs();

     if (ifc_get_hwaddr(ifname, hwaddr)) {
         return fatal("cannot obtain interface address");
     }
     if (ifc_get_ifindex(ifname, &if_index)) {
         return fatal("cannot obtain interface index");
     }

     s = open_raw_socket(ifname, hwaddr, if_index);

     timeout = TIMEOUT_INITIAL;
     state = STATE_SELECTING;
     info.type = 0;
     goto transmit;

     for (;;) {
         pfd.fd = s;
         pfd.events = POLLIN;
         pfd.revents = 0;
         r = poll(&pfd, 1, timeout);

         if (r == 0) {
 #if VERBOSE
             printerr("TIMEOUT\n");
 #endif
             if (timeout >= TIMEOUT_MAX) {
                 printerr("timed out\n");
                 if ( info.type == DHCPOFFER ) {
                     printerr("no acknowledgement from DHCP server\nconfiguring %s with offered parameters\n", ifname);
                     return dhcp_configure(ifname, &info);
                 }
                 errno = ETIME;
                 close(s);
                 return -1;
             }
             timeout = timeout * 2;

         transmit:
             size = 0;
             msg = NULL;
             switch(state) {
             case STATE_SELECTING:
                 msg = &discover_msg;
                 size = init_dhcp_discover_msg(msg, hwaddr, xid);
                 break;
             case STATE_REQUESTING:
                 msg = &request_msg;
                 size = init_dhcp_request_msg(msg, hwaddr, xid, info.ipaddr, info.serveraddr);
                 break;
             default:
                 r = 0;
             }
             if (size != 0) {
                 r = send_message(s, if_index, msg, size);
                 if (r < 0) {
                     printerr("error sending dhcp msg: %s\n", strerror(errno));
                 }
             }
             continue;
         }

         if (r < 0) {
             if ((errno == EAGAIN) || (errno == EINTR)) {
                 continue;
             }
             return fatal("poll failed");
         }

         errno = 0;
         r = receive_packet(s, &reply);
         if (r < 0) {
             if (errno != 0) {
                 ALOGD("receive_packet failed (%d): %s", r, strerror(errno));
                 if (errno == ENETDOWN || errno == ENXIO) {
                     return -1;
                 }
             }
             continue;
         }

 #if VERBOSE > 1
         dump_dhcp_msg(&reply, r);
 #endif
         decode_dhcp_msg(&reply, r, &info);

         if (state == STATE_SELECTING) {
             valid_reply = is_valid_reply(&discover_msg, &reply, r);
         } else {
             valid_reply = is_valid_reply(&request_msg, &reply, r);
         }
         if (!valid_reply) {
             printerr("invalid reply\n");
             continue;
         }

         if (verbose) dump_dhcp_info(&info);

         switch(state) {
         case STATE_SELECTING:
             if (info.type == DHCPOFFER) {
                 state = STATE_REQUESTING;
                 timeout = TIMEOUT_INITIAL;
                 xid++;
                 goto transmit;
             }
             break;
         case STATE_REQUESTING:
             if (info.type == DHCPACK) {
                 printerr("configuring %s\n", ifname);
                 close(s);
                 return dhcp_configure(ifname, &info);
             } else if (info.type == DHCPNAK) {
                 printerr("configuration request denied\n");
                 close(s);
                 return -1;
             } else {
                 printerr("ignoring %s message in state %d\n",
                          dhcp_type_to_name(info.type), state);
             }
             break;
         }
     }
     close(s);
     return 0;
 }

 int do_dhcp(char *iname)
 {
     if (ifc_set_addr(iname, 0)) {
         printerr("failed to set ip addr for %s to 0.0.0.0: %s\n", iname, strerror(errno));
         return -1;
     }

     if (ifc_up(iname)) {
         printerr("failed to bring up interface %s: %s\n", iname, strerror(errno));
         return -1;
     }

     return dhcp_init_ifc(iname);
 }
	/*
	* Copyright 2008, The Android Open Source Project
	*
	* Licensed under the Apache License, Version 2.0 (the "License");
	* you may not use this file except in compliance with the License.
	* You may obtain a copy of the License at
	*
	* http://www.apache.org/licenses/LICENSE-2.0
	*
	* Unless required by applicable law or agreed to in writing, software
	* distributed under the License is distributed on an "AS IS" BASIS,
	* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
	* See the License for the specific language governing permissions and
	* limitations under the License.
	*/

	#define LOG_TAG "DHCP"

	#include <dirent.h>
	#include <errno.h>
	#include <poll.h>
	#include <netinet/in.h>
	#include <stdarg.h>
	#include <stdlib.h>
	#include <stdio.h>
	#include <string.h>
	#include <sys/select.h>
	#include <sys/socket.h>
	#include <sys/time.h>
	#include <sys/types.h>
	#include <time.h>
	#include <unistd.h>

	#include <android/log.h>
	#include <cutils/properties.h>

	#include <netutils/ifc.h>
	#include "dhcpmsg.h"
	#include "packet.h"

	#define VERBOSE 2

	static int verbose = 1;
	static char errmsg[2048];

	typedef unsigned long long msecs_t;
	#if VERBOSE
	void dump_dhcp_msg();
	#endif

	msecs_t get_msecs(void)
	{
	struct timespec ts;

	if (clock_gettime(CLOCK_MONOTONIC, &ts)) {
	return 0;
	} else {
	return (((msecs_t) ts.tv_sec) * ((msecs_t) 1000)) +
	(((msecs_t) ts.tv_nsec) / ((msecs_t) 1000000));
	}
	}

	void printerr(char *fmt, ...)
	{
	va_list ap;

	va_start(ap, fmt);
	vsnprintf(errmsg, sizeof(errmsg), fmt, ap);
	va_end(ap);

	ALOGD("%s", errmsg);
	}

	const char *dhcp_lasterror()
	{
	return errmsg;
	}

	int fatal(const char *reason)
	{
	printerr("%s: %s\n", reason, strerror(errno));
	return -1;
	// exit(1);
	}

	const char *ipaddr(in_addr_t addr)
	{
	struct in_addr in_addr;

	in_addr.s_addr = addr;
	return inet_ntoa(in_addr);
	}

	extern int ipv4NetmaskToPrefixLength(in_addr_t mask);

	typedef struct dhcp_info dhcp_info;

	struct dhcp_info {
	uint32_t type;

	uint32_t ipaddr;
	uint32_t gateway;
	uint32_t prefixLength;

	uint32_t dns1;
	uint32_t dns2;

	uint32_t serveraddr;
	uint32_t lease;
	};

	dhcp_info last_good_info;

	void get_dhcp_info(uint32_t ipaddr, uint32_t gateway, uint32_t *prefixLength,
	uint32_t dns1, uint32_t dns2, uint32_t *server,
	uint32_t *lease)
	{
	*ipaddr = last_good_info.ipaddr;
	*gateway = last_good_info.gateway;
	*prefixLength = last_good_info.prefixLength;
	*dns1 = last_good_info.dns1;
	*dns2 = last_good_info.dns2;
	*server = last_good_info.serveraddr;
	*lease = last_good_info.lease;
	}

	static int dhcp_configure(const char ifname, dhcp_info info)
	{
	last_good_info = *info;
	return ifc_configure(ifname, info->ipaddr, info->prefixLength, info->gateway,
	info->dns1, info->dns2);
	}

	static const char *dhcp_type_to_name(uint32_t type)
	{
	switch(type) {
	case DHCPDISCOVER: return "discover";
	case DHCPOFFER: return "offer";
	case DHCPREQUEST: return "request";
	case DHCPDECLINE: return "decline";
	case DHCPACK: return "ack";
	case DHCPNAK: return "nak";
	case DHCPRELEASE: return "release";
	case DHCPINFORM: return "inform";
	default: return "???";
	}
	}

	void dump_dhcp_info(dhcp_info *info)
	{
	char addr[20], gway[20];
	ALOGD("--- dhcp %s (%d) ---",
	dhcp_type_to_name(info->type), info->type);
	strcpy(addr, ipaddr(info->ipaddr));
	strcpy(gway, ipaddr(info->gateway));
	ALOGD("ip %s gw %s prefixLength %d", addr, gway, info->prefixLength);
	if (info->dns1) ALOGD("dns1: %s", ipaddr(info->dns1));
	if (info->dns2) ALOGD("dns2: %s", ipaddr(info->dns2));
	ALOGD("server %s, lease %d seconds",
	ipaddr(info->serveraddr), info->lease);
	}


	int decode_dhcp_msg(dhcp_msg msg, int len, dhcp_info info)
	{
	uint8_t *x;
	unsigned int opt;
	int optlen;

	memset(info, 0, sizeof(dhcp_info));
	if (len < (DHCP_MSG_FIXED_SIZE + 4)) return -1;

	len -= (DHCP_MSG_FIXED_SIZE + 4);

	if (msg->options[0] != OPT_COOKIE1) return -1;
	if (msg->options[1] != OPT_COOKIE2) return -1;
	if (msg->options[2] != OPT_COOKIE3) return -1;
	if (msg->options[3] != OPT_COOKIE4) return -1;

	x = msg->options + 4;

	while (len > 2) {
	opt = *x++;
	if (opt == OPT_PAD) {
	len--;
	continue;
	}
	if (opt == OPT_END) {
	break;
	}
	optlen = *x++;
	len -= 2;
	if (optlen > len) {
	break;
	}
	switch(opt) {
	case OPT_SUBNET_MASK:
	if (optlen >= 4) {
	in_addr_t mask;
	memcpy(&mask, x, 4);
	info->prefixLength = ipv4NetmaskToPrefixLength(mask);
	}
	break;
	case OPT_GATEWAY:
	if (optlen >= 4) memcpy(&info->gateway, x, 4);
	break;
	case OPT_DNS:
	if (optlen >= 4) memcpy(&info->dns1, x + 0, 4);
	if (optlen >= 8) memcpy(&info->dns2, x + 4, 4);
	break;
	case OPT_LEASE_TIME:
	if (optlen >= 4) {
	memcpy(&info->lease, x, 4);
	info->lease = ntohl(info->lease);
	}
	break;
	case OPT_SERVER_ID:
	if (optlen >= 4) memcpy(&info->serveraddr, x, 4);
	break;
	case OPT_MESSAGE_TYPE:
	info->type = *x;
	break;
	default:
	break;
	}
	x += optlen;
	len -= optlen;
	}

	info->ipaddr = msg->yiaddr;

	return 0;
	}

	#if VERBOSE

	static void hex2str(char buf, size_t buf_size, const unsigned char array, int len)
	{
	int i;
	char *cp = buf;
	char *buf_end = buf + buf_size;
	for (i = 0; i < len; i++) {
	cp += snprintf(cp, buf_end - cp, " %02x ", array[i]);
	}
	}

	void dump_dhcp_msg(dhcp_msg *msg, int len)
	{
	unsigned char *x;
	unsigned int n,c;
	int optsz;
	const char *name;
	char buf[2048];

	ALOGD("===== DHCP message:");
	if (len < DHCP_MSG_FIXED_SIZE) {
	ALOGD("Invalid length %d, should be %d", len, DHCP_MSG_FIXED_SIZE);
	return;
	}

	len -= DHCP_MSG_FIXED_SIZE;

	if (msg->op == OP_BOOTREQUEST)
	name = "BOOTREQUEST";
	else if (msg->op == OP_BOOTREPLY)
	name = "BOOTREPLY";
	else
	name = "????";
	ALOGD("op = %s (%d), htype = %d, hlen = %d, hops = %d",
	name, msg->op, msg->htype, msg->hlen, msg->hops);
	ALOGD("xid = 0x%08x secs = %d, flags = 0x%04x optlen = %d",
	ntohl(msg->xid), ntohs(msg->secs), ntohs(msg->flags), len);
	ALOGD("ciaddr = %s", ipaddr(msg->ciaddr));
	ALOGD("yiaddr = %s", ipaddr(msg->yiaddr));
	ALOGD("siaddr = %s", ipaddr(msg->siaddr));
	ALOGD("giaddr = %s", ipaddr(msg->giaddr));

	c = msg->hlen > 16 ? 16 : msg->hlen;
	hex2str(buf, sizeof(buf), msg->chaddr, c);
	ALOGD("chaddr = {%s}", buf);

	for (n = 0; n < 64; n++) {
	unsigned char x = msg->sname[n];
	if ((x < ' ') \|\| (x > 127)) {
	if (x == 0) break;
	msg->sname[n] = '.';
	}
	}
	msg->sname[63] = 0;

	for (n = 0; n < 128; n++) {
	unsigned char x = msg->file[n];
	if ((x < ' ') \|\| (x > 127)) {
	if (x == 0) break;
	msg->file[n] = '.';
	}
	}
	msg->file[127] = 0;

	ALOGD("sname = '%s'", msg->sname);
	ALOGD("file = '%s'", msg->file);

	if (len < 4) return;
	len -= 4;
	x = msg->options + 4;

	while (len > 2) {
	if (*x == 0) {
	x++;
	len--;
	continue;
	}
	if (*x == OPT_END) {
	break;
	}
	len -= 2;
	optsz = x[1];
	if (optsz > len) break;
	if (x[0] == OPT_DOMAIN_NAME \|\| x[0] == OPT_MESSAGE) {
	if ((unsigned int)optsz < sizeof(buf) - 1) {
	n = optsz;
	} else {
	n = sizeof(buf) - 1;
	}
	memcpy(buf, &x[2], n);
	buf[n] = '\0';
	} else {
	hex2str(buf, sizeof(buf), &x[2], optsz);
	}
	if (x[0] == OPT_MESSAGE_TYPE)
	name = dhcp_type_to_name(x[2]);
	else
	name = NULL;
	ALOGD("op %d len %d {%s} %s", x[0], optsz, buf, name == NULL ? "" : name);
	len -= optsz;
	x = x + optsz + 2;
	}
	}

	#endif

	static int send_message(int sock, int if_index, dhcp_msg *msg, int size)
	{
	#if VERBOSE > 1
	dump_dhcp_msg(msg, size);
	#endif
	return send_packet(sock, if_index, msg, size, INADDR_ANY, INADDR_BROADCAST,
	PORT_BOOTP_CLIENT, PORT_BOOTP_SERVER);
	}

	static int is_valid_reply(dhcp_msg msg, dhcp_msg reply, int sz)
	{
	if (sz < DHCP_MSG_FIXED_SIZE) {
	if (verbose) ALOGD("Wrong size %d != %d\n", sz, DHCP_MSG_FIXED_SIZE);
	return 0;
	}
	if (reply->op != OP_BOOTREPLY) {
	if (verbose) ALOGD("Wrong Op %d != %d\n", reply->op, OP_BOOTREPLY);
	return 0;
	}
	if (reply->xid != msg->xid) {
	if (verbose) ALOGD("Wrong Xid 0x%x != 0x%x\n", ntohl(reply->xid),
	ntohl(msg->xid));
	return 0;
	}
	if (reply->htype != msg->htype) {
	if (verbose) ALOGD("Wrong Htype %d != %d\n", reply->htype, msg->htype);
	return 0;
	}
	if (reply->hlen != msg->hlen) {
	if (verbose) ALOGD("Wrong Hlen %d != %d\n", reply->hlen, msg->hlen);
	return 0;
	}
	if (memcmp(msg->chaddr, reply->chaddr, msg->hlen)) {
	if (verbose) ALOGD("Wrong chaddr %x != %x\n", (reply->chaddr),(msg->chaddr));
	return 0;
	}
	return 1;
	}

	#define STATE_SELECTING 1
	#define STATE_REQUESTING 2

	#define TIMEOUT_INITIAL 4000
	#define TIMEOUT_MAX 32000

	int dhcp_init_ifc(const char *ifname)
	{
	dhcp_msg discover_msg;
	dhcp_msg request_msg;
	dhcp_msg reply;
	dhcp_msg *msg;
	dhcp_info info;
	int s, r, size;
	int valid_reply;
	uint32_t xid;
	unsigned char hwaddr[6];
	struct pollfd pfd;
	unsigned int state;
	unsigned int timeout;
	int if_index;

	xid = (uint32_t) get_msecs();

	if (ifc_get_hwaddr(ifname, hwaddr)) {
	return fatal("cannot obtain interface address");
	}
	if (ifc_get_ifindex(ifname, &if_index)) {
	return fatal("cannot obtain interface index");
	}

	s = open_raw_socket(ifname, hwaddr, if_index);

	timeout = TIMEOUT_INITIAL;
	state = STATE_SELECTING;
	info.type = 0;
	goto transmit;

	for (;;) {
	pfd.fd = s;
	pfd.events = POLLIN;
	pfd.revents = 0;
	r = poll(&pfd, 1, timeout);

	if (r == 0) {
	#if VERBOSE
	printerr("TIMEOUT\n");
	#endif
	if (timeout >= TIMEOUT_MAX) {
	printerr("timed out\n");
	if ( info.type == DHCPOFFER ) {
	printerr("no acknowledgement from DHCP server\nconfiguring %s with offered parameters\n", ifname);
	return dhcp_configure(ifname, &info);
	}
	errno = ETIME;
	close(s);
	return -1;
	}
	timeout = timeout * 2;

	transmit:
	size = 0;
	msg = NULL;
	switch(state) {
	case STATE_SELECTING:
	msg = &discover_msg;
	size = init_dhcp_discover_msg(msg, hwaddr, xid);
	break;
	case STATE_REQUESTING:
	msg = &request_msg;
	size = init_dhcp_request_msg(msg, hwaddr, xid, info.ipaddr, info.serveraddr);
	break;
	default:
	r = 0;
	}
	if (size != 0) {
	r = send_message(s, if_index, msg, size);
	if (r < 0) {
	printerr("error sending dhcp msg: %s\n", strerror(errno));
	}
	}
	continue;
	}

	if (r < 0) {
	if ((errno == EAGAIN) \|\| (errno == EINTR)) {
	continue;
	}
	return fatal("poll failed");
	}

	errno = 0;
	r = receive_packet(s, &reply);
	if (r < 0) {
	if (errno != 0) {
	ALOGD("receive_packet failed (%d): %s", r, strerror(errno));
	if (errno == ENETDOWN \|\| errno == ENXIO) {
	return -1;
	}
	}
	continue;
	}

	#if VERBOSE > 1
	dump_dhcp_msg(&reply, r);
	#endif
	decode_dhcp_msg(&reply, r, &info);

	if (state == STATE_SELECTING) {
	valid_reply = is_valid_reply(&discover_msg, &reply, r);
	} else {
	valid_reply = is_valid_reply(&request_msg, &reply, r);
	}
	if (!valid_reply) {
	printerr("invalid reply\n");
	continue;
	}

	if (verbose) dump_dhcp_info(&info);

	switch(state) {
	case STATE_SELECTING:
	if (info.type == DHCPOFFER) {
	state = STATE_REQUESTING;
	timeout = TIMEOUT_INITIAL;
	xid++;
	goto transmit;
	}
	break;
	case STATE_REQUESTING:
	if (info.type == DHCPACK) {
	printerr("configuring %s\n", ifname);
	close(s);
	return dhcp_configure(ifname, &info);
	} else if (info.type == DHCPNAK) {
	printerr("configuration request denied\n");
	close(s);
	return -1;
	} else {
	printerr("ignoring %s message in state %d\n",
	dhcp_type_to_name(info.type), state);
	}
	break;
	}
	}
	close(s);
	return 0;
	}

	int do_dhcp(char *iname)
	{
	if (ifc_set_addr(iname, 0)) {
	printerr("failed to set ip addr for %s to 0.0.0.0: %s\n", iname, strerror(errno));
	return -1;
	}

	if (ifc_up(iname)) {
	printerr("failed to bring up interface %s: %s\n", iname, strerror(errno));
	return -1;
	}

	return dhcp_init_ifc(iname);
	}