75 lines
2.6 KiB
C
75 lines
2.6 KiB
C
/*
|
|
* Copyright (c) 2015 iComm-semi Ltd.
|
|
*
|
|
* Permission to use, copy, modify, and/or distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/version.h>
|
|
#include "ssv_skb.h"
|
|
#include <ssv6200.h>
|
|
#ifdef CONFIG_FW_ALIGNMENT_CHECK
|
|
#include <hwif/sdio/sdio_def.h>
|
|
#endif
|
|
|
|
struct sk_buff *ssv_skb_alloc(void *app_param, s32 len)
|
|
{
|
|
struct sk_buff *skb;
|
|
int header_len = (SSV6200_PKT_HEADROOM_RSVD > SSV_SKB_info_size) ? SSV6200_PKT_HEADROOM_RSVD : SSV_SKB_info_size;
|
|
|
|
#ifdef CONFIG_FW_ALIGNMENT_CHECK
|
|
skb = __dev_alloc_skb(len + SSV6200_ALLOC_RSVD + PLATFORM_DEF_DMA_ALIGN_SIZE - 1, GFP_KERNEL);
|
|
#else
|
|
skb = __dev_alloc_skb(len + SSV6200_ALLOC_RSVD, GFP_KERNEL);
|
|
#endif
|
|
if (skb != NULL) {
|
|
skb_reserve(skb, header_len);
|
|
#ifdef CONFIG_FW_ALIGNMENT_CHECK
|
|
if ((unsigned long)skb->data % PLATFORM_DEF_DMA_ALIGN_SIZE) {
|
|
unsigned long shift = PLATFORM_DEF_DMA_ALIGN_SIZE - ((unsigned long)skb->data % PLATFORM_DEF_DMA_ALIGN_SIZE);
|
|
skb_reserve(skb, shift);
|
|
}
|
|
#endif
|
|
}
|
|
return skb;
|
|
}
|
|
|
|
struct sk_buff *ssv_skb_alloc_ex(void *app_param, s32 len, gfp_t gfp_mask)
|
|
{
|
|
//struct ssv_softc *sc;
|
|
struct sk_buff *skb;
|
|
int header_len = (SSV6200_PKT_HEADROOM_RSVD > SSV_SKB_info_size) ? SSV6200_PKT_HEADROOM_RSVD : SSV_SKB_info_size;
|
|
|
|
#ifdef CONFIG_FW_ALIGNMENT_CHECK
|
|
skb = __dev_alloc_skb(len + SSV6200_ALLOC_RSVD + PLATFORM_DEF_DMA_ALIGN_SIZE - 1, gfp_mask);
|
|
#else
|
|
skb = __dev_alloc_skb(len + SSV6200_ALLOC_RSVD , gfp_mask);
|
|
#endif
|
|
if (skb != NULL) {
|
|
skb_reserve(skb, header_len);
|
|
#ifdef CONFIG_FW_ALIGNMENT_CHECK
|
|
if ((unsigned long)skb->data % PLATFORM_DEF_DMA_ALIGN_SIZE) {
|
|
unsigned long shift = PLATFORM_DEF_DMA_ALIGN_SIZE - ((unsigned long)skb->data % PLATFORM_DEF_DMA_ALIGN_SIZE);
|
|
skb_reserve(skb, shift);
|
|
}
|
|
#endif
|
|
}
|
|
return skb;
|
|
}
|
|
|
|
|
|
void ssv_skb_free(void *app_param, struct sk_buff *skb)
|
|
{
|
|
dev_kfree_skb_any(skb);
|
|
}
|