[ar71xx] ag71xx driver: forgot to add a new file

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@14657 3c298f89-4303-0410-b956-a3cf2f4a3e73

1 files changed, 53 insertions, 0 deletions

diff --git a/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c
new file mode 100644
index 000000000..39221ad62
--- /dev/null
+++ b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c
@@ -0,0 +1,53 @@
+/*
+ *  Atheros AR71xx built-in ethernet mac driver
+ *  Special support for the Atheros ar8216 switch chip
+ *
+ *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>
+ *
+ *  Based on Atheros' AG7100 driver
+ *
+ *  This program is free software; you can redistribute it and/or modify it
+ *  under the terms of the GNU General Public License version 2 as published
+ *  by the Free Software Foundation.
+ */
+
+#include "ag71xx.h"
+
+#define AR8216_PACKET_TYPE_MASK		0xf
+#define AR8216_PACKET_TYPE_NORMAL	0
+
+#define AR8216_HEADER_LEN	2
+
+void ag71xx_add_ar8216_header(struct ag71xx *ag, struct sk_buff *skb)
+{
+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
+
+	if (!pdata->has_ar8216)
+		return;
+
+        skb_push(skb, AR8216_HEADER_LEN);
+        skb->data[0] = 0x10;
+        skb->data[1] = 0x80;
+}
+
+int ag71xx_remove_ar8216_header(struct ag71xx *ag,
+				struct sk_buff *skb)
+{
+	struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
+	u8 type;
+
+	if (!pdata->has_ar8216)
+		return 0;
+
+	type = skb->data[1] & AR8216_PACKET_TYPE_MASK;
+
+	switch (type) {
+	case AR8216_PACKET_TYPE_NORMAL:
+		skb_pull(skb, AR8216_HEADER_LEN);
+		break;
+	default:
+		return -EINVAL;
+	}
+
+	return 0;
+}