LinkAddresses.cpp   [plain text]

/*
 * Copyright (c) 2002 Apple Computer, Inc. All rights reserved.
 *
 * @APPLE_LICENSE_HEADER_START@
 * 
 * Copyright (c) 1999-2003 Apple Computer, Inc.  All Rights Reserved.
 * 
 * This file contains Original Code and/or Modifications of Original Code
 * as defined in and that are subject to the Apple Public Source License
 * Version 2.0 (the 'License'). You may not use this file except in
 * compliance with the License. Please obtain a copy of the License at
 * http://www.opensource.apple.com/apsl/ and read it before using this
 * file.
 * 
 * The Original Code and all software distributed under the License are
 * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
 * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
 * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
 * Please see the License for the specific language governing rights and
 * limitations under the License.
 * 
 * @APPLE_LICENSE_HEADER_END@
 */
 
/*!
 *  @header LinkAddresses
 */
 
 
#include <stdio.h>
#include <unistd.h>
#include <stdlib.h>
#include <sys/types.h>
#include <sys/ioctl.h>
#include <sys/sysctl.h>
#include <sys/socket.h>
#include <sys/filio.h>
#include <errno.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_media.h>
#include <net/route.h>
#include <string.h>

#include "LinkAddresses.h"	

char*
sockaddr_dl_create_macaddr_string( struct sockaddr_dl * dl_p, const char* interfaceToMatch )
{
    int i;
    char	temp[10] = {0};
    char	bigTemp[20] = {0};
    char*	returnString = NULL;
    
    if ( dl_p->sdl_data && strcmp( dl_p->sdl_data, interfaceToMatch ) == 0 )
    {
        for (i = 0; i < dl_p->sdl_alen; i++)
        {
            sprintf( temp, "%s%2.2x", i ? ":" : "", ((unsigned char *)dl_p->sdl_data + dl_p->sdl_nlen)[i]);
            strcat( bigTemp, temp );
        }

        returnString = (char*)malloc( strlen(bigTemp)+1 );
        strcpy( returnString, bigTemp );
    }
    
    return returnString;
}

void
sockaddr_dl_print(struct sockaddr_dl * dl_p)
{
    int i;

    printf("link: len %d index %d family %d type 0x%x nlen %d alen %d"
	   " slen %d addr ", dl_p->sdl_len, 
	   dl_p->sdl_index,  dl_p->sdl_family, dl_p->sdl_type,
	   dl_p->sdl_nlen, dl_p->sdl_alen, dl_p->sdl_slen);
    for (i = 0; i < dl_p->sdl_alen; i++) 
	printf("%s%x", i ? ":" : "", 
	       ((unsigned char *)dl_p->sdl_data + dl_p->sdl_nlen)[i]);
    printf("\n");
}

struct sockaddr_dl *
LinkAddresses_lookup(LinkAddresses_t * list, char * ifname)
{
    int i;
    int len = strlen(ifname);

    for (i = 0; i < list->count; i++) {
	struct sockaddr_dl * sdl = list->list[i];

	if (strncmp(sdl->sdl_data, ifname, sdl->sdl_nlen) == 0
	    && len == sdl->sdl_nlen) {
	    return (sdl);
	}
    }
    return (NULL);
}

void
LinkAddresses_free(LinkAddresses_t * * list_p)
{
    int i;
    LinkAddresses_t * list = *list_p;

    if (list) {
	for (i = 0; i < list->count; i++) {
	    free(list->list[i]);
	    list->list[i] = NULL;
	}
	free(list->list);
	list->list = NULL;
	list->count = 0;
	free(list);
    }
    *list_p = NULL;
    return;
}

LinkAddresses_t *
LinkAddresses_create()
{
    char *			buf = NULL;
    size_t			buf_len = 0;
    int				mib[6];
    int				offset = 0;
    struct sockaddr_dl * *	list = NULL;
    int				list_size = 1;
    int				list_count = 0;
    LinkAddresses_t *		ret_list = NULL;

    mib[0] = CTL_NET;
    mib[1] = PF_ROUTE;
    mib[2] = 0;
    mib[3] = AF_LINK;
    mib[4] = NET_RT_IFLIST;
    mib[5] = 0;

    if (sysctl(mib, 6, NULL, &buf_len, NULL, 0) < 0) {
		goto failed;
    }
    buf = (char*)malloc(buf_len);
    if (sysctl(mib, 6, buf, &buf_len, NULL, 0) < 0) {
		goto failed;
    }
    list = (struct sockaddr_dl * *)malloc(sizeof(*list) * list_size);
    if (list == NULL) {
	goto failed;
    }
    offset = 0;
    while (offset < (int)buf_len) {
	struct if_msghdr * 	ifm;
	struct sockaddr_dl *	sdl;
	struct sockaddr_dl * 	new_p;

	ifm = (struct if_msghdr *)&buf[offset];

	switch (ifm->ifm_type) {
	case RTM_IFINFO:
	    /* get interface name */
	    sdl = (struct sockaddr_dl *)(ifm + 1);
	    if (list_count == list_size) {
		list_size *= 2;
		list = (struct sockaddr_dl * *)realloc(list, sizeof(*list) * list_size);
		if (list == NULL) {
		    goto failed;
		}
	    }
	    new_p = (struct sockaddr_dl *)malloc(sdl->sdl_len);
	    if (new_p == NULL) {
		break;
	    }
	    bcopy(sdl, new_p, sdl->sdl_len);
	    list[list_count++] = new_p;
	    break;

	default:
	    break;
	}
	/* advance to next address/interface */
	offset += ifm->ifm_msglen;
    }
    if (list_count == 0) {
	free(list);
	list = NULL;
    }
    else if (list_count < list_size) {
	list = (struct sockaddr_dl * *)realloc(list, sizeof(*list) * list_count);
    }
    if (list) {
	ret_list = (LinkAddresses_t *)malloc(sizeof(*ret_list));
	if (ret_list) {
	    ret_list->list = list;
	    ret_list->count = list_count;
	}
	else {
	    free(list);
	    list = NULL;
	}
    }
 failed:
    if (buf) {
	free(buf);
    }
    return (ret_list);
}