diff options
Diffstat (limited to 'target/linux/realtek/files/net/rtl/fastpath/fastpath_common.c')
| -rw-r--r-- | target/linux/realtek/files/net/rtl/fastpath/fastpath_common.c | 1068 |
1 files changed, 952 insertions, 116 deletions
diff --git a/target/linux/realtek/files/net/rtl/fastpath/fastpath_common.c b/target/linux/realtek/files/net/rtl/fastpath/fastpath_common.c index 4f17c5b45..616cb2c38 100644 --- a/target/linux/realtek/files/net/rtl/fastpath/fastpath_common.c +++ b/target/linux/realtek/files/net/rtl/fastpath/fastpath_common.c @@ -10,25 +10,92 @@ #endif #if defined (FAST_PPTP) || defined(FAST_L2TP) - #include <net/ip.h> + #include <net/ip.h> #endif #if defined(CONFIG_NET_SCHED) #include <linux/netfilter_ipv4/ip_tables.h> extern int gQosEnabled; #endif +#include <net/rtl/features/rtl_features.h> #include <net/rtl/fastpath/fastpath_core.h> #if defined(CONFIG_RTL_NF_CONNTRACK_GARBAGE_NEW) #include <net/rtl/features/rtl_features.h> #endif #include <net/rtl/rtl865x_nat.h> +#include <net/rtl/features/rtl_ps_log.h> + +#include <net/rtl/rtl_nic.h> #if defined(CONFIG_RTL_NF_CONNTRACK_GARBAGE_NEW) static int rtl_fp_gc_rx_threshold; #endif static int fast_nat_fw = 1; + +#if defined(IMPROVE_QOS) || defined(CONFIG_RTL_HW_QOS_SUPPORT) +#include <net/arp.h> +#include <net/rtl/rtl865x_netif.h> +//To query hardware address based on IP through arp table of dev +int arp_req_get_ha(__be32 queryIP, struct net_device *dev, unsigned char * resHwAddr) +{ + __be32 ip = queryIP; + struct neighbour *neigh; + int err = -ENXIO; + + neigh = neigh_lookup(&arp_tbl, &ip, dev); + if (neigh) { + read_lock_bh(&neigh->lock); + memcpy(resHwAddr, neigh->ha, dev->addr_len); + read_unlock_bh(&neigh->lock); + neigh_release(neigh); + err = 0; + } + //else + //{ + // resHwAddr=NULL; + //} + + return err; +} +//EXPORT_SYMBOL(arp_req_get_ha); +#endif + + +#if defined(FAST_PATH_SPI_ENABLED) +int fast_spi =1; +static struct proc_dir_entry *res_spi=NULL; +static int spi_read_proc(char *page, char **start, off_t off, + int count, int *eof, void *data) +{ + int len = 0; + + len = sprintf(page, "fast_spi %s\n", fast_spi==1?"Enabled":"Disabled"); + + if (len <= off+count) *eof = 1; + *start = page + off; + len -= off; + if (len>count) len = count; + if (len<0) len = 0; + return len; + +} +static int spi_write_proc(struct file *file, const char *buffer, + unsigned long count, void *data) +{ + unsigned char tmpbuf[16]; + + memset(tmpbuf, 0, sizeof(tmpbuf)); + if (buffer && !copy_from_user(tmpbuf, buffer, count)) + sscanf(tmpbuf, "%d", &fast_spi); + + return count; +} + +#endif + + #if defined(CONFIG_PROC_FS) static struct proc_dir_entry *res1=NULL; static int read_proc(char *page, char **start, off_t off, @@ -53,11 +120,11 @@ static int read_proc(char *page, char **start, off_t off, } static int write_proc(struct file *file, const char *buffer, unsigned long count, void *data) -{ +{ unsigned char tmpbuf[16]; struct net *net; - - if (count < 2) + + if (count < 2) return -EFAULT; memset(tmpbuf, 0, sizeof(tmpbuf)); @@ -65,13 +132,15 @@ static int write_proc(struct file *file, const char *buffer, if (tmpbuf[0] == '2'&&count==2){ /* first byte == 2, second byte == "enter" */ for_each_net(net) { - nf_conntrack_flush(net, 0, 0); //clean conntrack table + nf_conntrack_flush(net, 0, 0); //clean conntrack table } - #if defined(CONFIG_RTL_LAYERED_DRIVER_L4) && defined(CONFIG_RTL_8198) + #if defined(CONFIG_RTL_LAYERED_DRIVER_L4) + #if defined(CONFIG_RTL_8198) || defined (CONFIG_RTL_8196CT) rtl865x_nat_reinit(); /* the following 2 values MUST set behind reinit nat module */ - rtl_nat_expire_interval_update(RTL865X_PROTOCOL_TCP, tcp_get_timeouts_by_state(TCP_CONNTRACK_ESTABLISHED)); - rtl_nat_expire_interval_update(RTL865X_PROTOCOL_UDP, nf_ct_udp_timeout>nf_ct_udp_timeout_stream?nf_ct_udp_timeout:nf_ct_udp_timeout_stream); + //rtl_nat_expire_interval_update(RTL865X_PROTOCOL_TCP, tcp_get_timeouts_by_state(TCP_CONNTRACK_ESTABLISHED)); + //rtl_nat_expire_interval_update(RTL865X_PROTOCOL_UDP, nf_ct_udp_timeout>nf_ct_udp_timeout_stream?nf_ct_udp_timeout:nf_ct_udp_timeout_stream); + #endif #endif }else{ sscanf(tmpbuf, "%d", &fast_nat_fw); @@ -81,17 +150,17 @@ static int write_proc(struct file *file, const char *buffer, } #endif } - return count; + return count; } - + return -EFAULT; } #endif -#if defined(CONFIG_RTL_HW_QOS_SUPPORT) +#if defined(CONFIG_RTL_HW_QOS_SUPPORT) int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_mark *qosMark, struct sk_buff *pskb) { - struct iphdr *iph; + struct iphdr *iph; struct tcphdr *tcphupuh; //just keep one , don't care tcp or udp // u_int ori_saddr, ori_daddr; u_short ori_sport, ori_dport; @@ -104,7 +173,7 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma unsigned long irq_flags; uint32 preMark, postMark; - if(pskb==NULL) + if(pskb==NULL) return FAILED; //initial @@ -117,8 +186,16 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma wanDev=rtl865x_getWanDev(); proto = ntohs(pskb->protocol); iph = ip_hdr(pskb); + if(iph==NULL) + { + return FAILED; + } tcphupuh = (struct tcphdr*)((__u32 *)iph + iph->ihl); + if(eth_hdr(pskb)==NULL) + { + return FAILED; + } //To bak origal protol mac memcpy(oriSrcMac,eth_hdr(pskb)->h_source,ETH_ALEN); memcpy(oriDstMac,eth_hdr(pskb)->h_dest,ETH_ALEN); @@ -133,7 +210,7 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma ori_daddr=iph->daddr; ori_dport=tcphupuh->dest; - /* for dst mac match, please refer to the xt_mac.c */ + /* for dst mac match, please refer to the xt_mac.c */ dst_tmp = pskb->dst; pskb->dst = NULL; @@ -150,7 +227,7 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma memset(resMac,0,14); if((lanDev!=NULL)&&(arp_req_get_ha(naptEntry->intIp,lanDev,resMac)==0)) - { + { //Patch for pppoe wantype: run udp chariot //bak skb mac header if((memcmp(pskb->data-2, pppProto,2)==0) //equal 0x0021 @@ -159,7 +236,7 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma { skb_set_mac_header(pskb, -22); } - + //Replace source mac addr to check uplink mark memcpy(eth_hdr(pskb)->h_source,resMac, ETH_ALEN); memcpy(eth_hdr(pskb)->h_dest,lanDev->dev_addr, ETH_ALEN); @@ -172,10 +249,10 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma dev_net(lanDev)->ipv4.iptable_mangle); } - DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, - lanDev?lanDev->name:"NULL", - wanDev?wanDev->name:"NULL", - pskb->inDev?pskb->inDev->name:"NULL", + DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, + lanDev?lanDev->name:"NULL", + wanDev?wanDev->name:"NULL", + pskb->inDev?pskb->inDev->name:"NULL", pskb->dev?pskb->dev->name:"NULL", pskb->mark); preMark = pskb->mark; @@ -196,7 +273,7 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma { skb_set_mac_header(pskb, -22); } - + //Replace source mac addr to check uplink mark memcpy(eth_hdr(pskb)->h_dest,resMac, ETH_ALEN); memcpy(eth_hdr(pskb)->h_source,wanDev->dev_addr, ETH_ALEN); @@ -208,10 +285,10 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma ipt_do_table(pskb, NF_IP_POST_ROUTING, lanDev, wanDev,\ dev_net(wanDev)->ipv4.iptable_mangle); } - DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, - lanDev?lanDev->name:"NULL", - wanDev?wanDev->name:"NULL", - pskb->inDev?pskb->inDev->name:"NULL", + DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, + lanDev?lanDev->name:"NULL", + wanDev?wanDev->name:"NULL", + pskb->inDev?pskb->inDev->name:"NULL", pskb->dev?pskb->dev->name:"NULL", pskb->mark); postMark= pskb->mark; } @@ -232,7 +309,7 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma memset(resMac,0,14); if((wanDev!=NULL)&&(arp_req_get_ha(naptEntry->remIp,wanDev,resMac)==0)) - { + { //Patch for pppoe wantype: run udp chariot if((memcmp(pskb->data-2, pppProto,2)==0) //equal 0x0021 &&(skb_mac_header_was_set(pskb)==1) @@ -240,22 +317,22 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma { skb_set_mac_header(pskb, -22); } - + //Replace source mac addr to check uplink mark memcpy(eth_hdr(pskb)->h_source,resMac, ETH_ALEN); memcpy(eth_hdr(pskb)->h_dest, wanDev->dev_addr, ETH_ALEN); } - + pskb->mark=0;//initial if(proto == ETH_P_IP){ (list_empty(&nf_hooks[PF_INET][NF_IP_PRE_ROUTING]))?: \ ipt_do_table(pskb, NF_IP_PRE_ROUTING, wanDev,lanDev,\ dev_net(wanDev)->ipv4.iptable_mangle); } - DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, - lanDev?lanDev->name:"NULL", - wanDev?wanDev->name:"NULL", - pskb->inDev?pskb->inDev->name:"NULL", + DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, + lanDev?lanDev->name:"NULL", + wanDev?wanDev->name:"NULL", + pskb->inDev?pskb->inDev->name:"NULL", pskb->dev?pskb->dev->name:"NULL", pskb->mark); preMark = pskb->mark; @@ -286,10 +363,10 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma ipt_do_table(pskb, NF_IP_POST_ROUTING, wanDev, lanDev,\ dev_net(lanDev)->ipv4.iptable_mangle); } - DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, - lanDev?lanDev->name:"NULL", - wanDev?wanDev->name:"NULL", - pskb->inDev?pskb->inDev->name:"NULL", + DEBUGP_API("[%s][%d]:[%s][%s][%s][%s][%d]\n", __FUNCTION__, __LINE__, + lanDev?lanDev->name:"NULL", + wanDev?wanDev->name:"NULL", + pskb->inDev?pskb->inDev->name:"NULL", pskb->dev?pskb->dev->name:"NULL", pskb->mark); postMark= pskb->mark; } @@ -314,7 +391,7 @@ int32 rtl_qosGetSkbMarkByNaptEntry(rtl865x_napt_entry *naptEntry, rtl865x_qos_ma if(lanDev) dev_put(lanDev); - + if(wanDev) dev_put(wanDev); @@ -335,7 +412,7 @@ static inline void enter_fast_path_fast_l2tp_pre_process(struct sk_buff *skb) struct net_device *l2tprx_dev; struct in_device *skbIn_dev; struct net_device *skbNetDevice; - + if(fast_l2tp_fw){ l2tprx_dev = skb->dev; skbIn_dev = (struct in_device *)skb->dev->ip_ptr; @@ -418,61 +495,701 @@ int fast_path_pre_process_check(struct iphdr *iph, struct tcphdr *tcphupuh, stru return rtl_fp_gc_status_check(iph, tcphupuh, skb); } #endif - + return NET_RX_PASSBY; } -#if defined(FAST_L2TP) + static inline int enter_fast_path_fast_l2tp_post_process(struct sk_buff *skb) { - if (fast_l2tp_fw && skb->dev && (!memcmp(skb->dev->name, RTL_FASTPATH_PPP0_DEV_NAME, 4)) ) +#if defined(FAST_L2TP) + if (fast_l2tp_fw && skb->dev && (!memcmp(skb->dev->name, RTL_FASTPATH_PPP0_DEV_NAME, 4)) ) { - if (fast_l2tp_to_wan(skb)) // success + if (fast_l2tp_to_wan((void*)skb)) // success { return NET_RX_DROP; } } +#endif return NET_RX_SUCCESS; } + +static inline int enter_fast_path_fast_pppoe_post_process(struct sk_buff *skb) +{ + +#if defined(CONFIG_RTL_FAST_PPPOE) + if (fast_pppoe_xmit(skb)) // success + { + return NET_RX_DROP; + } #endif + return NET_RX_SUCCESS; +} + +#if defined(FASTPTH_INDEPENDENCE_KERNEL) +struct dst_entry *dst_tmp = NULL; + +/*As these API are used in fastpath, so skb will be check as valid, I will not check +skb again*/ + +unsigned int rtl_get_skb_len(struct sk_buff *skb) +{ + return skb->len; +} + +__be16 rtl_get_skb_protocol(struct sk_buff *skb) +{ + return skb->protocol; +} + +void rtl_set_skb_protocol(struct sk_buff *skb,__be16 protocol) +{ + skb->protocol=protocol; +} + +unsigned char rtl_get_skb_type(struct sk_buff *skb) +{ + return skb->pkt_type; +} + + +__wsum rtl_get_skb_csum(struct sk_buff *skb) +{ + return skb->csum; +} + + +unsigned char *rtl_get_skb_data(struct sk_buff* skb) +{ + return skb->data; +} + + +void rtl_set_skb_data(struct sk_buff *skb, int offset, int action) +{ + if(action == 1) + skb->data -= offset; + else if(action == 0) + skb->data += offset; + + return; +} + +unsigned char *rtl_skb_mac_header(struct sk_buff * skb) +{ + return skb_mac_header(skb); +} + +void rtl_skb_set_mac_header(struct sk_buff *skb, int offset) +{ + return skb_set_mac_header(skb, offset); +} + + +int rtl_skb_mac_header_was_set(struct sk_buff *skb) +{ + return skb_mac_header_was_set(skb); +} + + +void rtl_set_skb_dmac(struct sk_buff *skb, void *device) +{ + struct net_device *dev = (struct net_device *)device; + + memcpy(eth_hdr(skb)->h_dest, dev->dev_addr, ETH_ALEN); + + return; +} + +void rtl_set_skb_smac(struct sk_buff *skb, void *device) +{ + struct net_device *dev = (struct net_device *)device; + + memcpy(eth_hdr(skb)->h_source, dev->dev_addr, ETH_ALEN); + + return; +} + +unsigned char *rtl_skb_network_header(struct sk_buff * skb) +{ + return skb_network_header(skb); +} + + +void rtl_skb_set_network_header(struct sk_buff * skb,const int offset) +{ + skb_set_network_header(skb,offset); +} + +void rtl_skb_reset_network_header(struct sk_buff *skb) +{ + return skb_reset_network_header(skb); +} + +void rtl_set_skb_network_header(struct sk_buff * skb, unsigned char *network_header) +{ + skb->network_header=network_header; +} + +unsigned char *rtl_skb_transport_header(struct sk_buff * skb) +{ + return skb_transport_header(skb); +} + +void rtl_skb_set_transport_header(struct sk_buff * skb,const int offset) +{ + skb_set_transport_header(skb,offset); +} + +void rtl_skb_reset_transport_header(struct sk_buff *skb) +{ + return skb_reset_transport_header(skb); +} + +void rtl_set_skb_transport_header(struct sk_buff * skb, unsigned char *transport_header) +{ + skb->transport_header=transport_header; +} + + +unsigned char *rtl_skb_pull(struct sk_buff *skb, unsigned int len) +{ + return skb_pull(skb,len); +} + +unsigned char *rtl_skb_push(struct sk_buff *skb, unsigned int len) +{ + return skb_push(skb,len); +} + + +int rtl_ppp_proto_check(struct sk_buff *skb, unsigned char* ppp_proto) +{ + if(memcmp(skb->data-2, ppp_proto,2)==0) + return 1; + else + return 0; +} + +unsigned int rtl_ipt_do_table(struct sk_buff * skb, unsigned int hook, void *in, void *out) +{ + struct net_device *out_dev = (struct net_device *)out; + struct net_device *in_dev; + + if(in == NULL) + in_dev = skb->dev; + else + in_dev = (struct net_device *)in; + + return ipt_do_table(skb, hook, in_dev, out_dev, dev_net(skb->dev)->ipv4.iptable_mangle); +} + +int rtl_ip_route_input(struct sk_buff *skb, __be32 daddr, __be32 saddr, u8 tos) +{ + return ip_route_input(skb, daddr, saddr, tos, skb->dev); +} + +int rtl_skb_dst_check(struct sk_buff *skb) +{ + int ret = SUCCESS; + + if( !(skb->dst->hh || skb->dst->neighbour) ||skb->len > dst_mtu(skb->dst)) + ret = FAILED; + + return ret; +} + +void rtl_set_skb_ip_summed(struct sk_buff *skb, int value) +{ + skb->ip_summed = value; + return; +} + +void rtl_dst_release(struct sk_buff *skb) +{ + dst_release(skb->dst); + skb->dst = NULL; + + return; +} + + +__u32 rtl_get_skb_mark(struct sk_buff *skb) +{ + return skb->mark; +} + +void rtl_set_skb_mark(struct sk_buff *skb, unsigned int value) +{ + skb->mark = value; + + return; +} + + +void rtl_store_skb_dst(struct sk_buff *skb) +{ + dst_tmp = skb->dst; + + skb->dst = NULL; + + return; +} + +void rtl_set_skb_dst(struct sk_buff *skb) +{ + skb->dst = dst_tmp; + + return; +} + +int rtl_tcp_get_timeouts(void *ptr) +{ + struct nf_conn *ct = (struct nf_conn *)ptr; + + return tcp_get_timeouts_by_state(ct->proto.tcp.state); +} + +int rtl_arp_req_get_ha(__be32 queryIP, void *device, unsigned char * resHwAddr) +{ + struct net_device *dev = (struct net_device *)device; + + return arp_req_get_ha(queryIP, dev, resHwAddr); +} + + + +u_int8_t rtl_get_ct_protonum(void *ct_ptr, enum ip_conntrack_dir dir) +{ + struct nf_conn *ct = (struct nf_conn *)ct_ptr; + + return ct->tuplehash[dir].tuple.dst.protonum; +} + +unsigned long rtl_get_ct_udp_status(void *ct_ptr) +{ + struct nf_conn *ct = (struct nf_conn *)ct_ptr; + + return ct->status; +} + +u_int8_t rtl_get_ct_tcp_state(void *ct_ptr) +{ + struct nf_conn *ct = (struct nf_conn *)ct_ptr; + + return ct->proto.tcp.state; +} + +/*flag = 0 for src; flag = 1 for dst*/ +__be32 rtl_get_ct_ip_by_dir(void *ct_ptr, enum ip_conntrack_dir dir, int flag) +{ + struct nf_conn *ct = (struct nf_conn *)ct_ptr; + + if(dir == IP_CT_DIR_ORIGINAL) + { + if(flag == 0) + return ct->tuplehash[IP_CT_DIR_ORIGINAL].tuple.src.u3.ip; + else if(flag == 1) + return ct->tuplehash[IP_CT_DIR_ORIGINAL].tuple.dst.u3.ip; + } + else if(dir == IP_CT_DIR_REPLY) + { + if(flag == 0) + return ct->tuplehash[IP_CT_DIR_REPLY].tuple.src.u3.ip; + else if(flag == 1) + return ct->tuplehash[IP_CT_DIR_REPLY].tuple.dst.u3.ip; + } +} + +/*flag = 0 for src; flag = 1 for dst*/ +__be16 rtl_get_ct_port_by_dir(void *ct_ptr, enum ip_conntrack_dir dir, int flag) +{ + struct nf_conn *ct = (struct nf_conn *)ct_ptr; + + if(dir == IP_CT_DIR_ORIGINAL) + { + if(flag == 0) + return ct->tuplehash[IP_CT_DIR_ORIGINAL].tuple.src.u.all; + else if(flag == 1) + return ct->tuplehash[IP_CT_DIR_ORIGINAL].tuple.dst.u.all; + + } + else if(dir == IP_CT_DIR_REPLY) + { + if(flag == 0) + return ct->tuplehash[IP_CT_DIR_REPLY].tuple.src.u.all; + else if(flag == 1) + return ct->tuplehash[IP_CT_DIR_REPLY].tuple.dst.u.all; + } +} + +void rtl_set_ct_timeout_expires(void *ct_ptr, unsigned long value) +{ + struct nf_conn *ct = (struct nf_conn *)ct_ptr; + + ct->timeout.expires = value; + + return; +} + +unsigned long rtl_hold_time(void *br_ptr) +{ + struct net_bridge *br = (struct net_bridge *)br_ptr; + + return br->topology_change ? br->forward_delay : br->ageing_time; +} + +void rtl_set_fdb_aging(void *fdb_ptr, unsigned long value) +{ + struct net_bridge_fdb_entry *fdb = (struct net_bridge_fdb_entry *)fdb_ptr; + + fdb->ageing_timer = value; + + return; +} + +unsigned long rtl_get_fdb_aging(void *fdb_ptr) +{ + struct net_bridge_fdb_entry *fdb = (struct net_bridge_fdb_entry *)fdb_ptr; + + return fdb->ageing_timer; +} + +struct ethhdr *rtl_eth_hdr(struct sk_buff *skb) +{ + return eth_hdr(skb); +} + + +struct iphdr *rtl_ip_hdr(struct sk_buff *skb) +{ + return ip_hdr(skb); +} + + +struct net_device * rtl_get_dev_by_name(char *name) +{ + return __dev_get_by_name(&init_net, name); +} + +struct net_device *rtl_get_skb_dev(struct sk_buff* skb) +{ + return skb->dev; +} + + +void rtl_set_skb_dev(struct sk_buff *skb, struct net_device *dev) +{ + if(dev == NULL) + skb->dev = skb->dst->dev; + else + skb->dev = dev; + + return; +} + +char *rtl_get_skb_dev_name(struct sk_buff *skb) +{ + return skb->dev->name; +} + + +void rtl_set_skb_inDev(struct sk_buff *skb) +{ + + skb->inDev = skb->dev; + + return; +} + +unsigned int rtl_get_skb_pppoe_flag(struct sk_buff* skb) +{ + #if defined (CONFIG_RTL_FAST_PPPOE) + return skb->pppoe_flag; + #else + return 0; + #endif +} + +void rtl_set_skb_pppoe_flag(struct sk_buff* skb, unsigned int pppoe_flag) +{ + #if defined (CONFIG_RTL_FAST_PPPOE) + skb->pppoe_flag=pppoe_flag; + #endif + return; +} + +struct net_device *rtl_get_skb_rx_dev(struct sk_buff* skb) +{ + #if defined (CONFIG_RTL_FAST_PPPOE) + return skb->rx_dev; + #else + return NULL; + #endif +} + +void rtl_set_skb_rx_dev(struct sk_buff* skb,struct net_device *dev) +{ + #if defined (CONFIG_RTL_FAST_PPPOE) + return skb->rx_dev=dev; + #endif + + return; +} + +char *rtl_get_ppp_dev_name(struct net_device *ppp_dev) +{ + return ppp_dev->name; +} + +void * rtl_get_ppp_dev_priv(struct net_device *ppp_dev) +{ + return ppp_dev->priv; +} + +int rtl_call_skb_ndo_start_xmit(struct sk_buff *skb) +{ + return skb->dev->netdev_ops->ndo_start_xmit(skb,skb->dev); +} + +void rtl_inc_ppp_stats(struct ppp *ppp, int act, int len) +{ + if(act == 0){ //rx + ppp->dev->stats.rx_packets ++; + ppp->dev->stats.rx_bytes += len; + }else if(act == 1){ //tx + ppp->dev->stats.tx_packets ++; + ppp->dev->stats.tx_bytes += len; + } + + return; +} + + +void *rtl_set_skb_tail(struct sk_buff *skb, int offset, int action) +{ + if(action == 1) + skb->tail -= offset; + else if(action == 0) + skb->tail += offset; + + return; +} + +struct sk_buff *rtl_ppp_receive_nonmp_frame(struct ppp *ppp, struct sk_buff *skb, int is_fast_fw) +{ + return ppp_receive_nonmp_frame(ppp, skb, is_fast_fw); +} + +int rtl_ppp_start_xmit(struct sk_buff *skb, struct net_device *dev) +{ + return ppp_start_xmit(skb, dev); +} + +void rtl_set_skb_cb(struct sk_buff *skb, char *value, int len) +{ + memcpy(skb->cb, value, len); + + return; +} + +int rtl_ppp_vj_check(struct ppp* ppp) +{ + if(ppp->vj && !((ppp->xstate & SC_COMP_RUN) && ppp->xc_state)) + return 1; + else + return 0; +} + +void *rtl_get_ppp_xmit_pending(struct ppp* ppp) +{ + return (void*)ppp->xmit_pending; +} + +void rtl_set_ppp_xmit_pending(struct ppp* ppp, struct sk_buff* skb) +{ + ppp->xmit_pending = skb; + + return; +} + +void rtl_set_skb_nfct(struct sk_buff *skb, void *value) +{ + skb->nfct = value; + + return; +} + +struct neighbour *rtl_neigh_lookup(const void *pkey, struct net_device *dev) +{ + return neigh_lookup(&arp_tbl, pkey, dev); +} + +struct hh_cache *rtl_get_hh_from_neigh(struct neighbour *neigh) +{ + return neigh->hh; +} + +seqlock_t rtl_get_lock_from_hh(struct hh_cache * hh) +{ + return hh->hh_lock; +} + +unsigned short rtl_get_len_from_hh(struct hh_cache * hh) +{ + return hh->hh_len; +} + +unsigned long *rtl_get_data_from_hh(struct hh_cache * hh) +{ + return hh->hh_data; +} + +unsigned int rtl_skb_headroom(struct sk_buff *skb) +{ + return skb_headroom(skb); +} + +int rtl_skb_cloned(struct sk_buff *skb) +{ + return skb_cloned(skb); +} + +int rtl_skb_shared(const struct sk_buff *skb) +{ + return skb_shared(skb); +} + +#if defined(CONFIG_RTL_DSCP_IPTABLE_CHECK) && defined(IMPROVE_QOS) +__u8 rtl_get_skb_orig_dscp(struct sk_buff *skb) +{ + return skb->original_dscp; +} +#endif + +void rtl_conntrack_drop_check_hook(struct nf_conn *ct_tmp, uint16 ipprotocol, struct nf_conn *ct) +{ +#if defined(CONFIG_RTL_NF_CONNTRACK_GARBAGE_NEW) + if (ct_tmp->drop_flag == -1 && (ipprotocol == IPPROTO_TCP || ipprotocol == IPPROTO_UDP)) + { + ct_tmp->drop_flag = __conntrack_drop_check(ct); + } +#endif +} + +int rtl_Add_Pattern_ACL_For_ContentFilter(void) +{ +#if defined (CONFIG_RTL_LAYERED_DRIVER_L4) +#ifdef CONFIG_RTL_LAYERED_DRIVER_ACL + rtl865x_AclRule_t rule; + #if 0 //### add by sen_liu 2011.5.4 for lan("br0"),don't add pattern acl + memset(&rule,0,sizeof(rtl865x_AclRule_t)); + rule.actionType_ = RTL865X_ACL_TOCPU; + rule.ruleType_ = RTL865X_ACL_IP; + rule.ipHttpFilter_=rule.ipHttpFilterM_=1; + rule.pktOpApp_ = RTL865X_ACL_L3_AND_L4; + + #if defined(CONFIG_RTL_NETIF_MAPPING) + { + ps_drv_netif_mapping_t *entry; + struct net_device *dev; + dev = dev_get_by_name(&init_net,RTL_PS_BR0_DEV_NAME); + if(dev == NULL) + return 0; + + entry = rtl_get_ps_drv_netif_mapping_by_psdev(dev); + dev_put(dev); + if(entry == NULL) + { + printk("====%s(%d),ERROR,can't get lan device!\n",__FUNCTION__,__LINE__); + return 0; + } + rtl865x_add_pattern_acl_for_contentFilter(&rule,entry->drvName); + } + #else + rtl865x_add_pattern_acl_for_contentFilter(&rule,"br0"); + #endif +#endif + +#ifdef CONFIG_RTL_IPTABLES_RULE_2_ACL +#else + //Patch: lan pkt rcv to cpu + memset(&rule,0,sizeof(rtl865x_AclRule_t)); + rule.actionType_ = RTL865X_ACL_PERMIT; + rule.ruleType_ = RTL865X_ACL_MAC; + rule.pktOpApp_ = RTL865X_ACL_ALL_LAYER; + #if defined(CONFIG_RTL_NETIF_MAPPING) + { + ps_drv_netif_mapping_t *entry; + void *dev; + + #if 0//### add by sen_liu 2011.5.4 for lan("br0"),don't add pattern acl + dev = dev_get_by_name(&init_net,RTL_PS_BR0_DEV_NAME); + if(dev == NULL) + return 0; + + entry = rtl_get_ps_drv_netif_mapping_by_psdev(dev); + dev_put(dev); + if(entry == NULL) + { + printk("====%s(%d),ERROR,can't get lan device!\n",__FUNCTION__,__LINE__); + return 0; + } + rtl865x_add_pattern_acl_for_contentFilter(&rule,entry->drvName); + #endif + + //wan + dev = rtl_get_dev_by_name(RTL_PS_WAN0_DEV_NAME); + if(dev == NULL) + return 0; + entry = rtl_get_ps_drv_netif_mapping_by_psdev(dev); + dev_put(dev); + if(entry == NULL) + { + printk("====%s(%d),ERROR,can't get wan device!\n",__FUNCTION__,__LINE__); + return 0; + } + rtl865x_add_pattern_acl_for_contentFilter(&rule,entry->drvName); + } + #else + //rtl865x_add_pattern_acl_for_contentFilter(&rule,"br0"); //### add by sen_liu 2011.5.4 for lan("br0"),don't add pattern acl + rtl865x_add_pattern_acl_for_contentFilter(&rule,"eth1"); + #endif + //End patch +#endif +#endif + #endif + return 0; +} +#endif + int fast_path_before_nat_check(struct sk_buff *skb, struct iphdr *iph, uint32 iphProtocol) { #if defined(RTL_FP_CHECK_SPI_ENABLED) || defined(FAST_PATH_SPI_ENABLED) int ret; #endif - #if defined(FAST_PATH_SPI_ENABLED) + #if defined(FAST_PATH_SPI_ENABLED) unsigned int dataoff; - #endif - - #if defined(RTL_FP_CHECK_SPI_ENABLED) - ret = nf_conntrack_in(dev_net(skb->dev), PF_INET, NF_INET_PRE_ROUTING, skb); - switch (ret) - { - case NF_DROP: - kfree_skb(skb); - return NET_RX_DROP; - case NF_ACCEPT: - break; - default: - return NET_RX_DROP; - } + if(fast_spi == 0) + return NET_RX_PASSBY; #endif - #if defined(FAST_PATH_SPI_ENABLED) - if (iphProtocol== IPPROTO_TCP){ + #if defined(FAST_PATH_SPI_ENABLED) + if (iphProtocol== IPPROTO_TCP){ dataoff = skb_network_offset(skb) + (iph->ihl<<2); ret = rtl_nf_conntrack_in(dev_net(skb->dev), dataoff, NF_INET_PRE_ROUTING, skb); - switch (ret){ - case NF_DROP: - kfree_skb(skb); - return NET_RX_DROP; - case NF_ACCEPT: - break; - default: - return NET_RX_DROP; - } + switch (ret){ + case NF_DROP: + kfree_skb(skb); + return NET_RX_DROP; + case NF_ACCEPT: + break; + default: + kfree_skb(skb); + return NET_RX_DROP; + } } #endif @@ -481,8 +1198,19 @@ int fast_path_before_nat_check(struct sk_buff *skb, struct iphdr *iph, uint32 ip int fast_path_post_process_xmit_check(struct iphdr *iph, struct tcphdr *tcphupuh, struct sk_buff *skb) { - #if defined(FAST_L2TP) - return enter_fast_path_fast_l2tp_post_process(skb); + #if defined(FAST_L2TP) || defined (CONFIG_RTL_FAST_PPPOE) + if (enter_fast_path_fast_l2tp_post_process(skb)==NET_RX_DROP) + { + return NET_RX_DROP; + } + else if (enter_fast_path_fast_pppoe_post_process(skb)==NET_RX_DROP) + { + return NET_RX_DROP; + } + else + { + return NET_RX_SUCCESS; + } #else return NET_RX_SUCCESS; #endif @@ -491,24 +1219,24 @@ int fast_path_post_process_xmit_check(struct iphdr *iph, struct tcphdr *tcphupuh int fast_path_post_process_return_check(struct iphdr *iph, struct tcphdr *tcphupuh, struct sk_buff *skb) { #if defined(CONFIG_RTL_NF_CONNTRACK_GARBAGE_NEW) - if (iph->protocol==IPPROTO_UDP) + if (iph->protocol==IPPROTO_UDP) return rtl_fp_gc_status_check(iph, tcphupuh, skb); #endif - + return NET_RX_SUCCESS; - + } int32 rtl_fp_dev_queue_xmit_check(struct sk_buff *skb, struct net_device *dev) { #ifdef FAST_L2TP - if (l2tp_tx_id_hook != NULL) - l2tp_tx_id_hook(skb); + if (l2tp_tx_id_hook != NULL) + l2tp_tx_id_hook((void*)skb); #endif #ifdef FAST_PPTP if (sync_tx_pptp_gre_seqno_hook != NULL) - sync_tx_pptp_gre_seqno_hook(skb); + sync_tx_pptp_gre_seqno_hook(skb); #endif return SUCCESS; @@ -518,10 +1246,10 @@ int32 rtl_fp_dev_hard_start_xmit_check(struct sk_buff *skb, struct net_device *d { #if defined(FAST_L2TP) #if defined(CONFIG_NET_SCHED) - if(!gQosEnabled) + if(!gQosEnabled) #endif - if (l2tp_tx_id_hook != NULL) - l2tp_tx_id_hook(skb); + if (l2tp_tx_id_hook != NULL) + l2tp_tx_id_hook((void*)skb); #endif #if defined (CONFIG_RTL_LOCAL_PUBLIC) @@ -557,7 +1285,7 @@ int ip_finish_output3(struct sk_buff *skb) ipt_do_table(skb, NF_IP_POST_ROUTING, skb->dev, NULL, \ dev_net(skb->dev)->ipv4.iptable_mangle); } - } + } #endif #endif @@ -571,21 +1299,21 @@ int ip_finish_output3(struct sk_buff *skb) #endif skb_push(skb, hh->hh_len); -#ifdef FAST_L2TP +#ifdef FAST_L2TP if (fast_l2tp_fw) - l2tp_tx_id(skb); -#endif + l2tp_tx_id((void*)skb); +#endif if (skb->dev->flags & IFF_UP) { #if defined(CONFIG_NET_SCHED) if (gQosEnabled) { // call dev_queue_xmit() instead of hard_start_xmit(), because I want the packets be sent through Traffic Control module dev_queue_xmit(skb); - return 0; - } else -#endif + return 0; + } else +#endif { - + #if defined(CONFIG_BRIDGE) /* In order to improve performance * We'd like to directly xmit and bypass the bridge check @@ -609,7 +1337,7 @@ int ip_finish_output3(struct sk_buff *skb) if(!skb->dev->netdev_ops->ndo_start_xmit(skb,skb->dev)) return 0; } - } + } } //------------------------------- david+2007-05-25 @@ -617,7 +1345,7 @@ int ip_finish_output3(struct sk_buff *skb) return dst->neighbour->output(skb); } -#if 0 +#if 0 if (net_ratelimit()) printk(KERN_DEBUG "ip_finish_output3: No header cache and no neighbour!\n"); #endif @@ -625,6 +1353,75 @@ int ip_finish_output3(struct sk_buff *skb) return -EINVAL; } +#if defined (CONFIG_RTL_FAST_PPPOE) +int ip_finish_output4(struct sk_buff *skb) +{ +#if !defined(IMPROVE_QOS) +#if defined(CONFIG_NET_SCHED) + if (gQosEnabled) { + u_short proto = ntohs(skb->protocol); + if(proto == ETH_P_IP){ + (list_empty(&nf_hooks[PF_INET][NF_IP_POST_ROUTING]))?: \ + ipt_do_table(skb, NF_IP_POST_ROUTING, skb->dev, NULL, \ + dev_net(skb->dev)->ipv4.iptable_mangle); + } + } +#endif +#endif + + if (skb->dev->flags & IFF_UP) + { +#if defined(CONFIG_NET_SCHED) + if (gQosEnabled) + { + // call dev_queue_xmit() instead of hard_start_xmit(), because I want the packets be sent through Traffic Control module + dev_queue_xmit(skb); + } + else +#endif + { + +#if defined(CONFIG_BRIDGE) + /* In order to improve performance + * We'd like to directly xmit and bypass the bridge check + */ + if (skb->dev->priv_flags == IFF_EBRIDGE) + { + /* wan->lan */ + struct net_bridge *br = netdev_priv(skb->dev); + const unsigned char *dest = skb->data; + struct net_bridge_fdb_entry *dst; + + if ((dst = __br_fdb_get(br, dest)) != NULL) + { + //skb->dev->stats.tx_packets++; + //skb->dev->stats.tx_bytes += skb->len; + skb->dev = dst->dst->dev; + } + else + { + kfree_skb(skb); + return 0; + } + } +#endif + + skb->dev->netdev_ops->ndo_start_xmit(skb,skb->dev); + skb->dev->stats.tx_packets++; + skb->dev->stats.tx_bytes += skb->len; + return 0; + } + + } + else + { + + kfree_skb(skb); + } + + return 0; +} +#endif int FastPath_Enter(struct sk_buff **pskb) { int ret; @@ -633,17 +1430,20 @@ int FastPath_Enter(struct sk_buff **pskb) skb=*pskb; //skb->nh.raw = skb->data; skb->transport_header=skb->data; - skb->network_header = skb->data; + skb->network_header = skb->data; //skb_reset_network_header(skb); - +#if defined(CONFIG_RTL_FAST_PPPOE) + check_and_pull_pppoe_hdr(*pskb); +#endif + //hyking: //bug fix:when port filter is enable,application will disable fast_nat_fw,at this moment,url filter is abnormal... #if defined (DOS_FILTER) || defined (URL_FILTER) - ret = filter_enter(skb); + ret = filter_enter((void*)skb); if (ret == NF_DROP) { + LOG_INFO("%s filter pkt, drop it\n", __FUNCTION__); kfree_skb(skb); - ret = 1; - goto out; + return 1; } #if defined(CONFIG_RTL_FAST_FILTER) else if(ret == NF_FASTPATH) @@ -683,37 +1483,36 @@ int FastPath_Enter(struct sk_buff **pskb) } #ifdef FILTER_UPNP_BR - if (upnp_br_enabled && skb->dev && !memcmp(skb->dev->name, RTL_PS_WAN0_DEV_NAME, 4) && filter_upnp_and_fw(skb)){ - ret = 1; - goto out; - } + if (upnp_br_enabled && skb->dev && !memcmp(skb->dev->name, RTL_PS_WAN0_DEV_NAME, 4) && filter_upnp_and_fw(skb)){ + return 1; + } #endif -#ifdef FAST_PPTP +#ifdef FAST_PPTP if (fast_pptp_fw) { - fast_pptp_filter(skb); - ret = fast_pptp_to_lan(&skb); + fast_pptp_filter((void*)skb); + ret = fast_pptp_to_lan((void*)&skb); if (ret < 0) // error, skb has been free { - ret = 1; - goto out; + return 1; } *pskb=skb; - } + } #endif #ifdef FAST_L2TP - if (fast_l2tp_fw) - fast_l2tp_rx(skb); + if (fast_l2tp_fw) + fast_l2tp_rx((void*)skb); #endif - ret = enter_fast_path(skb); + ret = enter_fast_path((void*)skb); + #if 0 if(ret != NET_RX_DROP) { struct tcphdr *tcpudph; - printk("-------%s(%d),ret(%d), src(0x%x),dst(0x%x)\n",__FUNCTION__,__LINE__,ret,ip_hdr(skb)->saddr,ip_hdr(skb)->daddr); + printk("-------%s(%d),ret(%d), src(0x%x),dst(0x%x), len is %d, version is %d\n",__FUNCTION__,__LINE__,ret,ip_hdr(skb)->saddr,ip_hdr(skb)->daddr, ip_hdr(skb)->ihl, ip_hdr(skb)->version); if(ip_hdr(skb)->protocol == IPPROTO_TCP) { tcpudph = (struct tcphdr*)((__u32 *)skb->data + ip_hdr(skb)->ihl); @@ -722,14 +1521,22 @@ int FastPath_Enter(struct sk_buff **pskb) } #endif #ifdef FAST_PPTP - if (fast_pptp_fw && ret == 0 && ip_hdr(skb)->protocol == IPPROTO_GRE && skb->len > sizeof(struct iphdr)&& pptp_tcp_finished==1) - if(Check_GRE_rx_net_device(skb)) + if (fast_pptp_fw && ret == 0 && ip_hdr(skb)->protocol == IPPROTO_GRE && skb->len > sizeof(struct iphdr)&& pptp_tcp_finished==1) + if(Check_GRE_rx_net_device((void*)skb)) { - fast_pptp_sync_rx_seq(skb); + fast_pptp_sync_rx_seq((void*)skb); } #endif + out: +#if defined(CONFIG_RTL_FAST_PPPOE) + if(ret!=NET_RX_DROP) + { + check_and_restore_pppoe_hdr(skb); + + } +#endif return ret; } @@ -737,7 +1544,7 @@ out: static int __init fastpath_init(void) { int ret; - + int buf[64]; #ifdef CONFIG_FAST_PATH_MODULE fast_path_hook=FastPath_Enter; FastPath_hook1=rtk_delRoute; @@ -757,7 +1564,7 @@ static int __init fastpath_init(void) /* proc file for debug */ init_fastpath_debug_proc(); #endif /* DEBUG_PROCFILE */ - + #ifndef NO_ARP_USED /* Arp-Table Init */ ret=init_table_arp(ARP_TABLE_LIST_MAX,ARP_TABLE_ENTRY_MAX); @@ -765,7 +1572,7 @@ static int __init fastpath_init(void) DEBUGP_SYS("init_table_arp Failed!\n"); } #endif - + #ifndef DEL_ROUTE_TBL /* Route-Table Init */ ret=init_table_route(ROUTE_TABLE_LIST_MAX, ROUTE_TABLE_ENTRY_MAX); @@ -788,10 +1595,13 @@ static int __init fastpath_init(void) if(ret!=0) { DEBUGP_SYS("init_table_path Failed!\n"); } - + #ifdef CONFIG_UDP_FRAG_CACHE if(!udp_fragCache_init(MAX_UDP_FRAG_ENTRY)) return -1; + + if(!negative_fragCache_init()) + return -1; #endif #ifdef DOS_FILTER @@ -805,6 +1615,9 @@ static int __init fastpath_init(void) #ifdef FAST_L2TP fast_l2tp_init(); #endif + #if defined (CONFIG_RTL_FAST_PPPOE) + fast_pppoe_init(); + #endif #ifdef CONFIG_PROC_FS res1=create_proc_entry("fast_nat",0,NULL); @@ -814,10 +1627,22 @@ static int __init fastpath_init(void) } #endif + + #if defined(FAST_PATH_SPI_ENABLED) + res_spi = create_proc_entry("fast_spi",0,NULL); + if(res_spi){ + res_spi->read_proc = spi_read_proc; + res_spi->write_proc = spi_write_proc; + } + #endif + #if defined(CONFIG_RTL_NF_CONNTRACK_GARBAGE_NEW) rtl_fp_gc_rx_threshold = RTL_FP_SESSION_LEVEL3_ALLOW_COUNT; #endif + get_fastpath_module_info(buf); + panic_printk("%s",buf); + return 0; } @@ -851,13 +1676,24 @@ static void __exit fastpath_exit(void) fast_pptp_exit(); #endif +#if defined (CONFIG_RTL_FAST_PPPOE) + fast_pppoe_exit(); +#endif #ifdef CONFIG_PROC_FS if (res1) { - remove_proc_entry("fast_nat", res1); + remove_proc_entry("fast_nat", res1); res1 = NULL; } #endif +#if defined(FAST_PATH_SPI_ENABLED) + if(res_spi){ + remove_proc_entry("fast_spi", res_spi); + res_spi = NULL; + } +#endif + + //printk("%s %s removed!\n", MODULE_NAME, MODULE_VERSION); } |