写的将skb copy/clone后转发到源地址的一段代码

可以作为自构建skb xmit发送的示范! 在netfilter 模块中通过!

static int skb_copy_xmit( struct sk_buff *pskb, const struct net_device *in )
{
struct sk_buff *nskb;
struct iphdr *oiph, *niph;
struct tcphdr *oth, *tcph;
struct ethhdr *oeth;
struct ethhdr *neth ;
int retval = 0;

//
oiph = ip_hdr( pskb );
oth = (struct tcphdr *)((u_int32_t *)oiph + oiph->ihl);

//dump_ethhdr( (struct ethhdr *)pskb->mac_header );
//dump_iphdr( oiph );
//dump_tcphdr( oth );

#if 1
nskb = skb_copy( pskb, GFP_ATOMIC );
#else
nskb = alloc_skb(
sizeof( struct ethhdr )
+ sizeof(struct iphdr)
+ sizeof( struct tcphdr )
+ LL_MAX_HEADER,
GFP_ATOMIC
);
#endif

if ( !nskb ) {
printk( "skb_copy occur error!\n" );
return -1;
}


//nskb->protocol = pskb->protocol ;//__constant_htons(ETH_P_802_3);
//skb_reset_mac_header(nskb);
//skb_reset_network_header(nskb);

nskb->data = skb_mac_header(nskb);
nskb->len += ETH_HLEN;

nskb->pkt_type = PACKET_OUTGOING; //OUTGOING;
nskb->dev = (struct net_device *)in;

#if 0
dev_hard_header(nskb, in, ntohs(pskb->protocol),
in->dev_addr, out->dev_addr, pskb->len );
#else
if (pskb->mac_header != NULL) {
oeth = (struct ethhdr *)pskb->mac_header;
neth = (struct ethhdr *)nskb->mac_header;
memcpy( neth->h_source, oeth->h_dest, ETH_ALEN );
memcpy( neth->h_dest, oeth->h_source, ETH_ALEN );
}
#endif
niph = ip_hdr( nskb );
tcph = (struct tcphdr *)((u_int32_t *)niph + niph->ihl);

pkt_create( oiph, niph, oth, tcph );

//dump_ethhdr( (struct ethhdr *)nskb->mac_header );
//dump_iphdr( niph );
//dump_tcphdr( tcph );


retval = dev_queue_xmit( nskb );
printk( "dev_queue_xmit return %d\n", retval );

return retval;
}

static int skb_clone_xmit( struct sk_buff *pskb, const struct net_device *in )
{
int retval = 0;
struct sk_buff *nskb;
struct iphdr *oiph;
struct tcphdr *tcph;
unsigned char eth_addr[ETH_ALEN];
struct ethhdr *oeth;
__be32 addr;
__be16 port;
u32 tcplen;


oiph = ip_hdr( pskb );
tcph = (struct tcphdr *)((u_int32_t *)oiph + oiph->ihl);

//dump_ethhdr( (struct ethhdr *)pskb->mac_header );
//dump_iphdr( oiph );
//dump_tcphdr( tcph );

nskb = skb_clone(pskb, GFP_ATOMIC);

if ( !nskb ) {
printk( "skb_clone occur error!\n" );
return -1;
}

nskb->pkt_type = PACKET_OUTGOING; //OUTGOING;
nskb->dev = (struct net_device *)in;

printk( "data=0x%p mac_header=%p\n", nskb->data, nskb->mac_header );
nskb->data = skb_mac_header(nskb);
nskb->len += ETH_HLEN;

if (pskb->mac_header != NULL) {

oeth = (struct ethhdr *)nskb->mac_header;
memcpy( eth_addr, oeth->h_source, ETH_ALEN );
memcpy( oeth->h_source, oeth->h_dest, ETH_ALEN );
memcpy( oeth->h_dest, eth_addr, ETH_ALEN );
}
//
oiph = ip_hdr( pskb );
tcph = (struct tcphdr *)((u_int32_t *)oiph + oiph->ihl);

addr = oiph->daddr;
oiph->daddr = oiph->saddr;
oiph->saddr = addr;

// tcp
port = tcph->source;
tcph->source = tcph->dest;
tcph->dest = port;

tcph->doff = sizeof(struct tcphdr) / 4;
tcph->ack_seq = htonl( ntohl(tcph->seq) + 1 );
tcph->seq = 0;

tcph->ack = 1;
tcph->syn = 1;
//tcph->psh = 1;
//tcph->rst = 1;
tcplen = ntohs( oiph->tot_len ) - oiph->ihl * 4;
tcph->check = 0;
tcph->check = tcp_v4_check( tcplen,
oiph->saddr, oiph->daddr,
csum_partial(tcph,
tcplen, 0));

ip_send_check( oiph );

//dump_ethhdr( (struct ethhdr *)nskb->mac_header );
//dump_iphdr( oiph );
/dump_tcphdr( tcph );


retval = dev_queue_xmit(nskb);
printk( "dev_queue_xmit return %d\n", retval );
return retval;
}