RK3568-ANDROID11-4G-EC20-(详细步骤)

注意：硬件可以先使用USB转接板把模块接到电脑上，使用AT指令把模块调好。

原理图

//DTS配置
kernel\arch\arm64\boot\dts\rockchip\rk3568-evb1-ddr4-v10.dtsi
+    rk_modem: rk-modem {
+        compatible="4g-modem-platdata";
+        4G,power-gpio = <&gpio4 RK_PD2 GPIO_ACTIVE_LOW>; //4G/5G_EN-MODEM_ON-GPIO4_D2
+        4G,reset-gpio = <&gpio0 RK_PD5 GPIO_ACTIVE_HIGH>;//4G/5G_RST-MODEM_RST-GPIO0_D5
+        status = "okay";
+    };

驱动

RK3568\kernel\drivers\usb\serial\option.c
+static const struct usb_device_id option_ids[] = {
+      #if 1 //Added by Quectel
+      { USB_DEVICE(0x2C7C, 0x0125) }, /* Quectel EC20 R2.0/EC20 R2.1/EC25/EG25-G/EM05 */
+      { USB_DEVICE(0x2C7C, 0x0121) }, /* Quectel EC21/EG21-G */
+      { USB_DEVICE(0x2C7C, 0x0191) }, /* Quectel EG91 */
+      { USB_DEVICE(0x2C7C, 0x0195) }, /* Quectel EG95 */
+      { USB_DEVICE(0x2C7C, 0x0306) }, /* Quectel EG06/EP06/EM06 */
+      { USB_DEVICE(0x2C7C, 0x0512) }, /* Quectel EG12/EM12/EG18 */
+      { USB_DEVICE(0x2C7C, 0x0296) }, /* Quectel BG96 */
+      { USB_DEVICE(0x2C7C, 0x0700) }, /* Quectel BG95/BG77/BG600L-M3/BC69 */
+      { USB_DEVICE(0x2C7C, 0x0435) }, /* Quectel AG35 */
+      { USB_DEVICE(0x2C7C, 0x0415) }, /* Quectel AG15 */
+      { USB_DEVICE(0x2C7C, 0x0452) }, /* Quectel AG520R */
+      { USB_DEVICE(0x2C7C, 0x0455) }, /* Quectel AG550R */
+      { USB_DEVICE(0x2C7C, 0x0620) }, /* Quectel EG20 */
+      { USB_DEVICE(0x2C7C, 0x0800) }, /* Quectel RG500Q/RM500Q/RG510Q/RM510Q */
+      { USB_DEVICE(0x1E0E,0x9001),//SIM8200EAM2
+       .driver_info = RSVD(4) | RSVD(5) | RSVD(6) | RSVD(6)},
+  #endif
+}static struct usb_serial_driver option_1port_device = {.driver = {.owner =    THIS_MODULE,.name =        "option1",},.description       = "GSM modem (1-port)",.id_table          = option_ids,.num_ports         = 1,.probe             = option_probe,.open              = usb_wwan_open,.close             = usb_wwan_close,.dtr_rts       = usb_wwan_dtr_rts,.write             = usb_wwan_write,.write_room        = usb_wwan_write_room,.chars_in_buffer   = usb_wwan_chars_in_buffer,.tiocmget          = usb_wwan_tiocmget,.tiocmset          = usb_wwan_tiocmset,.ioctl             = usb_wwan_ioctl,.attach            = option_attach,.release           = option_release,.port_probe        = usb_wwan_port_probe,.port_remove      = usb_wwan_port_remove,.read_int_callback = option_instat_callback,
#ifdef CONFIG_PM.suspend           = usb_wwan_suspend,.resume            = usb_wwan_resume,
+ #if 1
+  .reset_resume      = usb_wwan_resume,
+ #endif
#endif
};

RK3568\kernel\drivers\usb\serial\usb_wwan.c
static struct urb *usb_wwan_setup_urb(struct usb_serial_port *port,int endpoint,int dir, void *ctx, char *buf, int len,void (*callback) (struct urb *))
{struct usb_serial *serial = port->serial;struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);struct urb *urb;struct usb_device_descriptor *desc = &serial->dev->descriptor;urb = usb_alloc_urb(0, GFP_KERNEL);   /* No ISO */if (!urb)return NULL;usb_fill_bulk_urb(urb, serial->dev,usb_sndbulkpipe(serial->dev, endpoint) | dir,buf, len, callback, ctx);if (intfdata->use_zlp && dir == USB_DIR_OUT)urb->transfer_flags |= URB_ZERO_PACKET;if (dir == USB_DIR_OUT) {if ((desc->idVendor == cpu_to_le16(0x1286) &&desc->idProduct == cpu_to_le16(0x4e3c)))urb->transfer_flags |= URB_ZERO_PACKET;+     if (desc->idVendor == cpu_to_le16(0x2c7c))
+          urb->transfer_flags |= URB_ZERO_PACKET;         }return urb;
}

添加qmi_wwan_q.c（放在最后）

修改Makefile（qmi_wwan_q.o的生成就是编译到了）

RK3568\kernel\drivers\net\usb\Makefile
obj-$(CONFIG_USB_NET_QMI_WWAN)  += qmi_wwan.o
+obj-$(CONFIG_USB_NET_QMI_WWAN)    += qmi_wwan_q.o

然后就是添加cdc-wdmo节点

RK3568\system\core\init\devices.cpp
void DeviceHandler::HandleUevent(const Uevent& uevent) {if (uevent.action == "add" || uevent.action == "change" || uevent.action == "online") {FixupSysPermissions(uevent.path, uevent.subsystem);}// if it's not a /dev device, nothing to doif (uevent.major < 0 || uevent.minor < 0) return;std::string devpath;std::vector<std::string> links;bool block = false;if (uevent.subsystem == "block") {block = true;devpath = "/dev/block/" + Basename(uevent.path);if (StartsWith(uevent.path, "/devices")) {links = GetBlockDeviceSymlinks(uevent);}} else if (const auto subsystem =std::find(subsystems_.cbegin(), subsystems_.cend(), uevent.subsystem);subsystem != subsystems_.cend()) {devpath = subsystem->ParseDevPath(uevent);} else if (uevent.subsystem == "usb") {if (!uevent.device_name.empty()) {devpath = "/dev/" + uevent.device_name;} else {// This imitates the file system that would be created// if we were using devfs instead.// Minors are broken up into groups of 128, starting at "001"int bus_id = uevent.minor / 128 + 1;int device_id = uevent.minor % 128 + 1;devpath = StringPrintf("/dev/bus/usb/%03d/%03d", bus_id, device_id);}
+              #if 1 //add by quectel for mknod /dev/cdc-wdmo
+                  } else if (uevent.subsystem == "usbmisc" && !uevent.device_name.empty()) {
+                             devpath = "/dev/" + uevent.device_name;
+              #endif      } else if (StartsWith(uevent.subsystem, "usb")) {// ignore other USB eventsreturn;} else {devpath = "/dev/" + Basename(uevent.path);}mkdir_recursive(Dirname(devpath), 0755);HandleDevice(uevent.action, devpath, block, uevent.major, uevent.minor, links);// Duplicate /dev/ashmem device and name it /dev/ashmem<boot_id>.// TODO(b/111903542): remove once all users of /dev/ashmem are migrated to libcutils API.HandleAshmemUevent(uevent);
}

然后编译可以看到出现以下节点就可以完成驱动方面的调试

console:/ $ su
console:/ #
console:/ # ls -l dev/ttyUSB*
crw-rw-rw- 1 radio radio 188,   0 2022-01-27 12:33 dev/ttyUSB0
crw-rw-rw- 1 radio radio 188,   1 2022-01-27 12:33 dev/ttyUSB1
crw-rw-rw- 1 radio radio 188,   2 2022-01-27 14:02 dev/ttyUSB2
crw-rw-rw- 1 radio radio 188,   3 2022-01-27 12:33 dev/ttyUSB3
console:/ #
console:/ # ls -l dev/cdc-wdm0
crw-rw---- 1 radio radio 180, 176 2022-01-27 12:33 dev/cdc-wdm0

//####################################################################//

1.从资源包获取对于文件并且更新（一定要确认你的库是支持的，大部分的问题都是库不对）

\Quectel_Android_RIL_Driver_V3.3.41_master_beta\libquectel-ril\arm64-v8a

使用了chat、ip-down、ip-up、ql-ril.conf

\Quectel_Android_RIL_Driver_V3.3.62_master_beta\libquectel-ril\arm64-v8a

使用了libreference-ril.so（改名为libreference-ril-ec20.so）

