[ar71xx] ag71xx driver: forgot to add a new file
[openwrt/svn-archive/archive.git] / target / linux / ar71xx / files / drivers / net / ag71xx / ag71xx_ar8216.c
1 /*
2 * Atheros AR71xx built-in ethernet mac driver
3 * Special support for the Atheros ar8216 switch chip
4 *
5 * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>
6 *
7 * Based on Atheros' AG7100 driver
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License version 2 as published
11 * by the Free Software Foundation.
12 */
13
14 #include "ag71xx.h"
15
16 #define AR8216_PACKET_TYPE_MASK 0xf
17 #define AR8216_PACKET_TYPE_NORMAL 0
18
19 #define AR8216_HEADER_LEN 2
20
21 void ag71xx_add_ar8216_header(struct ag71xx *ag, struct sk_buff *skb)
22 {
23 struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
24
25 if (!pdata->has_ar8216)
26 return;
27
28 skb_push(skb, AR8216_HEADER_LEN);
29 skb->data[0] = 0x10;
30 skb->data[1] = 0x80;
31 }
32
33 int ag71xx_remove_ar8216_header(struct ag71xx *ag,
34 struct sk_buff *skb)
35 {
36 struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
37 u8 type;
38
39 if (!pdata->has_ar8216)
40 return 0;
41
42 type = skb->data[1] & AR8216_PACKET_TYPE_MASK;
43
44 switch (type) {
45 case AR8216_PACKET_TYPE_NORMAL:
46 skb_pull(skb, AR8216_HEADER_LEN);
47 break;
48 default:
49 return -EINVAL;
50 }
51
52 return 0;
53 }