ar71xx: ag71xx: introduce ag71xx_has_ar8216() helper
SVN-Revision: 20505
This commit is contained in:
parent
200db5ebb5
commit
f9acf8ada1
3 changed files with 17 additions and 16 deletions
|
@ -456,6 +456,10 @@ static void inline ag71xx_mii_ctrl_set_speed(struct ag71xx *ag,
|
|||
#ifdef CONFIG_AG71XX_AR8216_SUPPORT
|
||||
void ag71xx_add_ar8216_header(struct ag71xx *ag, struct sk_buff *skb);
|
||||
int ag71xx_remove_ar8216_header(struct ag71xx *ag, struct sk_buff *skb);
|
||||
static inline int ag71xx_has_ar8216(struct ag71xx *ag)
|
||||
{
|
||||
return ag71xx_get_pdata(ag)->has_ar8216;
|
||||
}
|
||||
#else
|
||||
static inline void ag71xx_add_ar8216_header(struct ag71xx *ag,
|
||||
struct sk_buff *skb)
|
||||
|
@ -467,6 +471,10 @@ static inline int ag71xx_remove_ar8216_header(struct ag71xx *ag,
|
|||
{
|
||||
return 0;
|
||||
}
|
||||
static inline int ag71xx_has_ar8216(struct ag71xx *ag)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef CONFIG_AG71XX_DEBUG_FS
|
||||
|
|
|
@ -20,27 +20,17 @@
|
|||
|
||||
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;
|
||||
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);
|
||||
|
|
|
@ -614,7 +614,8 @@ static netdev_tx_t ag71xx_hard_start_xmit(struct sk_buff *skb,
|
|||
if (!ag71xx_desc_empty(desc))
|
||||
goto err_drop;
|
||||
|
||||
ag71xx_add_ar8216_header(ag, skb);
|
||||
if (ag71xx_has_ar8216(ag))
|
||||
ag71xx_add_ar8216_header(ag, skb);
|
||||
|
||||
if (skb->len <= 0) {
|
||||
DBG("%s: packet len is too small\n", ag->dev->name);
|
||||
|
@ -772,7 +773,7 @@ static int ag71xx_rx_packets(struct ag71xx *ag, int limit)
|
|||
struct ag71xx_desc *desc = ring->buf[i].desc;
|
||||
struct sk_buff *skb;
|
||||
int pktlen;
|
||||
int err;
|
||||
int err = 0;
|
||||
|
||||
if (ag71xx_desc_empty(desc))
|
||||
break;
|
||||
|
@ -795,7 +796,9 @@ static int ag71xx_rx_packets(struct ag71xx *ag, int limit)
|
|||
dev->stats.rx_packets++;
|
||||
dev->stats.rx_bytes += pktlen;
|
||||
|
||||
err = ag71xx_remove_ar8216_header(ag, skb);
|
||||
if (ag71xx_has_ar8216(ag))
|
||||
err = ag71xx_remove_ar8216_header(ag, skb);
|
||||
|
||||
if (err) {
|
||||
dev->stats.rx_dropped++;
|
||||
kfree_skb(skb);
|
||||
|
|
Loading…
Reference in a new issue