From 96d669cc6873461a890b52cbb3ae0fe3f8c07d39 Mon Sep 17 00:00:00 2001 From: juhosg Date: Wed, 25 Feb 2009 17:52:14 +0000 Subject: [ar71xx] ag71xx driver: forgot to add a new file git-svn-id: svn://svn.openwrt.org/openwrt/trunk@14657 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- .../files/drivers/net/ag71xx/ag71xx_ar8216.c | 53 ++++++++++++++++++++++ 1 file changed, 53 insertions(+) create mode 100644 target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_ar8216.c (limited to 'target/linux/ar71xx') 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 0000000000..39221ad62c --- /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 + * + * 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; +} -- cgit v1.2.3