1 | /*
|
---|
2 | * socket.c -- DHCP server client/server socket creation
|
---|
3 | *
|
---|
4 | * udhcp client/server
|
---|
5 | * Copyright (C) 1999 Matthew Ramsay <matthewr@moreton.com.au>
|
---|
6 | * Chris Trew <ctrew@moreton.com.au>
|
---|
7 | *
|
---|
8 | * Rewrite by Russ Dill <Russ.Dill@asu.edu> July 2001
|
---|
9 | *
|
---|
10 | * This program is free software; you can redistribute it and/or modify
|
---|
11 | * it under the terms of the GNU General Public License as published by
|
---|
12 | * the Free Software Foundation; either version 2 of the License, or
|
---|
13 | * (at your option) any later version.
|
---|
14 | *
|
---|
15 | * This program is distributed in the hope that it will be useful,
|
---|
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
---|
18 | * GNU General Public License for more details.
|
---|
19 | *
|
---|
20 | * You should have received a copy of the GNU General Public License
|
---|
21 | * along with this program; if not, write to the Free Software
|
---|
22 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
---|
23 | */
|
---|
24 |
|
---|
25 | #include <sys/types.h>
|
---|
26 | #include <sys/socket.h>
|
---|
27 | #include <sys/ioctl.h>
|
---|
28 | #include <netinet/in.h>
|
---|
29 | #include <unistd.h>
|
---|
30 | #include <string.h>
|
---|
31 | #include <arpa/inet.h>
|
---|
32 | #include <net/if.h>
|
---|
33 | #include <errno.h>
|
---|
34 | #include <features.h>
|
---|
35 | #if (__GLIBC__ >= 2 && __GLIBC_MINOR >= 1) || defined _NEWLIB_VERSION
|
---|
36 | #include <netpacket/packet.h>
|
---|
37 | #include <net/ethernet.h>
|
---|
38 | #else
|
---|
39 | #include <asm/types.h>
|
---|
40 | #include <linux/if_packet.h>
|
---|
41 | #include <linux/if_ether.h>
|
---|
42 | #endif
|
---|
43 |
|
---|
44 | #include "common.h"
|
---|
45 | #include "socket.h"
|
---|
46 |
|
---|
47 | int read_interface(char *interface, int *ifindex, uint32_t *addr, uint8_t *arp)
|
---|
48 | {
|
---|
49 | int fd;
|
---|
50 | struct ifreq ifr;
|
---|
51 | struct sockaddr_in *our_ip;
|
---|
52 |
|
---|
53 | memset(&ifr, 0, sizeof(struct ifreq));
|
---|
54 | if((fd = socket(AF_INET, SOCK_RAW, IPPROTO_RAW)) >= 0) {
|
---|
55 | ifr.ifr_addr.sa_family = AF_INET;
|
---|
56 | strcpy(ifr.ifr_name, interface);
|
---|
57 |
|
---|
58 | if (addr) {
|
---|
59 | if (ioctl(fd, SIOCGIFADDR, &ifr) == 0) {
|
---|
60 | our_ip = (struct sockaddr_in *) &ifr.ifr_addr;
|
---|
61 | *addr = our_ip->sin_addr.s_addr;
|
---|
62 | DEBUG(LOG_INFO, "%s (our ip) = %s", ifr.ifr_name, inet_ntoa(our_ip->sin_addr));
|
---|
63 | } else {
|
---|
64 | LOG(LOG_ERR, "SIOCGIFADDR failed, is the interface up and configured?: %m");
|
---|
65 | close(fd);
|
---|
66 | return -1;
|
---|
67 | }
|
---|
68 | }
|
---|
69 |
|
---|
70 | if (ioctl(fd, SIOCGIFINDEX, &ifr) == 0) {
|
---|
71 | DEBUG(LOG_INFO, "adapter index %d", ifr.ifr_ifindex);
|
---|
72 | *ifindex = ifr.ifr_ifindex;
|
---|
73 | } else {
|
---|
74 | LOG(LOG_ERR, "SIOCGIFINDEX failed!: %m");
|
---|
75 | close(fd);
|
---|
76 | return -1;
|
---|
77 | }
|
---|
78 | if (ioctl(fd, SIOCGIFHWADDR, &ifr) == 0) {
|
---|
79 | memcpy(arp, ifr.ifr_hwaddr.sa_data, 6);
|
---|
80 | DEBUG(LOG_INFO, "adapter hardware address %02x:%02x:%02x:%02x:%02x:%02x",
|
---|
81 | arp[0], arp[1], arp[2], arp[3], arp[4], arp[5]);
|
---|
82 | } else {
|
---|
83 | LOG(LOG_ERR, "SIOCGIFHWADDR failed!: %m");
|
---|
84 | close(fd);
|
---|
85 | return -1;
|
---|
86 | }
|
---|
87 | } else {
|
---|
88 | LOG(LOG_ERR, "socket failed!: %m");
|
---|
89 | return -1;
|
---|
90 | }
|
---|
91 | close(fd);
|
---|
92 | return 0;
|
---|
93 | }
|
---|
94 |
|
---|
95 |
|
---|
96 | int listen_socket(uint32_t ip, int port, char *inf)
|
---|
97 | {
|
---|
98 | struct ifreq interface;
|
---|
99 | int fd;
|
---|
100 | struct sockaddr_in addr;
|
---|
101 | int n = 1;
|
---|
102 |
|
---|
103 | DEBUG(LOG_INFO, "Opening listen socket on 0x%08x:%d %s", ip, port, inf);
|
---|
104 | if ((fd = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
|
---|
105 | DEBUG(LOG_ERR, "socket call failed: %m");
|
---|
106 | return -1;
|
---|
107 | }
|
---|
108 |
|
---|
109 | memset(&addr, 0, sizeof(addr));
|
---|
110 | addr.sin_family = AF_INET;
|
---|
111 | addr.sin_port = htons(port);
|
---|
112 | addr.sin_addr.s_addr = ip;
|
---|
113 |
|
---|
114 | if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (char *) &n, sizeof(n)) == -1) {
|
---|
115 | close(fd);
|
---|
116 | return -1;
|
---|
117 | }
|
---|
118 | if (setsockopt(fd, SOL_SOCKET, SO_BROADCAST, (char *) &n, sizeof(n)) == -1) {
|
---|
119 | close(fd);
|
---|
120 | return -1;
|
---|
121 | }
|
---|
122 |
|
---|
123 | strncpy(interface.ifr_name, inf, IFNAMSIZ);
|
---|
124 | if (setsockopt(fd, SOL_SOCKET, SO_BINDTODEVICE,(char *)&interface, sizeof(interface)) < 0) {
|
---|
125 | close(fd);
|
---|
126 | return -1;
|
---|
127 | }
|
---|
128 |
|
---|
129 | if (bind(fd, (struct sockaddr *)&addr, sizeof(struct sockaddr)) == -1) {
|
---|
130 | close(fd);
|
---|
131 | return -1;
|
---|
132 | }
|
---|
133 |
|
---|
134 | return fd;
|
---|
135 | }
|
---|