\vendor\rockchip\common\phone\bin\chat
\vendor\rockchip\common\phone\etc\ppp\ip-down
\vendor\rockchip\common\phone\etc\ppp\ip-up
\vendor\rockchip\common\phone\etc\ql-ril.conf
\vendor\rockchip\common\phone\lib\libreference-ril-ec20.so

2.添加设置复制进代码后的路径

rk3568\vendor\rockchip\common\phone\phone.mk
#########################################################
#   3G Dongle SUPPORT
#########################################################
-#PRODUCT_COPY_FILES += \
-#    $(CUR_PATH)/phone/etc/ppp/ip-down:system/etc/ppp/ip-down \
-#    $(CUR_PATH)/phone/etc/ppp/ip-up:system/etc/ppp/ip-up \
-#    $(CUR_PATH)/phone/etc/ppp/call-pppd:system/etc/ppp/call-pppd \
-#    $(CUR_PATH)/phone/etc/operator_table:system/etc/operator_table+PRODUCT_COPY_FILES += \
+    $(CUR_PATH)/phone/etc/ppp/ip-down:system/etc/ppp/ip-down \
+    $(CUR_PATH)/phone/etc/ppp/ip-up:system/etc/ppp/ip-up \
+    $(CUR_PATH)/phone/bin/chat:system/bin/chat \
+    $(CUR_PATH)/phone/lib/libreference-ril-ec20.so:vendor/lib64/libreference-ril-ec20.so \
+    $(CUR_PATH)/phone/etc/ppp/ql-ril.conf:system/etc/ql-ril.conf \
+  $(CUR_PATH)/etc/spn-conf.xml:system/etc/spn-conf.xml

RK3568\out\target\product\rk3568_r\vendor\lib64\libreference-ril-ec20.so

注意：检查libreference-ril-ec20.so是否更新到，可以使用对比文件看一下内容是否一样，我有遇到编译完，库没有更新的现象，要清理代码才能编进去，前期可以使用adb push进行验证。

3.关闭SELINUX

RK3568\device\rockchip\common\BoardConfig.mk
-BOARD_SELINUX_ENFORCING ?= true
+BOARD_SELINUX_ENFORCING ?= false

遇到一修改就卡死在android动画，最后把DDR降频就可以进入系统了。

4.打开BOARD_HAVE_DONGLE 和BOARD_HAS_RK_4G_MODEM

建议分开打开，编译会有错误。

RK3568\device\rockchip\common\BoardConfig.mk
#enable 3g dongle
- BOARD_HAVE_DONGLE ?= false
+ BOARD_HAVE_DONGLE ?= true
ifeq ($(BOARD_HAVE_DONGLE),true)
PRODUCT_PACKAGES += \android.hardware.radio@1.2-radio-service \android.hardware.radio.config@1.0-service
PRODUCT_PACKAGES += \rild \com.android.phone.common
endif#for rk 4g modem
-BOARD_HAS_RK_4G_MODEM ?= false
+BOARD_HAS_RK_4G_MODEM ?= trueifeq ($(strip $(BOARD_HAS_RK_4G_MODEM)),true)
DEVICE_MANIFEST_FILE += device/rockchip/common/4g_modem/manifest.xml
endif

BOARD_HAVE_DONGLE报错

[ 30% 283/935] target  C++: usb_dongle <= external/usb_modeswitch/usb_dongle/Misc.cpp
FAILED: out/target/product/rk3568_r/obj/EXECUTABLES/usb_dongle_intermediates/Misc.o解决方法：
\external\usb_modeswitch\usb_dongle\Android.mk- common_local_tidy_flags := -warnings-as-errors=clang-analyzer-security*,cert-*
+ #common_local_tidy_flags := -warnings-as-errors=clang-analyzer-security*,cert-*

BOARD_HAS_RK_4G_MODEM 报错（manifest.xml文件）

//报错android.hardware.radio.deprecated

解决方法：
RK3568\device\rockchip\common\manifest.xml<hal format="hidl"><name>android.hardware.radio</name><transport>hwbinder</transport><fqname>@1.1::IRadio/slot1</fqname><fqname>@1.1::IRadio/slot2</fqname><fqname>@1.2::ISap/slot1</fqname></hal>
-     <hal format="hidl">
-         <name>android.hardware.radio.deprecated</name>
-         <transport>hwbinder</transport>
-         <version>1.0</version>
-         <interface>
-             <name>IOemHook</name>
-             <instance>slot1</instance>
-         </interface>
-     </hal>
-     <kernel target-level="5"/>
- </manifest> RK3568\device\rockchip\common\4g_modem\manifest.xml
<manifest version="1.0" type="device"><hal format="hidl"><name>android.hardware.radio</name><transport>hwbinder</transport><fqname>@1.1::IRadio/slot1</fqname><fqname>@1.1::IRadio/slot2</fqname><fqname>@1.2::ISap/slot1</fqname></hal><hal format="hidl"><name>android.hardware.radio.deprecated</name><transport>hwbinder</transport><version>1.0</version><interface><name>IOemHook</name><instance>slot1</instance></interface></hal><hal format="hidl">
-        <name>android.hardware.radio.config</name>
+        <name>android.hardware.radio</name><transport>hwbinder</transport><version>1.0</version><interface>
-            <name>IRadioConfig</name>
+            <name>IRadio</name>
-            <instance>default</instance>
+            <instance>slot1</instance></interface></hal>
</manifest>

5.打开BOARD_HAS_RK_4G_MODEM属性之后加载的库，

这里修改成了我预制的libreference-ril-ec20.so（设置的是vendor.rild.libpath属性）

RK3568\device\rockchip\common\device.mk
ifeq ($(strip $(BOARD_HAS_RK_4G_MODEM)),true)
PRODUCT_PACKAGES += \CarrierDefaultApp \CarrierConfig \rild \
-    librk-ril \
+    libreference-ril-ec20 \dhcpcdPRODUCT_COPY_FILES += vendor/rockchip/common/phone/etc/apns-full-conf.xml:$(TARGET_COPY_OUT_PRODUCT)/etc/apns-conf.xmlPRODUCT_PACKAGES += \android.hardware.radio@1.2-radio-service \android.hardware.radio.config@1.0-servicePRODUCT_PROPERTY_OVERRIDES += \ro.boot.noril=false \ro.telephony.default_network=9ifeq ($(strip $(TARGET_ARCH)), arm64)
PRODUCT_PROPERTY_OVERRIDES += \
-        vendor.rild.libpath=/vendor/lib64/librk-ril.so
+       vendor.rild.libpath=/vendor/lib64/libreference-ril-ec20.soPRODUCT_COPY_FILES += \$(LOCAL_PATH)/4g_modem/bin64/dhcpcd:$(TARGET_COPY_OUT_VENDOR)/bin/dhcpcd \$(LOCAL_PATH)/4g_modem/lib64/librk-ril.so:$(TARGET_COPY_OUT_VENDOR)/lib64/librk-ril.so
else
PRODUCT_PROPERTY_OVERRIDES += \
-       vendor.rild.libpath=/vendor/lib/librk-ril.so
+      vendor.rild.libpath=/vendor/lib/libreference-ril-ec20.soPRODUCT_COPY_FILES += \$(LOCAL_PATH)/4g_modem/bin32/dhcpcd:$(TARGET_COPY_OUT_VENDOR)/bin/dhcpcd \$(LOCAL_PATH)/4g_modem/lib32/librk-ril.so:$(TARGET_COPY_OUT_VENDOR)/lib/librk-ril.soendif
endif

设置属性（rild.libpath）

RK3568\device\rockchip\rk356x\device.mk
PRODUCT_PROPERTY_OVERRIDES += \ro.ril.ecclist=112,911 \ro.opengles.version=196610 \wifi.interface=wlan0 \
+              ro.telephony.default_network=9 \
+              rild.libpath=/vendor/lib64/libreference-ril-ec20.so \
+              rild.libargs=-d /dev/ttyUSB2 \ro.audio.monitorOrientation=true \debug.nfc.fw_download=false \debug.nfc.se=false \vendor.hwc.compose_policy=1 \sys.wallpaper.rgb565=0 \sf.power.control=2073600 \sys.rkadb.root=0 \ro.sf.fakerotation=false \ro.tether.denied=false \sys.resolution.changed=false \ro.default.size=100 \ro.product.usbfactory=rockchip_usb \wifi.supplicant_scan_interval=15 \ro.factory.tool=0 \ro.kernel.android.checkjni=0 \ro.build.shutdown_timeout=6 \persist.enable_task_snapshots=false \ro.vendor.frameratelock=true#

6.去掉property:ro.boot.noril

如果存在电话这一项，就执行下面的内容

设置setprop ro.radio.noril 为true

