.._rk3568 ec20">
devbox
繁依Fanyi0
这个屌丝很懒，什么也没留下！
关注作者
热门标签
热门文章
当前位置:   article > 正文

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

作者：繁依Fanyi0 | 2024-03-20 16:56:33

赞

踩

rk3568 ec20

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

原理图

 

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

 驱动

  1. RK3568\kernel\drivers\usb\serial\option.c
  2. +static const struct usb_device_id option_ids[] = {
  3. +		#if 1 //Added by Quectel
  4. +		{ USB_DEVICE(0x2C7C, 0x0125) }, /* Quectel EC20 R2.0/EC20 R2.1/EC25/EG25-G/EM05 */
  5. +		{ USB_DEVICE(0x2C7C, 0x0121) }, /* Quectel EC21/EG21-G */
  6. +		{ USB_DEVICE(0x2C7C, 0x0191) }, /* Quectel EG91 */
  7. +		{ USB_DEVICE(0x2C7C, 0x0195) }, /* Quectel EG95 */
  8. +		{ USB_DEVICE(0x2C7C, 0x0306) }, /* Quectel EG06/EP06/EM06 */
  9. +		{ USB_DEVICE(0x2C7C, 0x0512) }, /* Quectel EG12/EM12/EG18 */
  10. +		{ USB_DEVICE(0x2C7C, 0x0296) }, /* Quectel BG96 */
  11. +		{ USB_DEVICE(0x2C7C, 0x0700) }, /* Quectel BG95/BG77/BG600L-M3/BC69 */
  12. +		{ USB_DEVICE(0x2C7C, 0x0435) }, /* Quectel AG35 */
  13. +		{ USB_DEVICE(0x2C7C, 0x0415) }, /* Quectel AG15 */
  14. +		{ USB_DEVICE(0x2C7C, 0x0452) }, /* Quectel AG520R */
  15. +		{ USB_DEVICE(0x2C7C, 0x0455) }, /* Quectel AG550R */
  16. +		{ USB_DEVICE(0x2C7C, 0x0620) }, /* Quectel EG20 */
  17. +		{ USB_DEVICE(0x2C7C, 0x0800) }, /* Quectel RG500Q/RM500Q/RG510Q/RM510Q */	
  18. +		{ USB_DEVICE(0x1E0E,0x9001),//SIM8200EAM2
  19. +		 .driver_info = RSVD(4) | RSVD(5) | RSVD(6) | RSVD(6)},
  20. +	#endif
  21. +}
  22.  
  23.  
  24.  
  25. static struct usb_serial_driver option_1port_device = {
  26. 	.driver = {
  27. 		.owner =	THIS_MODULE,
  28. 		.name =		"option1",
  29. 	},
  30. 	.description       = "GSM modem (1-port)",
  31. 	.id_table          = option_ids,
  32. 	.num_ports         = 1,
  33. 	.probe             = option_probe,
  34. 	.open              = usb_wwan_open,
  35. 	.close             = usb_wwan_close,
  36. 	.dtr_rts	   = usb_wwan_dtr_rts,
  37. 	.write             = usb_wwan_write,
  38. 	.write_room        = usb_wwan_write_room,
  39. 	.chars_in_buffer   = usb_wwan_chars_in_buffer,
  40. 	.tiocmget          = usb_wwan_tiocmget,
  41. 	.tiocmset          = usb_wwan_tiocmset,
  42. 	.ioctl             = usb_wwan_ioctl,
  43. 	.attach            = option_attach,
  44. 	.release           = option_release,
  45. 	.port_probe        = usb_wwan_port_probe,
  46. 	.port_remove	   = usb_wwan_port_remove,
  47. 	.read_int_callback = option_instat_callback,
  48. #ifdef CONFIG_PM
  49. 	.suspend           = usb_wwan_suspend,
  50. 	.resume            = usb_wwan_resume,
  51. + #if 1
  52. +	.reset_resume      = usb_wwan_resume,
  53. + #endif
  54. #endif
  55. };
  1. RK3568\kernel\drivers\usb\serial\usb_wwan.c
  2. static struct urb *usb_wwan_setup_urb(struct usb_serial_port *port,
  3. 				      int endpoint,
  4. 				      int dir, void *ctx, char *buf, int len,
  5. 				      void (*callback) (struct urb *))
  6. {
  7. 	struct usb_serial *serial = port->serial;
  8. 	struct usb_wwan_intf_private *intfdata = usb_get_serial_data(serial);
  9. 	struct urb *urb;
  10. 	struct usb_device_descriptor *desc = &serial->dev->descriptor;
  11.  
  12. 	urb = usb_alloc_urb(0, GFP_KERNEL);	/* No ISO */
  13. 	if (!urb)
  14. 		return NULL;
  15.  
  16. 	usb_fill_bulk_urb(urb, serial->dev,
  17. 			  usb_sndbulkpipe(serial->dev, endpoint) | dir,
  18. 			  buf, len, callback, ctx);
  19.  
  20. 	if (intfdata->use_zlp && dir == USB_DIR_OUT)
  21. 		urb->transfer_flags |= URB_ZERO_PACKET;
  22.  
  23. 	if (dir == USB_DIR_OUT) {
  24. 		if ((desc->idVendor == cpu_to_le16(0x1286) &&
  25. 		     desc->idProduct == cpu_to_le16(0x4e3c)))
  26. 			urb->transfer_flags |= URB_ZERO_PACKET;
  27. 			
  28. +		if (desc->idVendor == cpu_to_le16(0x2c7c))
  29. +			urb->transfer_flags |= URB_ZERO_PACKET;			
  30. 	}
  31. 	return urb;
  32. }

添加qmi_wwan_q.c（放在最后）

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

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

