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