00001 /* 00002 * Copyright (C) 2008 by egnite GmbH. 00003 * Copyright (c) 1982, 1989, 1993 by The Regents of the University of California. 00004 * 00005 * All rights reserved. 00006 * 00007 * Redistribution and use in source and binary forms, with or without 00008 * modification, are permitted provided that the following conditions 00009 * are met: 00010 * 00011 * 1. Redistributions of source code must retain the above copyright 00012 * notice, this list of conditions and the following disclaimer. 00013 * 2. Redistributions in binary form must reproduce the above copyright 00014 * notice, this list of conditions and the following disclaimer in the 00015 * documentation and/or other materials provided with the distribution. 00016 * 3. Neither the name of the copyright holders nor the names of 00017 * contributors may be used to endorse or promote products derived 00018 * from this software without specific prior written permission. 00019 * 00020 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 00021 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 00022 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 00023 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 00024 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 00025 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 00026 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 00027 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 00028 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 00029 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 00030 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 00031 * SUCH DAMAGE. 00032 * 00033 * For additional information see http://www.ethernut.de/ 00034 */ 00035 00048 #include <sys/types.h> 00049 #include <sys/heap.h> 00050 #include <netinet/if_ether.h> 00051 #include <net/ether.h> 00052 00053 #include <stdlib.h> 00054 #include <memdebug.h> 00055 00060 00064 typedef struct _ETH_PROTOCOLS ETH_PROTOCOLS; 00065 00066 struct _ETH_PROTOCOLS { 00067 ETH_PROTOCOLS *ethp_next; 00068 uint16_t ethp_type; 00069 uint16_t ethp_mask; 00070 int (*ethp_input)(NUTDEVICE *, NETBUF *); 00071 }; 00072 00073 static ETH_PROTOCOLS *eth_prot; 00074 00085 static int NutEtherDemux(NUTDEVICE * dev, NETBUF * nb) 00086 { 00087 ETH_PROTOCOLS *ep; 00088 uint16_t type = ntohs(((ETHERHDR *)nb->nb_dl.vp)->ether_type); 00089 00090 for (ep = eth_prot; ep; ep = ep->ethp_next) { 00091 if ((type & ep->ethp_mask) == ep->ethp_type) { 00092 if (ep->ethp_input && (*ep->ethp_input) (dev, nb) == 0) { 00093 return 0; 00094 } 00095 } 00096 } 00097 return -1; 00098 } 00099 00125 int NutRegisterEthHandler(uint16_t type, uint16_t mask, int (*hdlr)(NUTDEVICE *, NETBUF *)) 00126 { 00127 ETH_PROTOCOLS *ep; 00128 00129 /* Check existing registrations. */ 00130 for (ep = eth_prot; ep; ep = ep->ethp_next) { 00131 if (ep->ethp_type == type && ep->ethp_mask == mask) { 00132 /* Found one. */ 00133 break; 00134 } 00135 } 00136 00137 if (ep == NULL) { 00138 /* No existing entry. Allocate a new one. */ 00139 ep = calloc(1, sizeof(ETH_PROTOCOLS)); 00140 if (ep == NULL) { 00141 return -1; 00142 } 00143 /* Set type and mask of our new entry. */ 00144 ep->ethp_type = type; 00145 ep->ethp_mask = mask; 00146 if (eth_prot == NULL) { 00147 /* This is the first registration. Set the list root ... */ 00148 eth_prot = ep; 00149 /* ... and enable our demultiplexer. */ 00150 ether_demux = NutEtherDemux; 00151 } else { 00152 /* Not the first registration. Insert new handler at the top. */ 00153 ep->ethp_next = eth_prot; 00154 eth_prot = ep; 00155 } 00156 } 00157 /* Finally set the handler function pointer of the new or existing 00158 ** entry. */ 00159 ep->ethp_input = hdlr; 00160 00161 return 0; 00162 } 00163