ccc3e6c501b57b153feb8ba14780ba9314b665e7
[dragonfly.git] / libexec / bootpd / hwaddr.c
1 /*
2  * hwaddr.c - routines that deal with hardware addresses.
3  * (i.e. Ethernet)
4  *
5  * $FreeBSD: src/libexec/bootpd/hwaddr.c,v 1.7.2.1 2003/02/15 05:36:01 kris Exp $
6  */
7
8 #include <sys/types.h>
9 #include <sys/param.h>
10 #include <sys/socket.h>
11 #include <sys/ioctl.h>
12
13 #if defined(SUNOS) || defined(SVR4)
14 #include <sys/sockio.h>
15 #endif
16 #ifdef  SVR4
17 #include <sys/stream.h>
18 #include <stropts.h>
19 #include <fcntl.h>
20 #endif
21
22 #ifdef _AIX32
23 #include <sys/time.h>   /* for struct timeval in net/if.h */
24 #include <net/if.h>     /* for struct ifnet in net/if_arp.h */
25 #endif
26
27 #include <net/if_arp.h>
28 #include <netinet/in.h>
29
30 #ifdef WIN_TCP
31 #include <netinet/if_ether.h>
32 #include <sys/dlpi.h>
33 #endif
34
35 #include <stdio.h>
36 #ifndef NO_UNISTD
37 #include <unistd.h>
38 #endif
39 #include <syslog.h>
40
41 #ifndef USE_BFUNCS
42 /* Yes, memcpy is OK here (no overlapped copies). */
43 #include <memory.h>
44 #define bcopy(a,b,c)    memcpy(b,a,c)
45 #define bzero(p,l)      memset(p,0,l)
46 #define bcmp(a,b,c)     memcmp(a,b,c)
47 #endif
48
49 #ifndef ATF_INUSE       /* Not defined on some systems (i.e. Linux) */
50 #define ATF_INUSE 0
51 #endif
52
53 /* For BSD 4.4, set arp entry by writing to routing socket */
54 #if defined(BSD)
55 #if BSD >= 199306
56 extern int bsd_arp_set (struct in_addr *, char *, int);
57 #endif
58 #endif
59
60 #include "bptypes.h"
61 #include "hwaddr.h"
62 #include "report.h"
63
64 extern int debug;
65
66 /*
67  * Hardware address lengths (in bytes) and network name based on hardware
68  * type code.  List in order specified by Assigned Numbers RFC; Array index
69  * is hardware type code.  Entries marked as zero are unknown to the author
70  * at this time.  .  .  .
71  */
72
73 struct hwinfo hwinfolist[] =
74 {
75         {0, "Reserved"},                        /* Type 0:  Reserved (don't use this)   */
76         {6, "Ethernet"},                        /* Type 1:  10Mb Ethernet (48 bits)     */
77         {1, "3Mb Ethernet"},            /* Type 2:   3Mb Ethernet (8 bits)      */
78         {0, "AX.25"},                           /* Type 3:  Amateur Radio AX.25         */
79         {1, "ProNET"},                          /* Type 4:  Proteon ProNET Token Ring   */
80         {0, "Chaos"},                           /* Type 5:  Chaos                       */
81         {6, "IEEE 802"},                        /* Type 6:  IEEE 802 Networks           */
82         {0, "ARCNET"}                           /* Type 7:  ARCNET                      */
83 };
84 int hwinfocnt = sizeof(hwinfolist) / sizeof(hwinfolist[0]);
85
86
87 /*
88  * Setup the arp cache so that IP address 'ia' will be temporarily
89  * bound to hardware address 'ha' of length 'len'.
90  *
91  * s         socket fd
92  * ia        protocol address
93  * hafamily  HW address family
94  * halen     HW address data
95  */
96 void
97 setarp(int s, struct in_addr *ia, int hafamily, u_char *haddr, int halen)
98 {
99 #ifdef  SIOCSARP
100 #ifdef  WIN_TCP
101         /* This is an SVR4 with different networking code from
102          * Wollongong WIN-TCP.  Not quite like the Lachman code.
103          * Code from: drew@drewsun.FEITH.COM (Andrew B. Sudell)
104          */
105 #undef  SIOCSARP
106 #define SIOCSARP ARP_ADD
107         struct arptab arpreq;           /* Arp table entry */
108
109         bzero((caddr_t) &arpreq, sizeof(arpreq));
110         arpreq.at_flags = ATF_COM;
111
112         /* Set up IP address */
113         arpreq.at_in = ia->s_addr;
114
115         /* Set up Hardware Address */
116         bcopy(haddr, arpreq.at_enaddr, halen);
117
118         /* Set the Date Link type. */
119         /* XXX - Translate (hafamily) to dltype somehow? */
120         arpreq.at_dltype = DL_ETHER;
121
122 #else   /* WIN_TCP */
123         /* Good old Berkeley way. */
124         struct arpreq arpreq;           /* Arp request ioctl block */
125         struct sockaddr_in *si;
126         char *p;
127
128         bzero((caddr_t) &arpreq, sizeof(arpreq));
129         arpreq.arp_flags = ATF_INUSE | ATF_COM;
130
131         /* Set up the protocol address. */
132         arpreq.arp_pa.sa_family = AF_INET;
133         si = (struct sockaddr_in *) &arpreq.arp_pa;
134         si->sin_addr = *ia;
135
136         /* Set up the hardware address. */
137 #ifdef  __linux__       /* XXX - Do others need this? -gwr */
138         /*
139          * Linux requires the sa_family field set.
140          * longyear@netcom.com (Al Longyear)
141          */
142         arpreq.arp_ha.sa_family = hafamily;
143 #endif  /* linux */
144
145         /* This variable is just to help catch type mismatches. */
146         p = arpreq.arp_ha.sa_data;
147         bcopy(haddr, p, halen);
148 #endif  /* WIN_TCP */
149
150 #ifdef  SVR4
151         /*
152          * And now the stuff for System V Rel 4.x which does not
153          * appear to allow SIOCxxx ioctls on a socket descriptor.
154          * Thanks to several people: (all sent the same fix)
155          *   Barney Wolff <barney@databus.com>,
156          *   bear@upsys.se (Bj|rn Sj|holm),
157          *   Michael Kuschke <Michael.Kuschke@Materna.DE>,
158          */
159         {
160                 int fd;
161                 struct strioctl iocb;
162
163                 if ((fd=open("/dev/arp", O_RDWR)) < 0) {
164                         report(LOG_ERR, "open /dev/arp: %s\n", get_errmsg());
165                 }
166                 iocb.ic_cmd = SIOCSARP;
167                 iocb.ic_timout = 0;
168                 iocb.ic_dp = (char *)&arpreq;
169                 iocb.ic_len = sizeof(arpreq);
170                 if (ioctl(fd, I_STR, (caddr_t)&iocb) < 0) {
171                         report(LOG_ERR, "ioctl I_STR: %s\n", get_errmsg());
172                 }
173                 close (fd);
174         }
175 #else   /* SVR4 */
176         /*
177          * On SunOS, the ioctl sometimes returns ENXIO, and it
178          * appears to happen when the ARP cache entry you tried
179          * to add is already in the cache.  (Sigh...)
180          * XXX - Should this error simply be ignored? -gwr
181          */
182         if (ioctl(s, SIOCSARP, (caddr_t) &arpreq) < 0) {
183                 report(LOG_ERR, "ioctl SIOCSARP: %s", get_errmsg());
184         }
185 #endif  /* SVR4 */
186 #else   /* SIOCSARP */
187 #if defined(BSD) && (BSD >= 199306)
188         bsd_arp_set(ia, haddr, halen);
189 #else
190         /*
191          * Oh well, SIOCSARP is not defined.  Just run arp(8).
192          * Need to delete partial entry first on some systems.
193          * XXX - Gag!
194          */
195         int status;
196         char buf[256];
197         char *a;
198         extern char *inet_ntoa();
199
200         a = inet_ntoa(*ia);
201         snprintf(buf, sizeof(buf), "arp -d %s; arp -s %s %s temp",
202                         a, a, haddrtoa(haddr, halen));
203         if (debug > 2)
204                 report(LOG_INFO, "%s", buf);
205         status = system(buf);
206         if (status)
207                 report(LOG_ERR, "arp failed, exit code=0x%x", status);
208         return;
209 #endif  /* ! 4.4 BSD */
210 #endif  /* SIOCSARP */
211 }
212
213
214 /*
215  * Convert a hardware address to an ASCII string.
216  */
217 char *
218 haddrtoa(u_char *haddr, int hlen)
219 {
220         static char haddrbuf[3 * MAXHADDRLEN + 1];
221         char *bufptr;
222
223         if (hlen > MAXHADDRLEN)
224                 hlen = MAXHADDRLEN;
225
226         bufptr = haddrbuf;
227         while (hlen > 0) {
228                 sprintf(bufptr, "%02X:", (unsigned) (*haddr++ & 0xFF));
229                 bufptr += 3;
230                 hlen--;
231         }
232         bufptr[-1] = 0;
233         return (haddrbuf);
234 }
235
236
237 /*
238  * haddr_conv802()
239  * --------------
240  *
241  * Converts a backwards address to a canonical address and a canonical address
242  * to a backwards address.
243  *
244  * INPUTS:
245  *  adr_in - pointer to six byte string to convert (unsigned char *)
246  *  addr_len - how many bytes to convert
247  *
248  * OUTPUTS:
249  *  addr_out - The string is updated to contain the converted address.
250  *
251  * CALLER:
252  *  many
253  *
254  * DATA:
255  *  Uses conv802table to bit-reverse the address bytes.
256  */
257
258 static u_char conv802table[256] =
259 {
260         /* 0x00 */ 0x00, 0x80, 0x40, 0xC0, 0x20, 0xA0, 0x60, 0xE0,
261         /* 0x08 */ 0x10, 0x90, 0x50, 0xD0, 0x30, 0xB0, 0x70, 0xF0,
262         /* 0x10 */ 0x08, 0x88, 0x48, 0xC8, 0x28, 0xA8, 0x68, 0xE8,
263         /* 0x18 */ 0x18, 0x98, 0x58, 0xD8, 0x38, 0xB8, 0x78, 0xF8,
264         /* 0x20 */ 0x04, 0x84, 0x44, 0xC4, 0x24, 0xA4, 0x64, 0xE4,
265         /* 0x28 */ 0x14, 0x94, 0x54, 0xD4, 0x34, 0xB4, 0x74, 0xF4,
266         /* 0x30 */ 0x0C, 0x8C, 0x4C, 0xCC, 0x2C, 0xAC, 0x6C, 0xEC,
267         /* 0x38 */ 0x1C, 0x9C, 0x5C, 0xDC, 0x3C, 0xBC, 0x7C, 0xFC,
268         /* 0x40 */ 0x02, 0x82, 0x42, 0xC2, 0x22, 0xA2, 0x62, 0xE2,
269         /* 0x48 */ 0x12, 0x92, 0x52, 0xD2, 0x32, 0xB2, 0x72, 0xF2,
270         /* 0x50 */ 0x0A, 0x8A, 0x4A, 0xCA, 0x2A, 0xAA, 0x6A, 0xEA,
271         /* 0x58 */ 0x1A, 0x9A, 0x5A, 0xDA, 0x3A, 0xBA, 0x7A, 0xFA,
272         /* 0x60 */ 0x06, 0x86, 0x46, 0xC6, 0x26, 0xA6, 0x66, 0xE6,
273         /* 0x68 */ 0x16, 0x96, 0x56, 0xD6, 0x36, 0xB6, 0x76, 0xF6,
274         /* 0x70 */ 0x0E, 0x8E, 0x4E, 0xCE, 0x2E, 0xAE, 0x6E, 0xEE,
275         /* 0x78 */ 0x1E, 0x9E, 0x5E, 0xDE, 0x3E, 0xBE, 0x7E, 0xFE,
276         /* 0x80 */ 0x01, 0x81, 0x41, 0xC1, 0x21, 0xA1, 0x61, 0xE1,
277         /* 0x88 */ 0x11, 0x91, 0x51, 0xD1, 0x31, 0xB1, 0x71, 0xF1,
278         /* 0x90 */ 0x09, 0x89, 0x49, 0xC9, 0x29, 0xA9, 0x69, 0xE9,
279         /* 0x98 */ 0x19, 0x99, 0x59, 0xD9, 0x39, 0xB9, 0x79, 0xF9,
280         /* 0xA0 */ 0x05, 0x85, 0x45, 0xC5, 0x25, 0xA5, 0x65, 0xE5,
281         /* 0xA8 */ 0x15, 0x95, 0x55, 0xD5, 0x35, 0xB5, 0x75, 0xF5,
282         /* 0xB0 */ 0x0D, 0x8D, 0x4D, 0xCD, 0x2D, 0xAD, 0x6D, 0xED,
283         /* 0xB8 */ 0x1D, 0x9D, 0x5D, 0xDD, 0x3D, 0xBD, 0x7D, 0xFD,
284         /* 0xC0 */ 0x03, 0x83, 0x43, 0xC3, 0x23, 0xA3, 0x63, 0xE3,
285         /* 0xC8 */ 0x13, 0x93, 0x53, 0xD3, 0x33, 0xB3, 0x73, 0xF3,
286         /* 0xD0 */ 0x0B, 0x8B, 0x4B, 0xCB, 0x2B, 0xAB, 0x6B, 0xEB,
287         /* 0xD8 */ 0x1B, 0x9B, 0x5B, 0xDB, 0x3B, 0xBB, 0x7B, 0xFB,
288         /* 0xE0 */ 0x07, 0x87, 0x47, 0xC7, 0x27, 0xA7, 0x67, 0xE7,
289         /* 0xE8 */ 0x17, 0x97, 0x57, 0xD7, 0x37, 0xB7, 0x77, 0xF7,
290         /* 0xF0 */ 0x0F, 0x8F, 0x4F, 0xCF, 0x2F, 0xAF, 0x6F, 0xEF,
291         /* 0xF8 */ 0x1F, 0x9F, 0x5F, 0xDF, 0x3F, 0xBF, 0x7F, 0xFF,
292 };
293
294 void
295 haddr_conv802(u_char *addr_in, u_char *addr_out, int len)
296 {
297         u_char *lim;
298
299         lim = addr_out + len;
300         while (addr_out < lim)
301                 *addr_out++ = conv802table[*addr_in++];
302 }
303
304 #if 0
305 /*
306  * For the record, here is a program to generate the
307  * bit-reverse table above.
308  */
309 static int
310 bitrev(int n)
311 {
312         int i, r;
313
314         r = 0;
315         for (i = 0; i < 8; i++) {
316                 r <<= 1;
317                 r |= (n & 1);
318                 n >>= 1;
319         }
320         return r;
321 }
322
323 int
324 main(void)
325 {
326         int i;
327         for (i = 0; i <= 0xFF; i++) {
328                 if ((i & 7) == 0)
329                         printf("/* 0x%02X */", i);
330                 printf(" 0x%02X,", bitrev(i));
331                 if ((i & 7) == 7)
332                         printf("\n");
333         }
334         return 0;
335 }
336
337 #endif