暂停ril-daemon服务

- a/device/rockchip/common/init.rk30board.rc
+ b/device/rockchip/common/init.rk30board.rc
@@ -238,7 +238,7 @@ on property:sys.boot_completed=1# for telephony function
-on property:ro.boot.noril=true
-    setprop ro.radio.noril true
-    stop ril-daemon
+#on property:ro.boot.noril=true
+#    setprop ro.radio.noril true
+#    stop ril-daemon

7.添加权限

\device\rockchip\common\ueventd.rockchip.rc
# for radio
/dev/ttyUSB*              0666   radio      radio
#for cdc-wdm0
/dev/cdc-wdm*        0660   radio      radio

8.根据上述属性打开rild的库

RK3568\hardware\ril\rild\rild.c
#if defined(PRODUCT_COMPATIBLE_PROPERTY)
#define LIB_PATH_PROPERTY   "vendor.rild.libpath"
#define LIB_ARGS_PROPERTY   "vendor.rild.libargs"
#else
#define LIB_PATH_PROPERTY   "rild.libpath"
#define LIB_ARGS_PROPERTY   "rild.libargs"
#endif
#define MAX_LIB_ARGS        16

根据第五点设置的库，可以使用串口指令查看加载库是否正确

console:/ # getprop | grep rild
[rild.libargs]: [-d]
[rild.libpath]: [/vendor/lib64/libreference-ril-ec20.so]
[vendor.rild.libpath]: [/vendor/lib64/libreference-ril-ec20.so]

9.修改传进去的库的名称 /vendor/lib64/libreference-ril-ec20.so设置成这个参数

RK3568\hardware\ril\rild\rild.rc
-#service vendor.ril-daemon /vendor/bin/hw/rild
-#    class main
-#    user radio
-#    group radio cache inet misc audio log readproc wakelock
-#    capabilities BLOCK_SUSPEND NET_ADMIN NET_RAW
+service ril-daemon /vendor/bin/hw/rild -l /vendor/lib64/libreference-ril-ec20.so
+     class main
+     user root
+     group radio cache inet misc audio sdcard_rw log
+     capabilities BLOCK_SUSPEND NET_ADMIN NET_RAW

10.4G上网正常，但状态栏中没有4G图标(完全没有图标)：

device\rockchip\rk356x\overlay\frameworks\base\core\res\res\value\config.xml
<string-array translatable="false" name="networkAttributes">
<item>"wifi,1,1,2,-1,true"</item>
+ <item>"mobile,0,0,0,-1,true"</item>
+ <item>"mobile_mms,2,0,2,60000,true"</item>
+ <item>"mobile_supl,3,0,2,60000,true"</item>
+ <item>"mobile_dun,4,0,2,60000,true"</item>
+ <item>"mobile_hipri,5,0,3,60000,true"</item>
+ <item>"mobile_fota,10,0,2,60000,true"</item>
+ <item>"mobile_ims,11,0,2,60000,true"</item>
+ <item>"mobile_cbs,12,0,2,60000,true"</item>
<item>"bluetooth,7,7,0,-1,true"</item>
<item>"ethernet,9,9,9,-1,true"</item>

11. 4G物联网卡,把APN加入

  在\vendor\rockchip\common\phone\etc\apns-full-conf.xml中增加<apn carrier="China Telecom" mcc="460" mnc="11" apn="ctnet" type="default,supl" /><apn carrier="中国移动物联网4G" mcc="460" mnc="04" apn="cmiot" type="default,supl" /><apn carrier="中国移动物联网2G" mcc="460" mnc="04"  apn="cmmtm" type="default,supl" /><apn carrier="中国联通物联网gzm2mapn" mcc="460" mnc="06" apn="unim2m.gzm2mapn" port="80" type="default,supl" /><apn carrier="中国联通物联网njm2mapn" mcc="460" mnc="06" apn="unim2m.njm2mapn"  type="default,supl" /><apn carrier="中国电信物联网m2m" mcc="460" mnc="03" apn="CTNET" user="m2m" password="vnet.mobi" type="default" />

12.设置APN打开

RK3568\device\rockchip\common\overlay\frameworks\base\core\res\res\values\config.xml
-    <bool name="config_voice_capable">false</bool>
+    <bool name="config_voice_capable">true</bool>

13.遇到开机未插4G模块，就一直报错的问题，甚至把系统拉起不来

打印报错

[ 2650.466038] init: Control message: Could not find 'android.hardware.radio@1.1::IRadio/slot1' for ctl.interface_start from pid: 149 (/system/bin/hwservicemanager)

RK3568\system\core\init\init.cpp
static bool HandleControlMessage(std::string_view message, const std::string& name,pid_t from_pid) {std::string cmdline_path = StringPrintf("proc/%d/cmdline", from_pid);std::string process_cmdline;......const auto& function = it->second;if (auto result = function(service); !result.ok()) {LOG(ERROR) << "Control message: Could not ctl." << message << " for '" << name<< "' from pid: " << from_pid << " (" << process_cmdline<< "): " << result.error();return false;}
+  if(strcmp(name.c_str(),"android.hardware.radio@1.1::IRadio/slot1") != 0) { LOG(INFO) << "Control message: Processed ctl." << message << " for '" << name<< "' from pid: " << from_pid << " (" << process_cmdline << ")";
+      }return true;
}

RK3568\system\hwservicemanager\ServiceManager.cpp
static void tryStartService(const std::string& fqName, const std::string& name) {using ::android::base::SetProperty;// The "happy path" here is starting up a service that is configured as a// lazy HAL, but we aren't sure that is the case. If the service doesn't// have an 'interface' entry in its .rc file OR if the service is already// running, then this will be a no-op. So, for instance, if a service is// deadlocked during startup, you will see this message repeatedly.
+  if(strcmp(fqName.c_str(),"android.hardware.radio@1.1::IRadio") != 0) {LOG(INFO) << "Since " << fqName << "/" << name<< " is not registered, trying to start it as a lazy HAL.";
+  }std::thread([=] {(void)SetProperty("ctl.interface_start", fqName + "/" + name);}).detach();
}

RK3568\system\libhidl\transport\ServiceManagement.cppvoid wait(bool timeout) {using std::literals::chrono_literals::operator""s;if (!mRegisteredForNotifications) {// As an alternative, just sleep for a second and returnLOG(WARNING) << "Waiting one second for " << mInterfaceName << "/" << mInstanceName;sleep(1);return;}std::unique_lock<std::mutex> lock(mMutex);do {mCondition.wait_for(lock, 1s, [this]{return mRegistered;});if (mRegistered) {break;}
+      if(strcmp(mInterfaceName.c_str(),"android.hardware.radio@1.1::IRadio") != 0) { LOG(WARNING) << "Waited one second for " << mInterfaceName << "/" << mInstanceName;
+      }} while (!timeout);}sp<::android::hidl::base::V1_0::IBase> getRawServiceInternal(const std::string& descriptor,const std::string& instance,bool retry, bool getStub) {// In case of legacy or we were not asked to retry, don't.if (vintfLegacy || !retry) break;if (waiter != nullptr) {
+              if(strcmp(descriptor.c_str(),"android.hardware.radio@1.1::IRadio") != 0) { ALOGI("getService: Trying again for %s/%s...", descriptor.c_str(), instance.c_str());
+              }waiter->wait(true /* timeout */);}}return nullptr;
}

//###############################################################//

qmi_wwan_q.c源码，之前有遇到图标拨号都有，就是没有上不了网，换成这个驱动就可以了。

仅供参考，亲测有效。


