0dc71c
From c987623113e2d03e80f0ba1e108bf0a800628f85 Mon Sep 17 00:00:00 2001
0dc71c
From: Paulo Flabiano Smorigo <pfsmorigo@br.ibm.com>
0dc71c
Date: Tue, 30 Oct 2012 15:19:39 -0200
0dc71c
Subject: [PATCH 097/143] Add vlan-tag support
0dc71c
0dc71c
This patch adds support for virtual LAN (VLAN) tagging. VLAN tagging allows
0dc71c
multiple VLANs in a bridged network to share the same physical network link but
0dc71c
maintain isolation:
0dc71c
0dc71c
http://en.wikipedia.org/wiki/IEEE_802.1Q
0dc71c
0dc71c
This patch should fix this bugzilla:
0dc71c
https://bugzilla.redhat.com/show_bug.cgi?id=871563
0dc71c
---
0dc71c
 grub-core/kern/ieee1275/init.c   |  1 +
0dc71c
 grub-core/kern/ieee1275/openfw.c | 30 ++++++++++++++++++++++++++++
0dc71c
 grub-core/net/ethernet.c         | 42 +++++++++++++++++++++++++++++++++++++---
0dc71c
 include/grub/ieee1275/ieee1275.h |  1 +
0dc71c
 include/grub/net.h               |  2 ++
0dc71c
 5 files changed, 73 insertions(+), 3 deletions(-)
0dc71c
0dc71c
diff --git a/grub-core/kern/ieee1275/init.c b/grub-core/kern/ieee1275/init.c
0dc71c
index d5bd74d..8191f8c 100644
0dc71c
--- a/grub-core/kern/ieee1275/init.c
0dc71c
+++ b/grub-core/kern/ieee1275/init.c
0dc71c
@@ -117,6 +117,7 @@ grub_machine_get_bootlocation (char **device, char **path)
0dc71c
       char *dev, *canon;
0dc71c
       char *ptr;
0dc71c
       dev = grub_ieee1275_get_aliasdevname (bootpath);
0dc71c
+      grub_ieee1275_parse_net_options (bootpath);
0dc71c
       canon = grub_ieee1275_canonicalise_devname (dev);
0dc71c
       ptr = canon + grub_strlen (canon) - 1;
0dc71c
       while (ptr > canon && (*ptr == ',' || *ptr == ':'))
0dc71c
diff --git a/grub-core/kern/ieee1275/openfw.c b/grub-core/kern/ieee1275/openfw.c
0dc71c
index 6db8b98..81276fa 100644
0dc71c
--- a/grub-core/kern/ieee1275/openfw.c
0dc71c
+++ b/grub-core/kern/ieee1275/openfw.c
0dc71c
@@ -23,6 +23,7 @@
0dc71c
 #include <grub/mm.h>
0dc71c
 #include <grub/ieee1275/ieee1275.h>
0dc71c
 #include <grub/net.h>
0dc71c
+#include <grub/env.h>
0dc71c
 
0dc71c
 enum grub_ieee1275_parse_type
0dc71c
 {
0dc71c
@@ -451,6 +452,35 @@ fail:
0dc71c
   return ret;
0dc71c
 }
0dc71c
 
0dc71c
+int
0dc71c
+grub_ieee1275_parse_net_options (const char *path)
0dc71c
+{
0dc71c
+  char *comma;
0dc71c
+  char *args;
0dc71c
+  char *option = 0;
0dc71c
+
0dc71c
+  args = grub_ieee1275_get_devargs (path);
0dc71c
+  if (!args)
0dc71c
+    /* There is no option.  */
0dc71c
+    return -1;
0dc71c
+
0dc71c
+  do
0dc71c
+    {
0dc71c
+      comma = grub_strchr (args, ',');
0dc71c
+      if (! comma)
0dc71c
+        option = grub_strdup (args);
0dc71c
+      else
0dc71c
+        option = grub_strndup (args, (grub_size_t)(comma - args));
0dc71c
+      args = comma + 1;
0dc71c
+
0dc71c
+      if (! grub_strncmp(option, "vtag", 4))
0dc71c
+          grub_env_set ("vlan-tag", option + grub_strlen("vtag="));
0dc71c
+
0dc71c
+    } while (comma);
0dc71c
+
0dc71c
+  return 0;
0dc71c
+}
0dc71c
+
0dc71c
 char *
0dc71c
 grub_ieee1275_get_device_type (const char *path)