然后就是添加cdc-wdmo节点

  1. RK3568\system\core\init\devices.cpp
  2. void DeviceHandler::HandleUevent(const Uevent& uevent) {
  3.     if (uevent.action == "add" || uevent.action == "change" || uevent.action == "online") {
  4.         FixupSysPermissions(uevent.path, uevent.subsystem);
  5.     }
  6.  
  7.     // if it's not a /dev device, nothing to do
  8.     if (uevent.major < 0 || uevent.minor < 0) return;
  9.  
  10.     std::string devpath;
  11.     std::vector<std::string> links;
  12.     bool block = false;
  13.  
  14.     if (uevent.subsystem == "block") {
  15.         block = true;
  16.         devpath = "/dev/block/" + Basename(uevent.path);
  17.  
  18.         if (StartsWith(uevent.path, "/devices")) {
  19.             links = GetBlockDeviceSymlinks(uevent);
  20.         }
  21.     } else if (const auto subsystem =
  22.                    std::find(subsystems_.cbegin(), subsystems_.cend(), uevent.subsystem);
  23.                subsystem != subsystems_.cend()) {
  24.         devpath = subsystem->ParseDevPath(uevent);
  25.     } else if (uevent.subsystem == "usb") {
  26.         if (!uevent.device_name.empty()) {
  27.             devpath = "/dev/" + uevent.device_name;
  28.         } else {
  29.             // This imitates the file system that would be created
  30.             // if we were using devfs instead.
  31.             // Minors are broken up into groups of 128, starting at "001"
  32.             int bus_id = uevent.minor / 128 + 1;
  33.             int device_id = uevent.minor % 128 + 1;
  34.             devpath = StringPrintf("/dev/bus/usb/%03d/%03d", bus_id, device_id);
  35.         }
  36. +				#if 1 //add by quectel for mknod /dev/cdc-wdmo
  37. +					} else if (uevent.subsystem == "usbmisc" && !uevent.device_name.empty()) {
  38. +							   devpath = "/dev/" + uevent.device_name;
  39. +				#endif		
  40.     } else if (StartsWith(uevent.subsystem, "usb")) {
  41.        // ignore other USB events
  42.         return;
  43.     } else {
  44.         devpath = "/dev/" + Basename(uevent.path);
  45.     }
  46.  
  47.     mkdir_recursive(Dirname(devpath), 0755);
  48.  
  49.     HandleDevice(uevent.action, devpath, block, uevent.major, uevent.minor, links);
  50.  
  51.     // Duplicate /dev/ashmem device and name it /dev/ashmem<boot_id>.
  52.     // TODO(b/111903542): remove once all users of /dev/ashmem are migrated to libcutils API.
  53.     HandleAshmemUevent(uevent);
  54. }

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

  1. console:/ $ su                                                                 
  2. console:/ # 
  3. console:/ # ls -l dev/ttyUSB*
  4. crw-rw-rw- 1 radio radio 188,   0 2022-01-27 12:33 dev/ttyUSB0
  5. crw-rw-rw- 1 radio radio 188,   1 2022-01-27 12:33 dev/ttyUSB1
  6. crw-rw-rw- 1 radio radio 188,   2 2022-01-27 14:02 dev/ttyUSB2
  7. crw-rw-rw- 1 radio radio 188,   3 2022-01-27 12:33 dev/ttyUSB3
  8. console:/ # 
  9. console:/ # ls -l dev/cdc-wdm0                                                 
  10. 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）

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

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

  1. rk3568\vendor\rockchip\common\phone\phone.mk
  2. #########################################################
  3. #   3G Dongle SUPPORT
  4. #########################################################
  5. -#PRODUCT_COPY_FILES += \
  6. -#    $(CUR_PATH)/phone/etc/ppp/ip-down:system/etc/ppp/ip-down \
  7. -#    $(CUR_PATH)/phone/etc/ppp/ip-up:system/etc/ppp/ip-up \
  8. -#    $(CUR_PATH)/phone/etc/ppp/call-pppd:system/etc/ppp/call-pppd \
  9. -#    $(CUR_PATH)/phone/etc/operator_table:system/etc/operator_table
  10.  
  11. +PRODUCT_COPY_FILES += \
  12. +    $(CUR_PATH)/phone/etc/ppp/ip-down:system/etc/ppp/ip-down \
  13. +    $(CUR_PATH)/phone/etc/ppp/ip-up:system/etc/ppp/ip-up \
  14. +    $(CUR_PATH)/phone/bin/chat:system/bin/chat \
  15. +    $(CUR_PATH)/phone/lib/libreference-ril-ec20.so:vendor/lib64/libreference-ril-ec20.so \
  16. +    $(CUR_PATH)/phone/etc/ppp/ql-ril.conf:system/etc/ql-ril.conf \ 
  17. +	$(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

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

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

4.打开BOARD_HAVE_DONGLE 和BOARD_HAS_RK_4G_MODEM 

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

  1. RK3568\device\rockchip\common\BoardConfig.mk
  2. #enable 3g dongle
  3. - BOARD_HAVE_DONGLE ?= false
  4. + BOARD_HAVE_DONGLE ?= true
  5. ifeq ($(BOARD_HAVE_DONGLE),true)
  6. PRODUCT_PACKAGES += \
  7.     android.hardware.radio@1.2-radio-service \
  8.     android.hardware.radio.config@1.0-service 
  9. PRODUCT_PACKAGES += \
  10.                   rild \
  11. 				  com.android.phone.common               
  12. endif
  13.  
  14. #for rk 4g modem
  15. -BOARD_HAS_RK_4G_MODEM ?= false
  16. +BOARD_HAS_RK_4G_MODEM ?= true
  17.  
  18. ifeq ($(strip $(BOARD_HAS_RK_4G_MODEM)),true)
  19. DEVICE_MANIFEST_FILE += device/rockchip/common/4g_modem/manifest.xml
  20. endif
  21.

BOARD_HAVE_DONGLE报错

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

BOARD_HAS_RK_4G_MODEM 报错（manifest.xml文件）

//报错android.hardware.radio.deprecated

  1. 解决方法：
  2. RK3568\device\rockchip\common\manifest.xml
  3.      <hal format="hidl">
  4.          <name>android.hardware.radio</name>
  5.          <transport>hwbinder</transport>
  6.          <fqname>@1.1::IRadio/slot1</fqname>
  7.          <fqname>@1.1::IRadio/slot2</fqname>
  8.          <fqname>@1.2::ISap/slot1</fqname>
  9.      </hal>
  10. -     <hal format="hidl">
  11. -         <name>android.hardware.radio.deprecated</name>
  12. -         <transport>hwbinder</transport>
  13. -         <version>1.0</version>
  14. -         <interface>
  15. -             <name>IOemHook</name>
  16. -             <instance>slot1</instance>
  17. -         </interface>
  18. -     </hal>
  19. -     <kernel target-level="5"/>
  20. - </manifest>	
  21.  
  22.  
  23.  
  24. RK3568\device\rockchip\common\4g_modem\manifest.xml
  25. <manifest version="1.0" type="device">
  26.     <hal format="hidl">
  27.         <name>android.hardware.radio</name>
  28.         <transport>hwbinder</transport>
  29.         <fqname>@1.1::IRadio/slot1</fqname>
  30.         <fqname>@1.1::IRadio/slot2</fqname>
  31.         <fqname>@1.2::ISap/slot1</fqname>
  32.     </hal>
  33.     <hal format="hidl">
  34.         <name>android.hardware.radio.deprecated</name>
  35.         <transport>hwbinder</transport>
  36.         <version>1.0</version>
  37.         <interface>
  38.             <name>IOemHook</name>
  39.             <instance>slot1</instance>
  40.         </interface>
  41.     </hal>
  42.     <hal format="hidl">
  43. -        <name>android.hardware.radio.config</name>
  44. +        <name>android.hardware.radio</name>
  45.         <transport>hwbinder</transport>
  46.         <version>1.0</version>
  47.         <interface>
  48. -            <name>IRadioConfig</name>
  49. +            <name>IRadio</name>
  50. -            <instance>default</instance>
  51. +            <instance>slot1</instance>
  52.         </interface>
  53.     </hal>
  54. </manifest>

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

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

  1. RK3568\device\rockchip\common\device.mk
  2. ifeq ($(strip $(BOARD_HAS_RK_4G_MODEM)),true)
  3. PRODUCT_PACKAGES += \
  4.     CarrierDefaultApp \
  5.     CarrierConfig \
  6.     rild \
  7. -    librk-ril \
  8. +    libreference-ril-ec20 \
  9.     dhcpcd
  10.  
  11. PRODUCT_COPY_FILES += vendor/rockchip/common/phone/etc/apns-full-conf.xml:$(TARGET_COPY_OUT_PRODUCT)/etc/apns-conf.xml
  12.  
  13. PRODUCT_PACKAGES += \
  14.     android.hardware.radio@1.2-radio-service \
  15.     android.hardware.radio.config@1.0-service
  16.  
  17. PRODUCT_PROPERTY_OVERRIDES += \
  18. 		ro.boot.noril=false \
  19. 		ro.telephony.default_network=9
  20.  
  21. ifeq ($(strip $(TARGET_ARCH)), arm64)
  22. PRODUCT_PROPERTY_OVERRIDES += \
  23. -        vendor.rild.libpath=/vendor/lib64/librk-ril.so
  24. +		 vendor.rild.libpath=/vendor/lib64/libreference-ril-ec20.so
  25.  
  26. PRODUCT_COPY_FILES += \
  27. 		$(LOCAL_PATH)/4g_modem/bin64/dhcpcd:$(TARGET_COPY_OUT_VENDOR)/bin/dhcpcd \
  28. 		$(LOCAL_PATH)/4g_modem/lib64/librk-ril.so:$(TARGET_COPY_OUT_VENDOR)/lib64/librk-ril.so
  29. else
  30. PRODUCT_PROPERTY_OVERRIDES += \
  31. -		vendor.rild.libpath=/vendor/lib/librk-ril.so
  32. +		vendor.rild.libpath=/vendor/lib/libreference-ril-ec20.so
  33.  
  34. PRODUCT_COPY_FILES += \
  35. 		$(LOCAL_PATH)/4g_modem/bin32/dhcpcd:$(TARGET_COPY_OUT_VENDOR)/bin/dhcpcd \
  36. 		$(LOCAL_PATH)/4g_modem/lib32/librk-ril.so:$(TARGET_COPY_OUT_VENDOR)/lib/librk-ril.so
  37.  
  38. endif
  39. endif

设置属性（rild.libpath） 

  1. RK3568\device\rockchip\rk356x\device.mk
  2. PRODUCT_PROPERTY_OVERRIDES += \
  3.                 ro.ril.ecclist=112,911 \
  4.                 ro.opengles.version=196610 \
  5.                 wifi.interface=wlan0 \
  6. +				ro.telephony.default_network=9 \
  7. +				rild.libpath=/vendor/lib64/libreference-ril-ec20.so \
  8. +				rild.libargs=-d /dev/ttyUSB2 \
  9.                 ro.audio.monitorOrientation=true \
  10.                 debug.nfc.fw_download=false \
  11.                 debug.nfc.se=false \
  12.                 vendor.hwc.compose_policy=1 \
  13.                 sys.wallpaper.rgb565=0 \
  14.                 sf.power.control=2073600 \
  15.                 sys.rkadb.root=0 \
  16.                 ro.sf.fakerotation=false \
  17.                 ro.tether.denied=false \
  18.                 sys.resolution.changed=false \
  19.                 ro.default.size=100 \
  20.                 ro.product.usbfactory=rockchip_usb \
  21.                 wifi.supplicant_scan_interval=15 \
  22.                 ro.factory.tool=0 \
  23.                 ro.kernel.android.checkjni=0 \
  24.                 ro.build.shutdown_timeout=6 \
  25.                 persist.enable_task_snapshots=false \
  26.                 ro.vendor.frameratelock=true
  27.  
  28. #

6.去掉property:ro.boot.noril

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

设置setprop ro.radio.noril 为true

暂停ril-daemon服务

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

7.添加权限

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

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

  1. RK3568\hardware\ril\rild\rild.c
  2. #if defined(PRODUCT_COMPATIBLE_PROPERTY)
  3. #define LIB_PATH_PROPERTY   "vendor.rild.libpath"
  4. #define LIB_ARGS_PROPERTY   "vendor.rild.libargs"
  5. #else
  6. #define LIB_PATH_PROPERTY   "rild.libpath"
  7. #define LIB_ARGS_PROPERTY   "rild.libargs"
  8. #endif
  9. #define MAX_LIB_ARGS        16

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

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

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

  1. RK3568\hardware\ril\rild\rild.rc
  2. -#service vendor.ril-daemon /vendor/bin/hw/rild
  3. -#    class main
  4. -#    user radio
  5. -#    group radio cache inet misc audio log readproc wakelock
  6. -#    capabilities BLOCK_SUSPEND NET_ADMIN NET_RAW
  7. +service ril-daemon /vendor/bin/hw/rild -l /vendor/lib64/libreference-ril-ec20.so
  8. +     class main
  9. +     user root
  10. +     group radio cache inet misc audio sdcard_rw log
  11. +     capabilities BLOCK_SUSPEND NET_ADMIN NET_RAW

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

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

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

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

 12.设置APN打开

  1. RK3568\device\rockchip\common\overlay\frameworks\base\core\res\res\values\config.xml
  2. -    <bool name="config_voice_capable">false</bool>
  3. +    <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)
  1. RK3568\system\core\init\init.cpp
  2. static bool HandleControlMessage(std::string_view message, const std::string& name,
  3.                                  pid_t from_pid) {
  4.     std::string cmdline_path = StringPrintf("proc/%d/cmdline", from_pid);
  5.     std::string process_cmdline;
  6.     
  7.  
  8.    ......
  9.     const auto& function = it->second;
  10.  
  11.     if (auto result = function(service); !result.ok()) {
  12.         LOG(ERROR) << "Control message: Could not ctl." << message << " for '" << name
  13.                    << "' from pid: " << from_pid << " (" << process_cmdline
  14.                    << "): " << result.error();
  15.         return false;
  16.     }
  17. +	if(strcmp(name.c_str(),"android.hardware.radio@1.1::IRadio/slot1") != 0) { 
  18.         LOG(INFO) << "Control message: Processed ctl." << message << " for '" << name
  19.               << "' from pid: " << from_pid << " (" << process_cmdline << ")";
  20. +		}
  21.     return true;
  22. }
  1. RK3568\system\hwservicemanager\ServiceManager.cpp
  2. static void tryStartService(const std::string& fqName, const std::string& name) {
  3.     using ::android::base::SetProperty;
  4.  
  5.     // The "happy path" here is starting up a service that is configured as a
  6.     // lazy HAL, but we aren't sure that is the case. If the service doesn't
  7.     // have an 'interface' entry in its .rc file OR if the service is already
  8.     // running, then this will be a no-op. So, for instance, if a service is
  9.     // deadlocked during startup, you will see this message repeatedly.
  10. +	if(strcmp(fqName.c_str(),"android.hardware.radio@1.1::IRadio") != 0) {
  11.         LOG(INFO) << "Since " << fqName << "/" << name
  12.               << " is not registered, trying to start it as a lazy HAL.";
  13. +	}
  14.     std::thread([=] {
  15.         (void)SetProperty("ctl.interface_start", fqName + "/" + name);
  16.     }).detach();
  17. }
  1. RK3568\system\libhidl\transport\ServiceManagement.cpp
  2.     void wait(bool timeout) {
  3.         using std::literals::chrono_literals::operator""s;
  4.  
  5.         if (!mRegisteredForNotifications) {
  6.             // As an alternative, just sleep for a second and return
  7.             LOG(WARNING) << "Waiting one second for " << mInterfaceName << "/" << mInstanceName;
  8.             sleep(1);
  9.             return;
  10.         }
  11.  
  12.         std::unique_lock<std::mutex> lock(mMutex);
  13.         do {
  14.             mCondition.wait_for(lock, 1s, [this]{
  15.                 return mRegistered;
  16.             });
  17.  
  18.             if (mRegistered) {
  19.                 break;
  20.             }
  21. +		if(strcmp(mInterfaceName.c_str(),"android.hardware.radio@1.1::IRadio") != 0) { 
  22.                     LOG(WARNING) << "Waited one second for " << mInterfaceName << "/" << mInstanceName;
  23. +		}
  24.         } while (!timeout);
  25.     }
  26.  
  27.  
  28. sp<::android::hidl::base::V1_0::IBase> getRawServiceInternal(const std::string& descriptor,
  29.                                                              const std::string& instance,
  30.                                                              bool retry, bool getStub) {
  31.     
  32.         // In case of legacy or we were not asked to retry, don't.
  33.         if (vintfLegacy || !retry) break;
  35.         if (waiter != nullptr) {
  36. +				if(strcmp(descriptor.c_str(),"android.hardware.radio@1.1::IRadio") != 0) { 
  37.             ALOGI("getService: Trying again for %s/%s...", descriptor.c_str(), instance.c_str());
  38. +				}
  39.             waiter->wait(true /* timeout */);
  40.         }
  41.     }
  44.     return nullptr;
  45. }

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

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