RK3568\kernel\drivers\net\usb\qmi_wwan_q.c
/** 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/netdevice.h>
#include <linux/ethtool.h>
#include <linux/etherdevice.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>/* 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*//* 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
#include <linux/etherdevice.h>
#include <net/arp.h>
#include <net/ip.h>
#include <net/ipv6.h>/*Quectel_WCDMA&LTE_Linux_USB_Driver_User_Guide_V1.9.pdf5.6. Test QMAP on GobiNet or QMI WWAN0 - no QMAP1 - QMAP (Aggregation protocol)X - QMAP (Multiplexing and Aggregation protocol)
*/
#define QUECTEL_WWAN_QMAP 4#if defined(QUECTEL_WWAN_QMAP)
#define QUECTEL_QMAP_MUX_ID 0x81static uint __read_mostly qmap_mode = 0;
module_param( qmap_mode, uint, S_IRUGO);
module_param_named( rx_qmap, qmap_mode, uint, S_IRUGO );
#endif#ifdef CONFIG_BRIDGE
//#define QUECTEL_BRIDGE_MODE
#endif#ifdef QUECTEL_BRIDGE_MODE
static uint __read_mostly bridge_mode = BIT(0)/*|BIT(1)*/;
module_param( bridge_mode, uint, S_IRUGO );
#endif#if defined(QUECTEL_WWAN_QMAP)
typedef struct sQmiWwanQmap
{struct usbnet *mpNetDev;atomic_t refcount;struct net_device *mpQmapNetDev[QUECTEL_WWAN_QMAP];uint link_state;uint qmap_mode;
#ifdef QUECTEL_BRIDGE_MODEuint bridge_mode;uint bridge_ipv4;unsigned char bridge_mac[ETH_ALEN];
#endif
} sQmiWwanQmap;struct qmap_priv {struct net_device *real_dev;u8 offset_id;
#ifdef QUECTEL_BRIDGE_MODEuint bridge_mode;uint bridge_ipv4;unsigned char bridge_mac[ETH_ALEN];
#endif
};struct qmap_hdr {u8 cd_rsvd_pad;u8 mux_id;u16 pkt_len;
} __packed;#ifdef QUECTEL_BRIDGE_MODE
static int is_qmap_netdev(const struct net_device *netdev);
#endif
#endif#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(tip, arpptr, sizeof(tip));pr_info("%s sip = %d.%d.%d.%d, tip=%d.%d.%d.%d, ipv4=%d.%d.%d.%d\n", netdev_name(net),sip[0], sip[1], sip[2], sip[3], tip[0], tip[1], tip[2], tip[3], ipv4[0], ipv4[1], ipv4[2], ipv4[3]);//wwan0 sip = 10.151.137.255, tip=10.151.138.0, ipv4=10.151.137.255if (tip[0] == ipv4[0] && tip[1] == ipv4[1] && (tip[2]&0xFC) == (ipv4[2]&0xFC) && tip[3] != ipv4[3])reply = arp_create(ARPOP_REPLY, ETH_P_ARP, *((__be32 *)sip), net, *((__be32 *)tip), sha, default_modem_addr, sha);if (reply) {skb_reset_mac_header(reply);__skb_pull(reply, skb_network_offset(reply));reply->ip_summed = CHECKSUM_UNNECESSARY;reply->pkt_type = PACKET_HOST;netif_rx_ni(reply);}return 1;}return 0;
}static struct sk_buff *bridge_mode_tx_fixup(struct net_device *net, struct sk_buff *skb, uint bridge_ipv4, unsigned char *bridge_mac) {struct ethhdr *ehdr;const struct iphdr *iph;skb_reset_mac_header(skb);ehdr = eth_hdr(skb); if (ehdr->h_proto == htons(ETH_P_ARP)) {if (bridge_ipv4)bridge_arp_reply(net, skb, bridge_ipv4);return NULL;}iph = ip_hdr(skb);//DBG("iphdr: ");//PrintHex((void *)iph, sizeof(struct iphdr));// 1  0.000000000 0.0.0.0 255.255.255.255 DHCP    362 DHCP Request  - Transaction ID 0xe7643ad7        if (ehdr->h_proto == htons(ETH_P_IP) && iph->protocol == IPPROTO_UDP && iph->saddr == 0x00000000 && iph->daddr == 0xFFFFFFFF) {//if (udp_hdr(skb)->dest == htons(67)) //DHCP Request{memcpy(bridge_mac, ehdr->h_source, ETH_ALEN);pr_info("%s PC Mac Address: %02x:%02x:%02x:%02x:%02x:%02x\n", netdev_name(net),bridge_mac[0], bridge_mac[1], bridge_mac[2], bridge_mac[3], bridge_mac[4], bridge_mac[5]);}}if (memcmp(ehdr->h_source, bridge_mac, ETH_ALEN)) {return NULL;}return skb;
}
#endif#if defined(QUECTEL_WWAN_QMAP)
static ssize_t qmap_mode_show(struct device *dev, struct device_attribute *attr, char *buf) {struct net_device *netdev = to_net_dev(dev);struct usbnet * usbnetdev = netdev_priv( netdev );struct qmi_wwan_state *info = (void *)&usbnetdev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;return snprintf(buf, PAGE_SIZE, "%d\n",  pQmapDev->qmap_mode);
}static DEVICE_ATTR(qmap_mode, S_IRUGO, qmap_mode_show, NULL);static ssize_t link_state_show(struct device *dev, struct device_attribute *attr, char *buf) {struct net_device *netdev = to_net_dev(dev);struct usbnet * usbnetdev = netdev_priv( netdev );struct qmi_wwan_state *info = (void *)&usbnetdev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;return snprintf(buf, PAGE_SIZE, "0x%x\n",  pQmapDev->link_state);
}static ssize_t link_state_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) {struct net_device *netdev = to_net_dev(dev);struct usbnet * usbnetdev = netdev_priv( netdev );struct qmi_wwan_state *info = (void *)&usbnetdev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;unsigned link_state = 0;unsigned old_link = pQmapDev->link_state;link_state = simple_strtoul(buf, NULL, 0);if (pQmapDev->qmap_mode == 1)pQmapDev->link_state = !!link_state;else if (pQmapDev->qmap_mode > 1) {if (0 < link_state && link_state <= pQmapDev->qmap_mode)pQmapDev->link_state |= (1 << (link_state - 1));else if (0x80 < link_state && link_state <= (0x80 + pQmapDev->qmap_mode))pQmapDev->link_state &= ~(1 << ((link_state&0xF) - 1));}if (old_link != pQmapDev->link_state)dev_info(dev, "link_state 0x%x -> 0x%x\n", old_link, pQmapDev->link_state);return count;
}#ifdef QUECTEL_BRIDGE_MODE
static ssize_t bridge_mode_show(struct device *dev, struct device_attribute *attr, char *buf) {struct net_device *netdev = to_net_dev(dev);uint bridge_mode = 0;if (is_qmap_netdev(netdev)) {struct qmap_priv *priv = netdev_priv(netdev);bridge_mode = priv->bridge_mode;   }else {struct usbnet * usbnetdev = netdev_priv( netdev );struct qmi_wwan_state *info = (void *)&usbnetdev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;bridge_mode = pQmapDev->bridge_mode;}return snprintf(buf, PAGE_SIZE, "%u\n", bridge_mode);
}static ssize_t bridge_ipv4_show(struct device *dev, struct device_attribute *attr, char *buf) {struct net_device *netdev = to_net_dev(dev);unsigned int bridge_ipv4 = 0;unsigned char ipv4[4];if (is_qmap_netdev(netdev)) {struct qmap_priv *priv = netdev_priv(netdev);bridge_ipv4 = priv->bridge_ipv4;    }else {struct usbnet * usbnetdev = netdev_priv( netdev );struct qmi_wwan_state *info = (void *)&usbnetdev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;bridge_ipv4 = pQmapDev->bridge_ipv4; }ipv4[0]  = (bridge_ipv4 >> 24) & 0xFF;ipv4[1]  = (bridge_ipv4 >> 16) & 0xFF;ipv4[2]  = (bridge_ipv4 >> 8) & 0xFF;ipv4[3]  = (bridge_ipv4 >> 0) & 0xFF;return snprintf(buf, PAGE_SIZE, "%d.%d.%d.%d\n",  ipv4[0], ipv4[1], ipv4[2], ipv4[3]);
}static ssize_t bridge_ipv4_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) {struct net_device *netdev = to_net_dev(dev);if (is_qmap_netdev(netdev)) {struct qmap_priv *priv = netdev_priv(netdev);priv->bridge_ipv4 = simple_strtoul(buf, NULL, 16);}else {struct usbnet * usbnetdev = netdev_priv( netdev );struct qmi_wwan_state *info = (void *)&usbnetdev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;pQmapDev->bridge_ipv4 = simple_strtoul(buf, NULL, 16);}return count;
}
#endifstatic DEVICE_ATTR(link_state, S_IWUSR | S_IRUGO, link_state_show, link_state_store);
#ifdef QUECTEL_BRIDGE_MODE
static DEVICE_ATTR(bridge_mode,  S_IRUGO, bridge_mode_show, NULL);
static DEVICE_ATTR(bridge_ipv4, S_IWUSR | S_IRUGO, bridge_ipv4_show, bridge_ipv4_store);
#endifstatic struct attribute *qmi_wwan_sysfs_attrs[] = {&dev_attr_link_state.attr,&dev_attr_qmap_mode.attr,
#ifdef QUECTEL_BRIDGE_MODE&dev_attr_bridge_mode.attr,&dev_attr_bridge_ipv4.attr,
#endifNULL,
};static struct attribute_group qmi_wwan_sysfs_attr_group = {.attrs = qmi_wwan_sysfs_attrs,
};#ifdef QUECTEL_BRIDGE_MODE
static struct attribute *qmi_qmap_sysfs_attrs[] = {&dev_attr_bridge_mode.attr,&dev_attr_bridge_ipv4.attr,NULL,
};static struct attribute_group qmi_qmap_sysfs_attr_group = {.attrs = qmi_qmap_sysfs_attrs,
};
#endifstatic int qmap_open(struct net_device *dev)
{struct qmap_priv *priv = netdev_priv(dev);struct net_device *real_dev = priv->real_dev;if (!(priv->real_dev->flags & IFF_UP))return -ENETDOWN;if (netif_carrier_ok(real_dev))netif_carrier_on(dev);return 0;
}static int qmap_stop(struct net_device *pNet)
{netif_carrier_off(pNet);return 0;
}static int qmap_start_xmit(struct sk_buff *skb, struct net_device *pNet)
{int err;struct qmap_priv *priv = netdev_priv(pNet);unsigned int len;struct qmap_hdr *hdr;skb_reset_mac_header(skb);#ifdef QUECTEL_BRIDGE_MODEif (priv->bridge_mode && bridge_mode_tx_fixup(pNet, skb, priv->bridge_ipv4, priv->bridge_mac) == NULL) {dev_kfree_skb_any (skb);return NETDEV_TX_OK;}
#endifif (skb_pull(skb, ETH_HLEN) == NULL) {dev_kfree_skb_any (skb);return NETDEV_TX_OK;}len = skb->len;hdr = (struct qmap_hdr *)skb_push(skb, sizeof(struct qmap_hdr));hdr->cd_rsvd_pad = 0;hdr->mux_id = QUECTEL_QMAP_MUX_ID + priv->offset_id;hdr->pkt_len = cpu_to_be16(len);skb->dev = priv->real_dev;err = dev_queue_xmit(skb);if (err == NET_XMIT_SUCCESS) {pNet->stats.tx_packets++;pNet->stats.tx_bytes += skb->len;} else {pNet->stats.tx_errors++;}return err;
}static const struct net_device_ops qmap_netdev_ops = {.ndo_open       = qmap_open,.ndo_stop       = qmap_stop,.ndo_start_xmit = qmap_start_xmit,
};static int qmap_register_device(sQmiWwanQmap * pDev, u8 offset_id)
{struct net_device *real_dev = pDev->mpNetDev->net;struct net_device *qmap_net;struct qmap_priv *priv;int err;qmap_net = alloc_etherdev(sizeof(*priv));if (!qmap_net)return -ENOBUFS;SET_NETDEV_DEV(qmap_net, &real_dev->dev);priv = netdev_priv(qmap_net);priv->offset_id = offset_id;priv->real_dev = real_dev;sprintf(qmap_net->name, "%s.%d", real_dev->name, offset_id + 1);qmap_net->netdev_ops = &qmap_netdev_ops;memcpy (qmap_net->dev_addr, real_dev->dev_addr, ETH_ALEN);#ifdef QUECTEL_BRIDGE_MODEpriv->bridge_mode = !!(pDev->bridge_mode & BIT(offset_id));qmap_net->sysfs_groups[0] = &qmi_qmap_sysfs_attr_group;
#endiferr = register_netdev(qmap_net);if (err < 0)goto out_free_newdev;netif_device_attach (qmap_net);pDev->mpQmapNetDev[offset_id] = qmap_net;qmap_net->flags |= IFF_NOARP;dev_info(&real_dev->dev, "%s %s\n", __func__, qmap_net->name);return 0;out_free_newdev:free_netdev(qmap_net);return err;
}static void qmap_unregister_device(sQmiWwanQmap * pDev, u8 offset_id) {struct net_device *net = pDev->mpQmapNetDev[offset_id];if (net != NULL) {netif_carrier_off( net );unregister_netdev (net);free_netdev(net);}
}#ifdef CONFIG_ANDROID
static int qmap_ndo_do_ioctl(struct net_device *dev,struct ifreq *ifr, int cmd) {int rc = -EOPNOTSUPP;uint link_state = 0;switch (cmd) {case 0x89F1: //SIOCDEVPRIVATErc = copy_from_user(&link_state, ifr->ifr_ifru.ifru_data, sizeof(link_state));if (!rc) {char buf[32];snprintf(buf, sizeof(buf), "%u", link_state);link_state_store(&dev->dev, NULL, buf, strlen(buf));}break;default:break;}return rc;
}
#endif#ifdef QUECTEL_BRIDGE_MODE
static int is_qmap_netdev(const struct net_device *netdev) {return netdev->netdev_ops == &qmap_netdev_ops;
}
#endif
#endifstatic struct sk_buff *qmi_wwan_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags) {//MDM9x07,MDM9628,MDM9x40,SDX20,SDX24 only work on RAW IP modeif ((dev->driver_info->flags & FLAG_NOARP) == 0)return skb;// Skip Ethernet header from messageif (dev->net->hard_header_len == 0)return skb;elseskb_reset_mac_header(skb);#ifdef QUECTEL_BRIDGE_MODE
{struct qmi_wwan_state *info = (void *)&dev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;if (pQmapDev->bridge_mode && bridge_mode_tx_fixup(dev->net, skb, pQmapDev->bridge_ipv4, pQmapDev->bridge_mac) == NULL) {dev_kfree_skb_any (skb);return NULL;}
}
#endifif (skb_pull(skb, ETH_HLEN)) {return skb;} else {dev_err(&dev->intf->dev,  "Packet Dropped ");}// Filter the packet out, release itdev_kfree_skb_any(skb);return NULL;
}
#endif/* Make up an ethernet header if the packet doesn't have one.** A firmware bug common among several devices cause them to send raw* IP packets under some circumstances.  There is no way for the* driver/host to know when this will happen.  And even when the bug* hits, some packets will still arrive with an intact header.** The supported devices are only capably of sending IPv4, IPv6 and* ARP packets on a point-to-point link. Any packet with an ethernet* header will have either our address or a broadcast/multicast* address as destination.  ARP packets will always have a header.** This means that this function will reliably add the appropriate* header iff necessary, provided our hardware address does not start* with 4 or 6.** Another common firmware bug results in all packets being addressed* to 00:a0:c6:00:00:00 despite the host address being different.* This function will also fixup such packets.*/
static int qmi_wwan_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
{__be16 proto;
#ifdef QUECTEL_BRIDGE_MODEstruct qmi_wwan_state *info = (void *)&dev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
#endif/* This check is no longer done by usbnet */if (skb->len < dev->net->hard_header_len)return 0;switch (skb->data[0] & 0xf0) {case 0x40:proto = htons(ETH_P_IP);break;case 0x60:proto = htons(ETH_P_IPV6);break;case 0x00:if (is_multicast_ether_addr(skb->data))return 1;/* possibly bogus destination - rewrite just in case */skb_reset_mac_header(skb);goto fix_dest;default:/* pass along other packets without modifications */return 1;}if (skb_headroom(skb) < ETH_HLEN)return 0;skb_push(skb, ETH_HLEN);skb_reset_mac_header(skb);eth_hdr(skb)->h_proto = proto;memset(eth_hdr(skb)->h_source, 0, ETH_ALEN);
#if 1 //Added by Quectel//some kernel will drop ethernet packet which's souce mac is all zeromemcpy(eth_hdr(skb)->h_source, default_modem_addr, ETH_ALEN);
#endif
#ifdef QUECTEL_BRIDGE_MODE  if (pQmapDev->bridge_mode) {memcpy(eth_hdr(skb)->h_dest, pQmapDev->bridge_mac, ETH_ALEN);}
#endiffix_dest:memcpy(eth_hdr(skb)->h_dest, dev->net->dev_addr, ETH_ALEN);return 1;
}#if defined(QUECTEL_WWAN_QMAP)
static struct sk_buff *qmap_qmi_wwan_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags) {struct qmi_wwan_state *info = (void *)&dev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;struct qmap_hdr *qhdr;if (unlikely(pQmapDev == NULL)) {goto drop_skb;} else if (unlikely(pQmapDev->qmap_mode && !pQmapDev->link_state)) {dev_dbg(&dev->net->dev, "link_state 0x%x, drop skb, len = %u\n", pQmapDev->link_state, skb->len);goto drop_skb;} else if (pQmapDev->qmap_mode == 0) {return qmi_wwan_tx_fixup(dev, skb, flags);}else if (pQmapDev->qmap_mode > 1) {qhdr = (struct qmap_hdr *)skb->data;if (qhdr->cd_rsvd_pad != 0) {goto drop_skb;}if ((qhdr->mux_id&0xF0) != 0x80) {goto drop_skb;}return skb;}else {if (qmi_wwan_tx_fixup(dev, skb, flags)) {qhdr = (struct qmap_hdr *)skb_push(skb, sizeof(struct qmap_hdr));qhdr->cd_rsvd_pad = 0;qhdr->mux_id = QUECTEL_QMAP_MUX_ID;qhdr->pkt_len = cpu_to_be16(skb->len - sizeof(struct qmap_hdr));return skb;}else {return NULL;}}drop_skb:dev_kfree_skb_any (skb);return NULL;
}static int qmap_qmi_wwan_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
{struct qmi_wwan_state *info = (void *)&dev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;static int debug_len = 0;int debug_pkts = 0;int update_len = skb->len;if (pQmapDev->qmap_mode == 0)return qmi_wwan_rx_fixup(dev, skb);while (skb->len > sizeof(struct qmap_hdr)) {struct qmap_hdr *qhdr = (struct qmap_hdr *)skb->data;struct net_device *qmap_net;struct sk_buff *qmap_skb;
#ifdef QUECTEL_BRIDGE_MODEuint bridge_mode = 0;unsigned char *bridge_mac;
#endif__be16 proto;int pkt_len;u8 offset_id = 0;int err;unsigned len = (be16_to_cpu(qhdr->pkt_len) + sizeof(struct qmap_hdr));if (skb->len < (be16_to_cpu(qhdr->pkt_len) + sizeof(struct qmap_hdr))) {dev_info(&dev->net->dev, "drop qmap unknow pkt, len=%d, pkt_len=%d\n", skb->len, be16_to_cpu(qhdr->pkt_len));goto out;}debug_pkts++;if (qhdr->cd_rsvd_pad & 0x80) {dev_info(&dev->net->dev, "drop qmap command packet %x\n", qhdr->cd_rsvd_pad);goto skip_pkt;;}offset_id = qhdr->mux_id - QUECTEL_QMAP_MUX_ID;if (offset_id >= pQmapDev->qmap_mode) {dev_info(&dev->net->dev, "drop qmap unknow mux_id %x\n", qhdr->mux_id);goto skip_pkt;}qmap_net = pQmapDev->mpQmapNetDev[offset_id];if (qmap_net == NULL) {dev_info(&dev->net->dev, "drop qmap unknow mux_id %x\n", qhdr->mux_id);goto skip_pkt;}switch (skb->data[sizeof(struct qmap_hdr)] & 0xf0) {case 0x40:proto = htons(ETH_P_IP);break;case 0x60:proto = htons(ETH_P_IPV6);break;default:goto skip_pkt;}pkt_len = be16_to_cpu(qhdr->pkt_len) - (qhdr->cd_rsvd_pad&0x3F);qmap_skb = netdev_alloc_skb(qmap_net, ETH_HLEN + pkt_len);if (qmap_skb == NULL) {dev_info(&dev->net->dev, "fail to alloc skb, pkt_len = %d\n", pkt_len);return 0;}skb_reset_mac_header(qmap_skb);memcpy(eth_hdr(qmap_skb)->h_source, default_modem_addr, ETH_ALEN);memcpy(eth_hdr(qmap_skb)->h_dest, qmap_net->dev_addr, ETH_ALEN);eth_hdr(qmap_skb)->h_proto = proto;        memcpy(skb_put(qmap_skb, ETH_HLEN + pkt_len) + ETH_HLEN, skb->data + sizeof(struct qmap_hdr), pkt_len);
#ifdef QUECTEL_BRIDGE_MODEif (pQmapDev->qmap_mode > 1) {struct qmap_priv *priv = netdev_priv(qmap_net);bridge_mode = priv->bridge_mode;bridge_mac = priv->bridge_mac;}else {bridge_mode = pQmapDev->bridge_mode;bridge_mac = pQmapDev->bridge_mac;}if (bridge_mode) {memcpy(eth_hdr(qmap_skb)->h_dest, bridge_mac, ETH_ALEN);}
#endifif (pQmapDev->qmap_mode > 1) {qmap_skb->protocol = eth_type_trans (qmap_skb, qmap_net);memset(qmap_skb->cb, 0, sizeof(struct skb_data));err = netif_rx(qmap_skb);if (err == NET_RX_SUCCESS) {qmap_net->stats.rx_packets++;qmap_net->stats.rx_bytes += qmap_skb->len;} else {qmap_net->stats.rx_errors++;}}else {usbnet_skb_return(dev, qmap_skb);}skip_pkt:skb_pull(skb, len);}out:if (update_len > debug_len) {debug_len = update_len;dev_info(&dev->net->dev, "rx_pkts=%d, rx_len=%d\n", debug_pkts, debug_len);}return 0;
}
#endif/* very simplistic detection of IPv4 or IPv6 headers */
static bool possibly_iphdr(const char *data)
{return (data[0] & 0xd0) == 0x40;
}/* disallow addresses which may be confused with IP headers */
static int qmi_wwan_mac_addr(struct net_device *dev, void *p)
{int ret;struct sockaddr *addr = p;ret = eth_prepare_mac_addr_change(dev, p);if (ret < 0)return ret;if (possibly_iphdr(addr->sa_data))return -EADDRNOTAVAIL;eth_commit_mac_addr_change(dev, p);return 0;
}static const struct net_device_ops qmi_wwan_netdev_ops = {.ndo_open       = usbnet_open,.ndo_stop        = usbnet_stop,.ndo_start_xmit      = usbnet_start_xmit,.ndo_tx_timeout        = usbnet_tx_timeout,.ndo_change_mtu        = usbnet_change_mtu,.ndo_set_mac_address   = qmi_wwan_mac_addr,.ndo_validate_addr = eth_validate_addr,
#if defined(QUECTEL_WWAN_QMAP) && defined(CONFIG_ANDROID).ndo_do_ioctl = qmap_ndo_do_ioctl,
#endif
};/* using a counter to merge subdriver requests with our own into a* combined state*/
static int qmi_wwan_manage_power(struct usbnet *dev, int on)
{struct qmi_wwan_state *info = (void *)&dev->data;int rv;dev_dbg(&dev->intf->dev, "%s() pmcount=%d, on=%d\n", __func__,atomic_read(&info->pmcount), on);if ((on && atomic_add_return(1, &info->pmcount) == 1) ||(!on && atomic_dec_and_test(&info->pmcount))) {/* need autopm_get/put here to ensure the usbcore sees* the new value*/rv = usb_autopm_get_interface(dev->intf);dev->intf->needs_remote_wakeup = on;if (!rv)usb_autopm_put_interface(dev->intf);}return 0;
}static int qmi_wwan_cdc_wdm_manage_power(struct usb_interface *intf, int on)
{struct usbnet *dev = usb_get_intfdata(intf);/* can be called while disconnecting */if (!dev)return 0;return qmi_wwan_manage_power(dev, on);
}/* collect all three endpoints and register subdriver */
static int qmi_wwan_register_subdriver(struct usbnet *dev)
{int rv;struct usb_driver *subdriver = NULL;struct qmi_wwan_state *info = (void *)&dev->data;/* collect bulk endpoints */rv = usbnet_get_endpoints(dev, info->data);if (rv < 0)goto err;/* update status endpoint if separate control interface */if (info->control != info->data)dev->status = &info->control->cur_altsetting->endpoint[0];/* require interrupt endpoint for subdriver */if (!dev->status) {rv = -EINVAL;goto err;}/* for subdriver power management */atomic_set(&info->pmcount, 0);/* register subdriver */subdriver = usb_cdc_wdm_register(info->control, &dev->status->desc,4096, &qmi_wwan_cdc_wdm_manage_power);if (IS_ERR(subdriver)) {dev_err(&info->control->dev, "subdriver registration failed\n");rv = PTR_ERR(subdriver);goto err;}/* prevent usbnet from using status endpoint */dev->status = NULL;/* save subdriver struct for suspend/resume wrappers */info->subdriver = subdriver;err:return rv;
}static int qmi_wwan_bind(struct usbnet *dev, struct usb_interface *intf)
{int status = -1;u8 *buf = intf->cur_altsetting->extra;int len = intf->cur_altsetting->extralen;struct usb_interface_descriptor *desc = &intf->cur_altsetting->desc;struct usb_cdc_union_desc *cdc_union = NULL;struct usb_cdc_ether_desc *cdc_ether = NULL;u32 found = 0;struct usb_driver *driver = driver_of(intf);struct qmi_wwan_state *info = (void *)&dev->data;BUILD_BUG_ON((sizeof(((struct usbnet *)0)->data) <sizeof(struct qmi_wwan_state)));/* set up initial state */info->control = intf;info->data = intf;/* and a number of CDC descriptors */while (len > 3) {struct usb_descriptor_header *h = (void *)buf;/* ignore any misplaced descriptors */if (h->bDescriptorType != USB_DT_CS_INTERFACE)goto next_desc;/* buf[2] is CDC descriptor subtype */switch (buf[2]) {case USB_CDC_HEADER_TYPE:if (found & 1 << USB_CDC_HEADER_TYPE) {dev_dbg(&intf->dev, "extra CDC header\n");goto err;}if (h->bLength != sizeof(struct usb_cdc_header_desc)) {dev_dbg(&intf->dev, "CDC header len %u\n",h->bLength);goto err;}break;case USB_CDC_UNION_TYPE:if (found & 1 << USB_CDC_UNION_TYPE) {dev_dbg(&intf->dev, "extra CDC union\n");goto err;}if (h->bLength != sizeof(struct usb_cdc_union_desc)) {dev_dbg(&intf->dev, "CDC union len %u\n",h->bLength);goto err;}cdc_union = (struct usb_cdc_union_desc *)buf;break;case USB_CDC_ETHERNET_TYPE:if (found & 1 << USB_CDC_ETHERNET_TYPE) {dev_dbg(&intf->dev, "extra CDC ether\n");goto err;}if (h->bLength != sizeof(struct usb_cdc_ether_desc)) {dev_dbg(&intf->dev, "CDC ether len %u\n",h->bLength);goto err;}cdc_ether = (struct usb_cdc_ether_desc *)buf;break;}/* Remember which CDC functional descriptors we've seen.  Works* for all types we care about, of which USB_CDC_ETHERNET_TYPE* (0x0f) is the highest numbered*/if (buf[2] < 32)found |= 1 << buf[2];next_desc:len -= h->bLength;buf += h->bLength;}/* Use separate control and data interfaces if we found a CDC Union */if (cdc_union) {info->data = usb_ifnum_to_if(dev->udev,cdc_union->bSlaveInterface0);if (desc->bInterfaceNumber != cdc_union->bMasterInterface0 ||!info->data) {dev_err(&intf->dev,"bogus CDC Union: master=%u, slave=%u\n",cdc_union->bMasterInterface0,cdc_union->bSlaveInterface0);goto err;}}/* errors aren't fatal - we can live with the dynamic address */if (cdc_ether) {dev->hard_mtu = le16_to_cpu(cdc_ether->wMaxSegmentSize);usbnet_get_ethernet_addr(dev, cdc_ether->iMACAddress);}/* claim data interface and set it up */if (info->control != info->data) {status = usb_driver_claim_interface(driver, info->data, dev);if (status < 0)goto err;}status = qmi_wwan_register_subdriver(dev);if (status < 0 && info->control != info->data) {usb_set_intfdata(info->data, NULL);usb_driver_release_interface(driver, info->data);}/* Never use the same address on both ends of the link, even* if the buggy firmware told us to.*/if (ether_addr_equal(dev->net->dev_addr, default_modem_addr))eth_hw_addr_random(dev->net);/* make MAC addr easily distinguishable from an IP header */if (possibly_iphdr(dev->net->dev_addr)) {dev->net->dev_addr[0] |= 0x02;  /* set local assignment bit */dev->net->dev_addr[0] &= 0xbf; /* clear "IP" bit */}dev->net->netdev_ops = &qmi_wwan_netdev_ops;#if 1 //Added by Quectelif (dev->driver_info->flags & FLAG_NOARP) {     dev_info(&intf->dev, "Quectel EC25&EC21&EG91&EG95&EG06&EP06&EM06&EG12&EP12&EM12&EG16&EG18&BG96&AG35 work on RawIP mode\n");dev->net->flags |= IFF_NOARP;usb_control_msg(interface_to_usbdev(intf),usb_sndctrlpipe(interface_to_usbdev(intf), 0),0x22, //USB_CDC_REQ_SET_CONTROL_LINE_STATE0x21, //USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE1, //active CDC DTRintf->cur_altsetting->desc.bInterfaceNumber,NULL, 0, 100);}//to advoid module report mtu 1460, but rx 1500 bytes IP packets, and cause the customer's system crash//next setting can make usbnet.c:usbnet_change_mtu() do not modify rx_urb_size according to hard mtudev->rx_urb_size = ETH_DATA_LEN + ETH_HLEN + 6;#if defined(QUECTEL_WWAN_QMAP)if (qmap_mode > QUECTEL_WWAN_QMAP)qmap_mode = QUECTEL_WWAN_QMAP;if (!status){sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)kzalloc(sizeof(sQmiWwanQmap), GFP_KERNEL);if (pQmapDev == NULL)return -ENODEV;#ifdef QUECTEL_BRIDGE_MODEpQmapDev->bridge_mode = bridge_mode;
#endifpQmapDev->mpNetDev = dev;pQmapDev->link_state = 1;if (dev->driver_info->flags & FLAG_NOARP){int idProduct = le16_to_cpu(dev->udev->descriptor.idProduct);int lte_a = (idProduct == 0x0306 || idProduct == 0x0512 || idProduct == 0x0620 || idProduct == 0x0800);pQmapDev->qmap_mode = qmap_mode;if (lte_a || dev->udev->speed == USB_SPEED_SUPER) {if (pQmapDev->qmap_mode == 0) {pQmapDev->qmap_mode = 1; //force use QMAPif(qmap_mode == 0)qmap_mode = 1; //old quectel-CM only check sys/module/wwan0/parameters/qmap_mode}}if (pQmapDev->qmap_mode) {if (idProduct == 0x0121 || idProduct == 0x0125 || idProduct == 0x0435) //MDM9x07dev->rx_urb_size = 4*1024;else if (lte_a || dev->udev->speed == USB_SPEED_SUPER)dev->rx_urb_size = 32*1024;elsedev->rx_urb_size = 32*1024;//for these modules, if send pakcet before qmi_start_network, or cause host PC crash, or cause modules crashif (lte_a || dev->udev->speed == USB_SPEED_SUPER)pQmapDev->link_state = 0;}}info->unused = (unsigned long)pQmapDev;     dev->net->sysfs_groups[0] = &qmi_wwan_sysfs_attr_group;dev_info(&intf->dev, "rx_urb_size = %zd\n", dev->rx_urb_size);}
#endif
#endiferr:return status;
}static void qmi_wwan_unbind(struct usbnet *dev, struct usb_interface *intf)
{struct qmi_wwan_state *info = (void *)&dev->data;struct usb_driver *driver = driver_of(intf);struct usb_interface *other;if (info->subdriver && info->subdriver->disconnect)info->subdriver->disconnect(info->control);/* allow user to unbind using either control or data */if (intf == info->control)other = info->data;elseother = info->control;/* only if not shared */if (other && intf != other) {usb_set_intfdata(other, NULL);usb_driver_release_interface(driver, other);}info->subdriver = NULL;info->data = NULL;info->control = NULL;
}/* suspend/resume wrappers calling both usbnet and the cdc-wdm* subdriver if present.** NOTE: cdc-wdm also supports pre/post_reset, but we cannot provide* wrappers for those without adding usbnet reset support first.*/
static int qmi_wwan_suspend(struct usb_interface *intf, pm_message_t message)
{struct usbnet *dev = usb_get_intfdata(intf);struct qmi_wwan_state *info = (void *)&dev->data;int ret;/* Both usbnet_suspend() and subdriver->suspend() MUST return 0* in system sleep context, otherwise, the resume callback has* to recover device from previous suspend failure.*/ret = usbnet_suspend(intf, message);if (ret < 0)goto err;if (intf == info->control && info->subdriver &&info->subdriver->suspend)ret = info->subdriver->suspend(intf, message);if (ret < 0)usbnet_resume(intf);
err:return ret;
}static int qmi_wwan_resume(struct usb_interface *intf)
{struct usbnet *dev = usb_get_intfdata(intf);struct qmi_wwan_state *info = (void *)&dev->data;int ret = 0;bool callsub = (intf == info->control && info->subdriver &&info->subdriver->resume);if (callsub)ret = info->subdriver->resume(intf);if (ret < 0)goto err;ret = usbnet_resume(intf);if (ret < 0 && callsub)info->subdriver->suspend(intf, PMSG_SUSPEND);
err:return ret;
}static int qmi_wwan_reset_resume(struct usb_interface *intf)
{dev_info(&intf->dev, "device do not support reset_resume\n");intf->needs_binding = 1;return -EOPNOTSUPP;
}static const struct driver_info    qmi_wwan_info = {.description  = "WWAN/QMI device",.flags       = FLAG_WWAN,.bind      = qmi_wwan_bind,.unbind        = qmi_wwan_unbind,.manage_power    = qmi_wwan_manage_power,.rx_fixup       = qmi_wwan_rx_fixup,
};static const struct driver_info qmi_wwan_raw_ip_info = {.description = "WWAN/QMI device",.flags       = FLAG_WWAN | FLAG_RX_ASSEMBLE | FLAG_NOARP | FLAG_SEND_ZLP,.bind      = qmi_wwan_bind,.unbind        = qmi_wwan_unbind,.manage_power    = qmi_wwan_manage_power,
#if defined(QUECTEL_WWAN_QMAP).tx_fixup       = qmap_qmi_wwan_tx_fixup,.rx_fixup       = qmap_qmi_wwan_rx_fixup,
#else.tx_fixup       = qmi_wwan_tx_fixup,.rx_fixup       = qmi_wwan_rx_fixup,
#endif
};/* map QMI/wwan function by a fixed interface number */
#define QMI_FIXED_INTF(vend, prod, num) \USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \.driver_info = (unsigned long)&qmi_wwan_info#define QMI_FIXED_RAWIP_INTF(vend, prod, num) \USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \.driver_info = (unsigned long)&qmi_wwan_raw_ip_infostatic const struct usb_device_id products[] = {
#if 1 //Added by Quectel{ QMI_FIXED_INTF(0x05C6, 0x9003, 4) },  /* Quectel UC20 */{ QMI_FIXED_INTF(0x05C6, 0x9215, 4) },  /* Quectel EC20 (MDM9215) */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0125, 4) },  /* Quectel EC20 (MDM9X07)/EC25/EG25 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0121, 4) },  /* Quectel EC21 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0191, 4) },  /* Quectel EG91 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0195, 4) },  /* Quectel EG95 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0306, 4) },  /* Quectel EG06/EP06/EM06 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0512, 4) },  /* Quectel EG12/EP12/EM12/EG16/EG18 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0296, 4) },  /* Quectel BG96 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0435, 4) },  /* Quectel AG35 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0620, 4) },  /* Quectel EG20 */{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0800, 4) },  /* Quectel RG500 */
#endif{ }                   /* END */
};
MODULE_DEVICE_TABLE(usb, products);static int qmi_wwan_probe(struct usb_interface *intf,const struct usb_device_id *prod)
{struct usb_device_id *id = (struct usb_device_id *)prod;/* Workaround to enable dynamic IDs.  This disables usbnet* blacklisting functionality.  Which, if required, can be* reimplemented here by using a magic "blacklist" value* instead of 0 in the static device id table*/if (!id->driver_info) {dev_dbg(&intf->dev, "setting defaults for dynamic device id\n");id->driver_info = (unsigned long)&qmi_wwan_info;}if (intf->cur_altsetting->desc.bInterfaceClass != 0xff) {dev_info(&intf->dev,  "Quectel module not qmi_wwan mode! please check 'at+qcfg=\"usbnet\"'\n");return -ENODEV;}return usbnet_probe(intf, id);
}#if defined(QUECTEL_WWAN_QMAP)
static int qmap_qmi_wwan_probe(struct usb_interface *intf,const struct usb_device_id *prod)
{int status = qmi_wwan_probe(intf, prod);if (!status) {struct usbnet *dev = usb_get_intfdata(intf);struct qmi_wwan_state *info = (void *)&dev->data;      sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;unsigned i;if (pQmapDev) {if (pQmapDev->qmap_mode == 1) {pQmapDev->mpQmapNetDev[0] = dev->net;}else if (pQmapDev->qmap_mode > 1) {for (i = 0; i < pQmapDev->qmap_mode; i++) {qmap_register_device(pQmapDev, i);}}}}return status;
}static void qmap_qmi_wwan_disconnect(struct usb_interface *intf)
{struct usbnet *dev = usb_get_intfdata(intf);struct qmi_wwan_state *info = (void *)&dev->data;sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;if (pQmapDev) {if (pQmapDev->qmap_mode > 1) {unsigned i;for (i = 0; i < pQmapDev->qmap_mode; i++) {qmap_unregister_device(pQmapDev, i);}    }kfree(pQmapDev);}usbnet_disconnect(intf);
}
#endifstatic struct usb_driver qmi_wwan_driver = {.name              = "qmi_wwan_q",.id_table         = products,.probe              = qmi_wwan_probe,
#if defined(QUECTEL_WWAN_QMAP).probe              = qmap_qmi_wwan_probe,.disconnect          = qmap_qmi_wwan_disconnect,
#else.probe           = qmi_wwan_probe,.disconnect       = usbnet_disconnect,
#endif.suspend        = qmi_wwan_suspend,.resume             =    qmi_wwan_resume,.reset_resume         = qmi_wwan_reset_resume,.supports_autosuspend = 1,.disable_hub_initiated_lpm = 1,
};module_usb_driver(qmi_wwan_driver);MODULE_AUTHOR("Bjørn Mork <bjorn@mork.no>");
MODULE_DESCRIPTION("Qualcomm MSM Interface (QMI) WWAN driver");
MODULE_LICENSE("GPL");
#define QUECTEL_WWAN_VERSION "Quectel_Linux&Android_QMI_WWAN_Driver_V1.1"
MODULE_VERSION(QUECTEL_WWAN_VERSION);

