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

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@14657 3c298f89-4303-0410-b956-a3cf2f4a3e73
master
Gabor Juhos 2009-02-25 17:52:14 +00:00
parent bde9cc7cd1
commit b0d77eccb7
1 changed files with 53 additions and 0 deletions

View File

@ -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;
}