505 lines
14 KiB
C
505 lines
14 KiB
C
/* $NetBSD: if_media.c,v 1.21 2004/02/19 11:58:30 ragge Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1998 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
|
|
* NASA Ames Research Center.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the NetBSD
|
|
* Foundation, Inc. and its contributors.
|
|
* 4. Neither the name of The NetBSD Foundation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* Copyright (c) 1997
|
|
* Jonathan Stone and Jason R. Thorpe. All rights reserved.
|
|
*
|
|
* This software is derived from information provided by Matt Thomas.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by Jonathan Stone
|
|
* and Jason R. Thorpe for the NetBSD Project.
|
|
* 4. The names of the authors may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* BSD/OS-compatible network interface media selection.
|
|
*
|
|
* Where it is safe to do so, this code strays slightly from the BSD/OS
|
|
* design. Software which uses the API (device drivers, basically)
|
|
* shouldn't notice any difference.
|
|
*
|
|
* Many thanks to Matt Thomas for providing the information necessary
|
|
* to implement this interface.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: if_media.c,v 1.21 2004/02/19 11:58:30 ragge Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/malloc.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_media.h>
|
|
#include <net/netisr.h>
|
|
|
|
/*
|
|
* Compile-time options:
|
|
* IFMEDIA_DEBUG:
|
|
* turn on implementation-level debug printfs.
|
|
* Useful for debugging newly-ported drivers.
|
|
*/
|
|
|
|
#ifdef IFMEDIA_DEBUG
|
|
int ifmedia_debug = 0;
|
|
static void ifmedia_printword __P((int));
|
|
#endif
|
|
|
|
/*
|
|
* Initialize if_media struct for a specific interface instance.
|
|
*/
|
|
void
|
|
ifmedia_init(ifm, dontcare_mask, change_callback, status_callback)
|
|
struct ifmedia *ifm;
|
|
int dontcare_mask;
|
|
ifm_change_cb_t change_callback;
|
|
ifm_stat_cb_t status_callback;
|
|
{
|
|
|
|
TAILQ_INIT(&ifm->ifm_list);
|
|
ifm->ifm_cur = NULL;
|
|
ifm->ifm_media = 0;
|
|
ifm->ifm_mask = dontcare_mask; /* IF don't-care bits */
|
|
ifm->ifm_change = change_callback;
|
|
ifm->ifm_status = status_callback;
|
|
}
|
|
|
|
/*
|
|
* Add a media configuration to the list of supported media
|
|
* for a specific interface instance.
|
|
*/
|
|
void
|
|
ifmedia_add(ifm, mword, data, aux)
|
|
struct ifmedia *ifm;
|
|
int mword;
|
|
int data;
|
|
void *aux;
|
|
{
|
|
struct ifmedia_entry *entry;
|
|
|
|
#ifdef IFMEDIA_DEBUG
|
|
if (ifmedia_debug) {
|
|
if (ifm == NULL) {
|
|
printf("ifmedia_add: null ifm\n");
|
|
return;
|
|
}
|
|
printf("Adding entry for ");
|
|
ifmedia_printword(mword);
|
|
}
|
|
#endif
|
|
|
|
entry = malloc(sizeof(*entry), M_IFADDR, M_NOWAIT);
|
|
if (entry == NULL)
|
|
panic("ifmedia_add: can't malloc entry");
|
|
|
|
entry->ifm_media = mword;
|
|
entry->ifm_data = data;
|
|
entry->ifm_aux = aux;
|
|
|
|
TAILQ_INSERT_TAIL(&ifm->ifm_list, entry, ifm_list);
|
|
}
|
|
|
|
/*
|
|
* Add an array of media configurations to the list of
|
|
* supported media for a specific interface instance.
|
|
*/
|
|
void
|
|
ifmedia_list_add(ifm, lp, count)
|
|
struct ifmedia *ifm;
|
|
struct ifmedia_entry *lp;
|
|
int count;
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < count; i++)
|
|
ifmedia_add(ifm, lp[i].ifm_media, lp[i].ifm_data,
|
|
lp[i].ifm_aux);
|
|
}
|
|
|
|
/*
|
|
* Set the default active media.
|
|
*
|
|
* Called by device-specific code which is assumed to have already
|
|
* selected the default media in hardware. We do _not_ call the
|
|
* media-change callback.
|
|
*/
|
|
void
|
|
ifmedia_set(ifm, target)
|
|
struct ifmedia *ifm;
|
|
int target;
|
|
{
|
|
struct ifmedia_entry *match;
|
|
|
|
match = ifmedia_match(ifm, target, ifm->ifm_mask);
|
|
|
|
/*
|
|
* If we didn't find the requested media, then we try to fall
|
|
* back to target-type (IFM_ETHER, e.g.) | IFM_NONE. If that's
|
|
* not on the list, then we add it and set the media to it.
|
|
*
|
|
* Since ifmedia_set is almost always called with IFM_AUTO or
|
|
* with a known-good media, this really should only occur if we:
|
|
*
|
|
* a) didn't find any PHYs, or
|
|
* b) didn't find an autoselect option on the PHY when the
|
|
* parent ethernet driver expected to.
|
|
*
|
|
* In either case, it makes sense to select no media.
|
|
*/
|
|
if (match == NULL) {
|
|
printf("ifmedia_set: no match for 0x%x/0x%x\n",
|
|
target, ~ifm->ifm_mask);
|
|
target = (target & IFM_NMASK) | IFM_NONE;
|
|
match = ifmedia_match(ifm, target, ifm->ifm_mask);
|
|
if (match == NULL) {
|
|
ifmedia_add(ifm, target, 0, NULL);
|
|
match = ifmedia_match(ifm, target, ifm->ifm_mask);
|
|
if (match == NULL) {
|
|
panic("ifmedia_set failed");
|
|
}
|
|
}
|
|
}
|
|
ifm->ifm_cur = match;
|
|
|
|
#ifdef IFMEDIA_DEBUG
|
|
if (ifmedia_debug) {
|
|
printf("ifmedia_set: target ");
|
|
ifmedia_printword(target);
|
|
printf("ifmedia_set: setting to ");
|
|
ifmedia_printword(ifm->ifm_cur->ifm_media);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Device-independent media ioctl support function.
|
|
*/
|
|
int
|
|
ifmedia_ioctl(ifp, ifr, ifm, cmd)
|
|
struct ifnet *ifp;
|
|
struct ifreq *ifr;
|
|
struct ifmedia *ifm;
|
|
u_long cmd;
|
|
{
|
|
struct ifmedia_entry *match;
|
|
struct ifmediareq *ifmr = (struct ifmediareq *) ifr;
|
|
int error = 0;
|
|
|
|
if (ifp == NULL || ifr == NULL || ifm == NULL)
|
|
return (EINVAL);
|
|
|
|
switch (cmd) {
|
|
|
|
/*
|
|
* Set the current media.
|
|
*/
|
|
case SIOCSIFMEDIA:
|
|
{
|
|
struct ifmedia_entry *oldentry;
|
|
u_int oldmedia;
|
|
u_int newmedia = ifr->ifr_media;
|
|
|
|
match = ifmedia_match(ifm, newmedia, ifm->ifm_mask);
|
|
if (match == NULL) {
|
|
#ifdef IFMEDIA_DEBUG
|
|
if (ifmedia_debug) {
|
|
printf(
|
|
"ifmedia_ioctl: no media found for 0x%x\n",
|
|
newmedia);
|
|
}
|
|
#endif
|
|
return (EINVAL);
|
|
}
|
|
|
|
/*
|
|
* If no change, we're done.
|
|
* XXX Automedia may involve software intervention.
|
|
* Keep going in case the connected media changed.
|
|
* Similarly, if best match changed (kernel debugger?).
|
|
*/
|
|
if ((IFM_SUBTYPE(newmedia) != IFM_AUTO) &&
|
|
(newmedia == ifm->ifm_media) &&
|
|
(match == ifm->ifm_cur))
|
|
return 0;
|
|
|
|
/*
|
|
* We found a match, now make the driver switch to it.
|
|
* Make sure to preserve our old media type in case the
|
|
* driver can't switch.
|
|
*/
|
|
#ifdef IFMEDIA_DEBUG
|
|
if (ifmedia_debug) {
|
|
printf("ifmedia_ioctl: switching %s to ",
|
|
ifp->if_xname);
|
|
ifmedia_printword(match->ifm_media);
|
|
}
|
|
#endif
|
|
oldentry = ifm->ifm_cur;
|
|
oldmedia = ifm->ifm_media;
|
|
ifm->ifm_cur = match;
|
|
ifm->ifm_media = newmedia;
|
|
error = (*ifm->ifm_change)(ifp);
|
|
if (error) {
|
|
ifm->ifm_cur = oldentry;
|
|
ifm->ifm_media = oldmedia;
|
|
}
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Get list of available media and current media on interface.
|
|
*/
|
|
case SIOCGIFMEDIA:
|
|
{
|
|
struct ifmedia_entry *ep;
|
|
size_t nwords;
|
|
|
|
if (ifmr->ifm_count < 0)
|
|
return EINVAL;
|
|
|
|
ifmr->ifm_active = ifmr->ifm_current = ifm->ifm_cur ?
|
|
ifm->ifm_cur->ifm_media : IFM_NONE;
|
|
ifmr->ifm_mask = ifm->ifm_mask;
|
|
ifmr->ifm_status = 0;
|
|
(*ifm->ifm_status)(ifp, ifmr);
|
|
|
|
/*
|
|
* Count them so we know a-priori how much is the max we'll
|
|
* need.
|
|
*/
|
|
ep = TAILQ_FIRST(&ifm->ifm_list);
|
|
for (nwords = 0; ep != NULL; ep = TAILQ_NEXT(ep, ifm_list))
|
|
nwords++;
|
|
|
|
if (ifmr->ifm_count != 0) {
|
|
size_t count;
|
|
size_t minwords = nwords > (size_t)ifmr->ifm_count
|
|
? (size_t)ifmr->ifm_count
|
|
: nwords;
|
|
int *kptr = (int *)malloc(minwords * sizeof(int),
|
|
M_TEMP, M_WAITOK);
|
|
/*
|
|
* Get the media words from the interface's list.
|
|
*/
|
|
ep = TAILQ_FIRST(&ifm->ifm_list);
|
|
for (count = 0; ep != NULL && count < minwords;
|
|
ep = TAILQ_NEXT(ep, ifm_list), count++)
|
|
kptr[count] = ep->ifm_media;
|
|
|
|
error = copyout(kptr, ifmr->ifm_ulist,
|
|
minwords * sizeof(int));
|
|
if (error == 0 && ep != NULL)
|
|
error = E2BIG; /* oops! */
|
|
free(kptr, M_TEMP);
|
|
}
|
|
ifmr->ifm_count = nwords;
|
|
break;
|
|
}
|
|
|
|
default:
|
|
return (EINVAL);
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
/*
|
|
* Find media entry matching a given ifm word.
|
|
*/
|
|
struct ifmedia_entry *
|
|
ifmedia_match(ifm, target, mask)
|
|
struct ifmedia *ifm;
|
|
u_int target;
|
|
u_int mask;
|
|
{
|
|
struct ifmedia_entry *match, *next;
|
|
|
|
match = NULL;
|
|
mask = ~mask;
|
|
|
|
for (next = TAILQ_FIRST(&ifm->ifm_list); next != NULL;
|
|
next = TAILQ_NEXT(next, ifm_list)) {
|
|
if ((next->ifm_media & mask) == (target & mask)) {
|
|
if (match) {
|
|
#if defined(IFMEDIA_DEBUG) || defined(DIAGNOSTIC)
|
|
printf("ifmedia_match: multiple match for "
|
|
"0x%x/0x%x, selected instance %d\n",
|
|
target, mask, IFM_INST(match->ifm_media));
|
|
#endif
|
|
break;
|
|
}
|
|
match = next;
|
|
}
|
|
}
|
|
|
|
return match;
|
|
}
|
|
|
|
/*
|
|
* Delete all media for a given instance.
|
|
*/
|
|
void
|
|
ifmedia_delete_instance(ifm, inst)
|
|
struct ifmedia *ifm;
|
|
u_int inst;
|
|
{
|
|
struct ifmedia_entry *ife, *nife;
|
|
|
|
for (ife = TAILQ_FIRST(&ifm->ifm_list); ife != NULL;
|
|
ife = nife) {
|
|
nife = TAILQ_NEXT(ife, ifm_list);
|
|
if (inst == IFM_INST_ANY ||
|
|
inst == IFM_INST(ife->ifm_media)) {
|
|
TAILQ_REMOVE(&ifm->ifm_list, ife, ifm_list);
|
|
free(ife, M_DEVBUF);
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Compute the interface `baudrate' from the media, for the interface
|
|
* metrics (used by routing daemons).
|
|
*/
|
|
static const struct ifmedia_baudrate ifmedia_baudrate_descriptions[] =
|
|
IFM_BAUDRATE_DESCRIPTIONS;
|
|
|
|
u_quad_t
|
|
ifmedia_baudrate(int mword)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; ifmedia_baudrate_descriptions[i].ifmb_word != 0; i++) {
|
|
if ((mword & (IFM_NMASK|IFM_TMASK)) ==
|
|
ifmedia_baudrate_descriptions[i].ifmb_word)
|
|
return (ifmedia_baudrate_descriptions[i].ifmb_baudrate);
|
|
}
|
|
|
|
/* Not known. */
|
|
return (0);
|
|
}
|
|
|
|
#ifdef IFMEDIA_DEBUG
|
|
|
|
static const struct ifmedia_description ifm_type_descriptions[] =
|
|
IFM_TYPE_DESCRIPTIONS;
|
|
|
|
static const struct ifmedia_description ifm_subtype_descriptions[] =
|
|
IFM_SUBTYPE_DESCRIPTIONS;
|
|
|
|
static const struct ifmedia_description ifm_option_descriptions[] =
|
|
IFM_OPTION_DESCRIPTIONS;
|
|
|
|
/*
|
|
* print a media word.
|
|
*/
|
|
static void
|
|
ifmedia_printword(ifmw)
|
|
int ifmw;
|
|
{
|
|
const struct ifmedia_description *desc;
|
|
int seen_option = 0;
|
|
|
|
/* Print the top-level interface type. */
|
|
for (desc = ifm_type_descriptions; desc->ifmt_string != NULL;
|
|
desc++) {
|
|
if (IFM_TYPE(ifmw) == desc->ifmt_word)
|
|
break;
|
|
}
|
|
if (desc->ifmt_string == NULL)
|
|
printf("<unknown type> ");
|
|
else
|
|
printf("%s ", desc->ifmt_string);
|
|
|
|
/* Print the subtype. */
|
|
for (desc = ifm_subtype_descriptions; desc->ifmt_string != NULL;
|
|
desc++) {
|
|
if (IFM_TYPE_MATCH(desc->ifmt_word, ifmw) &&
|
|
IFM_SUBTYPE(desc->ifmt_word) == IFM_SUBTYPE(ifmw))
|
|
break;
|
|
}
|
|
if (desc->ifmt_string == NULL)
|
|
printf("<unknown subtype>");
|
|
else
|
|
printf("%s", desc->ifmt_string);
|
|
|
|
/* Print any options. */
|
|
for (desc = ifm_option_descriptions; desc->ifmt_string != NULL;
|
|
desc++) {
|
|
if (IFM_TYPE_MATCH(desc->ifmt_word, ifmw) &&
|
|
(ifmw & desc->ifmt_word) != 0 &&
|
|
(seen_option & IFM_OPTIONS(desc->ifmt_word)) == 0) {
|
|
if (seen_option == 0)
|
|
printf(" <");
|
|
printf("%s%s", seen_option ? "," : "",
|
|
desc->ifmt_string);
|
|
seen_option |= IFM_OPTIONS(desc->ifmt_word);
|
|
}
|
|
}
|
|
printf("%s\n", seen_option ? ">" : "");
|
|
}
|
|
|
|
#endif /* IFMEDIA_DEBUG */
|