生活一步一个脚印，每一步都不容易，请珍惜当下！

RK3568-ANDROID11-4G-EC20-(详细步骤)相关推荐

远程计算机怎么安装系统,w7系统可以远程安装吗_win7远程重装系统详细步骤
win7系统的安装方式有很多种,其中就有我们常见的,也有我们很少接触过的,其中就有远程安装win7系统,这样的操作可以为别人减少许多不必要的麻烦.可是win7要怎么远程重装系统呢?只要远程控制对方的电 ...
Ubuntu U盘启动工具Rufus制作(详细步骤)
Ubuntu U盘启动工具Rufus制作(详细步骤) 这篇文章使用的是Ubuntu推荐的U盘制作工具Rufus(windows环境下) 插入U盘(4G以上)打开Rufus(以Rufus3.3为例)[这 ...
linux安装oracle数据库详细步骤
Linux安装Oracle11g详细步骤及问题汇总一. 安装前准备工作 1.检查Linux系统是64位还是32位 getconf LONG_BIT 2.下载oracle11g并解压,先登录在下载官 ...
NSIS（Nullsoft Scriptable Install System）开源安装程序制作软件使用详细步骤（Windows系统下）
NSIS(Nullsoft Scriptable Install System)开源安装程序制作软件使用详细步骤(Windows系统下)安装包制作 1.软件详情软件版本版本说明翻译跟进 2.教程 ...
用u盘装linux系统分区怎么画,linux安装教程,U盘安装Linux详细步骤图解。
linux是免费开源的系统,经过多年的发展linux在应用方面已经有了很大的提升,很多工作都可以在linux下完成~如果你想要学习linux或是在linux下工作,那么需要把电脑安装成linux,如何 ...
360浏览器如何保存html文件夹下,在360浏览器中将书签保存的详细步骤
软件大小: 68.6MB 软件版本: 12.2.1812.0 软件类型: 浏览器查看详情直接下载很多用户都选择使用360浏览器,那么你们知道在其中怎样保存书签吗?下文就是在360浏览器中将书签保 ...
Cacti安装详细步骤
Cacti安装详细步骤前提LNMP或LAMP架构已搭建完成一.cacti概述 1. cacti是用php语言实现的一个软件,它的主要功能是用snmp服务获取数据,然后用rrdtool储存和更新数据 ...
android系统的iphone,iPhone上安装Android系统详细步骤。
该楼层疑似违规已被系统折叠隐藏此楼查看此楼在iphone安装android系统的详细步骤首先,准备好iphone的多点触屏和wlan固件.因为法律的缘故,我们不能分享这些文件,你可以去ipsw文 ...
Windows Server 2003 AD升级到Windows Server 2008 AD的方法及详细步骤
前言: Windows Server 2008 是现在企业比较流行的服务器操作系统,安全性高,配置灵活.方便,集成了Hyper-V虚拟化功能,能够充分发挥硬件的性能.Windows Server 20 ...
HTML用乘法函数,Excel乘法函数的使用方法和详细步骤
Excel是一款非常强大的办公软件,其应用非常广泛.我们在日常工作中经常都要用到Excel,使用Excel进行处理大型数据的表格,要在数据上计算就会使用到数据上相乘,这时候我们就需要使用乘法的函数,那 ...

RK3568-ANDROID11-4G-EC20-(详细步骤)

RK3568-ANDROID11-4G-EC20-(详细步骤)相关推荐

最新文章

热门文章