0dc71c
 {
0dc71c
diff --git a/grub-core/net/ethernet.c b/grub-core/net/ethernet.c
0dc71c
index c397b1b..faaca67 100644
0dc71c
--- a/grub-core/net/ethernet.c
0dc71c
+++ b/grub-core/net/ethernet.c
0dc71c
@@ -23,6 +23,7 @@
0dc71c
 #include <grub/net/arp.h>
0dc71c
 #include <grub/net/netbuff.h>
0dc71c
 #include <grub/net.h>
0dc71c
+#include <grub/env.h>
0dc71c
 #include <grub/time.h>
0dc71c
 #include <grub/net/arp.h>
0dc71c
 
0dc71c
@@ -56,10 +57,19 @@ send_ethernet_packet (struct grub_net_network_level_interface *inf,
0dc71c
 {
0dc71c
   struct etherhdr *eth;
0dc71c
   grub_err_t err;
0dc71c
+  grub_uint32_t vlantag = 0;
0dc71c
+  grub_uint8_t etherhdr_size;
0dc71c
 
0dc71c
-  COMPILE_TIME_ASSERT (sizeof (*eth) < GRUB_NET_MAX_LINK_HEADER_SIZE);
0dc71c
+  etherhdr_size = sizeof (*eth);
0dc71c
+  COMPILE_TIME_ASSERT (sizeof (*eth) + 4 < GRUB_NET_MAX_LINK_HEADER_SIZE);
0dc71c
 
0dc71c
-  err = grub_netbuff_push (nb, sizeof (*eth));
0dc71c
+  const char *vlantag_text = grub_env_get ("vlan-tag");
0dc71c
+  if (vlantag_text != 0) {
0dc71c
+      etherhdr_size += 4;
0dc71c
+      vlantag = grub_strtoul (vlantag_text, 0, 16);
0dc71c
+  }
0dc71c
+
0dc71c
+  err = grub_netbuff_push (nb, etherhdr_size);
0dc71c
   if (err)
0dc71c
     return err;
0dc71c
   eth = (struct etherhdr *) nb->data;
0dc71c
@@ -76,6 +86,19 @@ send_ethernet_packet (struct grub_net_network_level_interface *inf,
0dc71c
 	return err;
0dc71c
       inf->card->opened = 1;
0dc71c
     }
0dc71c
+
0dc71c
+  /* Check if a vlan-tag is needed. */
0dc71c
+  if (vlantag != 0)
0dc71c
+    {
0dc71c
+      /* Move eth type to the right */
0dc71c
+      grub_memcpy((char *) nb->data + etherhdr_size - 2,
0dc71c
+                  (char *) nb->data + etherhdr_size - 6, 2);
0dc71c
+
0dc71c
+      /* Add the tag in the middle */
0dc71c
+      grub_memcpy((char *) nb->data + etherhdr_size - 6,
0dc71c
+                  &vlantag, 4);
0dc71c
+    }
0dc71c
+
0dc71c
   return inf->card->driver->send (inf->card, nb);
0dc71c
 }
0dc71c
 
0dc71c
@@ -90,10 +113,23 @@ grub_net_recv_ethernet_packet (struct grub_net_buff *nb,
0dc71c
   grub_net_link_level_address_t hwaddress;
0dc71c
   grub_net_link_level_address_t src_hwaddress;
0dc71c
   grub_err_t err;
0dc71c
+  grub_uint8_t etherhdr_size = sizeof (*eth);
0dc71c
+
0dc71c
+  grub_uint16_t vlantag_identifier = 0;
0dc71c
+  grub_memcpy (&vlantag_identifier, nb->data + etherhdr_size - 2, 2);
0dc71c
+
0dc71c
+  /* Check if a vlan-tag is present. */
0dc71c
+  if (vlantag_identifier == VLANTAG_IDENTIFIER)
0dc71c
+    {
0dc71c
+      etherhdr_size += 4;
0dc71c
+      /* Move eth type to the original position */
0dc71c
+      grub_memcpy((char *) nb->data + etherhdr_size - 6,
0dc71c
+                  (char *) nb->data + etherhdr_size - 2, 2);
0dc71c
+    }
0dc71c
 
0dc71c
   eth = (struct etherhdr *) nb->data;
0dc71c
   type = grub_be_to_cpu16 (eth->type);
0dc71c
-  err = grub_netbuff_pull (nb, sizeof (*eth));
0dc71c
+  err = grub_netbuff_pull (nb, etherhdr_size);
0dc71c
   if (err)
0dc71c
     return err;
0dc71c
 
0dc71c
diff --git a/include/grub/ieee1275/ieee1275.h b/include/grub/ieee1275/ieee1275.h
0dc71c
index 9f26c69..6a21f5d 100644
0dc71c
--- a/include/grub/ieee1275/ieee1275.h
0dc71c
+++ b/include/grub/ieee1275/ieee1275.h
0dc71c
@@ -236,6 +236,7 @@ void EXPORT_FUNC(grub_ieee1275_children_first) (const char *devpath,
0dc71c
 						struct grub_ieee1275_devalias *alias);
0dc71c
 int EXPORT_FUNC(grub_ieee1275_cas_reboot) (char *script);
0dc71c
 int EXPORT_FUNC(grub_ieee1275_set_boot_last_label) (const char *text);
0dc71c
+int EXPORT_FUNC(grub_ieee1275_parse_net_options) (const char *path);
0dc71c
 
0dc71c
 #define FOR_IEEE1275_DEVALIASES(alias) for (grub_ieee1275_devalias_init_iterator (&(alias)); grub_ieee1275_devalias_next (&(alias));)
0dc71c
 
0dc71c
diff --git a/include/grub/net.h b/include/grub/net.h
0dc71c
index 538baa3..a799e6b 100644
0dc71c
--- a/include/grub/net.h
0dc71c
+++ b/include/grub/net.h
0dc71c
@@ -538,4 +538,6 @@ extern char *grub_net_default_server;
0dc71c
 #define GRUB_NET_INTERVAL 400
0dc71c
 #define GRUB_NET_INTERVAL_ADDITION 20
0dc71c
 
0dc71c
+#define VLANTAG_IDENTIFIER 0x8100
0dc71c
+
0dc71c
 #endif /* ! GRUB_NET_HEADER */
0dc71c
-- 
0dc71c
1.9.3
0dc71c