From: Simon Goldschmidt <goldsimon@gmx.de>
Date: Tue, 26 Jul 2011 19:03:27 +0000 (+0200)
Subject: ETHARP_SUPPORT_VLAN: add support for an external VLAN filter function instead of... 
X-Git-Url: http://rtime.felk.cvut.cz/gitweb/pes-rpp/rpp-lwip.git/commitdiff_plain/242dc34115143b502e9165ecf337c90bd62e2a87

ETHARP_SUPPORT_VLAN: add support for an external VLAN filter function instead of only checking for one VLAN (define ETHARP_VLAN_CHECK_FN)
---

diff --git a/CHANGELOG b/CHANGELOG
index 42cf341a..e31b2985 100644
--- a/CHANGELOG
+++ b/CHANGELOG
@@ -6,6 +6,10 @@ HISTORY
 
  ++ New features:
 
+  2011-08-26: Simon Goldschmidt
+  * etharp.c: ETHARP_SUPPORT_VLAN: add support for an external VLAN filter
+    function instead of only checking for one VLAN (define ETHARP_VLAN_CHECK_FN)
+
   2011-07-21: Simon Goldschmidt (patch by hanhui)
   * ip4.c, etharp.c, pbuf.h: bug #33634 ip_forward() have a faulty behaviour:
     Added pbuf flags to mark incoming packets as link-layer broadcast/multicast.
diff --git a/src/include/lwip/opt.h b/src/include/lwip/opt.h
index f4647b64..8ae6ba4d 100644
--- a/src/include/lwip/opt.h
+++ b/src/include/lwip/opt.h
@@ -461,6 +461,8 @@
  * Additionally, you can define ETHARP_VLAN_CHECK to an u16_t VLAN ID to check.
  * If ETHARP_VLAN_CHECK is defined, only VLAN-traffic for this VLAN is accepted.
  * If ETHARP_VLAN_CHECK is not defined, all traffic is accepted.
+ * Alternatively, define a function/define ETHARP_VLAN_CHECK_FN(eth_hdr, vlan)
+ * that returns 1 to accept a packet or 0 to drop a packet.
  */
 #ifndef ETHARP_SUPPORT_VLAN
 #define ETHARP_SUPPORT_VLAN             0
diff --git a/src/netif/etharp.c b/src/netif/etharp.c
index f2b87e27..8b333dd9 100644
--- a/src/netif/etharp.c
+++ b/src/netif/etharp.c
@@ -1297,13 +1297,17 @@ ethernet_input(struct pbuf *p, struct netif *netif)
       ETHARP_STATS_INC(etharp.drop);
       goto free_and_return;
     }
-#ifdef ETHARP_VLAN_CHECK /* if not, allow all VLANs */
+#if defined(ETHARP_VLAN_CHECK) || defined(ETHARP_VLAN_CHECK_FN) /* if not, allow all VLANs */
+#ifdef ETHARP_VLAN_CHECK_FN
+    if (!ETHARP_VLAN_CHECK_FN(ethhdr, vlan)) {
+#elif defined(ETHARP_VLAN_CHECK)
     if (VLAN_ID(vlan) != ETHARP_VLAN_CHECK) {
+#endif
       /* silently ignore this packet: not for our VLAN */
       pbuf_free(p);
       return ERR_OK;
     }
-#endif /* ETHARP_VLAN_CHECK */
+#endif /* defined(ETHARP_VLAN_CHECK) || defined(ETHARP_VLAN_CHECK_FN) */
     type = vlan->tpid;
     ip_hdr_offset = SIZEOF_ETH_HDR + SIZEOF_VLAN_HDR;
   }