Back to Blog

基于NXP LS1043 +FPGA ARM64位平台验证网口驱动钩子

#arm开发#fpga开发

之前在X86上验证过网口驱动的收发钩子,今天特意把代码放到LS1043单板上验证一下,看是否可行。
单板环境 LINUX 4.19.68
交叉编译器 GCC 7.5.0
CPU NXP LS1043 ARMV8 A53

测试代码如下:

#include   <linux/module.h>#include   <linux/init.h>#include   <linux/kernel.h>#include   <linux/netfilter.h>#include   <linux/netfilter_ipv4.h>#include   <linux/ip.h>#include   <net/ip.h>#include   <linux/udp.h>#include   <linux/in.h>#include   <linux/skbuff.h>#include   <linux/netdevice.h>#include   <linux/if_ether.h>#include   <linux/if.h>  unsigned int lan_tx_hook_fn(void *priv, struct sk_buff *skb, const struct nf_hook_state *state){    const struct ethhdr *ethheader = eth_hdr(skb);    const struct iphdr *iph = ip_hdr(skb);    char *tail;     if (strcmp("eth0", state->out->name))    {	//printk(KERN_INFO "state->out->name = %s, len=%d", state->out->name, strlen(state->out->name));        return NF_ACCEPT;    }         printk(KERN_INFO "skb->head = 0x%08lx, data = 0x%08lx, tail = 0x%08lx,  end = 0x%08lx", 	skb->head, skb->data, skb->tail, skb->end);     tail = __skb_put(skb, 4);    memset(tail, 0xaa, 4);     //filter ip        if (iph->protocol == 0)    {        printk(KERN_INFO "send (%s) pkt protocol:%u, Src: %08x, Dst: %08x, len: %d \n",            state->out->name, iph->protocol, ntohl(iph->saddr), ntohl(iph->daddr));        return NF_ACCEPT;    }     return NF_ACCEPT;} unsigned int lan_rx_hook_fn(void *priv, struct sk_buff *skb, const struct nf_hook_state *state){    const struct iphdr *iph = ip_hdr(skb);     if (strcmp("eth0", state->in->name))    {        return NF_ACCEPT;    }     printk(KERN_INFO "skb->len = %d, %d", skb->len, skb->data_len);         //filter ip        if (iph->protocol == 0)    {        printk(KERN_INFO "recv (%s) pkt protocol:%u, Src: %08x, Dst: %08x, len: %d \n",            state->in->name, iph->protocol, ntohl(iph->saddr), ntohl(iph->daddr), iph->tot_len);        return NF_ACCEPT;    }     return NF_ACCEPT;} //挂载钩子,挂在出口处理的位置static struct nf_hook_ops nf_lan_hook[] = {    {        .hook = (nf_hookfn *)lan_tx_hook_fn,        .pf = PF_INET,        .hooknum = NF_INET_LOCAL_OUT,//挂载在TX处理报文的节点        .priority = NF_IP_PRI_FIRST, //最高优先级    },     {        .hook = (nf_hookfn *)lan_rx_hook_fn,        .pf = PF_INET,        .hooknum = NF_INET_FORWARD,      //挂载在RX报文的节点        .priority = NF_IP_PRI_FIRST + 1, // 优先级比第一个低一点    }}; static int lan_hook_init(void){    printk(KERN_INFO "lan_hook_init \n");        /*注册钩子*/    nf_register_net_hooks(&init_net, nf_lan_hook, ARRAY_SIZE(nf_lan_hook));     return 0;} static void lan_hook_exit(void){    printk(KERN_INFO "lan_hook_exit \n");        /*卸载钩子*/    nf_unregister_net_hooks(&init_net, nf_lan_hook, ARRAY_SIZE(nf_lan_hook));} module_init(lan_hook_init);module_exit(lan_hook_exit); MODULE_LICENSE("GPL");MODULE_AUTHOR("bull-man"); MODULE_DESCRIPTION("lan rx/tx filter");

编写Makefile文件,如下

//KDIR是内核编译结果所在路径KDIR:= /home/xxxx/flexbuild_lsdk1909/build/linux/linux/arm64/LS/output obj-m :=lan_tx_hook.o all:	make -C $(KDIR) M=$(PWD) modules clean:	rm -f *.ko *.o *.mod.o *.mod.c *.symvers *.order

编译 命令 :
make -f Makefile ARCH=arm64

如果没有错误,则产生 lan_tx_hook.ko 内核模块

将内核文件通过 TFTP 加载到单板上,插入内核。执行效果如下

[root@LSDK tmp]# tftp -r lan_tx_hook.ko -g 10.8.8.114[root@LSDK tmp]# lsdbus            lan_tx_hook.ko[root@LSDK tmp]# chmod 777 lan_tx_hook.ko [root@LSDK tmp]# insmod lan_tx_hook.ko [  118.406138] lan_tx_hook: loading out-of-tree module taints kernel.[  118.412586] lan_hook_init [root@LSDK tmp]# [root@LSDK tmp]# [root@LSDK tmp]# [root@LSDK tmp]# ping 10.8.8.114PING 10.8.8.114 (10.8.8.114): 56 data bytes64 bytes from 10.8.8.114: seq=0 ttl=128 time=0.563 ms[  133.893739] skb->head = 0xffff80003ccc3400, data = 0xffff80003ccc3450, tail = 0x000000a4,  end = 0x000000c064 bytes from 10.8.8.114: seq=1 ttl=128 time=10.098 ms[  134.893815] skb->head = 0xffff80003ccc3200, data = 0xffff80003ccc3250, tail = 0x000000a4,  end = 0x000000c064 bytes from 10.8.8.114: seq=2 ttl=128 time=10.020 ms^C--- 10.8.8.114 ping statistics ---

以上总结,注意两点
1、内核模块编译所需要的内核源码路径要设置正确;
2、make的时候需要加ARCH参数,否则编译不过