仅供参考，亲测有效。

  1.  
  2. RK3568\kernel\drivers\net\usb\qmi_wwan_q.c
  3. /*
  4.  * Copyright (c) 2012  Bjørn Mork <bjorn@mork.no>
  5.  *
  6.  * The probing code is heavily inspired by cdc_ether, which is:
  7.  * Copyright (C) 2003-2005 by David Brownell
  8.  * Copyright (C) 2006 by Ole Andre Vadla Ravnas (ActiveSync)
  9.  *
  10.  * This program is free software; you can redistribute it and/or
  11.  * modify it under the terms of the GNU General Public License
  12.  * version 2 as published by the Free Software Foundation.
  13.  */
  15. #include <linux/module.h>
  16. #include <linux/netdevice.h>
  17. #include <linux/ethtool.h>
  18. #include <linux/etherdevice.h>
  19. #include <linux/mii.h>
  20. #include <linux/usb.h>
  21. #include <linux/usb/cdc.h>
  22. #include <linux/usb/usbnet.h>
  23. #include <linux/usb/cdc-wdm.h>
  24.  
  25. /* This driver supports wwan (3G/LTE/?) devices using a vendor
  26.  * specific management protocol called Qualcomm MSM Interface (QMI) -
  27.  * in addition to the more common AT commands over serial interface
  28.  * management
  29.  *
  30.  * QMI is wrapped in CDC, using CDC encapsulated commands on the
  31.  * control ("master") interface of a two-interface CDC Union
  32.  * resembling standard CDC ECM.  The devices do not use the control
  33.  * interface for any other CDC messages.  Most likely because the
  34.  * management protocol is used in place of the standard CDC
  35.  * notifications NOTIFY_NETWORK_CONNECTION and NOTIFY_SPEED_CHANGE
  36.  *
  37.  * Alternatively, control and data functions can be combined in a
  38.  * single USB interface.
  39.  *
  40.  * Handling a protocol like QMI is out of the scope for any driver.
  41.  * It is exported as a character device using the cdc-wdm driver as
  42.  * a subdriver, enabling userspace applications ("modem managers") to
  43.  * handle it.
  44.  *
  45.  * These devices may alternatively/additionally be configured using AT
  46.  * commands on a serial interface
  47.  */
  49. /* driver specific data */
  50. struct qmi_wwan_state {
  51. 	struct usb_driver *subdriver;
  52. 	atomic_t pmcount;
  53. 	unsigned long unused;
  54. 	struct usb_interface *control;
  55. 	struct usb_interface *data;
  56. };
  57.  
  58. /* default ethernet address used by the modem */
  59. static const u8 default_modem_addr[ETH_ALEN] = {0x02, 0x50, 0xf3};
  60.  
  61. #if 1 //Added by Quectel
  62. #include <linux/etherdevice.h>
  63. #include <net/arp.h>
  64. #include <net/ip.h>
  65. #include <net/ipv6.h>
  66.  
  67. /*
  68.     Quectel_WCDMA&LTE_Linux_USB_Driver_User_Guide_V1.9.pdf
  69.     5.6.	Test QMAP on GobiNet or QMI WWAN
  70.     0 - no QMAP
  71.     1 - QMAP (Aggregation protocol)
  72.     X - QMAP (Multiplexing and Aggregation protocol)
  73. */
  74. #define QUECTEL_WWAN_QMAP 4
  75.  
  76. #if defined(QUECTEL_WWAN_QMAP)
  77. #define QUECTEL_QMAP_MUX_ID 0x81
  78.  
  79. static uint __read_mostly qmap_mode = 0;
  80. module_param( qmap_mode, uint, S_IRUGO);
  81. module_param_named( rx_qmap, qmap_mode, uint, S_IRUGO );
  82. #endif
  83.  
  84. #ifdef CONFIG_BRIDGE
  85. //#define QUECTEL_BRIDGE_MODE
  86. #endif
  87.  
  88. #ifdef QUECTEL_BRIDGE_MODE
  89. static uint __read_mostly bridge_mode = BIT(0)/*|BIT(1)*/;
  90. module_param( bridge_mode, uint, S_IRUGO );
  91. #endif
  92.  
  93. #if defined(QUECTEL_WWAN_QMAP)
  94. typedef struct sQmiWwanQmap
  95. {
  96. 	struct usbnet *mpNetDev;
  97. 	atomic_t refcount;
  98. 	struct net_device *mpQmapNetDev[QUECTEL_WWAN_QMAP];
  99. 	uint link_state;
  100. 	uint qmap_mode;
  101. #ifdef QUECTEL_BRIDGE_MODE
  102. 	uint bridge_mode;
  103. 	uint bridge_ipv4;
  104. 	unsigned char bridge_mac[ETH_ALEN];
  105. #endif
  106. } sQmiWwanQmap;
  107.  
  108. struct qmap_priv {
  109. 	struct net_device *real_dev;
  110. 	u8 offset_id;
  111. #ifdef QUECTEL_BRIDGE_MODE
  112. 	uint bridge_mode;
  113. 	uint bridge_ipv4;
  114. 	unsigned char bridge_mac[ETH_ALEN];
  115. #endif
  116. };
  117.  
  118. struct qmap_hdr {
  119.     u8 cd_rsvd_pad;
  120.     u8 mux_id;
  121.     u16 pkt_len;
  122. } __packed;
  123.  
  124. #ifdef QUECTEL_BRIDGE_MODE
  125. static int is_qmap_netdev(const struct net_device *netdev);
  126. #endif
  127. #endif
  128.  
  129. #ifdef QUECTEL_BRIDGE_MODE
  130. static int bridge_arp_reply(struct net_device *net, struct sk_buff *skb, uint bridge_ipv4) {
  131.     struct arphdr *parp;
  132.     u8 *arpptr, *sha;
  133.     u8  sip[4], tip[4], ipv4[4];
  134.     struct sk_buff *reply = NULL;
  135.  
  136.     ipv4[0]  = (bridge_ipv4 >> 24) & 0xFF;
  137.     ipv4[1]  = (bridge_ipv4 >> 16) & 0xFF;
  138.     ipv4[2]  = (bridge_ipv4 >> 8) & 0xFF;
  139.     ipv4[3]  = (bridge_ipv4 >> 0) & 0xFF;
  140.         
  141.     parp = arp_hdr(skb);
  142.  
  143.     if (parp->ar_hrd == htons(ARPHRD_ETHER)  && parp->ar_pro == htons(ETH_P_IP)
  144.         && parp->ar_op == htons(ARPOP_REQUEST) && parp->ar_hln == 6 && parp->ar_pln == 4) {
  145.         arpptr = (u8 *)parp + sizeof(struct arphdr);
  146.         sha = arpptr;
  147.         arpptr += net->addr_len;	/* sha */
  148.         memcpy(sip, arpptr, sizeof(sip));
  149.         arpptr += sizeof(sip);
  150.         arpptr += net->addr_len;	/* tha */
  151.         memcpy(tip, arpptr, sizeof(tip));
  152.  
  153.         pr_info("%s sip = %d.%d.%d.%d, tip=%d.%d.%d.%d, ipv4=%d.%d.%d.%d\n", netdev_name(net),
  154.             sip[0], sip[1], sip[2], sip[3], tip[0], tip[1], tip[2], tip[3], ipv4[0], ipv4[1], ipv4[2], ipv4[3]);
  155. 	//wwan0 sip = 10.151.137.255, tip=10.151.138.0, ipv4=10.151.137.255
  156.         if (tip[0] == ipv4[0] && tip[1] == ipv4[1] && (tip[2]&0xFC) == (ipv4[2]&0xFC) && tip[3] != ipv4[3])
  157.             reply = arp_create(ARPOP_REPLY, ETH_P_ARP, *((__be32 *)sip), net, *((__be32 *)tip), sha, default_modem_addr, sha);
  158.  
  159.         if (reply) {
  160.             skb_reset_mac_header(reply);
  161.             __skb_pull(reply, skb_network_offset(reply));
  162.             reply->ip_summed = CHECKSUM_UNNECESSARY;
  163.             reply->pkt_type = PACKET_HOST;
  164.  
  165.             netif_rx_ni(reply);
  166.         }
  167.         return 1;
  168.     }
  169.  
  170.     return 0;
  171. }
  172.  
  173. static struct sk_buff *bridge_mode_tx_fixup(struct net_device *net, struct sk_buff *skb, uint bridge_ipv4, unsigned char *bridge_mac) {
  174. 	struct ethhdr *ehdr;
  175. 	const struct iphdr *iph;
  176. 	
  177. 	skb_reset_mac_header(skb);
  178. 	ehdr = eth_hdr(skb);	
  179.  
  180. 	if (ehdr->h_proto == htons(ETH_P_ARP)) {
  181. 		if (bridge_ipv4)
  182. 			bridge_arp_reply(net, skb, bridge_ipv4);
  183. 		return NULL;
  184. 	}
  185.  
  186. 	iph = ip_hdr(skb);
  187. 	//DBG("iphdr: ");
  188. 	//PrintHex((void *)iph, sizeof(struct iphdr));
  189.  
  190. // 1	0.000000000	0.0.0.0	255.255.255.255	DHCP	362	DHCP Request  - Transaction ID 0xe7643ad7        
  191. 	if (ehdr->h_proto == htons(ETH_P_IP) && iph->protocol == IPPROTO_UDP && iph->saddr == 0x00000000 && iph->daddr == 0xFFFFFFFF) {
  192. 		//if (udp_hdr(skb)->dest == htons(67)) //DHCP Request
  193. 		{
  194. 			memcpy(bridge_mac, ehdr->h_source, ETH_ALEN);
  195. 			pr_info("%s PC Mac Address: %02x:%02x:%02x:%02x:%02x:%02x\n", netdev_name(net),
  196. 				bridge_mac[0], bridge_mac[1], bridge_mac[2], bridge_mac[3], bridge_mac[4], bridge_mac[5]);
  197. 		}
  198. 	}
  199.         
  200. 	if (memcmp(ehdr->h_source, bridge_mac, ETH_ALEN)) {
  201. 		return NULL;
  202. 	}
  203.  
  204. 	return skb;
  205. }
  206. #endif
  207.  
  208. #if defined(QUECTEL_WWAN_QMAP)
  209. static ssize_t qmap_mode_show(struct device *dev, struct device_attribute *attr, char *buf) {
  210. 	struct net_device *netdev = to_net_dev(dev);
  211. 	struct usbnet * usbnetdev = netdev_priv( netdev );
  212. 	struct qmi_wwan_state *info = (void *)&usbnetdev->data;
  213. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  214.  
  215. 	return snprintf(buf, PAGE_SIZE, "%d\n",  pQmapDev->qmap_mode);
  216. }
  217.  
  218. static DEVICE_ATTR(qmap_mode, S_IRUGO, qmap_mode_show, NULL);
  219.  
  220. static ssize_t link_state_show(struct device *dev, struct device_attribute *attr, char *buf) {
  221. 	struct net_device *netdev = to_net_dev(dev);
  222. 	struct usbnet * usbnetdev = netdev_priv( netdev );
  223. 	struct qmi_wwan_state *info = (void *)&usbnetdev->data;
  224. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  225.  
  226. 	return snprintf(buf, PAGE_SIZE, "0x%x\n",  pQmapDev->link_state);
  227. }
  228.  
  229. static ssize_t link_state_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) {
  230. 	struct net_device *netdev = to_net_dev(dev);
  231. 	struct usbnet * usbnetdev = netdev_priv( netdev );
  232. 	struct qmi_wwan_state *info = (void *)&usbnetdev->data;
  233. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  234. 	unsigned link_state = 0;
  235. 	unsigned old_link = pQmapDev->link_state;
  236.  
  237. 	link_state = simple_strtoul(buf, NULL, 0);
  238. 	if (pQmapDev->qmap_mode == 1)
  239. 		pQmapDev->link_state = !!link_state;
  240. 	else if (pQmapDev->qmap_mode > 1) {
  241. 		if (0 < link_state && link_state <= pQmapDev->qmap_mode)
  242. 			pQmapDev->link_state |= (1 << (link_state - 1));
  243. 		else if (0x80 < link_state && link_state <= (0x80 + pQmapDev->qmap_mode))
  244. 			pQmapDev->link_state &= ~(1 << ((link_state&0xF) - 1));
  245. 	}
  246.  
  247. 	if (old_link != pQmapDev->link_state)
  248. 		dev_info(dev, "link_state 0x%x -> 0x%x\n", old_link, pQmapDev->link_state);
  249.  
  250. 	return count;
  251. }
  252.  
  253. #ifdef QUECTEL_BRIDGE_MODE
  254. static ssize_t bridge_mode_show(struct device *dev, struct device_attribute *attr, char *buf) {
  255. 	struct net_device *netdev = to_net_dev(dev);
  256. 	uint bridge_mode = 0;
  257.  
  258. 	if (is_qmap_netdev(netdev)) {
  259. 		struct qmap_priv *priv = netdev_priv(netdev);
  260. 		bridge_mode = priv->bridge_mode;	
  261. 	}
  262. 	else {
  263. 		struct usbnet * usbnetdev = netdev_priv( netdev );
  264. 		struct qmi_wwan_state *info = (void *)&usbnetdev->data;
  265. 		sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  266. 		bridge_mode = pQmapDev->bridge_mode;
  267. 	}
  268.  
  269. 	return snprintf(buf, PAGE_SIZE, "%u\n", bridge_mode);
  270. }
  271.  
  272. static ssize_t bridge_ipv4_show(struct device *dev, struct device_attribute *attr, char *buf) {
  273. 	struct net_device *netdev = to_net_dev(dev);
  274. 	unsigned int bridge_ipv4 = 0;
  275. 	unsigned char ipv4[4];
  276.  
  277. 	if (is_qmap_netdev(netdev)) {
  278. 		struct qmap_priv *priv = netdev_priv(netdev);
  279. 		bridge_ipv4 = priv->bridge_ipv4;	
  280. 	}
  281. 	else {
  282. 		struct usbnet * usbnetdev = netdev_priv( netdev );
  283. 		struct qmi_wwan_state *info = (void *)&usbnetdev->data;
  284. 		sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  285. 		bridge_ipv4 = pQmapDev->bridge_ipv4;	
  286. 	}
  287.  
  288. 	ipv4[0]  = (bridge_ipv4 >> 24) & 0xFF;
  289. 	ipv4[1]  = (bridge_ipv4 >> 16) & 0xFF;
  290. 	ipv4[2]  = (bridge_ipv4 >> 8) & 0xFF;
  291. 	ipv4[3]  = (bridge_ipv4 >> 0) & 0xFF;
  292.     
  293. 	return snprintf(buf, PAGE_SIZE, "%d.%d.%d.%d\n",  ipv4[0], ipv4[1], ipv4[2], ipv4[3]);
  294. }
  295.  
  296. static ssize_t bridge_ipv4_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) {
  297. 	struct net_device *netdev = to_net_dev(dev);
  298.  
  299. 	if (is_qmap_netdev(netdev)) {
  300. 		struct qmap_priv *priv = netdev_priv(netdev);
  301. 		priv->bridge_ipv4 = simple_strtoul(buf, NULL, 16);
  302. 	}
  303. 	else {
  304. 		struct usbnet * usbnetdev = netdev_priv( netdev );
  305. 		struct qmi_wwan_state *info = (void *)&usbnetdev->data;
  306. 		sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  307. 		pQmapDev->bridge_ipv4 = simple_strtoul(buf, NULL, 16);
  308. 	}
  309.  
  310. 	return count;
  311. }
  312. #endif
  313.  
  314. static DEVICE_ATTR(link_state, S_IWUSR | S_IRUGO, link_state_show, link_state_store);
  315. #ifdef QUECTEL_BRIDGE_MODE
  316. static DEVICE_ATTR(bridge_mode,  S_IRUGO, bridge_mode_show, NULL);
  317. static DEVICE_ATTR(bridge_ipv4, S_IWUSR | S_IRUGO, bridge_ipv4_show, bridge_ipv4_store);
  318. #endif
  319.  
  320. static struct attribute *qmi_wwan_sysfs_attrs[] = {
  321. 	&dev_attr_link_state.attr,
  322. 	&dev_attr_qmap_mode.attr,
  323. #ifdef QUECTEL_BRIDGE_MODE
  324. 	&dev_attr_bridge_mode.attr,
  325. 	&dev_attr_bridge_ipv4.attr,
  326. #endif
  327. 	NULL,
  328. };
  329.  
  330. static struct attribute_group qmi_wwan_sysfs_attr_group = {
  331. 	.attrs = qmi_wwan_sysfs_attrs,
  332. };
  333.  
  334. #ifdef QUECTEL_BRIDGE_MODE
  335. static struct attribute *qmi_qmap_sysfs_attrs[] = {
  336. 	&dev_attr_bridge_mode.attr,
  337. 	&dev_attr_bridge_ipv4.attr,
  338. 	NULL,
  339. };
  340.  
  341. static struct attribute_group qmi_qmap_sysfs_attr_group = {
  342. 	.attrs = qmi_qmap_sysfs_attrs,
  343. };
  344. #endif
  345.  
  346. static int qmap_open(struct net_device *dev)
  347. {
  348. 	struct qmap_priv *priv = netdev_priv(dev);
  349. 	struct net_device *real_dev = priv->real_dev;
  350.  
  351. 	if (!(priv->real_dev->flags & IFF_UP))
  352. 		return -ENETDOWN;
  353.  
  354. 	if (netif_carrier_ok(real_dev))
  355. 		netif_carrier_on(dev);
  356. 	return 0;
  357. }
  358.  
  359. static int qmap_stop(struct net_device *pNet)
  360. {
  361. 	netif_carrier_off(pNet);
  362. 	return 0;
  363. }
  364.  
  365. static int qmap_start_xmit(struct sk_buff *skb, struct net_device *pNet)
  366. {
  367. 	int err;
  368. 	struct qmap_priv *priv = netdev_priv(pNet);
  369. 	unsigned int len;
  370. 	struct qmap_hdr *hdr;
  371.  
  372. 	skb_reset_mac_header(skb);
  373.  
  374. #ifdef QUECTEL_BRIDGE_MODE
  375. 	if (priv->bridge_mode && bridge_mode_tx_fixup(pNet, skb, priv->bridge_ipv4, priv->bridge_mac) == NULL) {
  376. 	      dev_kfree_skb_any (skb);
  377. 	      return NETDEV_TX_OK;
  378. 	}
  379. #endif
  380.  
  381. 	if (skb_pull(skb, ETH_HLEN) == NULL) {
  382. 	      dev_kfree_skb_any (skb);
  383. 	      return NETDEV_TX_OK;
  384.    	}
  385.    
  386. 	len = skb->len;
  387. 	hdr = (struct qmap_hdr *)skb_push(skb, sizeof(struct qmap_hdr));
  388. 	hdr->cd_rsvd_pad = 0;
  389. 	hdr->mux_id = QUECTEL_QMAP_MUX_ID + priv->offset_id;
  390. 	hdr->pkt_len = cpu_to_be16(len);
  391.  
  392. 	skb->dev = priv->real_dev;
  393. 	err = dev_queue_xmit(skb);
  394. 	if (err == NET_XMIT_SUCCESS) {
  395. 		pNet->stats.tx_packets++;
  396. 		pNet->stats.tx_bytes += skb->len;
  397. 	} else {
  398. 		pNet->stats.tx_errors++;
  399. 	}
  400.  
  401. 	return err;
  402. }
  403.  
  404. static const struct net_device_ops qmap_netdev_ops = {
  405. 	.ndo_open       = qmap_open,
  406. 	.ndo_stop       = qmap_stop,
  407. 	.ndo_start_xmit = qmap_start_xmit,
  408. };
  409.  
  410. static int qmap_register_device(sQmiWwanQmap * pDev, u8 offset_id)
  411. {
  412.     struct net_device *real_dev = pDev->mpNetDev->net;
  413.     struct net_device *qmap_net;
  414.     struct qmap_priv *priv;
  415.     int err;
  416.  
  417.     qmap_net = alloc_etherdev(sizeof(*priv));
  418.     if (!qmap_net)
  419.         return -ENOBUFS;
  420.  
  421.     SET_NETDEV_DEV(qmap_net, &real_dev->dev);
  422.     priv = netdev_priv(qmap_net);
  423.     priv->offset_id = offset_id;
  424.     priv->real_dev = real_dev;
  425.     sprintf(qmap_net->name, "%s.%d", real_dev->name, offset_id + 1);
  426.     qmap_net->netdev_ops = &qmap_netdev_ops;
  427.     memcpy (qmap_net->dev_addr, real_dev->dev_addr, ETH_ALEN);
  428.  
  429. #ifdef QUECTEL_BRIDGE_MODE
  430. 	priv->bridge_mode = !!(pDev->bridge_mode & BIT(offset_id));
  431. 	qmap_net->sysfs_groups[0] = &qmi_qmap_sysfs_attr_group;
  432. #endif
  433.  
  434.     err = register_netdev(qmap_net);
  435.     if (err < 0)
  436.         goto out_free_newdev;
  437.     netif_device_attach (qmap_net);
  438.  
  439.     pDev->mpQmapNetDev[offset_id] = qmap_net;
  440.     qmap_net->flags |= IFF_NOARP;
  441.  
  442.     dev_info(&real_dev->dev, "%s %s\n", __func__, qmap_net->name);
  443.  
  444.     return 0;
  445.  
  446. out_free_newdev:
  447.     free_netdev(qmap_net);
  448.     return err;
  449. }
  450.  
  451. static void qmap_unregister_device(sQmiWwanQmap * pDev, u8 offset_id) {
  452.     struct net_device *net = pDev->mpQmapNetDev[offset_id];
  453.     if (net != NULL) {
  454.         netif_carrier_off( net );
  455.         unregister_netdev (net);
  456.         free_netdev(net);
  457.     }
  458. }
  459.  
  460. #ifdef CONFIG_ANDROID
  461. static int qmap_ndo_do_ioctl(struct net_device *dev,struct ifreq *ifr, int cmd) {
  462. 	int rc = -EOPNOTSUPP;
  463. 	uint link_state = 0;
  464.  
  465. 	switch (cmd) {
  466. 	case 0x89F1: //SIOCDEVPRIVATE
  467. 		rc = copy_from_user(&link_state, ifr->ifr_ifru.ifru_data, sizeof(link_state));
  468. 		if (!rc) {
  469. 			char buf[32];
  470. 			snprintf(buf, sizeof(buf), "%u", link_state);
  471. 			link_state_store(&dev->dev, NULL, buf, strlen(buf));
  472. 		}
  473. 	break;
  474.  
  475. 	default:
  476. 	break;
  477. 	}
  478.  
  479. 	return rc;
  480. }
  481. #endif
  482.  
  483. #ifdef QUECTEL_BRIDGE_MODE
  484. static int is_qmap_netdev(const struct net_device *netdev) {
  485. 	return netdev->netdev_ops == &qmap_netdev_ops;
  486. }
  487. #endif
  488. #endif
  489.  
  490. static struct sk_buff *qmi_wwan_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags) {
  491. 	//MDM9x07,MDM9628,MDM9x40,SDX20,SDX24 only work on RAW IP mode
  492. 	if ((dev->driver_info->flags & FLAG_NOARP) == 0)
  493. 		return skb;
  494.  
  495. 	// Skip Ethernet header from message
  496. 	if (dev->net->hard_header_len == 0)
  497. 		return skb;
  498. 	else
  499. 		skb_reset_mac_header(skb);
  500.  
  501. #ifdef QUECTEL_BRIDGE_MODE
  502. {
  503. 	struct qmi_wwan_state *info = (void *)&dev->data;
  504. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  505.  
  506. 	if (pQmapDev->bridge_mode && bridge_mode_tx_fixup(dev->net, skb, pQmapDev->bridge_ipv4, pQmapDev->bridge_mac) == NULL) {
  507. 	      dev_kfree_skb_any (skb);
  508. 	      return NULL;
  509. 	}
  510. }
  511. #endif
  512.  
  513. 	if (skb_pull(skb, ETH_HLEN)) {
  514. 		return skb;
  515. 	} else {
  516. 		dev_err(&dev->intf->dev,  "Packet Dropped ");
  517. 	}
  518.  
  519. 	// Filter the packet out, release it
  520. 	dev_kfree_skb_any(skb);
  521. 	return NULL;
  522. }
  523. #endif
  524.  
  525. /* Make up an ethernet header if the packet doesn't have one.
  526.  *
  527.  * A firmware bug common among several devices cause them to send raw
  528.  * IP packets under some circumstances.  There is no way for the
  529.  * driver/host to know when this will happen.  And even when the bug
  530.  * hits, some packets will still arrive with an intact header.
  531.  *
  532.  * The supported devices are only capably of sending IPv4, IPv6 and
  533.  * ARP packets on a point-to-point link. Any packet with an ethernet
  534.  * header will have either our address or a broadcast/multicast
  535.  * address as destination.  ARP packets will always have a header.
  536.  *
  537.  * This means that this function will reliably add the appropriate
  538.  * header iff necessary, provided our hardware address does not start
  539.  * with 4 or 6.
  540.  *
  541.  * Another common firmware bug results in all packets being addressed
  542.  * to 00:a0:c6:00:00:00 despite the host address being different.
  543.  * This function will also fixup such packets.
  544.  */
  545. static int qmi_wwan_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
  546. {
  547. 	__be16 proto;
  548. #ifdef QUECTEL_BRIDGE_MODE
  549. 	struct qmi_wwan_state *info = (void *)&dev->data;
  550. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  551. #endif
  552. 	
  553. 	/* This check is no longer done by usbnet */
  554. 	if (skb->len < dev->net->hard_header_len)
  555. 		return 0;
  557. 	switch (skb->data[0] & 0xf0) {
  558. 	case 0x40:
  559. 		proto = htons(ETH_P_IP);
  560. 		break;
  561. 	case 0x60:
  562. 		proto = htons(ETH_P_IPV6);
  563. 		break;
  564. 	case 0x00:
  565. 		if (is_multicast_ether_addr(skb->data))
  566. 			return 1;
  567. 		/* possibly bogus destination - rewrite just in case */
  568. 		skb_reset_mac_header(skb);
  569. 		goto fix_dest;
  570. 	default:
  571. 		/* pass along other packets without modifications */
  572. 		return 1;
  573. 	}
  574. 	if (skb_headroom(skb) < ETH_HLEN)
  575. 		return 0;
  576. 	skb_push(skb, ETH_HLEN);
  577. 	skb_reset_mac_header(skb);
  578. 	eth_hdr(skb)->h_proto = proto;
  579. 	memset(eth_hdr(skb)->h_source, 0, ETH_ALEN);
  580. #if 1 //Added by Quectel
  581. 	//some kernel will drop ethernet packet which's souce mac is all zero
  582. 	memcpy(eth_hdr(skb)->h_source, default_modem_addr, ETH_ALEN);
  583. #endif
  584. #ifdef QUECTEL_BRIDGE_MODE	
  585. 	if (pQmapDev->bridge_mode) {
  586. 		memcpy(eth_hdr(skb)->h_dest, pQmapDev->bridge_mac, ETH_ALEN);
  587. 	}
  588. #endif
  589.  
  590. fix_dest:
  591. 	memcpy(eth_hdr(skb)->h_dest, dev->net->dev_addr, ETH_ALEN);
  592. 	return 1;
  593. }
  594.  
  595. #if defined(QUECTEL_WWAN_QMAP)
  596. static struct sk_buff *qmap_qmi_wwan_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags) {
  597. 	struct qmi_wwan_state *info = (void *)&dev->data;
  598. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  599. 	struct qmap_hdr *qhdr;
  600.  
  601. 	if (unlikely(pQmapDev == NULL)) {
  602. 		goto drop_skb;
  603. 	} else if (unlikely(pQmapDev->qmap_mode && !pQmapDev->link_state)) {
  604. 		dev_dbg(&dev->net->dev, "link_state 0x%x, drop skb, len = %u\n", pQmapDev->link_state, skb->len);
  605. 		goto drop_skb;
  606. 	} else if (pQmapDev->qmap_mode == 0) {
  607. 		return qmi_wwan_tx_fixup(dev, skb, flags);
  608. 	}
  609. 	else if (pQmapDev->qmap_mode > 1) {
  610. 		qhdr = (struct qmap_hdr *)skb->data;
  611. 		if (qhdr->cd_rsvd_pad != 0) {
  612. 			goto drop_skb;
  613. 		}
  614. 		if ((qhdr->mux_id&0xF0) != 0x80) {
  615. 			goto drop_skb;
  616. 		}
  617. 		return skb;
  618. 	}
  619. 	else {
  620. 		if (qmi_wwan_tx_fixup(dev, skb, flags)) {
  621. 			qhdr = (struct qmap_hdr *)skb_push(skb, sizeof(struct qmap_hdr));
  622. 			qhdr->cd_rsvd_pad = 0;
  623. 			qhdr->mux_id = QUECTEL_QMAP_MUX_ID;
  624. 			qhdr->pkt_len = cpu_to_be16(skb->len - sizeof(struct qmap_hdr));
  625.  
  626.                     return skb;
  627. 		}
  628. 		else {
  629. 			return NULL;
  630. 		}
  631. 	}
  632.  
  633. drop_skb:
  634. 	dev_kfree_skb_any (skb);
  635. 	return NULL;
  636. }
  637.  
  638. static int qmap_qmi_wwan_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
  639. {
  640. 	struct qmi_wwan_state *info = (void *)&dev->data;
  641. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  642. 	static int debug_len = 0;
  643. 	int debug_pkts = 0;
  644. 	int update_len = skb->len;
  645.  
  646. 	if (pQmapDev->qmap_mode == 0)
  647. 		return qmi_wwan_rx_fixup(dev, skb);
  648.  
  649. 	while (skb->len > sizeof(struct qmap_hdr)) {
  650. 		struct qmap_hdr *qhdr = (struct qmap_hdr *)skb->data;
  651. 		struct net_device *qmap_net;
  652. 		struct sk_buff *qmap_skb;
  653. #ifdef QUECTEL_BRIDGE_MODE
  654. 		uint bridge_mode = 0;
  655. 		unsigned char *bridge_mac;
  656. #endif
  657. 		__be16 proto;
  658. 		int pkt_len;
  659. 		u8 offset_id = 0;
  660. 		int err;
  661. 		unsigned len = (be16_to_cpu(qhdr->pkt_len) + sizeof(struct qmap_hdr));
  662.  
  663. 		if (skb->len < (be16_to_cpu(qhdr->pkt_len) + sizeof(struct qmap_hdr))) {
  664. 			dev_info(&dev->net->dev, "drop qmap unknow pkt, len=%d, pkt_len=%d\n", skb->len, be16_to_cpu(qhdr->pkt_len));
  665. 			goto out;
  666. 		}
  667.  
  668. 		debug_pkts++;
  669.  
  670. 		if (qhdr->cd_rsvd_pad & 0x80) {
  671. 			dev_info(&dev->net->dev, "drop qmap command packet %x\n", qhdr->cd_rsvd_pad);
  672. 			goto skip_pkt;;
  673. 		}
  674.  
  675. 		offset_id = qhdr->mux_id - QUECTEL_QMAP_MUX_ID;
  676. 		if (offset_id >= pQmapDev->qmap_mode) {
  677. 			dev_info(&dev->net->dev, "drop qmap unknow mux_id %x\n", qhdr->mux_id);
  678. 			goto skip_pkt;
  679. 		}
  680.  
  681. 		qmap_net = pQmapDev->mpQmapNetDev[offset_id];
  682.  
  683. 		if (qmap_net == NULL) {
  684. 			dev_info(&dev->net->dev, "drop qmap unknow mux_id %x\n", qhdr->mux_id);
  685. 			goto skip_pkt;
  686. 		}
  687.  
  688. 		switch (skb->data[sizeof(struct qmap_hdr)] & 0xf0) {
  689. 			case 0x40:
  690. 				proto = htons(ETH_P_IP);
  691. 			break;
  692. 			case 0x60:
  693. 				proto = htons(ETH_P_IPV6);
  694. 			break;
  695. 			default:
  696. 				goto skip_pkt;
  697. 		}
  698.  
  699. 		pkt_len = be16_to_cpu(qhdr->pkt_len) - (qhdr->cd_rsvd_pad&0x3F);
  700. 		qmap_skb = netdev_alloc_skb(qmap_net, ETH_HLEN + pkt_len);
  701. 		if (qmap_skb == NULL) {
  702. 			dev_info(&dev->net->dev, "fail to alloc skb, pkt_len = %d\n", pkt_len);
  703. 			return 0;
  704. 		}
  705.  
  706. 		skb_reset_mac_header(qmap_skb);
  707. 		memcpy(eth_hdr(qmap_skb)->h_source, default_modem_addr, ETH_ALEN);
  708. 		memcpy(eth_hdr(qmap_skb)->h_dest, qmap_net->dev_addr, ETH_ALEN);
  709. 		eth_hdr(qmap_skb)->h_proto = proto;        
  710. 		memcpy(skb_put(qmap_skb, ETH_HLEN + pkt_len) + ETH_HLEN, skb->data + sizeof(struct qmap_hdr), pkt_len);
  711. #ifdef QUECTEL_BRIDGE_MODE
  712. 		if (pQmapDev->qmap_mode > 1) {
  713. 			struct qmap_priv *priv = netdev_priv(qmap_net);
  714. 			bridge_mode = priv->bridge_mode;
  715. 			bridge_mac = priv->bridge_mac;
  716. 		}
  717. 		else {
  718. 			bridge_mode = pQmapDev->bridge_mode;
  719. 			bridge_mac = pQmapDev->bridge_mac;
  720. 		}
  721.         	if (bridge_mode) {
  722.         		memcpy(eth_hdr(qmap_skb)->h_dest, bridge_mac, ETH_ALEN);
  723.         	}
  724. #endif
  725.  
  726. 		if (pQmapDev->qmap_mode > 1) {
  727. 			qmap_skb->protocol = eth_type_trans (qmap_skb, qmap_net);
  728. 			memset(qmap_skb->cb, 0, sizeof(struct skb_data));
  729. 			err = netif_rx(qmap_skb);
  730. 			if (err == NET_RX_SUCCESS) {
  731. 				qmap_net->stats.rx_packets++;
  732. 				qmap_net->stats.rx_bytes += qmap_skb->len;
  733. 			} else {
  734. 				qmap_net->stats.rx_errors++;
  735. 			}
  736. 		}
  737. 		else {
  738. 			usbnet_skb_return(dev, qmap_skb);
  739. 		}
  740.  
  741. 		skip_pkt:
  742. 		skb_pull(skb, len);
  743. 	}
  744.  
  745. out:
  746. 	if (update_len > debug_len) {
  747. 		debug_len = update_len;
  748. 		dev_info(&dev->net->dev, "rx_pkts=%d, rx_len=%d\n", debug_pkts, debug_len);
  749. 	}
  750. 	
  751.     return 0;
  752. }
  753. #endif
  754.  
  755. /* very simplistic detection of IPv4 or IPv6 headers */
  756. static bool possibly_iphdr(const char *data)
  757. {
  758. 	return (data[0] & 0xd0) == 0x40;
  759. }
  760.  
  761. /* disallow addresses which may be confused with IP headers */
  762. static int qmi_wwan_mac_addr(struct net_device *dev, void *p)
  763. {
  764. 	int ret;
  765. 	struct sockaddr *addr = p;
  766.  
  767. 	ret = eth_prepare_mac_addr_change(dev, p);
  768. 	if (ret < 0)
  769. 		return ret;
  770. 	if (possibly_iphdr(addr->sa_data))
  771. 		return -EADDRNOTAVAIL;
  772. 	eth_commit_mac_addr_change(dev, p);
  773. 	return 0;
  774. }
  775.  
  776. static const struct net_device_ops qmi_wwan_netdev_ops = {
  777. 	.ndo_open		= usbnet_open,
  778. 	.ndo_stop		= usbnet_stop,
  779. 	.ndo_start_xmit		= usbnet_start_xmit,
  780. 	.ndo_tx_timeout		= usbnet_tx_timeout,
  781. 	.ndo_change_mtu		= usbnet_change_mtu,
  782. 	.ndo_set_mac_address	= qmi_wwan_mac_addr,
  783. 	.ndo_validate_addr	= eth_validate_addr,
  784. #if defined(QUECTEL_WWAN_QMAP) && defined(CONFIG_ANDROID)
  785. 	.ndo_do_ioctl = qmap_ndo_do_ioctl,
  786. #endif
  787. };
  788.  
  789. /* using a counter to merge subdriver requests with our own into a
  790.  * combined state
  791.  */
  792. static int qmi_wwan_manage_power(struct usbnet *dev, int on)
  793. {
  794. 	struct qmi_wwan_state *info = (void *)&dev->data;
  795. 	int rv;
  796.  
  797. 	dev_dbg(&dev->intf->dev, "%s() pmcount=%d, on=%d\n", __func__,
  798. 		atomic_read(&info->pmcount), on);
  799.  
  800. 	if ((on && atomic_add_return(1, &info->pmcount) == 1) ||
  801. 	    (!on && atomic_dec_and_test(&info->pmcount))) {
  802. 		/* need autopm_get/put here to ensure the usbcore sees
  803. 		 * the new value
  804. 		 */
  805. 		rv = usb_autopm_get_interface(dev->intf);
  806. 		dev->intf->needs_remote_wakeup = on;
  807. 		if (!rv)
  808. 			usb_autopm_put_interface(dev->intf);
  809. 	}
  810. 	return 0;
  811. }
  812.  
  813. static int qmi_wwan_cdc_wdm_manage_power(struct usb_interface *intf, int on)
  814. {
  815. 	struct usbnet *dev = usb_get_intfdata(intf);
  816.  
  817. 	/* can be called while disconnecting */
  818. 	if (!dev)
  819. 		return 0;
  820. 	return qmi_wwan_manage_power(dev, on);
  821. }
  822.  
  823. /* collect all three endpoints and register subdriver */
  824. static int qmi_wwan_register_subdriver(struct usbnet *dev)
  825. {
  826. 	int rv;
  827. 	struct usb_driver *subdriver = NULL;
  828. 	struct qmi_wwan_state *info = (void *)&dev->data;
  829.  
  830. 	/* collect bulk endpoints */
  831. 	rv = usbnet_get_endpoints(dev, info->data);
  832. 	if (rv < 0)
  833. 		goto err;
  834.  
  835. 	/* update status endpoint if separate control interface */
  836. 	if (info->control != info->data)
  837. 		dev->status = &info->control->cur_altsetting->endpoint[0];
  838.  
  839. 	/* require interrupt endpoint for subdriver */
  840. 	if (!dev->status) {
  841. 		rv = -EINVAL;
  842. 		goto err;
  843. 	}
  844.  
  845. 	/* for subdriver power management */
  846. 	atomic_set(&info->pmcount, 0);
  847.  
  848. 	/* register subdriver */
  849. 	subdriver = usb_cdc_wdm_register(info->control, &dev->status->desc,
  850. 					 4096, &qmi_wwan_cdc_wdm_manage_power);
  851. 	if (IS_ERR(subdriver)) {
  852. 		dev_err(&info->control->dev, "subdriver registration failed\n");
  853. 		rv = PTR_ERR(subdriver);
  854. 		goto err;
  855. 	}
  856.  
  857. 	/* prevent usbnet from using status endpoint */
  858. 	dev->status = NULL;
  859.  
  860. 	/* save subdriver struct for suspend/resume wrappers */
  861. 	info->subdriver = subdriver;
  862.  
  863. err:
  864. 	return rv;
  865. }
  866.  
  867. static int qmi_wwan_bind(struct usbnet *dev, struct usb_interface *intf)
  868. {
  869. 	int status = -1;
  870. 	u8 *buf = intf->cur_altsetting->extra;
  871. 	int len = intf->cur_altsetting->extralen;
  872. 	struct usb_interface_descriptor *desc = &intf->cur_altsetting->desc;
  873. 	struct usb_cdc_union_desc *cdc_union = NULL;
  874. 	struct usb_cdc_ether_desc *cdc_ether = NULL;
  875. 	u32 found = 0;
  876. 	struct usb_driver *driver = driver_of(intf);
  877. 	struct qmi_wwan_state *info = (void *)&dev->data;
  878.  
  879. 	BUILD_BUG_ON((sizeof(((struct usbnet *)0)->data) <
  880. 		      sizeof(struct qmi_wwan_state)));
  881.  
  882. 	/* set up initial state */
  883. 	info->control = intf;
  884. 	info->data = intf;
  885.  
  886. 	/* and a number of CDC descriptors */
  887. 	while (len > 3) {
  888. 		struct usb_descriptor_header *h = (void *)buf;
  889.  
  890. 		/* ignore any misplaced descriptors */
  891. 		if (h->bDescriptorType != USB_DT_CS_INTERFACE)
  892. 			goto next_desc;
  893.  
  894. 		/* buf[2] is CDC descriptor subtype */
  895. 		switch (buf[2]) {
  896. 		case USB_CDC_HEADER_TYPE:
  897. 			if (found & 1 << USB_CDC_HEADER_TYPE) {
  898. 				dev_dbg(&intf->dev, "extra CDC header\n");
  899. 				goto err;
  900. 			}
  901. 			if (h->bLength != sizeof(struct usb_cdc_header_desc)) {
  902. 				dev_dbg(&intf->dev, "CDC header len %u\n",
  903. 					h->bLength);
  904. 				goto err;
  905. 			}
  906. 			break;
  907. 		case USB_CDC_UNION_TYPE:
  908. 			if (found & 1 << USB_CDC_UNION_TYPE) {
  909. 				dev_dbg(&intf->dev, "extra CDC union\n");
  910. 				goto err;
  911. 			}
  912. 			if (h->bLength != sizeof(struct usb_cdc_union_desc)) {
  913. 				dev_dbg(&intf->dev, "CDC union len %u\n",
  914. 					h->bLength);
  915. 				goto err;
  916. 			}
  917. 			cdc_union = (struct usb_cdc_union_desc *)buf;
  918. 			break;
  919. 		case USB_CDC_ETHERNET_TYPE:
  920. 			if (found & 1 << USB_CDC_ETHERNET_TYPE) {
  921. 				dev_dbg(&intf->dev, "extra CDC ether\n");
  922. 				goto err;
  923. 			}
  924. 			if (h->bLength != sizeof(struct usb_cdc_ether_desc)) {
  925. 				dev_dbg(&intf->dev, "CDC ether len %u\n",
  926. 					h->bLength);
  927. 				goto err;
  928. 			}
  929. 			cdc_ether = (struct usb_cdc_ether_desc *)buf;
  930. 			break;
  931. 		}
  932.  
  933. 		/* Remember which CDC functional descriptors we've seen.  Works
  934. 		 * for all types we care about, of which USB_CDC_ETHERNET_TYPE
  935. 		 * (0x0f) is the highest numbered
  936. 		 */
  937. 		if (buf[2] < 32)
  938. 			found |= 1 << buf[2];
  940. next_desc:
  941. 		len -= h->bLength;
  942. 		buf += h->bLength;
  943. 	}
  945. 	/* Use separate control and data interfaces if we found a CDC Union */
  946. 	if (cdc_union) {
  947. 		info->data = usb_ifnum_to_if(dev->udev,
  948. 					     cdc_union->bSlaveInterface0);
  949. 		if (desc->bInterfaceNumber != cdc_union->bMasterInterface0 ||
  950. 		    !info->data) {
  951. 			dev_err(&intf->dev,
  952. 				"bogus CDC Union: master=%u, slave=%u\n",
  953. 				cdc_union->bMasterInterface0,
  954. 				cdc_union->bSlaveInterface0);
  955. 			goto err;
  956. 		}
  957. 	}
  959. 	/* errors aren't fatal - we can live with the dynamic address */
  960. 	if (cdc_ether) {
  961. 		dev->hard_mtu = le16_to_cpu(cdc_ether->wMaxSegmentSize);
  962. 		usbnet_get_ethernet_addr(dev, cdc_ether->iMACAddress);
  963. 	}
  964.  
  965. 	/* claim data interface and set it up */
  966. 	if (info->control != info->data) {
  967. 		status = usb_driver_claim_interface(driver, info->data, dev);
  968. 		if (status < 0)
  969. 			goto err;
  970. 	}
  971.  
  972. 	status = qmi_wwan_register_subdriver(dev);
  973. 	if (status < 0 && info->control != info->data) {
  974. 		usb_set_intfdata(info->data, NULL);
  975. 		usb_driver_release_interface(driver, info->data);
  976. 	}
  977.  
  978. 	/* Never use the same address on both ends of the link, even
  979. 	 * if the buggy firmware told us to.
  980. 	 */
  981. 	if (ether_addr_equal(dev->net->dev_addr, default_modem_addr))
  982. 		eth_hw_addr_random(dev->net);
  983.  
  984. 	/* make MAC addr easily distinguishable from an IP header */
  985. 	if (possibly_iphdr(dev->net->dev_addr)) {
  986. 		dev->net->dev_addr[0] |= 0x02;	/* set local assignment bit */
  987. 		dev->net->dev_addr[0] &= 0xbf;	/* clear "IP" bit */
  988. 	}
  989. 	dev->net->netdev_ops = &qmi_wwan_netdev_ops;
  990.  
  991. #if 1 //Added by Quectel
  992. 	if (dev->driver_info->flags & FLAG_NOARP) {		
  993. 		dev_info(&intf->dev, "Quectel EC25&EC21&EG91&EG95&EG06&EP06&EM06&EG12&EP12&EM12&EG16&EG18&BG96&AG35 work on RawIP mode\n");
  994. 		dev->net->flags |= IFF_NOARP;
  995. 		usb_control_msg(
  996. 			interface_to_usbdev(intf),
  997. 			usb_sndctrlpipe(interface_to_usbdev(intf), 0),
  998. 			0x22, //USB_CDC_REQ_SET_CONTROL_LINE_STATE
  999. 			0x21, //USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE
  1000. 			1, //active CDC DTR
  1001. 			intf->cur_altsetting->desc.bInterfaceNumber,
  1002. 			NULL, 0, 100);
  1003. 	}
  1004.  
  1005. 	//to advoid module report mtu 1460, but rx 1500 bytes IP packets, and cause the customer's system crash
  1006. 	//next setting can make usbnet.c:usbnet_change_mtu() do not modify rx_urb_size according to hard mtu
  1007. 	dev->rx_urb_size = ETH_DATA_LEN + ETH_HLEN + 6;
  1009. #if defined(QUECTEL_WWAN_QMAP)
  1010. 	if (qmap_mode > QUECTEL_WWAN_QMAP)
  1011. 		qmap_mode = QUECTEL_WWAN_QMAP;
  1013. 	if (!status)
  1014. 	{
  1015. 		sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)kzalloc(sizeof(sQmiWwanQmap), GFP_KERNEL);
  1017. 		if (pQmapDev == NULL)
  1018. 			return -ENODEV;
  1020. #ifdef QUECTEL_BRIDGE_MODE
  1021. 		pQmapDev->bridge_mode = bridge_mode;
  1022. #endif
  1023. 		pQmapDev->mpNetDev = dev;
  1024. 		pQmapDev->link_state = 1;
  1025. 		
  1026. 		if (dev->driver_info->flags & FLAG_NOARP)
  1027. 		{
  1028. 			int idProduct = le16_to_cpu(dev->udev->descriptor.idProduct);
  1029. 			int lte_a = (idProduct == 0x0306 || idProduct == 0x0512 || idProduct == 0x0620 || idProduct == 0x0800);
  1031. 			pQmapDev->qmap_mode = qmap_mode;
  1032. 			if (lte_a || dev->udev->speed == USB_SPEED_SUPER) {
  1033. 				if (pQmapDev->qmap_mode == 0) {
  1034. 					pQmapDev->qmap_mode = 1; //force use QMAP
  1035. 					if(qmap_mode == 0)
  1036. 						qmap_mode = 1; //old quectel-CM only check sys/module/wwan0/parameters/qmap_mode
  1037. 				}
  1038. 			}
  1040. 			if (pQmapDev->qmap_mode) {
  1041. 				if (idProduct == 0x0121 || idProduct == 0x0125 || idProduct == 0x0435) //MDM9x07
  1042. 					dev->rx_urb_size = 4*1024;
  1043. 				else if (lte_a || dev->udev->speed == USB_SPEED_SUPER)
  1044. 					dev->rx_urb_size = 32*1024;
  1045. 				else
  1046. 					dev->rx_urb_size = 32*1024;
  1048. 				//for these modules, if send pakcet before qmi_start_network, or cause host PC crash, or cause modules crash
  1049. 				if (lte_a || dev->udev->speed == USB_SPEED_SUPER)
  1050. 					pQmapDev->link_state = 0;
  1051. 			}
  1052. 		}
  1054. 		info->unused = (unsigned long)pQmapDev;		
  1055. 		dev->net->sysfs_groups[0] = &qmi_wwan_sysfs_attr_group;
  1057. 		dev_info(&intf->dev, "rx_urb_size = %zd\n", dev->rx_urb_size);
  1058. 	}
  1059. #endif
  1060. #endif
  1062. err:
  1063. 	return status;
  1064. }
  1066. static void qmi_wwan_unbind(struct usbnet *dev, struct usb_interface *intf)
  1067. {
  1068. 	struct qmi_wwan_state *info = (void *)&dev->data;
  1069. 	struct usb_driver *driver = driver_of(intf);
  1070. 	struct usb_interface *other;
  1072. 	if (info->subdriver && info->subdriver->disconnect)
  1073. 		info->subdriver->disconnect(info->control);
  1075. 	/* allow user to unbind using either control or data */
  1076. 	if (intf == info->control)
  1077. 		other = info->data;
  1078. 	else
  1079. 		other = info->control;
  1081. 	/* only if not shared */
  1082. 	if (other && intf != other) {
  1083. 		usb_set_intfdata(other, NULL);
  1084. 		usb_driver_release_interface(driver, other);
  1085. 	}
  1087. 	info->subdriver = NULL;
  1088. 	info->data = NULL;
  1089. 	info->control = NULL;
  1090. }
  1092. /* suspend/resume wrappers calling both usbnet and the cdc-wdm
  1093.  * subdriver if present.
  1094.  *
  1095.  * NOTE: cdc-wdm also supports pre/post_reset, but we cannot provide
  1096.  * wrappers for those without adding usbnet reset support first.
  1097.  */
  1098. static int qmi_wwan_suspend(struct usb_interface *intf, pm_message_t message)
  1099. {
  1100. 	struct usbnet *dev = usb_get_intfdata(intf);
  1101. 	struct qmi_wwan_state *info = (void *)&dev->data;
  1102. 	int ret;
  1104. 	/* Both usbnet_suspend() and subdriver->suspend() MUST return 0
  1105. 	 * in system sleep context, otherwise, the resume callback has
  1106. 	 * to recover device from previous suspend failure.
  1107. 	 */
  1108. 	ret = usbnet_suspend(intf, message);
  1109. 	if (ret < 0)
  1110. 		goto err;
  1112. 	if (intf == info->control && info->subdriver &&
  1113. 	    info->subdriver->suspend)
  1114. 		ret = info->subdriver->suspend(intf, message);
  1115. 	if (ret < 0)
  1116. 		usbnet_resume(intf);
  1117. err:
  1118. 	return ret;
  1119. }
  1121. static int qmi_wwan_resume(struct usb_interface *intf)
  1122. {
  1123. 	struct usbnet *dev = usb_get_intfdata(intf);
  1124. 	struct qmi_wwan_state *info = (void *)&dev->data;
  1125. 	int ret = 0;
  1126. 	bool callsub = (intf == info->control && info->subdriver &&
  1127. 			info->subdriver->resume);
  1129. 	if (callsub)
  1130. 		ret = info->subdriver->resume(intf);
  1131. 	if (ret < 0)
  1132. 		goto err;
  1133. 	ret = usbnet_resume(intf);
  1134. 	if (ret < 0 && callsub)
  1135. 		info->subdriver->suspend(intf, PMSG_SUSPEND);
  1136. err:
  1137. 	return ret;
  1138. }
  1140. static int qmi_wwan_reset_resume(struct usb_interface *intf)
  1141. {
  1142. 	dev_info(&intf->dev, "device do not support reset_resume\n");
  1143. 	intf->needs_binding = 1;
  1144. 	return -EOPNOTSUPP;
  1145. }
  1147. static const struct driver_info	qmi_wwan_info = {
  1148. 	.description	= "WWAN/QMI device",
  1149. 	.flags		= FLAG_WWAN,
  1150. 	.bind		= qmi_wwan_bind,
  1151. 	.unbind		= qmi_wwan_unbind,
  1152. 	.manage_power	= qmi_wwan_manage_power,
  1153. 	.rx_fixup       = qmi_wwan_rx_fixup,
  1154. };
  1156. static const struct driver_info qmi_wwan_raw_ip_info = {
  1157. 	.description	= "WWAN/QMI device",
  1158. 	.flags		= FLAG_WWAN | FLAG_RX_ASSEMBLE | FLAG_NOARP | FLAG_SEND_ZLP,
  1159. 	.bind		= qmi_wwan_bind,
  1160. 	.unbind		= qmi_wwan_unbind,
  1161. 	.manage_power	= qmi_wwan_manage_power,
  1162. #if defined(QUECTEL_WWAN_QMAP)
  1163. 	.tx_fixup       = qmap_qmi_wwan_tx_fixup,
  1164. 	.rx_fixup       = qmap_qmi_wwan_rx_fixup,
  1165. #else
  1166. 	.tx_fixup       = qmi_wwan_tx_fixup,
  1167. 	.rx_fixup       = qmi_wwan_rx_fixup,
  1168. #endif
  1169. };
  1172. /* map QMI/wwan function by a fixed interface number */
  1173. #define QMI_FIXED_INTF(vend, prod, num) \
  1174. 	USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \
  1175. 	.driver_info = (unsigned long)&qmi_wwan_info
  1177. #define QMI_FIXED_RAWIP_INTF(vend, prod, num) \
  1178. 	USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \
  1179. 	.driver_info = (unsigned long)&qmi_wwan_raw_ip_info
  1181. static const struct usb_device_id products[] = {
  1182. #if 1 //Added by Quectel
  1183. 	{ QMI_FIXED_INTF(0x05C6, 0x9003, 4) },  /* Quectel UC20 */
  1184. 	{ QMI_FIXED_INTF(0x05C6, 0x9215, 4) },  /* Quectel EC20 (MDM9215) */
  1185. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0125, 4) },  /* Quectel EC20 (MDM9X07)/EC25/EG25 */
  1186. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0121, 4) },  /* Quectel EC21 */
  1187. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0191, 4) },  /* Quectel EG91 */
  1188. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0195, 4) },  /* Quectel EG95 */
  1189. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0306, 4) },  /* Quectel EG06/EP06/EM06 */
  1190. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0512, 4) },  /* Quectel EG12/EP12/EM12/EG16/EG18 */
  1191. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0296, 4) },  /* Quectel BG96 */
  1192. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0435, 4) },  /* Quectel AG35 */
  1193. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0620, 4) },  /* Quectel EG20 */
  1194. 	{ QMI_FIXED_RAWIP_INTF(0x2C7C, 0x0800, 4) },  /* Quectel RG500 */
  1195. #endif
  1196. 	{ }					/* END */
  1197. };
  1198. MODULE_DEVICE_TABLE(usb, products);
  1200. static int qmi_wwan_probe(struct usb_interface *intf,
  1201. 			  const struct usb_device_id *prod)
  1202. {
  1203. 	struct usb_device_id *id = (struct usb_device_id *)prod;
  1205. 	/* Workaround to enable dynamic IDs.  This disables usbnet
  1206. 	 * blacklisting functionality.  Which, if required, can be
  1207. 	 * reimplemented here by using a magic "blacklist" value
  1208. 	 * instead of 0 in the static device id table
  1209. 	 */
  1210. 	if (!id->driver_info) {
  1211. 		dev_dbg(&intf->dev, "setting defaults for dynamic device id\n");
  1212. 		id->driver_info = (unsigned long)&qmi_wwan_info;
  1213. 	}
  1215. 	if (intf->cur_altsetting->desc.bInterfaceClass != 0xff) {
  1216. 		dev_info(&intf->dev,  "Quectel module not qmi_wwan mode! please check 'at+qcfg=\"usbnet\"'\n");
  1217. 		return -ENODEV;
  1218. 	}
  1220. 	return usbnet_probe(intf, id);
  1221. }
  1223. #if defined(QUECTEL_WWAN_QMAP)
  1224. static int qmap_qmi_wwan_probe(struct usb_interface *intf,
  1225. 			  const struct usb_device_id *prod)
  1226. {
  1227. 	int status = qmi_wwan_probe(intf, prod);
  1228. 	
  1229. 	if (!status) {
  1230. 		struct usbnet *dev = usb_get_intfdata(intf);
  1231. 		struct qmi_wwan_state *info = (void *)&dev->data;		
  1232. 		sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  1233. 		unsigned i;
  1235. 		if (pQmapDev) {
  1236. 			if (pQmapDev->qmap_mode == 1) {
  1237. 				pQmapDev->mpQmapNetDev[0] = dev->net;
  1238. 			}
  1239. 			else if (pQmapDev->qmap_mode > 1) {
  1240. 				for (i = 0; i < pQmapDev->qmap_mode; i++) {
  1241. 					qmap_register_device(pQmapDev, i);
  1242. 				}
  1243. 			}
  1244. 		}
  1245. 	}
  1247. 	return status;
  1248. }
  1250. static void qmap_qmi_wwan_disconnect(struct usb_interface *intf)
  1251. {
  1252. 	struct usbnet *dev = usb_get_intfdata(intf);
  1253. 	struct qmi_wwan_state *info = (void *)&dev->data;
  1254. 	sQmiWwanQmap *pQmapDev = (sQmiWwanQmap *)info->unused;
  1256. 	if (pQmapDev) {
  1257. 		if (pQmapDev->qmap_mode > 1) {
  1258. 			unsigned i;
  1260. 			for (i = 0; i < pQmapDev->qmap_mode; i++) {
  1261. 				qmap_unregister_device(pQmapDev, i);
  1262. 			}	
  1263. 		}
  1264. 		
  1265. 		kfree(pQmapDev);
  1266. 	}
  1268. 	usbnet_disconnect(intf);
  1269. }
  1270. #endif
  1272. static struct usb_driver qmi_wwan_driver = {
  1273. 	.name		      = "qmi_wwan_q",
  1274. 	.id_table	      = products,
  1275. 	.probe		      = qmi_wwan_probe,
  1276. #if defined(QUECTEL_WWAN_QMAP)
  1277. 	.probe		      = qmap_qmi_wwan_probe,
  1278. 	.disconnect	      = qmap_qmi_wwan_disconnect,
  1279. #else
  1280. 	.probe		      = qmi_wwan_probe,
  1281. 	.disconnect	      = usbnet_disconnect,
  1282. #endif
  1283. 	.suspend	      = qmi_wwan_suspend,
  1284. 	.resume		      =	qmi_wwan_resume,
  1285. 	.reset_resume         = qmi_wwan_reset_resume,
  1286. 	.supports_autosuspend = 1,
  1287. 	.disable_hub_initiated_lpm = 1,
  1288. };
  1290. module_usb_driver(qmi_wwan_driver);
  1292. MODULE_AUTHOR("Bjørn Mork <bjorn@mork.no>");
  1293. MODULE_DESCRIPTION("Qualcomm MSM Interface (QMI) WWAN driver");
  1294. MODULE_LICENSE("GPL");
  1295. #define QUECTEL_WWAN_VERSION "Quectel_Linux&Android_QMI_WWAN_Driver_V1.1"
  1296. MODULE_VERSION(QUECTEL_WWAN_VERSION);

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

声明：本文内容由网友自发贡献，不代表【wpsshop博客】立场，版权归原作者所有，本站不承担相应法律责任。如您发现有侵权的内容，请联系我们。转载请注明出处：https://www.wpsshop.cn/w/繁依Fanyi0/article/detail/275170
推荐阅读
相关标签

Copyright © 2003-2013 www.wpsshop.cn 版权所有，并保留所有权利。

  

闽ICP备14008679号