aboutsummaryrefslogtreecommitdiffstats
path: root/package/ifxmips-atm/src/skb.c
diff options
context:
space:
mode:
Diffstat (limited to 'package/ifxmips-atm/src/skb.c')
-rw-r--r--package/ifxmips-atm/src/skb.c128
1 files changed, 128 insertions, 0 deletions
diff --git a/package/ifxmips-atm/src/skb.c b/package/ifxmips-atm/src/skb.c
new file mode 100644
index 0000000000..7ad60fd757
--- /dev/null
+++ b/package/ifxmips-atm/src/skb.c
@@ -0,0 +1,128 @@
+#include <linux/skbuff.h>
+
+#include "common.h"
+
+void resize_skb_rx(struct sk_buff *skb, unsigned int size, int is_cell)
+{
+ if((u32)skb < 0x80000000)
+ {
+ int key = 0;
+ printk("resize_skb_rx problem: skb = %08X, size = %d, is_cell = %d\n", (u32)skb, size, is_cell);
+ while(!key){}
+ }
+ skb->data = (unsigned char*)(((u32)skb->head + 16 + (DMA_ALIGNMENT - 1)) & ~(DMA_ALIGNMENT - 1));
+ skb->tail = skb->data;
+
+ /* Set up other state */
+ skb->len = 0;
+ skb->cloned = 0;
+#if defined(CONFIG_IMQ) || defined (CONFIG_IMQ_MODULE)
+ skb->imq_flags = 0;
+ skb->nf_info = NULL;
+#endif
+ skb->data_len = 0;
+}
+
+struct sk_buff* alloc_skb_rx(void)
+{
+ struct sk_buff *skb;
+
+ /* allocate memroy including trailer and padding */
+ skb = dev_alloc_skb(ppe_dev.aal5.rx_buffer_size + DMA_ALIGNMENT);
+ if (skb)
+ {
+ /* must be burst length alignment */
+ if ( ((u32)skb->data & (DMA_ALIGNMENT - 1)) != 0 )
+ skb_reserve(skb, ~((u32)skb->data + (DMA_ALIGNMENT - 1)) & (DMA_ALIGNMENT - 1));
+ /* put skb in reserved area "skb->data - 4" */
+ *((u32*)skb->data - 1) = (u32)skb;
+ /* invalidate cache */
+ dma_cache_inv((unsigned long)skb->head, (u32)skb->end - (u32)skb->head);
+ }
+ return skb;
+}
+
+void atm_free_tx_skb_vcc(struct sk_buff *skb)
+{
+ struct atm_vcc* vcc;
+
+ if ( (u32)skb <= 0x80000000 )
+ {
+ volatile int key = 0;
+ printk("atm_free_tx_skb_vcc: skb = %08X\n", (u32)skb);
+ for ( ; !key; );
+ }
+
+ vcc = ATM_SKB(skb)->vcc;
+ if ( vcc != NULL && vcc->pop != NULL )
+ {
+ if ( atomic_read(&skb->users) == 0 )
+ {
+ volatile int key = 0;
+ printk("atm_free_tx_skb_vcc(vcc->pop): skb->users == 0, skb = %08X\n", (u32)skb);
+ for ( ; !key; );
+ }
+ vcc->pop(vcc, skb);
+ }
+ else
+ {
+ if ( atomic_read(&skb->users) == 0 )
+ {
+ volatile int key = 0;
+ printk("atm_free_tx_skb_vcc(dev_kfree_skb_any): skb->users == 0, skb = %08X\n", (u32)skb);
+ for ( ; !key; );
+ }
+ dev_kfree_skb_any(skb);
+ }
+}
+
+struct sk_buff* alloc_skb_tx(unsigned int size)
+{
+ struct sk_buff *skb;
+
+ /* allocate memory including header and padding */
+ size += TX_INBAND_HEADER_LENGTH + MAX_TX_PACKET_ALIGN_BYTES + MAX_TX_PACKET_PADDING_BYTES;
+ size &= ~(DMA_ALIGNMENT - 1);
+ skb = dev_alloc_skb(size + DMA_ALIGNMENT);
+ /* must be burst length alignment */
+ if ( skb )
+ skb_reserve(skb, (~((u32)skb->data + (DMA_ALIGNMENT - 1)) & (DMA_ALIGNMENT - 1)) + TX_INBAND_HEADER_LENGTH);
+ return skb;
+}
+
+struct sk_buff* atm_alloc_tx(struct atm_vcc *vcc, unsigned int size)
+{
+ int conn;
+ struct sk_buff *skb;
+
+ /* oversize packet */
+ if ( ((size + TX_INBAND_HEADER_LENGTH + MAX_TX_PACKET_ALIGN_BYTES + MAX_TX_PACKET_PADDING_BYTES) & ~(DMA_ALIGNMENT - 1)) > ppe_dev.aal5.tx_max_packet_size )
+ {
+ printk("atm_alloc_tx: oversize packet\n");
+ return NULL;
+ }
+ /* send buffer overflow */
+ if ( atomic_read(&vcc->sk.sk_wmem_alloc) && !atm_may_send(vcc, size) )
+ {
+ printk("atm_alloc_tx: send buffer overflow\n");
+ return NULL;
+ }
+ conn = find_vcc(vcc);
+ if ( conn < 0 )
+ {
+ printk("atm_alloc_tx: unknown VCC\n");
+ return NULL;
+ }
+
+ skb = dev_alloc_skb(size);
+ if ( skb == NULL )
+ {
+ printk("atm_alloc_tx: sk buffer is used up\n");
+ return NULL;
+ }
+#define ATM_PDU_OVHD 0
+ atomic_add(skb->truesize + ATM_PDU_OVHD, &vcc->sk.sk_wmem_alloc);
+
+ return skb;
+}
+