rk3588安卓12适配移远EC20和EC200A模块4G

/* * Copyright (c) 2012 Bjørn Mork <bjorn@mork.no> * * The probing code is heavily inspired by cdc_ether, which is: * Copyright (C) 2003-2005 by David Brownell * Copyright (C) 2006 by Ole Andre Vadla Ravnas (ActiveSync) * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * version 2 as published by the Free Software Foundation. */ #include <linux/module.h> #include <linux/version.h> #include <linux/interrupt.h> #include <linux/netdevice.h> #include <linux/ethtool.h> #include <linux/etherdevice.h> #include <linux/time.h> #if LINUX_VERSION_CODE > KERNEL_VERSION(3,16,0) //8b094cd03b4a3793220d8d8d86a173bfea8c285b #include <linux/timekeeping.h> #else #define timespec64 timespec #define ktime_get_ts64 ktime_get_ts #define timespec64_sub timespec_sub #endif #include <net/arp.h> #include <net/ip.h> #include <net/ipv6.h> #include <linux/mii.h> #include <linux/usb.h> #include <linux/usb/cdc.h> #include <linux/usb/usbnet.h> #include <linux/usb/cdc-wdm.h> #ifndef ETH_P_MAP #define ETH_P_MAP 0xDA1A #endif #if (ETH_P_MAP == 0x00F9) #undef ETH_P_MAP #define ETH_P_MAP 0xDA1A #endif #ifndef ARPHRD_RAWIP #define ARPHRD_RAWIP ARPHRD_NONE #endif #ifdef CONFIG_PINCTRL_IPQ807x #define CONFIG_QCA_NSS_DRV //#define CONFIG_QCA_NSS_PACKET_FILTER #endif #define _RMNET_NSS_H_ #define _RMENT_NSS_H_ struct rmnet_nss_cb { int (*nss_create)(struct net_device *dev); int (*nss_free)(struct net_device *dev); int (*nss_tx)(struct sk_buff *skb); }; static struct rmnet_nss_cb __read_mostly *nss_cb = NULL; #if defined(CONFIG_PINCTRL_IPQ807x) || defined(CONFIG_PINCTRL_IPQ5018) #ifdef CONFIG_RMNET_DATA #define CONFIG_QCA_NSS_DRV /* define at qsdk/qca/src/linux-4.4/net/rmnet_data/rmnet_data_main.c */ /* set at qsdk/qca/src/data-kernel/drivers/rmnet-nss/rmnet_nss.c */ extern struct rmnet_nss_cb *rmnet_nss_callbacks __rcu __read_mostly; #endif #endif /* This driver supports wwan (3G/LTE/?) devices using a vendor * specific management protocol called Qualcomm MSM Interface (QMI) - * in addition to the more common AT commands over serial interface * management * * QMI is wrapped in CDC, using CDC encapsulated commands on the * control ("master") interface of a two-interface CDC Union * resembling standard CDC ECM. The devices do not use the control * interface for any other CDC messages. Most likely because the * management protocol is used in place of the standard CDC * notifications NOTIFY_NETWORK_CONNECTION and NOTIFY_SPEED_CHANGE * * Alternatively, control and data functions can be combined in a * single USB interface. * * Handling a protocol like QMI is out of the scope for any driver. * It is exported as a character device using the cdc-wdm driver as * a subdriver, enabling userspace applications ("modem managers") to * handle it. * * These devices may alternatively/additionally be configured using AT * commands on a serial interface */ #define VERSION_NUMBER "V1.2.1" #define QUECTEL_WWAN_VERSION "Quectel_Linux&Android_QMI_WWAN_Driver_"VERSION_NUMBER static const char driver_name[] = "qmi_wwan_q"; /* driver specific data */ struct qmi_wwan_state { struct usb_driver *subdriver; atomic_t pmcount; unsigned long unused; struct usb_interface *control; struct usb_interface *data; }; /* default ethernet address used by the modem */ static const u8 default_modem_addr[ETH_ALEN] = {0x02, 0x50, 0xf3}; #if 1 //Added by Quectel /* Quectel_WCDMA&LTE_Linux_USB_Driver_User_Guide_V1.9.pdf 5.6. Test QMAP on GobiNet or QMI WWAN 0 - no QMAP 1 - QMAP (Aggregation protocol) X - QMAP (Multiplexing and Aggregation protocol) */ #define QUECTEL_WWAN_QMAP 4 //MAX is 7 #if defined(QUECTEL_WWAN_QMAP) #define QUECTEL_QMAP_MUX_ID 0x81 static uint __read_mostly qmap_mode = 0; module_param( qmap_mode, uint, S_IRUGO); module_param_named( rx_qmap, qmap_mode, uint, S_IRUGO ); #endif #if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE) #define QUECTEL_BRIDGE_MODE #endif #ifdef QUECTEL_BRIDGE_MODE static uint __read_mostly bridge_mode = 0/*|BIT(1)*/; module_param( bridge_mode, uint, S_IRUGO ); #endif #if defined(QUECTEL_WWAN_QMAP) #define QUECTEL_UL_DATA_AGG 1 #if defined(QUECTEL_UL_DATA_AGG) struct tx_agg_ctx { /* QMIWDS_ADMIN_SET_DATA_FORMAT_RESP TLV_0x17 and TLV_0x18 */ uint ul_data_aggregation_max_datagrams; //UplinkDataAggregationMaxDatagramsTlv uint ul_data_aggregation_max_size; //UplinkDataAggregationMaxSizeTlv uint dl_minimum_padding; //0x1A }; #endif typedef struct { unsigned int size; unsigned int rx_urb_size; unsigned int ep_type; unsigned int iface_id; unsigned int qmap_mode; unsigned int qmap_version; unsigned int dl_minimum_padding; char ifname[8][16]; unsigned char mux_id[8]; } RMNET_INFO; typedef struct sQmiWwanQmap { struct usbnet *mpNetDev; struct driver_info driver_info; atomic_t refcount; struct net_device *mpQmapNetDev[QUECTEL_WWAN_QMAP]; uint link_state; uint qmap_mode; uint qmap_size; uint qmap_version; #if defined(QUECTEL_UL_DATA_AGG) struct tx_agg_ctx tx_ctx; struct tasklet_struct txq; #endif #ifdef QUECTEL_BRIDGE_MODE uint bridge_mode; uint bridge_ipv4; unsigned char bridge_mac[ETH_ALEN]; #endif uint use_rmnet_usb; RMNET_INFO rmnet_info; } sQmiWwanQmap; #if LINUX_VERSION_CODE > KERNEL_VERSION(3,13,0) //8f84985fec10de64a6b4cdfea45f2b0ab8f07c78 #define MHI_NETDEV_STATUS64 #endif struct qmap_priv { struct usbnet *dev; struct net_device *real_dev; struct net_device *self_dev; u8 offset_id; u8 mux_id; u8 qmap_version; // 5~v1, 9~v5 u8 link_state; #if defined(MHI_NETDEV_STATUS64) struct pcpu_sw_netstats __percpu *stats64; #endif spinlock_t agg_lock; struct sk_buff *agg_skb; unsigned agg_count; struct timespec64 agg_time; struct hrtimer agg_hrtimer; struct work_struct agg_wq; #ifdef QUECTEL_BRIDGE_MODE uint bridge_mode; uint bridge_ipv4; unsigned char bridge_mac[ETH_ALEN]; #endif uint use_qca_nss; }; struct qmap_hdr { u8 cd_rsvd_pad; u8 mux_id; u16 pkt_len; } __packed; enum rmnet_map_v5_header_type { RMNET_MAP_HEADER_TYPE_UNKNOWN, RMNET_MAP_HEADER_TYPE_COALESCING = 0x1, RMNET_MAP_HEADER_TYPE_CSUM_OFFLOAD = 0x2, RMNET_MAP_HEADER_TYPE_ENUM_LENGTH }; /* Main QMAP header */ struct rmnet_map_header { #if defined(__LITTLE_ENDIAN_BITFIELD) u8 pad_len:6; u8 next_hdr:1; u8 cd_bit:1; #elif defined (__BIG_ENDIAN_BITFIELD) u8 cd_bit:1; u8 next_hdr:1; u8 pad_len:6; #else #error "Please fix <asm/byteorder.h>" #endif u8 mux_id; __be16 pkt_len; } __aligned(1); /* QMAP v5 headers */ struct rmnet_map_v5_csum_header { #if defined(__LITTLE_ENDIAN_BITFIELD) u8 next_hdr:1; u8 header_type:7; u8 hw_reserved:7; u8 csum_valid_required:1; #elif defined (__BIG_ENDIAN_BITFIELD) u8 header_type:7; u8 next_hdr:1; u8 csum_valid_required:1; u8 hw_reserved:7; #else #error "Please fix <asm/byteorder.h>" #endif __be16 reserved; } __aligned(1); #ifdef QUECTEL_BRIDGE_MODE static int is_qmap_netdev(const struct net_device *netdev); #endif #endif static const struct driver_info rmnet_usb_info; #ifdef QUECTEL_BRIDGE_MODE static int bridge_arp_reply(struct net_device *net, struct sk_buff *skb, uint bridge_ipv4) { struct arphdr *parp; u8 *arpptr, *sha; u8 sip[4], tip[4], ipv4[4]; struct sk_buff *reply = NULL; ipv4[0] = (bridge_ipv4 >> 24) & 0xFF; ipv4[1] = (bridge_ipv4 >> 16) & 0xFF; ipv4[2] = (bridge_ipv4 >> 8) & 0xFF; ipv4[3] = (bridge_ipv4 >> 0) & 0xFF; parp = arp_hdr(skb); if (parp->ar_hrd == htons(ARPHRD_ETHER) && parp->ar_pro == htons(ETH_P_IP) && parp->ar_op == htons(ARPOP_REQUEST) && parp->ar_hln == 6 && parp->ar_pln == 4) { arpptr = (u8 *)parp + sizeof(struct arphdr); sha = arpptr; arpptr += net->addr_len; /* sha */ memcpy(sip, arpptr, sizeof(sip)); arpptr += sizeof(sip); arpptr += net->addr_len; /* tha */ memcpy(t